Wheel type odometer calibration method and laser radar external parameter calibration method

Through the two-step hand-eye calibration method of wheel odometer calibration and laser point cloud registration, the problem of high environmental dependence of lidar calibration is solved, and the accurate calibration of lidar external parameters is achieved, the calibration process is simplified and the robot is improved. Positioning and navigation accuracy.

CN118960783AActive Publication Date: 2024-11-15FUJIAN (QUANZHOU) HIT RESEARCH INSTITUTE OF ENGINEERING & TECHNOLOGY

Patent Information

Application Number
CN202411072531.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-06
Publication Date
2024-11-15
Estimated Expiration
2044-08-06

AI Technical Summary

Technical Problem

Existing lidar calibration methods rely on specific equipment and environments, increase system complexity and environmental requirements, making it difficult to simplify the calibration process and improve accuracy.

Method used

The position correction proportion coefficient and attitude correction proportion coefficient are calculated by the wheel odometer calibration method, combined with the differential wheeled robot's lidar to obtain laser point cloud data at adjacent moments for matching, and a two-step hand-eye calibration is used to reduce the equipment and The dependence of the environment directly determines the external parameters of the base coordinate system of the lidar and robot.

Benefits of technology

The environmental requirements for lidar external parameter calibration are achieved, the calibration process is simplified, the position and attitude accuracy of lidar in the base coordinate system of differential wheel robots is improved, and the positioning and navigation accuracy is improved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118960783A_ABST
    Figure CN118960783A_ABST
Patent Text Reader

Abstract

The invention discloses a wheel type odometer calibration method and a laser radar external parameter calibration method, and the calibration method comprises the steps: calculating a position correction proportionality coefficient alpha through a position calibration method, calculating an attitude correction proportionality coefficient beta through an attitude calibration method, and carrying out the calibration of the position correction proportionality coefficient alpha and the attitude correction proportionality coefficient beta through the calibration of the position correction proportionality coefficient alpha and the attitude correction proportionality coefficient beta; the wheel type odometer A is obtained through the rotating speed of a wheel and is calculated, calibrated and corrected through alpha and beta, the calibrated wheel type odometer A is obtained through an external parameter calibration method, laser point cloud data of two adjacent moments are obtained through a laser radar, and the two laser point cloud data are matched to estimate the speed and the position of the differential wheel type robot. A laser speedometer B is obtained; a plurality of groups of wheel type odometers A and laser odometers B are collected for joint calibration to obtain an optimal rotation matrix and an optimal translation matrix, so that a required relation value is obtained to complete joint calibration. The method has low requirements on calibration environment, can improve accuracy, and effectively simplifies the calibration process of the laser radar.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of laser radar calibration methods. Background Art

[0002] As an important sensor in the field of robotics, laser radar plays a vital role in positioning and navigation. Laser radar can provide rich environmental information, and wheel odometer can provide real-time and continuous robot pose estimation. The two complement each other. However, since there are only theoretical models for the installation pose of laser radar and the robot base coordinates, and due to the processing error, mechanical tolerance, assembly deviation, reducer accuracy, reducer idle travel, mass, joint flexibility, connecting rod flexibility and other dynamic factors of the robot chassis, there are inevitably certain errors between the theoretical model and the actual model. The main ones are: first, the actual installation pose of laser radar cannot be accurately consistent with the theoretical external parameters; second, the rotation center of the robot (i.e., the base coordinate system of the robot) is not necessarily located at the corresponding position of the theoretical model (usually the geometric center of the robot). The accuracy of these two directly affects the accuracy of the laser radar positioning perception results. Therefore, it is necessary to accurately calibrate the external parameters of the two to achieve multi-sensor data fusion to improve the accuracy of positioning and navigation.

[0003] Existing solutions to this problem include a lidar extrinsic parameter calibration method, device and storage medium based on point cloud registration, such as Chinese patent application No. 202311409630.X. This method collects the first point cloud and the second point cloud of the vehicle (collected from the left wheel and the right wheel respectively), uses the density clustering method to obtain the target center coordinates, and performs point cloud registration with the target center of the preset lidar coordinate system to obtain the target conversion parameters, thereby obtaining the external parameters of the lidar; although this method reduces the site and environmental requirements for lidar extrinsic parameter calibration, and does not require a four-wheel positioning system and measurement of the three-dimensional coordinates of the target center in the vehicle coordinate system, it still requires specific equipment and environment to collect point cloud data. There is also a vehicle-mounted laser radar external parameter calibration system and method such as Chinese patent application No. 202410519238.9, which includes a vehicle fixture, a first reflector, a second reflector, a reflective column, and a level, etc. The reflector and reflective column are set in front of the vehicle-mounted laser radar, and the reflector is used to reflect the radar waves emitted by the vehicle-mounted laser radar to achieve the calibration of external parameters; the system requires equipment such as vehicle fixtures, reflectors and reflective columns to set the calibration scene, which also increases the complexity of the system and the requirements for the environment. At the same time, the position and direction of the reflector and reflective column need to be accurately set to ensure accurate calibration results. It can be seen that the existing technical solutions are still highly dependent on equipment and the environment, which is not conducive to simplifying the calibration process of the laser radar. Summary of the invention

[0004] The object of the present invention is to provide a wheel odometer calibration method that can improve the accuracy of the wheel odometer. Another object of the present invention is to provide a laser radar external parameter calibration method that has low requirements on the calibration environment, can improve accuracy and effectively simplify the laser radar calibration process.

[0005] To achieve the above-mentioned purpose, the technical solution of the present invention is: a wheel odometer calibration method, wherein a position correction proportional coefficient α is calculated by a position calibration method, and a posture correction proportional coefficient β is calculated by a posture calibration method. The wheel odometer A calculates the running speed and relative displacement position of the robot through the wheel speed of the differential wheeled robot and calculates and calibrates the position correction proportional coefficient α and the posture correction proportional coefficient β.

[0006] The method for calculating and calibrating the wheel odometer A includes: assuming that the posture state of the differential wheeled robot is x=[xy θ], wherein x and y represent the spatial coordinates of the differential wheeled robot, and θ represents the angle of the differential wheeled robot. According to the motion model of the differential wheeled robot, its posture recursive equation in discrete time is:

[0007] When t = 0,

[0008] x t+1 =x t +αv t cosθ t Δt

[0009] y t+1 =y t +αv t sinθ t Δt

[0010] θ t+1 =θ t

[0011] When t ≠0 hours

[0012]

[0013]

[0014] θ t+1 =θ t +βω t Δt

[0015] Among them, v t is the speed of the robot at time t, ω tis the angular velocity of the robot at time t, Δt represents the time interval from time t to time t+1, α is the position correction proportional coefficient, β is the attitude correction proportional coefficient, and before calibration, α=β=1.0.

[0016] The position calibration method is to measure the distance deviation e between the actual stop position and the preset end point after the differential wheeled robot moves from the starting position aligned with the preset target spacing s to the end position of the target spacing s. t and the deviation ε between the distance reading of the wheel odometer A and the target distance s t , calculate the position correction proportional coefficient α, the expression is

[0017] The posture calibration method is to measure the deviation distance between the axis of the differential wheeled robot and the calibration reference line after the axis of the differential wheeled robot is aligned with the calibration reference line for multiple rotations in situ, and divide the deviation difference by the distance from the rotation center of the differential wheeled robot to the preset front mark to obtain the actual posture deviation e r The measured deviation between the odometer attitude reading and the target attitude is ε r ,but:

[0018] A laser radar external parameter calibration method, which obtains a calibrated and corrected wheel odometer A through the above-mentioned wheel odometer calibration method; obtains laser point cloud data at two adjacent moments through the laser radar of a differential wheeled robot and matches the laser point cloud data at two adjacent moments to estimate the speed and position of the differential wheeled robot, thereby obtaining a laser odometer B; collects multiple groups of wheel odometers A and laser odometers B for joint calibration, obtains the optimal rotation matrix and the optimal translation vector, and thus obtains the required external parameters to complete the joint calibration.

[0019] The method for matching the laser point cloud data at two adjacent moments is to set corresponding laser point cloud data for two adjacent frames of laser point cloud data. and Where i = 1, 2, 3, ..., N, the laser point cloud data and The centroid is removed to obtain the corresponding point cloud without the centroid, and then the point cloud is registered.

[0020] The centroid removal method is as follows: the centroids of the two frames of laser point clouds are and Then the corresponding laser point cloud without the centroid is and

[0021] The laser point cloud registration method is as follows: Perform SVD decomposition on the matrix H, that is, H = UΣV T, where U is the left singular matrix, Σ is the matrix composed of singular values, and V is the right singular matrix, then the rotation matrix R = VU T , the translation matrix

[0022] The joint calibration method is to assume that the position transformation from the base coordinate system of the differential wheeled robot to the laser radar coordinate system is X, and at time t1, the wheel odometer reading of the differential wheeled robot is P2 (1) , the laser odometer reading is P1 (1) At time t2, the robot's wheel odometer reading is P2 (2) , the laser odometer reading is P1 (2) , the wheel odometer and laser odometer at two moments have the following conversion relationship,

[0023]

[0024] Combining the above two equations, we can simplify and get AX = XB, and use the two-step method to solve:

[0025]

[0026] Where R X is the rotation matrix of the external parameter X to be determined, R A and R B are the rotations of transformation matrix A and transformation matrix B respectively, t X is the translation vector of the external parameter X to be determined, R A =exp([a] × ), R B =exp([b] × ), where a and b are R A , R B The corresponding Lie algebra can be transformed into:

[0027]

[0028] Collect multiple sets of wheel odometer A and laser odometer data B and solve the optimal rotation matrix through least squares fitting, denoted as R X * ,

[0029]

[0030] Depend on It can be seen that (R A -I)t X =R X t B -t A , multiply both sides by (R A -I) T, where I is the unit matrix, and rearrangement can solve the optimal translation vector, denoted as t X * ,

[0031] By adopting the above technical scheme, the beneficial effect of the present invention is: the above-mentioned laser radar external parameter calibration method of the present invention does not rely on calibration objects such as calibration plates, does not require cumbersome processes such as additional deployment of calibration scenes, and has low dependence on equipment and environment, that is, the calibration method of the present invention has low requirements for the calibration environment, and solves the problem of external parameter calibration of the laser radar in the differential wheeled robot base coordinate system by combining the wheel odometer and the laser odometer and adopting a two-step hand-eye calibration. Specifically, the wheel odometer is calculated by an encoder and calibrated by the above-mentioned wheel odometer calibration method, the laser odometer is calculated by point cloud registration, and the two-step hand-eye calibration is used to realize the external parameter calibration of the laser radar and the robot base coordinate system, which effectively reduces the dependence on equipment and environment, and can also improve the accuracy of parameters such as the position and posture of the laser radar in the differential wheeled robot base coordinate system. These parameters also directly affect the accuracy of the laser radar positioning perception results, and play a vital role in the robot's positioning, navigation and obstacle avoidance functions. BRIEF DESCRIPTION OF THE DRAWINGS

[0032] Figure 1 The invention discloses a principle block diagram of a laser radar external parameter calibration method.

[0033] Figure 2 The invention relates to a position calibration in a laser radar external parameter calibration method.

[0034] Figure 3 The invention relates to a posture calibration in a laser radar external parameter calibration method.

[0035] Figure 4 The invention relates to a joint calibration method in a laser radar external parameter calibration method. DETAILED DESCRIPTION

[0036] In order to further explain the technical solution of the present invention, the present invention is described in detail below through specific embodiments.

[0037] A wheel odometer calibration method of the present invention is disclosed in detail by a laser radar external parameter calibration method disclosed below in this embodiment. The principle of the laser radar external parameter calibration method is as follows: Figure 1As shown, the running speed and relative displacement position of the differential wheeled robot can be calculated by the wheel speed of the differential wheeled robot, and the wheeled odometer is recorded as A. Due to errors in processing, installation, measurement, etc., the calculated speed and position are not so accurate. The present invention calibrates and corrects the wheeled odometer A through the following calibration coefficients. Specifically, the position correction proportional coefficient α is calculated through the position calibration method, and the posture correction proportional coefficient β is calculated through the posture calibration method. The position correction proportional coefficient α and the posture correction proportional coefficient β are used to calculate and calibrate, which is described in detail below.

[0038] In addition, the laser radar of the differential wheeled robot scans the surrounding environment to obtain the laser data at the current moment. After the differential wheeled robot moves, it scans the surrounding environment again to obtain the laser data at the next moment, that is, the laser point cloud data at two adjacent moments are obtained. Then, the laser point cloud data at two adjacent moments are matched to estimate the speed and position of the differential wheeled robot, and the laser odometer is obtained and recorded as B.

[0039] Collect multiple sets of wheel odometers A and laser odometers B for joint calibration, such as the following corresponding pairs: A1-B1, A2-B2, A3-B3, A4-B4, ... to calculate the relative relationship between the laser radar and the robot base coordinate system, and obtain the optimal rotation matrix and the optimal translation matrix, so as to obtain the required external parameters to complete the joint calibration. Here is like solving an equation. For the straight line y=kx+c, given two sets of data (0,2) and (1,3), we can solve k=1 and c=2 to obtain the equation of the line, but the unknowns here are rotation and translation.

[0040] The wheel odometer A calibration method is as follows:

[0041] Motion solution, assuming that the posture state of the differential wheeled robot is x = [xy θ], where x and y represent the spatial coordinates of the differential wheeled robot, and θ represents the angle of the differential wheeled robot. According to the motion model of the differential wheeled robot, its posture recursive equation in discrete time is as follows:

[0042] When t =0 o'clock

[0043] x t+1 =x t +αv t cosθ t Δt

[0044] y t+1 =y t +αv t sinθ t Δt

[0045] θ t+1 =θt

[0046] When t ≠0 hours

[0047]

[0048]

[0049] θ t+1 =θ t +βω t Δt

[0050] Among them, v t is the speed of the robot at time t, ω t is the angular velocity of the robot at time t, Δt represents the time interval from time t to time t+1, α is the position correction proportional coefficient, β is the attitude correction proportional coefficient, and before calibration, α=β=1.0.

[0051] The position calibration method is to prepare measuring tools such as a tape measure and a marker, mark the starting point and the end point on the ground with a certain target distance denoted as s, and then control the differential wheeled robot to run to the end point through a program, such as Figure 2 As shown, the distance deviation between the measured actual position of the differential wheeled robot and the end point is recorded as e t , when the differential wheeled robot crosses the end point, it is positive, and the deviation between the distance difference of the wheel odometer A and the target distance s is recorded as ε t ,but

[0052] The posture calibration method aligns the central axis of the differential wheeled robot with the calibration reference line, and then controls the differential wheeled robot to rotate for multiple cycles through a program. In this embodiment, two cycles are taken as an example. Figure 3 As shown, the deviation distance between the center axis of the differential wheeled robot and the calibration reference line is measured, and divided by the distance from the rotation center of the differential wheeled robot to the front mark (the mark pre-made on the front of the differential wheeled robot), which is the actual posture deviation, recorded as e r When the differential wheeled robot passes the mark, the value is positive, and the deviation between the odometer attitude reading and the target attitude is recorded as ε r ,but:

[0053] The laser point cloud data matching method at two adjacent moments is as follows: The laser odometer is realized by matching the laser point cloud data at adjacent moments to estimate the motion state of the differential wheeled robot. For two adjacent frames of laser point cloud data, there are corresponding laser point cloud data. and Where i = 1, 2, 3, ..., N, the laser point cloud data and The centroid is removed to obtain the corresponding point cloud without the centroid, and then the point cloud is registered.

[0054] The centroid removal method is as follows: the centroids of the two frames of laser point clouds are and Then the corresponding laser point cloud without the centroid is and

[0055] The laser point cloud registration method is as follows: Perform SVD decomposition on the matrix H, that is, H = UΣV T , where U is the left singular matrix, Σ is the matrix composed of singular values, and V is the right singular matrix, then the rotation matrix R = VU T , the translation matrix

[0056] The joint calibration method is as follows: Since the base coordinates of the laser radar and the robot are relatively fixed (rigid connection), the posture relationship between the two is constrained by the external parameters of the laser radar installation posture in the base coordinate system. Suppose the posture transformation from the base coordinate system of the differential wheeled robot to the laser radar coordinate system is the external parameter to be determined, denoted as X, such as Figure 4 As shown, at time t1, the wheel odometer reading of the differential wheeled robot is P2 (1) , the laser odometer reading is P1 (1) At time t2, the robot's wheel odometer reading is P2 (2) , the laser odometer reading is P1 (2) , in the figure, B 12 represents the change of the laser radar's position from P1 to P2, B 23 Indicates the position change of the laser radar from P2 to P3, A 12 Indicates the position change of the laser radar from P1 to P2, A 23 Indicates the position change of the lidar from P2 to P3.

[0057] The wheel odometer and laser odometer at two moments have the following conversion relationship, namely P2 (2) It can be directly obtained by wheel odometer solution, or by laser odometer and external parameter X, as follows:

[0058]

[0059] Combining the above two equations, we can simplify and get AX = XB, and use the two-step method to solve:

[0060]

[0061] Among them, R A and R BThe rotation of transformation matrix A and transformation matrix B, R X is the rotation matrix of the external parameter X to be determined, t X is the translation vector of the external parameter X to be determined, R A =exp([a] × ), R B =exp([b] × ), where a and b are R A , R B The corresponding Lie algebra can be transformed into:

[0062]

[0063] Therefore, by collecting multiple sets of wheel odometer and laser odometer data, the optimal rotation matrix can be solved by least squares fitting, denoted as R X * ,Right now

[0064]

[0065] This form is consistent with the laser point cloud registration optimization method of the laser odometer, and SVD is still used for solution, which will not be repeated here.

[0066]

[0067] Inversely, multiply both sides by (R A -I) T , where I is the unit matrix, and rearrangement can solve the optimal translation vector, denoted as t X * ,Right now

[0068]

[0069] In summary, the calibration method of the present invention does not rely on calibration objects such as calibration plates, does not require cumbersome processes such as additional deployment of calibration scenes, has low requirements for the calibration environment, and can effectively simplify the calibration process of the lidar.

[0070] The above embodiments and drawings do not limit the product form and style of the present invention. Any appropriate changes or modifications made by ordinary technicians in the relevant technical field should be deemed to be within the patent scope of the present invention.

Claims

1. A wheel odometer calibration method, characterized in that: The position correction proportional coefficient α is calculated by the position calibration method, and the attitude correction proportional coefficient β is calculated by the attitude calibration method. The wheel odometer A calculates the robot's running speed and relative displacement position through the wheel speed of the differential wheeled robot and calculates and calibrates the position correction proportional coefficient α and the attitude correction proportional coefficient β.

2. A wheel odometer calibration method as claimed in claim 1, characterized in that: The method for calculating and calibrating the wheel odometer A includes: assuming that the posture state of the differential wheeled robot is x=[xy θ], wherein x and y represent the spatial coordinates of the differential wheeled robot, and θ represents the angle of the differential wheeled robot. According to the motion model of the differential wheeled robot, its posture recursive equation in discrete time is: When t = 0, x t+1 =x t +αv t cosθ t Δt and t+1 =and t +αv t sinθ t Δt i t+1 =θ t When t ≠0 hours i t+1 =θ t +vo t Δt Among them, v t is the speed of the robot at time t, ω t is the angular velocity of the robot at time t, Δt represents the time interval from time t to time t+1, α is the position correction proportional coefficient, β is the attitude correction proportional coefficient, and before calibration, α=β=1.

0.

3. A wheel odometer calibration method as claimed in claim 1 or 2, characterized in that: The position calibration method is to measure the distance deviation e between the actual stop position and the preset end point after the differential wheeled robot moves from the starting position aligned with the preset target spacing s to the end position of the target spacing s. t and the deviation ε between the distance difference of wheel odometer A and the target distance s t , calculate the position correction proportional coefficient α, the expression is 4. A wheel odometer calibration method as claimed in claim 1 or 2, characterized in that: The posture calibration method is to measure the deviation distance between the axis of the differential wheeled robot and the calibration reference line after the axis of the differential wheeled robot is aligned with the calibration reference line for multiple rotations in situ, and divide the deviation distance by the distance from the rotation center of the differential wheeled robot to the preset front mark to obtain the actual posture deviation e r , the odometer attitude reading is measured The deviation from the target posture is ε r ,but:

5. A wheel odometer calibration method as claimed in claim 3, characterized in that: The posture calibration method is to measure the deviation distance between the axis of the differential wheeled robot and the calibration reference line after the axis of the differential wheeled robot is aligned with the calibration reference line for multiple rotations in situ, and divide the deviation distance by the distance from the rotation center of the differential wheeled robot to the front mark to obtain the actual posture deviation e r , the measured deviation between the odometer attitude reading and the target attitude is ε r ,but:

6. A laser radar external parameter calibration method, characterized in that: A calibrated and corrected wheel odometer A is obtained by a wheel odometer calibration method as described in any one of claims 1 to 5; laser point cloud data at two adjacent moments are obtained by a laser radar of a differential wheeled robot and the speed and position of the differential wheeled robot are estimated by matching the laser point cloud data at two adjacent moments to obtain a laser odometer B; multiple groups of wheel odometers A and laser odometers B are collected for joint calibration to obtain an optimal rotation matrix and an optimal translation vector, thereby obtaining the required external parameters to complete the joint calibration.

7. A laser radar extrinsic parameter calibration method as claimed in claim 6, characterized in that: The method for matching the laser point cloud data at two adjacent moments is to set corresponding laser point cloud data for two adjacent frames of laser point cloud data. and Where i = 1, 2, 3, ..., N, the laser point cloud data and The centroid is removed to obtain the corresponding point cloud without the centroid, and then the point cloud is registered. The centroid removal method is as follows: the centroids of the two frames of laser point clouds are and Then the corresponding laser point cloud without the centroid is and The laser point cloud registration method is as follows: Perform SVD decomposition on the matrix H, that is, H = UΣV T , where U is the left singular matrix, Σ is the matrix composed of singular values, and V is the right singular matrix, then the rotation matrix R = VU T , the translation matrix 8. A laser radar extrinsic parameter calibration method as claimed in claim 7, characterized in that: The joint calibration method is to assume that the pose transformation from the base coordinate system of the differential wheeled robot to the laser radar coordinate system is X, and at time t1, the wheel odometer reading of the differential wheeled robot is The laser odometer reading is P1 (1) At time t2, the robot's wheel odometer reading is The laser odometer reading is P1 (2) , the wheel odometer and laser odometer at two moments have the following conversion relationship, Combining the above two equations, we can simplify and get AX = XB, and use the two-step method to solve: Where R X is the rotation matrix of the external parameter X to be determined, R A and R B are the rotations of transformation matrix A and transformation matrix B respectively, t X is the translation vector of the external parameter X to be determined, R A =exp([a] × ), R B =exp([b] × ), where a and b are R A , R B The corresponding Lie algebra can be transformed into: Collect multiple sets of wheel odometer A and laser odometer data B and solve the optimal rotation matrix through least squares fitting, which is recorded as Depend on It can be seen that (R A -I)t X =R X t B -t A , multiply both sides by (R A -I) T Where I is the unit matrix, and rearranging it can solve the optimal translation vector, denoted as t X * ,

Citation Information

Patent Citations

  • Differential mobile robot milemeter calibration method

    CN106289327A

  • Calibration algorithm for wheel encoder for four-wheel mobile robot

    CN109916431A

  • Parameter correction method for wheeled mobile robot

    CN111610523A

  • External parameter calibration method and apparatus for combined navigation device and laser radar

    WO2023131123A1

Cited By

  • Wheel type odometer and single-line laser radar combined calibration method

    CN119573770A

  • Non-singularity method and device for external parameter calibration of laser radar and inertial measurement unit

    CN121297901A