Project

General

Profile

Statistics
| Revision:

root / lab5 / utils.c @ 125

History | View | Annotate | Download (757 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
#ifdef LAB3
21
    uint32_t sys_inb_counter = 0;
22
#endif
23

    
24
int (util_sys_inb)(int port, uint8_t *value) {
25
    if(value == NULL) return NULL_PTR;
26
    uint32_t n = 0;
27
    if(sys_inb(port, &n)) return READ_ERROR;
28
    *value = n;
29
    #ifdef LAB3
30
        ++sys_inb_counter;
31
    #endif
32
    return SUCCESS;
33
}
34

    
35
int16_t abs16(int16_t x) {
36
    return (x >= 0) ? (int16_t)(x) : (int16_t)(-x);
37
}