CN110146044A - 一种tcp精度测量及校准方法 - Google Patents

一种tcp精度测量及校准方法 Download PDF

Info

Publication number
CN110146044A
CN110146044A CN201910514353.6A CN201910514353A CN110146044A CN 110146044 A CN110146044 A CN 110146044A CN 201910514353 A CN201910514353 A CN 201910514353A CN 110146044 A CN110146044 A CN 110146044A
Authority
CN
China
Prior art keywords
tcp
calibration
autocal
initialization
instruction
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
CN201910514353.6A
Other languages
English (en)
Other versions
CN110146044B (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.)
Shanghai Aerospace Equipments Manufacturer Co Ltd
Original Assignee
Shanghai Aerospace Equipments Manufacturer Co Ltd
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 Shanghai Aerospace Equipments Manufacturer Co Ltd filed Critical Shanghai Aerospace Equipments Manufacturer Co Ltd
Priority to CN201910514353.6A priority Critical patent/CN110146044B/zh
Publication of CN110146044A publication Critical patent/CN110146044A/zh
Application granted granted Critical
Publication of CN110146044B publication Critical patent/CN110146044B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/02—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness
    • G01B21/04—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness by measuring coordinates of points
    • G01B21/042—Calibration or calibration artifacts

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种基于Autocal TCP校准设备的TCP精度测量及校准方法，建立人机交互装置和Autocal TCP进行通讯，打破Autocal TCP校准的固化程序，通过人机交互装置编辑并发送指令控制Autocal TCP完成初始化和校准过程，本发明对Autocal TCP的初始化与校准过程进行了解析，并分析出交互代码特征与反馈代码含义，采用上位机人机交互界面作为系统主控，分别与Autocal TCP校准设备与机器人通信，在上位机统一协调校准步骤，本发明打破了Autocal TCP校准的固化程序，方便用户灵活自定义校准步骤，摆脱了限制末端工具长度的问题，扩展了适用性，经实验，可以实现TCP的自动校准，且全程稳定。

Description

一种TCP精度测量及校准方法
技术领域
本发明涉及工业自动化控制领域，尤其涉及一种基于人机交互界面和AutocalTCP校准设备的全自动TCP精度测量及校准方法。
背景技术
在机器人自动加工过程中，机器人工具坐标系(TCP坐标系)是一个非常重要的坐标系，所有加工位置信息都与TCP坐标有关。但是，由于使用过程中造成的工具形变或误操作导致机器人碰撞等失误，会导致TCP坐标与实际工具位置产生偏差，最终会导致所有目标位置出现偏差。因此在恢复生产前，需确保当前TCP坐标准确。
标定TCP通常使用机器人系统的标定方法，4点法测量末端工具的坐标点位置，2点法测量末端工具的方向。该方法需要人工操作执行，且在执行4点法时需人工操作机器人以四种不同的姿态将末端工具对准同一位置，精度依靠人工保证。
Dynalog公司AutoCal机器人重复性测试系统使用激光原理来采集数据，激光器安装在U型设备内，一侧发送，另一侧接收。对机器人设置一个程序，使机器人的末端执行器定时来探测U型设备中的某个点，每探测一次，记录该次测试的X/Y/Z/A/B/C坐标信息，从而测试机器人的重复定位精度，以校准机器人工具TCP。
机器人TCP的任何改变都可以通过AutoCal系统的“恢复校准”功能自动修正。在恢复生产之前，AutoCal系统要确认已修正机器人或TCP的精确度，确保稳定的品质和过程控制。AutoCal系统提供在线的机器人校准方案是直接与机器人通信，程序已固化，导致的需限制工具长度。
发明内容
本发明提供的一种基于人机交互界面和Autocal TCP校准设备的全自动TCP精度测量及校准方法，可以自定义校准步骤，摆脱了Autocal原有的在线机器人校准方案中校准步骤固定而导致的需限制工具长度。TCP校准分为两步：1、初始化。2、校准。初始化只做一次，目的是确定机器人与TCP校准设备之间的位置姿态关系。
一种基于Autocal TCP校准设备的TCP精度测量及校准方法，通过建立人机交互装置和Autocal TCP进行通讯，打破Autocal TCP校准的固化程序，通过人机交互装置编辑并发送指令控制Autocal TCP完成初始化和校准过程。
初始化过程包括：一、set0-set3，三点法；二、p1-p4四点法；三、pz横向轮廓扫描法。
校准过程包括p1-p4四点法和pz横向轮廓扫描法，两步为一个循环，一个循环结束，Autocal TCP校准设备会反馈校准是否完成的信息，若校准未完成，则再次循环；若完成，则结束。
初始化过程执行一次，然后重复执行校准过程。
在Autocal TCP校准设备上修改参数，将刀具直径，初始化过程坐标系的Z值输入。
该方法包括初始化过程上位机控制指令代码解析、初始化过程Autocal TCP校准设备反馈指令代码解析、校准过程上位机控制指令代码解析和校准过程Autocal TCP校准设备反馈指令代码解析。
人机交互装置包括发送模块和接收模块，发送模块发送的指令包括:初始化过程三点法的控制指令；初始化过程与校准过程的四点法控制指令；初始化过程与校准过程的扫描控制指令；Autocal复位指令；初始化计算开始指令；获取初始化计算结果指令；校准计算开始指令；获取校准结果指令；激光开关指令。
机器人开始运动指令；初始化计算完成信号；初始化计算结果；校准计算完成信号；校准计算结果；激光开关状态结果。
本发明的有益效果：本项目中以采用人机交互界面作为系统主控，要求所有设备信息均由人机交互界面统一规划控制，因此需对Autocal TCP校准设备的通信进行解析，并自定义人机交互界面与Autocal TCP校准设备的通信。可以自定义校准步骤，摆脱原有的固有程序，可以实现TCP的自动校准，全程稳定。
附图说明
图1是本发明实施例的测量点set0-set3位置示意图；
图2是本发明实施例的测量点p1-p4位置示意图；
图3是本发明实施例的测量点pz位置示意图；
图4是本发明实施例的初始化流程图；
图5是本发明实施例的校准流程图。
具体实施方式
TCP校准分为两步：1、初始化。2、校准。初始化只做一次，目的是确定机器人与TCP校准设备之间的位置姿态关系。
TCP初始化总共有三步：1、set0-set3，三点法。2、p1-p4四点法。3、pz横向轮廓扫描法。校准过程：1、p1-p4四点法。2、pz横向轮廓扫描法，两步为一个循环。一个循环结束，TCP校准设备会反馈校准是否完成的信息，若校准未完成，则再次循环；若完成，则结束。
人机交互界面与Autocal TCP校准设备采用TCP/IP通讯方式，以字符串的形式进行数据的接收与发送。
第一方面，本发明提供的一种基于人机交互界面与Autocal TCP校准设备全自动TCP精度测量与校准方法，包括：
发送模块：发送的内容主要有：1、初始化过程三点法的控制指令。2、初始化过程与校准过程的四点法控制指令。3、初始化过程与校准过程的扫描控制指令。4、Autocal复位指令。5、初始化计算开始指令。6、获取初始化计算结果指令。7、校准计算开始指令。8、获取校准结果指令。9、激光开关指令。
第二方面，本发明提供的一种基于人机交互界面和Autocal TCP校准设备的全自动TCP精度测量与校准方法，包括：
接收模块：接收模块主要解析的内容有：1、机器人开始运动指令。2、初始化计算完成信号。3、初始化计算结果。4、校准计算完成信号。5、校准计算结果。6、激光开关状态结果。
下面结合具体的实施例及附图对基于人机交互界面和Autocal TCP校准设备的全自动TCP精度测量与校准方法进行详细的描述，以使其更加清楚。
初始化过程
初始化总共需要测量8个点+1个轮廓。即set0、set1、set2、set3、p1、p2、p3、p4、pz。
测量位置如图1、图2、图3所示，步骤如图4所示。
操作流程如下：
①在Autocal TCP校准设备上修改参数。将刀具直径，初始化工具坐标系的Z值输入。
②执行set0-set3过程。set0-set3示教位置如图1所示，且刀具必须垂直于激光平面。测量set0时，发送Autoca TCP校准设备复位指令+机器人当前A1-A6关节角度+初始化工具坐标系XYZABC值+事件号+点名称。测量set1-set3时，发送机器人当前A1-A6关节角度+事件号+点名称。每发送一个点的测量信息后，对反馈数据进行解析，反馈事件号与发送事件号对应则表示该点测量完成，可继续执行机器人程序，机器人运动到下一个测量点。
③执行p1-p4过程。示教位置如图2所示，测量p1时，发送机器人当前A1-A6关节角度+初始化工具坐标系XYZABC值+事件号+点名称。测量p2-p4时，发送机器人当前A1-A6关节角度+事件号+点名称。每发送一个点的测量信息后，对反馈数据进行解析，反馈事件号与发送事件号对应则表示该点测量完成，可继续执行机器人程序，机器人运动到下一个测量点。
④执行pz过程。示教位置如图3，共需示教3个点，1、在激光中的点。2、开始扫描点，位于激光平面下。3、结束扫描点，位于激光平面上，执行扫描过程即从开始扫描点运动到结束扫描点。测量在激光中的点时，发送机器人当前A1-A6关节角度+初始化工具坐标系XYZABC值+事件号+点名称。对反馈数据进行解析，反馈事件号与发送事件号对应则表示该点测量完成，机器人运动到开始扫描点完成扫描过程。
所有点测量结束后发送初始化计算开始指令，Autocal TCP校准设备反馈计算完成的信号后上位机发送初始化计算结果获取指令，对反馈信息进行解析判断初始化执行是否完成。
校准过程
更换了新工具后，校准流程如图5所示，测量点与图2和图3相同。
操作流程如下：
①首先复位Autcal TCP校准设备，发送指令后对接收到的指令进行解析，接收到Autoca TCP反馈的复位成功代码后机器人继续运动到p1。
②执行p1-p4过程，示教位置如图2所示。测量p1点时，发送机器人当前A1-A6关节角度+校准后的新的工具坐标值(第一次时发送初始化工具坐标系)+事件号+点名称。测量p2-p4点时，发送机器人当前A1-A6关节角度+事件号+点名称。每发送一个点的测量数据后，对反馈数据进行解析，反馈事件号与发送事件号对应则表示该点测量完成，可继续执行机器人程序，机器人运动到下一个点。
③执行完p1-p4，发送校准开始计算与获取校准计算结果指令，若计算正常，则反馈计算完的工具坐标系值，此坐标值在机器人程序中需不断更新。若计算不正常，则自动流程中断。需排查故障，并复位机器人。
④执行pz过程，示教位置如图3所示。测量点时，发送机器人当前A1-A6关节角度+校准后的新的工具坐标值+事件号+点名称。对反馈数据进行解析，反馈事件号与发送事件号对应则表示该点测量完成，机器人运动到开始扫描点执行扫描过程。
⑤执行完pz，发送开始校准计算与获取校准计算结果指令。若计算正常，则反馈计算完的工具坐标系值，此坐标值在机器人程序中需不断更新。同时判断是否需要再次循环。若计算不正常，则自动流程中断。需排查故障，并复位机器人。
校准结果解析
执行完一个循环，对最后的校准计算结果进行解析，判断校准是否完成，是否需要再次循环。中间过程不做判断。
激光控制
激光的开关指令可控制Autocal TCP校准设备的激光开关。

Claims (8)

1.一种TCP精度测量及校准方法，基于Autocal TCP校准设备，其特征在于：建立人机交互装置和Autocal TCP进行通讯，打破Autocal TCP校准的固化程序，通过人机交互装置编辑并发送指令控制Autocal TCP完成初始化和校准过程。
2.根据权利要求1所述的一种TCP精度测量及校准方法，其特征在于：初始化过程包括：一、set0-set3，三点法；二、p1-p4四点法；三、pz横向轮廓扫描法。
3.根据权利要求1所述的一种TCP精度测量及校准方法，其特征在于：校准过程包括p1-p4四点法和pz横向轮廓扫描法，两步为一个循环，一个循环结束，Autocal TCP校准设备会反馈校准是否完成的信息，若校准未完成，则再次循环；若完成，则结束。
4.根据权利要求1所述的一种TCP精度测量及校准方法，其特征在于：初始化过程执行一次，然后重复执行校准过程。
5.根据权利要求2所述的一种TCP精度测量及校准方法，其特征在于：在Autocal TCP校准设备上修改参数，将刀具直径，初始化过程坐标系的Z值输入。
6.根据权利要求1所述的一种TCP精度测量及校准方法，其特征在于：该方法包括初始化过程上位机控制指令代码解析、初始化过程Autocal TCP校准设备反馈指令代码解析、校准过程上位机控制指令代码解析和校准过程Autocal TCP校准设备反馈指令代码解析。
7.根据权利要求1所述的一种TCP精度测量及校准方法，其特征在于：人机交互装置包括发送模块和接收模块，发送模块发送的指令包括:初始化过程三点法的控制指令；初始化过程与校准过程的四点法控制指令；初始化过程与校准过程的扫描控制指令；Autocal复位指令；初始化计算开始指令；获取初始化计算结果指令；校准计算开始指令；获取校准结果指令；激光开关指令。
8.根据权利要求7所述的一种TCP精度测量及校准方法，其特征在于：接收模块接收：机器人开始运动指令；初始化计算完成信号；初始化计算结果；校准计算完成信号；校准计算结果；激光开关状态结果。
CN201910514353.6A 2019-06-14 2019-06-14 一种tcp精度测量及校准方法 Active CN110146044B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910514353.6A CN110146044B (zh) 2019-06-14 2019-06-14 一种tcp精度测量及校准方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910514353.6A CN110146044B (zh) 2019-06-14 2019-06-14 一种tcp精度测量及校准方法

Publications (2)

Publication Number Publication Date
CN110146044A true CN110146044A (zh) 2019-08-20
CN110146044B CN110146044B (zh) 2021-12-28

Family

ID=67591255

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910514353.6A Active CN110146044B (zh) 2019-06-14 2019-06-14 一种tcp精度测量及校准方法

Country Status (1)

Country Link
CN (1) CN110146044B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112815887A (zh) * 2020-12-30 2021-05-18 廊坊市亿创科技有限公司 一种工业机器人末端工具坐标系标定方法

Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1892175A (zh) * 2005-07-08 2007-01-10 鸿富锦精密工业（深圳）有限公司 三坐标测量机床误差补偿系统及方法
CN102087096A (zh) * 2010-11-12 2011-06-08 浙江大学 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法
CN103115629A (zh) * 2013-01-23 2013-05-22 天津大学 机器人柔性视觉测量系统中工具坐标系快速修复方法
CN103273496A (zh) * 2013-05-08 2013-09-04 长沙长泰机器人有限公司 一种利用智能相机在机器人搬运系统中定位工件的方法
CN105091807A (zh) * 2014-04-30 2015-11-25 鸿富锦精密工业（深圳）有限公司 机器人工具坐标系的校正方法
CN105157567A (zh) * 2015-05-15 2015-12-16 天津智通机器人有限公司 一种测量机器人的工具坐标系标定方法及系统
CN105269565A (zh) * 2015-10-30 2016-01-27 福建长江工业有限公司 一种六轴磨抛工业机器人离线编程及修正方法
CN205219126U (zh) * 2015-12-09 2016-05-11 珠海格力电器股份有限公司 工业机器人工具坐标校准装置
CN205734940U (zh) * 2016-05-25 2016-11-30 南京工程学院 一种应用于工业机器人的tcp在线快速标定装置
CN106457562A (zh) * 2014-06-23 2017-02-22 Abb瑞士股份有限公司 用于校准机器人的方法和机器人系统
CN107053216A (zh) * 2017-04-25 2017-08-18 苏州蓝斯视觉系统股份有限公司 机器人和末端执行器的自动标定方法及系统
US20170322010A1 (en) * 2014-11-14 2017-11-09 Shenzhen A&E Smart Institute Co., Ltd. Method and apparatus for calibrating tool in flange coordinate system of robot
EP3274655A1 (de) * 2015-03-26 2018-01-31 Carl Zeiss Industrielle Messtechnik GmbH Kalibrierung einer an einem beweglichen teil eines koordinatenmessgeräts angebrachten drehvorrichtung
CN108274448A (zh) * 2018-01-31 2018-07-13 佛山智能装备技术研究院 一种人体交互的机器人示教方法及示教系统
CN109465826A (zh) * 2018-11-13 2019-03-15 南京工程学院 一种基于姿态均匀分布的工业机器人tcp标定方法
CN109514549A (zh) * 2018-10-17 2019-03-26 南京工程学院 一种可实现六自由度的tcp在线快速标定方法及装置
CN109708581A (zh) * 2018-12-12 2019-05-03 上海航天设备制造总厂有限公司 一种利用Autocal TCP校准设备测量物体直径的方法

Patent Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1892175A (zh) * 2005-07-08 2007-01-10 鸿富锦精密工业（深圳）有限公司 三坐标测量机床误差补偿系统及方法
CN102087096A (zh) * 2010-11-12 2011-06-08 浙江大学 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法
CN103115629A (zh) * 2013-01-23 2013-05-22 天津大学 机器人柔性视觉测量系统中工具坐标系快速修复方法
CN103273496A (zh) * 2013-05-08 2013-09-04 长沙长泰机器人有限公司 一种利用智能相机在机器人搬运系统中定位工件的方法
CN105091807A (zh) * 2014-04-30 2015-11-25 鸿富锦精密工业（深圳）有限公司 机器人工具坐标系的校正方法
CN106457562A (zh) * 2014-06-23 2017-02-22 Abb瑞士股份有限公司 用于校准机器人的方法和机器人系统
US20170322010A1 (en) * 2014-11-14 2017-11-09 Shenzhen A&E Smart Institute Co., Ltd. Method and apparatus for calibrating tool in flange coordinate system of robot
EP3274655A1 (de) * 2015-03-26 2018-01-31 Carl Zeiss Industrielle Messtechnik GmbH Kalibrierung einer an einem beweglichen teil eines koordinatenmessgeräts angebrachten drehvorrichtung
CN105157567A (zh) * 2015-05-15 2015-12-16 天津智通机器人有限公司 一种测量机器人的工具坐标系标定方法及系统
CN105269565A (zh) * 2015-10-30 2016-01-27 福建长江工业有限公司 一种六轴磨抛工业机器人离线编程及修正方法
CN205219126U (zh) * 2015-12-09 2016-05-11 珠海格力电器股份有限公司 工业机器人工具坐标校准装置
CN205734940U (zh) * 2016-05-25 2016-11-30 南京工程学院 一种应用于工业机器人的tcp在线快速标定装置
CN107053216A (zh) * 2017-04-25 2017-08-18 苏州蓝斯视觉系统股份有限公司 机器人和末端执行器的自动标定方法及系统
CN108274448A (zh) * 2018-01-31 2018-07-13 佛山智能装备技术研究院 一种人体交互的机器人示教方法及示教系统
CN109514549A (zh) * 2018-10-17 2019-03-26 南京工程学院 一种可实现六自由度的tcp在线快速标定方法及装置
CN109465826A (zh) * 2018-11-13 2019-03-15 南京工程学院 一种基于姿态均匀分布的工业机器人tcp标定方法
CN109708581A (zh) * 2018-12-12 2019-05-03 上海航天设备制造总厂有限公司 一种利用Autocal TCP校准设备测量物体直径的方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
安宗权 等: "《埃夫特工业机器人操作与编程》", 31 January 2018, 西安电子科技大学出版社 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112815887A (zh) * 2020-12-30 2021-05-18 廊坊市亿创科技有限公司 一种工业机器人末端工具坐标系标定方法
CN112815887B (zh) * 2020-12-30 2022-10-21 廊坊市亿创科技有限公司 一种工业机器人末端工具坐标系标定方法

Also Published As

Publication number Publication date
CN110146044B (zh) 2021-12-28

Similar Documents

Publication Publication Date Title
US10695910B2 (en) Automatic calibration method for robot system
US7149602B2 (en) Correction data checking system for rebots
US8406922B2 (en) System and method for setting the tool center point of a robotic tool
US20080154428A1 (en) Device, method, program and recording medium for robot offline programming
US20040172168A1 (en) Taught position modification device
EP2835229A2 (en) Robot control apparatus and method for controlling robot
CN102378943A (zh) 控制机器人工具的方法
US20140343727A1 (en) Robot positioning
US20060212171A1 (en) Off-line teaching device
CN104995481B (zh) 应用机床查明特征的方法
JP2015147280A (ja) ロボット較正方法
CN105094049A (zh) 学习路径控制
US10099376B2 (en) Method for setting up and/or calibrating a robot
CN111103850A (zh) 机床系统
CN110146044A (zh) 一种tcp精度测量及校准方法
CN117021113B (zh) 一种机械臂协作定位装配方法、系统及介质
US20210026335A1 (en) Multi-function integrated work table and production system using the same
CN109397259B (zh) 用于确定机器人设备的绝对位置的方法和机器人设备
US20020068994A1 (en) Robot control system and method
US20240091940A1 (en) Robot installation position measurement device, installation position measurement method, robot controller, teaching system, and simulator
CN115190831A (zh) 机器人系统
KR101438657B1 (ko) 산업 로봇 지그 측정방법
CN115916480A (zh) 机器人示教方法和机器人作业方法
US20210060776A1 (en) Redundant, diverse collision monitoring
JP2005028529A (ja) 産業用ロボットの原点位置合わせ装置

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