Matlab code used for the paper " Invariant Kalman Filtering for Visual Inertial SLAM" - View it on GitHub