一种基于纬度匹配与量测自适应加权的LEO卫星与IMU紧组合导航方法
本发明涉及组合导航的,特别是涉及一种基于纬度匹配与量测自适应加权的leo卫星与imu紧组合导航方法。
背景技术:
1、全球卫星导航系统在城市峡谷、林区、地下通道、强干扰和卫星导航拒止环境中,容易受到信号遮挡、多路径效应、电磁干扰及欺骗信号影响,导致可见卫星数量减少、定位精度下降甚至无法输出导航结果。
2、惯性测量单元不依赖外部无线信号,具有自主性强、短时连续性好的特点,但其输出中包含陀螺仪零偏、加速度计零偏及比例因子误差,位置、速度和姿态误差会随积分时间增加而不断累积。
3、低轨卫星具有轨道高度低、信号传播路径短、运行速度快以及星地几何构型变化迅速等特点,其伪距和多普勒观测能够为惯性导航提供外部位置和速度约束。因此,可利用低轨卫星观测与惯性测量数据构建组合导航系统。
4、然而,现有leo卫星与imu组合导航方法通常采用固定的卫星选择方式和固定量测噪声参数,未充分考虑用户纬度、卫星轨道倾角和星座空间分布之间的匹配关系。对于不同纬度区域,同一轨道构型的卫星可见数量、空间几何条件及多普勒观测敏感度存在明显差异。同时,低轨卫星观测质量还受到卫星仰角、轨道预报误差、多路径效应和高动态频率跟踪误差影响。若仍采用固定量测协方差矩阵,易导致低质量观测对滤波结果产生过大影响,降低组合导航精度和稳定性。
技术实现思路
1、本发明目的是为了解决现有leo卫星与imu组合导航方法在不同纬度区域和观测条件变化场景下适应能力不足的问题,提出了一种基于纬度匹配与量测自适应加权的leo卫星与imu紧组合导航方法。
2、本发明是通过以下技术方案实现的,本发明提出一种基于纬度匹配与量测自适应加权的leo卫星与imu紧组合导航方法,所述方法包括:
3、s1:构建leo卫星与imu紧组合导航系统的误差状态模型,并根据imu测量信息进行惯性导航机械编排,获得载体预测导航状态;
4、s2:根据载体预测纬度、leo卫星轨道倾角及卫星观测条件,计算候选leo卫星的纬度匹配系数,并确定参与紧组合导航的目标leo卫星;
5、s3:根据目标leo卫星的伪距观测量、多普勒观测量及载体预测导航状态构造紧组合量测残差,并根据目标leo卫星的纬度匹配系数、卫星仰角及量测新息自适应确定量测噪声协方差矩阵;
6、s4:采用扩展卡尔曼滤波估计惯性导航误差状态和接收机时钟误差状态,将所述误差状态反馈至惯性导航系统,输出校正后的载体位置、速度和姿态。
7、进一步地,在步骤s1中,误差状态向量表示为:
8、(1)
9、其中,为三维位置误差,为三维速度误差,为三维姿态误差,和分别为三轴陀螺仪零偏误差和三轴加速度计零偏误差,和分别为三轴陀螺仪比例因子误差和三轴加速度计比例因子误差,为接收机钟差误差,为接收机钟漂误差。
10、所述误差状态向量为23维;其连续时间状态方程为:
11、(2)
12、离散化后为:
13、(3)
14、其中,为误差状态转移矩阵,为系统噪声驱动矩阵,为离散状态转移矩阵,为离散系统噪声向量。
15、进一步地,步骤s2中,根据惯性导航机械编排得到的载体预测位置,计算用户预测纬度:
16、(4)
17、其中,为载体预测位置,为位置坐标到大地纬度的转换函数。
18、根据载体预测位置和第颗leo卫星的位置计算卫星仰角,将满足下式的卫星确定为候选leo卫星:
19、(5)
20、其中,为预设截止高度角,表示卫星位置和速度信息是否有效,表示该卫星是否具有至少一种有效观测量。
21、第颗候选leo卫星的纬度匹配系数为:
22、(6)
23、其中,为第颗leo卫星所属轨道面的轨道倾角,为纬度匹配函数。
24、进一步地,所述纬度匹配函数被配置为:
25、用户处于中低纬区域时,提高倾斜轨道leo卫星的纬度匹配系数;
26、用户处于高纬区域时,提高极轨或近极轨leo卫星的纬度匹配系数;
27、用户处于中低纬区域与高纬区域之间的过渡区域时,使不同轨道类型卫星的纬度匹配系数连续变化。
28、进一步地,为避免仅依据纬度进行硬切换,第颗候选leo卫星的综合评价量表示为:
29、(7)
30、其中,为卫星仰角质量指标,为卫星几何贡献指标;各权重均为非负数,并满足:
31、(8)
32、根据综合评价量对候选leo卫星进行排序,并在满足预设最小卫星数量以及量测矩阵可观测性要求的条件下,选取综合评价量相对高的候选leo卫星组成目标卫星集合。
33、进一步地,在步骤s3中,对于第颗具有有效伪距观测的目标leo卫星,其预测几何距离为:
34、(9)
35、预测伪距为:
36、(10)
37、伪距量测残差为:
38、(11)
39、其中,为第颗leo卫星的位置,为经预处理后的伪距观测量,为接收机钟差对应的等效距离预测值,为卫星钟差对应的等效距离改正值,和分别为对流层延迟和电离层延迟改正量。
40、进一步地,在步骤s3中,对于第颗具有有效多普勒观测的目标leo卫星,星地视线单位向量为:
41、(12)
42、预测伪距率为:
43、(13)
44、多普勒量测残差为:
45、(14)
46、其中,为leo卫星速度,为载体预测速度,和分别为接收机钟漂和卫星钟漂对应的等效距离率。
47、当接收机输出的是以赫兹为单位的多普勒频移时,伪距率观测量为:
48、(15)
49、其中,为对应leo卫星信号的载波波长。
50、将伪距量测残差和多普勒量测残差组合为:
51、(16)
52、其中,为量测矩阵,为量测噪声。
53、进一步地,在步骤s3中,第颗目标leo卫星的伪距先验量测噪声方差为:
54、(17)
55、多普勒先验量测噪声方差为:
56、(18)
57、其中,和分别为伪距和多普勒基准量测噪声方差,为多普勒跟踪质量指标,、、、和均为调节系数。
58、为保证量测噪声协方差矩阵正定,对各先验量测噪声方差设置正的下限和有限上限;
59、利用先验量测噪声协方差矩阵计算量测新息:
60、(19)
61、以及新息协方差矩阵:
62、(20)
63、第个标量量测的归一化新息平方为:
64、(21)
65、根据归一化新息平方计算量测噪声膨胀因子:
66、(22)
67、并得到自适应量测噪声方差:
68、(23)
69、(24)
70、函数为非减函数;当归一化新息平方处于正常范围时,;当归一化新息平方增大时,增大,降低对应量测的滤波权重;当归一化新息平方超过异常门限时,将对应量测噪声增大至预设上限或剔除对应量测;
71、对全部伪距和多普勒观测分别进行处理后,构造当前历元的自适应量测噪声协方差矩阵:
72、(25)。
73、进一步地,在步骤s4中,将步骤s3得到的自适应量测噪声协方差矩阵用于扩展卡尔曼滤波量测更新;进一步对位置和速度反馈校正、姿态反馈校正、陀螺仪零偏和加速度计零偏分别反馈校正、陀螺仪比例因子和加速度计比例因子分别反馈校正以及接收机钟差和钟漂分别反馈校正;利用校正后的惯性器件零偏和比例因子补偿后续imu输出,利用校正后的接收机钟差和钟漂计算下一历元的伪距和多普勒预测量;完成误差反馈校正后,将已经注入导航状态、惯性器件参数和接收机时钟参数的误差状态重置为零;对于姿态误差状态,根据误差状态重置关系对协方差矩阵进行相应变换;最后,输出校正后的载体位置、速度和姿态,并进入下一导航历元。
74、本发明还提出一种电子设备,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现所述一种基于纬度匹配与量测自适应加权的leo卫星与imu紧组合导航方法的步骤。
75、本发明的有益效果:
76、(1)本发明根据用户纬度和leo卫星轨道倾角建立纬度匹配关系,将星座轨道构型的区域覆盖特性引入卫星选择及量测加权过程,能够降低固定卫星选择方式与用户所在纬度区域不匹配所造成的观测约束不足。
77、(2)本发明根据纬度匹配程度、卫星仰角、信号跟踪质量和量测新息,分别调整各leo卫星伪距观测和多普勒观测对应的量测噪声,使不同卫星及不同类型的观测量按照各自可信程度参与滤波更新。
78、(3)本发明利用归一化新息对量测一致性进行检验,并通过增大量测噪声或者剔除异常量测降低异常伪距和异常多普勒对组合导航状态估计的影响。
79、(4)本发明将leo卫星伪距和多普勒观测直接引入误差状态扩展卡尔曼滤波,利用伪距提供的位置和钟差约束,利用多普勒提供的速度和钟漂约束,能够对惯性导航误差进行联合估计和反馈校正。
80、(5)本发明分别判断伪距观测和多普勒观测的有效性,当同一leo卫星仅能提供一种有效观测时,仍可利用该有效观测完成量测更新,从而提高leo机会信号观测信息的利用率。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com