[发明专利]一种消除单点GPS高次位置误差的双频组合滤波器及滤波方法

摘要

本发明涉及一种消除单点GPS高次位置误差的双频组合滤波器及滤波方法，包括输入部分、高频组合部分、低频组合部分和输出部分；输入部分包括捷联惯性测量单元SIMU、GPS模块；高频组合部分包含捷联解算A和卡尔曼滤波器KF；低频组合部分包括捷联解算B和LSSVM滤波器；输出部分包括运动补偿单元；高频组合部分结构与传统的SINS/GPS组合导航结构相似，低频组合部分通过捷联解算B的独立性隔离单点GPS高次位置误差，由LSSVM在线学习和训练模型，将高频组合输出的位置信息中的高次误差滤除。此外，在每个低频滤波周期结束时，通过LSSVM的预测值为捷联解算B提供位置校准，防止其位置累积误差进入实时运动补偿单元，并且妥善处理了各个低频分段之间位置信息的衔接和补偿问题。

主权项

一种消除单点GPS高次位置误差的双频组合滤波器，其特征在于：基于最小二乘支持向量机LSSVM，采用高频滤波和低频滤波结合的双频组合滤波实现；所述双频组合滤波器包括：输入部分、高频组合部分、低频组合部分和输出部分；输入部分包括捷联惯性测量单元SIMU、GPS模块；高频组合部分包含捷联解算A模块和卡尔曼滤波器KF；低频组合部分包括捷联解算B模块和LSSVM滤波器；输出部分包括运动补偿单元；输入部分中，捷联惯性测量单元SIMU固定在遥感载荷的中心位置附近，将敏感到的加速度和角速度原始测量数据经过初始校准模块的初始校准后打包发送给捷联解算A模块和捷联解算B模块；GPS接收模块通过安装在遥感载荷上的GPS天线获取定位信息；定位信息包括位置和速度信息；高频组合部分中，捷联解算A模块将SIMU发送来的加速度和角速度原始测量数据通过坐标转换和积分解算出当前时刻导航输出的位置和姿态信息，卡尔曼滤波器KF利用GPS模块的定位信息和捷联解算A模块当前时刻导航输出的位置和速度信息之差作为观测量进行组合，并将最优估计量反馈校正给捷联解算A模块，从而进行最优估计；同时捷联解算A模块将当前时刻的位置信息送往LSSVM滤波器和捷联解算B模块；低频组合中，捷联解算B模块将SIMU发送来的加速度和角速度原始测量数据通过坐标转换和积分解算出当前时刻导航输出的位置和姿态信息，当前时刻的位置信息送往LSSVM滤波器；LSSVM滤波器采用捷联解算A模块的位置信息和捷联解算B模块的位置信息实时更新训练集，训练集通过LSSVM算法学习得出训练模型，预测下一时刻的位置信息，循环迭代，得到位置信息的预测结果，该预测结果即是在线消除了高次位置误差后的位置信息；同时为了抑制捷联解算B模块的位置累积误差，避免捷联解算B模块的累积位置误差进入运动补偿单元而降低成像分辨率，每隔时间T便通过LSSVM的预测位置信息对捷联解算B模块的位置信息进行在线校正，避免捷联解算B模块累积位置误差，并通过捷联解算A模块向捷联解算B模块传递姿态和速度校正信息；输出部分，将低频组合部分中的消除了高次位置误差后的位置信息发送给运动补偿单元，运动补偿单元对遥感载荷进行高分辨率实时成像，从而消除单点GPS高次位置误差。