一種改進(jìn)的旋轉(zhuǎn)矢量姿態(tài)更新算法*

耿騰飛 劉 明

（云南民族大學(xué) 昆明 650031）

1 引言

自1971年Bortz提出旋轉(zhuǎn)矢量微分方程后[1]，有大量學(xué)者對圓錐誤差補(bǔ)償算法進(jìn)行了一系列的研究[2～7]，有效地提高了姿態(tài)解算的精度，然而上述算法表達(dá)式都是基于陀螺的角增量信息，近年來新型陀螺儀輸出大多為角速率形式，將原有算法直接應(yīng)用到角速率陀螺算法誤差會變大。針對上述現(xiàn)象，文獻(xiàn)[8～9]對硬件增強(qiáng)角速率輸入圓錐算法做了深入研究，詳細(xì)推導(dǎo)了基于角速率輸入的圓錐算法誤差補(bǔ)償系數(shù)的通式。文獻(xiàn)[10]對周期項(xiàng)的誤差補(bǔ)償進(jìn)行再次優(yōu)化，提出一種改進(jìn)的姿態(tài)算法。文獻(xiàn)[11]提出了一種同時(shí)把角速率和角增量信號作為輸入的圓錐誤差算法，提高了算法精度，此外還有許多文獻(xiàn)研究角速率輸入的圓錐誤差算法[12～13]。文中詳細(xì)推導(dǎo)了角速率輸入的圓錐誤差補(bǔ)償系數(shù)的表示方式，在此基礎(chǔ)上利用陀螺前周期角增量信息得到了改進(jìn)的求解圓錐誤差補(bǔ)償系數(shù)的算法，具有一定工程應(yīng)用價(jià)值。

2 圓錐誤差算法優(yōu)化準(zhǔn)則

3 角速率圓錐誤差補(bǔ)償算法

4 改進(jìn)圓錐補(bǔ)償算法

5 應(yīng)用

下面給出1～4子樣圓錐誤差系數(shù)，結(jié)果見表1。

表1 1～4子樣圓錐誤差系數(shù)

通過比較式（28）和式（32）可以看出同子樣數(shù)的改進(jìn)算法精度高于常規(guī)算法，更加實(shí)用。

以N=2時(shí)的算法為例，分別對傳統(tǒng)算法和改進(jìn)算法進(jìn)行模擬仿真，取a=1°，h=0.02s，算法誤差與圓錐頻率之間的關(guān)系如圖1所示。

圖1 算法誤差與圓錐運(yùn)動頻率的關(guān)系

由上圖可以看出，兩類算法誤差都隨著圓錐運(yùn)動的頻率增大而增大，但是在頻率相同的情況下，改進(jìn)算法的算法誤差與傳統(tǒng)算法相比有明顯的降低。……