|
Algorithm 2: Multiple Particle Filter Algorithm |
| 1: |
Input: ) |
| 2: |
Output) |
| 3: |
For ) iterations, follow the following procedure: |
| 4: |
|
| 5: |
If , then
|
| 6: |
) based on the
|
| 7: |
|
| 8: |
Move the particles diagonally by adding a diagonal distance to the particles |
| 9: |
Calculate for the weights of each particle |
| 10: |
Apply systemic resampling |
| 11: |
) to global particles repository |
| 12: |
Otherwise
|
| 13: |
)
|
| 14: |
Compute the distance between the landmark and the current
|
| 15: |
Move the particles diagonally by adding a diagonal distance to the particles |
| 16: |
Calculate the weights of each particle |
| 17: |
Apply systemic resampling |
| 18: |
Store particles (P) to global particles repository |
| 19: |
End |
| 20: |
)
|