一种基于鲁棒SCKF滤波的紧组合导航方法
摘要:
本发明公开了一种基于鲁棒SCKF滤波的紧组合导航方法。该方法步骤如下:通过轨迹发生器、卫星信号模拟器依次模拟生成导弹的IMU数据和GPS中频信号;将模拟生成的IMU数据进行惯导解算,将GPS中频信号注入软件接收机进行导航解算;建立发射惯性坐标系下GPS/SINS紧组合导航系统模型;在标准平方根容积卡尔曼滤波(SCKF)基础上,引入稳健M估计,对系统观测噪声阵进行自适应调节,构成鲁棒平方根容积卡尔曼滤波(RSCKF)算法,对系统状态进行滤波校正。本发明可有效消除系统中出现的观测异常误差,提高了GPS/SINS紧组合导航的抗干扰能力和导航精度。
0/0