void CRC16_S(byte[] data, int len)
{
byte CRC16Lo;
byte CRC16Hi; //CRC寄存器
byte CL; byte CH; //多項(xiàng)式碼&HA001
byte SaveHi; byte SaveLo;
int Flag;
CRC16Lo = 0xFF;
CRC16Hi = 0xFF;
CL = 0x01;
CH = 0xA0;
for (int i = 0; i < len; i++)
{
CRC16Lo = (byte)(CRC16Lo ^ data[i]); //每一個(gè)數(shù)據(jù)與CRC寄存器進(jìn)行異或
for (Flag = 0; Flag <= 7; Flag++)
{
SaveHi = CRC16Hi;
SaveLo = CRC16Lo;
CRC16Hi = (byte)(CRC16Hi >> 1); //高位右移一位
CRC16Lo = (byte)(CRC16Lo >> 1); //低位右移一位
if ((SaveHi & 0x01) == 0x01) //如果高位字節(jié)位為1
{
CRC16Lo = (byte)(CRC16Lo | 0x80); //則低位字節(jié)右移后前面補(bǔ)1
} //否則自動(dòng)補(bǔ)0
if ((SaveLo & 0x01) == 0x01) //如果LSB為1，則與多項(xiàng)式碼進(jìn)行異或
{
CRC16Hi = (byte)(CRC16Hi ^ CH);
CRC16Lo = (byte)(CRC16Lo ^ CL);
}
}
}
//如果是modbus協(xié)議的話，應(yīng)該是是低位，第二位是高位
data[len++] = CRC16Lo; //CRC低位
data[len] = CRC16Hi; //CRC 高位
}