Nothing Special   »   [go: up one dir, main page]

CN111489585A - Vehicle and pedestrian collision avoidance method based on edge calculation - Google Patents

Vehicle and pedestrian collision avoidance method based on edge calculation Download PDF

Info

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
Application number
CN202010143534.5A
Other languages
Chinese (zh)
Inventor
冯勇
李宇桐
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kunming University of Science and Technology
Original Assignee
Kunming University of Science and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kunming University of Science and Technology filed Critical Kunming University of Science and Technology
Priority to CN202010143534.5A priority Critical patent/CN111489585A/en
Publication of CN111489585A publication Critical patent/CN111489585A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/164Centralised systems, e.g. external to vehicles
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W24/00Supervisory, monitoring or testing arrangements
    • H04W24/06Testing, supervising or monitoring using simulated traffic
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02Services making use of location information
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/30Services specially adapted for particular environments, situations or purposes
    • H04W4/40Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P]
    • H04W4/44Services 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)
  • Navigation (AREA)
  • Traffic Control Systems (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

Vehicle and pedestrian collision avoidance method based on edge calculation
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:
Figure RE-GDA0002536505580000021
when ω is 0, the model is driven in a straight line, and the state transition function of the model becomes:
Figure RE-GDA0002536505580000022
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:
Figure RE-GDA0002536505580000023
when ω is 0, the jacobian matrix is:
Figure RE-GDA0002536505580000024
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:
Figure RE-GDA0002536505580000031
wherein mua
Figure RE-GDA0002536505580000036
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
Figure RE-GDA0002536505580000032
Therefore, the calculation formula of the covariance matrix Q for processing noise in the CTRV model is:
Figure RE-GDA0002536505580000033
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:
Figure RE-GDA0002536505580000034
the corresponding measurement equation is:
Figure RE-GDA0002536505580000035
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:
Figure RE-GDA0002536505580000041
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:
Figure RE-GDA0002536505580000042
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:
Figure RE-GDA0002536505580000043
the state equation for the system may be defined as:
Figure RE-GDA0002536505580000044
wherein, A is a system state transition matrix:
A=diag[Ax,Ay,Az]
Figure RE-GDA0002536505580000051
Ay,Azand so on;
Figure RE-GDA0002536505580000052
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 as
Figure RE-GDA0002536505580000053
White gaussian noise of (1);
Figure RE-GDA0002536505580000054
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+∈xlx
Ly=y+∈yly
Lz=z+∈zlz
writing in matrix form:
L=[Lx,Ly,Lz]T
v is observation noise V ═ omegalx,ωly,ωlz]T
H is an observation equation
Figure RE-GDA0002536505580000055
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:
Figure RE-GDA0002536505580000061
Figure RE-GDA0002536505580000062
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)]
Figure RE-GDA0002536505580000063
Φ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)]
Figure RE-GDA0002536505580000064
Φ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
Figure RE-GDA0002536505580000065
R (k) is a discretization matrix of an observation noise covariance matrix R of the system
Figure RE-GDA0002536505580000066
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:
Figure RE-GDA0002536505580000071
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:
Figure RE-GDA0002536505580000091
when ω is 0, the model is driven in a straight line, and the state transition function of the model becomes:
Figure RE-GDA0002536505580000092
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:
Figure RE-GDA0002536505580000093
when ω is 0, the jacobian matrix is:
Figure RE-GDA0002536505580000101
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:
Figure RE-GDA0002536505580000102
wherein mua
Figure RE-GDA0002536505580000105
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
Figure RE-GDA0002536505580000103
Therefore, the calculation formula of the covariance matrix Q for processing noise in the CTRV model is:
Figure RE-GDA0002536505580000104
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:
Figure RE-GDA0002536505580000111
the corresponding measurement equation is:
Figure RE-GDA0002536505580000112
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:
Figure RE-GDA0002536505580000113
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:
Figure RE-GDA0002536505580000114
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:
Figure RE-GDA0002536505580000121
the state equation for the system may be defined as:
Figure RE-GDA0002536505580000122
wherein, A is a system state transition matrix:
A=diag[Ax,Ay,Az]
Figure RE-GDA0002536505580000123
Ay,Azand so on;
Figure RE-GDA0002536505580000124
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 as
Figure RE-GDA0002536505580000125
White gaussian noise of (1);
Figure RE-GDA0002536505580000126
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+∈xlx
Ly=y+∈yly
Lz=z+∈zlz
writing in matrix form:
L=[Lx,Ly,Lz]T
v is observation noise V ═ omegalx,ωly,ωlz]T
H is an observation equation
Figure RE-GDA0002536505580000131
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:
Figure RE-GDA0002536505580000132
Figure RE-GDA0002536505580000133
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)]
Figure RE-GDA0002536505580000134
Φ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)]
Figure RE-GDA0002536505580000135
Φ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
Figure RE-GDA0002536505580000141
R (k) is a discretization matrix of an observation noise covariance matrix R of the system
Figure RE-GDA0002536505580000142
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:
Figure RE-GDA0002536505580000143
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:
Figure RE-FDA0002536505570000011
when ω is 0, the model is driven in a straight line, and the state transition function of the model becomes:
Figure RE-FDA0002536505570000012
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:
Figure RE-FDA0002536505570000021
when ω is 0, the jacobian matrix is:
Figure RE-FDA0002536505570000022
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:
Figure RE-FDA0002536505570000023
wherein mua
Figure RE-FDA0002536505570000024
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
Figure RE-FDA0002536505570000025
Therefore, the calculation formula of the covariance matrix Q for processing noise in the CTRV model is:
Figure RE-FDA0002536505570000026
Figure RE-FDA0002536505570000031
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:
Figure RE-FDA0002536505570000032
the corresponding measurement equation is:
Figure RE-FDA0002536505570000033
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:
Figure RE-FDA0002536505570000034
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:
Figure RE-FDA0002536505570000035
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:
Figure FDA0002399925360000041
the state equation for the system may be defined as:
Figure FDA0002399925360000042
wherein, A is a system state transition matrix:
A=diag[Ax,Ay,Az]
Figure FDA0002399925360000043
Ay,Azand so on;
Figure FDA0002399925360000044
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 as
Figure FDA0002399925360000045
White gaussian noise of (1);
Figure FDA0002399925360000046
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+∈xlx
Ly=y+∈yly
Lz=z+∈zlz
writing in matrix form:
L=[Lx,Ly,Lz]T
v is observation noise V ═ omegalx,ωly,ωlz]T
H is an observation equation
Figure FDA0002399925360000051
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:
Figure FDA0002399925360000052
Figure FDA0002399925360000053
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)]
Figure FDA0002399925360000061
Φ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)]
Figure FDA0002399925360000062
Φ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
Figure FDA0002399925360000063
R (k) is a discretization matrix of an observation noise covariance matrix R of the system
Figure FDA0002399925360000064
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:
Figure FDA0002399925360000071
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.
CN202010143534.5A 2020-03-04 2020-03-04 Vehicle and pedestrian collision avoidance method based on edge calculation Pending CN111489585A (en)

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)

* Cited by examiner, † Cited by third party
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

Cited By (24)

* Cited by examiner, † Cited by third party
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
CN113610263B (en) * 2021-06-18 2023-06-09 广东能源集团科学技术研究院有限公司 Power plant operation vehicle track estimation method and system
CN113610263A (en) * 2021-06-18 2021-11-05 广东能源集团科学技术研究院有限公司 Power plant operating 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
EP4148385A1 (en) Vehicle navigation positioning method and apparatus, and base station, system and readable 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
Wei et al. Multi-sensor environmental perception and adaptive cruise control of intelligent vehicles using kalman filter
CN113115230A (en) Vehicle broadcast communication control method based on information physical system
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

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