一种单轴旋转调制惯性-天文深组合导航方法技术

本发明专利技术公开了一种单轴旋转调制惯性‑天文深组合导航方法，该方法使用天体矢量修正飞行器的姿态误差，天体高度修正飞行器的位置误差；利用单轴旋转调制技术解决由于加速度计的常值偏置导致水平基准精度较低的问题，进而提高惯性/天文组合导航的精度。本发明专利技术可以显著提高系统的导航精度，弥补惯性/天文深组合导航方法研究的不足。

A Uniaxial Rotation Modulated Inertial-Astronomical Depth Integrated Navigation Method

The invention discloses a uniaxial rotation modulation inertia-astronomical depth integrated navigation method, which uses celestial vector to correct attitude error of aircraft and celestial height to correct position error of aircraft, and uses uniaxial rotation modulation technology to solve the problem of low horizontal reference accuracy caused by constant bias of accelerometer. Then the accuracy of inertial/astronomical integrated navigation is improved. The invention can significantly improve the navigation accuracy of the system and make up for the deficiency of the research on the inertial/astronomical depth integrated navigation method.

【技术实现步骤摘要】
一种单轴旋转调制惯性-天文深组合导航方法
本专利技术属于导航领域，一种单轴旋转调制惯性-天文深组合导航方法。
技术介绍
近年来，惯性/天文组合导航系统以其自主性强、不受电磁干扰、隐蔽性好、精度高等特点，在航空航天及国防军事领域得到了广泛应用。传统的惯性/天文浅组合导航方法中，天文导航需要同时观测三颗或三颗以上的恒星来确定飞行器的位置姿态，它与惯性导航解算的姿态相比较作为量测量，通过滤波求得系统的导航参数。惯性/天文深组合导航方法中，天文导航把天体矢量或天体高度直接与惯性导航数据进行融合，它不需要重复计算误差且只有一颗恒星被观测时，也能较好的工作，但在计算天体高度时需要利用惯性导航提供的水平基准，然而由于惯性器件的常值偏差，使得水平基准的精度较低，影响惯性/天文深组合导航系统的定位精度。
技术实现思路
本专利技术要解决的技术问题是：为弥补现有对惯性-天文深组合导航方法研究的不足，提高组合导航的精度，提出一种基于单轴旋转调制的惯性-天文深组合导航方法。本专利技术采用的技术方案为：一种基于单轴旋转调制的惯性-天文深组合导航方法，使用天体矢量修正飞行器的姿态误差，使用天体高度修正飞行器的位置误差。由于加速度计的常值偏置导致水平基准精度较低，影响了天文导航系统的定位精度，进而降低了组合导航的精度。在单轴旋转调制式捷联惯性导航系统中，通过使用单轴旋转调制技术，提高水平基准的精度，进而提高组合系统的导航精度。具体包括以下步骤：1.单轴旋转调制方案设计旋转调制技术对惯性导航系统来说是一种误差补偿技术，其过程可以表示为：初始时刻飞行器处于静止状态，即飞行器的位置固定不变，在飞行器内部，转位机构控制IMU绕竖直方向以一定的角速度开始进行转动，转速已知，则IMU坐标系和飞行器本体坐标系之间的转换矩阵为：式中，w为旋转轴的旋转角速度，t为转动时间。捷联解算都在导航坐标系中进行，因此需要把相关的量测量转换到导航系中，为了使旋转调制的效果简单易懂，设置飞行器本体坐标系和导航坐标系重合，也就是为单位矩阵，则在t时刻惯性测量元件的常值偏差在导航坐标系可以表示为：式中，εn＝[εEεNεU]T和分别代表导航坐标系中和IMU坐标系陀螺的常值漂移。和分别代表导航坐标系中和IMU坐标系中加速度计的常值偏置。由公式(2)和(3)可见，在水平方向，惯性测量元件的常值偏差被调制成具有正弦或者余弦形式的变化曲线，因此在一个完整的转动周期，它们的均值是零，不会对系统造成额外的偏差，不会影响组合导航系统的精度。然而沿着旋转轴方向上的陀螺和加速度计的常值偏差没有变化，它会引起捷联惯导系统的定位误差随着时间的累积而增加，综上所述，单轴旋转技术仅能调制垂直旋转轴方向的惯性器件常值偏差，而与旋转轴平行方向的常值偏差仍然按照原来的方式传播。为了使IMU常值偏差在三个方向上均有所调制，可采用敏感轴与旋转轴非重合的转位方案。如图2所示，图中o-xbybzb代表本体坐标系，o-xpypzp代表IMU坐标系，θbp代表IMU和飞行器之间的安装角。在单轴旋转调制过程中，旋转调制技术对陀螺和加速度计的偏差具有相同的效果。我们以陀螺的调制结果为例来进行分析，在起始时刻飞行器的导航系和本体系重合，陀螺绕着zb轴以恒定的角速度进行连续正反转旋转，旋转矩阵可以表示为：陀螺的漂移可以表示为：式中，εn＝[εEεNεU]T和分别代表导航坐标系中和IMU坐标系中陀螺的常值漂移；代表飞行器本体坐标系和导航坐标系之间的转换矩阵；代表一个正反转周期，从式(6)可知，当陀螺在x和z方向零偏相等时，且θbp为45°时，陀螺在三轴方向上的常值漂移在理论上可以被调制成零。2.单轴旋转调制惯导误差方程建立单轴旋转调制式捷联惯导系统的捷联解算流程同捷联惯导相同，单轴旋转调制式捷联惯导系统的误差方程也与传统捷联惯导系统一致。(1)姿态误差方程在小失准角的情况下，姿态误差方程可以表示为：式中，φ＝[φE,φN,φU]T；代表导航系中地球自转角速度；εp分别代表IMU坐标系中陀螺常值漂移；为理想的导航坐标系与计算机平台坐标系之间的转换矩阵；为IMU坐标系和飞行器本体坐标系之间的转换矩阵；I表示单位矩阵，代表由飞行器本体系到计算机导航坐标系的转换矩阵；(2)速度误差方程根据单轴旋转调制式捷联惯导的导航原理以及比力方程，可得到速度的计算公式为：式中，vn＝[vE,vN,vU]T为飞行器的速度，gn＝[0,0,-g]T代表地球重力加速度向量，其中g的大小为9.788m/s2。速度误差定义为：根据公式(8)，速度误差方程可以表示为：式中，δvn＝[δvE,δvN,δvU]。(3)位置误差方程飞行器的位置(即经纬度)微分方程可通过式(10)得到：由公式(10)进行微分，则位置误差方程为：(4)惯性器件误差方程陀螺常值漂移和加速度计常值偏置的误差方程可以写成：综上所述，系统总的误差方程可以写成：式中，为理想的导航坐标系与计算机平台坐标系之间的转换矩阵，δr＝[δL,δλ]T为位置误差。3.基于天体矢量和天体高度的单轴旋转调制惯性/天文深组合模型的建立针对基于天体矢量的惯性/天文深组合中只修正了飞行器的姿态误差，而由于加速度的常值偏差导致的位置误差和速度误差随着时间的增大而发散的问题，提出了基于天体矢量和天体高度的惯性/天文深组合导航方法，它不仅利用天体矢量信息来修正飞行器的姿态误差，而且利用所观测到的天体高度来修正飞行器的位置信息。计算天体高度的过程中，需要用到捷联惯导系统的水平基准，由于IMU常值偏差的影响，使得水平基准的精度较低。所以，IMU采取单轴正反转，即采用旋转调制惯导技术以提高捷联惯导提供的水平基准的精度。要想获取较高的导航精度，不仅仅要估计出导航信息，还要估计出IMU中陀螺和加速度计的常值偏差。其状态方程使用惯性导航系统的误差方程，量测量使用星光矢量和天体高度，滤波方法采用UKF。首先对系统建立状态方程。根据组合滤波原理，选取捷联惯性导航系统的误差方程作为系统的状态方程，用表示状态量，φE,φN,φU分别表示东向、北向、天向平台失准角；δvE,δvN表示东向、北向的速度误差；δL,δλ分别表示飞行器的纬度误差、经度误差；分别代表IMU坐标系中陀螺三个轴向的常值漂移；分别代表IMU坐标系中加速度计三个轴向的偏置。根据惯性导航原理，其状态方程为：式中，φ＝[φE,φN,φU]T；为导航系中导航系相对惯性系的旋转角速度；代表导航系中地球自转角速度；代表导航系中飞行器导航系相对地球系的转动角速度；δr＝[δL,δλ]T为位置误差；为导航坐标系中加速度计的输出。根据公式(15)，可以简写为：式中，W为系统的噪声矩阵。F为状态方程的状态转移矩阵，可以表示为：式中，是转换矩阵的前两行。FN可以表示为：式中：式中，Rx代表当地子午面内主曲率半径，Ry代表垂直于子午面上平面上的主曲率半径；ωie为地球绕其旋转轴的自转角速率。量测量选择天体矢量和天体高度。在量测方程中星光矢量ss可以表示为：式中，表示星敏感器安装矩阵；si表示第i个恒星的星光矢量信息；为从地心惯性坐标系到地球坐标系之间的转换矩阵。天体高度H可以表示为：sinH＝sin(L+δL)sin△+cos(L+δL)cos△cos(tGHA+λ+δλ)(20)式中，△为该颗本文档来自技高网...

【技术保护点】
1.一种单轴旋转调制惯性‑天文深组合导航方法，其特征在于，包括如下步骤：步骤一、针对单轴旋转调制惯导技术，制定IMU的旋转方案，使IMU的常值偏置在三个方向上均有所调制；所述的IMU的旋转方案，IMU旋转采用敏感轴与旋转轴非重合的连续正反转的转位方案，o‑xbybzb代表本体坐标系，o‑xpypzp代表IMU坐标系，θbp代表IMU和飞行器之间的安装角，在起始时刻飞行器的导航系和本体系重合，陀螺仪绕着zb轴以恒定的角速度进行连续正反转旋转，旋转矩阵可以表示为：

【技术特征摘要】
1.一种单轴旋转调制惯性-天文深组合导航方法，其特征在于，包括如下步骤：步骤一、针对单轴旋转调制惯导技术，制定IMU的旋转方案，使IMU的常值偏置在三个方向上均有所调制；所述的IMU的旋转方案，IMU旋转采用敏感轴与旋转轴非重合的连续正反转的转位方案，o-xbybzb代表本体坐标系，o-xpypzp代表IMU坐标系，θbp代表IMU和飞行器之间的安装角，在起始时刻飞行器的导航系和本体系重合，陀螺仪绕着zb轴以恒定的角速度进行连续正反转旋转，旋转矩阵可以表示为：式中，w为旋转轴的旋转角速度，t为转动时间；陀螺的漂移可以表示为：式中，εn＝[εEεNεU]T和分别代表导航坐标系中和IMU坐标系中陀螺的常值漂移；代表飞行器本体坐标系和导航坐标系之间的转换矩阵；代表一个正反转周期，从式(3)可知，当陀螺在x和z方向零偏相等时，且θbp为45°时，陀螺在三轴方向上的常值漂移在理论上可以被调制成零；步骤二、建立单轴旋转调制惯导误差方程；步骤三、以天体矢量和天体高度作为量测量，建立单轴旋转调制惯导-天文深组合状态方程和量测方程，首先对系统建立状态方程，根据组合滤波原理，选取捷联惯性导航系统的误差方程作为系统的状态方程，用表示状态量，φE,φN,φU分别表示东向、北向、天向平台失准角；δvE,δvN表示东向、北向的速度误差；δL,δλ分别表示飞行器的纬度误差、经...

【专利技术属性】
技术研发人员：宁晓琳，刘艳红，张杰，房建成，吴伟仁，刘刚，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：北京,11