56 lines
1.2 KiB
C
56 lines
1.2 KiB
C
#include "crc16.h"
|
|
|
|
void crc16_init(crc16_data_t *crc16Config)
|
|
{
|
|
crc16Config->currentCrc = 0;
|
|
}
|
|
|
|
void crc16_update(crc16_data_t *crc16Config, const uint8_t *src, uint32_t lengthInBytes)
|
|
{
|
|
uint32_t crc = crc16Config->currentCrc;
|
|
|
|
uint32_t j;
|
|
for (j = 0; j < lengthInBytes; ++j)
|
|
{
|
|
uint32_t i;
|
|
uint32_t byte = src[j];
|
|
crc ^= byte << 8;
|
|
for (i = 0; i < 8; ++i)
|
|
{
|
|
uint32_t temp = crc << 1;
|
|
if (crc & 0x8000)
|
|
{
|
|
temp ^= 0x1021;
|
|
}
|
|
crc = temp;
|
|
}
|
|
}
|
|
|
|
crc16Config->currentCrc = crc;
|
|
}
|
|
|
|
void crc16_finalize(crc16_data_t *crc16Config, uint16_t *hash)
|
|
{
|
|
*hash = crc16Config->currentCrc;
|
|
}
|
|
|
|
crc16_data_t crc16data;
|
|
|
|
void CRC16_UpdateMessageChecksum(i2c_message_t *message)
|
|
{
|
|
uint16_t hash;
|
|
crc16_init(&crc16data);
|
|
crc16_update(&crc16data, message->data, message->length);
|
|
crc16_finalize(&crc16data, &hash);
|
|
message->crc = hash;
|
|
}
|
|
|
|
bool CRC16_IsMessageValid(i2c_message_t *message)
|
|
{
|
|
uint16_t hash;
|
|
crc16_init(&crc16data);
|
|
crc16_update(&crc16data, message->data, message->length);
|
|
crc16_finalize(&crc16data, &hash);
|
|
return message->crc == hash;
|
|
}
|