Tính CRC - Modbus RTU

Tính CRC Modbus

int[] intSend = new int[8];
intSend[0] = 0x01; // ID of slave device
intSend[1] = 0x03; // code of the command
intSend[2] = 0x1D; // Register address 0x1D63
intSend[3] = 0x63; // Register address 0x1D63
intSend[4] = 0x00; // First 8 bits of the data
intSend[5] = 0x02; // Second 8 bits of the data

int int_crc = 0xFFFF;
int int_lsb;
int int_crc_byte_a, int_crc_byte_b;

for (int int_i = 0; int_i < intSend.Length - 2; int_i++)
{
int_crc = int_crc ^ intSend[int_i];
for (int int_j = 0; int_j < 8; int_j++)
{
int_lsb = int_crc & 0x0001; // Mask of LSB
int_crc = int_crc >> 1;
int_crc = int_crc & 0x7FFF;
if (int_lsb == 1) int_crc = int_crc ^ 0xA001;
}
}


Mình sẽ cho các bạn 1 đoạn mã để thử như sau :
"01 03 00 01 00 04" có mã CRC = 15 C9
----------------------------------------

Hoặc có hàm tính CRC này thấy dễ xem hơn .
Khi sử dụng, thì hãy truyền vào 1 mảng, kiểu dữ liệu là byte và "len" là số byte của chuỗi truyền.
Ví dụ: Với chuỗi "01 03 00 01 00 04". Ta khai báo 1 mảng byte mang[];
Hãy gán giá trị cho mảng như sau: mang[0] = Convert.ToByte("01",16) ....và tiếp tục với
các giá trị còn lại còn lại.
chuỗi truyền có 6 byte nên "len = 6";
Khi sử dụng thì hãy gọi hàm ModRTU_CRC(mang,len);


UInt16 ModRTU_CRC(byte[] buf, int len)
{
UInt16 crc = 0xFFFF;

for (int pos = 0; pos < len; pos++) {
crc ^= (UInt16)buf[pos]; // XOR byte into least sig. byte of crc

for (int i = 8; i != 0; i--) { // Loop over each bit
if ((crc & 0x0001) != 0) { // If the LSB is set
crc >>= 1; // Shift right and XOR 0xA001
crc ^= 0xA001;
}
else // Else LSB is not set
crc >>= 1; // Just shift right
}
}
// Note, this number has low and high bytes swapped, so use it accordingly (or swap bytes)
return crc;
}




Và đây là 1 video tui từng làm 

https://www.youtube.com/watch?v=eKS4dYHkMls