CN108748159B - 一种机械臂工具坐标系自标定方法 - Google Patents
一种机械臂工具坐标系自标定方法 Download PDFInfo
- Publication number
- CN108748159B CN108748159B CN201810635587.1A CN201810635587A CN108748159B CN 108748159 B CN108748159 B CN 108748159B CN 201810635587 A CN201810635587 A CN 201810635587A CN 108748159 B CN108748159 B CN 108748159B
- Authority
- CN
- China
- Prior art keywords
- point
- tool
- coordinate system
- mechanical arm
- center
- 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
Images
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/1679—Programme controls characterised by the tasks executed
- B25J9/1692—Calibration of manipulator
-
- 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/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/023—Cartesian coordinate type
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明公开了一种机械臂工具坐标自标定方法,属于机器人标定相关技术领域,该方法适用于XYZR直角坐标型机器人,利用机器人自身的点位标定工具中心点,通过调整在机械臂末端的旋转轴上固定安装工具与顶尖的多个点及对应的多个位置数据,直到所需点记录完成,将记录的点位数据进行圆拟合得到圆心坐标,根据坐标几何关系获得工具坐标。本发明不需要借助外部测量工具,利用自身条件对工具坐标系相对于末端坐标系的位姿进行辨识,方法简单,便于设备方现场应用。
Description
技术领域
本发明适用于XYZR直角坐标型机器人工具坐标系的标定领域,具体涉及一种机械臂工具坐标系自标定方法。
背景技术
以工业机器人为主的柔性加工生产单元已成为将来制造业的主要发展方向,而离线编程技术又会取代目前较为广泛应用的在线示教编程,而成为工业机器人任务规划的主要编程技术。离线编程需要在计算机中对实际的机器人及其工作环境中的其它设备和工具建立精确的模型,所以对实际机器人的几何机构参数和工具参数的标定是非常重要的。固定在机器人末端的诸如夹具、焊枪等工具或摄像机、探针等传感器,都要在其自身某一位置固定一个坐标系,从而控制其相对于机器人基坐标系或世界坐标系的位置和姿态,此坐标系即为工具坐标系。
机器人工具坐标系(tool coordinate frame,TCF)标定就是确定工具坐标系相对于机器人末端连杆坐标系的变换矩阵。目前大多数商品化的机器人,其末端工具本身就是标准件,其TCF参数通常已经固定在控制器中。而且生产商还会提供一个标准的参考点来校正工具,这样用户会很方便地调整工具,但这又限制了机器人的应用,也就是说若更换了工具,其TCF的参数就很难通过这种方法来确定。例如焊接机器人,焊枪是完成焊接任务必不可少的工具,即使是同一批量的焊枪,也会因为加工误差导致其偏移量不完全相同,工具坐标系的准确度直接影响机器人的轨迹精度,所以建立一种准确、快速的标定方法对机器人的应用具有重要意义。
目前国内外工业机器人工具标定从原理上分主要有外部基准法和多点标定法。外部基准法如FANUC机器人利用DynaCal系统进行标定,ABB弧焊机器人采用Bull Eyes系统工具自动标定方法,这些方法均依赖于外部基准。多点标定法因其标定简单被广泛使用,如六点标定法、球心拟合法等进行TCP位置标定。从标定数据来源上可以分为自身标定和外部测量两种。自身标定的数据来自机器人控制器末端点位数据,外部测量则借助外部的传感设备采集点位数据,如激光跟踪仪。大体上,国内外工件坐标系的标定方法比较类似,基本上都是获取工件坐标系下的采样点,根据这些采样点在分别在两个坐标系下的坐标值,根据相应的矩阵运算标定出工件坐标系。
发明内容
本发明的目的在于提供了一种机械臂工具坐标系自标定方法,以自身控制器数据对未知工具坐标系标定,该方法不依赖于运动学矩阵运算,避免了矩阵计算陷入奇异的问题。
为实现上述目的,本发明提供了一种机械臂工具坐标系自标定方法,包括如下步骤:
(1)在机械臂末端的旋转轴上固定安装工具,并将装有所述工具的所述旋转轴回零,此时将顶尖接近所述工具的末端中心点直到重合,固定所述顶尖,标记所述顶尖的尖端作为初始点,并记录此时所述初始点对应的位置数据为第一数据;
(2)旋转末端轴若干角度,使所述工具中心点从步骤(1)所述初始点转到第二个点,然后将所述工具中心点在不改变当前姿态的前提下,从所述第二个点移动到初始点,并记录此时所述初始点对应的位置数据为第二数据;
(3)将所述工具中心点在不改变当前姿态的前提下回到步骤(2)所述第二个点,再次旋转末端轴若干角度,使所述工具中心点从所述第二个点转到第三个点,然后将所述工具中心点在不改变当前姿态的前提下,从所述第三个点移动到初始点,并记录此时所述初始点对应的位置数据为第三数据;
(4)重复步骤(2)和步骤(3)过程,直到所需点记录完成,然后将记录的点位置数据进行空间圆拟合得到圆心坐标,根据坐标几何关系获得工具坐标。
进一步地,步骤(4)中所述所需点及对应的点位数据为6个。
进一步地,所述初始点对应的位置数据为机械臂末端法兰中心位置的坐标,旋转工具中心点获得的若干点为一个圆轨迹,基于等效原理,机械臂末端法兰中心也形成一个圆轨迹。
进一步地,步骤(4)具体为:所述圆拟合分为平面拟合和平面圆拟合,平面公式为:z=ax+by+c,采用最小二乘法的二元回归模型拟合,可获得平面法向量:将其单位化:当前笛卡尔坐标系{B}变换到新坐标系{P},其转换矩阵为:
其中x,y,z为空间坐标值,a,b,c为空间平面表达式系数,Ai为机械臂末端法兰中心在笛卡尔坐标系{B}下的位置坐标值,i取2,…,6中任意一个;A1为工具中心点在初始位置时机械臂末端法兰中心在笛卡尔坐标系{B}下的位置坐标值;为平面单位法向量;
将空间圆轨迹转换到二维空间的公式为:
其中,Ai为机械臂末端法兰中心在笛卡尔坐标系{B}下的位置坐标值,i取2,…,6中任意一个;PAi为Ai在新坐标系{P}下的位置坐标值;为新坐标系{P}变换到笛卡尔坐标系{B}的转换矩阵;为的逆矩阵,即笛卡尔坐标系{B}变换到新坐标系{P}的转换矩阵;
其中x,y为空间坐标值,λ,μ,η为圆表达式系数。
有益效果
机器人工具坐标系标定是计算工具端相对于机器人末端坐标系的位置和姿态的辨识过程,该位姿是一个未知的确定位姿。其中,机器人末端坐标系,是涉及到机器人控制器软件的坐标系,可以通过控制器读取各关节编码器值,并经正向运动学求得机器人末端坐标系的位置和姿态。工具坐标系是定义在工具末端的坐标系,本发明不需要借助外部测量工具,利用自身条件对工具坐标系相对于末端坐标系的位姿进行辨识,方法简单,便于设备方现场应用;现行的工具标定法大部分以六轴机器人为研究对象,适用于自由度较高的机型,而本发明主要适用于自由度低的机型,如四轴机器人,避免了使用矩阵运算易陷入奇异的情况。
附图说明
图1为本发明所述一种机械臂工具坐标自标定方法的结构示意图;
图2为本发明所述一种机械臂工具坐标自标定方法的原理示意图;
图3为本发明所述一种机械臂工具坐标自标定方法的原理示意图的右视图;
图4为本发明所述一种机械臂工具坐标自标定方法的工具坐标系示意图。
具体实施方式
应当指出,以下是结合附图及实施例,对本发明进行进一步的详细说明,此处所描述的具体实施例仅仅用以解释本发明,不应视为对本发明的保护范围有任何限制作用。此外,在不冲突的情形下,本部分中的实施例以及实施例中的特征可以相互组合。
请参阅图1至图2,本发明较佳实施方式提供的一种机械臂工具坐标系自标定方法,包括如下步骤:
(1)在机械臂末端的旋转轴1上固定安装工具2,并将装有所述工具2的所述旋转轴1回零,此时将顶尖3接近所述工具2的末端中心点直到重合,固定所述顶尖3,标记所述顶尖的尖端作为初始点P1,并记录此时所述初始点P1对应的位置数据为第一数据A1;
(2)旋转末端轴若干角度,使所述工具2中心点从步骤(1)所述初始点P1转到第二个点P2,然后将所述工具2中心点在不改变当前姿态的前提下,从所述第二个点P2移动到初始点P2,并记录此时所述初始点P1对应的位置数据为第二数据A2;
(3)将所述工具2中心点在不改变当前姿态的前提下回到步骤(2)所述第二个点P2,再次旋转末端轴若干角度,使所述工具2中心点从所述第二个点P2转到第三个点P3,然后将所述工具2中心点在不改变当前姿态的前提下,从所述第三个点P3移动到初始点P1,并记录此时所述初始点P1对应的位置数据为第三数据A3;
具体地,所述先旋转再移动到初始点P1所需记录的位置个数为6个。本实施方式中,所述记录的位置为6个,可以理解,在其他实施方式中,所述位置个数可以根据实际需要增加或减少,但最少不能少于3个。
如图3所示,所述记录位置数据A1-A6为机械臂末端法兰中心位置,可由控制器读取各关节编码器值,并经正向运动学求得机器人末端坐标系的位置和姿态,旋转工具中心点获得的若干点P1-P6为一个圆轨迹,基于等效原理,机械臂末端法兰中心也形成一个圆轨迹,
具体地,步骤(4)具体为:所述圆拟合分为平面拟合和平面圆拟合,平面公式为:z=ax+by+c,采用最小二乘法的二元回归模型拟合,可获得平面法向量:将其单位化:当前笛卡尔坐标系{B}变换到新坐标系{P},其转换矩阵为:
其中x,y,z为空间坐标值,a,b,c为空间平面表达式系数,Ai为机械臂末端法兰中心在笛卡尔坐标系{B}下的位置坐标值,i取2,…,6中任意一个;A1为工具中心点在初始位置时机械臂末端法兰中心在笛卡尔坐标系{B}下的位置坐标值;为平面单位法向量;
将空间圆轨迹转换到二维空间的公式为:
其中,Ai为机械臂末端法兰中心在笛卡尔坐标系{B}下的位置坐标值,i取2,…,6中任意一个;PAi为Ai在新坐标系{P}下的位置坐标值;为新坐标系{P}变换到笛卡尔坐标系{B}的转换矩阵;为的逆矩阵,即笛卡尔坐标系{B}变换到新坐标系{P}的转换矩阵;
其中x,y为空间坐标值,λ,μ,η为圆表达式系数。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉该技术的人在本发明所揭露的技术范围内,均可想到的变化或替换都涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求保护的范围为准。
Claims (4)
1.一种机械臂工具坐标系自标定方法,其特征在于,包括如下步骤:
(1)在机械臂末端的旋转轴上固定安装工具,并将装有所述工具的所述旋转轴回零,此时将顶尖接近所述工具的末端中心点直到重合,固定所述顶尖,标记所述顶尖的尖端作为初始点,并记录此时所述初始点对应的位置数据为第一数据;
(2)旋转末端轴若干角度,使所述工具中心点从步骤(1)所述初始点转到第二个点,然后将所述工具中心点在不改变当前姿态的前提下,从所述第二个点移动到初始点,并记录此时所述初始点对应的位置数据为第二数据;
(3)将所述工具中心点在不改变当前姿态的前提下回到步骤(2)所述第二个点,再次旋转末端轴若干角度,使所述工具中心点从所述第二个点转到第三个点,然后将所述工具中心点在不改变当前姿态的前提下,从所述第三个点移动到初始点,并记录此时所述初始点对应的位置数据为第三数据;
(4)重复步骤(2)和步骤(3)过程,直到所需点记录完成,然后将记录的点位置数据进行空间圆拟合得到圆心坐标,根据坐标几何关系获得工具坐标;
步骤(4)具体为:所述圆拟合分为平面拟合和平面圆拟合,平面公式为:z=ax+by+c,采用最小二乘法的二元回归模型拟合,可获得平面法向量:将其单位化:当前笛卡尔坐标系{B}变换到新坐标系{P},其转换矩阵为:
其中x,y,z为空间坐标值,a,b,c为空间平面表达式系数,Ai为机械臂末端法兰中心在笛卡尔坐标系{B}下的位置坐标值,i取2,…,6中任意一个;A1为工具中心点在初始位置时机械臂末端法兰中心在笛卡尔坐标系{B}下的位置坐标值;为平面单位法向量;
将空间圆轨迹转换到二维空间的公式为:
其中,Ai为机械臂末端法兰中心在笛卡尔坐标系{B}下的位置坐标值,i取2,…,6中任意一个;PAi为Ai在新坐标系{P}下的位置坐标值;为新坐标系{P}变换到笛卡尔坐标系{B}的转换矩阵;为的逆矩阵,即笛卡尔坐标系{B}变换到新坐标系{P}的转换矩阵;
其中x,y为空间坐标值,λ,μ,η为圆表达式系数。
2.根据权利要求1所述的一种机械臂工具坐标系自标定方法,其特征在于,步骤(4)中所述所需点及对应的点位数据为6个。
3.根据权利要求1所述的一种机械臂工具坐标系自标定方法,其特征在于,所述初始点对应的位置数据为机械臂末端法兰中心位置的坐标,旋转工具中心点获得的若干点为一个圆轨迹,基于等效原理,机械臂末端法兰中心也形成一个圆轨迹。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810635587.1A CN108748159B (zh) | 2018-06-20 | 2018-06-20 | 一种机械臂工具坐标系自标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810635587.1A CN108748159B (zh) | 2018-06-20 | 2018-06-20 | 一种机械臂工具坐标系自标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108748159A CN108748159A (zh) | 2018-11-06 |
CN108748159B true CN108748159B (zh) | 2022-01-14 |
Family
ID=63979053
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810635587.1A Active CN108748159B (zh) | 2018-06-20 | 2018-06-20 | 一种机械臂工具坐标系自标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108748159B (zh) |
Families Citing this family (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113059559B (zh) * | 2020-01-02 | 2022-07-12 | 台达电子工业股份有限公司 | 机器人工具的校正方法与校正系统 |
CN109900207A (zh) * | 2019-03-12 | 2019-06-18 | 精诚工科汽车系统有限公司 | 机器人视觉工具的工具中心点标定方法及系统 |
WO2020252631A1 (zh) * | 2019-06-17 | 2020-12-24 | 西门子(中国)有限公司 | 一种坐标系校准方法、装置和计算机可读介质 |
CN110411338B (zh) * | 2019-06-24 | 2020-12-18 | 武汉理工大学 | 机器人电弧增材修复的焊枪工具参数三维扫描标定方法 |
CN110487233B (zh) * | 2019-07-30 | 2021-06-15 | 东莞长盈精密技术有限公司 | 校正机器人用户坐标系的方法及系统 |
CN110682289B (zh) * | 2019-10-08 | 2021-01-12 | 华中科技大学 | 基于工业机器人的曲面工件坐标系自动标定方法 |
CN111157004B (zh) * | 2019-12-31 | 2024-03-19 | 上海新时达机器人有限公司 | 法兰朝下四轴机器人的工具标定方法 |
CN111590899B (zh) * | 2020-04-27 | 2021-09-14 | 蒋青 | 用于机械臂3d打印的视觉辅助定位装置及其定位方法 |
CN112318506B (zh) * | 2020-10-28 | 2021-12-17 | 上海交通大学医学院附属第九人民医院 | 机械臂自动标定方法、装置、设备、机械臂和介质 |
CN113400305B (zh) * | 2021-06-07 | 2023-01-17 | 北京长木谷医疗科技有限公司 | 磨挫工具的控制方法、装置、电子设备及存储介质 |
CN113459094B (zh) * | 2021-06-23 | 2022-06-14 | 佛山智能装备技术研究院 | 一种工业机器人工具坐标系及零点自标定方法 |
CN113635349B (zh) * | 2021-07-01 | 2023-06-20 | 东风柳州汽车有限公司 | 校准装置以及焊接机器人 |
CN113345014B (zh) * | 2021-08-04 | 2021-10-29 | 苏州鼎纳自动化技术有限公司 | 用于计算和验算视觉对位项目中旋转中心的方法 |
CN114794667B (zh) * | 2022-03-31 | 2023-04-14 | 深圳市如本科技有限公司 | 工具标定方法、系统、装置、电子设备以及可读存储介质 |
CN115127138B (zh) * | 2022-06-29 | 2023-12-26 | 山东澳信供热有限公司 | 一种空气源和燃气源结合的供热系统的供热方法 |
CN116423526B (zh) * | 2023-06-12 | 2023-09-19 | 上海仙工智能科技有限公司 | 一种机械臂工具坐标的自动标定方法及系统、存储介质 |
CN117182931B (zh) * | 2023-11-07 | 2024-01-23 | 上海仙工智能科技有限公司 | 一种机械臂标定数据校准方法及系统,存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5162713A (en) * | 1989-10-20 | 1992-11-10 | Hitachi, Ltd. | Structural error correction method for SCARA robot |
CN104354167A (zh) * | 2014-08-29 | 2015-02-18 | 广东正业科技股份有限公司 | 一种机器人手眼标定方法及装置 |
CN105773661A (zh) * | 2016-03-30 | 2016-07-20 | 东莞市速美达自动化有限公司 | 水平机器人固定相机下工件平移旋转标定方法 |
CN106113035A (zh) * | 2016-06-16 | 2016-11-16 | 华中科技大学 | 一种六自由度工业机器人末端工具坐标系标定装置及方法 |
CN107756391A (zh) * | 2016-08-19 | 2018-03-06 | 达观科技有限公司 | 机械手臂校正系统的校正方法 |
-
2018
- 2018-06-20 CN CN201810635587.1A patent/CN108748159B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5162713A (en) * | 1989-10-20 | 1992-11-10 | Hitachi, Ltd. | Structural error correction method for SCARA robot |
CN104354167A (zh) * | 2014-08-29 | 2015-02-18 | 广东正业科技股份有限公司 | 一种机器人手眼标定方法及装置 |
CN105773661A (zh) * | 2016-03-30 | 2016-07-20 | 东莞市速美达自动化有限公司 | 水平机器人固定相机下工件平移旋转标定方法 |
CN106113035A (zh) * | 2016-06-16 | 2016-11-16 | 华中科技大学 | 一种六自由度工业机器人末端工具坐标系标定装置及方法 |
CN107756391A (zh) * | 2016-08-19 | 2018-03-06 | 达观科技有限公司 | 机械手臂校正系统的校正方法 |
Non-Patent Citations (1)
Title |
---|
一种机器人工具坐标系标定方法;刘成业 等;《山东科学》;20120229;第25卷(第1期);69-74 * |
Also Published As
Publication number | Publication date |
---|---|
CN108748159A (zh) | 2018-11-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108748159B (zh) | 一种机械臂工具坐标系自标定方法 | |
CN107443382B (zh) | 工业机器人结构参数误差辨识与补偿方法 | |
CN107995885B (zh) | 一种坐标系标定方法 、系统及装置 | |
CN110193829B (zh) | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 | |
US7756608B2 (en) | System for calibration of an industrial robot and a method thereof | |
US8457786B2 (en) | Method and an apparatus for calibration of an industrial robot system | |
CN112105484B (zh) | 机器人运动学参数自标定方法、系统及存储装置 | |
CN110682289B (zh) | 基于工业机器人的曲面工件坐标系自动标定方法 | |
CN108972543B (zh) | 自动高精度非接触式机器人tcp标定方法 | |
KR101797122B1 (ko) | 이동형 3차원 좌표 측정기(cmm)의 에러 측정 및 보상 방법 | |
WO2018196232A1 (zh) | 机器人和末端执行器的自动标定方法及系统 | |
US20220105640A1 (en) | Method Of Calibrating A Tool Of An Industrial Robot, Control System And Industrial Robot | |
CN112109084A (zh) | 基于机器人关节角度补偿的末端位置补偿方法及其应用 | |
CN111515928B (zh) | 机械臂运动控制系统 | |
Santolaria et al. | Self-alignment of on-board measurement sensors for robot kinematic calibration | |
CN113240753A (zh) | 机器人与双轴变位机构基坐标系标定球面拟合法 | |
JP2011036956A (ja) | ロボットの精度調整方法およびロボット | |
CN112902898B (zh) | 三维测量装置及所适用的机械手臂的校正方法 | |
CN114310869B (zh) | 机器人手眼标定方法、系统以及终端 | |
CN109968347B (zh) | 一种七轴机器人的零位标定方法 | |
CN210704828U (zh) | 一种基于高精度三维空间定位系统的多轴机器人 | |
Liu et al. | Development and sensitivity analysis of a portable calibration system for joint offset of industrial robot | |
JP2021186929A (ja) | 多軸ロボットの制御方法 | |
Guo et al. | Dynamic Parameter Identification and Collision Detection of Robot | |
Maťuga | Control and positioning of robotic arm on CNC cutting machines and their applications in industry |
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 |