LIU Shijie, ZOU Yuan, ZHANG Xudong. A localization and navigation method for underground mine autonomous driving based on local geometric topology map[J]. Journal of Mine Automation,2023,49(8):70-80. DOI: 10.13272/j.issn.1671-251x.2023020010
Citation: LIU Shijie, ZOU Yuan, ZHANG Xudong. A localization and navigation method for underground mine autonomous driving based on local geometric topology map[J]. Journal of Mine Automation,2023,49(8):70-80. DOI: 10.13272/j.issn.1671-251x.2023020010

A localization and navigation method for underground mine autonomous driving based on local geometric topology map

More Information
  • Received Date: February 01, 2023
  • Revised Date: August 14, 2023
  • Available Online: September 03, 2023
  • Unmanned driving technology has enormous advantages in improving efficiency, saving costs and reducing safety hazards. In the current implementation of localization and navigation solutions in underground environments, there are problems of implementation difficulties, high costs, and time-consuming construction of maps. In order to solve the above problems, a localization and navigation method for underground mine autonomous driving based on local geometric topology map is proposed. A local geometric topology map has been designed. The main structure of the underground environment road network is represented by a topology map. The map defines roadways (sides) and intersections (nodes), and stores a local geometric map built around the node in each node to achieve precise positioning at the node. A localization method based on local geometric topology map is proposed, which uses a LiDAR-based intersection detection algorithm and intersection localization algorithm for global vehicle localization. A trajectory-following algorithm based on adaptive model predictive control (MPC) has been designed to ensure the path-tracking precision of vehicles turning at high curvature intersections. A simulation environment and vehicle simulation model for underground mines are constructed by using a 3D physical simulation platform. The simulation results show that this method can achieve underground mine autonomous driving localization and navigation functions. The positioning errors are within 0.2 m at various types of intersections, meeting the positioning localization precision requirements of autonomous driving. Throughout the entire driving process, the vehicle maintains a relatively stable driving state and a small tracking error. Compared with the current localization and navigation methods that rely on technologies such as 5G and UWB, this method only relies on two types of vehicle sensors: LiDAR and inertial measurement unit. It has great advantages in controlling equipment costs.
  • [1]
    SCHEDING S,DISSANAYAKE G,NEBOT E M,et al. An experiment in autonomous navigation of an underground mining vehicle[J]. IEEE Transactions on Robotics & Automation,2001,15(1):85-95.
    [2]
    DUFF E S, ROBERTS J M, CORKE P I. Automation of an underground mining vehicle using reactive navigation and opportunistic localization[C]. IEEE/RSJ International Conference on Intelligent Robots and Systems, Las Vegas, 2003:3775-3780.
    [3]
    MEECH J,PARREIRA J. An interactive simulation model of human drivers to study autonomous haulage trucks[J]. Procedia Computer Science,2011,6(1):118-123.
    [4]
    SZREK J, ZIMROZ R, WODECKI J, et al. Application of the infrared thermography and unmanned ground vehicle for rescue action support in underground mine-the AMICOS project[J]. Remote Sensing, 2021, 13(1). DOI: 10.3390/rs13010069.
    [5]
    张元刚,刘坤,白猛,等. 井下多传感器组合导航系统[J]. 工矿自动化,2019,45(7):10-16.

    ZHANG Yuangang,LIU Kun,BAI Meng,et al. Underground multi-sensor integrated navigation system[J]. Industry and Mine Automation,2019,45(7):10-16.
    [6]
    杨林,马宏伟,王岩,等. 煤矿巡检机器人同步定位与地图构建方法研究[J]. 工矿自动化,2019,45(9):18-24.

    YANG Lin,MA Hongwei,WANG Yan,et al. Research on method of simultaneous localization and mapping of coal mine inspection robot[J]. Industry and Mine Automation,2019,45(9):18-24.
    [7]
    CHEHRI A,FORTIER P,TARDIF P M. UWB-based sensor networks for localization in mining environments[J]. Ad Hoc Networks,2009,7(5):987-1000. DOI: 10.1016/j.adhoc.2008.08.007
    [8]
    杜京义,郭金宝,张渤. 井下无人驾驶列车惯性导航定位系统[J]. 工矿自动化,2018,44(9):5-9.

    DU Jingyi,GUO Jinbao,ZHANG Bo. Inertial navigation and positioning system for underground driverless train[J]. Industry and Mine Automation,2018,44(9):5-9.
    [9]
    周李兵. 煤矿井下无轨胶轮车无人驾驶系统研究[J]. 工矿自动化,2022,48(6):36-48.

    ZHOU Libing. Research on unmanned driving system of underground trackless rubber-tyred vehicle in coal mine[J]. Journal of Mine Automation,2022,48(6):36-48.
    [10]
    陈伟. 煤矿井下精确定位系统研究[J]. 工矿自动化,2019,45(12):86-90.

    CHEN Wei. Research on precise positioning system of coal mine underground[J]. Industry and Mine Automation,2019,45(12):86-90.
    [11]
    孙继平,江嬴. 矿井车辆无人驾驶关键技术研究[J]. 工矿自动化,2022,48(5):1-5,31.

    SUN Jiping,JIANG Ying. Research on key technologies of mine unmanned vehicle[J]. Journal of Mine Automation,2022,48(5):1-5,31.
    [12]
    李论. 基于RSSI的煤矿巷道高精度定位算法研究[D]. 徐州: 中国矿业大学, 2015.

    LI Lun. Research of precision positioning algorithm based on RSSI in coal mine tunnel[D]. Xuzhou: China University of Mining and Technology, 2015.
    [13]
    唐丽均,吴畏. 煤矿井下精确定位系统中的节点设计[J]. 煤炭工程,2015,47(6):18-20.

    TANG Lijun,WU Wei. Node design in accurate positioning system for underground coal mine[J]. Coal Engineering,2015,47(6):18-20.
    [14]
    游小荣,裴浩,霍振龙. 一种基于UWB的三边定位改进算法[J]. 工矿自动化,2019,45(11):19-23.

    YOU Xiaorong,PEI Hao,HUO Zhenlong. An improved trilateral positioning algorithm based on UWB[J]. Industry and Mine Automation,2019,45(11):19-23.
    [15]
    RADACINA RUSU S. Real-time localization in large-scale underground environments using RFID-based node maps[D]. Ottawa: Carleton University, 2011.
    [16]
    LARSON E J. Vehicle localization in an underground mine using ultrasonic sensors[D]. Golden: Colorado School of Mines, 2012.
    [17]
    MASCARÓ M,PARRA-TSUNEKAWA I,TAMPIER C,et al. Topological navigation and localization in tunnels-application to autonomous load-haul-dump vehicles operating in underground mines[J]. Applied Sciences,2021,11(14):6547. DOI: 10.3390/app11146547
    [18]
    MARSHALL J,BARFOOT T,LARSSON J. Autonomous underground tramming for center-articulated vehicles[J]. Journal of Field Robotics,2008,25(6):400-421.
    [19]
    HABIB M K, YUTA S. Map representation and path planning for mobile robots in a building environment[C]. IEEE International Workshap on Intelligent Robots, Tokyo, 1988: 173-178.
    [20]
    KUIPERS B,BRUYN Y T. A robot exploration and mapping strategy based on a semantic hierarchy of spacial representations[J]. Robotics and Autonomous Systems,1991,8:47-63. DOI: 10.1016/0921-8890(91)90014-C
    [21]
    LI Qingquan,CHEN Long,ZHU Quanwen,et al. Intersection detection and recognition for autonomous urban driving using a virtual cylindrical scanner[J]. Intelligent Transport Systems,2014,8(3):244-254. DOI: 10.1049/iet-its.2012.0202
    [22]
    崔文,薛棋文,李庆玲,等. 基于三维点云地图和ESKF的无人车融合定位方法[J]. 工矿自动化,2022,48(9):116-122.

    CUI Wen,XUE Qiwen,LI Qingling,et al. Unmanned vehicle fusion positioning method based on 3D point cloud map and ESKF[J]. Journal of Mine Automation,2022,48(9):116-122.
    [23]
    BESL P J,MCKAY H D. A method for registration of 3-D shapes[J]. IEEE Transactions on Pattern Analysis & Machine Intelligence,1992,14(2):239-256.
    [24]
    顾文华,周波,戴先中. 基于ICP匹配算法的室内移动机器人定位[J]. 华中科技大学学报(自然科学版),2013,41(增刊1):262-266.

    GU Wenhua,ZHOU Bo,DAI Xianzhong. ICP matching algorithm-based localization of indoor mobile robots[J]. Journal of Huazhong University of Science and Technology(Natural Science Edition),2013,41(S1):262-266.
    [25]
    BIBER P, STRASSER W. The normal distributions transform: a new approach to laser scan matching[C]. IEEE/RSJ International Conference on Intelligent Robots & Systems, Las Vegas, 2003: 2743-2748.
    [26]
    余洪山,付强,孙健,等. 面向室内移动机器人的改进3D−NDT点云配准算法[J]. 仪器仪表学报,2019,40(9):151-161.

    YU Hongshan,FU Qiang,SUN Jian,et al. Improved 3D-NDT point cloud registration algorithm for indoor mobile robot[J]. Chinese Journal of Scientific Instrument,2019,40(9):151-161.
    [27]
    CHEN B, TSAI C, LEE K. Path-following steering controller of automated lane change system with adaptive preview time[C]. IEEE International Conference on Systems, Man, and Cybernetics, Hong Kong, 2015: 2522-2526.
  • Related Articles

    [1]LIU Ruohan, LIU Yongli, LIU Shuang. A calculation model for the associated position interference between the boom and shovel table mechanisms of intelligent roadheader[J]. Journal of Mine Automation, 2024, 50(3): 114-121. DOI: 10.13272/j.issn.1671-251x.2023090014
    [2]GUO Lunfeng, GUO Yinan, JIANG Kangqing, GE Shirong. Measurement and calculation method of attitude parameters of roadheader[J]. Journal of Mine Automation, 2021, 47(12): 46-54. DOI: 10.13272/j.issn.1671-251x.2021070010
    [3]WU Fengliang, HE Xiaochen, CHANG Xintan, MA Li, LI Chao. Research on simulation technology of surface air leakage of shallow-buried goaf based on network calculatio[J]. Journal of Mine Automation, 2017, 43(12): 64-69. DOI: 10.13272/j.issn.1671-251x.2017.12.013
    [4]ZHANG Qing, WANG Xuewen, XIE Jiacheng, PANG Xinyu, YANG Zhaojian. Shearer position and attitude adjustment based on strapdown inertial navigation system[J]. Journal of Mine Automation, 2017, 43(10): 83-89. DOI: 10.13272/j.issn.1671-251x.2017.10.017
    [5]ZHANG Yuanzheng. Design of air flow switch sensor of air duct based on attitude recognition technology[J]. Journal of Mine Automation, 2016, 42(9): 9-12. DOI: 10.13272/j.issn.1671-251x.2016.09.003
    [6]HAO Shangqing, WANG Shibo, XIE Guijun, GE Zhaoliang, LI Ang. Research of determination technologies of position and attitude of shearer on long-wall fully mechanized coal mining face[J]. Journal of Mine Automation, 2014, 40(6): 21-25. DOI: 10.13272/j.issn.1671-251x.2014.06.006
    [7]HAN Liang. Position estimation of low-resolution Hall sensors based on current compensatio[J]. Journal of Mine Automation, 2013, 39(7): 46-49.
    [8]ZHU Guo-yua. Research of Position Detected Sensor of Mine-used Locomotive Based on Geomagnetic Induction[J]. Journal of Mine Automation, 2010, 36(6): 8-11.
    [9]REN Jian-qiang. A New Method of Real-time Reading of Pointer Meter of Industry and Mine Based on Difference Image Processing and Angle-proportionment Calculatio[J]. Journal of Mine Automation, 2009, 35(5): 18-21.
    [10]JIANG Xiu-zhu~, FENG Dong-qin~, XU Zhao~. Analysis of Real-time Performance of EPA and Its Calculatio[J]. Journal of Mine Automation, 2009, 35(4): 39-43.
  • Cited by

    Periodical cited type(1)

    1. 吴泽迅,闫荣格,郭晓婷,曹少卿. 无线电能传输系统传输距离及传输效率分析. 电源技术. 2020(08): 1212-1216 .

    Other cited types(2)

Catalog

    Article Metrics

    Article views (144) PDF downloads (34) Cited by(3)
    Related

    /

    DownLoad:  Full-Size Img  PowerPoint
    Return
    Return