ExtentionMethod.cs 27 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664
  1. using System;
  2. using System.Collections.Generic;
  3. using System.Linq;
  4. namespace Edge.Core.Parser.BinaryParser.Util
  5. {
  6. public static class ExtentionMethod
  7. {
  8. /// <summary>
  9. /// string "123" convert to byte[0] 0000001, byte[1] 00100011
  10. /// </summary>
  11. /// <param name="value">int value</param>
  12. /// <returns></returns>
  13. public static byte[] ToBCD(this string value)
  14. {
  15. if (value.Length % 2 != 0)
  16. {
  17. value = "0" + value;
  18. }
  19. List<byte> result = new List<byte>();
  20. for (int i = 0; i < value.Length; i += 2)
  21. {
  22. int parsed = -1;
  23. try
  24. {
  25. parsed = int.Parse(value[i].ToString());
  26. }
  27. catch
  28. {
  29. throw new ArgumentException(value[i].ToString() + " in string: " + value + ", can't convert to int.");
  30. }
  31. byte b = (byte)(parsed << 4);
  32. if (i + 1 <= value.Length - 1)
  33. {
  34. try
  35. {
  36. parsed = int.Parse(value[i + 1].ToString());
  37. }
  38. catch
  39. {
  40. throw new ArgumentException(value[i + 1].ToString() + " in string: " + value + ", can't convert to int.");
  41. }
  42. b += (byte)parsed;
  43. }
  44. result.Add(b);
  45. }
  46. return result.ToArray();
  47. }
  48. /// <summary>
  49. /// convert bytes to a Hex format log String, each byte divided by a SPACE.
  50. /// byte[0] = 1, byte[1] = 15, byte[2] = 134, output 01 0F 86.
  51. /// </summary>
  52. /// <param name="bytes"></param>
  53. /// <returns></returns>
  54. public static string ToHexLogString(this IEnumerable<byte> bytes)
  55. {
  56. if (bytes == null)
  57. throw new ArgumentNullException("'bytes' argument for ToHexLogString must not be null");
  58. if (bytes.Any())
  59. return bytes.Select(s => s.ToString("X").PadLeft(2, '0')).Aggregate((acc, n) => acc + " " + n);
  60. else return "";
  61. }
  62. public static string ToHexLogString(this byte target)
  63. {
  64. return target.ToString("X").PadLeft(2, '0');
  65. }
  66. public static string ToHexLogString(this int value)
  67. {
  68. return BitConverter.GetBytes(value).Reverse().ToHexLogString();
  69. }
  70. /// <summary>
  71. /// Convert bytes to a BCD int value, e.g.: input byte[0]=00000110, byte[1]=00010001, output 611
  72. /// </summary>
  73. /// <param name="bytes"></param>
  74. /// <returns></returns>
  75. public static int GetBCD(this IEnumerable<byte> bytes)
  76. {
  77. if (bytes == null || !bytes.Any()) throw new ArgumentException("invalid bytes for BCD convert, it's null or empty");
  78. string final = bytes.Aggregate(string.Empty, (current, b) => current + b.GetBCDString());
  79. return int.Parse(final);
  80. }
  81. /// <summary>
  82. /// Convert bytes to a BCD int value, e.g.: input byte[0]=00000110, byte[1]=00010001, output 611
  83. /// </summary>
  84. /// <param name="bytes"></param>
  85. /// <returns></returns>
  86. public static long GetBcdLong(this IEnumerable<byte> bytes)
  87. {
  88. if (bytes == null || !bytes.Any()) throw new ArgumentException("invalid bytes for BCD convert, it's null or empty");
  89. string final = bytes.Aggregate(string.Empty, (current, b) => current + b.GetBCDString());
  90. return long.Parse(final);
  91. }
  92. /// <summary>
  93. /// Convert one byte to a BCD string, e.g.: input 00020001, output 21
  94. /// </summary>
  95. /// <param name="oneByte"></param>
  96. /// <returns></returns>
  97. public static int GetBCD(this byte oneByte)
  98. {
  99. int low = oneByte - (oneByte >> 4) * 16;
  100. int high = oneByte >> 4;
  101. if (high > 9 || low > 9) throw new ArgumentException("invalid BCD number conversion for raw byte: 0x" + oneByte.ToString("X").PadLeft(2, '0'));
  102. return low + high * 10;
  103. }
  104. /// <summary>
  105. /// Convert one byte to a BCD string, e.g.: input 00020001, output "21"
  106. /// </summary>
  107. /// <param name="oneByte">one byte need to be converted</param>
  108. /// <returns>string value stands for the BCD</returns>
  109. public static string GetBCDString(this byte oneByte)
  110. {
  111. return oneByte.GetBCD() < 10 ? oneByte.GetBCD().ToString().PadLeft(2, '0') : oneByte.GetBCD().ToString();
  112. }
  113. /// <summary>
  114. /// Convert a serial of bytes to a BCD string, e.g.: input [0]00110001 [1]00010100 [2]00020001, output "311421"
  115. /// </summary>
  116. /// <param name="oneByte">one byte need to be converted</param>
  117. /// <returns>string value stands for the BCD</returns>
  118. public static string GetBCDString(this byte[] targetBytes)
  119. {
  120. string result = "";
  121. for (int i = 0; i < targetBytes.Length; i++)
  122. {
  123. result += targetBytes[i].GetBCD() < 10 ? targetBytes[i].GetBCD().ToString().PadLeft(2, '0') : targetBytes[i].GetBCD().ToString();
  124. }
  125. return result;
  126. }
  127. /// <summary>
  128. /// Convert a bytes to a Int32 value, the byte element which has smaller index have the bigger power.
  129. /// like 2 length byte array: byte[0] = 1, byte[1] = 2, then the converted Int32 value is 0000000100000010 = 258
  130. /// </summary>
  131. /// <param name="targetBytes">input bytes</param>
  132. /// <returns>int32 value</returns>
  133. public static int ToInt32(this IEnumerable<byte> targetBytes)
  134. {
  135. int accu = 0;
  136. for (int i = 0; i < targetBytes.Count(); i++)
  137. {
  138. accu += targetBytes.ElementAt(i) << ((targetBytes.Count() - i - 1) * 8);
  139. }
  140. return accu;
  141. }
  142. /// <summary>
  143. /// Replace some bits in a byte. like 10 in decimal, unfold it to bit(right most is the bit 0): 00001010,
  144. /// now want to replace the from bit 1 to bit 3 to decimal 3 (unfold with 011), then the replaced value is 00000110 = 3.
  145. /// </summary>
  146. /// <param name="target">target byte</param>
  147. /// <param name="bitStartIndex">which bits to start, based on 0</param>
  148. /// <param name="bitEndIndex">replace to which bits, based on 0</param>
  149. /// <param name="replacedValue">value which replaced to</param>
  150. /// <returns>the replaced value</returns>
  151. public static byte SetBit(this byte target, int bitStartIndex, int bitEndIndex, int replacedValue)
  152. {
  153. if (bitStartIndex < 0 || bitEndIndex > 7 || bitEndIndex < bitStartIndex)
  154. {
  155. throw new ArgumentException("bitStartIndex or bitEndIndex value is not valid");
  156. }
  157. byte mask = 0;
  158. for (int i = 0; i < bitEndIndex - bitStartIndex + 1; i++)
  159. {
  160. mask += (byte)Math.Pow(2, i);
  161. }
  162. if (replacedValue > mask)
  163. {
  164. throw new ArgumentOutOfRangeException("Replaced value: " + replacedValue + " cannot fit the bits range");
  165. }
  166. byte maskedValue = (byte)(target & (255 - (mask << bitStartIndex)));
  167. return (byte)(maskedValue + (replacedValue << bitStartIndex));
  168. }
  169. /// <summary>
  170. /// Like int 28, interpreted as binary 00011100, so index 0 bit is 0, index 2 bit is 1, index 3 bit is 1,
  171. /// index 4 bit is 1, index 5 bit is 0.
  172. /// </summary>
  173. /// <param name="target"></param>
  174. /// <param name="index">from low to high digits, based on 0.</param>
  175. /// <returns></returns>
  176. public static byte GetBit(this byte target, int index)
  177. {
  178. if (index < 0 || index > 7)
  179. {
  180. throw new ArgumentException("index value is not valid");
  181. }
  182. var turn = (target >> (index));
  183. var t = (turn << 7).GetBinBytes(4).Last() >> 7;
  184. return (byte)t;
  185. }
  186. /// <summary>
  187. /// Convert a hex string to a byte[]
  188. /// like targetHexString is 01030E, then the result bytes is: byte[0] = 1, byte[1] = 3, byte [2] = 14.
  189. /// </summary>
  190. /// <param name="targetHexString">input hex string</param>
  191. /// <returns>byte[]</returns>
  192. public static byte[] ToBytes(this string targetHexString)
  193. {
  194. targetHexString = targetHexString.Trim().Replace(" ", "");
  195. if (targetHexString.Length % 2 != 0)
  196. {
  197. throw new ArgumentException("The targetHexString length is not even.");
  198. }
  199. List<byte> result = new List<byte>();
  200. for (int i = 0; i < targetHexString.Length; i += 2)
  201. {
  202. var middle = targetHexString.Substring(i, 2);
  203. result.Add(Convert.ToByte(middle, 16));
  204. }
  205. return result.ToArray();
  206. }
  207. /// <summary>
  208. /// Append a bytes to the head of base bytes, like base bytes is byte[0] = 0, byte[1]=1, appending bytes is byte[0] = 2, then the result
  209. /// is byte[0] = 2, byte[1] = 0, byte[2] = 1.
  210. /// </summary>
  211. /// <param name="baseBytes"></param>
  212. /// <param name="bytesToAppending"></param>
  213. /// <returns></returns>
  214. public static byte[] AppendToHeader(this byte[] baseBytes, byte[] bytesToAppending)
  215. {
  216. return bytesToAppending.Concat(baseBytes).ToArray();
  217. }
  218. /// <summary>
  219. /// Convert a int to a bytes with BCD encoding, like 13(with outputtotalBytes set to 4)
  220. /// convert to byte[0] = 00000000, byte[1] = 00010011
  221. /// </summary>
  222. /// <param name="targetInt">target int value</param>
  223. /// <param name="outputTotalBytes">the array length of the output, put <![CDATA[<=]>]]>0 as the auto detect length</param>
  224. /// <returns>bytes</returns>
  225. public static byte[] GetBCDBytes(this long targetInt, int outputTotalBytes)
  226. {
  227. // put each digit to a single byte, like int 134 put into byte[0] = 00000000, byte[1] = 00000011, byte[2] = 00000100
  228. var process = targetInt.ToString().Select(b => (byte)int.Parse(b.ToString())).ToList();
  229. // always extend to even
  230. if (process.Count() % 2 != 0)
  231. {
  232. process = process.ToArray().AppendToHeader(new byte[] { 0 }).ToList();
  233. }
  234. // left move 4 bit for odd index item, then plus the followed even index item, form one byte of BCD.
  235. // then remove that odd index item.
  236. for (int i = process.Count() - 1; i >= 0; i--)
  237. {
  238. process[i] += (byte)(process.ToArray()[i - 1] << 4);
  239. process.RemoveAt(i - 1);
  240. i = i - 1;
  241. }
  242. var diff = outputTotalBytes - process.Count;
  243. if (diff > 0)
  244. {
  245. var v = Enumerable.Repeat(0, diff).Select(p => (byte)p).Concat(process).ToArray();
  246. return v;
  247. }
  248. return process.ToArray();
  249. }
  250. public static byte[] GetBCDBytes(this System.Numerics.BigInteger targetInt, int outputTotalBytes)
  251. {
  252. // put each digit to a single byte, like int 134 put into byte[0] = 00000000, byte[1] = 00000011, byte[2] = 00000100
  253. var process = targetInt.ToString().Select(b => (byte)int.Parse(b.ToString())).ToList();
  254. // always extend to even
  255. if (process.Count() % 2 != 0)
  256. {
  257. process = process.ToArray().AppendToHeader(new byte[] { 0 }).ToList();
  258. }
  259. // left move 4 bit for odd index item, then plus the followed even index item, form one byte of BCD.
  260. // then remove that odd index item.
  261. for (int i = process.Count() - 1; i >= 0; i--)
  262. {
  263. process[i] += (byte)(process.ToArray()[i - 1] << 4);
  264. process.RemoveAt(i - 1);
  265. i = i - 1;
  266. }
  267. var diff = outputTotalBytes - process.Count;
  268. if (diff > 0)
  269. {
  270. var v = Enumerable.Repeat(0, diff).Select(p => (byte)p).Concat(process).ToArray();
  271. return v;
  272. }
  273. return process.ToArray();
  274. }
  275. public static byte[] GetBCDBytes(this int targetInt, int outputTotalBytes)
  276. {
  277. // put each digit to a single byte, like int 134 put into byte[0] = 00000000, byte[1] = 00000011, byte[2] = 00000100
  278. var process = targetInt.ToString().Select(b => (byte)int.Parse(b.ToString())).ToList();
  279. // always extend to even
  280. if (process.Count() % 2 != 0)
  281. {
  282. process = process.ToArray().AppendToHeader(new byte[] { 0 }).ToList();
  283. }
  284. // left move 4 bit for odd index item, then plus the followed even index item, form one byte of BCD.
  285. // then remove that odd index item.
  286. for (int i = process.Count() - 1; i >= 0; i--)
  287. {
  288. process[i] += (byte)(process.ToArray()[i - 1] << 4);
  289. process.RemoveAt(i - 1);
  290. i = i - 1;
  291. }
  292. var diff = outputTotalBytes - process.Count;
  293. if (diff > 0)
  294. {
  295. var v = Enumerable.Repeat(0, diff).Select(p => (byte)p).Concat(process).ToArray();
  296. return v;
  297. }
  298. return process.ToArray();
  299. }
  300. /// <summary>
  301. /// Convert a int value to a bytes,
  302. /// low byte have the high order.
  303. /// like 3 convert to byte[0] = 00000011;
  304. /// 256 convert to byte[0] = 00000001, byte[1] = 00000000;
  305. /// 257 conver to byte[0] = 00000001, byte[1] = 0000001;
  306. /// 8800 conver to byte[0] = 00100010, byte[1] = 01100000;
  307. /// </summary>
  308. /// <param name="targetInt">target int value</param>
  309. /// <param name="outputTotalBytes">the array length of the output, put <![CDATA[<=]>]]>0 as the auto detect length</param>
  310. /// <returns>bytes</returns>
  311. public static byte[] GetBinBytes(this int targetInt, int outputTotalBytes)
  312. {
  313. if (outputTotalBytes > 4) throw new ArgumentOutOfRangeException("GetBinBytes support max 4 bytes output");
  314. var r = BitConverter.GetBytes(targetInt);
  315. if (outputTotalBytes == 0) return r;
  316. if (outputTotalBytes < r.Length)
  317. {
  318. for (int index = r.Length - 1; index > outputTotalBytes - 1; index--)
  319. {
  320. if (r[index] > 0)
  321. {
  322. throw new ArgumentException(string.Format("Target integer value {0} is too large to be converted into {1} bytes", targetInt, outputTotalBytes));
  323. }
  324. }
  325. }
  326. if (outputTotalBytes > 0)
  327. {
  328. return r.Take(outputTotalBytes).Reverse().ToArray();
  329. }
  330. return r.Reverse().ToArray();
  331. }
  332. public static byte[] GetBinBytes(this long targetInt, int outputTotalBytes)
  333. {
  334. if (outputTotalBytes > 4) throw new ArgumentOutOfRangeException("GetBinBytes support max 4 bytes output");
  335. var r = BitConverter.GetBytes(targetInt);
  336. if (outputTotalBytes == 0) return r;
  337. if (outputTotalBytes < r.Length)
  338. {
  339. for (int index = r.Length - 1; index > outputTotalBytes - 1; index--)
  340. {
  341. if (r[index] > 0)
  342. {
  343. throw new ArgumentException(string.Format("Target integer value {0} is too large to be converted into {1} bytes", targetInt, outputTotalBytes));
  344. }
  345. }
  346. }
  347. if (outputTotalBytes > 0)
  348. {
  349. return r.Take(outputTotalBytes).Reverse().ToArray();
  350. }
  351. return r.Reverse().ToArray();
  352. }
  353. /// <summary>
  354. /// Convert a bytes array to a string with hex encoding, like a byte[] { 00, 00, 64, 04 }, then converted string will be 00004004
  355. /// </summary>
  356. /// <param name="target">target byte array</param>
  357. /// <returns>a string with hex encoding</returns>
  358. public static string GetHexString(this IEnumerable<byte> target)
  359. {
  360. return target.Select(b => b.ToString("X").Length == 1 ? b.ToString("X").PadLeft(2, '0') : b.ToString("X")).Aggregate((p, n) => { return p + n; });
  361. }
  362. public static bool ValueEquals(this IEnumerable<byte> array1, IEnumerable<byte> array2)
  363. {
  364. if (array1 == null && array2 == null)
  365. {
  366. return true;
  367. }
  368. if ((array1 == null) || (array2 == null))
  369. {
  370. return false;
  371. }
  372. if (array1.Count() != array2.Count())
  373. {
  374. return false;
  375. }
  376. if (array1.Equals(array2))
  377. {
  378. return true;
  379. }
  380. else
  381. {
  382. for (int Index = 0; Index < array1.Count(); Index++)
  383. {
  384. if (!Equals(array1.ElementAt(Index), array2.ElementAt(Index)))
  385. {
  386. return false;
  387. }
  388. }
  389. }
  390. return true;
  391. }
  392. /// <summary>
  393. /// Get the first or default element in a WinEps message which specified by the element type.
  394. /// Since the element is a reference type, so nothing find will return a Null as the default value.
  395. /// </summary>
  396. /// <typeparam name="T">the look up element type</typeparam>
  397. /// <param name="message">WinEps message</param>
  398. /// <returns>the element, if not found, return null</returns>
  399. //public static T FirstOrDefaultElement<T>(this WinEpsMessageBase message) where T : WinEpsElementBase
  400. //{
  401. // return message.FirstOrDefault(e => e.GetType() == typeof(T)) as T;
  402. //}
  403. //private static ushort[] table = {
  404. // 0x0000, 0x1189, 0x2312, 0x329B, 0x4624, 0x57AD, 0x6536, 0x74BF,
  405. // 0x8C48, 0x9DC1, 0xAF5A, 0xBED3, 0xCA6C, 0xDBE5, 0xE97E, 0xF8F7,
  406. // 0x1081, 0x0108, 0x3393, 0x221A, 0x56A5, 0x472C, 0x75B7, 0x643E,
  407. // 0x9CC9, 0x8D40, 0xBFDB, 0xAE52, 0xDAED, 0xCB64, 0xF9FF, 0xE876,
  408. // 0x2102, 0x308B, 0x0210, 0x1399, 0x6726, 0x76AF, 0x4434, 0x55BD,
  409. // 0xAD4A, 0xBCC3, 0x8E58, 0x9FD1, 0xEB6E, 0xFAE7, 0xC87C, 0xD9F5,
  410. // 0x3183, 0x200A, 0x1291, 0x0318, 0x77A7, 0x662E, 0x54B5, 0x453C,
  411. // 0xBDCB, 0xAC42, 0x9ED9, 0x8F50, 0xFBEF, 0xEA66, 0xD8FD, 0xC974,
  412. // 0x4204, 0x538D, 0x6116, 0x709F, 0x0420, 0x15A9, 0x2732, 0x36BB,
  413. // 0xCE4C, 0xDFC5, 0xED5E, 0xFCD7, 0x8868, 0x99E1, 0xAB7A, 0xBAF3,
  414. // 0x5285, 0x430C, 0x7197, 0x601E, 0x14A1, 0x0528, 0x37B3, 0x263A,
  415. // 0xDECD, 0xCF44, 0xFDDF, 0xEC56, 0x98E9, 0x8960, 0xBBFB, 0xAA72,
  416. // 0x6306, 0x728F, 0x4014, 0x519D, 0x2522, 0x34AB, 0x0630, 0x17B9,
  417. // 0xEF4E, 0xFEC7, 0xCC5C, 0xDDD5, 0xA96A, 0xB8E3, 0x8A78, 0x9BF1,
  418. // 0x7387, 0x620E, 0x5095, 0x411C, 0x35A3, 0x242A, 0x16B1, 0x0738,
  419. // 0xFFCF, 0xEE46, 0xDCDD, 0xCD54, 0xB9EB, 0xA862, 0x9AF9, 0x8B70,
  420. // 0x8408, 0x9581, 0xA71A, 0xB693, 0xC22C, 0xD3A5, 0xE13E, 0xF0B7,
  421. // 0x0840, 0x19C9, 0x2B52, 0x3ADB, 0x4E64, 0x5FED, 0x6D76, 0x7CFF,
  422. // 0x9489, 0x8500, 0xB79B, 0xA612, 0xD2AD, 0xC324, 0xF1BF, 0xE036,
  423. // 0x18C1, 0x0948, 0x3BD3, 0x2A5A, 0x5EE5, 0x4F6C, 0x7DF7, 0x6C7E,
  424. // 0xA50A, 0xB483, 0x8618, 0x9791, 0xE32E, 0xF2A7, 0xC03C, 0xD1B5,
  425. // 0x2942, 0x38CB, 0x0A50, 0x1BD9, 0x6F66, 0x7EEF, 0x4C74, 0x5DFD,
  426. // 0xB58B, 0xA402, 0x9699, 0x8710, 0xF3AF, 0xE226, 0xD0BD, 0xC134,
  427. // 0x39C3, 0x284A, 0x1AD1, 0x0B58, 0x7FE7, 0x6E6E, 0x5CF5, 0x4D7C,
  428. // 0xC60C, 0xD785, 0xE51E, 0xF497, 0x8028, 0x91A1, 0xA33A, 0xB2B3,
  429. // 0x4A44, 0x5BCD, 0x6956, 0x78DF, 0x0C60, 0x1DE9, 0x2F72, 0x3EFB,
  430. // 0xD68D, 0xC704, 0xF59F, 0xE416, 0x90A9, 0x8120, 0xB3BB, 0xA232,
  431. // 0x5AC5, 0x4B4C, 0x79D7, 0x685E, 0x1CE1, 0x0D68, 0x3FF3, 0x2E7A,
  432. // 0xE70E, 0xF687, 0xC41C, 0xD595, 0xA12A, 0xB0A3, 0x8238, 0x93B1,
  433. // 0x6B46, 0x7ACF, 0x4854, 0x59DD, 0x2D62, 0x3CEB, 0x0E70, 0x1FF9,
  434. // 0xF78F, 0xE606, 0xD49D, 0xC514, 0xB1AB, 0xA022, 0x92B9, 0x8330,
  435. // 0x7BC7, 0x6A4E, 0x58D5, 0x495C, 0x3DE3, 0x2C6A, 0x1EF1, 0x0F78
  436. // };
  437. static ushort[] table = new ushort[256];
  438. const ushort polynomial = 0xA001;
  439. private static ushort ComputeChecksum(byte[] bytes)
  440. {
  441. ushort crc = 0;
  442. for (int i = 0; i < bytes.Length; ++i)
  443. {
  444. byte index = (byte)(crc ^ bytes[i]);
  445. crc = (ushort)((crc >> 8) ^ table[index]);
  446. }
  447. return crc;
  448. }
  449. public static byte[] ComputeChecksumBytesCrc16(this byte[] bytes)
  450. {
  451. ushort crc = ComputeChecksum(bytes);
  452. var result = BitConverter.GetBytes(crc);
  453. return result.Reverse().ToArray();
  454. }
  455. private static ushort ComputeChecksumModBus(byte[] bytes)
  456. {
  457. ushort crc = 0xFFFF;
  458. for (int i = 0; i < bytes.Length; ++i)
  459. {
  460. byte index = (byte)(crc ^ bytes[i]);
  461. crc = (ushort)((crc >> 8) ^ table[index]);
  462. }
  463. return crc;
  464. }
  465. public static byte[] ComputeChecksumBytesCrc16ModBus(this byte[] bytes)
  466. {
  467. ushort crc = ComputeChecksumModBus(bytes);
  468. var result = BitConverter.GetBytes(crc);
  469. return result.Reverse().ToArray();
  470. }
  471. private static readonly ushort[] CrcTable =
  472. {
  473. 0X0000, 0XC0C1, 0XC181, 0X0140, 0XC301, 0X03C0, 0X0280, 0XC241,
  474. 0XC601, 0X06C0, 0X0780, 0XC741, 0X0500, 0XC5C1, 0XC481, 0X0440,
  475. 0XCC01, 0X0CC0, 0X0D80, 0XCD41, 0X0F00, 0XCFC1, 0XCE81, 0X0E40,
  476. 0X0A00, 0XCAC1, 0XCB81, 0X0B40, 0XC901, 0X09C0, 0X0880, 0XC841,
  477. 0XD801, 0X18C0, 0X1980, 0XD941, 0X1B00, 0XDBC1, 0XDA81, 0X1A40,
  478. 0X1E00, 0XDEC1, 0XDF81, 0X1F40, 0XDD01, 0X1DC0, 0X1C80, 0XDC41,
  479. 0X1400, 0XD4C1, 0XD581, 0X1540, 0XD701, 0X17C0, 0X1680, 0XD641,
  480. 0XD201, 0X12C0, 0X1380, 0XD341, 0X1100, 0XD1C1, 0XD081, 0X1040,
  481. 0XF001, 0X30C0, 0X3180, 0XF141, 0X3300, 0XF3C1, 0XF281, 0X3240,
  482. 0X3600, 0XF6C1, 0XF781, 0X3740, 0XF501, 0X35C0, 0X3480, 0XF441,
  483. 0X3C00, 0XFCC1, 0XFD81, 0X3D40, 0XFF01, 0X3FC0, 0X3E80, 0XFE41,
  484. 0XFA01, 0X3AC0, 0X3B80, 0XFB41, 0X3900, 0XF9C1, 0XF881, 0X3840,
  485. 0X2800, 0XE8C1, 0XE981, 0X2940, 0XEB01, 0X2BC0, 0X2A80, 0XEA41,
  486. 0XEE01, 0X2EC0, 0X2F80, 0XEF41, 0X2D00, 0XEDC1, 0XEC81, 0X2C40,
  487. 0XE401, 0X24C0, 0X2580, 0XE541, 0X2700, 0XE7C1, 0XE681, 0X2640,
  488. 0X2200, 0XE2C1, 0XE381, 0X2340, 0XE101, 0X21C0, 0X2080, 0XE041,
  489. 0XA001, 0X60C0, 0X6180, 0XA141, 0X6300, 0XA3C1, 0XA281, 0X6240,
  490. 0X6600, 0XA6C1, 0XA781, 0X6740, 0XA501, 0X65C0, 0X6480, 0XA441,
  491. 0X6C00, 0XACC1, 0XAD81, 0X6D40, 0XAF01, 0X6FC0, 0X6E80, 0XAE41,
  492. 0XAA01, 0X6AC0, 0X6B80, 0XAB41, 0X6900, 0XA9C1, 0XA881, 0X6840,
  493. 0X7800, 0XB8C1, 0XB981, 0X7940, 0XBB01, 0X7BC0, 0X7A80, 0XBA41,
  494. 0XBE01, 0X7EC0, 0X7F80, 0XBF41, 0X7D00, 0XBDC1, 0XBC81, 0X7C40,
  495. 0XB401, 0X74C0, 0X7580, 0XB541, 0X7700, 0XB7C1, 0XB681, 0X7640,
  496. 0X7200, 0XB2C1, 0XB381, 0X7340, 0XB101, 0X71C0, 0X7080, 0XB041,
  497. 0X5000, 0X90C1, 0X9181, 0X5140, 0X9301, 0X53C0, 0X5280, 0X9241,
  498. 0X9601, 0X56C0, 0X5780, 0X9741, 0X5500, 0X95C1, 0X9481, 0X5440,
  499. 0X9C01, 0X5CC0, 0X5D80, 0X9D41, 0X5F00, 0X9FC1, 0X9E81, 0X5E40,
  500. 0X5A00, 0X9AC1, 0X9B81, 0X5B40, 0X9901, 0X59C0, 0X5880, 0X9841,
  501. 0X8801, 0X48C0, 0X4980, 0X8941, 0X4B00, 0X8BC1, 0X8A81, 0X4A40,
  502. 0X4E00, 0X8EC1, 0X8F81, 0X4F40, 0X8D01, 0X4DC0, 0X4C80, 0X8C41,
  503. 0X4400, 0X84C1, 0X8581, 0X4540, 0X8701, 0X47C0, 0X4680, 0X8641,
  504. 0X8201, 0X42C0, 0X4380, 0X8341, 0X4100, 0X81C1, 0X8081, 0X4040
  505. };
  506. public static byte[] CalculateModBusCrc(this byte[] data)
  507. {
  508. if (data == null)
  509. {
  510. throw new ArgumentNullException(nameof(data));
  511. }
  512. ushort crc = ushort.MaxValue;
  513. foreach (byte b in data)
  514. {
  515. byte tableIndex = (byte)(crc ^ b);
  516. crc >>= 8;
  517. crc ^= CrcTable[tableIndex];
  518. }
  519. return BitConverter.GetBytes(crc);
  520. }
  521. public static byte CalculateLRC(this IEnumerable<byte> bytes)
  522. {
  523. int LRC = 0;
  524. for (int i = 0; i < bytes.Count(); i++)
  525. {
  526. LRC ^= bytes.ElementAt(i);
  527. }
  528. return (byte)LRC;
  529. }
  530. static ExtentionMethod()
  531. {
  532. ushort value;
  533. ushort temp;
  534. for (ushort i = 0; i < table.Length; ++i)
  535. {
  536. value = 0;
  537. temp = i;
  538. for (byte j = 0; j < 8; ++j)
  539. {
  540. if (((value ^ temp) & 0x0001) != 0)
  541. {
  542. value = (ushort)((value >> 1) ^ polynomial);
  543. }
  544. else
  545. {
  546. value >>= 1;
  547. }
  548. temp >>= 1;
  549. }
  550. table[i] = value;
  551. }
  552. }
  553. }
  554. //public class Crc16
  555. //{
  556. // const ushort polynomial = 0xA001;
  557. // ushort[] table = new ushort[256];
  558. // public ushort ComputeChecksum(byte[] bytes)
  559. // {
  560. // ushort crc = 0;
  561. // for (int i = 0; i < bytes.Length; ++i)
  562. // {
  563. // byte index = (byte)(crc ^ bytes[i]);
  564. // crc = (ushort)((crc >> 8) ^ table[index]);
  565. // }
  566. // return crc;
  567. // }
  568. // public byte[] ComputeChecksumBytesCrc16(byte[] bytes)
  569. // {
  570. // ushort crc = ComputeChecksum(bytes);
  571. // return BitConverter.GetBytes(crc);
  572. // }
  573. // public Crc16()
  574. // {
  575. // ushort value;
  576. // ushort temp;
  577. // for (ushort i = 0; i < table.Length; ++i)
  578. // {
  579. // value = 0;
  580. // temp = i;
  581. // for (byte j = 0; j < 8; ++j)
  582. // {
  583. // if (((value ^ temp) & 0x0001) != 0)
  584. // {
  585. // value = (ushort)((value >> 1) ^ polynomial);
  586. // }
  587. // else
  588. // {
  589. // value >>= 1;
  590. // }
  591. // temp >>= 1;
  592. // }
  593. // table[i] = value;
  594. // }
  595. // }
  596. //}
  597. }