CN104759945B - 基于高精度工业相机的移动制孔机器人基准找正方法 - Google Patents
基于高精度工业相机的移动制孔机器人基准找正方法 Download PDFInfo
- Publication number
- CN104759945B CN104759945B CN201510133459.3A CN201510133459A CN104759945B CN 104759945 B CN104759945 B CN 104759945B CN 201510133459 A CN201510133459 A CN 201510133459A CN 104759945 B CN104759945 B CN 104759945B
- Authority
- CN
- China
- Prior art keywords
- robot
- axle
- laser
- coordinate system
- camera
- 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
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23Q—DETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
- B23Q17/00—Arrangements for observing, indicating or measuring on machine tools
- B23Q17/22—Arrangements for observing, indicating or measuring on machine tools for indicating or measuring existing or desired position of tool or work
- B23Q17/2233—Arrangements for observing, indicating or measuring on machine tools for indicating or measuring existing or desired position of tool or work for adjusting the tool relative to the workpiece
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23Q—DETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
- B23Q17/00—Arrangements for observing, indicating or measuring on machine tools
- B23Q17/24—Arrangements for observing, indicating or measuring on machine tools using optics or electromagnetic waves
- B23Q17/2409—Arrangements for indirect observation of the working space using image recording means, e.g. a camera
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Optics & Photonics (AREA)
- Manipulator (AREA)
- Machine Tool Sensing Apparatuses (AREA)
Abstract
本发明提出了一种基于高精度工业相机的移动制孔机器人基准找正方法,属于工业机器人标定技术领域。该方法利用高精度工业相机和Z向激光距离传感器确定基准孔的三维坐标值,以此来确定零组件和工业机器人的相对位置关系,多次循环调整工业机器人直到基准孔附近零组件平面和工业机器人末端刀具垂直角度符合要求,基准孔在相机坐标系中也同时达到预先设定的标准位置,再利用当前基准孔在机器人底座坐标系的坐标值,建立工件坐标系。本发明能够全自动进行基准检测,精度高,效率高,经济实用,操作工序简单易懂。
Description
技术领域
本发明涉及移动制孔机器人标定技术领域,是一种移动机器人基准找正方法,具体为一种基于高精度工业相机的移动制孔机器人基准找正方法。
背景技术
目前,移动机器人自动化制孔系统已经在飞机、汽车等制造领域被逐渐应用。移动机器人自动化制孔技术是基于产品数字化和自动化的一项技术,也是航空制造中最先进的加工技术之一。在移动机器人制孔流程中,制孔设备到达工位后,移动装置浮动锁紧,机器人根据编程工件坐标系中的路径到达制孔位置,由于移动装置定位或零组件安装存在误差,零组件与制孔机器人的相对位置将发生变化,最终导致移动机器人实际到达的位置的偏移。
现有某些设备利用激光跟踪仪,在加工之前将移动机器人和零组件的实际相对位置打出来,与理论位置比较进行修正,提高移动机器人的定位精度,由于这种方式,价格昂贵,设备复杂操作工序繁琐,同时和传统方式相比,效率没有明显提高,工人的劳动强度并不能降低。
发明内容
为解决现有技术存在的问题,本发明提出了一种基于高精度工业相机的移动制孔机器人基准找正方法。
本发明的技术方案为:
所述一种基于高精度工业相机的移动制孔机器人基准找正方法,其特征在于:包括以下步骤:
步骤1:在移动制孔机器人制孔刀具周围布置四个激光距离传感器A、B、C、D和一个相机,相机轴线和移动制孔机器人制孔刀具电主轴轴线平行,相机侧边还安装有一个Z向激光距离传感器;
步骤2:利用标定圆盘,通过以下步骤对四个激光距离传感器进行标定,所述标定圆盘由盘身和中心杆组成,中心杆与盘身保证垂直度为90±0.05°:
步骤2.1:将移动制孔机器人制孔刀具保持竖直状态,并将中心杆装夹在移动制孔机器人制孔刀具的刀柄上;
步骤2.2:调整四个激光距离传感器,是其将激光点均打在标定圆盘盘面上;
步骤2.3:移动制孔机器人制孔刀具电主轴沿轴向运动,带动标定圆盘轴向运动,观察四个激光距离传感器在盘面上的激光点运动轨迹;调整四个激光距离传感器,使四个激光距离传感器在盘面上的激光点运动轨迹相互平行,且任意三个激光距离传感器在盘面上的激光点运动轨迹不共线;
步骤2.4:分别测量计算四个激光距离传感器光轴与标定圆盘盘面的夹角
步骤3:轴向调整移动制孔机器人制孔刀具电主轴,使标定圆盘盘面与模拟工作面重合;所述模拟工作面指沿电主轴进给方向的,且与移动制孔机器人制孔刀具中处于缩回状态的压力鼻平面距离为l的平面;l为制孔时,待制孔零组件平面和处于缩回状态的压力鼻平面的距离;测量当前状态下四个激光距离传感器的距离读数sA,sB,sC,sD,以及Z向激光距离传感器测得的与标定圆盘盘面距离读数s0;
步骤4:在标定圆盘盘面上建立与移动制孔机器人制孔刀具固连的零面坐标系ObXbYbZb,并得到四个激光距离传感器在盘面上的激光点在零面坐标系ObXbYbZb中的坐标值(xA,yA),(xB,yB),(xC,yC),(xD,yD);零面坐标系原点选择为不包含Z向激光距离传感器的任意一个激光距离传感器在盘面上的激光点,并以该激光点的运动轨迹为ObYb轴;ObXb轴处于盘面上,且ObXb垂直于ObYb轴;ObYb轴正方向与工具坐标系OtXtYtZt的OtYt轴正方向夹角为锐角,ObXb轴正方向与工具坐标系OtXtYtZt的OtXt轴正方向夹角为锐角;ObZb轴正方向由ObYb轴正方向以及ObXb轴正方向按照右手定则确定;
所述工具坐标系OtXtYtZt与移动制孔机器人制孔刀具末端固连,本步骤中工具坐标系OtXtYtZt原点处于模拟工作面上,OtXt轴和OtYt轴在模拟工作面上,电主轴进给方向为OtZt轴正方向,移动制孔机器人法兰坐标系OFXFYFZF的OFXF轴正方向在模拟工作面上的投影为OtXt轴正方向,OFYF轴正方向在模拟工作面上的投影为OtYt轴正方向;
建立相机坐标系OvXvYvZv,相机坐标系OvXvYvZv与移动制孔机器人末端执行器固连,本步骤中相机坐标系OvXvYvZv原点处于模拟工作面上,电主轴进给方向为OvZv轴正方向,OvXvYv平面与模拟工作面重合;
移除标定圆盘;
步骤5:移动移动制孔机器人,并通过分析相机拍摄图像,使待制孔零组件上已经打好的基准孔中心与相机视野中心的偏差Δx、Δy满足设定范围要求,且Z向激光距离传感器测得的基准孔距离与标准距离的差值Δz也满足设定范围要求;所述标准距离为步骤3中得到的s0;
步骤6:保持移动制孔机器人末端姿态不变,沿模拟工作面移动移动制孔机器人,使工具坐标系OtXtYtZt的原点运动到步骤5完成后得到的相机坐标系的原点位置;并按照以下步骤进行法向调平:
步骤6.1:四个激光距离传感器将激光点A'、B'、C'、D'打在待制孔零组件表面,得到四个激光距离传感器的测量距离值sA’,sB’,sC’,sD’;根据sA’,sB’,sC’,sD’,步骤2.4得到的以及步骤3得到的sA,sB,sC,sD,计算得到激光点A'、B'、C'、D'在零面坐标系ObXbYbZb的坐标值;
步骤6.2:由激光点A'、B'、C'、D'在零面坐标系ObXbYbZb的坐标值计算得到四个平面A'B'C'、A'B'D'、A'C'D'、B'C'D'的法向量,取四个平面A'B'C'、A'B'D'、A'C'D'、B'C'D'法向量的平均值为待制孔零组件表面法向量n1;
步骤6.3:根据法向量n1在零面坐标系ObXbYbZb中的坐标,得到法向量n1与ObZb轴的夹角α1,若α1在±0.2°范围内,则法向调平结束,进入步骤7,否则根据法向量n1在零面坐标系ObXbYbZb中的坐标,得到将零面坐标系ObXbYbZb旋转至ObZb轴与法向量n1重合时,ObXb轴的旋转角度γ和ObYb轴的旋转角度β;按照角度γ和角度β移动移动制孔机器人,使工具坐标系的OtXt轴旋转角度γ,OtYt轴旋转角度β,并返回步骤6.1;
步骤7:保持移动制孔机器人末端姿态不变,沿模拟工作面移动移动制孔机器人,使相机坐标系OvXvYvZv的原点运动到步骤6法向调平完成后得到的工具坐标系的原点位置;通过分析相机拍摄图像,判断待制孔零组件上已经打好的基准孔中心与相机视野中心的偏差Δx、Δy是否满足设定范围要求,判断Z向激光距离传感器测得的基准孔距离与标准距离的差值Δz是否也满足设定范围要求;若均满足Δx、Δy、Δz均满足设定范围要求,则以此时相机坐标系原点在机器人底座坐标系中的坐标作为基准孔中心在机器人底座坐标系中的坐标,否则返回步骤5;
步骤8:重复步骤步骤5到步骤7,得到所有基准孔中心在机器人底座坐标系中的坐标,根据所有基准孔中心在机器人底座坐标系中的坐标,建立待制孔零组件的实际工件坐标系。
有益效果
本发明针对不同的零组件,根据离线生成确定的基准找正程序,可全自动进行基准找正,减少测量的工作量;而且综合考虑了零组件中孔分布类型,在保证精度的同时能适应更广泛的应用场合;本方法是基于高精度工业相机,在保证精度的同时,比目前存在的利用激光跟踪仪的方法,操作工序简单,经济实用。
附图说明
附图1是移动机器人和零组件的理论和实际位置关系示意图。
附图2是机器人末端工具坐标系和相机坐标系的关系示意图。
附图3是基准找正三点法零部件孔分布特征。
附图4是基准找正两点法零部件孔分布特征。
其中:1.机器人理论位置底座坐标系;2.机器人实际位置底座坐标系;3.实际零组件工件坐标系;4.基准孔;5.待制孔;6.待制孔零组件;7.机器人末端工具坐标系;8.气缸;9.压力鼻;10.模拟工作面;11.相机坐标系;12.Z向激光距离传感器激光束;13.Z向激光距离传感器;14.相机同轴光源;15.高精度工业相机。
具体实施方式
下面结合具体实施例描述本发明:
参照附图1,本实施例中主要介绍在移动机器人自动制孔系统中的基于工业相机的基准找正方法。影响移动机器人制孔系统定位精度的主要影响因素为移动装置定位偏差及零组件安装误差,导致移动机器人和零组件的相对位置与离线编程数模中的理论位置不同。
移动机器人到位,机器人实际位置2和机器人理论位置1不重合,导致在离线编程中通过待制孔零组件上基准孔P1、P2或P1、P2、P3建立的工件坐标系和实际工件坐标系有偏差,因此需要通过基准找正来确定实际零组件中工件坐标系3的具体位置。
本实施例利用高精度工业相机和Z向激光距离传感器确定基准孔的三维坐标值,以此来确定待制孔零组件和移动制孔机器人的相对位置关系,多次循环调整移动制孔机器人直到基准孔附近待制孔零组件平面和移动制孔机器人末端刀具垂直角度符合要求,基准孔在相机坐标系中也同时达到预先设定的标准位置,再利用基准孔在机器人底座坐标系的坐标值,建立工件坐标系。
本实施例方法的具体步骤为:
步骤1:在移动制孔机器人制孔刀具周围布置四个激光距离传感器A、B、C、D和一个相机,相机轴线和移动制孔机器人制孔刀具电主轴轴线平行,相机侧边还安装有一个Z向激光距离传感器。
步骤2:四个激光距离传感器用来检测刀具和待制孔零组件的法向角度,所以需要对四个激光距离传感器进行标定。本发明利用标定圆盘,通过以下步骤对四个激光距离传感器进行标定,所述标定圆盘由盘身和中心杆组成,中心杆与盘身保证垂直度为90±0.05°:
步骤2.1:将移动制孔机器人制孔刀具保持竖直状态,避免重力因素影响标定结果,将中心杆装夹在移动制孔机器人制孔刀具的刀柄上;
步骤2.2:调整四个激光距离传感器,是其将激光点均打在标定圆盘盘面上;
步骤2.3:移动制孔机器人制孔刀具电主轴沿轴向运动,带动标定圆盘轴向运动,使四个激光距离传感器和标定圆盘相对运动,观察四个激光距离传感器在盘面上的激光点运动轨迹;调整四个激光距离传感器,使四个激光距离传感器在盘面上的激光点运动轨迹相互平行,且任意三个激光距离传感器在盘面上的激光点运动轨迹不共线;
步骤2.4:分别测量计算四个激光距离传感器光轴与标定圆盘盘面的夹角 测量计算激光距离传感器光轴与标定圆盘盘面的夹角可以通过以下过程进行:以5mm为运动单位移动电主轴,记录激光距离传感器的距离读数差,记录多组数据取距离差平均值,而后通过三角关系得到激光距离传感器光轴与标定圆盘盘面的夹角。
步骤3:轴向调整移动制孔机器人制孔刀具电主轴,使标定圆盘盘面与模拟工作面重合;所述模拟工作面指沿电主轴进给方向的,且与移动制孔机器人制孔刀具中处于缩回状态的压力鼻平面距离为l的平面;l为制孔时,待制孔零组件平面和处于缩回状态的压力鼻平面的距离;由于制孔时,压力鼻受气缸推动压紧零组件表面进行制孔,所以这里模拟工作面是模拟待制孔零组件平面。测量当前状态下四个激光距离传感器的距离读数sA,sB,sC,sD,以及Z向激光距离传感器测得的与标定圆盘盘面距离读数s0。
步骤4:在标定圆盘盘面上建立与移动制孔机器人制孔刀具固连的零面坐标系ObXbYbZb,并得到四个激光距离传感器在盘面上的激光点在零面坐标系ObXbYbZb中的坐标值(xA,yA),(xB,yB),(xC,yC),(xD,yD);零面坐标系原点选择为不包含Z向激光距离传感器的任意一个激光距离传感器在盘面上的激光点,并以该激光点的运动轨迹为ObYb轴;ObXb轴处于盘面上,且ObXb垂直于ObYb轴;ObYb轴正方向与工具坐标系OtXtYtZt的OtYt轴正方向夹角为锐角,ObXb轴正方向与工具坐标系OtXtYtZt的OtXt轴正方向夹角为锐角;ObZb轴正方向由ObYb轴正方向以及ObXb轴正方向按照右手定则确定。
所述工具坐标系OtXtYtZt与移动制孔机器人制孔刀具末端固连,本步骤中工具坐标系OtXtYtZt原点处于模拟工作面上,OtXt轴和OtYt轴在模拟工作面上,电主轴进给方向为OtZt轴正方向,移动制孔机器人法兰坐标系OFXFYFZF的OFXF轴正方向在模拟工作面上的投影为OtXt轴正方向,OFYF轴正方向在模拟工作面上的投影为OtYt轴正方向。
建立相机坐标系OvXvYvZv,相机坐标系OvXvYvZv与移动制孔机器人末端执行器固连,本步骤中相机坐标系OvXvYvZv原点处于模拟工作面上,电主轴进给方向为OvZv轴正方向,OvXvYv平面与模拟工作面重合;由于相机只能拍到二维坐标值,所以增加了Z向激光距离传感器,来获取相机拍基准孔时,机器人末端距待制孔零组件的Z向实际距离值,由于本实施例中相机轴线与Z向激光距离传感器轴线相距较远,所以Z向激光距离传感器激光束同相机轴线有夹角θz,以确保相机在拍基准孔时,Z向激光距离传感器的激光束能照射到基准孔边缘,确保Z值准确。
移除标定圆盘。
步骤5:移动移动制孔机器人,并通过分析相机拍摄图像,使待制孔零组件上已经打好的基准孔中心与相机视野中心的偏差Δx、Δy满足设定范围要求,且Z向激光距离传感器测得的基准孔距离与标准距离的差值Δz也满足设定范围要求;所述标准距离为步骤3中得到的s0。
步骤6:保持移动制孔机器人末端姿态不变,沿模拟工作面移动移动制孔机器人,使工具坐标系OtXtYtZt的原点运动到步骤5完成后得到的相机坐标系的原点位置;并按照以下步骤进行法向调平:
步骤6.1:四个激光距离传感器将激光点A'、B'、C'、D'打在待制孔零组件表面,得到四个激光距离传感器的测量距离值sA’,sB’,sC’,sD’;根据sA’,sB’,sC’,sD’,步骤2.4得到的以及步骤3得到的sA,sB,sC,sD,计算得到激光点A'、B'、C'、D'在零面坐标系ObXbYbZb的坐标值。
步骤6.2:由于四个激光点不共线,所以四个激光点可以构成四个平面A'B'C'、A'B'D'、A'C'D'、B'C'D',在每个平面中,用三点构成的两条线叉乘,得到平面的法向量:激光点A'、B'、C'、D'在零面坐标系ObXbYbZb的坐标值计算得到四个平面A'B'C'、A'B'D'、A'C'D'、B'C'D'的法向量,取四个平面A'B'C'、A'B'D'、A'C'D'、B'C'D'法向量的平均值为待制孔零组件表面法向量n1。
步骤6.3:根据法向量n1在零面坐标系ObXbYbZb中的坐标,得到法向量n1与ObZb轴的夹角α1,若α1在±0.2°范围内,则法向调平结束,进入步骤7,否则根据法向量n1在零面坐标系ObXbYbZb中的坐标,得到将零面坐标系ObXbYbZb旋转至ObZb轴与法向量n1重合时,ObXb轴的旋转角度γ和ObYb轴的旋转角度β;将旋转角度γ、β通过工控机实时通讯传给机器人,按照角度γ和角度β移动移动制孔机器人,使工具坐标系的OtXt轴旋转角度γ,OtYt轴旋转角度β,并返回步骤6.1;
实际上返回步骤6.1后,在工控机中重新读取法向激光距离传感器的读数,重新计算法向量n1与ObZb轴的夹角α1,如果夹角α1在±0.2°范围内,则法向调平完成,否则,再次重复以上过程,直到夹角α1符合要求。
由于标定的零面坐标系和工具坐标系的坐标轴不完全平行,存在微小夹角θ,即工具坐标系的OtZt轴按顺时针方向旋转θ,就与零面坐标系的ObZb平行,所以通过零面坐标系检测出来的偏角γ、β,不受夹角θ的影响,将偏角γ、β传给机器人,分别使工具坐标系的OtXt轴旋转角度γ,OtYt轴旋转角度β,就能使工具坐标系的OtZt轴与待制孔零组件表面的法向量平行。同时,最终检测结果是通过检测法向量n1与零面坐标系的ObZb轴的夹角α1进行的,而零面坐标系的ObZb轴和工具坐标系的OtZt偏转角度在±0.05°内,所以,最终刀具轴线和待制孔零组件表面的垂直结果可以保证。在法向调平时,旋转工具坐标系的OtXt轴和OtYt轴,保证了工具坐标系的原点不变,由于工具坐标系的原点在待制孔零组件表面上,而原点是待制孔的位置,使得待制孔的空间位置坐标不会受到法向调平的影响。
步骤7:保持移动制孔机器人末端姿态不变,沿模拟工作面移动移动制孔机器人,使相机坐标系OvXvYvZv的原点运动到步骤6法向调平完成后得到的工具坐标系的原点位置;通过分析相机拍摄图像,判断待制孔零组件上已经打好的基准孔中心与相机视野中心的偏差Δx、Δy是否满足设定范围要求,判断Z向激光距离传感器测得的基准孔距离与标准距离的差值Δz是否也满足设定范围要求;若均满足Δx、Δy、Δz均满足设定范围要求,则以此时相机坐标系原点在机器人底座坐标系中的坐标作为基准孔中心在机器人底座坐标系中的坐标,否则返回步骤5。
步骤8:重复步骤步骤5到步骤7,得到所有基准孔中心在机器人底座坐标系中的坐标,根据所有基准孔中心在机器人底座坐标系中的坐标,建立待制孔零组件的实际工件坐标系。
参照附图3和附图4,在离线编程的加工程序中,零组件的工件坐标系用零组件上基准孔建立。当零组件上的孔无规律的分布时,适合三点法的基准找正。如图3,利用零组件上的三点P1、P2、P3在机器人底座坐标系下的坐标值,建立工件坐标系Base,点P1为原点,点P2为x轴正方向点,点P3为xoy平面的平面点,由右手定则确定工件坐标系的z正方向。参照附图4,当零组件上的孔成一竖排分布时,适合两点法的基准找正。利用零组件上的两点P1、P2在机器人底座坐标系下的坐标值,建立工件坐标系,点P1为原点,点P2为x轴正方向点,同时,利用机器人末端工具坐标系在点P1和点P2时的z负方向平均值作为矢量,与x轴正方向来确定工件坐标系的xoz平面,由右手定则得到工件坐标系Base的y正方向。
在实际工作中,一个工作段应该包括很多零组件,依照离线编程的基准找正程序,依次找到每个零组件实际的工件坐标系;再依照基准找正的顺序,更新每个零组件的工件坐标系,进行制孔加工。
Claims (1)
1.一种基于高精度工业相机的移动制孔机器人基准找正方法,其特征在于:包括以下步骤:
步骤1:在移动制孔机器人制孔刀具周围布置四个激光距离传感器A、B、C、D和一个相机,相机轴线和移动制孔机器人制孔刀具电主轴轴线平行,相机侧边还安装有一个Z向激光距离传感器;
步骤2:利用标定圆盘,通过以下步骤对四个激光距离传感器进行标定,所述标定圆盘由盘身和中心杆组成,中心杆与盘身保证垂直度为90±0.05°:
步骤2.1:将移动制孔机器人制孔刀具保持竖直状态,并将中心杆装夹在移动制孔机器人制孔刀具的刀柄上;
步骤2.2:调整四个激光距离传感器,使其将激光点均打在标定圆盘盘面上;
步骤2.3:移动制孔机器人制孔刀具电主轴沿轴向运动,带动标定圆盘轴向运动,观察四个激光距离传感器在盘面上的激光点运动轨迹;调整四个激光距离传感器,使四个激光距离传感器在盘面上的激光点运动轨迹相互平行,且任意三个激光距离传感器在盘面上的激光点运动轨迹不共线;
步骤2.4:分别测量计算四个激光距离传感器光轴与标定圆盘盘面的夹角
步骤3:轴向调整移动制孔机器人制孔刀具电主轴,使标定圆盘盘面与模拟工作面重合;所述模拟工作面指沿电主轴进给方向的,且与移动制孔机器人制孔刀具中处于缩回状态的压力鼻平面距离为l的平面;l为制孔时,待制孔零组件平面和处于缩回状态的压力鼻平面的距离;测量当前状态下四个激光距离传感器的距离读数sA,sB,sC,sD,以及Z向激光距离传感器测得的与标定圆盘盘面距离读数s0;
步骤4:在标定圆盘盘面上建立与移动制孔机器人制孔刀具固连的零面坐标系ObXbYbZb,并得到四个激光距离传感器在盘面上的激光点在零面坐标系ObXbYbZb中的坐标值(xA,yA),(xB,yB),(xC,yC),(xD,yD);零面坐标系原点选择为不包含Z向激光距离传感器的任意一个激光距离传感器在盘面上的激光点,并以该激光点的运动轨迹为ObYb轴;ObXb轴处于盘面上,且ObXb垂直于ObYb轴;ObYb轴正方向与工具坐标系OtXtYtZt的OtYt轴正方向夹角为锐角,ObXb轴正方向与工具坐标系OtXtYtZt的OtXt轴正方向夹角为锐角;ObZb轴正方向由ObYb轴正方向以及ObXb轴正方向按照右手定则确定;
所述工具坐标系OtXtYtZt与移动制孔机器人制孔刀具末端固连,本步骤中工具坐标系OtXtYtZt原点处于模拟工作面上,OtXt轴和OtYt轴在模拟工作面上,电主轴进给方向为OtZt轴正方向,移动制孔机器人法兰坐标系OFXFYFZF的OFXF轴正方向在模拟工作面上的投影为OtXt轴正方向,OFYF轴正方向在模拟工作面上的投影为OtYt轴正方向;
建立相机坐标系OvXvYvZv,相机坐标系OvXvYvZv与移动制孔机器人末端执行器固连,本步骤中相机坐标系OvXvYvZv原点处于模拟工作面上,电主轴进给方向为OvZv轴正方向,OvXvYv平面与模拟工作面重合;
移除标定圆盘;
步骤5:移动移动制孔机器人,并通过分析相机拍摄图像,使待制孔零组件上已经打好的基准孔中心与相机视野中心的偏差Δx、Δy满足设定范围要求,且Z向激光距离传感器测得的基准孔距离与标准距离的差值Δz也满足设定范围要求;所述标准距离为步骤3中得到的s0;
步骤6:保持移动制孔机器人末端姿态不变,沿模拟工作面移动移动制孔机器人,使工具坐标系OtXtYtZt的原点运动到步骤5完成后得到的相机坐标系的原点位置;并按照以下步骤进行法向调平:
步骤6.1:四个激光距离传感器将激光点A'、B'、C'、D'打在待制孔零组件表面,得到四个激光距离传感器的测量距离值sA’,sB’,sC’,sD’;根据sA’,sB’,sC’,sD’,步骤2.4得到的以及步骤3得到的sA,sB,sC,sD,计算得到激光点A'、B'、C'、D'在零面坐标系ObXbYbZb的坐标值;
步骤6.2:由激光点A'、B'、C'、D'在零面坐标系ObXbYbZb的坐标值计算得到四个平面A'B'C'、A'B'D'、A'C'D'、B'C'D'的法向量,取四个平面A'B'C'、A'B'D'、A'C'D'、B'C'D'法向量的平均值为待制孔零组件表面法向量n1;
步骤6.3:根据法向量n1在零面坐标系ObXbYbZb中的坐标,得到法向量n1与ObZb轴的夹角α1,若α1在±0.2°范围内,则法向调平结束,进入步骤7,否则根据法向量n1在零面坐标系ObXbYbZb中的坐标,得到将零面坐标系ObXbYbZb旋转至ObZb轴与法向量n1重合时,ObXb轴的旋转角度γ和ObYb轴的旋转角度β;按照角度γ和角度β移动移动制孔机器人,使工具坐标系的OtXt轴旋转角度γ,OtYt轴旋转角度β,并返回步骤6.1;
步骤7:保持移动制孔机器人末端姿态不变,沿模拟工作面移动移动制孔机器人,使相机坐标系OvXvYvZv的原点运动到步骤6法向调平完成后得到的工具坐标系的原点位置;通过分析相机拍摄图像,判断待制孔零组件上已经打好的基准孔中心与相机视野中心的偏差Δx、Δy是否满足设定范围要求,判断Z向激光距离传感器测得的基准孔距离与标准距离的差值Δz是否也满足设定范围要求;若Δx、Δy、Δz均满足设定范围要求,则以此时相机坐标系原点在机器人底座坐标系中的坐标作为基准孔中心在机器人底座坐标系中的坐标,否则返回步骤5;
步骤8:重复步骤5到步骤7,得到所有基准孔中心在机器人底座坐标系中的坐标,根据所有基准孔中心在机器人底座坐标系中的坐标,建立待制孔零组件的实际工件坐标系。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510133459.3A CN104759945B (zh) | 2015-03-25 | 2015-03-25 | 基于高精度工业相机的移动制孔机器人基准找正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510133459.3A CN104759945B (zh) | 2015-03-25 | 2015-03-25 | 基于高精度工业相机的移动制孔机器人基准找正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104759945A CN104759945A (zh) | 2015-07-08 |
CN104759945B true CN104759945B (zh) | 2017-04-19 |
Family
ID=53642212
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510133459.3A Active CN104759945B (zh) | 2015-03-25 | 2015-03-25 | 基于高精度工业相机的移动制孔机器人基准找正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104759945B (zh) |
Families Citing this family (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106584509B (zh) * | 2015-10-20 | 2019-01-25 | 沈阳新松机器人自动化股份有限公司 | 并联机器人的原点标定方法 |
CN105222712A (zh) * | 2015-11-02 | 2016-01-06 | 西北工业大学 | 一种改进的大曲率半径曲面零件法向测量与调整方法 |
CN106862860B (zh) * | 2015-12-10 | 2019-02-19 | 贵州红林机械有限公司 | 一种燃滑油泵调节器重配盖子壳体的方法 |
CN105397568A (zh) * | 2015-12-24 | 2016-03-16 | 湖州以创精工机械有限公司 | 一种车床车刀中心高误差的测算方法 |
CN105716525B (zh) * | 2016-03-30 | 2018-03-30 | 西北工业大学 | 基于激光跟踪仪的机器人末端执行器坐标系标定方法 |
CN105798909B (zh) * | 2016-04-29 | 2018-08-03 | 上海交通大学 | 基于激光与视觉的机器人零位标定系统与方法 |
CN106078359B (zh) * | 2016-06-02 | 2018-06-15 | 清华大学 | 一种龙门式多主轴制孔组合机床的零点定义与标定方法 |
CN107063216B (zh) * | 2017-06-05 | 2019-07-19 | 西北工业大学 | 一种基于激光测量的孔挤压芯棒垂直度校准方法与装置 |
CN109420923A (zh) * | 2017-08-24 | 2019-03-05 | 中航贵州飞机有限责任公司 | 一种飞机起落架轴承孔精加工方法 |
GB2580282B (en) * | 2017-09-05 | 2022-06-01 | Univ Northwestern Polytechnical | Method and system for automatic assembly of curved surface part |
CN107570983B (zh) * | 2017-09-05 | 2019-06-14 | 西北工业大学 | 一种曲面零件自动装配的方法及系统 |
CN108917604B (zh) * | 2018-07-12 | 2020-07-17 | 上海航天设备制造总厂有限公司 | 一种法向测量装置及其标定方法 |
CN109099859B (zh) * | 2018-09-26 | 2021-07-27 | 中国科学院上海光学精密机械研究所 | 大口径光学元件表面缺陷三维形貌测量装置和方法 |
CN109541626B (zh) * | 2018-12-12 | 2020-12-11 | 华南农业大学 | 目标平面法向量检测装置及检测方法 |
CN109702135A (zh) * | 2018-12-29 | 2019-05-03 | 上海发那科机器人有限公司 | 一种自动定位特征区域的装置及其调整垂直的方法 |
CN109794938B (zh) * | 2019-02-01 | 2021-08-06 | 南京航空航天大学 | 一种适用于曲面结构的机器人制孔误差补偿装置及其方法 |
CN110428469B (zh) * | 2019-06-14 | 2020-05-01 | 清华大学 | 一种任意曲面壁面法向定位方法 |
JP2020203348A (ja) * | 2019-06-18 | 2020-12-24 | 株式会社ダイヘン | ロボット制御装置、及びロボット制御システム |
CN110539309A (zh) * | 2019-07-23 | 2019-12-06 | 上海卫星装备研究所 | 基于激光找正和视觉测量的机械臂制孔定位系统及方法 |
CN110587615B (zh) * | 2019-08-02 | 2021-03-05 | 中国航空工业集团公司北京长城航空测控技术研究所 | 一种基于多传感器测量的产品特征精确识别方法 |
CN111152216B (zh) * | 2019-12-30 | 2022-04-26 | 福州国化智能技术有限公司 | 一种自动矫正工业机器人的工具中心点的方法 |
CN111408855B (zh) * | 2020-04-10 | 2022-01-11 | 一汽解放汽车有限公司 | 一种周向微孔激光加工自动找正装置及方法 |
CN111889730B (zh) * | 2020-06-15 | 2022-07-15 | 成都飞机工业(集团)有限责任公司 | 面向弱刚性飞机部件装配的机器人制孔基准设置方法 |
CN113369990B (zh) * | 2021-07-06 | 2022-05-10 | 成都飞机工业(集团)有限责任公司 | 一种用于非接触式测量孔的在线检测装置及其使用方法 |
CN113579854B (zh) * | 2021-07-21 | 2022-07-29 | 安庆中船动力配套有限公司 | 基于柴油机连杆加工机床的自动矫正系统 |
CN113625659B (zh) * | 2021-08-17 | 2023-02-24 | 杭州飞钛航空智能装备有限公司 | 制孔机构的控制方法、装置、电子设备和制孔机构 |
CN114346759B (zh) * | 2022-03-10 | 2022-07-15 | 成都飞机工业(集团)有限责任公司 | 一种用于孔在线检测与孔精加工的装置及其加工方法 |
CN114952830B (zh) * | 2022-05-13 | 2023-05-16 | 哈尔滨工业大学 | 基于接触约束的机器人高精度轴孔装配轴零件定位方法 |
CN114918455A (zh) * | 2022-06-21 | 2022-08-19 | 国营芜湖机械厂 | 一种航空大部件表面的自动化制孔设备及制孔方法 |
CN116796576B (zh) * | 2023-08-24 | 2023-12-08 | 成都飞机工业(集团)有限责任公司 | 一种群孔加工工艺规划方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6374158B1 (en) * | 2000-02-15 | 2002-04-16 | General Electric Company | Robotic laser pointer |
CN101968341A (zh) * | 2010-08-31 | 2011-02-09 | 南京理工大学 | 一种工业机器人零位自标定方法及装置 |
CN102087096B (zh) * | 2010-11-12 | 2012-07-25 | 浙江大学 | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 |
CN102416581A (zh) * | 2011-08-30 | 2012-04-18 | 北京航空航天大学 | 飞机部件柔性装配中待装配零件的混合测量定位方法 |
CN102601684B (zh) * | 2012-04-06 | 2013-11-20 | 南京航空航天大学 | 基于间接测量法的高精度制孔机器人的工具参数标定方法 |
CN103991006B (zh) * | 2014-04-01 | 2016-05-11 | 浙江大学 | 用于机器人制孔平台视觉测量系统的标定方法及装置 |
-
2015
- 2015-03-25 CN CN201510133459.3A patent/CN104759945B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN104759945A (zh) | 2015-07-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104759945B (zh) | 基于高精度工业相机的移动制孔机器人基准找正方法 | |
US5390128A (en) | Robotic processing and inspection system | |
US9895810B2 (en) | Cooperation system having machine tool and robot | |
US11642747B2 (en) | Aligning parts using multi-part scanning and feature based coordinate systems | |
US10900777B2 (en) | Method and device for determining the geometry of structures by means of computer tomography | |
Zhu et al. | Measurement error analysis and accuracy enhancement of 2D vision system for robotic drilling | |
CN104816307B (zh) | 工业机器人精准制孔的四点法向调平方法 | |
EP3367056B1 (en) | Error identification method for machine tool | |
CN108917604B (zh) | 一种法向测量装置及其标定方法 | |
CN103777570B (zh) | 基于nurbs曲面的加工误差快速检测补偿方法 | |
US20110295408A1 (en) | Process for positioning a workpiece | |
TW201509571A (zh) | 機床的刀具偏移值的自動設定裝置及自動設定方法 | |
CN103995496A (zh) | 一种基于数字化测量的飞机部件高精度匹配零件加工方法 | |
Srinivasan et al. | Automatic part localization in a CNC machine coordinate system by means of 3D scans | |
US9302345B2 (en) | Laser machining calibration method | |
CN106735963B (zh) | 一种加工光束空间传输指向精度检测装置 | |
CN106705880B (zh) | 一种大口径反射镜面形轮廓在位检测方法及装置 | |
CN108614519B (zh) | 一种基于激光点阵数控机床在线误差测量系统与方法 | |
CN106403873A (zh) | 一种基于曲面基准建立工件测量坐标系的方法 | |
CN112197725B (zh) | 一种大型复合材料零件加工工装的精准定位方法 | |
CN106141809A (zh) | 工装精确定位的方法 | |
CN109719714A (zh) | 机器人、机器人系统以及机器人的坐标系设定方法 | |
Cakir et al. | High precise and zero-cost solution for fully automatic industrial robot TCP calibration | |
CN107900781A (zh) | 用于车床的接触式在线检测系统的标定装置和标定方法 | |
JP2017037460A (ja) | 加工システム及び加工方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |