第32卷第7期 系统工程与电子技术 Systems Engineering and Electronics Vo1.32 No.7 2O1O年7月 文章编号:1001—506X(2010)07 1493—04 July 2010 小角度晃动干扰下解析粗对准的误差分析 周 琪,秦永元,赵长山 (西北工业大学自动化学院,陕西西安710129) 摘 要:研究了小角度晃动干扰对捷联惯性导航系统解析粗对准的影响。阐述了平台对准失准角与晃动干 扰的定量关系,讨论了晃动环境下解析粗对准的适用条件。指出平台水平对准失准角与对应的平均晃动干扰角 幅值相关,方位对准精度主要取决于东向平均干扰角速度即北向地球自转角速度的信噪比(signal noise rate, SNR)。转台小角度晃动实验验证了上述结论的合理性。 关键词:粗对准;晃动干扰;失准角;信噪比 中图分类号:U 666.1 文献标志码:A DOI:1O.3969/j.issn.1001—506X.2010.07.033 Error analysis of analytic coarse alignment on gentle swaying disturbance base ZHOU Qi,QIN Yong—yuan,ZHAO Chang—shan (School of Automation,Northwestern Polytechnical Univ.,X ’an 710129,China) Abstract:The chief aim of the present work is to investigate the impact of gentle swaying disturbance on analytic coarse alignment of strap—down inertial navigation system(SINS).The quantitative relationship between the platform misalignment angles and swaying disturbance angles is described,then the applicable con— ditions of analytic coarse alignment on swaying disturbance base are discussed.The studies we have performed showed that platform horizontal misalignment error angles are associated with corresponding average amplitude of disturbance angles and the azimuth error mainly depends on east average disturbance angular velocity.In other words,azimuth error is related with signal noise rate(SNR)of north earth’S angular velocity.Turntable gentle swaying experiment verifies that the above conclusion is reasonable。 Keywords:coarse alignment;sway disturbance;misalignment angles;signal noise rate(SNR) 0 引 言 捷联惯性导航系统的粗对准是为了确定姿态矩阵C;的 动干扰的定量关系是有意义的。本文通过对晃动干扰下解 析粗对准的误差进行分析,研究了平台对准失准角与晃动干 扰的定量关系,讨论了解析粗对准在晃动环境下的适用条 件,并通过双轴位置转台小角度晃动实验验证所得结论。 粗略值,从而为精对准过程提供初始值。利用重力矢量g 和地球自转角速度矢量∞ 在导航系n和载体系b中的投 影关系可以确定c ,此即为解析粗对准 ]。由于g和∞ 在 b系中的投影通过加速度计和陀螺测得,故存在惯性器件 l解析粗对准原理 众所周知,解析粗对准是基于双矢量定姿原理,为便于 分析,此处简述该原理:假定当地纬度L已知,导航坐标系 n与东北天(East-E,North-N,Up—U)当地地理坐标系重 测量误差。文献[2—4]研究了几类解析粗对准方法,并给 出了各方法的平台对准失准角与惯性器件误差间的关系, 解决了在相同精度传感器条件下不同对准算法的对准精度 问题。除器件误差影响外,小角度晃动干扰如阵风作用、人 合。载体坐标系b定义为载体右前上方向,定义晃动中心 的载体坐标系为晃动中心坐标系,记为bo,b相对b。作微幅 晃动。则g和∞ 在n系中的投影为 员走动、货物卸载等也是影响解析粗对准精度的重要因素。 文献[5]指出,解析粗对准的误差主要取决于晃动干扰的剧 烈程度,而晃动误差将引起较大的粗对准误差,使系统的精 对准时间延长甚至无法进入精对准阶段,因此建立一种衡量 g 一E0 0 ~G] ∞:一E0 ̄2cos L f ̄sin El 式中,G为当地重力加速度;Q为地球自转角速率。 对准过程忽略惯性器件的测量误差及晃动干扰影响,g (1) 晃动剧烈程度的标准是十分必要的,即研究解析粗对准与晃 收稿日期:2009—06—16;修回日期:2009—12—24。 作者简介:周琪(1984一),男,博士研究生,主要研究方向为惯性导航及应用。E—mail:zhouqis@139.tom 系统工程与电子技术 第32卷 和∞ 在b系中的投影可用加速度计和陀螺的输出, 和 近似表示 c≈一I一[t,(£)×] (4) 由于粗对准过程中,载体相对晃动中心作小角度晃动, =c g ≈一i≥一一 { ∞ 一Cb ∞ n≈面 =[亩 7曲 亩m 妣] 因此认为解析粗对准确定的是晃动中心bo相对 的姿态 一 … 矩阵c ,所以依据式(3)可以得到 C —MQ 文献[4]指出利用三个相互正交的向量g ,g ×∞ ,( × (5) 一 一碗)×旷可计算C 且有更高的对准精度,其中(g ×)表示 式中 ( 由 构造的叉乘反对称矩阵 6 M= (g ) (一 ) ( ×∞:) (一 × ((g”×∞ )×g ) ( ×亩 )× ) (一 ) (3) J (一 ) 式(3)即为一种形式的解析粗对准方法,下文以此方法作为 (一 × Ab o) I (一 ×础) 论述对象。 ( × Abo)× l(( x )× 2晃动干扰误差 对准过程中M是常值, 包含晃动引起的误差,为突 假设b相对b。作小角度晃动,晃动角为,,( ),干扰角 出晃动干扰的影响,此处认为惯性器件无测量误差,故 速度嘶(z)= (£)/ ,I表示3×3的单位矩阵,则b。和b 式(5)可改写成 系间关系可表示为 c 一M(Q+ Q)一(.|-/- Qc )c (6) 式中 一 ¨一 矿 X (一 ) Q一 (~ ×国 一 ×跏 。) ×∞ )×力+(一 疗×&obo)× +(力 ×∞ )× , ) l 一 一 一 正交化后的(C )。与理想矩阵C 的关系可用平台对准失 一c2。c:。g +c g 一[矿(f)×]c:。g 准角 的反对称矩阵表示 跏 一面 一∞ 一c2 c:。∞ +∞ (£)一c:。∞:一 C 一(J一 ×)C (1O) [ 。(f)×]c:。∞:+∞ (f) (7) 式中, 一[ j5L_] ,( ×)为 的叉乘反对称矩阵[ 。 由于式(6)确定的e 不满足单位正交化条件,一般需将e 则由式(9)和式(】O)可得失准角 的反对称矩阵表达式为 1 按式(8)进行正交化处理 。 ( ×)一寺((c: ) 一c; MT) (11) (e:。)。一e;。[(e; ) e ]一 / (8) 由式(7)可得晃动干扰误差在导航系中的投影为 正交化处理后,将式(8)中平方根项按级数展开并忽略二阶 一C ,%一[ ( )×]g,| 小量,式(6)整理为 洒 一C 胁 一一[矿(£)×]∞:+∞:(£) (12) ( )。一f_J+专(c乏 Mz一(c:。占Q ) )]c (9) (f)一[ )] 为晃动干扰角t,(£)在导航系,z的 投影,则可得 C 一 (~ ×∞ +g x d∞ ) f(13) ( ×∞ )×g +(g-×洒 )×g (g ×∞ )× , ) { 式中,∞ 一c细 一C;( +∞ (£))一∞ +∞:( )为陀螺输 扰角速度在导航系投影。 出在导航系投影; (£)=[ (£) ( ) cc, ( )] 为干 由式(11)~式(13)可得平台失准角的表达式为 第7期 一~ 篁!/J、角度晃动干扰下解析粗对准的误差分析 E・l495 ・ (£)一 20COS L 二 竺些 !1 (14) (1)将惯性组件(惯组)安装于转台台面,并调整转台 使惯组与当地地理坐标系重合; (15) 一~ N(f)~ ! 垄 ± 盟 竺 2t2COS L (2)开始采集并存储惯导中的陀螺和加速度计数据直到实验结束; (3)转台处于静止状态600 s; , oo丸一~ u( )一 ̄n(t)wa(t) a西v (t )+ d~(16) 由于对准过程中通常采用对传感器测量值取平均的方 法来提高对准精度,若粗对准结束时刻为t ,则式(14)~ (4)转台东向轴手动施加幅值约为2。,周期3 ~5 s的 晃动20 S; 式(16)中的t, (£)和龇(£)( —E,N,u)应用平均干扰角 (tD和平均干扰角速度 ( )替换。其中面,( )和 ( ) 的定义见图1,规定干扰角叩,(£)围成的面积为 ( ),且在横 坐标轴上方的面积为正,下方的面积为负,则定义于扰角 叩 (£)围成的面积的时间均值为平均干扰角,i ( 。),即 ( 一壹 ( 一J广i,'  ̄(t)dt(17) _定义粗对准结束和开始时刻对应的晃动干扰角之差对 对准时间z的变化率,称为平均晃动干扰角速度 (z ),如 图1中粗实直线所示,即 (f) o 图1 干扰角及平均干扰角速度 rf (£ )一 _一= : ÷盟 (18) 由于晃动干扰为小角度,故式(14)~式(16)中的二阶小量 可忽略 ≈一 ( ) (19) w≈—— N( ) (20) 九 ( )一 (21) 定义式(21)中 沽为北向地球自转角速度的信噪 比。式(19)~式(21)列出了晃动干扰与对准失准角度间的 定量关系,换言之上述三式也是界定晃动剧烈程度的方法, 即解析粗对准在晃动环境下适用条件的表达式。 3转台实验 采用光纤捷联惯导在双轴位置转台上进行小角度晃动 对准实验,实验所用位置转台的角位置精度为3n所用惯导 系统的光纤陀螺零偏重复性为0.02(。)/h,陀螺零偏稳定 性O・02(。)/h,石英加速度计精度为10~G;陀螺与加速度 计的数据采集周期均为10 ms。实验所用手动双轴位置转 台无法为晃动对准过程提供实时的姿态参考信息,为此设 计如下实验: (5)转台东向轴继续施加幅值小于0.5。,周期小于1 s 的晃动60 s; (6)调整转台东向轴使其偏离起始位置0.045。,静l} 约20 S。 根据转台晃动前的600 s数据进行初始自对准,根据 初始对准结果和后续晃动阶段数据进行姿态更新并存储 姿态信息和对应的时间。根据姿态更新的结果及晃动中 心姿态信息计算出晃动过程中惯组的晃动干扰角,如图2 所示。选取上述600 s后的数据进行解析粗对准,根据对 准结果及晃动中心坐标信息计算出平台失准角,如图3所 示。图4是扣除地球自转角速度的陀螺均值输出,视为平 均干扰角速度 图5为晃动干扰角均值,即平均晃动干 t|s (a)东向晃动干扰角 一2 0 一2 ,(b)北向晃动干扰角 .繇1 XlU ̄ 拜 。 (c)天向晃动干扰角 图2惯组东向、北向和天向晃动干扰角 tfs (a)东向平台失准角 一一4. t/s (b)北向平台失准角 8--, tis (c)天向平台失准角 图3平台失准角 ・1496・ 系统工程与电子技术 第32卷 "  ̄-。3 24008 0 l0 2O 3O 40 5O 6O 7O 8O 9O 1O0 t/s (a)惯组东向平均干扰角速度 0 o : t/s 惯组北向平均干扰角速度 盒0 \ 。 一0 O t (c)惯组天向平均干扰角速度 图4惯组平均干扰角速度 0 l0 20 30 40 50 60 70 80 90 100 l|s n_4 (a)惯组东向平均晃动干扰角 2厂=_ ———r——1———r——1———r——-r———T_——1——] 一 o hL _一3—0 4===上_: 0_L50 60每#}手等=—7L’1 01 0 200 80 90 1OO o t ,… (b)惯组北向平均晃动干扰角 ・ 一l2 卜—_E 生圭茎至至至 l ; 广—T} _—Ti=_—丁—丁—丁—T—T] 。一一0 210 20 30 4O 5O 6O 7O 8O 90 10O =±= ==:=j=:】 t (c)惯组天向平均晃动干扰角 图5惯组平均晃动干扰角 由图3(a)可以看出,平台东向失准角与图5(a)的东向 平均晃动干扰角的形状幅值恰好反向吻合,验证了式(19) 描述的关系;图3(b)中的北向平台失准角未能反应图5(b) 中北向平均晃动干扰角的变化趋势,这是因为对准过程未 考虑器件误差及杆臂效应的影响,这些误差比此时的北向 平均晃动干扰角大;图3(c)显示,平台方位失准角在晃动过 程中未收敛,惯组近似恢复到晃动中心后,平台方位失准角 迅速收敛。图3(c)显示平台方位失准角在对准结束时刻的 误差为7.29。,这是因为惯组在晃动结束后未恢复到晃动中 心,实验过程中设置惯组偏离晃动中心0.045。,而图2(a)显 示该偏差值为0.044 4。(由于转台角位置精度限制),以此 值代入式(21)可算得平台方位失准角约为7.36。,与实验值 7.29。基本符合。误差是由于实验过程中未考虑杆臂效应 的影响及式(21)未考虑器件误差的原因。图4(a)显示平均 晃动干扰角速度与图3(c)中方位失准角的变化趋势一致, 只不过,当平均晃动干扰角速度较大(超过地球自转角速度 的十分之一)时,平台失准角的小角度假设不成立,因此计 算的平台失准角有误,但仍可反应其变化趋势。对准结束 时刻,图4(a)显示平均干扰角速度为1.597 6(。)/h,与 式(18)计算的结果一致,因此,只有当对准结束时刻晃动的 平均干扰角速度比地球自转角速度至少低一个数量级时, 方位失准角才能近似为小角度。 依据文献[2—4]的结论,采用式(3)的对准算法,若陀螺 随机常值漂移0.02(。)/h,加速度计随机常值偏置1O G, 对准地纬度34。,则平台失准角极限值分别为一0.35 ,0.35 , 6 。与晃动干扰误差相比,惯性器件误差引起的对准误差 在晃动干扰误差分析中可以忽略。 4 结 论 通过对晃动干扰下解析粗对准的误差定量分析,并通 过实验验证,可以得出以下结论: (1)平台水平失准角幅值范围与对应的平均干扰角幅 值成正比例关系; (2)方位失准角误差主要取决于北向地球自转角速度 的信噪比,信噪比越大其失准角越小;或者说,对准结束时 刻的东向平均晃动干扰角速度与地球自转角速度的北向分 量相比越小,方位失准角就越小; (3)在惯性器件性能满足的条件下,充分延长对准时 间,对准精度可达到相应平均干扰角幅值的极限精度;若对 准结束时刻,载体可恢复到晃动对准起始位置,则方位对准 精度与对准过程中的晃动干扰无关。 依据上述结论及式(19)~式(21)的表述,当东向平均 晃动干扰角速度比地球自转角速度的北向分量至少小一个 数量级时,解析粗对准才有效果,延长对准时间可达到上述 目的;但若期望快速对准时该算法难以满足要求,可选择适 用于摇摆基座对准的其他对准算法 。 参考文献: [1]Britting K R.Inertial navigation system analysis[M].New York:Wiley,1971:199—203. [23柴卫华,沈晓蓉,张树侠.船用捷联惯导系统解析粗对准的误差 分析[J].哈尔滨工程大学学报,1999,20(4):46—50. [3]Jiang Y F.Error analysis of analytic coarse alignment methods[J]. jEEETrans.OnAerospace am1 Electronic Systems,1998,34(1): 334—337. [4]魏春岭,张洪钺.捷联惯导系统粗对准方法比较EJ].航天控制, 2000,10(3):16—21. r-s]秦永元.惯性导航[M].北京:科学出版社,2006:361—363. [6]秦永元,严恭敏,顾冬晴,等.摇摆基座上基于信息的捷联惯导粗 对准研究EJ].西北工业大学学报,2005,23(5):681~684. [7]Gu D Q,EI-Sheimy N,Has.san Coarse alignment for ̄rirle SINS using gravity in the inertila frame as a reference[C]f IEEE Position, Locationand Navigation Symposium,2008:961—965. Cs]Lian Junxiang,Hu Dewen,wu Yuanxin,et a1.Research on SINS alignment algorithm based on FIR filters[J].Journal of Beijing Institute of Technology,2007,16(4):437—442. [9]赵长山,秦永元,白亮.基于双矢量定姿的摇摆基座粗对准算法 分析与实验[J].中国惯性技术学报,2009,17(4):436—440. [1o3 Yang Sheng,Fang Jiancheng.A fast initial alignment method for SINS on stationary base[el∥Seyenth Internationaz Sym— posium on Instrumentation and Control Technology:Measure— ment Theory and Systems and Aeronautical Equipment,Bei— jing,2008:1—6.