串口通信的MPU姿態傳感(gǎn)器數據包解析技術
2018/1/19 點擊:
本程序段描述了MPUXXX姿態傳感器通過串口發送給主機(jī)時的數據包解析過程,僅供參考。
void Analysize_Data()
{
float CurrentTimeCounter = 0;
while (true){
bool data_1_catched = false;//緩存記錄數(shù)據是否捕獲到(dào)
//int CurrentTimeCounter = 0;
int buffer_len = buffer.Count;//獲取buffer長度
while (buffer.Count >= 5)//至少要包含頭(2字(zì)節) +功能字(1字節) +長度(1字節) +校驗(yàn)(1字節)
{
//1 查(chá)找數據頭
if (buffer[0] == 0x55 && buffer[1] == 0xaa)//檢(jiǎn)測是否是包頭
{
int len = buffer[3];//數據(jù)長(zhǎng)度
//數據不夠時移除數據
if (buffer.Count < len + 5)
{
buffer.RemoveRange(0, buffer.Count - 1);
break;
}
if (buffer[3] == 0x06) //該幀長度16字節//數(shù)據位沒有0x06位
{
Ctrl_Roll = (float)(((short)((buffer[4] << 8) | buffer[5])) / 100.0);//解析協(xié)議的(de),提取數據並將16進製轉換為10進製,
Ctrl_Pitch = (float)(((short)((buffer[6] << 8) | buffer[7])) / 100.0);
Ctrl_Yaw = (float)(((short)((buffer[8] << 8) | buffer[9])) / 10.0);
data_1_catched = true;
buffer.RemoveRange(0, len + 4);//正確分析一條數據,從緩存中移(yí)除數據。數據移除
if (data_1_catched)
{
//更新界麵
this.Invoke((EventHandler)(delegate//對監控的數據的(de)實時曲線進行跟新
{
chart1.Series[0].Points.AddXY(CurrentTimeCounter, Ctrl_Roll);
chart1.Series[1].Points.AddXY(CurrentTimeCounter, Ctrl_Pitch);
chart1.Series[2].Points.AddXY(CurrentTimeCounter, Ctrl_Yaw);
}));
}
}
else
{
buffer.RemoveAt(0);
break;
}
}
else
{ //這(zhè)裏是很重要的,如(rú)果數據開始不是(shì)頭,則(zé)刪除數(shù)據
buffer.RemoveAt(0);
}
}
}
}
WONGLOVE將一直關注*實用的編程技(jì)術,以饗網友。
- 上(shàng)一篇:UNITY3D MonoDevelop不能粘貼外部代(dài)碼文(wén)字怎(zěn) 2018/3/4
- 下一篇:串口協議以及串口二進製整數據包解析 2018/1/11