惯性导航原理

第三章惯性导航原理主要—捷联式3.1常用坐标系惯性导航中所采用的坐标系可分为惯性坐标系与非惯性坐标系两类，惯性导航区别于其它类型的导航方案（如无线电导航、天文导航等）的根本不同之处就在于其导航原理是建立在牛顿力学定律——又称惯性定律——的基础上的，“惯性导航”也因此而得名。而牛顿力学定律是在惯性空间内成立的，这就有必要首先引入惯性坐标系，作为讨论惯导基本原理的坐标基准。对飞行器进行导航的主要目的就是要确定其导航参数，飞行器的导航参数就是通过各个坐标系之间的关系来确定的，这些坐标系是区别于惯性坐标系、并根据导航的需要来选取的。将它们统称为非惯性坐标系，如地球坐标系、地理坐标系、导航坐标系、平台坐标系及机体坐标系等。在惯性导航中常用的坐标系有1.地心惯性坐标系——地心惯性坐标系不考虑地球绕太阳的公转运动，地心惯性坐标系的原点选在地球的中心，它不参与地球的自转。惯性坐标系是惯性敏感元件测量的基准，在导航计算时无需在这个坐标系中分解任何向量，因此惯性坐标系的坐标轴的定向无关紧要，但习惯上将z轴选在沿地轴指向北极的方向上，而x、y轴则在地球的赤道平面内，并指向空间的两颗恒星。iiiizyOx2.地球坐标系——地球坐标系是固连在地球上的坐标系，它相对惯性坐标系以地球自转角速率旋转，地球坐标系的原点在地球中心，轴与轴重合，在赤道平面内，x轴指向格林威治经线，y轴指向东经90度方向。eeezyOxeweOziOzeeyOx3.地理坐标系——地理坐标系是在飞行器上用来表示飞行器所在位置的东向、北向和垂线方向的坐标系。地理坐标系的原点选在飞行器重心处，x指向东，y指向北，z沿垂线方向指向天（东北天）。tttzyOx4.导航坐标系——导航坐标系是在导航时根据导航系统工作的需要而选取的作为导航基准的坐标系。指北方位系统：导航坐标系与地理坐标系重合；自由方位系统或游动自由方位系统：轴与轴重合，而与及与之间相差一个自由方位角或游动方位角。nnnzyOxnztznxtxnyty5.平台坐标系——平台坐标系是用惯导系统来复现导航坐标系时所获得的坐标系，平台坐标系的坐标原点位于飞行器的重心处。对于平台惯导系统，平台坐标系是通过平台台体来实现的；对于捷联惯导系统，平台坐标系是通过存储在计算机中的方向余弦矩阵来实现的。pppzyOx6.机体坐标系——机体坐标系是固连在机体上的坐标系。机体坐标系的坐标原点o位于飞行器的重心处，x沿机体横轴指向右，y沿机体纵轴指向前，z垂直于oxy，并沿飞行器的竖轴指向上。bbbzyOx3.2四元数理论四元数表示四元数：描述刚体角运动的数学工具(quaternions)针对捷联惯导系统，可弥补欧拉参数在描述和解算方面的不足。四元数的表示由一个实单位和三个虚数单位i,j,k组成的数kPjPiPq3211或者省略1，写成kPjPiPq321i,j,k服从如下运算公式：四元数组成部分i,j,k服从如下运算公式1kkjjiikijjiijkkjjkiikkPjPiPq321λ称作标量部分，kPjPiP321称作矢量部分四元数的另一种表示法Pq,P泛指矢量部分提示：四元数与刚体转动的关系四元数基本性质加减法kPjPiPq321kjivM3211．四元数加减法MqkPjPiPv)()()()(332211或简单表示为PvMq,四元数基本性质乘法2．四元数乘法))((321321kjivkPjPiPMq)(332211PPPviPPvP)(233211jPPvP)(311322kPPvP)(122133或简单表示为PvPPvMq※关于相乘符号※关于交换律和结合律四元数基本性质共轭范数3．共轭四元数仅向量部分符号相反的两个四元数),(Pq和),(*Pq互为共轭可证明：**)*(qhqh4．四元数的范数q定义2322212*PPPqqq1q则称为规范化四元数四元数基本性质逆除法5．逆四元数qq11qq*当1q时*1qq6．四元数的除法若Mqh则1Mhq若Mhq则Mhq1不能表示为hMq（含义不确切）四元数表示转动约定一个坐标系或矢量相对参考坐标系旋转，转角为θ，转轴n与参考系各轴间的方向余弦值为cosα、cosβ、cosγ。则表示该旋转的四元数可以写为nkjiq2sin2coscos2sincos2sincos2sin2cos为特征四元数（范数为1）四元数既表示了转轴方向，又表示了转角大小（转动四元数）四元数表示转动矢量旋转如果矢量R相对固定坐标系旋转，旋转四元数为q，转动后的矢量为R’，则这种转动关系可通过四元数旋转运算来实现1'qRqR含义：矢量R相对固定坐标系产生旋转，转角和转轴由q决定四元数表示转动坐标系旋转如果坐标系OXYZ发生q旋转，得到新坐标系OX’Y’Z’一个相对原始坐标系OXYZ不发生旋转变换的矢量VzkyjxiV矢量V在新坐标系上OX’Y’Z’的投影为''''''kzjyixV则不变矢量V在两个坐标系上的投影之间存在如下关系：qVqVee1'式中zkyjxiVekzjyixVe''''分别称为矢量V在坐标系OXYZ和OX’Y’Z’上的映像四元数映象图解zkyjxiV''''''kzjyixVkzjyixVe''''zkyjxiVe四元数表示转动方向余弦qVqVee1'将该投影变换式展开，也就是把kzjyixVe''''zkyjxiVekPjPiPq321kPjPiPq3211代入上述投影变换式kzjyix''')(321kPjPiP)(zkyjxi)(321kPjPiP进行四元数乘法运算，整理运算结果可得四元数表示转动方向余弦zyxCzyx'''其中方向余弦矩阵C222123213223113223212223212313212322212)(2)(2)(2)(2)(2)(2PPPPPPPPPPPPPPPPPPPPPPPPPPP四元数表示转动旋转合成多次旋转的合成对于一个坐标系经过多次旋转后，新坐标系和原始坐标系之间的关系等效于一个一次转动的效果，相应地有合成转动四元数假定q1、q2分别是第一次转动、第二次转动的四元数q是合成转动的四元数，那么有如下关系成立：21qqq上式中q1和q2的转轴方向必须以映象的形式给出。如果q1和q2的转轴方向都以原始坐标系的分量表示，则有12qqq求方向余弦非映象方式1用四元数旋转变换的方法求取两个坐标系之间的方向余弦表。坐标系OX’Y’Z’相对OXYZ三次旋转，以欧拉角ψ、θ、φ的形式给出。第一转，绕Z轴转ψ角，瞬时转轴n和k轴重合，则转动四元数为kq2sin2cos1第二转，绕OX1轴转θ角，瞬时转轴n的方向表示式为)sin(cosji其转动四元数为nq2sin2cos2)sin(cos2sin2cosji求方向余弦非映象方式2求方向余弦非映象方式合成由于q1和q2的瞬时转轴都是以同一个坐标系的方向余弦来表示，则合成转动四元数q的计算采用：12qqqkji2sin2cos)sin(cos2sin2coskji2sin2cos2sin2sin2cos2sin2cos2cos求方向余弦映象方式1以瞬时转轴映象形式给出转动四元数的表达式并求出合成转动四元数第一次转时，映象形式的q1和非映象形式的q1是一致的：kq2sin2cos1求方向余弦映象方式2第二转绕OX1轴转θ角瞬时转轴n是由OX经过第一转转换来的OX轴对应单位矢量i，所以定义n的映象为i则q2的映象表示式为iq2sin2cos2求方向余弦映象方式3第三转，绕OZ’轴转动φ角瞬时转轴n是由OZ经过第一转和第二转转换来的OZ’轴对应单位矢量k，所以定义n的映象为k则q3的映象表示式为kq2sin2cos3求方向余弦映象合成由于q1、q2和q3都是映象形式，所以三次转动的合成转动四元数q为321qqqqkik2sin2cos2sin2cos2sin2cosji2sin2sin2cos2sin2cos2cosk2sin2cos据此可算出对应的方向余弦表四元数补充两种转动公式坐标系旋转时，不变矢量V在两个坐标系上的投影之间存在如下关系：qVqVee1'在一些资料中，四元数的转动公式也经常写成如下的形式1'qqVVEE这个公式的意义是说，在一个超复数空间中，或者在一个固定坐标系中，矢量VE按着四元数q所表示的方向和大小转动了一个角度，得到一个新的矢量VE’四元数补充计算上的优点四元数法能得到迅速发展，是由于飞行器控制与导航的发展，要求更合理地描述刚体空间运动，以及便于计算机的应用。采用方向余弦矩阵描述飞行器运动时，要积分矩阵微分方程式：CC式中C为动坐标系转置到定坐标系的方向余弦矩阵，Ω为动坐标系相对定坐标系旋转角速度ω的反对称矩阵：000xyxzyz包含9个一阶微分方程式，计算量比较大四元数补充计算上的优点如果采用四元数法，则是要求解四元数方程式qq21q为动坐标系的转动四元数，ω为动坐标系相对定坐标系的旋转角速度，也表示为四元数kjizyx0按四元数乘积展开xyzyzyyzxzyxPPPPPPPPPPPP2131323213212222只要解四个一阶微分方程式组即可3.3视加速度和比力RrMaMgMaRMgTMaMTRamaraRa根据质心运动定理和相对运动学原理，飞行体质心运动的微分方程（在惯性坐标系下）为：式中，---飞行体的质量；----推力；---空气阻力；---惯性空间飞行时，导弹质心加速度；，---由推力产生的加速度；---由阻力引起的阻力加速度。RTagaa)(mamgmar)(gaarra)(RTraaa由上式可得出飞行体质心运动的微分方程（在弹体坐标系下）为：或，式中是动点的相对加速度，将（*）代入上式得)(gaasTaRasaa)()(agmmamgf由上式可知，测得的是推力加速度和阻力加速度的矢量和，称为视加速度，在实际的测试中由加速度传感器得到的值是在敏感轴上的分量，实际的惯性坐标系下的加速度可通过上式变换得到，在弹体坐标系上动点的力为称为比力，加速度计实际是通过比力来测量加速度的。由惯性测量组合测得的视加速度是相对惯性空间的加速度，在以上的分析计算中，假设了地球的曲率半径很大，自转速度为零，在实际的导航中，飞行体是在曲率半径不为零且具有引力场的地球表面上，因此，需要对惯性空间加速度相对地球加速度之差，即有害加速度进行补偿。即飞行体速度和地球自转角速度引起的哥氏加速度，飞行体沿地球表面飞行而产生的向心加速度。3.4捷联惯导系统的算法实现捷联惯导基本算法与误差捷联惯导系统算法概述算法：从惯性仪表输出到导航与控制信息捷联惯导算法的基本内容：一、系统初始化(Initialization)：1、给定飞行器初始位置、速度等2、数学平台的初始对准3、惯性仪表的校准二、惯性仪表误差补偿(Compensation)三、姿态矩阵的计算四、导航计算五、