联系人: 哈尔滨工程大学
所在地: 黑龙江哈尔滨市
摘要:本发明提供的是一种改进的粒子滤波方法。包括(1)运载体启动后,选取运载体状态函数及量测函数;(2)选取渐消因子和弱化因子;(3)采用STSRCKF设计重要性密度函数;(4)重新产生粒子;(5)计算粒子重要性权值并归一化;(6)重采样;(7)状态估计;(8)时刻迭代更新,判断当前时刻k是否为迭代终止时刻,若当前时刻k不是迭代终止时刻,则由当前时刻k更新到下一时刻k+1,重复执行步骤(2);若当前时刻k是迭代终止时刻,则结束,控制运载体停止运动。