19 lines
447 B
C
19 lines
447 B
C
#pragma once
|
|
|
|
#include <stdint.h>
|
|
|
|
inline uint16_t crc16_ccitt(const uint8_t* data, uint16_t len) {
|
|
uint16_t crc = 0xFFFF;
|
|
for (uint16_t i = 0; i < len; i++) {
|
|
crc ^= (uint16_t)data[i] << 8;
|
|
for (int j = 0; j < 8; j++) {
|
|
if (crc & 0x8000) {
|
|
crc = (crc << 1) ^ 0x1021;
|
|
} else {
|
|
crc = crc << 1;
|
|
}
|
|
crc &= 0xFFFF;
|
|
}
|
|
}
|
|
return crc;
|
|
} |