namespace TuneBoss.Core.BLE; /// /// Stateful byte-stream parser for TuneBoss BLE packets. /// Extracted from Form1_BLEhelper.cs ProcessByte() / OnFullPacketReceived(). /// Thread-safe only when all calls are serialized (BLE processing loop does this). /// public sealed class PacketParser { public sealed record ParsedPacket( byte DlCommand, byte SeqNum, byte DwCount, byte TlResponse, byte TlCommand, byte TlLength, byte[] Payload); private readonly Action _onPacketReceived; // ── Parser state ───────────────────────────────────────────────────────── private int _byteCycle; private int _startSeqCycle; private int _packetHeaderCycle; private int _dWordByteTrack; private int _dWordCheckSumTrack; private readonly byte[] _startSeq = new byte[4]; private readonly byte[] _packetHeader = new byte[4]; private readonly List _dataBuffer = new(); private readonly List _csBuffer = new(); private byte _currDlCommand; private byte _currDlSeqCount; private byte _currDlDWordCount; private byte _currTlResp; private byte _currTlCommand; private byte _currTlLength; public PacketParser(Action onPacketReceived) { _onPacketReceived = onPacketReceived; } public void Reset() { _byteCycle = 0; _startSeqCycle = 0; _packetHeaderCycle = 0; _dWordByteTrack = 0; _dWordCheckSumTrack = 0; _dataBuffer.Clear(); _csBuffer.Clear(); _currDlCommand = 0; _currDlSeqCount = 0; _currDlDWordCount = 0; _currTlResp = 0; _currTlCommand = 0; _currTlLength = 0; } public void ProcessByte(byte b) { // ── Zone 1: bytes 0–3 — preamble FF 00 FF 00 ───────────────────── if (_byteCycle <= 3) { _startSeq[_startSeqCycle] = b; if (_startSeqCycle == 3) { bool valid = _startSeq[0] == 0xFF && _startSeq[1] == 0x00 && _startSeq[2] == 0xFF && _startSeq[3] == 0x00; if (!valid) { Reset(); return; } } _startSeqCycle++; _byteCycle++; return; } // ── Zone 2: bytes 4–7 — packet header ──────────────────────────── if (_byteCycle <= 7) { _packetHeader[_packetHeaderCycle] = b; if (_packetHeaderCycle == 3) { if (!HeaderIntegrityOk(_packetHeader)) { Reset(); return; } _currDlCommand = _packetHeader[0]; _currDlSeqCount = _packetHeader[1]; _currDlDWordCount = _packetHeader[2]; } _packetHeaderCycle++; _byteCycle++; return; } // ── Zone 3: no payload ──────────────────────────────────────────── if (_currDlDWordCount == 0) { Reset(); return; } // ── Zone 4: bytes 8–11 — TL header (first DWord of payload) ────── if (_byteCycle <= 11) { switch (_byteCycle) { case 8: _currTlResp = b; break; case 9: _currTlCommand = b; break; case 10: _currTlLength = b; break; } _dataBuffer.Add(b); _byteCycle++; return; } // ── Zone 5: bytes 12+ — payload bytes + checksum ───────────────── _byteCycle++; int payloadBytes = 4 * (_currDlDWordCount - 1); // DWords after the TL header if (_dWordByteTrack < payloadBytes) { _dataBuffer.Add(b); _dWordByteTrack++; } else if (_dWordCheckSumTrack < 4) { _csBuffer.Add(b); _dWordCheckSumTrack++; if (_dWordCheckSumTrack == 4) OnFullPacketReceived(); } } private void OnFullPacketReceived() { byte[] data = _dataBuffer.ToArray(); byte[] cs = _csBuffer.ToArray(); // Verify checksum var expected = Protocol.ChecksumHelper.GenChecksumDW(data); var receivedCs = (uint)(cs[0] | (cs[1] << 8) | (cs[2] << 16) | (cs[3] << 24)); if (expected != receivedCs) { Reset(); return; } var packet = new ParsedPacket( DlCommand: _currDlCommand, SeqNum: _currDlSeqCount, DwCount: _currDlDWordCount, TlResponse: _currTlResp, TlCommand: _currTlCommand, TlLength: _currTlLength, Payload: data); Reset(); _onPacketReceived(packet); } private static bool HeaderIntegrityOk(byte[] h) { byte sum = unchecked((byte)(h[0] + h[1] + h[2])); byte invSum = unchecked((byte)~sum); return invSum == h[3]; } }