一种高频动态目标基准位置估测方法及计算机可读介质

技术领域

本发明属于全球卫星导航系统领域，尤其涉及一种高频动态目标基准位置估测方法及计算机可读介质。

背景技术

北斗/INS融合定位已经广泛应用到机器人、移动测图、车载导航等多个领域，在环境复杂、高频动态定位、运动无规律的动态应用中，北斗与INS是绝佳组合。动动相对定位技术选定动态基准站作为基准，实时更新自身位置并以此作为位置基准，通过相对定位解算动态位置结果，为动态目标间协同作业提供安全有效保障。动动相对定位中基站处于运动状态，现有方法通常是利用北斗/GNSS SPP计算3-10m精度的绝对位置，把绝对位置结果作为相对定位位置基准，存在以下问题：无法保证复杂时变环境下动态位置基准的稳定性和可靠性；没有融合INS，得不到高频的动态位置基准，进而无法解算高频的相对位置结果；基于相对定位的无人机动态位置结果也会随移动平台的位置基准随机抖动，无法完成对无人机降落的精确控制。虽然以上问题可以通过实时PPP解算来削弱，但实时PPP初始化时间较长，实时解算需要额外的北斗SSR改正数，对互联网通信要求较高。

针对以上问题，Tang等提出了北斗/INS融合的动态基准位置解算TDCP/INS方法，利用SPP和TDCP分别解算得到初始动态位置和高精度的位置变化量，并融合INS获得高频稳定的动态基准位置结果，虽然与“真实”动态位置存在固定偏移量，但不影响动态基准位置结果与实际运动状态的一致性。然而该方法采用松组合的模式，组合性能严重依赖于北斗/TDCP精度，在城市街道、树木遮挡等相对复杂观测环境下，难以保证结果的稳定性和可靠性。紧组合能够克服松组合的缺陷，可用卫星数不足4颗也能进行组合解算，但是计算压力大，数据处理要求高。因此，如何保证复杂时变环境下动态基准位置的稳定性是动动相对定位首要解决难题。

发明内容

本发明针对复杂时变环境下，动态目标的基准位置结果与实际运动状态不一致的问题，提出了一种高频动态目标基准位置估测方法及计算机可读介质。

本发明方法的技术方案为一种高频动态目标基准位置估测方法，其特征在于，包括：

获取每颗卫星多个观测时刻的北斗载波相位观测值，通过最小二乘解算，得到动态目标相邻两个观测时刻间的位置变化量和每颗卫星北斗载波相位差分观测值对应残差，通过卡方检验残差确定周跳类型卫星对周跳数进行参数估计，通过LAMBDA整数固定周跳整数值，修复每颗卫星每个观测时刻的北斗载波相位观测值，得到每颗卫星每个观测时刻高精度的北斗载波相位观测值；

根据当前观测时刻的动态位置结合当前观测时刻与下一观测时刻之间的高精度位置变化量递推得到第下一观测时刻的动态位置，利用卫星和INS下一观测时刻的动态位置信息构建松组合观测方程，利用INS动态位置预测当前和下一观测时刻的伪距观测值计算其相邻两个观测时刻的伪距差分观测值，利用卫星间北斗载波相位差分观测值之差和INS预测伪距差分观测值之差作为输入观测量构建紧组合观测方程；

根据下一观测时刻动态目标的卫星可见数以及空间位置精度因子，利用中文描述进行动态基准位置最优解算，结合INS机械编排得到的动态位置，获得动态目标当观测时刻与下一观测时刻之间间实时高频的动态基准位置结果。

本发明具体步骤如下：

步骤1：获取每颗卫星多个观测时刻的北斗载波相位观测值，计算每颗卫星相邻两个观测时刻的北斗载波相位差分观测值，获取INS多个观测时刻的动态位置，计算INS相邻两个观测时刻的高精度位置变化量，联合每颗卫星的北斗载波相位差分观测值作为输入观测量，通过最小二乘解算，得到动态目标相邻两个观测时刻间的位置变化量和每颗卫星北斗载波相位差分观测值对应残差，通过卡方检验残差确定周跳类型卫星，对周跳数进行参数估计，通过LAMBDA整数固定周跳整数值，修复每颗卫星每个观测时刻的北斗载波相位观测值，得到每颗卫星每个观测时刻高精度的北斗载波相位观测值；

步骤2：根据每颗卫星每个观测时刻高精度的北斗载波相位观测值，计算卫星之间的相邻两个观测时刻的高精度北斗载波相位差分观测值，利用卫星间北斗载波相位差分观测值之差作为输入观测量，通过最小二乘解算得到位置变化量，根据当前观测时刻的动态位置结合当前观测时刻与下一观测时刻之间的高精度位置变化量递推得到第下一观测时刻的动态位置，利用卫星和INS下一观测时刻的动态位置信息构建松组合观测方程，利用INS动态位置预测当前和下一观测时刻的伪距观测值计算其相邻两个观测时刻的伪距差分观测值，利用卫星间北斗载波相位差分观测值之差和INS预测伪距差分观测值之差作为输入观测量构建紧组合观测方程；

步骤3：根据下一观测时刻动态目标的卫星可见数以及空间位置精度因子，利用前述步骤2的中文描述进行动态基准位置最优解算，结合INS机械编排得到的动态位置，获得动态目标当观测时刻与下一观测时刻之间间实时高频的动态基准位置结果。

作为优选，步骤1所述通过INS辅助修复每颗卫星每个观测时刻的北斗载波相位观测值，具体如下：

步骤1.1：对每颗卫星北斗载波相位差分观测值对应残差进行卡方检验，若卡方检验不通过时，残差最大值对应的卫星观测值标记为周跳类型，在状态向量中增加新的周跳参数，解算得到周跳类型卫星的周跳浮点值。

步骤1.2：重复步骤1.1解算直到每颗卫星北斗载波相位差分观测值对应残差通过卡方检验，根据步骤1.2标记的结果，对发生周跳卫星的周跳浮点值进行LAMBDA整数固定获得周跳的整数值，修复相应卫星的北斗载波相位观测值，得到高精度的载波相位观测值。

作为优选，步骤2所述计算卫星之间的相邻两个观测时刻的高精度北斗载波相位差分观测值，具体如下：

计算卫星i和卫星j的相邻两个观测时刻的高精度北斗载波相位差分观测值，将北斗载波相位差分观测值进行作差，表示为：

其中，NT表示观测时刻的数量，λ表示波长，i表示第i颗卫星，j表示第j颗卫星，i∈[1,N]，j∈[1,M]，i≠j，N和M分别表示卫星数量，

其中，

表示第k与k+1观测时刻间卫星i的方向余弦之差；

其中，

表示第k+1观测时刻动态位置的X轴坐标，/>

其中，

表示第k与k+1观测时刻间的位置变化量，/>

其中，x

其中，

步骤2所述利用卫星间北斗载波相位差分观测值之差作为输入观测量，通过最小二乘解算得到位置变化量，具体如下：

其中，

步骤2所述根据当前观测时刻的动态位置结合当前观测时刻与下一观测时刻之间的高精度位置变化量递推得到第下一观测时刻的动态位置，具体如下：

其中，

根据k+1观测时刻的状态向量X

其中，X

步骤2所述利用卫星和INS第下一观测时刻的动态位置信息构建松组合观测方程，具体如下：

其中，Z

步骤2所述利用INS动态位置预测当前和下一观测时刻的伪距观测值计算其相邻两个观测时刻的伪距差分观测值，具体如下：

卫星i与j分别利用INS动态位置预测第k和k+1观测时刻的伪距观测值，计算其相邻两个观测时刻的伪距差分观测值，卫星i与j伪距差分观测值之差表示为：

其中，i表示第i颗卫星，j表示第j颗卫星，i∈[1,N]，j∈[1,M]，i≠j，N和M表示卫星数量，N≤60，M≤60，

表示第k与k+1观测时刻间卫星i的方向余弦之差，具体如下：

其中，

表示第k与k+1观测时刻间卫星j的方向余弦之差，具体如下：

其中，

表示第k与k+1观测时刻间的位置变化量，/>

其中，

步骤2所述利用卫星间北斗载波相位差分观测值之差和INS预测伪距差分观测值之差作为输入观测量构建紧组合观测方程，具体为：

其中，Z

本发明还提供了一种计算机可读介质，所述计算机可读介质存储电子设备执行的计算机程序，当所述计算机程序在电子设备上运行时，执行所述高频动态目标基准位置估测方法的步骤。

本发明产生的有益效果是：

本发明提出了一种北斗/INS半紧组合实时高频动态目标基准位置解算方案，相比于传统动态基准位置解算，确保动态基准位置与实际运动轨迹一致，为相对定位提供高频稳定动态基准。

本发明根据不同观测条件，兼顾北斗/INS松组合和紧组合两者优势，实现高频动态基准位置最优解，时效性高，适用于复杂时变环境。

附图说明

图1：本发明实施例的方法流程图。

具体实施方式

下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。

具体实施时，本发明技术方案提出的方法可由本领域技术人员采用计算机软件技术实现自动运行流程，实现方法的系统装置例如存储本发明技术方案相应计算机程序的计算机可读存储介质以及包括运行相应计算机程序的计算机设备，也应当在本发明的保护范围内。

在城市峡谷、树木高楼遮挡等复杂环境下，利用北斗卫星和INS观测值，实施动态目标基准位置估测方法。

下面结合图1介绍本发明实施例的方法为一种所述北斗/INS半紧组合实时高频动态目标基准位置估测方法，具体包括以下步骤：

步骤1：获取每颗卫星多个观测时刻的北斗载波相位观测值，计算每颗卫星相邻两个观测时刻的北斗载波相位差分观测值，获取INS多个观测时刻的动态位置，计算INS相邻两个观测时刻的高精度位置变化量，联合每颗卫星的北斗载波相位差分观测值作为输入观测量，通过最小二乘解算，得到动态目标相邻两个观测时刻间的位置变化量和每颗卫星北斗载波相位差分观测值对应残差，通过卡方检验残差确定周跳类型卫星，对周跳数进行参数估计，通过LAMBDA整数固定周跳整数值，修复每颗卫星每个观测时刻的北斗载波相位观测值，得到每颗卫星每个观测时刻高精度的北斗载波相位观测值；

步骤1所述通过INS辅助修复每颗卫星每个观测时刻的北斗载波相位观测值，具体如下：

步骤1.1：对每颗卫星北斗载波相位差分观测值对应残差进行卡方检验，若卡方检验不通过时，残差最大值对应的卫星观测值标记为周跳类型，在状态向量中增加新的周跳参数，解算得到周跳类型卫星的周跳浮点值。

步骤1.2：重复步骤1.1解算直到每颗卫星北斗载波相位差分观测值对应残差通过卡方检验，根据步骤1.2标记的结果，对发生周跳卫星的周跳浮点值进行LAMBDA整数固定获得周跳的整数值，修复相应卫星的北斗载波相位观测值，得到高精度的载波相位观测值。

步骤2：根据每颗卫星每个观测时刻高精度的北斗载波相位观测值，计算卫星之间的相邻两个观测时刻的高精度北斗载波相位差分观测值，利用卫星间北斗载波相位差分观测值之差作为输入观测量，通过最小二乘解算得到位置变化量，根据当前观测时刻的动态位置结合当前观测时刻与下一观测时刻之间的高精度位置变化量递推得到第下一观测时刻的动态位置，利用卫星和INS下一观测时刻的动态位置信息构建松组合观测方程，利用INS动态位置预测当前和下一观测时刻的伪距观测值计算其相邻两个观测时刻的伪距差分观测值，利用卫星间北斗载波相位差分观测值之差和INS预测伪距差分观测值之差作为输入观测量构建紧组合观测方程；

步骤2所述计算卫星之间的相邻两个观测时刻的高精度北斗载波相位差分观测值，具体如下：

计算卫星i和卫星j的相邻两个观测时刻的高精度北斗载波相位差分观测值，将北斗载波相位差分观测值进行作差，表示为：

其中，NT＝1024表示观测时刻的数量，λ表示波长，i表示第i颗卫星，j表示第j颗卫星，i∈[1,N]，j∈[1,M]，i≠j，N和M分别表示卫星数量，N＝60，M＝60，

其中，

表示第1与2观测时刻间卫星i的方向余弦之差；

其中，

表示第2观测时刻动态位置的X轴坐标，/>

其中，

表示第1与2观测时刻间的位置变化量，/>

其中，x

其中，

步骤2所述利用卫星间北斗载波相位差分观测值之差作为输入观测量，通过最小二乘解算得到位置变化量，具体如下：

其中，

步骤2所述根据当前观测时刻的动态位置结合当前观测时刻与下一观测时刻之间的高精度位置变化量递推得到第下一观测时刻的动态位置，具体如下：

其中，

根据第2观测时刻的状态向量X

其中，X

步骤2所述利用卫星和INS第下一观测时刻的动态位置信息构建松组合观测方程，具体如下：

其中，Z

步骤2所述利用INS动态位置预测当前和下一观测时刻的伪距观测值计算其相邻两个观测时刻的伪距差分观测值，具体如下：

卫星i与j分别利用INS动态位置预测第1和2观测时刻的伪距观测值，计算其相邻两个观测时刻的伪距差分观测值，卫星i与j伪距差分观测值之差表示为：

其中，i表示第i颗卫星，j表示第j颗卫星，i∈[1,N]，j∈[1,M]，i≠j，N和M表示卫星数量，N＝60，M＝60，

表示第1与2观测时刻间卫星i的方向余弦之差，具体如下：/>

其中，

表示第1与2观测时刻间卫星j的方向余弦之差，具体如下：

其中，

表示第1与2观测时刻间的位置变化量，/>

/>

其中，

步骤2所述利用卫星间北斗载波相位差分观测值之差和INS预测伪距差分观测值之差作为输入观测量构建紧组合观测方程，具体为：

其中，Z

步骤3：根据第2观测时刻动态目标的卫星可见数以及空间位置精度因子，利用前述步骤2的中文描述进行动态基准位置最优解算，结合INS机械编排得到的动态位置，获得动态目标第1与2观测时刻间实时高频的动态基准位置结果。

根据本发明技术方案得出了表1中北斗/INS半紧组合基准位置解算测试统计结果，其中MAX表示位置变化量误差在E/N/U方向上的最大值。表1中的结果表明北斗/INS半紧组合基准位置解算具有更高的位置变化量精度，位置变化量误差异常值更小，位置结果与实际运动状态一致性更好。

表1：北斗/INS半紧组合基准位置解算测试统计结果

本发明的具体实施例还提供了一种计算机可读介质。

所述计算机可读介质为服务器工作站；

所述服务器工作站存储电子设备执行的计算机程序，当所述计算机程序在电子设备上运行时，使得所述电子设备执行本发明实施例的所述高频动态目标基准位置估测方法的步骤。

应当理解的是，本说明书未详细阐述的部分均属于现有技术。

应当理解的是，上述针对较佳实施例的描述较为详细，并不能因此而认为是对本发明专利保护范围的限制，本领域的普通技术人员在本发明的启示下，在不脱离本发明权利要求所保护的范围情况下，还可以做出替换或变形，均落入本发明的保护范围之内，本发明的请求保护范围应以所附权利要求为准。