找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 1608|回復(fù): 0
收起左側(cè)

modbus協(xié)議上位機(jī)通用接口

[復(fù)制鏈接]
ID:385629 發(fā)表于 2018-8-13 08:19 | 顯示全部樓層 |閱讀模式
  1. public class KModbusUnity
  2.     {
  3.         static ushort POLYNOMIAL = 0xA001;
  4.         /// <summary>
  5.         /// 計算CRC校驗結(jié)果
  6.         /// </summary>
  7.         /// <param name="data">數(shù)據(jù)源</param>
  8.         /// <returns>校驗結(jié)果</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.                 // 校驗結(jié)果
  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進(jìn)制字符串轉(zhuǎn)byte數(shù)組
  76.         /// </summary>
  77.         /// <param name="hex">16進(jìn)制的字符串,可以是空格隔開的方式</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ù)組轉(zhuǎn)16進(jìn)制字符串
  94.         /// </summary>
  95.         /// <param name="bytes">byte數(shù)組</param>
  96.         /// <returns>16進(jìn)制字符串</returns>
  97.         public static String BytesToHexStr(byte[] bytes)
  98.         {
  99.             return BitConverter.ToString(bytes).Replace('-', ' ').Trim();
  100.         }
  101.         /// <summary>
  102.         /// byte轉(zhuǎn)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.     }
復(fù)制代碼


回復(fù)

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

手機(jī)版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表