In order to improve the outdoor long-endurance positioning accuracy of robots,the developing and application of graph optimization-based global navigation satellite system(GNSS)/stereo visual/inertial simultaneous localization and mapping(SLAM)system is proposed.As the extra geometrical constraints,the spatial line features are integrated into the threads of the front-end feature extraction and back-end pose optimization to enhance the pose estimates.At the same time,the graph structure for joint optimization is constructed via factor graphs and the global observation error model is further derived.The nearly 200-meter-long BullDog-CX robot substation experiment shows that compared with VINS-Fusion and PL-VINS,the proposed algorithm has achieved about 12.6%and 3.4%improvement in positioning accuracy,which provides a feasible scheme for long-endurance navigation of outdoor robots.
关键词
GNSS/双目视觉/惯性SLAM系统/图优化/线特征约束/全局观测/多传感器融合
Key words
GNSS/stereo visual/inertial SLAM system/graph optimization/line feature constraint/global observation/multi-sensor fusion