Systematic Handling of Heterogeneous Geometric Primitives in Graph-SLAM Optimization
In this paper, we propose a pose-landmark graph optimization back-end that supports maps consisting of points, lines or planes. Our back-end allows representing both homogeneous (point-point, line-line, plane-plane) and heterogeneous measurements (point-on-line, point-on-plane, line-on-plane). Rathe…