Implementing a Kalman and Particle filter
This is an extension of the Matlab Particle filter created by Andreas Svensson (http://youtu.be/aUkBa1zMKv4).
Within the same landscape, a Kalman filter can be used. Some landscape functions have been left in for testing