Algorithm 1.
Measurement Update
| 1: | /* sample M particles from importance function */ |
| 2: | . |
| 3: | /* compute particle weights */ |
| 4: | . |
| 5: | /* normalize the weights */ |
| 6: | . |
| 7: | /* calculate the filtered distribution */ |
| 8: | , |
| 9: | . |
Measurement Update
| 1: | /* sample M particles from importance function */ |
| 2: | . |
| 3: | /* compute particle weights */ |
| 4: | . |
| 5: | /* normalize the weights */ |
| 6: | . |
| 7: | /* calculate the filtered distribution */ |
| 8: | , |
| 9: | . |