fw/types.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53

#include <xc.h>

#include <stdint.h>

#include "types.h"

U16
addU16(U16 a, U16 b) {
	a.hi += b.hi;
	a.lo += b.lo;
	if (STATUSbits.C) {
		a.hi++;
	}
	return a;
}

U16
addU16U8(U16 a, U8 b) {
	a.lo += b;
	if (STATUSbits.C) {
		a.hi++;
	}
	return a;
}

U16
lshiftU16(U16 a, U8 b) {
	a.hi = (U8)(a.hi << b) | (a.lo >> (8u-b));
	a.lo <<= b;
	return a;
}

U16
rshiftU16(U16 a, U8 b) {
	a.lo = (U8)((a.hi >> (8u-b)) << (8u-b)) | (U8)(a.lo >> b);
	a.hi >>= b;
	return a;
}

I8
cmpU16(U16 a, U16 b) {
	if (a.hi > b.hi) {
		return 1;
	} else if (a.hi < b.hi) {
		return -1;
	} else if (a.lo > b.lo) {
		return 1;
	} else if (a.lo < b.lo) {
		return -1;
	} else {
		return 0;
	}
}