Unscented Kalman filter on matrix Lie groups implementation - View it on GitHub