checker_m4/source/soft/crc.c

#include "crc.h"







uint8_t crc_crc8(const uint8_t *data,int num)
{
  uint8_t crc = 0;
  uint16_t j,i;
  for (j = 0; j < num; j++)
  {
    crc ^= *(data+j);
    for ( i = 0; i < 8; i++)
    {
      if ((crc & 0x01) != 0)
      {
        crc >>= 1;
        crc ^= 0x8c;
      }
      else
      {
        crc >>= 1;
      }
    }
  }
  return crc;
}





void crc_crc16(const uint8_t *data, int len,uint8_t *lb,uint8_t *hb)
{
  if (len > 0)
  {
    uint16_t crc = 0xFFFF;
    int i = 0;
    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;
  }
}



uint32_t crc_crc32(const uint8_t *data,int size)
{
  uint32_t temp,crc=0xffffffff;
  int i=0,j=0;
  if((size%4)!=0)
  {
    return 0;
  }
  while(i<size)
  {
    temp=data[i]|(data[i+1]<<8)|(data[i+2]<<16)|(data[i+3]<<24);
    i+=4;
    for(j=0;j<32;j++)
    {
      if((crc^temp)&0x80000000)
        crc=0x04c11db7^(crc<<1);
      else
        crc<<=1;
      temp<<=1;
    }
    crc&=0xffffffff;
  }
  return crc;
}





void crc_sumcheck(const uint8_t *data,int size,uint8_t *chka,uint8_t *chkb) 
{
  if(chka==0) return;
  if(chkb==0) return;
  *chka=0;
  *chkb=0;
	for(int i=0;i<size;i++)
	{
		*chka+=data[i];
		*chkb+=*chka;
	}
}