尾矿库排洪隧洞探测机器人多传感器融合定位
周祎博1
周唯逸2
郭振武1
王斌锐1
1.中国计量大学 机电工程学院, 浙江 杭州 3100182.国网浙江乐清市供电公司, 浙江 温州 311799
摘要：尾矿库排洪隧洞内环境复杂,现有探测机器人定位算法存在弱纹理室内场景定位失效的问题,难以适用于该类环境下探测机器人的精确定位和累计误差消除.针对上述问题,提出了一种适用于尾矿库排洪隧洞环境的探测机器人多传感器融合定位算法.该算法基于测程法和图论,利用ArUco码将排洪隧洞环境的远距离定位简化为多段短距离定位.首先利用UMBmark算法进行里程计标定,有效消除探测机器人轮径和轴径两类系统误差;然后利用扩展卡尔曼滤波(EKF)算法融合里程计和惯导模块(IMU)信息,利用测程法实现运动过程中探测机器人位置和姿态信息计算;最后利用ArUco码作为路标并固定于隧洞内部,探测机器人携带标定后的相机对ArUco码信息进行识别与处理,利用各传感器量测值形成约束,结合图优化方法实现位姿优化,并根据ArUco码携带的信息消除累计误差,从而实现狭长空间弱纹理场景下探测机器人的远距离高精度定位.在尾矿库排洪隧洞实际场景中运行和关闭多传感器融合定位算法,分别进行10组行进40?m的重复定位实验,结果表明:多传感器融合定位算法具有较高的稳定性和精确性,能有效校正累计误差,实现探测机器人在排洪隧洞环境中的精确定位,行进20?m的平均定位误差为19.77?cm,40?m的平均定位误差为21.23?cm,且行进20?m校正后误差均值为4.2?mm.
关键词：尾矿库排洪隧洞探测机器人多传感器融合定位自主定位多段短距离定位
分类号：TD67(矿山电工)
资助基金：国家重点研发计划(2017YFC0804609)国家重点研发计划(SQ2018YFB210028)
论文发表日期：2022-03-10
在线出版日期：2025-08-15（本平台首次上网日期，不代表文献的发表时间）
页数：8( 78-85 )
英文信息