捷联惯性导航系统初始对准原理.docx

1、捷联惯性导航系统初始对准原理第二章 捷联惯导系统的初试对准2.1引言惯导系统是一种自主式导航系统。它不需要任何人为的外部信息，只要给定导航的初始条件（例如初始速度、位置等），便可根据系统中的惯性敏感元件测量的比力和角速率通过计算机实时地计算出各种导航参数。由于“平台”是测量比力的基准，因此“平台”的初始对准就非常重要。对于平台惯导系统，初试对准的任务就是要将平台调整在给定的导航坐标系的方向上。若采用游动方位系统，则需要将平台调水平-称为水平对准，并将平台的方位角调至某个方位角处-称为方位对准。对于捷联惯导系统，由于捷联矩阵起到了平台的作用，因此导航工作一开始就需要获得捷联矩阵的初始值，以便完成

2、导航的任务。显然捷联惯导系统的初始对准就是确定捷联矩阵的初始值。在静基座条件下，捷联惯导系统的加速度计的输入量为-，陀螺的输入量为地球自转角速率。因此与就成为初始对准的基准。将陀螺与加速度计的输入引出计算机，通过计算机就可以计算出捷联矩阵的初始值。由以上的分析可以看出，陀螺与加速度计的误差会导致对准误差；对准飞行器的干扰运动也是产生对准误差的重要因素。因此滤波技术对捷联系统尤其重要。由于初始对准的误差将会对捷联惯导系统的工作造成难以消除的影响，因此研究初始对准的误差传播方程也是非常必要的。2.2 捷联惯导系统的基本工作原理捷联式惯性导航系统，陀螺仪和加速度计直接与载体固联，加速度计测量是载体坐

3、标系轴向比力，只要把这个比力转换到导航坐标系上，则其它计算就与平台式惯性导航系统一样，而比力转换的关键就是要实时地进行姿态基准计算来提供数学平台，即实时更新姿态矩阵，姿态矩阵也称为捷联矩阵。一般选择地理坐标系为导航坐标系，那么捷联矩阵也可表示为， 其导航原理图如图2.1所示。 由惯导系统的工作原理可以看出，捷联式惯性导航系统有以下几个主要优点: 1.惯性敏感器便于安装、维修和更换。 2.惯性敏感器可以直接给出舰船坐标系轴向的线加速度、线速度，供给舰船稳定控制系统和武备控制系统。角速度以提供给舰船稳定控制系统和武 备控制系统。 3.便于将惯性敏感器重复布置，从而易在惯性敏感器的级别上实现冗余 技

4、术，这对提高系统的性能和可靠性十分有利。 4.由于去掉了具有常平架的平台，一则消除了稳定平台稳定过程中的各 种误差;二则由于不存在机电结合的常平架装置，使整个系统可以做得小而 轻，并易于维护。 当然，由于惯性敏感器直接固接于船体上也带来新的问题，即导致惯性 敏感器的工作环境恶化了。由于惯性敏感器直接承受舰船的振动、冲击及温 度波动等环境条件，惯性敏感器的输出信息将会产生严重的动态误差。为保 证惯性敏感器的参数和性能有很高的稳定性，则要求在系统中必须对惯性敏 感器采取误差补偿措施。 2.3 常用坐标系与捷联矩阵2.3.1常用坐标系惯性导航中常用的坐标系有以下几种:1.地心惯性坐标系（下标为i）惯

5、性坐标系是符合牛顿力学定律的坐标系，即是绝对静止或只做匀速直线运动的坐标系。由于宇宙空间中的万物都处于运动之中，因此想寻找绝对的惯性坐标系是不可能的，我们只能根据导航的需要来选取惯性坐标系。对于在地球附近运动的飞行器选取地心惯性坐标系是合适的。地心惯性坐标系不考虑地球绕太阳的公转运动，当然更略去了太阳相对于宇宙空间的运动。地心惯性坐标系的原点选在地球的中心，它不参与地球的自转。惯性坐标系是惯性敏感元件测量的基准。由于在进行导航计算时无需再这个坐标系中分解任何向量，因此惯性坐标系的坐标轴的定向本无关紧要，但习惯上我们可以将轴选在沿地轴指向北极的方向上，而、轴则在地球的赤道平面内，并指向空间的两颗

6、恒星。2.地球坐标系（下标为e）地球坐标系是固连在在地球上的坐标系，它相对于惯性坐标系以地球自转角速率旋转，。地球坐标系的原点在地球中心，轴与轴重合，在赤道平面内，轴指向格林威治经线，轴指向东经方向。3.地理坐标系（下标为t）地理坐标系是在飞行器上用来表示飞行器所在位置的东向、北向和垂线方向的坐标系。地理坐标系的原点选在飞行器的重心处，指向东，指向北，沿垂线方向指向天（东北天）。对于地理坐标系，在不同的惯导文献中往往有不同的取法。所不同之处仅在于坐标轴的正向的指向不同，如还有北西天、北东地等取法。坐标轴指向不同于仅使向量在坐标系中取投影分量时的正负号有所不同，并不影响导航基本原理的阐述及导航参

7、数计算结果的正确性。4.导航坐标系（下标为n）导航坐标系是在导航时根据导航系统工作的需要而选取的作为导航基准的坐标系。当把导航坐标系选得与地理坐标系相重合时，可将这种导航坐标系称为指北方位系统；为了适应在极区附近导航的需要往往将导航坐标系的轴仍选得与重合，而使与及与之间相差一个自由方位角或游动方位角，这种导航坐标系可称为自由方位系统或游动自由方位系统。5.平台坐标系（下标为p）平台坐标系是用惯导系统来复现导航坐标系时所获得的坐标系。平台坐标系的坐标原点位于飞行器的重心处。当惯导系统不存在误差时，平台坐标系与导航坐标系相重合；当惯导系统出现误差时，平台坐标系就要相对导航坐标系出现误差角。对于平台

8、惯导系统，平台坐标系是通过平台台体来实现的；对于捷联惯导系统，平台坐标系则是通过存储在计算机中的方向余弦矩阵来实现的，因此又叫做“数学平台”。对于平台惯导系统，平台坐标系与导航坐标系之间的误差是由平台的加工、装配工艺不完善、敏感元件误差以及初始对准误差等因素造成的；而对于捷联惯导系统，该误差则是由算法误差、敏感元件误差以及初始对准误差造成的。6.机体坐标系（下标为b）机体坐标系是固连在机体上的坐标系。机体坐标系的坐标原点位于飞行器的重心处，沿机体横轴指向右，沿机体纵轴指向前，垂直于，并沿飞行器的数轴指向上。2.3.2捷联矩阵的定义对于捷联惯导系统，加速度计时沿机体坐标系安装的，它只能测量沿机体

9、坐标系的比力分量，因此需要将，转换为，。实现由机体坐标系到平台坐标系的坐标转换的方向余弦矩阵又叫做捷联矩阵，本章用来表示；由于根据捷联矩阵的元素可以单值地确定飞行器的姿态角，因此又可以叫做飞行器状态矩阵；由于捷联矩阵起到了平台的作用（借助于它可以获得，），所以又可以叫做“数学平台”。设机体坐标系固连在机体上，其、轴分别沿飞机的横轴、纵轴与竖轴，实现由机体坐标系到平台坐标系的坐标转换的捷联矩阵应满足如下的矩阵方程 （3-1）式中 （3-2）当矩阵求得后，沿机体坐标系测量的比力就可以转换到平台坐标系上，得到。由平台坐标系至机体坐标系的转换关系，可以通过下述顺序的三种旋转来表示：其中、分别为机体的航

10、向角、俯仰角和倾斜角。根据上述的旋转顺序，可以得到由平台坐标系到机体坐标系的转换关系，即 （3-3）由式（3-1）可得 （3-4）考虑到捷联矩阵为正交矩阵，（表示转置），于是 (3-5)2.3 姿态的描述及更新算法物体（刚体）的姿态是物体相对观察者的几何角度关系的统称。姿态的数学描述是运动体进行姿态运动建模的基础。一般来讲，刚体的运动要用刚体位置移动和绕自身重心的转动来描述。其位置移动可用船体上下起伏（heave）、前后涌动（surge）、左右晃动（sway）来描述，而转动则要用纵摇（pitch）、横摇（roll）、和偏航（yaw）来描述。纵摇是用来描述船在穿过连续的浪头和波谷时，船头的船尾忽

11、上忽下而引起的船体绕横摇轴转动的振荡运动；横摇则是用来描述船体绕纵轴转动的振荡运动。因此，舰船和飞机一类的运载体的姿态参数就是其纵摇角、横摇角和航向角。为了描述载体的姿态，至少需要建立两个坐标系，即空间参考坐标系（Reference Coordinate）和固连于载体的本体坐标系（Body Reference）。载体坐标系的三个坐标轴在参考坐标系中的方向确定了载体的姿态，描述这些方向的物理量就称为姿态参数。姿态参数有多种形式，最常用的如欧拉角、四元数等。采用不同的姿态参数，可以构成不同的坐标转换矩阵，称为姿态矩阵。因为载体姿态是唯一确定的，因此各种姿态参数之间可以互相转换。2.3.1欧拉角欧拉

12、角（Euler Angles）发源于欧拉定理，即刚体绕固定点的角位移可以由绕该点的若干次有限转动合成。因此，可将参考坐标系绕不同坐标轴连续旋转三次得到载体坐标系，每次的旋转轴取为被旋转坐标系的某一轴，每次的旋转角就称为欧拉角。姿态矩阵与三次转动的顺序有关，但描述三轴控制的飞机、导弹、舰船等方面，一般采用非对称旋转。由坐标系的定义三个欧拉角的几何意义为：纵摇角（）：载体绕纵摇轴转动的角度；横摇角（）：载体绕横摇轴转动的角度；航向角（）：载体绕航向轴转动的角度。根据转动规律得到姿态矩阵： = (5-14)由(5-14)式可得：， ， (5-15)纵摇角定义在区间，和反正弦函数主值一样，不存在多值问

13、题。横摇角定义在区间，航向角定义在区间，都存在多值问题，求姿态角时应设法判断和的真值，以确定载体落在哪一个象限。欧拉角是经典的、应用最为广泛的一种姿态参数，具有直接、明显的几何意义，维数最小（三维），并且往往可以由姿态敏感器直接测量。在某些应用方面，欧拉角描述法具有明显的优势。但是，由于方向余弦矩阵具有九个元素，所以，解算矩阵微分方程时，实际上解算九个联立微分方程，一般说来，计算量比较大。此外，它还有一个固有缺陷，即对于某一个角度存在奇异问题。不同的旋转顺序，奇异角度也不同。因此，要准确描述任意姿态，至少需要两组欧拉角。为了解决这些问题，可以采用四元数法。下面介绍四元数法。2.3.2四元数（1

14、）四元数定义及其姿态矩阵设坐标系绕某轴ON转动某个角度，就与坐标系重合，如图5.2所示。图5.2 四元数示意图定义如下四个元素： (5-16)其中：分别为旋转欧拉轴ON在坐标系中的方向余弦。显然，用这四个元素就可以完全描述这两个坐标系之间的关系，则定义四元数为： (5-17)四元数满足以下的约束条件： (5-18)所以，四元数四个变量之中只有三个是独立的。根据欧拉旋转公式(5-14)及四元数定义，四元数姿态矩阵可表示为： (5-19)为导航坐标系与载体坐标系之间的坐标转换矩阵。注意到四元数姿态矩阵是由四元数的二项式组成，因此对于四元数，也可以得到(5-19)所示的姿态矩阵。四元数的这种非唯一性

15、是与欧拉角的非唯一性相一致的。物理意义上这两者实际代表同一种姿态、同一种旋转，并无区别。一般我们取四元数正值进行计算。上述分析说明，如果表征n系到b系的旋转四元数Q已经确定，那么就可以确定出运载体的航向角、俯仰角和横滚角，因此，四元数Q包含了所有的姿态信息，捷联惯导中的姿态更新实质上是如何计算四元数Q。2.3.3四元数与欧拉角的关系四元数和欧拉角的关系可由四元数的乘积公式求出。欧拉角载体坐标系按三次旋转到导航坐标系，则每次旋转所对应的四元数分别为： (5-20)根据四元数的定义及乘法公式，可得： (5-21)因此可解出： (5-22)或 (5-23)与欧拉角相比，四元数避免了奇异问题，没有复杂的三角运算，更有利于存储及计算。但由于计算误差等，较难保证四元数的规范化条件，因此往往需要重新规范化或降阶。2.3.4 姿态更新的四元数算法设由运载体的机体轴确定的坐标系为b，惯导系统所采用的导航坐标系为n，则由b系到n系的坐标变换矩阵称为运载体的姿态矩阵。姿态更新是指根据惯性器件的输出实时计算出矩阵。由于n系和b系均为直角坐标系，各轴之间始终保持直角，所以可将坐标系理解成刚体，当只研究两个坐标系间的角位置关系时，可对一个坐标系作平移，使其原点与另一个坐标系的原点重合。因此，两坐标系间的空间角位置可理解成刚体的定点转动。从这一基本思想出发，可获得姿态更新的四元数算法及旋