一种惯导天文高精度复合两位置对准及误差标定方法技术

一种惯导天文高精度复合两位置对准及误差标定方法，它有五大步骤：步骤一：将着陆器所确定的着陆位置作为火星车的初始位置信息；步骤二：根据火星车的初始位置以及天文导航子系统输出的惯性姿态矩阵确定火星车的初始姿态矩阵；步骤三：建立火星车两位置对准的系统状态模型和量测模型；步骤四：火星车通过自转实现两位置对准；步骤五：通过修正火星车的初始位姿信息实现对高精度初始对准的要求。本发明专利技术充分发挥了捷联惯导子系统和天文导航子系统各自的优势，并且还可以应用于其它巡视探测器，具有广阔的应用前景。

A method of high precision composite two position alignment and error calibration for INS

A high precision inertial navigation astronomical composite two position alignment and error calibration method, it has five steps: the lander landing position as determined by the rover's initial position information; step two: according to the rover's initial position and navigation subsystem output of the inertial attitude matrix to determine the initial attitude matrix the rover; step three: establish a system state model and the amount of the rover two position alignment measurement model; step four: the rover through the rotation to achieve two position alignment; step five: by modifying the initial Rover pose information to achieve the high precision of initial alignment requirements. The invention fully utilizes the advantages of the strapdown inertial navigation subsystem and the celestial navigation subsystem, and can also be applied to other patrol detectors, and has wide application prospect.

【技术实现步骤摘要】
一种惯导天文高精度复合两位置对准及误差标定方法
本专利技术涉及一种惯导天文高精度复合两位置对准及误差标定方法，属于惯性导航

技术介绍
在火星探测中，火星车是在火星表面进行巡视探测的航天器，是火星探测必不可少的工具和手段。通过火星车在火星表面的探测活动，人们可以获取火星表面的环境资料，收集火星表面的岩石和土壤标本，从而完成科学探测任务。火星车通常借助地面站通过无线电测控进行导航控制，但由于地球和火星的自转和公转运动以及所带来的地面站和火星车相对地理位置的变化等，有时火星车会处于地面站无法测控的区域内；同时，火星车与地面的通讯也存在时延和带宽的问题。因此，火星车利用自身携带的测量设备进行自主导航控制已经成为重要的研究方向。目前，任何一种单一的导航方式都无法同时满足火星车自主导航的要求，突破这一难点的最佳方案就是采用多传感器信息融合的组合导航技术。由于捷联惯导系统(SINS)具有完全自主、快速、动态性能好、短时间内精度高等优点，因此，适用于火星车的组合导航系统中一般均包括捷联惯导系统。但只要有捷联惯导系统参与的组合导航系统，就要首先考虑捷联惯导系统的初始对准问题，因为火星车初始位置和姿态的确定是运动过程中火星车定位的参考基准，其精度直接影响着火星车在整个运动过程中的定位精度。目前在初始定位算法方面的研究甚少，可进行的初始位置的确定方法有无线电跟踪测量和基于路标的自主位姿确定方法。无线电测控定位方法的优点是全局绝对定位，缺点是无法实现实时自主定位。勇气号和机遇号火星车着陆后，用其无线电系统同地球跟踪站直接通信，根据第2个火星日至第4个火星日地球测控站直接得到的双向多普勒信号以及火星车与奥德赛轨道器在两次通信窗口得到的双向多普勒信号，得到了着陆器的位置(即火星车的初始位置)；基于路标的自主位姿确定方法即利用陨石坑作为导航路标进行探测器状态估计，勇气号与机遇号着陆火星的过程中成功匹配了相邻两帧图像中的路标点，对着陆器相对火星表面的水平速度进行了估算，但导航路标位置的精确获取是保证该方法成功应用的重要前提。为了保证捷联惯导系统的初始对准精度以及导航精度，必须减小惯性器件的测量误差。因此，对捷联惯导系统进行误差标定与补偿是另一个需要考虑的问题。捷联惯导系统误差标定技术根据场所的不同，可分为实验室标定和外场标定。实验室标定是指在实验室内利用惯性测试设备标定系统的参数，外场标定则是将系统安装在载体上后进行的标定。由于通过实验室标定出的各项误差系数并不是固定不变的，包括陀螺仪常值误差和加速度计常值误差。这些参数随着系统的使用或存放时间的推移而变化。因此，在惯性测量组件的使用现场对其进行各项误差系数标定，不仅可以减小惯性器件测量误差对捷联惯导系统初始对准精度的影响，还能提高捷联惯导系统的使用精度。为了满足火星车高精度自主导航的要求，本专利申请提出了一种惯导天文高精度复合两位置对准及误差标定方法。
技术实现思路
针对现有技术中存在的问题，本专利技术提供一种惯导天文高精度复合两位置对准及误差标定方法，它利用着陆器所确定的着陆位置以及天文导航系统提供的高精度惯性姿态信息，得到火星车的初始位姿信息，在此基础上，利用天文导航系统辅助火星车捷联惯导系统进行两位置对准，并对火星车的初始位姿信息进行修正，最终达到高精度初始对准。本专利技术提出一种惯导天文高精度复合两位置对准及误差标定方法，包括捷联惯导子系统、天文导航子系统、初始位姿确定单元、惯导姿态量测信息构造单元和组合导航滤波器；它们之间的关系是：天文导航子系统将惯性姿态矩阵提供给初始位姿确定单元和组合导航滤波器，初始位姿确定单元将确定的初始位姿信息分别提供给惯导姿态量测信息构造单元和捷联惯导子系统，捷联惯导子系统将解算出的姿态矩阵和速度误差信息分别提供给惯导姿态量测信息构造单元和组合导航滤波器，惯导姿态量测信息构造单元将确定的惯性姿态矩阵提供给组合导航滤波器，组合导航滤波器为初始位姿确定单元提供初始位姿的估计误差。所述捷联惯导子系统包括惯性测量组件和导航解算单元；惯性测量组件测得火星车相对于惯性空间的角速度和比力，将得到的角速度和比力信息传送给导航解算单元；导航解算单元根据惯性测量组件传输的信息通过力学编排算法实时计算出火星车的速度误差和姿态矩阵；所述天文导航子系统包括大视场星敏感器和多矢量定姿单元；大视场星敏感器同一时刻能够观测得到三颗及三颗以上恒星的星光矢量信息，并将得到的观测信息提供给多矢量定姿单元；多矢量定姿单元对接收到的星光矢量信息进行处理，得到火星车相对惯性空间的姿态矩阵；所述初始位姿确定单元包括初始位置确定模块和初始姿态确定模块；初始位置确定模块将着陆器所确定的着陆位置作为火星车的初始位置信息，并将火星车的初始位置信息提供给初始姿态确定模块；初始姿态确定模块对接收到的火星车的初始位置信息、火星车的惯性姿态矩阵以及当前的导航时间进行处理，得到火星车的初始姿态矩阵；所述惯导姿态量测信息构造单元为捷联惯导子系统确定从火星赤道惯性坐标系转换到载体坐标系的惯性姿态矩阵；所述组合导航滤波器以SINS误差方程为状态方程，以惯导姿态量测信息构造单元与天文导航子系统分别提供的惯性姿态矩阵之差以及捷联惯导子系统提供的速度误差作为观测量，得到火星车初始位姿误差的估计值以及惯性测量组件零偏的估计值；本专利技术一种惯导天文高精度复合两位置对准及误差标定方法，具体包括以下步骤：步骤一：将着陆器所确定的着陆位置作为火星车的初始位置信息火星车的初始位置也即着陆器的着陆位置，着陆器着陆位置的确定主要依赖于着陆段导航的精度，目前着陆段自主导航的发展趋势为：1)精确着陆导航，其着陆误差直径范围小于10米；2)中等精度着陆导航，其着陆误差直径范围在10米与1千米之间；3)低精度着陆导航，其着陆误差直径范围大于1千米；以CCD相机作为传感器的视觉导航系统，具有体积小、重量轻、低能耗、视场宽、易于搭载等显著优势，更为重要的是，经过多年的发展，视觉导航算法已经能够通过提取图像中的信息较为精确地确定相机的位置、速度和姿态信息；因此，在火星着陆器着陆过程中，通过融合惯导系统的测量值以及CCD相机提供的位置、速度和姿态信息，就可以实现火星着陆器的精确着陆导航；在火星着陆器的着陆过程中，当着陆相机开始工作以后，首先通过提取CCD相机所拍摄的火星表面图像上的地标点，并与火星在轨卫星所形成的数字高程地图进行地标点匹配，可以估计出着陆器的绝对位置及姿态信息；由于火星在轨卫星所拍摄的图像的分辨率有限，当火星着陆器接近火星表面时，地标点无法被准确地提取，可以通过跟踪图像序列中特征点的变化，估计出着陆器的速度信息，进而获得着陆器位置和姿态的相对变化信息；在整个着陆过程中，通过利用组合导航滤波器融合惯导系统与视觉导航系统分别提供的位置、速度和姿态信息，能够有效地修正惯导系统的累积误差以及陀螺仪和加速度计的常值漂移，从而极大地提高导航精度、满足火星车精确着陆任务的需要；约翰逊等通过发射试验火箭模拟探测器的着陆过程对算法进行验证分析；试验结果表明，基于视觉匹配和惯性测量相结合的导航方法的速度误差为0.16m/s，位置误差为6.4m，能够满足未来火星精确着陆探测任务的需要；通过以上的分析可以看出，将着陆器的着陆位置作为火星车的初始位置时，可本文档来自技高网...

【技术保护点】
一种惯导天文高精度复合两位置对准及误差标定方法，其特征在于：它包括以下步骤：步骤一：将着陆器所确定的着陆位置作为火星车的初始位置信息在火星着陆器的着陆过程中，当着陆相机开始工作以后，首先通过提取CCD相机所拍摄的火星表面图像上的地标点，并与火星在轨卫星所形成的数字高程地图进行地标点匹配，预计出着陆器的绝对位置及姿态信息；由于火星在轨卫星所拍摄的图像的分辨率有限，当火星着陆器接近火星表面时，地标点无法被准确地提取，通过跟踪图像序列中特征点的变化，预计出着陆器的速度信息，进而获得着陆器位置和姿态的相对变化信息；在整个着陆过程中，通过利用组合导航滤波器融合惯导系统与视觉导航系统分别提供的位置、速度和姿态信息，能够有效地修正惯导系统的累积误差以及陀螺仪和加速度计的常值漂移，从而提高导航精度、满足火星车精确着陆任务的需要；试验结果表明，基于视觉匹配和惯性测量相结合的导航方法的速度误差为0.16m/s，位置误差为6.4m，能够满足未来火星精确着陆探测任务的需要；通过以上的分析看出，将着陆器的着陆位置作为火星车的初始位置时，认为火星车初始经纬度的确定误差均为1角秒，即δλ＝1″，δL＝1″，其中，λ代表火星车的经度，L代表火星车的纬度；步骤二：根据火星车的初始位置以及天文导航子系统输出的惯性姿态矩阵确定火星车的初始姿态矩阵；根据大视场星敏感器的输出便获得高精度的火星车载体坐标系b系相对于火星赤道惯性坐标系i系的姿态矩阵...

【技术特征摘要】
1.一种惯导天文高精度复合两位置对准及误差标定方法，其特征在于：它包括以下步骤：步骤一：将着陆器所确定的着陆位置作为火星车的初始位置信息在火星着陆器的着陆过程中，当着陆相机开始工作以后，首先通过提取CCD相机所拍摄的火星表面图像上的地标点，并与火星在轨卫星所形成的数字高程地图进行地标点匹配，预计出着陆器的绝对位置及姿态信息；由于火星在轨卫星所拍摄的图像的分辨率有限，当火星着陆器接近火星表面时，地标点无法被准确地提取，通过跟踪图像序列中特征点的变化，预计出着陆器的速度信息，进而获得着陆器位置和姿态的相对变化信息；在整个着陆过程中，通过利用组合导航滤波器融合惯导系统与视觉导航系统分别提供的位置、速度和姿态信息，能够有效地修正惯导系统的累积误差以及陀螺仪和加速度计的常值漂移，从而提高导航精度、满足火星车精确着陆任务的需要；试验结果表明，基于视觉匹配和惯性测量相结合的导航方法的速度误差为0.16m/s，位置误差为6.4m，能够满足未来火星精确着陆探测任务的需要；通过以上的分析看出，将着陆器的着陆位置作为火星车的初始位置时，认为火星车初始经纬度的确定误差均为1角秒，即δλ＝1″，δL＝1″，其中，λ代表火星车的经度，L代表火星车的纬度；步骤二：根据火星车的初始位置以及天文导航子系统输出的惯性姿态矩阵确定火星车的初始姿态矩阵；根据大视场星敏感器的输出便获得高精度的火星车载体坐标系b系相对于火星赤道惯性坐标系i系的姿态矩阵根据当前的导航时间t能够获得从火星赤道惯性坐标系i系转换到火星星固坐标系m系的方向余弦矩阵由于：其中：所以，火星车的初始姿态实际上就是导航坐标系n系和火星车载体坐标系b系之间的姿态转换矩阵其中，θ，γ，ψ分别代表火星车的俯仰角、横滚角和偏航角，cθ表示的是cos(θ)，sθ表示的是sin(θ)，其它的以此类推；根据式(2)得：θ＝arcsin(C23)(3)γ主＝-arctan(C13/C33)(4)ψ主＝arctan(C21/C22)(5)由以上三式得出的是反三角函数的主值；在实际应用中，俯仰角θ定义在(-π/2,π/2)区间，横滚角γ定义在(-π,π)区间，偏航角ψ定义在(0,2π)区间；这样，θ的主值即为真值，而γ和ψ的真值还需通过如下附加的判式来决定其在哪个象限：步骤三：建立火星车两位置对准的系统状态模型和量测模型；a.构建系统状态模型；以地理坐标系t系作为惯性导航解算的基本坐标系，则惯导系统误差模型如下所示：其中，为惯导的平台失准角，δVn为速度误差，εb为陀螺仪常值漂移，为加速度计零偏；因此，系统的状态方程为：其中，状态矢量系统的噪声矢量W(t)＝[wgxwgywgzwaxwaywaz]T，ωgi(i＝x,y,z)、ωai(i＝x,y,z)分别为陀螺仪、加速度计随机白噪声；b.构建系统量测模型；根据当前的导航时间t和火星车的初始位置，并结合SINS的姿态矩阵有：考虑到对准误差及陀螺漂移等因素的影响，SINS数学平台系n′系与导航坐标系n系之间存在数学平台失准角向量有：由于天文导航子系统测量的姿态精度较高，且其测量误差考虑为零均值的白噪声，所以天文导航子系统输出的惯性姿态矩阵认为是真实的姿态矩阵与星敏感器的量测白噪声阵Vs之和，即：将惯导姿态量测信息构造单元与天文导航子系统分别确定的方向余弦阵的差值记作姿态量测量Zs，则由式(10)、式(11)以及式(12)得：将Zs(3×3)展开成列向量Z1(9×1)，并结合系统的状态向量X，列写出量测方程：Z1＝H1X+V1(14)其中，H1＝[...

【专利技术属性】
技术研发人员：王新龙，管叙军，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：北京,11