Industrial robot automatic calibration system and method

Through the combination of Leica laser tracker and T-Mac equipment, the I/O communication box is used to realize automatic acquisition of the end coordinates and attitude angles of industrial robots, solving the problems of low calibration accuracy and unstable acquisition points in the existing technology, and improving the The robot's absolute positioning accuracy and calibration efficiency are achieved.

CN111390940BActive Publication Date: 2024-11-12SHANGHAI ROBOT IND TECH RES INST CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202010312326.3
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2020-04-20
Publication Date
2024-11-12
Estimated Expiration
2040-04-20

AI Technical Summary

Technical Problem

The existing laser tracker plus reflective ball calibration methods cannot accurately measure the attitude angle at the end of an industrial robot, resulting in low calibration accuracy. Moreover, due to the long measurement time, the laser tracker occasionally misses the opportunity to collect points, affecting the calibration effect.

Method used

Using Leica laser tracker and T-Mac equipment, the interactive communication between the upper computer, the robot electrical control cabinet and the laser tracker is realized through the I/O communication box, and the X, Y, Z coordinate values ​​and attitude angles of the industrial robot ends are completed. Continuous automatic acquisition, using iterative algorithm to solve the compensation value of DH parameter value and speed reduction ratio, and realize automatic and accurate calibration.

Benefits of technology

It improves the absolute positioning accuracy of industrial robots, ensures the complete acquisition point of the laser tracker, and realizes a more efficient automated calibration process, avoiding the loss of acquisition point due to unstable measurements.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN111390940B_ABST
    Figure CN111390940B_ABST
Patent Text Reader

Abstract

The present invention relates to an industrial robot automatic calibration system, comprising an industrial robot to be calibrated, the industrial robot is connected to a robot electrical control cabinet, and is characterized in that the industrial robot automatic calibration system also includes a Leica T-Mac device located at the end of the industrial robot, a Leica laser tracker is located directly in front of the industrial robot, and the T-Mac device is connected to a controller of the laser tracker; the industrial robot automatic calibration system also includes an I / O communication box, an I / O module of the robot electrical control cabinet is connected to the I / O communication box, and the I / O communication box is then connected to a host computer, and wireless communication is established between the host computer and the laser tracker. The present invention also relates to an industrial robot automatic calibration method.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to a system and method for distinguishing manual programming teaching calibration and non-gesture participation calculation, and in particular to an industrial robot automatic calibration system based on an I / O communication box, a Leica laser tracker and a T-Mac, and an automatic calibration method using the automatic calibration system. Background Art

[0002] The absolute positioning accuracy of industrial robots is an important indicator to measure the performance of industrial robots. The DH parameters or MDH parameters are corrected by using a laser tracker plus a reflective ball to collect points and an algorithm to iterate the function extreme value. This method has high calibration accuracy and strong adaptability. Industrial robots with various structures and different DH parameter values ​​can be calibrated. It is suitable for the prototype development and verification stage, as well as the calibration of difficult and complicated industrial robots in mass production.

[0003] The common laser tracker plus reflective ball calibration method usually only measures the X, Y, and Z coordinate values ​​of the reflective ball at the end of the industrial robot, but does not measure the attitude angle R of the end. x , R y , R z The laser tracker is used to measure the position of the robot, so the calibration effect is not very high. In addition, the common laser tracker plus reflective ball calibration method requires a few seconds for the industrial robot to stabilize after running a program. Therefore, the laser tracker occasionally fails to take points because the reflective ball is not stable. The robot will perform the next action after waiting for several seconds, so the laser tracker occasionally misses the opportunity to take points. Summary of the invention

[0004] The purpose of the present invention is to complete point sampling and automatic and accurate calibration of a laser tracker.

[0005] In order to achieve the above-mentioned purpose, the technical solution of the present invention is to provide an industrial robot automatic calibration system, including an industrial robot to be calibrated, the industrial robot is connected to the robot electrical control cabinet, and is characterized in that the industrial robot automatic calibration system also includes a Leica T-Mac device located at the end of the industrial robot, a Leica laser tracker is located directly in front of the industrial robot, and the T-Mac device is connected to the controller of the laser tracker; the industrial robot automatic calibration system also includes an I / O communication box containing a Beckhoff communication module, the I / O module of the robot electrical control cabinet is connected to the I / O communication box, and the I / O communication box is then connected to a host computer, and wireless communication is established between the host computer and the laser tracker.

[0006] Preferably, the industrial robot is arranged on a shock absorbing platform.

[0007] Preferably, the industrial robot is connected to the robot electrical control cabinet via a cable, and the I / O module of the robot electrical control cabinet is connected to the I / O communication box via a VGA cable.

[0008] Preferably, the straight-line distance D between the industrial robot and the laser tracker is 2 m to 4 m.

[0009] Preferably, the T-Mac device is connected to the controller of the laser tracker via a data line.

[0010] Preferably, the I / O communication box is connected to the host computer via a network cable.

[0011] Another technical solution of the present invention is to provide an industrial robot automatic calibration method, characterized in that it includes the following steps:

[0012] Step 1: Install the industrial robot to be calibrated on a stable shock-absorbing platform;

[0013] Step 2: Place the Leica laser tracker 2m to 4m in front of the industrial robot, and then install the Leica T-Mac device at the end of the industrial robot;

[0014] Step 3: Use a data cable to connect the T-Mac device to the laser tracker controller;

[0015] Step 4: Connect the robot electrical control cabinet connected to the industrial robot to the I / O communication box via a VGA cable;

[0016] Step 5: Connect the I / O communication box to the host computer via a network cable;

[0017] Step 6: Connect the laser tracker to the host computer through wireless communication, and finally complete the construction of the automated calibration platform;

[0018] Step 7: Compile a robot calibration program to enable the robot to change 30 postures, where the calibration program includes the function of interactive communication;

[0019] Step 8: Click Start on the host computer software, and the industrial robot starts running the current line of calibration program;

[0020] Step 9: When the industrial robot is in position, the I / O module of the robot electrical control cabinet sends a signal to the I / O communication box;

[0021] Step 10: The I / O communication box transmits the signal to the host computer, and the host computer sends the acquisition command to the laser tracker through wireless communication, and the laser tracker starts to collect points;

[0022] Step 11: When the laser tracker completes point collection, it sends a signal to the host computer through wireless communication, and the host computer transmits the signal to the I / O communication box; the I / O communication box transmits the signal to the I / O module of the robot electrical control cabinet, and the robot electrical control cabinet controls the industrial robot to run the next line of calibration program, and returns to step 9 until the collection of 30 pose points of the industrial robot is completed, and the set of actual collected pose points is obtained;

[0023] Step 12: On the host computer, compare and analyze the set of theoretical pose points with the set of actual collected pose points, solve the tool coordinate system, and solve the compensation values ​​of DH parameter values, reduction ratio, and reducer coupling ratio. Then, modify the DH parameter values, reduction ratio, and reducer coupling ratio of the industrial robot according to the compensation values ​​to complete the calibration.

[0024] Preferably, in step twelve, solving the compensation value includes the following steps:

[0025] Step 1201, check the control algorithm running on the robot electrical control cabinet (2), observe whether the DH parameter value, reduction ratio, reducer coupling ratio, and tool coordinate system can be modified, and set initial compensation values ​​for the DH parameters, reduction ratio, reducer coupling ratio, and tool coordinate system that can be modified;

[0026] Step 1202: Set the initial value of the number of iterations i to 1, set the initial value of the target value to be the target value of the 0th iteration, and set the threshold value of the number of iterations i to max ;

[0027] Step 1203: Substitute the compensation value obtained in the previous step into the forward kinematics operation of the robot in 30 postures to obtain the position value and attitude angle of the end tool point of the robot in 30 postures, and subtract them from the actual position value and actual attitude angle measured by the laser tracker (6). The result of the subtraction is the target value of the i-th iteration;

[0028] Step 1204: Determine whether the target value of the i-th iteration is less than the target value of the i-1-th iteration. If so, proceed to step 1205; if not, proceed to step 1207.

[0029] Step 1205: Use the LM algorithm to change the compensation value according to a predetermined step size;

[0030] Step 1206: If i is greater than the threshold value I max , then go to step 1207, otherwise, update i to i+1 and return to step 1203;

[0031] Step 1207, the target value obtained in the i-th iteration is the final target value, and the DH parameter value, reduction ratio, and compensation value of the reducer coupling ratio corresponding to the target value are the DH parameter value, reduction ratio, and compensation value of the reducer coupling ratio solved in step twelve.

[0032] The present invention has the following advantages:

[0033] The present invention uses the laser tracker and T-Mac equipment of Leica Company to completely collect the X, Y, Z coordinate values ​​and attitude angle R of the robot end. x , R y , R z , which is helpful for later calibration and solution, and can solve more accurate DH parameter values, reduction ratios, and compensation values ​​of reducer coupling ratios, so that the calibrated robot has higher absolute accuracy. The I / O communication box is used to realize the interactive communication between the host computer, the robot electrical control cabinet, and the Leica laser tracker, so that the Leica laser tracker can continuously and automatically collect the terminal coordinate values ​​and attitude angles of the industrial robot. BRIEF DESCRIPTION OF THE DRAWINGS

[0034] Figure 1 A schematic diagram of an industrial robot automated calibration system provided by the present invention. DETAILED DESCRIPTION

[0035] The present invention will be further described below in conjunction with specific embodiments. It should be understood that these embodiments are only used to illustrate the present invention and are not intended to limit the scope of the present invention. In addition, it should be understood that after reading the content taught by the present invention, those skilled in the art can make various changes or modifications to the present invention, and these equivalent forms fall within the scope limited by the appended claims of the application equally.

[0036] This embodiment takes an ABB industrial robot, an IO communication box based on a Beckhoff module, a DELL workstation, a laser tracker of Leica, and a T-Mac as examples to illustrate the present invention.

[0037] like Figure 1As shown, an industrial robot automatic calibration system provided by the present invention includes an industrial robot 1 to be calibrated, and the industrial robot 1 is installed on a stable shock-absorbing platform 3. The industrial robot 1 is connected to the robot electrical control cabinet 2 through a cable 4. A T-Mac device 5 of Leica is installed at the end of the industrial robot 1, and a laser tracker 6 of Leica is placed directly in front of the industrial robot 1. The straight-line distance D between the industrial robot 1 and the laser tracker 6 is 2m to 4m. The T-Mac device 5 is connected to the controller of the laser tracker 6 through a data cable 7. The I / O module of the robot electrical control cabinet 2 is connected to the I / O communication box 8 through a VGA cable 11, and the I / O communication box 8 is then connected to the host computer 9 through a network cable 10, and wireless communication is established between the host computer 9 and the laser tracker 6.

[0038] An industrial robot automatic calibration method provided by the present invention comprises the following steps:

[0039] Install the ABB industrial robot 1 on a stable shock-absorbing platform 3. Then place the Leica laser tracker 6 about 3 meters in front of the ABB industrial robot 1, and then install the tooling and T-Mac device 5 at the end of the ABB industrial robot 1. Use the data cable 7 to connect the T-Mac device 5 to the controller of the Leica laser tracker 6. Connect the robot electrical control cabinet 2 of the ABB industrial robot 1 to the I / O communication box 8 through the VGA cable 4. Note that three I / O interfaces are involved (the robot electrical control cabinet 2 gives two outputs and one input; the corresponding I / O communication box 8 requires two inputs and one output). Connect the I / O communication box 8 to the host computer 9 through the network cable 10. Connect the laser tracker 6 to the host computer 9 through wireless communication, and finally complete the construction of the automated calibration platform. Prepare a robot calibration operation program so that the robot changes 30 postures, and the calibration operation program includes the function of interactive communication. Note that each joint of the ABB industrial robot 1 needs to fully rotate within the range of travel and be as evenly distributed as possible, that is, each joint of the ABB industrial robot 1 needs to rotate significantly every time it runs a program, so that the subsequent algorithm can calculate the compensation value. Click Start on the host computer software, and the ABB industrial robot 1 starts to run the calibration program. When the ABB industrial robot 1 runs in place, the I / O module of the robot electrical control cabinet 2 sends a signal to the I / O communication box 8. The I / O communication box 8 transmits the signal to the host computer 9; the host computer 9 sends the acquisition instruction to the laser tracker 6 through wireless communication; the laser tracker 6 starts to collect points. When the laser tracker 6 completes the point collection, it sends a signal to the host computer 9 through wireless communication, and the host computer 9 transmits the signal to the I / O communication box 8; the I / O communication box 8 transmits the signal to the I / O module of the robot electrical control cabinet 2, and the robot electrical control cabinet 2 controls the ABB industrial robot 1 to run the next line of the program; this cycle repeats until the collection of 30 posture points of the ABB industrial robot 1 is completed. On the host computer 9, the theoretical pose point set is compared and analyzed with the actual collected pose point set, and the tool coordinate system is solved through a specific algorithm, and the compensation values ​​of DH parameter values, reduction ratio, reducer coupling ratio, etc. are solved at the same time.

[0040] The solution of the above compensation value specifically includes the following steps:

[0041] First, check the control algorithm running on the robot electrical control cabinet 2 to see whether the DH parameters (DH parameters include joint angle θ, torsion angle α, connecting rod length A, connecting rod offset D), reduction ratio i, reducer coupling ratio C, tool coordinate system, etc. can be modified.

[0042] Then, the initial compensation values ​​are set for the DH parameters that can be modified (joint angle θ, torsion angle α, connecting rod length A, connecting rod offset D), reduction ratio i, reducer coupling ratio C, tool coordinate system, etc., and participate in the positive kinematics operation of the robot's 30 postures to obtain the position value and attitude angle of the end tool point of the robot in 30 postures, and the difference is made with the actual position value and attitude angle measured by the laser tracker 6. The result of the difference is the target value. Using the LM algorithm, the compensation value is changed according to the pre-given step size and substituted into the positive kinematics operation. If the target value is reduced, the compensation value is further changed. Repeat the iterative operation in this way to minimize the target value. At this time, the compensation values ​​of the DH parameters (joint angle θ, torsion angle α, connecting rod length A, connecting rod offset D), reduction ratio i, reducer coupling ratio C, tool coordinate system, etc. are the final results.

[0043] Finally, the DH parameter value, reduction ratio, reducer coupling ratio, etc. of the industrial robot are modified according to the compensation value, ultimately achieving automated and precise pose point acquisition without omissions and automated calibration of the industrial robot.

Claims

1. An industrial robot automatic calibration method, using an industrial robot automatic calibration system, the industrial robot automatic calibration system comprising an industrial robot (1) to be calibrated, the industrial robot (1) being arranged on a shock-absorbing platform (3), the industrial robot (1) being connected to a robot electrical control cabinet (2), the industrial robot automatic calibration system further comprising a Leica T-Mac device (5) arranged at the end of the industrial robot (1), a Leica laser tracker (6) being arranged directly in front of the industrial robot (1), the straight-line distance D between the industrial robot (1) and the laser tracker (6) being 2m to 4m, the T-Mac device (5) being connected to a controller of the laser tracker (6); the industrial robot automatic calibration system further comprising an I / O communication box (8) containing a Beckhoff communication module, the I / O module of the robot electrical control cabinet (2) being connected to the I / O communication box (8), the I / O communication box (8) being further connected to a host computer (9), wireless communication being established between the host computer (9) and the laser tracker (6), characterized in that: The industrial robot automatic calibration method comprises the following steps: Step 1: Install the industrial robot (1) to be calibrated on a stable shock-absorbing platform (3); Step 2: Place a laser tracker (6) of Leica Corporation 2m to 4m in front of the industrial robot (1), and then install a T-Mac device (5) of Leica Corporation at the end of the industrial robot (1); Step 3: Use a data cable (7) to connect the T-Mac device (5) to the controller of the laser tracker (6); Step 4: Connect the robot electrical control cabinet (2) connected to the industrial robot (1) to the I / O communication box (8) via a VGA cable (4); Step 5: Connect the I / O communication box (8) to the host computer (9) via a network cable (10); Step 6: Connect the laser tracker (6) to the host computer (9) through wireless communication, and finally complete the construction of the automated calibration platform; Step 7: Compile a robot calibration program to enable the robot to change 30 postures, where the calibration program includes the function of interactive communication; Step 8: Click Start on the host computer software, and the industrial robot (1) starts running the current line of calibration program; Step 9: When the industrial robot (1) reaches the position, the I / O module of the robot electrical control cabinet (2) sends a position signal to the I / O communication box (8); Step 10: The I / O communication box (8) transmits the signal to the host computer (9), and the host computer (9) sends a collection instruction to the laser tracker (6) through wireless communication, and the laser tracker (6) starts to collect points; Step 11: When the laser tracker (6) completes point collection, it sends a signal to the host computer (9) through wireless communication, and the host computer (9) transmits the signal to the I / O communication box (8); the I / O communication box (8) transmits the signal to the I / O module of the robot electrical control cabinet (2), and the robot electrical control cabinet (2) controls the industrial robot to run the next line of calibration program, and returns to step 9 until the collection of 30 posture points of the industrial robot (1) is completed, and the set of actual collected posture points is obtained; Step 12: On the host computer (9), the set of theoretical pose points is compared and analyzed with the set of actual collected pose points, the tool coordinate system is solved, and the compensation values ​​of DH parameter value, reduction ratio, and reducer coupling ratio are solved at the same time. Then, the DH parameter value, reduction ratio, and reducer coupling ratio of the industrial robot are modified according to the compensation value, and finally the calibration is completed. The solution of the compensation value includes the following steps: Step 1201, check the control algorithm running on the robot electrical control cabinet (2), observe whether the DH parameter value, reduction ratio, reducer coupling ratio, and tool coordinate system can be modified, and set initial compensation values ​​for the DH parameters, reduction ratio, reducer coupling ratio, and tool coordinate system that can be modified; Step 1202: Set the initial value of the number of iterations i to 1, set the initial value of the target value to be the target value of the 0th iteration, and set the threshold value of the number of iterations i to max ; Step 1203: Substitute the compensation value obtained in the previous step into the forward kinematics operation of the robot in 30 postures to obtain the position value and attitude angle of the end tool point of the robot in 30 postures, and subtract them from the actual position value and actual attitude angle measured by the laser tracker (6). The result of the subtraction is the target value of the i-th iteration; Step 1204: Determine whether the target value of the i-th iteration is less than the target value of the i-1-th iteration. If so, proceed to step 1205; if not, proceed to step 1207. Step 1205: Use the LM algorithm to change the compensation value according to a predetermined step size; Step 1206: If i is greater than the threshold value I max , then go to step 1207, otherwise, update i to i+1 and return to step 1203; Step 1207, the target value obtained in the i-th iteration is the final target value, and the DH parameter value, reduction ratio, and compensation value of the reducer coupling ratio corresponding to the target value are the DH parameter value, reduction ratio, and compensation value of the reducer coupling ratio solved in step twelve.