机器人标定系统的制作方法
【专利摘要】本实用新型的机器人标定系统，所述系统包括：通信连接机器人本体的机器人控制装置、通信连接所述机器人控制装置的数据处理装置、及通信连接所述数据处理装置的用于采集所述机器人本体位姿数据的标定设备；本实用新型提供一套自动化标定系统的硬件基础，用于实现更为快捷、智能地标定机器人产品，减少人工数据交换工作，提高出厂调试的效率，并减少采样过程中的人工失误或是非实时数据引起的误差，提高产品质量。
【专利说明】
机器人标定系统
技术领域
[0001 ]本实用新型涉及机器人技术领域，特别是涉及机器人标定系统。
【背景技术】
[0002]通常工业机器人的重复定位精度很高，但是其绝对定位精度却在几毫米甚至几十毫米。这是由于机器人本体在制造及装配过程中，机器人的杆件长度和电机轴安装角度不可避免地存在着误差。这些误差导致了真实的机器人运动学模型参数和机器人控制器中存放的理论模型参数有一定偏差。控制器以理想模型参数去运算运动学反解并控制实际机器人运动时，机器人在绝对坐标系中的实到位姿必然不是软件中希望的位姿。因此每一台高品质的机器人在出厂时都必须要进行运动学参数的标定。
[0003]目前主要的标定手段都是基于独立的激光跟踪仪或线跟踪编码器设备去获取所要标定的真实机器人产品的运动学参数。但不管是使用什么设备都有以下缺点:
[0004]1.系统缺乏柔性:依据设备的不同，标定的流程一般需要采集24-50个点，并需要让标定设备知道机器人在每个标定点的关节转角信息。因此一般事先编写好一个对应某一种机型的标定运动程序，再将程序中的各点位的关节角度信息导出，通过U盘等介质上传到标定设备的处理系统上。同时也要将原始的运动学参数填入处理系统。对应每一种新型号的产品，这个准备环节都需要单独去做，不具有通用性。
[0005]2.流程不具备自动性，需要人工干预环节太多，不适合批量生产应用:在标定标定过程中，机器人运动到某个标定点后，标定设备是不知道的;标定设备采集完当前点的直角坐标信息，机器人也无法得知。因此每测一个标定点都需要测试人员于动让标定设备采集数据并让机器人向下一个点运动。几十个标定点测下来会耗费很多人力和时间，而且容易出错。
[0006]此外每一台产品都要被写入标定运动程序，完成标定之后再擦除。而标定生成的结果也需要人工重新导入到编码软件中，编译后上传到机器人控制系统，收尾步骤十分繁琐。
[0007]3.存在误差:由于每个标定点对应的关节角度值是在实际标定之前规定好的，并非是实际的角度反馈值，而实际的转角比指令转角偏差往往还会偏差一些，因此也会在一定程度上导致标定误差。
【发明内容】
[0008]鉴于以上所述现有技术的缺点，本实用新型的目的在于提供机器人标定系统的硬件结构，用于解决供现有技术中人工标定效率低的问题。
[0009]为实现上述目的及其他相关目的，本实用新型提供一种机器人标定系统，包括:通信连接机器人本体的机器人控制装置、通信连接所述机器人控制装置的数据处理装置、及通信连接所述数据处理装置的用于采集所述机器人本体位姿数据的标定设备。
[0010]于本实用新型的一实施例中，所述机器人控制装置集成于所述机器人本体，或者，所述机器人控制装置与所述机器人本体相互独立。
[0011]于本实用新型的一实施例中，所述数据处理装置集成于所述标定设备，或者，所述数据处理装置与所述标定设备相互独立。
[0012]于本实用新型的一实施例中，所述数据处理装置包括:计算机、工控机、微机、及信息上传终端中的任一种。
[0013]于本实用新型的一实施例中，所述标定设备包括:激光跟踪仪或线编码器。
[0014]于本实用新型的一实施例中，所述机器人控制装置和数据处理装置之间通过有线或无线以太网来通信连接，以及/或者，所述数据处理装置和标定设备之间通过有线或无线以太网来通信连接；所述通信的协议包括:Ethernet TCP/IP、Prof ibus-DP、CC_link、Modbus、RS232及自定义协议中的任意一种。
[0015]如上所述，本实用新型的机器人标定系统，所述系统包括:通信连接机器人本体的机器人控制装置、通信连接所述机器人控制装置的数据处理装置、及通信连接所述数据处理装置的用于采集所述机器人本体位姿数据的标定设备;本实用新型提供一套自动化标定系统的硬件基础，用于实现更为快捷、智能地标定机器人产品，减少人工数据交换工作，提高出厂调试的效率，并减少采样过程中的人工失误或是非实时数据引起的误差，提高产品质量。
【附图说明】
[0016]图1显示为本实用新型于一实施例中的机器人标定系统的结构示意图。
[0017]图2显示为本实用新型于一实施例中的机器人控制装置的功能模块示意图。
[0018]图3显示为本实用新型于一实施例中的数据处理装置的功能模块示意图。
[0019]图4A至4D显示为本实用新型于一实施例中的机器人标定系统的应用方法示意图。
[0020]元件标号说明
[0021 ]I机器人控制装置
[0022]11 机器人控制模块
[0023]12 标定功能模块
[0024]2数据处理装置
[0025]21 标定控制模块
[0026]3标定设备
[0027]4机器人本体
【具体实施方式】
[0028]以下由特定的具体实施例说明本实用新型的实施方式，熟悉此技术的人士可由本说明书所揭露的内容轻易地了解本实用新型的其他优点及功效。
[0029]须知，本说明书所附图式所绘示的结构、比例、大小等，均仅用以配合说明书所揭示的内容，以供熟悉此技术的人士了解与阅读，并非用以限定本实用新型可实施的限定条件，故不具技术上的实质意义，任何结构的修饰、比例关系的改变或大小的调整，在不影响本实用新型所能产生的功效及所能达成的目的下，均应仍落在本实用新型所揭示的技术内容得能涵盖的范围内。同时，本说明书中所引用的如“上”、“下”、“左”、“右”、“中间”及“一”等的用语，亦仅为便于叙述的明了，而非用以限定本实用新型可实施的范围，其相对关系的改变或调整，在无实质变更技术内容下，当亦视为本实用新型可实施的范畴。
[0030]本实用新型的技术方案应用于机器人标定技术领域，一般目前的现有技术中均专注于关于具体标定的精确性的算法上，而忽略了该些算法如何应用于实际场景中，也就是说，缺少将算法应用于实际环境中的系统，并且，该系统需要是自动化的而能达到自动化标定的目的。
[0031]基于此考量，本实用新型的目的正是为了提供一套这样的系统以及相应的处理过程，以下结合图示进行详细的实施例说明。
[0032]请参阅图1，本实用新型提供一种机器人标定系统，包括:机器人控制装置1、数据处理装置2、及标定设备3。
[0033]所述机器人控制装置I，通信连接机器人本体4。于本实用新型的一实施例中，所述机器人控制装置I可以集成在机器人本体4中，例如控制器等形式;而在另一实施例中，所述机器人控制装置I亦可以为独立于机器人本体4外的装置，例如控制柜等;需说明的是，无论是控制器还是控制柜均具有可以运行软件的硬件系统，包括例如处理器(MCU或CHJ等实现)，存储器(ROM或RAM等实现)；另外，所述机器人本体4可为多轴的机械臂，是能够实现自动控制的、可重复编程的、多自由度的、运动自由度建成空间直角关系的、多用途的操作机。其工作的行为方式主要是通过完成沿着X、Y、Z轴上的线性运动。
[0034]所述数据处理装置2，通信连接所述机器人控制装置I。于本实用新型的一实施例中，所述数据处理装置2可以是计算机、工控机、微机或是任何具有数据处理功能的设备，也可以是连接这些设备的信息上传终端;数据处理装置2可以独立设置，也可以附加安装在标定设备3上。
[0035]所述标定设备3，通信连接所述数据处理装置2，用于采集所述机器人本体4的位姿数据，可以是激光跟踪仪或线编码器，也可以是其他支持信息终端通讯的设备。
[0036]于本实用新型的一实施例中，所述机器人控制装置I和数据处理装置2之间通过有线或无线以太网来通信连接，以及/或者，所述数据处理装置2和标定设备3之间通过有线或无线以太网来通信连接;所述通信的协议包括:Ethernet TCP/IP、Profibus_DP、CC_link、Modbus、RS232及自定义协议中的任意一种;考虑便捷性和经济性，一般使用Ethernet TCP/IP协议及其硬件，但也可以是其他任何总线方式，例如Prof ibus-DP、CC_link、Modbus、RS232等，可以是标准协议也可以是自行修改的应用层协议。
[0037]以上实施例介绍本实用新型的硬件结构，本领域技术人员可以在上述硬件结构的基础上结合软件加以实现，但本实用新型的发明目的并非在于该些软件功能，而是提供一套可用于自动化标定的硬件结构基础。
[0038]以下提供几个优选实施例来教示如何利用本实用新型的硬件系统运行软件功能实现自动化标定。
[0039]如图2所示，所述机器人控制装置I，包括:机器人控制模块11及标定功能模块12。
[0040]所述机器人控制模块11，用于控制机器人本体4运动，且存储有与该控制相关的机器人本体4的原始运动参数。于本实用新型的一实施例中，所述机器人控制模块11可通过用于控制机器人的软件系统来实现，所述原始运动参数包括D-H参数;关于D-H模型，D-H矩阵全称Denavit-Hartenberg Matrix;Denavit和Hartenberg在 1955年提出一种通用的方法，这种方法在机器人的每个连杆上都固定一个坐标系，然后用4 X 4的齐次变换矩阵来描述相邻两连杆的空间关系。通过依次变换可最终推导出末端执行器相对于基坐标系的位姿，从而建立机器人的运动学方程;所述原始运动参数是根据机器人本体4的设计参数所得到的各种初始理论参数，如长度、角度等信息；当然，由于其为理论参数，因此会和实际机器人本体4产品之间存在误差(例如连杆长度误差等)，故需要进行所述标定作业来补偿误差。
[0041]优选的，所述机器人控制模块11还可存储有与机器人本体4控制相关的初始标定文件，当控制机器人本体4运动时，会通过该初始标定文件中的参数来补偿所述误差，而由于实际使用会对机器人本体4产生损耗、变化等，因此该标定文件需要进行更新替换，即本申请后续进行的标定文件的替换作业，当然，所述机器人控制模块11可以不存储初始标定文件，而利用本申请后文中产生的当前标定文件作为初始标定文件亦可，这样即省去了存储初始标定文件的工序。
[0042]所述标定功能模块12，连接所述机器人控制模块11，用于从所述数据处理装置2获取标定运动指令，具体的所述标定运动指令可以是转角指令，即令机器人本体4的关节转动预定角度的指令等;所述标定功能模块12将所述标定运动指令发送至所述机器人控制模块11以控制所述机器人本体4运动至标定位置。于本实用新型的一实施例中，所述标定位置为标定点，即位于预设坐标系中的预设点，该标定点可设有多个，所述机器人本体4到达一个标定点之后进行标定，然后可通过下一次的标定运动指令来继续控制机器人本体4到达下一个标定点继续进行标定。
[0043]所述标定功能模块12还用于接收所述机器人控制模块11控制机器人本体4运动至标定位置时所生成的到位信号和采集的此过程中机器人本体4的运动数据并将所述到位信号和运动数据发送至所述数据处理装置2。于本实用新型的一实施例中，所述运动数据包括机器人本体4关节的转角数据，优选的，为机器人本体4各轴(机器人关节可设有多轴的线编码器)的实际角度值，可实时反馈给所述数据处理装置2。
[0044]所述标定功能模块12还用于接收标定结果数据，并据以生成用于替换机器人控制模块11中预存的与控制所述机器人本体4运动相关的初始标定文件，或者在没有该初始标定文件的情况下将所述当前标定文件作为初始标定文件，此处的效果在前文已进行了描述;其中，所述数据处理装置2根据所述运动数据及原始运动参数计算运动到标定位置状态下的机器人本体4的理论位姿数据，并获取由所述标定设备3采集的运动到所述标定位置状态下的机器人本体4的实际位姿数据，从而根据所述理论位姿数据和实际位姿数据的差异计算得到所述标定结果数据并发送至所述机器人控制装置I。
[0045]于本实用新型的一实施例中，所述标定功能模块12提供与所述数据处理装置2通信交互的标准应用接口(API)，所述标准应用接口用于对外传输包括:所述原始运动学参数、标定运动指令、运动数据、及标定结果数据等信息，所述标准应用接口可以是对应上述各种传输数据的多个;当然，还可包括传输与数据处理装置2建立通信连接的握手指令。
[0046]于本实用新型的一实施例中，所述标定功能模块12包括:编译模块，用于编译所述标定结果数据以生成所述当前标定文件;覆写模块，用于将所述当前标定文件覆写至对应标定文件的存储空间中。
[0047]需说明的是，所述标定功能模块12可通过软件功能包来实现，并提供所述标准应用接口(API)以供外部的标定软件调用；在与各设备厂商约定的与其标定软件要求相关的规则建立和设置API并明确通讯协议后，任何一种机型的任何一台机器人产品的标定都将不再需要进行准备环节，这就提高了标定系统通用的柔性。
[0048]再如图3所示，所述数据处理装置2，包括:标定控制模块21。
[0049]所述标定控制模块21，用于接收所述机器人控制装置I发送的与所述机器人本体4运动控制相关的原始运动参数;所述标定控制模块21，用于向所述机器人控制装置I发送标定运动指令，以令所述机器人控制装置I控制所述机器人本体4运动至标定位置;所述标定控制模块21，用于从所述机器人控制装置I接收到位信号和运动数据，其中，所述机器人控制装置I控制机器人本体4运动至标定位置时生成所述到位信号，且在此过程中对机器人本体4采集以得到所述运动数据;所述标定控制模块21，用于在接收到所述到位信号时控制所述标定设备3对运动至所述标定位置状态下的机器人本体4采集以得到实际位姿数据，且用于根据所述运动数据及原始运动参数计算运动到标定位置状态下的机器人本体4的理论位姿数据(即计算机器人本体4运动到该标定位置时在理论上应当处于的位姿状态)，从而根据所述理论位姿数据和实际位姿数据的差异计算得到所述标定结果数据并发送至所述机器人控制装置I，以供所述机器人控制装置I据以生成与控制机器人本体4运动相关的当前标定文件。
[0050]需说明的是，所述标定控制模块21即可为所述标定软件，与所述标定功能模块12通过API接口进行信息交互来实现各种功能，由于该API接口的存在，使得在设置完成通信协议及规则的情况下，各种标定软件均可很方便地调用该标定功能模块12。
[0051]为更清楚展现本实用新型的应用，予一实施例中，请参阅图4A至4D，展示所述机器人标定系统的应用方法:
[0052]如图4A所示，所述机器人控制装置I将存储的与该控制相关的所述机器人本体4的原始运动参数发送给所述数据处理装置2。
[0053]如图4B所示，所述数据处理装置2向所述机器人控制装置I发送标定运动指令，以令所述机器人控制装置I控制所述机器人本体4运动至标定位置。
[0054]如图4C所示，所述机器人控制装置I在所述机器人本体4运动至标定位置时生成的到位信号且采集此过程中机器人本体4的运动数据并发送给所述数据处理装置2，且所述数据处理装置2在接收到所述到位信号时控制所述标定设备3对运动至所述标定位置状态下的机器人本体4采集以得到实际位姿数据。
[0055]所述数据处理装置2根据所述运动数据及原始运动参数计算运动到标定位置状态下的机器人本体4的理论位姿数据，从而根据所述理论位姿数据和实际位姿数据的差异计算得到所述标定结果数据并发送至所述机器人控制装置I。
[0056]如图4D所示，所述机器人控制装置I根据所述标定结果数据生成当前标定文件，且将所述当前标定文件替换预存的与控制所述机器人本体4运动相关的初始标定文件，或者在没有该初始标定文件的情况下将所述当前标定文件作为初始标定文件。
[0057]本实用新型的机器人标定系统，所述系统包括:通信连接机器人本体的机器人控制装置、通信连接所述机器人控制装置的数据处理装置、及通信连接所述数据处理装置的用于采集所述机器人本体位姿数据的标定设备;本实用新型提供一套自动化标定系统的硬件基础，用于实现更为快捷、智能地标定机器人产品，减少人工数据交换工作，提高出厂调试的效率，并减少采样过程中的人工失误或是非实时数据引起的误差，提高产品质量。
[0058]本实用新型有效克服了现有技术中的种种缺点而具高度产业利用价值。
[0059]上述实施例仅例示性说明本实用新型的原理及其功效，而非用于限制本实用新型。任何熟悉此技术的人士皆可在不违背本实用新型的精神及范畴下，对上述实施例进行修饰或改变。因此，举凡所属技术领域中具有通常知识者在未脱离本实用新型所揭示的精神与技术思想下所完成的一切等效修饰或改变，仍应由本实用新型的权利要求所涵盖。
【主权项】
1.一种机器人标定系统，其特征在于，包括:通信连接机器人本体的机器人控制装置、通信连接所述机器人控制装置的数据处理装置、及通信连接所述数据处理装置的用于采集所述机器人本体位姿数据的标定设备。2.根据权利要求1所述的机器人标定系统，其特征在于，所述机器人控制装置集成于所述机器人本体，或者，所述机器人控制装置与所述机器人本体相互独立。3.根据权利要求1所述的机器人标定系统，其特征在于，所述数据处理装置集成于所述标定设备，或者，所述数据处理装置与所述标定设备相互独立。4.根据权利要求1所述的机器人标定系统，其特征在于，所述数据处理装置包括:计算机、工控机、微机、及信息上传终端中的任一种。5.根据权利要求1所述的机器人标定系统，其特征在于，所述标定设备包括:激光跟踪仪或线编码器。6.根据权利要求1所述的机器人标定系统，其特征在于，所述机器人控制装置和数据处理装置之间通过有线或无线以太网来通信连接，以及/或者，所述数据处理装置和标定设备之间通过有线或无线以太网来通信连接；所述通信的协议包括= Ethernet TCP/IP、Profibus-DP、CC-1 ink、Modbus、RS232及自定义协议中的任意一种。
【文档编号】B25J9/16GK205614681SQ201620367622
【公开日】2016年10月5日
【申请日】2016年4月27日
【发明人】龚劭秋, 张建政, 张 诚, 董易, 范东平
【申请人】上海福赛特机器人有限公司