等式状态约束下的粒子滤波算法

Particle Filtering with Equality State Constraints

  • 摘要: 针对具有等式状态约束的非线性高斯系统滤波问题,在粒子滤波过程中,通过投影方法将状态向量投影到状态约束子空间,利用拉格朗日乘子法求解修正后的状态向量。由于在粒子滤波算法中可以针对状态估计或者粒子集修正,因此,对应了两种能够处理等式状态约束的粒子滤波方法。新方法与常规粒子滤波算法相比滤波误差明显降低。仿真结果验证了新方法的有效性。

     

    Abstract: The paper aims at the problem of nonlinear Gaussian system filtering with state constraints. In particle filtering, state vector is projected to the state constrained subspace via projection method, and the modified state vector is evaluated using the Lagrange multiplier method. Because either state estimation or particles can be modified in the particle filtering, two new methods are given to deal with particle filtering with equality state constraints. The filtering errors of the new methods are lower than the that of general particle filter obviously. Simulation results verify the effectiveness of the new methods.

     

/

返回文章
返回