Example code for contact-aided invariant extended Kalman filtering. - View it on GitHub