一种改进的粒子滤波方法

摘要

本发明提供的是一种改进的粒子滤波方法。包括：（1）运载体启动后，选取运载体状态函数及量测函数；（2）选取渐消因子和弱化因子；（3）采用STSRCKF设计重要性密度函数；（4）重新产生粒子；（5）计算粒子重要性权值并归一化；（6）重采样；（7）状态估计；（8）时刻迭代更新，判断当前时刻k是否为迭代终止时刻，若当前时刻k不是迭代终止时刻，则由当前时刻k更新到下一时刻k+1，重复执行步骤（2）；若当前时刻k是迭代终止时刻，则结束，控制运载体停止运动。