针对粒子滤波算法存在的粒子退化现象和重要性密度函数难以选取等问题,在研究交互式多模型滤波算法的基础上,设计一种基于随机加权自适应IMMUPF算法。首先,该算法在无迹粒子滤波的采样过程中融合了随机加权和交互式多模型滤波的优点,利用无迹卡尔曼滤波算法得到[k]时刻各模型估计最新量测信息的粒子;然后,对该组粒子进行输入交互作为各模型的输入,再经过模型匹配、重采样以及模型概率更新过程;最后,对各模型相对应的粒子进行输出交互,得到所有粒子的随机加权自适应和的表达式,循环更新粒子实现状态估计。将设计的算法应用于GPS/DR组合导航系统中进行仿真计算,结果表明,该算法计算得到的位置误差较UPF和IMMUPF有所减少,东向位置误差控制在[-8 m,+6 m],北向位置误差控制在[-8 m,+8 m],提高了GPS/DR组合导航系统定位的解算精度。
1
基于无迹卡尔曼滤波ukf的粒子滤波matlab程序
2019-12-21 18:49:09 2KB upf
1