CN111425182A - 基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法 - Google Patents
基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法 Download PDFInfo
- Publication number
- CN111425182A CN111425182A CN202010013306.6A CN202010013306A CN111425182A CN 111425182 A CN111425182 A CN 111425182A CN 202010013306 A CN202010013306 A CN 202010013306A CN 111425182 A CN111425182 A CN 111425182A
- Authority
- CN
- China
- Prior art keywords
- theta
- hole
- drill
- distance
- peripheral
- 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.)
- Granted
Links
- 230000002093 peripheral effect Effects 0.000 title claims abstract description 103
- 238000000034 method Methods 0.000 title claims abstract description 41
- 238000005553 drilling Methods 0.000 claims abstract description 44
- 238000003780 insertion Methods 0.000 claims abstract description 28
- 230000037431 insertion Effects 0.000 claims abstract description 28
- 238000005422 blasting Methods 0.000 claims abstract description 25
- 239000011435 rock Substances 0.000 claims abstract description 22
- 238000013461 design Methods 0.000 claims abstract description 20
- 230000036544 posture Effects 0.000 claims abstract description 17
- 238000000342 Monte Carlo simulation Methods 0.000 claims abstract description 11
- 238000010276 construction Methods 0.000 claims abstract description 10
- 238000004364 calculation method Methods 0.000 claims description 15
- 238000010586 diagram Methods 0.000 claims description 11
- 239000011159 matrix material Substances 0.000 claims description 11
- 230000009466 transformation Effects 0.000 claims description 10
- 238000000354 decomposition reaction Methods 0.000 claims description 5
- 125000004122 cyclic group Chemical group 0.000 claims description 4
- 238000004590 computer program Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 2
- 238000000611 regression analysis Methods 0.000 claims description 2
- 238000003860 storage Methods 0.000 claims description 2
- 230000005641 tunneling Effects 0.000 abstract description 7
- 230000007246 mechanism Effects 0.000 description 6
- 230000000694 effects Effects 0.000 description 4
- 238000013213 extrapolation Methods 0.000 description 3
- 238000012360 testing method Methods 0.000 description 3
- 238000011161 development Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000009412 basement excavation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000003245 coal Substances 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 239000002360 explosive Substances 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000002035 prolonged effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
- 230000014616 translation Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
- E21B44/00—Automatic control systems specially adapted for drilling operations, i.e. self-operating systems which function to carry out or modify a drilling operation without intervention of a human operator, e.g. computer-controlled drilling systems; Systems specially adapted for monitoring a plurality of drilling variables or conditions
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
- E21B15/00—Supports for the drilling machine, e.g. derricks or masts
- E21B15/003—Supports for the drilling machine, e.g. derricks or masts adapted to be moved on their substructure, e.g. with skidding means; adapted to drill a plurality of wells
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
- E21B15/00—Supports for the drilling machine, e.g. derricks or masts
- E21B15/04—Supports for the drilling machine, e.g. derricks or masts specially adapted for directional drilling, e.g. slant hole rigs
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
- E21B7/00—Special methods or apparatus for drilling
- E21B7/02—Drilling rigs characterised by means for land transport with their own drive, e.g. skid mounting or wheel mounting
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
- E21B7/00—Special methods or apparatus for drilling
- E21B7/02—Drilling rigs characterised by means for land transport with their own drive, e.g. skid mounting or wheel mounting
- E21B7/022—Control of the drilling operation; Hydraulic or pneumatic means for activation or operation
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
- E21B7/00—Special methods or apparatus for drilling
- E21B7/04—Directional drilling
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F42—AMMUNITION; BLASTING
- F42D—BLASTING
- F42D1/00—Blasting methods or apparatus, e.g. loading or tamping
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F42—AMMUNITION; BLASTING
- F42D—BLASTING
- F42D3/00—Particular applications of blasting techniques
- F42D3/04—Particular applications of blasting techniques for rock blasting
Landscapes
- Engineering & Computer Science (AREA)
- Geology (AREA)
- Life Sciences & Earth Sciences (AREA)
- Mining & Mineral Resources (AREA)
- Environmental & Geological Engineering (AREA)
- Fluid Mechanics (AREA)
- Physics & Mathematics (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geochemistry & Mineralogy (AREA)
- General Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Earth Drilling (AREA)
- Drilling And Exploitation, And Mining Machines And Methods (AREA)
Abstract
本发明涉及巷、隧道智能掘进机械自动设计***技术领域,提供了一种基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法,基于D‑H法建立钻臂运动模型,通过蒙特卡洛法在各关节范围内随机取值,计算钻头可达位置;对钻头施加判别条件,计算以各种不同姿态钻孔时的最大可钻范围;建立周边孔外插角和该范围横向宽度的函数关系,在钻孔前选择最佳周边孔外插角;确定最佳孔口距及周边孔孔口坐标,结合周边孔轨迹切线确定各周边孔的外插角的水平和竖直分量,完成周边孔设计。该方法适用于电脑凿岩台车在矿山小断面岩巷进行掘进施工时,在自动钻孔定位之前,由车载计算机结合实时工况自动完成周边孔部分的***设计,避免偶然因素影响,提高工作效率。
Description
技术领域
本发明涉及巷、隧道智能掘进机械自动设计***技术领域,特别涉及一种基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法。
背景技术
全电脑凿岩台车受计算机程序控制,在国外隧道建设中大量使用,国内偶有应用。与大断面公路、铁路隧道不同的是,矿山小断面岩巷对防水、防爆安全性有严格要求,且复杂的井下作业环境限制了其在该领域的研发工作,相关试验产品在井下的应用并不理想。因此,开发适用于矿山小断面岩巷的智能掘进机械及相关技术对矿山自动化,智能化施工有重要意义。
轮廓成型质量是巷道***重要的控制指标之一。岩体的过度破坏会增加成本,延长循环时间。国外文献表明:钻孔操作和恰当的***设计对提升***效果以及评估轮廓剖面质量非常关键,且轮廓线上钻出的周边孔的作用对于减少过度破坏是最重要的,必须在设计和标记的位置钻孔,特别是在周边孔部分,否则将引起过度或欠破坏。虽然使用隧道凿岩台车实施自动钻孔定位能够以高精度成型周边孔,减少因钻孔偏差造成的过度开挖,但目前国外最先进的凿岩台车也仅仅能按照预先载入计算机控制程序的***设计方案进行施工,钻孔时受偶然因素影响会造成所有炮孔将无法一次性成型,施工停滞,单循环的工作时间将会延长。而且凿岩台车工作时,实际工况与理想工况往往差距较大,随着井下环境变化,周边孔定位精度往往达不到令人满意的程度。如由于断面轮廓较大而预先设计的周边孔外插角较小,且凿岩台车停车位置不理想时,其工作空间无法覆盖所有炮孔,尤其是周边孔受此影响极大。考虑到中国仍普遍采用人工操作,***设计的实施依赖于工人的技能,导致控制***能力不足,光面***效果差,在施工建设大量展开的前提下,开发出适应性强的国产电脑凿岩台车迫在眉睫。
发明内容
本发明的目的是克服现有技术的不足,提供了一种基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法,适用于电脑凿岩台车在矿山小断面岩巷进行掘进施工时,在自动钻孔定位之前,由车载计算机结合实时工况自动完成周边孔部分的***设计,避免偶然因素影响,提高工作效率。
为了了解机器在复杂环境下的工作能力,首先需要明确钻臂的工作空间:基于D-H法建立钻臂运动学模型,通过蒙特卡洛法在各关节范围内随机取值,以计算钻头能够到达的位置。对于钻爆法的***设计而言,为了达到所有目标任务点,还需要取靠近工作面的部分工作空间进行研究,即对于所有钻头可能到达的位置而言,需要剔除离工作面较远处的点位。得到剩余点位后,对钻臂末端坐标系施加判别条件,计算钻臂末端以各种不同姿态钻孔时的最大可钻范围。该范围受到关节限制和设计参数限制的约束。
其次建立周边孔外插角和对应工作空间(最大可钻范围)横向宽度的函数关系,输入运动控制程序,使凿岩台车在钻孔前能实时通过计算选择合适的周边孔外插角。进而确定最佳孔口距及周边孔孔口坐标,结合周边孔轨迹切线确定各个周边孔的外插角的水平、竖直分量,完成周边孔的自动设计,确保全断面钻孔任务一次性完成。
该技术作为钻爆法炮孔自动设计的一部分,结合电脑凿岩台车优越的机械性能,能够实现精准高效的***效果。
本发明采用如下技术方案:
一种基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法,该方法包括如下步骤:
S1、基于D-H法建立钻臂运动学模型,通过蒙特卡洛法在钻臂各关节范围内随机取值,计算钻头能够到达的位置;
S2、对钻臂末端坐标系设置判别条件,计算钻臂末端以各种不同姿态钻孔时的最大可钻范围;
S3、建立周边孔外插角与该周边孔外插角下钻头最大横向距离的函数关系;根据所述函数关系,给定钻头最大横向距离求得相对应的周边孔外插角;
S4、确定周边孔的最佳孔口距及孔口坐标,并结合周边孔轨迹切线进一步确定各个周边孔的外插角的水平分量、竖直分量,完成周边孔的自动设计。
进一步的,步骤S1中,计算钻头能到到达的位置的方法为:
S1.1将钻臂刚体简化为连杆,将转动轴、移动轴简化为关节,作钻臂简化模型图,确定各关节的基准位置、相对角度和各关节量的变化范围;根据D-H法建立坐标系,通过相邻坐标系之间的变换关系逐级推导出钻臂基坐标系{O0}和钻臂末端坐标系{O末}之间变换的位姿矩阵;钻臂末端钻头在基坐标{O0}下的坐标为(px,py,pz),px为钻孔前进方向,py为横向, pz为竖直方向;
S1.2采用蒙特卡洛法随机选择各关节变量值,得到钻臂各种不同姿态下的位姿矩阵,根据不同位姿矩阵确定钻臂在不同姿态下所钻炮孔的外插角θa。
进一步的,步骤S2中,计算最大可钻范围的具体步骤为:
S2.1所述判别条件为:θa-θ0<|Δ1|,θ0=0,1,2,……为取整数值的θa,Δ1为角度偏差容许值,设定为某极小正角度;经过所述判别条件筛选过的钻臂所有姿态构成满足条件θa∈ (θ0-|Δ1|,θ0+|Δ1|)的工作空间;
S2.2钻臂末端点(px,py,pz)构成点集S0,点集S0满足:
S0={(px,py,pz)|θa-θ0≤|Δ1|,px-p0≤|Δ2|};
其中,p0为工作时凿岩台车到工作断面的最佳距离,Δ2为距离偏差容许值;θ0取不同值时得到不同的点集S0。
进一步的,S3的具体步骤如下:
S3.1构建数值对(θ0,pymax),其中pymax是当前θ0取值下所对应的点集S0中所有钻臂末端点坐标py的最大值,每一个θ0均对应一个pymax;
S3.2拟合所有数值对(θ0,pymax),回归分析出θa和pymax的对应函数关系,使得给定钻头最大横向距离pymax时能求得相对应的炮孔外插角θa。
进一步的,S4的具体步骤如下:
S4.1确定钻爆基本参数:所述基本参数包括循环进尺D、孔口坐标、孔口距边邦轮廓距离L1、孔口距L2、孔底坐标、孔底距边邦轮廓距离L3、孔底距L4;依据岩质、工作时间、钻具参数综合确定D;依据***经验、岩质因素确定L1、L3及L2的取值范围(L2min,L2max);
S4.2确定周边孔外插角θa终:根据台车定位结果确定钻头最大横向距离pymax实际,利用θa和pymax的对应函数关系求得与pymax实际对应的θaL;将θaL与根据***经验获得的外插角建议值θa0比较,取两者较大值作为最终的周边孔外插角θa终=max(θaL,θa0);
S4.3确定周边孔轨迹函数:周边孔轨迹为巷道轮廓线向内偏移L1得到;
S4.4确定周边孔孔口坐标:采用蒙特卡罗法在L2的取值范围(L2min,L2max)内随机选取孔口距L2进行多次计算,单次计算根据从下向上的顺序依次计算周边孔孔口坐标,最高处的两个周边孔孔口距最接近选取孔口距L2的一组做为最终结果;
S4.5周边孔外插角的分解:过各炮孔孔口做周边孔轨迹的切线T,定义切线T与水平线的夹角为θT;将θa分解为水平向夹角α和竖直向夹角β;α、β仅与θT、θa终有关。
进一步的,步骤S4.2中,根据车体定位结果确定凿岩台车中线偏离巷道中线的水平距离E2,再结合巷道半宽h2、双侧钻臂间距一半ε及孔口距边邦轮廓距离L1确定此时所需的钻头最大横向距离pymax实际:
L=|E2|+h2-L1
pymax实际=L-ε。
进一步的,步骤S4.2中,所述外插角建议值θa0的计算公式为:
本发明还提供了一种实现上述基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法的计算机程序。
一种实现上述基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法的信息数据处理终端。
一种计算机可读存储介质,包括指令,当其在计算机上运行时,使得计算机执行上述基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法。
本发明的有益效果为:基于D-H法建立钻臂运动学模型,通过蒙特卡洛法在钻臂各关节范围内随机取值,以计算钻头能够到达的位置。对钻臂末端坐标系施加判别条件,计算钻臂末端以各种不同姿态钻孔时的最大可钻范围。建立周边孔外插角和该范围横向宽度的函数关系,使凿岩台车在钻孔前能实时通过计算选择合适的周边孔外插角。进而确定最佳孔口距及周边孔孔口坐标,结合周边孔轨迹切线确定各个周边孔的外插角的水平、竖直分量,完成周边孔的自动设计。该方法适用于电脑凿岩台车在矿山小断面岩巷进行掘进施工时,在自动钻孔定位之前,由车载计算机结合实时工况自动完成周边孔部分的***设计,避免偶然因素影响,提高工作效率。
附图说明
图1所示为实施例中双臂凿岩台车结构示意图。
图2所示为实施例中钻臂各轴基准位置示意图。
图3所示为实施例中钻臂连杆坐标系示意图。
图4所示为周边孔基本参数示意图。
图5所示为周边孔与车体定位结果关系示意图。
图6所示为实施例中三圆心坐标的计算示意图。
图7所示为实施例中孔口坐标计算示意图。
图8所示为外插角分解示意图。
图9所示为实施例中外插角和工作空间轮廓示意图。
图10所示为实施例中外插角θa和pymax的对应函数关系示意图。
具体实施方式
下文将结合具体附图详细描述本发明具体实施例。应当注意的是,下述实施例中描述的技术特征或者技术特征的组合不应当被认为是孤立的,它们可以被相互组合从而达到更好的技术效果。在下述实施例的附图中,各附图所出现的相同标号代表相同的特征或者部件,可应用于不同实施例中。
不失一般性,下述实施例中,以双臂凿岩台车为例,但并不仅限于双臂凿岩台车;巷道以三心拱巷道为例,但并不仅限于三心拱巷道。本领域技术人员使用本发明思想所做的改变均应涵盖在本申请的包括范围内。
本发明实施例一种基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法,包括如下步骤:
1)获得双臂凿岩台车(如图1)的基础尺寸信息。不同双臂凿岩台车的机构设计与尺寸 (截面尺寸、长度)也不尽相同,但大体都能够简化为连杆和活动关节。将钻臂各刚体简化为连杆,将转动轴、移动轴简化为活动关节,作钻臂简化模型图,明确各关节的基准位置(如图2)及相对角度和各关节量的变化范围。
2)建立钻臂运动学模型
①根据D-H法在钻臂各关节建立坐标系,明确各坐标系的相对变换关系:
因左右双臂机构对称,故可按相同方法在各钻臂各连杆端部都按照同一原则建立一个固连坐标系{Oi}(如图3)。按照钻臂尺寸确定相应的连杆参数列于表1,表2,尺寸变量单位为mm,角度变量单位为°(度)。表1,表2中di、θi两列中θ1-θ5以及d6为关节变量,其值由传感器实时确定。小括号内数据为图2各轴位于基准位置时变量取值。
表1简化机构连杆参数表(左臂)
连杆i | α<sub>i-1</sub> | a<sub>i-1</sub> | d<sub>i</sub> | θ<sub>i</sub> | 取值范围 |
1 | 0 | 0 | 0 | θ<sub>1</sub>(0) | (-14,47) |
2 | -90 | 180 | 0 | θ<sub>2</sub>(90) | (35,106) |
3 | 90 | 53 | 2598 | θ<sub>3</sub>(180) | (40,290) |
4 | 90 | 0 | 0 | θ<sub>4</sub>(90) | (75,180) |
5 | 90 | 136 | 529 | θ<sub>5</sub>(90) | (45,125) |
6 | 90 | 0 | d<sub>6</sub>(1739) | 0 | (1739,3039) |
表2简化机构连杆参数表(右臂)
连杆i | α<sub>i-1</sub> | a<sub>i-1</sub> | d<sub>i</sub> | θ<sub>i</sub> | 取值范围 |
1 | 0 | 0 | 0 | θ<sub>1</sub>(0) | (-47,14) |
2 | -90 | 180 | 0 | θ<sub>2</sub>(90) | (35,106) |
3 | 90 | 53 | 2598 | θ<sub>3</sub>(180) | (70,320) |
4 | 90 | 0 | 0 | θ<sub>4</sub>(90) | (75,180) |
5 | 90 | 136 | 529 | θ<sub>5</sub>(90) | (55,135) |
6 | 90 | 0 | d<sub>6</sub>(1739) | 0 | (1739,3039) |
根据D-H法确定相邻两连杆坐标系的相对关系,坐标系{Oi}可以看成坐标系{Oi-1}按照一定顺序的四次变换(两个旋转Rot和两个平移Trans)得到。设坐标系{Oi}和{Oi-1}的变换矩阵Ai通式:
根据左臂尺寸、角度信息,可依次确定左侧各变换矩阵如下:
式中角θi的正、余弦简化表示为:si、ci。
由坐标系{Oi}和{Oi-1}的变换矩阵Ai,以及坐标系{Oi+1}和{Oi}的变换矩阵Ai+1,可确定坐标系{Oi-1}和{Oi+1}的变换矩阵最终建立钻臂末端坐标系{O6}与钻臂基坐标系{O0}之间的变换矩阵
3)基于判别条件的工作空间计算
①编写MATLAB程序,采用蒙特卡洛法随机选择各关节变量值θ1~θ5,及d6,同各常量一起代入矩阵中进行运算,得到各种不同姿态下的位姿矩阵当凿岩台车刚好停在工作面前理想位置,台车中线与工作面中线共面时,{O6}的Z6轴与{O0}的X0轴的夹角等于该姿态下所钻炮孔的外插角θa,可由矩阵的列向量(ax,ay,az)计算得到:
②设置判别条件θa-θ0<|Δ1|(θ0=0,1,2,……为取整数值的θa,Δ1为角度偏差容许值,一般设定为某极小正角度)。经过筛选得到的所有姿态构成了满足条件θa∈(θ0-|Δ1|,θ0+|Δ1|)的工作空间。该工作空间内,钻臂末端点坐标(px,py,pz)构成点集S0。
S0={(px,py,pz)|θa-θ0≤|Δ1|,px-p0≤|Δ2|}
点集S0中所有点满足距离工作面足够近的约束条件,即px∈(p0-|Δ2|,p0+|Δ2|)(p0为工作时凿岩台车到断面的最佳距离,为预先设定的常数,距台车p0距离的断面为理想断面;Δ2为距离偏差容许值,反映钻臂末端点与理想断面的接近程度,一般设定为比p0小一个数量级的正数)。
③构建数值对(θ0,pymax),其中pymax是当前θ0取值下所对应的点集S0中所有钻臂末端点坐标py的最大值,每一个θ0均对应一个pymax;
pymax={pymax|(px,py,pz)∈S0};
拟合所有数值对(θ0,pymax),找出θa和pymax的对应函数关系。对该函数求逆,使得对给定覆盖范围的工作空间(钻头最大横向距离pymax),能够求得其容许的的炮孔外插角θa。
pymax=f(θa)θa=f-1(pymax)。
4)周边孔位姿参数的确定
①钻爆法周边孔设计需要考虑循环进尺D、孔口坐标、孔口距边邦轮廓距离L1、孔口距 L2、孔底坐标、孔底距边邦轮廓距离L3、孔底距L4等多个参数。计算前需要依据岩质、工作时间、钻具参数等各方面因素综合确定D;依据***经验、岩质等因素确定L1、L3及L2的取值范围。根据L1、L3及D计算得到周边孔外插角的建议值θa0,最终是否采用,需要考察车体定位的结果;
以三心拱巷道为例(如图4)。图4中Of1,Of2,Of3,Ob1,Ob2,Ob3分别为孔口工作面和孔底工作面三心拱的圆心。前后两个工作面沿掘进方向的距离为循环进尺D,且有 D=|Of1Ob1|=|Of2Ob2|=|Of3Ob3|。Bf1,Bf2,Bf3,Bf4分别为孔口工作面上的周边孔孔口,四孔孔口距边邦轮廓距离L1均相等,孔口距L2=|Bf1Bf2|=|Bf3Bf4|。Bb1,Bb2,Bb3,Bb4分别为孔底工作面上的周边孔孔底,四孔孔底距边邦轮廓距离L3均相等,孔底距L4=|Bb1Bb2|=|Bb3Bb4|。B′f1,B′f2,B′f3, B′f4分别为四个周边孔孔口在孔底工作面内的投影点,且有|Bf1B′f1|=|Bf2B′f2|=|Bf3B′f3| =|Bf4B′f4|=D;|B′f1B′f2|=|B′f3B′f4|=L2。∠Bb1Bf1B′f1,∠Bb3Bf3B′f3为周边孔外插角,且有∠Bb1Bf1B′f1=∠Bb3Bf3B′f3。
②仍以三心拱巷道为例,巷道直墙高h1,拱高f,巷道半宽h2。特别的,对于圆拱隧道有f=h2。台车停于工作面前,稳定后不再移动。根据车体定位结果(如图5)确定台车中线偏离巷道中线的水平距离E2。{OC}原点OC到地面的距离为E1,该参数通常不构成对周边孔设计的影响,因此不考虑。
则对于该工况下的台车而言,所有炮孔孔口都应该在覆盖半宽为L的工作空间内。
L=|E2|+h2-L1
该工况下pymax实际=L-ε,ε为双侧钻臂间距一半。根据pymax实际计算确定的θa定义为θaL。将其与周边孔外插角建议值θa0进行比较,确定炮孔外插角最终值θa终。
③计算周边孔孔口所在位置的轨迹。该轨迹分为五段,从左往右依次为平行于左侧直墙的直线段(Line 1),以Of2为圆心的小圆弧段(Curve 1),以Of1为圆心的大圆弧段(Curve 2),以Of3为圆心的小圆弧段(Curve 3),平行于右侧直墙的直线段(Line 2)。该轨迹与边帮轮廓的距离恒为L1。
欲求该轨迹函数,首先需要计算三心拱的三圆心Of1,Of2,Of3的坐标(如图6)。图6中r1-L1为小圆弧半径,θf1为小圆弧圆心角,r2-L1为大圆弧半径,θf2为大圆弧圆心角。
则周边孔轨迹方程为:
④确定周边孔的孔口坐标。拟沿轨迹布置一圈周边孔,各孔口距相等,且沿巷道中线对称(如图7)。因左侧周边孔孔口坐标均为正,故只计算左侧,通过镜像确定右侧周边孔孔口坐标。孔口距L2的取值范围依据***经验、岩质等因素事先确定。设L2∈(L2min,L2max),采用蒙特卡罗法在取值范围内随机选取L2进行多次计算。单次计算根据从下向上的原则依次计算周边孔孔口坐标,最高处的两周边孔孔口距最接近L2的一组为最终结果。
单次计算步骤如下:
计算直线段(line1)上的炮孔数N1,注意到Floor函数为向下取整函数。
因此直线段(line1)上位置最低周边孔B1坐标为(h2-L1,L1+L2);周边孔Bu坐标为(h2-L1,L1+u·L2),其中u为炮孔编号,1<u<=N1;位置最高周边孔BN1坐标为(h2-L1,L1+N1·L2)。
计算曲线1段(curve 1)上位置最低周边孔BN1+1坐标为(xN1+1,yN1+1),注意到yN1+1>h1。
计算曲线1段(curve 1)上的炮孔数N2-N1,注意到Ceil函数为向上取整函数。
计算曲线1段(curve 1)上周边孔Bv坐标。v为炮孔编号,N1+1<v<=N2。
计算曲线2段(curve 2)上位置最低周边孔BN2+1坐标为(xN2+1,yN2+1),注意取xN2+1较小的解。
计算曲线2段(curve 2)上的炮孔数N3-N2,注意到Ceil函数为向上取整函数。
计算曲线2段(curve 2)上周边孔Bw坐标。w为炮孔编号,N2+1<w<=N3。
⑤起拱线以上周边孔外插角的分解
将起拱线以上各周边孔的θa分解为水平向夹角α和竖直向夹角β。该计算过程需要已知各炮孔坐标及对应θTk。θTk为过各炮孔孔口做周边孔轨迹的切线,该切线T与水平的夹角。计算曲线1段(curve 1)及曲线2段(curve 2)上各周边孔Bk对应θTk的值。
根据空间几何关系(如图8),分解θa。
现场应用的具体情况:
将上述结果编写成程序,和台车运动控制程序一起,进行井下试验。按照3)节内容对炮孔外插角和工作空间尺寸的关系进行了计算,求θ0分别等于0,1,2,……,14°时的单臂工作空间尺寸。
分别设置Δ1=0.1°,p0=4900mm,Δ2=100mm。各θ0对应工作空间内均包含50000个数据点。得到各θ0和对应工作空间数据点轮廓(外包络线)的关系(如图9)。针对图9中虚线框内的轮廓线进行分析(周边孔一般布置在该区域)。
取各θ0及其对应pymax进行组合。为避免计算过程中偶然因素造成结果不可靠,同时取 各工况下py最大的前100个值求平均值,与θ0进行组合(如图10)。在MATLAB中采用三 次多项式对图10中的点进行拟合,得到θa和pymax/pymean的函数关系。
试验及生产在中国四川广安绿水洞煤矿进行,为三心拱巷道,直墙高h1=2m,拱高f=1.6m,巷道半宽h2=2.4m。计算得到三圆心坐标Of1(0m,0.2789m);Of2(1.1474m,2m);Of3(-1.1474 m,2m),此外r1=1.2526m;r2=3.3211m;θf1=56.3099°;θf2=67.3801°。巷道岩质极硬,自稳性较好,爆后无支护措施。设计循环进尺D=1.8m;孔口距边邦轮廓距离L1=200mm,孔口距L2∈(400mm,500mm);孔底距边邦轮廓距离L3=50mm。因此θa0=7.9072°,取8°。车体定位后,台车中线偏离巷道中线的水平距离E2∈(-200mm,200mm)。因此,工作空间的覆盖半宽L∈(2200mm,2400mm),对应单臂pymax∈(1935mm,2135mm),该距离下θaL<1,说明巷道设计宽度不大。由于θaL<θa0,故采用θa0作为θa终。
按照4)节内容计算周边孔孔口坐标及起拱线以上周边孔对应切线角θTk、分解角α、β。经程序计算,得到L2=443.8870mm,xN3-L2=0.1244mm。各孔位姿参数如表3所示。
表3周边孔位姿参数
孔号 | X坐标/mm | Y坐标/mm | θ<sub>T</sub>(°) | α(°) | β(°) |
1 | 2200 | 643.887 | 90 | 8 | 0 |
2 | 2200 | 1087.774 | 90 | 8 | 0 |
3 | 2200 | 1531.661 | 90 | 8 | 0 |
4 | 2200 | 1975.548 | 90 | 8 | 0 |
5 | 2116.248 | 2411.462 | 66.989 | 7.371 | 3.119 |
6 | 1860.485 | 2774.259 | 42.645 | 5.439 | 5.876 |
7 | 1491.279 | 3020.679 | 28.542 | 3.842 | 7.022 |
8 | 1087.245 | 3204.505 | 20.387 | 2.803 | 7.496 |
9 | 661.219 | 3329.155 | 12.231 | 1.705 | 7.817 |
10 | 221.819 | 3392.108 | 4.075 | 0.572 | 7.980 |
现场实测周边孔自动定位精度为8.1cm。在巷道进行了大量的相邻孔间移动时间的测试,并与以前使用6连阀进行手动操作时的走孔时间进行了比较。自动定位走孔平均时间23s,手动定位平均走孔时间51s,自动定位较手动操作缩短了55%的时间。
以上所述仅是本发明针对特定机构双臂钻孔凿岩台车所提出的周边孔自动确定方法,应当指出,对于本技术领域的其他双臂台车来说,即使尺寸、机构发生一定变化,但仍以其工作空间为基础确定周边孔位姿参数的,这些变化也应该视为本发明的保护范围。同时,由于圆拱隧道可以视为三心拱隧道的特例,因此使用凿岩台车进行圆拱隧道周边孔自动设计也应该视为本发明的保护范围;同时本发明方法也适用于一些异形的巷道。
本文虽然已经给出了本发明的几个实施例,但是本领域的技术人员应当理解,在不脱离本发明精神的情况下,可以对本文的实施例进行改变。上述实施例只是示例性的,不应以本文的实施例作为本发明权利范围的限定。
Claims (10)
1.一种基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法,其特征在于,该方法包括如下步骤:
S1、基于D-H法建立钻臂运动学模型,通过蒙特卡洛法在钻臂各关节范围内随机取值,计算钻头能够到达的位置;
S2、对钻臂末端坐标系设置判别条件,计算钻臂末端以各种不同姿态钻孔时的最大可钻范围;
S3、建立周边孔外插角与该周边孔外插角下钻头最大横向距离的函数关系;根据所述函数关系,给定钻头最大横向距离求得相对应的周边孔外插角;
S4、确定周边孔的最佳孔口距及孔口坐标,并结合周边孔轨迹切线进一步确定各个周边孔的外插角的水平分量、竖直分量,完成周边孔的自动设计。
2.如权利要求1所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法,其特征在于,步骤S1中,计算钻头能到到达的位置的方法为:
S1.1将钻臂刚体简化为连杆,将转动轴、移动轴简化为关节,作钻臂简化模型图,确定各关节的基准位置、相对角度和各关节量的变化范围;根据D-H法建立坐标系,通过相邻坐标系之间的变换关系逐级推导出钻臂基坐标系{O0}和钻臂末端坐标系{O末}之间变换的位姿矩阵;钻臂末端钻头在基坐标{O0}下的坐标为(px,py,pz),px为钻孔前进方向,py为横向,pz为竖直方向;
S1.2采用蒙特卡洛法随机选择各关节变量值,得到钻臂各种不同姿态下的位姿矩阵,根据不同位姿矩阵确定钻臂在不同姿态下所钻炮孔的外插角θa。
3.如权利要求2所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法,其特征在于,步骤S2中,计算最大可钻范围的具体步骤为:
S2.1所述判别条件为:θa-θ0<|Δ1|,θ0=0,1,2,……为取整数值的θa,Δ1为角度偏差容许值;经过所述判别条件筛选过的钻臂所有姿态构成满足条件θa∈(θ0-|Δ1|,θ0+|Δ1|)的工作空间;
S2.2钻臂末端点(px,py,pz)构成点集S0,点集S0满足:
S0={(px,py,pz)|θa-θ0≤|Δ1|,px-p0≤|Δ2|};
其中,p0为工作时凿岩台车到工作断面的最佳距离,Δ2为距离偏差容许值;θ0取不同值时得到不同的点集S0。
4.如权利要求3所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法,其特征在于,S3的具体步骤如下:
S3.1构建数值对(θ0,pymax),其中pymax是当前θ0取值下所对应的点集S0中所有钻臂末端点坐标py的最大值,每一个θ0均对应一个pymax;
S3.2拟合所有数值对(θ0,pymax),回归分析出θa和pymax的对应函数关系,使得给定钻头最大横向距离pymax时能求得相对应的炮孔外插角θa。
5.如权利要求3或4所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法,其特征在于,S4的具体步骤如下:
S4.1确定钻爆基本参数:所述基本参数包括循环进尺D、孔口坐标、孔口距边邦轮廓距离L1、孔口距L2、孔底坐标、孔底距边邦轮廓距离L3、孔底距L4;依据岩质、工作时间、钻具参数综合确定D;依据***经验、岩质因素确定L1、L3及L2的取值范围(L2min,L2max);
S4.2确定周边孔外插角θa终:根据台车定位结果确定钻头最大横向距离pymax实际,利用θa和pymax的对应函数关系求得与pymax实际对应的θaL;将θaL与根据***经验获得的外插角建议值θa0比较,取两者较大值作为最终的周边孔外插角θa终=max(θaL,θa0);
S4.3确定周边孔轨迹函数:周边孔轨迹为巷道轮廓线向内偏移L1得到;
S4.4确定周边孔孔口坐标:采用蒙特卡罗法在L2的取值范围(L2min,L2max)内随机选取孔口距L2进行多次计算,单次计算根据从下向上的顺序依次计算周边孔孔口坐标,最高处的两个周边孔孔口距最接近选取孔口距L2的一组做为最终结果;
S4.5周边孔外插角的分解:过各炮孔孔口做周边孔轨迹的切线T,定义切线T与水平线的夹角为θT;将θa分解为水平向夹角α和竖直向夹角β;α、β仅与θT、θa终有关。
6.如权利要求5所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法,其特征在于,步骤S4.2中,根据车体定位结果确定凿岩台车中线偏离巷道中线的水平距离E2,再结合巷道半宽h2、双侧钻臂间距一半ε及孔口距边邦轮廓距离L1确定此时所需的钻头最大横向距离pymax实际:
L=|E2|+h2-L1
pymax实际=L-ε。
8.一种实现如权利要求1-7任一项所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法的计算机程序。
9.一种实现如权利要求1-7任一项所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法的信息数据处理终端。
10.一种计算机可读存储介质,包括指令,当其在计算机上运行时,使得计算机执行如权利要求1-7任一项所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010013306.6A CN111425182B (zh) | 2020-01-07 | 2020-01-07 | 基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010013306.6A CN111425182B (zh) | 2020-01-07 | 2020-01-07 | 基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111425182A true CN111425182A (zh) | 2020-07-17 |
CN111425182B CN111425182B (zh) | 2021-07-09 |
Family
ID=71546970
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010013306.6A Active CN111425182B (zh) | 2020-01-07 | 2020-01-07 | 基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111425182B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113932666A (zh) * | 2021-09-02 | 2022-01-14 | 中铁十八局集团有限公司 | 一种山岭隧道精确施工方法及结构 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100078215A1 (en) * | 2006-12-22 | 2010-04-01 | Saeleniemi Tommi | Designing drilling pattern for excavating rock cavern |
WO2013098460A1 (en) * | 2011-12-28 | 2013-07-04 | Sandvik Mining And Construction Oy | Method and mining vehicle for post-drilling insertion |
CN105605996A (zh) * | 2016-01-28 | 2016-05-25 | 中交隧道工程局有限公司北京分公司 | 一种使用三臂凿岩台车在ⅳ级围岩中台阶法施工的方法 |
CN105625943A (zh) * | 2016-01-11 | 2016-06-01 | 德阳坚兵工程技术有限公司 | 采用凿岩台车微调钻杆周边成孔精确控制超欠挖的方法 |
CN107885916A (zh) * | 2017-10-27 | 2018-04-06 | 西安工业大学 | 一种基于cfdh法的凿岩台车钻臂运动学分析方法 |
CN108301766A (zh) * | 2018-02-08 | 2018-07-20 | 北京科技大学 | 一种钻孔自动定位凿岩台车的双钻臂车体定位方法 |
CN108930539A (zh) * | 2018-08-02 | 2018-12-04 | 中铁十八局集团有限公司 | 一种基于bim隧道超欠挖控制的方法 |
CN109723444A (zh) * | 2019-01-04 | 2019-05-07 | 中铁十一局集团第四工程有限公司 | 一种软弱围岩隧道机械化全断面快速开挖成环钻眼***施工工法 |
-
2020
- 2020-01-07 CN CN202010013306.6A patent/CN111425182B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100078215A1 (en) * | 2006-12-22 | 2010-04-01 | Saeleniemi Tommi | Designing drilling pattern for excavating rock cavern |
WO2013098460A1 (en) * | 2011-12-28 | 2013-07-04 | Sandvik Mining And Construction Oy | Method and mining vehicle for post-drilling insertion |
CN105625943A (zh) * | 2016-01-11 | 2016-06-01 | 德阳坚兵工程技术有限公司 | 采用凿岩台车微调钻杆周边成孔精确控制超欠挖的方法 |
CN105605996A (zh) * | 2016-01-28 | 2016-05-25 | 中交隧道工程局有限公司北京分公司 | 一种使用三臂凿岩台车在ⅳ级围岩中台阶法施工的方法 |
CN107885916A (zh) * | 2017-10-27 | 2018-04-06 | 西安工业大学 | 一种基于cfdh法的凿岩台车钻臂运动学分析方法 |
CN108301766A (zh) * | 2018-02-08 | 2018-07-20 | 北京科技大学 | 一种钻孔自动定位凿岩台车的双钻臂车体定位方法 |
CN108930539A (zh) * | 2018-08-02 | 2018-12-04 | 中铁十八局集团有限公司 | 一种基于bim隧道超欠挖控制的方法 |
CN109723444A (zh) * | 2019-01-04 | 2019-05-07 | 中铁十一局集团第四工程有限公司 | 一种软弱围岩隧道机械化全断面快速开挖成环钻眼***施工工法 |
Non-Patent Citations (2)
Title |
---|
吴昊骏等: "基于双侧钻臂位姿协同约束的凿岩台车车体定位方法", 《煤炭学报》 * |
林智秋等: "液压凿岩台车钻臂工作空间分析及仿真", 《机械设计与制造》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113932666A (zh) * | 2021-09-02 | 2022-01-14 | 中铁十八局集团有限公司 | 一种山岭隧道精确施工方法及结构 |
Also Published As
Publication number | Publication date |
---|---|
CN111425182B (zh) | 2021-07-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109579831B (zh) | 矿用悬臂式掘进机可视化辅助导引方法和*** | |
US10975695B2 (en) | Hydraulic support monitoring support pose in real time based on inertia measurement unit and detection method thereof | |
Subrin et al. | Improvement of the mobile robot location dedicated for habitable house construction by 3D printing | |
CN106313007B (zh) | 并联型钻床的示教再现*** | |
CN111425182B (zh) | 基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法 | |
CN110722562B (zh) | 一种用于机器人参数辨识的空间雅克比矩阵构造方法 | |
CN108724695A (zh) | 一种地下封存空间的构建封存方法 | |
CN111459160A (zh) | 一种开放道路无人洗扫车大规模轨迹平滑方法 | |
Tian et al. | Kinematic models and simulations for trajectory planning in the cutting of Spatially-Arbitrary crosssections by a robotic roadheader | |
CN111274696B (zh) | 一种实时获取凿岩台车双三角钻臂空间位置姿态的方法 | |
CN102393211B (zh) | 一种悬臂式掘进机断面监视***性能检验方法 | |
CN107869309A (zh) | 小井斜情况下的井眼轨迹控制方法及装置 | |
WO2018095321A1 (zh) | 一种伞钻的大臂自动定位装置及方法 | |
CN205920091U (zh) | 一种弯管自动检测探伤*** | |
CN105551074A (zh) | 一种用于无人化采掘工作面的三维模型自动更新方法 | |
Cui et al. | Spiral trajectory planning approach for underground cavity measurements based on laser scanning | |
Shen et al. | Collision detection of virtual powered support groups under complex floors | |
CN106353401A (zh) | 一种弯管自动检测探伤*** | |
CN114440831A (zh) | 基于全站仪点投影的矿山断面检查方法 | |
CN106404910A (zh) | 一种弯管自动检测探伤方法 | |
CN114737992A (zh) | 一种分析盾构管片纵缝接头在管节收敛变形中显要性的***及应用 | |
CN107220213A (zh) | 五轴数控机床在线测量分析方法 | |
CN106321062B (zh) | Sagd双水平井的生产井靶区钻遇率的获取方法 | |
Zhao et al. | Automatic positioning of hydraulic anchor rod drilling rod spacing | |
CN116163755A (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 |