CN110978059A - 一种便携式六轴机械手标定装置及其标定方法 - Google Patents

Abstract

本发明公开了一种便携式六轴机械手标定装置，机械手端部设置标定传感装置；标定装置设有固定安装的标定球装置，标定球固定安装在标定球装置上；标定传感装置上设置四个或四个以上的激光位移传感器，通过激光位移传感器获取标定球球心在机械手处于不同位置和姿态下的坐标参数。本发明还公开了该标定装置的标定方法。采用上述技术方案，示教点的确定方式简单、省时省力；采用非接触式测量，激光位移传感器工作范围大，不会对标定设备造成损伤；机械手可在工作空间的较大范围内对标定球进行测量；同时，也因为激光位移传感器的工作距离较大，使标定球装置在机械手工作空间内的摆放更加容易。

Description

一种便携式六轴机械手标定装置及其标定方法

技术领域

本发明属于关节式机械手标定设备的技术领域。更具体地，本发明涉及一种便携式六轴机械手标定装置，应用于一般关节型机械手的几何模型参数的标定。本发明还涉及该标定装置的标定方法。

背景技术

一、机械手标定的相关技术发展背景介绍：

1、机械手的误差主要来自两方面：

其一，几何误差：主要是由于机械手在加工制造过程中存在的制造和装配误差导致，以及后期机械手运行过程中存在的磨损等导致，几何误差与机械手的负载和运动无关；

其二，非几何误差：主要是由机械手连杆变形、关节屈服变形、齿轮间隙、摩擦等原因导致，非几何误差与机械手的负载和运动有关；上述两方面的误差导致机械手实际运动学模型与理想运动学模型之间存在偏差，最终导致机械手末端产生位姿误差。

2、非几何误差因为与机械手的负载和运动相关，是变化的，且其误差产生机理较为复杂，一般难以确定误差模型；而几何误差与机械手负载和运动无关，只与机械手的运动学参数和关节位置相关，可较容易地建立误差模型，并辨识模型参数，对于机械手来说，如果只考虑其几何误差，通过一定方式辨识机械手的真实运动学模型参数的过程，即为机械手的几何模型标定。

3、对机械手进行几何模型标定，可提升机械手的绝对精度，对机械手生产者来说，也可作为制造质量的检验参考。

4、传统的机械手标定装置主要分为两类：

其一，坐标测量机：使用坐标测量机标定机械手，需要借助特殊设计的装置安装于机械手的末端法兰，此装置上一般包含有若干个标志物(如球体)，通过坐标测量机测量此装置上标志物组合在坐标测量机坐标系下的位置或者位姿；当机械手到达不同关节位置时，通过坐标测量机测量得到末端装置标志物组合的位置或位姿，通过设定的数据处理方法即可标定出机械手的运动学参数；

其二，激光跟踪仪：使用激光跟踪仪标定机械手，需要借助靶球，需将靶球安装于机械手末端，当机械手到达不同关节位置时，通过激光跟踪仪测量得到靶球在激光跟踪仪坐标系下的位置，某些激光跟踪仪还配有位姿测量配套装置，也可将此装置安装于机械手末端，此时当机械手处于不同关节位置时，激光跟踪仪可以测量出机械手末端配套装置的位姿，同样，通过设定的数据处理方法即可标定出机械手的运动学参数。

5、现有技术的缺点：传统的机械手标定装置虽然可提供的工作空间较大，但是设备笨重、昂贵，不便携且使用方法非常复杂，本创造发明提供一种便携式的易用的关节式机械手标定设备。

二、检索现有技术的相关文献情况：

1、中国专利文献：一种基于三维力传感器的工业机器人标定装置(201720566859.8)，其技术方案是：该标定装置包括标定测量组件和标定球组件，标定测量组件安装在机器人末端法兰上，标定球组件固定在机器人工作空间内，其中，标定测量组件包括有连接底板，固定安装在所述连接底板一端的三维力传感器，以及通过螺栓固定安装在所述三维力传感器上端的测量球结构，所述连接底板的另一端形成有用于与所述机器人末端法兰相连接的法兰安装结构；标定球组件包括有固定底座，固定安装在所述固定底座上端的连接件，以及通过螺栓固定安装在所述连接件上端且与测量球结构相对应的标定球结构。该专利文献认为其技术方案结构简单、标定方法操作步骤简单、标定精度高。

2、中国专利文献：一种工业机器人测量末端靶球快速定位装置(201720526966.8)，其技术方案是：该快速定位装置包括标定板以及过渡盘，标定板的正面具有至少三个台阶面，在标定板的正面设有至少4个用于安装靶球基座的定位孔，所有定位孔中至少3个定位孔分别位于三个台阶面上；过渡盘包括连接部一及连接部二，连接部一通过装置连接固定件一与标定板连接固定，连接部二通过装置连接固定件二与机器人的法兰盘连接固定。该专利文献认为其技术方案通过不同靶球基座定位孔的组合，可以采集多组数据，有效提高了采集数据的质量，有利于提高测试精度，避免了传统平面型标定板可能出现的奇异点问题。

3、中国专利文献：一种用于工业机械手位置标定的三维定位装置(201710185981.5)，其技术方案是：该定位装置包括立柱基座、立柱丝杠组件X轴组件、Y轴组件等，X轴组件与Y轴组件分别固定在立柱丝杠组件与立柱基座上，X轴上Z轴直线滑台模组与Y轴上Z轴直线滑台模组上的红色与绿色激光发射器发射激光，从而实现对机械手指定位置的坐标标定。该专利文献认为，与此前传统方法相比，其技术方案在定位的过程中不需要在机械手末端增加额外的装置，形象直观，操作简单，成本低，安装方便。

三、最接近的现有技术存在的问题：

1、对机械手进行标定时示教点的确定较为困难，示教繁琐费力。如专利文献“一种基于三维力传感器的工业机器人标定装置(201720566859.8)”记载的：确定示教点时要求测量球与标定球进行接触，因为两个球的接触是点接触，因此判断两个球的具体接触情况是较为困难的；

2、设别使用中损耗大，使用寿命短。如专利文献“一种基于三维力传感器的工业机器人标定装置(201720566859.8)”记载的：在确定示教点时需要确保测量球和标定球接触，而此时机械手处于运动状态，因此测量球和标定球之间存在一些不可控的碰撞冲击，会对标定设备的寿命产生一定的损耗；

3、标定设备在机械手工作空间不易安置。如专利文献“一种基于三维力传感器的工业机器人标定装置(201720566859.8)”记载的：为了在机器人工作空间的较大范围内标定机器人的运动学参数，同时测量标定球的方式为接触式，因此在布置标定球时可能需要支架设备，以使标定球可处于机械手整个工作空间的不同区域；

4、标定过程复杂，操作繁琐。如专利文献“一种用于工业机械手位置标定的三维定位装置(201710185981.5)”记载的：在获得每一个机械手末端指定位置的三维坐标的过程中，需要进行以下步骤：操作定位设备进行机械手运动前的零点标定，操作机械手运动至某一关节位置，操作定位设备进行机械手运动后的坐标标定，整个过程过于繁琐；

5、标定设备***复杂，误差易累积，***可靠性差。如专利文献“一种用于工业机械手位置标定的三维定位设备(201710185981.5)”中记载的：定位设备含有多个运动轴(X轴、Y轴和Z轴)，还需通过控制三个轴的运动判断两个激光发射器对机械手末端的照射情况，多轴***，误差容易累积。

发明内容

本发明提供一种便携式六轴机械手标定装置，其目的是使机械手的标定装置便捷、易用。

为了实现上述目的，本发明采取的技术方案为：

本发明的便携式六轴机械手标定装置，所述的机械手端部设置标定传感装置，所述的标定装置设有标定球装置，标定球固定安装在所述的标定球装置上；所述的标定传感装置上设置四个或四个以上的激光位移传感器，通过激光位移传感器获取标定球球心在机械手处于不同位置和姿态下的坐标参数。

所述的标定传感装置设有连接柱和连接盘，所述的连接柱的一端通过一个连接法兰与机械手端部法兰固定连接，另一端通过另一个连接法兰与连接盘同轴固定连接；所述的激光位移传感器固定安装在连接盘上，所述的激光位移传感器与连接柱在连接盘上的安装面相反。

当所述的激光位移传感器为四个时，其中三个激光位移传感器各通过一个方形固定板安装在连接盘上，且沿着连接盘的圆周方向三等分均布；一个激光位移传感器通过L形固定板安装在连接盘上。

所述的标定球通过标定球连接柱固定安装在标定球装置的底板上；所述的底板在标定过程中分别固定于机械手工作空间中的多个不同位置上。

为了实现与上述技术方案相同的发明目的，本发明还提供以上所述的便携式六轴机械手标定装置的标定方法，其技术方案是：

所述的标定方法设定一个标定传感装置的统一坐标系S；在操作机械手、使多个激光位移传感器瞄准摆放在机械手工作空间内的标定球时，根据多个激光位移传感器的读数，以及已知的标定球的半径r，计算出标定球球心在标定球装置统一坐标系S下的三维坐标参数(x，y，z)。

所述的标定方法的具体过程是：

1、将所述的标定传感装置2固定安装在机械手末端法兰上；

2、将所述的标定球装置3固定安装在机械手的工作空间内；

3、操作机械手，使标定传感装置上的多个激光位移传感器的激光束均能够打在标定球上；同时，确保标定球处于所有激光位移传感器的工作距离内；此时，记录所有激光位移传感器的读数，根据标定球的半径r，计算标定球的球心在统一坐标系S下的坐标，同时记录机械手关节角位置；

4、保持标定球装置不动，再次操作机械手，使机械手处于其他关节位置，且同样使所有激光位移传感器的激光束能够打在标定球上，记录此时所有激光位移传感器的读数，计算此时标定球31的球心在统一坐标系S下的坐标，同时记录机械手关节角位置；

5、根据两次测量标定球球心的机械手1的关节角位置，以及建立的机械手运动学模型，可以建立从机械手基坐标系B到标定传感装置统一坐标系S的转换关系，并可将求出的标定球球心从标定传感装置的S坐标系转换至机械手基坐标系B下的坐标；因为两次测量的标定球球心坐标在机械手基坐标系B下的描述是不变的，因此可建立三个坐标转换等式；

6、更改标定球装置在机械手工作空间内的位置共m次，重复进行步骤3、步骤4和步骤5，则可建立3m个坐标转换等式；通过设定的数据处理方法，即可计算出机械手的模型参数；

只需重复m次数足够大，使3m大于模型参数个数。

本发明采用上述技术方案，在机械手标定时，示教点的确定方式简单，示教省时省力；由于采用非接触式测量，且标定装置中的激光位移传感器工作范围大，只需4个激光位移传感器的激光束同时照射在标定球上即可，因此示教点的确定非常简单；正常使用不会因为机械手的运动速度过快触碰等因素导致对标定设备造成损伤；单次摆放标定球装置，机械手可在工作空间的较大范围内对标定球进行测量；同时，也因为激光位移传感器的工作距离较大，使标定球装置在机械手工作空间内的摆放更加容易一些，甚至不需要支架设备；整个标定过程操作简单，只需摆放标定球装置以及操作机械手即可，整体操作简单方便。

附图说明

附图所示内容及图中的标记简要说明如下：

图1为本发明的总体结构示意图；

图2为本发明的标定传感装置结构示意图；

图3为本发明的激光位移传感器的分布示意图；

图4为本发明的标定球安装连接示意图。

图中标记为：

1、机械手，2、标定传感装置，3、标定球装置；

201、连接法兰，202、连接柱，203、连接法兰，204、连接盘，205、方形固定板，206、方形固定板，207、方形固定板，208、L形固定板，209、激光位移传感器，210、激光位移传感器，211激光位移传感器，212激光位移传感器；

31、标定球，32、标定球连接柱，33、底板。

具体实施方式

下面对照附图，通过对实施例的描述，对本发明的具体实施方式作进一步详细的说明，以帮助本领域的技术人员对本发明的发明构思、技术方案有更完整、准确和深入的理解。

一、如图1至图4所示本发明的结构：

本发明为一种便携式六轴机械手标定装置，解决机械手运动学参数标定问题。所述的机械手1端部设置标定传感装置2。

为了克服现有技术的缺陷，实现使机械手的标定装置便捷、易用的发明目的，本发明采取的技术方案为：

如图1所示，本发明的便携式六轴机械手标定装置设有标定球装置3，标定球31固定安装在所述的标定球装置3上；所述的标定传感装置2上设置四个或四个以上的激光位移传感器，通过激光位移传感器获取标定球31球心在机械手1处于不同位置和姿态下的坐标参数。

为本发明为机械手标定提供一种便携、易用的标定设备。其主要包括：机械手1、标定传感装置2和标定球装置3。

采用上述技术方案的有益效果：

1、在标定时，示教点的确定方式简单，示教省时省力；

2、由于采用非接触式测量，且标定装置中的激光位移传感器工作范围大，只需4个激光位移传感器的激光束同时照射在标定球上即可，因此示教点的确定非常简单；

3、正常使用时，不会因为机械手的运动速度过快等因素导致对标定设备造成寿命损伤；

4、单次摆放标定球装置，机械手可在工作空间的较大范围内对标定球进行测量；同时，也因为激光位移传感器的工作距离较大，使标定球装置在机械手工作空间内的摆放更加容易一些，甚至不需要支架设备；

5、整个标定过程操作简单，只需摆放标定球装置以及操作机械手即可，整体操作简单方便。

二、标定传感装置2如图2所示：

标定传感装置2主要由连接法兰201、连接柱202、连接法兰203、连接盘204、方形固定板205、方形固定板206、方形固定板207、L形固定板208、激光位移传感器209、激光位移传感器210、激光位移传感器211和激光位移传感器212组成。

标定传感装置2的组成结构的连接方式：

所述的标定传感装置2设有连接柱202和连接盘204，所述的连接柱202的一端通过一个连接法兰201与机械手端部法兰固定连接，另一端通过另一个连接法兰203与连接盘204同轴固定连接；所述的激光位移传感器固定安装在连接盘204上。

所述的激光位移传感器安装在连接盘204朝向标定球31的面上

标定传感装置2中各结构及作用分别为：

1、连接法兰201：其上沿圆周方向布置有通孔，通过螺栓与机械手1法兰连接，且与机械手1法兰连接的连接面中心上设有沉孔，通过此沉孔与连接柱202连接；

2、连接柱202：上下两个圆柱端面上均设有螺栓孔，上端面通过螺栓孔与连接法兰201连接，下端面通过螺栓孔与连接法兰203连接；

3、连接法兰203：其上沿圆周方向布置有通孔，通过螺栓与连接盘204连接，且与连接盘204连接的连接面中心上设有沉孔，通过此沉孔与连接柱202连接；

4、连接盘204，其上表面中心区域沿圆周方向设有螺纹孔，通过此螺纹孔与连接法兰203连接，其沿圆周方向存在3个盘辐，每一个盘辐上设有通孔，通过此通孔与下方的方形固定板205、方形固定板206和方形固定板207连接；同时，连接盘204中心附近区域也设有相同通孔，以使连接盘中心附近下方通过此通孔连接一个L形固定板208。

三、激光位移传感器的安装结构如图3所示：

当所述的激光位移传感器为四个时，其中三个激光位移传感器209、激光位移传感器210、激光位移传感器211各通过一个方形固定板205、方形固定板206、方形固定板207安装在连接盘204上，且沿着连接盘204的圆周方向三等分均布；一个激光位移传感器212通过L形固定板208安装在连接盘204上。

激光位移传感器安装结构及作用分别为：

1、方形固定板：包括方形固定板205、方形固定板206和方形固定板207：其上侧面上设有螺纹孔，用于与连接盘204的三个盘辐连接，其主面上设有通孔，用于分别与激光位移传感器209、激光位移传感器210和激光位移传感器211连接；

2、L形固定板208：其侧板上设有螺纹孔，用于与连接盘204连接，其主板上设有通孔，用于与激光位移传感器212连接；

3、激光位移传感器：包括激光位移传感器209、激光位移传感器210、激光位移传感器211和激光位移传感器212，其侧面有两个用于固定的螺纹孔，其中激光位移传感器209、激光位移传感器210和激光位移传感器211用于分别与方形固定板205、方形固定板206和方形固定板207连接，激光位移传感器212与L形固定板208连接。

四、标定球装置如图4所示：

标定球装置3主要由三部分组成：标定球31、标定球连接柱32和底板33。所述的标定球31通过标定球连接柱32固定安装在标定球装置3的底板33上；所述的底板33在标定过程中分别固定于机械手工作空间中的多个不同位置上。

标定球装置的结构及作用分别为：

1、标定球31：标定球31表面必须具备一定的球面度和表面粗糙度，同时半径r已知，另外其下方设有螺纹孔，用于与标定球连接柱32连接；

2、标定球连接柱32：标定球连接柱32上方的螺纹用于与标定球连接，下方的螺纹用于与底板33连接，上方螺纹与标定球连接柱的主体部分连接处有锥面进行过渡；

3、底板33：底板33中心处设有螺纹孔，用于连接标定球连接柱32，另外，底板33四角设有光孔，用于固定整个标定球装置。

五、本发明的便携式六轴机械手标定装置的标定方法，其技术方案是(以四个激光位移传感器为例)：

标定传感装置2组装固定完成后，可对四个激光位移传感器默认坐标系之间的关系进行标定。

设定一个标定传感装置2的统一坐标系S；当操作机械手1、使四个激光位移传感器瞄准摆放在机械手1工作空间内的标定球31时，根据4个激光位移传感器的读数(d1，d2，d3，d4)，以及已知的标定球31的半径r，可计算出标定球球心在标定球装置2统一坐标系S下的三维位置(x，y，z)。

统一坐标系S可设置在4个激光位移传感器中的任一个的默认坐标系处，也可设置在其他任意位置。

所述的标定方法的具体过程是：

1、将所述的标定传感装置2固定安装在机械手末端法兰上；

2、将所述的标定球装置3固定安装在机械手1的工作空间内；

3、操作机械手1，使标定传感装置2上的四个激光位移传感器的激光束均能够打在标定球31上；同时，确保标定球31同时在四个激光位移传感器的工作距离内；此时，记录四个激光位移传感器的读数(d1，d2，d3，d4)，根据标定球31的半径r，计算标定球球心在统一坐标系S下的坐标，同时记录机械手关节角位置(a1，a2，a3，a4，a5，a6)；

4、保持标定球装置3不动，再次操作机械手1，使机械手处于其他关节位置，且同样使四个激光位移传感器的激光束能够打在标定球31上，记录此时四个激光位移传感器的读数，计算此时标定球31的球心在统一坐标系S下的坐标，同时记录机械手1关节角位置；

5、根据两次测量标定球31球心的机械手1的关节角位置，以及建立的机械手运动学模型，可以建立从机械手基坐标系B到标定传感装置2统一坐标系S的转换关系，并可将求出的标定球31球心坐标从标定传感装置2的S坐标系转换至机械手基坐标系B下的坐标；因为两次测量的标定球1球心坐标在机械手基坐标系B下的描述是不变的，因此可建立三个坐标转换等式；

6、更改标定球装置3在机械手1工作空间内的位置共m次，重复进行步骤3、步骤4和步骤5，则可建立3m个坐标转换等式；通过设定的数据处理方法，即可计算出机械手1的模型参数；

只需重复m次数足够大，使3m大于模型参数个数。

六、本发明与现有技术公开文献的对比分析：

1、关于现有技术文献：一种基于三维力传感器的工业机器人标定装置(201720566859.8)；本发明与其获取辅助标定物的局部三维位置的方式不同，应用的传感器不同。

该技术文献是基于三维力传感器获取辅助标定物的局部三维坐标，具体依靠测量球触碰标定球，根据检测得到的三维力信号，计算标定球球心在测量球局部坐标系下的三维坐标；而本发明是借助4个激光位移传感器，根据4个激光位移传感器的距离读数，计算标定球球心在激光位移传感器统一坐标系下的三维坐标。

在该技术文献中，检测标定球球心的三维坐标采用的是接触式方法；而本发明是检测标定球球心的三维坐标采用的是非接触式方法。

2、关于现有技术文献：一种工业机器人测量末端靶球快速定位装置(201720526966.8)；该技术文献主要用于固定激光跟踪仪的靶球，必须和激光跟踪仪设备配套使用以实现机械手的标定；而本发明是一整套完备的用于机械手运动学参数标定的标定设备。

3、关于现有技术文献：一种用于工业机械手位置标定的三维定位装置(201710185981.5)；该技术文献通过所属定位装置中的两个激光发射器以及X轴、Y轴和Z轴的运动，显式地计算机械手末端指定位置在外部测量坐标系下的三维位置；而本发明并未显式计算指定位置(标定球球心)在外部坐标系下的三维位置，只需建立关于此三维位置的约束等式。

该技术文献的标定精度主要取决于所属定位装置各轴(X轴、Y轴和Z轴)的移动精度；而本发明的标定精度主要取决于激光位移传感器的精度。

七、本发明的技术创新点和技术关键点总结：

1、采用4个激光位移传感器确定固定的标定球球心的三维坐标，采用4个激光位移传感器是确定一个标定球球心的最小数量，相对于激光跟踪仪和坐标测量机等测量设备，***简单，成本低、便携性强、安装方便；

2、采用4个激光位移传感器确定固定的标定球球心的三维坐标，确定标定示教点的方式更简单，只需4个激光位移传感器的激光束同时打在标定球上即可，示教简单，操作方便；

3、采用4个激光位移传感器的规格可变，标定球1的半径r可变，针对不同工作空间大小的机械手，可配置不同工作距离的激光位移传感器，以及不同半径的标定球，使标定设备在不同类型机械手上均可使用，即本标定设备应用范围广，可扩展性强。

八、本发明更具体的实施方式：

1、在本发明中，标定传感装置2中采用4个激光位移传感器测量标定球31的三维位置，这是所需激光位移传感器的最少个数，因此，多于4个的激光位移传感器配置也可应用于本发明，并可提供更高的测量精度；进而，如果标定传感装置2中的传感器是可以直接获得标定球的表面点云则也可直接应用于本发明，比如面结构光传感器、TOF相机等；

2、标定传感装置2中的4个激光位移传感器的安装位置可调，以适应不同半径大小的标定球；比如，对于较小半径的标定球，可调节4个激光位移传感器的安装位置使4个激光位移传感器所发射的激光束彼此之间的夹角更小，更方便标定示教点的确定；当然，对于较大半径的标定球，则可将4个激光位移传感器的光束之间的夹角调节的更大；

3、标定传感装置2中的连接法兰201可有多种周向通孔配置，以适应不同机械手末端法兰的安装要求；

4、标定传感装置2中的4个激光位移传感器的精度可选用不同规格，以适应不同标定精度要求；

5、标定传感装置2中的4个激光位移传感器的工作距离也可选择不同规格，以适应不同机械手的不同工作区间大小；

6、标定球装置3中的标定球31可采用不同半径，其球面的球面度、粗糙度等可配置不同规格以满足不同标定精度要求。

上面结合附图对本发明进行了示例性描述，显然本发明具体实现并不受上述方式的限制，只要采用了本发明的方法构思和技术方案进行的各种非实质性的改进，或未经改进将本发明的构思和技术方案直接应用于其它场合的，均在本发明的保护范围之内。

Claims (7)

1.一种便携式六轴机械手标定装置，所述的机械手(1)端部设置标定传感装置(2)，其特征在于：所述的标定装置设有标定球装置(3)，标定球(31)固定安装在所述的标定球装置(3)上；所述的标定传感装置(2)上设置四个或四个以上的激光位移传感器，通过激光位移传感器获取标定球(31)球心在机械手(1)处于不同位置和姿态下的坐标参数。

2.按照权利要求1所述的便携式六轴机械手标定装置，其特征在于：所述的标定传感装置(2)设有连接柱(202)和连接盘(204)，所述的连接柱(202)的一端通过一个连接法兰(201)与机械手端部法兰固定连接，另一端通过另一个连接法兰(203)与连接盘(204)同轴固定连接；所述的激光位移传感器安装在连接盘(204)朝向标定球(31)的面上。

3.按照权利要求2所述的便携式六轴机械手标定装置，其特征在于：当所述的激光位移传感器为四个时，其中三个激光位移传感器(209、210、211)各通过一个方形固定板(205、206、207)安装在连接盘(204)上，且沿着连接盘(204)的圆周方向三等分均布；一个激光位移传感器(212)通过L形固定板(208)安装在连接盘(204)上。

4.按照权利要求1所述的便携式六轴机械手标定装置，其特征在于：所述的标定球(31)通过标定球连接柱(32)固定安装在标定球装置(3)的底板(33)上；所述的底板(33)在标定过程中分别固定于机械手工作空间中的多个不同位置上。

5.按照权利要求1至4中任一项所述的便携式六轴机械手标定装置的标定方法，其特征在于：所述的标定方法设定一个标定传感装置(2)的统一坐标系S；在操作机械手(1)、使多个激光位移传感器瞄准摆放在机械手(1)工作空间内的标定球(31)时，根据多个激光位移传感器的读数，以及已知的标定球(31)的半径，计算出标定球(31)球心在标定球装置(2)统一坐标系S下的三维坐标参数。

6.按照权利要求5所述的便携式六轴机械手标定装置的标定方法，其特征在于：所述的标定方法的具体过程是：

1)、将所述的标定传感装置(2)固定安装在机械手末端法兰上；

2)、将所述的标定球装置(3)固定安装在机械手(1)的工作空间内；

3)、操作机械手(1)，使标定传感装置(2)上的多个激光位移传感器的激光束均能够打在标定球(31)上；同时，确保标定球(31)处于所有激光位移传感器的工作距离内；此时，记录所有激光位移传感器的读数，根据标定球(31)的半径，计算标定球(31)的球心在统一坐标系S下的坐标，同时记录机械手(1)关节角位置；

4)、保持标定球装置(3)不动，再次操作机械手(1)，使机械手(1)处于其他关节位置，且同样使所有激光位移传感器的激光束能够打在标定球(31)上，记录此时所有激光位移传感器的读数，计算此时标定球(31)的球心在统一坐标系S下的坐标，同时记录机械手(1) 关节角位置；

5)、根据两次测量标定球(31)球心的机械手(1)的关节角位置，以及建立的机械手运动学模型，可以建立从机械手基坐标系B到标定传感装置(2)统一坐标系S的转换关系，并可将求出的标定球(31)球心从标定传感装置(2)的S坐标系转换至机械手基坐标系B下的坐标；因为两次测量的标定球(1)球心坐标在机械手基坐标系B下的描述是不变的，因此可建立三个坐标转换等式；

6)、更改标定球装置(3)在机械手(1)工作空间内的位置共m次，重复进行步骤3)、步骤4)和步骤5)，则可建立3m个坐标转换等式；通过设定的数据处理方法，即可计算出机械手(1)的模型参数。

7.按照权利要求6所述的便携式六轴机械手标定装置的标定方法，其特征在于：只需重复m次数足够大，使3m大于模型参数个数。

Images