The present invention relates to the technical field of smart vehicles, in particular to a real-time assessment method of driving risk based on equivalent force and a device thereof.
With the development of the economy and the progress of society, the number of motor vehicles in China continues to increase, and the situation of traffic accidents is very serious. At present, great progress has been made in passive safety and active safety technology, which has contributed to a significant decrease in the number of traffic deaths. However, according to traffic accident statistics, the number of traffic accidents is still high. In 2015, there were 187,787 road traffic accidents involving casualties in China, resulting in 58022 deaths and 199880 injuries.
Intelligent transportation system (ITS, Intelligent transportation system) can reduce traffic accidents and improve traffic safety through the close cooperation of people, vehicles, and roads. However, traffic safety is affected by many traffic factors including various road users and the road environment, and the interaction between these factors is very complex. Therefore, the prior art mostly only considers the influence of limited factors (mainly surrounding vehicles), such as Advanced Driver Assistant System (ADAS), which is usually applied in simple scenarios such as straight driving and lane changing to reduce rear-end collisions and side collisions. accident. This type of technology is mostly based on vehicle dynamics and kinematics, and cannot adapt to the increasingly complex traffic environment. Existing traffic safety models based on the principles of vehicle kinematics and dynamics usually use vehicle state information (speed, acceleration, yaw rate, etc.) and the relative motion relationship between vehicles (relative speed, relative distance, etc.) to determine when the vehicle is in traffic. Risks caused by the environment. This type of traffic safety model is difficult to reflect the interaction and dynamic changes of driver characteristics, traffic environment and vehicle status.
In terms of road risk assessment methods, the existing technologies mainly include absolute number method, accident rate method and accident intensity analysis method. These analysis methods are mainly based on the macro statistics of traffic accidents that have occurred, such as the number of accidents, the number of casualties, economic losses, the number of local populations, the number of registered vehicles, and the number of deaths in 10,000 vehicles, and mathematical methods are used for evaluation. Although this kind of method has a certain guiding effect on the construction of traffic safety, its evaluation results are static, and cannot display the current safety status of the traffic environment in real time, let alone provide forward-looking guidance on traffic safety management within a certain time and space. At the same time, during the driving process, how the driver dynamically decides the expected trajectory of the car, that is, predicts the trajectory of the vehicle, is critical to driving risk assessment.
In the related research on the assessment of driving risk, most of the research failed to realize the requirement of real-time assessment. The prior art usually makes short-term predictions for the next moment based on the state of the previous moment of driving, and the selected evaluation index cannot effectively reflect the force situation between vehicles, that is, it does not fully explain the risk of the vehicle during driving. Other studies can guarantee real-time risk assessment, but do not provide a quantitative description of the risk value and cannot provide more detailed guidance for follow-up research. In driving scenes, the most classic scenes always cover two-car scenes, such as car following scenes, lane changing scenes, etc. Therefore, it is necessary to describe the relationship between the two vehicles in an intuitive and quantifiable way. The adoption of an equal effect method can directly reflect the force relationship between the two vehicles and provide support for risk quantification.
The present invention aims to provide a real-time assessment method of driving risk based on equivalent force and a device thereof, which can fully reflect the current risk status of the human-vehicle-road closed-loop traffic system, adapt to various road users such as pedestrians, cyclists, and vehicles, and adapt to the dynamic interaction between road users and the traffic environment, enabling real-time assessment Safe state of the road traffic environment in a controllable area.
To achieve the above objective, the present invention provides a real-time assessment method of driving risk based on equivalent force, including:
S1, collecting traffic environment information and various types of traffic environment use object information in a road environment in an area to be assessed;
S2, inputting, into an electronic control unit of a vehicle, the traffic environment use object information and the environment information acquired in S1, wherein a road risk assessment model based on the equivalent force distribution is preset in the electronic control unit;
S3, using the road risk assessment model, so as to acquire road traffic risk E of the vehicle i and equivalent force distribution Fij between vehicle i and object j in different traffic environments, and the object j represents any traffic element other than vehicle i in various traffic environment use object information, the road traffic risk E may be expressed as the sum of kinetic energy Ei of the vehicle i, kinetic energy Ej of the object j, and the relative kinetic energy Eij between the vehicle i and the object j.
Further, “Eij” and “Fij” in S3 are defined as follows:
wherein, Fij,max represents a maximum equivalent force on the object j loaded by the vehicle i,
mi represents a mass of the vehicle i; vi represents a speed of the vehicle i; vij represents a relative speed between the vehicle i and the object j; dij represents a relative distance between the vehicle i and the object j; vi, vij, dij each is a vector, θij is an angle from dij to vij, θij* is an angle from dij to vi, a counterclockwise direction is defined as positive; wki is a probability weight of the vehicle i to maintain a current wheel angle and to change the current wheel angle; wkj is a probability weight of the object j to maintain an angle of current state and to change the angle.
Further,
the object j is defined as a vehicle, wkj represents a probability weight of the vehicle j to maintain a current wheel angle and to change the current wheel angle; pki(δki) represents a steering probability of vehicle i at a next moment steering angle along a steering angle δki; pki(δkj) represents a steering probability of vehicle j at a next moment steering angle along a steering angle δkj; δ0=0 indicating straight-line driving, p0(δ0) indicating the probability that the vehicle i and the vehicle j go straight;
pki(δki), pkj(δkj), p0(δ0) can be obtained by the following calculation expression:
wherein k, n∈Z; Δδ represents an increment of the steering angle; if k is a positive integer, δk means turning to left; if k is a negative integer, δk means turning to right.
Further, the method includes:
S4, based on the equivalent force distribution Fij obtained in S3, the rationality of steering probability of the vehicle is verified according to distribution law of the possible trajectory of the driver.
Futter, the S4 includes the following steps:
S41, taking the target weight distance ds of all feasible expected trajectory decisions s of the driver, s=1 . . . n, and forming a set D to be determined,
D{d
1
,d
2
,d
3
, . . . d
n};
S42, security e1, efficiency e2, maneuverability e3 and regularity e4 forming an evaluation index set as following:
E={e
1
,e
2
,e
3
,e
4};
through the security e1, efficiency e2, maneuverability e3 and regularity e4, the n feasible expected trajectory decisions s in S41 are evaluated using a relative membership matrix with following evaluation indicators:
S43, defining an appropriate expected trajectory decision s has the greatest relative membership, in the form of:
A
m=1A2,A3,A4)T=(1,1,1,1)T;
S44, defining an inappropriate expected trajectory decision s has the smallest relative membership, in the form of:
B
m=(B1,B2,B3,B4)T=(0,0,0,0)T
S45, the evaluation indicators membership function of the expected trajectory decision s is expressed in vector form as:
m
s(m1s,m2s,m3s,m4s)T
S46, the difference between an actual trajectory decision u and the appropriate expected trajectory decision s is represented by the following generalized superior target weight distance dsA:
wherein msu represents one of m1s,m2s,m3s,m4s;
S47, the difference between the actual trajectory decision u and the inappropriate expected trajectory decision is expressed by the generalized poor target weight distance dsB:
p is a distance parameter, which is called Hamming distance when p=1; Euclidean distance when p=2;
ws represents weight for security e1, efficiency e2, maneuverability e3 and regularity e4;
S48, according to formulas in S46 and S47, the generalized superior target weight distance dsA and the generalized poor target weight distance dsB of all the decisions in the set D are obtained,
and relative proximity index Cs, Cs of the appropriate expected trajectory decision for each expected trajectory decision, are calculated according to the following formula:
the difference between an actual driving route and an optimal centerline path in the driver's multi-objective decision process, is compared by using the following optimization objective function:
f=max(Cs)
if the difference is small, it means that the actual trajectory distribution approaches the road centerline, indicating that the convergence of road risk assessment models based on equivalent force distribution is good.
The present invention further provides a real-time assessment device of driving risk based on equivalent force, including:
an information collecting unit, configured to collect traffic environment information and various types of traffic environment use object information in a road environment in an area to be assessed;
an electronic control unit, which is preset with a road risk assessment model based on an equivalent force distribution, the electronic control unit is configured to receive the traffic environment information and various types of traffic environment use object information collected by the information collection unit;
wherein the road risk assessment model is used to acquire a road traffic risk E of the vehicle i in different traffic environments and the equivalent force distribution Fij between the vehicle i and the object j, and the object j represents any traffic element other than vehicle i in various traffic environment use object information, the road traffic risk E may be expressed as the sum of kinetic energy Ei of the vehicle i, kinetic energy Ej of the object j, and the relative kinetic energy Eij between the vehicle i and the object j.
Further, “Eij” and “Fij” in S3 are defined as follows:
wherein Fij,max represents the maximum equivalent force on the object j loaded by the vehicle i,
mi represents a mass of the vehicle i; vi represents a speed of the vehicle i; vij represents a relative speed between the vehicle i and the object j; dij represents a relative distance between the vehicle i and the object j; vi, vij, dij each is a vector, θij is an angle from dij to vij, θij* is an angle from dij to vi, a counterclockwise direction is defined as positive; wki is a probability weight of the vehicle i to maintain a current wheel angle and to change the current wheel angle; wkj is a probability weight of the object j to maintain an angle of current state and to change the angle.
Further,
the object j is defined as a vehicle, wkj represents a probability weight of the vehicle j to maintain a current wheel angle and to change the current wheel angle; pki(δki) represents a steering probability of vehicle i at a next moment steering angle along a steering angle δki; pkj(δkj) represents a steering probability of vehicle j at a next moment steering angle along a steering angle δkj; δ0=0 indicating straight-line driving, p0(δ0) indicating the probability that the vehicle i and the vehicle j go straight;
pki(δki), pkj(δkj), p0(δ0) can be obtained by the following calculation expression:
wherein k, n∈Z; Δδ represents an increment of the steering angle; if k is a positive integer, δk means turning to left; if k is a negative integer, δk means turning to right.
Further, the device includes:
a verification module, which is used for verifying the rationality of steering probability of the vehicle according to distribution law of the possible trajectory of the driver, based on the equivalent force distribution Fij.
Further, the specific work of the verification module includes:
taking the target weight distance ds of all feasible expected trajectory decisions s of the driver, s=1 . . . n, and forming a set D to be determined,
D={d
1
,d
2
,d
3
, . . . d
n};
security e1, efficiency e2, maneuverability e3 and regularity e4 forming an evaluation index set as following:
E={e
1
,e
2
,e
3
,e
4};
through the security e1, efficiency e2, maneuverability e3 and regularity e4, using a relative membership matrix with following evaluation indicators to evaluate the n feasible expected trajectory decisions s,
defining an appropriate expected trajectory decision s has the greatest relative membership, in the form of:
A
m=(A1,A2,A3,A4)T=(1,1,1,1)T;
defining an inappropriate expected trajectory decision s has the smallest relative membership, in the form of:
B
m=(B1,B2,B3,B4)T=(0,0,0,0)T
the evaluation indicators membership function of the expected trajectory decision s is expressed in vector form as:
m
s(m1s,m2s,m3s,m4s)T
the difference between an actual trajectory decision u and the appropriate expected trajectory decision s is represented by the following generalized superior target weight distance dsA:
wherein msu represents one of m1s,m2s,m3s,m4s;
the difference between the actual trajectory decision u and the inappropriate expected trajectory decision is expressed by the generalized poor target weight distance dsB:
p is a distance parameter, which is called Hamming distance when p=1; Euclidean distance when p=2;
ws represents weight for security e1, efficiency e2, maneuverability e3 and regularity e4;
according to formulas as above, the generalized superior target weight distance dsA and the generalized poor target weight distance dsB of all the decisions in the set D are obtained, and relative proximity index Cs, Cs of the appropriate expected trajectory decision for each expected trajectory decision, are calculated according to the following formula:
the difference between an actual driving route and an optimal centerline path in the driver's multi-objective decision process, is compared by using the following optimization objective function:
f=max(Cs)
if the difference is small, it means that the actual trajectory distribution approaches the road centerline, indicating that the convergence of road risk assessment models based on equivalent force distribution is good.
The present invention has the following advantages due to the above technical solutions.
1. The present invention can obtain real-time traffic environment information and various traffic environment use object information in the road environment in the area to be assessed, and can perform real-time driving risk assessment based on the surrounding environment information. Therefore, the present invention can provide a basis for vehicle path planning and driving decision-making. At the same time, the present invention forms a complete driving risk assessment system to be applied to typical scenarios. The present invention is suitable for the risk estimation between vehicles in any scenario, thereby being more conducive to promoting the development of auxiliary driving systems suitable for complex road conditions, thereby realizing large-scale industrial applications on commercial vehicles, military vehicles, and passenger vehicles.
2. The present invention provides a road risk assessment model based on an equal effectiveness distribution, so that the traffic risk distribution expressed in an equal effectiveness form can be calculated at any time. In this model, any surrounding moving objects can be included, not limited to vehicles that are directly close to the vehicle. The road risk assessment model based on equal power distribution takes more potential risk factors into consideration, and can realize the risk prediction of the surrounding driving environment. Based on this model, autonomous vehicles can more accurately identify traffic risks and make decisions from the perspective of risk situations. Therefore, autonomous vehicles can perform actions, such as acceleration, braking or path planning, more safely, thereby realizing automatic driving control.
3. The present invention can establish a driving risk assessment database regarding various scenarios, which may be widely used in traffic control. With the rapid development of smart vehicle technology, traffic managers have more opportunities to capture the movement information of all road users in a timely manner, including GPS location, vehicle speed, pedestrians, and so on. In this case, real-time traffic risk assessment of each road in the urban environment can be used to manage and control traffic safety in a timely manner. It will be a big advantage for traffic management personnel to manage traffic flow based on the timely allocation of traffic risks. By using the present invention, under the balanced control of risk and efficiency, the traffic environment will become safer and more efficient.
The invention will now be described in detail in conjunction with the drawings and embodiments.
The real-time assessment method of driving risk based on equivalent force provided by one embodiment includes:
S1, collecting traffic environment information and various types of traffic environment use object information in a road environment in an area to be assessed.
“Traffic environment information” includes roadside equipments used to collect traffic environment information. For example, roadside equipments includes road cameras (single/binocular cameras), radar (millimeter wave radar), and communication base stations for people, vehicles, and road networks.
“Traffic environment use object information” includes the type and state of the traffic environment use object, wherein the types of the traffic environment use object include non-motor vehicles (non-motor vehicles including pedestrians, bicycles, motorcycles, etc.), and motor vehicles (motor vehicles including small vehicles, buses and trucks, etc., objects, fixed traffic signs and facilities. The state of the traffic environment use object includes information such as the speed and speed direction of the object, geometric size, category, mass, and the like. The objects are stationary objects on the road surface, including a movable guardrail and a cone. The fixed traffic signs and facilities include traffic lights, static traffic signs (for example, a speed limit board, warning signs), and the like.
S2. Inputting, into an electronic control unit of a vehicle, the traffic environment use object information and the environment information acquired in S1, wherein a road risk assessment model based on the equivalent force distribution is preset in the electronic control unit.
S3, Using the road risk assessment model, so as to acquire a road traffic risk E of the vehicle i and the equivalent force distribution Fij between the vehicle i and the object j in different traffic environments, and the object j represents any traffic element other than vehicle i in various traffic environment use object information, the road traffic risk E may be expressed as the sum of kinetic energy Ei of the vehicle i, kinetic energy Ej of the object j, and the relative kinetic energy Eij between the vehicle i and the object j.
In the following, the “Eij” and “Fij” in S3 will be described in detail according to various traffic environments or traffic scenes.
First, “follow-up scene” (or vehicle following scene) and “overtaking scene”, in which object j is defined as a vehicle.
In
The traffic risk caused by vehicle i and vehicle j is the same as that of a single moving object. Therefore, traffic risks are defined as follows:
Where mi represents the mass of the vehicle i, mj represents the mass of the object j, vi represents the speed of the vehicle i, vj represents the speed of the object j, xi represents the longitudinal position of the vehicle i, xj represents the longitudinal position of the object j, and Δxi represents the distance between the vehicle i and its target point in front of it. Δxj represents the distance between the moving object j and the target point in front of it.
In the follow-up, a collision event may only occur between the following vehicle (vehicle behind) i and the vehicle ahead j. That is, if event A is set to indicate that vehicle i has collided with vehicle j, and event B indicates that vehicle j has collided with vehicle i, the probability of event A must be greater than zero, and the probability B of the event is absolutely equal to zero. Therefore, the present embodiment defines the following vehicle as an active collision participant (ACP) and the preceding vehicle as a passive collision participant (PCP). The traffic risk between ACP and PCP is defined as follows:
This embodiment sets Fij=½mivi*TTCi, and Fij represents the equivalent force on the object j loaded by the vehicle i. “Eij”, “Fij”, and “Fij,max” can be expressed as:
Where Fij,max is the maximum equivalent force on the object j loaded by the vehicle i, and its specific expression is:
Where mi is the mass of vehicle i, vi is the speed of vehicle i, vij is the relative speed between vehicle i and object j; θij is the angle from dij to vij; θij* is the angle from dij to vi; counterclockwise is defined as positive; dij represents the relative distance between vehicle i and object j, ie |xi−x1|; TTCi represents the reciprocal of TTC, and TTC is the collision time.
Therefore, the traffic risk E of the road environment under the follow-up scene can be defined as the sum of the kinetic energy Ei of the vehicle i, the kinetic energy Ej of the object j and the relative kinetic energy Eij between the vehicle i and the object j.
The above section describes the relationship between two vehicles in the follow-up scene.
In
Then there is:
In addition,
In two-vehicle scene (
The maximum force on the vehicle j loaded by i is calculated as follows:
In two-vehicle scene, the real-time risk of driving can also be described by mathematical equations.
As shown in
According to certain traffic rules and road constraints that road users must observe in the traffic environment, this embodiment assumes that during normal driving and steering, the driver always follows the traffic rules and laws. That is, the vehicle can only travel forward in the straight lane. Therefore, when a vehicle is in a free-running state on a straight road, it is assumed that its speed and steering angle are continuous constant values. The position of the vehicle in the road environment at the next moment can be predicted by the road risk assessment model based on the equivalent force distribution, and the possible motion trajectory of the vehicle can be predicted based on each predicted position.
A schematic diagram of the range of possible motion trajectories is shown in
As shown in
Where K represents the stability factor, L represents the wheelbase of the vehicle i, and δ represents the steering angle.
When the vehicle i is driving at a constant speed with a negligible side slip angle, the predicted position (xip, yip) at the time range tp with the commanded steering angle δ can be calculated as follows:
It is assumed that the vehicle i is always has been in a controlled and stable driving state. The maximum speed and turning radius should be determined according to road conditions. The motion state of vehicle i is limited by the following formula:
Wherein, FX and FY respectively represent a longitudinal and lateral forces of the vehicle FZ represents a ground reaction force, φ represents a adhesion coefficient, f represents a rolling resistance coefficient, CD represents an air resistance coefficient, and A represents the windward area of the vehicle i.
According to the above, the relationship between the steering angle δ and the speed can be derived as follows:
According to the above, the relationship between the steering angle δ and the speed vi can be derived as follows:
among them,
As the speed of the vehicle increases, the allowable steering angle is obtained as follows:
The steering angle δi is related to the mechanical design of the vehicle i, the maximum of which is equal to the steering angle limit δmax. Usually, the passenger vehicle is δmax ∈[−π/4, π/4].
|δ(t)|≤δmax
Further depending on the range of steering angles, the possible trajectory of the vehicle i should have a certain boundary and the motion state of the vehicle i is stable within this boundary.
In
Where k, n∈Z; Δ δ represents the increment of the steering angle; if k is a positive integer, δ k means turning to the left; if k is a negative integer, δ k means turning to the right.
However, it is difficult to predict the driver's steering angle and assign a corresponding value to the steering probability. To solve this problem, the present embodiment uses real free driving experimental data.
The details of the experimental route are shown in
The details of the results are shown in
As shown in
k∈[−n, n] and k, n∈Z. p0 (δ0) indicates the probability that the vehicle will stay at an angle at the next moment; pk(δk) indicates the probability that the vehicle will turn at the angle at the next moment.
The equivalent force of each predicted point of the vehicle i can be calculated as follows:
Finally, the traffic risk map of the straight-through vehicle i is described by MATLAB, as shown in
Similarly, for the two vehicles, the weight of the equivalent force and equivalent force of the vehicle i may be defined as wki. The weight of the equivalent force and equivalent force of the vehicle j may be defined as wkj.
Then it can be obtained that the equivalent force on the vehicle j loaded by the vehicle i can be calculated as follows:
The equivalent force of vehicle i on the traffic environment Fki is expressed as:
Then the kinetic energy of the vehicle i is: Ei=Fki·Δxi
The equivalent force of object j on the traffic environment Fkj is expressed as:
then the kinetic energy Ej of the object j is:
E
j
=F
kj
·Δx
j
On the basis of
As shown in
In a normal driving process, the driver will give priority to ensuring the safety of the vehicle, that is, ensure that there is a certain relative distance between the vehicle and the boundary of the feasible area of the road, so that the vehicle can drive in a relatively safe position in the feasible area. Secondly, as far as the driver's own factors are concerned, the driver always hopes that the input action change to the vehicle is as small as possible, which is expressed in terms of ease of maneuverability. Drivers seek to reach their destinations as efficiently as possible, so there is an index of efficiency. Finally, the turning angle and range of the car must comply with the traffic rules during the driving process. The design performance of the vehicles itself determines that the vehicle's turning ability has certain limitations. Such restrictions correspond to regular indicators. Therefore, when evaluating whether the predicted trajectory is in line with the actual manipulation trajectory, the four indicators used include security, efficiency, maneuverability and regularity.
The method of the embodiment of the present invention further includes:
S4, based on the equivalent force distribution Fij obtained in S3, the rationality of steering probability of the vehicle is verified according to distribution law of the possible trajectory of the driver.
S4 includes the following steps:
S41, taking the target weight distance ds of all feasible expected trajectory decisions s of the driver, s=1 . . . n, and forming a set D to be determined,
D{d
1
,d
2
,d
3
, . . . d
n};
S42, security e1, efficiency e2, maneuverability e3 and regularity e4 forming an evaluation index set as following:
E={e
1
,e
2
,e
3
,e
4};
through the security e1, efficiency e2, maneuverability e3 and regularity e4, the n feasible expected trajectory decisions s in S41 are evaluated using a relative membership matrix with following evaluation indicators:
S43, defining an appropriate expected trajectory decision s has the greatest relative membership, in the form of:
A
m=(A1,A2,A3,A4)T=(1,1,1,1)T;
S44, defining an inappropriate expected trajectory decision s has the smallest relative membership, in the form of:
B
m=(B1,B2B3B4)T=(0,0,0,0)T
S45, the evaluation indicators membership function of the expected trajectory decision s is expressed in vector form as:
m
s(m1s,m2s,m3s,m4s)T
S46, the difference between an actual trajectory decision u and the appropriate expected trajectory decision s is represented by the following generalized superior target weight distance dsA:
wherein msu represents one of m1s,m2s,m3s,m4s;
S47, the difference between the actual trajectory decision u and the inappropriate expected trajectory decision is expressed by the generalized poor target weight distance dsB:
p is a distance parameter, which is called Hamming distance when p=1; Euclidean distance when p=2;
ws represents weight for security e1, efficiency e2, maneuverability e3 and regularity e4;
S48, according to formulas in S46 and S47, the generalized superior target weight distance dsA and the generalized poor target weight distance dsB of all the decisions in the set D are obtained,
and relative proximity index Cs, Cs of the appropriate expected trajectory decision for each expected trajectory decision, are calculated according to the following formula:
the difference between an actual driving route and an optimal centerline path in the driver's multi-objective decision process, is compared by using the following optimization objective function:
f=max(Cs)
if the difference is small, it means that the actual trajectory distribution approaches the road centerline, indicating that the convergence of road risk assessment models based on equivalent force distribution is good.
As shown in
In the above embodiments, the reference coordinate system based on xi can be defined as: the x-axis is a horizontal axis parallel to the traveling direction of the vehicle i, the y-axis is a vertical axis perpendicular to the traveling direction of the vehicle i, and the positive direction of the x-axis is the traveling direction of the vehicle i.
The invention also provides a real-time assessment device of driving risk based on equivalent force, including: an information collecting unit and an electronic control unit.
The information collecting unit is configured to collect traffic environment information and various types of traffic environment use object information in a road environment in an area to be assessed.
The electronic control unit is preset with a road risk assessment model based on an equivalent force distribution, the electronic control unit is configured to receive the traffic environment information and various types of traffic environment use object information collected by the information collection unit.
The road risk assessment model is used to acquire a road traffic risk E of the vehicle i in different traffic environments and the equivalent force distribution Fij between the vehicle i and the object j, and the object j represents any traffic element other than vehicle i in various traffic environment use object information, the road traffic risk E may be expressed as the sum of kinetic energy Ei of the vehicle i, kinetic energy Ej of the object j, and the relative kinetic energy Eij between the vehicle i and the object j.
In one embodiment, the “Eij” and “Fij” obtained by the road risk assessment model based on the equivalent force distribution are as follows:
Fij,max is the maximum equivalent force on the object j loaded by the vehicle i, and its specific expression is:
mi represents a mass of the vehicle vi; represents a speed of the vehicle i; vij represents a relative speed between the vehicle i and the object j; dij represents a relative distance between the vehicle i and the object; vi, vij, dij each is a vector, θij is an angle from dij to vij, θij* is an angle from dij to vi, a counterclockwise direction is defined as positive; wki is a probability weight of the vehicle i to maintain a current wheel angle and to change the current wheel angle; wki is a probability weight of the object j to maintain an angle of current state and to change the angle.
The “Eij” and “Fij” obtained in the above embodiments can be displayed on the graphical interface of the vehicle for the driver's reference, and the autonomous vehicle can perform operations more safely, such as acceleration, braking or path planning, thereby implementing an automatic driving control. “Eij” and “Fij” can be displayed on the graphical interface of the traffic management system for traffic management personnel to manage the traffic flow according to the traffic risk. With the present invention, the traffic environment will become safer and more efficient under the balance of risk and efficiency.
In one embodiment, “wki” and “wkj” are calculated by the following formulas, respectively,
the object j is defined as a vehicle, wkj represents a probability weight of the vehicle j to maintain a current wheel angle and to change the current wheel angle; pki(δki) represents a steering probability of vehicle i at a next moment steering angle along a steering angle θki; pkj(δkj) represents a steering probability of vehicle j at a next moment steering angle along a steering angle δkj; δ0=0 indicating straight-line driving, p0(δ0) indicating the probability that the vehicle i and the vehicle j go straight;
pki(δki), pkj(δkj), p0(δ0) can be obtained by the following calculation expression:
wherein k, n∈Z; Δδ represents an increment of the steering angle; if k is a positive integer, δk means turning to left; if k is a negative integer, δk means turning to right.
In one embodiment, the device further include a verification module, which is used for verifying the rationality of steering probability of the vehicle according to distribution law of the possible trajectory of the driver, based on the equivalent force distribution Fij.
In another embodiment, the specific work of the verification module includes:
taking the target weight distance ds of all feasible expected trajectory decisions s of the driver, s=1 . . . n, and forming a set D to be determined,
D={d
1
,d
2
,d
3
, . . . d
n};
security e1, efficiency e2, maneuverability e3 and regularity e4 forming an evaluation index set as following:
E={e
1
,e
2
,e
3
,e
4};
through the security e1, efficiency e2, maneuverability e3 and regularity e4, using a relative membership matrix with following evaluation indicators to evaluate the n feasible expected trajectory decisions s,
defining an appropriate expected trajectory decision s has the greatest relative membership, in the form of:
A
m=(A1,A2,A3,A4)T=(1,1,1,1)T;
defining an inappropriate expected trajectory decision s has the smallest relative membership, in the form of:
B
m=(B1,B2,B3,B4)T=(0,0,0,0)T
the evaluation indicators membership function of the expected trajectory decision s is expressed in vector form as:
m
s=(m1s,m2s,m3s,m4s)T
the difference between an actual trajectory decision u and the appropriate expected trajectory decision s is represented by the following generalized superior target weight distance dsA:
wherein msu represents one of m1s,m2s,m3s,m4s;
the difference between the actual trajectory decision u and the inappropriate expected trajectory decision is expressed by the generalized poor target weight distance dsB:
p is a distance parameter, which is called Hamming distance when p=1; Euclidean distance when p=2;
ws represents weight for security e1, efficiency e2, maneuverability e3 and regularity e4;
according to formulas as above, the generalized superior target weight distance dsA and the generalized poor target weight distance dsB of all the decisions in the set D are obtained,
and relative proximity index Cs, Cs of the appropriate expected trajectory decision for each expected trajectory decision, are calculated according to the following formula:
the difference between an actual driving route and an optimal centerline path in the driver's multi-objective decision process, is compared by using the following optimization objective function:
f=max(Cs)
if the difference is small, it means that the actual trajectory distribution approaches the road centerline, indicating that the convergence of road risk assessment models based on equivalent force distribution is good.
Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, and are not limited thereto. It should be understood by those skilled in the art that the technical solutions described in the foregoing embodiments may be modified, or some of the technical features may be equivalently substituted; the modifications or substitutions do not deviate from the spirit and scope of the technical solutions of the embodiments.
Number | Date | Country | Kind |
---|---|---|---|
201810433436.8 | May 2018 | CN | national |
This application is the national phase entry of International Application No. PCT/CN2018/086639, filed on May 14, 2018, which is based upon and claims priority to Chinese Patent Application No. 201810433436.8, filed on May 8, 2018, the entire contents of which are incorporated herein by reference.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/CN2018/086639 | 5/14/2018 | WO | 00 |