Volume 50 Issue 5
May  2024
Turn off MathJax
Article Contents
WANG Pengpeng, LI Rui, LIU Xin, et al. A positioning solution method for roadheader under optical target occlusion conditions[J]. Journal of Mine Automation,2024,50(5):118-124.  doi: 10.13272/j.issn.1671-251x.2023110001
Citation: WANG Pengpeng, LI Rui, LIU Xin, et al. A positioning solution method for roadheader under optical target occlusion conditions[J]. Journal of Mine Automation,2024,50(5):118-124.  doi: 10.13272/j.issn.1671-251x.2023110001

A positioning solution method for roadheader under optical target occlusion conditions

doi: 10.13272/j.issn.1671-251x.2023110001
  • Received Date: 2023-11-05
  • Rev Recd Date: 2024-06-01
  • Available Online: 2024-06-13
  • In order to solve the problem of interruption in the positioning of roadheader in the case that the optical target is blocked under the current commonly used integrated navigation positioning of roadheader based on "inertial navigation+visual measurement+optical target", a positioning solution method for roadheader under optical target occlusion occlusion is proposed. Firstly, the method collects images of an optical target composed of four rectangular distributed target points in unblocked conditions, obtains the pixel coordinates of the imaging spot of the target points in the camera, and constructs a rectangle. Then, the method expands and constructs an auxiliary rectangular area box according to a certain proportion. Secondly, the method collects images of partially blocked target points, obtains the pixel coordinates of the imaging spot of the unblocked target points in the camera. The method determines the corresponding relationship between the unblocked target points and the imaging spot based on the Euclidean distance between the imaging spot of the target points and the vertex of the auxiliary rectangular area box, thereby determining the blocked target points. Thirdly, using the known geometric dimensions of the target and the target attitude information provided by inertial navigation, the method establishes the corresponding relationship between the projected target point and the imaging spot, and then solves for the pixel coordinates of the spot corresponding to the blocked target point. Finally, the spatial coordinates of the center position of the optical target are obtained using the perspective-N-point (PNP) algorithm to achieve the positioning solution of the roadheader. The experimental results show that when the optical target is blocked, by calculating the pixel coordinates of the light spot corresponding to the blocked target point, the problem of interruption in the positioning of the roadheader can be solved. It ensures the real-time positioning of the roadheader, and the positioning error meets the actual positioning requirements of the roadheader.

     

  • loading
  • [1]
    王步康. 煤矿巷道掘进技术与装备的现状及趋势分析[J]. 煤炭科学技术,2020,48(11):1-11.

    WANG Bukang. Current status and trend analysis of roadway driving technology and equipment in coal mine[J]. Coal Science and Technology,2020,48(11):1-11.
    [2]
    胡兴涛,朱涛,苏继敏,等. 煤矿巷道智能化掘进感知关键技术[J]. 煤炭学报,2021,46(7):2123-2135.

    HU Xingtao,ZHU Tao,SU Jimin,et al. Key technology of intelligent drivage perception in coal mine roadway[J]. Journal of China Coal Society,2021,46(7):2123-2135.
    [3]
    刘送永,张德义. 巷道掘进机智能化技术研究现状及展望[J]. 工矿自动化,2019,45(10):23-28.

    LIU Songyong,ZHANG Deyi. Research status and prospect of intelligentization technology of roadheader[J]. Industry and Mine Automation,2019,45(10):23-28.
    [4]
    张国喜. 悬臂式掘进机惯性测量系统的改进与试验[J]. 江西煤炭科技,2021(2):238-240. doi: 10.3969/j.issn.1006-2572.2021.02.080

    ZHANG Guoxi. Transformation and experiment on inertial measurement system in cantilever roadheader[J]. Jiangxi Coal Science & Technology,2021(2):238-240. doi: 10.3969/j.issn.1006-2572.2021.02.080
    [5]
    田原. 悬臂式掘进机视觉定位方法研究[J]. 矿山机械,2019,47(3):8-12. doi: 10.3969/j.issn.1001-3954.2019.03.003

    TIAN Yuan. Research on vision positioning method for boom-type roadheader[J]. Mining & Processing Equipment,2019,47(3):8-12. doi: 10.3969/j.issn.1001-3954.2019.03.003
    [6]
    刘超,符世琛,成龙,等. 基于TSOA定位原理混合算法的掘进机位姿检测方法[J]. 煤炭学报,2019,44(4):1255-1264.

    LIU Chao,FU Shichen,CHENG Long,et al. Pose detection method based on hybrid algorithm of TSOA positioning principle for roadheader[J]. Journal of China Coal Society,2019,44(4):1255-1264.
    [7]
    石勇. 基于三维激光雷达的掘进机实时位姿纠偏系统[J]. 煤矿机械,2023,44(5):64-66.

    SHI Yong. Real-time pose correction system of roadheader based on three-dimensional lidar[J]. Coal Mine Machinery,2023,44(5):64-66.
    [8]
    薛光辉,张云飞,候称心,等. 基于激光靶向跟踪的掘进机位姿测量方法[J]. 矿业科学学报,2020,5(4):416-422.

    XUE Guanghui,ZHANG Yunfei,HOU Chenxin,et al. Measurement of roadheader position and posture based on laser target tracking[J]. Journal of Mining Science And Technology,2020,5(4):416-422.
    [9]
    杨文娟,张旭辉,马宏伟,等. 悬臂式掘进机机身及截割头位姿视觉测量系统研究[J]. 煤炭科学技术,2019,47(6):50-57.

    YANG Wenjuan,ZHANG Xuhui,MA Hongwei,et al. Research on position and posture measurement system of body and cutting head for boom-type roadheader based on machine vision[J]. Coal Science and Technology,2019,47(6):50-57.
    [10]
    杨文娟,张旭辉,张超,等. 悬臂式掘进机器人巷道成形智能截割控制系统研究[J]. 工矿自动化,2019,45(9):40-46.

    YANG Wenjuan,ZHANG Xuhui,ZHANG Chao,et al. Research on intelligent cutting control system for roadway forming of boom-type tunneling robot[J]. Industry and Mine Automation,2019,45(9):40-46.
    [11]
    刘豪. 捷联惯导与里程计组合的矿用掘进机自主导航定位系统[D]. 重庆:重庆大学,2020.

    LIU Hao. An autonomous navigation system of mining TBM based on the combination of SINS and OD[D]. Chongqing:Chongqing University,2020.
    [12]
    张旭辉,刘博兴,张超,等. 掘进机全站仪与捷联惯导组合定位方法[J]. 工矿自动化,2020,46(9):1-7.

    ZHANG Xuhui,LIU Boxing,ZHANG Chao,et al. Roadheader positioning method combining total station and strapdown inertial navigation system[J]. Industry and Mine Automation,2020,46(9):1-7.
    [13]
    崔玉明. 煤矿巷道掘进机视觉/惯性融合自主定位关键技术研究[D]. 徐州:中国矿业大学,2021.

    CUI Yuming. Key technology research of visual/inertial fusion autonomous positioning for roadheader in coal mine[D]. Xuzhou:China University of Mining and Technology,2021.
    [14]
    YANG Wenjuan,ZHANG Xuhui,MA Hongwei,et al. Infrared LEDs-based pose estimation with underground camera model for boom-type roadheader in coal mining[J]. IEEE Access,2019,7:33698-33712. doi: 10.1109/ACCESS.2019.2904097
    [15]
    雷孟宇,张旭辉,杨文娟,等. 煤矿掘进装备视觉位姿检测与控制研究现状与趋势[J]. 煤炭学报,2021,46(增刊2):1135-1148.

    LEI Mengyu,ZHANG Xuhui,YANG Wenjuan,et al. Current status and trend of research on visual pose detection and control of heading equipment in coal mines[J]. Journal of China Coal Society,2021,46(S2):1135-1148.
    [16]
    黄东,杨凌辉,罗文,等. 基于视觉/惯导的掘进机实时位姿测量方法研究[J]. 激光技术,2017,41(1):19-23.

    HUANG Dong,YANG Linghui,LUO Wen,et al. Study on measurement method of realtime position and attitude of roadheader based on vision/inertial navigation system[J]. Laser Technology,2017,41(1):19-23.
    [17]
    田原. 悬臂式掘进机导航技术现状及其发展方向[J]. 工矿自动化,2017,43(8):37-43.

    TIAN Yuan. Present situation and development direction of navigation technology of boom-type roadheader[J]. Industry and Mine Automation,2017,43(8):37-43.
    [18]
    田原. 基于四点式光靶的掘进机自动定位方法研究[J]. 煤炭科学技术,2018,46(12):35-40.

    TIAN Yuan. Research on automatic positioning method of roadheader based on four point light target[J]. Coal Science and Technology,2018,46(12):35-40.
    [19]
    陈和,杨志浩,郭磐,等. 激光光斑中心高精度定位算法研究[J]. 北京理工大学学报,2016,36(2):181-185.

    CHEN He,YANG Zhihao,GUO Pan,et al. Research of the high precision laser spot center location algorithm[J]. Transactions of Beijing Institute of Technology,2016,36(2):181-185.
    [20]
    李道萍,杨波. 高精度光斑中心定位算法[J]. 光学仪器,2018,40(4):20-25.

    LI Daoping,YANG Bo. High-precision center location algorithm of light spot[J]. Optical Instrument,2018,40(4):20-25.
    [21]
    GB 50213—2010 煤矿井巷工程质量验收规范[S].

    GB 50213-2010 Code for acceptance of shaft sinking and drifting of coal mine[S].
  • 加载中

Catalog

    通讯作者: 陈斌, bchen63@163.com
    • 1. 

      沈阳化工大学材料科学与工程学院 沈阳 110142

    1. 本站搜索
    2. 百度学术搜索
    3. 万方数据库搜索
    4. CNKI搜索

    Figures(5)  / Tables(1)

    Article Metrics

    Article views (44) PDF downloads(6) Cited by()
    Proportional views
    Related

    /

    DownLoad:  Full-Size Img  PowerPoint
    Return
    Return