/// <summary>
/// 字节缓冲器
/// </summary>
public class ByteQueue2
{
private List<byte> m_buffer = new List<byte>();
public bool Find()
{
if (m_buffer.Count == 0)
return false;
int HeadIndex = m_buffer.FindIndex(o => o == 0xAA);
if (HeadIndex == -1)
{
m_buffer.Clear();
return false; //没找到AA
}
else if (HeadIndex != 0) //不为开头移掉之前的字节
{
if (HeadIndex > 1)
m_buffer.RemoveRange(0, HeadIndex);
}
int length = GetLength();
if (m_buffer.Count < length)
{
return false;
}
int TailIndex = m_buffer.FindIndex(o => o == 0x55); //查找55的位置
if (TailIndex == -1)
{
//这一步为防止连发一个AA开头的包后，没发55，而又发了一个AA
int head = m_buffer.FindLastIndex(o => o == 0xAA);
if (head > -1)
{
m_buffer.RemoveRange(0, head);
}
return false;
}
else if (TailIndex + 1 != length) //计算包尾是否与包长度相等
{
m_buffer.RemoveRange(0, TailIndex);
return false;
}
return true;
}
/// <summary>
/// 数据长度
/// </summary>
/// <returns></returns>
public int GetLength()
{
if (m_buffer.Count >= 3)
{
byte[] len=new byte[2];
len[0]=m_buffer[1];
len[1]=m_buffer[2];
return BitConverter.ToInt16(len, 0);
}
return 0;
}
/// <summary>
/// 命令码
/// </summary>
/// <returns></returns>
public byte Cmd()
{
if (m_buffer.Count >= 4)
{
return m_buffer[3];
}
return 0;
}
/// <summary>
/// 提取数据
/// </summary>
public byte[] Dequeue()
{
int size = 1 + 2 + 1 + GetLength() + 1;
byte[] buffer = m_buffer.Take(size).ToArray();
m_buffer.RemoveRange(0, size);
}
/// <summary>
/// 队列数据
/// </summary>
/// <param name="buffer"></param>
public void Enqueue(byte[] buffer)
{
m_buffer.AddRange(buffer);
}
}
