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
Citation: 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

Measurement and calculation method of attitude parameters of roadheader

More Information
  • Received Date: July 02, 2021
  • Revised Date: December 04, 2021
  • The current roadheader attitude parameter measurement method uses the output angle of the biaxial inclinometer directly as the pitch angle and roll angle of the roadheader. By analyzing the attitude parameter measurement of the roadheader and the measurement principle of the biaxial inclinometer, it is concluded that whether it is in a horizontal or inclined roadway, the pitch angle and roll angle cannot be measured by using the biaxial inclinometer alone. The biaxial inclinometer must be integrated with the positioning method containing the heading information of the roadheader to calculate the full attitude parameters of the roadheader simultaneously. Aiming at two typical driving conditions of horizontal roadway and inclined roadway, the attitude calculation method of combining sector laser and biaxial inclinometer (method 1) and the attitude calculation method of combining roadheader two-point coordinates and biaxial inclinometer (method 2) are proposed. In method 1, the yaw angle of the roadheader relative to the roadway coordinate system is determined in real time according to the spot position of the sector laser beam, and the pitch angle and the roll angle of the roadheader body relative to the roadway coordinate system are obtained by a biaxial inclinometer, so that the yaw angle, the pitch angle and the roll angle of the roadheader are calculated. In method 2, the three-dimensional coordinates of two points to be measured on the roadheader body in the roadway coordinate system are firstly measured, and then according to the principle of double-vector attitude determination, the attitude parameters of the roadheader are measured and calculated by using the biaxial inclinometer. The co-simulation results of Matlab and Gazebo show that in horizontal roadway and inclined roadway with four different inclination angles, the method of taking the output angle of biaxial inclinometer as the pitch angle and roll angle of roadheader directly has large errors, which can not meet the needs of attitude parameter measurement of roadheader. The errors of method 1 and method 2 are very small. The average maximum angle error in the horizontal roadway is 0.004 9°, and the average maximum angle error in the inclined roadway is 0.025°, which verifies the rationality of the two roadheader attitude calculation methods.
  • [1]
    李睿.悬臂掘进机机身位姿参数检测系统研究[D].北京:中国矿业大学(北京),2012. LI Rui.Research on an automatic detection system for the position and orientation parameters of boom-type roadheader body[D].Beijing:China University of Mining & Technology(Beijing),2012.
    [2]
    杜雨馨,刘停,童敏明,等.基于机器视觉的悬臂式掘进机机身位姿检测系统[J].煤炭学报,2016,41(11):2897-2906.

    DU Yuxin,LIU Ting,TONG Minming,et al.Pose measurement system of boom-type roadheader based on machine vision[J].Journal of China Coal Society,2016,41(11):2897-2906.
    [3]
    薛光辉,张云飞,候称心,等.基于激光靶向扫描的掘进机位姿测量方法[J].煤炭科学技术,2020,48(11):19-25.

    XUE Guanghui,ZHANG Yunfei,HOU Chenxin,et al.Measurement of roadheader position and posture based on orientation laser scanning[J].Coal Science and Technology,2020,48(11):19-25.
    [4]
    田原.基于四点式光靶的掘进机自动定位方法研究[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.
    [5]
    YANG Wenjuan,ZHANG Xuhui,MA Hongwei,et al.Laser beams-based localization methods for boom-type roadheader using underground camera non-uniform blur model[J].IEEE Access,2020,8:190327-190341.
    [6]
    杨文娟,张旭辉,马宏伟,等.悬臂式掘进机机身及截割头位姿视觉测量系统研究[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.
    [7]
    符世琛,李一鸣,杨健健,等.基于超宽带技术的掘进机自主定位定向方法研究[J].煤炭学报,2015,40(11):2603-2610.

    FU Shichen,LI Yiming,YANG Jianjian,et al.Research on autonomous positioning and orientation method of roadheader based on ultra wide-band technology[J].Journal of China Coal Society,2015,40(11):2603-2610.
    [8]
    FU Shichen,LI Yiming,ZONG Kai,et al.Ultra-wideband pose detection method based on TDOA positioning model for boom-type roadheader[J].AEU-International Journal of Electronics and Communications,2018,99:70-80.
    [9]
    吴淼,贾文浩,华伟,等.基于空间交汇测量技术的悬臂式掘进机位姿自主测量方法[J].煤炭学报,2015,40(11):2596-2602.

    WU Miao,JIA Wenhao,HUA Wei,et al.Autonomous measurement of position and attitude of boom-type roadheader based on space intersection measurement[J].Journal of China Coal Society,2015,40(11):2596-2602.
    [10]
    田原.悬臂式掘进机自动定位技术研究与试验[J].矿山机械,2019,47(7):6-10.

    TIAN Yuan.Research and test on automatic positioning technology for boomed roadheader[J].Mining & Processing Equipment,2019,47(7):6-10.
    [11]
    田原.悬臂掘进机自动导向和定位技术探索[J].工矿自动化,2010,36(8):26-29.

    TIAN Yuan.Discussion of automatic guidance and location technology for cantilever excavator[J].Industry and Mine Automation,2010,36(8):26-29.
    [12]
    严恭敏,翁浚.捷联惯导算法与组合导航原理[M].西安:西北工业大学出版社,2019.

    YAN Gongmin,WENG Jun.Strapdown inertial navigation algorithm and integrated navigation principle[M].Xi'an:Northwestern Polytechnical University Press,2019.
    [13]
    佟刚,王涛,吴志勇,等.高精度倾角传感器在测量车载平台变形中的应用[J].光学精密工程,2010,18(6):1347-1353.

    TONG Gang,WANG Tao,WU Zhiyong,et al.Application of high accuracy inclinometer to deformation measurement for vehicular platform[J].Optics and Precision Engineering,2010,18(6):1347-1353.
    [14]
    约翰J.克雷格.机器人学导论[M].贠超,王伟,译.北京:机械工业出版社,2018.

    CRAIG J J.Introduction to robotics[M].YUN Chao,WANG Wei,translate.Beijing:China Machine Press,2018.
    [15]
    陶云飞.掘进机位姿激光自动测量方法及系统研究[D].北京:中国矿业大学(北京),2017.

    TAO Yunfei.Research on automatic measurement method and system of position and attitude of roadheader based on laser measurement system[D].Beijing:China University of Mining & Technology(Beijing),2017.
    [16]
    陶云飞,宗凯,张敏骏,等.基于iGPS的掘进机单站多点分时机身位姿测量方法[J].煤炭学报,2015,40(11):2611-2616.

    TAO Yunfei,ZONG Kai,ZHANG Minjun,et al.A position and orientation measurement method of single-station,multipoint and time-sharing for roadheader body based on iGPS[J].Journal of China Coal Society,2015,40(11):2611-2616.
    [17]
    GAO Yang,LIN Jiarui,HE Feiyan,et al.A monocular vision and inclinometer combined system for 6DOF measurement of double shield TBM[J].Sensors and Actuators A:Physical,2016,249:155-162.
    [18]
    胡春旭.ROS机器人开发实践[M].北京:机械工业出版社,2018.

    HU Chunxu.ROS robot development practice[M].Beijing:China Machine Press,2018.
  • Related Articles

    [1]LIU Jing, WEI Zhiqiang, CAI Chunmeng, LIU Yang. Positioning method for roadheaders based on fusion of LiDAR and inertial navigation[J]. Journal of Mine Automation, 2025, 51(3): 78-85, 95. DOI: 10.13272/j.issn.1671-251x.2025010021
    [2]HE Jianwei. Research on the positioning method of continuous shearer in coal mines[J]. Journal of Mine Automation, 2021, 47(10): 42-48. DOI: 10.13272/j.issn.1671-251x.2020120011
    [3]YANG Lin, MA Hongwei, WANG Yan, WANG Chuanwei, ZHANG Zhenzhen. Research on method of simultaneous localization and mapping of coal mine inspection robot[J]. Journal of Mine Automation, 2019, 45(9): 18-24. DOI: 10.13272/j.issn.1671-251x.17444
    [4]TIAN Yuan. Inertial navigation positioning method of roadheader based on zero-velocity update[J]. Journal of Mine Automation, 2019, 45(8): 70-73. DOI: 10.13272/j.issn.1671-251x.2019010033
    [5]DU Jingyi, GUO Jinbao, ZHANG Bo. Inertial navigation and positioning system for underground driverless trai[J]. Journal of Mine Automation, 2018, 44(9): 5-9. DOI: 10.13272/j.issn.1671-251x.2018040022
    [6]ZHANG Shouxiang, LI Sen, SONG Lailiang. Positioning of coal mining equipments based on inertial navigation and odometer[J]. Journal of Mine Automation, 2018, 44(5): 52-57. DOI: 10.13272/j.issn.1671-251x.2018010042
    [7]JIANG Lei, YANG Liuming, WU Fangda, HAN Huijie, ZHOU Xue. Underground positioning method based on GMapping algorithm and fingerprint map constructio[J]. Journal of Mine Automation, 2017, 43(9): 96-101. DOI: 10.13272/j.issn.1671-251x.2017.09.017
    [8]TIAN Yuan. Present situation and development direction of navigation technology of boom-type roadheader[J]. Journal of Mine Automation, 2017, 43(8): 37-43. DOI: 10.13272/j.issn.1671-251x.2017.08.008
    [9]WANG Zhenghe. Trajectory generation algorithm of inertial navigation based on smart phone[J]. Journal of Mine Automation, 2015, 41(5): 87-90. DOI: 10.13272/j.issn.1671-251x.2015.05.021
    [10]LI Lu, MA Shao-yi. Construction of Mine-map Graph Correction System Based on MapX[J]. Journal of Mine Automation, 2009, 35(11): 115-116.
  • Cited by

    Periodical cited type(9)

    1. 曹建东. 煤矿综采工作面采煤机截割系统方案设计与应用. 机械管理开发. 2022(06): 227-228+231 .
    2. 宋单阳,杨金衡,陶心雅,卢春贵,田慕琴,宋建成. 基于非完整性约束的采煤机定位方法. 工矿自动化. 2022(07): 52-57 . 本站查看
    3. 武元军. 薄煤层综采工作面采煤机组合定位方法研究. 矿业装备. 2021(03): 216-217 .
    4. 杨金衡,宋单阳,田慕琴,宋建成,许春雨. 基于自适应卡尔曼滤波的双惯导采煤机定位方法. 工矿自动化. 2021(07): 14-20+28 . 本站查看
    5. 任广玉. 大采高智能化综采工作面设备配套工艺研究. 自动化应用. 2021(03): 122-123+127 .
    6. 任怀伟,赵国瑞,周杰,文治国,丁艳,李帅帅. 智能开采装备全位姿测量及虚拟仿真控制技术. 煤炭学报. 2020(03): 956-971 .
    7. 王守波. 综放工作面采煤工艺可靠性研究. 中国设备工程. 2020(13): 131-132 .
    8. 李帅帅,任怀伟. 综采工作面“三机”设备位姿测量技术研究现状与展望. 煤炭科学技术. 2020(09): 218-226 .
    9. 胡光军,廖洪波,兰利平,吴寻云. 极近距离极薄煤层软顶控制技术优化. 矿业工程研究. 2020(04): 6-12 .

    Other cited types(5)

Catalog

    Article Metrics

    Article views (219) PDF downloads (43) Cited by(14)
    Related

    /

    DownLoad:  Full-Size Img  PowerPoint
    Return
    Return