using JT809.Protocol.JT809Attributes; using JT809.Protocol.JT809Enums; using JT809.Protocol.JT809Exceptions; using JT809.Protocol.JT809Extensions; using System; using System.Buffers; using System.Collections.Generic; using System.Text; namespace JT809.Protocol.JT809Formatters { public class JT809PackageFormatter : IJT809Formatter { public JT809Package Deserialize(ReadOnlySpan bytes, out int readSize) { int offset = 0; JT809Package jT809Package = new JT809Package(); // 转义还原——>验证校验码——>解析消息 // 1. 解码(转义还原) ReadOnlySpan buffer = JT809DeEscape(bytes); // 2. 验证校验码 // 2.1. 获取校验位索引 int checkIndex = buffer.Length - 3; // 2.2. 获取校验码 int crcCodeOffset = 0; jT809Package.CRCCode = JT809BinaryExtensions.ReadUInt16Little(buffer.Slice(checkIndex,2),ref crcCodeOffset); if (!JT809GlobalConfig.Instance.SkipCRCCode) { // 2.3. 从消息头到校验码前一个字节 ushort checkCode = buffer.ToCRC16_CCITT(1, checkIndex); // 2.4. 验证校验码 if (jT809Package.CRCCode != checkCode) { throw new JT809Exception(JT809ErrorCode.CRC16CheckInvalid, $"{jT809Package.CRCCode.ToString()}!={checkCode.ToString()}"); } } jT809Package.BeginFlag = JT809BinaryExtensions.ReadByteLittle(buffer, ref offset); // 3.初始化消息头 try { jT809Package.Header = JT809FormatterExtensions.GetFormatter().Deserialize(buffer.Slice(offset, JT809Header.FixedByteLength), out readSize); } catch (Exception ex) { throw new JT809Exception(JT809ErrorCode.HeaderParseError, $"offset>{offset.ToString()}", ex); } offset += readSize; // 5.数据体处理 // 5.1 判断是否有数据体(总长度-固定长度)> 0 if ((jT809Package.Header.MsgLength - JT809Package.FixedByteLength) > 0) { //JT809.Protocol.JT809Enums.JT809BusinessType 映射对应消息特性 JT809BodiesTypeAttribute jT809BodiesTypeAttribute = jT809Package.Header.BusinessType.GetAttribute(); if (jT809BodiesTypeAttribute != null) { try { // 5.2 是否加密 switch (jT809Package.Header.EncryptFlag) { case JT809Header_Encrypt.None: //5.3 处理消息体 jT809Package.Bodies = JT809FormatterResolverExtensions.JT809DynamicDeserialize(JT809FormatterExtensions.GetFormatter(jT809BodiesTypeAttribute.JT809BodiesType), buffer.Slice(offset, checkIndex - offset), out readSize); break; case JT809Header_Encrypt.Common: byte[] bodiesData = JT809GlobalConfig.Instance.Encrypt.Decrypt(buffer.Slice(offset, checkIndex - offset).ToArray(), jT809Package.Header.EncryptKey); jT809Package.Bodies = JT809FormatterResolverExtensions.JT809DynamicDeserialize(JT809FormatterExtensions.GetFormatter(jT809BodiesTypeAttribute.JT809BodiesType), bodiesData, out readSize); break; } } catch (Exception ex) { throw new JT809Exception(JT809ErrorCode.BodiesParseError,$"offset>{offset.ToString()}", ex); } } } jT809Package.EndFlag = buffer[buffer.Length - 1]; readSize = buffer.Length; return jT809Package; } public int Serialize(ref byte[] bytes, int offset, JT809Package value) { // 1. 先序列化数据体,根据数据体的长度赋值给头部,在序列化头部。 int messageBodyOffset = 0; JT809BodiesTypeAttribute jT809BodiesTypeAttribute = value.Header.BusinessType.GetAttribute(); if (jT809BodiesTypeAttribute != null) { if (value.Bodies != null) { // 1.1 处理数据体 messageBodyOffset = JT809FormatterResolverExtensions.JT809DynamicSerialize(JT809FormatterExtensions.GetFormatter(jT809BodiesTypeAttribute.JT809BodiesType), ref bytes, messageBodyOffset, value.Bodies); } } byte[] messageBodyData=null; if (messageBodyOffset != 0) { messageBodyData = bytes.AsSpan(0, messageBodyOffset).ToArray(); // 1.2 数据加密 switch (value.Header.EncryptFlag) { case JT809Header_Encrypt.None: break; case JT809Header_Encrypt.Common: messageBodyData = JT809GlobalConfig.Instance.Encrypt.Encrypt(messageBodyData, value.Header.EncryptKey); break; } } // ------------------------------------开始组包 // 1.起始符 offset += JT809BinaryExtensions.WriteByteLittle(bytes, offset, value.BeginFlag); // 2.赋值头数据长度 if (messageBodyOffset != 0) { value.Header.MsgLength = (uint)(JT809Package.FixedByteLength + messageBodyData.Length); } else { value.Header.MsgLength = JT809Package.FixedByteLength; } // 2.1写入头部数据 offset = JT809FormatterExtensions.GetFormatter().Serialize(ref bytes, offset, value.Header); if (messageBodyOffset != 0) { // 3. 写入数据体 Array.Copy(messageBodyData, 0, bytes, offset, messageBodyData.Length); offset += messageBodyData.Length; messageBodyData = null; } // 4.校验码 offset += JT809BinaryExtensions.WriteUInt16Little(bytes, offset, bytes.ToCRC16_CCITT(1, offset)); // 5.终止符 offset += JT809BinaryExtensions.WriteByteLittle(bytes, offset, value.EndFlag); // 6.转义 return JT809Escape(ref bytes, offset); } internal static ReadOnlySpan JT809DeEscape(ReadOnlySpan buffer) { byte[] tmpBuffer = JT809ArrayPool.Rent(buffer.Length - 1); try { int offset = 0; tmpBuffer[offset++] = buffer[0]; for (int i = 1; i < buffer.Length - 1; i++) { byte first = buffer[i]; byte second = buffer[i + 1]; if (first == 0x5a && second == 0x01) { tmpBuffer[offset++] = 0x5b; i++; } else if (first == 0x5a && second == 0x02) { tmpBuffer[offset++] = 0x5a; i++; } else if (first == 0x5e && second == 0x01) { tmpBuffer[offset++] = 0x5d; i++; } else if (first == 0x5e && second == 0x02) { tmpBuffer[offset++] = 0x5e; i++; } else { tmpBuffer[offset++] = first; } } tmpBuffer[offset++] = buffer[buffer.Length - 1]; return tmpBuffer.AsSpan(0, offset).ToArray(); } finally { JT809ArrayPool.Return(tmpBuffer); } } internal static int JT809Escape(ref byte[] buffer, int offset) { byte[] tmpBuffer = buffer.AsSpan(0, offset).ToArray(); int tmpOffset = 0; buffer[tmpOffset++] = tmpBuffer[0]; for (int i = 1; i < offset - 1; i++) { var item = tmpBuffer[i]; switch (item) { case 0x5b: buffer[tmpOffset++] = 0x5a; buffer[tmpOffset++] = 0x01; break; case 0x5a: buffer[tmpOffset++] = 0x5a; buffer[tmpOffset++] = 0x02; break; case 0x5d: buffer[tmpOffset++] = 0x5e; buffer[tmpOffset++] = 0x01; break; case 0x5e: buffer[tmpOffset++] = 0x5e; buffer[tmpOffset++] = 0x02; break; default: buffer[tmpOffset++] = item; break; } } buffer[tmpOffset++]= tmpBuffer[tmpBuffer.Length - 1]; return tmpOffset; } } }