root / lab5 / utils.c @ 125
History | View | Annotate | Download (757 Bytes)
| 1 | 109 | up20180655 | #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 | } |