[筆記]Modbus CRC-16 算法 C# 版本

 (1) 將CRC 寄存器的初始值設為H'FFFF。

(2) 對CRC 寄存器和資訊的第1 個位元組資料進行XOR 運算，並將計算結果

返回CRC 寄存器。

(3) 用“0”填入MSB，同時使CRC 寄存器右移1 位。

(4) 從LSB 移動的位如果為“0”，則重複執行步驟(3)( 處理下1 個移位)。

從LSB 移動的位如果為“1”，則對CRC 寄存器和H'A001 進行XOR 運算，並將結果返回

CRC 寄存器。

(5) 重複執行步驟(3) 和(4)，直到移動8 位。

(6) 如果資訊處理尚未結束，則對CRC 寄存器和資訊的下1 個位元組進行XOR 運算，並返回CRC

寄存器，從第(3) 步起重複執行。

(7) 將計算的結果(CRC 寄存器的值) 從低位元位元組附加到資訊上。

 

public static byte[] CRC16_Sum(byte[] msg)
{
     UInt16 crc16_buf = 0xFFFF;
     for (int i = 0; i < msg.Length; i++)
     {
          crc16_buf ^= msg[i];
          for (int j = 0; j < 8; j++)
          {
              if ((crc16_buf & 0x01) == 0x01)
              {
                  crc16_buf >>= 1;
                  crc16_buf ^= 0xA001;
              }
              else crc16_buf >>= 1;
           }
     }
     byte[] data = { (byte)(crc16_buf & 0xFF), (byte)(crc16_buf >> 8) };

    return data;

}