Skip to main content
. Author manuscript; available in PMC: 2022 Mar 8.
Published in final edited form as: IFAC Pap OnLine. 2021 Sep 15;54(7):511–516. doi: 10.1016/j.ifacol.2021.08.411

Algorithm 1.

Measurement Update

1: /* sample M particles from importance function */
2: x˜ti~π(xtY1:t),i=1,,M.
3: /* compute particle weights */
4: w˜tipθ(ytx˜ti)j=1Mpθ(ytx˜tj),i,j=1,,M.
5: /* normalize the weights */
6: wti=w˜tij=1Mw˜tj,i,j=1,,M.
7: /* calculate the filtered distribution */
8: μt=j=1Mwtjx˜tj,
9: Σt=j=1Mwtj(μtx˜tj)(μtx˜tj)T.