public byte[] Serialize() { List <byte> result = new List <byte>(); result.Add(uMCP.SIGN); result.Add((byte)PTYPE); result.Add(SID); result.Add(TID); if (PTYPE == uMCPPacketType.REP) { result.Add(tCNT); } else if ((PTYPE == uMCPPacketType.ACK) || (PTYPE == uMCPPacketType.DTA) || (PTYPE == uMCPPacketType.DTE)) { result.Add(tCNT); result.Add(rCNT); } result.Add(CRC.CRC8_Get(result, 0, result.Count)); if ((PTYPE == uMCPPacketType.DTA) || (PTYPE == uMCPPacketType.DTE)) { int dtaStartOffset = result.Count; result.Add(Convert.ToByte(dATA.Length)); result.AddRange(dATA); result.Add(CRC.CRC8_Get(result, dtaStartOffset, dATA.Length + 1)); } return(result.ToArray()); }
public int InputDataProcess(byte[] data) { while (Interlocked.CompareExchange(ref rLock, 1, 0) == 0) { Thread.SpinWait(1); } #region write data to ring for (int i = 0; i < data.Length; i++) { ring[wPos] = data[i]; wPos = (wPos + 1) % rSize; rCnt++; } #endregion bool isStep = false; bool isEmpty = false; while (!isEmpty) { #region look for a packet start bool isPacketStart = false; while ((rCnt >= uMCPPacket.MIN_SIZE) && (!isPacketStart)) { if (ring[rPos] == uMCP.SIGN) { isPacketStart = true; } else { rPos = (rPos + 1) % rSize; rCnt--; } } #endregion if (isPacketStart) { #region try to parse int rPosCache = rPos; int rCntCache = rCnt; RingReadByte(rPosCache, rCntCache, out rPosCache, out rCntCache); // skip SIGN uMCPPacketType pType = (uMCPPacketType)RingReadByte(rPosCache, rCntCache, out rPosCache, out rCntCache); if (pType != uMCPPacketType.INVALID) { int hSize; rPosCache = rPos; rCntCache = rCnt; if ((pType == uMCPPacketType.STR) || (pType == uMCPPacketType.STA)) { hSize = uMCP.STASTR_HSIZE; } else if (pType == uMCPPacketType.REP) { hSize = uMCP.REP_HSIZE; } else { hSize = uMCP.ACKDTA_HSIZE; } if (rCntCache >= hSize) { #region read header & its CRC var packet = RingRead(rPosCache, rCntCache, hSize, out rPosCache, out rCntCache); byte declaredPacketCRC = packet[packet.Length - 1]; byte actualPacketCRC = CRC.CRC8_Get(packet, 0, packet.Length - 1); #endregion if (declaredPacketCRC == actualPacketCRC) { #region if packet CRC is OK #region decode control header byte sid = packet[uMCPPacket.SID_OFFSET]; byte tid = packet[uMCPPacket.TID_OFFSET]; #endregion if ((pType == uMCPPacketType.STR) || (pType == uMCPPacketType.STA)) { #region STR & STA isStep = true; packets.Add(new uMCPSTPacket(pType, sid, tid)); #endregion } else { byte tcnt = packet[uMCPPacket.RCNT_OFFSET]; if (pType == uMCPPacketType.REP) { #region REP isStep = true; packets.Add(new uMCPREPPacket(sid, tid, tcnt)); #endregion } else { byte rcnt = packet[uMCPPacket.TCNT_OFFSET]; if (pType == uMCPPacketType.ACK) { #region ACK isStep = true; packets.Add(new uMCPACKPacket(sid, tid, rcnt, tcnt)); #endregion } else { #region DTA & DTE // try to get dcnt if (rCntCache > 1) { byte actualDBlockCRC = 0xFF; byte dcnt = RingReadByte(rPosCache, rCntCache, out rPosCache, out rCntCache); if (dcnt >= 1) { actualDBlockCRC = CRC.CRC8_Update(dcnt, actualDBlockCRC); if (rCntCache >= dcnt + 1) { var dataBlock = RingRead(rPosCache, rCntCache, dcnt, out rPosCache, out rCntCache); actualDBlockCRC = CRC.CRC8_Update(dataBlock, 0, dataBlock.Length, actualDBlockCRC); byte declaredDBlockCRC = RingReadByte(rPosCache, rCntCache, out rPosCache, out rCntCache); if (declaredDBlockCRC == actualDBlockCRC) { packets.Add(new uMCPDATAPacket(sid, tid, rcnt, tcnt, dataBlock, (pType == uMCPPacketType.DTE))); } isStep = true; // even if bad crc } else { // wait for data... isEmpty = true; } } else { // bad data block, use only header isStep = true; packets.Add(new uMCPACKPacket(sid, tid, rcnt, tcnt)); } } else { // wait for data... isEmpty = true; } #endregion } } } #endregion } else { // bad crc, just skip it isStep = true; } } else { // leave, wait for data isEmpty = true; } } else { // bad or not a packet, skip isStep = true; } if (isStep) { rPos = rPosCache; rCnt = rCntCache; } #endregion } else { // no packet start found isEmpty = true; } } // while (!isEmpty)... Interlocked.Decrement(ref rLock); return(packets.Count); }