CN109129465A - 一种机器人手眼标定***及其工作流程 - Google Patents
一种机器人手眼标定***及其工作流程 Download PDFInfo
- Publication number
- CN109129465A CN109129465A CN201810828154.8A CN201810828154A CN109129465A CN 109129465 A CN109129465 A CN 109129465A CN 201810828154 A CN201810828154 A CN 201810828154A CN 109129465 A CN109129465 A CN 109129465A
- Authority
- CN
- China
- Prior art keywords
- target
- robot
- coordinate
- dimensional visual
- visual measurement
- 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.)
- Granted
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
Abstract
本发明属于机器人标定技术领域,具体涉及一种机器人手眼标定***及其工作流程,包括机器人(1)、标靶(2)、三维视觉测量***(3)和控制***(4),所述标靶(2)设置于所述机器人(1)末端,所述三维视觉测量***(3)用于测量所述标靶(2)的坐标,所述机器人(1)用于移动所述标靶(2),并测量所述标靶(2)的坐标,所述机器人(1)和所述三维视觉测量***(3)均与所述控制***(4)电连接。该***利用迭代权重分配的机制,为参与奇异值分解拟合的坐标点附加不同权重,从而减少了误差较大的坐标点对最终拟合结果的干扰,提高了标定精度。
Description
技术领域
本发明属于机器人标定技术领域,具体涉及一种机器人手眼标定***及其工作流程。
背景技术
在机器人集成应用中,往往需要与视觉设备联合工作,以实现自主抓取,分类以及跟踪等复杂工作。三维视觉传感器及其相应测量***因获得的信息量丰富,以及高灵敏度、高精度、与工件无接触等优点,而越来越受到人们的重视和应用。而机器人与三维视觉测量***之间的手眼标定,则是两者能够准确协作的重要环节。手眼标定是通过在机器人末端安装特定的标靶,分别获取当前标靶在机器人基坐标系下的坐标以及三维视觉测量坐标系下的坐标点,通过拟合算法求得机器人基坐标系与三维视觉测量坐标系之间的平移旋转矩阵,从而确定了机器人与三维视觉传感器之间的相对位置。
现有技术中,手眼标定方法都是利用奇异值分解法,对大量的坐标点进行拟合,这类方法的不足在于,各个坐标点在拟合过程中的权重默认是相等的,这样容易导致一些误差较大的坐标点无法被排除,从而降低整体的拟合精度。
综上可知,相关技术存在缺陷,不利于工业生产,亟待完善。
发明内容
本发明的目的之一在于:针对现有技术的不足,而提供一种机器人手眼标定***,利用迭代权重分配的机制,为参与奇异值分解拟合的坐标点附加不同权重,从而减少了误差较大的坐标点对最终拟合结果的干扰。
为实现上述目的,本发明采用如下技术方案:
一种机器人手眼标定***,包括机器人、标靶、三维视觉测量***和控制***,所述标靶设置于所述机器人末端,所述三维视觉测量***用于测量所述标靶的坐标,所述机器人用于移动所述标靶,并测量所述标靶的坐标,所述机器人和所述三维视觉测量***均与所述控制***电连接。该***利用迭代权重分配的机制,为参与奇异值分解拟合的坐标点附加不同权重,从而减少了误差较大的坐标点对最终拟合结果的干扰。
作为本发明所述的机器人手眼标定***的一种改进,所述机器人的基座与所述三维视觉测量***基座的位置相对固定。这种设计使得***的工作空间相对固定,提高了工作的稳定性。
本发明的目的之二在于:针对现有技术的不足,还提供一种机器人手眼标定***的使用方法,使其工作稳定、高效,可靠性高。
为实现上述目的,本发明提供一种机器人手眼标定***的工作流程,包括如下步骤:
S1、所述机器人通过TCP示教获得所述标靶相对于所述机器人的位置信息,并读取所述标靶相对于所述机器人基坐标系{B}下的坐标,并将信息传递给所述控制***;
S2、所述三维视觉测量***读取所述标靶相对于所述三维视觉测量***基坐标系{S}下的坐标,并将信息传递给所述控制***;
S3、所述控制***控制所述机器人运动,所述机器人带动所述标靶移动,使得所述标靶的相对位置发生改变;
S4、依次执行步骤S1和步骤S2;
S5、依次执行步骤S3和步骤S4,重复n次,并获得所述标靶在所述机器人基坐标系{B}下的坐标Bp1,Bp2,Bp3...,Bpn,以及所述标靶在所述三维视觉测量***基坐标系{S}下的坐标Sp1,Sp2,Sp3...,Spn。此时两组坐标点满足关系:
其中,分别是机器人手眼标定所需要标定的旋转矩阵和平移向量;
S6、对各个坐标点的初始权重(w1 w2 w3 ... wn)均赋值为1,对Bp1,Bp2,Bp3...,Bpn和Sp1,Sp2,Sp3...,Spn分别按下述等式求取重心和
S7、构造如下矩阵:
并对矩阵XWYT进行奇异值分解:X·W·YT=U·Σ·VT,然后代入以下等式求得当前的旋转矩阵和平移向量
S8、检查各个坐标点在当前旋转矩阵和平移向量下的误差:
设计一误差阈值r,若发现有坐标点最大误差Δemax大于该误差阈值r,则进行下一步,否则,作为机器人手眼标定结果当前旋转矩阵和平移向量
S9、设计误差-权重函数:根据各个坐标点的误差对其权重进行重新分配;
S10、依次重复执行步骤S6、步骤S7和步骤S8,直至满足步骤S8的误差阈值r为止。
与现有技术相比,本发明的有益效果在于:针对现有机器人手眼标定技术中,参与拟合旋转矩阵和平移向量的各个坐标点权重相等导致无法排除误差较大点干扰的情况。提取一个基于迭代权重分配的机器人手眼标定方法,根据每一次迭代所得标定结果的各个坐标点误差,利用误差-权重函数:调整各个坐标点的权重,使误差较大的点权重减少,并通过多次迭代,使各个坐标点的误差在一个合理的误差阈值范围内,从而减少了测量过程之中一些误差较大坐标点的干扰。
附图说明
此处所说明的附图用来提供对本发明的进一步理解,构成本发明的一部分,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明中的结构示意图;
其中:1-机器人;2-标靶;3-三维视觉测量***;4-控制***;{B}-标靶相对于机器人基坐标系;{S}-标靶相对于三维视觉测量***基坐标系。
具体实施方式
如在说明书及权利要求当中使用了某些词汇来指称特定组件。本领域技术人员应可理解,硬件制造商可能会用不同名词来称呼同一个组件。本说明书及权利要求并不以名称的差异来作为区分组件的方式,而是以组件在功能上的差异来作为区分的准则。如在通篇说明书及权利要求当中所提及的“包含”为一开放式用语,故应解释成“包含但不限定于”。“大致”是指在可接受的误差范围内,本领域技术人员能够在一定误差范围内解决所述技术问题,基本达到所述技术效果。
在本发明的描述中,需要理解的是,术语“上”、“下”、“前”、“后”、“左”、“右”、水平”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
在本发明中,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”、“固定”等术语应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。
以下结合附图对本发明作进一步详细说明,但不作为对本发明的限定。
实施例1
如图1所示,一种机器人手眼标定***,包括机器人1、标靶2、三维视觉测量***3和控制***4,标靶2设置于机器人1末端,三维视觉测量***3用于测量标靶2的坐标,机器人1用于移动标靶2,并测量标靶2的坐标,机器人1和三维视觉测量***3均与控制***4电连接。该***利用迭代权重分配的机制,为参与奇异值分解拟合的坐标点附加不同权重,从而减少了误差较大的坐标点对最终拟合结果的干扰。
优选的,机器人1的基座与三维视觉测量***3基座的位置相对固定。这种设计使得***的工作空间相对固定,提高了工作的稳定性。
实施例2
如图1所示,一种实施例1机器人手眼标定***的工作流程,包括如下步骤:
S1、机器人1通过TCP示教获得标靶2相对于机器人1的位置信息,并读取标靶2相对于机器人1基坐标系{B}下的坐标,并将信息传递给控制***4;
S2、三维视觉测量***3读取标靶2相对于三维视觉测量***3基坐标系{S}下的坐标,并将信息传递给控制***4;
S3、控制***4控制机器人1运动,机器人1带动标靶2移动,使得标靶2的相对位置发生改变;
S4、依次执行步骤S1和步骤S2;
S5、依次执行步骤S3和步骤S4,重复n次,并获得标靶2在机器人1基坐标系{B}下的坐标Bp1,Bp2,Bp3...,Bpn,以及标靶2在三维视觉测量***3基坐标系{S}下的坐标Sp1,Sp2,Sp3...,Spn。此时两组坐标点满足关系:
其中,分别是机器人手眼标定所需要标定的旋转矩阵和平移向量;
S6、对各个坐标点的初始权重(w1 w2 w3 ... wn)均赋值为1,对Bp1,Bp2,Bp3...,Bpn和Sp1,Sp2,Sp3...,Spn分别按下述等式求取重心和
S7、构造如下矩阵:
并对矩阵XWYT进行奇异值分解:X·W·YT=U·Σ·VT,然后代入以下等式求得当前的旋转矩阵和平移向量
S8、检查各个坐标点在当前旋转矩阵和平移向量下的误差:
设计一误差阈值r,若发现有坐标点最大误差Δemax大于该误差阈值r,则进行下一步,否则,作为机器人手眼标定结果当前旋转矩阵和平移向量
S9、设计误差-权重函数:根据各个坐标点的误差对其权重进行重新分配;
S10、依次重复执行步骤S6、步骤S7和步骤S8,直至满足步骤S8的误差阈值r为止。
上述说明示出并描述了本发明的若干优选实施例,但如前所述,应当理解本发明并非局限于本文所披露的形式,不应看作是对其他实施例的排除,而可用于各种其他组合、修改和环境,并能够在本文所述发明构想范围内,通过上述教导或相关领域的技术或知识进行改动。而本领域人员所进行的改动和变化不脱离本发明的精神和范围,则都应在本发明所附权利要求的保护范围内。
Claims (3)
1.一种机器人手眼标定***,其特征在于:包括机器人(1)、标靶(2)、三维视觉测量***(3)和控制***(4),所述标靶(2)设置于所述机器人(1)末端,所述三维视觉测量***(3)用于测量所述标靶(2)的坐标,所述机器人(1)用于移动所述标靶(2),并测量所述标靶(2)的坐标,所述机器人(1)和所述三维视觉测量***(3)均与所述控制***(4)电连接。
2.如权利要求1所述的机器人手眼标定***,其特征在于:所述机器人(1)的基座与所述三维视觉测量***(3)基座的位置相对固定。
3.一种所述机器人手眼标定***及其工作流程,包括如下步骤:
S1、所述机器人(1)通过TCP示教获得所述标靶(2)相对于所述机器人(1)的位置信息,并读取所述标靶(2)相对于所述机器人(1)基坐标系{B}下的坐标,并将信息传递给所述控制***(4);
S2、所述三维视觉测量***(3)读取所述标靶(2)相对于所述三维视觉测量***(3)基坐标系{S}下的坐标,并将信息传递给所述控制***(4);
S3、所述控制***(4)控制所述机器人(1)运动,所述机器人(1)带动所述标靶(2)移动,使得所述标靶(2)的相对位置发生改变;
S4、依次执行步骤S1和步骤S2;
S5、依次执行步骤S3和步骤S4,重复n次,并获得所述标靶(2)在所述机器人(1)基坐标系{B}下的坐标Bp1,Bp2,Bp3...,Bpn,以及所述标靶(2)在所述三维视觉测量***(3)基坐标系{S}下的坐标Sp1,Sp2,Sp3...,Spn。此时两组坐标点满足关系:
其中,分别是机器人手眼标定所需要标定的旋转矩阵和平移向量;
S6、对各个坐标点的初始权重(w1 w2 w3 ... wn)均赋值为1,对Bp1,Bp2,Bp3...,Bpn和Sp1,Sp2,Sp3...,Spn分别按下述等式求取重心和
S7、构造如下矩阵:
并对矩阵XWYT进行奇异值分解:X·W·YT=U·Σ·VT,然后代入以下等式求得当前的旋转矩阵和平移向量
S8、检查各个坐标点在当前旋转矩阵和平移向量下的误差:
设计一误差阈值r,若发现有坐标点最大误差Δemax大于该误差阈值r,则进行下一步,否则,作为机器人手眼标定结果当前旋转矩阵和平移向量
S9、设计误差-权重函数:根据各个坐标点的误差对其权重进行重新分配;
S10、依次重复执行步骤S6、步骤S7和步骤S8,直至满足步骤S8的误差阈值r为止。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810828154.8A CN109129465B (zh) | 2018-07-25 | 2018-07-25 | 一种机器人手眼标定***及其工作流程 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810828154.8A CN109129465B (zh) | 2018-07-25 | 2018-07-25 | 一种机器人手眼标定***及其工作流程 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109129465A true CN109129465A (zh) | 2019-01-04 |
CN109129465B CN109129465B (zh) | 2021-12-14 |
Family
ID=64798430
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810828154.8A Active CN109129465B (zh) | 2018-07-25 | 2018-07-25 | 一种机器人手眼标定***及其工作流程 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109129465B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112057326A (zh) * | 2020-09-07 | 2020-12-11 | 中科尚易健康科技(北京)有限公司 | 一种用于经络调理***的探针镜像装置及其算法 |
CN112123329A (zh) * | 2020-02-21 | 2020-12-25 | 深圳市三宝创新智能有限公司 | 一种机器人3d视觉手眼标定方法 |
CN112525074A (zh) * | 2020-11-24 | 2021-03-19 | 杭州素问九州医疗科技有限公司 | 标定方法、***、机器人、计算机装置和导航*** |
CN112792816A (zh) * | 2021-01-26 | 2021-05-14 | 杭州素问九州医疗科技有限公司 | 基于几何的手眼标定方法、机器人、计算机及存储介质 |
CN113843792A (zh) * | 2021-09-23 | 2021-12-28 | 四川锋准机器人科技有限公司 | 一种手术机器人的手眼标定方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08272414A (ja) * | 1995-03-29 | 1996-10-18 | Fanuc Ltd | ロボットとハンドカメラを用いた視覚センサのキャリブレーション方法 |
CN102825602A (zh) * | 2012-08-21 | 2012-12-19 | 华北电力大学(保定) | 一种基于psd的工业机器人自标定方法及装置 |
CN103895023A (zh) * | 2014-04-04 | 2014-07-02 | 中国民航大学 | 一种基于编码方位装置的机械臂末端跟踪测量***及方法 |
CN104729481A (zh) * | 2015-03-12 | 2015-06-24 | 北京空间飞行器总体设计部 | 一种基于pnp透视模型的合作目标位姿精度测量方法 |
CN108214476A (zh) * | 2017-12-28 | 2018-06-29 | 北京航空航天大学 | 基于改进型径向基神经网络的机械臂绝对定位精度标定方法 |
-
2018
- 2018-07-25 CN CN201810828154.8A patent/CN109129465B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08272414A (ja) * | 1995-03-29 | 1996-10-18 | Fanuc Ltd | ロボットとハンドカメラを用いた視覚センサのキャリブレーション方法 |
CN102825602A (zh) * | 2012-08-21 | 2012-12-19 | 华北电力大学(保定) | 一种基于psd的工业机器人自标定方法及装置 |
CN103895023A (zh) * | 2014-04-04 | 2014-07-02 | 中国民航大学 | 一种基于编码方位装置的机械臂末端跟踪测量***及方法 |
CN104729481A (zh) * | 2015-03-12 | 2015-06-24 | 北京空间飞行器总体设计部 | 一种基于pnp透视模型的合作目标位姿精度测量方法 |
CN108214476A (zh) * | 2017-12-28 | 2018-06-29 | 北京航空航天大学 | 基于改进型径向基神经网络的机械臂绝对定位精度标定方法 |
Non-Patent Citations (1)
Title |
---|
K.S.ARUN: "Least-Squares Fitting of Two 3-D Point Sets", 《IEEE TRANSACTIONS ON》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112123329A (zh) * | 2020-02-21 | 2020-12-25 | 深圳市三宝创新智能有限公司 | 一种机器人3d视觉手眼标定方法 |
CN112057326A (zh) * | 2020-09-07 | 2020-12-11 | 中科尚易健康科技(北京)有限公司 | 一种用于经络调理***的探针镜像装置及其算法 |
CN112057326B (zh) * | 2020-09-07 | 2021-08-06 | 中科尚易健康科技(北京)有限公司 | 一种用于经络调理***的探针镜像装置及其算法 |
CN112525074A (zh) * | 2020-11-24 | 2021-03-19 | 杭州素问九州医疗科技有限公司 | 标定方法、***、机器人、计算机装置和导航*** |
CN112792816A (zh) * | 2021-01-26 | 2021-05-14 | 杭州素问九州医疗科技有限公司 | 基于几何的手眼标定方法、机器人、计算机及存储介质 |
CN113843792A (zh) * | 2021-09-23 | 2021-12-28 | 四川锋准机器人科技有限公司 | 一种手术机器人的手眼标定方法 |
CN113843792B (zh) * | 2021-09-23 | 2024-02-06 | 四川锋准机器人科技有限公司 | 一种手术机器人的手眼标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109129465B (zh) | 2021-12-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109129465A (zh) | 一种机器人手眼标定***及其工作流程 | |
CN105157725B (zh) | 一种二维激光视觉传感器和机器人的手眼标定方法 | |
CN105518486B (zh) | 追踪可移动目标物体的方位的***和方法 | |
CN105333819A (zh) | 基于面激光传感器的机器人工件装配及形位公差检测***及其检测方法 | |
CN109848983A (zh) | 一种高顺应性人引导机器人协同作业的方法 | |
CN109489548B (zh) | 一种利用三维点云的零件加工精度自动检测方法 | |
Beravs et al. | Magnetometer calibration using Kalman filter covariance matrix for online estimation of magnetic field orientation | |
CN110014426A (zh) | 一种利用低精度深度相机高精度抓取形状对称工件的方法 | |
Jiang et al. | A measurement method for robot peg-in-hole prealignment based on combined two-level visual sensors | |
CN105910535A (zh) | 一种用于舱段自动对接的单双目位姿偏差测量方法 | |
CN109446892A (zh) | 基于深度神经网络的人眼注意力定位方法及*** | |
CN111657947B (zh) | 一种神经调控靶区的定位方法 | |
CN106127758A (zh) | 一种基于虚拟现实技术的视觉检测方法及装置 | |
CN109808914A (zh) | 一种飞机大部件随动式调姿******坐标自动识别方法 | |
Kim et al. | Robot head-eye calibration using the minimum variance method | |
Moser et al. | Evaluation of user-centric optical see-through head-mounted display calibration using a leap motion controller | |
Pan et al. | A closed-form solution to eye-to-hand calibration towards visual grasping | |
Ge et al. | Online 3-D modeling of complex workpieces for the robotic spray painting with low-cost RGB-D cameras | |
Zenha et al. | Incremental adaptation of a robot body schema based on touch events | |
Hvilshøj et al. | Calibration techniques for industrial mobile manipulators: Theoretical configurations and best practices | |
CN112157654B (zh) | 一种机器人加工***定位误差的优化方法 | |
CN106092053A (zh) | 一种机器人重复定位***及其定位方法 | |
Jianming et al. | Error correction for high-precision measurement of cylindrical objects diameter based on machine vision | |
Hao et al. | Image-based visual servoing for position alignment with orthogonal binocular vision | |
CN106248000A (zh) | 零件孔轴线的测量方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |