CN110454182B - 一种全断面隧道掘进机换刀机器人视觉定位结构及方法 - Google Patents

一种全断面隧道掘进机换刀机器人视觉定位结构及方法 Download PDF

Info

Publication number
CN110454182B
CN110454182B CN201910819248.3A CN201910819248A CN110454182B CN 110454182 B CN110454182 B CN 110454182B CN 201910819248 A CN201910819248 A CN 201910819248A CN 110454182 B CN110454182 B CN 110454182B
Authority
CN
China
Prior art keywords
tool
end effector
changing robot
image
tool changing
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.)
Active
Application number
CN201910819248.3A
Other languages
English (en)
Other versions
CN110454182A (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.)
China Railway Engineering Equipment Group Co Ltd CREG
Original Assignee
China Railway Engineering Equipment Group Co Ltd CREG
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 China Railway Engineering Equipment Group Co Ltd CREG filed Critical China Railway Engineering Equipment Group Co Ltd CREG
Priority to CN201910819248.3A priority Critical patent/CN110454182B/zh
Publication of CN110454182A publication Critical patent/CN110454182A/zh
Application granted granted Critical
Publication of CN110454182B publication Critical patent/CN110454182B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E21EARTH OR ROCK DRILLING; MINING
    • E21DSHAFTS; TUNNELS; GALLERIES; LARGE UNDERGROUND CHAMBERS
    • E21D9/00Tunnels or galleries, with or without linings; Methods or apparatus for making thereof; Layout of tunnels or galleries
    • E21D9/003Arrangement of measuring or indicating devices for use during driving of tunnels, e.g. for guiding machines
    • EFIXED CONSTRUCTIONS
    • E21EARTH OR ROCK DRILLING; MINING
    • E21DSHAFTS; TUNNELS; GALLERIES; LARGE UNDERGROUND CHAMBERS
    • E21D9/00Tunnels or galleries, with or without linings; Methods or apparatus for making thereof; Layout of tunnels or galleries
    • E21D9/06Making by using a driving shield, i.e. advanced by pushing means bearing against the already placed lining
    • E21D9/08Making by using a driving shield, i.e. advanced by pushing means bearing against the already placed lining with additional boring or cutting means other than the conventional cutting edge of the shield
    • E21D9/087Making by using a driving shield, i.e. advanced by pushing means bearing against the already placed lining with additional boring or cutting means other than the conventional cutting edge of the shield with a rotary drilling-head cutting simultaneously the whole cross-section, i.e. full-face machines

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Environmental & Geological Engineering (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Geochemistry & Mineralogy (AREA)
  • Geology (AREA)
  • Manipulator (AREA)

Abstract

本发明提出了一种全断面隧道掘进机换刀机器人视觉定位结构及方法,用以解决现有自动换刀过程中不能对滚刀进行精确定位的技术问题,本发明视觉定位结构包括相机装置,相机装置固定在换刀机器人末端执行器上。本发明依托全断面隧道掘进机实际工况,通过架设于换刀机器人末端执行器上的工业相机及光源采集刀箱图像,通过图像处理手段获得换刀机器人末端执行器当前位姿与标定位姿的偏差并进行纠偏,实现换刀机器人末端执行器的精确定位;且成本低、易实现,对全断面隧道掘进机换刀机器人自动换刀技术的成功研发提供了可能;解决全断面隧道掘进机人工换刀难度大、风险高、效率低等突出问题,具有良好的可实现性和经济性。

Description

一种全断面隧道掘进机换刀机器人视觉定位结构及方法
技术领域
本发明涉及全断面隧道掘进机自动换刀的技术领域,尤其涉及一种全断面隧道掘进机换刀机器人视觉定位结构及方法。
背景技术
全断面隧道掘进机是一种集机、电、光、液、传感、控制等多种技术于一体的大型机械化、自动化、集成化隧道开挖衬砌成套设备,具有自动化程度高、施工速度快、安全经济、对地表沉降及地面交通影响小等突出特点。刀盘是全断面隧道掘进机的核心部件,在掘进机掘进过程中直接与掌子面接触,刀盘上的滚刀难免磨损严重,磨损到一定程度后就要及时更换。目前,滚刀的更换基本采用人工操作,面对高压、高湿环境,换刀作业风险和时间成本都很高。针对全断面隧道掘进机的自动换刀技术,国内外部分企业和专家学者开始进行初步研究,未有效应用于实际工况中,其中关于自动换刀过程中滚刀的精确定位问题研究,目前尚未看到有效技术手段。
由于全断面隧道掘进机刀盘直径达10米以上,体积大,重量大,导致惯性大,虽然刀盘主轴安装有旋转编码器,可以实现刀盘相对准确的停机,但依旧难保证十分精确。对于换刀机器人来说,如果按照既定程序路径走,微小的偏差都将导致换刀机器人末端执行器无法准确抓取磨损的滚刀刀座,导致无法顺利完成换刀动作,偏差大时还可能导致换刀机器人末端执行器撞机,产生破坏性结果。
发明内容
针对现有自动换刀过程中不能对滚刀进行精确定位的技术问题,依托全断面隧道掘进机实际工况,本发明提出一种全断面隧道掘进机换刀机器人视觉定位结构及方法,通过图像采集处理手段实现换刀机器人末端执行器的精确定位,实现换刀机器人的精准换刀动作;且成本低、易实现,对全断面隧道掘进机换刀机器人自动换刀技术的成功研发提供了可能。
为了达到上述目的,本发明的技术方案是这样实现的:一种全断面隧道掘进机换刀机器人视觉定位结构,包括相机装置,相机装置固定在换刀机器人末端执行器上。
还包括反光件,反光件固定在容纳滚刀的刀箱上,相机装置与上位机相连接,上位机与机器人控制***相连接。
所述反光件的数量设有至少两个、均固定在刀箱正面上;所述反光件为包括反光片,反光片通过固定螺钉固定在刀箱上。
所述相机装置包括工业相机和相机镜头,相机镜头可拆卸连接在工业相机上,工业相机通过支架固定在换刀机器人末端执行器的固定爪的中部。
所述支架上固定有相机光源,相机光源的数量设有两个、且分别设置在工业相机的两侧。
一种全断面隧道掘进机换刀机器人视觉定位方法,其步骤如下:
步骤一:确定标定图像:根据任一刀箱的位置设定标定位置,机器人控制***控制换刀机器人末端执行器移动到特定位置,手动调节机器人控制***内的参数使换刀机器人末端执行器正对刀箱,上位机开启工业相机和相机光源,对反光件所在的刀箱进行图像采集,并将采集的图像作为标定图像。
步骤二:换刀机器人末端执行器按照机器人控制***设定的路径移动到待拆卸滚刀所在刀箱的正面,上位机开启工业相机和相机光源,对反光件所在的刀箱正面进行图像采集;
步骤三:上位机对步骤二采集的图像进行识别,确定换刀机器人末端执行器的当前姿态,计算当前姿态与标定图像的姿态的旋转角偏差值,上位机将旋转角偏差值传送至机器人控制***,对换刀机器人末端执行器的姿态进行调整;
步骤四:工业相机采集姿态调整后反光件所在的刀箱的图像,上位机对姿态调整后的图像进行识别确定换刀机器人末端执行器的当前位置,计算当前位置与标定图像的标定位置的距离偏差值,上位机将距离偏差值传送至机器人控制***,利用距离偏差值对换刀机器人末端执行器的位置进行调整;
步骤五:工业相机采集位置调整后的反光件所在的刀箱的图像,上位机对位置调整后的图像进行识别,确定换刀机器人末端执行器的当前位置,计算当前位置在XY平面内与标定图像的标定位置的偏差值,上位机将偏差值传送至机器人控制***,利用偏差值对换刀机器人末端执行器的位置进行调整;
步骤六:完成换刀机器人末端执行器位姿的修正,进行下一步的换刀动作。
所述特定位置位于刀箱的中心线上,且距离刀箱正面的距离的范围30-50cm;所述工业相机在图像采集前,利用巡检机器人利用高压水对待采集图像的刀箱冲洗,机器人控制***调整换刀机器人末端执行器的位置使工业相机的轴线与刀盘正面所在的平面垂直。
所述反光件的数量设有3个,且三个反光件分别固定在刀箱的任意三个角上;将3个反光件的中心作为特征点,上位机通过图像处理方法识别三个特征点在采集图像视野范围内的像素坐标;且标定图像中三个特征点在视野范围内的像素坐标分别为A(xA,yA)、B(xB,yB)和C(xC,yC)。
所述步骤三中计算当前姿态与标定图像的姿态的旋转角偏差值的方法为:
S31:上位机通过图像处理方法对步骤二中采集的图像中的三个特征点进行识别,得到换刀机器人末端执行器当前姿态下三个特征点在视野范围内的像素坐标分别为A1'(x'1A,y'1A)和B1'(x'1B,y'1B)和C1'(x'1C,y'1C);
S32:计算
Figure GDA0002952196880000031
利用向量法求条直线的夹角;式中θ1为线段AB与线段A1′B1′所在直线的夹角,
Figure GDA0002952196880000032
为A、B点的向量,
Figure GDA0002952196880000033
为A1′、B1′点的向量,
Figure GDA0002952196880000034
为向量
Figure GDA0002952196880000035
的模,
Figure GDA0002952196880000036
为向量
Figure GDA0002952196880000037
的模;
S33:夹角θ1为旋转角偏差值,通过线段AB与线段A1′B1′所在直线的斜率判断换刀机器人末端执行器当前姿态相对于标定姿态的旋转方向,线段A1′B1′所在直线的斜率大于线段AB所在直线的斜率,则旋转方向为正,反之,旋转方向为负。
所述步骤四中计算当前位置与标定图像的标定位置的距离偏差值的方法为:
S41:上位机通过图像处理方法对步骤四中采集的姿态调整后的图像中的三个特征点进行识别,得到换刀机器人末端执行器在当前位置下三个特征点在视野范围内的像素坐标分别为A2'(x'2A,y'2A)和B2'(x'2B,y'2B)和C2'(x'2C,y'2C);
S42:根据拍照距离与成像大小成反比的原理,则在当前位置换刀机器人末端执行器距滚刀的刀箱正面的距离d1的计算为:
Figure GDA0002952196880000038
其中,d0为标定图像的标定位置与换刀机器人末端执行器距滚刀的刀箱正面的距离,A2'B2'表示当前采集图像中A2'、B2'两点的像素距离,AB表示标定图像中A、B两点的像素距离;
S43:当前位置与标定为的距离偏差值为:Δd=d1-d0
所述步骤五中计算当前位置在XY平面内与标定图像的标定位置的偏差值的方法为:
步骤S51:上位机通过图像处理方法对步骤五中采集的位置调整后的图像中的三个特征点进行识别,得到换刀机器人末端执行器在当前位置下三个特征点在视野范围内的像素坐标分别为A3'(x'3A,y'3A)和B3'(x'3B,y'3B)和C3'(x'3C,y'3C);
步骤S52:则换刀机器人末端执行器的当前位置在XY平面内与标定图像的标定位置在X方向的偏差值Δx,Δy分别为:
Figure GDA0002952196880000041
根据步骤S32的原理计算分别计算直线BC与直线B'C'之间的夹角θ2、直线AC与直线A'C'之间的夹角θ3,取夹角θ1、θ2和θ3的平均值作为旋转角偏差值;根据步骤S42的原理通过线段BC与线段B'2C'2及线段AC与A'2C'2线段的长度关系分别计算一个距离偏差值,取三次计算的平均值作为最终的距离偏差值;根据步骤S52中的原理通过B点和C点计算换刀机器人末端执行器在XY平面内的偏差值,取三次计算的平均值作为换刀机器人末端执行器在XY平面内与标定位置的偏差值。
本发明的有益效果:解决全断面隧道掘进机人工换刀难度大、风险高、效率低等突出问题,以全断面隧道掘进机实际工况为基础,通过架设于换刀机器人末端执行器上的工业相机及光源,采用图像识别处理的方法,获得换刀机器人末端执行器当前位姿与标定位姿的偏差并进行纠偏,从而实现换刀机器人末端执行器的精确定位,最终实现换刀机器人的精准换刀动作。本发明为全断面隧道掘进机换刀机器人自动换刀过程中机器人末端执行器的精确定位问题提供了可能,具有良好的可实现性和经济性,为全断面隧道掘进机换刀机器人的成功研制奠定了基础。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为全断面隧道掘进机换刀机器人拆装滚刀的示意图,其中,(a)为拆刀前刀箱与换刀机器人末端执行器的相对位置,(b)为拆刀后刀箱与换刀机器人末端执行器的相对位置。
图2为本发明的换刀机器人末端执行器和相机光源装置的结构示意图。
图3为本发明的反光件的结构示意图。
图4为本发明的相机光源装置的结构示意图。
图5为本发明的刀箱的正视图。
图6为本发明的视觉定位方法的流程图。
图7为本发明的旋转角和距离偏差计算的示意图。
图8为本发明的XY平面内位置偏差计算的示意图。
图中,1为换刀机器人末端执行器,1-1为固定爪,2为反光件,2-1为固定螺栓,2-2为反光片,3为刀箱,4为滚刀刀座,5为滚刀,6为相机光源装置,6-1为支架,6-2为工业相机,6-3为相机镜头,6-4为相机光源。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有付出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
实施例1,如图2所示,一种全断面隧道掘进机换刀机器人视觉定位结构,包括相机装置6,相机装置6固定在换刀机器人末端执行器1上。相机装置6固定在换刀机器人末端执行器1前部的固定爪1-1中部,换刀机器人末端执行器1在更换滚刀前拍摄刀箱3前端的图像,对刀箱3的进行图像处理,计算出换刀机器人末端执行器1当前位姿相对标准换刀位姿的偏差值,然后机器人控制***根据偏差值调节换刀机器人末端执行器1的位姿,实现控制换刀机器人末端执行器1自动精确移动到滚刀刀座4的正前方,实现对刀箱3内滚刀的更换。在拆装滚刀过程中换刀机器人末端执行器1与刀箱3的位置关系如图1所示,在自动更换滚刀过程中需要判定换刀机器人末端执行器1相对刀箱3的位姿偏差值,根据偏差值精确调整换刀机器人末端执行器1的位姿使其正对滚刀刀座4,然后机器人控制***控制换刀机器人末端执行器1抓取刀座4,将待更换的滚刀5取出。
还包括反光件2,反光件2固定在容纳滚刀5的刀箱3的正面上,反光件2与相机装置6相对应,相机装置6拍摄刀箱3正面的图像可以方便采集到反光件,后续图像处理中将反光件2作为特征点,方便对拍摄的图像进行识别。相机装置6与上位机相连接,相机装置6拍摄的图像的大小相等,相机装置6将拍摄的刀箱3的正面的图像传送至上位机,上位机进行图像识别处理,计算换刀机器人末端执行器1当前位姿相对标定位姿的偏差值,根据偏差值换刀机器人控制***调整换刀机器人末端执行器1的位姿使其移动到正对滚刀刀座4。
所述反光件2的数量设有至少两个、均固定在刀箱3正面上;如图3所示,所述反光件2为包括反光片2-2,反光片2-2通过固定螺钉2-1固定在刀箱3上,反光片2-2内嵌于固定螺栓2-1上,防止在实际恶劣工况下反光片2-2脱落,同时通过固定螺栓2-1固定于刀箱正面三个角的位置,作为视觉定位的特征识别点。
如图4所示,所述相机装置6包括工业相机6-2和相机镜头6-3,相机镜头6-3可拆卸连接在工业相机6-2上,工业相机6-2和相机镜头6-3通过自带螺纹相连,工业相机6-2通过支架6-1固定在换刀机器人末端执行器1的固定爪1-1的中部,支架6-1通过螺栓固定于换刀机器人末端执行器1的固定爪1-1上。
所述支架6-1上固定有相机光源6-4,相机光源6-4的数量设有两个、且分别设置在工业相机6-2的两侧,可有效消除光照不均匀给图像采集带来的影响,便于后期图像数据处理。工业相机6-2和相机光源6-4均通过螺钉固定于支架6-1上。上位机与机器人控制***相连接,机器人控制***检测到换刀机器人末端执行器1移动到预设的换刀位置附近时,将信号发送至上位机,上位机触发信号,开启工业相机6-2和相机光源6-4,进行图像采集。
实施例2,如图6所示,一种全断面隧道掘进机换刀机器人视觉定位方法,其步骤如下:
步骤一:确定标定图像:根据任一刀箱3的位置设定标定位置,机器人控制***控制换刀机器人末端执行器1移动到特定位置,手动调节机器人控制***内的参数使换刀机器人末端执行器1正对刀箱3,上位机开启工业相机6-2和相机光源6-4,对反光件2所在的刀箱3进行图像采集,并将采集的图像作为标定图像。
所述工业相机6-2在图像采集前,先由安装在掘进机上的巡检机器人利用高压水对待采集的刀箱进行冲洗,确保刀箱、刀座和刀具表面清洁,为下一步图像采集和数据处理做准备。换刀机器人末端执行器1按照机器人控制***设定的路径移动到换刀位置附近,机器人控制***调整换刀机器人末端执行器1的位置使工业相机6-2的轴线与刀盘3正面所在的平面垂直。换刀机器人末端执行器1到达预定位置后,触发工业相机6-2和光源6-4开启,开始进行图像采集。所述特定位置距离刀箱3正面的距离的范围为30-50cm,且位于刀箱3正面中心周围1m×1m范围内,方便后续图像处理。所述反光件2的数量设有3个,且三个反光件2分别固定在刀箱3的任意三个角上,如图5所示,刀箱3的上部两个角上均设有一个反光件,刀箱3下部的一个角上设有一个反光件,从而构成直角三角形。
换刀机器人末端执行器按照程序设定路径移动到指定的特定位置后,开始进行图像的采集和数据处理,图像识别采用OpenCV的Canny算法检测轮廓,寻找特征中心坐标。将3个反光件2的中心作为特征点,上位机通过图像处理方法识别三个特征点在采集图像视野范围内的像素坐标;且标定图像中三个特征点在视野范围内的像素坐标分别为A(xA,yA)、B(xB,yB)和C(xC,yC),点A、B和C分别是三个反光件作为三个特征识别点在标定图像中的像素坐标,拍摄标定图像的换刀机器人末端执行器1的位置为标定位置、姿态是标定姿态。图7中点A、B和C所在图像为标定图像,点A1'、B1'和C1'所在图像为换刀机器人末端执行器1的当前位置采集到的图像。
步骤二:换刀机器人末端执行器1按照机器人控制***设定的路径移动到待拆卸滚刀5所在刀箱3的正面,上位机开启工业相机6-2和相机光源6-4,对反光件2所在的刀箱3正面进行图像采集。
采集图像并进行数据处理,识别区分三个特征点,计算当前图像中任意两个特征点连线与标定图像中对应特征点连线之间的夹角,得到换刀机器人末端执行器1当前姿态与标定姿态的旋转角偏差,将旋转角偏差信号传输给机器人控制***,由机器人控制***将换刀机器人末端执行器1旋转至标定姿态。
步骤三:上位机对步骤二采集的图像进行识别,确定换刀机器人末端执行器1的当前姿态,计算当前姿态与标定图像的姿态的旋转角偏差值,上位机将旋转角偏差值传送至机器人控制***,对换刀机器人末端执行器1的姿态进行调整。
所述步骤三中计算当前姿态与标定图像的姿态的旋转角偏差值的方法为:
S31:上位机通过图像处理方法对步骤二中采集的图像中的三个特征点进行识别,得到换刀机器人末端执行器1当前姿态下三个特征点在视野范围内的像素坐标分别为A1'(x'1A,y'1A)和B1'(x'1B,y'1B)和C1'(x'1C,y'1C);
S32:计算
Figure GDA0002952196880000071
利用向量法求条直线的夹角;式中θ1为线段AB与线段A1′B1′所在直线的夹角,
Figure GDA0002952196880000072
为A、B点的向量,
Figure GDA0002952196880000073
为A1′、B1′点的向量,
Figure GDA0002952196880000074
为向量
Figure GDA0002952196880000075
的模,
Figure GDA0002952196880000076
为向量
Figure GDA0002952196880000077
的模;
S33:夹角θ1为旋转角偏差值,通过线段AB与线段A1′B1′所在直线的斜率判断换刀机器人末端执行器1当前姿态相对于标定姿态的旋转方向,线段A1′B1′所在直线的斜率大于选段AB所在直线的斜率,则旋转方向为正,反之,旋转方向为负。
根据步骤S32的原理计算分别计算直线BC与直线B'C'之间的夹角θ2、直线AC与直线A'C'之间的夹角θ3,取夹角θ1、θ2和θ3的平均值作为旋转角偏差值。
步骤四:工业相机6-2采集姿态调整后反光件2所在的刀箱3的图像,上位机对姿态调整后的图像进行识别确定换刀机器人末端执行器1的当前位置,计算当前位置与标定图像的标定位置的距离偏差值,上位机将距离偏差值传送至机器人控制***,利用距离偏差值对换刀机器人末端执行器1的位置进行调整。
采集图像并进行数据处理,识别区分三个特征点,计算当前图像任意两特征点之间距离与标定图像中对应特征点间距离的比值,根据图像采集距离与图像成像大小成反比的原理,计算换刀机器人末端执行器1当前位置与标定位置的偏移量,将偏移量信号传输给机器人控制***,由机器人控制***将末端执行器1移动到标定距离处。
所述步骤四中计算当前位置与标定图像的标定位置的距离偏差值的方法为:
S41:上位机通过图像处理方法对步骤四中采集的姿态调整后的图像中的三个特征点进行识别,得到换刀机器人末端执行器1在当前位置下三个特征点在视野范围内的像素坐标分别为A2'(x'2A,y'2A)和B2'(x'2B,y'2B)和C2'(x'2C,y'2C);
S42:根据拍照距离与成像大小成反比的原理,则在当前位置换刀机器人末端执行器1距滚刀的刀箱3正面的距离d1的计算为:
Figure GDA0002952196880000081
其中,d0为标定图像的标定位置与换刀机器人末端执行器1距滚刀的刀箱3正面的距离,A2'B2'表示当前采集图像中A2'、B2'两点的像素距离,AB表示标定图像中A、B两点的像素距离;
S43:当前位置与标定为的距离偏差值为:Δd=d1-d0
根据步骤S42的原理通过线段BC与线段B'2C'2及线段AC与A'2C'2线段的长度关系分别计算一个距离偏差值,取三次计算的平均值作为最终的距离偏差值。
步骤五:工业相机6-2采集位置调整后的反光件2所在的刀箱3的图像,上位机对位置调整后的图像进行识别,确定换刀机器人末端执行器1的当前位置,计算当前位置在XY平面内与标定图像的标定位置的偏差值,上位机将偏差值传送至机器人控制***,利用偏差值对换刀机器人末端执行器1的位置进行调整。
采集图像并进行数据处理,识别区分三个特征点,计算当前图像中任意特征点与标定图像中对应特征点之间距离在X轴、Y轴上的偏移量,将偏移量信号传输给机器人控制***,由机器人控制***将末端执行器1移动到标定位置。图8中ABC所在图像为标定图像,A3'B3'C3'所在图像是经过步骤三和四位姿调整后,换刀机器人末端执行器当前位置采集到的图像,A、B、C为三个特征识别点。
所述步骤五中计算当前位置在XY平面内与标定图像的标定位置的偏差值的方法为:
步骤S51:上位机通过图像处理方法对步骤五中采集的位置调整后的图像中的三个特征点进行识别,得到换刀机器人末端执行器1在当前位置下三个特征点在视野范围内的像素坐标分别为A3'(x'3A,y'3A)和B3'(x'3B,y'3B)和C3'(x'3C,y'3C);
步骤S52:则换刀机器人末端执行器1的当前位置在XY平面内与标定图像的标定位置在X方向的偏差值Δx,Δy分别为:
Figure GDA0002952196880000091
根据步骤S52中的原理通过B点和C点计算换刀机器人末端执行器1在XY平面内的偏差值,取三次计算的平均值作为换刀机器人末端执行器1在XY平面内与标定位置的偏差值。
步骤六:完成换刀机器人末端执行器1位姿的修正,进行下一步的换刀动作。
每次换刀前,重复步骤二至六,可实现换刀机器人末端执行器1的精确定位,顺利完成拆刀动作,换刀机器人末端执行器1按照机器人控制***预先设定的路径将拆下的旧滚刀存放于刀具存储箱中,从另一个存储箱中取出新滚刀,按照机器人控制***记录的上次拆刀路径将新滚刀准确安装在刀箱中,完成整个换刀流程,且上述图像采集处理过程均可通过计算机高级编程语言实现,易实现,易扩展。
本发明致力于解决全断面隧道掘进机人工换刀难度大、风险高、效率低等突出问题,以全断面隧道掘进机实际工况为基础,提供一种全断面隧道掘进机换刀机器人视觉定位结构及方法,全断面隧道掘进机换刀机器人技术中机器人末端执行器的精确定位是一大技术难题,本发明通过设计的视觉定位结构,并采用图像识别处理方法,可以实现对换刀机器人末端执行器位姿的精确纠偏,为全断面隧道掘进机换刀机器人自动换刀的末端执行器精确定位技术提供可能。
本发明的全断面隧道掘进机换刀机器人视觉定位结构,实现换刀机器人末端执行器的精确定位,为换刀机器人采用视觉定位提供了结构基础,本发明的全断面隧道掘进机换刀机器人视觉定位方法,可以实现换刀机器人末端执行器位姿的精确修正,最终实现换刀机器人的精准换刀动作,为下一步的换到动作的顺利完成提供保障。本发明具有良好的可实现性和经济性,为全断面隧道掘进机换刀机器人自动换刀技术提供了借鉴。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (12)

1.一种全断面隧道掘进机换刀机器人视觉定位方法,其特征在于,其步骤如下:
步骤一:确定标定图像:根据任一刀箱(3)的位置设定标定位置,机器人控制***控制换刀机器人末端执行器(1)移动到特定位置,手动调节机器人控制***内的参数使换刀机器人末端执行器(1)正对刀箱(3),上位机开启工业相机(6-2)和相机光源(6-4),对反光件(2)所在的刀箱(3)进行图像采集,并将采集的图像作为标定图像;
步骤二:换刀机器人末端执行器(1)按照机器人控制***设定的路径移动到待拆卸滚刀(5)所在刀箱(3)的正面,上位机开启工业相机(6-2)和相机光源(6-4),对反光件(2)所在的刀箱(3)正面进行图像采集;
步骤三:上位机对步骤二采集的图像进行识别,确定换刀机器人末端执行器(1)的当前姿态,计算当前姿态与标定图像的姿态的旋转角偏差值,上位机将旋转角偏差值传送至机器人控制***,对换刀机器人末端执行器(1)的姿态进行调整;
步骤四:工业相机(6-2)采集姿态调整后反光件(2)所在的刀箱(3)的图像,上位机对姿态调整后的图像进行识别确定换刀机器人末端执行器(1)的当前位置,计算当前位置与标定图像的标定位置的距离偏差值,上位机将距离偏差值传送至机器人控制***,利用距离偏差值对换刀机器人末端执行器(1)的位置进行调整;
步骤五:工业相机(6-2)采集位置调整后的反光件(2)所在的刀箱(3)的图像,上位机对位置调整后的图像进行识别,确定换刀机器人末端执行器(1)的当前位置,计算当前位置在XY平面内与标定图像的标定位置的偏差值,上位机将偏差值传送至机器人控制***,利用偏差值对换刀机器人末端执行器(1)的位置进行调整;
步骤六:完成换刀机器人末端执行器(1)位姿的修正,进行下一步的换刀动作。
2.根据权利要求1所述的一种全断面隧道掘进机换刀机器人视觉定位方法的定位结构,其特征在于,包括相机装置(6),相机装置(6)固定在换刀机器人末端执行器(1)上。
3.根据权利要求2所述的定位结构,其特征在于,还包括反光件(2),反光件(2)固定在容纳滚刀(5)的刀箱(3)上,相机装置(6)与上位机相连接。
4.根据权利要求3所述的定位结构,其特征在于,所述反光件(2)的数量设有至少两个、均固定在刀箱(3)正面上;所述反光件(2)为包括反光片(2-2),反光片(2-2)通过固定螺钉(2-1)固定在刀箱(3)上。
5.根据权利要求2或3所述的定位结构,其特征在于,所述相机装置(6)包括工业相机(6-2)和相机镜头(6-3),相机镜头(6-3)可拆卸连接在工业相机(6-2)上,工业相机(6-2)通过支架(6-1)固定在换刀机器人末端执行器(1)的固定爪(1-1)的中部。
6.根据权利要求5所述的定位结构,其特征在于,所述支架(6-1)上固定有相机光源(6-4),相机光源(6-4)的数量设有两个、且分别设置在工业相机(6-2)的两侧。
7.根据权利要求1所述的全断面隧道掘进机换刀机器人视觉定位方法,其特征在于,所述特定位置位于刀箱(3)的中心线上,且距离刀箱(3)正面的距离的范围为30cm-50cm;所述工业相机(6-2)在图像采集前,利用巡检机器人利用高压水对待采集图像的刀箱冲洗,机器人控制***调整换刀机器人末端执行器(1)的位置使工业相机(6-2)的轴线与刀盘(3)正面所在的平面垂直。
8.根据权利要求1或7所述的全断面隧道掘进机换刀机器人视觉定位方法,其特征在于,所述反光件(2)的数量设有3个,且三个反光件(2)分别固定在刀箱(3)的任意三个角上;将3个反光件(2)的中心作为特征点,上位机通过图像处理方法识别三个特征点在采集图像视野范围内的像素坐标;且标定图像中三个特征点在视野范围内的像素坐标分别为A(xA,yA)、B(xB,yB)和C(xC,yC)。
9.根据权利要求8所述的全断面隧道掘进机换刀机器人视觉定位方法,其特征在于,所述步骤三中计算当前姿态与标定图像的姿态的旋转角偏差值的方法为:
S31:上位机通过图像处理方法对步骤二中采集的图像中的三个特征点进行识别,得到换刀机器人末端执行器(1)当前姿态下三个特征点在视野范围内的像素坐标分别为A1'(x'1A,y'1A)和B1'(x'1B,y'1B)和C1'(x'1C,y'1C);
S32:计算
Figure FDA0002952196870000021
式中,θ1为线段AB与线段A′1B′1所在直线的夹角,
Figure FDA0002952196870000022
为A点、B点的向量,
Figure FDA0002952196870000023
为A′1点、B′1点的向量,
Figure FDA0002952196870000024
为向量
Figure FDA0002952196870000025
的模,
Figure FDA0002952196870000026
为向量
Figure FDA0002952196870000027
的模;
S33:夹角θ1为旋转角偏差值,通过线段AB与线段A′1B′1所在直线的斜率判断换刀机器人末端执行器(1)当前姿态相对于标定姿态的旋转方向,线段A′1B′1所在直线的斜率大于线段AB所在直线的斜率,则旋转方向为正,反之,旋转方向为负。
10.根据权利要求9所述的全断面隧道掘进机换刀机器人视觉定位方法,其特征在于,所述步骤四中计算当前位置与标定图像的标定位置的距离偏差值的方法为:
S41:上位机通过图像处理方法对步骤四中采集的姿态调整后的图像中的三个特征点进行识别,得到换刀机器人末端执行器(1)在当前位置下三个特征点在视野范围内的像素坐标分别为A2'(x'2A,y'2A)和B2'(x'2B,y'2B)和C2'(x'2C,y'2C);
S42:根据拍照距离与成像大小成反比的原理,则在当前位置换刀机器人末端执行器(1)距刀箱(3)正面的距离d1的计算为:
Figure FDA0002952196870000031
其中,d0为标定图像的标定位置与换刀机器人末端执行器(1)距刀箱(3)正面的距离,A2'B2'表示当前采集图像中A2'、B2'两点的像素距离,AB表示标定图像中A、B两点的像素距离;
S43:当前位置与标定为的距离偏差值为:Δd=d1-d0
11.根据权利要求10所述的全断面隧道掘进机换刀机器人视觉定位方法,其特征在于,所述步骤五中计算当前位置在XY平面内与标定图像的标定位置的偏差值的方法为:
步骤S51:上位机通过图像处理方法对步骤五中采集的位置调整后的图像中的三个特征点进行识别,得到换刀机器人末端执行器(1)在当前位置下三个特征点在视野范围内的像素坐标分别为A3'(x'3A,y'3A)和B3'(x'3B,y'3B)和C3'(x'3C,y'3C);
步骤S52:则换刀机器人末端执行器(1)的当前位置在XY平面内与标定图像的标定位置在X方向的偏差值Δx,Δy分别为:
Figure FDA0002952196870000032
12.根据权利要求11所述的全断面隧道掘进机换刀机器人视觉定位方法,其特征在于,根据步骤S32的原理计算分别计算直线BC与直线B'C'之间的夹角θ2、直线AC与直线A'C'之间的夹角θ3,取夹角θ1、θ2和θ3的平均值作为旋转角偏差值;根据步骤S42的原理通过线段BC与线段B'2C'2及线段AC与A'2C'2线段的长度关系分别计算一个距离偏差值,取三次计算的平均值作为最终的距离偏差值;根据步骤S52中的原理通过B点和C点计算换刀机器人末端执行器(1)在XY平面内的偏差值,取三次计算的平均值作为换刀机器人末端执行器(1)在XY平面内与标定位置的偏差值。
CN201910819248.3A 2019-08-31 2019-08-31 一种全断面隧道掘进机换刀机器人视觉定位结构及方法 Active CN110454182B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910819248.3A CN110454182B (zh) 2019-08-31 2019-08-31 一种全断面隧道掘进机换刀机器人视觉定位结构及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910819248.3A CN110454182B (zh) 2019-08-31 2019-08-31 一种全断面隧道掘进机换刀机器人视觉定位结构及方法

Publications (2)

Publication Number Publication Date
CN110454182A CN110454182A (zh) 2019-11-15
CN110454182B true CN110454182B (zh) 2021-07-02

Family

ID=68490198

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910819248.3A Active CN110454182B (zh) 2019-08-31 2019-08-31 一种全断面隧道掘进机换刀机器人视觉定位结构及方法

Country Status (1)

Country Link
CN (1) CN110454182B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111119919B (zh) * 2019-12-30 2021-06-18 中铁工程装备集团有限公司 一种柔臂掘进机推进***控制计算方法
CN111691891B (zh) * 2020-06-30 2022-04-29 中国铁建重工集团股份有限公司 一种用于更换盾构机滚刀的换刀装置
CN113090276B (zh) * 2021-04-21 2021-12-03 中交天和机械设备制造有限公司 盾构机常压换刀刀具检测方法及***
CN113984569A (zh) * 2021-10-26 2022-01-28 深圳市地铁集团有限公司 滚刀磨损图像识别测量方法、滚刀的检测***和盾构机
CN116475815B (zh) * 2023-05-17 2023-12-15 广州里工实业有限公司 一种数控机床的自动换刀方法、***、装置及存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104198490A (zh) * 2014-08-19 2014-12-10 中交隧道工程局有限公司 一种盾构机刀具刀盘的前部可视化检测装置及其方法
CN205206830U (zh) * 2015-12-11 2016-05-04 中船重工(青岛)轨道交通装备有限公司 全断面隧道掘进机辅助换刀机构
CN106761795A (zh) * 2017-03-08 2017-05-31 东北大学 一种盾构机盘形滚刀刀箱结构
CN109236310A (zh) * 2018-11-08 2019-01-18 大连理工大学 一种适用于tbm换刀机器人快速拆装的新型刀座
CN109989763A (zh) * 2019-04-28 2019-07-09 中铁工程装备集团有限公司 一种隧道掘进机用检测换刀机器人及其使用方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104198490A (zh) * 2014-08-19 2014-12-10 中交隧道工程局有限公司 一种盾构机刀具刀盘的前部可视化检测装置及其方法
CN205206830U (zh) * 2015-12-11 2016-05-04 中船重工(青岛)轨道交通装备有限公司 全断面隧道掘进机辅助换刀机构
CN106761795A (zh) * 2017-03-08 2017-05-31 东北大学 一种盾构机盘形滚刀刀箱结构
CN109236310A (zh) * 2018-11-08 2019-01-18 大连理工大学 一种适用于tbm换刀机器人快速拆装的新型刀座
CN109989763A (zh) * 2019-04-28 2019-07-09 中铁工程装备集团有限公司 一种隧道掘进机用检测换刀机器人及其使用方法

Also Published As

Publication number Publication date
CN110454182A (zh) 2019-11-15

Similar Documents

Publication Publication Date Title
CN110454182B (zh) 一种全断面隧道掘进机换刀机器人视觉定位结构及方法
CN106272426B (zh) 太阳能电池片串焊前视觉定位及角度检测设备及检测方法
CN110370286B (zh) 基于工业机器人和单目相机的定轴运动刚体空间位置识别方法
CN107192331A (zh) 一种基于双目视觉的工件抓取方法
CN101718536B (zh) 三角形金刚石刀具角度高精度自动测量***和测量方法
CN110259067B (zh) 机器人的瓷砖铺设位置识别方法和***
CN108177143A (zh) 一种基于激光视觉引导的机器人定位抓取方法及***
CN106705847A (zh) 一种自由曲面内缝隙几何尺寸测量方法及装置
CN109378207A (zh) 一种基于在线视觉检测的绕线机工艺控制方法
CN107414474A (zh) 一种狭窄空间螺栓定位安装机器人及控制方法
CN110385889A (zh) 一种动态贴装视觉检测与纠偏的装置及方法
CN207771466U (zh) 打磨工件打磨加工***
CN103398669A (zh) 一种用于测量自由曲面的多轴联动视觉检测方法和设备
CN115026683B (zh) 一种基于多机器人协同的航空叶片磨抛装置及控制方法
CN111036863A (zh) 采用机器视觉定位大包下水口的装置及其使用方法
CN113246787A (zh) 一种新能源汽车电池定位方法及装置
CN104007664B (zh) 一种核电站爬壁机器人三维视景仿真模拟运动方法
CN109732601B (zh) 一种自动标定机器人位姿与相机光轴垂直的方法和装置
CN108328347A (zh) 电缆盘自动卸垛设备
CN110763137A (zh) 产品姿态的确定方法及装置
CN105047239B (zh) 核燃料组件修复跟踪检测方法及装置
CN114354630A (zh) 一种图像获取***、方法及显示面板加工设备
CN208079277U (zh) 一种三维图像采集装置
CN109513632A (zh) 一种换向器检测装置
JP2011161615A (ja) ハンガーラインからのワーク回収装置及び方法

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