CN102226677A - 具有协作关系的多机器人系统的基坐标系标定方法 - Google Patents

具有协作关系的多机器人系统的基坐标系标定方法 Download PDF

Info

Publication number
CN102226677A
CN102226677A CN2011100270806A CN201110027080A CN102226677A CN 102226677 A CN102226677 A CN 102226677A CN 2011100270806 A CN2011100270806 A CN 2011100270806A CN 201110027080 A CN201110027080 A CN 201110027080A CN 102226677 A CN102226677 A CN 102226677A
Authority
CN
China
Prior art keywords
robot
cooperation
basis coordinates
robots
point
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
Application number
CN2011100270806A
Other languages
English (en)
Other versions
CN102226677B (zh
Inventor
甘亚辉
戴先中
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Southeast University
Original Assignee
Southeast University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Southeast University filed Critical Southeast University
Priority to CN 201110027080 priority Critical patent/CN102226677B/zh
Publication of CN102226677A publication Critical patent/CN102226677A/zh
Application granted granted Critical
Publication of CN102226677B publication Critical patent/CN102226677B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

本发明介绍了一种应用于多机器人系统的协作机器人基坐标系标定方法。该方法的基本思路是通过在两两协作机器人之间构造四组特定形式的握手动作获取标定方程所需的位姿信息，借助特定形式的标定方程计算协作机器人基坐标系间的相对位姿关系。采用本发明介绍的方法除发明中介绍的标定指外，可以在不增加任何传感器和测量设备的情况下，快速、准确的标定具有协作关系的机器人基坐标系间的相对位姿，为实现具有多机器人协作功能的更先进的机器人控制器提供了技术基础。

Description

具有协作关系的多机器人系统的基坐标系标定方法
技术领域
本发明针对多机器人协作系统，提出了一种新的协作机器人基坐标系标定方法。该方法借助于机器人内部关节位置传感器和标定指，可实现在不需要增加任何传感或测量设备的情况下，标定具有协作关系的机器人基坐标系间的相对位姿。属于工业机器人、柔性化制造系统技术领域。
背景技术
现代化生产中存在许多复杂的装配任务或大型工件的搬运等，多机器人协作系统的出现为解决上述难题提供了便捷、有效的途径。多机器人协作系统目前已成为机器人领域的研究热点，特别是在柔性化制造系统的设计和实现过程中发挥着越来越重要的作用。在多机器人系统中，每个机器人在执行协作任务的时候需要知道其它机器人的位置，也就是确定其它机器人的基坐标系与自己的基坐标系间的相对位姿。这也就是所谓的协作机器人基坐标系标定问题。
解决协作机器人的基坐标系标定问题，特别是对于生产环境下的工业机器人系统，依然缺少简单有效的方法。目前的多机器人协作系统的基坐标系标定方法，一般均需要附加传感器或测量装置，标定方法的步骤和精度也存有很大差别。
为满足现代化生产过程的需求、顺应机器人技术的发展趋势，本发明提出了一种操作简单的协作机器人基坐标系标定方法。其基本思想是通过在协作机器人之间构造特定的“握手”动作并记录机器人对应的位姿信息，依据特定形式的标定方程计算协作机器人间的基坐标系位姿关系。采用本发明中提出的协作机器人基坐标系标定方法除标定指外，不需要增加额外的传感装置或测量设备，操作步骤简单、标定精度较高，能够解决常见的机器人协作任务下的基坐标系标定问题。
发明内容
技术问题：本发明的目的是为工业机器人多机器人系统提供应用于多机器人系统的协作机器人基坐标系标定方法，在仅依赖机器人原有的关节位置传感器的基础上提供一种操作简便、精度满足绝大多数机器人操作任务要求的机器人基坐标系标定方法。
技术方案：协作机器人基坐标系标定方法的基本思想是：通过在具有协作关系的机器人之间构建特定的“握手”动作来获取标定方程所需的位置信息，通过特定形式的标定方程求解协作机器人基坐标系之间的相对位姿关系。
将n台多机器人系统按相互间有协作关系的前提分成n-1组，每组两台，通过在每组两台协作机器人之间构造四组握手动作获取标定方程所需的位置信息，借助于标定方程求解具有协作关系的两机器人基坐标系间的位姿变换矩阵；重复n-1次，完成n-1组两协作机器人的基坐标系标定，从而完成n台机器人系统的协作机器人基坐标系标定。
协作机器人基坐标系标定方法中，标定方程的具体形式为：
Figure 566875DEST_PATH_IMAGE001
Figure 577556DEST_PATH_IMAGE002
Figure 483195DEST_PATH_IMAGE003
其中，是两协作机器人之间构成握手动作时机器人工具手的中心点在机器人
Figure 477882DEST_PATH_IMAGE005
的基坐标系
Figure 280753DEST_PATH_IMAGE006
下的位置坐标，
Figure 606561DEST_PATH_IMAGE007
分别针对四组不同位置下的握手动作，上标
Figure 189989DEST_PATH_IMAGE008
表示该点的坐标是针对坐标系
Figure 377388DEST_PATH_IMAGE006
而言；
Figure 362661DEST_PATH_IMAGE009
是两协作机器人之间构成握手动作时机器人工具手的中心点在机器人
Figure 859370DEST_PATH_IMAGE010
的基坐标系
Figure 930095DEST_PATH_IMAGE011
下的位置坐标，上标
Figure 921184DEST_PATH_IMAGE012
表示该点的坐标是针对坐标系
Figure 760964DEST_PATH_IMAGE013
而言；
Figure 428575DEST_PATH_IMAGE014
是标定方程的中间计算结果，
Figure 658699DEST_PATH_IMAGE015
是协作机器人基坐标系间的旋转变换矩阵，是协作机器人基坐标系间的平移变换向量。
齐次变换矩阵
Figure 397034DEST_PATH_IMAGE017
就是最后得到的标定结果，反映了两协作机器人基坐标系之间的位姿变换关系。
所述的握手动作构造的基本要求是两机器人工具手中心点位于协作机器人工作空间重叠区域中的同一点。
通过在每组两台协作机器人之间构造四组握手动作，针对四组握手动作完成时的机器人工具手中心点取法提出的一种“直角正三棱锥”四点取法，四点位置在机器人协作空间中构成一个直角正三棱锥。
对于标准的工业机器人系统，在机器人的基座处建立机器人基坐标系
Figure 48595DEST_PATH_IMAGE018
，在机器人的末端关节处建立末端法兰坐标系
Figure 31595DEST_PATH_IMAGE019
。当机器人的末端安装有执行特定任务的工具手后，在机器人工具手的中心点建立工具手坐标系
Figure 426804DEST_PATH_IMAGE020
。附图1以两个具有协作关系的工业机械臂系统为例描述了上述坐标系及它们之间的变换关系。图中
Figure 168407DEST_PATH_IMAGE006
是机器人
Figure 194132DEST_PATH_IMAGE005
的基坐标系，
Figure 461165DEST_PATH_IMAGE021
是机器人的末端法兰坐标系，
Figure 250315DEST_PATH_IMAGE022
是机器人
Figure 446941DEST_PATH_IMAGE005
的末端工具手坐标系；
Figure 201271DEST_PATH_IMAGE011
是机器人
Figure 125233DEST_PATH_IMAGE010
的基坐标系，是机器人
Figure 16146DEST_PATH_IMAGE010
的末端法兰坐标系，
Figure 179143DEST_PATH_IMAGE024
是机器人
Figure 719846DEST_PATH_IMAGE010
的末端工具手坐标系；
Figure 301000DEST_PATH_IMAGE025
是世界坐标系。对于协作系统中的每个机器人
Figure 636166DEST_PATH_IMAGE005
，
Figure 552038DEST_PATH_IMAGE026
是其末端法兰坐标系到其基坐标系
Figure 66513DEST_PATH_IMAGE006
的齐次变换矩阵，
Figure 572581DEST_PATH_IMAGE027
是其末端工具手坐标系
Figure 975750DEST_PATH_IMAGE024
到其末端法兰坐标系
Figure 858255DEST_PATH_IMAGE021
的齐次变换矩阵。
Figure 148422DEST_PATH_IMAGE028
是机器人的基坐标系
Figure 715855DEST_PATH_IMAGE011
到另一个机器人
Figure 74156DEST_PATH_IMAGE005
的基坐标系
Figure 546725DEST_PATH_IMAGE006
的齐次变换矩阵。所谓的协作机器人基坐标系标定问题就是确定齐次变换矩阵的具体值。
本发明中提到的在协作机器人之间构造特定的“握手”动作，其本质的要求是将两个机器人的工具手中心点运动到协作空间中的同一点
Figure 506777DEST_PATH_IMAGE029
，该动作的典型要求和形式如附图2所示。在图2所示的机器人的末端安装有一种单独加工的“标定指”，标定指的加工图纸如附图3所示。理论上讲，只要能将参与协作的两个机器人的工具手中心点运动到工作空间中的同一点，就符合握手动作的基本要求，而不必在机器人末端安装如图2中所示的标定指。实际操作时，为保证尽可能准确的将两个机器人的工具手中心点运动到协作空间中的同一点，本发明设计了一种形状简单、加工方便的“标定指”，加工要求如图3所示。其中标定指的顶端就是机器人工具手坐标系的原点、机器人工具手的中心点。该标定指可以看作是一种特殊的机器人工具手，同时标定指的使用能够提高标定结果的精度，方便握手动作的构造。
当参与协作的两个机器人构成如图2所示的握手动作后，记录此时机器人末端工具手的中心点位置。目前的机器人控制器中均装有关节位置传感器，借助于机器人正运动学方程可求出工具手坐标系
Figure 668768DEST_PATH_IMAGE020
到机器人基坐标系
Figure 200373DEST_PATH_IMAGE018
的齐次变换矩阵
Figure 484724DEST_PATH_IMAGE030
。在机器人运动学中，描述一个齐次变换矩阵通常采用如下形式，
Figure 834934DEST_PATH_IMAGE031
                                               （1）
其中
Figure 597353DEST_PATH_IMAGE032
是坐标系间的旋转矩阵，
Figure 965887DEST_PATH_IMAGE033
是坐标系间的平移向量。对于齐次变换矩阵
Figure 421139DEST_PATH_IMAGE030
而言，其平移分量
Figure 258645DEST_PATH_IMAGE034
又可以看作是机器人工具手坐标系
Figure 11706DEST_PATH_IMAGE020
的原点在机器人基坐标系
Figure 47795DEST_PATH_IMAGE018
下的位置表示，也就是机器人工具手的中心点在机器人基坐标系
Figure 611632DEST_PATH_IMAGE018
下的坐标。记协作机器人构成握手动作时的工具手中心点在两机器人的基坐标系下的坐标分别是
Figure 998751DEST_PATH_IMAGE035
、。由于两个机器人的工具手中心点位于协作空间中的同一点
Figure 446098DEST_PATH_IMAGE029
，依据空间点坐标变换方程有下式成立，
Figure 180836DEST_PATH_IMAGE037
                                             （2）先后在两机器人协作空间中的四个不同的点
Figure 789672DEST_PATH_IMAGE038
、
Figure 150115DEST_PATH_IMAGE039
、
Figure 98479DEST_PATH_IMAGE040
、
Figure 66435DEST_PATH_IMAGE041
构造如图2所示的握手动作，分别记录上述四个点在机器人
Figure 349518DEST_PATH_IMAGE005
的基坐标系
Figure 795543DEST_PATH_IMAGE006
下的位置坐标
Figure 863993DEST_PATH_IMAGE042
、
Figure 2850DEST_PATH_IMAGE043
、、，在机器人
Figure 945902DEST_PATH_IMAGE010
的基坐标系
Figure 442611DEST_PATH_IMAGE011
下的位置坐标
Figure 513335DEST_PATH_IMAGE046
、、
Figure 344205DEST_PATH_IMAGE048
、
Figure 17675DEST_PATH_IMAGE049
。将上述四个点的坐标依次代入（2）式得，
Figure 247799DEST_PATH_IMAGE050
                                         （3） 
Figure 104897DEST_PATH_IMAGE051
                                         （4）
Figure 986134DEST_PATH_IMAGE052
                                         （5）  
Figure 637695DEST_PATH_IMAGE053
                                         （6）
将（3）式与（4）、（5）、（6）式左右两边分别相减并综合所得结果得到如下方程，
Figure 620694DEST_PATH_IMAGE001
     （7）     将式（7）简记为的形式。显然，只要满足条件
Figure 751647DEST_PATH_IMAGE055
，旋转矩阵存在唯一的解
Figure 44406DEST_PATH_IMAGE057
。式（7）构成了本标定方法中的核心方程之一，通过该式可求出机器人基坐标系
Figure 164677DEST_PATH_IMAGE006
和
Figure 771239DEST_PATH_IMAGE011
之间的旋转变换矩阵。对于条件
Figure 30182DEST_PATH_IMAGE055
等价于，
Figure 705883DEST_PATH_IMAGE058
                           （8）
其中，
Figure 708474DEST_PATH_IMAGE059
，
Figure 169542DEST_PATH_IMAGE060
，。
只要
Figure 762384DEST_PATH_IMAGE038
、
Figure 240769DEST_PATH_IMAGE039
、
Figure 618661DEST_PATH_IMAGE040
、四个点不共面，条件（8）就是满足的。实际操作中可选择
Figure 807383DEST_PATH_IMAGE038
、
Figure 151777DEST_PATH_IMAGE039
、
Figure 836705DEST_PATH_IMAGE040
、
Figure 342772DEST_PATH_IMAGE041
构成一个以
Figure 496673DEST_PATH_IMAGE038
为顶点、为底面正三角形的直角正三棱锥，如附图4所示。附图4是以两台KUKA公司的KR30机器人协作系统为例设计的四点取法，实际系统中各点之间的距离应考虑机器人的结构参数、工作空间范围做出相应调整。调整原则是工作空间大的机器人对应四点间的距离大，工作空间小的机器人对应四点间的距离小。本发明建议采用图4中的构成直角正三棱锥的四点取法，但只要所取的四点不共面即符合本发明的应用要求。
对于任意的旋转矩阵需满足正交归一化的约束条件
Figure 527406DEST_PATH_IMAGE064
，协作机器人基坐标系标定结果中的
Figure 965340DEST_PATH_IMAGE056
也必须满足这一约束条件。实际标定过程中，由于握手动作执行时存在操作误差、计算过程存在截断误差、机器人关节位置传感器数据存在噪声等因素，利用式（7）直接计算出来的标定结果并不满足正交归一的约束条件，即
Figure 776170DEST_PATH_IMAGE065
，因而需对
Figure 983161DEST_PATH_IMAGE056
进行正交归一化处理，使其满足上述约束条件。矩阵
Figure 283561DEST_PATH_IMAGE056
的正交归一化处理就是找到一个满足约束条件
Figure 208792DEST_PATH_IMAGE064
的矩阵
Figure 370783DEST_PATH_IMAGE063
，同时保证矩阵
Figure 884810DEST_PATH_IMAGE056
与
Figure 169160DEST_PATH_IMAGE063
在某种矩阵范数下的差别最小。本发明采用了矩阵的Frobenius范数来度量两个矩阵之间的差别，矩阵的Frobenius范数定义方式如下，
Figure 253791DEST_PATH_IMAGE066
                                             （9）
其中，
Figure 281790DEST_PATH_IMAGE067
是一个的矩阵，
Figure 105575DEST_PATH_IMAGE069
。
结合矩阵的Frobenius范数的定义，
Figure 943081DEST_PATH_IMAGE056
的正交归一化问题可以写成如下形式，
Figure 696143DEST_PATH_IMAGE070
                                        （10）
采用拉格朗日乘子法对式（10）进行求解得，
                                       （11）
记旋转矩阵
Figure 296068DEST_PATH_IMAGE072
为
Figure 417608DEST_PATH_IMAGE056
正交归一化的结果，上述结果可记作，
Figure 974360DEST_PATH_IMAGE073
                                   （12）
Figure 130535DEST_PATH_IMAGE002
                                   （13）
正交归一化矩阵
Figure 865273DEST_PATH_IMAGE072
将作为本发明中协作机器人基坐标系标定结果中的旋转矩阵的最终形式。在求得两坐标系间的旋转变换关系后，依据方程（3）、（4）、（5）、（6）可以求出两坐标系间的平移变换关系，
Figure 661059DEST_PATH_IMAGE074
                  （14）
综合方程（7）和式（13）、（14）就构成了本发明中提到的标定方程。采用本发明中介绍的标定方法，仅借助机器人控制器现有的关节位置传感器，通过在协作机器人之间构造四组不同的握手动作并记录各机器人工具手中心点的坐标，依据标定方程（7）、（13）、（14）就可以求出两机器人基坐标系间的位姿变换矩阵，标定的结果为
Figure 568973DEST_PATH_IMAGE017
。
至此完成了对本发明的技术方案的介绍。有关本发明的具体实施步骤，参见下文“具体实施方式”中的介绍。
本发明主要针对工业应用型多机器人协作系统提出，可应用于包括垂直关节型机器人、直角坐标型机器人、SCARA型机器人等常见的工业机器人组成的协作系统中。只要参与协作的机器人具有重叠的工作空间，机器人控制器配有关节位置传感器且能够完成机器人正运动学变换，就能够采用本发明提出的协作机器人基坐标系标定方法。本发明在工业生产系统中，特别是柔性化制造系统的设计和使用中，具有着广阔的应用前景。
有益效果：本发明的基本思想是利用协作机器人构成握手动作时满足工具手中心点位置相同的约束关系，构造特定形式的标定方程求解协作机器人基坐标系间的位姿变换关系。采用本发明提出的方法除发明中介绍的标定指外，不需要为机器人控制器增加任何的传感或测量装置，且标定结果能够满足绝大多数机器人操作任务的精度要求。
本发明的具体优点在于：
Figure 517337DEST_PATH_IMAGE075
．提出了一种新的协作机器人基坐标系标定方法。协作机器人基坐标系的标定是实现协作控制的基础，本发明的提出解决了这一协作控制的基本问题、关键问题，为设计更先进的机器人控制器提供了技术支持。
．避免了为多机器人协作系统增加新的传感或测量装置，降低了协作系统的实现成本。本发明充分利用了机器人控制器现有的关节位置传感器，通过构造特定的协作动作和标定方程完成机器人基坐标系标定，最大程度的降低了协作系统的硬件要求，节约了多机器人协作系统的实现成本。
Figure 774235DEST_PATH_IMAGE077
．操作步骤简单，标定精度可靠，方便应用于各类生产环境中。本发明提出的标定方法仅需要在协作机器人之间构造四组握手动作、调用一次标定方程求解函数即可完成。步骤简单，使用方便。同时，标定指的使用、直角正三棱锥的四点取法能够提高标定的精度，保证标定结果满足绝大多数机器人操作任务的精度要求。这些都使得本发明能够方便的应用到各类常见的工业机器人协作任务中。
本发明是设计具有多机器人协作功能的更为先进的机器人控制器的核心组成部分，也是实现多机器人协作控制的基础，可应用于各类工业机器人协作系统中，包括垂直关节型机器人、直角坐标型机器人、SCARA型机器人等。本发明是实现多机器人协作控制的一项关键技术，在柔性化制造系统等工业生产领域具有广阔的应用前景。
附图说明
图1描述了由两个工业机器人组成的双机器人协作系统中的坐标系及其之间的相互变换关系。图中1和2分别表示机器人和机器人
Figure 554289DEST_PATH_IMAGE010
。
图2显示了将两个工业机器人的工具手中心点运动到协作空间中的同一点
Figure 880097DEST_PATH_IMAGE029
，构成本发明中指定的“握手”动作。图中1和2分别表示参与协作的机器人
Figure 197946DEST_PATH_IMAGE005
和机器人
Figure 650924DEST_PATH_IMAGE010
，3表示的是为辅助握手动作的完成而安装在机器人末端法兰的标定指。
图3是图2中安装在机器人末端法兰的标定指的示意图。标定指的作用是辅助两个协作机器人完成握手动作，也可以看作是一种特殊的机器人工具手。标定指的顶点就是本发明中提到的工具手中心点，也是机器人工具手坐标系的原点。该图中所示螺孔的直径和位置可依据具体的机器人法兰尺寸和安装螺孔的位置调整，其目的是将标定指安装固定在机器人末端法兰。
图4是本发明建议的四点取法，
Figure 823148DEST_PATH_IMAGE038
、
Figure 132907DEST_PATH_IMAGE039
、
Figure 875735DEST_PATH_IMAGE040
、
Figure 929142DEST_PATH_IMAGE041
构成一个以
Figure 955872DEST_PATH_IMAGE038
为顶点、
Figure 374215DEST_PATH_IMAGE062
为底面正三角形的直角正三棱锥。图中标注的各点间的距离是以两台KUKA公司的KR30机器人组成的协作系统为例设计的，实际应用本发明时应该依据参与协作的机器人的结构参数、工作空间大小做相应调整。调整原则是结构参数大、工作空间大的协作系统，四点间的距离也大；结构参数小、工作空间小的协作系统，四点间的距离也小。
图5是实现本发明的硬件基础，以双机器人协作系统为例，主要包括：1机器人
Figure 932236DEST_PATH_IMAGE005
、2机器人
Figure 710705DEST_PATH_IMAGE010
、3标定指、4机器人
Figure 670571DEST_PATH_IMAGE005
的控制器、5机器人
Figure 259815DEST_PATH_IMAGE010
的控制器、6协调控制器、7协作系统示教盒，共七大组成部分。
具体实施方式
以双机器人协作系统为例，实现本发明的硬件基础如附图5所示。图5中1是机器人
Figure 39552DEST_PATH_IMAGE005
、2是机器人
Figure 621712DEST_PATH_IMAGE010
、3是标定指、4是机器人
Figure 373767DEST_PATH_IMAGE005
的控制器、5是机器人
Figure 196230DEST_PATH_IMAGE010
的控制器、6是协调控制器、7是协作系统示教盒。其中，各机器人的控制器均已安装关节位置传感器并能完成机器人正运动学变换，绝大多数的工业机器人均满足此要求。协调控制器6完成多机器人之间的协作运动的规划和控制，包括协作机器人之间的基坐标系标定等任务。协调控制器6是一个功能上的组件，物理上可以通过在现有机器人控制器上扩展系统软件来实现。对多机器人协作系统而言，协作系统示教盒7是一个新增的物理部件，主要完成人机交互，借助一个共享的示教盒完成对所有机器人的标定、示教、编程和控制等。
下面结合附图内容和技术方案的介绍，对本发明的具体实施步骤做进一步说明。对于协作机器人数目大于2个的情况，可采用本发明介绍的方法分组依次标定具有协作关系的两个机器人之间的基坐标系变换关系。
分别为参与协作的机器人
Figure 650214DEST_PATH_IMAGE005
和
Figure 849114DEST_PATH_IMAGE010
安装标定指，安装完成后依次为机器人
Figure 455676DEST_PATH_IMAGE005
和
Figure 449040DEST_PATH_IMAGE010
执行工具手标定。现有的工业机器人均带有机器人工具手标定功能，对于机器人工具手的标定问题不在本发明讨论范围。
按照如图4所示的四点取法，在协作机器人的工作空间重叠区域大致规划出一个以为顶点、为底面正三角形的直角正三棱锥。图4中标注的各点间的距离是以两台KUKA公司的KR30机器人组成的协作系统为例设计的，实际应用本发明时可依据参与协作的机器人的结构参数、工作空间大小等对各点间的距离做出相应调整。
为减小标定结果的误差，应用本发明时尽可能的使四点之间构成直角正三棱锥，同时允许一定的操作误差存在。
利用协作系统示教盒7切换到对机器人
Figure 853979DEST_PATH_IMAGE005
的手动控制模式，将的工具手的中心点，也就是标定指3的尖端点运动到两机器人工作空间重叠区域中的任意一点。协调控制器6从机器人控制器4读取并记录此时机器人工具手的末端位姿为
Figure 942784DEST_PATH_IMAGE079
，
该位姿矩阵中的平移分量就是
Figure 320676DEST_PATH_IMAGE078
点在机器人
Figure 108372DEST_PATH_IMAGE005
基坐标系
Figure 509398DEST_PATH_IMAGE006
下的位置坐标，即
Figure 853791DEST_PATH_IMAGE080
。
保持机器人
Figure 273140DEST_PATH_IMAGE005
静止不动，利用协作系统示教盒7切换到对机器人
Figure 44787DEST_PATH_IMAGE010
的手动控制模式，将
Figure 933109DEST_PATH_IMAGE010
的工具手中心点同样运动到点
Figure 815614DEST_PATH_IMAGE078
，使机器人
Figure 355049DEST_PATH_IMAGE010
和
Figure 235280DEST_PATH_IMAGE005
构成如图2所示的握手动作。协调控制器6从机器人控制器5读取并记录机器人
Figure 673215DEST_PATH_IMAGE010
工具手的末端位姿，其中的平移变换分量即为
Figure 546362DEST_PATH_IMAGE078
点在机器人
Figure 753352DEST_PATH_IMAGE010
基坐标系
Figure 804485DEST_PATH_IMAGE011
下的位置坐标，即
Figure 729715DEST_PATH_IMAGE081
，
Figure 140974DEST_PATH_IMAGE082
。
按照如图4所示的四点取法，在协作机器人的工作空间重叠区域选取一点
Figure 405733DEST_PATH_IMAGE039
。重复Step 3和Step 4中的操作，将两机器人工具手的中心点运动到，此时两机器人在
Figure 23982DEST_PATH_IMAGE039
点构成握手动作。协调控制器6读取并记录此时
Figure 51981DEST_PATH_IMAGE039
点在
Figure 171247DEST_PATH_IMAGE006
下的位置坐标
Figure 626499DEST_PATH_IMAGE083
、在
Figure 447693DEST_PATH_IMAGE011
下的位置坐标
Figure 951487DEST_PATH_IMAGE084
。
按照如图4所示的四点取法，在协作机器人的工作空间重叠区域选取一点
Figure 253155DEST_PATH_IMAGE040
。重复Step 3和Step 4中的操作，将两机器人工具手的中心点运动到
Figure 72119DEST_PATH_IMAGE040
，此时两机器人在
Figure 193659DEST_PATH_IMAGE040
点构成握手动作。协调控制器6读取并记录此时点在
Figure 657318DEST_PATH_IMAGE006
下的位置坐标
Figure 641323DEST_PATH_IMAGE085
、在
Figure 187842DEST_PATH_IMAGE011
下的位置坐标。
按照如图4所示的四点取法，在协作机器人的工作空间重叠区域选取一点
Figure 293388DEST_PATH_IMAGE041
。重复Step 3和Step 4中的操作，将两机器人工具手的中心点运动到
Figure 261344DEST_PATH_IMAGE041
，此时两机器人在
Figure 295159DEST_PATH_IMAGE041
点构成握手动作。协调控制器6读取并记录此时点在
Figure 58901DEST_PATH_IMAGE006
下的位置坐标
Figure 135442DEST_PATH_IMAGE087
、在
Figure 718870DEST_PATH_IMAGE011
下的位置坐标。
将上述四点的坐标值
Figure 140810DEST_PATH_IMAGE089
、
Figure 388251DEST_PATH_IMAGE083
、
Figure 645926DEST_PATH_IMAGE085
、
Figure 699333DEST_PATH_IMAGE087
，
Figure 476796DEST_PATH_IMAGE090
、、
Figure 702427DEST_PATH_IMAGE086
、代入条件方程式（8）
Figure 925915DEST_PATH_IMAGE058
，
验证各点坐标是否满足本发明中要求的条件。如满足上述条件则继续Step 9，否则返回Step 2重新选择四个点执行步骤Step 2-Step 7。
将上述四点的坐标值依次代入式（7）、
Figure 30006DEST_PATH_IMAGE001
式（13）、
Figure 809743DEST_PATH_IMAGE002
和式（14），
Figure 142636DEST_PATH_IMAGE091
计算求解得到协作机器人基坐标系的标定结果
Figure 138099DEST_PATH_IMAGE028
，
Figure 960562DEST_PATH_IMAGE017
。
依次执行上述9个步骤就可以实现本发明中介绍的协作机器人基坐标系标定方法。
采用本发明提出的协作机器人基坐标系标定方法可解决多机器人系统中的机器人基坐标系标定问题。本发明的标定精度完全满足常见的机器人操作任务的精度要求。

Claims (4)

1.一种应用于多机器人系统的协作机器人基坐标系标定方法，其特征在于：将n台多机器人系统按相互间有协作关系的前提分成n-1组，每组两台，通过在每组两台协作机器人之间构造四组握手动作获取标定方程所需的位置信息，借助于标定方程求解具有协作关系的两机器人基坐标系间的位姿变换矩阵；重复n-1次，完成n-1组两协作机器人的基坐标系标定，从而完成n台机器人系统的协作机器人基坐标系标定。
2.如权利要求1所述的应用于多机器人系统的协作机器人基坐标系标定方法，其特征在于：协作机器人基坐标系标定方法中，标定方程的具体形式为：
Figure 128624DEST_PATH_IMAGE002
Figure 2011100270806100001DEST_PATH_IMAGE003
其中，
Figure 95311DEST_PATH_IMAGE004
是两协作机器人之间构成握手动作时机器人工具手的中心点在机器人
Figure 2011100270806100001DEST_PATH_IMAGE005
的基坐标系下的位置坐标，
Figure 2011100270806100001DEST_PATH_IMAGE007
分别针对四组不同位置下的握手动作，上标表示该点的坐标是针对坐标系
Figure 189672DEST_PATH_IMAGE006
而言；
Figure 2011100270806100001DEST_PATH_IMAGE009
是两协作机器人之间构成握手动作时机器人工具手的中心点在机器人的基坐标系
Figure 2011100270806100001DEST_PATH_IMAGE011
下的位置坐标，上标
Figure 774380DEST_PATH_IMAGE012
表示该点的坐标是针对坐标系
Figure 2011100270806100001DEST_PATH_IMAGE013
而言；是标定方程的中间计算结果，是协作机器人基坐标系间的旋转变换矩阵，
Figure 561257DEST_PATH_IMAGE016
是协作机器人基坐标系间的平移变换向量。齐次变换矩阵
Figure DEST_PATH_IMAGE017
就是最后得到的标定结果，反映了两协作机器人基坐标系之间的位姿变换关系。
3.如权利要求1所述的应用于多机器人系统的协作机器人基坐标系标定方法，其特征在于：所述的握手动作构造的基本要求是两机器人工具手中心点位于协作机器人工作空间重叠区域中的同一点。
4.如权利要求1所述的应用于多机器人系统的协作机器人基坐标系标定方法，其特征在于：通过在每组两台协作机器人之间构造四组握手动作，针对四组握手动作完成时的机器人工具手中心点取法提出的一种“直角正三棱锥”四点取法，四点位置在机器人协作空间中构成一个直角正三棱锥。
CN 201110027080 2011-01-26 2011-01-26 具有协作关系的多机器人系统的基坐标系标定方法 Expired - Fee Related CN102226677B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN 201110027080 CN102226677B (zh) 2011-01-26 2011-01-26 具有协作关系的多机器人系统的基坐标系标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN 201110027080 CN102226677B (zh) 2011-01-26 2011-01-26 具有协作关系的多机器人系统的基坐标系标定方法

Publications (2)

Publication Number Publication Date
CN102226677A true CN102226677A (zh) 2011-10-26
CN102226677B CN102226677B (zh) 2013-01-16

Family

ID=44807664

Family Applications (1)

Application Number Title Priority Date Filing Date
CN 201110027080 Expired - Fee Related CN102226677B (zh) 2011-01-26 2011-01-26 具有协作关系的多机器人系统的基坐标系标定方法

Country Status (1)

Country Link
CN (1) CN102226677B (zh)

Cited By (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103868996A (zh) * 2014-03-20 2014-06-18 北京理工大学 用于无损检测的双机械手工件坐标系自动重合方法
CN104165584A (zh) * 2013-05-17 2014-11-26 上海三菱电梯有限公司 机器人基坐标系的非接触式高精度标定方法及其应用
CN105066831A (zh) * 2015-09-09 2015-11-18 大族激光科技产业集团股份有限公司 一种单一或多机器人系统协同工作坐标系的标定方法
CN105073349A (zh) * 2013-03-19 2015-11-18 松下知识产权经营株式会社 机器人系统的控制方法以及机器人系统
CN105180962A (zh) * 2015-05-29 2015-12-23 浙江大学 一种基于空间两点投影的协同机器人基座标系标定方法
WO2016074646A1 (zh) * 2014-11-14 2016-05-19 深圳配天智能技术研究院有限公司 一种工具在机器人法兰坐标系上的标定方法及装置
CN105698678A (zh) * 2016-02-24 2016-06-22 浙江大学 一种飞机壁板卧式自动钻铆机的基坐标系标定方法
CN105902312A (zh) * 2016-05-20 2016-08-31 深圳市智图医疗技术有限责任公司 一种手术导航工具的标定方法
CN106141472A (zh) * 2016-07-05 2016-11-23 纳博特南京科技有限公司 一种双机器人双边对称焊接控制方法
CN104215206B (zh) * 2014-09-28 2017-01-11 东南大学 一种双机器人协作系统的基坐标标定方法
CN107037235A (zh) * 2016-11-28 2017-08-11 东南大学 一种制动下滑量软测量方法及测量装置
CN107121108A (zh) * 2017-06-06 2017-09-01 湖北工业大学 一种快捷自判误机器人工具坐标系标定方法
CN107727026A (zh) * 2017-10-18 2018-02-23 北方工业大学 面向双工业机器人协同工作的工件坐标系的标定方法
CN108230402A (zh) * 2018-01-23 2018-06-29 北京易智能科技有限公司 一种基于三棱锥模型的立体标定方法
CN108436915A (zh) * 2018-04-17 2018-08-24 上海达野智能科技有限公司 双机器人运动控制方法
WO2018233088A1 (zh) * 2017-06-20 2018-12-27 巨轮（广州）机器人与智能制造有限公司 一种双六轴机器人协同运动控制模型及算法
CN109304731A (zh) * 2017-07-28 2019-02-05 深圳先进技术研究院 一种机器人坐标系标定工具
CN109333537A (zh) * 2018-10-29 2019-02-15 华中科技大学 一种双臂协作机器人系统的基坐标系标定方法及系统
WO2020015624A1 (zh) * 2018-07-16 2020-01-23 北京理工大学 一种双机械手超声检测系统和方法
WO2020051748A1 (zh) * 2018-09-10 2020-03-19 深圳配天智能技术研究院有限公司 标定方法及标定装置
CN111546330A (zh) * 2020-04-15 2020-08-18 浙江娃哈哈智能机器人有限公司 一种自动化工件坐标系标定方法
CN112105484A (zh) * 2019-05-24 2020-12-18 深圳配天智能技术研究院有限公司 机器人运动学参数自标定方法、系统及存储装置
CN113787541A (zh) * 2021-11-17 2021-12-14 杭州灵西机器人智能科技有限公司 一种机器人位置校正的方法和机器人定位系统
CN114905548A (zh) * 2022-06-29 2022-08-16 武汉库柏特科技有限公司 一种双臂机器人基坐标系标定方法及其装置
CN116294987A (zh) * 2022-11-25 2023-06-23 无锡中车时代智能装备研究院有限公司 一种双机器人自动测量打磨系统中的坐标转换方法及系统
CN117601137A (zh) * 2024-01-24 2024-02-27 海克斯康软件技术(青岛)有限公司 一种多机器人的联合控制方法
US12005591B2 (en) 2018-07-16 2024-06-11 Beijing Institute Of Technology Ultrasonic testing system of dual robot arms and method thereof

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2003021365A2 (en) * 2001-08-31 2003-03-13 The Board Of Regents Of The University And Community College System, On Behalf Of The University Of Nevada, Reno Coordinated joint motion control system
CN101630162A (zh) * 2008-07-16 2010-01-20 中国科学院自动化研究所 多移动机器人局部跟随控制方法
CN101945492A (zh) * 2010-08-09 2011-01-12 哈尔滨工程大学 基于分簇的多机器人任务分配方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2003021365A2 (en) * 2001-08-31 2003-03-13 The Board Of Regents Of The University And Community College System, On Behalf Of The University Of Nevada, Reno Coordinated joint motion control system
CN101630162A (zh) * 2008-07-16 2010-01-20 中国科学院自动化研究所 多移动机器人局部跟随控制方法
CN101945492A (zh) * 2010-08-09 2011-01-12 哈尔滨工程大学 基于分簇的多机器人任务分配方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
《工业控制计算机》 20101231 陈兴云 等 弧焊机器人工具标定与接触寻找焊缝实现 62-64 1-4 第23卷, 第2期 *
《机器人》 20010331 朴永杰 等 弧焊机器人TCF参数的标定 109-112 1-4 第23卷, 第2期 *
《机器人》 20100331 于文鹏 等 抓持式对接机构的设计及分析 233-240 1-4 第32卷, 第2期 *
《福州大学学报》 20080930 赵娇娇 等 弧焊机器人系统标定 31-34 1-4 第36卷, *

Cited By (38)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105073349A (zh) * 2013-03-19 2015-11-18 松下知识产权经营株式会社 机器人系统的控制方法以及机器人系统
CN104165584A (zh) * 2013-05-17 2014-11-26 上海三菱电梯有限公司 机器人基坐标系的非接触式高精度标定方法及其应用
CN103868996B (zh) * 2014-03-20 2016-09-14 北京理工大学 用于无损检测的双机械手工件坐标系自动重合方法
CN103868996A (zh) * 2014-03-20 2014-06-18 北京理工大学 用于无损检测的双机械手工件坐标系自动重合方法
CN104215206B (zh) * 2014-09-28 2017-01-11 东南大学 一种双机器人协作系统的基坐标标定方法
US10539406B2 (en) 2014-11-14 2020-01-21 Shenzhen A&E Smart Institute Co., Ltd. Method and apparatus for calibrating tool in flange coordinate system of robot
WO2016074646A1 (zh) * 2014-11-14 2016-05-19 深圳配天智能技术研究院有限公司 一种工具在机器人法兰坐标系上的标定方法及装置
CN105180962A (zh) * 2015-05-29 2015-12-23 浙江大学 一种基于空间两点投影的协同机器人基座标系标定方法
CN105180962B (zh) * 2015-05-29 2017-12-29 浙江大学 一种基于空间两点投影的协同机器人基坐标系标定方法
CN105066831A (zh) * 2015-09-09 2015-11-18 大族激光科技产业集团股份有限公司 一种单一或多机器人系统协同工作坐标系的标定方法
CN105698678A (zh) * 2016-02-24 2016-06-22 浙江大学 一种飞机壁板卧式自动钻铆机的基坐标系标定方法
CN105902312A (zh) * 2016-05-20 2016-08-31 深圳市智图医疗技术有限责任公司 一种手术导航工具的标定方法
CN105902312B (zh) * 2016-05-20 2019-06-25 深圳市智图医疗技术有限责任公司 一种手术导航工具的标定方法
CN106141472A (zh) * 2016-07-05 2016-11-23 纳博特南京科技有限公司 一种双机器人双边对称焊接控制方法
CN107037235A (zh) * 2016-11-28 2017-08-11 东南大学 一种制动下滑量软测量方法及测量装置
CN107121108A (zh) * 2017-06-06 2017-09-01 湖北工业大学 一种快捷自判误机器人工具坐标系标定方法
CN107121108B (zh) * 2017-06-06 2019-05-10 湖北工业大学 一种快捷自判误机器人工具坐标系标定方法
WO2018233088A1 (zh) * 2017-06-20 2018-12-27 巨轮（广州）机器人与智能制造有限公司 一种双六轴机器人协同运动控制模型及算法
CN109304731A (zh) * 2017-07-28 2019-02-05 深圳先进技术研究院 一种机器人坐标系标定工具
CN109304731B (zh) * 2017-07-28 2021-09-07 深圳先进技术研究院 一种机器人坐标系标定工具
CN107727026A (zh) * 2017-10-18 2018-02-23 北方工业大学 面向双工业机器人协同工作的工件坐标系的标定方法
CN108230402A (zh) * 2018-01-23 2018-06-29 北京易智能科技有限公司 一种基于三棱锥模型的立体标定方法
CN108230402B (zh) * 2018-01-23 2021-09-21 北京易智能科技有限公司 一种基于三棱锥模型的立体标定方法
CN108436915A (zh) * 2018-04-17 2018-08-24 上海达野智能科技有限公司 双机器人运动控制方法
WO2020015624A1 (zh) * 2018-07-16 2020-01-23 北京理工大学 一种双机械手超声检测系统和方法
US12005591B2 (en) 2018-07-16 2024-06-11 Beijing Institute Of Technology Ultrasonic testing system of dual robot arms and method thereof
WO2020051748A1 (zh) * 2018-09-10 2020-03-19 深圳配天智能技术研究院有限公司 标定方法及标定装置
CN109333537A (zh) * 2018-10-29 2019-02-15 华中科技大学 一种双臂协作机器人系统的基坐标系标定方法及系统
CN112105484A (zh) * 2019-05-24 2020-12-18 深圳配天智能技术研究院有限公司 机器人运动学参数自标定方法、系统及存储装置
CN112105484B (zh) * 2019-05-24 2023-05-05 深圳配天智能技术研究院有限公司 机器人运动学参数自标定方法、系统及存储装置
CN111546330B (zh) * 2020-04-15 2022-04-19 浙江娃哈哈智能机器人有限公司 一种自动化工件坐标系标定方法
CN111546330A (zh) * 2020-04-15 2020-08-18 浙江娃哈哈智能机器人有限公司 一种自动化工件坐标系标定方法
CN113787541A (zh) * 2021-11-17 2021-12-14 杭州灵西机器人智能科技有限公司 一种机器人位置校正的方法和机器人定位系统
CN114905548A (zh) * 2022-06-29 2022-08-16 武汉库柏特科技有限公司 一种双臂机器人基坐标系标定方法及其装置
CN116294987B (zh) * 2022-11-25 2023-12-08 无锡中车时代智能装备研究院有限公司 一种双机器人自动测量打磨系统中的坐标转换方法及系统
CN116294987A (zh) * 2022-11-25 2023-06-23 无锡中车时代智能装备研究院有限公司 一种双机器人自动测量打磨系统中的坐标转换方法及系统
CN117601137A (zh) * 2024-01-24 2024-02-27 海克斯康软件技术(青岛)有限公司 一种多机器人的联合控制方法
CN117601137B (zh) * 2024-01-24 2024-03-29 海克斯康软件技术(青岛)有限公司 一种多机器人的联合控制方法

Also Published As

Publication number Publication date
CN102226677B (zh) 2013-01-16

Similar Documents

Publication Publication Date Title
CN102226677B (zh) 具有协作关系的多机器人系统的基坐标系标定方法
CN104440864B (zh) 一种主从式遥操作工业机器人系统及其控制方法
CN108818535B (zh) 机器人3d视觉手眼标定方法
CN101791801B (zh) 工业机器人运动规划与性能测试系统及其实现方法
CN110193829A (zh) 一种耦合运动学与刚度参数辨识的机器人精度控制方法
CN106003034B (zh) 一种主从式机器人控制系统及控制方法
CN111360827A (zh) 一种视觉伺服切换控制方法及系统
KR20160149290A (ko) 로봇을 프로그래밍하기 위한 방법 및 시스템
CN110815189B (zh) 基于混合现实的机器人快速示教系统及方法
WO2022174657A1 (zh) 一种五轴数控机床平动轴几何误差补偿数据快速优化方法
CN105066831A (zh) 一种单一或多机器人系统协同工作坐标系的标定方法
CN102004485A (zh) 机器人离线示教方法
JPH0820894B2 (ja) 産業用ロボツトの動作制御方法
CN106647529B (zh) 一种面向六轴工业机器人轨迹精确跟踪控制的智能示教系统
CN108406769A (zh) 串联机器人的关节旋转角度确定方法及装置
CN105643619B (zh) 一种采用框架描述的工业机器人工具位姿控制方法
CN201856249U (zh) 工业机器人运动规划与性能测试系统
Wu et al. Fuzzy sliding mode variable structure control of a high-speed parallel PnP robot
Ramana Babu et al. Design optimization of 3PRS parallel manipulator using global performance indices
CN106997201A (zh) 多机器人协作的路径规划方法
Wang et al. Design and implementation of five-axis transformation function in CNC system
CN107471257A (zh) 基于单拉线编码器的机器人几何标定方法
CN111515928B (zh) 机械臂运动控制系统
Wang et al. The modular design of trajectory compensation based on ATCF for precision motion control
CN114347045A (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
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20130116

Termination date: 20220126

CF01 Termination of patent right due to non-payment of annual fee