針對MEMS慣性測量單元器件特性導致的測量精度低,數據發(fā)散和航向角積分漂移等問(wèn)題,提出一種基于卡爾曼濾波的四元數姿態(tài)解算算法。設計了4維卡爾曼濾波器,通過(guò)加速度計和磁力計的數據作觀(guān)測量,對姿態(tài)解算過(guò)程中的四元數進(jìn)行線(xiàn)性最優(yōu)估計,在計算量沒(méi)有大幅提高的前提下修正了四元數的值,進(jìn)而完成了對姿態(tài)角和姿態(tài)矩陣的補償。通過(guò)在無(wú)磁轉臺上進(jìn)行靜態(tài)測試以及在測試標定系統上進(jìn)行動(dòng)態(tài)測試,分析各軸向的補償效果表明,該方法可以有效增強MIMU的動(dòng)態(tài)跟隨性能、明顯提升姿態(tài)解算精度。
張靜,李維剛,張駿虎,聶鵬,張傳莊.基于卡爾曼濾波的四元數姿態(tài)解算算法研究計算機測量與控制[J].,2020,28(12):233-237.
您是本站第 4754718 訪(fǎng)問(wèn)者
通信地址:北京市海淀區阜成路14號航天12院
電話(huà)/傳真:01068372068 68767886 68370689 68371556 E-mail:ck@chinamca.com
版權所有:計算機測量與控制 ® 2025 版權所有
京公網(wǎng)安備 11010802026262號