[发明专利]一种基于惯性/双星间断伪距约束的定位方法

说明书

技术领域

本发明属于组合导航技术领域，涉及一种新的少可见星组合定位方法，在只有两颗可见导航卫星的情况下可以获得稳定、可信的定位结果，且不受惯导既有位置误差的影响。

背景技术

目前适用于载体航行的导航系统有很多种，单个的导航系统一般都有其不足之处，GNSS/INS(全球卫星导航系统/惯性导航系统)组合导航系统，克服了惯性导航系统误差积累的缺点，以及卫星导航系统更新频率低，易受干扰的缺点，成为当今一种主流的导航方式。

然而在某些情况下，例如接收天线被遮挡或载体高动态机动、卫星导航信号被持续干扰情况下，卫星导航性能大幅度降低甚至失效。当可见卫星数目少于四颗时，GNSS/INS松组合定位精度将下降，当卫星信号中断无法提供定位信息时，松组合系统被破坏，整个导航系统性能迅速降低。以伪距和伪距率为观测量的GNSS/INS紧组合导航系统，可以利用少于四颗卫星信息进行组合，输出精度高于松组合的结果，具有一定的抗干扰能力。但是由于系统观测量的缺失，紧组合导航系统定位误差仍然较大，甚至发散。在GNSS信号失效，只有两颗星信号的时候，常规的GNSS/INS紧组合导航无法提供长时间的、准确的导航定位结果。如何在卫星信号失效，可见卫星数目少于四颗时，提供稳定、可靠的导航定位结果具有重要意义。

在卫星信号失效的情况下，为提高系统的精度和鲁棒性，近年来学者们提出了多种算法。解决观测量的不足，可以采用虚拟卫星法，该方法通过增加虚拟的卫星的数量，补全观测，从而构造出新的观测量，提高系统稳定性和精度。将里程计和GPS伪距信息通过非线性滤波模型进行融合的方法，和常规基于EKF的导航系统相比，在少可见星的情况下，其精度有所提高。容积卡尔曼滤波导航系统在一定程度也可以提高卫星信号缺失情况下的导航精度，提高系统适应复杂环境的能力。

发明内容

在卫星信号恶劣，只有两颗可见卫星情况下，单一时刻的卫星信息很难准确地获取载体的位置，常规卡尔曼滤波组合导航定位易发散且难以保证精度；若利用多个时刻的卫星信息与惯导组合，则可以输出载体位置。本发明的目的在于克服现有GNSS/INS组合导航技术在卫星信号失效时的缺不足，鉴于两颗可见卫星条件下，多个时刻间GNSS对载体绝对位置的约束与INS对载体相对位置的约束，提供一种基于惯性/双星间断伪距约束的定位方法。本发明方法充分利用不同时刻间的卫星、惯性信息，使用不连续的卫星信息，而且对于时刻间隔大小没有固定要求，所以即使在卫星信号失效严重的情况下，只要GNSS提供数个时刻的卫星位置与伪距，就可以用约束的方法定位，有效提高了组合导航系统的稳定性与精度。

本发明一种基于惯性/双星间断伪距约束的定位方法，通过下述步骤来完成：

步骤一：选取4个以上具备两颗可见导航卫星信号的时刻点，时刻点间隔根据载体运动速度确定，以第一个时刻为参考点，利用惯性导航系统(Inertial Navigation System,INS)计算每个时刻与参考点之间导航坐标系下的相对位移；

步骤二：根据选取的每个时刻两颗卫星的位置、伪距信息，计算该时刻点载体位置可行解轨道的参数，包括：轨道圆心、轨道半径、轨道平面法向量；

步骤三：利用平面法向量，求出每个时刻由轨道坐标系到地心地固系的两次旋转变换的旋转角度值；

步骤四：依据每个时刻可行解轨道参数，通过坐标变换，将不同时刻导航坐标系下可行解轨道统一到地心地固系下；

步骤五：依据惯导输出高度或高度辅助测量以及可行解轨道参数方程确定参考点时刻的初始搜索区间；

步骤六：以各时刻间惯性导航系统获得的相对运动轨迹为约束，在初始搜索区间进行快速搜索，根据搜索误差大小确定搜索结果，缩小搜索区间，反复搜索直至满足精度要求，输出定位结果。

本发明的优点在于：

(1)本发明方法充分利用不同时刻间的卫星、惯性信息，依据两者间的约束关系，可以实现位置的单时刻输出或者连续输出，不受惯导既有位置误差的影响，提高了组合导航系统在两颗可见卫星下的定位精度；

(2)本发明使用不连续的卫星信息，而且对于时刻间隔大小没有固定要求，所以即使在卫星信号失效严重的情况下，只要GNSS提供数个时刻两颗卫星的位置与伪距，就可以用约束的方法定位，具有良好的算法稳定性和系统鲁棒性；

(3)本发明在计算过程中并未产生复杂的矩阵运算，快速搜索的使用更能减少搜索次数，避免不需要的计算，其计算量远小于常规紧组合算法，具有很好的实用性。

(4)本算法方法简单，易于操作。

附图说明