summaryrefslogtreecommitdiff
path: root/src/util/ublox-cksum
blob: 05e8d6b11bd64014f724b0f91ca591beb3688dec (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
#!/usr/bin/env nickle

typedef struct {
	int	a, b;
} ck_t;

/* Fletcher algorithm */
ck_t checksum(int[] msg)
{
	ck_t	ck = { .a = 0, .b = 0 };
	for (int i = 4; i < dim(msg); i++) {
		ck.a += msg[i];
		ck.b += ck.a;
		ck.a &= 0xff;
		ck.b &= 0xff;
	}
	return ck;
}

void main()
{
	string[...]	input;
	int[...]	msg;

	setdim(input, 0);
	while (!File::end(stdin)) {
		input[dim(input)] = gets();
	}

	setdim(msg, 0);
	for (int i = 0; i < dim(input); i++) {
		string[*] words = String::wordsplit(input[i], " ,\t");
		for (int j = 0; j < dim(words); j++) {
			if (words[j] == "/" + "*")
				break;
			if (String::length(words[j]) > 0 &&
			    Ctype::isdigit(words[j][0])) {
				msg[dim(msg)] = string_to_integer(words[j]);
			}
		 }
	}
	printf("\t0xb5, 0x62, \t\t/* length: %d bytes */\n", dim(msg));
	for (int i = 0; i < dim(input); i++)
		printf("%s\n", input[i]);
	ck_t ck = checksum(msg);
	printf ("\t0x%02x, 0x%02x,\n",
		ck.a, ck.b);
}

main();