github.com/UtilitechAS.amsreader-firmware
1
0
Fork 0
mirror of https://github.com/UtilitechAS/amsreader-firmware.git synced 2026-01-25 20:06:08 +00:00
Code Issues Packages Projects Releases Wiki Activity

CRC and Pow board profile

Browse Source
This commit is contained in:
Gunnar Skjold
2024-03-17 09:14:02 +01:00
parent bdba6a0254
commit dfca5e37dc
3 changed files with 30 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

1
lib/AmsDecoder/include/crc.h
View File

@@ -12,5 +12,6 @@
uint16_t crc16(const uint8_t* p, int len);
uint16_t crc16_x25(const uint8_t* p, int len);
uint16_t crc16_ccit(const uint8_t* p, int len);
#endif

22
lib/AmsDecoder/src/crc.cpp
View File

@@ -21,7 +21,7 @@ uint16_t crc16 (const uint8_t *p, int len) {
uint16_t crc = 0;
while (len--) {
int i;
uint8_t i;
crc ^= *p++;
for (i = 0 ; i < 8 ; ++i) {
if (crc & 1)
@@ -32,4 +32,22 @@ uint16_t crc16 (const uint8_t *p, int len) {
}
return crc;
}
}
uint16_t crc16_ccit(const uint8_t *p, int len)
{
int crc;
char i;
crc = 0;
while (len--) {
uint8_t i;
crc = crc ^ (uint8_t) *p++ << 8;
for (i = 0 ; i < 8 ; ++i) {
if (crc & 0x8000)
crc = crc << 1 ^ 0x1021;
else
crc = crc << 1;
}
}
return (crc);
}