基于MEMS器件的低成本微慣性導航系統設計
加入技術(shù)交流群
1．2 信號采集處理與傳輸模塊
根據慣性傳感器特性，在留有余度的基礎上選用16位高精度A／D采集芯片ADS8344，其8個(gè)通道循環(huán)采樣，轉換速率可調且最大為100 kHz，采用SPI接口與CPU通信?？紤]運算速度及方便使用，CPU選擇ADI公司的ADuC842單片機，該單片機主頻可達16．67 MHz，片上自帶8路12位A／D，可用于溫度傳感器信號的采集，并完成陀螺和加速度計信號的讀取、預處理以及溫漂補償等操作，最終通過(guò)RS 232與導航計算機通信。
1．3 導航計算機
捷聯(lián)式慣性導航算法非常復雜，運算量很大，需建立“數學(xué)平臺”以代替平臺慣導的機械平臺。為滿(mǎn)足系統的實(shí)時(shí)性要求，選擇臺灣昭營(yíng)科技的主頻1．2 GHz，內存512 MB的嵌入式小型計算機eBox4850作為導航計算機，可以很好地滿(mǎn)足要求。
2 信號預處理
微慣性傳感器，尤其是微陀螺技術(shù)目前還不是很成熟，低成本的MIMU在性能和精度上都存在較大的缺陷，野值比較明顯，噪聲水平也比較高。利用先前已在MEMS陀螺降噪方面所做的工作，在此先在單片機中對信號做預處理，再利用降噪算法在導航計算機中進(jìn)行陀螺降噪，最后完成導航解算，以獲得較好的處理效果?？紤]單片機系統的處理能力及實(shí)時(shí)性，本文采用均值濾波算法做預處理，即對每組采集的7個(gè)數據，首先去除最大值x(1)和最小值x(7)，剩余數據記為x(2)，x(3)，x(4)，x(5)，x(6)；然后將x(2)，x(3)的均值，x(3)，x(4)，x(5)的均值，x(5)，x(6)的均值再平均后作為預處理后的輸出數據。
目前已經(jīng)廣泛應用到眾多導航設備中。姿態(tài)更新計算是捷聯(lián)式慣導的關(guān)鍵算法，主要有歐拉角法、方向余弦法和四元數法。其中四元數法具有計算量小、精度高、可避免奇異性等優(yōu)點(diǎn)，本文采用此方法作為姿態(tài)更新算法。圖2、圖3為陀螺及加速度計靜態(tài)信號在數據預處理前后在Matlab中的仿真圖，由圖可見(jiàn)，均值濾波預處理算法效果較好，其中的奇異值基本消除。
3 捷聯(lián)解算(SINS)
在此設計的捷聯(lián)式慣性導航系統工作原理圖如圖4所示。將MEMS陀螺和MEMS加速度計直接固聯(lián)在運載體上，通過(guò)導航計算機依靠算法建立導航坐標系，即平臺坐標系以數學(xué)平臺形式存在，省略了復雜的物理平臺，具有結構簡(jiǎn)單、體積小、重量輕、成本低等優(yōu)點(diǎn)。本文引用地址：http://dyxdggzs.com/article/162532.htm
3．1 姿態(tài)矩陣
設導航坐標系為n，運載體坐標系為b，俯仰角δ、橫滾角θ、航向角φ，由導航坐標系至運載體坐標系的姿態(tài)變化矩陣為：
3．2 四元數即時(shí)修正及歸一化
設載體坐標系相對導航坐標系的轉動(dòng)四元數為公式(1)，其中Wx、Wy、Wz為經(jīng)過(guò)補償后的3軸捷聯(lián)MEMS陀螺輸出。
在更新過(guò)程中，由于存在計算誤差，姿態(tài)矩陣成為非正交陣，因此需要正交化處理以消除非正交引起的算法誤差，處理方法為用式(3)中的替換Q中的相應qi即可。
評論