弹载光纤陀螺旋转惯组误差自补偿技术
2024-06-02
来源:好走旅游网
第39卷第6期 光电工程 V_0l-39.NO.6 2012年6月 Opto-Electronic Engineering June,2012 文章编号:1003—501X(2012)06—0041—06 弹载光纤陀螺旋转惯组误差自补偿技术 刘洁瑜,杨建业,汪立新,蔚国强 (第二炮兵工程大学自动控制系,西安710025) 摘要:目前弹载惯性测量组合测试标定精度受外界干扰影响较大,特别是光纤陀螺温度稳定性低,易受环境温度 影响参数变化,导致误差补偿效果不好。针对该问题,提出设计一种光纤陀螺旋转惯性测量组合。在惯性测量组 合外加旋转轴,在导弹飞行过程中使惯性测量组合绕旋转轴连续旋转,将射前补偿不完全误差调制为周期项,从 而达到误差自补偿的效果。理论分析和仿真结果表明,通过旋转不仅能自动补偿与转轴垂直方向惯性仪表的常值 误差和部分安装误差,而且能补偿加速度计部分一次项误差、二次项误差和部分交叉轴耦合项误差,选择合适的 旋转方案还可以完全消除旋转速度与陀螺仪标度因数误差、安转误差的耦合误差。 关键词:光纤陀螺;惯组;旋转;自补偿 中图分类号:V241.5;TN253 文献标志码:A doi:10.3969 ̄.issn.1003.501X.2012.06.007 Error Autocompensation of FOG・based Rotating Inertial Measurement Unit for Ballistic Missile LIU Jie-yu,YANG Jian-ye,WANG Li-xin,YU Guo-qiang (Department ofAutomatic Control,the SecondArtillery Engineering University,Xian 710025,China) Abstract:To solve the problems that the prelaunch calibration accuracy of ballistic missile is seriously influenced by external disturbance,especially the temperature stability of Fiber Optic Gyro(FOG)is SO low that hte parameters are changed by temperature influence and the error compensation is not satislying,a rotating inertial measurement unit based on FOG for hte missile is proposed.A rotating axis is added to the strapdown Inertial Measruement Unit(IMU),the IMU rotates around the axis,and the residual error after prelaunch compensation is modulated into periodic terms.Then,error autocompensation is realized.Through theoretical analysis and simulation,not only the constant error and part of misaligamaent errors of inertial instruments orthogonal to rotating axis,but the first-order,second—order and part of cross-coupling error of intersecting axis of Accelerometers can be compensated by rotating,and the coupling error between rotating speed and error of scale factor and misalignment of FOG Can be eliminated completely by selecting appropriate rotating scheme. Key words:FOG;inertial measurement unit;rotating;autocompensation 0 引 言 随着国内光纤陀螺精度的逐步提高,光纤陀螺捷联惯性测量组合在制导武器上的应用越来越广泛。为 了进一步提高系统的制导精度,目前常用的方法有两种,一种是提高光学器件本身的精度,另一种是采用 误差补偿技术 ¨。从我国的情况看,要在短期内进一步提高器件本身的精度较为困难,因此,研究误差补 偿技术显得尤为重要 。在USAF基金项目支持下,美国Honeywell公司提出研制高精度激光陀螺系统 HALS(High Accuracy Laser System),主要用于ICBM(InterContinental Ballistic Missile,洲际弹道导弹)上[4]。 收稿日期:201卜08—01 l收到修改稿日期:2012—02—11 基金项目:中国博士后基金资助项目(20090461470) 作者简介:刘洁瑜(1970一),女(汉族),广东增城人。副教授,博士,主要从事光学惯性器件技术及测试的研究。E-mail:jieyu.1iu@gmail.tom。 http://www gdgc ac。Cll 42 光电工程 2012年6月 HALS原理如图1所示,导弹在飞行过程中,传感器组合始终绕 沿发动机推力方向的轴旋转,转速为60。/s,在一个旋转周期内, 部分误差会得到抵消。另一个轴只是在导弹射前自对准和自标定 时旋转,导弹起飞后不参与旋转。此旋转方案大大补偿了光学捷 联惯性系统的误差。 针对目前国内制导武器惯性测量组合精度现状,文中设计了 一种弹载光纤陀螺旋转惯性测量组合。在组合上沿弹体OZb轴方 图1高精度激光捷联系统 Fig.1 High accuracy laser system 向加入旋转轴,在导弹飞行过程中通过转轴旋转自动补偿各种误 差。本文将对弹载光纤陀螺旋转惯性测量组合的误差自补偿机理 进行系统的研究。 1 旋转光纤惯性测量组合误差传播方程 定义如图2所示坐标系组,其中oxy,z,为发射点惯性坐标系,射向与北向的夹角为 ,ObX z 为 弹体坐标系, 理论上 。 z。为惯性测量组合坐标系,()bz 轴与0Sz 轴重合, Xs z 绕 z。相对()bX z 旋 转0角,转速为CO。导航坐标系选为发射点惯性坐标系。 V =a +g(r ) 实际上 :(1) (2) (J一 ×)(n +8a )+g( ) 式(1)式(2)相减,将引力项展开,忽略高次项后得 6V = + Xa +6a f31 的表达式见文献[10]。将国 转换到 Xs z 系上,即可 得出旋转惯性旋转组合的速度误差传播方程为 = + ×a + 6a (4) NOrth 其中: I COS(C0t)一sin(cot)0 lc =ll sin(oct)cos( )0l 0 0 1J 同理,旋转惯性测量组合的姿态误差传播方程为 = 图2坐标示意图 Fig.2 Sketcfi diagram ofcoordinate 渤 (5) 国 、面 分别为 X rsZ 坐标系上的加速度误差和角速度误差。 2误差自补偿分析 设惯性测量组合惯性元件由三个光纤陀螺和三个石英挠性摆式加速度计组成。 2.1光纤陀螺误差自补偿分析 2.1.1光纤陀螺误差模型 相比传统转子式陀螺仪,光纤陀螺仪输出不受重力加速度影响,其误差模型相对简单。此处不考虑温 度等因数的影响,将误差模型简化为 以= + G + ,(ri= ,Y,z) (6) 其中:如I为陀螺仪的输出误差, 为常值漂移,繇: 为标度因数误差, 且考虑安装误差后,旋转惯性测量组合姿态误差传播方程变为 =为随机漂移。将式(6)代入式(5), c c (s+ )+c;c ([ G]+[ G])∞: http://www gdgc 8c crl (7) 其中: 第39卷第6期 刘洁瑜,等:弹载光纤陀螺旋转惯组误差自补偿技术 43 s= Ez r, =[ ] ,[ G]:diag[o"K 6/ ̄ 6/ ̄G2], 『0 一 [嬲]=1 ] 0 一 l,6/ ̄ f(f= ,Y,z)和 (f=1,2,…,6)分别为陀螺仪的刻度系数误差和安装误差角。 l一 2 Or"3 0 J = (8+ )+ ([oTf。]+[ ]) s b+ ([蠲 ]+[ 】)∞ (8) 当惯性测量组合不旋转时,姿态误差传播方程变为 = ( + )+c t([oTG]+[ G])∞ b (9) 2.1.2转动对常值漂移的抑制 假设导弹主动段飞行时间 为惯性测量组合旋转周期的整数倍,则 甜f=[0 0 GT] (10) 即旋转对挺、ys轴向两个陀螺仪常值误差有抑制作用,对Zs轴向陀螺仪常值误差无抑制作用。 2.1.3转动对标度因数误差及安装误差的抑制 假设 恒定,则惯性测量组合不旋转时 IbTKOxT—a4T ([ 。]+[阳]) d :I 旋转时 l—ot2T ot3T 8K T l(戤 + .)T/2一( 1+ 4)T/2 0 1 ∞ f c ([疆G]+[ G_])cbs mb出=l l ( 1+0:4)T/2 (( +6/ ̄ ) 0 l bm0 0 8K J (12) 值不确定, 由式(11)、(12)可得,旋转对陀螺仪部分安装误差有抑制作用,但导弹在实际飞行中, 所以对安转误差的抑制作用也不确定,但对陀螺仪标度因数误差没有抑制作用。 另外,在旋转过程中,旋转角速度与标度因数误差、安装误差耦合会引入额外误差项 ([ 。]+[硒]) 。,虽然此项误差在一个周期内积分为零,但由于其幅值较大,会引入较大误差。本 文第三节将讨论合适的旋转方案,从而消除此项误差的影响。 2.2摆式加速度计误差自补偿分析 2.2.1摆式加速度计误差模型 摆式加速度计的误差模型为 J 8a K + maIl+K0 a0i+KPia +K10taIia + iKol,iaota哦+KmianaI +KInn2I+K PPin +a ‘、13、) 其中:i= ,Y,z,K 为加速度计零偏; 为标度因数误差; , 为一次项误差; 删, , 肌 为交叉轴耦合系数;K胁为二阶非线性系数; 跗为摆性轴灵敏度二阶非线性系数;a 为随机误差项。 考虑加速度计安转误差后,旋转惯性测量组合的速度误差传播方程变为 =F + ×a + 。+ [翻] (14) 『0 一k'4 ] 其中:8a =[ 6a 8a r,[翻]=ll 0 一 l, ( l,2,…,6)为加速度计安装误差角。 屈 0 j 2.2.2转动对标度因数误差及安装误差的抑制 转动对 、 轴向加速度计零偏抑制的讨论与陀螺仪类似,此处不再赘述。此处讨论转动对加速度计 标度因数误差及安装误差的抑制情况,不旋转时误差项为c ([ ]+[翻]) ,旋转时误差项变为 cbiLb([ac ]+[翻】)c 口。。 。与前边分析类似,旋转对加速度计标度因数误差没抑制作用,但导弹在主动段飞行过程中弹体加速度 http://www gdgc ac cn 44 光电工程 2012年6月 在弹体坐标系上的分量ak、a 符号不变,所以转动对部分加速度计安装误差有抑制作用。 2.2.3转动对加速度计二次项的抑制 l 0 0 l J 0 0 l "4 a =[口k abz] ,[ ]=l 0 ky 0 l,[ 】=1 0 0 l。 l 0 0 J l 0 0 j 不旋转时误差项为 c 】[口 ]口 =c [ 胁 2 ,,,v以 Kmall (15) 旋转时误差项变为 l 2 cos(cot)十Kllx sin(cot)l ][ ] = sin( )+ 2 cos(ca)l (16) I 以 f 由式(15)、式(16)得,旋转对加速度二次项误差有抑制作用。 2.2.4转动对其它误差项的抑制 转动对加速度计交叉轴耦合项的抑制与加速度计在台体上的安 装方式有关,假设加速度计按图3所示配置。 以K 、 肌项为例进行讨论,不旋转时误差项为 t[KHxa ab 一 肌 byak or,旋转时误差项为 I KPlxa 口 y I I Kelxa 口6y sin(cot)+K z cos(c谢)l c Kpl iy0a J 口 I l= 口 cos(o)t)+Kp0 zyaby sin(ox)IJ (17) 图3加速度计配置图 Fig.3 Arrangement plan of accelerometers 可见,转动对 胁、 肌有抑制作用。 同理,在图3所示加速度计配置下,对于 、 轴向加速度计,转动还对 、 、 胁、 脚有 抑制作用;对于Zs轴向加速度计,转动对K 、 P:、K 、K 有抑制作用。 2.2.5加速度计的尺寸效应误差 在旋转惯性测量组合中,加速度计的理想定位应该是转动的中心,但实际上由于加速度计有一定的尺 寸,所以,当惯性测量组合绕旋转轴Zs以 旋转时,墨和 轴向加速度会敏感到一大小为 ,.的离心加速 度, 为加速度计与转轴的距离。其实,这相当于加速度计的常值误差,转动会将该误差调制为周期量, 且09 r较小,所以在一个周期内引起的导航误差可以忽略。 3旋转方案讨论 基于上述分析提出三种旋转方案,分别如下: 方案一,所有惯性仪表均绕Zs轴旋转;方案二,Zs轴向陀螺仪和加速度计相对弹体固定,不参与旋转, 其余仪表均参与旋转;方案三,只有Zs轴向陀螺仪相对弹体固定,不参与旋转,其余仪表均参与旋转。 由第2节分析可知,调制速度会与陀螺仪标度因数误差、安转误差耦合引起一很大误差项 c ([蕊。】+[掰])∞ 。。所以在方案一中,此项误差得不到消除,另外导弹在主动段飞行过程中,若Zs轴 向加速度旋转,则 、 、 、 腑均会得到抑制。同时方案三还可以避免递增的计算误差。所以 在所提三种方案中,方案三比较可取。 4仿真及结果分析 4.1仿真条件 假设导弹主动段飞行时间为i00 S,最大加速度为lOg,选择文中所提第三种旋转方案,旋转速度取为 7.2。/s,分别对以下两种情况进行仿真: http://www。gdgc。ac.cn 第39卷第6期 刘洁瑜,等:弹载光纤陀螺旋转惯组误差自补偿技术 — 、_I口甚岛。一ll∞0 ^呐/IIJJ 呈 扫I。o一 、_ 45 1)三个陀螺仪常值漂移均为0.O1。/h,三个加速度计零偏均为5 ̄10~g,陀螺仪、加速度计安装误差均 为 l 0 —0.00001 0.00002 l A=l 0.00003 0 —0.00002 l l一0.00002 0.00003 0 j 2)三个加速度计二次项误差系数均为10 ̄tg/g (旋转对一次项误差、交叉项误差的抑制机理与二次项误 差类似,由于篇幅所限,此处仅对二次项误差进行仿真)。 4.2结果分析 由图4、图5、图6及图7可以看出,当惯性测量组合旋转时, 和Y向位置误差、速度误差均有削弱, —q\ ohra d[0【1晶0 ^∞/IIIj,J28扫I。0_【 z向速度误差、位置误差基本不变,即旋转对垂直于旋转轴方向的陀螺仪常值漂移、加速度计零偏、加速 度计部分安装误差、加速度计二次项误差均有抑制作用,仿真中Zs轴向陀螺相对弹体固定,故不存在旋转 速度与陀螺仪安转误差耦合引起的误差项。 0 i i i7 8 .4 毒№… Ro ̄ , ting j” i/ 5 :::: 甜 。 ‘r , ,:,. ‘ :肄: 3 “' } } 一 .8 —÷_- N6Rdt ratoitn ̄ ating4 … \ 1 .12 i ;’ . : : :: 0 .1 0 20 40 60 80 100 0 20 40 60 80 100 0 20 40 60 80 lO0 Time/s Ti— 、基)_me/s h 暑 ll∞0 Time/s (a) 向位置误差 (b)y向位置误差 (c)Z向位置误差 (a)Position error ofX (b)Position error of Y (c)Position error ofZ CO0rdinate axis cootdinate axis coordinate axis 图4仪表常值误差、安转误差引起的位置误差 Fig.4 Position error caused by constant errors and misaiignment errors of inertial instruments O O.20 宙 0.15 .0.05 0.15 o,l0 == R龇狮 ; ’ .0.10 0.1O 0.05 -0.15 O.20 0.05 I : 一::: ‘g 0 : —0_25 0 .o.o5 0 20 40 6O 80 100 0 20 40 60 80 100 0 20 40 60 80 100 Time/s Time/s Time/s (a)X向速度误差 (b)y向速度误差 (C)Z向速度误差 (a)Velocity error ofX (b)Velocity errorofY (C)Velociyt errorofZ coordinate xais coordinate xais coordinate xais 图5仪表常值误差 安转误差引起的速度误差 Fig.5 Velociyt error caused by constant errors and misalignment errors ofiaertial instruments ——L—N 、t / 1.0 6 一.;一. -' r- : / 2 i— ~。 。二_ //| 2 辈R…一 o乏 :t ing 0.5 No rotatin ̄ -RO tting 0 —…~l、 .、 .i一… …=… - 。, 0.5 .5 .—6 1.0 0 20 40 60 80 l00 0 20 40 6O 8O 100 0 20 40 60 80 100 Time/s Time/s Time/s (a)X向位置误差 (b)Y向位置误差 (C)Z向位置误差 (a)Position error ofX (b)Position error of Y (c)Position error ofZ coordinate xais coordinate axis coordinate xais 图6加速度计二次项误差引起的位置误差 Fig.6 Position error caused by secon&ofder errors ofaeeclerometers http://www.gdgc.ac.cR 46 光电工程 2012年6月 ———苍0.2 二NoI 0t t ng !1.0 …. ROt£ !ng o。 .毒№熟 粗 . N0 rq) tatinI 5 0.5 §0.1 :/ : 苔 Rota cing i 0.3 兰 甚 0 言0 / l i直 ,f’ 旦 / \; 言 o/I/ ,三 .1 ≥: 一0.5 .0.1 .O.1 : i jr 一1.0 0 20 40 60 8O 100 0 20 40 60 8O 100 0 20 40 60 80 100 Time/s Time/s Time/s (a】 向速度误差 (b)y向速度误差 (c)z向速度误差 (a)Velocity error ofX (b)Velociyt ̄:wroTofY (c)Velociyt errorofZ COOrdinate axis COOrdinate axis CO0rdinate axis 图7加速度计二次项误差引起的速度误差 Fig.7 Velociyt error caused by second-order en_0rs ofaccelerometers 5结论 针对目前制导武器对光纤陀螺捷联惯性组合精度的更高要求,本文设计了一种弹载光纤陀螺旋转惯性 测量组合,当导弹在飞行过程中,通过惯性测量组合的旋转,达到误差自补偿效果。理论分析和仿真结果 表明,旋转对垂直于旋转轴方向的陀螺仪常值漂移,加速度计零偏、部分安转误差、部分一次项误差、二 次项误差和部分交叉轴耦合项误差有抑制作用。选择合适的旋转方案后,旋转还对沿转轴方向加速度计的 部分一次项误差和部分交叉轴耦合项误差有抑制作用,还可以完全消除旋转速度与陀螺仪标度因数误差、 安转误差的耦合误差。 参考文献: [1] 陆元九.惯性器件[M].北京:宇航出版社,1991:卜2. LU Yuan ̄iu.Inertial Sensors[M】.Beijing:Astronautic Publishing House,1991:卜2. [2] 李家垒,何婧,许化龙.光纤陀螺的温度试验与误差补偿.[J].光电工程,2009,36(12):132—137. LI Jia—lei,HE Jing,XU Hua-long.Temperature Test and Error Compensation ofFOG[J].Opto-Electronic Engineering, 2009,36(12):132—137. 【3] 毛耀,马佳光,包启亮.光纤陀螺时滞环节的实时补偿技术[J].光电工程,2009,36(2):105—109. MAO Yao,MA Jia-guang,BAO Qi—liang.Real—time Compensation Technolgy of Time Delay Unit of Fiber Optic Gyro[J]. Opto—Electronic Engineering,2009,36(2):105—109. [4]Levinson Dr E,San Giovanni Jr.Laser Gyro Potential for Long Endurnace Marine Navigation[c]//IEEE Posiiton Location and Navigation Symposium,Piscataway,N J,1980:115—129. [5] SUN Feng,CAO Tong,XU Bo,et a1.Initial Alignment ofr Strapdown Inertial Navigation System Based on Inertial Frame[c]// 2009 IEEE International Conference on Meehatronics andAutomation,Aug 9-12,2009:3751—3756. [6】Yang Y,Miao L J.Fiber-Optic S ̄apdown Inertial System with Sensing Cluster Continuous Rotation[J].IEEE Transacitons onAerospace and Electronic Systems,2004,40(4):1173.1178. [7]ZHAO Lin,WANG Xin-zhe,HUANG Chen,et a1.The Research on Rotation Self-Compensation Scheme ofStrapdown Inertial System【c]//2009 IEEE International Conference on Mechatronics and Automation,Aug 9-12,2009:4760—4764. [8] 索玉龙,纪志农,王玉辉.捷联惯测组合旋转机构的研究[J】.战术导弹控制技术,2006,52(1):45—51. SUO Yu—long,JI Zhi—nong,WANG Yu—hui.Research on the Revolving Apparatus of Strapdown Inertial Measurement[J]. Control Technology ofTactical Missile,2006,52(1):45—51. 【9】 袁保伦.四频激光陀螺旋转式惯导系统研究【D】.长沙:国防科学技术大学,2007. YUAN Bao—lun.Research on Rotating Inertial Navigation System with Four-rfequency Diferential Laser Gyroscope[D】. Changsha:National University ofDefense Technology,2007. [10]秦永元.惯性导航[M】.北京:科学出版社,2007:355—361. http://www gdgc,ac cn