A robust, low-cost method for calibrating robotic tools
By using a standard calibration board and an error function optimization solution method, the problems of high cost and noise error were solved, achieving low-cost and high-precision robot tool calibration.
Patent Information
- Application Number
- CN202411537009.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-31
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2044-10-31
AI Technical Summary
Existing robot tool calibration methods require custom-made special targets and are costly. The solution results are easily affected by noise errors, leading to deviations.
Using a standard calibration board, a checkerboard calibration board, a dot calibration board, or a grating glass chart, the translation amount of the tool TCP is obtained by establishing an error function E=Ed+λEp and optimizing the solution using the LM method.
It achieves low-cost calibration, improves calibration accuracy and robustness, and can obtain near-optimal solutions under noisy conditions.
Smart Images

Figure CN119347759B_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of robot tool calibration technology, and in particular to a robust, low-cost robot tool calibration method. Background Technology
[0002] Robot tool calibration refers to the process of determining the transformation matrix of the tool coordinate system relative to the robot's end effector coordinate system. The purpose of this process is to allow the operator to flexibly adjust the posture of the robot's end effector and more precisely control the robot's motion trajectory. Currently, a widely used method involves controlling the robot to repeatedly contact the tool's end effector TCP point with a fixed spatial point in different postures, recording the rotation angles of each robot joint during contact, and then using the robot's kinematic position constraints to establish an equation to solve for the robot's end effector position.
[0003] Existing solutions utilize specific needle-tip targets or planar devices, such as tool targets with fixed needle tips or resistive touchscreens with ranging capabilities, to obtain the true distance between all contact points. Alternatively, a sensing metal plate can send a feedback signal to stop the robot after it contacts the plane. These solutions all require custom-made targets, which are not only difficult to obtain but also costly. Furthermore, most current solution methods are based on direct equation solving. While these methods can yield accurate results under ideal conditions with no noise and no errors, data errors are inevitable in practice, leading to potential deviations in the solution results.
[0004] Therefore, a new technical solution is urgently needed to solve the above-mentioned technical problems. Summary of the Invention
[0005] The purpose of this invention is to overcome the problems of the prior art and provide a robust and low-cost robot tool calibration method to solve the problems of the existing technology which requires the customization of special targets, which is not only difficult to obtain but also costly; and the existing solution methods, which are mostly based on direct equation solving, cannot be performed under ideal conditions without noise and error, thus leading to possible deviations in the solution results.
[0006] The above objectives are achieved through the following technical solutions:
[0007] A robust, low-cost robot tool calibration method includes a horizontally positioned calibration plate accessible to the end effector of a robot tool, the calibration plate having several key points; the method includes the following steps:
[0008] Step (1) Based on the contact between the robot tool end and the key points, the robot controller obtains the relative position transformation of the robot joint end relative to the robot base coordinate system.
[0009] Where i∈(1,n); n is the number of key points, n>5, and the positions of the key points are not collinear;
[0010] Step (2) Establish the coordinates of each key point on the calibration board in the robot base coordinate system. As shown in the following formula:
[0011]
[0012] Then we have:
[0013]
[0014] in, This represents the translation of the tool end relative to the end of the robot joint;
[0015] Step (3) Establish the error function E for robot tool calibration, including distance error E d Coplanarity error E p The distance error E d The formula for the difference between the actual distance and the calculated distance between two adjacent keypoints is as follows:
[0016]
[0017] Where, d ij It is the actual distance between two adjacent key points;
[0018] The coplanarity error is the sum of squared distances from each key point to the plane, as shown in the following formula:
[0019]
[0020] Then we have:
[0021] E = E d +λE p
[0022] Wherein, λ is a weighting factor used to balance distance error and coplanarity error;
[0023] Step (4) Based on the recorded robot joint end data True distance d ij And the established error function E = E d +λE p The LM method is used for optimization to obtain the solution.
[0024] Furthermore, the calibration plate is one of a checkerboard calibration plate, a dot calibration plate, or a grating glass chart.
[0025] Furthermore, in the coplanar error, if all key points are assumed to be located on the same horizontal plane, then the plane equation is ax + by + cz + d = 0.
[0026] This invention provides a robust, low-cost robot tool calibration method that can calibrate the tool's contact area (TCP) using a common calibration board, eliminating the need for customized targets. Furthermore, during the TCP calibration process, an optimized error function is established based on the principle that the distances between all contact points are known and coplanar. This optimized solution is simple to operate, highly accurate, and robust to noise; even in noisy conditions, this method can still obtain a close approximation of the optimal solution. Attached Figure Description
[0027] Figure 1 This is a flowchart of a robust, low-cost robotic tool calibration method according to the present invention. Detailed Implementation
[0028] The present invention will now be described in further detail with reference to the accompanying drawings and embodiments. The described embodiments are merely some, not all, of the embodiments of the present invention. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of the present invention.
[0029] This solution provides a robust, low-cost method for calibrating robotic tools, including a horizontally positioned calibration plate that can be touched by the end effector of the robotic tool. The calibration plate has several key points. It should be noted that in vision-guided robotic welding or grasping scenarios, hand-eye calibration is required, so calibration plates are usually available on-site, making them easy to obtain and inexpensive. In this embodiment, the calibration plate is selected from one of the following: a checkerboard calibration plate, a dot calibration plate, or a grating glass chart.
[0030] like Figure 1 As shown, this solution includes the following steps:
[0031] Step (1) Move the robot's tool end effector to the key point positions on the planar calibration plate in different postures. Based on the contact between the robot's tool end effector and the key points, obtain the relative position transformation of the robot joint end effector relative to the robot's base coordinate system through the robot controller.
[0032] Where i∈(1,n); n is the number of key points, n>5, and the positions of the key points are not collinear;
[0033] Step (2) Establish the coordinates of each key point on the calibration board in the robot base coordinate system. As shown in the following formula:
[0034]
[0035] Then we have:
[0036]
[0037] in, The translation of the tool end relative to the robot joint end, i.e., the TCP position, is the quantity to be determined.
[0038] Step (3) Based on the fact that the actual distance between each key point on the calibration board is known and all points are located on the same plane, establish the error function E for robot tool calibration, including the distance error E. d Coplanarity error E p ;
[0039] Specifically, the distance error E d The formula for the difference between the actual distance and the calculated distance between two adjacent keypoints is as follows:
[0040]
[0041] Where, d ij It is the actual distance between two adjacent key points, which can be obtained based on the point index and calibration plate specifications;
[0042] Assuming all keypoints lie on the same horizontal plane, the plane equation is ax + by + cz + d = 0. For each keypoint, this plane equation should be satisfied. The coplanarity error is the sum of the squared distances from each keypoint to the plane, as shown in the following formula:
[0043]
[0044] Then we have:
[0045] E = E d +λE p
[0046] Wherein, λ is a weighting factor used to balance distance error and coplanarity error;
[0047] Step (4) Based on the robot joint end data recorded in the above steps True distance d ij And the established error function E = E d +λE p The LM method is used for optimization to obtain the solution.
[0048] It should be noted that the LM (Levenberg-Marquard) method used in this embodiment is an optimization algorithm for nonlinear least squares problems. It combines the advantages of gradient descent and the Gauss-Newton method, introducing a parameter to balance the trade-offs between the two, thus providing better convergence performance. In the early stages of the algorithm, gradient descent is emphasized to explore the solution space; in the later stages, the Gauss-Newton method is emphasized for faster convergence. The steps include: initializing parameter values; calculating the Jacobian and Hessian matrices of the error function; calculating the next update step size based on the current Hessian matrix and the algorithm's method of dynamically adjusting the error function; and determining the termination condition, such as reaching the maximum number of iterations or the sum of squared residuals being less than a threshold, at which point the algorithm terminates.
[0049] Therefore, by establishing an error function and using the LM iterative optimization method during the solution process, an approximate optimal solution can be obtained even under noisy conditions, thus demonstrating the robustness of this method.
[0050] The above description is merely illustrative of the embodiments of the present invention and is not intended to limit the present invention. For those skilled in the art, any modifications, equivalent substitutions, improvements, etc., made within the spirit and principles of the present invention should be included within the protection scope of the present invention.
Claims
1. A robust, low-cost method for calibrating robotic tools, characterized in that, It includes a horizontally positioned calibration plate that can be touched by the end effector of a robotic tool, and the calibration plate has several key points; it includes the following steps: Step (1) Based on the contact between the robot tool end effector and the key points, obtain the relative position transformation of the robot joint end effector relative to the robot base coordinate system through the robot controller. ; in ; For the number of key points, Furthermore, the key points are not collinear; Step (2) Establish the coordinates of each key point on the calibration board in the robot base coordinate system. As shown in the following formula: = Then we have: in, This represents the translation of the tool end relative to the end of the robot joint; Step (3) Establish the error function E for robot tool calibration, including distance error E d Coplanarity error E p The distance error E d The formula for the difference between the actual distance and the calculated distance between two adjacent keypoints is as follows: in, It is the actual distance between two adjacent key points; The coplanarity error is the sum of squared distances from each key point to the plane, as shown in the following formula: Then we have: in, This is a weighting factor used to balance distance error and coplanarity error; In the coplanarity error, assuming all key points lie on the same horizontal plane, the plane equation is: ; Step (4) Based on the recorded robot joint end data Real distance and the established error function The LM method is used for optimization to obtain the solution. .
2. The robust, low-cost robot tool calibration method according to claim 1, characterized in that, The calibration board is one of a checkerboard calibration board, a dot calibration board, or a grating glass chart.
Citation Information
Patent Citations
Online feedback hand-eye calibration method based on weighted least square method
CN111203881A
Mechanical arm parameter calibration method based on laser displacement meter
CN114260941A
