CN114367979A - 一种矿用钻杆自动加接方法 - Google Patents
一种矿用钻杆自动加接方法 Download PDFInfo
- Publication number
- CN114367979A CN114367979A CN202111546611.2A CN202111546611A CN114367979A CN 114367979 A CN114367979 A CN 114367979A CN 202111546611 A CN202111546611 A CN 202111546611A CN 114367979 A CN114367979 A CN 114367979A
- Authority
- CN
- China
- Prior art keywords
- sigma
- drill rod
- robot
- relative
- transformation matrix
- 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
Images
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/1679—Programme controls characterised by the tasks executed
- B25J9/1687—Assembly, peg and hole, palletising, straight line, weaving pattern movement
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J15/00—Gripping heads and other end effectors
- B25J15/02—Gripping heads and other end effectors servo-actuated
- B25J15/0206—Gripping heads and other end effectors servo-actuated comprising articulated grippers
- B25J15/022—Gripping heads and other end effectors servo-actuated comprising articulated grippers actuated by articulated links
-
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Earth Drilling (AREA)
Abstract
本发明公开了一种矿用钻杆自动加接方法,主要包括一种自动配准算法、执行装置、机械手爪和辅助装置等。执行装置包括工业机器人、安装法兰、激光轮廓仪。辅助装置包括钻杆夹持器和钻杆安装架等。设定机器人的加接位置为初始状态,此时引入理论虚拟钻杆作为位姿基准。利用激光轮廓仪采集待抓取钻杆点云数据,重构三维表面轮廓,提取其几何特征,采用SAC‑IA+ICP三维点云配准算法,将其几何特征与加接位置处理论虚拟钻杆的几何特征进行匹配,获得钻杆当前位置与加接位置之间的坐标变换矩阵,利用此矩阵,基于机器人逆运动学原理求解机器人各关节运动量,控制机器人抓取当前位置处的钻杆并移动到加接位置处,实现钻杆的自动加接。
Description
技术领域
本发明属于自动化系统技术领域,具体涉及一种对矿用钻杆进行连续抓取安装的方法。
背景技术
随着我国经济社会的快速发展,石油等自然资源的供应需求日益增多,因此高效地开采石油才能可靠保证其正常供给。在石油开采时,矿井的深度长达数千米,而深井钻探用的单根钻杆的长度有限,需将钻杆沿轴向加接在一起以满足钻井深度要求。目前,钻杆的加接主要采用人工方式或者专门的钻杆安装装置辅以人工协助,不能实现钻杆抓取和安装的自动化。钻杆的数量多且重量大,降低了其安装过程的效率且增加了工作强度。另外,人工辅助也会降低石油开采过程的安全系数,增加劳动力成本。因此,钻杆的自动加接在深井钻探中非常关键。
本发明利用配有感知系统的工业机器人以识别钻杆的位姿并对钻杆进行抓取和安装,从而可靠地实现钻杆的自动加接,有效地提高钻杆的安装效率,节约劳动力成本。
发明内容
本发明的目的在于提供了一种矿用钻杆自动加接方法对蓝绿激光散射特性的计算方法,采用配有感知系统的工业机器人实现钻杆的自动化加接,以取代钻杆加接时的人工作业。
为实现上述目的,本发明提供如下技术方案:一种矿用钻杆自动加接方法,其具体步骤如下:
步骤1:首先在加工位置安装固定工业机器人、钻杆安装箱、钻杆安装架、激光轮廓仪;所述钻杆安装架上设置有钻杆夹持器、钻机;所述钻杆安装箱位于钻杆安装架的旁边;
步骤2:利用激光轮廓仪扫描待抓取钻杆,获取钻杆三维表面轮廓数据,以点云数据P={Pi|(xi,yi,zi),i∈Z}描述钻杆三维表面轮廓和坐标位姿;其中χi、уi、zi为钻杆三维数据点坐标值;
步骤3:设定工业机器人处于加接位置为初始状态,提取引入的理论虚拟钻杆对应的点云数据Q={Qi|(xi,yi,zi),i∈Z}描述理论虚拟钻杆三维表面轮廓和坐标位姿;
上式中:
n=(nx,ny,nz)为∑F的X轴对∑M的三个坐标轴的方向余弦;
o=(ox,oy,oz)为∑F的Y轴对∑M的三个坐标轴的方向余弦;
a=(ax,ay,az)为∑F的Z轴对∑M的三个坐标轴的方向余弦;
p=(px,py,pz)为∑F的原点在∑M中的坐标;
公式(2)中,θ1~θ6为机器人各关节运动量;
步骤6:利用公式(2)得到机器人各关节运动量,控制机器人完成对钻杆的抓取;
上式中:
n=(nx,ny,nz)为∑M的X轴对∑F的三个坐标轴的方向余弦;
o=(ox,oy,oz)为∑M的Y轴对∑F的三个坐标轴的方向余弦;
a=(ax,ay,az)为∑M的Z轴对∑F的三个坐标轴的方向余弦;
p=(px,py,pz)为∑M的原点在∑F中的坐标;
公式(4)中,θ1′~θ6′机器人各关节运动量;
步骤9:利用公式(4)得到机器人各关节运动量,控制机器人将已抓取的钻杆移动到安装位置;
步骤10:钻杆夹持器夹紧钻杆,钻机旋转,实现钻机与钻杆顶端螺纹连接,完成钻杆安装,钻杆夹持器松开,钻机带动钻杆旋转,进行作业;
步骤11:重复步骤2~步骤10,对钻杆进行连续加接,直至满足钻井深度要求。
与现有技术相比,本发明的有益效果如下:
利用激光轮廓仪采集待抓取钻杆点云数据,重构三维表面轮廓,提取其几何特征,采用SAC-IA+ICP三维点云配准算法,将其几何特征与加接位置处理论虚拟钻杆的几何特征进行匹配,获得钻杆当前位置与加接位置之间的坐标变换矩阵,利用此矩阵,基于机器人逆运动学原理求解机器人各关节运动量,控制机器人抓取当前位置处的钻杆并移动到加接位置处,实现钻杆的自动加接。
配备有感知系统的工业机器人可以识别钻杆的位姿以及钻杆的自动抓取、安装,从而实现钻杆的自动加接,能够有效地提高钻杆的安装效率、节约劳动力成本以及降低工作风险。
附图说明
图1为本发明的总体方案示意图;
图2为本发明的机器人坐标系示意图;
图3为本发明的扫描钻杆示意图;
图4为本发明的抓取钻杆示意图;
图5为本发明的安装钻杆示意图;
图6为本发明的钻杆加接过程流程图;
图7为本发明的三维配准算法流程图;
图8为本发明的SAC-IA+ICP配准前后效果图。
图中,1.1-工业机器人,1.2-安装法兰,1.3-激光轮廓仪,2.1-连接基体,2.2-夹持手指,2.3-电磁铁,2.4-液压缸,3.1-钻杆,3.2-钻杆安装箱,3.3-钻杆夹持器,3.4-理论虚拟钻杆,3.5-钻杆安装架,3.6-钻机,机器人基坐标系为∑G,腰关节坐标系为∑Y,肩关节坐标系为∑J,肘关节坐标系为∑Z,腕关节坐标系为∑W1,腕关节俯仰坐标系为∑W2,腕关节坐标系为∑W3,机械手爪坐标系为∑M,待抓取钻杆坐标系为∑F。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1-8本发明提供一种技术方案:一种矿用钻杆自动加接方法,所采用的设备包括执行装置、机械手爪和辅助装置等,执行装置包括工业机器人1.1、安装法兰1.2、激光轮廓仪1.3,工业机器人1.1为六个自由度,所述工业机器人1.1头部设置设置有机械手爪,机械手爪包括连接基体2.1、夹持手指2.2、电磁铁2.3和设置于连接基体上的液压缸2.4等,辅助装置包括钻杆安装箱3.2,钻杆夹持器3.3和钻杆3.1安装架3.5等,设定工业机器人1.1处于图4所示的加接位置为初始状态,此时引入理论虚拟钻杆3.4作为位姿基准。利用激光轮廓仪1.3采集待抓取钻杆3.1点云数据,重构三维表面轮廓,提取钻杆3.1几何特征,采用SAC-IA+ICP三维点云配准算法,将钻杆3.1几何特征与加接位置处理论虚拟钻杆3.4的几何特征进行匹配,获得钻杆3.1当前位置与加接位置之间的坐标变换矩阵,利用此矩阵,基于机器人逆运动学原理求解机器人各关节运动量,控制工业机器人1.1抓取当前位置处的钻杆3.1并移动到加接位置处,实现钻杆3.1的自动加接。
钻杆3.1的自动抓取和安装过程如图6所示,其具体步骤如下:
(1)安装固定工业机器人1.1、钻杆安装箱3.2和钻杆安装架3.5、激光轮廓仪1.3;
(2)如图3所示,利用激光轮廓仪1.3扫描待抓取钻杆3.1,获取钻杆3.1三维表面轮廓数据,以点云数据P={Pi|(xi,yi,zi),i∈Z}描述钻杆3.1三维表面轮廓和坐标位姿;
(3)设定机器人处于图4所示加接位置为初始状态,提取引入的理论虚拟钻杆3.4对应的点云数据Q={Qi|(xi,yi,zi),i∈Z}描述理论虚拟钻杆3.4三维表面轮廓和坐标位姿;
(4)提取点云数据几何特征并采用如图7所示的SAC-IA+ICP三维点云配准算法,计算出待抓取钻杆3.1相对于理论虚拟钻杆3.4的坐标变换矩阵如图8所示,即坐标系∑F相对于坐标系∑M的坐标变换矩阵即公式(1):
公式(1)中:
n=(nx,ny,nz)为∑F的X轴对∑M的三个坐标轴的方向余弦;
o=(ox,oy,oz)为∑F的Y轴对∑M的三个坐标轴的方向余弦;
a=(ax,ay,az)为∑F的Z轴对∑M的三个坐标轴的方向余弦;
p=(px,py,pz)为∑F的原点在∑M中的坐标;
(6)如图4所示,利用公式(2)得到机器人各关节运动量,控制工业机器人1.1完成对钻杆3.1的抓取;
式中:
n为∑M的X轴对∑F的三个坐标轴的方向余弦;
o为∑M的Y轴对∑F的三个坐标轴的方向余弦;
a为∑M的Z轴对∑F的三个坐标轴的方向余弦;
p为∑M的原点在∑F中的坐标;
(9)利用公式(4)得到工业机器人1.1各关节运动量,控制工业机器人1.1将已抓取的钻杆3.1移动到安装位置;
(10)如图5所示,钻杆夹持器3.3夹紧钻杆,钻机3.6旋转,实现钻机3.6与钻杆3.1顶端螺纹连接,完成钻杆3.1安装,钻杆夹持器3.3松开,钻机3.6带动钻杆3.1旋转,进行作业;
(11)重复步骤(2)~(10),对钻杆3.1进行连续加接,直至满足钻井深度要求。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (1)
1.一种矿用钻杆自动加接方法,其特征在于,其具体步骤如下:
步骤1:首先在加工位置安装固定工业机器人(1.1)、钻杆安装箱(3.2)、钻杆安装架(3.5)、激光轮廓仪(1.3);所述钻杆安装架(3.5)上设置有钻杆夹持器(3.3)、钻机(3.6);所述钻杆安装箱(3.2)位于钻杆安装架(3.5)的旁边;
步骤2:利用激光轮廓仪(1.3)扫描待抓取钻杆(3.1),获取钻杆(3.1)三维表面轮廓数据,以点云数据P={Pi|(xi,yi,zi),i∈Z}描述钻杆(3.1)三维表面轮廓和坐标位姿;其中χi、уi、zi为钻杆三维数据点坐标值;
步骤3:设定工业机器人(1.1)处于加接位置为初始状态,提取引入的理论虚拟钻杆(3.4)对应的点云数据Q={Qi|(xi,yi,zi),i∈Z}描述理论虚拟钻杆(3.4)三维表面轮廓和坐标位姿;
上式中:
n=(nx,ny,nz)为∑F的X轴对∑M的三个坐标轴的方向余弦;
o=(ox,oy,oz)为∑F的Y轴对∑M的三个坐标轴的方向余弦;
a=(ax,ay,az)为∑F的Z轴对∑M的三个坐标轴的方向余弦;
p=(px,py,pz)为∑F的原点在∑M中的坐标;
公式(2)中,θ1~θ6为机器人各关节运动量;
步骤6:利用公式(2)得到机器人各关节运动量,控制机器人完成对钻杆(3.1)的抓取;
上式中:
n=(nx,ny,nz)为∑M的X轴对∑F的三个坐标轴的方向余弦;
o=(ox,oy,oz)为∑M的Y轴对∑F的三个坐标轴的方向余弦;
a=(ax,ay,az)为∑M的Z轴对∑F的三个坐标轴的方向余弦;
p=(px,py,pz)为∑M的原点在∑F中的坐标;
公式(4)中,θ1′~θ6′机器人各关节运动量;
步骤9:利用公式(4)得到机器人各关节运动量,控制机器人将已抓取的钻杆(3.1)移动到安装位置;
步骤10:钻杆夹持器(3.3)夹紧钻杆(3.1),钻机(3.6)旋转,实现钻机(3.6)与钻杆(3.1)顶端螺纹连接,完成钻杆(3.1)安装,钻杆夹持器(3.3)松开,钻机(3.6)带动钻杆(3.1)旋转,进行作业;
步骤11:重复步骤2~步骤10,对钻杆(3.1)进行连续加接,直至满足钻井深度要求。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111546611.2A CN114367979B (zh) | 2021-12-16 | 2021-12-16 | 一种矿用钻杆自动加接方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111546611.2A CN114367979B (zh) | 2021-12-16 | 2021-12-16 | 一种矿用钻杆自动加接方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114367979A true CN114367979A (zh) | 2022-04-19 |
CN114367979B CN114367979B (zh) | 2023-07-18 |
Family
ID=81139573
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111546611.2A Active CN114367979B (zh) | 2021-12-16 | 2021-12-16 | 一种矿用钻杆自动加接方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114367979B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN203357446U (zh) * | 2013-07-12 | 2013-12-25 | 中国石油大学(华东) | 一种钻杆排放机械手 |
WO2017015898A1 (zh) * | 2015-07-29 | 2017-02-02 | Abb 瑞士股份有限公司 | 用于机器人拆垛设备的控制系统和用于控制机器人拆垛的方法 |
CN108942910A (zh) * | 2018-07-16 | 2018-12-07 | 武汉科技大学 | 一种岩心钻机钻杆自动排放机械手 |
CN109895101A (zh) * | 2019-04-09 | 2019-06-18 | 大连理工大学 | 一种关节型机械臂逆运动学数值唯一解求取方法 |
-
2021
- 2021-12-16 CN CN202111546611.2A patent/CN114367979B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN203357446U (zh) * | 2013-07-12 | 2013-12-25 | 中国石油大学(华东) | 一种钻杆排放机械手 |
WO2017015898A1 (zh) * | 2015-07-29 | 2017-02-02 | Abb 瑞士股份有限公司 | 用于机器人拆垛设备的控制系统和用于控制机器人拆垛的方法 |
CN108942910A (zh) * | 2018-07-16 | 2018-12-07 | 武汉科技大学 | 一种岩心钻机钻杆自动排放机械手 |
CN109895101A (zh) * | 2019-04-09 | 2019-06-18 | 大连理工大学 | 一种关节型机械臂逆运动学数值唯一解求取方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114367979B (zh) | 2023-07-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108638069B (zh) | 一种机械臂末端精确运动控制方法 | |
CN101913076B (zh) | 基于工业机器人的活塞、活塞销和连杆装配方法及装置 | |
CN203438234U (zh) | 一种多用途物料搬运工业机器人 | |
CN104570938B (zh) | 一种插装生产中的双臂机器人系统的控制方法 | |
CN103306690A (zh) | 隧道加固机器人 | |
CN102091967A (zh) | 一种多轴数控加工的进给速度平滑方法 | |
CN101676074A (zh) | 机械手换料方法 | |
CN107953340A (zh) | 一种通用型六自由度机械手逆解工程算法 | |
CN206357237U (zh) | 一种双液压缸推动搬运机器人 | |
CN108481324A (zh) | 一种八轴多功能机械臂的逆解工程及其碰撞检测算法 | |
CN114367979A (zh) | 一种矿用钻杆自动加接方法 | |
CN114211498B (zh) | 基于方向包围盒的锚杆支护机器人碰撞检测方法及系统 | |
CN104669254A (zh) | 一种双串联机械臂式移动操作机装置的自动化定位方法 | |
CN107253180B (zh) | 一种基于工业机器人的物体姿态调整装置及姿态调整方法 | |
CN206407640U (zh) | 一种铝型材自动堆垛系统 | |
Jianjun et al. | Monte Carlo method for searching functional workspace of an underwater manipulator | |
Yuan et al. | Discussion on the robotic approach of disc cutter replacement for shield machine | |
CN207172076U (zh) | 一种双机械臂系统 | |
Li et al. | Spatial kinematics modeling and simulation of wheel loader | |
Sun et al. | TECHNOLOGY AND APPLICATION OF AUTOMATED PRODUCTION CONTROL ROBOT FOR PETROLEUM DRILL PIPE. | |
Yang et al. | Trajectory planning of TBM cutter changing robot based on binocular vision | |
CN114619427B (zh) | 一种用于智能装配的6pus-3rrr双平台设备 | |
CN112571405B (zh) | 机械手及机械手点位确定方法 | |
CN212145391U (zh) | 一种陶瓷轴具的加工装置 | |
Wu et al. | Kinematics analysis and simulation of KUKA KR5-arc welding robot based on MATLAB |
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 |