一种适用于多种模式下的高精度POS快速对准方法技术

本发明专利技术提供一种适用于多种模式下的高精度POS快速对准方法，包括判断POS系统处于静止状态或运动状态，相应选择对准模式为静对准或者动对准；进行静对准或者动对准，同时继续检测系统的运动状态，静对准时采用基于惯性系的对准方式对姿态矩阵进行分解，动对准时采用基于快速卡尔曼滤波的对准方式；判断对准是否成功，若对准成功则反馈对准结果，若对准失败则根据检测到的载体运动状态调整对准模式，重新对准。本发明专利技术适用于陆地、航空、航海等多种工作模式下的高精度定位定姿系统的初始对准，使得系统能够快速有效的获取准确的初始航向和姿态信息。

【技术实现步骤摘要】
一种适用于多种模式下的高精度POS快速对准方法
本专利技术涉及陆地、航空和航海等多种模式下的高精度定位定姿
，尤其涉及一种适用于陆地/航空/航海等多种模式下的高精度定位定姿系统(POS)动态快速对准技术。
技术介绍
高精度定位定姿系统是集GPS定位和惯性导航技术于一体的系统，通过采用卡尔曼滤波技术实现数据的融合，POS系统将充分发挥GPS和INS各自的优点，能够为处于陆地/航空/航海模式下的载荷提供实时、高精度的位置、航向、姿态和速度等信息，能为运动载荷的导航和制导提供重要的信息。随着科技的进步和社会的发展，人们对地理空间信息的获取和更新速度提出了更高的需求，传统的测绘方式已经不能满足这一需求，测绘科技工作者必须寻求更高效、可靠的空间信息获取技术。在这种需求下，移动测量系统应运而生，能够实现陆地、航空、航海等多种模式下的地理空间信息获取，给测绘行业带来了一场信息技术革命。移动测量系统的运用需要高精度的POS系统提供高精度、可靠的导航信息，目前国外一些公司，如加拿大的Applanix、美国Z/IImaging和德国IGI等已经开发出相应的机载和车载POS产品并应用于航空摄影和地面空间数据的采集，但其对华实施产品禁运和相关技术封锁。随着我国对惯性测量技术、高精度GPS接收机研究的不断深入，特别是随着我国北斗卫星定位技术的不断发展，研究具有自主知识产权的高精度定位定姿测量系统，并将其用于城市空间地理信息的获取和国土测量等领域中，不但为我国大规模生产实践、国民经济建设、社会发展、人们生活提供必要的基础地理信息，还可使我国在导航技术中有所突破，摆脱对国外技术的依赖。
技术实现思路
POS系统的动态快速对准技术是保证系统可靠、高效运转的重要技术，针对这一技术难题，本专利技术在捷联惯导误差模型研究的基础上，提出了一种适用于陆地/航空/航海/多种模式下的高精度POS动态快速对准技术。本专利技术采用的技术方案提供一种适用于多种模式下的高精度POS快速对准方法，包括以下步骤：步骤1，判断POS系统处于静止状态或运动状态，相应选择对准模式为静对准或者动对准；步骤2，根据步骤1中选择结果，相应进行静对准或者动对准，同时继续检测系统的运动状态；设惯性坐标系标记为i，地球坐标系标记为e，导航坐标系标记为n，载体坐标系标记为b，静对准时，采用基于惯性系的对准方式，包括将姿态矩阵分解如下式：式中，ib0指初始对准t0时刻的载体坐标系，为t时刻惯性系与n系之间的变换矩阵，由载体的地理位置及粗对准时间t确定；为t时刻b系与ib0系之间的变换矩阵，利用陀螺输出的b系相对ib0系的角运动信息确定；为ib0系与i系之间的变换矩阵，由重力加速度与加速度计输出之间的转换关系求得；动对准时，采用基于快速卡尔曼滤波的对准方式；步骤3，判断对准是否成功，若对准成功则反馈对准结果，若对准失败则根据检测到的载体运动状态调整对准模式，重新对准。而且，采用基于快速卡尔曼滤波的对准方式时，在基于SINS/GPS离散模型转移矩阵Φk/k-1和Φk/k-1和系统状态向量误差方差矩阵Pk-1计算一步预测误差方差矩阵时，先计算矩阵B＝Φk/k-1Pk-1，再计算矩阵计算B＝Φk/k-1Pk-1时，通过直接展开Φk/k-1Pk-1来表示B的每一个元素。而且，当POS系统在静态过程中上电启动，若在步骤3中判断对准失败，判定是否执行静态对准的时间已超过预设的时间阈值，若是则转入动对准模式。而且，变换矩阵求取如下，其中，t表示对准时间，ωie表示地球自转角速度矢量，λ表示载体所在位置的经度，L表示载体所在位置的纬度，表示e系相对于i系的旋转矩阵，表示n系相对于e系的位置矩阵。而且，变换矩阵通过捷联惯导姿态更新算法求得。而且，变换矩阵求取如下，取t0＜tu≤tv＜td，其中t0为粗对准开始时刻、td为粗对准结束时刻，其中，表示时刻t0到tu加速度计输出的比力增量在ib0系的投影、表示时刻tv到td加速度计输出的比力增量在ib0系的投影、表示时刻t0到tu加速度计输出的比力增量在i系的投影、表示时刻tv到td加速度计输出的比力增量在i系的投影。本专利技术具有下列优点和积极效果：1)本专利技术适用于陆地、航空、航海等多种工作模式下的高精度定位定姿系统的初始对准，使得系统能够快速有效的获取准确的初始航向和姿态信息，具有重要的市场价值；2)对准时间短，精度高，系统计算量小；3)可根据系统运动状态自主选择最优的对准方式，自主性好。附图说明图1是本专利技术实施例的流程图。具体实施方式以下结合附图和实施例对本专利技术技术方案进行具体描述。本专利技术所提供技术方案，是根据POS系统上电时的运动状态，自动选取对准的方式，以适应陆地/航空/航海等多种模式的应用需求，具体实施时POS系统通过工装与相应载体固连。当POS系统在静态过程中上电启动时，系统在传统解析式粗对准的基础上，将初始对准姿态矩阵进行分解，使得粗对准具有跟踪载体角运动的功能(具体可参见后续公式(3)，(6)，(15))，降低晃动对系统对准的影响，获得的是粗对准结束时刻的姿态矩阵。当POS系统在运动过程中开机或者重新启动时，需要利用动基座对准技术，本方案利用GPS轨迹的航迹角对惯导初始方位进行粗对准，一般误差能够控制在10度以内，由于粗对准对水平姿态角的初始值精度要求不高，而载体的水平姿态角一般不大，不妨将其初始化为零，惯导系统的速度初值由GPS提供，这样构成一个小失准角的SINS/GPS对准系统。在利用卡尔曼滤波进行组合导航解算是为了提高解算速度。本方案采用直接展开法，摒弃了程序循环控制计算方法，直接展开法虽然增加了少许程序长度和降低了通用性，但是极大减少了乘法运算次数和程序循环控制开销，有利于减少数值舍入累积误差，直接展开法还考虑了协方差阵的对称性，提高了数值稳定性。进一步，特殊地，可以当POS系统在静态过程中上电启动，静态对准时间不满足系统需求时，系统将在静态粗对准的基础上迅速转入动基座对准模式，提高对准精度，减少对准时间。因此，本专利技术的基本工作原理是：本专利技术首先根据POS系统上电前几秒采集的IMU和GNSS数据判断系统的初始状态，并根据相应的状态选择对准模式进行初始对准，并在对准的过程中实时监测系统的运动状态，并根据检测结果对系统的对准模式进行相应的调整。系统在静态模式时，采用基于惯性坐标系的对准技术，快速准确获取载体的初始姿态信息；系统在动态模式时，采用基于快速卡尔曼滤波的动对准技术，快速有效地获取载体的精确姿态角信息。参见图1，实施例包括以下步骤：1)判断POS系统处于静止状态或运动状态，相应选择对准模式为静对准或者动对准；POS系统通过工装与载体固连，运动状态一致；2)根据步骤1)中选择结果，相应进行静对准或者动对准，同时继续检测系统的运动状态；A.静对准时，采用基于惯性系的对准方式，具体步骤如下：传统解析式粗对准中，姿态矩阵的计算如下式：式中，下标中的“i”和“e”分别表示惯性坐标系(i系)和地球坐标系(e系)，gn和为重力加速度矢量和地球旋转矢量在导航坐标系(n系)中的投影，gb和为重力加速度矢量和地球旋转矢量在载体坐标系(b系)中的投影。如果载体出现较大幅值的晃动干扰，上述粗对准方法可能产生很大误差，为减小晃动对对准的影响，将姿态矩阵本文档来自技高网...

【技术保护点】
一种适用于多种模式下的高精度POS快速对准方法，其特征在于，包括以下步骤：步骤1，判断POS系统处于静止状态或运动状态，相应选择对准模式为静对准或者动对准；步骤2，根据步骤1中选择结果，相应进行静对准或者动对准，同时继续检测系统的运动状态；设惯性坐标系标记为i，地球坐标系标记为e，导航坐标系标记为n，载体坐标系标记为b，静对准时，采用基于惯性系的对准方式，包括将姿态矩阵

【技术特征摘要】
1.一种适用于多种模式下的高精度POS快速对准方法，其特征在于，包括以下步骤：步骤1，判断POS系统处于静止状态或运动状态，相应选择对准模式为静对准或者动对准；步骤2，根据步骤1中选择结果，相应进行静对准或者动对准，同时继续检测系统的运动状态；设惯性坐标系标记为i，地球坐标系标记为e，导航坐标系标记为n，载体坐标系标记为b，静对准时，采用基于惯性系的对准方式，包括将姿态矩阵分解如下式：式中，ib0指初始对准t0时刻的载体坐标系，为t时刻惯性系与n系之间的变换矩阵，由载体的地理位置及粗对准时间t确定；为t时刻b系与ib0系之间的变换矩阵，利用陀螺输出的b系相对ib0系的角运动信息确定；为ib0系与i系之间的变换矩阵，由重力加速度与加速度计输出之间的转换关系求得；动对准时，采用基于快速卡尔曼滤波的对准方式；步骤3，判断对准是否成功，若对准成功则反馈对准结果，若对准失败则根据检测到的载体运动状态调整对准模式，重新对准。2.根据权利要求1所述适用于多种模式下的高精度POS快速对准方法，其特征在于：采用基于快速卡尔曼滤波的对准方式时，在基于SINS/GPS离散模型转移矩阵Φk/k-1和Φk/k-1和系统状态向量误差方差矩阵Pk-1计算一步预测误差方差矩阵时，先计算矩阵B＝Φk/k-1Pk-1，再计算矩阵计算B＝Φk/k-1Pk-1时，通过直接展开Φk/k-1Pk-1来表示B的每一个元素。3.根据权利要求1或2所述适用于多种模式下的高精度POS快速对准方法，其特征在于：当POS系统在静态过程中上电启动，若在步骤3中判断对准失败，判定是否执行静态对准的时间已超过预设的时间阈值，若是则转入动对准模式。4.根据权利要求1或2所述适用于多种模式下的高精度POS快速对准方法，其特征在于：变换矩阵求取如下，

【专利技术属性】
技术研发人员：邵慧超，洪勇，张帅，
申请(专利权)人：立得空间信息技术股份有限公司，
类型：发明
国别省市：湖北,42