WO2022127532A1 - Procédé et appareil d'étalonnage de paramètre externe d'un radar laser et d'une unité de mesure inertielle, et dispositif - Google Patents
Procédé et appareil d'étalonnage de paramètre externe d'un radar laser et d'une unité de mesure inertielle, et dispositif Download PDFInfo
- Publication number
- WO2022127532A1 WO2022127532A1 PCT/CN2021/132432 CN2021132432W WO2022127532A1 WO 2022127532 A1 WO2022127532 A1 WO 2022127532A1 CN 2021132432 W CN2021132432 W CN 2021132432W WO 2022127532 A1 WO2022127532 A1 WO 2022127532A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- coordinate system
- point cloud
- cloud data
- external parameter
- imu
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 119
- 238000006243 chemical reaction Methods 0.000 claims abstract description 51
- 230000009466 transformation Effects 0.000 claims description 82
- 238000012545 processing Methods 0.000 claims description 38
- 238000005259 measurement Methods 0.000 claims description 35
- 230000008569 process Effects 0.000 claims description 24
- 238000004590 computer program Methods 0.000 claims description 23
- 230000001133 acceleration Effects 0.000 claims description 17
- 238000004891 communication Methods 0.000 claims description 17
- 238000003860 storage Methods 0.000 claims description 17
- 238000004422 calculation algorithm Methods 0.000 abstract description 27
- 238000009434 installation Methods 0.000 abstract description 7
- 238000013461 design Methods 0.000 description 39
- 238000005457 optimization Methods 0.000 description 16
- 238000010586 diagram Methods 0.000 description 15
- 238000000605 extraction Methods 0.000 description 12
- 230000006870 function Effects 0.000 description 9
- 238000013480 data collection Methods 0.000 description 6
- 238000004364 calculation method Methods 0.000 description 5
- 239000000284 extract Substances 0.000 description 4
- 230000001360 synchronised effect Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 239000002245 particle Substances 0.000 description 2
- 238000002939 conjugate gradient method Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000011478 gradient descent method Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/497—Means for monitoring or calibrating
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Definitions
- the embodiments of the present application relate to the technical field of automatic driving, and in particular, to a method, device, and device for calibrating external parameters of a lidar and an IMU.
- High-precision maps are the basis and necessary condition for realizing geographic information data for lane-level navigation and monitoring of unmanned vehicles.
- High-precision maps mainly rely on inertial measurement unit (IMU), global navigation satellite system (GNSS), lidar and other sensors for acquisition and production.
- IMU inertial measurement unit
- GNSS global navigation satellite system
- lidar lidar
- other sensors for acquisition and production.
- IMU inertial measurement unit
- GNSS global navigation satellite system
- lidar lidar
- the lidar on the acquisition vehicle is usually installed in parallel with the roof.
- the point cloud data of the common features of two adjacent frames scanned by the lidar are used, and an inter-frame matching algorithm, such as iterative nearest point (iterative closest point), is used.
- the closest point, ICP) algorithm calculates and collects the pose changes of the vehicle to obtain the trajectory of the lidar, and then combines with the integrated navigation system to give the trajectory of the IMU. Then, the least squares method can be used to complete the external parameter calibration of the lidar relative to the IMU.
- the radar in the collecting vehicle can be installed obliquely. It is mainly the features on the ground, on the sides of the vehicle and on the obliquely above the roof, and the features in front of the collected vehicle cannot be scanned, which leads to fewer features scanned between adjacent frames, resulting in a large matching error between frames, which affects the External parameter calibration accuracy.
- Embodiments of the present application provide a method, device, and device for calibrating external parameters of a lidar and an IMU, which are used to solve the problem that the inter-frame matching algorithm in the prior art is not suitable for calibrating external parameters of an obliquely installed lidar.
- an embodiment of the present application provides an external parameter calibration method for a lidar and an IMU, which is applied to a calibration device. Both the lidar and the IMU are fixedly installed on a vehicle to be calibrated, and the method includes:
- the first point cloud data collected by the lidar is used to represent the position in the lidar coordinate system of the features around the to-be-calibrated vehicle collected by the to-be-calibrated vehicle traveling on the target path ;
- the first point cloud data is converted from the lidar coordinate system to the IMU coordinate system to obtain the second point cloud data, and the external parameter value to be optimized uses for indicating a first relative transformation relationship between the lidar coordinate system and the IMU coordinate system;
- the second point cloud data is converted into the reference coordinate system to obtain third point cloud data;
- the second relative transformation relationship is based on Obtained from the position and attitude of the vehicle to be calibrated collected by the IMU when the vehicle to be calibrated travels on the target path;
- the third point cloud data determine the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the reference coordinate system or the position difference satisfies
- the current external parameter value to be optimized is used as the target external parameter value; otherwise, the external parameter value to be optimized is adjusted, and the adjusted external parameter value is used as the target external parameter value in the next adjustment.
- Optimized extrinsic parameter values are used as the target external parameter value.
- the calibration device converts the point cloud data collected by the lidar from the lidar coordinate system to the reference coordinate system, and iteratively optimizes the external parameter values to be optimized according to the point cloud data in the reference coordinate system until the current adjustment and use
- the external parameter value to be optimized makes the same feature collected by the lidar traveling to different positions in the same position in the reference coordinate system or the position difference satisfies the preset condition
- the current external parameter value to be optimized is taken as
- the target external parameter value avoids the influence of the installation angle of the lidar, which leads to the low accuracy and efficiency of the external parameter calibration result, realizes automatic external parameter calibration, and improves the external parameter calibration efficiency and accuracy.
- the first point cloud data is collected by the lidar at N first collection moments
- obtaining the second relative transformation relationship between the IMU coordinate system and the reference coordinate system includes: Acquiring measurement data collected by the IMU at M second collection moments, the measurement data including the linear acceleration and angular velocity of the vehicle to be calibrated collected by the IMU while the vehicle to be calibrated is traveling on the target path ; According to the measurement data, the second relative conversion relationships at M second collection moments are obtained respectively, and the second relative conversion relationships at the second collection moments are used to characterize the IMU coordinates at the second collection moment.
- the relative transformation relationship between the system and the reference coordinate system includes: Acquiring measurement data collected by the IMU at M second collection moments, the measurement data including the linear acceleration and angular velocity of the vehicle to be calibrated collected by the IMU while the vehicle to be calibrated is traveling on the target path ; According to the measurement data, the second relative conversion relationships at M second collection moments are obtained respectively, and the second relative conversion relationships at the second collection moments are used to characterize the IMU coordinates at the
- the calibration device obtains the relative transformation relationship between the IMU coordinate system and the reference coordinate system at M second acquisition moments respectively according to the linear acceleration and angular velocity of the calibrated vehicle collected by the IMU, which improves the accuracy of external parameter calibration.
- converting the second point cloud data to the reference coordinate system to obtain third point cloud data including: According to the second relative conversion relationships at the M second collection moments, respectively, third relative conversion relationships at the N first collection moments are obtained, and the third relative conversion relationships at the first collection moments are used to represent the The first acquisition moment, the relative transformation relationship between the IMU coordinate system and the reference coordinate system; according to the third relative transformation relationship of the i-th first acquisition moment, respectively
- the second point cloud data is converted to the reference coordinate system to obtain the i-th point cloud data at the first collection moment, and i is taken as a positive integer less than or equal to N to obtain N point cloud data at the first collection moment forming the third point cloud data.
- the calibration device can obtain the relative transformation relationship between the IMU coordinate system and the reference coordinate system at the N first acquisition moments, respectively, according to the relative transformation relationship between the IMU coordinate system and the reference coordinate system at the M second acquisition moments. , to convert the second point cloud data of N first acquisition moments from the IMU coordinate system to the reference coordinate system, improving the efficiency and accuracy of the external parameter calibration of lidar and IMU.
- the third point cloud data is used to represent the three-dimensional coordinates of X features in the reference coordinate system, and X is a positive integer;
- the external parameter value to be optimized used for the current adjustment determines the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the reference coordinate system or the position difference satisfies
- the preset conditions include: if the difference between the sum of the error parameters of the X features in the current adjustment and the sum of the error parameters of the X features in the previous adjustment is less than the first threshold, then determine the current adjustment to be used.
- the optimized external parameter value makes the same feature collected by the lidar traveling to different positions in the same position in the reference coordinate system or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is the first feature.
- the sum of variances corresponding to the coordinates of the feature in the three dimensions of the reference coordinate system respectively, and the first feature is any one of the X features.
- the external parameter value to be optimized can make the same feature collected by the lidar travel to different positions in the same position in the reference coordinate system or the position difference meets the predetermined Setting the condition can also be understood as the external parameter value to be optimized so that the same feature collected by the lidar traveling to different positions overlaps or basically overlaps in the reference coordinate system, which improves the external parameter calibration efficiency.
- the external parameter value ie the initial external parameter value
- the external parameter value is insensitive and has good convergence.
- the third point cloud data is used to represent the three-dimensional coordinates of X features in the reference coordinate system, and X is a positive integer;
- the third point cloud data determine the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the reference coordinate system or the position difference satisfies
- the preset conditions include: if the difference between the error parameters of the X features in the current adjustment and the error parameters of the X features in the previous adjustment are all smaller than the second threshold, then determine the external parameters to be optimized used in the current adjustment.
- the parameter value enables the same feature collected by the lidar to travel to different positions in the same position in the reference coordinate system or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is that the first feature is in The sum of variances corresponding to the coordinates of the three dimensions of the reference coordinate system respectively, and the first feature is any one of the X features.
- the external parameter values to be optimized can make the same feature collected by the lidar travel to different positions in the same position in the reference coordinate system or the position difference satisfies the preset conditions , improve the accuracy of external parameter calibration, and it is not sensitive to the initial external parameter value, the convergence is good, and the efficiency of external parameter calibration is improved.
- the third point cloud data is used to represent the three-dimensional coordinates of X features in the reference coordinate system, and X is a positive integer;
- the third point cloud data determine the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the reference coordinate system or the position difference satisfies
- the preset conditions include: if the difference between the sum of the error parameters of the X features in the current adjustment and the sum of the error parameters of the X features in the previous adjustment is less than the first threshold, and the current adjustment uses the to-be-optimized If the difference between the external parameter value and the external parameter value to be optimized used in the last adjustment is less than the third threshold, the external parameter value to be optimized used in the current adjustment is determined so that the lidar travels to a different location to collect The position of the same feature in the reference coordinate system is the same or the position difference satisfies the preset condition; wherein, the error parameter of the first feature is that the coordinates of the first feature in the three dimensions of the reference coordinate system correspond to The sum of the variances of , the first feature is any one of the X features.
- the external parameter value to be optimized used in the current adjustment is determined so that the lidar travels to The position of the same feature collected at different positions in the reference coordinate system is the same or the position difference satisfies a preset condition, while ensuring the calibration accuracy and calibration efficiency of external parameters.
- the third point cloud data is used to represent the three-dimensional coordinates of X features in the reference coordinate system, and X is a positive integer;
- the third point cloud data determine the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the reference coordinate system or the position difference satisfies
- the preset conditions include: if the difference between the error parameters of the X features in the current adjustment and the error parameters of the X features in the previous adjustment is less than the second threshold, and the external parameters to be optimized used in the current adjustment. The difference between the value of the external parameter to be optimized and the value of the external parameter to be optimized used in the last adjustment is smaller than the third threshold, then the value of the external parameter to be optimized used for the current adjustment is determined to make the lidar travel to different locations to collect the same feature.
- the position of the object in the reference coordinate system is the same or the position difference satisfies the preset condition; wherein, the error parameter of the first feature is the difference of the corresponding variances of the coordinates of the first feature in the three dimensions of the reference coordinate system. And, the first feature is any one of the X features.
- the external parameter values to be optimized used in the current adjustment are determined, so that the lidar travels to different locations to collect data
- the position of the same feature in the reference coordinate system is the same or the position difference satisfies the preset condition, while ensuring the calibration accuracy and calibration efficiency of external parameters.
- converting the second point cloud data to the reference coordinate system to obtain third point cloud data including: According to the second relative transformation relationship between the IMU coordinate system and the reference coordinate system, the second point cloud data is converted from the IMU coordinate system to the reference coordinate system to obtain fourth point cloud data; The compensated fourth point cloud data is used as the third point cloud data, and the fourth point cloud data after motion compensation is based on all data collected by the IMU when the vehicle to be calibrated travels on the target path. The motion compensation for the position, attitude and speed of the vehicle to be calibrated is described.
- motion compensation is performed on the point cloud data to eliminate the motion error caused by the motion of the vehicle body and improve the accuracy of external parameter calibration.
- an embodiment of the present application provides a method for calibrating external parameters of a laser radar and an IMU, which is applied to a calibration device. Both the laser radar and the IMU are fixedly installed on a vehicle to be calibrated.
- the method includes:
- the first point cloud data collected by the lidar is used to represent the position in the lidar coordinate system of the features around the to-be-calibrated vehicle collected by the to-be-calibrated vehicle traveling on the target path ;
- the first point cloud data is converted from the lidar coordinate system to the IMU coordinate system to obtain the second point cloud data, and the external parameter value to be optimized uses for indicating a first relative transformation relationship between the lidar coordinate system and the IMU coordinate system;
- the second point cloud data determine the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the IMU coordinate system or the position difference satisfies
- the current external parameter value to be optimized is used as the target external parameter value; otherwise, the external parameter value to be optimized is adjusted, and the adjusted external parameter value is used as the target external parameter value in the next adjustment.
- Optimized extrinsic parameter values are used as the target external parameter value.
- the calibration device can convert the point cloud data from the lidar coordinate system to the IMU coordinate system after acquiring the point cloud data collected by the lidar, and directly according to the point cloud data in the IMU coordinate system, the external parameters to be optimized Iteratively adjust the value until the external parameter value to be optimized used in the current adjustment can make the same feature collected by the lidar traveling to different positions overlap or partially overlap in the IMU coordinate system, so as to avoid the external parameter calibration result being affected by the lidar.
- the influence of the installation angle improves the efficiency and accuracy of the external parameter calibration of the lidar.
- the second point cloud data is used to represent the three-dimensional coordinates of X features in the IMU coordinate system, and X is a positive integer;
- the preset conditions include: if the difference between the sum of the error parameters of the X features in the current adjustment and the sum of the error parameters of the X features in the previous adjustment is less than the first threshold, then determine the current adjustment to be used.
- the optimized external parameter value enables the same feature collected by the lidar to travel to different positions in the same position in the IMU coordinate system or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is the first The sum of variances corresponding to the coordinates of the feature in the three dimensions of the IMU coordinate system respectively, and the first feature is any one of the X features.
- the external parameter value to be optimized can make the same feature collected by the lidar travel to different positions in the same position in the reference coordinate system or the position difference meets the predetermined Set conditions to improve the efficiency of external parameter calibration.
- the second point cloud data is used to represent the three-dimensional coordinates of X features in the IMU coordinate system, and X is a positive integer;
- the second point cloud data determine the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the IMU coordinate system or the position difference satisfies
- the preset conditions include: if the difference between the error parameters of the X features in the current adjustment and the error parameters of the X features in the previous adjustment are all smaller than the second threshold, then determine the external parameters to be optimized used in the current adjustment.
- the parameter value enables the same feature collected by the lidar to travel to different positions in the same position in the IMU coordinate system or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is that the first feature is at The sum of variances corresponding to the coordinates of the three dimensions of the IMU coordinate system respectively, and the first feature is any one of the X features.
- the external parameter values to be optimized can make the same feature collected by the lidar travel to different positions in the same position in the reference coordinate system or the position difference satisfies the preset conditions , to improve the accuracy of external parameter calibration.
- the second point cloud data is used to represent the three-dimensional coordinates of X features in the IMU coordinate system, and X is a positive integer;
- the preset conditions include: if the difference between the sum of the error parameters of the X features in the current adjustment and the sum of the error parameters of the X features in the previous adjustment is less than the first threshold, and the current adjustment uses the to-be-optimized If the difference between the external parameter value and the external parameter value to be optimized used in the last adjustment is less than the third threshold, the external parameter value to be optimized used in the current adjustment is determined so that the lidar travels to a different location to collect The position of the same feature in the IMU coordinate system is the same or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is that the coordinates of the first feature in the three dimensions of the IMU coordinate system correspond to The sum of the variances of , the first feature is any one of the X features.
- the external parameter values to be optimized used in the current adjustment are determined, so that the lidar travels to different
- the position of the same feature collected from the position is the same in the reference coordinate system or the position difference satisfies a preset condition, while ensuring the calibration accuracy and calibration efficiency of external parameters.
- the second point cloud data is used to represent the three-dimensional coordinates of X features in the IMU coordinate system, and X is a positive integer;
- the second point cloud data determine the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the IMU coordinate system or the position difference satisfies
- the preset conditions include: if the difference between the error parameters of the X features in the current adjustment and the error parameters of the X features in the previous adjustment is less than the second threshold, and the external parameters to be optimized used in the current adjustment. The difference between the value of the external parameter to be optimized and the value of the external parameter to be optimized used in the last adjustment is smaller than the third threshold, then the value of the external parameter to be optimized used for the current adjustment is determined to make the lidar travel to different locations to collect the same feature.
- the position of the object in the IMU coordinate system is the same or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is the difference between the corresponding variances of the coordinates of the first feature in the three dimensions of the IMU coordinate system. And, the first feature is any one of the X features.
- the external parameter values to be optimized used in the current adjustment are determined, so that the lidar travels to different locations to collect data
- the position of the same feature in the reference coordinate system is the same or the position difference satisfies the preset condition, while ensuring the calibration accuracy and calibration efficiency of external parameters.
- an embodiment of the present application provides a method for calibrating external parameters of a laser radar and an IMU, which is applied to a calibration device. Both the laser radar and the IMU are fixedly installed on a vehicle to be calibrated.
- the method includes: acquiring first point cloud data collected by a lidar, where the first point cloud data is used to represent the presence of features around the vehicle to be calibrated collected by the vehicle to be calibrated while driving on a target path in the lidar.
- the position in the coordinate system; in the current adjustment, according to the external parameter value to be optimized, and according to the second relative transformation relationship between the IMU coordinate system and the reference coordinate system, the fourth relative transformation between the lidar coordinate system and the reference coordinate system is obtained.
- the external parameter value to be optimized is used to indicate the first relative transformation relationship between the lidar coordinate system and the IMU coordinate system, and the second relative transformation relationship between the IMU coordinate system and the reference coordinate system is Obtained according to the position and attitude of the to-be-calibrated vehicle collected by the IMU when the to-be-calibrated vehicle is traveling on the target path; based on the fourth relative transformation between the lidar coordinate system and the reference coordinate system relationship, convert the first point cloud data from the lidar coordinate system to the reference coordinate system to obtain second point cloud data; according to the second point cloud data, determine the external adjustment to be optimized for the current adjustment.
- the current external parameter value to be optimized is used as the target external parameter. value, otherwise, adjust the external parameter value to be optimized, and use the adjusted external parameter value as the external parameter value to be optimized in the next adjustment.
- the calibration device can directly convert the point cloud data from the lidar coordinate system to the reference coordinate system after acquiring the point cloud data collected by the lidar, and according to the point cloud data in the reference coordinate system, the external parameters to be optimized Iteratively adjust the value until the external parameter value to be optimized used in the current adjustment can make the same feature collected by the lidar traveling to different positions overlap or partially overlap in the IMU coordinate system, so as to avoid the external parameter calibration result being affected by the lidar.
- the influence of the installation angle improves the efficiency and accuracy of the external parameter calibration of the lidar.
- an embodiment of the present application provides an external parameter calibration method for a lidar and an IMU, and the method can be performed by a calibration device or a chip or a chip system in the calibration device, so as to realize the first aspect, the second aspect or the The method in any possible implementation manner performed by the calibration apparatus in the third aspect.
- the present application provides an external parameter calibration device for a lidar and an IMU, the calibration device including a module/unit for performing the method in any of the possible implementations of the first aspect, the second aspect or the third aspect .
- These modules/units can be implemented by hardware or by executing corresponding software by hardware.
- the present application provides a calibration device, comprising a processor and a memory, wherein the memory is used to store one or more computer programs; when the one or more computer programs stored in the memory are executed by the processor, the calibration is performed.
- the apparatus can implement the method in any possible implementation manner of the first aspect, the second aspect or the third aspect.
- the present application provides a computer program that, when the computer program runs on a computer, causes the computer to execute the method in any of the possible implementations of the first aspect, the second aspect or the third aspect. .
- the present application provides a computer-readable storage medium, where a computer program is stored in the computer-readable storage medium, and when the computer program is executed by a computer, the computer is made to execute the above-mentioned first aspect, second A method in any of the possible implementations of the aspect or the third aspect.
- the present application provides a chip, which is used to read a computer program stored in a memory and execute the method in any of the possible implementation manners of the first aspect, the second aspect or the third aspect.
- an embodiment of the present application further provides a chip system, where the chip system includes a processor for supporting a computer device to implement the method in any of the possible implementation manners of the first aspect, the second aspect, or the third aspect. .
- the chip system further includes a memory for storing necessary programs and data of the computer device.
- the chip system can be composed of chips, and can also include chips and other discrete devices.
- FIG. 1 is a schematic diagram of a possible calibration scenario provided in an embodiment of the present application.
- FIG. 2 is a schematic diagram of a possible position between a lidar and a collection vehicle provided in an embodiment of the present application
- 3A is a schematic diagram of a possible calibration site provided in an embodiment of the present application.
- 3B is a schematic diagram of another possible calibration site provided in the embodiment of the present application.
- FIG. 4 is a schematic diagram of a possible collection route provided in the embodiment of the present application.
- FIG. 5 is a schematic flowchart of a first possible external parameter calibration method for a lidar and an IMU provided in an embodiment of the application;
- FIG. 6 is a schematic flowchart of a possible external parameter calibration method for a lidar and an IMU provided in an embodiment of the present application;
- FIG. 7 is a schematic flowchart of another possible external parameter calibration method for a lidar and an IMU provided in an embodiment of the present application;
- FIG. 8 is a schematic flowchart of a second possible external parameter calibration method for a lidar and an IMU provided in an embodiment of the present application
- FIG. 9 is a schematic flowchart of a third possible external parameter calibration method for a lidar and an IMU provided in an embodiment of the present application.
- FIG. 10 is a schematic structural diagram of a possible calibration device provided in an embodiment of the application.
- FIG. 11 is a schematic structural diagram of another possible calibration device provided in the embodiment of the present application.
- the public coordinate system also known as the world coordinate system or the global coordinate system, whose coordinate origin is a fixed point in space.
- the common coordinate system is an absolute coordinate system, and all objects in the space can use the common coordinate system as a reference to determine the position of the object.
- the common coordinate system may be a world coordinate system with east, north, and sky as the X-axis, Y-axis, and Z-axis.
- the parameters that affect the performance of lidar are divided into two types: internal parameters and external parameters.
- the internal parameters are determined when the lidar is manufactured, and the internal parameters may include, but are not limited to, the horizontal and vertical angles of each laser beam and the distance correction value.
- the external parameters refer to the offset distance and offset angle of the lidar relative to the IMU.
- the offset distance of the lidar relative to the IMU means that the lidar is regarded as a particle, and the coordinates (x, y, z) of the particle in the IMU coordinate system O-x1y1z1 can indicate the relative distance of the lidar to the IMU.
- the lidar coordinate system O-x2y2z2 is established with the center of mass of the lidar as the origin. It is assumed that the lidar coordinate system O-x2y2z2 is rotated around the x2 axis, y2 axis and z2 axis respectively.
- ⁇ 1, ⁇ 2 and ⁇ 3 can be regarded as the offset angle of the lidar relative to the IMU.
- FIG. 1 is a schematic diagram of a possible calibration scenario provided in an embodiment of the application, including a collection vehicle (the collection vehicle may also be referred to as a vehicle to be calibrated), a lidar, and an IMU. Both the lidar and the IMU are fixedly installed on the collection vehicle.
- the lidar In the process of collecting vehicles traveling according to the collecting route, the lidar can obtain the point cloud data of the features around the collecting route, and the IMU can obtain the linear acceleration and angular velocity of the collecting vehicle.
- the acquisition vehicle further includes a global navigation satellite system (GNSS), and the GNSS is used to realize clock synchronization between the lidar and the IMU, and to provide the three-dimensional position of the acquisition vehicle in a common coordinate system.
- GNSS global navigation satellite system
- FIG. 2 is a schematic diagram of a possible position between the lidar and the collection vehicle provided in the embodiment of the application.
- the inclination angle between the lidar and the collection vehicle is a set angle.
- the lidar is installed obliquely in the The vehicle is collected, that is, the inclination angle is the first set angle, for example, the first set angle may be 32°.
- the lidar can also be installed in parallel with the acquisition vehicle, that is, the inclination angle is the second set angle, for example, the second set angle can be 1°.
- Calibration site requirements refer to Figure 3A and Figure 3B, take the satellite navigation antenna set on the top of the acquisition vehicle as the center, and use the radius R meters, the elevation angle is more than ⁇ degrees, and the site without obstructions is used as the calibration site. For example, taking the satellite navigation antenna set on the top of the vehicle as the center, a site with a radius of 20 meters, an elevation angle of more than 45 degrees, and no obstructions is used as the calibration site.
- the number of satellites received by the satellite navigation receiving device is greater than 30, and the positioning accuracy attenuation factor (PDOP) value is less than 1.5, so as to ensure that the acquired position of the collecting vehicle in the public coordinate system is more accurate and the measurement accuracy is improved.
- the satellite navigation antenna and the satellite navigation receiving device are both devices in the GNSS.
- features include plane features and high-altitude features.
- the plane feature may be a flat ground with a set area.
- the plane feature is 1 square of ground, and the 1 square of ground is relatively flat and free of upslopes and potholes.
- the high-altitude feature is an object whose height from the ground reaches the set height.
- the high-altitude feature can be the lamp head of a street lamp that is 3 meters above the ground.
- the high-altitude feature can be a sign that is 3 meters above the ground.
- the collection vehicle can pass the same feature in the forward and reverse directions during the driving process.
- the laser radar can scan the feature multiple times during the driving process of the collection vehicle.
- the acquisition route may also be referred to as the target route.
- Figure 4 includes two features, the ground and the lamp cap of the street lamp. L1, L2, L3, and L4 are different driving routes.
- the collection route of the collection vehicle can be A ⁇ L1 ⁇ B ⁇ L2 ⁇ C ⁇ A ⁇ L3 ⁇ B ⁇ L4 ⁇ C ⁇ L4 ⁇ B ⁇ L3 ⁇ A ⁇ C ⁇ L2 ⁇ B ⁇ L1 ⁇ A.
- the traveling speed of the collecting vehicle is less than the set threshold, for example, the traveling speed of the collecting vehicle is less than 10km/h.
- the lidar collects the point cloud data of the characteristic objects, and the IMU obtains the linear acceleration and angular velocity of the collection vehicle.
- the calibration device can convert the point cloud data collected by the lidar to the IMU coordinate system according to the external parameter values to be optimized; according to the linear acceleration and angular velocity of the collected vehicle collected by the IMU, the IMU coordinate system and reference The relative transformation relationship between the coordinate systems; according to the relative transformation relationship between the IMU coordinate system and the reference coordinate system, the point cloud data is converted from the IMU coordinate system to the reference coordinate system; according to the point cloud data of the reference coordinate system, it is optimized The extrinsic parameter value is adjusted to obtain the target extrinsic parameter value.
- the external parameter values to be optimized are optimized and adjusted based on the point cloud data in the reference coordinate system, so as to realize automatic calibration and improve the efficiency of external parameter calibration.
- FIG. 5 is a possible external parameter calibration method for a lidar and an IMU provided in an embodiment of the present application.
- the method can be performed by a calibration device or by a chip or a chip system in the calibration device.
- the execution subject of S501-S504 is taken as an example of the calibration device.
- the calibration device acquires first point cloud data collected by the lidar, where the first point cloud data is used to represent the position in the lidar coordinate system of the feature collected by the collecting vehicle traveling on the target path.
- the lidar coordinate system is simply referred to as a radar coordinate system.
- the first point cloud data includes N frames of point cloud data collected by lidar at N collection moments.
- the first point cloud data may be obtained according to the lidar data collected by the lidar in the data collection stage, where the lidar data includes any one or more of the reflection intensity, scanning angle, and scanning direction of the lidar.
- the lidar collects the lidar data.
- the calibration device can analyze the lidar data according to the internal parameters, and obtain the first point cloud data collected by the lidar.
- the first point cloud data may be stored in a point cloud data (point cloud data, PCD) format.
- the collected lidar data may be stored in the storage area.
- the calibration device can acquire lidar data from the storage area.
- the calibration device converts the first point cloud data from the lidar coordinate system to the IMU coordinate system according to the external parameter value to be optimized, and obtains the second point cloud data, and the external parameter value to be optimized is used for A first relative transformation relationship between the lidar coordinate system and the IMU coordinate system is indicated.
- the external parameter value to be optimized in the first adjustment can also be called the initial external parameter value.
- the initial external parameter value includes the offset distance between the radar coordinate system and the IMU coordinate system, and ⁇ or, the radar coordinate system and the IMU coordinate Offset angle between systems.
- the initial extrinsic parameter values can be estimated according to the installation positions of the IMU and lidar in the acquisition vehicle.
- the calibration device can perform rectangular coordinate transformation on the first point cloud data according to the initial external parameter value, and convert the first point cloud data from the radar coordinate system to the IMU coordinate system.
- the calibration device performs displacement transformation on the first point cloud data according to the offset distance included in the initial external parameter value, and performs rotation axis transformation on the first point cloud data according to the offset angle included in the initial external parameter value. , to obtain the second point cloud data in the IMU coordinate system.
- the calibration device converts the second point cloud data to the reference coordinate system to obtain third point cloud data according to the second relative transformation relationship between the IMU coordinate system and the reference coordinate system, and the relative transformation relationship between the IMU coordinate system and the reference coordinate system is based on It is obtained by collecting the position and attitude of the collecting vehicle collected by the IMU during the process of collecting the vehicle traveling on the target path.
- the second relative transformation relationship between the IMU coordinate system and the reference coordinate system may be obtained by the calibration device in the following manner: the calibration device obtains the measurement data collected by the IMU at M second collection moments, and the measurement data includes the collection of the vehicle traveling on the target path. The linear acceleration and angular velocity of the collection vehicle collected by the IMU during the process of collecting the ; The relative transformation relationship between the IMU coordinate system and the reference coordinate system at the time of acquisition.
- the calibration device obtains third relative conversion relationships at N first collection moments respectively according to the second relative conversion relationships at the M second collection moments, respectively, and the third relative conversion relationships at the first collection moments are used to represent the first
- the relative transformation relationship between the IMU coordinate system and the reference coordinate system at the acquisition moment according to the third relative transformation relationship at the i-th first acquisition moment, the second point cloud data at the i-th first acquisition moment are respectively converted to
- the point cloud data of the i-th first collection moment is obtained, and i is taken as a positive integer less than or equal to N, so as to obtain N point cloud data of the first collection moment to form the third point cloud data.
- the calibration device obtains the third relative conversion relationship at the N first collection moments according to the second relative conversion relationships at the M second collection moments, respectively.
- the single frame of point cloud data is any frame of point cloud data in the second point cloud data.
- the third relative conversion relationship at the time of collection of the single frame of point cloud data is to obtain the relative conversion relationship between the IMU coordinate system and the reference coordinate system at the time of collection of the single frame of point cloud data.
- the calibration device can use an interpolation algorithm to obtain The third relative conversion relationship at the acquisition moment of the single frame of point cloud data.
- the interpolation algorithm may adopt any one of linear interpolation algorithm, parabolic interpolation algorithm, Lagrangian interpolation algorithm, and Newton interpolation algorithm.
- the interpolation algorithm can be selected according to one or more of the severity of changes in the motion of the collected vehicle, the set interpolation accuracy, and the set real-time calculation requirements.
- the reference coordinate system may refer to a common coordinate system.
- the reference coordinate system is the common coordinate system
- the method of determining the second relative transformation relationship between the IMU coordinate system and the common coordinate system refer to Embodiment 1 for details.
- the reference coordinate system may also refer to a local coordinate system, and the local coordinate system includes a radar coordinate system at a fixed time, an IMU coordinate system at a fixed time, or a custom coordinate system, for example, 0 seconds (s)
- the radar coordinate system at the moment for another example, the IMU coordinate system at the 0s moment.
- the reference coordinate system is a local coordinate system, for the method of determining the second relative transformation relationship between the IMU coordinate system and the local coordinate system, refer to Embodiment 2 for details.
- the acquisition moment may be represented by GNSS time.
- the IMU and LiDAR Before collecting data from the vehicle, the IMU and LiDAR can be clocked through GNSS.
- the GNSS can input the GNSS second pulse signal and the global positioning system (GPS) information (GPRMC) data frame with the recommended minimum data amount to the corresponding data interface of the lidar, and the lidar receives the GNSS second pulse signal. Then, calibrate the lidar clock according to the standard time contained in the GPRMC data frame. After the time synchronization between the IMU and the lidar is completed, both the IMU and the lidar can convert the time of data collection into GNSS time.
- GPS global positioning system
- the calibration device determines, according to the third point cloud data, the external parameter values to be optimized for the current adjustment, so that the same feature collected by the lidar travels to different positions in the same position in the reference coordinate system or the position difference satisfies the preset condition, take the current external parameter value to be optimized as the target external parameter value, otherwise, adjust the external parameter value to be optimized, and use the adjusted external parameter value as the external parameter value to be optimized in the next adjustment .
- the third point cloud data is used to represent the three-dimensional coordinates of the X features in the reference coordinate system, where X is a positive integer.
- the calibration device directly determines the external parameter value to be optimized for the current adjustment according to the third point cloud data, so that the same feature collected by the lidar travels to different positions in the same position in the reference coordinate system or the position difference satisfies the preset condition.
- take the current external parameter value to be optimized as the target external parameter value otherwise, adjust the external parameter value to be optimized, and use the adjusted external parameter value as the external parameter value to be optimized in the next adjustment.
- the third point cloud data can also be extracted with features. Further, the calibration device determines the external parameter value to be optimized for the current adjustment according to the extracted feature point cloud set of each feature, so that the lidar travels to different positions to collect the position of the same feature in the reference coordinate system. When the same or the position difference meets the preset conditions, the current external parameter value to be optimized is used as the target external parameter value, otherwise, the external parameter value to be optimized is adjusted, and the adjusted external parameter value is used as the next adjustment. The external parameter value to be optimized.
- the calibration device extracts X feature point cloud sets from the third point cloud data according to the X reference coordinate ranges, and the X reference coordinate ranges are X feature objects.
- the calibration device first performs point cloud splicing on the third point cloud data in the reference coordinate system, and then performs feature extraction.
- the calibration device performs point cloud splicing on the N frames of point cloud data included in the third point cloud data under the reference coordinate system to obtain the spliced third point cloud data; Feature extraction to obtain feature point cloud sets of X features.
- point cloud stitching refers to the process of unifying the data collected at different angles and different time points into the same coordinate system.
- the third point cloud data includes point cloud data 1, point cloud data 2 and point cloud data 3.
- the calibration device performs point cloud splicing on point cloud data 1, point cloud data 2 and point cloud data 3, the spliced point cloud data is obtained.
- the calibration site includes feature A, and according to the reference coordinate range of feature A, the feature point cloud set of feature A is extracted from the third point cloud data after splicing.
- the calibration device first performs feature extraction on the third point cloud data in the reference coordinate system, and then performs point cloud splicing.
- the calibration device performs feature extraction on N frames of point cloud data contained in the third point cloud data under the reference coordinate system, respectively, to obtain each frame of feature data of X features;
- the corresponding N frames of feature data are point cloud spliced to obtain the third point cloud data after splicing.
- the calibration device can perform feature extraction for a single frame of point cloud data according to the reference coordinate range of each feature, and the measurement accuracy of the reference coordinate range can be meter level.
- the calibration site contains feature A
- the calibration device extracts the point cloud data within the reference coordinate range of feature A from point cloud data 1 in the reference coordinate system according to the reference coordinate range of feature A, as the feature object A frame of feature point cloud of A.
- the feature extraction method in the single frame of point cloud data is used to extract the features of the N frames of point cloud data contained in the third point cloud data, and the feature point cloud of N frames of feature A can be obtained.
- the feature point cloud set of feature A can be obtained.
- the calibration device can determine the external parameter value to be optimized used in the current adjustment through, but not limited to, the following two possible implementation manners, so that the same feature collected by the lidar travels to different positions in the reference coordinate system.
- the position is the same or the position difference meets the preset conditions:
- the first possible implementation when the calibration device determines that the first iteration stop condition is satisfied, it determines the external parameter value to be optimized used in the current adjustment, so that the same feature collected by the lidar travels to different positions in the reference coordinate system. The position is the same or the position difference meets the preset condition.
- the calibration device adopts an iterative optimization algorithm according to the extracted feature point cloud sets of each feature to adjust the external parameter values to be optimized until the first iteration stop condition is satisfied, and determines the to-be-optimized value used for the current adjustment.
- the extrinsic parameter value of makes the position of the same feature collected by the lidar traveling to different positions in the reference coordinate system is the same or the position difference satisfies the preset condition.
- the iterative optimization algorithm may adopt, but is not limited to, any of the Gauss-Newton method, the conjugate gradient method, the gradient descent method, and the like.
- the error parameter is used as the objective function, and the external parameter value to be optimized is used as the optimization variable.
- the calibration device can calculate and obtain the error parameters of each feature according to the feature point cloud set of each feature. Among them, the error parameter of a feature is used to represent the sum of variances corresponding to the coordinates of a feature in the three dimensions of the reference coordinate system.
- the first iteration stop condition may be, but not limited to, any one of the fixed number of iterations method, the fixed time method, and the pre- and post-difference method.
- the fixed cycle number method means that the iteration stops when the number of iterations reaches the threshold of the number of iterations.
- the fixed time method means that the iteration stops when the iteration duration reaches the duration threshold.
- the stopping condition of the first iteration may be that the difference between the error parameters of the X features in the current iteration and the error parameters of the X features in the previous iteration is smaller than the second threshold.
- the calibration device adopts an iterative optimization algorithm.
- the statistical value of feature A is calculated in the reference coordinate system O-xyz.
- the variance of the feature point cloud set on the x-axis is 1, the variance on the y-axis is 2, and the variance on the z-axis is 3.
- variance 1 variance 2 and variance 3 obtained by statistics, the feature point cloud set of feature A is obtained.
- the sum of the variances on each axis of the reference coordinate system, that is, the error parameter of the feature A is obtained.
- the calibration device is in the reference coordinate system O-xyz, and the variance of the feature point cloud set of the feature B on the x-axis is calculated 4 , variance 5 on the y-axis, variance 6 on the z-axis, according to the variance 4, variance 5 and variance 6 obtained by statistics, get the variance of the feature point cloud set of feature B on each axis of the reference coordinate system
- the sum, that is, the error parameter of the feature B is obtained.
- the first iteration stop condition may also be that the difference between the sum of the error parameters of the X features in the current iteration and the sum of the error parameters of the X features in the previous iteration is less than the first threshold.
- the calibration device adopts an iterative optimization algorithm.
- the feature point cloud set of feature A is counted in the reference coordinate system O-xyz.
- the variance on the x-axis is 1
- the variance on the y-axis is 2
- the variance on the z-axis is 3.
- the sum of the variances of the feature point cloud set of the feature A on each axis of the reference coordinate system is obtained, that is, the feature is obtained.
- the error parameter of object A in the reference coordinate system O-xyz, count the variance 4 on the x-axis, the variance 5 on the y-axis, and the variance 6 on the z-axis of the feature point cloud set of feature B to obtain the feature.
- the sum of the variances of the feature point cloud set of object B in each axis of the reference coordinate system, that is, the error parameter of feature B is obtained.
- the calibration device adds the error parameter of feature A and the error parameter of feature B. And, the sum of the error parameters of feature A and feature B is obtained.
- the iteration is stopped, and the adjusted extrinsic parameter value is output.
- the external parameter value to be optimized is adjusted according to the set step size.
- the set step size includes the step size of the offset distance and the step size of the offset angle.
- the step size of the offset distance can be 0.1cm, and for example, the step size of the offset angle can be 0.01°.
- the calibration device determines that the first iterative stop condition and the second iterative stop condition are satisfied, it determines the external parameter value to be optimized used in the current adjustment so that the lidar travels to different locations to collect the same feature
- the position of the object in the reference coordinate system is the same or the position difference meets the preset condition.
- the second iterative stop condition may also adopt, but is not limited to, any one of the fixed number of iterations method, the fixed time method, and the pre- and post-difference method.
- the difference method is used.
- third threshold is used.
- the third threshold includes a distance threshold and an angle threshold
- the calibration device judges whether the difference in the offset distance between the external parameter value used in the current adjustment and the external parameter value to be optimized used in the previous adjustment is less than the distance threshold. , and determine whether the difference in the offset angle between the external parameter value to be optimized used in the current adjustment and the external parameter value to be optimized used in the previous adjustment is smaller than the angle threshold.
- the extrinsic parameter value to be optimized used in the current adjustment is less than the distance threshold, and the extrinsic parameter value to be optimized used in the current adjustment is equal to If the offset angle between the extrinsic parameter values to be optimized used in the last adjustment is smaller than the angle threshold, the extrinsic parameter value to be optimized used in the current adjustment is used as the target extrinsic parameter value.
- the calibration device can also use the position, attitude and speed of the collected vehicle collected by the IMU to determine the first point cloud data.
- Motion compensation is performed on point cloud data, second point cloud data or third point cloud data. Motion compensation is a method of describing the difference between adjacent frames to eliminate the influence of motion caused by any of the velocity, linear acceleration, or angular velocity of the acquisition vehicle.
- Embodiment 1 Take the reference coordinate system as the common coordinate system as an example.
- FIG. 6 is a possible external parameter calibration method for a lidar and an IMU provided in an embodiment of the present application.
- the method may be performed by a calibration device, or may be performed by a chip or a chip system in the calibration device.
- the calibration device acquires the measurement data collected by the IMU, and obtains a set of pose information of the IMU in the public coordinate system according to the measurement data collected by the IMU, where the pose information includes one or more of three-dimensional position, three-dimensional velocity, and three-dimensional attitude angle Item, hereinafter the three-dimensional position, three-dimensional velocity, and three-dimensional attitude angle are simply referred to as position, velocity, and attitude angle.
- the pose information of the IMU in the common coordinate system is used to describe the relative transformation relationship between the IMU coordinate system and the common coordinate system.
- the pose information set includes pose information collected by the IMU at M collection moments.
- the measurement information collected by the IMU includes linear acceleration and angular velocity.
- the IMU can collect the linear acceleration and angular velocity of the collecting vehicle at N collection times.
- the measurement information may be stored in a storage area, for example, the storage area may be a hard disk, a portable notebook, etc. configured in the collection vehicle.
- the calibration device can obtain the measurement information collected by the stored IMU from the storage area.
- an inertial navigation system may be configured in the acquisition vehicle, and the INS includes an IMU.
- the calibration device obtains the measurement information of the IMU, it performs inertial navigation calculation on the measurement information collected by the IMU through the inertial navigation system (INS), and obtains the INS navigation information.
- the INS navigation information includes the acquisition vehicle in the IMU coordinate system. One or more of the three-dimensional position, three-dimensional velocity, and three-dimensional attitude angle of .
- the acquisition vehicle is also equipped with GNSS. During the process of the acquisition vehicle driving on the acquisition route, GNSS can collect GNSS measurement information.
- the GNSS measurement information includes the 3D position, 3D velocity, and 3D attitude angle of the collected vehicle in the public coordinate system. one or more.
- the calibration device adopts inertial navigation algorithm and fusion filtering algorithm to fuse INS navigation information and GNSS measurement information, and can obtain the pose information set of IMU in the public coordinate system.
- the calibration device acquires point cloud data collected by the lidar.
- the point cloud data collected by the lidar includes N frames of point cloud data collected by the lidar at N collection moments.
- the calibration device converts the point cloud data from the radar coordinate system to the IMU coordinate system according to the Mth group of external parameter values, and obtains point cloud data in the IMU coordinate system.
- M is a natural number.
- the 0th group of extrinsic parameter values can also be called initial extrinsic parameter values, and the initial extrinsic parameter values include the offset distance and offset angle between the radar coordinate system and the IMU coordinate system.
- the calibration device projects the point cloud data in the IMU coordinate system to the public coordinate system according to the pose information corresponding to the point cloud data collection time, and obtains the point cloud data in the public coordinate system.
- the single frame of point cloud data is any frame of point cloud data in the point cloud data in the IMU coordinate system.
- the collection moment of a single frame of point cloud data is the same as the collection moment of a piece of pose information in the pose information set.
- the calibration device can determine that the pose information corresponding to the collection moment of the single frame of point cloud data is the above one pose information.
- the collection moment of a single frame of point cloud data is different from the collection moment of the pose information in the pose information set.
- the calibration device can use an interpolation algorithm to calculate the corresponding pose information when the collection time is the collection time of a single frame of point cloud data, as the target pose information. pose information. Further, the calibration device projects the single frame of point cloud data in the IMU coordinate system to the common coordinate system according to the target pose information. For example, the GNSS time of a single frame of point cloud data is the 15th second, the GNSS time of the pose information 1 is the 14th second, and the GNSS time of the pose information 2 is the 16th second. Using the linear interpolation algorithm, the GNSS time of the 15th second is calculated.
- the pose information is the average value of the pose information 1 and the pose information 2, which is used as the target pose information.
- the calibration device will correct the point cloud data according to the pose information and/or the measurement data of the IMU. Motion compensation is performed on point cloud data in a common coordinate system.
- the calibration device extracts feature objects from the point cloud data in the public coordinate system, and obtains a feature point cloud set of each feature object.
- the calibration device adopts an iterative optimization algorithm to iteratively optimize the Mth group of external parameter values until the first iteration stop condition is satisfied, and obtains the M+1th group of external parameter values, see S504 for details.
- the error parameter is used as the objective function
- the Mth group of external parameter values is used as the optimization variable.
- the calibration device can calculate and obtain the error parameters of each feature according to the feature point cloud set of each feature.
- the first iteration stop condition may be that the difference between the error parameter of each feature in the current iteration and the error parameter of each feature in the previous iteration is smaller than the first error. threshold.
- the calibration device judges whether the second iteration stop condition is satisfied, if yes, executes S609, otherwise, executes S608.
- the calibration device judges whether the difference between the offset distances between the M+1 group of extrinsic parameter values and the M-th group of extrinsic parameter values is smaller than the distance threshold, and determines whether the M-th Whether the difference in the offset angle between the +1 group of extrinsic parameter values and the Mth group of extrinsic parameter values is less than the angle threshold.
- the calibration device replaces the Mth group of external parameter values with the M+1th group of external parameter values, and executes S603.
- the calibration device uses the Mth group of external parameter values as the target external parameter values.
- Embodiment 2 Take the reference coordinate system as the local coordinate system as an example.
- FIG. 7 is a possible external parameter calibration method for a lidar and an IMU provided in an embodiment of the present application. The method may be performed by a calibration device, or may be performed by a chip or a chip system in the calibration device. In the following, the execution subject of S701-S709 is taken as an example of the calibration device.
- the calibration device obtains the measurement data collected by the IMU, and obtains the relative transformation relationship between the IMU coordinate system and the local coordinate system at the M collection moments according to the measurement data collected by the IMU.
- the local coordinate system is the IMU coordinate system at a fixed time
- the IMU coordinate system at the fixed time is the IMU coordinate system at the 0s time.
- the measurement information collected by the IMU includes the linear acceleration and angular velocity of the collection vehicle collected by the IMU at M collection times.
- the calibration device obtains the measurement information collected by the IMU, according to the linear acceleration and angular velocity collected at the M collection times, the relative conversion relationship between the IMU coordinate system at the M collection times and the IMU coordinate system at the 0s time can be obtained through integral calculation.
- the measurement data collected by the IMU includes the linear acceleration and angular velocity collected by the IMU at the time of 0s, and the linear acceleration and angular velocity collected by the IMU at the time of 1s. Integrate calculation to obtain the relative conversion relationship between the IMU coordinate system at 1s and the IMU coordinate system at 0s.
- the local coordinate system is the radar coordinate system at a fixed time
- the IMU coordinate system at the fixed time is the radar coordinate system at the 0s time.
- the M collection times can be obtained.
- the calibration device can obtain the relative conversion relationship between the IMU coordinate system at the M acquisition moments and the radar coordinate system at the 0s time according to the initial external parameter value.
- the calibration device acquires the point cloud data collected by the lidar, for details, refer to S501.
- the calibration device converts the point cloud data from the radar coordinate system to the IMU coordinate system according to the Mth group of external parameter values, and obtains point cloud data in the IMU coordinate system, see S502 for details.
- the calibration device converts the point cloud data in the IMU coordinate system to the local coordinate system according to the relative transformation relationship between the IMU coordinate system and the local coordinate system, and obtains point cloud data in the local coordinate system, see S503 for details.
- the calibration device performs feature extraction on the point cloud data in the local coordinate system, and obtains a feature point cloud set of each feature. For details, refer to S504.
- the calibration device uses an iterative optimization algorithm to iteratively optimize the Mth group of external parameter values until the first iterative stop condition is satisfied, and obtains the M+1th group of external parameter values, see S504 for details.
- S707 The calibration device judges whether the second iteration stop condition is satisfied, and if so, executes S709; otherwise, executes S708.
- the calibration device replaces the Mth group of external parameter values with the M+1th group of external parameter values, and executes S703.
- the calibration device uses the Mth group of external parameter values as the target external parameter values.
- the point cloud data collected by the lidar is converted into the local coordinate system through the external parameter values to be optimized and the relative transformation relationship between the IMU and the local coordinate system, and the point cloud data in the local coordinate system are characterized. Extract the feature points to obtain the feature point cloud data of each feature. Then iteratively optimizes the external parameter values to be optimized according to the characteristic point cloud data of each feature, realizes automatic calibration between the lidar and IMU coordinate systems, improves the calibration efficiency of the lidar and IMU coordinate systems, and avoids the installation of lidar. The effect of angle on calibration accuracy.
- the embodiments of the present application provide a second possible external parameter calibration method for lidar and IMU.
- the calibration device acquires the first point cloud data collected by the lidar; in the current adjustment, the calibration device is based on the external parameter value to be optimized and the second relative conversion relationship between the IMU coordinate system and the reference coordinate system.
- the fourth relative transformation relationship between the lidar coordinate system and the reference coordinate system is obtained, and the external parameter value to be optimized is used to indicate the first relative transformation relationship between the lidar coordinate system and the IMU coordinate system;
- the method for determining the second relative conversion relationship of the coordinate system is shown in Embodiment 1 and Embodiment 2; the calibration device converts the first point cloud data from the lidar coordinate system from the lidar coordinate system Convert the system to the reference coordinate system to obtain the second point cloud data; adjust the external parameter values to be optimized according to the second point cloud data; the calibration device determines the external parameter values to be optimized for the current adjustment according to the second point cloud data such that When the same feature collected by the lidar travels to different positions in the same position in the IMU coordinate system or the position difference satisfies the preset conditions, the current external parameter value to be optimized is used as the target external parameter value, otherwise, the external parameter value to be optimized is used. Adjust the external parameter value, and use the adjusted external parameter value as the external parameter value to be optimized in the next adjustment.
- FIG. 8 is the second possible external parameter calibration method of the laser radar and the IMU provided in the embodiment of the application.
- the execution subject of S801-S808 is taken as an example of the calibration device.
- the calibration device acquires the measurement data collected by the IMU, and obtains the relative transformation relationship between the IMU coordinate system and the local coordinate system at the M collection moments according to the measurement data collected by the IMU.
- the method for determining the relative transformation relationship between the IMU coordinate system and the local coordinate system at the M collection moments is S701.
- the calibration device acquires the point cloud data collected by the lidar, for details, refer to S501.
- the calibration device obtains the relative transformation relationship between the radar coordinate system and the local coordinate system at the N collection moments according to the Mth group of external parameter values and the relative transformation relationship between the IMU coordinate system and the local coordinate system at the M collection moments respectively .
- an interpolation algorithm is used to obtain the relative transformation relationship between the IMU coordinate system and the local coordinate system at the N collection moments respectively;
- M sets of external parameter values, and the relative transformation relationship between the IMU coordinate system and the local coordinate system at N acquisition moments, respectively, can obtain the relative transformation relationship between the radar coordinate system and the local coordinate system at N acquisition moments.
- the calibration device converts the point cloud data in the radar coordinate system to the local coordinate system according to the relative transformation relationship between the radar coordinate system and the local coordinate system at the N collection moments respectively, and obtains the point cloud data in the local coordinate system.
- the calibration device performs feature extraction on the point cloud data in the local coordinate system, and obtains a feature point cloud set of each feature. For details, refer to S504.
- the calibration device adopts an iterative optimization algorithm to adjust the Mth group of external parameter values until the first iteration stop condition is satisfied, and obtains the M+1th group of external parameter values, see S504 for details.
- the calibration device judges whether the second iterative convergence condition is satisfied, and if so, executes S809, otherwise, executes S808.
- the calibration device replaces the Mth group of external parameter values with the M+1th group of external parameter values, and executes S803.
- the calibration device takes the M+1 group of external parameter values as the target external parameter value.
- the calibration device obtains the first point cloud data collected by the lidar, and the first point cloud data is used to represent that the features around the vehicle to be calibrated collected by the vehicle to be calibrated driving on the target path are in the lidar coordinate system
- the calibration device converts the first point cloud data from the lidar coordinate system to the IMU coordinate system according to the external parameter values to be optimized to obtain the second point cloud data, and the external parameter values to be optimized are used for Indicate the first relative conversion relationship between the lidar coordinate system and the IMU coordinate system;
- the calibration device determines the external parameter value to be optimized for the current adjustment and uses according to the second point cloud data, so that the lidar travels to different locations to collect the same image
- the current external parameter value to be optimized is used as the target external parameter
- FIG. 9 is a third possible external parameter calibration method for lidar and IMU provided in the embodiment of the present application, and the method can be executed by a calibration device or by a chip or a chip system in the calibration device. .
- the calibration device acquires the point cloud data collected by the lidar. For details, refer to S501.
- the calibration device converts the point cloud data from the radar coordinate system to the IMU coordinate system according to the Mth group of external parameter values, and obtains point cloud data in the IMU coordinate system, see S502 for details.
- the calibration device performs feature extraction on the point cloud data in the IMU coordinate system to obtain a feature point cloud set of each feature.
- the process that the calibration device performs feature extraction on the point cloud data in the IMU coordinate system is similar to the process of performing feature extraction on the third point cloud data in S504, and will not be repeated here.
- the calibration device uses an iterative optimization algorithm to iteratively optimize the Mth group of external parameter values until the first iterative stop condition is satisfied, and obtains the M+1th group of external parameter values.
- the calibration device judges whether the second iterative convergence condition is satisfied, if yes, executes S907, otherwise, executes S906.
- the calibration device replaces the Mth group of external parameter values with the M+1th group of external parameter values, and executes S902.
- the calibration device uses the Mth group of external parameter values as the target external parameter values.
- the external parameter values to be optimized can be optimized directly according to the point cloud data in the IMU coordinate system. Improve the calibration efficiency of external parameters, and avoid the influence of the installation angle of the lidar on the calibration accuracy.
- the embodiment of the present application also provides a method for calibrating external parameters between multiple laser radars.
- the method can A possible method is to obtain the extrinsic parameter values between each lidar and the IMU respectively, and obtain the extrinsic parameter values between multiple lidars according to the extrinsic parameter values between each lidar and the IMU.
- the first external parameter value between the first laser radar and the IMU can be obtained, and the second laser radar and the IMU can be obtained.
- the extrinsic parameter value between the first laser radar and the second laser radar is obtained.
- the first external parameter value between the first laser radar and the IMU the second laser radar can be obtained.
- the second extrinsic parameter value between the radar and the IMU, and the third extrinsic parameter value between the third lidar and the IMU According to the relative relationship between the first extrinsic parameter value and the second extrinsic parameter value, the extrinsic parameter value between the first laser radar and the second laser radar can be obtained. According to the relative relationship between the first extrinsic parameter value and the third extrinsic parameter value, the extrinsic parameter value between the first laser radar and the third laser radar can be obtained. According to the relative relationship between the second external parameter value and the third external parameter value, the external parameter value between the second laser radar and the third laser radar can be obtained.
- the present application also provides an external parameter calibration device for lidar and IMU.
- the structure of the calibration device is shown in FIG. 10 , including a communication unit 1001 and a processing unit 1002 .
- the calibration device 1000 can be applied to the calibration device in the calibration method shown in FIGS. 5-9 .
- the functions of each unit in the calibration device 1000 will be introduced below.
- the communication unit 1001 is used for receiving and sending data.
- the communication unit 601 may also be referred to as a physical interface, a communication module, a communication interface, and an input/output interface.
- the calibration apparatus 1000 includes a communication unit 1001 and a processing unit 1002,
- the communication unit 1001 is used to obtain the first point cloud data collected by the lidar, where the first point cloud data is used to represent the characteristic objects around the vehicle to be calibrated collected by the vehicle to be calibrated while driving on the target path. position in the radar coordinate system;
- the processing unit 1002 is configured to convert the first point cloud data from the lidar coordinate system to the IMU coordinate system to obtain second point cloud data according to the external parameter value to be optimized in the current adjustment, the to-be-optimized external parameter value.
- the optimized external parameter value is used to indicate the first relative transformation relationship between the lidar coordinate system and the IMU coordinate system; according to the second relative transformation relationship between the IMU coordinate system and the reference coordinate system, the The second point cloud data is converted to the reference coordinate system to obtain third point cloud data; the second relative conversion relationship is based on the to-be-calibrated vehicle collected by the IMU during the process of the to-be-calibrated vehicle traveling on the target path.
- the position and attitude of the vehicle are obtained; and, according to the third point cloud data, the external parameter value to be optimized used for the current adjustment is determined so that the same feature collected by the lidar traveling to different positions is in the reference
- the current external parameter value to be optimized is used as the target external parameter value, otherwise, the external parameter value to be optimized is adjusted, and the adjusted value is used.
- the external parameter value is used as the external parameter value to be optimized in the next adjustment.
- the first point cloud data is collected by the lidar at N first collection moments
- the communication unit 1001 is further configured to acquire the IMU collected at M second collection moments
- the measured data includes the linear acceleration and angular velocity of the to-be-calibrated vehicle collected by the IMU when the to-be-calibrated vehicle is traveling on the target path;
- the processing unit 1002 When acquiring the second relative transformation relationship between the IMU coordinate system and the reference coordinate system, the processing unit 1002 is configured to: obtain, according to the measurement data, second relative transformation relationships at M second acquisition moments, respectively, The second relative transformation relationship at the second acquisition moment is used to represent the relative transformation relationship between the IMU coordinate system and the reference coordinate system at the second acquisition moment.
- the processing unit 1002 when converting the second point cloud data to the reference coordinate system to obtain third point cloud data, is used for:
- the second point cloud data at the ith first collection moment are respectively converted to the reference coordinate system to obtain the point cloud at the ith first collection moment
- i is taken as a positive integer less than or equal to N, so as to obtain N point cloud data at the first collection moment to form the third point cloud data.
- the third point cloud data is used to represent the three-dimensional coordinates of X features in the reference coordinate system, where X is a positive integer;
- the processing unit 1002 determines the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the reference coordinate system or the position difference satisfies Under preset conditions, the processing unit 1002 is used for:
- the external parameter value to be optimized used in the current adjustment is determined such that The same feature collected by the lidar traveling to different positions has the same position in the reference coordinate system or the position difference meets a preset condition; wherein, the error parameter of the first feature is the first feature in the reference coordinate system.
- the sum of variances corresponding to the coordinates of the three dimensions of the coordinate system respectively, and the first feature is any one of the X features.
- the third point cloud data is used to represent the three-dimensional coordinates of X features in the reference coordinate system, where X is a positive integer;
- the processing unit 1002 determines the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the reference coordinate system or the position difference satisfies Under preset conditions, the processing unit 1002 is used for:
- the difference between the error parameters of the X features in the current adjustment and the error parameters of the X features in the previous adjustment is smaller than the second threshold, then determine the external parameter value to be optimized used in the current adjustment so that the laser
- the position of the same feature collected by the radar traveling to different positions in the reference coordinate system is the same or the position difference meets a preset condition; wherein, the error parameter of the first feature is the first feature in the reference coordinate system.
- the sum of variances corresponding to the coordinates of the three dimensions respectively, and the first feature is any one of the X features.
- the third point cloud data is used to represent the three-dimensional coordinates of X features in the reference coordinate system, and X is a positive integer;
- the processing unit 1002 determines the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the reference coordinate system or the position difference satisfies Under preset conditions, the processing unit 1002 is used for:
- the external parameter value to be optimized used in the current adjustment is the same as the above
- the difference between the external parameter values to be optimized used in one adjustment is smaller than the third threshold, and the external parameter value to be optimized used in the current adjustment is determined so that the same feature collected by the lidar traveling to different positions is at the location.
- the positions in the reference coordinate system are the same or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is the sum of the variances corresponding to the coordinates of the first feature in the three dimensions of the reference coordinate system, so The first feature is any one of the X features.
- the third point cloud data is used to represent the three-dimensional coordinates of X features in the reference coordinate system, where X is a positive integer;
- the processing unit 1002 determines the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the reference coordinate system or the position difference satisfies Under preset conditions, the processing unit 1002 is used for:
- the difference between the error parameters of the X features in the current adjustment and the error parameters of the X features in the previous adjustment is less than the second threshold, and the value of the external parameter to be optimized used in the current adjustment is the same as the one used in the previous adjustment
- the external parameter value to be optimized used for the current adjustment is determined so that the same feature collected by the lidar travels to different positions at the reference coordinates
- the positions in the reference coordinate system are the same or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is the sum of the variances corresponding to the coordinates of the first feature in the three dimensions of the reference coordinate system, and the first feature
- the feature is any of the X features.
- the processing unit 1002 when converting the second point cloud data to the reference coordinate system to obtain third point cloud data, is used for:
- the second point cloud data is converted from the IMU coordinate system to the reference coordinate system to obtain fourth point cloud data
- the fourth point cloud data after motion compensation is used as the third point cloud data, and the fourth point cloud data after motion compensation is collected by the IMU according to the process of the vehicle to be calibrated driving on the target path motion compensation for the position, attitude and speed of the vehicle to be calibrated.
- the calibration apparatus 1000 includes a communication unit 1001 and a processing unit 1002,
- the communication unit 1001 is used to obtain the first point cloud data collected by the lidar, where the first point cloud data is used to represent the characteristic objects around the vehicle to be calibrated collected by the vehicle to be calibrated while driving on the target path. position in the radar coordinate system;
- the processing unit 1002 is configured to convert the first point cloud data from the lidar coordinate system to the IMU coordinate system to obtain second point cloud data according to the external parameter value to be optimized in the current adjustment, the to-be-optimized external parameter value.
- the optimized extrinsic parameter value is used to indicate the first relative transformation relationship between the lidar coordinate system and the IMU coordinate system; and, according to the second point cloud data, determine the extrinsic parameter to be optimized used for the current adjustment.
- the current external parameter value to be optimized is used as the target external parameter. value, otherwise, adjust the external parameter value to be optimized, and use the adjusted external parameter value as the external parameter value to be optimized in the next adjustment.
- the second point cloud data is used to represent the three-dimensional coordinates of X features in the IMU coordinate system, where X is a positive integer;
- the processing unit 1002 determines the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the IMU coordinate system or the position difference satisfies Under preset conditions, the processing unit 1002 is used for:
- the external parameter value to be optimized used in the current adjustment is determined such that The position of the same feature collected by the lidar traveling to different positions in the IMU coordinate system is the same or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is the first feature in the IMU.
- the sum of variances corresponding to the coordinates of the three dimensions of the coordinate system respectively, and the first feature is any one of the X features.
- the second point cloud data is used to represent the three-dimensional coordinates of X features in the IMU coordinate system, where X is a positive integer;
- the processing unit 1002 determines the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the IMU coordinate system or the position difference satisfies Under preset conditions, the processing unit 1002 is used for:
- the external parameter value to be optimized used in the current adjustment is determined such that The position of the same feature collected by the lidar traveling to different positions in the IMU coordinate system is the same or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is the first feature in the IMU.
- the sum of variances corresponding to the coordinates of the three dimensions of the coordinate system respectively, and the first feature is any one of the X features.
- the second point cloud data is used to represent the three-dimensional coordinates of X features in the IMU coordinate system, where X is a positive integer;
- the processing unit 1002 determines the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the IMU coordinate system or the position difference satisfies Under preset conditions, the processing unit 1002 is used for:
- the difference between the error parameters of the X features in the current adjustment and the error parameters of the X features in the previous adjustment is smaller than the second threshold, then determine the external parameter value to be optimized used in the current adjustment so that the laser
- the error parameter of the first feature is the error parameter of the first feature in the IMU coordinate system.
- the sum of variances corresponding to the coordinates of the three dimensions respectively, and the first feature is any one of the X features.
- the second point cloud data is used to represent the three-dimensional coordinates of X features in the IMU coordinate system, where X is a positive integer;
- the processing unit 1002 determines the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the IMU coordinate system or the position difference satisfies Under preset conditions, the processing unit 1002 is used for:
- the external parameter value to be optimized used in the current adjustment is the same as the above.
- the difference between the external parameter values to be optimized used in one adjustment is smaller than the third threshold, and the external parameter value to be optimized used in the current adjustment is determined so that the same feature collected by the lidar traveling to different positions is at the location.
- the positions in the IMU coordinate system are the same or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is the sum of the variances corresponding to the coordinates of the first feature in the three dimensions of the IMU coordinate system, so The first feature is any one of the X features.
- the second point cloud data is used to represent the three-dimensional coordinates of X features in the IMU coordinate system, where X is a positive integer;
- the processing unit 1002 determines the external parameter value to be optimized used for the current adjustment, so that the same feature collected by the lidar traveling to different positions has the same position in the IMU coordinate system or the position difference satisfies Under preset conditions, the processing unit 1002 is used for:
- the external parameter values to be optimized used in the current adjustment are determined so that the same feature collected by the lidar travels to different positions at the coordinates of the IMU The positions in the system are the same or the position difference satisfies a preset condition; wherein, the error parameter of the first feature is the sum of the variances corresponding to the coordinates of the first feature in the three dimensions of the IMU coordinate system, and the first feature The feature is any of the X features.
- the calibration apparatus 1000 includes a communication unit 1001 and a processing unit 1002,
- the communication unit 1001 is used to obtain the first point cloud data collected by the lidar, where the first point cloud data is used to represent the characteristic objects around the vehicle to be calibrated collected by the vehicle to be calibrated while driving on the target path. position in the radar coordinate system;
- the processing unit 1002 is used for obtaining the fourth relative transformation between the lidar coordinate system and the reference coordinate system according to the external parameter value to be optimized and the second relative transformation relationship between the IMU coordinate system and the reference coordinate system in the current adjustment
- the external parameter value to be optimized is used to indicate the first relative transformation relationship between the lidar coordinate system and the IMU coordinate system, and the second relative transformation relationship between the IMU coordinate system and the reference coordinate system is Obtained according to the position and attitude of the to-be-calibrated vehicle collected by the IMU when the to-be-calibrated vehicle is traveling on the target path; based on the fourth relative transformation between the lidar coordinate system and the reference coordinate system relationship, converting the first point cloud data from the lidar coordinate system to the reference coordinate system to obtain second point cloud data; and, according to the second point cloud data, determining the current adjustment to be optimized
- the current external parameter value to be optimized is used
- the present application also provides an external parameter calibration device for lidar and IMU.
- the calibration device 1100 can implement the functions of the calibration device in the calibration methods shown in FIGS. 5-9 .
- the calibration apparatus 1100 includes: a transceiver 1101 , a processor 1102 and a memory 1103 .
- the transceiver 1101 , the processor 1102 and the memory 1103 are connected to each other.
- the processor 1102 may be configured to perform all the operations performed by the calibration apparatus in any of the embodiments shown in FIG. 5 to FIG. 9 except for the acquisition operation.
- the transceiver 1101 , the processor 1102 and the memory 1103 are connected to each other through a bus 1104 .
- the bus 1104 may be a peripheral component interconnect (PCI) bus or an extended industry standard architecture (EISA) bus or the like.
- PCI peripheral component interconnect
- EISA extended industry standard architecture
- the bus can be divided into an address bus, a data bus, a control bus, and the like. For ease of presentation, only one thick line is used in FIG. 11, but it does not mean that there is only one bus or one type of bus.
- the transceiver 1101 is used to receive and transmit data, and implement communication interaction with other devices.
- the memory in Figure 11 of the present application may be either volatile memory or non-volatile memory, or may include both volatile and non-volatile memory.
- the non-volatile memory may be a read-only memory (Read-Only Memory, ROM), a programmable read-only memory (Programmable ROM, PROM), an erasable programmable read-only memory (Erasable PROM, EPROM), an electrically programmable read-only memory (Erasable PROM, EPROM). Erase programmable read-only memory (Electrically EPROM, EEPROM) or flash memory.
- Volatile memory may be Random Access Memory (RAM), which acts as an external cache.
- RAM random access memory
- SRAM Static RAM
- DRAM Dynamic RAM
- SDRAM Synchronous DRAM
- SDRAM double data rate synchronous dynamic random access memory
- Double Data Rate SDRAM DDR SDRAM
- enhanced SDRAM ESDRAM
- synchronous link dynamic random access memory Synchlink DRAM, SLDRAM
- Direct Rambus RAM Direct Rambus RAM
- the embodiments of the present application further provide a computer program, when the computer program runs on a computer, the computer causes the computer to execute the calibration methods provided by the embodiments shown in FIGS. 5-9 .
- the embodiments of the present application further provide a computer-readable storage medium, where a computer program is stored in the computer-readable storage medium, and when the computer program is executed by a computer, the computer executes the programs shown in FIGS. 5-9 .
- the storage medium may be any available medium that the computer can access.
- computer readable media may include RAM, ROM, EEPROM, CD-ROM or other optical disk storage, magnetic disk storage media or other magnetic storage devices, or be capable of carrying or storing instructions or data structures in the form of desired program code and any other medium that can be accessed by a computer.
- an embodiment of the present application further provides a chip, which is used to read a computer program stored in a memory, and implement the calibration method provided by the embodiments shown in FIG. 5 to FIG. 9 .
- the embodiments of the present application provide a chip system, where the chip system includes a processor for supporting a computer device to implement the functions involved in the calibration device in the embodiments shown in FIGS. 5-9 .
- the chip system further includes a memory for storing necessary programs and data of the computer device.
- the chip system may be composed of chips, or may include chips and other discrete devices.
- the embodiments of the present application may be provided as a method, a system, or a computer program product. Accordingly, the present application may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware aspects. Furthermore, the present application may take the form of a computer program product embodied on one or more computer-usable storage media (including, but not limited to, disk storage, CD-ROM, optical storage, etc.) having computer-usable program code embodied therein.
- computer-usable storage media including, but not limited to, disk storage, CD-ROM, optical storage, etc.
- These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing apparatus to function in a particular manner, such that the instructions stored in the computer-readable memory result in an article of manufacture comprising instruction means, the instructions
- the apparatus implements the functions specified in the flow or flow of the flowcharts and/or the block or blocks of the block diagrams.
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Manufacturing & Machinery (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Traffic Control Systems (AREA)
Abstract
Procédé d'étalonnage d'un paramètre externe d'un radar laser et d'une unité de mesure inertielle, appareil d'étalonnage (1000, 1100) et dispositif pour résoudre le problème de l'état de la technique selon lequel un algorithme de mise en correspondance inter-trames n'est pas approprié pour un étalonnage de paramètre externe d'un radar laser installé de manière oblique. Le procédé comprend les étapes suivantes : la conversion, par l'appareil d'étalonnage (1000, 1100), des données de nuage de points collectées par le radar laser en un système de coordonnées d'unité de mesure inertielle en fonction d'une valeur de paramètre externe à optimiser (S502) ; la conversion des données de nuage de points du système de coordonnées d'unité de mesure inertielle en un système de coordonnées de référence en fonction de la relation de conversion relative entre le système de coordonnées d'unité de mesure inertielle et le système de coordonnées de référence (S503) ; la réalisation d'un réglage itératif sur ladite valeur de paramètre externe en fonction des données de nuage de points dans le système de coordonnées de référence, pour obtenir une valeur de paramètre externe cible (S504), ce qui permet d'éviter l'influence du résultat d'étalonnage de paramètre externe à partir de l'angle d'installation du radar laser, d'obtenir un étalonnage automatique et d'améliorer l'efficacité d'étalonnage de paramètre externe.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011492455.1 | 2020-12-16 | ||
CN202011492455.1A CN114636993A (zh) | 2020-12-16 | 2020-12-16 | 一种激光雷达与imu的外参标定方法、装置及设备 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2022127532A1 true WO2022127532A1 (fr) | 2022-06-23 |
Family
ID=81944508
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2021/132432 WO2022127532A1 (fr) | 2020-12-16 | 2021-11-23 | Procédé et appareil d'étalonnage de paramètre externe d'un radar laser et d'une unité de mesure inertielle, et dispositif |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN114636993A (fr) |
WO (1) | WO2022127532A1 (fr) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114897942A (zh) * | 2022-07-15 | 2022-08-12 | 深圳元戎启行科技有限公司 | 点云地图的生成方法、设备及相关存储介质 |
CN115236644A (zh) * | 2022-07-26 | 2022-10-25 | 广州文远知行科技有限公司 | 一种激光雷达外参标定方法、装置、设备和存储介质 |
CN115435784A (zh) * | 2022-08-31 | 2022-12-06 | 中国科学技术大学 | 高空作业平台激光雷达与惯导融合定位建图装置及方法 |
CN115435773A (zh) * | 2022-09-05 | 2022-12-06 | 北京远见知行科技有限公司 | 室内停车场高精度地图采集装置 |
CN115512242A (zh) * | 2022-07-22 | 2022-12-23 | 北京微视威信息科技有限公司 | 场景变化检测方法及飞行装置 |
CN116740197A (zh) * | 2023-08-11 | 2023-09-12 | 之江实验室 | 一种外参的标定方法、装置、存储介质及电子设备 |
CN116819469A (zh) * | 2023-08-28 | 2023-09-29 | 南京慧尔视智能科技有限公司 | 一种多雷达目标位置同步方法、装置、设备及存储介质 |
CN117269939A (zh) * | 2023-10-25 | 2023-12-22 | 北京路凯智行科技有限公司 | 用于传感器的参数标定系统、方法及存储介质 |
CN117554937A (zh) * | 2024-01-08 | 2024-02-13 | 安徽中科星驰自动驾驶技术有限公司 | 一种误差可控的激光雷达和组合惯导外参标定方法和系统 |
CN117706530A (zh) * | 2024-02-05 | 2024-03-15 | 中国科学院自动化研究所 | 一种用于实现多激光雷达与组合导航标定的方法及系统 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115267751A (zh) * | 2022-08-19 | 2022-11-01 | 广州小鹏自动驾驶科技有限公司 | 传感器标定方法、装置、车辆及存储介质 |
CN116385550B (zh) * | 2022-12-16 | 2024-07-23 | 北京斯年智驾科技有限公司 | 外参标定方法、装置、计算设备、介质和车辆 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107710010A (zh) * | 2015-06-11 | 2018-02-16 | 奥托立夫开发公司 | 车辆雷达系统的失准估计 |
US20180356825A1 (en) * | 2017-06-13 | 2018-12-13 | TuSimple | UNDISTORTED RAW LiDAR SCANS AND STATIC POINT EXTRACTIONS METHOD FOR GROUND TRUTH STATIC SCENE SPARSE FLOW GENERATION |
CN110837080A (zh) * | 2019-10-28 | 2020-02-25 | 武汉海云空间信息技术有限公司 | 激光雷达移动测量系统的快速标定方法 |
CN111044992A (zh) * | 2018-10-11 | 2020-04-21 | 百度(美国)有限责任公司 | 用于自动驾驶的基于交叉验证的自动lidar校准 |
CN111208492A (zh) * | 2018-11-21 | 2020-05-29 | 长沙智能驾驶研究院有限公司 | 车载激光雷达外参标定方法及装置、计算机设备及存储介质 |
CN111650598A (zh) * | 2019-02-19 | 2020-09-11 | 北京京东尚科信息技术有限公司 | 一种车载激光扫描系统外参标定方法和装置 |
-
2020
- 2020-12-16 CN CN202011492455.1A patent/CN114636993A/zh active Pending
-
2021
- 2021-11-23 WO PCT/CN2021/132432 patent/WO2022127532A1/fr active Application Filing
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107710010A (zh) * | 2015-06-11 | 2018-02-16 | 奥托立夫开发公司 | 车辆雷达系统的失准估计 |
US20180356825A1 (en) * | 2017-06-13 | 2018-12-13 | TuSimple | UNDISTORTED RAW LiDAR SCANS AND STATIC POINT EXTRACTIONS METHOD FOR GROUND TRUTH STATIC SCENE SPARSE FLOW GENERATION |
CN111044992A (zh) * | 2018-10-11 | 2020-04-21 | 百度(美国)有限责任公司 | 用于自动驾驶的基于交叉验证的自动lidar校准 |
CN111208492A (zh) * | 2018-11-21 | 2020-05-29 | 长沙智能驾驶研究院有限公司 | 车载激光雷达外参标定方法及装置、计算机设备及存储介质 |
CN111650598A (zh) * | 2019-02-19 | 2020-09-11 | 北京京东尚科信息技术有限公司 | 一种车载激光扫描系统外参标定方法和装置 |
CN110837080A (zh) * | 2019-10-28 | 2020-02-25 | 武汉海云空间信息技术有限公司 | 激光雷达移动测量系统的快速标定方法 |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114897942B (zh) * | 2022-07-15 | 2022-10-28 | 深圳元戎启行科技有限公司 | 点云地图的生成方法、设备及相关存储介质 |
CN114897942A (zh) * | 2022-07-15 | 2022-08-12 | 深圳元戎启行科技有限公司 | 点云地图的生成方法、设备及相关存储介质 |
CN115512242A (zh) * | 2022-07-22 | 2022-12-23 | 北京微视威信息科技有限公司 | 场景变化检测方法及飞行装置 |
CN115512242B (zh) * | 2022-07-22 | 2023-05-30 | 北京微视威信息科技有限公司 | 场景变化检测方法及飞行装置 |
CN115236644A (zh) * | 2022-07-26 | 2022-10-25 | 广州文远知行科技有限公司 | 一种激光雷达外参标定方法、装置、设备和存储介质 |
CN115435784A (zh) * | 2022-08-31 | 2022-12-06 | 中国科学技术大学 | 高空作业平台激光雷达与惯导融合定位建图装置及方法 |
CN115435773A (zh) * | 2022-09-05 | 2022-12-06 | 北京远见知行科技有限公司 | 室内停车场高精度地图采集装置 |
CN115435773B (zh) * | 2022-09-05 | 2024-04-05 | 北京远见知行科技有限公司 | 室内停车场高精度地图采集装置 |
CN116740197B (zh) * | 2023-08-11 | 2023-11-21 | 之江实验室 | 一种外参的标定方法、装置、存储介质及电子设备 |
CN116740197A (zh) * | 2023-08-11 | 2023-09-12 | 之江实验室 | 一种外参的标定方法、装置、存储介质及电子设备 |
CN116819469A (zh) * | 2023-08-28 | 2023-09-29 | 南京慧尔视智能科技有限公司 | 一种多雷达目标位置同步方法、装置、设备及存储介质 |
CN116819469B (zh) * | 2023-08-28 | 2023-11-10 | 南京慧尔视智能科技有限公司 | 一种多雷达目标位置同步方法、装置、设备及存储介质 |
CN117269939A (zh) * | 2023-10-25 | 2023-12-22 | 北京路凯智行科技有限公司 | 用于传感器的参数标定系统、方法及存储介质 |
CN117269939B (zh) * | 2023-10-25 | 2024-03-26 | 北京路凯智行科技有限公司 | 用于传感器的参数标定系统、方法及存储介质 |
CN117554937A (zh) * | 2024-01-08 | 2024-02-13 | 安徽中科星驰自动驾驶技术有限公司 | 一种误差可控的激光雷达和组合惯导外参标定方法和系统 |
CN117554937B (zh) * | 2024-01-08 | 2024-04-26 | 安徽中科星驰自动驾驶技术有限公司 | 一种误差可控的激光雷达和组合惯导外参标定方法和系统 |
CN117706530A (zh) * | 2024-02-05 | 2024-03-15 | 中国科学院自动化研究所 | 一种用于实现多激光雷达与组合导航标定的方法及系统 |
CN117706530B (zh) * | 2024-02-05 | 2024-05-14 | 中国科学院自动化研究所 | 一种用于实现多激光雷达与组合导航标定的方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN114636993A (zh) | 2022-06-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2022127532A1 (fr) | Procédé et appareil d'étalonnage de paramètre externe d'un radar laser et d'une unité de mesure inertielle, et dispositif | |
CN109696663B (zh) | 一种车载三维激光雷达标定方法和系统 | |
EP2990828B1 (fr) | Dispositif, système et procédé de traitement de données de position de nuages de points et programme associé | |
JP6880080B2 (ja) | ポイントクラウドに基づく姿勢推定を用いた車両ナビゲーションシステム | |
CN108921947B (zh) | 生成电子地图的方法、装置、设备、存储介质以及采集实体 | |
CN110859044B (zh) | 自然场景中的集成传感器校准 | |
US10240934B2 (en) | Method and system for determining a position relative to a digital map | |
CN111007530B (zh) | 激光点云数据处理方法、装置及系统 | |
JP6656886B2 (ja) | 情報処理装置、制御方法、プログラム及び記憶媒体 | |
US20200355513A1 (en) | Systems and methods for updating a high-definition map | |
CN114444158B (zh) | 一种基于三维重建的地下巷道形变预警方法及系统 | |
JP2022542289A (ja) | 地図作成方法、地図作成装置、電子機器、記憶媒体及びコンピュータプログラム製品 | |
CN103424112A (zh) | 一种基于激光平面辅助的运动载体视觉导航方法 | |
CN113933818A (zh) | 激光雷达外参的标定的方法、设备、存储介质及程序产品 | |
CN114526745A (zh) | 一种紧耦合激光雷达和惯性里程计的建图方法及系统 | |
CN114323050B (zh) | 车辆定位方法、装置和电子设备 | |
CN112455502B (zh) | 基于激光雷达的列车定位方法及装置 | |
CN110412596A (zh) | 一种基于图像信息和激光点云的机器人定位方法 | |
US20220205804A1 (en) | Vehicle localisation | |
WO2024001649A1 (fr) | Procédé de positionnement de robot, appareil et support de stockage lisible par ordinateur | |
CN110986888A (zh) | 一种航空摄影一体化方法 | |
CN115236714A (zh) | 多源数据融合定位方法、装置、设备及计算机存储介质 | |
CN102620745B (zh) | 一种机载imu视准轴误差检校方法 | |
WO2022256976A1 (fr) | Procédé et système de construction de données de valeur de vérité en nuage de points dense et dispositif électronique | |
JP2020073931A (ja) | 情報処理装置、制御方法、プログラム及び記憶媒体 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 21905461 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 21905461 Country of ref document: EP Kind code of ref document: A1 |