锚杆钻车钻臂定位控制方法

李力恒, 宋建成, 田慕琴, 王相元

李力恒,宋建成,田慕琴,等. 锚杆钻车钻臂定位控制方法[J]. 工矿自动化,2023,49(3):77-84, 123. DOI: 10.13272/j.issn.1671-251x.2022070052
引用本文: 李力恒,宋建成,田慕琴,等. 锚杆钻车钻臂定位控制方法[J]. 工矿自动化,2023,49(3):77-84, 123. DOI: 10.13272/j.issn.1671-251x.2022070052
LI Liheng, SONG Jiancheng, TIAN Muqin, et al. Positioning control method for drilling arm of bolt drilling rig[J]. Journal of Mine Automation,2023,49(3):77-84, 123. DOI: 10.13272/j.issn.1671-251x.2022070052
Citation: LI Liheng, SONG Jiancheng, TIAN Muqin, et al. Positioning control method for drilling arm of bolt drilling rig[J]. Journal of Mine Automation,2023,49(3):77-84, 123. DOI: 10.13272/j.issn.1671-251x.2022070052

锚杆钻车钻臂定位控制方法

基金项目: 山西省科技重大专项计划“揭榜挂帅”项目(202101020101021)。
详细信息
    作者简介:

    李力恒(1995—),男,陕西西安人,硕士研究生,研究方向为矿用智能电器技术,E-mail:liliheng2022@163.com

  • 中图分类号: TD421

Positioning control method for drilling arm of bolt drilling rig

  • 摘要: 目前常用代数法和几何法实现锚杆钻车钻臂定位控制,存在效率低、有无解或多解情况、通用性差等问题。采用粒子群优化(PSO)算法进行机械臂定位控制具有编程简单、搜索性能强、容错性好等优势,但易陷入局部最优解。目前基于改进PSO算法的机械臂定位控制整体寻优效率较低,寻优时间过长。针对上述问题,在精英反向粒子群优化(EOPSO)算法基础上,引入混沌初始化、交叉操作、变异操作和极值扰动,设计了混沌交叉精英变异反向粒子群优化(CEMOPSO)算法。采用标准测试函数对PSO算法、EOPSO算法、交叉精英反向粒子群优化(CEOPSO)算法、CEMOPSO算法进行测试,结果表明CEMOPSO算法的稳定性、精度、收敛速度最优。建立了锚杆钻车钻臂运动模型,采用CEMOPSO算法进行钻臂定位控制,并在Matlab软件中对控制性能进行仿真研究,结果表明:在相同的迭代次数和误差精度约束条件下,采用CEMOPSO算法时钻臂位置误差和姿态误差从迭代初期即具有极快的收敛速度,且位置误差和姿态误差均小于其他3种算法,误差曲线较平稳,最大位置误差为0.005 m,最大姿态误差为0.005 rad;设定位置误差为1 mm、姿态误差为0.01 rad时,CEMOPSO算法的平均迭代次数为343,位置误差为0.1 mm、姿态误差为0.001 rad时平均迭代次数为473,在相同的定位精度条件下,CEMOPSO算法的收敛速度和稳定性优于其他3种算法,满足工程应用要求,且求解精度越高,其优越性越突出。
    Abstract: Algebraic and geometric methods are commonly used to realize drilling arm positioning control of bolt drilling rig. However, there are some problems such as low efficiency, no solution, multiple solutions, or poor universality. Using particle swarm optimization (POS) algorithm for positioning control of the drilling arm has the advantages of simple programming, strong search performance and good fault tolerance. But it is easy to fall into the local optimal solution. At present, the drilling arm positioning control based on improved PSO algorithm has low overall optimization efficiency and long optimization time. In order to solve the above problems, a chaotic crossover elite mutation opposition-based PSO (CEMOPSO) algorithm is designed by introducing chaos initialization, crossover operation, mutation operation and extreme value perturbation based on elite opposition-based PSO (EOPOS) algorithm. The method uses standard test functions to test PSO algorithm, EOPSO algorithm, CEOPSO algorithm and CEMOPSO algorithm. The results show that CEMOPSO has the best stability, precision and convergence speed. The motion model of the drilling arm of the bolt drilling rig is established. The CEMOPSO algorithm is used to control the drilling arm positioning. The simulation of the control performance is carried out in Matlab. The results show that under the same iteration times and error precision constraints, the position error and posture error of the drilling arm have a very fast convergence rate from the initial iteration when using the CEMOPSO algorithm. The position error and posture error are smaller than those of the other three algorithms. The error curve is smooth, and the maximum position error is 0.005 m and the maximum posture error is 0.005 rad. When the position error is 1 mm and the posture error is 0.01 rad, the average iteration number of the CEMOPSO algorithm is 343. When the position error is 0.1 mm and the posture error is 0.001 rad, the average iteration number is 473. Under the same positioning precision, the convergence speed and stability of the CEMOPSO algorithm are better than those of the other three algorithms. The results meet the requirements of engineering application. The higher the accuracy of the solution, the better it is.
  • 在巷道、硐室等地下工程中,围岩裂纹发育、贯通是导致围岩结构失稳的主要原因,而裂纹识别与提取是认识围岩裂纹演变规律的基础。常见的裂纹提取方法有可见光拍照[1]、CT扫描[2]、电镜扫描[3]、声学成像[4]、红外热成像[5]、薄片显微观测[6]等。其中,CT扫描和声学成像法能够探测到岩石内部裂纹发育信息,但设备昂贵,现场应用困难;可见光照片在岩石力学实验中应用最为广泛。此外,在智能矿山建设过程中,视频监测装置已被广泛应用[7],获得了大量视频数据,为研究基于可见光照片的受力岩石裂纹提取方法提供了数据来源。

    基于可见光照片的受力岩石裂纹提取方法主要包括阈值分割二值化法[8-9]、边缘检测法[10-11]、区域生长法[12-13]等。这些方法对单张照片的分析较方便快捷,对由颜色相近的矿物组成的岩石(如砂岩)裂纹的提取效果较好[14],但对于由多色矿物组成的复杂岩石(如花岗岩),由于不同矿物灰度存在较大差异,矿物边界会被一并搜出,对裂纹提取造成干扰。另外,对视频监测数据进行分析时,需要首先确定视频图像中是否存在裂纹。实际上,岩石裂纹之所以能被肉眼识别,根本原因在于裂纹反射率与岩石反射率不同。在岩石受力变化过程中,不仅红外反射率[15-17]、微波反射率会发生变化[18-19],可见光反射率也会发生变化。这种可见光反射率的变化可作为裂纹提取的重要依据。而且,基于光反射率的裂纹识别方法受环境光辐射的影响较小,更适用于光照条件复杂多变的井下。因此,本文在分析试件破坏后的光反射率响应及其空间分异特征的基础上,提出一种基于光反射率突变的受力岩石裂纹提取方法。

    基于光反射率突变的受力岩石裂纹提取流程如图1 所示。关键步骤如下:① 光反射率计算,得到由光反射率表示的数字图像。② 数字图像时间序列差分计算和光反射率突变点识别。③ 数字图像光反射率突变点空间分异性分析。④ 裂纹信息提取。

    图  1  受力岩石裂纹提取流程
    Figure  1.  Crack extraction process of stressed rock

    物质实测反射率与数字图像灰度之间具有显著的线性相关性[20]。根据反射率波谱野外实地测量方法,当目标物体和标准板的环境条件相同时,目标物的光反射率为[21]

    $$ K=\frac{N}{{N}_{{\rm{b}}}} {K}_{{\rm{b}}} $$ (1)

    式中:$ {K}_{{\rm{b}}} $为标准板的光反射率;$ N $$ {N}_{{\rm{b}}} $分别为目标物、标准板的可见光数字图像灰度。

    一般地,标准板由硫酸钡、聚四氟乙烯等材料制成,具有固定的反射率,是用于反射率测量的标准漫反射参考物。

    根据式(1)可方便地将数字图像各像元的灰度转换为光反射率,进而得到由光反射率表示的数字图像。数字图像中位置(ij)处像元的光反射率为

    $$ {K_i}_j = f(i,j) $$ (2)

    式中f为光反射率关于位置的空间函数。

    某一时刻t数字图像中位置(ij)处像元的光反射率为

    $$ {K_{t\,i}}_j = g(t,i,j) $$ (3)

    式中g为光反射率的时空函数。

    裂纹发育与光反射率的突变信息相对应。为了便于反映裂纹发育前后光反射率的突变性,对数字图像时间序列进行差分处理。

    $$ {V_{t\,i}}_j = \frac{{g(t + \Delta t,i,j) - g(\Delta t,i,j)}}{{\Delta t}} $$ (4)

    式中:$ {V_{t\,i}}_j $t$\text{~} $$ t + \Delta t $时间段内数字图像中位置(ij)处像元的光反射率变化速率;Δt为时间变化值。

    一般地,$ \Delta t $取值不能太大,因为$ \Delta t $较小时才能反映裂纹发育时刻光反射率的突变性。

    假设在受力岩石裂纹未发育时,对于用光反射率变化速率表示的数字图像,其灰度呈正态分布,则光反射率变化速率太大或太小都是小概率事件。利用数理统计理论可以确定数字图像中光反射率突变的判别阈值。

    $$ \left\{ \begin{array}{l} {[{V_{t\,}}]_{{\text{up}}}} = E({V_{t\,}}) + k \sqrt {D({V_{t\,}})} \\ {[{V_{t\,}}]_{{\text{down}}}} = E({V_{t\,}}) - k \sqrt {D({V_{t\,}})} \end{array} \right.$$ (6)

    式中:$ {[{V_{t\,}}]_{{\text{up}}}} $$ {[{V_{t\,}}]_{{\text{down}}}} $分别为t时刻光反射率突增、突降的判别阈值;$ E({V_{t\,}}) $$ D({V_{t\,}}) $分别为用光反射率变化速率Vt表示的数字图像灰度的均值和方差;k为常数,取3或4。

    $ {V_{t\,i}}_j > {[{V_{t\,}}]_{{\text{up}}}} $$ {V_{t\,i}}_j < {[{V_{t\,}}]_{{\text{down}}}} $时,认为位置(i , j)处像元的光反射率发生了突变,称该类像元为光反射率突变点。

    受力岩石裂纹发育可引起光反射率突变,但光反射率突变并不意味着裂纹发育,二者不是一一对应的关系。裂纹发育引起的光反射率突变点在空间上的分异性是识别裂纹的关键特征。根据光反射率突变点的空间分异性可以判断数字图像中是否存在裂纹。为此,引入反映空间点分布集中程度的指标−分异系数C[22]

    对数字图像中的光反射率突变点进行样方分析[23],即通过突变点分布密度的变化来评定其分布模式(包括聚集分布、均匀分布和随机分布)。将数字图像划分成方格网(方格尺寸应结合裂纹宽度确定,建议方格对应的空间分辨率为 2 mm×2 mm),然后统计落入每个方格中的突变点数量,得到样方点量数列$\{x(k), k=1,2, \cdots , m\}$m为样方数)。分异系数为样方点量数列的方差${{D}}\left( x \right)$与均值${{E}}\left( x \right)$的比值:

    $$ C = \frac{{{{D}}\left( x \right)}}{{{{E}}\left( x \right)}} $$ (7)

    利用式(6)可判断数字图像时间序列中每帧数字图像的光反射率突变点是否呈聚集分布。当 C<1 时,光反射率突变点呈均匀分布;当 C=1 时,光反射率突变点呈随机分布;当 C>1 时,光反射率突变点呈聚集分布,$ C $值越大,对应的空间分异性越强。

    利用试件加载过程中光反射率突变点分异系数的变化曲线,可判断出试件裂纹发育时刻,为后续裂纹信息提取和空间特征分析提供支持。

    判断出数字照片中存在裂纹后,一方面,通过光反射率变化速率反映裂纹活动的瞬时信息,以研究试件在何时、何处有裂纹产生或扩展;另一方面,将考察时间段内所有突变点的空间信息在同一张数字图像中显示,提取出裂纹活动的累积信息,以分析一段时间内岩石表面裂纹的发育、扩展情况及贯通程度。

    受力岩石裂纹提取实验系统主要由压力机、快速照相机、声发射系统及标准板等组成,如图2所示。实验所用试件由150 mm×150 mm×50 mm的花岗岩岩块经四角切割、中心钻孔制备而成,孔直径为 40 mm。压力机型号为RLW−3000,可进行双轴加载,最大轴压为3 000 kN,侧压可达1 000 kN,用于对试件施加荷载,模拟地应力环境。快速照相机型号为GX3300,最高分辨率为3 296像素×2 472像素,最大帧率为17 帧/s,用于可见光照片实时拍摄。采用8CHs PCI−2声发射系统[24]对加载过程中试件的裂纹发育信息进行实时监测。

    图  2  受力岩石裂纹提取实验系统
    Figure  2.  Experimental system of crack extraction of stressed rock

    实验前,将试件放进压力机加载仓内,将声发射探头布置在试样背面圆孔上方。照相机由三脚架支撑,架设在距离试件大于2 m的位置,对试件正面进行垂直观测,采样帧率设为10 帧/s。在照相机监测过程中,由固定光源照射。根据试件尺寸和数字图像中试件所占用像素,经计算可知,每个像素的大小为 0.088 7 mm。采用聚四氟乙烯作为标准板($ {K}_{{\rm{b}}} $为0.93)。

    采用双轴加载、应力控制方式进行实验,其中垂直轴为主轴。实验开始后,先将水平荷载预加载至100 kN(20 MPa)保持恒定,以提供稳定的水平应力,随后垂直方向以1.2 kN/s 匀速加载,通过快速照相机、声发射系统同步监测,直至试件破坏。实验结束后,对可见光照片中试件和标准板进行截取分析。

    标准板灰度分析结果如图3所示。图3(a)中,XY为像素坐标。可看出标准板的灰度在一定范围内波动,中位数在230附近,经计算,灰度均值为 231。这说明在实验光照条件下,可取 231作为标准板的灰度,代入式(1)进行光反射率计算。

    图  3  标准板灰度分析结果
    Figure  3.  Grayscale analysis results of standard plates

    裂纹活动包括裂纹发育、扩展和贯通等。裂纹活动过程中光反射率突变与否,一般从2个角度来衡量:① 变化是否在较短时间内进行;② 变化量是否较大。为了验证裂纹发育、扩展可引起光反射率突变,选择代表区域AR0,拍摄加载过程中第653,654 s时AR0 区域的裂纹发育照片,如图4所示。图4中,AR0 区域大小为17 mm$ \times $8 mm,面积较小。将照片放大后,由于分辨率较小,照片较模糊,但仍可以看出:在第653 s,AR0区域裂纹不够明显;到第654 s,裂纹依稀可见。这说明在653~654 s,AR0区域有裂纹产生或扩展。

    图  4  AR0区域裂纹活动前后照片
    Figure  4.  Photographs of AR0 region before and after crack activity

    裂纹的光反射率变化速率空间分布如图5所示。图5 用灰度反映光反射率变化速率,图中像素越亮,代表其光反射率变化速率越大。对比图4图5可看出,在数值上,裂纹发育的区域呈白色,对应的光反射率变化速率较大,最大超过0.2/s;在空间上,裂纹活动区域的光反射率变化具有明显的空间分异性。

    图  5  AR0区域裂纹活动前后光反射率变化速率空间分布
    Figure  5.  Spatial distribution of change speed of light reflectivity before and after crack activity in AR0 region

    AR0 区域无裂纹活动时刻(第300 s)光反射率变化速率直方图如图6所示。可看出无裂纹活动时刻,试件表面光反射率变化速率近似呈正态分布,3倍标准差为0.03/s。结合图5图6 可看出,裂纹活动引起的光反射率变化速率(接近 0.2/s)远大于无裂纹活动时刻的光反射率变化速率(小于0.03/s)。由以上分析可看出,试件受力后的裂纹发育、扩展可在较短时间内引起光反射率的显著变化。

    图  6  AR0 区域无裂纹活动时刻光反射率变化速率直方图
    Figure  6.  Histogram of light reflectivity variation at the time without crack activity in AR0 region Histogram of light reflectivity variation

    光反射率突变点空间分布如图7所示。其中白色小点为突变点,黑色为非突变点。由图7(a) 可看出,在无裂纹发育时刻,试件表面光反射率突变点分布较分散,相对均匀,单位面积内突变点的数量变化较小。由图7(b)可看出,在裂纹发育时刻,试件表面光反射率突变点多呈簇状或条带状分布,单位面积内突变点的数量变化较大。

    图  7  光反射率突变点空间分布
    Figure  7.  Spatial distribution of mutation points of light reflectivity

    试件加载过程中光反射率突变点的分异系数变化曲线如图8 所示。可看出在0~597 s(阶段I和II),光反射率突变点的分异系数在小范围内变化,标准差为1.10,平均值为3.01。分异系数与临界值1接近,说明该时间段内试件表面光反射率突变点接近随机分布,无裂纹活动或活动不剧烈。在597~657 s(阶段III),光反射率突变点的分异系数变化幅度较大,最大值可达189,远远大于临界值1,说明该时间段内试件表面光反射率突变点多呈聚集分布,裂纹活动剧烈。

    图  8  试件加载过程中光反射突变点分异系数变化曲线
    Figure  8.  The variation curve of differentiation coefficient of mutation points of light reflectivity during specimen loading process

    试件加载过程中声发射突变率变化曲线如图9 所示。声发射突变率反映了声发射率的突变性[24]。 可看出在阶段I内,声发射不活跃,说明该阶段无裂纹产生。以该阶段分异系数C的均值加3倍标准差为阈值(5.12),可对分异系数异常时刻(裂纹活动时刻)进行自动筛选。

    图  9  试件加载过程中声发射突变率变化曲线
    Figure  9.  The variation curve of acoustic emission mutation rate during specimen loading process

    另外,可见光数字图像反映了岩石表面信息,声发射反映了岩石表面和内部信息,将二者进行对比分析,可以研究岩石受力破坏过程中内部和表面损伤的关系问题。

    裂纹发育、扩展瞬时信息如图10所示。可看出在第604 s 试件表面有裂纹发育、扩展,裂纹活动区域集中于孔洞左侧;在第623 s 试件表面也有裂纹发育、扩展,裂纹活动区域转移到孔洞右侧。这说明在裂纹发育过程中,伴随着应力集中的转移,裂纹活动区域也会转移,并非总沿着已有裂纹持续扩展。

    图  10  裂纹发育、扩展瞬时信息
    Figure  10.  Instantaneous information of crack development and propagation

    604~623 s裂纹发育、扩展累积信息如图11所示。可看出在该时间段内试件孔洞两侧都有裂纹活动,累积信息反映了考察时间段内试件表面裂纹发育、扩展的整体情况。

    图  11  裂纹发育、扩展累积信息
    Figure  11.  Accumulation information of crack development and propagation

    需要注意的是,裂纹活动的累积信息不宜通过2个时刻的数字图像(像元灰度为光反射率)相减的方法得到。因为,当时间间隔较长时,该时间段内岩石应力变化可能较大,引起的岩石表面位移和变形会大于数字图像的空间分辨率,从而造成光反射率整体大幅度变化。

    岩石光反射率的大小除了与岩石内部矿物的电磁性质、环境光辐射特征有关外,也与岩石表面的粗糙度紧密相关。前2个因素分别与矿物种类和实验环境条件有关,在实验中可视为常量。在岩石受力变形破裂过程中,岩石表面粗糙度不断发生变化,是导致光反射率变化的主要因素。一般地,岩石裂纹的产生具有突变性,所以,岩石表面光反射率的变化也具有一定突变性。

    基于光反射率突变的受力岩石裂纹提取方法可为研究受力岩石破坏演变特征、认识岩石表面与内部损伤之间的关系提供有效方法。

    试件破坏过程中光反射率变化空间分布如图12所示。该图反映了试件破坏演变过程:① 第566 s,破裂先在孔洞左侧发生,集中于孔洞周边边帮的中点附近,破裂范围较小,产生的岩屑会发生弹射。 ② 第632 s,裂纹发育区域发生转移,由孔洞左侧转移到了右侧。③ 第641 s,孔洞两侧裂纹继续扩展,扩展到一定程度之后,在孔洞左右两侧上方远离孔洞的区域产生新的裂纹,但新裂纹与孔洞周边的破裂区域未贯通。④ 第652 s,裂纹继续扩展,并趋于贯通,意味着岩石即将破坏。实际上,试件在第656 s出现了垮塌,圆形孔洞发生严重破坏,但应力仍未达到峰值,这与现场巷道围岩破坏后仍具有承载能力的现象一致。

    图  12  试件破坏过程中光反射率变化空间分布
    Figure  12.  Spatial distribution of light reflectivity changes during specimen failure

    基于光反射率突变的花岗岩试件裂纹提取结果如图13所示。在数字照片中,裂纹很难看清;而在同时刻的光反射率变化空间分布图中,清楚地显现出了裂纹(白色条纹),为下一步判断裂纹性质及其发生机制打下基础。

    图  13  基于光反射率突变的花岗岩试件裂纹提取结果
    Figure  13.  Crack extraction results of granite specimens based on mutation of light reflectivity

    声发射是研究岩石破坏演变的重要工具,通过实时监测受力岩石裂纹发育扩展中所释放的高频振动信号,可获取岩石破裂、损伤发育的剧烈程度。需要注意的是,通过声发射监测获得的是岩石内部和表面的整体信息,而通过可见光照片仅能获得表面裂纹的活动信息。

    光反射率突变点的分异系数是个综合指标,如果分异系数出现异常,说明光反射率发生了突变。突变点的空间分异性是反映岩石表面有无裂纹发育、扩展的重要指标。

    为了研究试件内部损伤与表面损伤之间的关系,对图8图9 进行对比分析。在阶段I(0~420 s)、阶段III(597~657 s)、阶段IV(657~703 s),声发射突变率与光反射率突变点分异系数变化特征接近;在阶段II(420~597 s),前者活跃,而后者表现较平稳,二者出现了显著差别,声发射参数比光反射率参数活跃得早。这说明岩石内部损伤要早于表面损伤发育,表面破坏可以作为岩石整体失稳的后期前兆。

    由于可见光穿透性较差,通过可见光数字图像只能获取围岩表面裂纹信息,后期可以结合微波激光雷达、地质雷达等具有穿透性的设备,定期巡检围岩内部损伤及破坏情况。

    当前,智慧矿山建设已经成为矿山发展的趋势[25],视频监测系统被称为智慧矿山的“眼睛”。杨春雨等[26]提出将智能视频技术用于巷道巡检机器人,对巷道变形情况进行监测,以及时发现巷道变形与支护隐患,保障煤矿生产安全。岩石表面裂纹剧烈发育、贯通是破坏的重要前兆信息,对岩体破坏具有重要的指示意义。如果在巷道巡检机器人平台上搭载高清摄像机,对巷道进行动态巡检,可得到大量数字图像,结合本文提出的基于光反射率变化的受力岩石裂纹提取方法,可实时提取巷道围岩裂纹发育信息,进行巷道围岩稳定性评估,对保障矿山安全具有重要意义。然而,本文仅以实验为基础开展岩石裂纹提取方法研究,由于室内实验环境与现场环境存在较大区别,要真正搭载到巷道巡检机器人平台,用于实时提取巷道围岩裂纹发育信息,还存在很多基础问题需要研究。比如,巡检机器人要在移动中监测,不同时间在相同位置巡检得到的系列数字图像如何精确匹配;在巷道黑暗、多光源条件下,光源稳定性对光反射率反演精度会造成影响。

    (1) 岩石受力裂纹发育、扩展可引起光反射率突变,最大突变速率可达0.2/s,远大于由其他随机因素导致的变化速率(0.03/s);在裂纹活动时刻,光反射率突变点呈显著的空间分异现象(C值可达189),分异系数远大于随机分布时的值(C值为1)。这种空间分异性是受力岩石裂纹提取的重要依据。

    (2) 基于光反射率突变的受力岩石裂纹提取方法利用分异系数判断岩石裂纹活动的时刻,大大提高了搜索效率和自动化程度。该方法能够提取出裂纹活动的瞬时信息和累积信息,分别用于研究裂纹活动的时空特征、判断裂纹贯通程度。

    (3) 讨论了岩石破裂过程中光反射率变化的原因、所提方法的岩石力学意义及其在巷道安全巡检中的应用前景:在岩石受力破坏过程中,表面粗糙度是导致光反射率变化的主要因素;所提方法可为研究受力岩石破坏演变特征、认识岩石表面与内部损伤之间的关系提供了有效方法;结合巷道巡检机器人、高清摄像机和本文方法,可实时提取巷道围岩裂纹发育信息,进行巷道围岩稳定性评估,对保障矿山安全具有重要意义。

  • 图  1   锚杆钻车钻臂结构

    1−大臂摇摆关节;2−大臂俯仰关节;3−大臂伸缩关节;4−推进梁俯仰关节;5−推进梁摆动关节;6−推进梁回转关节;7−锚杆关节;8−推进梁伸缩关节。

    Figure  1.   Drilling arm structure of bolt drilling rig

    图  2   锚杆钻车钻臂坐标系

    Figure  2.   Coordinates of drilling arm of bolt drilling rig

    图  3   基于CEMOPSO算法的锚杆钻车钻臂定位控制流程

    Figure  3.   Positioning control flow of drilling arm of bolt drilling rig based on chaotic crossover elite mutation opposition-based particle swarm optimization(CEMOPSO) algorithm

    图  4   标准测试函数进化曲线

    Figure  4.   Evolution curves of standard test functions

    图  5   锚杆钻车钻臂模型

    Figure  5.   Drilling arm model of bolt drilling rig

    图  6   锚杆钻车钻臂末端工作区域

    Figure  6.   Working area of drilling arm end of bolt drilling rig

    图  7   4种算法对钻臂定位控制的位置误差和姿态误差收敛曲线

    Figure  7.   Convergence curves of position errors and posture errors of drilling arm positioning control by use of four algorithms

    图  8   4种算法对钻臂定位控制的位置误差和姿态误差曲线

    Figure  8.   Position error and posture error curves of drilling arm positioning control by use of four algorithms

    图  9   4种算法在不同精度条件下的迭代次数

    Figure  9.   Iteration times of four algorithms under different precision conditions

    表  1   锚杆钻车钻臂D−H参数

    Table  1   D-H parameters of drilling arm of bolt drilling rig

    关节$ {\theta _j}/(^\circ ) $$ {\alpha _j}/(^\circ ) $$ {a_j}/{\rm{m}} $$ {d_j}/{\rm{m}} $
    1[45,135]900.300
    2[−150,−60]−9000
    3180−900[0,1.8]
    4[−120,−30]−900.350
    5[−135,−45]9000
    6[−270,90]−900.600.4
    7[−90,0]9000.8
    890−900[0,2.5]
    下载: 导出CSV

    表  2   标准测试函数

    Table  2   Standard test functions

    函数维度搜索范围最优解
    ${f}_{1}(g)\text{=}{\displaystyle \sum _{r=1}^{n}{g}_{r}^{2} }$30[−100,100]0
    ${f_2}(g) =\displaystyle \sum\limits_{r = 1}^n {\left| { {g_r} } \right|} + \prod\limits_{r = 1}^n {\left| { {g_r} } \right|}$30[−10,10]0
    ${f_3}(g) = \displaystyle \sum\limits_{r = 1}^n {(\sum\limits_{q = 1}^n { {g_q}{)^2} } }$30[−100,100]0
    $\mathop f\nolimits_4 (g) = \max \{ \left| {\mathop g\nolimits_r } \right|,1 \leqslant r \leqslant n\}$30[−100,100]0
    下载: 导出CSV

    表  3   标准测试函数计算结果

    Table  3   Calculation results of standard test functions

    函数PSO算法EOPSO算法CEOPSO算法CEMOPSO算法
    $ {f_1}(g) $标准差:$3.223\; 2 \times {10^{ { { - } }2} }$标准差:$ 6.193\;9 \times {10^{{{ - }}2}} $标准差:$2.925\;9 \times {10^{{{ - 6}}}}$标准差:$2.870\;6 \times {10^{{{ - 18}}}}$
    最优解:$ 2.807\;2 \times {10^{{{ - }}2}} $最优解:$ 2.979\;5 \times {10^{{{ - }}2}} $最优解:$1.393\;2 \times {10^{{{ - 6}}}}$最优解:$4.794\;3 \times {10^{{{ - 19}}}}$
    $ {f_2}(g) $标准差:$ 1.001\;8 \times {10^0} $标准差:$ 1.255\;4 \times {10^0} $标准差:$ 7.436\;1 \times {10^{{{ - }}2}} $标准差:$5.045\;2 \times {10^{{{ - 13}}}}$
    最优解:$ 8.349\;6 \times {10^{{{ - }}1}} $最优解:$ 8.012\;2 \times {10^{{{ - }}1}} $最优解:$ 6.558\;2 \times {10^{{{ - }}2}} $最优解:$1.479\;4 \times {10^{{{ - 13}}}}$
    $ {f_3}(g) $标准差:$ 39.100\;3 \times {10^0} $标准差:$ 36.417\;4 \times {10^0} $标准差:$ 34.092\;9 \times {10^0} $标准差:$9.092\;9 \times {10^{{{ - }}2}}$
    最优解:$ 32.092\;9 \times {10^0} $最优解:$ 31.565\;9 \times {10^0} $最优解:$ 32.073\;7 \times {10^0} $最优解:$7.686\;5 \times {10^{{{ - }}2}}$
    $ {f_4}(g) $标准差:$ 1.268\;5 \times {10^0} $标准差:$ 1.820\;8 \times {10^0} $标准差:$ 5.433\;3 \times {10^{{{ - }}1}} $标准差:$1.683\;6 \times {10^{{{ - 3}}}}$
    最优解:$ 1.167\;1 \times {10^0} $最优解:$ 1.035\;9 \times {10^0} $最优解:$ 5.398\;9 \times {10^{{{ - }}1}} $最优解:$1.327\;9 \times {10^{{{ - 3}}}}$
    下载: 导出CSV
  • [1] 李国江,张飞,李露,等. 基于多种群协同进化算法的绳索牵引并联机器人末端位置误差补偿[J]. 机器人,2021,43(1):81-89. DOI: 10.13973/j.cnki.robot.200054

    LI Guojiang,ZHANG Fei,LI Lu,et al. Error compensation of end-effector position for the cable-driven parallel robot based on multi-group co-evolutionary algorithm[J]. Robot,2021,43(1):81-89. DOI: 10.13973/j.cnki.robot.200054

    [2] 吉阳珍,侯力,罗岚,等. 基于组合优化算法的6R机器人逆运动学求解[J]. 中国机械工程,2021,32(10):1222-1232. DOI: 10.3969/j.issn.1004-132X.2021.10.011

    JI Yangzhen,HOU Li,LUO Lan,et al. Solution of inverse kinematics for 6R robots based on combinatorial optimization algorithm[J]. China Mechanical Engineering,2021,32(10):1222-1232. DOI: 10.3969/j.issn.1004-132X.2021.10.011

    [3] 史也,梁斌,王学谦,等. 基于量子粒子群优化算法的空间机器人非完整笛卡尔路径规划[J]. 机械工程学报,2011,47(23):65-73. DOI: 10.3901/JME.2011.23.065

    SHI Ye,LIANG Bin,WANG Xueqian,et al. Cartesian non-holonomic path planning of space robot based on quantum-behaved particle swarm optimization algorithm[J]. Journal of Mechanical Engineering,2011,47(23):65-73. DOI: 10.3901/JME.2011.23.065

    [4] 刘洋. 基于多目标粒子群算法的机器人逆运动学求解方法[J]. 现代计算机,2020(10):13-17. DOI: 10.3969/j.issn.1007-1423.2020.10.003

    LIU Yang. Inverse kinematics solution of robot manipulators based on multi-objective particle swarm optimization[J]. Modern Computer,2020(10):13-17. DOI: 10.3969/j.issn.1007-1423.2020.10.003

    [5] 郑雪芳,林意. 基于改进萤火虫算法的冗余机器人轨迹规划[J]. 组合机床与自动化加工技术,2019(12):80-84. DOI: 10.13462/j.cnki.mmtamt.2019.12.020

    ZHENG Xuefang,LIN Yi. Trajectory planning for redundant robot based on improved glowworm swarm optimization algorithm[J]. Modular Machine Tool & Automatic Manufacturing Technique,2019(12):80-84. DOI: 10.13462/j.cnki.mmtamt.2019.12.020

    [6] 樊华羽,詹浩,程诗信,等. 基于α-stable分布的多目标粒子群算法研究及应用[J]. 西北工业大学学报,2019,37(2):232-241. DOI: 10.3969/j.issn.1000-2758.2019.02.004

    FAN Huayu,ZHAN Hao,CHENG Shixin,et al. Research and application of multi-objective particle swarm optimization algorithm based on α-stable distribution[J]. Journal of NorthWestern Polytechnical University,2019,37(2):232-241. DOI: 10.3969/j.issn.1000-2758.2019.02.004

    [7] 齐飞,平雪良,刘洁,等. 工业机器人误差补偿及冗余参数研究[J]. 机械设计,2017,34(2):17-22. DOI: 10.13841/j.cnki.jxsj.2017.02.004

    QI Fei,PING Xueliang,LIU Jie,et al. Error compensation and parameters redundancy research of industrial robot[J]. Journal of Machine Design,2017,34(2):17-22. DOI: 10.13841/j.cnki.jxsj.2017.02.004

    [8] 王宪伦,喻洋,王道全,等. 凿岩机器人的建模与运动学分析[J]. 矿山机械,2016,44(1):90-93. DOI: 10.16816/j.cnki.ksjx.2016.01.022

    WANG Xianlun,YU Yang,WANG Daoquan,et al. Modeling and kinematics analysis of rock drilling robot[J]. Mining & Processing Equipment,2016,44(1):90-93. DOI: 10.16816/j.cnki.ksjx.2016.01.022

    [9] 徐勤宪,郭治富. 锚杆钻车三角钻臂的运动学研究[J]. 煤矿机械,2019,40(6):25-27. DOI: 10.13436/j.mkjx.201906008

    XU Qinxian,GUO Zhifu. Kinematics research of triangular drill arm of bolt drilling rig[J]. Coal Mine Machinery,2019,40(6):25-27. DOI: 10.13436/j.mkjx.201906008

    [10] 武少华,高岳林. 粒子群算法的改进与比较研究[J]. 合肥工业大学学报(自然科学版),2019,42(2):184-188,194. DOI: 10.3969/j.issn.1003-5060.2019.02.008

    WU Shaohua,GAO Yuelin. Improvement and comparison of particle swarm optimization[J]. Journal of Hefei University of Technology(Natural Science),2019,42(2):184-188,194. DOI: 10.3969/j.issn.1003-5060.2019.02.008

    [11] 梁樱馨,田浩杉. 基于细菌觅食与粒子群的改进粒子群算法[J]. 电子科技,2017,30(4):79-82.

    LIANG Yingxin,TIAN Haoshan. Improved hybrid algorithm based on bacterial foraging and particle swarm optimization[J]. Electronic Science and Technology,2017,30(4):79-82.

    [12] 潘勇,郭晓东. 一种基于遗传算法改进的粒子群优化算法[J]. 计算机应用与软件,2011,28(9):222-224. DOI: 10.3969/j.issn.1000-386X.2011.09.067

    PAN Yong,GUO Xiaodong. An improved particle swarm optimization algorithm based on genetic algorithm[J]. Computer Applications and Software,2011,28(9):222-224. DOI: 10.3969/j.issn.1000-386X.2011.09.067

    [13] 张晓莉,王秦飞,冀汶莉. 一种改进的自适应惯性权重的粒子群算法[J]. 微电子学与计算机,2019,36(3):66-70. DOI: 10.19304/j.cnki.issn1000-7180.2019.03.014

    ZHANG Xiaoli,WANG Qinfei,JI Wenli. An improved particle swarm optimization algorithm for adaptive inertial weights[J]. Microelectronics & Computer,2019,36(3):66-70. DOI: 10.19304/j.cnki.issn1000-7180.2019.03.014

    [14]

    SEKIGUCHI S, KIKUUWE, R. A stable algorithm for unsolvable inverse kinematics of a class of six-DoF manipulators[C]. IEEE/SICE International Symposium on System Integration, Honolulu, 2020: 1521-1529.

    [15] 黄开启,魏文彬,陈荣华,等. 凿岩机器人钻臂定位误差补偿控制交叉精英反向粒子群优化算法[J]. 机械科学与技术,2018,37(7):1005-1012. DOI: 10.13433/j.cnki.1003-8728.2018.0702

    HUANG Kaiqi,WEI Wenbin,CHEN Ronghua,et al. CEOPSO algorithm for positioning error compensation control of rock drilling robotic drilling arm[J]. Mechanical Science and Technology for Aerospace Engineering,2018,37(7):1005-1012. DOI: 10.13433/j.cnki.1003-8728.2018.0702

    [16] 王涛. 非线性权重和柯西变异的蝗虫算法[J]. 微电子学与计算机,2020,37(5):82-86. DOI: 10.19304/j.cnki.issn1000-7180.2020.05.016

    WANG Tao. Grasshopper optimization algorithm with nonlinear weight and cauchy mutation[J]. Microelectronics & Computer,2020,37(5):82-86. DOI: 10.19304/j.cnki.issn1000-7180.2020.05.016

    [17] 康岚兰,董文永,田降森. 一种自适应柯西变异的反向学习粒子群优化算法[J]. 计算机科学,2015,42(10):226-231.

    KANG Lanlan,DONG Wenyong,TIAN Jiangsen. Opposition-based particle swarm optimization with adaptive Cauchy mutation[J]. Computer Science,2015,42(10):226-231.

    [18] 于建芳,刘升,韩斐斐,等. 基于柯西变异的蚁狮优化算法[J]. 微电子学与计算机,2019,36(6):45-49,54. DOI: 10.19304/j.cnki.issn1000-7180.2019.06.010

    YU Jianfang,LIU Sheng,HAN Feifei,et al. Ant lion optimization algorithm based on Cauchy variation[J]. Microelectronics & Computer,2019,36(6):45-49,54. DOI: 10.19304/j.cnki.issn1000-7180.2019.06.010

    [19] 徐浩天,季伟东,孙小晴,等. 基于正态分布衰减惯性权重的粒子群优化算法[J]. 深圳大学学报(理工版),2020,37(2):208-213. DOI: 10.3724/SP.J.1249.2020.02208

    XU Haotian,JI Weidong,SUN Xiaoqing,et al. A PSO algorithm with inertia weight decay by normal distribution[J]. Journal of Shenzhen University(Science and Engineering),2020,37(2):208-213. DOI: 10.3724/SP.J.1249.2020.02208

    [20] 李俊,汪冲,李波,等. 基于多策略协同作用的粒子群优化算法[J]. 计算机应用,2016,36(3):681-686. DOI: 10.11772/j.issn.1001-9081.2016.03.681

    LI Jun,WANG Chong,LI Bo,et al. Particle swarm optimization algorithm based on multi-strategy synergy[J]. Journal of Computer Applications,2016,36(3):681-686. DOI: 10.11772/j.issn.1001-9081.2016.03.681

    [21] 韩玉辉. 液压凿岩台车自动定位钻孔关键技术研究[D]. 徐州: 中国矿业大学, 2019.

    HAN Yuhui. Research on key technologies of automatic location drilling for rock drilling jumbo[D]. Xuzhou: China University of Mining and Technology, 2019.

    [22] 冯帆. 红外视觉定位的机械臂控制算法研究与实现[D]. 西安: 西安工业大学, 2019.

    FENG Fan. Research and implementation of manipulator control algorithm for infrared vision positioning[D]. Xi'an: Xi'an Technological University, 2019.

  • 期刊类型引用(24)

    1. 张文科,郭瑜,赵辉. 基于图像识别的煤矿带式输送机自适应调速系统设计. 煤炭工程. 2024(01): 220-224 . 百度学术
    2. 刘锋,白金牛. 基于视觉技术的胶带输送机煤量检测方法. 陕西煤炭. 2024(01): 52-57+64 . 百度学术
    3. 尚伟栋,杨大山,张坤. 基于深度神经网络的带式输送机煤量检测方法. 工矿自动化. 2024(S1): 139-145 . 本站查看
    4. 贾良杰,胡子波,赵娟. 基于永磁变频技术的刮板输送机调速系统节能分析. 煤矿机械. 2023(03): 139-141 . 百度学术
    5. 胡而已,张耀. 激光煤流量测量中光斑条纹过饱和问题研究. 煤炭科学技术. 2023(02): 377-389 . 百度学术
    6. 郝洪涛,王凯,丁文捷. 基于超声阵列的输送带动态煤量检测系统. 工矿自动化. 2023(04): 120-127 . 本站查看
    7. 吕晨辉,李新,刘新龙,赵安新,张晨阳. 基于煤量检测与变频一体机的煤流自适应智能调速. 煤矿机械. 2023(08): 213-216 . 百度学术
    8. 陈湘源,薛旭升. 基于线性模型划分的煤流体积测量. 工矿自动化. 2023(07): 35-40+106 . 本站查看
    9. 朱富文,侯志会,李明振. 轻量化的多尺度跨通道注意力煤流检测网络. 工矿自动化. 2023(08): 100-105 . 本站查看
    10. 刘飞,张乐群,潘红光,李利. 带式输送机煤量检测技术及其发展趋势. 中国煤炭. 2023(09): 77-83 . 百度学术
    11. 郭永涛,裴文良,马永飞,张旭华,谢海峰,寇丽梅. 矿用隔爆型煤量扫描装置的设计与应用. 集成电路应用. 2023(10): 322-323 . 百度学术
    12. 汪连成. 刮板输送机智能化技术及应用. 煤矿机械. 2022(01): 138-140 . 百度学术
    13. 刘新龙,胡平,吕晨辉,赵安新,李学文. 基于激光红外线扫描的带式输送机煤流量实时检测技术. 煤炭技术. 2022(01): 217-219 . 百度学术
    14. 王利欣,杨秀宇,袁鹏喆,尉瑞,秦文光,李波,张恩明. 智能掘进工作面智能视频安全管理系统的应用. 煤矿机械. 2022(09): 200-203 . 百度学术
    15. 孙鹏亮,吴少伟. 基于红外扫描装置的转载机煤量监测技术研究. 数字通信世界. 2022(08): 63-65 . 百度学术
    16. 郑忠友,朱磊,程海星,张光磊. 综放工作面采放协调关系及智能装备研究. 煤矿机械. 2021(01): 54-56 . 百度学术
    17. 卢进南,韩建国,王常宝,郭友瑞,王志良. 热电厂运煤车厢动态监测及体积测量方法. 煤矿机电. 2021(01): 49-53+56 . 百度学术
    18. 孙延飞. 悬臂掘进机截割方量测量系统设计. 煤矿机械. 2021(09): 24-26 . 百度学术
    19. 崔亚平,朱时雪. 基于激光线扫描的桥梁检测仪器误差自动化矫正方法研究. 自动化与仪器仪表. 2020(01): 32-35 . 百度学术
    20. 韩涛,黄友锐,张立志,徐善永,许家昌,鲍士水. 基于图像识别的带式输送机输煤量和跑偏检测方法. 工矿自动化. 2020(04): 17-22 . 本站查看
    21. 王杰. 矿用隔爆型煤量扫描装置设计与应用. 煤. 2020(06): 49-50 . 百度学术
    22. 赵倩,陈杨军. 激光技术的轨道表面瑕疵识别系统设计. 激光杂志. 2020(08): 110-114 . 百度学术
    23. 王文清,田柏林,冯海明,陈兴明,李萍,任安祥. 基于激光测距矿用带式输送机多参数检测方法研究. 煤炭科学技术. 2020(08): 131-138 . 百度学术
    24. 武国平,梁兴国,胡金良,葛小冬. 图像处理和SVM应用于煤矸石分选的实验研究. 信息技术. 2019(01): 97-102+107 . 百度学术

    其他类型引用(9)

图(9)  /  表(3)
计量
  • 文章访问数:  192
  • HTML全文浏览量:  57
  • PDF下载量:  18
  • 被引次数: 33
出版历程
  • 收稿日期:  2022-07-19
  • 修回日期:  2023-02-28
  • 网络出版日期:  2023-03-26
  • 刊出日期:  2023-03-24

目录

/

返回文章
返回