矿井掘进机自主定位仿真模拟及应用研究_郜亚男.pdf

煤矿现代化2020 年第 5 期总第 158 期 0引言 目前一些学者、 专家对煤矿掘进机自主定位进行 了探讨、 研究， 例如吴淼团队[1]利用激光指示器引导掘 进机进行定向掘进研究， 但这种方法只能达到一定的 定向功能， 不能准确实现掘进机的精确定位； 文献[2]提 出了一种基于超宽带技术的掘进机自走式定位方法， 但该方法在 Z 轴上的误差不能满足煤矿巷道工程的 质量验收规范。在文献[3]介绍了一种基于全站仪的机 身位姿参数测量系统， 该系统可以使用全站仪精确测 量掘进机的姿态角 （偏转角， 仰角和侧倾角） ， 但没有 进行深入的研究。文献[4]提出了基于 GPS检测确定掘 进机姿态参数的方法， 但是该方法的最大测量距离仅 为 40m， 无法远程测量。 迄今为止， 虽然国内外对煤岩 巷掘进机的检测和自主定位方法进行了相关研究。 但 是， 由于井下巷道条件复杂多变、 环境恶劣， 容易影响 自动测量结果， 导致测量精度低。煤矿综掘工作面的 实际应用效果尚未达到理想的技术水平。 在当今高精度测量功能技术基础上，提出了一 种基于仿真模拟指导巷道掘进机自主定位系统。从 矿井实际条件、 测量系统结构、 自主定位原理等方面 出发， 建立了 Matlab 自校准数学模型， 仿真软件根据 现场测量模拟和精度分析，实现了综掘机在掘进过 程中的自主定位， 为矿井快速、 精准掘进巷道提供了 理论指导。 1掘进机定位系统组成 矿井掘进机的机位姿测量系统主要用于井下巷 道开挖自动导向系统中， 可以实现掘进机的自主定 位、 位姿检测、 激光定位以及全站仪的自主校准等 功能[5]。其中， 掘进机掘进期间激光定位示意如图 1 所示。 1， 2， 3机载待测棱镜; 4后视棱镜; 5自动全站仪; 6自整平式仪器平台; 7掘进机; 8掘进工作面 图 1掘进机掘进期间激光定位示意 矿井掘进机定位系统包括一个高精度自动全站 仪， 一个自动调平仪器平台， 一个机载测量棱镜， 一个 矿井掘进机自主定位仿真模拟及应用研究 郜 亚 男 （山西兰花科创股份有限公司大阳煤矿分公司 ， 山西 晋城 048000 ） 摘要 为解决井下巷道断面掘进质量， 提出了掘进机自主定位系统指导综掘。从理论上阐述了掘进 机定位系统组成和定位原理， 模拟分析了掘进机自主定位误差情况、 姿态角分布规律和校准效果， 应 用表明在自主定位下掘进掘进的巷道断面质量好， 实现了快速、 精准作业， 为矿井实现高产高效奠定 了理论基础。 关键词 掘进机 ； 激光定位 ； 全站仪 ； 位姿控制 中图分类号 TD265文献标识码 A文章编号 1009- 0797 （2020 ） 05- 0120- 03 Research on Simulation and application of mine roadheader autonomous positioning GAO Yanan （Shanxi lanhua kechuangco., LTD. Dayangcoal mine branch , Shanxi Jincheng 048000） Abstract In order to solve the quality of cross- section tunneling in underground roadways, an independent positioning system of roadheader is proposed to guide comprehensive excavation. The composition and positioning principle of the positioning system of the roadheader are expounded theoretically, and the error situation of the roadheaders autonomous positioning, the distribution law of attitude angle and the calibration effect are simulated and analyzed. The application shows that the roadway section quality of the roadheading under the autonomous positioning is good, and the fast and accurate operation is realized, which lays a foundation for realizing high production and high efficiency in the mine. Key words Roadheader ; Laser positioning; Total station ; Posture control 120 ChaoXing 煤矿现代化2020 年第 5 期总第 158 期 后视棱镜，一个台式定位棱镜和一台终端控制平台， 系统各个结构共同作用实现掘进机自主定位巷道掘 进功能。 2自主定位原理 在掘进机的激光测量系统中， 自动全站仪的自动 校准是掘进机无人操作实现的关键[6]。 目前， 对掘进机 自主定位的研究较少，没有真正的自主无人掘进机。 随着掘进机的不断进步， 机载测量棱镜与掘进机之间 的距离不断增大。在井下工作条件复杂的情况下， 测 量误差不断增大， 最终导致导向系统失效， 而自动全 站仪校准必须手工完成， 它不仅难以安装， 在进行校 准的过程中需要很长时间，不利于煤矿的安全生产。 在快速换档过程中， 通过自动调平仪平台的快速悬挂 功能， 在距离自动全站仪一定距离的前巷道顶板的任 何位置安装三个自动调平仪表平台。为方便说明， 初 步选择为 A， B， C三点。自动调平仪平台 B和 C分别 安装后视棱镜和工位定位棱镜，并进行自动调平操 作。自动调平完成后， 自动全站仪精确测量测量点的 位置坐标； 自动全站仪转移到 A 点自动调平仪平台， 自动调平操作。在自动调平完成后， 自动全站仪确定 站点后， 根据激光线自动移动位置坐标， 在移动的过 程中快速换挡和站点自主定位、 校准， 这整个过程便 是矿井掘进机自主定位的基本原理， 详见图 2 所示。 1， 2， 3机载测量棱镜; 4后视棱镜; 5自动全站仪;6掘进机; 7掘进工作面; 8工业计算机; 9测站定位棱镜 图 2掘进机自主移动及定位原理 3Matlab 仿真模拟研究 为探索该系统定位误差的分布规律， 利用 Matlab 仿真对该方法实现的过程进行了仿真。 根据以上分析 和研究， 掘进机自校准数学模型的初始测量参数为全 站仪测量的方位角和距离， 选择校准棱镜间距和校准 距离两个因子。采用站点误差分布规律， 选择校准距 离和测量距离，研究掘进机姿态角的误差分布规律。 假设掘进机的前进方向为 X 轴， 规定 X 轴为正， 模拟 计算从 X 轴 20～60m的负方向开始，其中每距离 1m 进行一次， 在相应的影响因素下得到自主定位误差的 仿真结果。 在 20～60m方向上每 1m选择一个测量点， 以及对掘进机位置误差进行模拟计算， 通过对计算结 果的分析获得相应的影响因素。其中， 轴仿真与站点 误差值随标定距离分布情况的仿真结果如图 3 所示。 （a ） 轴误差分布 （b） 站点误差分布 图 3轴仿真与站点误差值随标定距离分布情况 仿真结果表明， 该自主定位方法可以检测不同测 量位置的全站仪设置站， 但存在一定的测量误差。其 中， 在 X 轴的误差值大于 Y 轴的误差， 表明巷道方向 的误差相对较大， 精度较低。各轴的误差值随着校准 距离的增加而增大。 站点误差随校准棱镜间距的增大 而减小， 随校准距离的增加而增大。当校准距离超过 35m的范围时， 校准棱镜间距对现场误差几乎没有影 响。当校准距离为 60m 时， 站点误差最大， 最大值为 0.19mm。自校准后， Matlab 仿真自动全站仪在掘进机 上计算出的位姿误差仿真结果如图 4 所示。 仿真结果表明，随着测距和校准距离的增大， 航 向角误差大于俯仰角和侧倾角， 但满足煤矿巷道工程 质量验收规范。最大航向角是校准距离和测量距离。 两者均在 60m 的情况下获得， 最大值为 0.0157； 姿 态角误差随着测量距离和校准距离的增加而增大， 测 量距离对姿态角误差影响更为明显， 因此提出了一种 相对优化的自主定位策略。 校准距离和测量距离均较 大， 是 60m。 当全站仪执行多个独立校准时， 可以从设置站点 坐标的解决方案过程看出。从图 5 可以看出， 站 1 的 坐标由校准点 1 和 2 确定， 并且可以测量校准点 3 和 121 ChaoXing 煤矿现代化2020 年第 5 期总第 158 期 4 的坐标。然后， 全站仪移动到站 2， 并且由于站 2 的 坐标通过观察站 2 到校准点 3 和 4 的距离和角度来 校准， 校准点 3 和 4 的坐标是当设置站 2 的坐标误差 变化规律和站 1 的坐标误差变化规律相同。 当校准点 坐标为真时， 设置站的定位精度和第一次校准的定位 精度的变化是一致的。 （a ）航向角误差 （b） 俯仰角误差 （c ） 横滚角误差 图 4掘进机自主定位姿态角仿真模拟结果 图 5掘进机自主定位设站、 移站、 标定流程示意 4井下应用 带有自主定位系统的掘进机在井下半煤岩巷进 行了工业性实践。掘进机在自主定位作用下， 与设计 值相比， 掘出的巷道两帮误差均值为 301.6mm， 单边 误差均值为 150.5mm， 均小于人工操作误差均值。机 身初始位置在巷道中心线上， 无明显偏差， 单边定位 精度小于 30mm， 回转定位精度小于 15mm， 连续完成 断面截割和扫底动作，自主定位截割运行效果良好， 截割的断面完全满足使用要求。在掘进过程中， 掘进 机未出现机械故障。人工操作至少需要人数为 8 人， 在自主定位技术下，人员数量 5 人即可进行巷道掘 进。 实现了快速掘进， 降低了工人劳动强度， 提高了巷 道断面质量和生产效率。 5结论 1 ）矿井掘进机定位系统由高精度自动全站仪、 自动调平仪、 棱镜和控制平台构成， 系统各个结构共 同作用实现掘进机自主定位巷道掘进功能， 自主定位 的基本原理是自动调平仪棱镜自动调节， 全站仪测量 站点位置， 激光线对准站点， 控制平台控制移动、 快速 换挡和、 校准。 2 ）采用 Matlab 仿真软件模拟分析了掘进机自主 定位的轴误差与站点误差值随标定距离分布规律、 姿 态角分布情况、 校准效果， 模拟表明自主定位对掘进 机精准掘进具有明显的优势。 3 ）掘进机在自主定位系统作用下掘进半煤岩 巷， 掘进断面质量好， 减小了操作人员数量， 实现了快 速掘进， 为矿井掘进效率奠定了基础。 参考文献 [1] 李睿.悬臂掘进机机身位姿参数检测系统研究[D].北京 中国矿业大学 （北京） ， 201241- 48. [2] 符世琛,李一鸣,杨健健,等.基于超宽带技术的掘进机自 主 定 位 定 向 方 法 研 究 [J]. 煤 炭 学 报 ,2015,40 11 2603- 2610. [3] 朱信平,李睿,高娟,等.基于全站仪的掘进机机身位姿参 数测量方法[J].煤炭工程,2011 （6） 113- 115. [4] 陶云飞,宗凯,张敏骏,等.基于 iGPS 的掘进机单站多点分 时 机 身 位 姿 测 量 方 法 [J]. 煤 炭 学 报 ,2015,40 11 2611- 2616. [5] 吴淼,贾文浩,华伟,等.基于空间交汇测量技术的悬臂式 掘进机位姿自主测量方法 [J]. 煤炭学报,2015,4011 2596- 2602. [6] 周玲玲,董海波,杜雨馨.基于双激光标靶图像识别的掘进机 位姿检测方法[J].激光与光电子学进展,2017,54 （4 ） 186- 192. 作者简介 郜亚男 （1987-） ， 男， 山西省长治市人， 2010 年年 7 月毕 业于山西煤炭职业技术学院矿山机电专业，助理工程师， 现 从事工作 （或研究方向） 机电设备的管理和维修。 （收稿日期 2019- 12- 16） 122 ChaoXing