譚強(qiáng)俊,程永生,唐 彬,劉顯學(xué),周 浩,李寅鑫
(中國工程物理研究院 電子工程研究所,四川 綿陽 621000)
由于加速度計的安裝位置很難與載體搖擺參考點(diǎn)相重合,在角運(yùn)動環(huán)境下加速度計輸出會產(chǎn)生相對參考點(diǎn)的干擾加速度,即桿臂效應(yīng)[1-2].航姿參考系統(tǒng)(Attitude and Heading Reference System,AHRS)中加速度計測量重力加速度在載體系各坐標(biāo)軸上的投影分量從而獲取水平姿態(tài)角,同時修正陀螺漂移[3-5].在靜態(tài)條件下可獲得較高的姿態(tài)測量精度.但在動態(tài)環(huán)境,疊加在加速度計敏感軸上的干擾加速度會對加速度計測姿精度造成極大影響.
本文基于AHRS系統(tǒng),通過對桿臂效應(yīng)的誤差機(jī)理以及現(xiàn)有濾波、補(bǔ)償方法的不足進(jìn)行分析,提出了一種改進(jìn)的桿臂效應(yīng)補(bǔ)償方法,與現(xiàn)有方法相對比,顯著提高了桿臂效應(yīng)誤差補(bǔ)償精度.
定義慣性坐標(biāo)系(i系)為oixiyizi,載體坐標(biāo)系(b系)為obxbybzb,加速度計安裝在載體P處,ob點(diǎn)為載體的參考點(diǎn),R為P點(diǎn)在慣性系中的位置矢量,R1為載體參考點(diǎn)ob在慣性系中的位置矢量,r為從載體參考點(diǎn)到P點(diǎn)的位置矢量,即為桿臂.位置示意圖如圖1所示.
在角運(yùn)動環(huán)境下,由于載體參考點(diǎn)ob與加速度計安裝點(diǎn)P不重合,在加速度計的輸出中就含有相對參考點(diǎn)的桿臂效應(yīng)誤差,如式(1)所示
(1)
桿臂效應(yīng)引起的干擾加速度表示為
(2)
其中第1項定義為桿臂效應(yīng)的向心加速度項,第2項定義為桿臂效應(yīng)的切向加速度項.
圖1 坐標(biāo)系間矢量關(guān)系
桿臂效應(yīng)對加速度計測姿的影響航姿參考系統(tǒng)中加速度計通過測量重力加速度在載體系各坐標(biāo)軸上的投影分量來獲取水平姿態(tài)角,以y軸為例
(3)
由式(2)、(3)可以得到,桿臂效應(yīng)造成的橫滾角誤差Δγ為
(4)
在橫滾角γ=0°時,由Δf1,Δf2分別造成的橫滾角誤差Δγ1,Δγ2如圖2所示.
圖2中,Δγ1為向心加速度造成的姿態(tài)誤差;Δγ2為切向加速度造成的姿態(tài)誤差.由圖2可見隨著角速度、角加速度以及桿臂長度的增加,桿臂效應(yīng)相應(yīng)增大,加速度計測姿誤差也越大,只有通過對加速度計桿臂效應(yīng)進(jìn)行有效的補(bǔ)償,才能保證AHRS系統(tǒng)測姿精度.
圖2 桿臂效應(yīng)造成的測姿誤差
目前處理桿臂效應(yīng)的解析方法主要為低通濾波法和力學(xué)補(bǔ)償法.在實(shí)際工程中二者應(yīng)用廣泛,但也存在其自身的不足.
從現(xiàn)有文獻(xiàn)看,采用低通濾波法主要應(yīng)用在初始對準(zhǔn)場景中.此時載體一般沒有大的角機(jī)動,只有微幅晃動(振動).該環(huán)境下的干擾頻率遠(yuǎn)高于舒拉頻率以及地球自轉(zhuǎn)頻率,可視為高頻干擾[6].但是低通濾波無法濾除振動產(chǎn)生的直流分量.
設(shè)在振動環(huán)境下,載體沿俯仰軸、橫滾軸有頻率相同,相位差為90°的角振動,即
(5)
式中:Ω為振動的角頻率,θ為俯仰角,θm為俯仰角的振動幅值,γ為橫滾角,γm為橫滾角的振動幅值,ψ為方位角.
由歐拉角微分方程,振動環(huán)境下的角速度為
(6)
在微幅振動環(huán)境下,可以把θ,γ當(dāng)作小角度處理,即
(7)
(8)
由式(8)可見,振動環(huán)境下向心加速度項存在直流分量,依靠低通濾波無法將直流分量濾除.
對式(6)求角加速度,可得
在振動環(huán)境下角加速度仍為振蕩形式,通過低通濾波可濾除切向加速度.但在機(jī)動環(huán)境下,若角加速度也包含有直流項時,低通濾波無法濾除角加速度直流項.
(9)
(10)
var(a)=2Qω/ΔT2.
(11)
利用低通濾波法,桿臂效應(yīng)中的向心加速度項會殘存整流誤差項;再者當(dāng)角加速度也含有直流分量時,桿臂效應(yīng)中的切向加速度項也會出現(xiàn)低通濾波無法濾除的整流誤差.采用力學(xué)補(bǔ)償法,向心加速度項的求解誤差會受到陀螺測量誤差的影響;而通過角速度微分獲取角加速度,會引起切向加速度項誤差激劇放大.考慮到多加速度計可以直接解析地求解角加速度[17-18],可避免角速度微分計算造成的誤差放大.因此綜合考慮低通濾波法、力學(xué)補(bǔ)償法以及多加速度計解析求解法,提出一種改進(jìn)的桿臂效應(yīng)補(bǔ)償方法見圖3.對于桿臂效應(yīng)中的向心加速度,在低于給定角頻率閾值工況下采用低通濾波法,在高于給定角頻率閾值工況下采用力學(xué)補(bǔ)償+低通濾波法.對桿臂效應(yīng)中的切向加速度項,通過多加速度計解析求解角加速度.
圖3 改進(jìn)的桿臂效應(yīng)補(bǔ)償方法
(12)
則根據(jù)式(12),經(jīng)過小波去噪后,可認(rèn)為
(13)
(14)
將式(7)代入式(14),即
(15)
(16)
將式(7)代入式(16),即
(17)
(18)
將式(7)代入式(18),即
(19)
設(shè)角頻率閾值Ω0為
Ω0=8|b|/(3γmθm),
(20)
當(dāng)Ω≥Ω0時,有
(21)
而在Ω<Ω0時,有
(22)
由式(21)、(22)可見,當(dāng)角頻率Ω大于角頻率閾值Ω0時,采用力學(xué)補(bǔ)償+低通濾波法造成的殘存整流誤差小于直接采用低通濾波造成的整流誤差;而在角頻率Ω小于角頻率閾值Ω0時,直接采用低通濾波造成的整流誤差小于采用力學(xué)補(bǔ)償+低通濾波法造成的殘存整流誤差.
因微分法求解角加速度會放大誤差,而低通濾波無法濾除直流分量,因此提出兩種利用多加速度計解析求解角加速度的改進(jìn)方法.
3.2.1 6加速度計構(gòu)型1
設(shè)置6加速度計構(gòu)型,如圖4所示.6個加速度計安裝在立方體6個面的中心,其敏感軸沿著每個面的對角線.令θb表示加速度計在載體系中敏感方向矢量,在6加速度計構(gòu)型其中心位于P點(diǎn),立方體的邊長為2l時,由式(1)可得單個加速度計的輸出表達(dá)式為
(23)
圖4 六加速度計構(gòu)型1
該構(gòu)型方案的安裝參數(shù)矩陣
將安裝參數(shù)矩陣代入式(23),可得角加速度
(24)
(25)
3.2.2 6加速度計構(gòu)型2
構(gòu)型1中加速度計的布局相對6個基準(zhǔn)面為傾斜安裝.文獻(xiàn)[20]指出斜置IMU,存在大安裝誤差角,安裝誤差角二次項的影響不能忽略.文獻(xiàn)[21]指出斜裝形式下的標(biāo)定需要:1)設(shè)計傾斜的標(biāo)定工裝;2)設(shè)計專門的斜裝標(biāo)定算法.由此可見構(gòu)型1中加速度計的布局對實(shí)際安裝以及標(biāo)定都帶來一定的困難.文獻(xiàn)[22]指出正交雙加速度計可消除安裝誤差角影響.文獻(xiàn)[23]中給出了一種便于安裝的6加速度計構(gòu)型,但該方案將多個加速度計安裝在同一點(diǎn),若采用體積較大的石英撓性加速度計,會產(chǎn)生較大的安裝誤差.為此設(shè)計了另一種構(gòu)型:6加速度計構(gòu)型2,如圖5所示.將各加速度計的安裝位置移至各基準(zhǔn)面的中心,避免了將多個加速度計安裝在同一點(diǎn)造成的安裝誤差.各加速度計距離質(zhì)心的距離均為l.同時構(gòu)型2不存在大安裝誤差角問題.
圖5 6加速度計構(gòu)型2
該構(gòu)型方案的安裝參數(shù)矩陣
代入式(23),可得角加速度為
(26)
(27)
相比構(gòu)型1,構(gòu)型2在振動環(huán)境下會有整流殘差,且隨著角頻率、振幅的增加,其殘留整流誤差也隨之增大.對比式(24)及式(26),在角加速度項含有直流分量的情況下,構(gòu)型1能很好地補(bǔ)償切向加速度,而構(gòu)型2求解角加速度的誤差項中含有角速度信息,也即是構(gòu)型2求解角加速度的誤差會隨著角速度的增大而增大.
由圖6可見,對于向心加速度的補(bǔ)償,在角頻率大于角頻率閾值時,改進(jìn)算法的殘存整流誤差小于低通濾波法殘存整流誤差.隨著振幅增大,角頻率閾值迅速減小,也即是在大振幅工況下,改進(jìn)算法遠(yuǎn)勝于低通濾波法.
圖6 改進(jìn)算法與低通濾波算法的比較
Fig.6 Comparison between improved algorithm and low-pass filtering algorithm
在實(shí)際工程上應(yīng)用的MEMS加速度計其精度已達(dá)到1×10-4g[19].因此在仿真中設(shè)定加速度計常值漂移服從Gauss分布,均方差為10-4g.
4.2.1 非振動低動態(tài)環(huán)境
4.2.2 非振動高動態(tài)環(huán)境
從圖7可見,構(gòu)型1解析求解的切向加速度比直接微分法的精度提高了1個數(shù)量級.構(gòu)型2的求解誤差隨著角速度的增大而增大,但在低動態(tài)環(huán)境下構(gòu)型2的求解誤差是可以接受的.在仿真650 s時,構(gòu)型2的求解誤差達(dá)到-0.042(m/s2),與直接微分法的求解誤差相仿,而此時角速度達(dá)到325(°/s).也即是除了高動態(tài)環(huán)境下,一般的工程應(yīng)用也可采用構(gòu)型2.
4.2.3 振動環(huán)境
設(shè)定振動頻率范圍為0~20 Hz,俯仰角的振幅θm與橫滾角的振幅γm設(shè)為10°,仿真時間為40 s,兩種加速度計構(gòu)型在振動環(huán)境下的求解桿臂效應(yīng)的切向加速度項誤差如圖9所示(以x軸角加速度為例)
從圖9可看到,振動頻率對構(gòu)型1影響較小,而構(gòu)型2的切向加速度誤差隨著振動頻率增加而增大.
圖7 非振動環(huán)境下切向加速度誤差對比
Fig.7 Comparison of tangential acceleration errors in non-vibrating environment
圖8 振動環(huán)境下切向加速度誤差對比
Fig.8 Comparison of tangential acceleration errors in vibrating environment
結(jié)合圖7、圖8可看到,無論是振動環(huán)境或非振動環(huán)境,低動態(tài)或高動態(tài),構(gòu)型1的性能總是優(yōu)于構(gòu)型2.但是構(gòu)型1的安裝方式為斜置安裝,需要設(shè)計專用的標(biāo)定工裝以及斜裝標(biāo)定算法,給工程實(shí)現(xiàn)帶來一定的難度.構(gòu)型2為正交安裝,可以利用重力加速度的幅值平方g2作為參考基準(zhǔn),在標(biāo)定過程中不受安裝誤差角的影響.同時無須設(shè)計專用標(biāo)定工裝,給工程實(shí)現(xiàn)帶來一定便利.
實(shí)際工程中,慣性器件經(jīng)過一定時間的使用其自身性能參數(shù)會隨時間的推移與應(yīng)用環(huán)境的變化而發(fā)生改變,同時在使用過程中由于摩擦、振動等因素的影響,慣性器件的安裝位置、安裝誤差角也可能發(fā)生變化,需重新標(biāo)定才能滿足使用要求.因此對現(xiàn)場無精密標(biāo)定設(shè)備、且工況為低振動、低動態(tài)環(huán)境,優(yōu)先采用構(gòu)型2.而高振動、高動態(tài)環(huán)境優(yōu)先采用構(gòu)型1.
4.2.4 內(nèi)桿臂對多加速度計測姿的影響
由式(24)、式(26)可看到,多加速度計的內(nèi)桿臂長度越長,多加速度計測姿精度越高.以非振動低動態(tài)環(huán)境下測姿為例,內(nèi)桿臂l長度范圍為1 cm~4 cm,構(gòu)型1和構(gòu)型2的切向加速度誤差如圖9所示.
圖9 內(nèi)桿臂長度對加速度計測姿的影響
Fig.9 Influence of inner lever arm on accelerometer attitude measurement
從圖9可以看到構(gòu)型1和構(gòu)型2內(nèi)桿臂l越大,求解的角加速度誤差越小.但是在實(shí)際工程中,儀器安裝的空間總是有限的,為提高求解精度在有限的安裝空間里應(yīng)盡可能增大內(nèi)桿臂長度.
本文研究了桿臂效應(yīng)誤差對加速度計測姿精度的影響,針對低通濾波法與力學(xué)補(bǔ)償法各自的不足,提出了一種改進(jìn)的桿臂效應(yīng)誤差補(bǔ)償方案.1)對向心加速度項,以振動角頻率為判別標(biāo)準(zhǔn),在低于給定角頻率閾值時采用低通濾波法,在高于給定角頻率閾值時采用力學(xué)補(bǔ)償+低通濾波法.與傳統(tǒng)的低通濾波法對比,改進(jìn)算法顯著提高了向心加速度項的補(bǔ)償精度.2)對切向加速度項,設(shè)計了兩種多加速度計構(gòu)型方式,通過多加速度計解析求解角加速度,避免了角速度直接微分造成的誤差放大.3)對加速度計構(gòu)型1和構(gòu)型2在三種工況環(huán)境下的求解精度進(jìn)行了分析,同時根據(jù)構(gòu)型1、構(gòu)型2標(biāo)定參數(shù)的難易,確定了構(gòu)型1和構(gòu)型2的適用范圍.