13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
|
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
|
-
+
-
+
-
+
-
+
-
+
|
* file.
*/
#include "config.h"
#import "OFCRC16.h"
#define CRC16_MAGIC 0xA001
OFCRC16(uint16_t crc, const void *bytes_, size_t length)
OFCRC16(uint16_t CRC, const void *bytes_, size_t length)
{
const unsigned char *bytes = bytes_;
for (size_t i = 0; i < length; i++) {
crc ^= bytes[i];
CRC ^= bytes[i];
for (uint8_t j = 0; j < 8; j++)
crc = (crc >> 1) ^ (CRC16_MAGIC & (~(crc & 1) + 1));
CRC = (CRC >> 1) ^ (CRC16Magic & (~(CRC & 1) + 1));
}
return crc;
return CRC;
}
|