基于ARM與低成本MEMS器件的AHRS設(shè)計
加入技術(shù)交流群
4．2 硬磁及非正交度校正
地磁場正常情況下測量到的三維數(shù)據(jù)在空間上的包絡(luò)應(yīng)該是一個標(biāo)準(zhǔn)的圓球。但是磁場汁測量出來的數(shù)據(jù)由于受到外界磁場的影響，加上磁阻傳感器各軸的標(biāo)度因子和非正交度，導(dǎo)致傳感器采集到的數(shù)據(jù)在三維空間內(nèi)分布的包絡(luò)面為球心偏移原點的橢球面，磁場裸數(shù)據(jù)三維分布如圖4所示。本文引用地址：http://m.butianyuan.cn/article/148911.htm
橢球面約束方程如式(15)所示。
(m-c)T×(mT×U)(m-c)=1 (15)
其中m為傳感器測得的三維磁場強度，c為球心偏移的三維向量，U為標(biāo)度岡子及非正交度校矩陣。磁場強度沒有實際意義，關(guān)心的是傳感器測量的地磁三維矢量方向，所以設(shè)磁場向量模為1。通過最小二乘法可以計算出U和c。磁場數(shù)據(jù)校正前后對比如圖5所示，左右兩圖為校正前后數(shù)據(jù)在XY平面上的投影。
5 實驗結(jié)果
AHRS放置在與1024線光柵編碼器固連的轉(zhuǎn)動平臺上，測試俯仰姿態(tài)角的測量精度及跟蹤性能，AHRS與編碼器測量曲線對比如圖6所示。
圖中實線為AHRS的測量值，點劃線為編碼器的測量值。當(dāng)測試平臺以幅度約±10°的幅度擺動時。AHRS與編碼器測量數(shù)據(jù)相比在時間上滯后最大不超過5 ms，峰峰值相差不超過0．3°。
結(jié)語
基于四元數(shù)擴展卡爾曼濾波算法的AHRS具有更新速率高、實時性好、價格低廉的特點，能夠廣泛應(yīng)用于手機、平板電腦等消費類電子產(chǎn)品，也能滿足一些機器人對姿態(tài)控制的測量需求。
評論