CN105157567B - 一种测量机器人的工具坐标系标定方法及*** - Google Patents
一种测量机器人的工具坐标系标定方法及*** Download PDFInfo
- Publication number
- CN105157567B CN105157567B CN201510250609.9A CN201510250609A CN105157567B CN 105157567 B CN105157567 B CN 105157567B CN 201510250609 A CN201510250609 A CN 201510250609A CN 105157567 B CN105157567 B CN 105157567B
- Authority
- CN
- China
- Prior art keywords
- mrow
- mtd
- msub
- mtr
- robot
- 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
Landscapes
- Manipulator (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Battery Electrode And Active Subsutance (AREA)
Abstract
本发明提出了一种测量机器人的工具坐标系标定方法及***,采用点约束方法标定出测量机器人的点激光传感器的工具坐标系,包括如下步骤:设置点激光传感器的工具坐标系的多个姿态标定点,以及设置点激光传感器的工具坐标系的多个位置标定点。本发明通过设置点激光传感器的工具坐标系的姿态标定点和位置标定点,为有效控制标定精度提供了依据,提高了标定的精度,并且适用于点激光这种非接触式工具坐标系的标定。
Description
技术领域
本发明涉及机器人技术领域,特别涉及一种测量机器人的工具坐标系标定方法及***。
背景技术
测量机器人工具坐标系标定是指对机器人末端的点激光传感器坐标系与机器人末端法兰盘坐标系之间的转换矩阵进行标定,这是实现整体叶盘在线测量的前提。目前工具坐标系标定一般采用一个机械约束点来实现,需要人工示教机器人,使待标定的工具点以不同的姿态接近约束点。
但是,这种方法存在以下问题:一方面标定精度受人工示教精度的影响,标定精度不高;另一方面采用机械约束点的方法不适用于点激光这种非接触式工具坐标系的标定。
发明内容
本发明的目的旨在至少解决所述技术缺陷之一。
为此,本发明的目的在于提出一种测量机器人的工具坐标系标定方法及***,可以适用于点激光这种非接触式工具坐标系的标定,并且提高了标定的精度。
为了实现上述目的,本发明一方面的实施例提供一种测量机器人的工具坐标系标定方法,采用点约束方法标定出测量机器人的点激光传感器的工具坐标系,包括如下步骤:
步骤S1:设置点激光传感器的工具坐标系的多个姿态标定点,包括如下步骤:
步骤S11,将平面靶标放置于所述机器人的工作空间内,其中,所述机器人法兰盘坐标系的第一位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标为(U0,V0);
步骤S12,控制所述机器人沿着基坐标系的Z轴移动第一距离ΔZ,其中,所述机器人法兰盘坐标系的第二位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0+ΔZ),激光点在图像坐标系下的坐标将变为(U1,V1);
步骤S13,控制所述机器人沿着基坐标系的X、Y轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点在图像坐标系恢复至步骤S11中的(U0,V0),其中,所述机器人法兰盘坐标系的第三位姿为(Rx0,Ry0,Rz0,X1,Y1,Z0+ΔZ);
步骤S14,重复步骤S12和S13,获得n个机器人的位姿点Tri,将其设置为多个姿态标定点,1≤i≤n;
步骤S2:设置点激光传感器的工具坐标系的多个位置标定点,包括如下步骤:
步骤S21,将所述平面靶标放置于所述机器人的工作空间内,其中,所述机器人法兰盘坐标系的第一位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标为(U0,V0);
步骤22,控制所述机器人绕着基坐标系的X轴转动第二距离ΔRx,其中,机器人法兰盘坐标系的第四位姿为(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Ux1,Vx1);
步骤S23,控制所述机器人沿着基坐标系的X、Y和Z轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点在图像坐标系恢复至步骤S21中的(U0,V0),其中,机器人法兰盘坐标系的第五位姿为(Rx0+ΔRx,Ry0,Rz0,Xx1,Yx1,Zx1);
步骤S24,控制所述机器人绕着基坐标系的Y轴转动第三距离ΔRy,其中,机器人法兰盘坐标系的第六位姿为(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Uy1,Vy1);
步骤S25,控制所述机器人沿着基坐标系的X、Y和Z轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点恢复至步骤S21中的(U0,V0),其中,机器人法兰盘坐标系的第七位姿为(Rx0,Ry0+ΔRy,Rz0,Xy1,Yy1,Zy1);
步骤S26,重复步骤S22至步骤S25,获得2n+1个所述机器人的Tti,将其设置为多个位置标定点,1≤i≤n。
在本发明的一个实施例中,在所述步骤S11和S21中,所述平面靶标与所述机器人的基坐标系的XOY坐标面大体平行。
在本发明的一个实施例中,所述步骤S14中得到多个姿态标定点和所述步骤S26中得到的多个位置标定点满足如下条件:当机器人运动到所述姿态标定点和位置标定点时,夹持的点激光传感器发射的激光束在平面靶标上形成的激光点为同一个点。
在本发明的一个实施例中,所述多个姿态标定点为:
其中,(Rx0,Ry0,Rz0,X0,Y0,Z0)为机器人法兰盘坐标系的当前位姿,ΔZ为机器人沿着基坐标系的Z轴移动的第一距离,n为机器人数量。
在本发明的一个实施例中,所述多个位置标定点为:
其中,ΔRx、ΔRy分别机器人绕着基坐标系的X轴、Y轴的第二距离和第三距离,(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0)、(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0)分别为机器人绕着基坐标系的X轴、Y轴转动时的机器人法兰盘坐标系的当前位姿,n为机器人数量。
根据本发明实施例的测量机器人的工具坐标系标定方法,在通用工具坐标系标定算法的基础上,推导了点激光传感器坐标系位置和姿态标定算法并采用视觉***控制的约束点自动实现了机器人点激光传感器坐标系工具坐标系的标定,分析了工具坐标系各分量标定误差对测量结果的影响,通过设置点激光传感器的工具坐标系的姿态标定点和位置标定点,为有效控制标定精度提供了依据,提高了标定的精度,并且适用于点激光这种非接触式工具坐标系的标定。
本发明另一方面的实施例提供一种测量机器人的工具坐标系标定***,包括:控制器、机器人、点激光传感器、平面靶标和单目视觉***,其中,所述点激光传感器由所述机器人所夹持,所述控制器控制所述机器人夹持所述点激光传感器运动,所述点激光传感器发射激光束投射到所述平面靶标上形成光斑,所述光斑在所述单目视觉***的CCD图像传感器上成像,
所述平面靶标放置于所述机器人的工作空间内,所述机器人法兰盘坐标系的第一位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标为(U0,V0);
所述控制器用于设置点激光传感器的工具坐标系的多个姿态标定点,包括如下步骤:
(1)所述控制器控制所述机器人沿着基坐标系的Z轴移动第一距离ΔZ,其中,所述机器人法兰盘坐标系的第二位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0+ΔZ),激光点在图像坐标系下的坐标将变为(U1,V1);
(2)所述控制器控制所述机器人沿着基坐标系的X、Y轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点在图像坐标系恢复至(U0,V0),其中,所述机器人法兰盘坐标系的第三位姿为(Rx0,Ry0,Rz0,X1,Y1,Z0+ΔZ);
(3)重复步骤(1)和(2),所述控制器获得n个机器人的位姿点Tri,将其设置为多个姿态标定点,1≤i≤n;
所述控制器用于置点激光传感器的工具坐标系的多个位置标定点,包括如下步骤:
(1)所述控制器控制所述机器人绕着基坐标系的X轴转动第二距离ΔRx,其中,机器人法兰盘坐标系的第四位姿为(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Ux1,Vx1);
(2)所述控制器控制所述机器人沿着基坐标系的X、Y和Z轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点在图像坐标系恢复至(U0,V0),其中,机器人法兰盘坐标系的第五位姿为(Rx0+ΔRx,Ry0,Rz0,Xx1,Yx1,Zx1);
(3)所述控制器控制所述机器人绕着基坐标系的Y轴转动第三距离ΔRy,其中,机器人法兰盘坐标系的第六位姿为(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Uy1,Vy1);
(4)所述控制器控制所述机器人沿着基坐标系的X、Y和Z轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点恢复至(U0,V0),其中,机器人法兰盘坐标系的第七位姿为(Rx0,Ry0+ΔRy,Rz0,Xy1,Yy1,Zy1);
(5)重复步骤(1)至步骤(4),获得2n+1个所述机器人的Tti,将其设置为多个位置标定点,1≤i≤n。
在本发明的一个实施例中,所述平面靶标与所述机器人的基坐标系的XOY坐标面大体平行。
在本发明的一个实施例中,所述姿态标定点和所述位置标定点满足如下条件:当所述机器人运动到所述姿态标定点和位置标定点时,夹持的点激光传感器发射的激光束在平面靶标上形成的激光点为同一个点。
在本发明的一个实施例中,所述多个姿态标定点为:
其中,(Rx0,Ry0,Rz0,X0,Y0,Z0)为机器人法兰盘坐标系的当前位姿,ΔZ为机器人沿着基坐标系的Z轴移动的第一距离,n为机器人数量。
在本发明的一个实施例中,所述多个位置标定点为:
其中,ΔRx、ΔRy分别机器人绕着基坐标系的X轴、Y轴的第二距离和第三距离,(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0)、(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0)分别为机器人绕着基坐标系的X轴、Y轴转动时的机器人法兰盘坐标系的当前位姿,n为机器人数量。
根据本发明实施例的测量机器人的工具坐标系标定***,在通用工具坐标系标定算法的基础上,推导了点激光传感器坐标系位置和姿态标定算法并采用视觉***控制的约束点自动实现了机器人点激光传感器坐标系工具坐标系的标定,分析了工具坐标系各分量标定误差对测量结果的影响,通过设置点激光传感器的工具坐标系的姿态标定点和位置标定点,为有效控制标定精度提供了依据,提高了标定的精度,并且适用于点激光这种非接触式工具坐标系的标定。
本发明附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1为根据本发明实施例的基于点约束的工具坐标系标定算法的点激光传感器的标定原理图;
图2为根据本发明实施例的基于点约束的工具坐标系姿态标定的点激光传感器姿态标定原理图;
图3为根据本发明实施例的基于点约束的工具坐标系位置标定的点激光传感器位置标定原理图;
图4为根据本发明实施例的测量机器人的工具坐标系标定方法的流程图;
图5为根据本发明实施例的设置点激光传感器的工具坐标系的多个姿态标定点的流程图;
图6为根据本发明实施例的设置点激光传感器的工具坐标系的多个位置标定点的流程图;
图7为根据本发明实施例的测量机器人的工具坐标系标定***的结构图;
图8为根据本发明实施例的测量机器人的工具坐标系标定***的工作原理图;
图9为根据本发明实施例的单目视觉***的成像原理图;
图10(a)和图10(b)分别为根据本发明实施例的姿态标定点的设置示意图;
图11(a)和图11(b)分别为根据本发明实施例的位置标定点的设置示意图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
本发明根据机器人点激光传感器测量***的特点,提出一种测量机器人的工具坐标系标定方法及***,可以实现非接触式工具坐标系的标定算法和实现方法。本发明同时对标定误差如何影响测量结果进行分析,为控制标定精度及实现整体叶盘高精度测量打下基础。
为了说明本发明实施例的测量机器人的工具坐标系标定方法和***,下面参考图1至图3对应用的基于点约束的工具坐标系标定算法进行说明。
图1为根据本发明实施例的基于点约束的工具坐标系标定算法的点激光传感器的标定原理图。如图1所示,在点激光传感器上有一虚拟点p,也是测量距离的参考原点,点激光传感器通过点激光发射器与CCD图像传感器的结合,可以获得被测点与传感器参考原点之间的距离。设参考原点在机器人法兰盘坐标系下的坐标为(x0,y0,z0),激光束方向在法兰盘坐标系下的方向向量为(nx,ny,nz),被测量点与传感器参考原点之间的距离为L,则被测量点在机器人法兰盘坐标系下的坐标为:
x=x0+nL (1)
其中:x=(x,y,z)T,x0=(x0,y0,z0)T及n=(nx,ny,nz)T。
将式(1)代入式(4.7)可得:
tgi=R0i(x0+nLi)+t0i (2)
采用一个固定的点作为标定靶标时,令f(tgi)=0,即得:
tgi=tg(i+1)=tg (3)
将式(2)代入式(3)可得:
R0i(x0+nLi)+t0i=R0(i+1)(x0+nL(i+1))+t0(i+1) (4)
图2为根据本发明实施例的基于点约束的工具坐标系姿态标定的点激光传感器姿态标定原理图。参考图2对基于点约束的工具坐标系姿态标定进行说明。
首先,保持机器人法兰盘坐标系的姿态不变,调整法兰盘坐标系在机器人基坐标系下的位置,使传感器的激光束始终打在靶标上的同一个点,则式(4)可变换为:
R0nLi+t0i=R0nL(i+1)+t0(i+1) (5)
变形得到:
其中:R0、t0(i+1)和t0i可从机器人控制器中直接读到,Li和L(i+1)可由测头直接测量获得。
当有两个标定点时,可直接用式(6)计算出点激光传感器激光束在法兰盘坐标系下的方向向量n;当有M个测量点时(M≥3),可用最小二乘法求解下式(7)的线性方程组获得相应的最佳方向向量n。
An=B (7)
其中:
A=[R0 ...... R0]T
图3为根据本发明实施例的基于点约束的工具坐标系位置标定的点激光传感器位置标定原理图。参考图3对基于点约束的工具坐标系位置标定进行说明。
具体地,变换机器人法兰盘坐标系的姿态,同时调整法兰盘坐标系在机器人基坐标系下的位置,使传感器的激光束始终打在测量靶标上的同一个点,则式(4)可变换为:
(R0i-R0(i+1))x0=R0(i+1)nL(i+1)-R0inLi+t0(i+1)-t0i (9)
由于测头坐标系姿态n已标定出,当有两个标定点时,可直接用上式计算出测头原点在法兰盘坐标系下的坐标x0;当有N个测量点时(N≥3),可用最小二乘法求解下式(10)的线性方程组获得相应的坐标x0。
Ax0=B (10)
其中:
根据上述推导的标定算法可知,为了采用点约束标定出测量机器人中的点激光传感器工具坐标系,在标定过程中,需要使得多个标定点并保证各个标定点对应的传感器的光束始终打到标定靶标的同一个点上。
如图4所示,本发明实施例的测量机器人的工具坐标系标定方法,采用点约束方法标定出测量机器人的点激光传感器的工具坐标系,包括如下步骤:
步骤S1,设置点激光传感器的工具坐标系的多个姿态标定点。
步骤S2:设置点激光传感器的工具坐标系的多个位置标定点
图5为根据本发明实施例的设置点激光传感器的工具坐标系的多个姿态标定点的流程图。参考图5对步骤S1的详细流程进行说明。
步骤S1,设置点激光传感器的工具坐标系的多个姿态标定点,包括如下步骤:
步骤S11,将平面靶标放置于机器人的工作空间内。在本步骤中,平面靶标与机器人的基坐标系的XOY坐标面大体平行。控制机器人到达某一位姿时,使得点激光传感器激光束近似打到平面靶标的中心上且基本垂直于平面靶标。此时,机器人法兰盘坐标系的第一位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标为(U0,V0)。
步骤S12,控制机器人沿着基坐标系的Z轴移动第一距离ΔZ。此时,机器人法兰盘坐标系当前的第二位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0+ΔZ),激光点在图像坐标系下的坐标由(U0,V0)变为(U1,V1)。
步骤S13,控制机器人沿着基坐标系的X、Y轴移动,直至点激光传感器投射到平面靶标上的激光点在图像坐标系恢复至步骤S11中的(U0,V0)。此时,机器人法兰盘坐标系当前的第三位姿为(Rx0,Ry0,Rz0,X1,Y1,Z0+ΔZ)。
步骤S14,重复步骤S12和S13,获得n个机器人的位姿点Tri,将其设置为多个姿态标定点,1≤i≤n。
具体地,本步骤多个姿态标定点满足如下条件:当机器人运动到姿态标定点和位置标定点时,夹持的点激光传感器发射的激光束在平面靶标上形成的激光点为同一个点。
多个姿态标定点为:
其中,(Rx0,Ry0,Rz0,X0,Y0,Z0)为机器人法兰盘坐标系的当前位姿,ΔZ为机器人沿着基坐标系的Z轴移动的第一距离,n为机器人数量。图10(a)和图10(b)示出了基于视觉的点激光传感器姿态标定点设计结果。
图6为根据本发明实施例的设置点激光传感器的工具坐标系的多个位置标定点的流程图。参考图6对步骤S2的详细流程进行说明。
步骤S2:设置点激光传感器的工具坐标系的多个位置标定点,包括如下步骤:
步骤S21,将平面靶标放置于机器人的工作空间内。在本步骤中,平面靶标与机器人的基坐标系的XOY坐标面大体平行。控制机器人到达某一位姿,使得激光线打到平面靶标的中心上且基本垂直于平面靶标。此时,机器人法兰盘坐标系的第一位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标为(U0,V0)。
步骤22,控制机器人绕着基坐标系的X轴转动第二距离ΔRx。此时,机器人法兰盘坐标系当前的第四位姿为(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Ux1,Vx1)。
步骤S23,控制机器人沿着基坐标系的X、Y和Z轴移动,直至点激光传感器投射到平面靶标上的激光点在图像坐标系恢复至步骤S21中的(U0,V0)。此时,机器人法兰盘坐标系当前的第五位姿为(Rx0+ΔRx,Ry0,Rz0,Xx1,Yx1,Zx1)。
步骤S24,控制机器人绕着基坐标系的Y轴转动第三距离ΔRy。此时,机器人法兰盘坐标系当前的第六位姿为(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Uy1,Vy1)。
步骤S25,控制机器人沿着基坐标系的X、Y和Z轴移动,直至点激光传感器投射到平面靶标上的激光点恢复至步骤S21中的(U0,V0)。此时,机器人法兰盘坐标系的第七位姿为(Rx0,Ry0+ΔRy,Rz0,Xy1,Yy1,Zy1)。
步骤S26,重复步骤S22至步骤S25,获得2n+1个机器人的Tti,将其设置为多个位置标定点,1≤i≤n。
具体地,多个位置标定点满足如下条件:当机器人运动到姿态标定点和位置标定点时,夹持的点激光传感器发射的激光束在平面靶标上形成的激光点为同一个点。
多个位置标定点为:
其中,ΔRx、ΔRy分别机器人绕着基坐标系的X轴、Y轴的第二距离和第三距离,(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0)、(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0)分别为机器人绕着基坐标系的X轴、Y轴转动时的机器人法兰盘坐标系的当前位姿,n为机器人数量。图11(a)和图11(b)分别为基于视觉的点激光传感器位置标定点设计结果。
标定点是在工具坐标系标定过程中,按一定的规则设计的机器人末端法兰盘的各个位姿点。针对点激光传感器工具坐标系的标定,当机器人运动到这些标定点时,通过单目视觉***检测到的打到平面靶标上的激光点在图像坐标系下应始终为同一个点。为了实现工具坐标系的标定过程,本发明提供了测量机器人的工具坐标系标定方法。
本发明在通用工具坐标系标定算法的基础上,推导了点激光传感器坐标系位置和姿态标定算法并采用视觉***控制的约束点自动实现了机器人点激光传感器坐标系工具坐标系的标定,分析了工具坐标系各分量标定误差对测量结果的影响,通过设置点激光传感器的工具坐标系的姿态标定点和位置标定点,为有效控制标定精度提供了依据,提高了标定的精度,并且适用于点激光这种非接触式工具坐标系的标定。
如图7所示,本发明还提出一种测量机器人的工具坐标系标定***,包括:控制器1、机器人2、点激光传感器3、平面靶标4和单目视觉***5。
具体地,点激光传感器3由机器人2所夹持。控制器1控制机器人2夹持点激光传感器3运动,点激光传感器3发射激光束投射到平面靶标4上形成光斑,光斑在单目视觉***5的CCD图像传感器上成像。
图8为根据本发明实施例的测量机器人的工具坐标系标定***的工作原理图。
当点激光传感器3发射的光束打到平面靶标4(图8中P)上后,会在平面靶标4上形成一个光斑M。同时,这个光斑会在单目视觉***5(图8中的C)中的CCD图像传感器上成像m。
图9为根据本发明实施例的单目视觉***的成像原理图。
令(O,X,Y,Z)为单目视觉***坐标系,(o,x,y)为图像坐标系,则有:
其中,(x,y)是点m在图像坐标系下的图像坐标,(X,Y,Z)是点M在视觉***坐标系下的坐标,f为视觉***的焦距。则视觉***模型可表示为:
其中,(u,v)为点m在图像坐标系下的像素坐标,(u0,v0)为原点在图像坐标系下的像素坐标,(αx,αy)为像素坐标与图像坐标的比例系数。
平面靶标4放置于机器人2的工作空间内。控制机器人2到达某一位姿时,使得点激光传感器3激光束近似打到平面靶标的中心上且基本垂直于平面靶标。此时,机器人法兰盘坐标系的第一位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标为(U0,V0)。在本发明的实施例中,平面靶标4与机器人2的基坐标系的XOY坐标面大体平行。
平面靶标4在单目视觉***5坐标系下的方程为:
aX+bY+cZ+d=0, (16)
将式(16)代入式(15),得到:
当点靶标***结构确定后,(ax,ay,f,u0,v0,a,b,c,d)为已知量。由此只要使打在平面靶标4上的激光点在图像坐标系下的坐标(u,v)保持同一固定值,就能保证点激光传感器3的激光束始终打到空间的一个点上。基于这种原理可以设计基于视觉的点靶标***,用这种***可以很方便控制激光点在空间中的位置,从而为机器人点激光传感器工具坐标系的标定提供一个约束点。
在完成上述准备工作之后,控制器1设置点激光传感器3的工具坐标系的多个姿态标定点,包括如下步骤:
(1)控制器1控制机器人2沿着基坐标系的Z轴移动第一距离ΔZ。此时,机器人法兰盘坐标系的第二位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0+ΔZ),激光点在图像坐标系下的坐标将变为(U1,V1)。
(2)控制器1控制机器人2沿着基坐标系的X、Y轴移动,直至点激光传感器3投射到平面靶标4上的激光点在图像坐标系恢复至(U0,V0)。此时,机器人法兰盘坐标系的第三位姿为(Rx0,Ry0,Rz0,X1,Y1,Z0+ΔZ)。
(3)重复步骤(1)和(2),控制器1获得n个机器人2的位姿点Tri,将其设置为多个姿态标定点,1≤i≤n。
具体地,姿态标定点满足如下条件:当机器人运动到姿态标定点和位置标定点时,夹持的点激光传感器发射的激光束在平面靶标上形成的激光点为同一个点。
多个姿态标定点为:
其中,(Rx0,Ry0,Rz0,X0,Y0,Z0)为机器人法兰盘坐标系的当前位姿,ΔZ为机器人沿着基坐标系的Z轴移动的第一距离,n为机器人数量。
控制器1用于置点激光传感器3的工具坐标系的多个位置标定点,包括如下步骤:
(1)控制器1控制机器人2绕着基坐标系的X轴转动第二距离ΔRx。此时,机器人法兰盘坐标系的第四位姿为(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Ux1,Vx1)。
(2)控制器1控制机器人2沿着基坐标系的X、Y和Z轴移动,直至点激光传感器3投射到平面靶标4上的激光点在图像坐标系恢复至(U0,V0)。此时,机器人法兰盘坐标系的第五位姿为(Rx0+ΔRx,Ry0,Rz0,Xx1,Yx1,Zx1)。
(3)控制器1控制机器人2绕着基坐标系的Y轴转动第三距离ΔRy。此时,机器人法兰盘坐标系的第六位姿为(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Uy1,Vy1)。
(4)控制器1控制机器人2沿着基坐标系的X、Y和Z轴移动,直至点激光传感器3投射到平面靶标4上的激光点恢复至(U0,V0)。此时,机器人法兰盘坐标系的第七位姿为(Rx0,Ry0+ΔRy,Rz0,Xy1,Yy1,Zy1)。
(5)重复步骤(1)至步骤(4),获得2n+1个机器人2的Tti,将其设置为多个位置标定点,1≤i≤n。
具体地,位置标定点满足如下条件:当机器人运动到姿态标定点和位置标定点时,夹持的点激光传感器发射的激光束在平面靶标上形成的激光点为同一个点。
多个位置标定点为:
其中,ΔRx、ΔRy分别机器人绕着基坐标系的X轴、Y轴的第二距离和第三距离,(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0)、(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0)分别为机器人绕着基坐标系的X轴、Y轴转动时的机器人法兰盘坐标系的当前位姿,n为机器人数量。
根据本发明实施例的测量机器人的工具坐标系标定***,在通用工具坐标系标定算法的基础上,推导了点激光传感器坐标系位置和姿态标定算法并采用视觉***控制的约束点自动实现了机器人点激光传感器坐标系工具坐标系的标定,分析了工具坐标系各分量标定误差对测量结果的影响,通过设置点激光传感器的工具坐标系的姿态标定点和位置标定点,为有效控制标定精度提供了依据,提高了标定的精度,并且适用于点激光这种非接触式工具坐标系的标定。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。本发明的范围由所附权利要求极其等同限定。
Claims (10)
1.一种测量机器人的工具坐标系标定方法,其特征在于,采用点约束方法标定出测量机器人的点激光传感器的工具坐标系,包括如下步骤:
步骤S1:设置点激光传感器的工具坐标系的多个姿态标定点,包括如下步骤:
步骤S11,将平面靶标放置于所述机器人的工作空间内,其中,所述机器人法兰盘坐标系的第一位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标为(U0,V0);
步骤S12,控制所述机器人沿着基坐标系的Z轴移动第一距离ΔZ,其中,所述机器人法兰盘坐标系的第二位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0+ΔZ),激光点在图像坐标系下的坐标将变为(U1,V1);
步骤S13,控制所述机器人沿着基坐标系的X、Y轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点在图像坐标系恢复至步骤S11中的(U0,V0),其中,所述机器人法兰盘坐标系的第三位姿为(Rx0,Ry0,Rz0,X1,Y1,Z0+ΔZ);
步骤S14,重复步骤S12和S13,获得n个机器人的位姿点Tri,将其设置为多个姿态标定点,1≤i≤n;
步骤S2:设置点激光传感器的工具坐标系的多个位置标定点,包括如下步骤:
步骤S21,将所述平面靶标放置于所述机器人的工作空间内,其中,所述机器人法兰盘坐标系的第一位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标为(U0,V0);
步骤22,控制所述机器人绕着基坐标系的X轴转动第二距离ΔRx,其中,机器人法兰盘坐标系的第四位姿为(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Ux1,Vx1);
步骤S23,控制所述机器人沿着基坐标系的X、Y和Z轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点在图像坐标系恢复至步骤S21中的(U0,V0),其中,机器人法兰盘坐标系的第五位姿为(Rx0+ΔRx,Ry0,Rz0,Xx1,Yx1,Zx1);
步骤S24,控制所述机器人绕着基坐标系的Y轴转动第三距离ΔRy,其中,机器人法兰盘坐标系的第六位姿为(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Uy1,Vy1);
步骤S25,控制所述机器人沿着基坐标系的X、Y和Z轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点恢复至步骤S21中的(U0,V0),其中,机器人法兰盘坐标系的第七位姿为(Rx0,Ry0+ΔRy,Rz0,Xy1,Yy1,Zy1);
步骤S26,重复步骤S22至步骤S25,获得2n+1个所述机器人的Tti,将其设置为多个位置标定点,1≤i≤n。
2.如权利要求1所述的测量机器人的工具坐标系标定方法,其特征在于,在所述步骤S11和S21中,所述平面靶标与所述机器人的基坐标系的XOY坐标面大体平行。
3.如权利要求1所述的测量机器人的工具坐标系标定方法,其特征在于,所述步骤S14中得到多个姿态标定点和所述步骤S26中得到的多个位置标定点满足如下条件:当机器人运动到所述姿态标定点和位置标定点时,夹持的点激光传感器发射的激光束在平面靶标上形成的激光点为同一个点。
4.如权利要求1或3所述的测量机器人的工具坐标系标定方法,其特征在于,所述多个姿态标定点为:
其中,(Rx0,Ry0,Rz0,X0,Y0,Z0)为机器人法兰盘坐标系的当前位姿,ΔZ为机器人沿着基坐标系的Z轴移动的第一距离,n为机器人数量。
5.如权利要求1或3所述的测量机器人的工具坐标系标定方法,其特征在于,所述多个位置标定点为:
<mrow>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mi>i</mi>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mn>0</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>+</mo>
<mn>2</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mrow>
<mo>(</mo>
<mrow>
<mn>2</mn>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
<mi>n</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mn>0</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mn>0</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mn>0</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>x</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>x</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>x</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>x</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>x</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mi>n</mi>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>x</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>x</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>x</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>x</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>y</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>y</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>y</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>y</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mn>2</mn>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>y</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>y</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>y</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>y</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>y</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mi>n</mi>
<mi>R</mi>
<mi>y</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>y</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>y</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>x</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
其中,ΔRx、ΔRy分别机器人绕着基坐标系的X轴、Y轴的第二距离和第三距离,(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0)、(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0)分别为机器人绕着基坐标系的X轴、Y轴转动时的机器人法兰盘坐标系的当前位姿,n为机器人数量。
6.一种测量机器人的工具坐标系标定***,其特征在于,包括:控制器、机器人、点激光传感器、平面靶标和单目视觉***,其中,所述点激光传感器由所述机器人所夹持,所述控制器控制所述机器人夹持所述点激光传感器运动,所述点激光传感器发射激光束投射到所述平面靶标上形成光斑,所述光斑在所述单目视觉***的CCD图像传感器上成像,
所述平面靶标放置于所述机器人的工作空间内,所述机器人法兰盘坐标系的第一位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标为(U0,V0);
所述控制器用于设置点激光传感器的工具坐标系的多个姿态标定点,包括如下步骤:
(1)所述控制器控制所述机器人沿着基坐标系的Z轴移动第一距离ΔZ,其中,所述机器人法兰盘坐标系的第二位姿为(Rx0,Ry0,Rz0,X0,Y0,Z0+ΔZ),激光点在图像坐标系下的坐标将变为(U1,V1);
(2)所述控制器控制所述机器人沿着基坐标系的X、Y轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点在图像坐标系恢复至(U0,V0),其中,所述机器人法兰盘坐标系的第三位姿为(Rx0,Ry0,Rz0,X1,Y1,Z0+ΔZ);
(3)重复步骤(1)和(2),所述控制器获得n个机器人的位姿点Tri,将其设置为多个姿态标定点,1≤i≤n;
所述控制器用于置点激光传感器的工具坐标系的多个位置标定点,包括如下步骤:
(1)所述控制器控制所述机器人绕着基坐标系的X轴转动第二距离ΔRx,其中,机器人法兰盘坐标系的第四位姿为(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Ux1,Vx1);
(2)所述控制器控制所述机器人沿着基坐标系的X、Y和Z轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点在图像坐标系恢复至(U0,V0),其中,机器人法兰盘坐标系的第五位姿为(Rx0+ΔRx,Ry0,Rz0,Xx1,Yx1,Zx1);
(3)所述控制器控制所述机器人绕着基坐标系的Y轴转动第三距离ΔRy,其中,机器人法兰盘坐标系的第六位姿为(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0),激光点在图像坐标系下的坐标将变为(Uy1,Vy1);
(4)所述控制器控制所述机器人沿着基坐标系的X、Y和Z轴移动,直至所述点激光传感器投射到所述平面靶标上的激光点恢复至(U0,V0),其中,机器人法兰盘坐标系的第七位姿为(Rx0,Ry0+ΔRy,Rz0,Xy1,Yy1,Zy1);
(5)重复步骤(1)至步骤(4),获得2n+1个所述机器人的Tti,将其设置为多个位置标定点,1≤i≤n。
7.如权利要求6所述的测量机器人的工具坐标系标定***,其特征在于,所述平面靶标与所述机器人的基坐标系的XOY坐标面大体平行。
8.如权利要求6所述的测量机器人的工具坐标系标定***,其特征在于,所述姿态标定点和所述位置标定点满足如下条件:当所述机器人运动到所述姿态标定点和位置标定点时,夹持的点激光传感器发射的激光束在平面靶标上形成的激光点为同一个点。
9.如权利要求6或8所述的测量机器人的工具坐标系标定***,其特征在于,所述多个姿态标定点为:
其中,(Rx0,Ry0,Rz0,X0,Y0,Z0)为机器人法兰盘坐标系的当前位姿,ΔZ为机器人沿着基坐标系的Z轴移动的第一距离,n为机器人数量。
10.如权利要求6或8所述的测量机器人的工具坐标系标定***,其特征在于,所述多个位置标定点为:
<mrow>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mi>i</mi>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mn>0</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>+</mo>
<mn>2</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mrow>
<mo>(</mo>
<mrow>
<mn>2</mn>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>T</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
<mi>n</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mn>0</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mn>0</mn>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mn>0</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>x</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>x</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>x</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>x</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>x</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mi>n</mi>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>x</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>x</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>x</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>x</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>y</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>y</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>y</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>y</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mn>2</mn>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>y</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>y</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>y</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>y</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
<mi>&Delta;</mi>
<mi>R</mi>
<mi>y</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Rx</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Ry</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mi>n</mi>
<mi>R</mi>
<mi>y</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>Rz</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>X</mi>
<mrow>
<mi>y</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Y</mi>
<mrow>
<mi>y</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>Z</mi>
<mrow>
<mi>x</mi>
<mi>n</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
其中,ΔRx、ΔRy分别机器人绕着基坐标系的X轴、Y轴的第二距离和第三距离,(Rx0+ΔRx,Ry0,Rz0,X0,Y0,Z0)、(Rx0,Ry0+ΔRy,Rz0,X0,Y0,Z0)分别为机器人绕着基坐标系的X轴、Y轴转动时的机器人法兰盘坐标系的当前位姿,n为机器人数量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510250609.9A CN105157567B (zh) | 2015-05-15 | 2015-05-15 | 一种测量机器人的工具坐标系标定方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510250609.9A CN105157567B (zh) | 2015-05-15 | 2015-05-15 | 一种测量机器人的工具坐标系标定方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105157567A CN105157567A (zh) | 2015-12-16 |
CN105157567B true CN105157567B (zh) | 2017-10-10 |
Family
ID=54798513
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510250609.9A Active CN105157567B (zh) | 2015-05-15 | 2015-05-15 | 一种测量机器人的工具坐标系标定方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105157567B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPWO2017208699A1 (ja) * | 2016-05-30 | 2019-03-22 | ソニー株式会社 | 情報処理装置と情報処理方法とプログラムおよび撮像システム |
CN106289379B (zh) * | 2016-08-12 | 2018-07-27 | 杭州亿恒科技有限公司 | 工业机器人性能测量方法 |
CN106289378B (zh) * | 2016-08-12 | 2018-07-27 | 杭州亿恒科技有限公司 | 基于激光跟踪仪的工业机器人性能测量方法 |
CN107152911A (zh) * | 2017-06-01 | 2017-09-12 | 无锡中车时代智能装备有限公司 | 基于psd反馈的点激光传感器与机器人相对位置的标定方法 |
CN107953333B (zh) * | 2017-12-20 | 2021-04-20 | 深圳大学 | 一种机械手末端工具标定的控制方法及*** |
CN108592838B (zh) * | 2018-06-21 | 2021-01-22 | 昆山华恒机器人有限公司 | 工具坐标系的标定方法、装置以及计算机存储介质 |
CN109077822B (zh) * | 2018-06-22 | 2020-11-03 | 雅客智慧(北京)科技有限公司 | 一种基于视觉测量的牙科种植手机标定***及方法 |
CN110146044B (zh) * | 2019-06-14 | 2021-12-28 | 上海航天设备制造总厂有限公司 | 一种tcp精度测量及校准方法 |
CN111267092B (zh) * | 2019-08-27 | 2022-09-02 | 上海飞机制造有限公司 | 标定机器人工具坐标系的方法和*** |
CN110974421B (zh) * | 2019-12-13 | 2021-05-11 | 杭州三坛医疗科技有限公司 | 手术机器人tcp的标定方法、***及存储介质 |
CN111707189B (zh) * | 2020-06-12 | 2021-04-27 | 天津大学 | 基于双目视觉的激光位移传感器光束方向标定方法 |
CN112959364B (zh) * | 2021-03-15 | 2022-11-22 | 北京电子工程总体研究所 | 一种工业机器人装配误差补偿***及方法 |
CN114098961A (zh) * | 2021-12-16 | 2022-03-01 | 南京普爱医疗设备股份有限公司 | 一种标定手术机械臂导向器的工装装置及其工作方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1831468A (zh) * | 2005-03-10 | 2006-09-13 | 新奥博为技术有限公司 | 激光扫描器与机器人的相对位置的标定方法 |
CN1903525A (zh) * | 2005-07-25 | 2007-01-31 | 廊坊智通机器人***有限公司 | 基于平板测量的机器人工具中心点三分量校准法 |
CN101097132A (zh) * | 2006-06-30 | 2008-01-02 | 廊坊智通机器人***有限公司 | 基于相对测量的工件坐标***标定方法 |
CN101097131A (zh) * | 2006-06-30 | 2008-01-02 | 廊坊智通机器人***有限公司 | 一种工件坐标***的标定方法 |
CN102087096A (zh) * | 2010-11-12 | 2011-06-08 | 浙江大学 | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5365379B2 (ja) * | 2009-07-06 | 2013-12-11 | 富士電機株式会社 | ロボットシステム及びロボットシステムのキャリブレーション方法 |
-
2015
- 2015-05-15 CN CN201510250609.9A patent/CN105157567B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1831468A (zh) * | 2005-03-10 | 2006-09-13 | 新奥博为技术有限公司 | 激光扫描器与机器人的相对位置的标定方法 |
CN1903525A (zh) * | 2005-07-25 | 2007-01-31 | 廊坊智通机器人***有限公司 | 基于平板测量的机器人工具中心点三分量校准法 |
CN101097132A (zh) * | 2006-06-30 | 2008-01-02 | 廊坊智通机器人***有限公司 | 基于相对测量的工件坐标***标定方法 |
CN101097131A (zh) * | 2006-06-30 | 2008-01-02 | 廊坊智通机器人***有限公司 | 一种工件坐标***的标定方法 |
CN102087096A (zh) * | 2010-11-12 | 2011-06-08 | 浙江大学 | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 |
Non-Patent Citations (1)
Title |
---|
机器人三维激光扫描视觉***标定误差;齐立哲等;《机器工程学报》;20110731;第47卷(第13期);第9-15页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105157567A (zh) | 2015-12-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105157567B (zh) | 一种测量机器人的工具坐标系标定方法及*** | |
JP6468741B2 (ja) | ロボットシステム及びロボットシステムの校正方法 | |
JP5815761B2 (ja) | 視覚センサのデータ作成システム及び検出シミュレーションシステム | |
CN111300481B (zh) | 基于视觉及激光传感器的机器人抓取位姿纠正方法 | |
JP6429473B2 (ja) | ロボットシステム、ロボットシステムの校正方法、プログラム、およびコンピュータ読み取り可能な記録媒体 | |
JP5321532B2 (ja) | ロボットキャリブレーション装置及びキャリブレーション方法 | |
US20160279800A1 (en) | Robot, robot control device, and robotic system | |
JP2018176334A5 (zh) | ||
CN107443377A (zh) | 传感器‑机器人坐标系转换方法及机器人手眼标定方法 | |
CN107152911A (zh) | 基于psd反馈的点激光传感器与机器人相对位置的标定方法 | |
CN106272444A (zh) | 一种实现手眼关系和双机器人关系同时标定的方法 | |
US11230011B2 (en) | Robot system calibration | |
JP5618770B2 (ja) | ロボットの校正装置および校正方法 | |
CN108297100B (zh) | 机械臂参数标定方法、装置和***、机械臂 | |
CN110450163A (zh) | 无需标定板的基于3d视觉的通用手眼标定方法 | |
CN103302666A (zh) | 信息处理设备和信息处理方法 | |
CN106737859B (zh) | 基于不变平面的传感器与机器人的外部参数标定方法 | |
US20180207755A1 (en) | Gear mechanism assembly apparatus and assembly method | |
CN109623822A (zh) | 机器人手眼标定方法 | |
CN110893619A (zh) | 一种基于激光跟踪仪的工业机器人位姿校准装置 | |
Bonilla et al. | A vision-based, impedance control strategy for industrial robot manipulators | |
JP7502003B2 (ja) | 移動機械の移動軌跡のずれを取得する装置、及び方法 | |
Qi et al. | Hand-eye calibration method of gantry robot based on 3D vision sensor | |
WO2023013740A1 (ja) | ロボット制御装置、ロボット制御システム、及びロボット制御方法 | |
JP2016203282A (ja) | エンドエフェクタの姿勢変更機構を備えたロボット |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230419 Address after: 100176 room 206, 2nd floor, building 2, No.5, Yongchang South Road, Beijing Economic and Technological Development Zone, Daxing District, Beijing Patentee after: Beijing Jingcheng Zhitong Robot Technology Co.,Ltd. Address before: 301700 building 15, Beijing Bin Industrial Park, Wuqing District, Tianjin Patentee before: TIANJIN INTERSMART ROBOT CO.,LTD. |