102 lines
2.4 KiB
C
102 lines
2.4 KiB
C
#include "crc16.h"
|
||
|
||
static uint8_t crc_tab16_init = 0;
|
||
static uint16_t crc_tab16[256];
|
||
|
||
/*
|
||
* uint16_t crc_16( const unsigned char *input_str, size_t num_bytes );
|
||
*
|
||
*函数crc_16()一次计算一个字节的16位CRC16
|
||
*其开头已传递给函数的字符串。的数量
|
||
*要检查的字节也是一个参数。字符串中的字节数为
|
||
*受恒定大小最大值的限制。
|
||
*/
|
||
uint16_t crc_16(const uint8_t *input_str, uint16_t num_bytes)
|
||
{
|
||
uint16_t crc;
|
||
const uint8_t *ptr;
|
||
uint16_t a;
|
||
if (!crc_tab16_init)
|
||
init_crc16_tab();
|
||
crc = CRC_START_16;
|
||
ptr = input_str;
|
||
if (ptr != NULL)
|
||
for (a = 0; a < num_bytes; a++)
|
||
{
|
||
crc = (crc >> 8) ^ crc_tab16[(crc ^ (uint16_t)*ptr++) & 0x00FF];
|
||
}
|
||
return crc;
|
||
}
|
||
|
||
/*
|
||
* uint16_t crc_modbus( const unsigned char *input_str, size_t num_bytes );
|
||
*
|
||
*函数crc_modbus()一次计算16位modbus循环冗余校验
|
||
*一个字节字符串，其开头已被传递给函数。这
|
||
*要检查的字节数也是一个参数。
|
||
*/
|
||
|
||
uint16_t crc_modbus(const uint8_t *input_str, uint16_t num_bytes)
|
||
{
|
||
uint16_t crc;
|
||
const uint8_t *ptr;
|
||
uint16_t a;
|
||
|
||
if (!crc_tab16_init)
|
||
init_crc16_tab();
|
||
|
||
crc = CRC_START_MODBUS;
|
||
ptr = input_str;
|
||
if (ptr != NULL)
|
||
for (a = 0; a < num_bytes; a++)
|
||
{
|
||
|
||
crc = (crc >> 8) ^ crc_tab16[(crc ^ (uint16_t)*ptr++) & 0x00FF];
|
||
}
|
||
return crc;
|
||
}
|
||
|
||
/*
|
||
* uint16_t update_crc_16( uint16_t crc, unsigned char c );
|
||
*
|
||
*函数update_crc_16()根据
|
||
*前一个循环冗余校验值和下一个要检查的数据字节。
|
||
*/
|
||
uint16_t update_crc_16(uint16_t crc, uint8_t c)
|
||
{
|
||
if (!crc_tab16_init)
|
||
init_crc16_tab();
|
||
return (crc >> 8) ^ crc_tab16[(crc ^ (uint16_t)c) & 0x00FF];
|
||
}
|
||
|
||
/*
|
||
* static void init_crc16_tab( void );
|
||
*
|
||
*为了获得最佳性能，使用CRC16例程查找带有值的表
|
||
*可以直接在异或算法中使用的算法。
|
||
*查找表首次由init_crc16_tab()例程计算
|
||
*调用循环冗余校验函数。
|
||
*/
|
||
void init_crc16_tab(void)
|
||
{
|
||
uint16_t i;
|
||
uint16_t j;
|
||
uint16_t crc;
|
||
uint16_t c;
|
||
for (i = 0; i < 256; i++)
|
||
{
|
||
crc = 0;
|
||
c = i;
|
||
for (j = 0; j < 8; j++)
|
||
{
|
||
if ((crc ^ c) & 0x0001)
|
||
crc = (crc >> 1) ^ CRC_POLY_16;
|
||
else
|
||
crc = crc >> 1;
|
||
c = c >> 1;
|
||
}
|
||
crc_tab16[i] = crc;
|
||
}
|
||
crc_tab16_init = 1;
|
||
}
|