CN113112830A - Signal control intersection emptying method and system based on laser radar and track prediction - Google Patents
Signal control intersection emptying method and system based on laser radar and track prediction Download PDFInfo
- Publication number
- CN113112830A CN113112830A CN202110379124.5A CN202110379124A CN113112830A CN 113112830 A CN113112830 A CN 113112830A CN 202110379124 A CN202110379124 A CN 202110379124A CN 113112830 A CN113112830 A CN 113112830A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- intersection
- track
- time
- yellow light
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000001514 detection method Methods 0.000 claims abstract description 26
- 238000012545 processing Methods 0.000 claims description 12
- 238000012360 testing method Methods 0.000 claims description 9
- 238000012549 training Methods 0.000 claims description 9
- 230000008569 process Effects 0.000 claims description 8
- 238000004458 analytical method Methods 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 4
- 238000013527 convolutional neural network Methods 0.000 claims description 4
- 238000013507 mapping Methods 0.000 claims description 3
- 238000012216 screening Methods 0.000 claims description 3
- 230000008859 change Effects 0.000 abstract description 10
- 230000008447 perception Effects 0.000 abstract description 2
- 230000006399 behavior Effects 0.000 description 10
- 206010039203 Road traffic accident Diseases 0.000 description 3
- 230000002265 prevention Effects 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 241001464837 Viridiplantae Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011897 real-time detection Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/07—Controlling traffic signals
- G08G1/081—Plural intersections under common control
- G08G1/082—Controlling the time between beginning of the same phase of a cycle at adjacent intersections
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/07—Controlling traffic signals
- G08G1/081—Plural intersections under common control
-
- 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/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/50—Systems of measurement based on relative movement of target
- G01S17/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
-
- 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
-
- 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/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0108—Measuring and analyzing of parameters relative to traffic conditions based on the source of data
- G08G1/0116—Measuring and analyzing of parameters relative to traffic conditions based on the source of data from roadside infrastructure, e.g. beacons
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0125—Traffic data processing
- G08G1/0129—Traffic data processing for creating historical data or processing based on historical data
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0125—Traffic data processing
- G08G1/0133—Traffic data processing for classifying traffic situation
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/04—Detecting movement of traffic to be counted or controlled using optical or ultrasonic detectors
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/052—Detecting movement of traffic to be counted or controlled with provision for determining speed or overspeed
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Traffic Control Systems (AREA)
Abstract
The invention provides a signal control intersection emptying method and system based on laser radar and track prediction, which belong to the field of intelligent traffic perception, vehicle track data at an intersection entrance lane are obtained through 3D laser radar detection, whether a motor vehicle rushes into the intersection during the phase change of a signal lamp is predicted to be controlled by the signal lamp, the track data of the vehicle is collected by the 3D laser radar arranged at the city intersection entrance lane, and whether the vehicle rushes into the intersection after a yellow light is turned off and a red light is turned on is judged; and the running time of the intruding vehicle in the intersection is predicted, and the full red time of the intersection is adjusted on the basis of the running time, so that the aims of timely emptying the vehicles in the range of the intersection and reducing traffic conflicts are fulfilled. The method can provide a complete solution for actively identifying the motor vehicle intrusion behavior during the phase change of the signal lamp of the urban road intersection, and has the advantages of no dependence on the characteristic information of the moving target, accurate, stable and efficient detection, low cost, good adaptability and the like.
Description
Technical Field
The invention belongs to the field of intelligent traffic perception, and particularly relates to a signal control intersection emptying method and system based on a laser radar and track prediction.
Background
The urban road plane intersection is the throat of the network traffic capacity of the urban road, and is a region with multiple urban traffic accidents. According to the statistics of traffic police department, more than 60% of the traffic accidents occurred on the urban roads are in the range of the plane intersection, wherein most of the accidents occur during the green interval, namely the period from the end of the green of the traffic signal lamp in the previous phase to the beginning of the green in the next phase. Since long phase transition times lead to heterogeneous decisions at the end of the green phase. Therefore, dangerous driving behaviors, such as red-light driving, sudden stop, aggressive passing, and inconsistent decision making of the leading and trailing vehicles, are more likely to occur at these intersections, possibly resulting in right-angle and rear-end traffic accidents.
For dangerous driving behaviors existing in the phase change period of the current intersection, the existing solution methods mainly prevent the dangerous behaviors. For example, the red light running probability of a driver is reduced by simply adjusting the signal timing such as increasing the yellow light duration and setting the signal light countdown; by issuing laws and regulations, a red light running snapshot system is installed, and punishment strength is increased to reduce the occurrence of red light running behaviors; some recent learners propose to realize early warning of vehicle ends of vehicles through intelligent equipment facilities and communication between equipment and vehicles in a vehicle-road cooperative mode. However, the existing modes only prevent dangerous behaviors, and do not have enough adaptability and safety prevention and control efficiency because enough intelligent equipment at the roadside and the vehicle end is required to be supported.
Therefore, the invention provides a signal control intersection emptying method and system based on laser radar and track prediction.
Disclosure of Invention
In order to overcome the defects in the prior art, the invention provides a signal control intersection emptying method and system based on a laser radar and track prediction and based on 3d laser radar detection and vehicle track prediction.
In order to achieve the above purpose, the invention provides the following technical scheme:
step 1, sensing a vehicle about to enter an intersection by using a 3D laser radar installed at an entrance lane of the urban intersection, and detecting and acquiring vehicle track data through the 3D laser radar;
step 2, mapping vehicle track data obtained by the 3D laser radar detection into a three-dimensional coordinate system within the range of an entrance lane, and classifying the vehicles according to lanes where the vehicles are located;
step 3, after receiving a yellow light starting signal, inputting vehicle track data acquired within the first 1.5s of the yellow light time into a track prediction model, judging the vehicle track data within the first 1.5s of the yellow light time through the track prediction model, and predicting the vehicle track data within 1.5s after the yellow light time according to a judgment result;
step 4, judging whether the vehicle rushes into the intersection after the yellow light is finished and the red light is turned on according to vehicle track data which is 1.5s after the yellow light time; if yes, continuing to predict the running time of all vehicles with the prediction results of the vehicles entering the intersection in the intersection, and further screening to obtain the maximum time for the vehicles entering the intersection to drive away from the intersection; if not, returning to the step 1 to continue detection;
the driving time of the vehicle in the intersection refers to the time from the time when the vehicle enters the intersection at the end of the yellow light to the time when the vehicle leaves the intersection;
and 5, adjusting the full red time of the intersection according to the obtained maximum time for the break-in vehicle to drive away from the intersection.
Preferably, the three-dimensional coordinate system is established before the vehicle trajectory data is acquired, and stop line coordinates of an intersection, coordinates and range of a lane, and information of the lane are input into the three-dimensional coordinate system.
Preferably, the vehicle trajectory data includes: the ID of the vehicle, the speed of the vehicle, the acceleration of the vehicle, the distance of the vehicle from the stop line; the yellow light starting signal specifically comprises real-time phase information of the intersection, namely the current phase and the duration time of the current phase.
Preferably, the track prediction model in step 3 is established according to historical vehicle track data, and the establishment of the track prediction model comprises the following steps:
step 3.1, collecting historical vehicle track data within 3s of yellow light time to form a vehicle track data set A;
step 3.2, carrying out clustering analysis on the vehicle track data set A to obtain clustering center track data; dividing the data of the vehicle track data set A into i types according to the clustering result, taking the i types as i track labels, wherein each type corresponds to one track label;
3.3, dividing the vehicle track data set A into a training set B and a testing set C, taking the track data of the training set B and a track label corresponding to each track as input, and establishing a convolutional neural network learning model to learn the historical vehicle track data and the label corresponding to the historical vehicle track data;
and 3.4, training the model until the model is tested by using the test set C, and if the test value reaches the expected accuracy, finishing the establishment of the track prediction model.
Preferably, the vehicle trajectory data or historical vehicle trajectory data is divided into a straight-driving vehicle data set, and/or a left-turning vehicle data set, and/or a right-turning vehicle data set.
Preferably, the step 3 specifically includes the following steps:
inputting vehicle track data acquired within the first 1.5s of the yellow light time into a track prediction model established in advance, and predicting by the track prediction model to acquire a track label to which the track data belong; according to the predicted track label, selecting the track data 1.5s behind the yellow light of the cluster center track data of the category corresponding to the track label, namely the predicted track data 1.5s behind the yellow light of the vehicle, and then judging the passing trend of the vehicle after the yellow light is finished and predicting the track data of the vehicle at the stop line by the track data.
Preferably, the 3D lidar obtains whether a single vehicle passes through or a vehicle queue passes through each lane of the entrance lane at the time by detecting the vehicle at the entrance lane of the intersection, and the prediction in step 3 is divided into two situations, namely single vehicle passing prediction and vehicle queue passing prediction;
the specific prediction process for a single vehicle is as follows: after receiving a yellow light starting signal, judging the phase position of the yellow light at the moment, wherein different phases need to predict and judge the corresponding lane vehicle; if the yellow light is in the straight-going phase, after the starting signal of the yellow light is received, the system only needs to predict and judge the vehicles on the straight-going lane; if the vehicle is a yellow light with a special left-turn phase, after receiving a starting signal of the yellow light, only the vehicle on the left-turn lane needs to be predicted and judged at the moment;
the specific prediction process for the vehicle queue is as follows: when the 3D laser radar collects vehicle track data, all vehicles are collected integrally; when each vehicle is predicted and judged to break in, the vehicle is predicted and judged one by one from the first vehicle in the vehicle queue; when the vehicles are judged one by one, if a certain vehicle is judged not to break into the intersection when the yellow light is finished, all vehicles in the queue behind the vehicle are judged not to break into the intersection when the yellow light is finished.
Preferably, the specific content of predicting the travel time of all vehicles intruding into the intersection in the intersection as a result of prediction is as follows:
in the range of an entrance lane, after a red light is turned on after a yellow light of the current phase is turned off, vehicle data of an intersection can be entered, and according to a lane where the vehicle is located, a running track and running time of the vehicle in the intersection are predicted; if the vehicle is on a straight road, the driving track of the vehicle is predicted to be straight and pass through the intersection and leave; if the vehicle is in the left-turn lane, the driving track of the vehicle is predicted to be that the vehicle turns left to turn into the left road lane and leaves the intersection;
based on the predicted speed of the vehicle entering the intersection at the yellow light ending time and the predicted running track of the vehicle within the range of the intersection, the running time of the vehicle in the intersection can be predicted by assuming that the vehicle runs through the intersection at a constant speed at the predicted speed of the vehicle entering the intersection at the yellow light ending time; and comparing and predicting the driving time of each vehicle in the intersection to obtain the maximum time t for the intruding vehicle to drive away from the intersection.
Preferably, the specific content of adjusting the total red time of the intersection is as follows:
and setting the time t as new full red time according to the obtained maximum time t for the rushing-in vehicle to drive away from the intersection, so that the last rushing-in vehicle driving away from the intersection can be ensured to drive away from the intersection within the full red time, and the purposes of timely emptying vehicles within the range of the intersection and reducing traffic conflicts among vehicles with different phases are achieved.
The invention also aims to provide a signal control intersection emptying system based on the laser radar and the track prediction, which comprises a detection module, a data processing module, a data prediction module and a signal control management module;
the detection module is used for acquiring vehicle track data at an entrance road of an urban intersection;
the data processing module is used for analyzing and processing the acquired vehicle track data;
the data prediction module is used for predicting the running track of the vehicle, judging whether the vehicle breaks into the intersection or not and predicting the running time of the broken-in vehicle in the intersection;
and the signal control management module is used for acquiring signal lamp information and adjusting the full red time of the signal lamp.
The signal control intersection emptying method and system based on the laser radar and the track prediction have the following beneficial effects:
the equipment used for detecting the vehicle track data by the method is 3D laser radar detection equipment fixed on the side of an entrance road, adopts historical and real-time radar data, and has the advantages of reasonable cost, high accuracy, low operation requirement, adaptability to all-weather road environments and the like. The real-time running track of the motor vehicle with high precision can be obtained, and meanwhile, compared with other detection means such as video detection, the processing efficiency of the information processing of the laser radar is higher, so that the real-time track prediction can be realized, and the analysis processing can be made in time. Therefore, the driving behavior of the vehicle at the intersection in the phase change period can be accurately, efficiently, stably and all-weather detected.
The invention provides a set of complete schemes from prediction to prevention and control for the traffic safety problem of vehicle intrusion during the phase change of the signal lamps of the urban signal control intersection. According to the scheme, the dangerous behaviors of the traffic signal during the phase change period can be stably, accurately and efficiently identified and predicted, and the aim of timely emptying vehicles in the intersection range and reducing traffic conflicts is fulfilled by adjusting the full red time of the intersection signal lamp on the basis. The potential safety hazards of the vehicles during phase change of the intersection can be further reduced, the accidents at the intersection are reduced, and the operation safety level of the urban road is improved.
In the detection means, the continuous track of the vehicle can be accurately acquired only according to the data acquired by the 3D laser radar, so that subsequent analysis and prediction can be carried out, and dependence on vehicle-side equipment such as a high-precision GPS (global positioning system) is not required; in the aspect of prevention and control measures, only one adjusting module for the full red time needs to be added on the basis of the existing intersection communication and control system, and extra complicated attachments are not needed. Therefore, the required cost of the equipment is low, and the adaptability to the existing traffic environment is higher.
Drawings
In order to more clearly illustrate the embodiments of the present invention and the design thereof, the drawings required for the embodiments will be briefly described below. The drawings in the following description are only some embodiments of the invention and it will be clear to a person skilled in the art that other drawings can be derived from them without inventive effort.
Fig. 1 is a schematic work flow diagram of a signal control intersection emptying method based on laser radar and trajectory prediction in embodiment 1 of the present invention.
Fig. 2 is a flowchart of establishing a trajectory prediction model according to an embodiment of the present invention.
Detailed Description
In order that those skilled in the art will better understand the technical solutions of the present invention and can practice the same, the present invention will be described in detail with reference to the accompanying drawings and specific examples. The following examples are only for illustrating the technical solutions of the present invention more clearly, and the protection scope of the present invention is not limited thereby.
Example 1
The invention provides a signal control intersection emptying system based on 3d laser radar detection and vehicle track prediction for overcoming the safety problem existing at a road intersection. The system comprises a detection module, a data processing module, a data prediction module and a signal control management module; the detection module acquires vehicle track data at an entrance road by using a 3D laser radar, so that the detection is more accurate, stable and efficient; the data processing module is used for analyzing and processing the acquired vehicle track data; the data prediction module is used for predicting the running track of the vehicle, judging whether the vehicle breaks into the intersection or not and predicting the running time of the broken-in vehicle in the intersection; and the signal control management module is used for acquiring signal lamp information and adjusting the full red time of the signal lamp.
Based on a general inventive concept, the invention also provides a signal control intersection emptying method based on 3D laser radar detection and vehicle track prediction, the method fully utilizes the data detected by the 3D laser radar, and utilizes the kinematic characteristics and the track prediction of the vehicle to realize the real-time detection of the vehicle about to enter the intersection in the duration of the yellow light and the prediction of whether the vehicle enters the intersection after the yellow light finishes entering the intersection, and then the purposes of emptying the vehicle in the intersection range in time and reducing traffic conflicts are achieved by adjusting the full red time of the signal lamps of the intersection. Therefore, a complete solution is provided for actively identifying and controlling the motor vehicle intrusion behavior during the phase change of the signal lamp of the urban road intersection, the detection is accurate, stable and efficient, the cost is low, and the adaptability is good. As shown in fig. 1, the method includes the following steps:
step 1, sensing a vehicle about to enter an intersection by using a 3D laser radar installed at an entrance lane of the urban intersection, and detecting and acquiring vehicle track data through the 3D laser radar; specifically, in this embodiment, the vehicle trajectory data includes: information such as the ID of the vehicle, the speed of the vehicle, the acceleration of the vehicle, and the distance from the vehicle to the stop line; the vehicle track data or the historical vehicle track data are divided into a straight-going vehicle data set and/or a left-turning vehicle data set and/or a right-turning vehicle data set;
the 3D laser radar can be installed on the side of an inlet road or a portal frame and a sign rod piece, a certain installation height needs to be guaranteed, and the shielding of green plants, sign boards and the like is avoided by the height requirement. And then the 3D laser radar detects and senses the vehicles in the range of the entrance way, and the function is completed through a detection module of the system.
Step 2, mapping vehicle track data obtained by the detection of the 3D laser radar into a three-dimensional coordinate system within the range of an entrance lane, and classifying the vehicles according to lanes where the vehicles are located; the method comprises the steps that a three-dimensional coordinate system is established before vehicle track data are obtained, and stop line coordinates of an intersection, coordinates and ranges of lanes and information of the lanes are input into the three-dimensional coordinate system;
by establishing a three-dimensional coordinate system within the range of the entrance lane, coordinates of the stop line, coordinates and range of the lane, information of the lane are input in advance in the coordinate system. The 3D laser radar obtains the coordinates of the vehicle relative to the radar by sensing the vehicle, maps the coordinates in the established coordinate system, and classifies the vehicle according to the lane where the vehicle is located. The real-time running speed and acceleration information of the vehicle can be obtained by endowing each vehicle with ID (identity), timestamp information and the moving position of the vehicle in a certain time interval, and the function is completed by a data processing module of the system.
Step 3, after receiving the yellow light starting signal, inputting vehicle track data acquired within the first 1.5s of the yellow light time into a track prediction model, judging the vehicle track data within the first 1.5s of the yellow light time through the track prediction model, and predicting the vehicle track data within 1.5s after the yellow light time according to a judgment result;
in this embodiment, the yellow light starting signal specifically includes real-time phase information of the intersection, that is, the current phase and the duration time of the current phase; through the information, the system can selectively predict and judge vehicles of different types;
specifically, after receiving the yellow light starting signal, the phase to which the yellow light belongs is judged, and the vehicles in different lanes are predicted and judged based on different phases. If the yellow light is in the straight-going phase, after the starting signal of the yellow light is received, the system only needs to predict and judge the vehicles on the straight-going lane; if the vehicle is a yellow light with a special left-turn phase, after the starting signal of the yellow light is received, the system only needs to predict and judge the vehicle on the left-turn lane. The system predicts the passing trend of the vehicle after the yellow light is finished based on the vehicle track data acquired in the first 1.5s of the yellow light time.
The system starts from the first vehicle in the vehicle queue and predicts and judges one by one. When the system judges one vehicle by one, if a certain vehicle is judged not to break into the intersection when the yellow light is finished, all vehicles in a queue behind the vehicle are judged not to break into the intersection when the yellow light is finished;
step 4, judging whether the vehicle rushes into the intersection after the yellow light is finished and the red light is turned on according to vehicle track data which is 1.5s after the yellow light time; if yes, continuing to predict the running time of all vehicles with the prediction results of the vehicles entering the intersection in the intersection, and further screening to obtain the maximum time for the vehicles entering the intersection to drive away from the intersection; if not, returning to the step 1 to continue detection;
the driving time of the vehicle in the intersection refers to the time from the time when the vehicle enters the intersection at the end of the yellow light to the time when the vehicle leaves the intersection;
specifically, in this embodiment, the specific contents of predicting the travel time of all vehicles intruding into the intersection in the intersection as the prediction results are as follows:
in the range of an entrance lane, after a red light is turned on after a yellow light of the current phase is turned off, vehicle data of an intersection can be entered, and according to a lane where the vehicle is located, a running track and running time of the vehicle in the intersection are predicted; if the vehicle is on a straight road, the driving track of the vehicle is predicted to be straight and pass through the intersection and leave; if the vehicle is in the left-turn lane, the driving track of the vehicle is predicted to be that the vehicle turns left to turn into the left road lane and leaves the intersection;
based on the predicted speed of the vehicle entering the intersection at the yellow light ending time and the predicted running track of the vehicle within the range of the intersection, the running time of the vehicle in the intersection can be predicted by assuming that the vehicle runs through the intersection at a constant speed at the predicted speed of the vehicle entering the intersection at the yellow light ending time; and comparing and predicting the driving time of each vehicle in the intersection to obtain the maximum time t for the intruding vehicle to drive away from the intersection.
And 5, adjusting the full red time of the intersection according to the obtained maximum time for the rushing-in vehicle to drive away from the intersection, specifically, setting the time t as a new full red time according to the obtained maximum time t for the rushing-in vehicle to drive away from the intersection, so that the last rushing-in vehicle driving away from the intersection can drive away from the intersection within the full red time, and the purposes of timely emptying vehicles within the range of the intersection and reducing traffic conflicts among vehicles with different phases are achieved.
Specifically, in this embodiment, the trajectory prediction model in step 3 is established according to historical vehicle trajectory data, and as shown in fig. 2, the establishment of the trajectory prediction model includes the following steps:
step 3.1, collecting historical vehicle track data within 3s of yellow light time to form a vehicle track data set A;
step 3.2, carrying out clustering analysis on the vehicle track data set A (the data volume is large enough, K-Means or DBSCAN) to obtain clustering center track data; dividing the data of the vehicle track data set A into i types according to the clustering result (the specific value of i is based on the clustering result, and each intersection is different), taking the i types as i track labels, and enabling each type to correspond to one track label;
3.3, dividing the vehicle track data set A into a training set B and a testing set C, taking the track data of the training set B and a track label corresponding to each track as input, and establishing a Convolutional Neural Network (CNN) learning model to learn the historical track data and the track label corresponding to the historical track data;
and 3.4, training the model until the model is tested by using the test set C, and establishing the track prediction model when the test value reaches the expected accuracy.
In the building process, vehicle track data within 1.5s before a yellow light of the track data are extracted as input, the track data within the last 1.5s are taken as results, each piece of data is given an explicit label, and a supervised learning process is built.
Based on the above trajectory prediction model, in this embodiment, step 3 specifically includes the following steps:
inputting vehicle track data acquired within the first 1.5s of the yellow light time into a track prediction model established in advance, wherein the track prediction model can predict and acquire a track label to which the track data belong; according to the predicted track label, selecting the track data 1.5s behind the yellow light of the cluster center track data (3s) of the category corresponding to the track label, namely the predicted track data 1.5s behind the yellow light of the vehicle, and then judging the passing trend of the vehicle after the yellow light is finished and predicting the track data of the vehicle at the stop line by the track data.
Specifically, in the embodiment, the 3D laser radar detects the vehicles at the entrance lane of the intersection to know whether the vehicles pass through the entrance lane or the vehicle queue at the time, and the prediction in step 3 is divided into two situations, namely single vehicle passing prediction and vehicle queue passing prediction;
the specific prediction process for a single vehicle is as follows: after receiving a yellow light starting signal, judging the phase position of the yellow light at the moment, wherein different phases need to predict and judge the corresponding lane vehicle; if the yellow light is in the straight-going phase, after the starting signal of the yellow light is received, the system only needs to predict and judge the vehicles on the straight-going lane; if the vehicle is a yellow light with a special left-turn phase, after receiving a starting signal of the yellow light, only the vehicle on the left-turn lane needs to be predicted and judged at the moment;
the specific prediction process for the vehicle queue is as follows: when the 3D laser radar collects vehicle track data, all vehicles are collected integrally; when each vehicle is predicted and judged to break in, the vehicle is predicted and judged one by one from the first vehicle in the vehicle queue; when the vehicles are judged one by one, if a certain vehicle is judged not to break into the intersection when the yellow light is finished, all vehicles in the queue behind the vehicle are judged not to break into the intersection when the yellow light is finished.
Based on a high-precision 3D laser radar detection technology and a vehicle track prediction technology, the method helps to identify dangerous behaviors during the phase change of traffic signals, predict the dangerous behaviors in real time and adjust the full red time in time, and achieves the purposes of emptying vehicles in the range of an intersection in time and reducing traffic conflicts. And then the phase change of the vehicle at the intersection can be reduced, the traffic hidden trouble existing in the signal control intersection can be effectively prevented and solved, and the driving safety of the driver in the intersection range can be improved.
The above-mentioned embodiments are only preferred embodiments of the present invention, and the scope of the present invention is not limited thereto, and any simple modifications or equivalent substitutions of the technical solutions that can be obviously obtained by those skilled in the art within the technical scope of the present invention are included in the scope of the present invention.
Claims (10)
1. A signal control intersection emptying method based on laser radar and track prediction is characterized by comprising the following steps:
step 1, sensing a vehicle about to enter an intersection by using a 3D laser radar installed at an entrance lane of the urban intersection, and detecting and acquiring vehicle track data through the 3D laser radar;
step 2, mapping vehicle track data obtained by the 3D laser radar detection into a three-dimensional coordinate system within the range of an entrance lane, and classifying the vehicles according to lanes where the vehicles are located;
step 3, after receiving a yellow light starting signal, inputting vehicle track data acquired within the first 1.5s of the yellow light time into a track prediction model, judging the vehicle track data within the first 1.5s of the yellow light time through the track prediction model, and predicting the vehicle track data within 1.5s after the yellow light time according to a judgment result;
step 4, judging whether the vehicle rushes into the intersection after the yellow light is finished and the red light is turned on according to vehicle track data which is 1.5s after the yellow light time; if yes, continuing to predict the running time of all vehicles with the prediction results of the vehicles entering the intersection in the intersection, and further screening to obtain the maximum time for the vehicles entering the intersection to drive away from the intersection; if not, returning to the step 1 to continue detection;
the driving time of the vehicle in the intersection refers to the time from the time when the vehicle enters the intersection at the end of the yellow light to the time when the vehicle leaves the intersection;
and 5, adjusting the full red time of the intersection according to the obtained maximum time for the break-in vehicle to drive away from the intersection.
2. The signal control intersection emptying method based on the laser radar and the track prediction as claimed in claim 1, characterized in that the three-dimensional coordinate system is established before the vehicle track data is acquired, and stop line coordinates of an intersection, coordinates and range of a lane and information of the lane are input into the three-dimensional coordinate system.
3. The method for emptying a signalized intersection based on lidar and trajectory prediction according to claim 1, wherein the vehicle trajectory data comprises: the ID of the vehicle, the speed of the vehicle, the acceleration of the vehicle, the distance of the vehicle from the stop line; the yellow light starting signal specifically comprises real-time phase information of the intersection, namely the current phase and the duration time of the current phase.
4. The signal control intersection emptying method based on the laser radar and the track prediction as claimed in claim 1, wherein the track prediction model in the step 3 is established according to historical vehicle track data, and the establishment of the track prediction model comprises the following steps:
step 3.1, collecting historical vehicle track data within 3s of yellow light time to form a vehicle track data set A;
step 3.2, carrying out clustering analysis on the vehicle track data set A to obtain clustering center track data; dividing the data of the vehicle track data set A into i types according to the clustering result, taking the i types as i track labels, wherein each type corresponds to one track label;
3.3, dividing the vehicle track data set A into a training set B and a testing set C, taking the track data of the training set B and a track label corresponding to each track as input, and establishing a convolutional neural network learning model to learn the historical vehicle track data and the label corresponding to the historical vehicle track data;
and 3.4, training the model until the model is tested by using the test set C, and if the test value reaches the expected accuracy, finishing the establishment of the track prediction model.
5. The method for emptying signalized intersections based on lidar and trajectory prediction according to claim 4, wherein the vehicle trajectory data or historical vehicle trajectory data are each divided into a straight-going vehicle data set, and/or a left-turning vehicle data set, and/or a right-turning vehicle data set.
6. The signal-controlled intersection emptying method based on the lidar and the track prediction as claimed in claim 5, wherein the step 3 specifically comprises the following steps:
inputting vehicle track data acquired within the first 1.5s of the yellow light time into a track prediction model established in advance, and predicting by the track prediction model to acquire a track label to which the track data belong; according to the predicted track label, selecting the track data 1.5s behind the yellow light of the cluster center track data of the category corresponding to the track label, namely the predicted track data 1.5s behind the yellow light of the vehicle, and then judging the passing trend of the vehicle after the yellow light is finished and predicting the track data of the vehicle at the stop line by the track data.
7. The signal control intersection emptying method based on the laser radar and the track prediction is characterized in that the 3D laser radar obtains whether a single vehicle passes or a vehicle queue passes in each lane of an entrance way at the moment through detection of the vehicle at the entrance way of the intersection, and the prediction of the step 3 is divided into two situations of single vehicle passing prediction and vehicle queue passing prediction;
the specific prediction process for a single vehicle is as follows: after receiving a yellow light starting signal, judging the phase position of the yellow light at the moment, wherein different phases need to predict and judge the corresponding lane vehicle; if the yellow light is in the straight-going phase, after the starting signal of the yellow light is received, the system only needs to predict and judge the vehicles on the straight-going lane; if the vehicle is a yellow light with a special left-turn phase, after receiving a starting signal of the yellow light, only the vehicle on the left-turn lane needs to be predicted and judged at the moment;
the specific prediction process for the vehicle queue is as follows: when the 3D laser radar collects vehicle track data, all vehicles are collected integrally; when each vehicle is predicted and judged to break in, the vehicle is predicted and judged one by one from the first vehicle in the vehicle queue; when the vehicles are judged one by one, if a certain vehicle is judged not to break into the intersection when the yellow light is finished, all vehicles in the queue behind the vehicle are judged not to break into the intersection when the yellow light is finished.
8. The signal control intersection emptying method based on the laser radar and the track prediction as claimed in claim 7, wherein the specific contents of predicting the running time of all vehicles which break into the intersection in the intersection are as follows:
in the range of an entrance lane, after a red light is turned on after a yellow light of the current phase is turned off, vehicle data of an intersection can be entered, and according to a lane where the vehicle is located, a running track and running time of the vehicle in the intersection are predicted; if the vehicle is on a straight road, the driving track of the vehicle is predicted to be straight and pass through the intersection and leave; if the vehicle is in the left-turn lane, the driving track of the vehicle is predicted to be that the vehicle turns left to turn into the left road lane and leaves the intersection;
based on the predicted speed of the vehicle entering the intersection at the yellow light ending time and the predicted running track of the vehicle within the range of the intersection, the vehicle is assumed to run through the intersection at a constant speed at the predicted speed of the vehicle entering the intersection at the yellow light ending time, so that the running time of the vehicle in the intersection is predicted; and comparing and predicting the driving time of each vehicle in the intersection to obtain the maximum time t for the intruding vehicle to drive away from the intersection.
9. The signal control intersection emptying method based on the laser radar and the track prediction as claimed in claim 8, wherein the specific content of adjusting the total red time of the intersection is as follows:
and setting the time t as new full red time according to the obtained maximum time t for the rushing-in vehicle to drive away from the intersection, thereby ensuring that the last rushing-in vehicle driving away from the intersection drives away from the intersection within the full red time.
10. A signal control intersection emptying system based on laser radar and track prediction is characterized by comprising a detection module, a data processing module, a data prediction module and a signal control management module;
the detection module is used for acquiring vehicle track data at an entrance road of an urban intersection;
the data processing module is used for analyzing and processing the acquired vehicle track data;
the data prediction module is used for predicting the running track of the vehicle, judging whether the vehicle breaks into the intersection or not and predicting the running time of the broken-in vehicle in the intersection;
and the signal control management module is used for acquiring signal lamp information and adjusting the full red time of the signal lamp.
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110379124.5A CN113112830B (en) | 2021-04-08 | 2021-04-08 | Signal control intersection emptying method and system based on laser radar and track prediction |
| US17/620,674 US20240046787A1 (en) | 2021-04-08 | 2021-09-09 | Method And System For Traffic Clearance At Signalized Intersections Based On Lidar And Trajectory Prediction |
| PCT/CN2021/117350 WO2022213542A1 (en) | 2021-04-08 | 2021-09-09 | Method and system for clearing information-controlled intersection on basis of lidar and trajectory prediction |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110379124.5A CN113112830B (en) | 2021-04-08 | 2021-04-08 | Signal control intersection emptying method and system based on laser radar and track prediction |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113112830A true CN113112830A (en) | 2021-07-13 |
| CN113112830B CN113112830B (en) | 2021-12-17 |
Family
ID=76714666
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110379124.5A Active CN113112830B (en) | 2021-04-08 | 2021-04-08 | Signal control intersection emptying method and system based on laser radar and track prediction |
Country Status (3)
| Country | Link |
|---|---|
| US (1) | US20240046787A1 (en) |
| CN (1) | CN113112830B (en) |
| WO (1) | WO2022213542A1 (en) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113990064A (en) * | 2021-09-14 | 2022-01-28 | 北京无限感测科技有限公司 | Traffic data acquisition method, system and computer readable storage medium |
| WO2022213542A1 (en) * | 2021-04-08 | 2022-10-13 | 同济大学 | Method and system for clearing information-controlled intersection on basis of lidar and trajectory prediction |
| CN115547064A (en) * | 2022-09-06 | 2022-12-30 | 智慧互通科技股份有限公司 | Periodic lost time calculation method and system based on radar fusion |
| EP4156143A1 (en) * | 2021-09-24 | 2023-03-29 | Autonomous A2Z | Method for predicting traffic light information by using lidar and server using the same |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN118038704B (en) * | 2024-04-11 | 2024-07-05 | 泉州师范学院 | Path prediction method and system |
Citations (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102298846A (en) * | 2010-06-25 | 2011-12-28 | 建程科技股份有限公司 | Real-time traffic sign control method of group intersection and method for predicting needed green time |
| CN103065477A (en) * | 2012-12-20 | 2013-04-24 | 北京交通大学 | Full red signal setup system with dynamic time length adjusting function and method |
| CN105809958A (en) * | 2016-03-29 | 2016-07-27 | 中国科学院深圳先进技术研究院 | Traffic control method and system based on intersection group |
| CN106683449A (en) * | 2017-02-14 | 2017-05-17 | 武汉理工大学 | Dynamic green-light interval time adjustment method of traffic control system under vehicular access cooperation environment |
| CN106710250A (en) * | 2016-12-28 | 2017-05-24 | 北京博研智通科技有限公司 | Traffic signal control method and system for preventing intersection congestion when visibility is low |
| CN108755308A (en) * | 2018-06-01 | 2018-11-06 | 公安部交通管理科学研究所 | A kind of intersection traffic organization method and system used based on track dynamic |
| CN109559528A (en) * | 2019-01-18 | 2019-04-02 | 吉林大学 | It is a kind of based on 3D laser radar from perception interactive formula traffic-control unit |
| US20190122547A1 (en) * | 2017-09-07 | 2019-04-25 | Toyota Motor Engineering & Manufacturing North America, Inc. | Traffic signal learning and optimization |
| US20190347933A1 (en) * | 2018-05-11 | 2019-11-14 | Virtual Traffic Lights, LLC | Method of implementing an intelligent traffic control apparatus having a reinforcement learning based partial traffic detection control system, and an intelligent traffic control apparatus implemented thereby |
| CN111681433A (en) * | 2020-05-14 | 2020-09-18 | 黄传明 | Intersection traffic signal lamp timing optimization method and device |
| CN111862602A (en) * | 2020-06-24 | 2020-10-30 | 南京理工大学 | Single-intersection signal timing optimization method based on track data |
| CN112562329A (en) * | 2020-11-28 | 2021-03-26 | 山西省交通科技研发有限公司 | Traffic event sensing method based on millimeter wave radar data |
Family Cites Families (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9396653B2 (en) * | 2012-06-01 | 2016-07-19 | Aeio Group Inc. | Method and system for traffic resources allocation |
| CN103198686B (en) * | 2013-03-26 | 2015-04-01 | 东南大学 | Vehicle speed induction control method for reducing probability that vehicle breaks yellow light |
| CN106327886B (en) * | 2016-08-29 | 2018-10-23 | 安徽科力信息产业有限责任公司 | Reduce the method and system that non-motor vehicle influences plane perceptual signal control efficiency |
| JP7276311B2 (en) * | 2018-02-23 | 2023-05-18 | 住友電気工業株式会社 | TRAFFIC SIGNAL CONTROL DEVICE, TRAFFIC SIGNAL CONTROL METHOD, AND COMPUTER PROGRAM |
| US10916152B2 (en) * | 2019-07-01 | 2021-02-09 | Honeywell International Inc. | Collision awareness system for ground operations |
| KR20210077046A (en) * | 2019-12-16 | 2021-06-25 | 현대자동차주식회사 | System and method for controlling operation of autonomous vehicle |
| EP4233027A4 (en) * | 2020-10-20 | 2024-08-28 | Thrugreen Llc | Probabilistically adaptive traffic management system |
| US20220161830A1 (en) * | 2020-11-23 | 2022-05-26 | Lyft, Inc. | Dynamic Scene Representation |
| CN113112830B (en) * | 2021-04-08 | 2021-12-17 | 同济大学 | Signal control intersection emptying method and system based on laser radar and track prediction |
| US11731630B2 (en) * | 2021-04-27 | 2023-08-22 | Ford Global Technologies, Llc | Methods and systems for asserting right of way for traversing an intersection |
-
2021
- 2021-04-08 CN CN202110379124.5A patent/CN113112830B/en active Active
- 2021-09-09 WO PCT/CN2021/117350 patent/WO2022213542A1/en active Application Filing
- 2021-09-09 US US17/620,674 patent/US20240046787A1/en not_active Abandoned
Patent Citations (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102298846A (en) * | 2010-06-25 | 2011-12-28 | 建程科技股份有限公司 | Real-time traffic sign control method of group intersection and method for predicting needed green time |
| CN103065477A (en) * | 2012-12-20 | 2013-04-24 | 北京交通大学 | Full red signal setup system with dynamic time length adjusting function and method |
| CN105809958A (en) * | 2016-03-29 | 2016-07-27 | 中国科学院深圳先进技术研究院 | Traffic control method and system based on intersection group |
| CN106710250A (en) * | 2016-12-28 | 2017-05-24 | 北京博研智通科技有限公司 | Traffic signal control method and system for preventing intersection congestion when visibility is low |
| CN106683449A (en) * | 2017-02-14 | 2017-05-17 | 武汉理工大学 | Dynamic green-light interval time adjustment method of traffic control system under vehicular access cooperation environment |
| US20190122547A1 (en) * | 2017-09-07 | 2019-04-25 | Toyota Motor Engineering & Manufacturing North America, Inc. | Traffic signal learning and optimization |
| US20190347933A1 (en) * | 2018-05-11 | 2019-11-14 | Virtual Traffic Lights, LLC | Method of implementing an intelligent traffic control apparatus having a reinforcement learning based partial traffic detection control system, and an intelligent traffic control apparatus implemented thereby |
| CN108755308A (en) * | 2018-06-01 | 2018-11-06 | 公安部交通管理科学研究所 | A kind of intersection traffic organization method and system used based on track dynamic |
| CN109559528A (en) * | 2019-01-18 | 2019-04-02 | 吉林大学 | It is a kind of based on 3D laser radar from perception interactive formula traffic-control unit |
| CN111681433A (en) * | 2020-05-14 | 2020-09-18 | 黄传明 | Intersection traffic signal lamp timing optimization method and device |
| CN111862602A (en) * | 2020-06-24 | 2020-10-30 | 南京理工大学 | Single-intersection signal timing optimization method based on track data |
| CN112562329A (en) * | 2020-11-28 | 2021-03-26 | 山西省交通科技研发有限公司 | Traffic event sensing method based on millimeter wave radar data |
Non-Patent Citations (1)
| Title |
|---|
| 王俊骅,等: "干线公路交叉口右转车辆与非机动车冲突精细化治理实例", 《汽车与安全》 * |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2022213542A1 (en) * | 2021-04-08 | 2022-10-13 | 同济大学 | Method and system for clearing information-controlled intersection on basis of lidar and trajectory prediction |
| CN113990064A (en) * | 2021-09-14 | 2022-01-28 | 北京无限感测科技有限公司 | Traffic data acquisition method, system and computer readable storage medium |
| EP4156143A1 (en) * | 2021-09-24 | 2023-03-29 | Autonomous A2Z | Method for predicting traffic light information by using lidar and server using the same |
| US20230098014A1 (en) * | 2021-09-24 | 2023-03-30 | Autonomous A2Z | Method for Predicting Traffic Light Information by Using Lidar and Server Using the Same |
| US11643093B2 (en) * | 2021-09-24 | 2023-05-09 | Autonmous A2Z | Method for predicting traffic light information by using lidar and server using the same |
| CN115547064A (en) * | 2022-09-06 | 2022-12-30 | 智慧互通科技股份有限公司 | Periodic lost time calculation method and system based on radar fusion |
Also Published As
| Publication number | Publication date |
|---|---|
| CN113112830B (en) | 2021-12-17 |
| US20240046787A1 (en) | 2024-02-08 |
| WO2022213542A1 (en) | 2022-10-13 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN113112830B (en) | Signal control intersection emptying method and system based on laser radar and track prediction | |
| US11990036B2 (en) | Driver behavior monitoring | |
| US20240290201A1 (en) | Driver behavior monitoring | |
| US10957201B2 (en) | System and method for relative positioning based safe autonomous driving | |
| JP7266627B2 (en) | Early warning methods, devices, electronic devices, recording media and computer program products | |
| CN118447688A (en) | System and method for using V2X and sensor data | |
| CN114385661A (en) | High-precision map updating system based on V2X technology | |
| US10930145B2 (en) | Traffic system for predicting and providing traffic signal switching timing | |
| CN112606831A (en) | Anti-collision warning information external interaction method and system for passenger car | |
| CN107564336B (en) | Signalized intersection left turn conflict early warning system and early warning method | |
| CN112907955A (en) | Evaluation method of vehicle-road cooperative system based on information fusion | |
| CN114283617A (en) | Intersection anti-collision warning system based on pedestrian tracking algorithm | |
| CN111798579A (en) | ETC portal frame-based highway congestion prediction method and system | |
| US20230033314A1 (en) | Method and processor circuit for operating an automated driving function with object classifier in a motor vehicle, as well as the motor vehicle | |
| CN112927514B (en) | Motor vehicle yellow light running behavior prediction method and system based on 3D laser radar | |
| CN116434520A (en) | Pedestrian crossing collision risk early warning method and system based on holographic sensing | |
| CN113128847A (en) | Entrance ramp real-time risk early warning system and method based on laser radar | |
| CN110910644A (en) | Intersection vehicle identification and safety early warning system | |
| CN114241764B (en) | Bus accurate data fusion center system and method based on bus-road cooperation technology | |
| CN118470977B (en) | Traffic safety early warning system and traffic safety early warning method in man-machine mixed driving environment | |
| Li et al. | Research on Characteristics of Hesitant Driving Behavior in Urban Expressway Diversion Areas | |
| CN117789526A (en) | Warning method for urban suburb intersection without signal lamp | |
| CN116580576A (en) | Intelligent information processing method and intelligent information processing terminal | |
| KR20240107638A (en) | Local server and method for managing road traffic | |
| KR20230168381A (en) | Emergency Response Traffic Signal Control System |
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 |