Calibration apparatus and calibration method for coordinate system of robotic arm

Patent metadata

Field	Value
Publication number	US-11951637-B2
Application number	US-202117339760-A
Country	US
Kind code	B2
Filing date	Jun 4, 2021
Priority date	Sep 29, 2020
Publication date	Apr 9, 2024
Grant date	Apr 9, 2024

Abstract

A calibration apparatus includes a processor, an alignment device, and an arm. The alignment device captures images in a three-dimensional space, and a tool is arranged on a flange of the arm. The processor records a first matrix of transformation between an end-effector coordinate-system and a robot coordinate-system, and performs a tool calibration procedure according to the images captured by the alignment device for obtaining a second matrix of transformation between a tool coordinate-system and the end-effector coordinate-system. The processor calculates relative position of a tool center point of the tool in the robot coordinate-system based on the first and second matrixes, and controls the TCP to move in the three-dimensional space for performing a positioning procedure so as to regard points in an alignment device coordinate-system as points of the TCP, and calculates the relative positions of points in the alignment device coordinate-system and in the robot coordinate-system.

First claim

What is claimed is:

1. A calibration apparatus for a coordinate system of a robotic arm, the calibration apparatus comprising:
an alignment device, capturing an image in a field of view (FoV), wherein the FoV is a three-dimensional space, and the alignment device uses an alignment device coordinate system, where the alignment device is immovable and the alignment device coordinate system is fixed;
a robotic arm, one end of the robotic arm being arranged with a flange thereon, wherein the robotic arm uses a robot coordinate system, and the flange uses an end-effector coordinate system, and the robotic arm and the alignment device are arranged individually;
a tool, one end of the tool being arranged on the flange, the other end of the tool comprising a tool center point (TCP), wherein the tool uses a tool coordinate system; and
a processor, electrically connected with the alignment device and the robotic arm, recording a first homogeneous matrix indicating a transforming relationship between the end-effector coordinate system and the robot coordinate system, wherein the processor is configured to control the tool to move in the three-dimensional space generated by the alignment device under multiple gestures for performing a tool calibration procedure, and to compute a second homogeneous matrix indicating a transforming relationship between the tool coordinate system and the end-effector coordinate system according to data obtained from the tool calibration procedure;
wherein, the processor is configured to compute a third homogeneous matrix indicating a transforming relationship between the tool coordinate system and the robot coordinate system according to the first homogeneous matrix and the second homogeneous matrix, and to compute the relative position of the TCP in the robot coordinate system based on the third homogeneous matrix;
wherein, the processor is configured to control the TCP to perform a three-point fix procedure in the three-dimensional space for regarding points in the alignment device coordinate system as points of the TCP, the processor is configured to compute a fourth homogeneous matrix indicating a transforming relationship between the alignment device coordinate system and the robot coordinate system based on the third homogeneous matrix, and to compute the relative positions of points in the alignment device coordinate system and in the robot coordinate system according to the fourth homogeneous matrix.

2. The calibration apparatus in claim 1 , wherein the alignment device is a 3D machine visual sensor.

3. The calibration apparatus in claim 2 , wherein the tool calibration procedure comprises a tool dimension calibration procedure for obtaining a displacement amount of the TCP with respect to the flange and a tool direction calibration procedure for obtaining a rotation amount of the TCP with respect to the flange, and the processor is configured to establish the second homogeneous matrix based on the displacement amount and the rotation amount; wherein when the tool dimension calibration procedure is performed, the processor is configured to control the alignment device to perform an image analysis to the tool, control the tool to make the TCP arrive at the same positioning point in the three-dimensional space under multiple gestures based on data obtained from the image analysis, record coordinate information of the tool under each of the gestures, and compute a dimension of the tool according to the coordinate information; wherein when the tool direction calibration procedure is performed, the processor is configured to control the tool to move in the three-dimensional space based on multiple heights and angles, and perform the image analysis to the tool by the alignment device to obtain positions and tilted angles of the tool for computing a direction vector of the tool.

4. The calibration apparatus in claim 1 , wherein the alignment device comprises a light blocking sensor and a 2D visual extractor, the light blocking sensor is configured to emit a light beam, the 2D visual extractor is configured to capture a 2D image within the FoV, the light beam is located within the FoV and forms the three-dimensional space with the 2D image, wherein the processor is configured to control the tool to block the light beam under multiple gestures for performing the tool calibration procedure through the light blocking sensor.

5. The calibration apparatus in claim 4 , wherein the light blocking sensor is arranged on a horizontal plane, and the light beam is emitted on a fixed height.

6. The calibration apparatus in claim 4 , wherein the tool calibration procedure comprises a tool dimension calibration procedure for obtaining a displacement amount of the TCP with respect to the flange and a tool direction calibration procedure for obtaining a rotation amount of the TCP with respect to the flange, and the processor is configured to establish the second homogeneous matrix based on the displacement amount and the rotation amount; wherein when the tool dimension calibration procedure is performed, the processor is configured to control the tool to make the TCP arrive at the same positioning point and block the light beam under multiple gestures, record coordinate information of the tool under each of the gestures respectively, and compute a dimension of the tool according to the coordinate information; wherein when the tool direction calibration procedure is performed, the processor is configured to control the tool to move and block the light beam based on multiple heights, compute a horizontal displacement amount of the flange for the tool to block the light beam upon each height, and compute a direction vector of the tool according to the multiple horizontal displacement amounts.

7. The calibration apparatus in claim 4 , wherein when the three-point fix procedure is performed, the processor is configured to control the tool to move and make the TCP successively arrive at three positioning points on a two-dimensional plane in the three-dimensional space, and perform the three-point fix procedure according to the coordinate information of three positioning points.

8. The calibration apparatus in claim 7 , wherein the processor is configured to execute the following actions to implement the three-point fix procedure:
controlling the TCP to arrive at a first positioning point on the two-dimensional plane and block the light beam;
recording coordinate information of the TCP on the first positioning point;
controlling the TCP to arrive at a second positioning point on the two-dimensional plane and block the light beam, wherein a height of the second positioning point is the same with a height of the first positioning point;
recording coordinate information of the TCP on the second positioning point;
controlling the TCP to arrive at a third positioning point on the two-dimensional plane, wherein a height of the third positioning point is different from the height of the first positioning point and the height of the second positioning point;
recording coordinate information of the TCP on the third positioning point; and
performing the three-point fix procedure according to the coordinate information of the first positioning point, the second positioning point, and the third positioning point.

9. A calibration method for a coordinate system of a robotic arm, incorporated with a calibration apparatus comprising an alignment device, a robotic arm, a tool arranged on a flange on one end of the robotic arm and comprising a tool center point (TCP), and a processor electrically connected with the alignment device and the robotic arm, wherein the robotic arm uses a robot coordinate system, the flange uses an end-effector coordinate system, the too

Assignees

• Delta Electronics Inc

Inventors

• Huang Cheng-Hao
• Wang Shi-Yu
• Huang Po-Chiao
• Lin Han-Ching
• Li meng-zong

Classifications

• B25J9/1692 Primary

  Calibration of manipulator · CPC title

• B25J9/023

  Cartesian coordinate type · CPC title

• B25J9/1607

  Calculation of inertia, jacobian matrixes and inverses · CPC title

• B25J9/1664

  characterised by motion, path, trajectory planning · CPC title

• B25J9/1697

  Vision controlled systems · CPC title