193 lines
3.5 KiB
C++
193 lines
3.5 KiB
C++
#include "crc.h"
|
|
#include <QDebug>
|
|
#include "QString"
|
|
|
|
|
|
crc::crc()
|
|
{
|
|
|
|
}
|
|
|
|
uint8_t crc::crc8(uint8_t *Ptr,uint8_t num)
|
|
{
|
|
|
|
uint8_t crc = 0;
|
|
uint16_t j,i;
|
|
|
|
for (j = 0; j < num; j++)
|
|
{
|
|
crc ^= *(Ptr+j);
|
|
for ( i = 0; i < 8; i++)
|
|
{
|
|
if ((crc & 0x01) != 0)
|
|
{
|
|
crc >>= 1;
|
|
crc ^= 0x8c;
|
|
}
|
|
else
|
|
{
|
|
crc >>= 1;
|
|
}
|
|
}
|
|
}
|
|
return crc;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void crc::crc16(uint8_t *data, int offset, int len,uint8_t *lb,uint8_t *hb)
|
|
{
|
|
if (len > 0)
|
|
{
|
|
uint16_t crc = 0xFFFF;
|
|
int i = offset;
|
|
for (; i < len; i++)
|
|
{
|
|
crc = (uint16_t)(crc ^ (data[i]));
|
|
for (int j = 0; j < 8; j++)
|
|
{
|
|
crc = (crc & 1) != 0 ? (uint16_t)((crc >> 1) ^ 0xA001) : (uint16_t)(crc >> 1);
|
|
}
|
|
}
|
|
uint8_t hi = (uint8_t)((crc & 0xFF00) >> 8); //高位置
|
|
uint8_t lo = (uint8_t)(crc & 0x00FF); //低位置
|
|
*lb=lo;*hb=hi;
|
|
}
|
|
}
|
|
|
|
|
|
int8_t crc::CheckSumCode(uint8_t CODEMODE, uint8_t *pBuffer, uint16_t Len, uint16_t offset, uint8_t *CHKA, uint8_t *CHKB)
|
|
{
|
|
uint16_t i = 0;
|
|
uint8_t _CHKA = 0x00,_CHKB = 0x00;
|
|
|
|
|
|
for(i=offset;i<Len;i++)
|
|
{
|
|
_CHKA += pBuffer[i];
|
|
_CHKB +=_CHKA;
|
|
}
|
|
if(CODEMODE==DECODE){
|
|
if(_CHKA!=*CHKA)
|
|
return -1;
|
|
if(_CHKB!=*CHKB)
|
|
return -2;
|
|
}
|
|
else{
|
|
*CHKA = _CHKA;
|
|
|
|
*CHKB = _CHKB;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int crc::CheckSumCode(uint8_t CODEMODE, QByteArray pBuffer, uint16_t Len, uint16_t offset, uint8_t *CHKA, uint8_t *CHKB)
|
|
{
|
|
uint16_t i = 0;
|
|
uint8_t _CHKA = 0x00,_CHKB = 0x00;
|
|
|
|
|
|
for(i=offset;i<Len;i++)
|
|
{
|
|
_CHKA += pBuffer[i];
|
|
_CHKB +=_CHKA;
|
|
}
|
|
if(CODEMODE==DECODE){
|
|
if(_CHKA!=*CHKA)
|
|
return -1;
|
|
if(_CHKB!=*CHKB)
|
|
return -2;
|
|
}
|
|
else{
|
|
*CHKA = _CHKA;
|
|
|
|
*CHKB = _CHKB;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
QString crc::byte_array_to_string(QByteArray data)
|
|
{
|
|
QString ret(data.toHex().toUpper());
|
|
int len = ret.length()/2;
|
|
for(int i=1;i<len;i++)
|
|
{
|
|
ret.insert(2*i+i-1," ");
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
|
|
// u16转为整形
|
|
QString crc::byte_array_to_int_string(QByteArray data)
|
|
{
|
|
QString str;
|
|
int len = data.size()/2;
|
|
for(int i=0;i<len;i++)
|
|
{
|
|
str.append(QString::number(data[i*2]|(data[i*2+1]<<8),10));
|
|
str.append(',');
|
|
}
|
|
|
|
return str;
|
|
}
|
|
|
|
|
|
|
|
|
|
uint32_t crc::crc32(const QByteArray &data_buf)
|
|
{
|
|
uint32_t temp,crc = 0xFFFFFFFF;
|
|
int i,j;
|
|
i = 0;
|
|
ConverBuf cov;
|
|
if((data_buf.size() %4) != 0)
|
|
{
|
|
return 0;
|
|
}
|
|
while(i<data_buf.size())
|
|
{
|
|
cov.c_databuf[0] = data_buf[i++];
|
|
cov.c_databuf[1] = data_buf[i++];
|
|
cov.c_databuf[2] = data_buf[i++];
|
|
cov.c_databuf[3] = data_buf[i++];
|
|
temp = cov.ul_data;
|
|
for(j=0; j<32; j++)
|
|
{
|
|
if( (crc ^ temp) & 0x80000000 )
|
|
{
|
|
crc = 0x04C11DB7 ^(crc<<1);
|
|
}
|
|
else
|
|
{
|
|
crc <<=1;
|
|
}
|
|
temp<<=1;
|
|
}
|
|
crc&=0xFFFFFFFF;
|
|
}
|
|
return crc;
|
|
}
|
|
|
|
|
|
QString crc::uint8_array_to_string(uint8_t * buf,int len)
|
|
{
|
|
QString temp,msg;
|
|
int j = 0;
|
|
|
|
while (j<len)
|
|
{
|
|
temp = QString("%1 ").arg((int)buf[j], 2, 16, QLatin1Char('0'));
|
|
msg.append(temp);
|
|
j++;
|
|
}
|
|
|
|
return msg;
|
|
}
|
|
|