Invariant EKF Slam

Photo by rawpixel on Unsplash

Completed as part of a graduate course at the University of Toronto | MATLAB.

Simultaneous Localization and Mapping (SLAM) has been a highly research problem and the techniques that solve it have undergone huge improvements in the last two decades. One of the most popular technique is the Extended Kalman filtering (EKF) approach, but it suffers from the problem of inconsistency. Out of the many ways developed to solve this problem, the Invariant Kalman filter based approach is quite interesting and offers provable mathematical guarantees. This project implements an Invariant EKF-SLAM method by representing the robot pose as a member of the special euclidean Lie group. The normalized estimation error square (NEES) metric is also computed which reveals that the given implementation, though works, is over-confident. The inconsistency appears during the process of loop closure and experiments are suggested for further investigation.

Abhinav Grover
Abhinav Grover
MASc Student and Researcher

Research student at the University of Toronto, interested in robot manipulation and tactile sensing.