CN111489585A - Vehicle and pedestrian collision avoidance method based on edge calculation - Google Patents
Vehicle and pedestrian collision avoidance method based on edge calculation Download PDFInfo
- Publication number
- CN111489585A CN111489585A CN202010143534.5A CN202010143534A CN111489585A CN 111489585 A CN111489585 A CN 111489585A CN 202010143534 A CN202010143534 A CN 202010143534A CN 111489585 A CN111489585 A CN 111489585A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- pedestrian
- collision
- noise
- matrix
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 37
- 238000004364 calculation method Methods 0.000 title claims abstract description 15
- 238000004891 communication Methods 0.000 claims abstract description 18
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 15
- 238000001914 filtration Methods 0.000 claims abstract description 8
- 239000011159 matrix material Substances 0.000 claims description 45
- 238000005259 measurement Methods 0.000 claims description 24
- 230000001133 acceleration Effects 0.000 claims description 15
- 238000012545 processing Methods 0.000 claims description 14
- 238000013179 statistical model Methods 0.000 claims description 9
- 230000007704 transition Effects 0.000 claims description 9
- 230000000694 effects Effects 0.000 claims description 6
- 238000013507 mapping Methods 0.000 claims description 6
- 238000012546 transfer Methods 0.000 claims description 6
- 101000802640 Homo sapiens Lactosylceramide 4-alpha-galactosyltransferase Proteins 0.000 claims description 3
- 102100035838 Lactosylceramide 4-alpha-galactosyltransferase Human genes 0.000 claims description 3
- 238000012937 correction Methods 0.000 claims description 3
- 230000001419 dependent effect Effects 0.000 claims description 3
- 230000004927 fusion Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 230000009897 systematic effect Effects 0.000 claims description 3
- 238000004088 simulation Methods 0.000 abstract description 2
- 230000000007 visual effect Effects 0.000 abstract 2
- 238000001514 detection method Methods 0.000 abstract 1
- 230000010267 cellular communication Effects 0.000 description 3
- 230000000052 comparative effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000001413 cellular effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/164—Centralised systems, e.g. external to vehicles
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W24/00—Supervisory, monitoring or testing arrangements
- H04W24/06—Testing, supervising or monitoring using simulated traffic
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/40—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P]
- H04W4/44—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P] for communication between vehicles and infrastructures, e.g. vehicle-to-cloud [V2C] or vehicle-to-home [V2H]
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
Abstract
The invention discloses a vehicle and pedestrian collision avoidance method based on edge calculation, which belongs to the field of Internet of things, and is characterized in that under the environment of edge calculation, communication between a vehicle and pedestrian equipment is realized through an edge server, communication delay is reduced, the position of the vehicle is predicted by Kalman filtering, the pedestrian track is predicted by using a sensor on the pedestrian equipment, the limitation of visual range is overcome, the collision detection precision is improved, the method is suitable for most non-visual range (N L OS) scenes, a collision risk model based on collision time (TTC) is established according to the relative motion relationship between the vehicle and the pedestrian, and simulation results show that the collision avoidance algorithm provided by the invention can effectively reduce the collision risk of the vehicle and the pedestrian.
Description
Technical Field
The invention relates to the technical field of Internet of things, in particular to a vehicle and pedestrian collision avoidance method based on edge calculation.
Background
In 2017, Hassan Artail proposes a scheme for realizing pedestrian and vehicle communication by using a cellular technology in Avoding car-pedestrian communication using a VANETto cellular communication frame, so as to detect possible vehicle and pedestrian collision. In the technical scheme, the remote cloud server is used as the intermediate server to indirectly realize the communication between the vehicle and the pedestrian, so that the limitation of the sight distance is overcome, but the system delay is very high and is difficult to determine, which is undoubtedly fatal to a pedestrian safety algorithm program extremely sensitive to delay; moreover, the pedestrian and vehicle position prediction algorithm in the technical scheme is extremely rough, all positions where pedestrians and vehicles possibly appear simultaneously can be marked as unsafe regions under most conditions, and the false alarm probability is high.
Disclosure of Invention
The invention aims to provide a vehicle and pedestrian collision avoidance method based on edge calculation, which not only reduces communication delay between vehicles and pedestrians, but also improves the early warning accuracy rate of vehicle and pedestrian collision accidents.
The technical purpose of the invention is realized by the following technical scheme:
a vehicle pedestrian collision avoidance method based on edge calculation, comprising the steps of:
step 1: establishing a network model of pedestrian device-to-vehicle communication: arranging a Road Side Unit (RSU)/base station and a Mobile Edge Computing (MEC) server connected with the RSU/base station at an intersection or a road edge, wherein the pedestrian equipment is a smart phone with a GPS module, and the pedestrian equipment and the vehicle can realize communication in the coverage range of the network model;
in the mode, the MEC server can be connected to a roadside unit (RSU)/base station, a vehicle can communicate with the RSU/base station through L TE-V2X, and a pedestrian can communicate with the RSU/base station through a smart phone;
step 2: respectively predicting the future positions of the vehicles and the pedestrians by utilizing a Kalman filter according to the current information and the historical information of the vehicle and pedestrian devices;
step 3: and according to the predicted paths of the vehicles and the pedestrians in Step2, running a vehicle and pedestrian collision avoidance algorithm according to the mutual motion relation, and early warning the possible collision.
Further, the specific steps of predicting the future position of the vehicle in Step2 are as follows:
assuming that the automobile has constant rotation rate and speed, the state vector of the automobile is selected as follows:
X=[x y v θ ω]T
theta is a yaw angle which is an included angle between a tracked target vehicle and an x axis under a current vehicle coordinate system, the anticlockwise direction is positive, the numeric area is [0, 2 pi ], and omega is a yaw angular speed; the moving state of the running automobile is generally straight or turning due to the limitation of roads, traffic regulations and the like, the two moving states can be represented by the state vector, and when omega is not equal to 0, the automobile runs in a non-straight line, and the state transfer function of the model is as follows:
when ω is 0, the model is driven in a straight line, and the state transition function of the model becomes:
for the multivariate functions of (1) and (2), a multivariate Taylor series is used for expansion, high-order series is omitted, only the linearization by a Jacobian matrix is considered, and in the model, partial derivatives of each element can be obtained to obtain a Jacobian matrix JAWhen ω ≠ 0:
when ω is 0, the jacobian matrix is:
calculating uncertainty Q caused by noise processing; in the network model, the introduction of noise mainly originates from two places: linear acceleration and yaw rate noise that affect the state quantity (x, y, v, θ, ω), the linear acceleration and yaw rate noise having the following expression for the effect on the state:
wherein mua,For acceleration on a straight line and on a corner, Q is a covariance matrix for processing noise, and is expressed as:
Q=E[n·nT]=E[GμμTGT]=G·E[μμT]·GT(4)
wherein
Therefore, the calculation formula of the covariance matrix Q for processing noise in the CTRV model is:
selecting data collected by two sensors, namely a laser radar and a radar, to perform sensor fusion to predict the vehicle track when a measurement equation is established;
firstly, the laser radar, the data of which is in a Cartesian coordinate system, can detect the position of a vehicle, but has no speed information, and the measured value of the laser radar is the coordinate (x, y) of a target vehicle; therefore, the measurement model of the lidar is still linear, and the measurement matrix is:
the corresponding measurement equation is:
secondly, radar, the measured target vehicle data of which are under a polar coordinate system, the prediction mapping of the radar to the measurement space is nonlinear[16]The expression is as follows:
when h (x) is used to represent such a non-linear mapping, then the non-linear process is also linearized using taylor's formula when solving for kalman gain, and the jacobian matrix of h (x) is solved with reference to the prediction process:
predicting and correcting unknown parameters J in a modelH,JAAfter Q and R (processing noise, generally provided by the manufacturer) have been solved, the data can be filtered according to the network model, so as to predict the future position of the vehicle.
Further, the specific steps of determining the future position of the pedestrian in Step2 are as follows:
the position of the pedestrian is determined according to the information collected by the GPS module of the smart phone, but many errors exist in the dynamic positioning of the GPS module, such as satellite clock error and the like; in order to eliminate errors and improve positioning accuracy, a Kalman filtering method is applied to a current statistical model of GPS dynamic filtering;
starting with a positioning result output by a GPS receiver directly, the total error caused by various error sources of GPS positioning in all directions is equivalent to the sum of a current mean value and colored noise conforming to a first-order Markov process; according to the 'current' statistical model, the state vector of the pedestrian is selected as:
the state equation for the system may be defined as:
wherein, A is a system state transition matrix:
A=diag[Ax,Ay,Az]
Ay,Azand so on;
w (t) is:
=[0 0 WaxWx0 0 WayWy0 0 WazWz]T
is a system noise vector;
τax,τay,τazrespectively, acceleration-dependent time constants; tau isx,τy,τzRespectively, the relevant time constants of the corresponding Markov processes; wax,Way,WazAre respectively asWhite gaussian noise of (1);is the average value of the current acceleration on three coordinate axes;
taking the GPS receiver in 3 coordinate axis directions when establishing a measurement equationUpward positioning result Lx,Ly,LzIs a measured value, then:
Lx=x+∈x+ωlx
Ly=y+∈y+ωly
Lz=z+∈z+ωlz
writing in matrix form:
L=[Lx,Ly,Lz]T
v is observation noise V ═ omegalx,ωly,ωlz]T
H is an observation equation
The corresponding measurement equation is
L=HX+V (7)
So far, we use the observation equation of GPS system to establish the measurement equation of system, use the "current" statistical model and the error model of GPS system to establish the state transition equation of system, and then according to the above system equation and observation equation, set the sampling period as T, through the discretization process[18]The discrete kalman filter equation is established as follows:
K(k+1)=P(k+1,k)HT(k+1)[H(k+1)P(k+1)HT(k+1)+R(k+1)]-1
(9)
P(k+1,k)=Φ(k+1,k)P(k)ΦT(k+1,k)+Q(k) (10)
P(k+1)=[I-K(k+1)H(k+1)]P(k+1,k) (11)
wherein phil(k+1,k)=
diag[Φlx(k+1,k),Φly(k+1,k),Φlz(k+1,k)]
Φly,ΦlzAnd so on;
Φ (k +1, k) in equation (10) is the discretization matrix of the system transfer matrix a:
Φ(k+1,k)=diag[Φx(k+1,k),Φy(k+1,k),Φz(k+1,k)]
Φy(k+1,k),Φz(k +1, k) and so on, simply let τ in (12)ax,τxRespectively converted into tauay,τyAnd τaz,τzThen the method is finished;
q (k) is a discretization matrix of a systematic noise covariance matrix Q
R (k) is a discretization matrix of an observation noise covariance matrix R of the system
Q (k), R (k) are positive definite matrixes;
and (4) until the unknown parameters in the prediction and correction models are solved, and then performing corresponding data processing according to a conventional Kalman filtering program.
Further, the Step3 is a vehicle and pedestrian collision avoidance algorithm, which comprises the following specific steps:
step3.1: the vehicle and pedestrian equipment periodically collect respective state information through a sensor, upload the state information to an MEC server through an RSU/base station, and operate a corresponding Kalman filter on the MEC server according to the state information of pedestrians and vehicles to predict the tracks of traveling people and vehicles;
in Step3.1, the motion of the pedestrian needs to be regarded as nonlinear because the motion of the pedestrian has great uncertainty, and EKF is a filter for predicting the position of a nonlinear moving object; compared with pedestrians, vehicles running on the road can roughly be divided into two classes due to the limitation of the road, wherein the two classes are straight running, the yaw rate is zero, and the vehicles can be regarded as linear motion; one is that the yaw rate is not zero at the time of turning and the motion is nonlinear;
step3.2: running a collision avoidance algorithm to calculate Time To Collision (TTC) and determining a likelihood of a vehicle pedestrian collision from the value of TTC to alert the vehicle driver and the pedestrian;
the TTC (time to collision) is as follows:
L1,L2the lengths of the trajectories to the collision points, V, for vehicles and pedestrians, respectively1,V2Current speeds of the vehicle and pedestrian, tv,tpRespectively, communication delay from the vehicle and the pedestrian to the edge server, and judging whether collision occurs according to the TTC value;
when TTC is 0, that is, if the current vehicle and pedestrian keep running without taking measures, a collision may occur, at which time, a warning message is transmitted to the vehicle, and the vehicle is notified of taking measures before an accident occurs, thereby avoiding the collision.
Further, in step3.2, since there is an unavoidable error in the algorithm, ttcr (time to collision range) and the threshold ξ are set when
TTCR≤ξ
Collision early warning is carried out, so that the influence of errors and vehicle length generated by track prediction is eliminated.
The invention has the beneficial effects that:
firstly, the feasible communication mode of the vehicles and the pedestrians under the current network environment is established through the MEC server, the communication delay is effectively reduced, the delay from the vehicles to the MEC server is less than 10ms, and the delay from the pedestrian equipment to the server is less than 50ms, so that the accuracy of the vehicle and pedestrian collision accident early warning is improved, and the probability of the vehicle and pedestrian collision accidents under the non-line-of-sight conditions such as rain and fog road blind areas is effectively reduced.
Secondly, the feasible communication mode of vehicles and pedestrians in the current network environment is established through the MEC server, the burden of the cloud server is greatly relieved by introducing the MEC, the efficiency of the system is improved, and the throughput of the system is increased.
Thirdly, the invention introduces the pedestrian device, namely the smart phone, overcomes the non-line-of-sight limitation, effectively expands the application scene, adds the device which is carried by the pedestrian and can provide the location service at any time and any place into the Internet of vehicles, obviously improves the safety of the non-motor road users, and the introduction of the smart phone has a positive influence on the current situation that the current pedestrian safety research takes the vehicle as the center of gravity.
Fourthly, the invention also adopts Kalman filtering to predict the future positions of the vehicles and the pedestrians, thereby further improving the accuracy of the vehicle and pedestrian collision accident early warning.
Drawings
FIG. 1 is a diagram of a system model of the present invention;
FIG. 2 is a graph of data results showing the effect of vehicle speed on collision warning success;
FIG. 3 is a graph of data results showing the effect of pedestrian velocity on collision warning success;
FIG. 4 is a graph of comparative experimental data results.
Detailed Description
For the purpose of describing the invention in more detail and facilitating understanding for those skilled in the art, the present invention will be further described with reference to the accompanying drawings and examples, which are provided for illustration and understanding of the present invention and are not intended to limit the present invention.
Example (b):
a vehicle pedestrian collision avoidance method based on edge calculation, as shown in fig. 1, comprising the steps of:
step 1: establishing a network model of pedestrian device-to-vehicle communication: arranging a Road Side Unit (RSU)/base station and a Mobile Edge Computing (MEC) server connected with the RSU/base station at an intersection or a road edge, wherein the pedestrian equipment is a smart phone with a GPS module, and the pedestrian equipment and the vehicle can realize communication in the coverage range of the network model;
in the mode, the MEC server can be connected to a roadside unit (RSU)/base station, a vehicle can communicate with the RSU/base station through L TE-V2X, and a pedestrian can communicate with the RSU/base station through a smart phone;
step 2: respectively predicting the future positions of the vehicles and the pedestrians by utilizing a Kalman filter according to the current information and the historical information of the vehicle and pedestrian devices;
step 3: and according to the predicted paths of the vehicles and the pedestrians in Step2, running a vehicle and pedestrian collision avoidance algorithm according to the mutual motion relation, and early warning the possible collision.
Further, the specific steps of predicting the future position of the vehicle in Step2 are as follows:
assuming that the automobile has constant rotation rate and speed, the state vector of the automobile is selected as follows:
X=[x y v θ ω]T
theta is a yaw angle which is an included angle between a tracked target vehicle and an x axis under a current vehicle coordinate system, the anticlockwise direction is positive, the numeric area is [0, 2 pi ], and omega is a yaw angular speed; the moving state of the running automobile is generally straight or turning due to the limitation of roads, traffic regulations and the like, the two moving states can be represented by the state vector, and when omega is not equal to 0, the automobile runs in a non-straight line, and the state transfer function of the model is as follows:
when ω is 0, the model is driven in a straight line, and the state transition function of the model becomes:
for the multivariate functions of (1) and (2), a multivariate Taylor series is used for expansion, high-order series is omitted, only the linearization by a Jacobian matrix is considered, and in the model, partial derivatives of each element can be obtained to obtain a Jacobian matrix JAWhen ω ≠ 0:
when ω is 0, the jacobian matrix is:
calculating uncertainty Q caused by noise processing; in the network model, the introduction of noise mainly originates from two places: linear acceleration and yaw rate noise that affect the state quantity (x, y, v, θ, ω), the linear acceleration and yaw rate noise having the following expression for the effect on the state:
wherein mua,For acceleration in a straight line and in a corner, Q is a co-ordinate for noise handlingA variance matrix, whose expression is:
Q=E[n·nT]=E[GμμTGT]=G·E[μμT]·GT(4)
wherein
Therefore, the calculation formula of the covariance matrix Q for processing noise in the CTRV model is:
selecting data collected by two sensors, namely a laser radar and a radar, to perform sensor fusion to predict the vehicle track when a measurement equation is established;
firstly, the laser radar, the data of which is in a Cartesian coordinate system, can detect the position of a vehicle, but has no speed information, and the measured value of the laser radar is the coordinate (x, y) of a target vehicle; therefore, the measurement model of the lidar is still linear, and the measurement matrix is:
the corresponding measurement equation is:
secondly, radar, the measured target vehicle data of which are under a polar coordinate system, the prediction mapping of the radar to the measurement space is nonlinear[16]The expression is as follows:
when h (x) is used to represent such a non-linear mapping, then the non-linear process is also linearized using taylor's formula when solving for kalman gain, and the jacobian matrix of h (x) is solved with reference to the prediction process:
predicting and correcting unknown parameters J in a modelH,JAAfter Q and R (processing noise, generally provided by the manufacturer) have been solved, the data can be filtered according to the network model, so as to predict the future position of the vehicle.
Further, the specific steps of determining the future position of the pedestrian in Step2 are as follows:
the position of the pedestrian is determined according to the information collected by the GPS module of the smart phone, but many errors exist in the dynamic positioning of the GPS module, such as satellite clock error and the like; in order to eliminate errors and improve positioning accuracy, a Kalman filtering method is applied to a current statistical model of GPS dynamic filtering;
starting with a positioning result output by a GPS receiver directly, the total error caused by various error sources of GPS positioning in all directions is equivalent to the sum of a current mean value and colored noise conforming to a first-order Markov process; according to the 'current' statistical model, the state vector of the pedestrian is selected as:
the state equation for the system may be defined as:
wherein, A is a system state transition matrix:
A=diag[Ax,Ay,Az]
Ay,Azand so on;
w (t) is:
=[0 0 WaxWx0 0 WayWy0 0 WazWz]T
is a system noise vector;
τax,τay,τazrespectively, acceleration-dependent time constants; tau isx,τy,τzRespectively, the relevant time constants of the corresponding Markov processes; wax,Way,WazAre respectively asWhite gaussian noise of (1);is the average value of the current acceleration on three coordinate axes;
the positioning result L of the GPS receiver in 3 coordinate axis directions is taken when the measurement equation is establishedx,Ly,LzIs a measured value, then:
Lx=x+∈x+ωlx
Ly=y+∈y+ωly
Lz=z+∈z+ωlz
writing in matrix form:
L=[Lx,Ly,Lz]T
v is observation noise V ═ omegalx,ωly,ωlz]T
H is an observation equation
The corresponding measurement equation is L HX + V (7)
So far, we use the observation equation of GPS system to establish the measurement equation of system, use the "current" statistical model and the error model of GPS system to establish the state transition equation of system, and then according to the above system equation and observation equation, set the sampling period as T, through the discretization process[18]The discrete kalman filter equation is established as follows:
K(k+1)=P(k+1,k)HT(k+1)[H(k+1)P(k+1)HT(k+1)+R(k+1)]-1
(9)
P(k+1,k)=Φ(k+1,k)P(k)ΦT(k+1,k)+Q(k) (10)
P(k+1)=[I-K(k+1)H(k+1)]P(k+1,k) (11)
wherein phil(k+1,k)=
diag[Φlx(k+1,k),Φly(k+1,k),Φlz(k+1,k)]
Φly,ΦlzAnd so on;
Φ (k +1, k) in equation (10) is the discretization matrix of the system transfer matrix a:
Φ(k+1,k)=diag[Φx(k+1,k),Φy(k+1,k),Φz(k+1,k)]
Φy(k+1,k),Φz(k +1, k) and so on, it is only necessary to add to (12)τax,τxRespectively converted into tauay,τyAnd τaz,τzThen the method is finished;
q (k) is a discretization matrix of a systematic noise covariance matrix Q
R (k) is a discretization matrix of an observation noise covariance matrix R of the system
Q (k), R (k) are positive definite matrixes;
and (4) until the unknown parameters in the prediction and correction models are solved, and then performing corresponding data processing according to a conventional Kalman filtering program.
Further, the Step3 is a vehicle and pedestrian collision avoidance algorithm, which comprises the following specific steps:
step3.1: the vehicle and pedestrian equipment periodically collect respective state information through a sensor, upload the state information to an MEC server through an RSU/base station, and operate a corresponding Kalman filter on the MEC server according to the state information of pedestrians and vehicles to predict the tracks of traveling people and vehicles;
in Step3.1, the motion of the pedestrian needs to be regarded as nonlinear because the motion of the pedestrian has great uncertainty, and EKF is a filter for predicting the position of a nonlinear moving object; compared with pedestrians, vehicles running on the road can roughly be divided into two classes due to the limitation of the road, wherein the two classes are straight running, the yaw rate is zero, and the vehicles can be regarded as linear motion; one is that the yaw rate is not zero at the time of turning and the motion is nonlinear;
step3.2: running a collision avoidance algorithm to calculate Time To Collision (TTC) and determining a likelihood of a vehicle pedestrian collision from the value of TTC to alert the vehicle driver and the pedestrian;
the TTC (time to collision) is as follows:
L1,L2the lengths of the trajectories to the collision points, V, for vehicles and pedestrians, respectively1,V2Current speeds of the vehicle and pedestrian, tv,tpRespectively, communication delay from the vehicle and the pedestrian to the edge server, and judging whether collision occurs according to the TTC value;
when TTC is 0, that is, if the current vehicle and pedestrian keep running without taking measures, a collision may occur, at which time, a warning message is transmitted to the vehicle, and the vehicle is notified of taking measures before an accident occurs, thereby avoiding the collision.
Further, in step3.2, since there is an unavoidable error in the algorithm, ttcr (time to collision range) and the threshold ξ are set when
TTCR≤ξ
Collision early warning is carried out, so that the influence of errors and vehicle length generated by track prediction is eliminated.
As can be seen from fig. 2, the higher the vehicle speed is at TTC 0, the lower the warning accuracy rate, because the higher the vehicle speed is, the greater the error and delay have an effect thereon, when the threshold ξ is increased, the warning accuracy rate is first increased and reaches the highest value because the influence of the system error is gradually reduced after the threshold is increased.
It can also be seen that the warning accuracy curve is steeper as the vehicle speed is higher, and smoother as the vehicle speed is lower. Because the higher the vehicle speed, the more sensitive it is to delay, the lower the vehicle speed, the more accurate the trajectory prediction, and the corresponding accuracy is higher.
It can be seen from fig. 3 that the influence of the pedestrian speed and the vehicle speed on the system is approximately the same, and the curve trend also follows the trend of "steeper" speed and "gentler" speed, when the TTC is 0, the speed and the early warning success rate are inversely related, except that when the threshold ξ is the same, the early warning accuracy rate of the part is generally higher than that in 5.3, because the influence on the system is not as obvious as that of the vehicle because the pedestrian speed is slower than that of the vehicle.
FIG. 4 is a graph of the results of a comparative test in which the collision points are calculated based on the pedestrian trajectories of vehicles, and each pedestrian and vehicle has their own trajectory, so that the total number of vehicles and pedestrians will affect the performance of the system. this section studies the impact of the total number of pedestrians and vehicles on the system, and compares this with the method in the Avoding car-traffic utilization a VANETto cellular communication framework.
And a single vehicle or a pedestrian may receive a plurality of early warnings when the track increases, the total number of the early warnings is increased at this time, and after a certain vehicle receives accurate early warning information and decelerates successfully to avoid collision, other received early warning information is invalidated, namely, the number of early warning success times of the single vehicle or the pedestrian is less than or equal to 1, namely, the upper limit of the number of early warning success times is smaller, but only the number of early warning success times is larger and larger along with the increase of the total number and the upper limit is very high, so that the change trend of the early warning success rate is gradually reduced along with the increase of the total number of. Compared with the algorithm in the Avoiding car-companion simulation using a VANET cellular communication frame, the early warning success rate of the algorithm is higher.
While the present invention has been described in detail with reference to the embodiments shown in the drawings, the present invention is not limited to the embodiments, and various changes can be made without departing from the spirit and scope of the present invention.
Claims (5)
1. A vehicle pedestrian collision avoidance method based on edge calculation is characterized in that: the method comprises the following steps:
step 1: establishing a network model of pedestrian device-to-vehicle communication: arranging a Road Side Unit (RSU)/base station and a Mobile Edge Computing (MEC) server connected with the RSU/base station at an intersection or a road edge, wherein the pedestrian equipment is a smart phone with a GPS module, and the pedestrian equipment and the vehicle can realize communication in the coverage range of the network model;
step 2: respectively predicting the future positions of the vehicles and the pedestrians by utilizing a Kalman filter according to the current information and the historical information of the vehicle and pedestrian devices;
step 3: and according to the predicted paths of the vehicles and the pedestrians in Step2, running a vehicle and pedestrian collision avoidance algorithm according to the mutual motion relation, and early warning the possible collision.
2. The vehicle pedestrian collision avoidance method based on the edge calculation according to claim 1, characterized in that: the concrete steps of predicting the future position of the vehicle in Step2 are as follows:
assuming that the automobile has constant rotation rate and speed, the state vector of the automobile is selected as follows:
X=[x y v θ ω]T
theta is a yaw angle which is an included angle between a tracked target vehicle and an x axis under a current vehicle coordinate system, the anticlockwise direction is positive, the numeric area is [0, 2 pi ], and omega is a yaw angular speed; the moving state of the running automobile is generally straight or turning due to the limitation of roads, traffic regulations and the like, the two moving states can be represented by the state vector, and when omega is not equal to 0, the automobile runs in a non-straight line, and the state transfer function of the model is as follows:
when ω is 0, the model is driven in a straight line, and the state transition function of the model becomes:
for the multivariate functions of (1) and (2), a multivariate Taylor series is used for expansion, high-order series is omitted, only the linearization by a Jacobian matrix is considered, and in the model, partial derivatives of each element can be obtained to obtain a Jacobian matrix JAWhen ω ≠ 0:
when ω is 0, the jacobian matrix is:
calculating uncertainty Q caused by noise processing; in the network model, the introduction of noise mainly originates from two places: linear acceleration and yaw rate noise that affect the state quantity (x, y, v, θ, ω), the linear acceleration and yaw rate noise having the following expression for the effect on the state:
wherein mua,For acceleration on a straight line and on a corner, Q is a covariance matrix for processing noise, and is expressed as:
Q=E[n·nT]=E[GμμTGT]=G·E[μμT]·GT(4)
wherein
Therefore, the calculation formula of the covariance matrix Q for processing noise in the CTRV model is:
selecting data collected by two sensors, namely a laser radar and a radar, to perform sensor fusion to predict the vehicle track when a measurement equation is established;
firstly, the laser radar, the data of which is in a Cartesian coordinate system, can detect the position of a vehicle, but has no speed information, and the measured value of the laser radar is the coordinate (x, y) of a target vehicle; therefore, the measurement model of the lidar is still linear, and the measurement matrix is:
the corresponding measurement equation is:
secondly, radar, the measured target vehicle data of which are under a polar coordinate system, the prediction mapping of the radar to the measurement space is nonlinear[16]The expression is as follows:
when h (x) is used to represent such a non-linear mapping, then the non-linear process is also linearized using taylor's formula when solving for kalman gain, and the jacobian matrix of h (x) is solved with reference to the prediction process:
predicting and correcting unknown parameters J in a modelH,JAAfter Q and R (processing noise, generally provided by the manufacturer) have been solved, the data can be filtered according to the network model, so as to predict the future position of the vehicle.
3. The vehicle pedestrian collision avoidance method based on the edge calculation according to claim 1, characterized in that: the specific steps of determining the future position of the pedestrian in Step2 are as follows:
the position of the pedestrian is determined according to the information collected by the GPS module of the smart phone, but many errors exist in the dynamic positioning of the GPS module, such as satellite clock error and the like; in order to eliminate errors and improve positioning accuracy, a Kalman filtering method is applied to a current statistical model of GPS dynamic filtering;
starting with a positioning result output by a GPS receiver directly, the total error caused by various error sources of GPS positioning in all directions is equivalent to the sum of a current mean value and colored noise conforming to a first-order Markov process; according to the 'current' statistical model, the state vector of the pedestrian is selected as:
the state equation for the system may be defined as:
wherein, A is a system state transition matrix:
A=diag[Ax,Ay,Az]
Ay,Azand so on;
w (t) is:
=[0 0 WaxWx0 0 WayWy0 0 WazWz]T
is a system noise vector;
τax,τay,τazrespectively, acceleration-dependent time constants; tau isx,τy,τzRespectively, the relevant time constants of the corresponding Markov processes; wax,Way,WazAre respectively asWhite gaussian noise of (1);is the average value of the current acceleration on three coordinate axes;
the positioning result L of the GPS receiver in 3 coordinate axis directions is taken when the measurement equation is establishedx,Ly,LzIs a measured value, then:
Lx=x+∈x+ωlx
Ly=y+∈y+ωly
Lz=z+∈z+ωlz
writing in matrix form:
L=[Lx,Ly,Lz]T
v is observation noise V ═ omegalx,ωly,ωlz]T
H is an observation equation
The corresponding measurement equation is
L=HX+V (7)
So far, we use the observation equation of GPS system to establish the measurement equation of system, use the "current" statistical model and the error model of GPS system to establish the state transition equation of system, and then according to the above system equation and observation equation, set the sampling period as T, through the discretization process[18]The discrete kalman filter equation is established as follows:
K(k+1)=P(k+1,k)HT(k+1)[H(k+1)P(k+1)HT(k+1)+R(k+1)]-1
(9)
P(k+1,k)=Φ(k+1,k)P(k)ΦT(k+1,k)+Q(k) (10)
P(k+1)=[I-K(k+1)H(k+1)]P(k+1,k) (11)
wherein phil(k+1,k)=
diag[Φlx(k+1,k),Φly(k+1,k),Φlz(k+1,k)]
Φly,ΦlzAnd so on;
Φ (k +1, k) in equation (10) is the discretization matrix of the system transfer matrix a:
Φ(k+1,k)=diag[Φx(k+1,k),Φy(k+1,k),Φz(k+1,k)]
Φy(k+1,k),Φz(k +1, k) and so on, simply let τ in (12)ax,τxRespectively converted into tauay,τyAnd τaz,τzThen the method is finished;
q (k) is a discretization matrix of a systematic noise covariance matrix Q
R (k) is a discretization matrix of an observation noise covariance matrix R of the system
Q (k), R (k) are positive definite matrixes;
and (4) until the unknown parameters in the prediction and correction models are solved, and then performing corresponding data processing according to a conventional Kalman filtering program.
4. The vehicle pedestrian collision avoidance method based on the edge calculation according to claim 1, characterized in that: the method for avoiding the collision of the vehicles and the pedestrians in Step3 comprises the following specific steps:
step3.1: the vehicle and pedestrian equipment periodically collect respective state information through a sensor, upload the state information to an MEC server through an RSU/base station, and operate a corresponding Kalman filter on the MEC server according to the state information of pedestrians and vehicles to predict the tracks of traveling people and vehicles;
in Step3.1, the motion of the pedestrian needs to be regarded as nonlinear because the motion of the pedestrian has great uncertainty, and EKF is a filter for predicting the position of a nonlinear moving object; compared with pedestrians, vehicles running on the road can roughly be divided into two classes due to the limitation of the road, wherein the two classes are straight running, the yaw rate is zero, and the vehicles can be regarded as linear motion; one is that the yaw rate is not zero at the time of turning and the motion is nonlinear;
step3.2: running a collision avoidance algorithm to calculate Time To Collision (TTC) and determining a likelihood of a vehicle pedestrian collision from the value of TTC to alert the vehicle driver and the pedestrian;
the TTC (time to collision) is as follows:
L1,L2the lengths of the trajectories to the collision points, V, for vehicles and pedestrians, respectively1,V2Current speeds of the vehicle and pedestrian, tv,tpRespectively, communication delay from the vehicle and the pedestrian to the edge server, and judging whether collision occurs according to the TTC value;
when TTC is 0, that is, if the current vehicle and pedestrian keep running without taking measures, a collision may occur, at which time, a warning message is transmitted to the vehicle, and the vehicle is notified of taking measures before an accident occurs, thereby avoiding the collision.
5. The method as claimed in claim 4, wherein the TTCR (time to collision range) and the threshold ξ are set when the algorithm has unavoidable error in Step3.2
TTCR≤ξ
Collision early warning is carried out, so that the influence of errors and vehicle length generated by track prediction is eliminated.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010143534.5A CN111489585A (en) | 2020-03-04 | 2020-03-04 | Vehicle and pedestrian collision avoidance method based on edge calculation |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010143534.5A CN111489585A (en) | 2020-03-04 | 2020-03-04 | Vehicle and pedestrian collision avoidance method based on edge calculation |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111489585A true CN111489585A (en) | 2020-08-04 |
Family
ID=71794318
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010143534.5A Pending CN111489585A (en) | 2020-03-04 | 2020-03-04 | Vehicle and pedestrian collision avoidance method based on edge calculation |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111489585A (en) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112562405A (en) * | 2020-11-27 | 2021-03-26 | 山东高速建设管理集团有限公司 | Radar video intelligent fusion and early warning method and system |
CN112634354A (en) * | 2020-12-21 | 2021-04-09 | 紫清智行科技(北京)有限公司 | Road side sensor-based networking automatic driving risk assessment method and device |
CN113012469A (en) * | 2021-03-16 | 2021-06-22 | 浙江亚太机电股份有限公司 | Intelligent traffic early warning system based on target recognition |
CN113112805A (en) * | 2021-04-16 | 2021-07-13 | 吉林大学 | Intersection monitoring and early warning method based on base station communication and intersection camera positioning |
CN113140132A (en) * | 2021-04-20 | 2021-07-20 | 重庆邮电大学 | Pedestrian anti-collision early warning system and method based on 5G V2X mobile intelligent terminal |
CN113223325A (en) * | 2021-03-26 | 2021-08-06 | 南京市德赛西威汽车电子有限公司 | Method for safely passing signal-lamp-free intersection |
CN113345248A (en) * | 2021-04-29 | 2021-09-03 | 华设设计集团股份有限公司 | Non-signal control intersection safety early warning and control method and system |
CN113610263A (en) * | 2021-06-18 | 2021-11-05 | 广东能源集团科学技术研究院有限公司 | Power plant operating vehicle track estimation method and system |
CN113727308A (en) * | 2021-10-20 | 2021-11-30 | 湖北大学 | Edge calculation unloading optimization method based on vehicle position prediction |
CN113851017A (en) * | 2021-08-19 | 2021-12-28 | 复旦大学 | Pedestrian and vehicle identification and early warning multifunctional system based on road side RSU |
CN114120715A (en) * | 2020-08-31 | 2022-03-01 | 中移(成都)信息通信科技有限公司 | Method, device and equipment for collision prevention of low-altitude aircraft and computer storage medium |
CN115131990A (en) * | 2022-05-20 | 2022-09-30 | 兆边(上海)科技有限公司 | Early warning method and system for mixed flow collision risk of non-signal control intersection |
CN115267868A (en) * | 2022-09-27 | 2022-11-01 | 腾讯科技(深圳)有限公司 | Positioning point processing method and device and computer readable storage medium |
CN115457806A (en) * | 2022-09-05 | 2022-12-09 | 广东轻工职业技术学院 | Rear vehicle collision early warning system and method based on Internet of vehicles |
CN115830860A (en) * | 2022-11-17 | 2023-03-21 | 西部科学城智能网联汽车创新中心(重庆)有限公司 | Traffic accident prediction method and device |
CN116246489A (en) * | 2023-02-06 | 2023-06-09 | 云控智行科技有限公司 | Pedestrian protection method, device and equipment |
-
2020
- 2020-03-04 CN CN202010143534.5A patent/CN111489585A/en active Pending
Cited By (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114120715A (en) * | 2020-08-31 | 2022-03-01 | 中移(成都)信息通信科技有限公司 | Method, device and equipment for collision prevention of low-altitude aircraft and computer storage medium |
CN114120715B (en) * | 2020-08-31 | 2023-02-28 | 中移(成都)信息通信科技有限公司 | Method, device and equipment for collision prevention of low-altitude aircraft and computer storage medium |
CN112562405A (en) * | 2020-11-27 | 2021-03-26 | 山东高速建设管理集团有限公司 | Radar video intelligent fusion and early warning method and system |
CN112634354A (en) * | 2020-12-21 | 2021-04-09 | 紫清智行科技(北京)有限公司 | Road side sensor-based networking automatic driving risk assessment method and device |
CN112634354B (en) * | 2020-12-21 | 2021-08-13 | 紫清智行科技(北京)有限公司 | Road side sensor-based networking automatic driving risk assessment method and device |
CN113012469A (en) * | 2021-03-16 | 2021-06-22 | 浙江亚太机电股份有限公司 | Intelligent traffic early warning system based on target recognition |
CN113223325A (en) * | 2021-03-26 | 2021-08-06 | 南京市德赛西威汽车电子有限公司 | Method for safely passing signal-lamp-free intersection |
CN113112805B (en) * | 2021-04-16 | 2022-08-02 | 吉林大学 | Intersection monitoring and early warning method based on base station communication and intersection camera positioning |
CN113112805A (en) * | 2021-04-16 | 2021-07-13 | 吉林大学 | Intersection monitoring and early warning method based on base station communication and intersection camera positioning |
CN113140132A (en) * | 2021-04-20 | 2021-07-20 | 重庆邮电大学 | Pedestrian anti-collision early warning system and method based on 5G V2X mobile intelligent terminal |
CN113140132B (en) * | 2021-04-20 | 2023-11-03 | 西安华企众信科技发展有限公司 | Pedestrian anti-collision early warning system and method based on 5G V2X mobile intelligent terminal |
CN113345248A (en) * | 2021-04-29 | 2021-09-03 | 华设设计集团股份有限公司 | Non-signal control intersection safety early warning and control method and system |
CN113610263A (en) * | 2021-06-18 | 2021-11-05 | 广东能源集团科学技术研究院有限公司 | Power plant operating vehicle track estimation method and system |
CN113610263B (en) * | 2021-06-18 | 2023-06-09 | 广东能源集团科学技术研究院有限公司 | Power plant operation vehicle track estimation method and system |
CN113851017A (en) * | 2021-08-19 | 2021-12-28 | 复旦大学 | Pedestrian and vehicle identification and early warning multifunctional system based on road side RSU |
CN113727308A (en) * | 2021-10-20 | 2021-11-30 | 湖北大学 | Edge calculation unloading optimization method based on vehicle position prediction |
CN113727308B (en) * | 2021-10-20 | 2023-06-30 | 湖北大学 | Edge calculation unloading optimization method based on vehicle position prediction |
CN115131990A (en) * | 2022-05-20 | 2022-09-30 | 兆边(上海)科技有限公司 | Early warning method and system for mixed flow collision risk of non-signal control intersection |
CN115457806A (en) * | 2022-09-05 | 2022-12-09 | 广东轻工职业技术学院 | Rear vehicle collision early warning system and method based on Internet of vehicles |
CN115267868B (en) * | 2022-09-27 | 2023-09-19 | 腾讯科技(深圳)有限公司 | Positioning point processing method and device and computer readable storage medium |
CN115267868A (en) * | 2022-09-27 | 2022-11-01 | 腾讯科技(深圳)有限公司 | Positioning point processing method and device and computer readable storage medium |
CN115830860A (en) * | 2022-11-17 | 2023-03-21 | 西部科学城智能网联汽车创新中心(重庆)有限公司 | Traffic accident prediction method and device |
CN115830860B (en) * | 2022-11-17 | 2023-12-15 | 西部科学城智能网联汽车创新中心(重庆)有限公司 | Traffic accident prediction method and device |
CN116246489A (en) * | 2023-02-06 | 2023-06-09 | 云控智行科技有限公司 | Pedestrian protection method, device and equipment |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111489585A (en) | Vehicle and pedestrian collision avoidance method based on edge calculation | |
CN110596694B (en) | Complex environment radar multi-target tracking and road driving environment prediction method | |
CN111307162B (en) | Multi-sensor fusion positioning method for automatic driving scene | |
CN109556615B (en) | Driving map generation method based on multi-sensor fusion cognition of automatic driving | |
CN113715814B (en) | Collision detection method, device, electronic equipment, medium and automatic driving vehicle | |
CN111653113B (en) | Method, device, terminal and storage medium for determining local path of vehicle | |
JP6601696B2 (en) | Prediction device, prediction method, and program | |
CN107826104B (en) | Method for providing information about a predicted driving intent of a vehicle | |
WO2022141538A1 (en) | Trajectory prediction method and apparatus | |
CN106558219B (en) | Vehicle track prediction method and device | |
US20220144265A1 (en) | Moving Track Prediction Method and Apparatus | |
CN109767619B (en) | Intelligent networking pure electric vehicle running condition prediction method | |
US11685406B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
CN112147651B (en) | Asynchronous multi-vehicle cooperative target state robust estimation method | |
JP2019194592A (en) | Method for calculating vehicle position depending on satellite by using motion and position sensors | |
CN113227831B (en) | Guardrail estimation method based on multi-sensor data fusion and vehicle-mounted equipment | |
Huang et al. | Toward C-V2X Enabled Connected Transportation System: RSU-Based Cooperative Localization Framework for Autonomous Vehicles | |
CN113115230A (en) | Vehicle broadcast communication control method based on information physical system | |
Wei et al. | Multi-sensor environmental perception and adaptive cruise control of intelligent vehicles using kalman filter | |
CN112615604A (en) | Filtering method and device of intelligent driving perception system and electronic equipment | |
CN117387647A (en) | Road planning method integrating vehicle-mounted sensor data and road sensor data | |
CN113470070B (en) | Driving scene target tracking method, device, equipment and storage medium | |
US20230103178A1 (en) | Systems and methods for onboard analysis of sensor data for sensor fusion | |
CN115817466A (en) | Collision risk assessment method and device | |
CN115082562A (en) | External parameter calibration method, device, equipment, server and vehicle-mounted computing equipment |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20200804 |