engleski

Exactly Sparse Delayed State Filter on Lie groups for Long-term Pose Graph SLAM

In this paper we propose a SLAM back-end solution called the exactly sparse delayed state filter on Lie groups (LG-ESDSF). We derive LG- ESDSF and demonstrate that it retains all the good characteristics of the classic Euclidean ESDSF—main being the exact sparsity of the information matrix. The key advantage of LG- ESDSF in comparison to the classic ESDSF lies in the ability to respect the state space geometry by negotiating uncertainties and employing filtering equations directly on Lie groups. We also exploit the special structure of the information matrix in order to allow long-term operation while the robot is moving repeatedly through the same environment. To prove the effectiveness of the proposed SLAM solution, we conducted extensive experiments on two different publicly available datasets, namely the KITTI and EuRoC dataset, using two front-ends: one based on the stereo camera and the other on the 3D LIDAR. We compare LG-ESDSF with the general graph optimization framework (g2o) when coupled with the same front-ends. Similarly to g2o the proposed LG-ESDSF is front-end agnostic and the comparison demonstrates that our solution can match the accuracy of g2o, while maintaining faster computation times. Furthermore, the proposed back-end coupled with the stereo camera front-end forms a complete visual SLAM solution dubbed LG-SLAM. In the end, we evaluated LG-SLAM using the online KITTI protocol and at the time of writing it achieved the second best result among the stereo odometry solutions and the best result among the tested SLAM algorithms.

SLAM ; exactly sparse delayed state filter ; Lie groups ; graph optimization

nije evidentirano