49 lines
1.2 KiB
C#
49 lines
1.2 KiB
C#
|
using System;
|
|||
|
|
using System.Collections.Concurrent;
|
|||
|
|
using System.Linq;
|
|||
|
|
using System.Threading;
|
|||
|
|
|
|||
|
|
namespace LoraGamepad.Util;
|
|||
|
|
|
|||
|
|
public class SerialPipeIn: IAsyncPipe<byte,byte[]>
|
|||
|
|
{
|
|||
|
|
protected override void Process(ConcurrentQueue<byte> queue)
|
|||
|
|
{
|
|||
|
|
if (!queue.TryPeek(out var first))
|
|||
|
|
{
|
|||
|
|
SpinWait.SpinUntil(() => false, 1);
|
|||
|
|
// 队列无数据
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (0xFE != first) {
|
|||
|
|
// 未匹配到包头,扔掉继续
|
|||
|
|
queue.TryDequeue(out _);
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (queue.Count < 14) {
|
|||
|
|
// 数据长度过低
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
var pack = queue.Take(14).ToArray();
|
|||
|
|
if (pack[13] != CrcUtil.CRC8_Calculate(pack.Skip(1).SkipLast(1).ToArray())) {
|
|||
|
|
// crc校验失败，砍头
|
|||
|
|
queue.TryDequeue(out _);
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// 队列消除整包数据
|
|||
|
|
for (var i = 0; i < 14; i++) {
|
|||
|
|
queue.TryDequeue(out _);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// 输出数据，砍头砍尾
|
|||
|
|
// Console.WriteLine(BitConverter.ToString(pack));
|
|||
|
|
OnOut(pack.Skip(1).SkipLast(1).ToArray());
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
}
|