aboutsummaryrefslogtreecommitdiffstats
path: root/fw/types.c
blob: 24a7c3a8b62a4c4e47d49e97cc02e02e37369c5e (plain) (blame)
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
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
#include <stdint.h>

#include "types.h"

#define cmp(a, b) (((a) > (b)) ? 1 : (((a) < (b)) ? -1 : 0))

Status
u32ToNum(U32 x, NumType t, Number *n) {
	n->type = t;

	switch (t) {
	case NUM_U8:
		n->u8 = x & 0xFF;
		return OK;
	case NUM_U16:
		n->u16 = x & 0xFFFF;
		return OK;
	case NUM_U32:
		n->u32 = x;
		return OK;
	case NUM_I8:
		n->u8 = x & 0xFF;
		n->i8 = *(I8 *)&n->u8;
		return OK;
	case NUM_I16:
		n->u16 = x & 0xFFFF;
		n->i16 = *(I16 *)&n->u16;
		return OK;
	case NUM_I32:
		n->i32 = *(I32 *)&x;
		return OK;
	default:
		return FAIL;
	}
}

static Status
cmpU32Num(U32 a, Number b, int *ord) {
	switch (b.type) {
	case NUM_U8:
		*ord = cmp(a, b.u8);
		return OK;
	case NUM_U16:
		*ord = cmp(a, b.u16);
		return OK;
	case NUM_U32:
		*ord = cmp(a, b.u32);
		return OK;
	case NUM_I8:
		*ord = cmp(a, b.i8);
		return OK;
	case NUM_I16:
		*ord = cmp(a, b.i16);
		return OK;
	case NUM_I32:
		*ord = cmp(a, b.i32);
		return OK;
	default:
		return FAIL;
	}
}

Status
cmpNum(Number a, Number b, int *ord) {
	switch (a.type) {
	case NUM_U8:
		a.i32 = a.u8;
		break;
	case NUM_U16:
		a.i32 = a.u16;
		break;
	case NUM_U32:
		return cmpU32Num(a.u32, b, ord);
	case NUM_I8:
		a.i32 = a.i8;
		break;
	case NUM_I16:
		a.i32 = a.i16;
		break;
	case NUM_I32:
		break; // do nothing
	default:
		return FAIL;
	}

	switch (b.type) {
	case NUM_U8:
		*ord = cmp(a.i32, b.u8);
		return OK;
	case NUM_U16:
		*ord = cmp(a.i32, b.u16);
		return OK;
	case NUM_U32:
		*ord = cmp(a.i32, b.u32);
		return OK;
	case NUM_I8:
		*ord = cmp(a.i32, b.i8);
		return OK;
	case NUM_I16:
		*ord = cmp(a.i32, b.i16);
		return OK;
	case NUM_I32:
		*ord = cmp(a.i32, b.i32);
		return OK;
	default:
		return FAIL;
	}
}