Kalman filter using C++ and Manif - View it on GitHub