Matlab implementation of a 2D and 3D Point Mass Filter (PMF). This implementation is based on the descritption from Niclas Bergman's Thesis: Recursive Bayesian Estimation Navigation and Tracking Applications, Chapter 5. Both implemenations rely on N-dimensional sparse arrays which is included in this distribution.
In your matlab Command Window make sure you are outside the point-mass-filter directory and run:
The folder PMF_2D contains two examples of how to use the 2D PMF filter.
Run script Example1.m and you should see an orange packman agent follows a circular motion whilst measuring distances and bearings (red line) to a wall (black line). You should see both figures illustrated below after runing the scripts.
Run script Example1.m and you should see the figure below appear. To control the agent use your arrow keys and press Esc to exit the simulation loop.