用于工件校准的方法和使用该方法的机器人系统与流程

本发明涉及对机器人的控制，更加具体地，涉及通过触摸装置对机器人的控制。

背景技术：

机器人是一种可重新编程的多功能操纵器，其被设计用于通过可变的、编程的运动来移动工具或专业装置，以执行多种任务，诸如对工件进行加工。机器人具有机器人控制器和操纵器，该操纵器具有在机器人控制器的控制下的多个运动轴。在机器人与工件之间维持可标识的关系是必要的。在机器人与工件之间存在相对移动从而导致工件相对于机器人占用了一个新位置的情况下尤其如此。因此，需要实施一种方案，通过该方案，每当将工件相对于机器人置于一个新位置时，可容易地标识到在机器人与工件之间的位置关系。

专利ep2,828,283a1公开了一种用于相对于机器人装置校准机器人的方法，该方法涉及：以加法的形式将人工移动存储到标称模型，并且加法包括对标称坐标的校正。该方法涉及在标称模型中对机器人装置进行建模，并且具有对工作对象和参数集的描述，该参数集描述了机器人中的物理关系。期望的位置被定义为模型中的坐标。该坐标被转换成机器人坐标。机器人被操作以到达由机器人坐标限定的一系列机器人位置。机器人从机器人位置被人工移到对应的期望位置。该人工移动被以加法的形式存储到标称模型，并且加法包括对标称坐标的校正。

根据该专利的方案的缺点在于需要高度的操作者交互，这种操作者交互会非常耗时且是不准确的。

技术实现要素：

根据本发明的一个方面，提供了一种用于校准工件的方法，该工件以预定方式被安装到机器人系统中的工作对象，其中工作对象具有第一表面、第二表面和第三表面，以及其中工作对象参考系由位于第一表面、第二表面和第三表面的交叉处的第一坐标线、第二坐标线和第三坐标线限定，第一表面、第二表面和第三表面会合于一点，该方法包括：触摸在工作对象的第一表面上的、由机器人触摸式探头所定位的第一数目的位置，以测量第一数目的位置在机器人参考系中的第一表面上的实际位置，并且存储用于所测得位置的所测得的第一坐标；触摸在工作对象的第二表面上的、由机器人触摸式探头所定位的第二数目的位置，以测量第二数目的位置在机器人参考系中的第二表面上的实际位置，并且存储用于所测得位置的所测得的第二坐标；触摸在工作对象的第三表面上的、由机器人触摸式探头所定位的第三数目的位置，以测量第三数目的位置在机器人参考系中的第三表面上的实际位置，并且存储用于所测得位置的所测得的第三坐标；基于用于所测得位置的所测得的第一坐标、第二坐标和第三坐标，从机器人参考系计算工作对象参考系的定向和原点，其中工作对象被定位在机器人单元中。

根据本发明的另一方面，提供了一种机器人系统，包括：工作对象，具有第一表面、第二表面和第三表面，其中工作对象参考系由位于第一表面、第二表面和第三表面的交叉处的第一坐标线、第二坐标线和第三坐标线限定，第一表面、第二表面和第三表面会合于一点，并且工作对象被配置为具有以预定方式被安装到工作对象的工件；操纵器，保持触摸式探头；以及机器人控制器，具有运动控制模块、计算模块和存储器模块；其中：其中运动控制模块适于控制操纵器：触摸在工作对象的第一表面上的、由机器人触摸式探头所定位的第一数目的位置，以测量第一数目的位置在机器人参考系中的第一表面上的实际位置，触摸在工作对象的第二表面上的、由机器人触摸式探头所定位的第二数目的位置，以测量第二数目的位置在机器人参考系中的第二表面上的实际位置，并且触摸在工作对象的第三表面上的、由机器人触摸式探头所定位的第三数目的位置，以测量第三数目的位置在机器人参考系中的第三表面上的实际位置；存储器模块适于存储用于所测得位置的所测得的第一坐标，存储用于所测得位置的所测得的第二坐标，并且存储用于所测得位置的所测得的第三坐标；以及计算模块适于基于用于所测得位置的所测得的第一坐标、第二坐标和第三坐标，从机器人参考系计算工作对象参考系的定向和原点，其中工作对象被定位在机器人单元中。

根据本发明的技术方案可以提供所有必要的数据来确定实际工作对象参考系相对于机器人参考系的定向和原点。这使机器人能够在工作对象上的位置处准确地执行机器操作。

优选地，基于第一坐标线、第二坐标线和第三坐标线的定向，确定工作对象参考系相对于机器人参考系的定向，第一坐标线、第二坐标线和第三坐标线的定向通过分别向用于所测得位置的所测得的第一坐标、第二坐标和第三坐标应用二乘拟合算法而被计算；基于针对第一坐标线、第二坐标线和第三坐标线的会合点在机器人参考系中的坐标，确定在工作对象参考系与机器人参考系之间的原点，该会合点通过分别向用于所测得位置的所测得的第一坐标、第二坐标和第三坐标应用二乘拟合算法而被计算。

优选地，将夹具参考系的第二和第三坐标线的定向调节成正交于夹具参考系的第一坐标线在机器人参考系中的定向。

优选地，第一表面、第二表面和第三表面被设置成彼此基本上垂直。

过程的目标是在实现最高准确度的同时执行最少数目的步骤。为了从二乘拟合得到明确的结果，第一数目等于或大于三；第二数目等于或大于三；并且第三数目等于或大于三。本发明提供了对工作对象相对于机器人的定向和位置的快速且准确的确定。所限定的点无需精确地定位在夹具上，这有利于整个过程。

附图说明

下文将参照优选示例性实施例更详细地阐释本发明的主题，附图中图示了这些优选示例性实施例，在图中：

图1图示了根据本发明的实施例的机器人系统；以及

图2图示了不具有可触摸几何特征的形状下的工件以及工作对象。

在附图标记列表中以概述的形式列举了在图中所使用的附图标记及其含义。原则上，在图中，为相同的部分提供有相同的附图标记。

具体实施方式

在以下描述中，出于阐释和非限制性的目的，阐述了具体的细节，诸如特定的电路、电路组件、接口、技术等，以便提供对本发明的透彻理解。然而，对本领域的技术人员而言清楚的是，可以在偏离这些具体细节的其他实施例中实践本发明。在其他实例中，省略了公知的方法和编程过程、装置和电路的详细描述，以使不必要的细节不会模糊对本发明的描述。

图1图示了根据本发明的实施例的机器人系统。如图1所示，机器人系统1包括工作对象10、操纵器11、触摸式探头12和机器人控制器13。

例如，工作对象10可以被成形为类似块状、立方体和长方体，工作对象10具有第一表面s1、第二表面s2和第三表面s1。工作对象参考系fw由位于第一表面s1、第二表面s2和第三表面s3的交叉处的第一坐标线xw、第二坐标线yw和第三坐标线zw所限定，该第一表面s1、第二表面s2和第三表面s3会合于点ow。下面描述块状形状的工作对象10作为示例，其中第一表面s1、第二表面s2和第三表面s3是三个正交的平面。

操纵器11可以由机器人控制器13所控制，机器人控制器13保持触摸式探头12的或终止于触摸式探头12。探头12(其可以是线性触摸传感器)可操作，以便每当其指针120与对象相接触(即，发生位移)时向机器人控制器13提供信号。

控制机器人系统1的功能的机器人控制器13可以具有运动控制模块130、计算模块131和存储器模块132。机器人控制器13设置有数据链路14，用于接收命令，以控制操纵器11的位置以及被附接到操纵器11的工具和传感器的位置。计算机16向操作者提供界面，用于编辑被存储在机器人控制器13的存储器模块132中的数据。

例如，在工作对象10从操纵器的工作范围内的机器人单元中的第一位置l1被转移到第二位置l2的情况下，由于工作对象10相对于机器人参考系fr的位置已经被改变，所以需要更新在机器人与工作对象之间的位置关系，以便执行多种任务，诸如对工件进行加工。实际上，可能会要求更高的准确度和操作效率。因此，确定工作对象相对于机器人的实际位置和定向是至关重要的。通常，这是通过在机器人参考系的坐标中标识工作对象参考系来实现的。

为了在机器人参考系的坐标中标识在第二位置l2处的工作对象参考系，响应于来自计算机16的命令，机器人控制器13的运动控制模块130可以控制操纵器11，使得触摸式探头12在第一数目的位置s1a、s1b、s1c、s1d处触摸工作对象10的第一表面s1，该第一数目的位置s1a、s1b、s1c、s1d的实际位置由触摸式探头12测量，并且因此，在机器人参考系fr中所测得的第一坐标被提供给机器人控制器13，并且被存储在其存储器模块132中。响应于来自计算机16的命令，机器人控制器13的运动控制模块130可以控制操纵器11，使得触摸式探头12在第二数目的位置s2a、s2b、s2c处触摸工作对象10的第二表面s2，该第二数目的位置s2a、s2b、s2c的实际位置由触摸式探头12测量，并且因此，在机器人参考系fr中所测得的第二坐标被提供给机器人控制器13，并且被存储在其存储器模块132中。如果工作对象的表面上的触摸位置中的至少三个触摸位置不是共线的，则该触摸位置可以被随机选择。另外，响应于来自计算机16的命令，机器人控制器13的运动控制模块130可以控制操纵器11，使得触摸式探头12在第三数目的位置s3a、s3b、s3c处触摸工作对象10的第三表面s3，该第三数目的位置s3a、s3b、s3c的实际位置由触摸式探头12测量，并且因此，在机器人参考系fr中所测得的第三坐标被提供给机器人控制器13，并且被存储在其存储器模块132中。在实际操作中，可以以显见的增量来快速地移动触摸式探头12，以与工作对象表面接触，并且然后以高分辨率的增量(当触摸式探头13与工作对象表面失去接触时进行的位置测量)回退，因此，是“触发”概念。

通过使用针对第一数目的位置s1a、s1b、s1c、s1d(例如，四个位置)、第二数目的位置s2a、s2b、s2c(例如，三个位置)和第三数目的位置s3a、s3b、s3c(例如，三个位置)的所测得坐标，可以经由数学算法，例如，方程式(1)和(2)，来对工作对象13的第一表面s1、第二表面s2和第三表面s3、第二表面s2和第三表面s3进行建模，并且因此可以计算出工作对象参考系fw的原点of在机器人参考系fr中的坐标。

其中，在代数的3d中，(x,y,z)指示工作对象参考系的原点在机器人参考系中的坐标，as1、bs1和cs1是用于描述第一表面s1的三个因素，并且as2、bs2和cs2是用于描述第二表面s2的三个因素，as3、bs3和cs3是用于描述第三表面s3的三个因素。

用于求解asi、bsi、csi因素的3d最小二乘拟合算法是：

其中，xn,si、yn,si、zn,si是在工作对象的第i个表面上第n个测得位置的测得坐标。

例如：

(x1,s1,y1,s1,z1,s1)指示在第一表面s1上所测得的第一位置s1a的在机器人参考系rf中的测得坐标；

(x2,s1,y2,s1,z2,s1)指示在第一表面s1上所测得的第二位置s1b的在机器人参考系rf中的测得坐标；

(x3,s1,y3,s1,z3,s1)指示在第一表面s1上所测得的第三位置s1c的在机器人参考系rf中的测得坐标；

(x4,s1,y4,s1,z4,s1)指示在第一表面s1上所测得的第四位置s1d的在机器人参考系rf中的测得坐标；

(x1,s2,y1,s2,z1,s2)指示在第二表面s2上所测得的第一位置s2a的在机器人参考系rf中的测得坐标；

(x2,s2,y2,s2,z2,s2)指示在第二表面s2上所测得的第二位置s2b的在机器人参考系rf中的测得坐标；

(x3,s2,y3,s2,z3,s2)指示在第二表面s2上所测得的第三位置s2c的在机器人参考系rf中的测得坐标；

(x1,s3,y1,s3,z1,s3)指示在第三表面s3上所测得的第一位置s3a的在机器人参考系rf中的测得坐标；

(x2,s3,y2,s3,z2,s3)指示在第三表面s3上所测得的第二位置s3b的在机器人参考系rf中的测得坐标；

(x3,s3,y3,s3,z3,s3)指示在第三表面s3上所测得的第三位置s3c的在机器人参考系rf中的测得坐标；

概括地说，基于第一坐标线、第二坐标线和第三坐标线的会合点在机器人参考系中的坐标，可以确定在工作对象参考系fw与机器人参考系fr之间的原点，该会合点通过分别向用于所测得位置的所测得的第一坐标、第二坐标和第三坐标应用二乘拟合算法而被计算。

基于针对第一坐标线、第二坐标线和第三坐标线的定向，可以确定工作对象参考系fw相对于机器人参考系fr的定向，第一坐标线、第二坐标线和第三坐标线的定向通过分别向用于所测得位置的所测得的第一坐标、第二坐标和第三坐标应用二乘拟合算法而被计算。

可以通过计算结果创建三个向量。具体地，表示工作对象参考系fw的定向的向量(as1bs1cs1)、(as2bs2cs2)、(as2bs2cs2)被存储在机器人控制器13的存储器模块132中。

这提供了所有必要的数据来确定实际工作对象参考系相对于机器人参考系的定向和原点。这使机器人能够在工作对象上的位置处准确地执行机器操作。

在根据本发明的实施例中，机器人系统能够通过触摸工作对象的第一表面上的四个位置、工作对象的第二表面上的三个位置和工作对象的第三表面上的三个位置来确定机器人参考系的定向和原点。过程的目标是在实现最高准确度的同时执行最少数目的步骤。为了从二乘拟合得到明确的结果，第一数目等于或大于三；第二数目等于或大于三；并且第三数目等于或大于三。本发明提供了对工作对象相对于机器人的定向和位置的快速且准确的确定。所限定的点无需精确地定位在夹具上，这有利于整个过程。

可以将夹具参考系的第二坐标线和第三坐标线的定向调节成正交于夹具参考系的第一坐标线在机器人参考系中的定向。该过程在jingguoge和haogu发表于2014年在柏林的会议isrrobotik(第389页)上的“anautomaticindustrialrobotcellcalibrationmethod”中公开。

基于根据本发明的实施例，可以确定在机器人与工件之间的位置关系，尤其是考虑到该工件具有不带可触摸几何特征的形状，诸如具有不规则形状或凹凸不平表面的几何特征；因此，通过触摸三个点，无法依照ax+by+cz＝1形成该平面。图2图示了工作对象和形状为不带可触摸几何特征的工件。如图2所示，工作对象10可以被配置为具有以预定方式安装到工作对象的工件wp。例如，工件wp可以被定向且紧固到工作对象10，位于其第一表面s1上。因此，工件wp和夹具10可以被一起转移，在它们之间不存在相对移动。

与根据图1的实施例相似，操纵器11可以受机器人控制器13控制，机器人控制器13保持触摸式探头12或终止于触摸式探头12，并且工作对象参考系相对于机器人参考系的定向和原点也可以被相应地确定。

非常准确地相对于机器人来定位工作对象和关联的工件是一种得到确认的过程。因此，工作对象和工件两者的定向和位置都非常准确地处于已知的机器人坐标中。为了限定工件wp上的点在机器人参考系fr中的坐标，离线数据15(诸如，来自cad数据库)被提供给机器人控制器13的存储器模块132并且存储在其中，并且为工件wp上的多个点wp1、wp2、wp3指定了在工作对象参考系fw中的坐标。考虑到工作对象参考系在机器人参考系中的定向和原点以及工件wp上的点在机器人参考系中的坐标，可以为工件上的多个点wp1、wp2、wp3确定在机器人参考系中的坐标。

在工作可能不具有合格的几何形状、并且操纵器难以通过直接触摸工件直接标识工件的实际位置的情形下，首先确定工件对象相对于机器人参考系的实际位置和定向是至关重要的。如上所述，这通常是通过在机器人参考系的坐标中标识工作对象参考系来实现的。然后，指示工件在工作对象参考系中的位置和定向的坐标转变被确定，并且随后将其应用到离线数据(在工作对象参考系中的工件坐标)，该离线数据指定位于工作对象参考系上的工件的位置和定向。

虽然已经基于一些优选实施例描述了本发明，但本领域的技术人员应该了解这些实施例绝不应该限制本发明的范围。在不偏离本发明的精神和构思的情况下，对实施例的任何改变和修改都应该在本领域中具有普通知识和技术的技术人员的理解范围内，并且因此落入由随附权利要求书所限定的本发明的范围中。