Kalman Filter for Pose estimation using Lie Algebra - View it on GitHub