2020-09-15 03:33:59 +02:00
|
|
|
"""Helper functions."""
|
2021-04-01 17:19:16 +02:00
|
|
|
import typing as t
|
2020-09-17 02:35:09 +02:00
|
|
|
|
2021-04-01 17:19:16 +02:00
|
|
|
_crc16_cache = {}
|
2020-09-17 02:35:09 +02:00
|
|
|
|
|
|
|
|
2021-04-01 17:19:16 +02:00
|
|
|
def crc16(
|
|
|
|
sequence: t.Sequence[int],
|
|
|
|
polynomial: int = 0xA001, # Default: Modbus CRC-16.
|
|
|
|
init_value: int = 0xFFFF,
|
|
|
|
) -> int:
|
|
|
|
"""Calculate the CRC-16 of a sequence of integers."""
|
|
|
|
global _crc16_cache
|
2020-09-17 02:35:09 +02:00
|
|
|
|
2021-04-01 17:19:16 +02:00
|
|
|
try:
|
|
|
|
crc_table = _crc16_cache[polynomial]
|
|
|
|
except KeyError:
|
|
|
|
crc_table = []
|
|
|
|
for dividend in range(0, 256):
|
|
|
|
remainder = dividend
|
|
|
|
for _ in range(0, 8):
|
|
|
|
if remainder & 1:
|
|
|
|
remainder = remainder >> 1 ^ polynomial
|
|
|
|
else:
|
|
|
|
remainder = remainder >> 1
|
|
|
|
crc_table.append(remainder)
|
|
|
|
_crc16_cache[polynomial] = crc_table
|
2020-09-20 11:16:49 +02:00
|
|
|
|
2021-04-01 17:19:16 +02:00
|
|
|
crc = init_value
|
|
|
|
for item in sequence:
|
|
|
|
crc = crc >> 8 ^ crc_table[(crc ^ item) & 0xFF]
|
|
|
|
return crc
|