16位CRC校验程序

/*CRC计算方法

1、预置1个16位的寄存器为十六进制FFFF（即全为1），称此寄存器为CRC寄存器；

2、把第一个8位二进制数据（即通讯信息帧的第一个字节）与16位的CRC寄存器的低8位相异或，把结果放于CRC寄存器中

3、把CRC寄存器的内容右移一位（朝低位）用0填补最高位，并检查右移后的移出位

4、如果移出位为0，重复第三步（再次右移一位）

如果移出位为1；CRC寄存器与多项式A001（1010 0000 0000 0001）进行异或

5、重复步骤3和4，直到右移八次，这样整个8位数据全部进行了处理。

6、重复步骤2到步骤5，进行通讯信息帧下一个字节的处理

7、将该通讯信息帧所有字节按上述步骤计算完成后，得到的16位CRC寄存器的高、低字节进行交换

*/

 

 

u16 Modbus_CRC(u8 *mod_buf,u8 len )

{

u16 Crc = 0xffff,CRC_swop;

u8 i = 0,j;

for(i = 0;1 < len;i++)

{

Crc=Crc^*(mod_buf+i);

for(j = 0;j < 8;j++)

{

if(Crc&0x1)

{

Crc >>= 1;

Crc = Crc^0xA001;

}

else

{

Crc >>= 1;

}

}

}

CRC_swop = (Crc&0xff)<<8;

CRC_swop |= Crc >> 8&0xff;

//if((mod_buf[len+1]) == (CRC_swop&0xff)&&(mod_buf[len]) == (CRC_swop >>8&0xff))

//{

//return 1;

//}

return CRC_swop;

 

}