[go: up one dir, main page]

CN107214692A - 机器人系统的自动标定方法 - Google Patents

机器人系统的自动标定方法 Download PDF

Info

Publication number
CN107214692A
CN107214692A CN201610163828.8A CN201610163828A CN107214692A CN 107214692 A CN107214692 A CN 107214692A CN 201610163828 A CN201610163828 A CN 201610163828A CN 107214692 A CN107214692 A CN 107214692A
Authority
CN
China
Prior art keywords
distance
robot
center
sphere
sensor
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
CN201610163828.8A
Other languages
English (en)
Other versions
CN107214692B (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.)
Tyco Electronics Shanghai Co Ltd
TE Connectivity Corp
Original Assignee
Tyco Electronics Shanghai Co Ltd
Tyco Electronics Corp
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 Tyco Electronics Shanghai Co Ltd, Tyco Electronics Corp filed Critical Tyco Electronics Shanghai Co Ltd
Priority to CN201610163828.8A priority Critical patent/CN107214692B/zh
Priority to JP2019500046A priority patent/JP6657469B2/ja
Priority to KR1020187030524A priority patent/KR102084656B1/ko
Priority to PCT/IB2017/051626 priority patent/WO2017163177A2/en
Priority to EP17719918.9A priority patent/EP3433061B1/en
Publication of CN107214692A publication Critical patent/CN107214692A/zh
Priority to US16/139,119 priority patent/US11027431B2/en
Application granted granted Critical
Publication of CN107214692B publication Critical patent/CN107214692B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1679—Programme controls characterised by the tasks executed
    • B25J9/1692—Calibration of manipulator
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02—Sensing devices
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/37—Measurements
    • G05B2219/37423—Distance, gap between tool and surface sensor
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/39—Robotics, robotics to robotics hand
    • G05B2219/39015—With different manipulator configurations, contact known sphere, ballbar
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/39—Robotics, robotics to robotics hand
    • G05B2219/39026—Calibration of manipulator while tool is mounted
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/39—Robotics, robotics to robotics hand
    • G05B2219/39054—From teached different attitudes for same point calculate tool tip position
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/40—Robotics, robotics mapping to robotics vision
    • G05B2219/40545—Relative position of wrist with respect to end effector spatial configuration

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

本发明公开一种机器人系统的自动标定方法，包括：提供一个具有球体的球棒部件；将球棒部件固定至安装在机器人的法兰盘上的末端执行工具上；在目标点的周围设置三个距离传感器，用于分别检测至球体的表面的实际距离；根据三个距离传感器检测到的三个实际距离控制机器人分别以多种不同的姿态将球体的中心精确地移动到目标点，并根据机器人在目标点的位姿数据计算出球体的中心相对于法兰盘的中心的传递矩阵Ts；和根据公式Tt＝Ts*Tc计算末端执行工具的中心相对于机器人的法兰盘的中心的传递矩阵Tt。因此，在本发明中，无需根据图像来识别球体的中心，从而极大地提高了机器人系统的标定效率。

Description

机器人系统的自动标定方法
技术领域
本发明涉及一种机器人系统的自动标定方法。
背景技术
在现有技术中，对于机器人系统的标定，一般采用人工示教的方法，例如，手动地控制机器人以多种不同的姿态(对于六轴机器人而言，一般为四种或更多种不同的姿态)将安装在机器人的法兰盘上的末端执行工具(或称为末端执行器)的中心移动到同一目标点。但是，由于需要通过人眼来判断末端执行工具的中心是否移动到同一目标点，因此，不可避免地会存在误差，导致末端执行工具的中心相对于机器人的法兰盘的中心的传递矩阵的标定不准确，而且手动地控制机器人以多种不同的姿态到达同一目标点和依靠人眼判断是否到达同一目标点的工作非常费时，影响工作效率。对于需要经常更换末端执行工具的机器人系统，在每更换一次末端执行工具之后，都要进行一次重新标定，非常麻烦，非常费时。
在现有技术中，还曾提出过一种基于标定的视觉传感器自动执行机器人系统的标定的技术方案，在该技术方案中，在视觉传感器的引导下控制机器人以多种不同的姿态将安装在机器人的法兰盘上的末端执行工具的中心移动到同一目标点。与用人眼来判断末端执行工具的中心是否到达同一目标点相比，该技术方案省时省力。但是，在该技术方案中，视觉传感器需要识别末端执行工具的中心，由于末端执行工具的几何结构比较复杂，识别非常困难，特别是对于需要经常更换末端执行工具的机器人系统，每更换一次末端执行工具之后，都要重新识别末端执行工具的中心，非常麻烦，非常费时。
此外，在前述现有技术中，视觉传感器一般为摄像机，识别处理系统根据视觉传感器拍摄到的图像来识别末端执行工具的中心。但是，根据拍摄到的图像识别末端执行工具的中心的计算量非常大，导致识别速度很慢，严重地降低了机器人系统的标定效率。
发明内容
本发明的目的旨在解决现有技术中存在的上述问题和缺陷的至少一个方面。
根据本发明的一个目的，旨在于提供一种机器人系统的自动标定方法，其能够精确地且高效地完成机器人系统的标定工作。
根据本发明的一个方面，提供一种机器人系统的自动标定方法，包括如下步骤：
S100：提供一个球棒部件，所述球棒部件具有一个连接杆和附接在所述连接杆的一端上的球体；
S200：将所述球棒部件的连接杆的另一端固定至安装在机器人的法兰盘上的末端执行工具上；
S300：在一个已知的目标点的周围设置三个距离传感器，用于分别检测至所述球体的表面的实际距离；
S400：根据三个距离传感器检测到的三个实际距离控制所述机器人分别以多种不同的姿态将所述球体的中心精确地移动到所述目标点，并根据所述机器人在所述目标点的位姿数据计算出所述球体的中心相对于所述法兰盘的中心的传递矩阵Ts；和
S500：根据下面的公式(1)计算所述末端执行工具的中心相对于所述机器人的法兰盘的中心的传递矩阵Tt，
Tt＝Ts*Tc (1)，其中
Tc为所述末端执行工具的中心相对于所述球体的中心的传递矩阵，并且传递矩阵Tc是已知的、固定不变的。
根据本发明的一个实例性的实施例，所述三个距离传感器包括第一距离传感器、第二距离传感器和第三距离传感器；并且当所述球体的中心被精确地移动到所述目标点时，所述第一距离传感器、第二距离传感器和第三距离传感器到所述球体的表面的距离分别等于第一预定距离、第二预定距离和第三预定距离。
根据本发明的另一个实例性的实施例，在所述步骤S400中，根据所述第一距离传感器检测到的第一实际距离与所述第一预定距离之间的第一距离误差、所述第二距离传感器检测到的第二实际距离与所述第二预定距离之间的第二距离误差、以及所述第三距离传感器检测到的第三实际距离与所述第三预定距离之间的第三距离误差，对机器人进行闭环反馈控制，直至所述第一距离误差、第二距离误差和第三距离误差都等于零。
根据本发明的另一个实例性的实施例，在所述步骤S400中，根据所述三个距离传感器检测到的三个实际距离计算出所述球体的中心在传感器坐标系中的实际位置，并根据所述球体的中心在传感器坐标系中的实际位置与所述目标点在所述传感器坐标系中的目标位置之间的位置误差，对机器人进行闭环反馈控制，直至所述位置误差等于零。
根据本发明的另一个实例性的实施例，所述第一距离传感器的轴线、所述第二距离传感器的轴线和所述第三距离传感器的轴线相交于同一点。
根据本发明的另一个实例性的实施例，所述第一距离传感器的轴线、所述第二距离传感器的轴线和所述第三距离传感器的轴线的交点作为所述目标点。
根据本发明的另一个实例性的实施例，所述第一距离传感器的轴线、所述第二距离传感器的轴线和所述第三距离传感器的轴线相互正交。
根据本发明的另一个实例性的实施例，所述第一距离传感器的轴线、所述第二距离传感器的轴线和所述第三距离传感器的轴线分别限定了传感器坐标系的三个轴线方向，并且所述传感器坐标系的原点与所述第一距离传感器的轴线、所述第二距离传感器的轴线和所述第三距离传感器的轴线的交点重合。
根据本发明的另一个实例性的实施例，在所述步骤S400中，所述机器人以至少两种不同的姿态将所述球体的中心精确地移动到所述目标点。
根据本发明的另一个实例性的实施例，所述步骤S400包括：
S410：根据三个距离传感器检测到的三个实际距离控制机器人以第一姿态将所述球体的中心移动到所述目标点，并记录所述机器人在所述目标点处的第一位姿数据；
S420：根据三个距离传感器检测到的三个实际距离控制机器人以第二姿态将所述球体的中心移动到所述目标点，并记录所述机器人在所述目标点处的第二位姿数据；
S430：根据三个距离传感器检测到的三个实际距离控制机器人以第三姿态将所述球体的中心移动到所述目标点，并记录所述机器人在所述目标点处的第三位姿数据；
S440：根据三个距离传感器检测到的三个实际距离控制机器人以第四姿态将所述球体的中心移动到所述目标点，并记录所述机器人在所述目标点处的第四位姿数据；和
S450：根据获得的所述机器人的第一位姿数据、第二位姿数据、第三位姿数据和第四位姿数据计算出所述球体的中心相对于所述法兰盘的中心的传递矩阵Ts。
根据本发明的另一个实例性的实施例，在前述步骤S420至S440中的每个步骤中，根据所述第一距离传感器检测到的第一实际距离与所述第一预定距离之间的第一距离误差、所述第二距离传感器检测到的第二实际距离与所述第二预定距离之间的第二距离误差、以及所述第三距离传感器检测到的第三实际距离与所述第三预定距离之间的第三距离误差，对机器人进行闭环反馈控制，直至所述第一距离误差、第二距离误差和第三距离误差都等于零。
根据本发明的另一个实例性的实施例，在所述步骤S420至S440中的每个步骤中，根据所述三个距离传感器检测到的三个实际距离计算出所述球体的中心在传感器坐标系中的实际位置，并根据所述球体的中心在所述传感器坐标系中的实际位置与所述目标点在所述传感器坐标系中的目标位置之间的位置误差，对机器人进行闭环反馈控制，直至所述位置误差等于零。
根据本发明的另一个实例性的实施例，所述机器人为多轴机器人。
根据本发明的另一个实例性的实施例，所述三个距离传感器为非接触式距离传感器。
根据本发明的另一个实例性的实施例，所述三个距离传感器为激光式距离传感器或超声波式距离传感器。
在本发明的前述各个实施例中，可以根据三个距离传感器检测到的、与球体的表面之间的三个实际距离来控制机器人将球体的中心精确地移动到已知的目标点，因此，无需根据图像来识别球体的中心，提高了机器人系统的标定效率。
通过下文中参照附图对本发明所作的描述，本发明的其它目的和优点将显而易见，并可帮助对本发明有全面的理解。
附图说明
图1显示根据本发明的一个实例性的实施例的机器人系统的原理图；
图2显示三个距离传感器的坐标系；
图3显示利用三个距离传感器检测三个距离传感器与球体的表面之间的三个实际距离；
图4显示当球体的中心被精确地移动到目标点时，三个距离传感器与球体的表面之间的预定距离；和
图5显示控制机器人分别以四种不同的姿态将球体的中心精确地移动到目标点。
具体实施方式
下面通过实施例，并结合附图，对本发明的技术方案作进一步具体的说明。在说明书中，相同或相似的附图标号指示相同或相似的部件。下述参照附图对本发明实施方式的说明旨在对本发明的总体发明构思进行解释，而不应当理解为对本发明的一种限制。
根据本发明的一个总体技术构思，提供一种机器人系统的自动标定方法，包括如下步骤：提供一个球棒部件，所述球棒部件具有一个连接杆和附接在所述连接杆的一端上的球体；将所述球棒部件的连接杆的另一端固定至安装在机器人的法兰盘上的末端执行工具上；在一个已知的目标点的周围设置三个距离传感器，用于分别检测至所述球体的表面的实际距离；根据三个距离传感器检测到的三个实际距离控制所述机器人分别以多种不同的姿态将所述球体的中心精确地移动到所述目标点，并根据所述机器人在所述目标点的位姿数据计算出所述球体的中心相对于所述法兰盘的中心的传递矩阵Ts；和根据下面的公式(1)计算所述末端执行工具的中心相对于所述机器人的法兰盘的中心的传递矩阵Tt，Tt＝Ts*Tc(1)，其中Tc为所述末端执行工具的中心相对于所述球体的中心的传递矩阵，并且传递矩阵Tc是已知的、固定不变的。
图1显示根据本发明的一个实例性的实施例的机器人系统的原理图。
图1显示了一个六轴机器人系统的示意图，但是，本发明不局限于图示的实施例，机器人系统也可以是其它类型的多自由度机器人系统，例如，四轴机器人系统或五轴机器人系统。
请参见图1，图示的机器人系统主要包括三个距离传感器11、12、13、六轴机器人20、安装在机器人20的法兰盘21上的末端执行工具(或称为末端执行器)30和固定至末端执行工具30上的一个球棒部件41、42。
在图示的实施例中，该球棒部件41、42具有一个连接杆41和附接在连接杆41的一端上的球体42。球棒部件41、42的连接杆41的另一端固定至安装在机器人20的法兰盘21上的末端执行工具30上。
在图示的实施例中，球棒部件41、42的连接杆41和球体42的几何参数是已知的、固定不变的。因此，当球棒部件41、42固定至末端执行工具30上之后，可以预先获得末端执行工具30的中心Tool相对于球体42的中心的传递矩阵Tc。由于球棒部件41、42的连接杆41和球体42的几何参数是已知的、固定不变的，因此传递矩阵Tc是已知的、固定不变的。
图2显示三个距离传感器11、12、13的坐标系(此坐标系也称作传感器坐标系)。图3显示利用三个距离传感器11、12、13检测三个距离传感器11、12、13与球体42的表面之间的三个实际距离L1’、L2’、L3’。
在图示的实施例中，在一个已知的目标点(例如，图2中所示的点Os)的周围设置三个距离传感器11、12、13，用于分别检测至与球体42的表面的实际距离L1’、L2’、L3’(参见图3)。
为了便于说明，如图1至图3所示，三个距离传感器11、12、13分别被称为第一距离传感器11、第二距离传感器12和第三距离传感器13。如图3所示，在实际应用中，当球体42朝向目标点Os移动时，第一距离传感器11可以实时地检测出第一距离传感器11至球体42的表面的第一实际距离L1’，第二距离传感器12可以实时地检测出第二距离传感器12至球体42的表面的第二实际距离L2’，第三距离传感器13可以实时地检测出第三距离传感器13至球体42的表面的第三实际距离L3’。在图示的实施例中，第一实际距离L1’是指沿第一距离传感器11的轴线方向从第一距离传感器11至球体42的表面的距离，第二实际距离L2’是指沿第二距离传感器12的轴线方向从第二距离传感器12至球体42的表面的距离，第三实际距离L3’是指沿第三距离传感器13的轴线方向从第三距离传感器13至球体42的表面的距离。
尽管未图示，本发明的机器人系统还包括控制器，用于根据预先编制的程序对机器人进行控制。
图4显示当球体42的中心C被精确地移动到目标点Os时，三个距离传感器11、12、13与球体42的表面之间的预定距离L1、L2、L3；和图5显示控制机器人分别以四种不同的姿态Pose#1、Pose#2、Pose#3、Pose#4将球体42的中心C精确地移动到目标点Os。
下面将根据附图1-5来详细地说明根据本发明的一个实施例的机器人系统的自动标定方法，该方法主要包括以下步骤：
S100：如图1所示，提供一个球棒部件41、42，球棒部件41、42具有一个连接杆41和附接在连接杆41的一端上的球体42；
S200：如图1所示，将球棒部件41、42的连接杆41的另一端固定至安装在机器人20的法兰盘21上的末端执行工具30上；
S300：如图2和图3所示，在一个已知的目标点的周围设置三个距离传感器11、12、13，用于分别检测至球体42的表面的实际距离L1’、L2’、L3’：
S400：如图3、图4和图5所示，根据三个距离传感器11、12、13检测到的三个实际距离L1’、L2’、L3’控制机器人20分别以多种不同的姿态Pose#1、Pose#2、Pose#3、Pose#4将球体42的中心C精确地移动到目标点，并根据机器人在目标点的位姿数据计算出球体42的中心C相对于法兰盘21的中心Tool0的传递矩阵Ts；和
S500：根据下面的公式(1)计算末端执行工具30的中心Tool相对于机器人20的法兰盘21的中心Tool0的传递矩阵Tt，
Tt＝Ts*Tc (1)。
如图1至图5所示，第一距离传感器11、第二距离传感器12和第三距离传感器13的位置是已知的并且是固定不变的。因此，当球体42的中心C被精确地移动到已知的目标点Os时，第一距离传感器11、第二距离传感器12和第三距离传感器13到球体42的表面的距离也是已知的和固定不变的。为了便于说明，如图4所示，当球体42的中心C被精确地移动到已知的目标点Os时，第一距离传感器11、第二距离传感器12和第三距离传感器13到球体42的表面的距离被分别设定为第一预定距离L1、第二预定距离L2和第三预定距离L3。即，沿第一距离传感器11的轴线方向从第一距离传感器11至球体42的表面的第一预定距离L1，沿第二距离传感器12的轴线方向从第二距离传感器12至球体42的表面的第二预定距离L2，沿第三距离传感器13的轴线方向从第三距离传感器13至球体42的表面的第三预定距离L3是已知的和固定不变的。
请注意，前述第一预定距离L1、第二预定距离L2和第三预定距离L3可以彼此相等也可以彼此不相等。在本发明的一个实例性的实施例中，在前述步骤S400中，根据第一距离传感器11检测到的第一实际距离L1’与第一预定距离L1之间的第一距离误差、第二距离传感器12检测到的第二实际距离L2’与第二预定距离L2之间的第二距离误差、以及第三距离传感器13检测到的第三实际距离L3’与第三预定距离L3之间的第三距离误差，对机器人20进行闭环反馈控制，直至第一距离误差、第二距离误差和第三距离误差都等于零，即，直至球体42的中心C被精确地移动到目标点Os。
在本发明的另一个实例性的实施例中，在前述步骤S400中，根据三个距离传感器11、12、13检测到的三个实际距离L1’、L2’、L3’计算出球体42的中心C在传感器坐标系xs、ys、zs中的实际位置，并根据球体42的中心C在传感器坐标系xs、ys、zs中的实际位置与目标点在传感器坐标系xs、ys、zs中的目标位置之间的位置误差，对机器人20进行闭环反馈控制，直至位置误差等于零，即，直至球体42的中心C被精确地移动到目标点Os。
请注意，在做标定的过程中，不一定要计算出球体42的中心C在传感器坐标系xs、ys、zs中的实际位置。例如，如前所述，可以通过控制机器人使第一距离传感器11检测到的第一实际距离L1’与第一预定距离L1一致、第二距离传感器12检测到的第二实际距离L2’与第二预定距离L2一致、以及第三距离传感器13检测到的第三实际距离L3’与第三预定距离L3一致。这样，就可确定球体42的中心C被精确地移动到了目标点Os。
在本发明的一个实例性的实施例中，为了便于计算，第一距离传感器11的轴线、第二距离传感器12的轴线和第三距离传感器13的轴线相交于同一点Os。但是，本发明不局限于此，第一距离传感器11的轴线、第二距离传感器12的轴线和第三距离传感器13的轴线也可以不相交于同一点。
在本发明的一个实例性的实施例中，为了便于计算，第一距离传感器11的轴线、第二距离传感器12的轴线和第三距离传感器13的轴线的交点Os作为目标点。但是，本发明不局限于此，目标点可以与前述交点Os不重合。
在本发明的一个实例性的实施例中，为了便于计算，第一距离传感器11的轴线、第二距离传感器12的轴线和第三距离传感器13的轴线相互正交。但是，本发明不局限于此，第一距离传感器11的轴线、第二距离传感器12的轴线和第三距离传感器13的轴线也可以不相互垂直。
在本发明的一个实例性的实施例中，为了便于计算，第一距离传感器11的轴线、第二距离传感器12的轴线和第三距离传感器13的轴线分别限定了传感器坐标系xs、ys、zs的三个轴线方向，并且传感器坐标系xs、ys、zs的原点与第一距离传感器11的轴线、第二距离传感器12的轴线和第三距离传感器13的轴线的交点Os重合。
在本发明的一个实例性的实施例中，如图1-5所示，前述步骤S400包括：
S410：根据三个距离传感器11、12、13检测到的三个实际距离L1’、L2’、L3’控制机器人20以第一姿态Pose#1将球体42的中心C移动到目标点，并记录机器人20在目标点处的第一位姿数据；
S420：根据三个距离传感器11、12、13检测到的三个实际距离L1’、L2’、L3’控制机器人20以第二姿态Pose#2将球体42的中心C移动到目标点，并记录机器人在目标点处的第二位姿数据；
S430：根据三个距离传感器11、12、13检测到的三个实际距离L1’、L2’、L3’控制机器人20以第三姿态Pose#3将球体42的中心C移动到目标点，并记录机器人在目标点处的第三位姿数据；
S440：根据三个距离传感器11、12、13检测到的三个实际距离L1’、L2’、L3’控制机器人20以第四姿态Pose#4将球体42的中心C移动到目标点，并记录机器人在目标点处的第四位姿数据；和
S450：根据获得的机器人的第一位姿数据、第二位姿数据、第三位姿数据和第四位姿数据计算出球体42的中心C相对于法兰盘21的中心Tool0的传递矩阵Ts。
在本发明的一个实例性的实施例中，在前述步骤S420至S440中的每个步骤中，根据第一距离传感器11检测到的第一实际距离L1’与第一预定距离L1之间的第一距离误差、第二距离传感器12检测到的第二实际距离L2’与第二预定距离L2之间的第二距离误差、以及第三距离传感器13检测到的第三实际距离L3’与第三预定距离L3之间的第三距离误差，对机器人20进行闭环反馈控制，直至第一距离误差、第二距离误差和第三距离误差都等于零，即，直至球体42的中心C被精确地移动到目标点Os。
在本发明的另一个实例性的实施例中，在步骤S420至S440中的每个步骤中，根据三个距离传感器11、12、13检测到的三个实际距离L1’、L2’、L3’计算出球体42的中心C在传感器坐标系xs、ys、zs中的实际位置，并根据球体42的中心C在传感器坐标系xs、ys、zs中的实际位置与目标点在传感器坐标系xs、ys、zS中的目标位置之间的位置误差，对机器人20进行闭环反馈控制，直至位置误差等于零，即，直至球体42的中心C被精确地移动到目标点Os。
在图示的前述实施例中，根据三个距离传感器11、12、13检测到的三个实际距离L1’、L2’、L3’控制机器人20以四种不同的姿态Pose#1、Pose#2、Pose#3、Pose#4将球体42的中心C精确地移动到同一目标点Os。但是，本发明不局限于图示的实施例，机器人20也可以以两种、三种、五种或更多种不同的姿态将球体42的中心C精确地移动到同一目标点。
在本发明的一个实例性的实施例中，三个距离传感器11、12、13可以为但不限于非接触式距离传感器。
在本发明的一个实例性的实施例中，三个距离传感器11、12、13可以为激光式距离传感器或超声波式距离传感器。
在本发明的前述各个实施例中，在机器人20的法兰盘21上安装一个球棒部件41、42，并且在目标点的周围设置三个距离传感器11、12、13。这样，可以根据三个距离传感器11、12、13检测到的、与球体42的表面之间的三个实际距离L1’、L2’、L3’来控制机器人20将球体42的中心C精确地移动到已知的目标点，因此，无需根据图像来识别球体42的中心，提高了机器人系统的标定效率。
虽然结合附图对本发明进行了说明，但是附图中公开的实施例旨在对本发明优选实施方式进行示例性说明，而不能理解为对本发明的一种限制。
虽然本总体发明构思的一些实施例已被显示和说明，本领域普通技术人员将理解，在不背离本总体发明构思的原则和精神的情况下，可对这些实施例做出改变，本发明的范围以权利要求和它们的等同物限定。
应注意，措词“包括”不排除其它元件或步骤，措词“一”或“一个”不排除多个。另外，权利要求的任何元件标号不应理解为限制本发明的范围。

Claims (15)

1.一种机器人系统的自动标定方法，包括如下步骤：
S100：提供一个球棒部件(41、42)，所述球棒部件(41、42)具有一个连接杆(41)和附接在所述连接杆(41)的一端上的球体(42)；
S200：将所述球棒部件(41、42)的连接杆(41)的另一端固定至安装在机器人(20)的法兰盘(21)上的末端执行工具(30)上；
S300：在一个已知的目标点的周围设置三个距离传感器(11、12、13)，用于分别检测至所述球体(42)的表面的实际距离(L1’、L2’、L3’)；
S400：根据三个距离传感器(11、12、13)检测到的三个实际距离(L1’、L2’、L3’)控制所述机器人(20)分别以多种不同的姿态(Pose#1、Pose#2、Pose#3、Pose#4)将所述球体(42)的中心(C)精确地移动到所述目标点，并根据所述机器人在所述目标点的位姿数据计算出所述球体(42)的中心(C)相对于所述法兰盘(21)的中心(Tool0)的传递矩阵Ts；和
S500：根据下面的公式(1)计算所述末端执行工具(30)的中心(Tool)相对于所述机器人(20)的法兰盘(21)的中心(Tool0)的传递矩阵Tt，
Tt＝Ts*Tc (1)，其中
Tc为所述末端执行工具(30)的中心(Tool)相对于所述球体(42)的中心(C)的传递矩阵，并且传递矩阵Tc是已知的、固定不变的。
2.根据权利要求1所述的方法，其特征在于：
所述三个距离传感器(11、12、13)包括第一距离传感器(11)、第二距离传感器(12)和第三距离传感器(13)；并且
当所述球体(42)的中心(C)被精确地移动到所述目标点时，所述第一距离传感器(11)、第二距离传感器(12)和第三距离传感器(13)到所述球体(42)的表面的距离分别等于第一预定距离(L1)、第二预定距离(L2)和第三预定距离(L3)。
3.根据权利要求2所述的方法，其特征在于：
在所述步骤S400中，根据所述第一距离传感器(11)检测到的第一实际距离(L1’)与所述第一预定距离(L1)之间的第一距离误差、所述第二距离传感器(12)检测到的第二实际距离(L2’)与所述第二预定距离(L2)之间的第二距离误差、以及所述第三距离传感器(13)检测到的第三实际距离(L3’)与所述第三预定距离(L3)之间的第三距离误差，对机器人(20)进行闭环反馈控制，直至所述第一距离误差、第二距离误差和第三距离误差都等于零。
4.根据权利要求2所述的方法，其特征在于：
在所述步骤S400中，根据所述三个距离传感器(11、12、13)检测到的三个实际距离(L1’、L2’、L3’)计算出所述球体(42)的中心(C)在传感器坐标系(xs、ys、zs)中的实际位置，并根据所述球体(42)的中心(C)在传感器坐标系(xs、ys、zs)中的实际位置与所述目标点在所述传感器坐标系(xs、ys、zs)中的目标位置之间的位置误差，对机器人(20)进行闭环反馈控制，直至所述位置误差等于零。
5.根据权利要求3或4所述的方法，其特征在于：
所述第一距离传感器(11)的轴线、所述第二距离传感器(12)的轴线和所述第三距离传感器(13)的轴线相交于同一点。
6.根据权利要求5所述的方法，其特征在于：
所述第一距离传感器(11)的轴线、所述第二距离传感器(12)的轴线和所述第三距离传感器(13)的轴线的交点(Os)作为所述目标点。
7.根据权利要求6所述的方法，其特征在于：
所述第一距离传感器(11)的轴线、所述第二距离传感器(12)的轴线和所述第三距离传感器(13)的轴线相互正交。
8.根据权利要求7所述的方法，其特征在于：
所述第一距离传感器(11)的轴线、所述第二距离传感器(12)的轴线和所述第三距离传感器(13)的轴线分别限定了传感器坐标系(xs、ys、zs)的三个轴线方向，并且
所述传感器坐标系(xs、ys、zs)的原点与所述第一距离传感器(11)的轴线、所述第二距离传感器(12)的轴线和所述第三距离传感器(13)的轴线的交点(Os)重合。
9.根据权利要求2所述的方法，其特征在于：
在所述步骤S400中，所述机器人(20)以至少两种不同的姿态(Pose#1、Pose#2、Pose#3、Pose#4)将所述球体(42)的中心(C)精确地移动到所述目标点。
10.根据权利要求2所述的方法，其特征在于，所述步骤S400包括：
S410：根据三个距离传感器(11、12、13)检测到的三个实际距离(L1’、L2’、L3’)控制机器人(20)以第一姿态(Pose#1)将所述球体(42)的中心(C)移动到所述目标点，并记录所述机器人(20)在所述目标点处的第一位姿数据；
S420：根据三个距离传感器(11、12、13)检测到的三个实际距离(L1’、L2’、L3’)控制机器人(20)以第二姿态(Pose#2)将所述球体(42)的中心(C)移动到所述目标点，并记录所述机器人在所述目标点处的第二位姿数据；
S430：根据三个距离传感器(11、12、13)检测到的三个实际距离(L1’、L2’、L3’)控制机器人(20)以第三姿态(Pose#3)将所述球体(42)的中心(C)移动到所述目标点，并记录所述机器人在所述目标点处的第三位姿数据；
S440：根据三个距离传感器(11、12、13)检测到的三个实际距离(L1’、L2’、L3’)控制机器人(20)以第四姿态(Pose#4)将所述球体(42)的中心(C)移动到所述目标点，并记录所述机器人在所述目标点处的第四位姿数据；和
S450：根据获得的所述机器人的第一位姿数据、第二位姿数据、第三位姿数据和第四位姿数据计算出所述球体(42)的中心(C)相对于所述法兰盘(21)的中心(Tool0)的传递矩阵Ts。
11.根据权利要求10所述的方法，其特征在于：
在前述步骤S420至S440中的每个步骤中，根据所述第一距离传感器(11)检测到的第一实际距离(L1’)与所述第一预定距离(L1)之间的第一距离误差、所述第二距离传感器(12)检测到的第二实际距离(L2’)与所述第二预定距离(L2)之间的第二距离误差、以及所述第三距离传感器(13)检测到的第三实际距离(L3’)与所述第三预定距离(L3)之间的第三距离误差，对机器人(20)进行闭环反馈控制，直至所述第一距离误差、第二距离误差和第三距离误差都等于零。
12.根据权利要求10所述的方法，其特征在于：
在所述步骤S420至S440中的每个步骤中，根据所述三个距离传感器(11、12、13)检测到的三个实际距离(L1’、L2’、L3’)计算出所述球体(42)的中心(C)在传感器坐标系(xs、ys、zs)中的实际位置，并根据所述球体(42)的中心(C)在所述传感器坐标系(xs、ys、zs)中的实际位置与所述目标点在所述传感器坐标系(xs、ys、zs)中的目标位置之间的位置误差，对机器人(20)进行闭环反馈控制，直至所述位置误差等于零。
13.根据权利要求1所述的方法，其特征在于：所述机器人(20)为多轴机器人。
14.根据权利要求1所述的方法，其特征在于：所述三个距离传感器(11、12、13)为非接触式距离传感器。
15.根据权利要求15所述的方法，其特征在于：所述三个距离传感器(11、12、13)为激光式距离传感器或超声波式距离传感器。
CN201610163828.8A 2016-03-22 2016-03-22 机器人系统的自动标定方法 Active CN107214692B (zh)

Priority Applications (6)

Application Number Priority Date Filing Date Title
CN201610163828.8A CN107214692B (zh) 2016-03-22 2016-03-22 机器人系统的自动标定方法
JP2019500046A JP6657469B2 (ja) 2016-03-22 2017-03-21 ロボットシステムの自動較正方法
KR1020187030524A KR102084656B1 (ko) 2016-03-22 2017-03-21 로봇 시스템을 위한 자동 교정 방법
PCT/IB2017/051626 WO2017163177A2 (en) 2016-03-22 2017-03-21 Automatic calibration method for robot system
EP17719918.9A EP3433061B1 (en) 2016-03-22 2017-03-21 Automatic calibration method for robot system and corresponding robot system
US16/139,119 US11027431B2 (en) 2016-03-22 2018-09-24 Automatic calibration method for robot system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610163828.8A CN107214692B (zh) 2016-03-22 2016-03-22 机器人系统的自动标定方法

Publications (2)

Publication Number Publication Date
CN107214692A true CN107214692A (zh) 2017-09-29
CN107214692B CN107214692B (zh) 2020-04-03

Family

ID=58638902

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610163828.8A Active CN107214692B (zh) 2016-03-22 2016-03-22 机器人系统的自动标定方法

Country Status (6)

Country Link
US (1) US11027431B2 (zh)
EP (1) EP3433061B1 (zh)
JP (1) JP6657469B2 (zh)
KR (1) KR102084656B1 (zh)
CN (1) CN107214692B (zh)
WO (1) WO2017163177A2 (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107932018A (zh) * 2017-11-23 2018-04-20 纳博特南京科技有限公司 一种工业机器人标定装置及标定方法
CN108942930A (zh) * 2018-07-18 2018-12-07 上海天豚信息科技有限公司 机械臂装置的闭环控制系统及方法
CN109176517A (zh) * 2018-09-10 2019-01-11 武汉久同智能科技有限公司 基于末端名义点约束的串联工业机器人连杆参数标定方法
CN111157004A (zh) * 2019-12-31 2020-05-15 上海新时达机器人有限公司 法兰朝下四轴机器人的工具标定方法
CN112045684A (zh) * 2020-09-05 2020-12-08 上官佳荣 一种自动辅助标定装置及其方法
CN112525074A (zh) * 2020-11-24 2021-03-19 杭州素问九州医疗科技有限公司 标定方法、系统、机器人、计算机装置和导航系统
CN115249267A (zh) * 2022-09-22 2022-10-28 海克斯康制造智能技术(青岛)有限公司 一种基于转台及机器人位姿解算的自动检测方法及装置

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106483963B (zh) * 2015-08-26 2020-02-11 泰科电子(上海)有限公司 机器人系统的自动标定方法
EP3630417A1 (en) * 2017-05-22 2020-04-08 ABB Schweiz AG Robot-conveyor calibration method, robot system and control system
TWI668541B (zh) * 2017-09-29 2019-08-11 財團法人工業技術研究院 機器人工具中心點校正系統及其方法
CN111267092B (zh) * 2019-08-27 2022-09-02 上海飞机制造有限公司 标定机器人工具坐标系的方法和系统
JP2021196691A (ja) * 2020-06-10 2021-12-27 富士通株式会社 算出方法、算出プログラムおよび情報処理装置
US11524410B2 (en) 2020-06-12 2022-12-13 Hexagon Metrology, Inc. Robotic alignment method for workpiece measuring systems
CN113834432B (zh) * 2020-06-23 2022-07-19 宝山钢铁股份有限公司 基于激光测距传感器对细长冶金工具作标定的装置及方法
TWI762371B (zh) * 2021-07-06 2022-04-21 財團法人工業技術研究院 機械手臂與輪廓感測器座標系相對關係之自動校正方法與系統
KR102591942B1 (ko) * 2021-09-29 2023-10-24 한국생산기술연구원 강성 모델과 절삭력 모델을 이용한 로봇 제어 방법 및 장치
KR102582430B1 (ko) * 2021-09-28 2023-09-27 한국생산기술연구원 레이저 트래커 피드백을 이용한 로봇 제어 방법 및 장치
CN114536324B (zh) * 2022-01-11 2023-11-07 重庆智能机器人研究院 一种工业机器人自动工具工件标定方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100504687C (zh) * 2002-10-11 2009-06-24 弗迪亚有限公司 用于测量、补偿和测试数控机床头和/或工作台的系统和方法
CN102015221A (zh) * 2008-04-30 2011-04-13 Abb技术有限公司 用于确定机器人坐标系与位于机器人工作范围内的本地坐标系之间的关系的方法和系统
DE102010060124A1 (de) * 2009-10-27 2011-06-16 Werth Messtechnik Gmbh Verfahren und Anordnung zum Messen mit einem Koordinatenmessgerät
CN104626205A (zh) * 2014-12-11 2015-05-20 珠海格力电器股份有限公司 机器人机械臂的检测方法和装置
CN104827480A (zh) * 2014-02-11 2015-08-12 泰科电子(上海)有限公司 机器人系统的自动标定方法

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05329786A (ja) * 1992-05-29 1993-12-14 Mitsubishi Electric Corp 産業用ロボット装置
DE19854011A1 (de) * 1998-11-12 2000-05-25 Knoll Alois Einrichtung und Verfahren zum Vermessen von Mechanismen und ihrer Stellung
US6434449B1 (en) * 2000-08-03 2002-08-13 Pierre De Smet Method and device for automated robot-cell calibration
DE10153049B4 (de) * 2001-10-26 2007-03-08 Wiest Ag 3D-Koordinationssystem
US7245982B2 (en) * 2002-10-11 2007-07-17 Fidia S.P.A. System and process for measuring, compensating and testing numerically controlled machine tool heads and/or tables
JP4191080B2 (ja) * 2004-04-07 2008-12-03 ファナック株式会社 計測装置
US8989897B2 (en) * 2004-11-19 2015-03-24 Dynalog, Inc. Robot-cell calibration
JP2011224672A (ja) * 2010-04-15 2011-11-10 Kobe Steel Ltd ロボットのツールベクトルの導出方法及び較正方法
DE102010029429A1 (de) * 2010-05-28 2011-12-01 Dr. Johannes Heidenhain Gmbh Messvorrichtung
JP5425006B2 (ja) * 2010-07-12 2014-02-26 株式会社神戸製鋼所 ロボットのツールベクトルの導出に用いる治具
CN109579766B (zh) * 2018-12-24 2020-08-11 苏州瀚华智造智能技术有限公司 一种产品外形自动检测方法及系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100504687C (zh) * 2002-10-11 2009-06-24 弗迪亚有限公司 用于测量、补偿和测试数控机床头和/或工作台的系统和方法
CN102015221A (zh) * 2008-04-30 2011-04-13 Abb技术有限公司 用于确定机器人坐标系与位于机器人工作范围内的本地坐标系之间的关系的方法和系统
DE102010060124A1 (de) * 2009-10-27 2011-06-16 Werth Messtechnik Gmbh Verfahren und Anordnung zum Messen mit einem Koordinatenmessgerät
CN104827480A (zh) * 2014-02-11 2015-08-12 泰科电子(上海)有限公司 机器人系统的自动标定方法
CN104626205A (zh) * 2014-12-11 2015-05-20 珠海格力电器股份有限公司 机器人机械臂的检测方法和装置

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107932018A (zh) * 2017-11-23 2018-04-20 纳博特南京科技有限公司 一种工业机器人标定装置及标定方法
CN108942930A (zh) * 2018-07-18 2018-12-07 上海天豚信息科技有限公司 机械臂装置的闭环控制系统及方法
CN109176517A (zh) * 2018-09-10 2019-01-11 武汉久同智能科技有限公司 基于末端名义点约束的串联工业机器人连杆参数标定方法
CN109176517B (zh) * 2018-09-10 2021-04-30 武汉久同智能科技有限公司 基于末端名义点约束的串联工业机器人连杆参数标定方法
CN111157004A (zh) * 2019-12-31 2020-05-15 上海新时达机器人有限公司 法兰朝下四轴机器人的工具标定方法
CN111157004B (zh) * 2019-12-31 2024-03-19 上海新时达机器人有限公司 法兰朝下四轴机器人的工具标定方法
CN112045684A (zh) * 2020-09-05 2020-12-08 上官佳荣 一种自动辅助标定装置及其方法
CN112045684B (zh) * 2020-09-05 2021-07-06 杭州键嘉机器人有限公司 一种自动辅助标定装置及其方法
CN112525074A (zh) * 2020-11-24 2021-03-19 杭州素问九州医疗科技有限公司 标定方法、系统、机器人、计算机装置和导航系统
CN115249267A (zh) * 2022-09-22 2022-10-28 海克斯康制造智能技术(青岛)有限公司 一种基于转台及机器人位姿解算的自动检测方法及装置

Also Published As

Publication number Publication date
JP2019509186A (ja) 2019-04-04
US20190022867A1 (en) 2019-01-24
EP3433061A2 (en) 2019-01-30
CN107214692B (zh) 2020-04-03
WO2017163177A3 (en) 2017-11-02
EP3433061B1 (en) 2024-03-13
JP6657469B2 (ja) 2020-03-04
WO2017163177A2 (en) 2017-09-28
KR20180126539A (ko) 2018-11-27
US11027431B2 (en) 2021-06-08
KR102084656B1 (ko) 2020-04-27

Similar Documents

Publication Publication Date Title
CN107214692B (zh) 机器人系统的自动标定方法
CN106483963B (zh) 机器人系统的自动标定方法
CN104759945B (zh) 基于高精度工业相机的移动制孔机器人基准找正方法
CN109153125B (zh) 用于定向工业机器人的方法和工业机器人
CN104608129B (zh) 基于平面约束的机器人标定方法
CN106272416B (zh) 基于力觉和视觉的机器人细长轴精密装配系统及方法
CN104827480A (zh) 机器人系统的自动标定方法
US9517560B2 (en) Robot system and calibration method of the robot system
JP2018126857A (ja) ロボットの制御方法、ロボットの教示方法、ロボットシステム、プログラム及び記録媒体
CN105773609A (zh) 一种基于视觉测量及距离误差模型的机器人运动学标定方法
WO2018196232A1 (zh) 机器人和末端执行器的自动标定方法及系统
CN109822577A (zh) 一种基于视觉伺服的移动式机器人高精度加工方法
CN102802883A (zh) 工业机器人的基座坐标系的校准
CN110340881B (zh) 机器人工具的标定方法和标定系统
CN106248000B (zh) 零件孔轴线的测量方法
CN107009360A (zh) 一种六轴多关节工业机器人的校准装置及方法
Liu et al. An automated method to calibrate industrial robot kinematic parameters using Spherical Surface constraint approach
JP6367702B2 (ja) 位置決めシステム及び溶接システム
Mai et al. Applying a virtual tool center point calibration and position teaching system of robotic arm to automatically detect displays
CN115319754B (zh) 机器人与激光传感器手眼标定方法及装置
Li Improvement of Robot Accuracy with an Optical Tracking System
CN116061162A (zh) 一种避免奇异性的手眼标定数据采集与处理方法
JP2024145832A (ja) 摩擦攪拌接合方法及び摩擦攪拌接合システム
Wu et al. An automatic tracking approach for aircraft skin drilling and riveting robot by using monocular vision technology
TW202402493A (zh) 機器人點位演算校正系統與校正方法

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