2D Extended Kalman filter SLAM with known correspondences - View it on GitHub