標題: modbus協(xié)議上位機通用接口 [打印本頁]
作者: hopedream    時間: 2018-8-13 08:19
標題: modbus協(xié)議上位機通用接口
  1. public class KModbusUnity
  2.     {
  3.         static ushort POLYNOMIAL = 0xA001;
  4.         /// <summary>
  5.         /// 計算CRC校驗結果
  6.         /// </summary>
  7.         /// <param name="data">數(shù)據(jù)源</param>
  8.         /// <returns>校驗結果</returns>
  9.         public static byte[] CRCCheck(byte[] data )
  10.         {
  11.             ushort crc = 0xffff;
  12.             for(ushort i=0;i<data.Length;i++)
  13.             {
  14.                 crc ^= (ushort)(data[i] & 0x00FF);
  15.                 for(ushort j = 0;j<8;j++)
  16.                 {
  17.                     if ((crc & 0x0001) != 0)
  18.                     {
  19.                         crc >>= 1;
  20.                         crc ^= POLYNOMIAL;
  21.                     }
  22.                     else
  23.                         crc >>= 1;
  24.                 }
  25.             }

  27.             return System.BitConverter.GetBytes(crc);
  28.         }
  29.         /// <summary>
  30.         /// 收到的數(shù)據(jù)有效
  31.         /// </summary>
  32.         /// <param name="data">數(shù)據(jù)</param>
  33.         /// <returns></returns>
  34.         public static bool IsValid(byte[] data)
  35.         {
  36.             bool bReturn = false;
  37.             int n = data.Length;
  38.             if (n >= 4)
  39.             {
  40.                 byte[] check = new byte[n - 2];
  41.                 for (int j = 0; j < n - 2; j++)
  42.                 {
  43.                     check[j] = data[j];
  44.                 }
  45.                 // 校驗結果
  46.                 byte[] crc = KModbusUnity.CRCCheck(check);
  47.                 if (crc[0] == data[n - 2] && crc[1] == data[n - 1])
  48.                 {
  49.                     bReturn = true;
  50.                 }
  51.             }
  52.             return bReturn;
  53.         }
  54.         /// <summary>
  55.         /// 返回帶校驗碼的數(shù)據(jù)
  56.         /// </summary>
  57.         /// <param name="data">源數(shù)據(jù)</param>
  58.         /// <returns>帶校驗碼的數(shù)據(jù)</returns>
  59.         public static byte[] CRCData(byte[] data)
  60.         {
  61.             byte[] crcCheck = CRCCheck(data);
  62.             byte[] rdata = new byte[data.Length + 2];

  64.             data.CopyTo(rdata, 0);
  65.             crcCheck.CopyTo(rdata, data.Length);

  67.             return rdata;
  68.         }

  70.         public static byte[] CRCData(String hex)
  71.         {
  72.             return CRCData(HexStrToBytes(hex));
  73.         }
  74.         /// <summary>
  75.         /// 16進制字符串轉byte數(shù)組
  76.         /// </summary>
  77.         /// <param name="hex">16進制的字符串,可以是空格隔開的方式</param>
  78.         /// <returns>byte數(shù)組</returns>
  79.         public static byte[] HexStrToBytes(String hex)
  80.         {
  81.             hex = hex.Replace(" ", "");
  82.             if ((hex.Length % 2) != 0)
  83.                 hex += " ";
  84.             byte[] returnBytes = new byte[hex.Length / 2];
  85.             for (int i = 0; i < returnBytes.Length; i++)
  86.             {
  87.                 String sub = hex.Substring(i * 2, 2);
  88.                 returnBytes[i] = Convert.ToByte(sub, 16);
  89.             }
  90.             return returnBytes;
  91.         }
  92.         /// <summary>
  93.         /// byte數(shù)組轉16進制字符串
  94.         /// </summary>
  95.         /// <param name="bytes">byte數(shù)組</param>
  96.         /// <returns>16進制字符串</returns>
  97.         public static String BytesToHexStr(byte[] bytes)
  98.         {
  99.             return BitConverter.ToString(bytes).Replace('-', ' ').Trim();
  100.         }
  101.         /// <summary>
  102.         /// byte轉float
  103.         /// </summary>
  104.         /// <param name="data">byte</param>
  105.         /// <param name="nStart">開始位置</param>
  106.         /// <returns>float</returns>
  107.         public static float BytesToFloat(byte[] data ,int nStart = 0)
  108.         {
  109.             float fResult = 0;
  110.             
  111.             fResult = BitConverter.ToSingle(new byte[] {data[nStart+3],data[nStart+2],data[nStart+1],data[nStart] }, 0);
  112.             return fResult;
  113.         }

  115.         public static bool[] ByteToBitArray(byte data)
  116.         {
  117.             bool[] bResult = new bool[8];
  118.             for(int i =0;i<8;i++)
  119.             {
  120.                 var tmp = 1 << i;
  121.                 bool b = ((data & tmp) == tmp);
  122.                 bResult[i] = b;
  123.             }

  125.             return bResult;
  126.         }

  128.         public static byte[] StringToBytes(String str)
  129.         {
  130.             return System.Text.Encoding.ASCII.GetBytes(str);
  131.         }
  132.     }
復制代碼






歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1