捷联惯性导航系统初始对准原理.docx
《捷联惯性导航系统初始对准原理.docx》由会员分享,可在线阅读,更多相关《捷联惯性导航系统初始对准原理.docx(21页珍藏版)》请在冰豆网上搜索。
捷联惯性导航系统初始对准原理
第二章捷联惯导系统的初试对准
2.1引言
惯导系统是一种自主式导航系统。
它不需要任何人为的外部信息,只要给定导航的初始条件(例如初始速度、位置等),便可根据系统中的惯性敏感元件测量的比力和角速率通过计算机实时地计算出各种导航参数。
由于“平台”是测量比力的基准,因此“平台”的初始对准就非常重要。
对于平台惯导系统,初试对准的任务就是要将平台调整在给定的导航坐标系的方向上。
若釆用游动方位系统,则需要将平台调水平---称为水平对准,并将平台的方位角调至某个方位角处一-称为方位对准。
对于捷联惯导系统,由于捷联矩阵T起到了平台的作用,因此导航工作一开始就需要获得捷联矩阵T的初始值,以便完成导航的任务。
显然捷联惯导系统的初始对准就是确定捷联矩阵的初始值。
在静基座条件下,捷联惯导系统的加速度计的输入量为一-g",陀螺的输入量为地球自转角速率M;。
因此g"与c比就成为初始对准的基准。
将陀螺与加速度计的输入引出计算机,通过计算机就可以计算出捷联矩阵T的初始值。
由以上的分析可以看出,陀螺与加速度计的误差会导致对准误差;对准飞行器的干扰运动也是产生对准误差的重要因素。
因此滤波技术对捷联系统尤其重要。
由于初始对准的误差将会对捷联惯导系统的工作造成难以消除的影响,因此研究初始对准的误差传播方程也是非常必要的。
2.2捷联惯导系统的基本工作原理
捷联式惯性导航系统,陀螺仪和加速度计直接与载体固联,加速度计测量是载体坐标系轴向比力,只要把这个比力转换到导航坐标系上,则其它计算就与平台式惯性导航系统一样,而比力转换的关键就是要实时地进行姿态基准计算來提供数学平台,即实时更新姿态矩阵C;,姿态矩阵也称为捷联矩阵。
一般选择地理坐标系为导航坐标系,那么捷联矩阵C;也可表示为C;,其导航原理图如图
由惯导系统的工作原理可以看出,捷联式惯性导航系统有以下几个主要优点:
1•惯性敏感器便于安装、维修和更换。
2.惯性敏感器可以直接给出舰船坐标系轴向的线加速度、线速度,供给舰船稳定控制系统和武备控制系统。
角速度以提供给舰船稳定控制系统和武备控制系统。
3.便于将惯性敏感器重复布置,从而易在惯性敏感器的级别上实现冗余技术,这对提高系统的性能和可靠性十分有利。
4.由于去掉了具有常平架的平台,一则消除了稳定平台稳定过程中的各种误差;二则由于不存在机电结合的常平架装置,使整个系统可以做得小而轻,并易于维护。
当然,由于惯性敏感器直接固接于船体上也带來新的问题,即导致惯性敏感器的工作环境恶化了。
由于惯性敏感器直接承受舰船的振动、冲击及温度波动等环境条件,惯性敏感器的输出信息将会产生严重的动态误差。
为保证惯性敏感器的参数和性能有很高的稳定性,则要求在系统中必须对惯性敏感器采取误差补偿措施。
2.3常用坐标系与捷联矩阵
2.3.1常用坐标系
惯性导航中常用的坐标系有以下几种:
1.地心惯性坐标系(下标为i)一一O/iN
惯性坐标系是符合牛顿力学定律的坐标系,即是绝对静止或只做匀速直线运动的坐标系。
由于宇宙空间中的万物都处于运动之中,因此想寻找绝对的惯性坐标系是不可能的,我们只能根据导航的需要來选取惯性坐标系。
对于在地球附近运动的飞行器选取地心惯性坐标系是合适的。
地心惯性坐标系不考虑地球绕太阳的公转运动,当然更略去了太阳相对于宇宙空间的运动。
地心惯性坐标系的原点Q.选在地球的中心,它不参与地球的自转。
惯性坐标系是惯性敏感元件测量的基准。
由于在进行导航计算时无需再这个坐标系中分解任何向量,因此惯性坐标系的坐标轴的定向本无关紧要,但习惯上我们可以将$轴选在沿地轴指向北极的方向上,而兀、儿轴则在地球的赤道平面内,并指向空间的两颗恒星。
2.地球坐标系(下标为e)—一Q儿儿乙
地球坐标系是固连在在地球上的坐标系,它相对于惯性坐标系以地球自转角速率仪旋转,0=15.04107“//?
。
地球坐标系的原点在地球中心Q.,轴与O忆轴重合,Q入以在赤道平面内,兀轴指向格林威治经线,儿轴指向东经%方向。
3.地理坐标系(下标为t)一一Ox』忆
地理坐标系是在飞行器上用來表示飞行器所在位置的东向、北向和垂线方向的坐标系。
地理坐标系的原点。
选在飞行器的重心处,兀指向东,刃指向北,乙沿垂线方向指向天(东北天)。
对于地理坐标系,在不同的惯导文献中往往有不同的取法。
所不同之处仅在于坐标轴的正向的指向不同,如还有北西天、北东地等取法。
坐标轴指向不同于仅使向量在坐标系中取投影分量时的正负号有所不同,并不影响导航基本原理的阐述及导航参数计算结果的正确性。
4.导航坐标系(下标为n)—一Ox”儿乙”
导航坐标系是在导航时根据导航系统工作的需要而选取的作为导航基准的坐标系。
当把导航坐标系选得与地理坐标系相重合时,可将这种导航坐标系称为指北方位系统;为了适应在极区附近导航的需要往往将导航坐标系的乙轴仍选得与乙重合,而使兀与兀及儿与另之间相差一个自由方位角或游动方位角°,这种导航坐标系可称为自由方位系统或游动自由方位系统。
5.平台坐标系(下标为p)—一◎,儿。
平台坐标系是用惯导系统來复现导航坐标系时所获得的坐标系。
平台坐标系的坐标原点。
位于飞行器的重心处。
当惯导系统不存在误差时,平台坐标系与导
航坐标系相重合;当惯导系统出现误差时,平台坐标系就要相对导航坐标系出现误差角。
对于平台惯导系统,平台坐标系是通过平台台体來实现的;对于捷联惯导系统,平台坐标系则是通过存储在计算机中的方向余弦矩阵來实现的,因此乂叫做“数学平台”。
对于平台惯导系统,平台坐标系与导航坐标系之间的误差是由平台的加工、装配工艺不完善、敏感元件误差以及初始对准误差等因素造成的;而对于捷联惯导系统,该误差则是由算法误差、敏感元件误差以及初始对准误差造成的。
6.机体坐标系(下标为b)—一OxbyA
机体坐标系是固连在机体上的坐标系。
机体坐标系的坐标原点。
位于飞行器的重心处,耳沿机体横轴指向右,几沿机体纵轴指向前,%垂直于Ox』,,并沿飞行器的数轴指向上。
2.3.2捷联矩阵的定义
对于捷联惯导系统,加速度计时沿机体坐标系Oxhyhzh安装的,它只能测量沿机体坐标系的比力分量f;,因此需要将f;,严转换为厂,
实现由机体坐标系到平台坐标系的坐标转换的方向余弦矩阵C(乂叫做捷联矩阵,本章用丁來表示;由于根据捷联矩阵的元素可以单值地确定飞行器的姿态角,因此乂可以叫做飞行器状态矩阵;由于捷联矩阵起到了平台的作用(借助于它可以获得77,并,£"),所以又可以叫做“数学平台”。
设机体坐标系O.%胪b固连在机体上,其6八0几、轴分别沿飞机的横轴、纵轴与竖轴,实现由机体坐标系到平台坐标系的坐标转换的捷联矩阵T应满
(3-1)
足如下的矩阵方程
■■
©
■«■
儿
=T
yb
式中
(3-2)
当矩阵丁求得后,沿机体坐标系测量的比力尸就可以转换到平台坐标系上,得到厂。
由平台坐标系至机体坐标系的转换关系,可以通过下述顺序的三种旋转來表
示:
绕)%轴v
卩》XbVbZb
其中鸭、°、/分别为机体的航向角、俯仰角和倾斜角。
根据上述的旋转顺序,可以得到由平台坐标系到机体坐标系的转换关系,即
cos/
0
sin/
0
sin^
cosQ0
COS0
sinp
cosp
cos/cos0-sillysin0sm屮
一cos0sin0
sin/cos屮+cos/sin0sin屮
cosysin0+sinysin0cos屮
cosQcosp
sin/sm^-cosysinQcos%
-siii/cos^
sinC
cosycos0
yP
0
(3-3)
由式(3-1)可得
■■
■■
©
yb
=T~l
儿
(3-4)
考虑到捷联矩阵厂为正交矩阵,=r(『表示转置),于是
cosycos0-sin/sui6sin屮T=cosysin+siii/sin0cos
-sm/cos^
-cos。
sin0
cos。
cos0
sin&
sui/cos屮+cosysin0sin屮sin/Sill0-cos/sin0cos屮cos/cos
(3-5)
2.3姿态的描述及更新算法
物体(刚体)的姿态是物体相对观察者的儿何角度关系的统称。
姿态的数学描述是运动体进行姿态运动建模的基础。
一般来讲,刚体的运动要用刚体位置移动和绕自身重心的转动來描述。
其位置移动可用船体上下起伏(heave)、前后涌动(surge)>左右晃动(sway)来描述,而转动则要用纵摇(pitch)、横摇(roll)、和偏航(yaw)来描述。
纵摇是用來描述船在穿过连续的浪头和波谷时,船头的船尾忽上忽下而引起的船体绕横摇轴转动的振荡运动;横摇则是用來描述船体绕纵轴转动的振荡运动。
因此,舰船和飞机一类的运载体的姿态参数就是其纵摇角、横摇角和航向角。
为了描述载体的姿态,至少需要建立两个坐标系,即空间参考坐标系(ReferenceCoordinate)和固连于载体的本体坐标系(BodyReference)o载体坐标系的三个坐标轴在参考坐标系中的方向确定了载体的姿态,描述这些方向的物理量就称为姿态参数。
姿态参数有多种形式,最常用的如欧拉角、四元数等。
釆用不同的姿态参数,可以构成不同的坐标转换矩阵,称为姿态矩阵。
因为载体姿态是唯一确定的,因此各种姿态参数之间可以互相转换。
2.3.1欧拉角
欧拉角(EulerAngles)发源于欧拉定理,即刚体绕固定点的角位移可以由绕该点的若干次有限转动合成。
因此,可将参考坐标系绕不同坐标轴连续旋转三次得到载体坐标系,每次的旋转轴取为被旋转坐标系的某一轴,每次的旋转角就称为欧拉角。
姿态矩阵与三次转动的顺序有关,但描述三轴控制的飞机、导弹、舰船等方面,一般采用非对称旋转。
由坐标系的定义三个欧拉角的儿何意义为:
2捷联惯性导航系统初始对准原理
纵摇角°(0,):
载体绕纵摇轴X,,转动的角度;
横摇角7(0):
载体绕横摇轴人转动的角度;
航向角鸭(比):
载体绕航向轴乙转动的角度。
根据转动规律得到姿态矩阵:
COS0/COS九+SillgSill%、Sill%
一cos%sm血
singcos血+cos0sin%、sin%
cos札sni%一sill0sm0“cos血
cos0pCOS如
sill(pysin%一cos0sin%cos血
一singcos%
sm%
cos0COS0卩
(5-14)
由(5-14)式可得:
&=sinT(石3)
了=塚7(_牛),0=娥7(_字)
(5-15)
纵摇角定义在处[-90°,90°]区间,和反正弦函数主值一样,不存在多值问题。
横摇角定义在代[-180°,180°]区间,航向角定义在0丘[0°,360°]区间,都存在多值问题,求姿态角时应设法判断/和P的真值,以确定载体落在哪一个象限。
欧拉角是经典的、应用最为广泛的一种姿态参数,具有直接、明显的儿何意义,维数最小(三维),并且往往可以由姿态敏感器直接测量。
在某些应用方面,欧拉角描述法具有明显的优势。
但是,由于方向余弦矩阵具有九个元素,所以,解算矩阵微分方程时,实际上解算九个联立微分方程,一般说來,计算量比较大。
此外,它还有一个固有缺陷,即对于某一个角度存在奇异问题。
不同的旋转顺序,奇异角度也不同。
因此,要准确描述任意姿态,至少需要两组欧拉角。
为了解决这些问题,可以釆用四元数法。
下面介绍四元数法。
2.3.2四元数
(1)四元数定义及其姿态矩阵
设坐标系S“(Ox“)也)绕某轴ON转动某个角度0,就与坐标系Sh(Oxhyhzh)重
合,如图5.2所示。
0
图5.2四元数示意图
定义如下四个元素:
<7o=cos(0/2)(5-16)
4=C]Sin(0/2)
q2=C2sin(0/2)
仏=C3sm(0/2)
其中:
G,GG分别为旋转欧拉轴ON在坐标系S“(Qr“儿乙)中的方向余弦。
显然,用绻-仏这四个元素就可以完全描述这两个坐标系之间的关系,则定义四元数为:
(5-17)
q=q。
+qj+qj+q*=q°+q
四元数满足以下的约束条件:
広+q:
+g;+q;=i(5-18)
所以,四元数四个变量之中只有三个是独立的。
根据欧拉旋转公式(5-14)及四元数定义,四元数姿态矩阵可表示为:
[爾7+(%/-[°])訂凡
2(g:
+d)-12©6+绻他)2(的3-绻么)~|(5一⑼
=2©竹一绻仏)2(広+広)一12(鼻的+绻4)R°=Tbolq)R。
2(4仏+%血)2(么仏一绻4)2(血+恋)一1
人。
(7)为导航坐标系与载体坐标系之间的坐标转换矩阵。
注意到四元数姿态矩阵是由四元数彳的二项式组成,因此对于四元数T7=[-%-旷「,也可以得到(5-19)所示的姿态矩阵。
四元数的这种非唯一性是与欧拉角的非唯一性相一致的。
物理意义上这两者实际代表同一种姿态、同一种旋转,并无区别。
一般我们取四元数正值进行计算。
上述分析说明,如果表征n系到b系的旋转四元数Q己经确定,那么就可以确定出运载体的航向角、俯仰角和横滚角,因此,四元数Q包含了所有的姿态信息,捷联惯导中的姿态更新实质上是如何计算四元数Q。
2.3.3四元数与欧拉角的关系
四元数和欧拉角的关系可由四元数的乘积公式求出。
欧拉角载体坐标系按三次旋转到导航坐标系,则每次旋转所对应的四元数分别为:
(5-20)
G(0)=COS
心)=cos?
+is沁
-22
^3(/)=cosj+jsm|
根据四元数的定义及乘法公式,可得:
因此可解出:
00y・0・0./
0222222屮.6r.ii/6./cl=cos—sin—cos—+sin—cos—sin—
1222222ii/6./•屮.ey
CK=cos—COS—Sill——SUl—Sill—cos—・222222
…0亠&亠/亠0…。
…/
2
2
e
q.=cos—sin—sin—-sm—cos—cos
322222
(5-21)
(5-22)
(5-23)
6>=snr1[2(^:
+^0)]—心款厂竽)]2(爲+石)_1罟初[弊跆]2(g()+①)一1
与欧拉角相比,四元数避免了奇异问题,没有复杂的三角运算,更有利于存储及计算。
但由于计算误差等,较难保证四元数的规范化条件,因此往往需要重新规范化或降阶。
2.3.4姿态更新的四元数算法
设由运载体的机体轴确定的坐标系为b,惯导系统所釆用的导航坐标系为n,则由b系到n系的坐标变换矩阵C;称为运载体的姿态矩阵。
姿态更新是指根据惯性器件的输出实时计算出C;矩阵。
由于n系和b系均为直角坐标系,各轴之间始终保持直角,所以可将坐标系理解成刚体,当只研究两个坐标系间的角位置关系时,可对一个坐标系作平移,使其原点与另一个坐标系的原点重合。
因此,两坐标系间的空间角位置可理解成刚体的定点转动。
从这一基本思想出发,可获得姿态更新的四元数算法及旋转矢量算法。
一、四元数微分方程
假设表征n系至b系的旋转四元数为
g=cos-+wsin-
(1)
对
(1)式求导可得
晋=押亚⑵
刚体绕"旋转
在捷联惯导系统中,角速度信息是捷联陀螺提供的,而捷联陀螺是在机体坐标系内测量的,所以
(2)式中的血人还需换成力2。
根据四元数向量之间的变换关系(/**=00,')可得,
(3)
将(3)式代入
(2)式可得
(4)
(5)
即得到
■■
■0
(6)
%
_1
0
么
~2
-co.
0
©
q.
0
0
其中,的获取按照下式进行
此二此-⑷:
+硝)⑺
式中,凶;是捷联陀螺的输出;C:
;由姿态更新的最新值确定;和砒:
分别是未知
速率和地球自转速率,对于导航坐标系取地理坐标系的情况行
V.
(8)
CDicCOS厶+L
(Rn
v
厶+—tanL
Rn
式中,人、匕.厶为导航计算所得的最新值,分别是北向速度、东向速度.纬度;Rn为地球沿卯西圈的曲率半径,&彳为地球子午圈的曲率半径,在不精确计算的情况下,也可以视地球为圆球形状,则(8)式中心、尺讨可用地球半径尺,代替。
二、四元数的初值确定和规范化处理
四元数的初值0(°)由捷联惯导的初始对准确定。
设初始对准确定的姿态阵为久=[7訂,根据式(5-19)及描述刚体旋转的四元数为规范化四元数的结论,有如下方程成立
%+q;一q,q;=TxQo—4+弘一仏=^22绻一4一弘+仏=T33g;+g;+g;+g;=l2吐-q°qJ=Tf2©%+绻乞)=人32©弘+qQ=T2i2(g召一
2©%-仏)=心2(鼻仏+仆7。
)=:
从上述方程解得
|^o|=271+711+722+733
(10)
4加0=人2-人34心%=兀-乙
4仏绻=乙一兀
绻的符号可以任选。
由于表征旋转的四元数是规范化四元数,即||0||=1,但是由于计算误差等因素,计算过程中四元数会逐渐失去规范化特性,因此若干次更新后,必须对四元数做规范化处理:
Q/'i=0,1,2,3
M;+q;+q;+q;
其中,么、N、么、么是四元数更新所得的值。
2.4捷联惯导系统的误差模型
对于工作在非极区的捷联惯导系统,为了简化计算,导航坐标系一般选取地理坐标系,这样,捷联惯导完全等效于指北方位系统。
由于陀螺在捷联系统中起测量器件作用,陀螺漂移引起的数学漂移与陀螺漂移的方向相反,刻度系数误差引起对运载体角速度的测量误差,
2捷联惯性导航系统初始对准原理经姿态更新计算引入系统。
2.4.1速度误差方程和位置误差方程
根据比力方程,当不考虑任何误差时,速度的理想值由卞式确定:
K=C;f-(2<+减)X%+g”(3.6.1)
而实际系统中总存在各种误差,所以实际的速度计算值应由下述方程确定:
V.=C;:
fh-2(0.+砒Jxy+g。
(3.6.2)
式中
Vc=Vn+6V"
=g“+5g
U=C:
;C;=U-0”x)C;;
■0
_九
0"x=
九
0
_0E
_一0"
©E
0
[%]
=diag[8KAx
8K
严=(/+[5KJ)(7+[5A])/"+B
0
[6A]=-6A.
8A.-6AX
0俱
6,0
其中,竝、%、九为姿态误差角,
5心和54和(i=x,y,z)分别为加速度计的刻度
系数和安装误差角。
用式(3・6・1)减去式(3・6・2),
忽略5g的影响,并略去二阶小量,得
彫”=一0*厂+C;([5K』+[54])厂+刃"x(2觀+此)+V”x(25型;+&>:
;)+▽"
当取地理坐标系为导航坐标系时,
_0
■
0
a)n=
%
cosL
§3;=
-SLcdsmL
ie
sinL
9
8LcoieCQsL
Vy
Rm+h
心+/?
——-一tanL
Rjh
RXf+h
+Sh
(心+f1)2
Rjh
-8h
Rn+h
r"匕>>rVFtanL
tan厶+5厶——-—sec*L-8h丁
Rn+h(Rn+hy
将上述式子代入式(3.6.3),可以得到速度误差方程:
X-
西V
=
0
0
_血
7/
血
0
_九
Zv
+
—0V
0
九
5K山
-独
-8A,
%
54
y
-8A
X
%
X
其中,
RM+h
-SVE
0
Vv
0
V
2©cos厶+——-—心+/2
2cosinL+———tanL
”R.+h
+=
RM+h(Rm+hy
5V.
一25Leo.sinL+-8h—.
R、dh(RN+h)2
VE2[爼tanL
——secL-8h
(心+/疗
5K
28Leo.cosL+tanL+^L
Rn+hRn+h
式(3・6・4)
位置误差方程为:
6L=f-6h一
心+h(心+hy
(3.6.5)
成="secL+dL———tanLsecL-8h'/匕
R“+hRn+h(Rn+hy
嘲=肌
2.4.2姿态误差方程
根据式
(2),姿态四元数满足如下微分方程:
Q气Q0此
其中,姿态速率鸟;视为零标量四元数。
如果求取的姿态速率不含任何误差,即
=犹_犹
则无误差的理想姿态四元数由下式确定:
0=舟00(减-風:
)(3.6.6)
但实际系统中,姿态速率由陀螺的输出角速度<和对数学平台的指令角速度确定
**h~b~b
%=%—%
其中,指令角速度根据系统解算出的导航解确定,带有一定的误差。
所以实际解算的四元数由下式确定:
e=|e®(^-J(3.6.7)
设与0相对应的姿态阵为C;',根据姿态阵与姿态四元数之间的等价关系,与c;[=c;;'c;:
相对应的四元数为
。
=翅®Q
即
=(3.6.8)
其中,50为0引起的误差四元数。
对式(3.6.8)两边对时间求导,用式(3.6.6)和式(3.6.7)代入之,可以得到,
=*00(犹-犹疋0+扣0(-欽+<)06*
=_扣0風_或)碗冷Q阴:
吨+*Q嗣;吨
=_扌00邂®g4®g0g*-lg®^;0g*®Q®Q'+^Q®Q*®Q0A-,®Q^
其中
词;m
由四元数的变化关系有
所以
将式(3.6.8)代入上式,得
^2=-|枫眈0-*<050+"g⑷:
;+拠)
将50写成三角形式
5e=cos|+|sin(
其中,0=1询,0是由0确定的导航坐标系"'相对于由0确定的导航坐标系〃的偏差角矢量,即姿态误差角矢量。
由于0是小角,所以50可写成
Jfi=1+f(3.6.10)
上式两边对/求导后得
西气(3.6.11)
将式(3.6.10)和式(3.6.11)代入式(9.8.9),略去二阶小量后
d=_牺;+<5<+0y;:
(3.6.12)
其中