CN104132616B - 激光测量机器人的手眼标定方法及系统 - Google Patents
激光测量机器人的手眼标定方法及系统 Download PDFInfo
- Publication number
- CN104132616B CN104132616B CN201410408307.5A CN201410408307A CN104132616B CN 104132616 B CN104132616 B CN 104132616B CN 201410408307 A CN201410408307 A CN 201410408307A CN 104132616 B CN104132616 B CN 104132616B
- Authority
- CN
- China
- Prior art keywords
- search
- arc radius
- robot
- region
- laser
- 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
- 238000005259 measurement Methods 0.000 title claims abstract description 27
- 230000000875 corresponding Effects 0.000 claims abstract description 26
- 239000011159 matrix material Substances 0.000 claims abstract description 18
- 230000001131 transforming Effects 0.000 claims abstract description 15
- 238000003379 elimination reaction Methods 0.000 claims abstract description 10
- 238000000034 method Methods 0.000 description 8
- 230000000052 comparative effect Effects 0.000 description 4
- 238000004321 preservation Methods 0.000 description 3
- 238000005457 optimization Methods 0.000 description 2
- 241001269238 Data Species 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000003287 optical Effects 0.000 description 1
Abstract
本发明提供一种激光测量机器人的手眼标定方法及系统,所述方法包括:接收激光数据,获取初始位置下,靶球的圆弧半径R0;以及机器人分别沿X方向、Y方向、Z方向平移微小步长后靶球的圆弧半径Rx,Ry,Rz;根据上述圆弧半径确认本次搜索方向;以及确认圆弧半径R的搜索区间;采用区间消去法逐渐减小搜索区间;在所述搜索区间内,判断当前圆弧半径R是否满足如下关系:若是,对应获取圆弧半径为R的圆弧圆心坐标,以及机器人的位置姿态信息;并将其形成一个共轭对,求取多个共轭对,并根据其求解变换矩阵,完成手眼标定。本发明使手眼标定结果更加准确,实现方法简单,自动化程度高,同时,该系统实用性强,可广泛应用于工业测量。
Description
技术领域
本发明涉及一种激光测量机器人的手眼标定方法及系统,主要应用于工业测量技术领域。
背景技术
激光测量机器人是指工业机器人搭载成品化的激光器组成的机器人视觉测量系统,该系统用于工业零部件的形位尺寸检测。目前,最常见的机器人视觉测量系统的组成方式是六自由度工业机器人搭载2D激光器,其中2D激光器输出的数据是光平面上的被测物体的二维数据,2D激光器有厂家内置的坐标系。当2D激光器固定到工业机器人末端手臂上之后,不考虑环境因素影响的话,激光器坐标系与工业机器人末端法兰坐标系的相对变换矩阵就唯一确定,且激光器拆卸再安装前不会改变。
手眼标定,即2D激光器坐标系与工业机器人末端法兰坐标系的相对变换矩阵的确定,往往通过一个半径已知的高精度靶球,理想情况下机器人以不同的位置姿态使激光器恰好输出靶球球心所在的最大圆弧,通过圆拟合可求出最大圆弧的圆心,即球心,此时机器人位置姿态信息与靶球球心坐标即组成一个共轭对,然后建立多个共轭对,并以球心相对于机器人基坐标系位置不变作为约束,即可求解激光器坐标系与工业机器人末端法兰坐标系的相对变换矩阵。
而实际标定中很难人为控制机器人使激光器恰好能输出靶球球心所在的最大圆弧,目前做法通常是输出靶球某一圆弧,该圆弧半径与靶球半径、该圆弧圆心与靶球球心距离构成直角三角形,通过计算该圆弧圆心与靶球球心距离得到靶球球心的坐标。然而,该方法不能准确建立机器人位置姿态信息与靶球球心坐标的对应关系,现有方法建立的对应关系并不是机器人位置姿态信息与靶球球心坐标对应关系的真实反映,进一步的,导致手眼标定结果不够精准。
发明内容
为了解决上述问题,本发明的目的在于提供一种激光测量机器人的手眼标定方法及系统;该方法及系统可以控制机器人运动使激光器恰好输出靶球球心所在的最大圆弧,进而准确建立机器人真实位置姿态与靶球球心坐标的对应关系,使手眼标定结果更加准确。
相应的,本发明一实施方式的激光测量机器人的手眼标定方法,所述方法包括以下步骤:
S1、将激光投射到靶球表面形成激光数据;
S2、接收所述激光数据,获取初始位置下,所述靶球的圆弧半径R0;
S3、基于机器人的基坐标系,以上述初始位置为基点,所述机器人分别沿X方向、Y方向、Z方向平移微小步长后,分别获取并记录X方向、Y方向、Z方向对应的靶球的圆弧半径Rx,Ry,Rz;
S4、将Rx,Ry,Rz分别与R0进行大小比较,根据其比较结果,确认本次搜索方向,并沿着当前搜索方向,确认圆弧半径R的搜索区间;
S5、采用区间消去法逐渐减小搜索区间;
S6、在所述搜索区间内,判断当前圆弧半径R是否满足如下关系:
其中,r为靶球半径,R为实时获取的圆弧半径,为系统预设阈值;
若是,获取当前状态下,对应圆弧半径为R的圆弧圆心坐标,以及机器人的位置姿态信息;记录机器人的位置姿态信息和所获取的圆弧圆心坐标,并将其形成一个共轭对;
若否,返回步骤S5;
S7、根据所述共轭对信息,求解变换矩阵,完成手眼标定。
作为本发明的进一步改进,所述方法还包括以下步骤:接收激光投射到靶球表面的圆弧离散点数据,通过圆拟合计算所述圆弧半径R0、Rx,Ry,Rz。
作为本发明的进一步改进,所述步骤S4具体包括:将圆弧半径Rx,Ry,Rz分别与R0进行比较,选择圆弧半径变化最大的坐标轴方向作为本次搜索方向。
作为本发明的进一步改进,所述步骤S4具体包括:沿着当前搜索方向,通过外推法确认圆弧半径R的搜索区间,所述搜索区间按照圆弧半径小-大-小的位置关系确定。
作为本发明的进一步改进,所述步骤S7具体包括:调整机器人到不同的位置姿态,重复步骤S1至S6,得到N个所述共轭对;
判断N是否大于第二系统阈值;
若是,求解变换矩阵,完成手眼标定;
若否,回到步骤S1。
相应地,本发明一实施方式的激光测量机器人的手眼标定方法系统,所述系统包括:激光发射单元,所述激光发射单元用于将激光投射到靶球表面形成激光数据;
数据处理单元,所述数据处理单元用于接收所述激光数据,获取初始位置下,所述靶球的圆弧半径R0;
基于机器人的基坐标系,以上述初始位置为基点,控制所述机器人分别沿X方向、Y方向、Z方向平移微小步长后,分别获取并记录X方向、Y方向、Z方向对应的靶球的圆弧半径Rx,Ry,Rz;
将Rx,Ry,Rz分别与R0进行大小比较,根据其比较结果,确认本次搜索方向,并沿着当前搜索方向,确认圆弧半径R的搜索区间;
采用区间消去法逐渐减小搜索区间;
在所述搜索区间内,判断当前圆弧半径R是否满足如下关系:
其中,r为靶球半径,R为实时获取的圆弧半径,为系统预设阈值;
若是,获取当前状态下,对应圆弧半径为R的圆弧圆心坐标,以及机器人的位置姿态信息;记录机器人的位置姿态信息和所获取的圆弧圆心坐标,并将其形成一个共轭对;
若否,继续沿着当前搜索方向,采用区间消去法逐渐减小搜索区间;
根据所述共轭对信息,求解变换矩阵,完成手眼标定。
作为本发明的进一步改进,所述数据处理单元还用于,接收激光投射到靶球表面的圆弧离散点数据,通过圆拟合计算所述圆弧半径R0、Rx,Ry,Rz。
作为本发明的进一步改进,所述数据处理单元还用于,将圆弧半径Rx,Ry,Rz分别与R0进行比较,选择圆弧半径变化最大的坐标轴方向作为本次搜索方向。
作为本发明的进一步改进,所述数据处理单元还用于,沿着当前搜索方向,通过外推法确认圆弧半径R的搜索区间,所述搜索区间按照圆弧半径小-大-小的位置关系确定。
作为本发明的进一步改进,所述数据处理单元还用于,调整机器人到不同的位置姿态,重复获得N个所述共轭对;
判断N是否大于第二系统阈值;
若是,求解变换矩阵,完成手眼标定;
若否,继续调整机器人到不同的位置姿态,重复获得下一个所述共轭对。
与现有技术相比,本发明的激光测量机器人的手眼标定方法及系统,该方法及系统可以控制机器人运动使激光器恰好输出靶球球心所在的最大圆弧,进而准确建立机器人真实位置姿态与靶球球心坐标的对应关系,使手眼标定结果更加准确,实现方法简单,自动化程度高,同时,该系统实用性强,可广泛应用于工业测量。
附图说明
图1是本发明一实施方式中激光测量机器人的手眼标定方法的流程图;
图2是本发明一实施方式中确定圆弧半径搜索区间过程示意图;
图3是本发明一实施方式中激光测量机器人的手眼标定系统的结构示意图。
具体实施方式
以下将结合附图所示的各实施方式对本发明进行详细描述。但这些实施方式并不限制本发明,本领域的普通技术人员根据这些实施方式所做出的结构、方法、或功能上的变换均包含在本发明的保护范围内。
如图1所示,在本发明一实施方式中激光测量机器人的手眼标定方法,所述方法包括以下步骤:
S1、将激光投射到靶球表面形成激光数据。
相应的,借助人工,手动调整机器人的位置,进而使机器人带动激光器运动将激光投射在靶球上。
优选的,在本发明的优选实施方式中,所述机器人为6自由度机器人,所述激光器为2D激光器。
优选的,激光投射到靶球上的位置没有具体限定,然而,由于本发明最终所要获取的结果与通过该圆心坐标的最大圆弧相关,相应的,为了缩短优化过程,以及提高收敛度,故,激光第一次投射到靶球上的位置,应尽可能的靠近通过所述靶球圆心坐标的最大圆弧处。
S2、接收所述激光数据,获取初始位置下,所述靶球的圆弧半径R0。
具体的,接收激光投射到靶球表面的圆弧离散点数据,通过圆拟合计算所述圆弧半径R0,并记录所述圆弧半径R0的数值。
所述初始位置为激光初次投射到靶球表面的位置。
S3、基于机器人的基坐标系,以上述初始位置为基点,所述机器人分别沿X方向、Y方向、Z方向平移微小步长后,分别获取并记录X方向、Y方向、Z方向对应的靶球的圆弧半径Rx,Ry,Rz。
具体的,沿着机器人基坐标系的X方向、Y方向、Z方向,分别平移数值相等的微小步长,并记录平移微小步长后,X方向、Y方向、Z方向上分别对应的靶球圆弧半径Rx,Ry,Rz。
进一步的,机器人每次沿X方向、Y方向、Z方向平移微小步长,获取圆弧半径Rx,Ry,Rz后,所述机器人均退回到初始位置;以优化计算过程,缩短计算时间。
相应的,按照获取R0的数值的方法,接收激光投射到靶球表面的圆弧离散点数据,通过圆拟合计算所述圆弧半径Rx,Ry,Rz,并记录所述圆弧半径Rx,Ry,Rz的数值。
S4、将Rx,Ry,Rz分别R0的进行大小比较,根据其比较结果,确认本次搜索方向,并沿着当前搜索方向,确认圆弧半径R的搜索区间。
具体的,将圆弧半径Rx,Ry,Rz分别与R0进行比较,选择圆弧半径变化最大的坐标轴方向作为本次搜索方向;
相应的,将Rx与R0的差值的绝对值、将Ry与R0的差值的绝对值、将Rz与R0的差值的绝对值进行大小比较,选择相较于R0变化最大的圆弧半径所在方向为本次搜索方向。
进一步,判断本次搜索方向上的圆弧半径是否大于初始位置的圆弧半径;若是,沿着与机器人前次平移方向的同一方向确认圆弧半径R的搜索区间;若否,沿着与机器人前次平移方向的相反方向确认圆弧半径R的搜索区间。
为了更清楚的描述本发明的技术方案,以下将列举一具体实施例描述步骤S4,需要说明的是,本具体实施例并不能用来限制本发明,在此不做详细赘述。
具体的,在将Rx,Ry,Rz分别R0的进行大小比较后,假设,确认Rx与R0的差值绝对值最大,此时,确认当前的搜索方向为,相对于机器人基坐标系的X方向;进一步,判断Rx是否大于R0,若是,确认搜索方向与获取Rx时的平移方向相同,若否,确认搜索方向与获取Rx时的平移方向相反。
具体的,沿着当前搜索方向,通过外推法确认圆弧半径R的搜索区间,所述搜索区间按照圆弧半径小-大-小的位置关系确定。
为了更清楚的描述本发明的技术方案,以下将列举一具体实施例描述步骤S5,需要说明的是,本具体实施例并不能用来限制本发明,在此不做详细赘述。
结合图2所示,沿着当前搜索方向,假设获得第一个位置下激光器输出的圆弧半径为r1,第二个位置下圆弧半径为r2,第三个位置下圆弧半径为r3,则上述圆弧半径满足如下关系:r1<r2>r3,此时,确定靶球球心所在的圆弧在r1所在位置和r3所在位置之间。上述搜索过程即为所述搜索区间按照圆弧半径小-大-小的位置关系确定。需要说明的是,图2中箭头所示方向为当前搜索方向,该箭头指示方向仅仅是示意性的标识,在实际应用中,所述搜索方向根据计算结果确定,在此不做详细赘述。
S5、采用区间消去法逐渐减小搜索区间。
相应的,采用区间消去规则减小搜索区间;即在上一次的搜索方向上及搜索区间内,使机器人往复运动,减小搜索区间。
S6、在所述搜索区间内,判断当前圆弧半径R是否满足如下关系: 其中,r为靶球半径,R为实时获取的圆弧半径,为系统预设阈值;
若是,获取当前状态下,对应圆弧半径为R的圆弧圆心坐标,以及机器人的位置姿态信息;并记录机器人的位置姿态信息和所获取的圆弧圆心坐标,将其形成一个共轭对;以供后续计算使用。
若否,返回步骤S5;
相应的,的取值范围并没有具体限定,其取值标准可根据需要,具体设定,可以理解的是,取值越小,其计算结果更加精准,在此不做详细赘述。
相应的,所述机器人的位置姿态信息也被称为:所述机器人各关节的码盘数,或所述机器人末端法兰坐标系相对于基坐标系的变换关系。
S7、根据所述共轭对信息,求解变换矩阵,完成手眼标定。
相应的,在所述机器人形成当前共轭对的最终姿态的基础上,人工控制机器人至下一个位置姿态,或机器人自动调整至下一个位置姿态,重复步骤S1至步骤S6的过程,并在不同的位置姿态上,形成后续所需要的多个共轭对,同时,对获取的多个共轭对进行保存。
具体的,控制机器人至不同的位置姿态后,重复步骤S1至S6,得到N个所述共轭对;
判断N是否大于第二系统阈值;
若是,求解变换矩阵,完成手眼标定;若否,控制机器人在形成前一个共轭对的最终位置姿态基础上,控制机器人至下一个位置姿态,并重新开始进行步骤S1。
具体的,根据N个共轭对,计算出2D激光器坐标系与机器人位置姿态信息相对变换矩阵,完成手眼标定。
需要说明的是,所述第二系统阈值的数值没有具体限定,一般情况下,所述第二系统阈值的数值越大,最终所要获取的结果更加准确。
相应的,所述位置姿态的确定,尽可能的在不同的方向使激光投射到靶球上,进而计算出对应靶球各个方向上对应的多个所述共轭对的信息。
与现有技术相比,本发明的激光测量机器人的手眼标定方法,该方法及系统可以控制机器人运动使激光器恰好输出靶球球心所在的最大圆弧,进而准确建立机器人真实位置姿态与靶球球心坐标的对应关系,使手眼标定结果更加准确,实现方法简单,自动化程度高,同时,该系统实用性强,可广泛应用于工业测量。
相应的,结合图3所示,图3是本发明一实施方式中激光测量机器人的手眼标定系统的结构示意图。
相应的,所述系统包括:激光发射单元100,数据处理单元200。
激光发射单元100,激光发射单元100用于将激光投射到靶球表面形成激光数据;
相应的,借助人工,手动调整机器人的位置,进而使机器人带动激光器运动,激光发射单元100将激光投射在靶球上。
优选的,在本发明的优选实施方式中,所述机器人为6自由度机器人,所述激光器为2D激光器。
优选的,激光发射单元100将激光投射到靶球上的位置没有具体限定,然而,由于本发明最终所要获取的结果与通过该圆心坐标的最大圆弧相关,相应的,为了缩短优化过程,以及提高收敛度,故,激光第一次投射到靶球上的位置,应尽可能的靠近通过所述靶球圆心坐标的最大圆弧处。
数据处理单元200,数据处理单元200用于接收所述激光数据,获取初始位置下,所述靶球的圆弧半径R0;
具体的,数据处理单元200用于接收激光投射到靶球表面的圆弧离散点数据,通过圆拟合计算所述圆弧半径R0,并记录所述圆弧半径R0的数值。
所述初始位置为激光初次投射到靶球表面的位置。
数据处理单元200用于基于机器人的基坐标系,以上述初始位置为基点,控制所述机器人分别沿X方向、Y方向、Z方向平移微小步长后,分别获取并记录X方向、Y方向、Z方向对应的靶球的圆弧半径Rx,Ry,Rz。
具体的,数据处理单元200控制机器人沿其基坐标系的X方向、Y方向、Z方向,分别平移数值相等的微小步长,并记录平移微小步长后,X方向、Y方向、Z方向上分别对应的靶球圆弧半径Rx,Ry,Rz。
进一步的,数据处理单元200控制机器人每次沿X方向、Y方向、Z方向平移微小步长,获取圆弧半径Rx,Ry,Rz后,均控制所述机器人均退回到初始位置;以优化计算过程,缩短计算时间。
相应的,数据处理单元200按照获取R0的数值的方法,接收激光投射到靶球表面的圆弧离散点数据,通过圆拟合计算所述圆弧半径Rx,Ry,Rz,并记录所述圆弧半径Rx,Ry,Rz的数值。
数据处理单元200将Rx,Ry,Rz分别R0的进行大小比较,根据其比较结果,确认本次搜索方向,并沿着当前搜索方向,确认圆弧半径R的搜索区间。
具体的,数据处理单元200将圆弧半径Rx,Ry,Rz分别与R0进行比较,选择圆弧半径变化最大的坐标轴方向作为本次搜索方向。
相应的,数据处理单元200将Rx与R0的差值的绝对值、将Ry与R0的差值的绝对值、将Rz与R0的差值的绝对值进行大小比较,选择相较于R0变化最大的圆弧半径所在方向为本次搜索方向。
进一步,数据处理单元200判断本次搜索方向上的圆弧半径是否大于初始位置的圆弧半径;
若是,沿着与机器人前次平移方向的同一方向确认圆弧半径R的搜索区间;
若否,沿着与机器人前次平移方向的相反方向确认圆弧半径R的搜索区间。
为了更清楚的描述本发明的技术方案,以下将列举一具体实施例描述步骤S4,需要说明的是,本具体实施例并不能用来限制本发明,在此不做详细赘述。
具体的,数据处理单元200在将Rx,Ry,Rz分别R0的进行大小比较后,假设,确认Rx与R0的差值绝对值最大,此时,确认当前的搜索方向为,相对于机器人基坐标系的X方向;进一步,数据处理单元200判断Rx是否大于R0,若是,确认搜索方向与获取Rx时的平移方向相同,若否,确认搜索方向与获取Rx时的平移方向相反。
数据处理单元200沿着当前搜索方向,确认圆弧半径R的搜索区间。
具体的,数据处理单元200沿着当前搜索方向,通过外推法确认圆弧半径R的搜索区间,所述搜索区间按照圆弧半径小-大-小的位置关系确定。
为了更清楚的描述本发明的技术方案,以下将列举一具体实施例详细描述,需要说明的是,本具体实施例并不能用来限制本发明,在此不做详细赘述。
结合图2所示,数据处理单元200沿着当前搜索方向,假设获得第一个位置下激光器输出的圆弧半径为r1,第二个位置下圆弧半径为r2,第三个位置下圆弧半径为r3,则上述圆弧半径满足如下关系:r1<r2>r3,此时,确定靶球球心所在的圆弧在r1所在位置和r3所在位置之间。上述搜索过程即为所述搜索区间按照圆弧半径小-大-小的位置关系确定。需要说明的是,图2中箭头所示方向为当前搜索方向,该箭头指示方向仅仅是示意性的标识,在实际应用中,所述搜索方向根据计算结果确定,在此不做详细赘述。
相应的,数据处理单元200采用区间消去规则减小搜索区间;即在上一次的搜索方向上及搜索区间内,使机器人往复运动,减小搜索区间。
数据处理单元200在所述搜索区间内,判断当前圆弧半径R是否满足如下关系:其中,r为靶球半径,R为实时获取的圆弧半径,为系统预设阈值;
若是,数据处理单元200获取当前状态下,对应圆弧半径为R的圆弧圆心坐标,以及机器人的位置姿态信息;记录机器人的位置姿态信息和所获取的圆弧圆心坐标,并将其形成一个共轭对;
若否,数据处理单元200继续沿着当前搜索方向,进一步减小搜索区间。
相应的,的取值范围并没有具体限定,其取值标准可根据需要,具体设定,可以理解的是,取值越小,其计算结果更加精准,在此不做详细赘述。
相应的,所述机器人的位置姿态信息也被称为:所述机器人各关节的码盘数,或所述机器人末端法兰坐标系相对于基坐标系的变换关系。
数据处理单元200根据所述共轭对信息,求解变换矩阵,完成手眼标定。
相应的,数据处理单元200在所述机器人形成当前共轭对的最终姿态的基础上,控制机器人至下一个位置姿态,并在不同的位置姿态上,形成后续所需要的多个共轭对,同时,对获取的多个共轭对进行保存。当然,也可以通过人工控制所述机器人至下一位置姿态,在此不做详细赘述。
具体的,数据处理单元200控制机器人至不同的位置姿态后,得到N个所述共轭对;
判断N是否大于第二系统阈值;若是,求解变换矩阵,完成手眼标定;若否,数据处理单元200在形成前一个共轭对的最终位置姿态基础上,控制机器人至下一个位置姿态,,获得当前位置姿态下的共轭对。
具体的,数据处理单元200根据N个共轭对,计算出2D激光器坐标系与机器人位置姿态信息相对变换矩阵,完成手眼标定。
需要说明的是,所述第二系统阈值的数值没有具体限定,一般情况下,所述第二系统阈值的数值越大,最终所要获取的结果更加准确。
相应的,所述位置姿态的确定,尽可能的在不同的方向使激光投射到靶球上,进而计算出对应靶球各个方向上对应的多个所述共轭对的信息。
与现有技术相比,本发明的激光测量机器人的手眼标定方法及系统,该方法及系统可以控制机器人运动使激光器恰好输出靶球球心所在的最大圆弧,进而准确建立机器人真实位置姿态与靶球球心坐标的对应关系,使手眼标定结果更加准确,实现方法简单,自动化程度高,同时,该系统实用性强,可广泛应用于工业测量。
为了描述的方便,描述以上装置时以功能分为各种模块分别描述。当然,在实施本申请时可以把各模块的功能在同一个或多个软件和/或硬件中实现。
通过以上的实施方式的描述可知,本领域的技术人员可以清楚地了解到本申请可借助软件加必需的通用硬件平台的方式来实现。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以保存在保存介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,信息推送服务器,或者网络设备等)执行本申请各个实施方式或者实施方式的某些部分所述的方法。
以上所描述的装置实施方式仅仅是示意性的,其中所述作为分离部件说明的模块可以是或者也可以不是物理上分开的,作为模块显示的部件可以是或者也可以不是物理模块,即可以位于一个地方,或者也可以分布到多个网络模块上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施方式方案的目的。本领域普通技术人员在不付出创造性劳动的情况下,即可以理解并实施。
本申请可用于众多通用或专用的计算系统环境或配置中。例如:个人计算机、信息推送服务器计算机、手持设备或便携式设备、平板型设备、多处理模块系统、基于微处理模块的系统、置顶盒、可编程的消费电子设备、网络PC、小型计算机、大型计算机、包括以上任何系统或设备的分布式计算环境等等。
本申请可以在由计算机执行的计算机可执行指令的一般上下文中描述,例如程序模块。一般地,程序模块包括执行特定任务或实现特定抽象数据类型的例程、程序、对象、组件、数据结构等等。也可以在分布式计算环境中实践本申请,在这些分布式计算环境中,由通过通信网络而被连接的远程处理设备来执行任务。在分布式计算环境中,程序模块可以位于包括保存设备在内的本地和远程计算机保存介质中。
应当理解,虽然本说明书按照实施方式加以描述,但并非每个实施方式仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施方式中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。
上文所列出的一系列的详细说明仅仅是针对本发明的可行性实施方式的具体说明,它们并非用以限制本发明的保护范围,凡未脱离本发明技艺精神所作的等效实施方式或变更均应包含在本发明的保护范围之内。
Claims (6)
1.一种激光测量机器人的手眼标定方法,其特征在于,所述方法包括以下步骤:
S1、将激光投射到靶球表面形成激光数据;
S2、接收所述激光数据,获取初始位置下,所述靶球的圆弧半径R0;
S3、基于机器人的基坐标系,以上述初始位置为基点,所述机器人分别沿X方向、Y方向、Z方向平移微小步长后,分别获取并记录X方向、Y方向、Z方向对应的靶球的圆弧半径Rx,Ry,Rz;
S4、将圆弧半径Rx,Ry,Rz分别与R0进行比较,选择圆弧半径变化最大的坐标轴方向作为本次搜索方向;沿着当前搜索方向,通过外推法确认圆弧半径R的搜索区间,所述搜索区间按照圆弧半径小-大-小的位置关系确定;
S5、采用区间消去法逐渐减小搜索区间;所述区间消去法为在上一次的搜索方向上及搜索区间内,使机器人往复运动,减小搜索区间;
S6、在所述搜索区间内,判断当前圆弧半径R是否满足如下关系:
其中,r为靶球半径,R为实时获取的圆弧半径,为系统预设阈值;
若是,获取当前状态下,对应圆弧半径为R的圆弧圆心坐标,以及机器人的位置姿态信息;记录机器人的位置姿态信息和所获取的圆弧圆心坐标,将其形成一个共轭对;
若否,返回步骤S5;
S7、根据所述共轭对信息,求解变换矩阵,完成手眼标定。
2.根据权利要求1所述的激光测量机器人的手眼标定方法,其特征在于,所述方法还包括以下步骤:
接收激光投射到靶球表面的圆弧离散点数据,通过圆拟合计算所述圆弧半径R0、Rx,Ry,Rz。
3.根据权利要求1或2所述的激光测量机器人的手眼标定方法,其特征在于,所述步骤S7具体包括:
调整机器人到不同的位置姿态,重复步骤S1至S6,得到N个所述共轭对;
判断N是否大于第二系统阈值;
若是,求解变换矩阵,完成手眼标定;
若否,继续调整机器人到不同的位置姿态,并回到步骤S1。
4.一种激光测量机器人的手眼标定系统,其特征在于,所述系统包括:
激光发射单元,所述激光发射单元用于将激光投射到靶球表面形成激光数据;
数据处理单元,所述数据处理单元用于接收所述激光数据,获取初始位置下,所述靶球的圆弧半径R0;
基于机器人的基坐标系,以上述初始位置为基点,控制所述机器人分别沿X方向、Y方向、Z方向平移微小步长后,分别获取并记录X方向、Y方向、Z方向对应的靶球的圆弧半径Rx,Ry,Rz;
将圆弧半径Rx,Ry,Rz分别与R0进行比较,选择圆弧半径变化最大的坐标轴方向作为本次搜索方向;沿着当前搜索方向,通过外推法确认圆弧半径R的搜索区间,所述搜索区间按照圆弧半径小-大-小的位置关系确定;
采用区间消去法逐渐减小搜索区间;所述区间消去法为在上一次的搜索方向上及搜索区间内,使机器人往复运动,减小搜索区间;
在所述搜索区间内,判断当前圆弧半径R是否满足如下关系:
其中,r为靶球半径,R为实时获取的圆弧半径,为系统预设阈值;
若是,获取当前状态下,对应圆弧半径为R的圆弧圆心坐标,以及机器人的位置姿态信息;记录机器人的位置姿态信息和所获取的圆弧圆心坐标,并将其形成一个共轭对;
若否,继续沿着当前搜索方向,采用区间消去法逐渐减小搜索区间;
根据所述共轭对信息,求解变换矩阵,完成手眼标定。
5.根据权利要求4所述的激光测量机器人的手眼标定系统,其特征在于,所述数据处理单元还用于,接收激光投射到靶球表面的圆弧离散点数据,通过圆拟合计算所述圆弧半径R0、Rx,Ry,Rz。
6.根据权利要求4或5所述的激光测量机器人的手眼标定系统,其特征在于,
所述数据处理单元还用于,调整机器人到不同的位置姿态,重复获得N个所述共轭对;
判断N是否大于第二系统阈值;
若是,求解变换矩阵,完成手眼标定;
若否,继续调整机器人到不同的位置姿态,重复获得下一个所述共轭对。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410408307.5A CN104132616B (zh) | 2014-08-19 | 激光测量机器人的手眼标定方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410408307.5A CN104132616B (zh) | 2014-08-19 | 激光测量机器人的手眼标定方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104132616A CN104132616A (zh) | 2014-11-05 |
CN104132616B true CN104132616B (zh) | 2017-01-04 |
Family
ID=
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1831468A (zh) * | 2005-03-10 | 2006-09-13 | 新奥博为技术有限公司 | 激光扫描器与机器人的相对位置的标定方法 |
CN102062576A (zh) * | 2010-11-12 | 2011-05-18 | 浙江大学 | 基于激光跟踪测量的附加外轴机器人自动标定装置及方法 |
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1831468A (zh) * | 2005-03-10 | 2006-09-13 | 新奥博为技术有限公司 | 激光扫描器与机器人的相对位置的标定方法 |
CN102062576A (zh) * | 2010-11-12 | 2011-05-18 | 浙江大学 | 基于激光跟踪测量的附加外轴机器人自动标定装置及方法 |
Non-Patent Citations (2)
Title |
---|
一种线结构光视觉传感器手眼标定方法及仿真;熊会元等;《系统仿真学报》;20100930;第22卷(第9期);第2223-2226页 * |
激光线扫式形貌测量机器人的标定研究;黄佳等;《传感技术学报》;20120131;第25卷(第1期);第62-66页 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107738254B (zh) | 一种机械臂坐标系的转换标定方法与系统 | |
EP3166084B1 (en) | Method and system for determining a configuration of a virtual robot in a virtual environment | |
US20180243911A1 (en) | Robot and robot system | |
US9452533B2 (en) | Robot modeling and positioning | |
US11338441B2 (en) | Calibration system for robot tool and calibration method for the same | |
GB2584608A (en) | Robot motion optimization system and method | |
CN105509671A (zh) | 一种利用平面标定板的机器人工具中心点标定方法 | |
CN112643665B (zh) | 一种绝对位姿传感器安装误差的标定方法和装置 | |
CN111836185A (zh) | 一种基站位置坐标的确定方法、装置、设备及存储介质 | |
CN108958065A (zh) | 一种赤道惯性系下空间试验器半实物仿真试验系统 | |
KR20220136300A (ko) | 레이저 레이더와 위치 결정 기기의 캘리브레이션 방법, 기기 및 자율 주행 차량 | |
US10539653B2 (en) | Method for detecting position of mobile body | |
CN115439633A (zh) | 标定方法、装置和电子设备 | |
CN109933058B (zh) | 用于确定可移动设备的移动误差的方法、装置、服务器及存储介质 | |
CN113601510A (zh) | 基于双目视觉的机器人移动控制方法、装置、系统及设备 | |
CN104132616B (zh) | 激光测量机器人的手眼标定方法及系统 | |
JP2018536916A (ja) | 仮想空間における仮想物体の位置を決定する方法及び装置 | |
de Souza et al. | Industrial robot programming by demonstration using stereoscopic vision and inertial sensing | |
CN106248000B (zh) | 零件孔轴线的测量方法 | |
CN116974291A (zh) | 主从协同导航农业机械的控制误差确定方法及装置 | |
US20210201011A1 (en) | Data processing method for multi-sensor fusion, positioning apparatus and virtual reality device | |
CN104132616A (zh) | 激光测量机器人的手眼标定方法及系统 | |
CN114690179A (zh) | 基于短距离雷达与捷联惯导的室内追踪定位方法及装置 | |
CN114926545A (zh) | 相机标定精度的评估方法、装置、电子设备及存储介质 | |
CN108592838B (zh) | 工具坐标系的标定方法、装置以及计算机存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant |