Example run: Problem3.txt

Compare this example with Problem1.txt and note how the masurements correct the state estimate and reduce its uncertainty.

Also note that I've made the window slightly bigger than the world so that you can see the laser beam, even when it falls outside the world boundary.


Initial starting configuration:

After first movement:

First laser rangefinder measurement:

Corrected state estimate and covariance:

After second movement:

Second laser rangefinder measurement:

Corrected state estimate and covariance:

After third movement:

Third laser rangefinder measurement:

Corrected state estimate and covariance:

After fourth movement: