Parser.cs 5.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144
  1. using Edge.Core.Parser.BinaryParser;
  2. using Edge.Core.Parser.BinaryParser.MessageEntity;
  3. using Edge.Core.Parser.BinaryParser.Util;
  4. using System;
  5. using System.Collections.Generic;
  6. using System.Linq;
  7. using System.Text;
  8. namespace Dfs.WayneChina.GilbarcoDispenserPayTerminal
  9. {
  10. public class Parser : ParserBase
  11. {
  12. public Parser() : base(MessageTemplateLookup.Default)
  13. {
  14. IgnoreExtraTailBytesInDeserialize = true;
  15. }
  16. public override byte[] Serialize(MessageTemplateBase message)
  17. {
  18. var bytesWithoutCrc16 = base.Serialize(message).ToList();
  19. if (message.GetType().GetProperty("CRC") != null)
  20. {
  21. // skip the first of 0xFA.
  22. var crc16 = Crc16.ComputeCrcBytes(bytesWithoutCrc16.Skip(1).ToArray());
  23. var processedBody = ProcessDoubleHexFAInMsgBody(bytesWithoutCrc16);
  24. var processedCrc = ProcessDoubleHexFAInCRC(crc16);
  25. var _ = processedBody.Concat(processedCrc);
  26. return _.ToArray();
  27. }
  28. return bytesWithoutCrc16.ToArray();
  29. }
  30. /// <summary>
  31. /// 转义字符:0FAH;在数据里每两个 0FAH 替换为一个 0FAH;在目标地址、源地址、帧号/控制、
  32. ///有效数据长度中不能出现 0FAH,转义字符不计入 CRC 中,CRC 中采用转义。
  33. /// </summary>
  34. /// <param name="original"></param>
  35. /// <returns></returns>
  36. public static byte[] ProcessDoubleHexFAInMsgBody(List<byte> original)
  37. {
  38. //====record 0xFA position============
  39. var indexs = new List<int>();
  40. for (int i = 6; i < original.Count; i++)
  41. {
  42. if (original[i] == 0xFA)
  43. {
  44. indexs.Add(i);
  45. }
  46. }
  47. //=====end=====
  48. if (!indexs.Any()) return original.ToArray();
  49. var originalLen = original.Skip(4).Take(2).GetBCD();
  50. //var newLen = (originalLen + indexs.Count).GetBCDBytes(2);
  51. var newLen = (originalLen).GetBCDBytes(2);
  52. original[4] = newLen[0];
  53. original[5] = newLen[1];
  54. byte[] _ = new byte[original.Count];
  55. original.CopyTo(_);
  56. var newList = _.ToList();
  57. for (int i = 0; i < indexs.Count; i++)
  58. {
  59. newList.Insert(indexs[i] + i, 0xFA);
  60. }
  61. return newList.ToArray();
  62. }
  63. public static byte[] ProcessDoubleHexFAInCRC(byte[] originalCrc)
  64. {
  65. var result = new List<byte>();
  66. result.Add(originalCrc[0]);
  67. if (originalCrc[0] == 0xFA)
  68. {
  69. result.Add(0xFA);
  70. }
  71. result.Add(originalCrc[1]);
  72. if (originalCrc[1] == 0xFA)
  73. {
  74. result.Add(0xFA);
  75. }
  76. return result.ToArray();
  77. }
  78. }
  79. public class Crc16
  80. {
  81. private static ushort[] CrcTable =
  82. {
  83. 0X0000, 0XC0C1, 0XC181, 0X0140, 0XC301, 0X03C0, 0X0280, 0XC241,
  84. 0XC601, 0X06C0, 0X0780, 0XC741, 0X0500, 0XC5C1, 0XC481, 0X0440,
  85. 0XCC01, 0X0CC0, 0X0D80, 0XCD41, 0X0F00, 0XCFC1, 0XCE81, 0X0E40,
  86. 0X0A00, 0XCAC1, 0XCB81, 0X0B40, 0XC901, 0X09C0, 0X0880, 0XC841,
  87. 0XD801, 0X18C0, 0X1980, 0XD941, 0X1B00, 0XDBC1, 0XDA81, 0X1A40,
  88. 0X1E00, 0XDEC1, 0XDF81, 0X1F40, 0XDD01, 0X1DC0, 0X1C80, 0XDC41,
  89. 0X1400, 0XD4C1, 0XD581, 0X1540, 0XD701, 0X17C0, 0X1680, 0XD641,
  90. 0XD201, 0X12C0, 0X1380, 0XD341, 0X1100, 0XD1C1, 0XD081, 0X1040,
  91. 0XF001, 0X30C0, 0X3180, 0XF141, 0X3300, 0XF3C1, 0XF281, 0X3240,
  92. 0X3600, 0XF6C1, 0XF781, 0X3740, 0XF501, 0X35C0, 0X3480, 0XF441,
  93. 0X3C00, 0XFCC1, 0XFD81, 0X3D40, 0XFF01, 0X3FC0, 0X3E80, 0XFE41,
  94. 0XFA01, 0X3AC0, 0X3B80, 0XFB41, 0X3900, 0XF9C1, 0XF881, 0X3840,
  95. 0X2800, 0XE8C1, 0XE981, 0X2940, 0XEB01, 0X2BC0, 0X2A80, 0XEA41,
  96. 0XEE01, 0X2EC0, 0X2F80, 0XEF41, 0X2D00, 0XEDC1, 0XEC81, 0X2C40,
  97. 0XE401, 0X24C0, 0X2580, 0XE541, 0X2700, 0XE7C1, 0XE681, 0X2640,
  98. 0X2200, 0XE2C1, 0XE381, 0X2340, 0XE101, 0X21C0, 0X2080, 0XE041,
  99. 0XA001, 0X60C0, 0X6180, 0XA141, 0X6300, 0XA3C1, 0XA281, 0X6240,
  100. 0X6600, 0XA6C1, 0XA781, 0X6740, 0XA501, 0X65C0, 0X6480, 0XA441,
  101. 0X6C00, 0XACC1, 0XAD81, 0X6D40, 0XAF01, 0X6FC0, 0X6E80, 0XAE41,
  102. 0XAA01, 0X6AC0, 0X6B80, 0XAB41, 0X6900, 0XA9C1, 0XA881, 0X6840,
  103. 0X7800, 0XB8C1, 0XB981, 0X7940, 0XBB01, 0X7BC0, 0X7A80, 0XBA41,
  104. 0XBE01, 0X7EC0, 0X7F80, 0XBF41, 0X7D00, 0XBDC1, 0XBC81, 0X7C40,
  105. 0XB401, 0X74C0, 0X7580, 0XB541, 0X7700, 0XB7C1, 0XB681, 0X7640,
  106. 0X7200, 0XB2C1, 0XB381, 0X7340, 0XB101, 0X71C0, 0X7080, 0XB041,
  107. 0X5000, 0X90C1, 0X9181, 0X5140, 0X9301, 0X53C0, 0X5280, 0X9241,
  108. 0X9601, 0X56C0, 0X5780, 0X9741, 0X5500, 0X95C1, 0X9481, 0X5440,
  109. 0X9C01, 0X5CC0, 0X5D80, 0X9D41, 0X5F00, 0X9FC1, 0X9E81, 0X5E40,
  110. 0X5A00, 0X9AC1, 0X9B81, 0X5B40, 0X9901, 0X59C0, 0X5880, 0X9841,
  111. 0X8801, 0X48C0, 0X4980, 0X8941, 0X4B00, 0X8BC1, 0X8A81, 0X4A40,
  112. 0X4E00, 0X8EC1, 0X8F81, 0X4F40, 0X8D01, 0X4DC0, 0X4C80, 0X8C41,
  113. 0X4400, 0X84C1, 0X8581, 0X4540, 0X8701, 0X47C0, 0X4680, 0X8641,
  114. 0X8201, 0X42C0, 0X4380, 0X8341, 0X4100, 0X81C1, 0X8081, 0X4040
  115. };
  116. public static ushort ComputeCrc(byte[] data)
  117. {
  118. ushort crc = 0;
  119. foreach (byte datum in data)
  120. {
  121. crc = (ushort)(CrcTable[(crc ^ datum) & 0xFF] ^ (crc >> 8));
  122. }
  123. return crc;
  124. }
  125. public static byte[] ComputeCrcBytes(byte[] data)
  126. {
  127. ushort result = ComputeCrc(data);
  128. return BitConverter.GetBytes(result).Reverse().ToArray();
  129. }
  130. }
  131. }