面向组合导航系统的导航定位方法及装置
摘要:
本发明提供一种面向组合导航系统的导航定位方法及装置,在该方法中,包括:基于惯导系统确定针对导航目标的第一导航定位信息,以及基于GPS系统确定针对导航目标的第二导航定位信息;GPS系统包含实时动态GPS模块和激光雷达模块;基于惯导系统的导航参数误差模型构建针对滤波模型的状态方程,以及基于惯导系统与GPS系统所输出的定位信息的偏差构建针对滤波模型的量测方程,滤波模型以导航参数误差作为状态量;基于滤波模型,确定对应量测信息的导航参数误差;滤波模型采用强跟踪卡尔曼滤波算法;基于导航参数误差,校正第一导航定位信息。由此,通过增量式自适应强跟踪卡尔曼滤波方法进行工作,实现高精度导航定位信息。
公开/授权文献
0/0