Разбор на данни от сериен порт, безопасен за нишки

Чета данни от серийния порт и ги анализирам в отделен клас. Данните обаче се анализират неправилно и някои проби се повтарят, докато други липсват.

Ето пример за анализирания пакет. Започва с packetIndex (трябва да започне от 1 и да се увеличава). Можете да видите как packetIdx се повтаря и някои от другите стойности също се повтарят. Мисля, че това се дължи на многонишковостта, но не съм сигурен как да го поправя.

    2 -124558.985180734 -67934.4168823262 -164223.049786454 -163322.386243628
    2 -124619.580759952 -67962.535376851 -164191.757344217 -163305.68949052
    3 -124685.719571795 -67995.8394760894 -164191.042088394 -163303.119039907 
    5 -124801.747477263 -68045.7062179692 -164195.288919841 -163299.140429394 
    6 -124801.747477263 -68045.7062179692 -164221.105184687 -163297.46404856 
    6 -124832.8387538 -68041.9287731563 -164214.936103217 -163294.983004926 

Ето какво трябва да получа:

1 -124558.985180734 -67934.4168823262 -164223.049786454 -163322.386243628
2 -124619.580759952 -67962.535376851 -164191.757344217 -163305.68949052
3 -124685.719571795 -67995.8394760894 -164191.042088394 -163303.119039907 
4 -124801.747477263 -68045.7062179692 -164195.288919841 -163299.140429394 
 ...

Това е SerialPort_DataReceived

 public void serialPort1_DataReceived(object sender, System.IO.Ports.SerialDataReceivedEventArgs e)
    {
        lock (_lock)
        {
            byte[] buffer = new byte[_serialPort1.BytesToRead];
            _serialPort1.Read(buffer, 0, buffer.Length);

            for (int i = 0; i < buffer.Length; i++)
            {
                //Parse data
                double[] samplesAtTimeT = DataParserObj.interpretBinaryStream(buffer[i]);
                //Add data to BlockingCollection when parsed 
                if (samplesAtTimeT != null)
                    _bqBufferTimerSeriesData.Add(samplesAtTimeT);
            }
        }
    }

И класът, който анализира данните:

public class DataParser
{
    private int packetSampleCounter = 0;
    private int localByteCounter = 0;
    private int packetState = 0;
    private byte[] tmpBuffer = new byte[3];
    private double[] ParsedData = new double[5]; //[0] packetIdx (0-255), [1-4] signal


    public double[] interpretBinaryStream(byte actbyte)
    {
        bool returnDataFlag = false;

        switch (packetState)
        {
            case 0: // end packet indicator
                if (actbyte == 0xC0)
                    packetState++;
                break;
            case 1: // start packet indicator
                if (actbyte == 0xA0)
                    packetState++;
                else
                    packetState = 0;
                break;
            case 2: // packet Index 
                packetSampleCounter = 0;
                ParsedData[packetSampleCounter] = actbyte;
                packetSampleCounter++;
                localByteCounter = 0;
                packetState++;
                break;
            case 3: //channel data (4 channels x 3byte/channel)
                // 3 bytes
                tmpBuffer[localByteCounter] = actbyte;
                localByteCounter++;
                if (localByteCounter == 3)
                {
                    ParsedData[packetSampleCounter] = Bit24ToInt32(tmpBuffer);
                    if (packetSampleCounter == 5)
                        packetState++; //move to next state, end of packet
                    else
                        localByteCounter = 0;
                }
                break;
            case 4: // end packet
                if (actbyte == 0xC0)
                {
                    returnDataFlag = true;
                    packetState = 1;
                }
                else
                    packetState = 0;
                break;
            default:
                packetState = 0;
                break;
        }
        if (returnDataFlag)
            return ParsedData;
        else
            return null;
    }
}