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
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
|
#include "global.h"
#include "MATH_crc.h"
ARM_FUNC void MATHi_CRC8InitTable(struct MATHCRC8Table *table, u8 poly) {
u32 r, i, j;
u8 *t = table->table;
for (i = 0; i < 256; i++) {
r = i;
for (j = 0; j < 8; j++) {
if (r & 0x80) {
r = (r << 1) ^ poly;
}
else {
r <<= 1;
}
}
t[i] = (u8)r;
}
}
ARM_FUNC void MATHi_CRC8Update(const struct MATHCRC8Table *table, MATHCRC8Context *context, const void *input, u32 length) {
u32 r, i;
const u8* t = table->table;
u8* data = (u8*)input;
r = *context;
for (i = 0; i < length; i++) {
r = t[(r ^ *data) & 0xff];
data++;
}
*context = (MATHCRC8Context)r;
}
ARM_FUNC void MATHi_CRC16InitTable(struct MATHCRC16Table *table, u16 poly) {
u32 r, i, j;
u16 *t = table->table;
for (i = 0; i < 256; i++) {
r = i << 8;
for (j = 0; j < 8; j++) {
if (r & 0x8000) {
r = (r << 1) ^ poly;
}
else {
r <<= 1;
}
}
t[i] = (u16)r;
}
}
ARM_FUNC void MATHi_CRC16InitTableRev(struct MATHCRC16Table *table, u16 poly) {
u32 r, i, j;
u16 *t = table->table;
for (i = 0; i < 256; i++) {
r = i;
for (j = 0; j < 8; j++) {
if (r & 1) {
r = (r >> 1) ^ poly;
}
else {
r >>= 1;
}
}
t[i] = (u16)r;
}
}
ARM_FUNC void MATHi_CRC16Update(const struct MATHCRC16Table *table, MATHCRC16Context *context, const void *input, u32 length) {
u32 r, i;
const u16* t = table->table;
u8* data = (u8*)input;
r = *context;
for (i = 0; i < length; i++) {
r = (r << 8) ^ t[((r >> 8) ^ *data) & 0xff];
data++;
}
*context = (MATHCRC16Context)r;
}
ARM_FUNC void MATHi_CRC16UpdateRev(const struct MATHCRC16Table *table, MATHCRC16Context *context, const void *input, u32 length) {
u32 r, i;
const u16* t = table->table;
u8* data = (u8*)input;
r = *context;
for (i = 0; i < length; i++) {
r = (r >> 8) ^ t[(r ^ *data) & 0xff];
data++;
}
*context = (MATHCRC16Context)r;
}
ARM_FUNC void MATHi_CRC32InitTableRev(struct MATHCRC32Table *table, u32 poly) {
u32 r, i, j;
u32 *t = table->table;
for (i = 0; i < 256; i++) {
r = i;
for (j = 0; j < 8; j++) {
if (r & 1) {
r = (r >> 1) ^ poly;
}
else {
r >>= 1;
}
}
t[i] = r;
}
}
ARM_FUNC void MATHi_CRC32UpdateRev(const struct MATHCRC32Table *table, MATHCRC32Context *context, const void *input, u32 length) {
u32 r, i;
const u32* t = table->table;
u8* data = (u8*)input;
r = *context;
for (i = 0; i < length; i++) {
r = (r >> 8) ^ t[(r ^ *data) & 0xff];
data++;
}
*context = r;
}
ARM_FUNC u8 MATH_CalcCRC8(const struct MATHCRC8Table *table, const void *data, u32 dataLength) {
MATHCRC8Context ctx = 0;
MATHi_CRC8Update(table, &ctx, data, dataLength);
return ctx;
}
ARM_FUNC u16 MATH_CalcCRC16(const struct MATHCRC16Table *table, const void *data, u32 dataLength) {
MATHCRC16Context ctx = 0;
MATHi_CRC16UpdateRev(table, &ctx, data, dataLength);
return ctx;
}
ARM_FUNC u16 MATH_CalcCRC16CCITT(const struct MATHCRC16Table *table, const void *data, u32 dataLength) {
MATHCRC16Context ctx = 0xffff;
MATHi_CRC16Update(table, &ctx, data, dataLength);
return ctx;
}
ARM_FUNC u32 MATH_CalcCRC32(const struct MATHCRC32Table *table, const void *data, u32 dataLength) {
MATHCRC32Context ctx = (MATHCRC32Context)(~0);
MATHi_CRC32UpdateRev(table, &ctx, data, dataLength);
return ~ctx;
}
|
