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

本发明专利技术提出了一种高频动态目标基准位置估测方法及计算机可读介质

【技术实现步骤摘要】
一种高频动态目标基准位置估测方法及计算机可读介质


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

技术介绍

[0002]北斗
/INS
融合定位已经广泛应用到机器人
、
移动测图
、
车载导航等多个领域，在环境复杂
、
高频动态定位
、
运动无规律的动态应用中，北斗与
INS
是绝佳组合
。
动动相对定位技术选定动态基准站作为基准，实时更新自身位置并以此作为位置基准，通过相对定位解算动态位置结果，为动态目标间协同作业提供安全有效保障
。
动动相对定位中基站处于运动状态，现有方法通常是利用北斗
/GNSS SPP
计算3‑
10m
精度的绝对位置，把绝对位置结果作为相对定位位置基准，存在以下问题：无法保证复杂时变环境下动态位置基准的稳定性和可靠性；没有融合
INS
，得不到高频的动态位置基准，进而无法解算高频的相对位置结果；基于相对定位的无人机动态位置结果也会随移动平台的位置基准随机抖动，无法完成对无人机降落的精确控制
。
虽然以上问题可以通过实时
PPP
解算来削弱，但实时
PPP
初始化时间较长，实时解算需要额外的北斗
SSR
改正数，对互联网通信要求较高
。
[0003]针对以上问题，
>Tang
等提出了北斗
/INS
融合的动态基准位置解算
TDCP/INS
方法，利用
SPP
和
TDCP
分别解算得到初始动态位置和高精度的位置变化量，并融合
INS
获得高频稳定的动态基准位置结果，虽然与“真实”动态位置存在固定偏移量，但不影响动态基准位置结果与实际运动状态的一致性
。
然而该方法采用松组合的模式，组合性能严重依赖于北斗
/TDCP
精度，在城市街道
、
树木遮挡等相对复杂观测环境下，难以保证结果的稳定性和可靠性
。
紧组合能够克服松组合的缺陷，可用卫星数不足4颗也能进行组合解算，但是计算压力大，数据处理要求高
。
因此，如何保证复杂时变环境下动态基准位置的稳定性是动动相对定位首要解决难题
。

技术实现思路

[0004]本专利技术针对复杂时变环境下，动态目标的基准位置结果与实际运动状态不一致的问题，提出了一种高频动态目标基准位置估测方法及计算机可读介质
。
[0005]本专利技术方法的技术方案为一种高频动态目标基准位置估测方法，其特征在于，包括：
[0006]获取每颗卫星多个观测时刻的北斗载波相位观测值，通过最小二乘解算，得到动态目标相邻两个观测时刻间的位置变化量和每颗卫星北斗载波相位差分观测值对应残差，通过卡方检验残差确定周跳类型卫星对周跳数进行参数估计，通过
LAMBDA
整数固定周跳整数值，修复每颗卫星每个观测时刻的北斗载波相位观测值，得到每颗卫星每个观测时刻高精度的北斗载波相位观测值；
[0007]根据当前观测时刻的动态位置结合当前观测时刻与下一观测时刻之间的高精度位置变化量递推得到第下一观测时刻的动态位置，利用卫星和
INS
下一观测时刻的动态位
置信息构建松组合观测方程，利用
INS
动态位置预测当前和下一观测时刻的伪距观测值计算其相邻两个观测时刻的伪距差分观测值，利用卫星间北斗载波相位差分观测值之差和
INS
预测伪距差分观测值之差作为输入观测量构建紧组合观测方程；
[0008]根据下一观测时刻动态目标的卫星可见数以及空间位置精度因子，利用中文描述进行动态基准位置最优解算，结合
INS
机械编排得到的动态位置，获得动态目标当观测时刻与下一观测时刻之间间实时高频的动态基准位置结果
。
[0009]本专利技术具体步骤如下：
[0010]步骤1：获取每颗卫星多个观测时刻的北斗载波相位观测值，计算每颗卫星相邻两个观测时刻的北斗载波相位差分观测值，获取
INS
多个观测时刻的动态位置，计算
INS
相邻两个观测时刻的高精度位置变化量，联合每颗卫星的北斗载波相位差分观测值作为输入观测量，通过最小二乘解算，得到动态目标相邻两个观测时刻间的位置变化量和每颗卫星北斗载波相位差分观测值对应残差，通过卡方检验残差确定周跳类型卫星，对周跳数进行参数估计，通过
LAMBDA
整数固定周跳整数值，修复每颗卫星每个观测时刻的北斗载波相位观测值，得到每颗卫星每个观测时刻高精度的北斗载波相位观测值；
[0011]步骤2：根据每颗卫星每个观测时刻高精度的北斗载波相位观测值，计算卫星之间的相邻两个观测时刻的高精度北斗载波相位差分观测值，利用卫星间北斗载波相位差分观测值之差作为输入观测量，通过最小二乘解算得到位置变化量，根据当前观测时刻的动态位置结合当前观测时刻与下一观测时刻之间的高精度位置变化量递推得到第下一观测时刻的动态位置，利用卫星和
INS
下一观测时刻的动态位置信息构建松组合观测方程，利用
INS
动态位置预测当前和下一观测时刻的伪距观测值计算其相邻两个观测时刻的伪距差分观测值，利用卫星间北斗载波相位差分观测值之差和
INS
预测伪距差分观测值之差作为输入观测量构建紧组合观测方程；
[0012]步骤3：根据下一观测时刻动态目标的卫星可见数以及空间位置精度因子，利用前述步骤2的中文描述进行动态基准位置最优解算，结合
INS
机械编排得到的动态位置，获得动态目标当观测时刻与下一观测时刻之间间实时高频的动态基准位置结果
。
[0013]作为优选，步骤1所述通过
INS
辅助修复每颗卫星每个观测时刻的北斗载波相位观测值，具体如下：
[0014]步骤
1.1
：对每颗卫星北斗载波相位差分观测值对应残差进行卡方检验，若卡方检验不通过时，残差最大值对应的卫星观测值标记为周跳类型，在状态向量中增加新的周跳参数，解算得到周跳类型卫星的周跳浮点值
。
[0015]步骤
1.2
：重复步骤
1.1
解算直到每颗卫星北斗载波相位差分观测值对应残差通过卡方检验，根据步骤
1.2
标记的结果，对发生周跳卫星的周跳浮点值进行
LAMBDA
整数固定获得周跳的整数值，修复相应卫星的北斗载波相位观测值，得到高精度的载波相位观测值
。
[0016]作为优选，步骤2所述计算卫星之间的相邻两个观测时刻的高精度北斗载波相位差分观测值，具体如下：
[0017]计算卫星本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.
一种高频动态目标基准位置估测方法，其特征在于，包括：获取每颗卫星多个观测时刻的北斗载波相位观测值，通过最小二乘解算，得到动态目标相邻两个观测时刻间的位置变化量和每颗卫星北斗载波相位差分观测值对应残差，通过卡方检验残差确定周跳类型卫星对周跳数进行参数估计，通过
LAMBDA
整数固定周跳整数值，修复每颗卫星每个观测时刻的北斗载波相位观测值，得到每颗卫星每个观测时刻高精度的北斗载波相位观测值；根据当前观测时刻的动态位置结合当前观测时刻与下一观测时刻之间的高精度位置变化量递推得到第下一观测时刻的动态位置，利用卫星和
INS
下一观测时刻的动态位置信息构建松组合观测方程，利用
INS
动态位置预测当前和下一观测时刻的伪距观测值计算其相邻两个观测时刻的伪距差分观测值，利用卫星间北斗载波相位差分观测值之差和
INS
预测伪距差分观测值之差作为输入观测量构建紧组合观测方程；根据下一观测时刻动态目标的卫星可见数以及空间位置精度因子，利用中文描述进行动态基准位置最优解算，结合
INS
机械编排得到的动态位置，获得动态目标当观测时刻与下一观测时刻之间间实时高频的动态基准位置结果
。2.
根据权利要求1所述的高频动态目标基准位置估测方法，其特征在于，包括以下步骤：步骤1：获取每颗卫星多个观测时刻的北斗载波相位观测值，计算每颗卫星相邻两个观测时刻的北斗载波相位差分观测值，获取
INS
多个观测时刻的动态位置，计算
INS
相邻两个观测时刻的高精度位置变化量，联合每颗卫星的北斗载波相位差分观测值作为输入观测量，通过最小二乘解算，得到动态目标相邻两个观测时刻间的位置变化量和每颗卫星北斗载波相位差分观测值对应残差，通过卡方检验残差确定周跳类型卫星，对周跳数进行参数估计，通过
LAMBDA
整数固定周跳整数值，修复每颗卫星每个观测时刻的北斗载波相位观测值，得到每颗卫星每个观测时刻高精度的北斗载波相位观测值；步骤2：根据每颗卫星每个观测时刻高精度的北斗载波相位观测值，计算卫星之间的相邻两个观测时刻的高精度北斗载波相位差分观测值，利用卫星间北斗载波相位差分观测值之差作为输入观测量，通过最小二乘解算得到位置变化量，根据当前观测时刻的动态位置结合当前观测时刻与下一观测时刻之间的高精度位置变化量递推得到第下一观测时刻的动态位置，利用卫星和
INS
下一观测时刻的动态位置信息构建松组合观测方程，利用
INS
动态位置预测当前和下一观测时刻的伪距观测值计算其相邻两个观测时刻的伪距差分观测值，利用卫星间北斗载波相位差分观测值之差和
INS
预测伪距差分观测值之差作为输入观测量构建紧组合观测方程；步骤3：根据下一观测时刻动态目标的卫星可见数以及空间位置精度因子，利用前述步骤2的中文描述进行动态基准位置最优解算，结合
INS
机械编排得到的动态位置，获得动态目标当观测时刻与下一观测时刻之间间实时高频的动态基准位置结果
。3.
根据权利要求2所述的高频动态目标基准位置估测方法，其特征在于：步骤1所述通过
INS
辅助修复每颗卫星每个观测时刻的北斗载波相位观测值，具体如下：步骤
1.1
：对每颗卫星北斗载波相位差分观测值对应残差进行卡方检验，若卡方检验不通过时，残差最大值对应的卫星观测值标记为周跳类型，在状态向量中增加新的周跳参数，
解算得到周跳类型卫星的周跳浮点值
。
步骤
1.2
：重复步骤
1.1
解算直到每颗卫星北斗载波相位差分观测值对应残差通过卡方检验，根据步骤
1.2
标记的结果，对发生周跳卫星的周跳浮点值进行
LAMBDA
整数固定获得周跳的整数值，修复相应卫星的北斗载波相位观测值，得到高精度的载波相位观测值
。4.
根据权利要求3所述的高频动态目标基准位置估测方法，其特征在于：步骤2所述计算卫星之间的相邻两个观测时刻的高精度北斗载波相位差分观测值，具体如下：计算卫星
i
和卫星
j
的相邻两个观测时刻的高精度北斗载波相位差分观测值，将北斗载波相位差分观测值进行作差，表示为：
k∈[1,NT]
其中，
NT
表示观测时刻的数量，
λ
表示波长，
i
表示第
i
颗卫星，
j
表示第
j
颗卫星，
i∈[1,N]
，
j∈[1,M]
，
i≠j
，
N
和
M
分别表示卫星数量，表示第
k
与
k+1
观测时刻间卫星
i
与
j
载波相位差分观测值之差，其中，表示第
k
观测时刻间卫星
i
的载波相位观测值，表示第
k+1
观测时刻间卫星
i
的载波相位观测值，表示第
k
观测时刻间卫星
j
的载波相位观测值，表示第
k+1
观测时刻间卫星
j
的载波相位观测值
。
表示第
k
与
k+1
观测时刻间卫星
i
的方向余弦之差；的方向余弦之差；的方向余弦之差；其中，表示第
k
与
k+1
观测时刻间卫星
i
的方向余弦之差，表示第
k
观测时刻动态位置的
X
轴坐标，表示第
k
观测时刻动态位置的
Y
轴坐标，表示第
k
观测时刻动态位置的
Z
轴坐标，表示第
k
观测时刻卫星
i
轨道的
X
轴坐标，表示第
k
观测时刻卫星
i
轨道的
Y
轴坐标，表示第
k
观测时刻卫星
i
轨道的
Z
轴坐标，表示第
k
观测时刻动态位置与卫星
i
间的距离；表示第
k+1
观测时刻动态位置的
X
轴坐标，表示第
k+1
观测时刻动态位置的
Y
轴坐标，表示第
k+1
观测时刻动态位置的
Z
轴坐标，表示第
k+1
观测时刻卫星
i
轨道的
X
轴坐标，表示第
k+1
观测时刻卫星
i
轨道的
Y
轴坐标，表示第
k+1
观测时刻卫星
i
轨道的
Z
轴坐标，表示第
k+1
观测时刻动态位置与卫星
i
间的距离；
其中，表示第
k
与
k+1
观测时刻间卫星
j
的方向余弦之差，表示第
k
观测时刻动态位置的
X
轴坐标，表示第
k
观测时刻动态位置的
Y
轴坐标，表示第
k
观测时刻动态位置的
Z
轴坐标，表示第
k
观测时刻卫星
j
轨道的
X
轴坐标，表示第
k
观测时刻卫星
j
轨道的
Y
轴坐标，表示第
k
观测时刻卫星
j
轨道的
Z
轴坐标，表示第
k
观测时刻动态位置与卫星
j
间的距离
。
表示第
k+1
观测时刻动态位置的
X
轴坐标，表示第
k+1
观测时刻动态位置的
Y
轴坐标，表示第
k+1
观测时刻动态位置的
Z
轴坐标，表示第
k+1
观测时刻卫星
j
轨道的
X
轴坐标，表示第
k+1
观测时刻卫星
j
轨道的
Y
轴坐标，表示第
k+1
观测时刻卫星
j
轨道的
Z
轴坐标，表示第
k+1
观测时刻动态位置与卫星
j
间的距离；表示第
k
与
k+1
观测时刻间的位置变化量，表示第
k
与
k+1
观测时刻间卫星
i
与
j
的载波相位差分观测值残差之差，
k
表示第
k
个观测时刻，
k+1
表示第
k+1
个观测时刻；其中，
x
k
表示第
k
观测时刻间动态位置的
X
轴坐标，
x
k+1
表示第
k+1
观测时刻间动态位置的
X
轴坐标，
y
k
表示第
k
观测时刻间动态位置的
Y
轴坐标，
y
k+1
表示第
k+1
观测时刻间动态位置的
Y
轴坐标，
z
k
表示第
k
观测时刻间动态位置的
Z
轴坐标，
z
k+1
表示第
k+1
观测时刻间动态位置的
Z
轴坐标
。
其中，表示第
k
观测时刻间卫星
i
的载波相位观测值残差，表示第
k+1
观测时刻间卫星
i
的载波相位观测值残差，表示第
k
观测时刻间卫星
j
的载波相位观测值残差，表示第
k+1
观测时刻间卫星
j
的载波相位观测值残差
。5.
根据权利要求4所述的高频动态目标基准位置估测方法，其特征在于：步骤2所述利用卫星间北斗载波相位差分观测值之差作为输入观测量，通过最小二乘解算得到位置变化量，具体如下：其中，表示第
k
与
k+1
观测时刻间的位置变化量，
Δ
x
k,k+1
表示第
k
与
k+1
观测时刻间位置变化量的
X
轴坐标，
Δ
y
k,k+1
表示第
k
与
k+1
观测时刻间位置变化量...

【专利技术属性】
技术研发人员：李洋洋，唐卫明，邓辰龙，邹璇，张永峰，
申请(专利权)人：武汉大学，
类型：发明
国别省市：