Project

General

Profile

Statistics
| Revision:

root / proj / utils.c @ 145

History | View | Annotate | Download (866 Bytes)

1
#include <lcom/lcf.h>
2

    
3
#include "utils.h"
4

    
5
#include <stdint.h>
6
#include "errors.h"
7

    
8
int(util_get_LSB)(uint16_t val, uint8_t *lsb) {
9
    if (lsb == NULL) return NULL_PTR;
10
    *lsb = val;
11
    return SUCCESS;
12
}
13

    
14
int(util_get_MSB)(uint16_t val, uint8_t *msb) {
15
    if (msb == NULL) return NULL_PTR;
16
    *msb = (val >> 8);
17
    return SUCCESS;
18
}
19

    
20
int (util_sys_inb)(int port, uint8_t *value) {
21
    if(value == NULL) return NULL_PTR;
22
    uint32_t n = 0;
23
    if(sys_inb(port, &n)) return READ_ERROR;
24
    *value = n;
25
    return SUCCESS;
26
}
27

    
28
int (unsubscribe_interrupt)(int *interrupt_id) {
29
    if (interrupt_id == NULL) return NULL_PTR;
30
    if(sys_irqrmpolicy(interrupt_id)) return UNSBCR_ERROR;
31
    return SUCCESS;
32
}
33

    
34
int16_t min(int16_t a, int16_t b){ return (b < a ? b : a); }
35
int16_t max(int16_t a, int16_t b){ return (a < b ? b : a); }