基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法

摘要

本发明涉及巷、隧道智能掘进机械自动设计爆破技术领域，提供了一种基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法，基于D‑H法建立钻臂运动模型，通过蒙特卡洛法在各关节范围内随机取值，计算钻头可达位置；对钻头施加判别条件，计算以各种不同姿态钻孔时的最大可钻范围；建立周边孔外插角和该范围横向宽度的函数关系，在钻孔前选择最佳周边孔外插角；确定最佳孔口距及周边孔孔口坐标，结合周边孔轨迹切线确定各周边孔的外插角的水平和竖直分量，完成周边孔设计。该方法适用于电脑凿岩台车在矿山小断面岩巷进行掘进施工时，在自动钻孔定位之前，由车载计算机结合实时工况自动完成周边孔部分的爆破设计，避免偶然因素影响，提高工作效率。

权利要求

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周边孔外插角θa终的分解：过各炮孔孔口做周边孔轨迹的切线T，定义切线T与水平线的夹角为θT；将θa终分解为水平向夹角α和竖直向夹角β；α、β仅与θT、θa终有关。

6.如权利要求5所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法，其特征在于，步骤S4.2中，根据车体定位结果确定凿岩台车中线偏离巷道中线的水平距离E2，再结合巷道半宽h2、双侧钻臂间距一半ε及孔口距边邦轮廓距离L1确定此时所需的钻头最大横向距离pymax实际，L为工作空间的半宽：L＝|E2|+h2‑L1；

pymax实际＝L‑ε。

7.如权利要求5所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法，其特征在于，步骤S4.2中，所述外插角建议值θa0的计算公式为：

8.一种实现如权利要求1‑7任一项所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法的信息数据处理终端。

9.一种计算机可读存储介质，包括指令，当其在计算机上运行时，使得计算机执行如权利要求1‑7任一项所述的基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法。

说明书

基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法

技术领域

[0001] 本发明涉及巷、隧道智能掘进机械自动设计爆破技术领域，特别涉及一种基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法。

背景技术

[0002] 全电脑凿岩台车受计算机程序控制，在国外隧道建设中大量使用，国内偶有应用。与大断面公路、铁路隧道不同的是，矿山小断面岩巷对防水、防爆安全性有严格要求，且复
杂的井下作业环境限制了其在该领域的研发工作，相关试验产品在井下的应用并不理想。
因此，开发适用于矿山小断面岩巷的智能掘进机械及相关技术对矿山自动化，智能化施工
有重要意义。

[0003] 轮廓成型质量是巷道爆破重要的控制指标之一。岩体的过度破坏会增加成本，延长循环时间。国外文献表明：钻孔操作和恰当的爆破设计对提升爆破效果以及评估轮廓剖
面质量非常关键，且轮廓线上钻出的周边孔的作用对于减少过度破坏是最重要的，必须在
设计和标记的位置钻孔，特别是在周边孔部分，否则将引起过度或欠破坏。虽然使用隧道凿
岩台车实施自动钻孔定位能够以高精度成型周边孔，减少因钻孔偏差造成的过度开挖，但
目前国外最先进的凿岩台车也仅仅能按照预先载入计算机控制程序的爆破设计方案进行
施工，钻孔时受偶然因素影响会造成所有炮孔将无法一次性成型，施工停滞，单循环的工作
时间将会延长。而且凿岩台车工作时，实际工况与理想工况往往差距较大，随着井下环境变
化，周边孔定位精度往往达不到令人满意的程度。如由于断面轮廓较大而预先设计的周边
孔外插角较小，且凿岩台车停车位置不理想时，其工作空间无法覆盖所有炮孔，尤其是周边
孔受此影响极大。考虑到中国仍普遍采用人工操作，爆破设计的实施依赖于工人的技能，导
致控制爆破能力不足，光面爆破效果差，在施工建设大量展开的前提下，开发出适应性强的
国产电脑凿岩台车迫在眉睫。

发明内容

[0004] 本发明的目的是克服现有技术的不足，提供了一种基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法，适用于电脑凿岩台车在矿山小断面岩巷进行掘进施工时，在
自动钻孔定位之前，由车载计算机结合实时工况自动完成周边孔部分的爆破设计，避免偶
然因素影响，提高工作效率。

[0005] 为了了解机器在复杂环境下的工作能力，首先需要明确钻臂的工作空间：基于D‑H 法建立钻臂运动学模型，通过蒙特卡洛法在各关节范围内随机取值，以计算钻头能够到达
的位置。对于钻爆法的爆破设计而言，为了达到所有目标任务点，还需要取靠近工作面的部
分工作空间进行研究，即对于所有钻头可能到达的位置而言，需要剔除离工作面较远处的
点位。得到剩余点位后，对钻臂末端坐标系施加判别条件，计算钻臂末端以各种不同姿态钻
孔时的最大可钻范围。该范围受到关节限制和设计参数限制的约束。

[0006] 其次建立周边孔外插角和对应工作空间(最大可钻范围)横向宽度的函数关系，输入运动控制程序，使凿岩台车在钻孔前能实时通过计算选择合适的周边孔外插角。进而确
定最佳孔口距及周边孔孔口坐标，结合周边孔轨迹切线确定各个周边孔的外插角的水平、
竖直分量，完成周边孔的自动设计，确保全断面钻孔任务一次性完成。

[0007] 该技术作为钻爆法炮孔自动设计的一部分，结合电脑凿岩台车优越的机械性能，能够实现精准高效的爆破效果。

[0008] 本发明采用如下技术方案：

[0009] 一种基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法，该方法包括如下步骤：

[0010] S1、基于D‑H法建立钻臂运动学模型，通过蒙特卡洛法在钻臂各关节范围内随机取值，计算钻头能够到达的位置；

[0011] S2、对钻臂末端坐标系设置判别条件，计算钻臂末端以各种不同姿态钻孔时的最大可钻范围；

[0012] S3、建立周边孔外插角与该周边孔外插角下钻头最大横向距离的函数关系；根据所述函数关系，给定钻头最大横向距离求得相对应的周边孔外插角；

[0013] S4、确定周边孔的最佳孔口距及孔口坐标，并结合周边孔轨迹切线进一步确定各个周边孔的外插角的水平分量、竖直分量，完成周边孔的自动设计。

[0014] 进一步的，步骤S1中，计算钻头能到到达的位置的方法为：

[0015] S1.1将钻臂刚体简化为连杆，将转动轴、移动轴简化为关节，作钻臂简化模型图，确定各关节的基准位置、相对角度和各关节量的变化范围；根据D‑H法建立坐标系，通过相
邻坐标系之间的变换关系逐级推导出钻臂基坐标系{O0}和钻臂末端坐标系{O末}之间变换
的位姿矩阵；钻臂末端钻头在基坐标{O0}下的坐标为(px,py,pz)，px为钻孔前进方向，py为横
向， pz为竖直方向；

[0016] S1.2采用蒙特卡洛法随机选择各关节变量值，得到钻臂各种不同姿态下的位姿矩阵，根据不同位姿矩阵确定钻臂在不同姿态下所钻炮孔的外插角θa。

[0017] 进一步的，步骤S2中，计算最大可钻范围的具体步骤为：

[0018] S2.1所述判别条件为：θa‑θ0<|Δ1|，θ0＝0,1,2,……为取整数值的θa，Δ1为角度偏差容许值，设定为某极小正角度；经过所述判别条件筛选过的钻臂所有姿态构成满足条件
θa∈ (θ0‑|Δ1|,θ0+|Δ1|)的工作空间；

[0019] S2.2钻臂末端点(px,py,pz)构成点集S0，点集S0满足：

[0020] S0＝{(px,py,pz)|θa‑θ0≤|Δ1|,px‑p0≤|Δ2|}；

[0021] 其中，p0为工作时凿岩台车到工作断面的最佳距离，Δ2为距离偏差容许值；θ0取不同值时得到不同的点集S0。

[0022] 进一步的，S3的具体步骤如下：

[0023] S3.1构建数值对(θ0，pymax)，其中pymax是当前θ0取值下所对应的点集S0中所有钻臂末端点坐标py的最大值，每一个θ0均对应一个pymax；

[0024] S3.2拟合所有数值对(θ0，pymax)，回归分析出θa和pymax的对应函数关系，使得给定钻头最大横向距离pymax时能求得相对应的炮孔外插角θa。

[0025] 进一步的，S4的具体步骤如下：

[0026] S4.1确定钻爆基本参数：所述基本参数包括循环进尺D、孔口坐标、孔口距边邦轮廓距离L1、孔口距L2、孔底坐标、孔底距边邦轮廓距离L3、孔底距L4；依据岩质、工作时间、钻
具参数综合确定D；依据爆破经验、岩质因素确定L1、L3及L2的取值范围(L2min,L2max)；

[0027] S4.2确定周边孔外插角θa终：根据台车定位结果确定钻头最大横向距离pymax实际，利用θa和pymax的对应函数关系求得与pymax实际对应的θaL；将θaL与根据爆破经验获得的外插角建
议值θa0比较，取两者较大值作为最终的周边孔外插角θa终＝max(θaL，θa0)；

[0028] S4.3确定周边孔轨迹函数：周边孔轨迹为巷道轮廓线向内偏移L1得到；

[0029] S4.4确定周边孔孔口坐标：采用蒙特卡罗法在L2的取值范围(L2min,L2max)内随机选取孔口距L2进行多次计算，单次计算根据从下向上的顺序依次计算周边孔孔口坐标，最高
处的两个周边孔孔口距最接近选取孔口距L2的一组做为最终结果；

[0030] S4.5周边孔外插角的分解：过各炮孔孔口做周边孔轨迹的切线T，定义切线T与水平线的夹角为θT；将θa分解为水平向夹角α和竖直向夹角β；α、β仅与θT、θa终有关。

[0031] 进一步的，步骤S4.2中，根据车体定位结果确定凿岩台车中线偏离巷道中线的水平距离E2，再结合巷道半宽h2、双侧钻臂间距一半ε及孔口距边邦轮廓距离L1确定此时所需
的钻头最大横向距离pymax实际：

[0032] L＝|E2|+h2‑L1

[0033] pymax实际＝L‑ε。

[0034] 进一步的，步骤S4.2中，所述外插角建议值θa0的计算公式为：

[0035]

[0036] 本发明还提供了一种实现上述基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法的计算机程序。

[0037] 一种实现上述基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法的信息数据处理终端。

[0038] 一种计算机可读存储介质，包括指令，当其在计算机上运行时，使得计算机执行上述基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法。

[0039] 本发明的有益效果为：基于D‑H法建立钻臂运动学模型，通过蒙特卡洛法在钻臂各关节范围内随机取值，以计算钻头能够到达的位置。对钻臂末端坐标系施加判别条件，计算
钻臂末端以各种不同姿态钻孔时的最大可钻范围。建立周边孔外插角和该范围横向宽度的
函数关系，使凿岩台车在钻孔前能实时通过计算选择合适的周边孔外插角。进而确定最佳
孔口距及周边孔孔口坐标，结合周边孔轨迹切线确定各个周边孔的外插角的水平、竖直分
量，完成周边孔的自动设计。该方法适用于电脑凿岩台车在矿山小断面岩巷进行掘进施工
时，在自动钻孔定位之前，由车载计算机结合实时工况自动完成周边孔部分的爆破设计，避
免偶然因素影响，提高工作效率。

附图说明

[0040] 图1所示为实施例中双臂凿岩台车结构示意图。

[0041] 图2所示为实施例中钻臂各轴基准位置示意图。

[0042] 图3所示为实施例中钻臂连杆坐标系示意图。

[0043] 图4所示为周边孔基本参数示意图。

[0044] 图5所示为周边孔与车体定位结果关系示意图。

[0045] 图6所示为实施例中三圆心坐标的计算示意图。

[0046] 图7所示为实施例中孔口坐标计算示意图。

[0047] 图8所示为外插角分解示意图。

[0048] 图9所示为实施例中外插角和工作空间轮廓示意图。

[0049] 图10所示为实施例中外插角θa和pymax的对应函数关系示意图。

具体实施方式

[0050] 下文将结合具体附图详细描述本发明具体实施例。应当注意的是，下述实施例中描述的技术特征或者技术特征的组合不应当被认为是孤立的，它们可以被相互组合从而达
到更好的技术效果。在下述实施例的附图中，各附图所出现的相同标号代表相同的特征或
者部件，可应用于不同实施例中。

[0051] 不失一般性，下述实施例中，以双臂凿岩台车为例，但并不仅限于双臂凿岩台车；巷道以三心拱巷道为例，但并不仅限于三心拱巷道。本领域技术人员使用本发明思想所做
的改变均应涵盖在本申请的包括范围内。

[0052] 本发明实施例一种基于全电脑凿岩台车工作空间的周边孔位姿参数确定方法，包括如下步骤：

[0053] 1)获得双臂凿岩台车(如图1)的基础尺寸信息。不同双臂凿岩台车的机构设计与尺寸 (截面尺寸、长度)也不尽相同，但大体都能够简化为连杆和活动关节。将钻臂各刚体
简化为连杆，将转动轴、移动轴简化为活动关节，作钻臂简化模型图，明确各关节的基准位
置(如图2)及相对角度和各关节量的变化范围。

[0054] 2)建立钻臂运动学模型

[0055] ①根据D‑H法在钻臂各关节建立坐标系，明确各坐标系的相对变换关系：

[0056] 因左右双臂机构对称，故可按相同方法在各钻臂各连杆端部都按照同一原则建立一个固连坐标系{Oi}(如图3)。按照钻臂尺寸确定相应的连杆参数列于表1，表2，尺寸变量
单位为mm，角度变量单位为°(度)。表1，表2中di、θi两列中θ1‑θ5以及d6为关节变量，其值由传
感器实时确定。小括号内数据为图2各轴位于基准位置时变量取值。

[0057] 表1简化机构连杆参数表(左臂)

[0058]连杆i αi‑1 ai‑1 di θi 取值范围
1 0 0 0 θ1(0) (‑14，47)
2 ‑90 180 0 θ2(90) (35，106)
3 90 53 2598 θ3(180) (40，290)
4 90 0 0 θ4(90) (75，180)
5 90 136 529 θ5(90) (45，125)
6 90 0 d6(1739) 0 (1739，3039)

[0059] 表2简化机构连杆参数表(右臂)

[0060] 连杆i αi‑1 ai‑1 di θi 取值范围1 0 0 0 θ1(0) (‑47，14)
2 ‑90 180 0 θ2(90) (35，106)
3 90 53 2598 θ3(180) (70，320)
4 90 0 0 θ4(90) (75，180)
5 90 136 529 θ5(90) (55，135)
6 90 0 d6(1739) 0 (1739，3039)

[0061] 根据D‑H法确定相邻两连杆坐标系的相对关系，坐标系{Oi}可以看成坐标系{Oi‑1}按照一定顺序的四次变换(两个旋转Rot和两个平移Trans)得到。设坐标系{Oi}和{Oi‑1}的
变换矩阵Ai通式：

[0062]

[0063] 根据左臂尺寸、角度信息，可依次确定左侧各变换矩阵如下：

[0064]

[0065]

[0066] 式中角θi的正、余弦简化表示为：si、ci。

[0067] 由坐标系{Oi}和{Oi‑1}的变换矩阵Ai，以及坐标系{Oi+1}和{Oi}的变换矩阵Ai+1，可确定坐标系{Oi‑1}和{Oi+1}的变换矩阵 最终建立钻臂末端坐标系{O6}与钻臂基坐标系
{O0}之间的变换矩阵

[0068]

[0069] 因钻臂尺寸固定，且各关节转角、位移都可以通过传感器检测得到，故矩阵 在任意时刻和状态下都是可测的，唯一确定的。设：

[0070]

[0071] 3)基于判别条件的工作空间计算

[0072] ①编写MATLAB程序，采用蒙特卡洛法随机选择各关节变量值θ1～θ5，及d6，同各常量一起代入矩阵中进行运算，得到各种不同姿态下的位姿矩阵 当凿岩台车刚好停在工
作面前理想位置，台车中线与工作面中线共面时，{O6}的Z6轴与{O0}的X0轴的夹角等于该姿
态下所钻炮孔的外插角θa，可由矩阵 的列向量(ax,ay,az)计算得到：

[0073]

[0074] ②设置判别条件θa‑θ0<|Δ1|(θ0＝0,1,2,……为取整数值的θa，Δ1为角度偏差容许值，一般设定为某极小正角度)。经过筛选得到的所有姿态构成了满足条件θa∈(θ0‑|Δ1
|,θ0+|Δ1|)的工作空间。该工作空间内，钻臂末端点坐标(px,py,pz)构成点集S0。

[0075] S0＝{(px,py,pz)|θa‑θ0≤|Δ1|,px‑p0≤|Δ2|}

[0076] 点集S0中所有点满足距离工作面足够近的约束条件，即px∈(p0‑|Δ2|,p0+|Δ2|)(p0为工作时凿岩台车到断面的最佳距离，为预先设定的常数，距台车p0距离的断面为理想
断面；Δ2为距离偏差容许值，反映钻臂末端点与理想断面的接近程度，一般设定为比p0小一
个数量级的正数)。

[0077] ③构建数值对(θ0，pymax)，其中pymax是当前θ0取值下所对应的点集S0中所有钻臂末端点坐标py的最大值，每一个θ0均对应一个pymax；

[0078] pymax＝{pymax|(px,py,pz)∈S0}；

[0079] 拟合所有数值对(θ0，pymax)，找出θa和pymax的对应函数关系。对该函数求逆，使得对给定覆盖范围的工作空间(钻头最大横向距离pymax)，能够求得其容许的的炮孔外插角θa。

[0080] pymax＝f(θa)θa＝f‑1(pymax)。

[0081] 4)周边孔位姿参数的确定

[0082] ①钻爆法周边孔设计需要考虑循环进尺D、孔口坐标、孔口距边邦轮廓距离L1、孔口距 L2、孔底坐标、孔底距边邦轮廓距离L3、孔底距L4等多个参数。计算前需要依据岩质、工
作时间、钻具参数等各方面因素综合确定D；依据爆破经验、岩质等因素确定L1、L3及L2的取
值范围。根据L1、L3及D计算得到周边孔外插角的建议值θa0，最终是否采用，需要考察车体定
位的结果；

[0083]

[0084] 以三心拱巷道为例(如图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。

[0085] ②仍以三心拱巷道为例，巷道直墙高h1，拱高f，巷道半宽h2。特别的，对于圆拱隧道有f＝h2。台车停于工作面前，稳定后不再移动。根据车体定位结果(如图5)确定台车中线偏
离巷道中线的水平距离E2。{OC}原点OC到地面的距离为E1，该参数通常不构成对周边孔设计
的影响，因此不考虑。

[0086] 则对于该工况下的台车而言，所有炮孔孔口都应该在覆盖半宽为L的工作空间内。

[0087] L＝|E2|+h2‑L1

[0088] 该工况下pymax实际＝L‑ε，ε为双侧钻臂间距一半。根据pymax实际计算确定的θa定义为θaL。将其与周边孔外插角建议值θa0进行比较，确定炮孔外插角最终值θa终。

[0089]

[0090] ③计算周边孔孔口所在位置的轨迹。该轨迹分为五段，从左往右依次为平行于左侧直墙的直线段(Line 1)，以Of2为圆心的小圆弧段(Curve 1)，以Of1为圆心的大圆弧段
(Curve 2)，以Of3为圆心的小圆弧段(Curve 3)，平行于右侧直墙的直线段(Line 2)。该轨迹
与边帮轮廓的距离恒为L1。

[0091] 欲求该轨迹函数，首先需要计算三心拱的三圆心Of1,Of2,Of3的坐标(如图6)。图6中 r1‑L1为小圆弧半径，θf1为小圆弧圆心角，r2‑L1为大圆弧半径，θf2为大圆弧圆心角。

[0092]

[0093] 则周边孔轨迹方程为：

[0094]

[0095] ④确定周边孔的孔口坐标。拟沿轨迹布置一圈周边孔，各孔口距相等，且沿巷道中线对称(如图7)。因左侧周边孔孔口坐标均为正，故只计算左侧，通过镜像确定右侧周边孔
孔口坐标。孔口距L2的取值范围依据爆破经验、岩质等因素事先确定。设L2∈(L2min,L2max)，
采用蒙特卡罗法在取值范围内随机选取L2进行多次计算。单次计算根据从下向上的原则依
次计算周边孔孔口坐标，最高处的两周边孔孔口距最接近L2的一组为最终结果。

[0096] 单次计算步骤如下：

[0097] 计算直线段(line1)上的炮孔数N1，注意到Floor函数为向下取整函数。

[0098]

[0099] 因此直线段(line1)上位置最低周边孔B1坐标为(h2‑L1,L1+L2)；周边孔Bu坐标为 (h2‑L1,L1+u·L2)，其中u为炮孔编号，1L2)。

[0100] 计算曲线1段(curve 1)上位置最低周边孔BN1+1坐标为(xN1+1,yN1+1)，注意到yN1+1>h1。

[0101]

[0102] 计算曲线1段(curve 1)上的炮孔数N2‑N1，注意到Ceil函数为向上取整函数。

[0103]

[0104]

[0105] 计算曲线1段(curve 1)上周边孔Bv坐标。v为炮孔编号，N1+1

[0106]

[0107] 计算曲线2段(curve 2)上位置最低周边孔BN2+1坐标为(xN2+1,yN2+1)，注意取xN2+1较小的解。

[0108]

[0109] 计算曲线2段(curve 2)上的炮孔数N3‑N2，注意到Ceil函数为向上取整函数。

[0110]

[0111]

[0112] 计算曲线2段(curve 2)上周边孔Bw坐标。w为炮孔编号，N2+1

[0113]

[0114] ⑤起拱线以上周边孔外插角的分解

[0115] 将起拱线以上各周边孔的θa分解为水平向夹角α和竖直向夹角β。该计算过程需要已知各炮孔坐标及对应θTk。θTk为过各炮孔孔口做周边孔轨迹的切线，该切线T与水平的夹
角。计算曲线1段(curve 1)及曲线2段(curve 2)上各周边孔Bk对应θTk的值。

[0116]

[0117] 根据空间几何关系(如图8)，分解θa。

[0118]

[0119] 现场应用的具体情况：

[0120] 将上述结果编写成程序，和台车运动控制程序一起，进行井下试验。按照3)节内容对炮孔外插角和工作空间尺寸的关系进行了计算，求θ0分别等于0,1,2,……,14°时的单臂
工作空间尺寸。

[0121] 分别设置Δ1＝0.1°，p0＝4900mm，Δ2＝100mm。各θ0对应工作空间内均包含50000个数据点。得到各θ0和对应工作空间数据点轮廓(外包络线)的关系(如图9)。针对图9中虚
线框内的轮廓线进行分析(周边孔一般布置在该区域)。

[0122] 取各θ0及其对应pymax进行组合。为避免计算过程中偶然因素造成结果不可靠，同时取 各工况下py最大的前100个值求平均值，与θ0进行组合(如图10)。在MATLAB中采用三 次
多项式对图10中的点进行拟合，得到θa和pymax/pymean的函数关系。

[0123]

[0124] 试验及生产在中国四川广安绿水洞煤矿进行，为三心拱巷道，直墙高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终。

[0125] 按照4)节内容计算周边孔孔口坐标及起拱线以上周边孔对应切线角θTk、分解角α、β。经程序计算，得到L2＝443.8870mm，xN3‑L2＝0.1244mm。各孔位姿参数如表3所示。

[0126] 表3周边孔位姿参数

[0127] 孔号 X坐标/mm Y坐标/mm θT(°) α(°) β(°)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

[0128] 现场实测周边孔自动定位精度为8.1cm。在巷道进行了大量的相邻孔间移动时间的测试，并与以前使用6连阀进行手动操作时的走孔时间进行了比较。自动定位走孔平均时
间23s，手动定位平均走孔时间51s,自动定位较手动操作缩短了55％的时间。

[0129] 以上所述仅是本发明针对特定机构双臂钻孔凿岩台车所提出的周边孔自动确定方法，应当指出，对于本技术领域的其他双臂台车来说，即使尺寸、机构发生一定变化，但仍
以其工作空间为基础确定周边孔位姿参数的，这些变化也应该视为本发明的保护范围。同
时，由于圆拱隧道可以视为三心拱隧道的特例，因此使用凿岩台车进行圆拱隧道周边孔自
动设计也应该视为本发明的保护范围；同时本发明方法也适用于一些异形的巷道。

[0130] 本文虽然已经给出了本发明的几个实施例，但是本领域的技术人员应当理解，在不脱离本发明精神的情况下，可以对本文的实施例进行改变。上述实施例只是示例性的，不
应以本文的实施例作为本发明权利范围的限定。