成人免费黄色网_曰本女同videos_男女在线观看视频_在线亚洲黄色_欧美欧美欧美欧美_bestialityvideo另类最新

  • 您的位置:首頁 > 新聞動態 > 技術文章

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

    2018/1/19??????點擊:

    本程序段描述了MPUXXX姿態傳感器通過串口發送給主機時的數據包解析過程,僅供參考。

    void Analysize_Data()
            {

               float CurrentTimeCounter = 0;

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

                    while (buffer.Count >= 5)//至少要包含頭(2字節) +功能字(1字節) +長度(1字節) +校驗(1字節)
                    {
                        //1 查找數據頭  
                        if (buffer[0] == 0x55 && buffer[1] == 0xaa)//檢測是否是包頭
                        {
                            int len = buffer[3];//數據長度  
                            //數據不夠時移除數據
                            if (buffer.Count < len + 5)
                            {
                                buffer.RemoveRange(0, buffer.Count - 1);
                                break;
                            }
                            if (buffer[3] == 0x06) //該幀長度16字節//數據位沒有0x06位
                            {
                                Ctrl_Roll = (float)(((short)((buffer[4] << 8) | buffer[5])) / 100.0);//解析協議的,提取數據并將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);//正確分析一條數據,從緩存中移除數據。數據移除 
                                if (data_1_catched)
                                {
                                    //更新界面  
                                    this.Invoke((EventHandler)(delegate//對監控的數據的實時曲線進行跟新
                                    {
                                        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將一直關注*實用的編程技術,以饗網友。


    主站蜘蛛池模板: 青青青国产在线观看免费 | 国产一级二级毛片 | 999国产视频 | 国产露脸系列magnet | 午夜精品一区二区三区在线视 | 国产女人水真多18毛片18精品 | 男人狂桶女人高潮嗷嗷叫 | 午夜av中文字幕 | 亚洲av久久无码精品影视 | 人人干天天射 | 中文字幕成人一区 | 日韩免费a | 女同性做爰三级 | 51偷拍视频区视频免费观看 | 成人国产一区二区三区精品 | ye321夜色资源最新地址 | 国产黄色片在线观看 | 在线免费观看成人网 | 中文字幕二区在线观看 | 老鸭窝91久久精品色噜噜 导演 | 成人欧美一区二区三区的电影蜜臀 | 白人と日本人の交わりビデオ | 99精品久久99久久久久胖女人 | 免费污视频在线观看 | 26uuu成人网一区二区三区 | 日本成本人片免费网站 | 大地资源播放在线观看 | 疯狂按揉小核让她喷水h | 艹逼逼逼 | 国产欧美日韩麻豆91 | 蝴蝶飞飞免费观看 | 亚洲国产精品推荐 | 亚洲国产91精品在线观看 | 亚洲国产拍拍拍拍久久久 | 国产日本欧美一区二区三区 | 国产精品电影网站 | 五月激情婷婷丁香综合基地 | 欧美色欧美亚洲另类二区 | 无码aⅴ免费中文字幕久久 国产成人在线看 | 国产又粗又硬又大爽黄老大爷 | 国产精品免费一区二区区 |