Invariant EKF Design for Scan Matching-Aided Localization

Localization in indoor environments is a technique that estimates the robot's pose by fusing data from onboard motion sensors with readings of the environment, in our case obtained by scan matching point clouds captured by a low-cost Kinect depth camera. We develop both an invariant extended Kalman filter (IEKF)-based and a multiplicative extended Kalman filter-based solution to this problem. The two designs are successfully validated in experiments and demonstrate the advantage of the IEKF design.