示例#1
0
        /// <summary>
        /// 从数据帧提取数据
        /// </summary>
        /// <param name="data"></param>
        /// <returns></returns>
        public static FrameStruct DeFrameData(byte[] data)
        {
            FrameStruct frameData = new FrameStruct();
            frameData.validity = false;

            try
            {
                byte[] dat = ParseData.UnPackData(data);   //去掉头尾和转义字节

                //检查CRC校验码
                UInt16 wCrc1 = Crc16.GetCRC16(dat, 0, dat.Length - 2);
                UInt16 wCrc2 = DataConvert.BytestoUInt16(dat, dat.Length - 2);

                wCrc2 = DataConvert.InvWord(wCrc2);

                if (wCrc1 == wCrc2)
                {
                    int i = 0;

                    UInt16 dataLen = DataConvert.BytestoUInt16(dat, i);
                    dataLen = DataConvert.InvWord(dataLen);

                    i = i + 2;

                    frameData.srcPort = dat[i];
                    i++;

                    frameData.srcLen = dat[i];
                    i++;

                    frameData.srcAddr = new byte[frameData.srcLen];
                    Array.Copy(dat, i, frameData.srcAddr, 0, frameData.srcLen);
                    i = i + frameData.srcLen;

                    frameData.dstPort = dat[i];
                    i++;

                    frameData.dstLen = dat[i];
                    i++;

                    frameData.dstAddr = new byte[frameData.dstLen];
                    Array.Copy(dat, i, frameData.dstAddr, 0, frameData.dstLen);
                    i = i + frameData.dstLen;

                    frameData.optType = dat[i];
                    i++;

                    frameData.cmd = dat[i];
                    i++;

                    int iLen = dataLen - i;
                    frameData.data = new byte[iLen];

                    Array.Copy(dat, i, frameData.data, 0, iLen);

                    frameData.validity = true;
                }

            }
            catch (System.Exception ex)
            {
                throw ex;
            }

            return frameData;
        }
示例#2
0
文件: Form1.cs 项目: szlon/WifiData
        private void SendPackage()
        {
            //生成并发送数据包
            configRecord record = GetCurRecord();

            FrameStruct fsData = new FrameStruct();
            fsData.srcPort = Convert.ToByte(record.SrcID, 16);

            if (record.SrcAddr.Length > 0)
            {
                fsData.srcAddr = DataConvert.StrToHexByte(record.SrcAddr);
                fsData.srcLen = (byte)fsData.srcAddr.Length;
            }
            else
                fsData.srcLen = 0;

            fsData.dstPort = Convert.ToByte(record.DstID, 16);
            if (record.DstAddr.Length > 0)
            {
                fsData.dstAddr = DataConvert.StrToHexByte(record.DstAddr);
                fsData.dstLen = (byte)fsData.dstAddr.Length;
            }
            else
                fsData.dstLen = 0;

            fsData.optType =  Convert.ToByte(record.OpType, 16);
            fsData.cmd = Convert.ToByte(record.Cmd, 16);
            fsData.data = DataConvert.StrToHexByte(record.Data);

            //------------------------------------------------
            byte[] data = ParseData.MakeFrameData(fsData);

            string outText = "";
            if (chkCom.Checked)
            {
                //串口发送
                //tcpComm.BroadcastData(ClientLevel.None, data);
                if (serialPort.IsOpen)
                {
                    outText = string.Format("[{0} {1}] COM发送 \r\n{2}\r\n", DateTime.Now.ToLongDateString(), DateTime.Now.ToLongTimeString(), ByteToHexStr(data));
                    serialPort.Write(data, 0, data.Length);
                }

            }
            else
            {
                //网络发送
                outText = string.Format("[{0} {1}] TCP发送 \r\n{2}\r\n", DateTime.Now.ToLongDateString(), DateTime.Now.ToLongTimeString(), ByteToHexStr(data));
                if (ServerMode)
                {
                    tcpServer.BroadcastData(ClientLevel.None, data);
                }
                else
                {
                    tcpClient.Send(data);
                }
            }

            SafeOutText(outText);
        }
示例#3
0
        //生成数据帧
        //static public byte[] MakeFrameData(byte srcPort, byte srcLen, byte[] srcAddr,
        //                                    byte dstPort, byte dstLen, byte[] dstAddr,
        //                                    byte optType, byte cmd, byte[] data)
        public static byte[] MakeFrameData(FrameStruct frameData)
        {
            byte[] dat = null;

            try
            {
                UInt16 dataLen = (UInt16)(8 + frameData.srcLen + frameData.dstLen + frameData.data.Length);
                //dataLen = DataConvert.InvWord(dataLen);

                int i = 0;

                dat = new byte[dataLen + 2]; //数据长度 + CRC长度

                DataConvert.UInt16toBytes(DataConvert.InvWord(dataLen), dat, i);
                i = i + 2;

                // Source
                dat[i] = frameData.srcPort;
                i++;

                dat[i] = frameData.srcLen;
                i++;

                if (frameData.srcLen > 0)
                {
                    Array.Copy(frameData.srcAddr, 0, dat, i, frameData.srcAddr.Length);
                    i = i + frameData.srcLen;
                }

                // Destination
                dat[i] = frameData.dstPort;
                i++;

                dat[i] = frameData.dstLen;
                i++;

                if (frameData.dstLen > 0)
                {
                    Array.Copy(frameData.dstAddr, 0, dat, i, frameData.dstAddr.Length);
                    i = i + frameData.dstLen;
                }

                // Command
                dat[i] = frameData.optType;
                i++;

                dat[i] = frameData.cmd;
                i++;

                Array.Copy(frameData.data, 0, dat, i, frameData.data.Length);

                //添加CRC校验码
                UInt16 wCRC16 = Crc16.GetCRC16(dat, 0, dataLen); //计算从信息长度到数据结束的CRC校验
                wCRC16 = DataConvert.InvWord(wCRC16);
                DataConvert.UInt16toBytes(wCRC16, dat, dataLen);   //添加CRC16校验

            }
            catch (System.Exception ex)
            {
                throw ex;
            }

            byte[] outData = PackData(dat);   //加头尾,转义处理

            return outData;
        }