123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182 |
- #include "crc8.h"
- unsigned char crc8( unsigned char *pData,
- unsigned int dataLen,
- unsigned char initialValue,
- unsigned char polynomial )
- {
- unsigned char i;
- unsigned char crc;
- crc = initialValue;
- while (dataLen --)
- {
- crc ^= *pData ++;
- for( i = 0; i < 8; i++ )
- {
- if(crc & 0x80)
- {
- crc <<= 1;
- crc ^= polynomial;
- }
- else
- {
- crc <<= 1;
- }
- }
- }
- return crc;
- }
- unsigned char crc8_ger( unsigned char *pData,
- unsigned int dataLen)
- {
- return crc8(pData, dataLen, 0xff, 0x31);
- }
- int crc8_gernCheckT( unsigned char *pData,
- unsigned int dataLen,
- unsigned char targetCRC)
- {
- if (crc8(pData, dataLen, 0xff, 0x31) == targetCRC)
- {
- return 1;
- }
- return 0;
- }
- int crc8_sht3x( unsigned char *pData,
- unsigned int dataLen,
- unsigned char targetCRC)
- {
- if (crc8(pData, dataLen, 0xff, 0x31) == targetCRC)
- {
- return 1;
- }
- return 0;
- }
- int crc8_sht2x( unsigned char *pData,
- unsigned int dataLen,
- unsigned char targetCRC)
- {
- if (crc8(pData, dataLen, 0x00, 0x31) == targetCRC)
- {
- return 1;
- }
- return 0;
- }
- int cmp_crc8( uint8_t *pData,
- uint16_t dataLen,
- uint8_t targetCRC)
- {
- if (crc8(pData, dataLen, 0x55, 0x07) == targetCRC)
- {
- return 1;
- }
- return 0;
- }
- int get_crc8( uint8_t *pData,
- uint16_t dataLen)
- {
- return crc8(pData, dataLen, 0x55, 0x07);
- }
- bool checkFramLegal(uint8_t *srcBuffer, uint8_t srcLen)
- {
- bool ret = false;
- uint8_t len;
- uint8_t cmd;
- uint8_t crc1;
-
- len = srcBuffer[0];
- cmd = srcBuffer[1];
- crc1 = srcBuffer[len];
-
- if (len == (srcLen - 1))
- {
- if ((cmd & 0x80) == 0)
- {
- if (cmp_crc8(srcBuffer, srcLen - 1, crc1))
- {
- ret = true;
-
- }
- }
- else
- {
- ret = true;
- }
- }
- return ret;
- }
- void completFramParams(uint8_t *srcBuffer, uint8_t srcLen)
- {
- uint8_t *head;
- uint8_t *len;
- uint8_t *crc1;
-
- uint8_t *end;
- len = &srcBuffer[0];
- crc1 = &srcBuffer[srcLen - 1];
-
- *len = srcLen - 1;
- *crc1 = get_crc8(srcBuffer, srcLen - 1);
-
- }
|