第27卷 第1期航 空 学 报Vol 127No 11 2006年 1月ACTA A ERONAU TICA ET ASTRONAU TICA SIN ICA J an. 2006收稿日期:2004209230;修订日期:2005204227基金项目:国家自然科学基金(60234030)、国家杰出青年科学基金(60225015)和教育部高校青年教师奖资助项目 文章编号:100026893(2005)0120098206捷联惯导姿态算法中的圆锥误差与量化误差练军想,胡德文,胡小平,吴文启(国防科技大学机电工程与自动化学院自动控制系,湖南长沙 410073)R esearch on Coning E rror and Q uantization E rror of SINS Attitude AlgorithmL IAN J un 2xiang ,HU De 2wen ,HU Xiao 2ping ,WU Wen 2qi(Department of Automatic Control ,College of Mechatronics and Automation ,NationalUniversity of Denfense Technology ,Changsha 410073,China )摘 要:对捷联惯导系统的误差源进行了研究,利用几何方法分析了不可交换性误差和量化误差的形成机理,以及它们的相互影响。
针对工程应用中激光陀螺输出脉冲采样量化条件,就多子样算法进行了讨论,并设计了基于MA TL AB/Simulink 的仿真。
研究结果表明,当考虑量化误差的影响时,选取适当的量化因子,三子样等效旋转矢量算法比其它算法具有更好的综合性能。
关键词:捷联惯导;姿态算法;不可交换性误差;量化误差;多子样中图分类号:V249.3 文献标识码:AAbstract :In this paper ,the error sources of strapdown inertial navigation system (SINS )are researched.The mechanism of noncommutativity error and quantization error is illustrated f rom the geometrical point of view ,and the mutual influence between them is analyzed.Considering the sample condition of the output pulses of the ring laser gyroscope (RL G ),the multi 2sample attitude algorithm of SINS is discussed.The simu 2lation is carried out using MA TL AB/Simulink.It is concluded that the three 2sample rotation vector algorithm with the proper quantization factor outperforms others when the impact of quantization errors is taken into ac 2count.K ey w ords :SINS ;attitude algorithm ;noncommutativity error ;quantization error ;multi 2sample 对于捷联惯导系统姿态更新算法的研究,目前国内外同行们有很多成果。
普遍的观点认为[1,2]:四元数姿态更新算法比方向余弦和欧拉角等其它方法的计算量小、适应性好;双子样、三子样等效旋转矢量算法在抑制不可交换性误差方面比单子样有显著改善;将姿态更新分成快慢两个回路,即快速回路更新旋转矢量,慢速回路更新姿态参数,既能有效抑制不可交换性误差,还可以减少算法的计算量。
但上述观点很少有结合捷联惯导系统工程实际来考虑的。
本文针对工程中激光陀螺输出脉冲采样量化条件,就多子样算法展开研究,并得出了相应的结论。
1 误差源分析评价算法优劣的最重要的标准之一是算法的精度。
要提高算法的精度就必须研究各种误差及其补偿、抑制方法。
在对惯导系统作原理性分析时,尚可以理想化地认为平台坐标系(平台式或捷联式)准确、无误差地模拟地理坐标系,但实际的惯导系统不可避免地受到各种误差的影响[3]。
通常,可将误差分为源信息误差和解算方法误差。
对捷联惯导系统,解算方法误差是指数值求解姿态矩阵和比力方程时产生的原理性误差,比如不可交换性误差、舍入误差、截断误差等。
源信息误差可分为解析源信息误差和测量源信息误差。
测量源信息误差就是惯性传感器的误差,此类误差因惯性器件的物理原理和仪表的精度不同而各不相同。
比如陀螺的常值漂移和随机漂移、刻度因子误差、非线性误差、输出值的量化误差等。
下面重点对捷联姿态解算时不可交换性误差和陀螺采样的量化误差进行分析。
111 不可交换性误差在利用方向余弦矩阵微分方程或四元数微分方程进行姿态更新时,都会遇到角速度矢量的积分问题。
由于刚体有限转动的不可交换性,当转 第1期练军想等:捷联惯导姿态算法中的圆锥误差与量化误差 动不定轴,即角速度矢量ω的方向在空间变化时,对角速度矢量的积分是没有意义的,而且会引入不可交换性误差。
因而,等效旋转矢量Φ被用来确定载体在姿态变化前后的相对姿态关系[4,5]。
等效旋转矢量的思想来源于:把刚体在一段时间内的转动等效为绕某个定轴矢量的旋转。
该定轴矢量就是旋转矢量,其中,旋转矢量的方向确定旋转轴的指向,旋转矢量的幅值确定旋转的角度。
这样,一个确定的旋转矢量就可唯一地表示一次刚体姿态变化;同样,任何一次姿态变化都可找到相应的旋转矢量来表示。
等效旋转矢量的微分方程可表示为[1]Φ・=ω+12Φ×ω+ 1<21-<sin<2(1-co s<)Φ×(Φ×ω)(1)其中:Φ表示旋转矢量;ω表示角速度矢量;<= (ΦTΦ)1/2,×表示叉乘,下同。
对于不可交换性误差,G oodman2Robinson 定理给出了明确的几何解释[6,7]:刚体(具有与之固联的体坐标系O X Y Z)作任意角运动,其等效转动矢量Φ在i轴(i=X,Y,Z)上的投影分量Φi与刚体角速度ω在i轴上的投影分量ωi有如下关系Φi=∫t f t0ωi d t+A i(2)其中:A i是i轴在单位球面上运动曲线A B C与连接此曲线两端的大圆弧D C所围成的球面有向面积,即不可交换性误差。
单位球面的球心在体坐标系的原点O,如图1所示。
图1 不可交换性误差的几何解释Fig11 The geomet ric explanation of noncommutativity error 文献[8]和文献[9]也从圆锥误差的角度进行表述。
事实上,圆锥误差与刚体有限转动不可交换性误差具有相同的性质,圆锥误差就是在三维角振动环境下刚体有限转动产生的不可交换性误差。
为了便于分析,通常选择圆锥运动模型来研究不可交换性误差。
假设刚体存在圆锥运动Φ=[<sin t <cos t 0]T(3)其中: 为锥运动频率;<为半锥角(即等效旋转矢量的幅值)。
设姿态更新步长为h,根据G oodman2Robinson定理,在一个步长中Z轴向的圆锥误差,即特定运动方式下的不可交换性误差,如图2所示。
精确解析表达式推导如下A k=S球面弓形=S球面扇形-S球面三角形(4)其中S球面扇形=κS平面扇形d x d y1-x2-y2= h(1-cos<)(5) S球面三角形=(∠A+∠O′+∠C-π)R2= 2arctancoth2cos<+ h-πR2(6)其中:S表示面积;∠A,∠O′,∠C为球面三角形的3个球面角,∠O′= h;R=1,为单位球半径;∠O′的两条夹边等长,为半锥角<。
根据球面三角形余弦定理可得出式(6)。
图2 一步长Z轴向圆锥误差的几何解释Fig12 The geometric explanation of coning error in axis Z in one step通过上述推导,一个步长的圆锥误差解析表达式可表示为A k=π- h cos<-2arctancoth2cos<(7) 若使用单子样、双子样、三子样、四子样旋转矢量算法逼近平面弓形,以平面弓形近似球面弓形,则可得到在一个姿态更新步长中各自的圆锥误差表达式[2]。
单子样^A1=112(Δθn-1×Δθn)=13sin2<sin2 h2sin h(8)99 航 空 学 报第27卷 双子样^A2=23(δθ1×δθ2)=83sin2<sin2 h4sinh2(9) 三子样^A3=23(δθ1×δθ2)+712(δθ2×δθ3)+12(δθ1×δθ3)=5sin2<sin2 h6sin h3+2sin2<sin2h6sin2 h3(10)四子样^A4=23(δθ1×δθ2)+23(δθ3×δθ4)+ 12(δθ1+δθ2)×(δθ3+δθ4)=16 3sin2<sin2 h8sinh4+2sin2<sin2h4sinh2(11)112 量化误差所谓量化误差,是指不计传感器固有误差,对传感器输出信息进行量化处理,将连续信息变为离散信息时,若传感器的输出端信号为[Δθ],真实值是Δθ,则量化误差为[10,11]σ=Δθ-[Δθ](12)其中:[Δθ]=nξ;n为满足条件nξ<Δθ的最大整数。
输出信息[Δθ]的精度可以达到1个量化因子ξ的值。
在采样过程中,会遇到针对模拟量的量化和针对脉冲量的量化两种情况,图3和图4分别直观地表示了这两种量化误差的产生机理。
对模拟量进行采样时,一经转化为数字量,被量化掉的部分就永久丢弃,形成量化误差,该量化误差是服从均匀分布的白噪声。
对脉冲量进行量化时,与模拟量的采样量化所不同的是,计数脉冲会将信号脉冲当前周期内的量化误差转到下一个周期,比如,一个周期内有n+013个脉冲,则013个脉冲被量化掉,但在下一个采样周期内这013个脉冲仍被计入。
在这种情况下,脉冲总量不会有误差,但是在每一步量化中仍然会引入误差,特别是在载体高动态运动条件下,脉冲量的量化误差降低了传感器的分辨率,而且由于各轴向耦合影响,也会降低惯性组合的整体测量精度。