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];
}
}