CN108643828A - 一种高坡锚固装备智能控制方法 - Google Patents

一种高坡锚固装备智能控制方法 Download PDF

Info

Publication number
CN108643828A
CN108643828A CN201810257714.9A CN201810257714A CN108643828A CN 108643828 A CN108643828 A CN 108643828A CN 201810257714 A CN201810257714 A CN 201810257714A CN 108643828 A CN108643828 A CN 108643828A
Authority
CN
China
Prior art keywords
algorithm
operating platform
sensor
gyroscope
drill
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
Application number
CN201810257714.9A
Other languages
English (en)
Other versions
CN108643828B (zh
Inventor
胡宏伟
毛聪
付宏渊
尹来容
张明军
曾铃
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Changsha University of Science and Technology
Original Assignee
Changsha University of Science and Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Changsha University of Science and Technology filed Critical Changsha University of Science and Technology
Priority to CN201810257714.9A priority Critical patent/CN108643828B/zh
Publication of CN108643828A publication Critical patent/CN108643828A/zh
Application granted granted Critical
Publication of CN108643828B publication Critical patent/CN108643828B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • EFIXED CONSTRUCTIONS
    • E21EARTH OR ROCK DRILLING; MINING
    • E21BEARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
    • E21B7/00Special methods or apparatus for drilling
    • E21B7/02Drilling rigs characterised by means for land transport with their own drive, e.g. skid mounting or wheel mounting
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/20Scenes; Scene-specific elements in augmented reality scenes

Landscapes

  • Engineering & Computer Science (AREA)
  • Geology (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Physics & Mathematics (AREA)
  • Mining & Mineral Resources (AREA)
  • Environmental & Geological Engineering (AREA)
  • Fluid Mechanics (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Geochemistry & Mineralogy (AREA)
  • General Physics & Mathematics (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Earth Drilling (AREA)

Abstract

一种高坡锚固装备智能控制方法,包括:不同坡度时驾驶室姿态的自适应控制、基于机器视觉的自适应钻孔控制。其特点是操作平台上装有倾角传感器和陀螺仪,当锚固装备进入新的坡面时,操作平台的角度可以通过倾角传感器与陀螺仪保证驾驶室自成水平状态;而且通过视觉传感器以及激光测距传感器,运用插值填充算法、二值法算法、图像平滑算法和边缘提取算法达到自适应钻孔;本发明适用于各种坡面、工况复杂的工作环境,具有工作效率高、易操作、安全可靠等优点。

Description

一种高坡锚固装备智能控制方法
技术领域
本发明涉及一种山体斜坡锚固装置控制方法,特别涉及一种高坡锚固装备智能控制方法。
背景技术
在我们进行建筑施工、道路建设、地下挖掘作业过程中,经常会遇到滑坡的情况,虽然通过清除土石减小坡度能降低滑坡风险,但若遇到连续降雨、阵雨等这种极端天气,仍有很大的安全隐患,威胁人们安全,容易造成财产损失,何况有的斜坡太过巨大,植被稀少,清除土石根本无法解决问题,针对这种问题,岩土锚固技术应运而生;传统的岩土锚固技术,对于小斜坡,大多通过提升设备或搭脚手架来运输锚固钻机,这种做法虽然也能解决问题,但必须要不断改变手脚架的位置、高度或移动提升设备才能改变锚固钻机的位置,工作效率低,且搭脚手架工作任务大,成本高,对于太高太大的山坡,这种做法明显耗资巨大且不安全。如何高效、快速、安全地、智能地在高坡上进行岩土锚固施工已成为我们主要研究内容。
授权公告号为CN206280005U的专利中,提供了钻机保持垂直度的装置,通过预设垂直度限位孔来保持钻孔的垂直度,又如申请公布号为CN107724950A的专利,此专利提供了若干定位孔的钻模板,可以实现多孔钻取;但是上述专利都局限于有钻模板的情况下进行施工,不能适应于大范围的钻孔要求,而且只用于平地上钻孔,难以适应高坡等多种工况,在施工过程需要通过人工安装,缺少了施工的钻孔定位的精确性,施工效率不高。
申请公布号为CN104775837A的专利中,公开了一种铁路隧道锚杆台车,可实现隧道锚杆施工的机械化,提高施工的质量以及效率;但是在坡上施工时,操作平台不能保持水平,使得操作员的操作视野受阻,影响施工的安全,以及施工的质量。
发明内容
针对现今高坡岩土锚固技术存在的施工困难、效率低下、操作繁杂、机动性差、成本高的问题,本发明提供了一种操作容易、自动化程度及施工效率高、安全性能好的高坡锚固装备智能控制方法。
适用于本方法的一种高坡岩土锚固用可调式锚杆钻机,包括行走履带、倾角传感器、视觉传感器、调节油缸、滑动导轨、吊耳、操作平台、动臂、动臂油缸、钻臂、钻臂油缸、钻头套管、钻机导轨、锚杆钻机、卷扬机、钢丝绳、拉力传感器;所述滑动导轨上方安装有操作平台,操作平台可以沿着滑动导轨前后移动,操作人员可以根据施工情况及时调整操作平台和锚杆钻机的姿态;所述操作平台安装有倾角传感器和陀螺仪,可以及时感知操作平台的姿态,结合PID控制系统,可以通过调节油缸来迅速调整操作平台的姿态,使操作平台始终保持水平;锚杆钻机可以沿着钻机导轨移动,其尾部安装有视觉传感器和激光测距仪,前端安装有钻头套管;钻孔时,锚杆钻机可以根据嵌入式控制器所规划的钻孔参数,进行自适应钻孔,提高了设备的自动化和精确性,并通过视觉传感器传输施工画面至操作平台,有利于操作人员及时掌握施工状态信息,提高设备安全性;
一种操作平台实现姿态自控制的方法为,在驾驶室下方中心安装一个陀螺仪,与倾角传感器组成驾驶室倾角调整模块,采用PID算法控制,用于形成一种简易互补滤波的方法,融合陀螺仪和倾角传感器的输出信号,补偿倾角传感器的动态误差及陀螺仪的漂移误差,得到优化后的驾驶室倾角θs。本方法使用低通滤波去除了倾角传感器短时快速变化的信号,保留长时性缓慢信号,使用高通滤波处理陀螺仪部分数据,进而抑制陀螺仪的漂移。
本方法使用卡尔曼滤波器技术,首先建立系统状态方程和测量方程,对于驾驶室倾角θ,其状态方程由下列方程给出:
其中θk+1,θk为倾角,ωk为倾斜速度,bk为陀螺仪的零漂,T为采样时间;Wb,Wθ为过程高斯白噪声,其协方差为Qb,Qθ;选择xk+1=[θk,bk]T作为系统状态变量,将ωk视为控制输入,可以将倾角方程写为:
上述方程中Wk=[Wb,Wθ]T,利用输出信号的测量值和系统模型方程,实时获得系统状态变量和输出信号的最优值,从而得到优化后的驾驶室倾角θs
设定倾角阈值为±α°度,设定T秒为测量周期,将优化后的驾驶室倾角θs作为误差数据与设定阈值倾角进行比对,进行PID条件判断(图中定义顺时针方向为正向),从而控制液压缸伸缩长度,若在|θs|≤α°,则液压缸保持现状,若在θs>α°,则液压缸行程缩短,若在θs<-α°且则液压缸行程伸长,同时PID控制器反馈本次调整后倾角值于卡尔曼滤波器,与下一周期测量数据进行计算,判断驾驶室相对于水平面倾角是否超过|α°|。
一种利用视觉传感器自动钻孔的方法为,通过视觉传感器与图像信息采集卡,获得混凝土梁网的图像,把图像传送到工控机上后,经过插值填充算法,二值法算法,图像平滑算法,对图像进行优化处理,再运用边缘提取算法获得精确的混凝土梁网轮廓;再通过比例尺的比对,计算出混凝土梁网的尺寸;根据用户钻孔数量的要求,工控机会对混凝土梁网的尺寸均分,得到钻孔的位置和钻孔中心点O;动臂和钻臂运动到钻孔中心点O,利用3个激光测距传感器测量并计算O处的单位法向量en,再判断O处的单位法向量en与锚杆钻机轴线的夹角若夹角在允许的偏差范围内,则锁定锚杆钻机进行钻孔;若夹角不在允许的偏差范围内,则工控机调整动臂油缸、钻臂油缸;保证钻孔的质量。
本发明的优点在于:
与现有的发明相比,本发明通过液压油缸调整操作平台的角度,结合倾角传感器与陀螺仪,可以实现操作平台姿态的自适应调整,以保证在不同角度坡面进行作业时,都可自动将驾驶室调节至水平位置,方便工作人员操控机器,通过视觉传感器和激光测距传感器,结合插值填充算法、二值法算法、图像平滑算法、边缘提取算法,可以实现自动钻孔,适用于各种高坡锚固的工作环境,实用性强,提高了工作效率。
附图说明
图1为本发明的控制流程图。
图2为本发明装备的侧视图。
图3为本发明装备的斜视图。
图4为本发明装备的正视图。
图5为实施方案孔洞定位图。
图中:1-行走履带(1)、2-倾角传感器(2)、3-视觉传感器(3)、4-调节油缸(4)、5-滑动导轨(5)、6-吊耳(6)、7-操作平台(7)、8-动臂(8)、9-动臂油缸(9)、10-钻臂(10)、11-钻臂油缸(11)、12-钻头套管(12)、13-钻机导轨(13)、14-锚杆钻机(14)、15-卷扬机(15)、16-钢丝绳(16)、17-拉力传感器(17)。
具体实施方式
下面结合说明书附图和具体实施例对本发明作进一步详细说明。
如图2和图3所示,一种高坡岩土锚固用可调式锚杆钻机,包括行走履带1、倾角传感器2、视觉传感器3、调节油缸4、滑动导轨5、吊耳6、操作平台7、动臂8、动臂油缸9、钻臂10、钻臂油缸11、钻头套管12、钻机导轨13、锚杆钻机14、卷扬机15、钢丝绳16、拉力传感器17;所述滑动导轨5上方安装有操作平台7,操作平台7可以沿着滑动导轨5前后移动,操作人员可以根据施工情况及时调整操作平台7和锚杆钻机14的姿态;所述操作平台7安装有倾角传感器2,倾角传感器2和陀螺仪,可以及时感知操作平台7的姿态,结合PID控制系统,可以通过调节油缸4来迅速调整操作平台7的姿态,使操作平台7始终保持水平;锚杆钻机14可以沿着钻机导轨13移动,其尾部安装有视觉传感器3和激光测距仪,前端安装有钻头套管12;钻孔时,锚杆钻机14可以根据嵌入式控制器所规划的钻孔参数,进行自适应钻孔,提高了设备的自动化和精确性,并通过视觉传感器3传输施工画面至操作平台7,有利于操作人员及时掌握施工状态信息,提高设备安全性;
一种操作平台实现姿态自控制的方法为,在驾驶室下方中心安装一个陀螺仪,与倾角传感器组成驾驶室倾角调整模块,采用PID算法控制,用于形成一种简易互补滤波的方法,融合陀螺仪和倾角传感器的输出信号,补偿倾角传感器的动态误差及陀螺仪的漂移误差,得到优化后的驾驶室倾角θs,设定倾角阈值为±5°度,设定12秒为测量周期,将优化后的驾驶室倾角θs作为误差数据与设定阈值倾角进行比对,进行PID条件判断(图中定义顺时针方向为正向),从而控制液压缸伸缩长度,若在|θs|≤5°,则液压缸保持现状,若在θs>5°,则液压缸行程缩短,若在θs<-5°且则液压缸行程伸长,同时PID控制器反馈本次调整后倾角值于卡尔曼滤波器,与下一周期测量数据进行计算,判断驾驶室相对于水平面倾角是否超过±5°。
操作平台在第一个测量周期调整操作平台平衡后,通过视觉传感器与图像信息采集卡,获得混凝土梁网的图像,把图像传送到工控机上后,经过插值填充算法,二值法算法,图像平滑算法,对图像进行优化处理,再运用边缘提取算法获得精确的混凝土梁网轮廓;再通过比例尺的比对,计算出混凝土梁网的尺寸为1600mm*900mm;根据用户钻孔数量的要求,需要打5个孔;工控机会对混凝土梁网的尺寸均分为各相隔100mm的5个孔洞定位(如图5所示),得到钻孔的位置和钻孔中心点O;动臂和钻臂运动到钻孔中心点O,利用3个激光测距传感器测量并计算O处的单位法向量en,再判断O处的单位法向量en与锚杆钻机轴线的夹角φ=3°;若夹角φ=3°在允许的偏差范围内,则锁定锚杆钻机进行钻孔;若夹角φ不在允许的偏差范围内,则工控机调整动臂油缸、钻臂油缸,保证钻孔的质量。

Claims (3)

1.一种高坡锚固装备智能控制方法,该方法的适用装备为,一种高坡岩土锚固用可调式锚杆钻机,包括行走履带(1)、倾角传感器(2)、视觉传感器(3)、调节油缸(4)、滑动导轨(5)、吊耳(6)、操作平台(7)、动臂(8)、动臂油缸(9)、钻臂(10)、钻臂油缸(11)、钻头套管(12)、钻机导轨(13)、锚杆钻机(14)、卷扬机(15)、钢丝绳(16),该方法的特征在于,通过陀螺仪和倾角传感器实现操作平台(7)的姿态自动控制,通过在钻头上方的视觉传感器(3)及激光测距传感器实现自动钻孔。
2.根据权利要求1所述的方法,其特征在于,所述的操作平台实现姿态自动控制的方法为:操作平台下方安装一个陀螺仪,与倾角传感器组成驾驶室倾角调整模块,用于形成一种基于卡尔曼滤波器技术的互补滤波方法以得到优化后的驾驶室倾角θs,并采用PID算法控制液压缸的伸缩以实现姿态的自动控制;其中PID算法进行条件判断的具体过程为,将驾驶室倾角值θs作为误差数据,与设定阈值倾角进行比对,从而控制液压缸的运动状态,若|θs|≤α°,则液压缸保持现状,若θs>α°,则液压缸行程缩短,若在θs<α°,则液压缸行程伸长,本方法使用低通滤波去除了倾角传感器短时快速变化的信号,保留长时性缓慢信号,使用高通滤波处理陀螺仪部分数据,进而抑制陀螺仪的漂移;同时PID控制器反馈本次调整后的倾角值于卡尔曼滤波器,与下一周期测量数据进行计算,判断驾驶室相对于水平面倾角是否超过|α°|。
3.根据权利要求1所述的方法,其特征在于,所述的自动钻孔的方法为:通过视觉传感器与图像信息采集卡,获得混凝土梁网的图像,把图像传送到工控机后,经过插值填充算法,二值法算法,图像平滑算法,对图像进行优化处理,再运用边缘提取算法获得精确的混凝土梁网轮廓;再通过比例尺的比对,计算出混凝土梁网的尺寸;根据用户钻孔数量的要求,工控机对混凝土梁网的尺寸均分,得到钻孔的位置和钻孔中心点O;动臂和钻臂运动到钻孔中心点O,利用3个激光测距传感器测量并计算O处的单位法向量en,再判断O处的单位法向量en与锚杆钻机轴线的夹角若夹角在允许的偏差范围内,则锁定锚杆钻机进行钻孔;若夹角不在允许的偏差范围内,则工控机调整动臂油缸、钻臂油缸;保证钻孔的质量。
CN201810257714.9A 2018-03-27 2018-03-27 一种高坡锚固装备智能控制方法 Expired - Fee Related CN108643828B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810257714.9A CN108643828B (zh) 2018-03-27 2018-03-27 一种高坡锚固装备智能控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810257714.9A CN108643828B (zh) 2018-03-27 2018-03-27 一种高坡锚固装备智能控制方法

Publications (2)

Publication Number Publication Date
CN108643828A true CN108643828A (zh) 2018-10-12
CN108643828B CN108643828B (zh) 2020-05-05

Family

ID=63744820

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810257714.9A Expired - Fee Related CN108643828B (zh) 2018-03-27 2018-03-27 一种高坡锚固装备智能控制方法

Country Status (1)

Country Link
CN (1) CN108643828B (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109707366A (zh) * 2019-02-19 2019-05-03 重庆平山矿山机电设备有限公司 一种钻机角度在线精确测控装置及方法
CN110456646B (zh) * 2019-08-23 2021-01-29 中国矿业大学 基于ekf的锚杆钻机钻臂摆角自适应滑模控制系统设计方法
CN113914880A (zh) * 2021-09-01 2022-01-11 中铁九局集团电务工程有限公司 基于激光测距的倾角可修正隧道打孔方法及打孔机器人
CN114982424A (zh) * 2022-08-03 2022-09-02 徐州中矿岩土技术股份有限公司 一种高陡边坡植生孔钻进施工机械及施工工法
CN116480390A (zh) * 2023-06-19 2023-07-25 山西研控智能科技有限公司 一种自动钻锚控制方法及系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1136126A (zh) * 1995-05-01 1996-11-20 日立建机株式会社 钻进钻孔方法及钻进钻孔机
JP2003064974A (ja) * 2001-06-15 2003-03-05 Hitachi Constr Mach Co Ltd 斜面穿孔機と斜面穿孔設備と斜面穿孔工法
CN204170997U (zh) * 2014-09-10 2015-02-25 山东鲁能智能技术有限公司 变电站带电水冲洗机器人系统
CN104929530A (zh) * 2014-03-23 2015-09-23 湖南泰达天易重工有限公司 防倾倒长螺旋钻机
CN206190212U (zh) * 2016-11-27 2017-05-24 曹对对 一种煤矿钻孔用外置式钻杆角度监测装置
WO2017146135A1 (ja) * 2016-02-26 2017-08-31 トピー工業株式会社 地質サンプル採取方法および姿勢制御可能な作業装置

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1136126A (zh) * 1995-05-01 1996-11-20 日立建机株式会社 钻进钻孔方法及钻进钻孔机
JP2003064974A (ja) * 2001-06-15 2003-03-05 Hitachi Constr Mach Co Ltd 斜面穿孔機と斜面穿孔設備と斜面穿孔工法
CN104929530A (zh) * 2014-03-23 2015-09-23 湖南泰达天易重工有限公司 防倾倒长螺旋钻机
CN204170997U (zh) * 2014-09-10 2015-02-25 山东鲁能智能技术有限公司 变电站带电水冲洗机器人系统
WO2017146135A1 (ja) * 2016-02-26 2017-08-31 トピー工業株式会社 地質サンプル採取方法および姿勢制御可能な作業装置
CN206190212U (zh) * 2016-11-27 2017-05-24 曹对对 一种煤矿钻孔用外置式钻杆角度监测装置

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109707366A (zh) * 2019-02-19 2019-05-03 重庆平山矿山机电设备有限公司 一种钻机角度在线精确测控装置及方法
CN110456646B (zh) * 2019-08-23 2021-01-29 中国矿业大学 基于ekf的锚杆钻机钻臂摆角自适应滑模控制系统设计方法
CN113914880A (zh) * 2021-09-01 2022-01-11 中铁九局集团电务工程有限公司 基于激光测距的倾角可修正隧道打孔方法及打孔机器人
CN113914880B (zh) * 2021-09-01 2024-02-23 中铁九局集团电务工程有限公司 基于激光测距的倾角可修正隧道打孔方法及打孔机器人
CN114982424A (zh) * 2022-08-03 2022-09-02 徐州中矿岩土技术股份有限公司 一种高陡边坡植生孔钻进施工机械及施工工法
CN116480390A (zh) * 2023-06-19 2023-07-25 山西研控智能科技有限公司 一种自动钻锚控制方法及系统
CN116480390B (zh) * 2023-06-19 2023-09-12 山西研控智能科技有限公司 一种自动钻锚控制方法及系统

Also Published As

Publication number Publication date
CN108643828B (zh) 2020-05-05

Similar Documents

Publication Publication Date Title
CN108643828A (zh) 一种高坡锚固装备智能控制方法
CN108590518B (zh) 一种高坡锚固用可调式锚杆钻机
CN103119225B (zh) 推土铲控制系统及建筑机械
CN101736755B (zh) 清水孔桩基施工方法
CN107558989B (zh) 旋挖钻机智能控制装置、旋挖钻机智能控制方法及系统
CN110939384B (zh) 一种高坡锚固用锚杆钻机的工作方法
CN112253083A (zh) 钻孔自动定位装置及方法
CN110468833A (zh) 用于内河航道的水上钻孔灌注桩施工装置及其使用方法
CN204530661U (zh) 深水基床夯实系统
CN108625302A (zh) 一种箱涵顶进纵向坡度的调整装置及其监测控制方法
CN110130339A (zh) 装配式水上作业船及施工方法
CN109630013A (zh) 一种液压凿岩台车
CN108643829B (zh) 一种高坡锚固用锚孔施工方法
CN107675743B (zh) 一种锚艇辅助顶推单边横移施工系统及其施工方法
JP2004092128A (ja) 地中連続溝の掘削方法および地中連続溝掘削機
CN203175409U (zh) 一种矿井用钻机
CN110331726A (zh) 一种水下地形3d打印机及施工控制方法
CN211446903U (zh) 一种phc管桩内钻引孔锤击一体机
CN205895138U (zh) 边坡锚杆框架梁钻孔辅助器具
CN209457869U (zh) 一种液压凿岩台车
CN115434687B (zh) 一种基于打桩的智能调节系统
KR102189580B1 (ko) 케이슨 제작용 슬립폼 시스템
CN117107748A (zh) 砂岩地区锚固桩机械干作业成孔施工工法
CN106480920A (zh) 一种桥式自动侧挖式抓斗挖泥船
CN111119732B (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
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20200505