一種基于陀螺數(shù)據(jù)的帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)渦動(dòng)補(bǔ)償方法技術(shù)方案

本發(fā)明專利技術(shù)公開(kāi)了一種基于陀螺數(shù)據(jù)的帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)渦動(dòng)補(bǔ)償方法，步驟如下：采集水平陀螺的原始輸出，扣除交叉敏感項(xiàng)、地球自轉(zhuǎn)分量及陀螺常值漂移，得到的剩余量即為渦動(dòng)引起的陀螺敏感量；對(duì)陀螺數(shù)據(jù)剩余量進(jìn)行積分，并對(duì)積分后的數(shù)據(jù)進(jìn)行擬合；建立渦動(dòng)參數(shù)與渦動(dòng)引起的陀螺敏感量之間微分方程，并根據(jù)上一步得到的陀螺數(shù)據(jù)剩余量的擬合值，解算出渦動(dòng)參數(shù)；用得到的渦動(dòng)參數(shù)對(duì)載體姿態(tài)更新算法進(jìn)行補(bǔ)償。該方法能有效地對(duì)帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)中慣性測(cè)量單元的渦動(dòng)進(jìn)行準(zhǔn)確建模，大幅提高載體姿態(tài)輸出精度，具有重要意義。

【技術(shù)實(shí)現(xiàn)步驟摘要】

本專利技術(shù)涉及一種慣性
中帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)渦動(dòng)補(bǔ)償方法，適用于帶旋轉(zhuǎn)機(jī)構(gòu)的慣性導(dǎo)航系統(tǒng)，具體涉及一種基于陀螺數(shù)據(jù)的帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)渦動(dòng)補(bǔ)償方法。
技術(shù)介紹
旋轉(zhuǎn)調(diào)制技術(shù)是一種有效抑制器件常值漂移對(duì)導(dǎo)航精度的影響方法。以連續(xù)旋轉(zhuǎn)型旋轉(zhuǎn)調(diào)制慣性導(dǎo)航系統(tǒng)為例，它可以將與旋轉(zhuǎn)軸垂直方向的兩個(gè)陀螺的常值漂移在載體系下的投影調(diào)制成均值為零的正余弦變化量，從而大幅減小導(dǎo)航誤差的發(fā)散，提高導(dǎo)航精度。旋轉(zhuǎn)調(diào)制技術(shù)被廣泛用于新一代慣性導(dǎo)航系統(tǒng)中，主要包括旋轉(zhuǎn)調(diào)制慣導(dǎo)系統(tǒng)和混合式慣導(dǎo)系統(tǒng)，本專利技術(shù)中，統(tǒng)稱為帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)。在本專利技術(shù)涉及的帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)中，主要用到了三個(gè)坐標(biāo)系，下面給出其定義：慣性測(cè)量單元系(s系)：正交坐標(biāo)系，zs指向電機(jī)軸向，xs指向x陀螺敏感方向，ys與xs、zs構(gòu)成右手正交系。載體系(b系)：正交坐標(biāo)系，xb、yb、zb分別指向載體“右前上”方向。導(dǎo)航坐標(biāo)系(n系)：當(dāng)?shù)貣|北天坐標(biāo)系。其中，s系與b系關(guān)系如公式(5)。Cbs=cos(ψ)sin(ψ)0-sin(ψ)cos(ψ)0001---(5)]]>其中ψ為測(cè)角結(jié)構(gòu)得到的框架角度，當(dāng)ψ＝0時(shí)，s系與b系重合。慣性測(cè)量單元通過(guò)導(dǎo)航解算可以得到其自身相對(duì)于地理系的姿態(tài)再配合由測(cè)角機(jī)構(gòu)得到的s系相對(duì)于b系的姿態(tài)即可得到載體姿態(tài)具體公式如(6)。Cbn=Csn·Cbs---(6)]]>在實(shí)際系統(tǒng)中，由于安裝間隙等原因，IMU除了繞框架正反旋轉(zhuǎn)以外，還會(huì)存在繞其他方向的軸系渦動(dòng)，這導(dǎo)致不能完全反映s系相對(duì)于b系的姿態(tài)，從而導(dǎo)致載體姿態(tài)存在旋轉(zhuǎn)周期的震蕩，極大地影響載體姿態(tài)輸出精度。同一慣導(dǎo)系統(tǒng)，在旋轉(zhuǎn)調(diào)制模式下和捷聯(lián)模式下載體姿態(tài)輸出對(duì)比如附圖2所示。
技術(shù)實(shí)現(xiàn)思路
本專利技術(shù)提出一種基于陀螺數(shù)據(jù)的帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)渦動(dòng)補(bǔ)償方法，有效補(bǔ)償帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)中存在的IMU渦動(dòng)，大幅提高了載體姿態(tài)輸出精度。將水平陀螺數(shù)據(jù)扣除已知的交叉敏感項(xiàng)、地球自轉(zhuǎn)分量及常值漂移，剩下的即為渦動(dòng)帶來(lái)的陀螺敏感項(xiàng)；對(duì)剩余量進(jìn)行建模分析，并建立渦動(dòng)參數(shù)與其帶來(lái)的陀螺敏感量之間的關(guān)系，得到渦動(dòng)參數(shù)，據(jù)此對(duì)載體姿態(tài)輸出進(jìn)行補(bǔ)償。本專利技術(shù)的技術(shù)解決方案：一種基于陀螺數(shù)據(jù)的帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)渦動(dòng)補(bǔ)償方法，步驟如下：步驟(1)、采集水平陀螺原始數(shù)據(jù)，并扣除交叉敏感項(xiàng)、地球自轉(zhuǎn)分量及陀螺常值漂移，得到因渦動(dòng)帶來(lái)的陀螺敏感量；步驟(2)、對(duì)步驟(1)得到的量進(jìn)行積分，并對(duì)積分量進(jìn)行擬合；步驟(3)、建立渦動(dòng)與渦動(dòng)引起的陀螺敏感量之間的微分方程，解微分方程，得到渦動(dòng)參數(shù)；步驟(4)、利用渦動(dòng)參數(shù)對(duì)載體姿態(tài)更新算法進(jìn)行補(bǔ)償。進(jìn)一步的，步驟(2)中所述對(duì)積分量所進(jìn)行的傅里葉擬合采用二階模型。具體模型如下：∫ωx‾=Ax0+Ax1cosωt+Bx1sinωt+Ax2cos2ωt+Bx2sin2ωt∫ωy‾=Ay0+Ay1cosωt+By1sinωt+Ay2cos2ωt+By2sin2ωt---(7)]]>其中和為步驟(1)得到的因渦動(dòng)引起的陀螺敏感量，ω為旋轉(zhuǎn)調(diào)制的角速度，t為時(shí)間。進(jìn)一步的，步驟(3)中所述建立的渦動(dòng)與渦動(dòng)引起的陀螺敏感量之間的微分方程如公式(8)。ωx‾=θ·y-ω·θxωy‾=θ·x+ω·θy---(8)]]>其中θx為繞ys軸方向的渦動(dòng)角度，θy為繞xs軸方向的渦動(dòng)角度，分別為其微分量。進(jìn)一步的，步驟(3)中所述解微分方程，采用的是系數(shù)匹配的方法。即假設(shè)渦動(dòng)的描述式如下：θx=x1cosωt+x2sinωt+x3cos2ωt+x4sin2ωtθy=y1cosωt+y2sinωt+y3cos2ωt+y4sin2ωt---(9)]]>根據(jù)渦動(dòng)與陀螺敏感量之間的關(guān)系，得到如下公式：-Ax1ωsinωt+Bx1ωcosωt-2Ax2ωsin2ωt+2Bx2ωcos2ωt=-y1ωsinωt+y2ωcosωt-2y3ωsin2ωt+2y4ωcos2ωt-ω(x1cosωt+x2sinωt+x3cos2ωt+x4sin2ωt)-Ay1ωsinωt+By1ωcosωt-2Ay2ωsin2ωt+2By2ωcos2ωt=-x1ωsinωt+x2ωcosωt-2x3ωsin2ωt+2x4ωcos2ωt+ω(y1cosωt+y2sinωt+y3cos2ωt+y4sin2ωt)---(10)]]>根據(jù)各項(xiàng)分量的系數(shù)相等，可解出渦動(dòng)參數(shù)。本專利技術(shù)與現(xiàn)有技術(shù)相比的優(yōu)點(diǎn)在于：(1)、本專利技術(shù)從陀螺原始數(shù)據(jù)入手，能夠?qū)u動(dòng)進(jìn)行準(zhǔn)確建模，擬合殘差小；(2)、本專利技術(shù)的渦動(dòng)補(bǔ)償方法，僅僅對(duì)載體姿態(tài)輸出進(jìn)行修正，不會(huì)帶來(lái)其他的導(dǎo)航誤差；(3)、本專利技術(shù)的對(duì)渦動(dòng)的分析，揭示了渦動(dòng)的具體運(yùn)動(dòng)形式；(4)、本專利技術(shù)的對(duì)載體姿態(tài)輸出精度的補(bǔ)償算法，可滿足系統(tǒng)在線實(shí)時(shí)性需求，提高在線導(dǎo)航載體姿態(tài)輸出精度。附圖說(shuō)明圖1為本專利技術(shù)實(shí)現(xiàn)流程圖；圖2為系統(tǒng)工作在捷聯(lián)模式和旋轉(zhuǎn)模式時(shí)的載體水平姿態(tài)輸出對(duì)比；圖3為x陀螺敏感量積分?jǐn)M合曲線和殘差；圖4為y陀螺敏感量積分?jǐn)M合曲線和殘差；圖5為補(bǔ)償前后載體水平姿態(tài)輸出對(duì)比。具體實(shí)施方式下面結(jié)合具體的實(shí)施例，詳細(xì)介紹本專利技術(shù)方法。如圖1所示，本專利技術(shù)提出一種基于陀螺數(shù)據(jù)的帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)渦動(dòng)補(bǔ)償方法，步驟如下：(1)、采集水平陀螺原始數(shù)據(jù)，并按公式(11)扣除交叉敏感項(xiàng)、地球自轉(zhuǎn)分量及陀螺常值漂移，得到因渦動(dòng)帶來(lái)的陀螺敏感量；其中，ωx、ωy、ωz為陀螺原始輸出，ωie為地球自轉(zhuǎn)角速度，L為緯度，為測(cè)角機(jī)構(gòu)輸出，εx、εy分別為x、y陀螺常值漂移，為陀螺安裝誤差角。(2)、對(duì)步驟(1)得到的量進(jìn)行積分，并對(duì)積分量進(jìn)行傅里葉擬合，擬合模型如公式(12)所示：∫ωx‾=Ax0+Ax1cosωt+Bx1sinωt+Ax2cos2ωt+Bx2sin2ωt∫ωy‾=Ay0+Ay1cos&omega本文檔來(lái)自技高網(wǎng)...

【技術(shù)保護(hù)點(diǎn)】
一種基于陀螺數(shù)據(jù)的帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)渦動(dòng)補(bǔ)償方法，其特征在于：包括如下步驟：步驟(1)、采集水平陀螺原始數(shù)據(jù)，并扣除交叉敏感項(xiàng)、地球自轉(zhuǎn)分量及陀螺常值漂移，得到因渦動(dòng)帶來(lái)的陀螺敏感量；步驟(2)、對(duì)步驟(1)得到的量進(jìn)行積分，而后進(jìn)行擬合；步驟(3)、建立渦動(dòng)與渦動(dòng)引起的陀螺敏感量之間的微分方程，解微分方程，得到渦動(dòng)參數(shù)；步驟(4)、利用渦動(dòng)參數(shù)對(duì)載體姿態(tài)輸出進(jìn)行補(bǔ)償。

【技術(shù)特征摘要】
1.一種基于陀螺數(shù)據(jù)的帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)渦動(dòng)補(bǔ)償方法，其特征在于：包括如下步驟：步驟(1)、采集水平陀螺原始數(shù)據(jù)，并扣除交叉敏感項(xiàng)、地球自轉(zhuǎn)分量及陀螺常值漂移，得到因渦動(dòng)帶來(lái)的陀螺敏感量；步驟(2)、對(duì)步驟(1)得到的量進(jìn)行積分，而后進(jìn)行擬合；步驟(3)、建立渦動(dòng)與渦動(dòng)引起的陀螺敏感量之間的微分方程，解微分方程，得到渦動(dòng)參數(shù)；步驟(4)、利用渦動(dòng)參數(shù)對(duì)載體姿態(tài)輸出進(jìn)行補(bǔ)償。2.根據(jù)權(quán)利要求書(shū)1所述的基于陀螺數(shù)據(jù)的帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)渦動(dòng)補(bǔ)償方法，其特征在于：步驟(2)中所述對(duì)積分量所進(jìn)行的傅里葉擬合采用二階模型，具體模型如下：∫ωx‾=Ax0+Ax1cosωt+Bx1sinωt+Ax2cos2ωt+Bx2sin2ωt∫ωy‾=Ay0+Ay1cosωt+By1sinωt+Ay2cos2ωt+By2sin2ωt---(1)]]>其中和為步驟(1)得到的因渦動(dòng)引起的陀螺敏感量，ω為旋轉(zhuǎn)調(diào)制的角速度，t為時(shí)間。3.根據(jù)權(quán)利要求書(shū)1所述的基于陀螺數(shù)據(jù)的帶旋轉(zhuǎn)機(jī)構(gòu)的慣導(dǎo)系統(tǒng)渦動(dòng)補(bǔ)償方法，其特征在于：步驟(3)中所述建立的渦動(dòng)與渦動(dòng)引起的陀螺敏感量之間的微分方程如下：ωx‾=θ·y-ω·θxωy‾=θ·x+ω·θy---(2)]]>其中θx為繞慣性測(cè)量坐標(biāo)系y軸方向的渦動(dòng)角度，θy為繞慣性測(cè)量坐標(biāo)系x軸方向的渦動(dòng)角度，分別為其微分量。4....

【專利技術(shù)屬性】
技術(shù)研發(fā)人員：王蕾，隋杰，王瑋，宋天驍，
申請(qǐng)(專利權(quán))人：北京航空航天大學(xué)，
類型：發(fā)明
國(guó)別省市：北京;11