唐山轨道机控制端TCP服务
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

155 lines
5.8 KiB

8 months ago
using System;
using System.Security.Cryptography;
namespace EGFramework{
public static class EGCrcModbusExtension
{
/// CRC calculate is a common device verify algorithm
/// use
// hex = {0x80,0x05};
// Polynomial = x^16+x^15+x^2+1 = 1 80 05
public const ushort CRC_16_Modbus_Polynomial = 0x8005;
// hex = {0xFF,0xFF}
public const ushort CRC_16_Modbus_Start = 0xFFFF;
// hex = {0x00,0x00}
public const ushort CRC_16_Modbus_ResultXOR = 0x0000;
private static readonly ushort[] Crc_16_Table_Modbus ={
0x00,0xC0C1,0xC181,0x140,0xC301,0x3C0,0x280,0xC241,0xC601,0x6C0,0x780,0xC741,0x500,0xC5C1,0xC481,0x440,
0xCC01,0xCC0,0xD80,0xCD41,0xF00,0xCFC1,0xCE81,0xE40,0xA00,0xCAC1,0xCB81,0xB40,0xC901,0x9C0,0x880,0xC841,
0xD801,0x18C0,0x1980,0xD941,0x1B00,0xDBC1,0xDA81,0x1A40,0x1E00,0xDEC1,0xDF81,0x1F40,0xDD01,0x1DC0,0x1C80,0xDC41,
0x1400,0xD4C1,0xD581,0x1540,0xD701,0x17C0,0x1680,0xD641,0xD201,0x12C0,0x1380,0xD341,0x1100,0xD1C1,0xD081,0x1040,
0xF001,0x30C0,0x3180,0xF141,0x3300,0xF3C1,0xF281,0x3240,0x3600,0xF6C1,0xF781,0x3740,0xF501,0x35C0,0x3480,0xF441,
0x3C00,0xFCC1,0xFD81,0x3D40,0xFF01,0x3FC0,0x3E80,0xFE41,0xFA01,0x3AC0,0x3B80,0xFB41,0x3900,0xF9C1,0xF881,0x3840,
0x2800,0xE8C1,0xE981,0x2940,0xEB01,0x2BC0,0x2A80,0xEA41,0xEE01,0x2EC0,0x2F80,0xEF41,0x2D00,0xEDC1,0xEC81,0x2C40,
0xE401,0x24C0,0x2580,0xE541,0x2700,0xE7C1,0xE681,0x2640,0x2200,0xE2C1,0xE381,0x2340,0xE101,0x21C0,0x2080,0xE041,
0xA001,0x60C0,0x6180,0xA141,0x6300,0xA3C1,0xA281,0x6240,0x6600,0xA6C1,0xA781,0x6740,0xA501,0x65C0,0x6480,0xA441,
0x6C00,0xACC1,0xAD81,0x6D40,0xAF01,0x6FC0,0x6E80,0xAE41,0xAA01,0x6AC0,0x6B80,0xAB41,0x6900,0xA9C1,0xA881,0x6840,
0x7800,0xB8C1,0xB981,0x7940,0xBB01,0x7BC0,0x7A80,0xBA41,0xBE01,0x7EC0,0x7F80,0xBF41,0x7D00,0xBDC1,0xBC81,0x7C40,
0xB401,0x74C0,0x7580,0xB541,0x7700,0xB7C1,0xB681,0x7640,0x7200,0xB2C1,0xB381,0x7340,0xB101,0x71C0,0x7080,0xB041,
0x5000,0x90C1,0x9181,0x5140,0x9301,0x53C0,0x5280,0x9241,0x9601,0x56C0,0x5780,0x9741,0x5500,0x95C1,0x9481,0x5440,
0x9C01,0x5CC0,0x5D80,0x9D41,0x5F00,0x9FC1,0x9E81,0x5E40,0x5A00,0x9AC1,0x9B81,0x5B40,0x9901,0x59C0,0x5880,0x9841,
0x8801,0x48C0,0x4980,0x8941,0x4B00,0x8BC1,0x8A81,0x4A40,0x4E00,0x8EC1,0x8F81,0x4F40,0x8D01,0x4DC0,0x4C80,0x8C41,
0x4400,0x84C1,0x8581,0x4540,0x8701,0x47C0,0x4680,0x8641,0x8201,0x42C0,0x4380,0x8341,0x4100,0x81C1,0x8081,0x4040,
};
public static ushort CalculateCRC16Modbus(this byte[] bytes)
{
CRC16 provider = new CRC16(Crc_16_Table_Modbus);
byte[] hash = provider.ComputeHash(bytes);
ushort crc16 = BitConverter.ToUInt16(hash, 0);
ushort reversedResult = (ushort)((crc16 >> 8) | (crc16 << 8));
return reversedResult;
}
}
public static class EGCrcUtility
{
//Crc with table
public static uint CalculateCrc(byte[] data, uint initialValue, uint xorValue, bool inputReverse, bool outputReverse,uint[] CrcTable)
{
uint crc = initialValue;
for (int i = 0; i < data.Length; i++)
{
if (inputReverse)
data[i] = ReverseBits(data[i]);
crc ^= (uint)(data[i] << 24);
for (int j = 0; j < 8; j++)
{
crc = (crc << 8) ^ CrcTable[crc >> 24];
}
}
if (outputReverse)
crc = ReverseBits(crc);
return crc ^ xorValue;
}
//Crc without table
public static uint CalculateCrc(byte[] data, uint polynomial, uint initialValue, uint xorValue, bool inputReverse, bool outputReverse)
{
uint crc = initialValue;
for (int i = 0; i < data.Length; i++)
{
if (inputReverse)
data[i] = ReverseBits(data[i]);
crc ^= (uint)(data[i] << 24);
for (int j = 0; j < 8; j++)
{
if ((crc & 0x80000000) != 0)
{
crc = (crc << 1) ^ polynomial;
}
else
{
crc <<= 1;
}
}
}
if (outputReverse)
crc = ReverseBits(crc);
return crc ^ xorValue;
}
private static uint ReverseBits(uint value)
{
uint result = 0;
for (int i = 0; i < 8; i++)
{
result = (result << 1) | ((value >> i) & 1);
}
return result;
}
private static byte ReverseBits(byte value)
{
byte result = 0;
for (int i = 0; i < 8; i++)
{
result = (byte)((result << 1) | ((value >> i) & 1));
}
return result;
}
}
public class CRC16 : HashAlgorithm
{
private const ushort polynomial = 0x8005;
private ushort[] table = new ushort[256];
private ushort crc = 0xFFFF;
public CRC16(ushort[] table)
{
HashSizeValue = 16;
this.table = table;
}
protected override void HashCore(byte[] array, int ibStart, int cbSize)
{
for (int i = ibStart; i < ibStart + cbSize; i++)
{
byte index = (byte)(crc ^ array[i]);
crc = (ushort)((crc >> 8) ^ table[index]);
}
}
protected override byte[] HashFinal()
{
return BitConverter.GetBytes(crc);
}
public override void Initialize()
{
crc = ushort.MaxValue;
}
}
}