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]ZHAI Xiaowei, WANG Chen, HAO Le, LI Xintian, HOU Qinyuan, MA Teng. Study on the temperature prediction model of residual coal in goaf based on ACO-KELM[J]. Journal of Mine Automation, 2024, 50(12): 128-135. DOI: 10.13272/j.issn.1671-251x.18226
    [2]ZHANG Baojun, MENG Qinglin, LIU Peng, JI Xiang, LIU Wei, ZHANG Dezheng, LU Weiqiang. Research on the application of modulated model predictive control in coal mine power quality management based on STATCOM[J]. Journal of Mine Automation, 2023, 49(10): 17-25. DOI: 10.13272/j.issn.1671-251x.18087
    [3]REN Huaiwei, ZHANG Shuai, XUE Guohua, ZHAO Shuji, ZHANG Yuliang, LI Jian. Research on the dynamic law of automatic following of hydraulic support[J]. Journal of Mine Automation, 2023, 49(9): 47-54. DOI: 10.13272/j.issn.1671-251x.18133
    [4]LIU Minqiang, GAO Xiaoqiang, CHEN Gang. Track protection method of unmanned transport vehicle in open-pit mine[J]. Journal of Mine Automation, 2022, 48(S1): 80-82,91.
    [5]CAO Xiaodong, YANG Shihai, JI Feng, YE Zongbin. Low loss control of explosion-proof frequency converter based on model predictive control[J]. Journal of Mine Automation, 2019, 45(2): 85-90. DOI: 10.13272/j.issn.1671-251x.2018100008
    [6]CHEN Shun, ZHENG Nanshan, QI Yun, BAN Meng. Application research on Offset Tracking technology in monitoring oflarge surface deformation in coal mine subsidence area[J]. Journal of Mine Automation, 2017, 43(6): 32-37. DOI: 10.13272/j.issn.1671-251x.2017.06.008
    [7]SHI Yong, LIN Jiang, CUI Zhifang, YUAN Xiaoqin. Mathematical model of automatic following control in the middle of fully mechanized mining face[J]. Journal of Mine Automation, 2016, 42(11): 14-19. DOI: 10.13272/j.issn.1671-251x.2016.11.004
    [8]ZHAO Jianwei, WANG Hongyan, TANG Bing, YANG Zhongya. Research of GPS track generation and location based on mobile robot[J]. Journal of Mine Automation, 2016, 42(1): 17-19. DOI: 10.13272/j.issn.1671-251x.2016.01.006
    [9]ZHANG Xuan, LI Chonggui, YANG Fa. Research of algorithm of walking track for underground personnel[J]. Journal of Mine Automation, 2014, 40(1): 42-45. DOI: 10.13272/j.issn.1671-251x.2014.01.012
    [10]NIU Chao, YAO Yu-mei. Research of Adaptive Backstepping Control of Crane Hoisting System[J]. Journal of Mine Automation, 2011, 37(9): 67-71.
  • Cited by

    Periodical cited type(2)

    1. 胡青松,李鹤,罗渝嘉,王柳笛,寇志豪,李世银. 多径与非视距影响下的精确目标定位关键技术. 金属矿山. 2024(11): 173-184 .
    2. 王佳恒,王天鑫,王晋淼. 基于体素的地下矿山三维点云地图增量式更新方法. 采矿技术. 2024(06): 243-247 .

    Other cited types(8)

Catalog

    Article Metrics

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

    /

    DownLoad:  Full-Size Img  PowerPoint
    Return
    Return