CN114102604B - 一种应用于三臂凿岩台车的孔序自动规划方法 - Google Patents
一种应用于三臂凿岩台车的孔序自动规划方法 Download PDFInfo
- Publication number
- CN114102604B CN114102604B CN202111556639.4A CN202111556639A CN114102604B CN 114102604 B CN114102604 B CN 114102604B CN 202111556639 A CN202111556639 A CN 202111556639A CN 114102604 B CN114102604 B CN 114102604B
- Authority
- CN
- China
- Prior art keywords
- hole
- rock drilling
- operation area
- arm operation
- sequence
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 14
- 238000005553 drilling Methods 0.000 claims abstract description 111
- 239000011435 rock Substances 0.000 claims abstract description 71
- 230000002068 genetic effect Effects 0.000 claims abstract description 4
- 238000010586 diagram Methods 0.000 claims description 8
- 238000011156 evaluation Methods 0.000 claims description 6
- 238000010276 construction Methods 0.000 abstract description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 239000011148 porous material Substances 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012772 sequence design Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1682—Dual arm manipulator; Coordination of several manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Earth Drilling (AREA)
Abstract
本发明是一种应用于三臂凿岩台车的孔序自动规划方法。本发明涉及隧道施工技术领域,本发明根据三个凿岩机械臂的工作范围为将凿岩孔划分为左臂作业区、右臂作业区和中臂作业区,并按照孔类型对凿岩孔进行分类;规划左臂作业区和右臂作业区中孔类型作业顺序,根据不同类型孔的位置分布;分别确定三个作业区中凿岩孔序的起点和终点;在左臂作业区和右臂作业区中分别确定五类孔集合的起止点;利用遗传算法以路径长度最短为指标优化左臂和右臂作业区中五类孔集合的孔序,中臂作业区中,使用贪心算法逐一取点组成孔序,完成孔序自动规划。
Description
技术领域
本发明涉及隧道施工技术领域,是一种应用于三臂凿岩台车的孔序自动规划方法。
背景技术
三臂凿岩台车是一种应用于凿岩作业的大型隧道工程机械,目前仍采用人工操纵方式作业。由于隧道建设过程中面临着岩爆、坍塌以及突泥涌水等风险,三臂凿岩台车全自动无人化作业成为了现阶段研究的重点。
三臂凿岩台车的作业任务是控制三个凿岩机械臂按照拟定的凿岩孔作业顺序完成掌子面上的钻孔工作,每个机械臂需要完成的凿岩孔数量大致相同。凿岩孔序设计的是否合理极大程度上影响了作业效率与机械臂之间的碰撞风险。传统的孔序规划是利用人工手动规划完成的,单次凿岩作业需要规划的孔数约为160个,因此对于数目众多的凿岩孔,人工孔序规划的规划难度大且无法获得高效率和高安全性的孔序。
发明内容
本发明为了解决现有人工规划技术存在规划结果作业效率低、臂杆碰撞风险高的技术问题,本发明提供了一种应用于三臂凿岩台车的孔序自动规划方法。本发明提供了以下技术方案:
一种应用于三臂凿岩台车的孔序自动规划方法,包括以下步骤:
步骤1:根据三个凿岩机械臂的工作范围为将凿岩孔划分为左臂作业区、右臂作业区和中臂作业区,并按照孔类型对凿岩孔进行分类;
步骤2:规划左臂作业区和右臂作业区中孔类型作业顺序,根据不同类型孔的位置分布,设置孔类型的作业顺序为:底板孔、开槽孔、辅助孔、内轮廓孔和外轮廓孔;
步骤3:分别确定三个作业区中凿岩孔序的起点和终点;
步骤4:在左臂作业区和右臂作业区中分别确定五类孔集合的起止点;
步骤5:利用遗传算法以路径长度最短为指标优化左臂和右臂作业区中五类孔集合的孔序,通过将各类孔集合的孔序相连得到左臂作业区和右臂作业区的孔序;
步骤6:中臂作业区中,使用贪心算法逐一取点组成孔序,完成孔序自动规划。
优选地,所述步骤1具体为:通过MATLAB读取包含凿岩孔信息的XML格式文件,根据文件中孔类型标签将凿岩孔分类,根据凿岩孔的坐标绘制凿岩孔分布图,根据机械臂运动空间的分析结果将凿岩孔分为左臂作业区、右臂作业区和中臂作业区。
优选地,所述步骤3具体为:左臂作业区中以左下角的底板孔为起始凿岩孔,以左下角的外轮廓孔为终止凿岩孔;右臂作业区中以左下角底板凿岩孔为起始凿岩孔,右下角外轮廓孔为终止凿岩孔;中臂作业区中以最左侧凿岩孔为起始凿岩孔,以最上侧凿岩孔为终止凿岩孔。
优选地,所述步骤4中确定起止点的原则为:在同一类型孔集合中,终点为距离起点最远的凿岩孔;后一类型孔集合中的起点为距离前一类型孔集合终点最近的凿岩孔。
优选地,所述步骤6具体为:
在中臂作业区中,孔序中第i号孔的评价函数通过下式表示:
fi=di-1,i+1/di,n
其中,di-1,i为第i号孔与孔序中前一孔的距离,di,n为第i号孔与中臂作业区终止凿岩孔的距离;
以中臂作业区起始凿岩孔作为孔序的起点,使用贪心算法依次从中臂作业区孔集合中选取使得评价函数最小的孔作为下一节点,直到分配完中臂作业区中所有凿岩孔;至此三个工作区的孔序规划均以完成,完成规划。
本发明具有以下有益效果:
本发明为了解决了同类型孔不能集中作业和孔序杂乱的问题,左臂和右臂作业区孔类型种类高达五种,按孔类型分类得到不同类型孔的集合,在各类型孔集合中规划孔序实现同类型孔集中处理,同时采用设置各类型孔集合孔序起点和终点的方式,避免了不同类型孔集合的孔序在连接时出现单步移动过长的问题,减少了凿岩机械臂在凿岩孔之间的移臂距离,提高了凿岩作业效率;解决了三臂同时作业时中臂与容易其他两臂发生碰撞的问题,当前孔与孔序中的前一孔距离越近则凿岩作业时机械臂运动量越少,通过综合当前孔与前一孔的距离以及当前孔与终点孔距离设计目标函数,能够让远离中臂工作区终点孔的凿岩孔先被纳入孔序中,从而实现中臂工作区的孔序呈现由下至上和由外至内的趋势,因此中臂在作业时逐渐远离左臂和右臂工作区,降低了臂杆碰撞的风险,极大提高了作业的安全性。
附图说明
图1为凿岩孔分布图;
图2为孔序起止点示意图;
图3为中臂作业区孔序规划原理图;
图4为孔序规划结果图。
具体实施方式
以下结合具体实施例,对本发明进行了详细说明。
具体实施例一:
根据图1至图4所示,为解决上述技术问题采取的具体优化技术方案是:本发明涉及一种应用于三臂凿岩台车的孔序自动规划方法:
一种应用于三臂凿岩台车的孔序自动规划方法,包括以下步骤:
步骤1:根据三个凿岩机械臂的工作范围为将凿岩孔划分为左臂作业区、右臂作业区和中臂作业区,并按照孔类型对凿岩孔进行分类;
所述步骤1具体为:通过MATLAB读取包含凿岩孔信息的XML格式文件,根据文件中孔类型标签将凿岩孔分类,根据凿岩孔的坐标绘制凿岩孔分布图,根据机械臂运动空间的分析结果将凿岩孔分为左臂作业区、右臂作业区和中臂作业区。如图1所示。
步骤2:规划左臂作业区和右臂作业区中孔类型作业顺序,根据不同类型孔的位置分布,设置孔类型的作业顺序为:底板孔、开槽孔、辅助孔、内轮廓孔和外轮廓孔;
步骤3:分别确定三个作业区中凿岩孔序的起点和终点;
所述步骤3具体为:左臂作业区中以左下角的底板孔为起始凿岩孔,以左下角的外轮廓孔为终止凿岩孔;右臂作业区中以左下角底板凿岩孔为起始凿岩孔,右下角外轮廓孔为终止凿岩孔;中臂作业区中以最左侧凿岩孔为起始凿岩孔,以最上侧凿岩孔为终止凿岩孔。三个作业区孔序的起止点如图2所示。
步骤4:在左臂作业区和右臂作业区中分别确定五类孔集合的起止点;所述步骤4中确定起止点的原则为:在同一类型孔集合中,终点为距离起点最远的凿岩孔;后一类型孔集合中的起点为距离前一类型孔集合终点最近的凿岩孔。
步骤5:利用遗传算法以路径长度最短为指标优化左臂和右臂作业区中五类孔集合的孔序,通过将各类孔集合的孔序相连得到左臂作业区和右臂作业区的孔序;
步骤6:中臂作业区中,使用贪心算法逐一取点组成孔序,完成孔序自动规划。
所述步骤6具体为:
在中臂作业区中,孔序中第i号孔的评价函数通过下式表示:
fi=di-1,i+1/di,n
其中,di-1,i为第i号孔与孔序中前一孔的距离,di,n为第i号孔与中臂作业区终止凿岩孔的距离,如图3所示;
以中臂作业区起始凿岩孔作为孔序的起点,使用贪心算法依次从中臂作业区孔集合中选取使得评价函数最小的孔作为下一节点,直到分配完中臂作业区中所有凿岩孔;至此三个工作区的孔序规划均以完成,完成规划结果如图4所示。
以上所述仅是一种应用于三臂凿岩台车的孔序自动规划方法的优选实施方式,一种应用于三臂凿岩台车的孔序自动规划方法的保护范围并不仅局限于上述实施例,凡属于该思路下的技术方案均属于本发明的保护范围。应当指出,对于本领域的技术人员来说,在不脱离本发明原理前提下的若干改进和变化,这些改进和变化也应视为本发明的保护范围。
Claims (2)
1.一种应用于三臂凿岩台车的孔序自动规划方法,其特征是:包括以下步骤:
步骤1:根据三个凿岩机械臂的工作范围为将凿岩孔的分布图划分为左臂作业区、右臂作业区和中臂作业区,并按照孔类型对凿岩孔进行分类;
步骤2:规划左臂作业区和右臂作业区中凿岩孔类型作业顺序,根据不同类型凿岩孔的位置分布,设置凿岩孔类型的作业顺序为:底板孔、开槽孔、辅助孔、内轮廓孔和外轮廓孔;
步骤3:分别确定左臂作业区、右臂作业区、中臂作业区中凿岩孔序的起始凿岩孔和终止凿岩孔;
所述步骤3具体为:左臂作业区中以左下角的底板孔为起始凿岩孔,以左下角的外轮廓孔为终止凿岩孔;右臂作业区中以左下角底板孔为起始凿岩孔,右下角外轮廓孔为终止凿岩孔;中臂作业区中以最左侧凿岩孔为起始凿岩孔,以最上侧凿岩孔为终止凿岩孔;
步骤4:在左臂作业区和右臂作业区中分别确定五种类型的凿岩孔集合的起点和终点;
所述步骤4中确定起点和终点的原则为:在同一类型凿岩孔集合中,终点为距离起点最远的凿岩孔;后一类型凿岩孔集合中的起点为距离前一类型凿岩孔集合终点最近的凿岩孔;
步骤5:利用遗传算法以路径长度最短为指标优化左臂作业区和右臂作业区中五种类型的凿岩孔集合的孔序,通过将各类型的凿岩孔集合的孔序相连得到左臂作业区和右臂作业区的孔序;
步骤6:中臂作业区中,使用贪心算法逐一取点组成孔序,完成孔序自动规划;
所述步骤6具体为:
在中臂作业区中,孔序中第i号凿岩孔的评价函数通过下式表示:
其中,为第i号凿岩孔与孔序中前一凿岩孔的距离,/>为第i号凿岩孔与中臂作业区终止凿岩孔的距离;
以中臂作业区起始凿岩孔作为孔序的起点,使用贪心算法依次从中臂作业区孔集合中选取使得评价函数最小的孔作为下一节点,直到分配完中臂作业区中所有凿岩孔;至此左臂作业区、右臂作业区、中臂作业区的孔序规划均已完成,完成规划。
2.根据权利要求1所述的一种应用于三臂凿岩台车的孔序自动规划方法,其特征是:所述步骤1具体为:通过MATLAB读取包含凿岩孔信息的XML格式文件,根据文件中凿岩孔类型标签将凿岩孔分类,根据凿岩孔的坐标绘制凿岩孔分布图,根据机械臂运动空间的分析结果将凿岩孔的分布图分为左臂作业区、右臂作业区和中臂作业区。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111556639.4A CN114102604B (zh) | 2021-12-17 | 2021-12-17 | 一种应用于三臂凿岩台车的孔序自动规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111556639.4A CN114102604B (zh) | 2021-12-17 | 2021-12-17 | 一种应用于三臂凿岩台车的孔序自动规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114102604A CN114102604A (zh) | 2022-03-01 |
CN114102604B true CN114102604B (zh) | 2024-04-05 |
Family
ID=80365991
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111556639.4A Active CN114102604B (zh) | 2021-12-17 | 2021-12-17 | 一种应用于三臂凿岩台车的孔序自动规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114102604B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1599836A (zh) * | 2001-12-03 | 2005-03-23 | 山特维克坦罗克有限公司 | 控制钻孔序列的方法、钻岩设备以及形成钻孔序列的计算机程序 |
JP2005220627A (ja) * | 2004-02-06 | 2005-08-18 | Enzan Kobo:Kk | 削岩機搭載台車における穿孔位置決め制御方法 |
CN201714390U (zh) * | 2010-05-31 | 2011-01-19 | 三一重型装备有限公司 | 一种硬岩液压破碎式掘进机 |
CN108894726A (zh) * | 2018-07-23 | 2018-11-27 | 中铁十九局集团第六工程有限公司 | 三臂凿岩台车隧道全断面钻孔操作方法 |
CN108979529A (zh) * | 2018-08-01 | 2018-12-11 | 中铁十九局集团第六工程有限公司 | 一种两臂凿岩台车隧道钻孔方法 |
CN112539029A (zh) * | 2019-09-05 | 2021-03-23 | 山特维克矿山工程机械有限公司 | 用于钻探次序计划的设备、方法和软件产品 |
CN112861361A (zh) * | 2021-02-20 | 2021-05-28 | 中国铁建重工集团股份有限公司 | 一种基于凿岩台车的工作空间仿真方法 |
-
2021
- 2021-12-17 CN CN202111556639.4A patent/CN114102604B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1599836A (zh) * | 2001-12-03 | 2005-03-23 | 山特维克坦罗克有限公司 | 控制钻孔序列的方法、钻岩设备以及形成钻孔序列的计算机程序 |
JP2005220627A (ja) * | 2004-02-06 | 2005-08-18 | Enzan Kobo:Kk | 削岩機搭載台車における穿孔位置決め制御方法 |
CN201714390U (zh) * | 2010-05-31 | 2011-01-19 | 三一重型装备有限公司 | 一种硬岩液压破碎式掘进机 |
CN108894726A (zh) * | 2018-07-23 | 2018-11-27 | 中铁十九局集团第六工程有限公司 | 三臂凿岩台车隧道全断面钻孔操作方法 |
CN108979529A (zh) * | 2018-08-01 | 2018-12-11 | 中铁十九局集团第六工程有限公司 | 一种两臂凿岩台车隧道钻孔方法 |
CN112539029A (zh) * | 2019-09-05 | 2021-03-23 | 山特维克矿山工程机械有限公司 | 用于钻探次序计划的设备、方法和软件产品 |
CN112861361A (zh) * | 2021-02-20 | 2021-05-28 | 中国铁建重工集团股份有限公司 | 一种基于凿岩台车的工作空间仿真方法 |
Non-Patent Citations (1)
Title |
---|
三臂凿岩机器人孔序规划及其优化;肖永前等;《传感器与微系统》;第38卷(第4期);第73-81页 * |
Also Published As
Publication number | Publication date |
---|---|
CN114102604A (zh) | 2022-03-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105171743B (zh) | 码垛机械臂末端的运动轨迹规划方法 | |
CN111798041A (zh) | 一种基于时间窗的agv智能调度方法 | |
CN105045211B (zh) | 一种等弓高误差变步长切线插补方法 | |
CN113074728B (zh) | 基于跳点寻路与协同避障的多agv路径规划方法 | |
CN103302172B (zh) | 平板冲孔生产线智能适配模具的加工方法及系统 | |
CN102880113A (zh) | 一种激光切割路径优化方法 | |
CN101718977A (zh) | 用于汽车纵梁冲孔加工的cam系统及控制方法和构建方法 | |
CN113953685B (zh) | 一种平面板材激光切割路径规划方法 | |
CN104732355A (zh) | 设备空闲时间段调整的设备驱动综合调度方法 | |
CN110456746A (zh) | 一种多品种混线自动化生产的实时调度方法 | |
CN114102604B (zh) | 一种应用于三臂凿岩台车的孔序自动规划方法 | |
CN108581191A (zh) | 一种激光切割路径规划实现激光头停光空移避障的方法 | |
CN112596464A (zh) | 一种大型复杂舱体结构件数控加工走刀路径优化方法 | |
CN102985886A (zh) | 数控编程方法、数控编程装置、程序及数控装置 | |
CN113359774B (zh) | 一种用于四向穿梭车的路径规划方法 | |
CN112942837B (zh) | 一种悬挑结构混凝土3d打印方法及系统 | |
CN102609564A (zh) | 一种加工特征与加工操作快速定位与对应方法 | |
CN110170416A (zh) | 一种适用多种产品的自动点胶方法及装置 | |
CN102830656B (zh) | 腹面冲孔生产线双冲的加工系统及方法 | |
CN108829032A (zh) | 一种高精度控制的插补算法 | |
CN110618640A (zh) | 一种速度规划的点胶机示教系统 | |
CN102830655B (zh) | U型梁腹面冲孔适配模具的系统和方法 | |
CN114170847B (zh) | 一种移动机器人系统的交通管制方法 | |
CN110188947A (zh) | 盾构纠偏中当前环目标预测方法及系统 | |
CN113505424B (zh) | 一种线性工程派生构件交互式建造方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |