CN111413689A - Efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz - Google Patents

Efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz Download PDF

Info

Publication number
CN111413689A
CN111413689A CN202010379045.XA CN202010379045A CN111413689A CN 111413689 A CN111413689 A CN 111413689A CN 202010379045 A CN202010379045 A CN 202010379045A CN 111413689 A CN111413689 A CN 111413689A
Authority
CN
China
Prior art keywords
point cloud
rviz
objects
laser radar
coordinate system
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202010379045.XA
Other languages
Chinese (zh)
Other versions
CN111413689B (en
Inventor
张林灿
董钊志
宋罡
张婉蒙
刘树全
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wohang Technology Nanjing Co ltd
Original Assignee
Wohang Technology Nanjing Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Wohang Technology Nanjing Co ltd filed Critical Wohang Technology Nanjing Co ltd
Priority to CN202010379045.XA priority Critical patent/CN111413689B/en
Publication of CN111413689A publication Critical patent/CN111413689A/en
Application granted granted Critical
Publication of CN111413689B publication Critical patent/CN111413689B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
    • Y02A90/10—Information and communication technologies [ICT] supporting adaptation to climate change, e.g. for weather forecasting or climate simulation

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

The invention discloses an efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz, which comprises the following steps: measuring the relative position of each laser radar relative to the vehicle body coordinate system; placing the three calibration cuboids under the coordinates in the vehicle body coordinate system to form a triangular potential; then writing a topic publishing program, drawing the positions of the three objects in a vehicle body coordinate system according to the actual shapes and the placing positions of the three objects, starting the topic publishing program and rviz, monitoring the point cloud of a multi-path laser radar and the topic of the object by the rviz, and observing the difference between the point cloud imaging and the drawn object position in a three-dimensional view; compiling a parameter calibration configuration file, which comprises six parameters respectively representing three parameters of a translation vector, a rolling angle, a pitch angle and a yaw angle; observing the point cloud imaging movement trend by modifying the three angle values until the point cloud imaging movement trend is adjusted to be coincident with three reference objects drawn in rviz; and finally, fine-tuning the numerical value of the translation vector, and finishing the whole calibration process.

Description

Efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz
The technical field is as follows:
the invention relates to an efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz, and belongs to the technical field of intelligent driving of electric vehicles.
Background art:
the Multi-sensor Information Fusion (MSIF) is an Information processing process which is carried out by utilizing computer technology to automatically analyze and synthesize Information and data from multiple sensors or multiple sources under a certain criterion so as to complete needed decision and estimation. Before the step of the above-mentioned operation is carried out, for multiple laser radars, in the installation process of each laser radar, due to the problem of the installation precision of a mechanical structure, the phenomena of angular deviation such as pitching, yawing, rolling and the like are inevitable, in addition, the installation positions of different laser radars are different, and all the factors determine that the coordinate system of each laser radar needs to be synchronized to the coordinate system of the vehicle body so as to meet the condition that the point clouds of different laser radars are uniquely determined for the identification of the same object; if the step is not completed, the same obstacle can be identified into a plurality of objects by the multi-path laser radar, and further misleading judgment of subsequent fusion decisions is caused, so that immeasurable results are caused. At present, the problem that a plurality of laser radars, especially products of different brands, are difficult to calibrate is particularly obvious in the use process, technicians of a plurality of manufacturers are often required to perform combined calibration, and most of laser radar manufacturers provide calibration at present, so that the calibration is paid, and the whole calibration is time-consuming, labor-consuming and expensive.
Therefore, there is a need to improve the prior art to overcome the deficiencies of the prior art.
The invention content is as follows:
the invention provides an efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz for solving the problems in the prior art, which can be used for synchronizing the coordinate systems of all radars to a vehicle body coordinate system when a plurality of laser radars are used as sensors of an intelligent driving vehicle, so that the alignment operation of the laser radar point cloud on original data is realized.
The technical scheme adopted by the invention is as follows: an efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz comprises the following steps:
the first step is as follows: measuring the relative position of each laser radar relative to the coordinate system of the vehicle body, namely the translation vector [ x ]a,ya,za]T；
The second step is that: placing three calibration cuboids with the length of 20cm, the width of 20cm and the height of 200cm under coordinates (20m,5m,0m), (30m,0m,0m) and (20m, -5m,0m) in a vehicle body coordinate system respectively, wherein the coordinates correspond to (x, y, z) in the vehicle body coordinate system respectively to form a triangular potential;
the third step: then writing a topic publishing program, drawing the positions of three objects in a vehicle body coordinate system according to the actual shapes and the placing positions of the three objects, starting the topic publishing program and rviz, monitoring the point cloud of a multi-path laser radar and the topic of the objects by the rviz, observing the difference between the point cloud imaging and the positions of the drawn objects in a three-dimensional view, writing a parameter calibration configuration file, wherein the parameter calibration configuration file comprises six parameters which are x, y, z, roll, pitch and yaw respectively, and the six parameters respectively represent three parameters of a translation vector, a roll angle, a pitch angle and a yaw angle;
the fourth step: observing the point cloud imaging movement trend by modifying the angle values of a rolling angle, a pitch angle and a yaw angle until the point cloud imaging movement trend is adjusted to be coincident with three reference objects drawn in rviz;
the fifth step: and finally, fine-tuning the numerical value of the translation vector, namely, the point cloud imaging of the three objects in the fourth step is overlapped with the three reference objects drawn in rviz, and the point clouds formed by any other objects in the common coverage area of the three laser radars are completely overlapped and consistent when moving or standing, so that the whole calibration process is completed.
The invention has the following beneficial effects: the invention can synchronize the coordinate system of each radar to the coordinate system of the vehicle body when a plurality of laser radars are used as the sensors of the intelligent driving vehicle, thereby realizing the alignment operation of the laser radar point cloud on the original data. Meanwhile, the 128-line main laser radar and the two 32-line blind-sweeping lateral laser radars realize the synchronization of the laser radar point clouds to the same vehicle coordinate system, and lay a foundation for subsequent processing such as filtering, downsampling, clustering and identification of the laser radar point clouds.
The specific implementation mode is as follows:
the core problem of the invention is to synchronize the coordinate system of the multi-path laser radar to a unified coordinate system (generally selecting a vehicle body coordinate system), and for the systemThe problem of synchronization of a multi-path laser radar coordinate system can be understood from mathematics that the coordinates of a plurality of objects in different coordinate systems are known, and a rotation matrix and a translation vector in the two coordinate systems are solved. The mathematical formula can be expressed as the following equation: [ x ] ofa,ya,za]T＝R*[xb,yb,zb]T+[x0,y0,z0]TWherein [ x ]a,ya,za]TIs a coordinate in a coordinate system A, [ x ]b,yb,zb]TIs a coordinate in a coordinate system B, R is a rotation matrix, [ x ]0,y0,z0]TFor translation vectors, directly find R and [ x ]0,y0,z0]TIt is difficult.
Therefore, the efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz provided by the invention comprises the following steps:
the first step is as follows: roughly measuring the relative position of each laser radar relative to the coordinate system of the vehicle body, namely a translation vector [ xa,ya,za]T；
The second step is that: three calibration cuboids (length 20cm, width 20cm and height 200cm) are respectively placed under coordinates (20m,5m,0m), (30m,0m,0m), (20m, -5m and 0m) in a vehicle body coordinate system to form a triangular potential;
the third step: then writing a topic publishing program, drawing the positions of the three objects in a vehicle body coordinate system according to the actual shapes and the placing positions of the three objects, starting the topic publishing program and rviz, monitoring the point cloud of a multi-path laser radar and the topic of the object by the rviz, and observing the difference between the point cloud imaging and the drawn object position in a three-dimensional view; writing a parameter calibration configuration file, wherein the parameter calibration configuration file comprises six parameters, namely x, y, z, roll, pitch and yaw, and the six parameters respectively represent three parameters of a translation vector, a rolling angle, a pitching angle and a yaw angle.
Wherein the rotation matrix can be further expressed by the following formula:
Figure BDA0002481245190000031
the fourth step: observing the point cloud imaging movement trend by modifying the angle values of a rolling angle, a pitch angle and a yaw angle until the point cloud imaging movement trend is adjusted to be coincident with three reference objects drawn in rviz;
the fifth step: and finally, fine-tuning the numerical value of the translation vector, namely, the point cloud imaging of the three objects in the fourth step is coincident with three reference objects drawn in rviz, and the point clouds formed by any other objects in the common coverage area of the three laser radars are completely coincident when moving or standing, so that the whole calibration process is completed, and the method is simple and convenient.
The invention can synchronize the coordinate system of each radar to the coordinate system of the vehicle body when a plurality of laser radars are used as the sensors of the intelligent driving vehicle, thereby realizing the alignment operation of the laser radar point cloud on the original data.
The foregoing is only a preferred embodiment of this invention and it should be noted that modifications can be made by those skilled in the art without departing from the principle of the invention and these modifications should also be considered as the protection scope of the invention.

Claims (1)

1. An efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz is characterized by comprising the following steps: the method comprises the following steps:
the first step is as follows: measuring the relative position of each laser radar relative to the coordinate system of the vehicle body, namely the translation vector [ x ]a,ya,za]T；
The second step is that: three calibration cuboids with the length of 20cm, the width of 20cm and the height of 200cm are respectively placed under coordinates (20m,5m,0m), (30m,0m,0m), (20m, -5m,0m) in a vehicle body coordinate system to form a triangular potential;
the third step: then writing a topic publishing program, drawing the positions of three objects in a vehicle body coordinate system according to the actual shapes and the placing positions of the three objects, starting the topic publishing program and rviz, monitoring the point cloud of a multi-path laser radar and the topic of the objects by the rviz, observing the difference between the point cloud imaging and the positions of the drawn objects in a three-dimensional view, writing a parameter calibration configuration file, wherein the parameter calibration configuration file comprises six parameters which are x, y, z, roll, pitch and yaw respectively, and the six parameters respectively represent three parameters of a translation vector, a roll angle, a pitch angle and a yaw angle;
the fourth step: observing the point cloud imaging movement trend by modifying the angle values of a rolling angle, a pitch angle and a yaw angle until the point cloud imaging movement trend is adjusted to be coincident with three reference objects drawn in rviz;
the fifth step: and finally, fine-tuning the numerical value of the translation vector, namely, the point cloud imaging of the three objects in the fourth step is overlapped with the three reference objects drawn in rviz, and the point clouds formed by any other objects in the common coverage area of the three laser radars are completely overlapped and consistent when moving or standing, so that the whole calibration process is completed.
CN202010379045.XA 2020-05-07 2020-05-07 Efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz Active CN111413689B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010379045.XA CN111413689B (en) 2020-05-07 2020-05-07 Efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010379045.XA CN111413689B (en) 2020-05-07 2020-05-07 Efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz

Publications (2)

Publication Number Publication Date
CN111413689A true CN111413689A (en) 2020-07-14
CN111413689B CN111413689B (en) 2023-04-07

Family

ID=71492413

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010379045.XA Active CN111413689B (en) 2020-05-07 2020-05-07 Efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz

Country Status (1)

Country Link
CN (1) CN111413689B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112068155A (en) * 2020-08-13 2020-12-11 沃行科技(南京)有限公司 Partition obstacle detection method based on multiple multi-line laser radars
CN112180348A (en) * 2020-11-27 2021-01-05 深兰人工智能(深圳)有限公司 Attitude calibration method and device for vehicle-mounted multi-line laser radar
CN112396663A (en) * 2020-11-17 2021-02-23 广东电科院能源技术有限责任公司 Visual calibration method, device, equipment and medium for multi-depth camera

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108020826A (en) * 2017-10-26 2018-05-11 厦门大学 Multi-line laser radar and multichannel camera mixed calibration method
CN109839624A (en) * 2017-11-27 2019-06-04 北京万集科技股份有限公司 A kind of multilasered optical radar position calibration method and device
CN110390695A (en) * 2019-06-28 2019-10-29 东南大学 The fusion calibration system and scaling method of a kind of laser radar based on ROS, camera
CN110596683A (en) * 2019-10-25 2019-12-20 中山大学 Multi-group laser radar external parameter calibration system and method thereof
CN110703230A (en) * 2019-10-15 2020-01-17 西安电子科技大学 Position calibration method between laser radar and camera
CN110837080A (en) * 2019-10-28 2020-02-25 武汉海云空间信息技术有限公司 Rapid calibration method of laser radar mobile measurement system

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108020826A (en) * 2017-10-26 2018-05-11 厦门大学 Multi-line laser radar and multichannel camera mixed calibration method
CN109839624A (en) * 2017-11-27 2019-06-04 北京万集科技股份有限公司 A kind of multilasered optical radar position calibration method and device
CN110390695A (en) * 2019-06-28 2019-10-29 东南大学 The fusion calibration system and scaling method of a kind of laser radar based on ROS, camera
CN110703230A (en) * 2019-10-15 2020-01-17 西安电子科技大学 Position calibration method between laser radar and camera
CN110596683A (en) * 2019-10-25 2019-12-20 中山大学 Multi-group laser radar external parameter calibration system and method thereof
CN110837080A (en) * 2019-10-28 2020-02-25 武汉海云空间信息技术有限公司 Rapid calibration method of laser radar mobile measurement system

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
ANKIT DHALL 等: "LiDAR-Camera Calibration using 3D-3D Point correspondences" *
LIANG ZHIWEI 等: "Improved Visual Odometry Method for Matching 3D Point Cloud Data" *
NINA HEIDE 等: "Calibration of multiple 3D LiDAR sensors to a common vehicle frame" *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112068155A (en) * 2020-08-13 2020-12-11 沃行科技(南京)有限公司 Partition obstacle detection method based on multiple multi-line laser radars
CN112068155B (en) * 2020-08-13 2024-04-02 沃行科技(南京)有限公司 Partition obstacle detection method based on multiple multi-line laser radars
CN112396663A (en) * 2020-11-17 2021-02-23 广东电科院能源技术有限责任公司 Visual calibration method, device, equipment and medium for multi-depth camera
CN112396663B (en) * 2020-11-17 2021-09-14 南方电网电力科技股份有限公司 Visual calibration method, device, equipment and medium for multi-depth camera
CN112180348A (en) * 2020-11-27 2021-01-05 深兰人工智能(深圳)有限公司 Attitude calibration method and device for vehicle-mounted multi-line laser radar
CN112180348B (en) * 2020-11-27 2021-03-02 深兰人工智能(深圳)有限公司 Attitude calibration method and device for vehicle-mounted multi-line laser radar

Also Published As

Publication number Publication date
CN111413689B (en) 2023-04-07

Similar Documents

Publication Publication Date Title
CN111413689B (en) Efficient static calibration method for realizing multi-laser radar point cloud alignment based on rviz
CN108012325B (en) Navigation positioning method based on UWB and binocular vision
CN106462968B (en) Method and device for calibrating a camera system of a motor vehicle
CN110244284B (en) Calibration plate for calibrating multi-line laser radar and GPS\INS and method thereof
CN107507167A (en) A kind of cargo pallet detection method and system matched based on a cloud face profile
CN112581451A (en) Warehouse coil position detection system and method based on laser radar
CN110108269A (en) AGV localization method based on Fusion
CN113947639B (en) Self-adaptive online estimation calibration system and method based on multi-radar point cloud line characteristics
CN112197773B (en) Visual and laser positioning mapping method based on plane information
US20230419531A1 (en) Apparatus and method for measuring, inspecting or machining objects
CN115082881A (en) Target detection method, storage medium, electronic device, and vehicle
CN111462241B (en) Target positioning method based on monocular vision
CN112147598A (en) Laser calibration method based on right-angle wall surface
CN113985435A (en) Mapping method and system fusing multiple laser radars
CN114325760B (en) Highway tunnel quality inspection obstacle avoidance method and system based on multi-line laser radar
CN118334129A (en) Traffic camera calibration method based on multi-constraint pso particle swarm optimization
CN114299039A (en) Robot and collision detection device and method thereof
CN107330934A (en) The boundling Adjustable calculation method and system of low dimensional
CN115100287B (en) External parameter calibration method and robot
CN114495038B (en) Post-processing method for automatic driving detection marking data
CN114862908A (en) Dynamic target tracking method and system based on depth camera
CN115932877A (en) Target tracking method and system with fusion of laser radar and monocular camera
CN112614189B (en) Combined calibration method based on camera and 3D laser radar
CN117635721A (en) Target positioning method, related system and storage medium
CN111736137B (en) LiDAR external parameter calibration method, system, computer equipment and readable storage medium

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant