北斗数据包格式封装和解析

1.北斗协议的具体格式如下图

image.png

image.png

2.数据包类型 根据北斗协议类型定义如下枚举类型

 /// <summary>
    /// 数据包类型
    /// </summary>
    public enum BDFrameType : ushort
    {
        /// <summary>
        /// 默认
        /// </summary>
        Default = 0x00,
 
        /// <summary>
        /// 终端通用应答
        /// </summary>
        TerCommonResponse = 0x0001,
 
        /// <summary>
        /// 平台通用应答
        /// </summary>
        PlatCommonResponse = 0x8001,
 
        /// <summary>
        /// 终端心跳
        /// </summary>
        TerHeartbeat = 0x0002,
         
         
             /// <summary>
             /// 位置信息汇报
            /// </summary>
              Position = 0x0200
         
        //省略其他的数据包类型
 
    }

3.基础类封装 BDBaseFrame,使用 IByteBuffer 类来封装数据包,IByteBuffer 内置提供了很多字节操作方法(read,write) 

byteBuffer.ReadUnsignedShort()
byteBuffer.WriteUnsignedShort()
//等等
public abstract class BDBaseFrame
    {
        /// <summary>
        /// 消息ID
        /// </summary>
        public BDFrameType FrameType { get; set; }
 
        /// <summary>
        /// 是否分包
        /// </summary>
        public bool IsSubpackage { get; set; }
 
        /// <summary>
        /// 加密方式
        /// </summary>
        public BDFrameEncryptType FrameEncryptType { get; set; }
 
        /// <summary>
        /// 消息体长度
        /// </summary>
        public UInt16 FrameContentLen { get; private set; }
 
        /// <summary>
        /// 终端手机号  唯一
        /// </summary>
        public string TerminalPhone { get; set; } = string.Empty;
 
 
        /// <summary>
        /// 消息流水号
        /// </summary>
        public ushort FrameSerialNum { get; set; }
 
        /// <summary>
        /// 消息总包数
        /// </summary>
        public ushort FramePackageCount { get; set; }
 
        /// <summary>
        /// 包序号  从 1开始
        /// </summary>
        public ushort FramePackageIndex { get; set; }
 
 
        private int m_frameBodyOffset = 13;
 
        /// <summary>
        /// 消息体 数据偏于量
        /// </summary>
        protected int FrameBodyOffset
        {
            get { return m_frameBodyOffset; }
        }
 
        private static ushort m_SendFrameSerialNum = 0;
 
        /// <summary>
        /// 获取发送的流水号
        /// </summary>
        public static ushort SendFrameSerialNum
        {
            get
            {
                if (m_SendFrameSerialNum == ushort.MaxValue)
                    m_SendFrameSerialNum = 0;
 
                m_SendFrameSerialNum++;
 
                return m_SendFrameSerialNum;
            }
        }
 
        /// <summary>
        /// 数据包内容 字节
        /// </summary>
        //public IByteBuffer ContentBuffer { get; set; }
 
        #region 解析数据包
        /// <summary>
        /// 解析头部
        /// </summary>
        private void DecoderHead(IByteBuffer byteBuffer)
        {
            //消息体属性
            byteBuffer.SetReaderIndex(1);
            FrameType = (BDFrameType)byteBuffer.ReadUnsignedShort();
            ushort frameProerty = byteBuffer.ReadUnsignedShort();
            IsSubpackage = FrameHelper.ReadBoolean16(frameProerty, 13);
            FrameContentLen = (UInt16)(frameProerty & 0x1FFF);//消息体长度
            if (IsSubpackage)
                m_frameBodyOffset = 17;
            //终端手机号
            StringBuilder stringBuilder = new StringBuilder();
            for (int i = 0; i < 6; i++)
            {
                stringBuilder.Append(byteBuffer.ReadByte().ToString("X2"));
            }
            TerminalPhone = stringBuilder.ToString().TrimStart(new char[] { '0' });
            //消息流水号
            FrameSerialNum = byteBuffer.ReadUnsignedShort();
            //消息包封装项
            if (IsSubpackage)
            {
                FramePackageCount = byteBuffer.ReadUnsignedShort();
                FramePackageIndex = byteBuffer.ReadUnsignedShort();
            }
        }
 
        /// <summary>
        /// 解析内容
        /// </summary>
        public virtual void DecoderFrame(IByteBuffer byteBuffer)
        {
            //解析头部
            DecoderHead(byteBuffer);
        }
 
        #endregion
 
        #region 封装数据包
 
        public virtual IByteBuffer EncoderContent()
        {
            return null;
        }
 
        #endregion
 
        public override string ToString()
        {
            return $"{TerminalPhone} {FrameTypeHelper.GetFrameType(FrameType)}  {DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss")}";
        }
    }

4.具体数据包类型封装 PositionFrame

 /// <summary>
    /// 位置信息汇报
    /// </summary>
    public class PositionFrame : BDBaseFrame
    {
        public PositionFrame()
        {
            FrameType = BDFrameType.Position;
        }
 
        /// <summary>
        /// 报警标志
        /// </summary>
        public UInt32 AlarmFlag { get; set; }
 
        /// <summary>
        /// 状态
        /// </summary>
        public UInt32 StatusFlag { get; set; }
 
        /// <summary>
        /// 纬度 DWORD 以度为单位的纬度值乘以 10 的 6 次方,精确到百万分之一度
        /// </summary>
        public double Lat { get; set; }
 
        /// <summary>
        /// 经度 DWORD 以度为单位的经度值乘以 10 的 6 次方,精确到百万分之一度
        /// </summary>
        public double Lng { get; set; }
 
        /// <summary>
        /// 高程 WORD 海拔高度,单位为米(m)
        /// </summary>
        public UInt16 Height { get; set; }
 
        /// <summary>
        /// 速度 WORD 1/10km/h
        /// </summary>
        public float Speed { get; set; }
 
        /// <summary>
        /// 方向 WORD 0-359,正北为 0,顺时针
        /// </summary>
        public UInt16 Direction { get; set; }
 
        /// <summary>
        /// 时间 BCD[6] YY-MM-DD-hh-mm-ss(GMT+8 时间,本标准中之后涉及的时间均采用此时区)
        /// </summary>
        public DateTime GpsDateTime { get; set; }
 
        public override void DecoderFrame(IByteBuffer byteBuffer)
        {
            base.DecoderFrame(byteBuffer);
 
            AlarmFlag = byteBuffer.ReadUnsignedInt();
            StatusFlag = byteBuffer.ReadUnsignedInt();
            Lat = byteBuffer.ReadUnsignedInt() / 1000000.0;
            Lng = byteBuffer.ReadUnsignedInt() / 1000000.0;
            Height = byteBuffer.ReadUnsignedShort();
            Speed = byteBuffer.ReadUnsignedShort() / 10.0f;
            Direction = byteBuffer.ReadUnsignedShort();
            //时间 BCD[6]
            byte[] bcdTime = new byte[6];
            byteBuffer.ReadBytes(bcdTime);
            string bcdTimeString = FrameHelper.Bcd2String(bcdTime);
            DateTime gpsTime;
            if (DateTime.TryParseExact(bcdTimeString, "yyMMddHHmmss", new CultureInfo("zh-CN", true), DateTimeStyles.None, out gpsTime))
                GpsDateTime = gpsTime;
            else
                GpsDateTime = new DateTime(2001, 1, 1, 0, 0, 0);
        }
 
 
        public override IByteBuffer EncoderContent()
        {
            IByteBuffer contentBuffer = Unpooled.Buffer(100, 1024);
            contentBuffer.WriteInt((int)AlarmFlag);
            contentBuffer.WriteInt((int)StatusFlag);
            contentBuffer.WriteInt((int)(Lat * 1000000));
            contentBuffer.WriteInt((int)(Lng * 1000000));
            contentBuffer.WriteUnsignedShort(Height);
            contentBuffer.WriteUnsignedShort((UInt16)(Speed * 10));
            contentBuffer.WriteUnsignedShort(Direction);
            //时间 BCD[6]
            byte[] timeBcdBuffer = FrameHelper.WriteBCDString(GpsDateTime.ToString("yyMMddHHmmss"));
            contentBuffer.WriteBytes(timeBcdBuffer);
            return contentBuffer;
        }
 
        public override string ToString()
        {
            return string.Format("通讯号:{0},时间:{1},经纬度{2}|{3},高度:{4},方向:{5}", TerminalPhone, GpsDateTime.ToString("yyyy-MM-dd HH:mm:ss"), Lng, Lat, Height, Direction);
        }
    }

5.dotnetty EncoderHandler 封装,上面封装的只是消息体的数据,没有包括标识位,消息头,验证码,标识位,在发送数据通道中,需要把数据加上标识位,消息头,验证码,标识位。包括数据包转义

 /// <summary>
    /// 北斗数据包 封装
    /// </summary>
    public class BeiDouContentEncoderHandler : MessageToByteEncoder<BDBaseFrame>
    {
        protected override void Encode(IChannelHandlerContext context, BDBaseFrame message, IByteBuffer output)
        {
            EncodeFrame(message, output);
        }
 
        private void EncodeFrame(BDBaseFrame message, IByteBuffer output)
        {
            //IByteBuffer frameBuffer = output;
            output.MarkReaderIndex();
            //内容
            IByteBuffer contentBuffer = message.EncoderContent();
            if (contentBuffer == null)
                contentBuffer = Unpooled.Empty;
            //byte[] content = new byte[contentBuffer.ReadableBytes];
            //contentBuffer.ReadBytes(content, 0, content.Length);
            //写头标志
            output.WriteByte(BDFrameConst.FRAME_FLAG);
            //消息 ID
            output.WriteUnsignedShort((ushort)message.FrameType);
            //消息体属性  加密没做
            // ushort contentLen = (ushort)content.Length;
            ushort contentLen = (ushort)contentBuffer.ReadableBytes;
            if (message.IsSubpackage)
            {
                contentLen = (ushort)(contentLen | 0x2000);
                output.WriteUnsignedShort(contentLen);
            }
            else
            {
                output.WriteUnsignedShort(contentLen);
            }
            //终端手机号
            string tPhone = message.TerminalPhone.ToStringFramePropertyLength(12, '0');
            byte[] tPhoneBuffer = CZEFrameHelper.WriteBCDString(tPhone);
            output.WriteBytes(tPhoneBuffer);
            //消息流水号
            output.WriteUnsignedShort(message.FrameSerialNum);
            //消息包封装项
            if (message.IsSubpackage)
            {
                output.WriteUnsignedShort(message.FramePackageCount);
                output.WriteUnsignedShort(message.FramePackageIndex);
            }
            //消息体
            output.WriteBytes(contentBuffer);
            contentBuffer.Release();
            //计算校验码
            byte[] checkCodeBuffer = new byte[output.ReadableBytes];
            output.ReadBytes(checkCodeBuffer, 0, checkCodeBuffer.Length);
            byte value = checkCodeBuffer[1];
            for (int i = 2; i < checkCodeBuffer.Length; i++)
                value ^= checkCodeBuffer[i];
            output.WriteByte(value);
            //写尾标志
            output.WriteByte(BDFrameConst.FRAME_FLAG);
            //转义
            output.ResetReaderIndex();
            checkCodeBuffer = new byte[output.ReadableBytes];
            output.ReadBytes(checkCodeBuffer, 0, checkCodeBuffer.Length);
            byte[] frame = FrameEscaping.BDEscapingBufferSend(checkCodeBuffer);
 
            //数据写入 frameBuffer
            output.Clear();
            output.WriteBytes(frame);
        }
 
    }

6.使用 BeiDouContentEncoderHandler,在通道中加入BeiDouContentEncoderHandler,通道里面的顺序很重要,BeiDouContentEncoderHandler必须要在你发送的Handler前加到通道中去如下图

主要的代码就这些,水平有限,请大家多多指教

原文地址 http://www.dncblogs.cn/Blog/LookBlog/71

猜你喜欢

转载自www.cnblogs.com/zhongzw/p/10513611.html