An implementation of an Error State Kalman Filter (ESKF) - View it on GitHub