CN105444672B - 激光测距仪和机械臂末端关系的正交平面标定方法及*** - Google Patents
激光测距仪和机械臂末端关系的正交平面标定方法及*** Download PDFInfo
- Publication number
- CN105444672B CN105444672B CN201510953856.5A CN201510953856A CN105444672B CN 105444672 B CN105444672 B CN 105444672B CN 201510953856 A CN201510953856 A CN 201510953856A CN 105444672 B CN105444672 B CN 105444672B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msubsup
- msup
- coordinate system
- calibration plane
- 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
- 238000000034 method Methods 0.000 title claims abstract description 35
- 239000013598 vector Substances 0.000 claims abstract description 203
- 238000013519 translation Methods 0.000 claims abstract description 160
- 230000009466 transformation Effects 0.000 claims abstract description 34
- 238000005457 optimization Methods 0.000 claims abstract description 4
- 230000014616 translation Effects 0.000 claims description 134
- 239000011159 matrix material Substances 0.000 claims description 121
- 230000001678 irradiating effect Effects 0.000 claims description 26
- 238000012847 principal component analysis method Methods 0.000 claims description 24
- 239000000203 mixture Substances 0.000 claims description 12
- 238000005259 measurement Methods 0.000 claims description 11
- 238000004364 calculation method Methods 0.000 claims description 6
- 238000012935 Averaging Methods 0.000 claims description 2
- 241001123248 Arma Species 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 4
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000006467 substitution reaction Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 210000000078 claw Anatomy 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000002513 implantation Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012994 industrial processing Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明公开了一种激光测距仪和机械臂末端关系的正交平面标定方法及***。本发明采用激光测距仪固定在机械臂末端,并在空间中放置相互正交的标定平面,通过机械臂的旋转平移运动带动激光测距仪的位姿改变,使用激光测距仪测量的距离d,求解平移向量r和激光束的单位方向向量v,完成激光测距仪和机械臂末端的空间变换关系标定,根据x=r+dv,实现对三维空间中物体上点x的重建;明确给出了机械臂末端坐标系和激光测距仪坐标系的变换关系;使用正交平面作为标定平面和应用非线性优化方法充分利用点的共面性作为约束条件来求解空间变换关系的标定问题,从而增加约束条件减少误差,降低噪声干扰,提高方法的鲁棒性和易实施性,并提高空间变换关系的标定精度。
Description
技术领域
本发明涉及视觉测量领域,具体涉及一种激光测距仪和机械臂末端的空间变换关系的正交平面标定方法及***。
背景技术
随着电子工业水平的提高,计算机技术和光学传感器技术的发展,使得机器视觉在工业加工、航空、汽车、船舶、娱乐、医疗等领域都有广泛的应用。
为了利用机械臂完成立体定向电极植入手术,需要将机械臂的坐标系和病人的三维空间坐标进行配准。而配准的基础是建立机械臂末端(比如爪手、法兰盘等)和传感器(相机、结构光设备、激光测距仪等)之间的变换关系,求解这个变换关系的问题称为手眼标定问题。
对机械臂的手眼标定问题,已经有不少学者提出相应的解决办法,Zhuang将机械臂和传感器一起建模,用于机械臂运动学参数校正,Tsai将手眼标定分为旋转和平移两个部分分别求解,Ma采用相互正交的纯平移来线性化手眼矩阵的旋转部分,对旋转部分的求解需要三次有解的平移运动,Malm采用光流场的法向导数方法,Shiu等人将手眼标定问题归结为求解AX=XB的问题。
在文献[The international journal of robotics research,1995,14(3):195-210]中给出了通用的求解手眼标定方法,对它进行必要的修改可以适合相机、激光测距仪、结构光等不同的传感器,但具体如何修改使得它适应不同的传感器,需要读者做一定创造性探索。在文献[Robotics and Automation,IEEE Transactions on,1998,14(3):493-497]中给出一般情况下激光测距仪和机械臂的手眼标定方法,但具体如何从将在机械臂坐标系下坐标的变换转换到激光测距仪坐标系下的变换,该文献[Robotics andAutomation,IEEE Transactions on,1998,14(3):493-497]中并没有明确给出,要想实现它也需要读者做一定的创造性探索。并且当前的方法在理论上可以得到很高的精度,但是在实践中由于约束条件不足,导致求解手眼标定矩阵的可重复性较差。
发明内容
为了解决现有技术中存在的问题,本发明提出了一种激光测距仪和机械臂末端的空间变换关系的正交平面标定方法及***,使用固定在机械臂末端的激光测距仪来实现对三维空间中物体上点的重建,它具有测量精度高,价格相对低廉的优点。
本发明的一个目的在于提出一种激光测距仪和机械臂末端的空间变换关系的正交平面标定***。
本发明的激光测距仪和机械臂末端的空间变换关系的正交平面标定***包括:机械臂、机械臂末端、激光测距仪以及三个相互正交的标定平面;其中,激光测距仪固定在机械臂末端,二者相对位置不变;在空间中放置三个相互正交的第一至第三标定平面P1~P3,标定平面相对于机械臂的位置固定,标定平面的表面平整;机械臂连接至机械臂的控制器,从机械臂的控制器中直接读取出机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量。
本发明的另一个目的在于提出一种激光测距仪和机械臂末端的空间变换关系的正交平面标定方法。
本发明的激光测距仪和机械臂末端的空间变换关系的正交平面标定方法,包括以下步骤:
1)建立空间变换关系:
机械臂末端坐标系为Om,激光测距仪坐标系为OL,激光测距仪坐标系相对于机械臂末端坐标系只发生平移r,激光测距仪发出的激光束的单位方向向量在激光测距仪坐标系下为v,机械臂末端坐标系下激光束照射到标定平面上的点为x,即机械臂末端坐标系的原点到激光束照射到标定平面上的点表示为x,激光测距仪测量得到的距离为d,即在激光测距仪坐标系下,激光测距仪坐标系的原点到激光束照射到标定平面的点x的距离为d,根据机械臂末端坐标系和激光测距仪坐标系的关系,对于照射到标定平面上的点表示为:x=r+dv,其中,r为平移向量,v为激光束的单位方向向量,二者未知,下面分别求得r和v;由第一标定平面P1求得的激光束的单位方向向量为v1,平移向量为r1,由第二标定平面P2求得的激光束的单位方向向量为v2,平移向量为r2,由第三标定平面P3求得的激光束的单位方向向量为v3,平移向量为r3;
2)通过控制机械臂运动,使得激光测距仪发出的激光束分别照射到第一至第三标定平面上,分别测量并求解得到v1和r1、v2和r2以及v3和r3,其中,v1和r1分别为由第一标定平面P1求得的激光束的单位方向向量和平移向量,v2和r2分别为由第二标定平面P2求得的激光束的单位方向向量和平移向量,以及v3和r3分别为由第三标定平面P3求得的激光束的单位方向向量和平移向量;
3)优化计算平移向量r和激光束的单位方向向量v:
设定初始值、约束函数和目标函数,采用迭代算法,直至满足给定的收敛条件为止,得到优化计算后的平移向量r和激光束的单位方向向量v,完成激光测距仪和机械臂末端的空间变换关系的标定;
4)对于激光束照射到三维空间中物体的一个点,激光测距仪测量得到的距离为d,根据步骤3)得到的激光束的单位方向向量v和平移向量r,在机械臂末端坐标系下,该点表示为x=r+dv,完成对三维空间中物体上该点在机械臂末端坐标系下空间坐标的测量。
其中,在步骤2)中,由第一至第三标定平面P1~P3,分别测量并求解得到v1和r1、v2和r2以及v3和r3,包括以下步骤:
a)测量并求解由第一标定平面P1求得的激光束的单位方向向量v1:
i.控制机械臂运动,激光测距仪发出的激光束照射在第一标定平面P1上,保持机械臂不动,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量记为初始位姿点;
ii.保持姿态不改变,机械臂末端相对于初始位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量多次平移后测量得到第一标定平面P1的第一组平动数据,在机械臂末端坐标系下初始位姿点的第一标定平面的单位法向量满足:
得到第一标定平面P1的第一组约束,其中,j为≥2的自然数,
iii.调整机械臂末端的位姿,使其相对于初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在第一标定平面P1上,固定这时的位姿,记为第二位姿点,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第二位姿点的第一标定平面的单位法向量其中,为在机械臂末端坐标系下,从原始位姿点到第二位姿点的旋转矩阵,并且
iv.保持姿态不改变,机械臂末端相对于第二位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到第一标定平面P1的第二组平动数据,在机械臂末端坐标系下第二位姿点的第一标定平面P1的单位法向量满足:
得到第一标定平面P1的第二组约束,其中,j为≥2的自然数,
v.调整机械臂末端的位姿,使其相对于初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在第一标定平面P1上,固定这时的位姿使其不同于初始位姿点和第二位姿点,记为第三位姿点,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第三位姿点的第一标定平面P1的单位法向量其中,为在机械臂末端坐标系下,从原始位姿点到第三位姿点的旋转矩阵,并且
vi.保持姿态不改变,机械臂末端相对于第三位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到第一标定平面P1的第三组平动数据,在机械臂末端坐标系下第三位姿点的第一标定平面的单位法向量满足:
得到第一标定平面P1的第三组约束,其中,j为≥2的自然数,
vii.使用上面三组第一标定平面P1的约束和单位向量模的约束求解出和p11、p12和p13的值;
viii.由和求解出由第一标定平面P1求得的激光束的单位方向向量v1;
b)测量并求解由第一标定平面P1求得的平移向量r1:
控制机械臂相对于初始位姿点做旋转平移运动,至少旋转平移k次,且激光测距仪发出的激光束照射在第一标定平面P1上,记录第j次旋转平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量满足约束方程:
其中,1≤j≤k,k为≥3的自然数,为在机械臂末端坐标系下初始位姿点的第一标定平面P1的单位法向量,在步骤a)中已经得到,对于每一次的旋转平移,分别列出约束方程,一共k个约束方程,k个约束方程联立得到由第一标定平面P1求得的平移向量r1;
c)测量并求解由第二标定平面P2求得的激光束的单位方向向量v2:
i.控制机械臂运动,激光测距仪发出的激光束照射在第二标定平面P2上,保持机械臂不动,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量记为第二标定平面P2的初始位姿点;
ii.保持姿态不改变,机械臂末端相对于第二标定平面P2的初始位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量多次平移后测量得到第二标定平面P2的第一组平动数据,在机械臂末端坐标系下初始位姿点的第二标定平面P2的单位法向量满足:
得到第二标定平面P2的第一组约束,其中,j为≥2的自然数,
iii.调整机械臂末端的位姿,使其相对于第二标定平面P2的初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在第二标定平面P2上,固定这时的位姿,记为第二标定平面P2的第二位姿点,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第二位姿点的第二标定平面P2的单位法向量其中,为在机械臂末端坐标系下,从第二标定平面P2的原始位姿点到第二位姿点的旋转矩阵,并且
iv.保持姿态不改变,机械臂末端相对于第二标定平面P2的第二位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到第二标定平面P2的第二组平动数据,在机械臂末端坐标系下第二位姿点的第二标定平面P2的单位法向量满足:
得到第二标定平面P2的第二组约束,其中,j为≥2的自然数,
v.调整机械臂末端的位姿,使其相对于第二标定平面P2的初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在第二标定平面P2上,固定这时的位姿使其不同于第二标定平面P2的初始位姿点和第二位姿点,记为第二标定平面P2的第三位姿点,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第三位姿点的第二标定平面的单位法向量其中,为在机械臂末端坐标系下,从第二标定平面P2的原始位姿点到第三位姿点的旋转矩阵,并且
vi.保持姿态不改变,机械臂末端相对于第二标定平面P2的第三位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到第二标定平面P2的第三组平动数据,在机械臂末端坐标系下第三位姿点的第二标定平面P2的单位法向量满足:
得到第二标定平面P2的第三组约束,其中,j为≥2的自然数,
vii.使用上面三组第二标定平面P2的约束和单位向量模的约束求解出和p21、p22和p33的值;
viii.由和求解出由第二标定平面P2求得的激光束的单位方向向量v2;
d)测量并求解由第二标定平面P2求得的平移向量r2:
控制机械臂相对于第二标定平面P2的初始位姿点做旋转平移运动,至少旋转平移k次,且激光测距仪发出的激光束照射在第二标定平面P2上,记录第j次旋转平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量满足约束方程:
其中,为在机械臂末端坐标系下初始位姿点的第二标定平面的单位法向量,在步骤c)中已经得到,对于每一次的旋转平移,分别列出约束方程,一共k个约束方程,k个约束方程联立得到由第二标定平面P2求得的平移向量r2。
e)测量并求解由第三标定平面P3求得的激光束的单位方向向量v3:
i.控制机械臂运动,激光测距仪发出的激光束照射在第三标定平面P3上,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量记为第三标定平面P3的初始位姿点;
ii.保持姿态不改变,机械臂末端相对于第三标定平面P3的初始位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量多次平移后测量得到第三标定平面P3的第一组平动数据,在机械臂末端坐标系下初始位姿点的第三标定平面的单位法向量满足:
得到第三标定平面P3的第一组约束,其中,j为≥2自然数,
iii.调整机械臂末端的位姿,使其相对于第三标定平面P3的初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在第三标定平面P3上,固定这时的位姿且激光测距仪,记为第三标定平面P3的第二位姿点,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第二位姿点的第三标定平面P3的单位法向量其中,为在机械臂末端坐标系下,从第三标定平面P3的原始位姿点到第二位姿点的旋转矩阵,并且
iv.保持姿态不改变,机械臂末端相对于第三标定平面P3的第二位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到第三标定平面P3的第二组平动数据,在机械臂末端坐标系下第二位姿点的第三标定平面P3的单位法向量满足:
得到第三标定平面P3的第二组约束,其中,j为≥2的自然数,
v.调整机械臂末端的位姿,使其相对于第三标定平面P3的初始位姿点既有平移又有旋转运动,固定这时的位姿使其不同于第三标定平面P3的初始位姿点和第二位姿点,记为第三标定平面P3的第三位姿点,且激光测距仪发出的激光束照射在第三标定平面P3上,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第三位姿点的第三标定平面P3的单位法向量其中,为在机械臂末端坐标系下,从第三标定平面P3的原始位姿点到第三位姿点的旋转矩阵,并且
vi.保持姿态不改变,机械臂末端相对于第三标定平面P3的第三位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到平移后测量的第三组平动数据,在机械臂末端坐标系下第三位姿点的第三标定平面P3的单位法向量满足:
得到第三标定平面P3的第三组约束,其中,j为≥2的自然数,
vii.使用上面三组第三标定平面P3的约束和单位向量模的约束求解出和p31、p32和p33的值;
viii.由和求解出由第三标定平面P3求得的激光束的单位方向向量v3;
f)测量并求解由第三标定平面P3求得的平移向量r3:
控制机械臂相对于第三标定平面P3的初始位姿点做旋转平移运动,至少旋转平移k次,且激光测距仪发出的激光束照射在第三标定平面P3上,记录第j次旋转平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量满足约束方程:
其中,1≤j≤k,k为≥3的自然数,为在机械臂末端坐标系下初始位姿点的第三标定平面P3的单位法向量,在步骤e)中已经得到,对于每一次的旋转平移,分别列出约束方程,一共k个约束方程,k个约束方程联立得到由第三标定平面P3求得的平移向量r3。
步骤3)中,优化计算平移向量r和激光束的单位方向向量v,具体包括以下步骤:
a)设定初始值:
对三个标定平面分别求得的平移向量取平均得到优化算法的平移向量r的初始值,即r的初始值为同理求得激光束的单位方向向量v的初始值,即v的初始值为
b)确定约束条件:
使用多个有约束的线性最小二乘法组成的非线性最小化算法,线性约束条件是非线性约束条件是标定平面的单位法向量的第三个分量大于零,即
c)确定目标函数:
算法的目标函数为f=f1+f2+f3,其中f1为与第一标定平面P1相关的约束函数,f2为与第二标定平面P2相关的约束函数,f3为与第三标定平面P3相关的约束函数;
d)迭代计算:
不断的迭代更新直至满足给定的收敛条件为止;
与第一标定平面P1相关的约束函数表示为f1=f11+f12+f13+f14,其中X11为步骤2)的a)的ii)中测量得到的点组成的矩阵,即 为X11使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X12为步骤2)的a)的iv)中测量得到的点组成的矩阵,即 为X12使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X13为步骤2)的a)的vi)中测量得到的点组成的矩阵,即 为X13使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X14为步骤2)的b)中测量得到的点组成的矩阵,即 为X14使用主成分分析方法得到的主平面上对应的点组成的矩阵;
同样,与第二标定平面P2相关的函数f2=f21+f22+f23+f24,其中,X21为步骤2)的c)的ii)中测量得到的点组成的矩阵,即 为X21使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X22为步骤2)的c)的iv)中测量得到的点组成的矩阵,即 为X22使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X23为2)的c)的vi)中测量得到的点组成的矩阵,即 为X23使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X24为步骤2)的d)中测量得到的点组成的矩阵,即 为X24使用主成分分析方法得到的主平面上对应的点组成的矩阵;
同样,与第三标定平面P3相关的函数f3=f31+f32+f33+f34,其中,X31为步骤2)的e)的ii)中测量得到的点组成的矩阵,即 为X31使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X32为步骤2)的e)的iv)中测量得到的点组成的矩阵,即 为X32
使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X33为步骤2)的e)的vi)中测量得到的点组成的矩阵,即 为X33使用主成分分析方法得到的主平面上对应的点组成的矩阵;
其中的X34为步骤2)的f)中测量得到的点组成的矩阵,即 为X34使用主成分分析方法得到的主平面上对应的点组成的矩阵;
当算法收敛停止迭代后,得到优化的激光束的单位方向向量v和平移向量r。
进一步,当完成空间变换关系标定后,激光测距仪测量空间中的第j位置的点,在得到它的距离dj和这时的机械臂的控制器中的读出的机械臂末端坐标系相对于机械臂坐标系的旋转矩阵Rbj和平移列向量Tbj,由xbj=Rbjxmj+Tbj=Rbj(r+djv)+Tbj,求得该点在机械臂坐标系下的空间坐标值xbj,采集多个需要测量的三维空间点,从而完成三维空间点的测量。
本发明的优点:
本发明采用激光测距仪固定在机械臂末端,并在空间中放置相互正交的标定平面,通过机械臂的旋转平移运动带动激光测距仪的位姿改变,使用激光测距仪测量的距离d,求解平移向量r和激光束的单位方向向量v,完成激光测距仪和机械臂末端的空间变换关系标定,根据x=r+dv,可以实现对三维空间中物体上点x的重建,具有测量精度高,价格相对低廉的优点;本发明明确给出了机械臂末端坐标系和激光测距仪坐标系的变换关系;使用正交平面作为标定平面和应用非线性优化方法充分利用点的共面性作为约束条件来求解空间变换关系的标定问题,从而增加约束条件、减少误差,降低噪声干扰,提高方法的鲁棒性和易实施性,并提高空间变换关系的标定精度。
附图说明
图1为本发明的机械臂末端坐标系与激光测距仪坐标系的关系的示意图;
图2为激光测距仪和机械臂末端的空间变换关系的理论模型的示意图;
图3为本发明的激光测距仪和机械臂末端的空间变换关系的正交平面标定方法的理论模型的示意图;
图4为本发明的激光测距仪和机械臂末端的空间变换关系的正交平面标定***的示意图。
具体实施方式
下面结合附图,通过具体实施例,进一步阐述本发明。
机械臂末端坐标系为Om,Xm、Ym和Zm分别为机械臂末端坐标系的三个坐标轴,激光测距仪坐标系为OL,XL、YL和ZL分别为激光测距仪坐标系的三个坐标轴,激光测距仪坐标系相对于机械臂末端坐标系只发生平移r,激光测距仪发出的激光束的单位方向向量在激光测距仪坐标系为v,如图1所示。
下述空间点坐标和向量都用3*1列向量表示,法向量为单位向量,激光束的单位方向向量也为单位向量。
如图2所示,在初始位置,标定平面的单位法向量在机械臂末端坐标系下为nm0,设在机械臂末端坐标系下激光测距仪发射出的激光束照射到标定平面上的点为xm0,激光测距仪测量得到的距离为d0,则在机械臂末端坐标系下标定平面的平面方程可表示为:
其中,b0为在初始位置,在机械臂末端坐标系下,机械臂末端坐标系的原点到标定平面的距离。
机械臂末端发生旋转和平移后,在第j位置,设机械臂末端坐标系下激光测距仪发射出的激光束照射到标定平面上的点为xmj,激光测距仪测量得到的距离为dj,这时在机械臂坐标系下的标定平面的单位法向量为nmj,同样对于标定平面在机械臂末端坐标系下有平面方程:
其中,bj为在第j位置,在机械臂末端坐标系下,机械臂末端坐标系的原点到标定平面的距离。
设在标定平面上的两点有如下关系:
xm0=Rm0jxmj+Tm0j (3)
其中,Rm0j为在机械臂末端坐标系下,从第j位置到初始位置的旋转矩阵,Tm0j在机械臂末端坐标系下,从第j位置到初始位置的平移列向量。
则将(3)代入(1)中得到:
比较(2)和(4)可以得到:
在机械臂末端坐标系下,根据机械臂末端坐标系和激光测距仪坐标系的关系,对于照射到标定平面上的点可以表示成:
xm0=r+d0v (7)
xmj=r+djv (8)
将(8)代入(4)中整理后得到:
在(9)中的未知变量r和v是确定空间变换标定的关键变量,如果能够确定r和v则完成机械臂末端和激光测距仪的空间变换标定。在(9)中nm0,Rm0j,Tm0j,b0等变量也是待求解的,其中的Rm0j,Tm0j是无法直接得到,但是可以通过机械臂的旋转和平移情况得到,接下来就推导出它们和机械臂坐标系的旋转平移的关系。
如图3所示,标定平面相对于机械臂坐标系Ob是固定的,在机械臂坐标系下标定平面的单位法向量为N,机械臂坐标系的原点到标定平面的距离为b,在实际操作中可以直接从机械臂的控制器中读取到在第j位置时,机械臂末端坐标系Om到机械臂坐标系Ob的旋转矩阵Rbj和平移列向量Tbj。
在初始位置,标定平面的单位法向量在机械臂末端坐标系下为nm0,设在机械臂末端坐标系下激光束打到标定平面上的点表示为xm0,同时该点在机械臂坐标系下表示为xb0,机械臂坐标系原点到标定平面的距离为b,激光测距仪测量得到的距离为d0,从机械臂末端坐标系相对于机械臂坐标系的旋转矩阵为Rb0,平移列向量为Tb0,这时有从机械臂末端坐标系下的点到机械臂坐标系下的同一点的变换关系为:
对于标定平面,在机械臂末端坐标系下有平面方程(1),在机械臂坐标系下有平面方程:
NTxb0+b=0 (11)
机械臂末端发生旋转和平移后,在第j位置,机械臂末端坐标系下激光束照射到标定平面上的另外一点为xmj,同时该点在机械臂坐标系下为xbj,激光测距仪测量得到的距离为dj,从机械臂末端坐标系相对于机械臂坐标系的旋转矩阵为Rbj,平移列向量为Tbj,这时有从机械臂末端坐标系到机械臂坐标系的变换关系为:
这时的标定平面,在第j位置,机械臂末端坐标系下的标定平面的单位法向量为nmj,同样对于标定平面,在机械臂末端坐标系下有平面方程(2),在机械臂坐标系下有平面方程:
NTxbj+b=0 (13)
将等式(10)代入(11)有:
NTxb0+b=NT(Rb0xm0+Tb0)+b=0 (14)
同理(12)代入(13)有:
NTxbj+b=NT(Rbjxmj+Tbj)+b=0 (15)
再由等式(14)和(15),使用最小二乘可得:
比较(3)和(16)可得:
在初始位置,从机械臂末端坐标系相对于机械臂坐标系的旋转矩阵为Rb0,平移列向量为Tb0,以及在第j位置,从机械臂末端坐标系相对于机械臂坐标系的旋转矩阵为Rbj,平移列向量为Tbj,都可以通过机械臂控制器直接读取,这样由(17)(18)两个等式可以得到Rm0j和Tm0j。
根据等式(9),假设机械臂末端只有平移运动,即Rm0j=I,代入(9)中得到:
当j=0时,即还没有产生相对的旋转和平移运动,这时的Tm0j=[0;0;0],则有:
(19)-(20)有:
接下来求解(21)式,假设把写成公式(22)
则(21)式可表示成:
在(23)式中的p还是未知变量,但是nm0为单位向量即有等式且z方向沿着机械臂末端坐标系的Zm轴正方向,即nm0z>0。这样对于(23)式最少2次测量(即初始位置和第j位置)可以求出nm0,且同时可以求得p。这样代回(22)式,可以得到v的一组约束。
接下来,控制机械臂进行旋转平移运动,在旋转平移后的机械臂末端坐标系下的标定平面的单位法向量为n'm0,从机械臂末端坐标系到机械臂坐标系的旋转矩阵为R′b0,设在机械臂末端坐标系下,从初始位置到当前位置的旋转矩阵为R'm0,并且由公式(5)可得到接着控制机械臂只进行平移运动,由公式(23)可以求得对应的p',代入(22)得到另一组约束,再用同样的方法得到第三组约束,这样就可以解出v。
为了降低采集数据的各种噪声和误差,增加采集数据,对(23)使用最小二乘法计算可得:
其中,j≥2,即在每一个位置,需至少平移两次。
当完成对nm0,v的求解后,再回到(9)式,将其重写如下:
在(9)式中还有r,b0是未知的,
重新写(20):
(9)-(20)得:
在(25)式中只有r未知,由于每次测量只能求得一个约束方程,所以至少需要测量三组旋转平移数据,才能够将r解出。
至此,间变换标定所需的r和v都已经解出。
在完成空间变换标定后,就可以根据(12)式得:
xbj=Rbjxmj+Tbj=Rbj(r+djv)+Tbj (26)
这样当使用激光测距仪测量空间中的某个点,在得到它的距离dj和这时的机械臂的控制器中的读数Rbj和Tbj,就可以由(26)式求得该点在机械臂坐标系下的空间坐标值xbj。
如图4所示,本实施例中,机械臂末端m挂载有激光测距仪L,在空间中放置有一个相对于机械臂基座B空间位置固定的互相正交的第一至第三标定平面P1~P3,要求标定平面的平整度尽可能好。
控制机械臂运动,使得激光测距仪发出的激光光斑照射在一个标定平面上,记录这时的激光测距仪测量的距离d0,机械臂末端坐标系相对于机械臂坐标系的旋转矩阵Rb0和平移列向量Tb0,记为初始位姿点。保持姿态不改变,机械臂末端相对于初始位姿点只做平移运动,测量每一次的距离dj和旋转矩阵Rbj和平移列向量Tbj,一共测量15次数据得到第一组平动数据,代入(24)式得到nm0和p的第一组约束。调整机械臂末端的位姿,使其相对于初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在同一个标定平面上,固定这时的位姿,记为第二位姿点,且激光测距仪记录这时的激光测距仪测量的距离d'0及机械臂末端坐标系相对于机械臂坐标系的旋转矩阵R′b0和平移列向量T′b0。保持姿态不改变,机械臂末端相对于第二位姿点只做平移运动,测量每一次的距离d'j和旋转矩阵R′bj和平移列向量T′bj,一共测量15次数据得到第二组平动数据,代入(24)式得到n'm0和p'的第二组约束。调整机械臂末端的位姿,使其相对于初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在同一个标定平面上,固定这时的位姿使其不同于初始位姿点和第二位姿点,记为第三位姿点,且激光测距仪记录这时的激光测距仪测量的距离d″0及机械臂末端坐标系相对于机械臂坐标系的旋转矩阵R″b0和平移列向量T″b0。保持姿态不改变,机械臂末端相对于第三位姿点只做平移运动,测量每一次的距离d″j和旋转矩阵R″bj和平移列向量T″bj,一共测量15次数据得到第三组平动数据,代入(24)式得到n”m0和p”的第三组约束。
使用上面三组约束和单位向量模的约束可以求解出每一组的标定平面的单位法向量nm0,p,p'和p”值,再根据(22)式,可以求解出激光束的单位方向向量v。
接下来控制机械臂相对于初始位姿点做旋转平移运动,测量每一次的距离d″′j和旋转矩阵R″′bj和平移列向量T″′bj,一共测量15次数据得到旋转平移数据。将每一次得到的数据分别代入(25)式,列出15个约束方程,使用最小二乘法,就可以求出激光测距仪坐标系相对于机械臂末端坐标系的平移量r。
按照上面的步骤,激光束依次照射到第一至第三标定平面,分别测量并求解得到v1和r1、v2和r2以及v3和r3,然后优化计算平移向量r和激光束的单位方向向量v。
至此,空间变换关系的标定所需的r和v,都已经解出。
在完成空间变换标定后,这样当使用激光测距仪测量空间中的第j位置的点,在得到它的距离dj和这时的机械臂的控制器中的读数Rbj和Tbj,就可以由(26)式求得该点在机械臂坐标系下的空间坐标值xbj,采集多个需要测量的三维空间点,就可以完成三维空间点的测量。
最后需要注意的是,公布实施例的目的在于帮助进一步理解本发明,但是本领域的技术人员可以理解:在不脱离本发明及所附的权利要求的精神和范围内,各种替换和修改都是可能的。因此,本发明不应局限于实施例所公开的内容,本发明要求保护的范围以权利要求书界定的范围为准。
Claims (4)
1.一种激光测距仪和机械臂末端的空间变换关系的正交平面标定方法,其特征在于,所述标定方法包括以下步骤:
1)建立空间变换关系:
机械臂末端坐标系为Om,激光测距仪坐标系为OL,激光测距仪坐标系相对于机械臂末端坐标系只发生平移r,激光测距仪发出的激光束的单位方向向量在激光测距仪坐标系下为v,机械臂末端坐标系下激光束照射到标定平面上的点为x,即机械臂末端坐标系的原点到激光束照射到标定平面上的点表示为x,激光测距仪测量得到的距离为d,即在激光测距仪坐标系下,激光测距仪坐标系的原点到激光束照射到标定平面的点x的距离为d,根据机械臂末端坐标系和激光测距仪坐标系的关系,对于照射到标定平面上的点表示为:x=r+dv,其中,r为平移向量,v为激光束的单位方向向量,二者未知,下面分别求得r和v;由第一标定平面P1求得的激光束的单位方向向量为v1,平移向量为r1,由第二标定平面P2求得的激光束的单位方向向量为v2,平移向量为r2,由第三标定平面P3求得的激光束的单位方向向量为v3,平移向量为r3;
2)通过控制机械臂运动,使得激光测距仪发出的激光束分别照射到第一至第三标定平面上,分别测量并求解得到v1和r1、v2和r2以及v3和r3,其中,v1和r1分别为由第一标定平面P1求得的激光束的单位方向向量和平移向量,v2和r2分别为由第二标定平面P2求得的激光束的单位方向向量和平移向量,以及v3和r3分别为由第三标定平面P3求得的激光束的单位方向向量和平移向量;
3)优化计算平移向量r和激光束的单位方向向量v:
设定初始值、约束函数和目标函数,采用迭代算法,直至满足给定的收敛条件为止,得到优化计算后的平移向量r和激光束的单位方向向量v,完成激光测距仪和机械臂末端的空间变换关系的标定;
4)对于激光束照射到三维空间中物体的一个点,激光测距仪测量得到的距离为d,根据步骤3)得到的激光束的单位方向向量v和平移向量r,在机械臂末端坐标系下,该点表示为x=r+dv,完成对三维空间中物体上该点在机械臂末端坐标系下空间坐标的测量。
2.如权利要求1所述的标定方法,其特征在于,在步骤2)中,由第一至第三标定平面P1~P3,分别测量并求解得到v1和r1、v2和r2以及v3和r3,包括以下步骤:
a)测量并求解由第一标定平面P1求得的激光束的单位方向向量v1:
i.控制机械臂运动,激光测距仪发出的激光束照射在第一标定平面P1上,保持机械臂不动,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量记为初始位姿点;
ii.保持姿态不改变,机械臂末端相对于初始位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量多次平移后测量得到第一标定平面P1的第一组平动数据,在机械臂末端坐标系下初始位姿点的第一标定平面的单位法向量满足:
<mrow>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>11</mn>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<mrow>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>11</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>11</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>11</mn>
</msubsup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>11</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>11</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<msup>
<mi>p</mi>
<mn>11</mn>
</msup>
</mrow>
得到第一标定平面P1的第一组约束,其中,j为≥2的自然数,
iii.调整机械臂末端的位姿,使其相对于初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在第一标定平面P1上,固定这时的位姿,记为第二位姿点,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第二位姿点的第一标定平面的单位法向量其中,为在机械臂末端坐标系下,从原始位姿点到第二位姿点的旋转矩阵,并且
iv.保持姿态不改变,机械臂末端相对于第二位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到第一标定平面P1的第二组平动数据,在机械臂末端坐标系下第二位姿点的第一标定平面P1的单位法向量满足:
<mrow>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>12</mn>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<mrow>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>12</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>12</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>12</mn>
</msubsup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>12</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>12</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<msup>
<mi>p</mi>
<mn>12</mn>
</msup>
</mrow>
得到第一标定平面P1的第二组约束,其中,j为≥2的自然数,
v.调整机械臂末端的位姿,使其相对于初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在第一标定平面P1上,固定这时的位姿使其不同于初始位姿点和第二位姿点,记为第三位姿点,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第三位姿点的第一标定平面P1的单位法向量其中,为在机械臂末端坐标系下,从原始位姿点到第三位姿点的旋转矩阵,并且
vi.保持姿态不改变,机械臂末端相对于第三位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到第一标定平面P1的第三组平动数据,在机械臂末端坐标系下第三位姿点的第一标定平面的单位法向量满足:
<mrow>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>13</mn>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<mrow>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>13</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>13</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>13</mn>
</msubsup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>13</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>13</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<msup>
<mi>p</mi>
<mn>13</mn>
</msup>
</mrow>
2
得到第一标定平面P1的第三组约束,其中,j为≥2的自然数,
vii.使用上面三组第一标定平面P1的约束和单位向量模的约束求解出和p11、p12和p13的值;
viii.由和求解出由第一标定平面P1求得的激光束的单位方向向量v1;
b)测量并求解由第一标定平面P1求得的平移向量r1:
控制机械臂相对于初始位姿点做旋转平移运动,至少旋转平移k次,且激光测距仪发出的激光束照射在第一标定平面P1上,记录第j次旋转平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量满足约束方程:
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>11</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>R</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>14</mn>
</msubsup>
<mo>-</mo>
<mi>I</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>14</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>11</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<msubsup>
<mi>R</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>14</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>11</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>11</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>)</mo>
</mrow>
<msub>
<mi>v</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>11</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>14</mn>
</msubsup>
<mo>=</mo>
<mn>0</mn>
</mrow>
其中,1≤j≤k,k为≥3的自然数,为在机械臂末端坐标系下初始位姿点的第一标定平面P1的单位法向量,在步骤a)中已经得到,对于每一次的旋转平移,分别列出约束方程,一共k个约束方程,k个约束方程联立得到由第一标定平面P1求得的平移向量r1;
c)测量并求解由第二标定平面P2求得的激光束的单位方向向量v2:
i.控制机械臂运动,激光测距仪发出的激光束照射在第二标定平面P2上,保持机械臂不动,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量记为第二标定平面P2的初始位姿点;
ii.保持姿态不改变,机械臂末端相对于第二标定平面P2的初始位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量多次平移后测量得到第二标定平面P2的第一组平动数据,在机械臂末端坐标系下初始位姿点的第二标定平面P2的单位法向量满足:
<mrow>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>21</mn>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<mrow>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>21</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>21</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>21</mn>
</msubsup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>21</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>21</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<msup>
<mi>p</mi>
<mn>21</mn>
</msup>
</mrow>
得到第二标定平面P2的第一组约束,其中,j为≥2的自然数,
iii.调整机械臂末端的位姿,使其相对于第二标定平面P2的初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在第二标定平面P2上,固定这时的位姿,记为第二标定平面P2的第二位姿点,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第二位姿点的第二标定平面P2的单位法向量其中,为在机械臂末端坐标系下,从第二标定平面P2的原始位姿点到第二位姿点的旋转矩阵,并且
iv.保持姿态不改变,机械臂末端相对于第二标定平面P2的第二位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到第二标定平面P2的第二组平动数据,在机械臂末端坐标系下第二位姿点的第二标定平面P2的单位法向量满足:
<mrow>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>22</mn>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<mrow>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>22</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>22</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>22</mn>
</msubsup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>22</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>22</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<msup>
<mi>p</mi>
<mn>22</mn>
</msup>
</mrow>
得到第二标定平面P2的第二组约束,其中,j为≥2的自然数,
v.调整机械臂末端的位姿,使其相对于第二标定平面P2的初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在第二标定平面P2上,固定这时的位姿使其不同于第二标定平面P2的初始位姿点和第二位姿点,记为第二标定平面P2的第三位姿点,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第三位姿点的第二标定平面的单位法向量其中,为在机械臂末端坐标系下,从第二标定平面P2的原始位姿点到第三位姿点的旋转矩阵,并且
vi.保持姿态不改变,机械臂末端相对于第二标定平面P2的第三位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到第二标定平面P2的第三组平动数据,在机械臂末端坐标系下第三位姿点的第二标定平面P2的单位法向量满足:
<mrow>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>23</mn>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<mrow>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>23</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>23</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>23</mn>
</msubsup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>23</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>23</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<msup>
<mi>p</mi>
<mn>23</mn>
</msup>
</mrow>
得到第二标定平面P2的第三组约束,其中,j为≥2的自然数,
vii.使用上面三组第二标定平面P2的约束和单位向量模的约束求解出和p21、p22和p33的值;
viii.由和求解出由第二标定平面P2求得的激光束的单位方向向量v2;
d)测量并求解由第二标定平面P2求得的平移向量r2:
控制机械臂相对于第二标定平面P2的初始位姿点做旋转平移运动,至少旋转平移k次,且激光测距仪发出的激光束照射在第二标定平面P2上,记录第j次旋转平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量满足约束方程:
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>21</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>R</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>24</mn>
</msubsup>
<mo>-</mo>
<mi>I</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>r</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>24</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>21</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<msubsup>
<mi>R</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>24</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>21</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>21</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>)</mo>
</mrow>
<msub>
<mi>v</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>21</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>24</mn>
</msubsup>
<mo>=</mo>
<mn>0</mn>
</mrow>
其中,为在机械臂末端坐标系下初始位姿点的第二标定平面的单位法向量,在步骤c)中已经得到,对于每一次的旋转平移,分别列出约束方程,一共k个约束方程,k个约束方程联立得到由第二标定平面P2求得的平移向量r2;
e)测量并求解由第三标定平面P3求得的激光束的单位方向向量v3:
i.控制机械臂运动,激光测距仪发出的激光束照射在第三标定平面P3上,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量记为第三标定平面P3的初始位姿点;
ii.保持姿态不改变,机械臂末端相对于第三标定平面P3的初始位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量多次平移后测量得到第三标定平面P3的第一组平动数据,在机械臂末端坐标系下初始位姿点的第三标定平面的单位法向量满足:
<mrow>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>31</mn>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<mrow>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>31</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>31</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>31</mn>
</msubsup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>31</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>31</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<msup>
<mi>p</mi>
<mn>31</mn>
</msup>
</mrow>
得到第三标定平面P3的第一组约束,其中,j为≥2自然数,
iii.调整机械臂末端的位姿,使其相对于第三标定平面P3的初始位姿点既有平移又有旋转运动,且激光测距仪发出的激光束照射在第三标定平面P3上,固定这时的位姿且激光测距仪,记为第三标定平面P3的第二位姿点,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第二位姿点的第三标定平面P3的单位法向量其中,为在机械臂末端坐标系下,从第三标定平面P3的原始位姿点到第二位姿点的旋转矩阵,并且
iv.保持姿态不改变,机械臂末端相对于第三标定平面P3的第二位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到第三标定平面P3的第二组平动数据,在机械臂末端坐标系下第二位姿点的第三标定平面P3的单位法向量满足:
<mrow>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>32</mn>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<mrow>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>32</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>32</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>32</mn>
</msubsup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>32</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>32</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<msup>
<mi>p</mi>
<mn>32</mn>
</msup>
</mrow>
得到第三标定平面P3的第二组约束,其中,j为≥2的自然数,
v.调整机械臂末端的位姿,使其相对于第三标定平面P3的初始位姿点既有平移又有旋转运动,固定这时的位姿使其不同于第三标定平面P3的初始位姿点和第二位姿点,记为第三标定平面P3的第三位姿点,且激光测距仪发出的激光束照射在第三标定平面P3上,记录这时的激光测距仪测量的距离并且直接从机械臂的控制器中读取机械臂末端坐标系相对于机械臂坐标系的旋转矩阵和平移列向量在机械臂末端坐标系下第三位姿点的第三标定平面P3的单位法向量其中,为在机械臂末端坐标系下,从第三标定平面P3的原始位姿点到第三位姿点的旋转矩阵,并且
vi.保持姿态不改变,机械臂末端相对于第三标定平面P3的第三位姿点只做平移运动,记录第j次平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量多次平移后测量得到平移后测量的第三组平动数据,在机械臂末端坐标系下第三位姿点的第三标定平面P3的单位法向量满足:
<mrow>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>33</mn>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<mrow>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>33</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>33</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&lsqb;</mo>
<munder>
<mo>&Sigma;</mo>
<mi>j</mi>
</munder>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>33</mn>
</msubsup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>33</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>33</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<msup>
<mi>p</mi>
<mn>33</mn>
</msup>
</mrow>
得到第三标定平面P3的第三组约束,其中,j为≥2的自然数,
vii.使用上面三组第三标定平面P3的约束和单位向量模的约束求解出和p31、p32和p33的值;
viii.由和求解出由第三标定平面P3求得的激光束的单位方向向量v3;
f)测量并求解由第三标定平面P3求得的平移向量r3:
控制机械臂相对于第三标定平面P3的初始位姿点做旋转平移运动,至少旋转平移k次,且激光测距仪发出的激光束照射在第三标定平面P3上,记录第j次旋转平移后的第j位置的激光测距仪测量的距离并且直接从机械臂的控制器中读取旋转矩阵和平移列向量满足约束方程:
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>31</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>R</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>34</mn>
</msubsup>
<mo>-</mo>
<mi>I</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>r</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>d</mi>
<mi>j</mi>
<mn>34</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>31</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<msubsup>
<mi>R</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>34</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>0</mn>
<mn>31</mn>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>31</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>)</mo>
</mrow>
<msub>
<mi>v</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>n</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
</mrow>
<mn>31</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<msubsup>
<mi>T</mi>
<mrow>
<mi>m</mi>
<mn>0</mn>
<mi>j</mi>
</mrow>
<mn>34</mn>
</msubsup>
<mo>=</mo>
<mn>0</mn>
</mrow>
6
其中,1≤j≤k,k为≥3的自然数,为在机械臂末端坐标系下初始位姿点的第三标定平面P3的单位法向量,在步骤e)中已经得到,对于每一次的旋转平移,分别列出约束方程,一共k个约束方程,k个约束方程联立得到由第三标定平面P3求得的平移向量r3。
3.如权利要求1所述的标定方法,其特征在于,步骤3)中,优化计算平移向量r和激光束的单位方向向量v,具体包括以下步骤:
a)设定初始值:
对三个标定平面分别求得的平移向量取平均得到优化算法的平移向量r的初始值,即r的初始值为同理求得激光束的单位方向向量v的初始值,即v的初始值为
b)确定约束条件:
使用多个有约束的线性最小二乘法组成的非线性最小化算法,线性约束条件是非线性约束条件是标定平面的单位法向量的第三个分量大于零,即
c)确定目标函数:
算法的目标函数为f=f1+f2+f3,其中f1为与第一标定平面P1相关的约束函数,f2为与第二标定平面P2相关的约束函数,f3为与第三标定平面P3相关的约束函数;
d)迭代计算:
不断的迭代更新r,v,直至满足给定的收敛条件为止;
与第一标定平面P1相关的约束函数表示为f1=f11+f12+f13+f14,其中X11为步骤2)的a)的ii)中测量得到的点组成的矩阵,即 为X11使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X12为步骤2)的a)的iv)中测量得到的点组成的矩阵,即 为X12使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X13为步骤2)的a)的vi)中测量得到的点组成的矩阵,即 为X13使用主成分分析方法得到的主平面上对应的点组成的矩阵;X14为步骤2)的b)中测量得到的点组成的矩阵,即 为X14使用主成分分析方法得到的主平面上对应的点组成的矩阵;
同样,与第二标定平面P2相关的函数f2=f21+f22+f23+f24,其中,X21为步骤2)的c)的ii)中测量得到的点组成的矩阵,即 为X21使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X22为步骤2)的c)的iv)中测量得到的点组成的矩阵,即 为X22使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X23为步骤2)的c)的vi)中测量得到的点组成的矩阵,即 为X23使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X24为步骤2)的d)中测量得到的点组成的矩阵,即 为X24使用主成分分析方法得到的主平面上对应的点组成的矩阵;
同样,与第三标定平面P3相关的函数f3=f31+f32+f33+f34,其中,X31为步骤2)的e)的ii)中测量得到的点组成的矩阵,即 为X31使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X32为步骤2)的e)的iv)中测量得到的点组成的矩阵,即 为X32使用主成分分析方法得到的主平面上对应的点组成的矩阵;
X33为步骤2)的e)的vi)中测量得到的点组成的矩阵,即 为X33使用主成分分析方法得到的主平面上对应的点组成的矩阵;
其中的X34为步骤2)的f)中测量得到的点组成的矩阵,即 为X34使用主成分分析方法得到的主平面上对应的点组成的矩阵;
当算法收敛停止迭代后,得到优化的激光束的单位方向向量v和平移向量r。
4.如权利要求1所述的标定方法,其特征在于,进一步,在完成空间变换关系标定后,激光测距仪测量空间中的第j位置的点,在得到它的距离dj和这时的机械臂的控制器中的读出的机械臂末端坐标系相对于机械臂坐标系的旋转矩阵Rbj和平移列向量Tbj,由xbj=Rbjxmj+Tbj=Rbj(r+djv)+Tbj,求得该点在机械臂坐标系下的空间坐标值xbj,采集多个需要测量的三维空间点,从而完成三维空间点的测量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510953856.5A CN105444672B (zh) | 2015-12-17 | 2015-12-17 | 激光测距仪和机械臂末端关系的正交平面标定方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510953856.5A CN105444672B (zh) | 2015-12-17 | 2015-12-17 | 激光测距仪和机械臂末端关系的正交平面标定方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105444672A CN105444672A (zh) | 2016-03-30 |
CN105444672B true CN105444672B (zh) | 2017-10-17 |
Family
ID=55555151
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510953856.5A Active CN105444672B (zh) | 2015-12-17 | 2015-12-17 | 激光测距仪和机械臂末端关系的正交平面标定方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105444672B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106568381B (zh) * | 2016-10-25 | 2019-05-24 | 西北工业大学 | 一种基于标准平面的线激光测量***标定方法 |
CN106426172B (zh) * | 2016-10-27 | 2019-04-16 | 深圳元启智能技术有限公司 | 一种工业机器人工具坐标系的标定方法与*** |
CN107817682B (zh) * | 2017-10-20 | 2021-02-09 | 北京控制工程研究所 | 一种基于手眼相机的空间机械臂在轨标定方法及*** |
CN109658460A (zh) * | 2018-12-11 | 2019-04-19 | 北京无线电测量研究所 | 一种机械臂末端相机手眼标定方法和*** |
CN109655024B (zh) * | 2019-01-24 | 2020-05-19 | 大连理工大学 | 采用空间变换技术的位移传感器外部参数标定方法 |
CN109765567B (zh) * | 2019-02-12 | 2023-05-16 | 华北水利水电大学 | 基于长方体标定物的二维激光测距仪定位方法 |
CN110296680B (zh) * | 2019-06-11 | 2020-11-24 | 清华大学 | 机器人抓取货品的姿态测量方法和*** |
CN110340738B (zh) * | 2019-06-21 | 2020-05-22 | 武汉理工大学 | 一种基于pca的机器人拉丝高铁白车身工件精确标定方法 |
CN111336919B (zh) * | 2020-03-11 | 2021-10-15 | 上海嘉奥信息科技发展有限公司 | 探针标定的方法 |
CN112549018B (zh) * | 2020-11-03 | 2021-11-30 | 武汉数字化设计与制造创新中心有限公司 | 一种机器人线激光快速手眼标定方法 |
CN113662669A (zh) * | 2021-08-30 | 2021-11-19 | 华南理工大学 | 一种光力融合末端夹持器及其定位控制方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1831468A (zh) * | 2005-03-10 | 2006-09-13 | 新奥博为技术有限公司 | 激光扫描器与机器人的相对位置的标定方法 |
CN101581575A (zh) * | 2009-06-19 | 2009-11-18 | 南昌航空大学 | 基于激光和摄像机数据融合的三维重建方法 |
CN102062576A (zh) * | 2010-11-12 | 2011-05-18 | 浙江大学 | 基于激光跟踪测量的附加外轴机器人自动标定装置及方法 |
CN102607411A (zh) * | 2012-03-06 | 2012-07-25 | 上海大学 | 机器人末端位姿测量装置 |
CN103389114A (zh) * | 2013-07-23 | 2013-11-13 | 中国兵器工业集团第二一四研究所苏州研发中心 | 基于g敏感性的三轴MEMS陀螺非正交误差标定方法 |
CN103759716A (zh) * | 2014-01-14 | 2014-04-30 | 清华大学 | 基于机械臂末端单目视觉的动态目标位置和姿态测量方法 |
CN104596418A (zh) * | 2014-08-12 | 2015-05-06 | 清华大学 | 一种多机械臂***坐标系标定及精度补偿方法 |
CN104596420A (zh) * | 2015-01-26 | 2015-05-06 | 北京卫星环境工程研究所 | 激光跟踪仪测量基准立方镜中心点位置的精测方法 |
CN105014678A (zh) * | 2015-07-16 | 2015-11-04 | 深圳市得意自动化科技有限公司 | 基于激光测距的机器人手眼标定方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102294695A (zh) * | 2010-06-25 | 2011-12-28 | 鸿富锦精密工业(深圳)有限公司 | 机器人标定方法及标定*** |
-
2015
- 2015-12-17 CN CN201510953856.5A patent/CN105444672B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1831468A (zh) * | 2005-03-10 | 2006-09-13 | 新奥博为技术有限公司 | 激光扫描器与机器人的相对位置的标定方法 |
CN101581575A (zh) * | 2009-06-19 | 2009-11-18 | 南昌航空大学 | 基于激光和摄像机数据融合的三维重建方法 |
CN102062576A (zh) * | 2010-11-12 | 2011-05-18 | 浙江大学 | 基于激光跟踪测量的附加外轴机器人自动标定装置及方法 |
CN102607411A (zh) * | 2012-03-06 | 2012-07-25 | 上海大学 | 机器人末端位姿测量装置 |
CN103389114A (zh) * | 2013-07-23 | 2013-11-13 | 中国兵器工业集团第二一四研究所苏州研发中心 | 基于g敏感性的三轴MEMS陀螺非正交误差标定方法 |
CN103759716A (zh) * | 2014-01-14 | 2014-04-30 | 清华大学 | 基于机械臂末端单目视觉的动态目标位置和姿态测量方法 |
CN104596418A (zh) * | 2014-08-12 | 2015-05-06 | 清华大学 | 一种多机械臂***坐标系标定及精度补偿方法 |
CN104596420A (zh) * | 2015-01-26 | 2015-05-06 | 北京卫星环境工程研究所 | 激光跟踪仪测量基准立方镜中心点位置的精测方法 |
CN105014678A (zh) * | 2015-07-16 | 2015-11-04 | 深圳市得意自动化科技有限公司 | 基于激光测距的机器人手眼标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105444672A (zh) | 2016-03-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105444672B (zh) | 激光测距仪和机械臂末端关系的正交平面标定方法及*** | |
CN107738254B (zh) | 一种机械臂坐标系的转换标定方法与*** | |
CN109655024B (zh) | 采用空间变换技术的位移传感器外部参数标定方法 | |
CN109859275B (zh) | 一种基于s-r-s结构的康复机械臂的单目视觉手眼标定方法 | |
CN106457562B (zh) | 用于校准机器人的方法和机器人*** | |
CN110202575B (zh) | 一种用于工业测量的机器人目标轨迹精度补偿方法 | |
US11072074B2 (en) | Calibration and operation of vision-based manipulation systems | |
CN108324373B (zh) | 一种基于电磁定位***的穿刺手术机器人精确定位实现方法 | |
CN110370316B (zh) | 一种基于垂直反射的机器人tcp标定方法 | |
CN113386136B (zh) | 一种基于标准球阵目标估计的机器人位姿矫正方法及*** | |
WO2016074646A1 (zh) | 一种工具在机器人法兰坐标系上的标定方法及装置 | |
CN109895094B (zh) | 一种工业机器人测量轨迹定位误差分析方法及*** | |
CN105318838B (zh) | 激光测距仪和机械臂末端关系的单平面标定方法 | |
WO2015070010A1 (en) | Calibration system and method for calibrating industrial robot | |
CN110253574A (zh) | 一种多任务机械臂位姿检测和误差补偿方法 | |
CN110883774A (zh) | 机器人关节角零位标定***、方法及存储介质 | |
CN114343847B (zh) | 基于光学定位***的手术机器人的手眼标定方法 | |
CN112767493B (zh) | Stewart平台运动学参数的机器视觉标定方法 | |
CN113843792B (zh) | 一种手术机器人的手眼标定方法 | |
CN115546289A (zh) | 一种基于机器人的复杂结构件三维形貌测量方法 | |
CN113211445A (zh) | 一种机器人参数标定方法、装置、设备及存储介质 | |
Shen et al. | Automatic camera calibration for a multiple-sensor integrated coordinate measurement system | |
CN114654466B (zh) | 自动标定方法、装置、***、电子设备及存储介质 | |
Santolaria et al. | Self-alignment of on-board measurement sensors for robot kinematic calibration | |
CN114029982A (zh) | 一种相机在机器臂外的手眼标定装置及其标定方法 |
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 |