融合语义路标的煤矿井下多传感器建图与定位方法

Multi-sensor mapping and localization method in underground coal mines based on semantic landmarks

  • 摘要: 同步定位与建图(SLAM)是实现矿用机器人自主导航的关键技术,受煤矿井下环境特征稀疏、重复度高等影响,存在定位误差累计显著、重定位耗时长等问题。针对该问题,提出了一种融合语义路标的煤矿井下多传感器建图与定位方法:通过系统融合视觉里程计、惯导里程计与激光里程计的观测信息,构建紧耦合的多传感器融合里程计系统,提升特征缺失环境下定位的鲁棒性;定义适用于井下环境的语义路标,通过建立巷道结构特征与路标编码信息的映射关系,构建包含空间几何特征和自定义语义标签的融合语义路标地图,以解决因巷道特征重复性高而导致的重定位效率低和特征误匹配问题;利用语义路标实时修正里程计累计误差,实现机器人位姿动态校正。基于冲尘机器人平台开展地面隧道环境下试验和井下工业性试验,结果表明:该方法在地面隧道中的建图误差平均值为0.020 m,静态定位误差最大值为0.035 m,动态定位绝对位姿误差最大值为0.153 m,平均重定位时间为3.3 s;在井下巷道中可构建2 400 m全局地图,百米地图平均误差为0.038 m,可实现机器人自主导航。

     

    Abstract: Simultaneous Localization and Mapping (SLAM) is a key technology for achieving autonomous navigation of mining robots. However, due to sparse and highly repetitive environmental features in underground coal mines, significant cumulative localization errors and prolonged relocalization times occur. To address this problem, a multi-sensor mapping and localization method for underground coal mines based on semantic landmarks was proposed. The method integrated observation information from visual odometry, inertial odometry, and LiDAR odometry to construct a tightly coupled multi-sensor fusion odometry system, thereby improving localization robustness in feature-deficient environments. Semantic landmarks suitable for underground environments were defined. By establishing a mapping relationship between roadway structural features and landmark encoding information, a fused semantic landmark map containing spatial geometric features and customized semantic labels was constructed to solve low relocalization efficiency and feature mismatches caused by the high repetitiveness of roadway features. Semantic landmarks were used to correct cumulative odometry errors in real time to achieve dynamic pose correction of the robot. Experiments were conducted using a dust suppression robot platform in surface tunnel environments and in underground industrial tests. The results showed that the average mapping error in the ground tunnel was 0.020 m, the maximum static localization error was 0.035 m, the maximum absolute pose error in dynamic localization was 0.153 m, and the average relocalization time was 3.3 s. In underground roadways, a global map covering 2 400 m was constructed, with an average error of 0.038 m per 100 m, and autonomous navigation of the robot was achieved.

     

/

返回文章
返回