Observability-Constrained (OC)-EKF for 2D SLAM - View it on GitHub