CN111596309B - Vehicle queuing measurement method based on laser radar - Google Patents
Vehicle queuing measurement method based on laser radar Download PDFInfo
- Publication number
- CN111596309B CN111596309B CN202010299678.XA CN202010299678A CN111596309B CN 111596309 B CN111596309 B CN 111596309B CN 202010299678 A CN202010299678 A CN 202010299678A CN 111596309 B CN111596309 B CN 111596309B
- Authority
- CN
- China
- Prior art keywords
- laser radar
- point
- point cloud
- lidar
- ground
- 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.)
- Active
Links
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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/065—Traffic control systems for road vehicles by counting the vehicles in a section of the road or in a parking area, i.e. comparing incoming count with outgoing count
-
- 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
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
The invention relates to the technical field of laser radar measurement, in particular to a vehicle queuing measurement method based on a laser radar. The invention has the beneficial effects that: the method can rapidly filter the ground point cloud, eliminate uncorrelated noise interference, and has the advantages of high reliability, high precision, wide application range, accurate vehicle queuing length calculation and small error.
Description
Technical Field
The invention relates to the technical field of laser radar measurement, in particular to a vehicle queuing measurement method based on a laser radar.
Background
Lidar is a generic term for laser active detection sensor devices. For the measurement imaging laser radar, the main working principle is to realize three-dimensional scanning measurement (imaging) of the target contour through high-frequency ranging and scanning angle measurement. The measuring imaging laser radar mainly comprises two major types of measuring LiDAR and navigation LiDAR. The measuring LiDAR is mainly used for high-precision mapping; the navigation LiDAR is mainly used for navigation obstacle avoidance of intelligent vehicles, robots and flying equipment. The measurement principle and the technical basis of the two products are similar, and the main difference is the difference of the operation mode, the detection distance and the measurement precision. The navigation LiDAR product trades for reduced equipment size and weight and increased laser scan line count at the expense of detection distance, ranging/angular measurement accuracy, and detection of imaging gray scale. In addition, the navigation LiDAR realizes the measurement of the three-dimensional contour of the target through a plurality of scanning lines. Compared with auxiliary driving sensors such as cameras, ultrasonic radars, millimeter wave radars and the like, the laser radars are 'eyes of intelligent vehicles' truly provided with space three-dimensional resolution capability.
The traditional laser radar filtering ground algorithm mainly adopts a PCL-based RANSAC algorithm, and the RANSAC is an abbreviation of 'Random Sample Consensus (random sampling consensus'). It can estimate the parameters of the mathematical model in an iterative manner from a set of observation data sets containing "outliers". It is an uncertain algorithm-it has a certain probability to get a reasonable result; the number of iterations must be increased in order to increase the probability.
The basic assumption of RANSAC is:
(1) The data consists of "intra-office points", such as: the distribution of the data may be interpreted with some model parameters;
(2) An "outlier" is data that cannot fit the model;
(3) The data in addition belongs to noise.
The reasons for the generation of the off-site points are: extreme values of noise; an erroneous measurement method; false assumptions about data. RANSAC also makes the following assumptions: given a set of (usually small) intra-office points, there is a process by which model parameters can be estimated; and the model can be interpreted or applied to the local points. A certain distance threshold is set through a RANSAC filtering algorithm of PCL, no matter the threshold is too large or too small, if the threshold is too small, the ground cannot be well filtered, and if the threshold is too large, the point clouds of other objects can be filtered out.
Disclosure of Invention
The invention aims to overcome the problems in the prior art and provides a vehicle queuing measurement method based on a laser radar, which can solve the problems in the prior art to at least a certain extent.
In order to achieve the technical purpose and the technical effect, the invention is realized by the following technical scheme:
a lidar-based vehicle queuing measurement method, comprising:
1) Filtering a point cloud near the ground, comprising the steps of:
filtering the ground point cloud by utilizing a RANSAC algorithm and laser radar height included angle information in the process of filtering the ground by utilizing a multithread laser radar, and then obtaining point cloud information of an upper layer of a road;
2) The vehicle length is calculated based on the K-means algorithm, and the method comprises the following steps of:
2.1 Selecting classes/groups and randomly initializing their respective center points;
2.2 Calculating the distance from each data point to the center point, and dividing the data points into which type from which center point the data points are nearest;
2.3 Calculating the center point in each class as a new center point;
2.4 Repeating the steps until each class of center does not change much after each iteration;
3) And determining the position of the automobile based on a clustering algorithm and the reflection intensity of the laser radar, wherein the data point cloud format output by the multi-thread laser radar is (x, y, r), x and y are coordinate values of scanning points, and r is the reflection intensity.
As a further optimization of the solution described above, in the step 1), the point cloud is filtered by the linear distance of each thread in the multi-threaded lidar to the ground.
As a further optimization of the above technical solution, in the step 3), the reflection intensity of the multi-thread laser radar is (0, 255).
The invention has the beneficial effects that: the method can rapidly filter the ground point cloud, eliminate uncorrelated noise interference, and has the advantages of high reliability, high precision, wide application range, accurate vehicle queuing length calculation and small error.
Drawings
In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings that are needed for the description of the embodiments will be briefly described below, and it is obvious that the drawings in the following description are only some embodiments of the present invention, and that other drawings may be obtained according to these drawings without inventive effort for a person skilled in the art.
FIG. 1 is a diagram showing steps for calculating a vehicle length based on a K-means algorithm in the present invention;
FIG. 2 is an illustration of the step of determining the position of an automobile based on a clustering algorithm and laser radar reflection intensity in the present invention.
Description of the embodiments
In order to make the technical means, the creation features, the achievement of the purposes and the effects of the present invention easy to understand, the technical solutions of the embodiments of the present invention will be clearly and completely described below in conjunction with the embodiments of the present invention, and it is obvious that the described embodiments are only some embodiments of the present invention, not all embodiments. All other embodiments, which can be made by those skilled in the art based on the embodiments of the invention without making any inventive effort, are intended to be within the scope of the invention.
A lidar-based vehicle queuing measurement method, comprising:
1) Filtering a point cloud near the ground, comprising the steps of:
the method comprises the steps that in the process of filtering the ground by utilizing a multithread laser radar, a RANSAC algorithm is used for filtering the ground point cloud together with the laser radar height included angle information, then point cloud information of the upper layer of the road is obtained, the straight line distance between each thread and the ground is known, and the point cloud close to the ground can be filtered according to the information;
referring to fig. 1 and 2), calculating a vehicle length based on a K-means algorithm, mainly by performing an algorithm operation on a point cloud remaining after removing the ground, including the steps of:
2.1 First we select some classes/groups and randomly initialize their respective center points. The center point is the same location as the vector length of each data point. This requires that we predict the number of classes (i.e. the number of center points) in advance;
2.2 Calculating the distance from each data point to the center point, and dividing the data points into which type from which center point the data points are nearest;
2.3 Calculating the center point in each class as a new center point;
2.4 Repeating the above steps until each class center does not change much after each iteration. The center point can be initialized randomly for a plurality of times, and then one with the best operation result is selected;
referring to fig. 2 and 3), the position of the automobile is determined based on a clustering algorithm and the reflection intensity of the laser radar, the data point cloud format output by the multi-thread laser radar is (x, y, r), x and y are coordinate values of scanning points, r is reflection intensity, the reflection intensity of the multi-thread laser radar is (0, 255) generally, the reflection intensity of the object which is more bright and opaque is stronger, so that the reflection intensity of the automobile is far greater than that of other objects such as roads and green belts, the point cloud swept to the automobile by the laser radar is usually greater than 200, the automobile can be well identified according to the information and the clustering algorithm, and the queuing information of the automobile can be measured.
It is noted that relational terms such as first and second, and the like are used solely to distinguish one entity or action from another entity or action without necessarily requiring or implying any actual such relationship or order between such entities or actions. Moreover, the terms "comprises," "comprising," or any other variation thereof, are intended to cover a non-exclusive inclusion, such that a process, method, article, or apparatus that comprises a list of elements does not include only those elements but may include other elements not expressly listed or inherent to such process, method, article, or apparatus. Without further limitation, an element defined by the phrase "comprising one … …" does not exclude the presence of other like elements in a process, method, article, or apparatus that comprises the element.
The preferred embodiments of the invention disclosed above are intended only to assist in the explanation of the invention. The preferred embodiments are not exhaustive or to limit the invention to the precise form disclosed. Obviously, many modifications and variations are possible in light of the above teaching. The embodiments were chosen and described in order to best explain the principles of the invention and the practical application, to thereby enable others skilled in the art to best understand and utilize the invention. The invention is limited only by the claims and the full scope and equivalents thereof.
Claims (3)
1. A laser radar-based vehicle queuing measurement method, comprising:
1) Filtering a point cloud near the ground, comprising the steps of:
the multi-thread laser radar receives the ground point cloud information and the laser radar height included angle information, filters the point cloud information by utilizing a RANSAC algorithm, and then acquires the point cloud information of the upper layer of the road;
2) The vehicle length is calculated based on the K-means algorithm, and the method comprises the following steps of:
2.1 Selecting classes/groups in which a value is randomly determined as the center point of such group or groups within the data taken in such group or groups;
2.2 Calculating the distance from each data point of the class/group to the center point, and dividing the data point into the class as to which center point is nearest to;
2.3 Taking the calculated new central point of each class as the central point of the next iterative calculation;
2.4 Repeating the steps until the central point of each class does not change more than a certain range after each iteration;
3) And determining the position of the automobile based on a clustering algorithm and the reflection intensity of the laser radar, wherein the data point cloud format output by the multi-thread laser radar is (x, y, r), x and y are coordinate values of scanning points, and r is the reflection intensity.
2. The lidar-based vehicle queuing measurement method of claim 1, wherein in step 1), the point cloud is filtered by the linear distance of each thread in the multi-threaded lidar to the ground.
3. The method for lidar-based vehicle queuing measurement according to claim 1, wherein in step 3), the reflection intensity of the multi-threaded lidar takes a value of (0,255).
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010299678.XA CN111596309B (en) | 2020-04-16 | 2020-04-16 | Vehicle queuing measurement method based on laser radar |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010299678.XA CN111596309B (en) | 2020-04-16 | 2020-04-16 | Vehicle queuing measurement method based on laser radar |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111596309A CN111596309A (en) | 2020-08-28 |
| CN111596309B true CN111596309B (en) | 2023-05-12 |
Family
ID=72185006
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010299678.XA Active CN111596309B (en) | 2020-04-16 | 2020-04-16 | Vehicle queuing measurement method based on laser radar |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111596309B (en) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114913469B (en) * | 2022-07-11 | 2022-11-22 | 浙江大华技术股份有限公司 | Method for establishing vehicle length estimation model, terminal equipment and storage medium |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108460416A (en) * | 2018-02-28 | 2018-08-28 | 武汉理工大学 | A kind of structured road feasible zone extracting method based on three-dimensional laser radar |
| CN108765937A (en) * | 2018-03-30 | 2018-11-06 | 深圳市金溢科技股份有限公司 | Vehicle identifier, roadside unit and method for ETC system |
| CN109212541A (en) * | 2018-09-20 | 2019-01-15 | 同济大学 | High-precision vehicle detecting system based on vehicle perpendicular type feature and laser radar |
| EP3492872A1 (en) * | 2017-11-30 | 2019-06-05 | Bayerische Motoren Werke Aktiengesellschaft | Method and system for storing and transmitting measurement data from measuring vehicles |
| CN110969855A (en) * | 2019-12-13 | 2020-04-07 | 长沙莫之比智能科技有限公司 | Traffic flow monitoring system based on millimeter wave radar |
-
2020
- 2020-04-16 CN CN202010299678.XA patent/CN111596309B/en active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP3492872A1 (en) * | 2017-11-30 | 2019-06-05 | Bayerische Motoren Werke Aktiengesellschaft | Method and system for storing and transmitting measurement data from measuring vehicles |
| CN108460416A (en) * | 2018-02-28 | 2018-08-28 | 武汉理工大学 | A kind of structured road feasible zone extracting method based on three-dimensional laser radar |
| CN108765937A (en) * | 2018-03-30 | 2018-11-06 | 深圳市金溢科技股份有限公司 | Vehicle identifier, roadside unit and method for ETC system |
| CN109212541A (en) * | 2018-09-20 | 2019-01-15 | 同济大学 | High-precision vehicle detecting system based on vehicle perpendicular type feature and laser radar |
| CN110969855A (en) * | 2019-12-13 | 2020-04-07 | 长沙莫之比智能科技有限公司 | Traffic flow monitoring system based on millimeter wave radar |
Non-Patent Citations (2)
| Title |
|---|
| 基于k-means的自适应聚类算法研究;刘磊;《中国优秀硕士学位论文全文数据库信息科技辑》(第03期);正文第19-52页 * |
| 基于车载32线激光雷达点云的车辆目标识别算法;孔栋 等;《科学技术与工程》;第18卷(第5期);第81-85页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111596309A (en) | 2020-08-28 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107632308B (en) | Method for detecting contour of obstacle in front of vehicle based on recursive superposition algorithm | |
| Thormann et al. | Extended target tracking using Gaussian processes with high-resolution automotive radar | |
| Kellner et al. | Instantaneous lateral velocity estimation of a vehicle using Doppler radar | |
| CN103424112B (en) | A kind of motion carrier vision navigation method auxiliary based on laser plane | |
| Park et al. | Radar localization and mapping for indoor disaster environments via multi-modal registration to prior LiDAR map | |
| CN108508439A (en) | The method that double carried SARs position target cooperative imaging volume | |
| CN114659514A (en) | LiDAR-IMU-GNSS fusion positioning method based on voxelized fine registration | |
| CN114972532B (en) | External parameter calibration method, device, equipment and storage medium between laser radars | |
| CN112379393A (en) | Train collision early warning method and device | |
| Lee et al. | A geometric model based 2D LiDAR/radar sensor fusion for tracking surrounding vehicles | |
| CN114488026B (en) | Underground parking garage passable space detection method based on 4D millimeter wave radar | |
| CN112180361A (en) | Vehicle-mounted radar target tracking method based on dynamic federal filtering | |
| CN111562570A (en) | Vehicle sensing method for automatic driving based on millimeter wave radar | |
| CN114035187A (en) | Perception fusion method of automatic driving system | |
| CN111596309B (en) | Vehicle queuing measurement method based on laser radar | |
| Li et al. | Pedestrian liveness detection based on mmwave radar and camera fusion | |
| Xu et al. | Dynamic vehicle pose estimation and tracking based on motion feedback for LiDARs | |
| CN117590362B (en) | Multi-laser radar external parameter calibration method, device and equipment | |
| Ebert et al. | Deep radar sensor models for accurate and robust object tracking | |
| CN111765883B (en) | Robot Monte Carlo positioning method, equipment and storage medium | |
| CN113296120A (en) | Obstacle detection method and terminal | |
| Yang et al. | Target recognition using rotating ultrasonic sensor for an amphibious ROV | |
| Steinemann et al. | 3D outline contours of vehicles in 3D-LIDAR-measurements for tracking extended targets | |
| CN113177966B (en) | Three-dimensional scanning coherent laser radar point cloud processing method based on velocity clustering statistics | |
| CN113091693B (en) | Monocular vision long-range distance measurement method based on image super-resolution technology |
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 |