加速度计补偿:
假設(shè)n系為地理坐標(biāo)系,b系為機體坐標(biāo)系,在地理坐標(biāo)系中,加速度的輸出為:,經(jīng)過矩陣轉(zhuǎn)換后的值為:。在b系中,加速度的測量值為:,現(xiàn)在和都表示在b系中數(shù)值向下的向量,由此,我們對這兩個向量做向量積(叉積),得到誤差:,利用這個誤差來修正矩陣,于是乎,我們的四元數(shù)就在這樣一個過程中被修正了。但是,由于加速度計無法感知Z軸上的旋轉(zhuǎn)運動,所以還需要用地磁計來進一步補償。現(xiàn)在我們假設(shè)旋轉(zhuǎn)矩陣是經(jīng)過加速度計校正后的矩陣,當(dāng)某個確定的向量(b系中)經(jīng)過這個矩陣旋轉(zhuǎn)之后(到n系),這兩個坐標(biāo)系在XOY平面上重合,只是在Z軸旋轉(zhuǎn)上會存在一個偏航角的誤差。下圖表示的是經(jīng)過旋轉(zhuǎn)之后的b系和n系的相對關(guān)系。可以明顯發(fā)現(xiàn)加速度計可以把b系通過四元數(shù)法從任意角度拉到與n系水平的位置上,這時,只剩下一個偏航角誤差。這也是為什么加速度計誤差修正偏航的原因。
總結(jié)
- 上一篇: 正方教务系统——用Postman优雅的选
- 下一篇: 表语从句笔记