Here is a video of my EKF-SLAM code performing with 1 landmark. The red line is the EKF estimate while the blue and black lines are dead reckoning and true trajectory.

I adopted my code from I hope use my code to look at the error bounds of EKF-SLAM more closely after adapting it to use more landmarks.

Next Post Previous Post