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
|
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
|
-
+
-
+
-
+
-
+
-
+
-
+
|
* Public License, either version 2 or 3, which can be found in the file
* LICENSE.GPLv2 or LICENSE.GPLv3 respectively included in the packaging of this
* file.
*/
#include "config.h"
#import "crc16.h"
#import "OFCRC16.h"
#define CRC16_MAGIC 0xA001
static const uint16_t CRC16Magic = 0xA001;
uint16_t
of_crc16(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;
}
|