一种TCP精度测量及校准方法技术

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

A Method of TCP Accuracy Measurement and Calibration

【技术实现步骤摘要】
一种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系统提供在线的机器人校准方案是直接与机器人通信，程序已固化，导致的需限制工具长度。
技术实现思路
本专利技术提供的一种基于人机交互界面和AutocalTCP校准设备的全自动TCP精度测量及校准方法，可以自定义校准步骤，摆脱了Autocal原有的在线机器人校准方案中校准步骤固定而导致的需限制工具长度。TCP校准分为两步：1、初始化。2、校准。初始化只做一次，目的是确定机器人与TCP校准设备之间的位置姿态关系。一种基于AutocalTCP校准设备的TCP精度测量及校准方法，通过建立人机交互装置和AutocalTCP进行通讯，打破AutocalTCP校准的固化程序，通过人机交互装置编辑并发送指令控制AutocalTCP完成初始化和校准过程。初始化过程包括：一、set0-set3，三点法；二、p1-p4四点法；三、pz横向轮廓扫描法。校准过程包括p1-p4四点法和pz横向轮廓扫描法，两步为一个循环，一个循环结束，AutocalTCP校准设备会反馈校准是否完成的信息，若校准未完成，则再次循环；若完成，则结束。初始化过程执行一次，然后重复执行校准过程。在AutocalTCP校准设备上修改参数，将刀具直径，初始化过程坐标系的Z值输入。该方法包括初始化过程上位机控制指令代码解析、初始化过程AutocalTCP校准设备反馈指令代码解析、校准过程上位机控制指令代码解析和校准过程AutocalTCP校准设备反馈指令代码解析。人机交互装置包括发送模块和接收模块，发送模块发送的指令包括:初始化过程三点法的控制指令；初始化过程与校准过程的四点法控制指令；初始化过程与校准过程的扫描控制指令；Autocal复位指令；初始化计算开始指令；获取初始化计算结果指令；校准计算开始指令；获取校准结果指令；激光开关指令。机器人开始运动指令；初始化计算完成信号；初始化计算结果；校准计算完成信号；校准计算结果；激光开关状态结果。本专利技术的有益效果：本项目中以采用人机交互界面作为系统主控，要求所有设备信息均由人机交互界面统一规划控制，因此需对AutocalTCP校准设备的通信进行解析，并自定义人机交互界面与AutocalTCP校准设备的通信。可以自定义校准步骤，摆脱原有的固有程序，可以实现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校准设备会反馈校准是否完成的信息，若校准未完成，则再次循环；若完成，则结束。人机交互界面与AutocalTCP校准设备采用TCP/IP通讯方式，以字符串的形式进行数据的接收与发送。第一方面，本专利技术提供的一种基于人机交互界面与AutocalTCP校准设备全自动TCP精度测量与校准方法，包括：发送模块：发送的内容主要有：1、初始化过程三点法的控制指令。2、初始化过程与校准过程的四点法控制指令。3、初始化过程与校准过程的扫描控制指令。4、Autocal复位指令。5、初始化计算开始指令。6、获取初始化计算结果指令。7、校准计算开始指令。8、获取校准结果指令。9、激光开关指令。第二方面，本专利技术提供的一种基于人机交互界面和AutocalTCP校准设备的全自动TCP精度测量与校准方法，包括：接收模块：接收模块主要解析的内容有：1、机器人开始运动指令。2、初始化计算完成信号。3、初始化计算结果。4、校准计算完成信号。5、校准计算结果。6、激光开关状态结果。下面结合具体的实施例及附图对基于人机交互界面和AutocalTCP校准设备的全自动TCP精度测量与校准方法进行详细的描述，以使其更加清楚。初始化过程初始化总共需要测量8个点+1个轮廓。即set0、set1、set2、set3、p1、p2、p3、p4、pz。测量位置如图1、图2、图3所示，步骤如图4所示。操作流程如下：①在AutocalTCP校准设备上修改参数。将刀具直径，初始化工具坐标系的Z值输入。②执行set0-set3过程。set0-set3示教位置如图1所示，且刀具必须垂直于激光平面。测量set0时，发送AutocaTCP校准设备复位指令+机器人当前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值+事件号+点名称。对反馈数据进行解析，反馈事件号与发送事件号对应则表示该点测量完成，机器人运动到开始扫描点完本文档来自技高网...

【技术保护点】
1.一种TCP精度测量及校准方法，基于Autocal TCP校准设备，其特征在于：建立人机交互装置和Autocal TCP进行通讯，打破Autocal TCP校准的固化程序，通过人机交互装置编辑并发送指令控制Autocal TCP完成初始化和校准过程。

【技术特征摘要】
1.一种TCP精度测量及校准方法，基于AutocalTCP校准设备，其特征在于：建立人机交互装置和AutocalTCP进行通讯，打破AutocalTCP校准的固化程序，通过人机交互装置编辑并发送指令控制AutocalTCP完成初始化和校准过程。2.根据权利要求1所述的一种TCP精度测量及校准方法，其特征在于：初始化过程包括：一、set0-set3，三点法；二、p1-p4四点法；三、pz横向轮廓扫描法。3.根据权利要求1所述的一种TCP精度测量及校准方法，其特征在于：校准过程包括p1-p4四点法和pz横向轮廓扫描法，两步为一个循环，一个循环结束，AutocalTCP校准设备会反馈校准是否完成的信息，若校准未完成，则再次循环；若完成，则结束。4.根据权利要求1所述的一种TCP精度测量及校准方法，其特征在于：初始化过程执行一次，然后重复执行校准过程。5.根据权利要求2所述的一种TCP精度测量及校准方法，其特征在于：在AutocalTCP...

【专利技术属性】
技术研发人员：李芳昕，许腾云，张勇，焦新生，白彦伟，孟引根，张楠，曹晓，王学林，
申请(专利权)人：上海航天设备制造总厂有限公司，
类型：发明
国别省市：上海,31