• 串口通信的MPU姿態傳感器數據包解析技術

    2018/1/19      點擊:

    本程序(xù)段描述了MPUXXX姿態傳(chuán)感器通過(guò)串口(kǒu)發送給主機(jī)時的數據包解析過程,僅供參考。

    void Analysize_Data()
            {

               float CurrentTimeCounter = 0;

                while (true)
                {
                    bool data_1_catched = false;//緩存記錄數(shù)據是否捕獲到  
                    //int  CurrentTimeCounter = 0;
                    int buffer_len = buffer.Count;//獲(huò)取buffer長度

                    while (buffer.Count >= 5)//至少要包含頭(2字節) +功能字(1字節) +長度(1字(zì)節(jiē)) +校驗(1字節)
                    {
                        //1 查找數據頭  
                        if (buffer[0] == 0x55 && buffer[1] == 0xaa)//檢測是否是包頭(tóu)
                        {
                            int len = buffer[3];//數據長度  
                            //數據不(bú)夠時(shí)移除數(shù)據
                            if (buffer.Count < len + 5)
                            {
                                buffer.RemoveRange(0, buffer.Count - 1);
                                break;
                            }
                            if (buffer[3] == 0x06) //該幀長度16字節//數據(jù)位(wèi)沒有0x06位(wèi)
                            {
                                Ctrl_Roll = (float)(((short)((buffer[4] << 8) | buffer[5])) / 100.0);//解析協議的(de),提取數據(jù)並將16進製(zhì)轉換為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);//正確分析一條數據,從緩存中移除(chú)數據。數據(jù)移除 
                                if (data_1_catched)
                                {
                                    //更(gèng)新界麵(miàn)  
                                    this.Invoke((EventHandler)(delegate//對監控的數據的實時曲(qǔ)線進行跟新
                                    {
                                        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
                        {      //這裏是很重要的,如果數據開始不是頭,則刪除數據  
                            buffer.RemoveAt(0);
                        }
                    }
                }

            }


        WONGLOVE將一直關注*實用的編程技(jì)術(shù),以(yǐ)饗網友(yǒu)。


    91影视免费版下载-91麻豆国产福利精品-91麻豆精品一二三区在线-国产91系列视频在线观看