REAL-TIME DRIVING RISK ASSESSMENT METHOD EMPLOYING EQUIVALENT FORCE AND DEVICE THEREOF

20220036735 · 2022-02-03

Assignee

Inventors

Cpc classification

International classification

Abstract

A real-time assessment method of driving risk based on equivalent force 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; 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 F.sub.ij between the vehicle i and the object j in different traffic environments, wherein the object j represents any traffic element other than vehicle i in various traffic environment use object information. A real-time assessment device of driving risk based on equivalent force is further provided.

Claims

1. A real-time assessment method of driving risk based on equivalent force, comprising: 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 various types of traffic environment use object information and the traffic environment information acquired in S1, wherein a road risk assessment model based on an equivalent force distribution is preset in the electronic control unit; S3, using the road risk assessment model to acquire a road traffic risk E of a vehicle i and an equivalent force distribution F.sub.ij between the vehicle i and an object j in different traffic environments, wherein the object j represents any traffic element other than the vehicle i in the various types of traffic environment use object information, the road traffic risk E is expressed as a sum of kinetic energy E.sub.i of the vehicle i, kinetic energy E.sub.j of the object j, and relative kinetic energy E.sub.ij between the vehicle i and the object j.

2. The real-time assessment method according to claim 1, wherein E.sub.ij and F.sub.ij in S3 are defined as follows: E ij = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * ) ; F ij = 1 2 w ki w kj F ij , max ; wherein, F.sub.ij,max represents a maximum equivalent force on the object j loaded by the vehicle i, and is expressed as: F ij , max = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * ) d ij ; wherein, m.sub.i represents a mass of the vehicle i; v.sub.i represents a speed of the vehicle i; v.sub.ij represents a relative speed between the vehicle i and the object j; d.sub.ij represents a relative distance between the vehicle i and the object j; v.sub.i, v.sub.ij, d.sub.ij each is a vector, θ.sub.ij is an angle from d.sub.ij to v.sub.ij, θ.sub.ij.sup.* is an angle from d.sub.ij to v.sub.i, a counterclockwise direction is defined as positive; w.sub.ki is a probability weight of the vehicle i to maintain a current wheel angle and to change the current wheel angle; w.sub.kj is a probability weight of the object j to maintain an angle of a current state and to change the angle of the current state.

3. The real-time assessment method according to claim 2, wherein w ki = p ki ( δ ki ) p 0 ( δ 0 ) ; w kj = p kj ( δ kj ) p 0 ( δ 0 ) ; the object j is defined as a vehicle, w.sub.ij represents a probability weight of a vehicle j to maintain the current wheel angle and to change the current wheel angle; p.sub.ki (δ.sub.ki) represents a steering probability of the vehicle i at a next moment steering angle along a steering angle δ.sub.ki; p.sub.kj(δ.sub.kj) represents a steering probability of the vehicle j at the next moment steering angle along a steering angle δ.sub.kj; δ.sub.0=0 indicates straight-line driving, p.sub.0 (δ.sub.0) indicates a probability that the vehicle i and the vehicle j go straight; p.sub.ki(δ.sub.ki), p.sub.kj(δ.sub.kj), p.sub.0(δ.sub.0) are obtained by the following calculation expression: p k ( δ k ) = 1 3.7704 * 2 π e - δ k 2 28.4318 , δ k = k * Δδ , k [ - n , n ] , wherein k, n∈Z; Δδ represents an increment of a steering angle; when k is a positive integer, δ.sub.k means turning to left; when k is a negative integer, δ.sub.k means turning to right.

4. The real-time assessment method according to claim 1, further comprising: S4, based on the equivalent force distribution F.sub.ij obtained in S3, verifying a rationality of steering probability of the vehicle according to distribution law of a possible trajectory of a driver.

5. The real-time assessment method according to claim 4, wherein the S4 comprises the following steps: S41, taking a target weight distance d.sub.s of n feasible expected trajectory decisions s of the driver, s=1 . . . n, and forming a set D to be determined,
D={d.sub.1,d.sub.2,d.sub.3, . . . d.sub.n}; S42, forming an evaluation index set by a security e.sub.1, an efficiency e.sub.2, a maneuverability e.sub.3 and a regularity e.sub.4 as follows:
E{e.sub.1,e.sub.2,e.sub.3,e.sub.4}; through the security e.sub.1, the efficiency e.sub.2, the maneuverability e.sub.3 and the regularity e.sub.4, evaluating the n feasible expected trajectory decisions s in S41 using a relative membership matrix with evaluation indicators as follows: M t = [ m 11 m 12 .Math. m 1 n m 21 m 22 .Math. m 2 n m 31 m 32 .Math. m 3 n m 41 m 42 .Math. m 4 n ] = ( m su ) 4 * n ; S43, defining an appropriate expected trajectory decision s having a greatest relative membership, in a form of:
A.sub.m=(A.sub.1,A.sub.2,A.sub.3A.sub.4).sup.T=(1,1,1,1).sup.T; S44, defining an inappropriate expected trajectory decision s having a smallest relative membership, in a form of:
B.sub.m(B.sub.1,B.sub.2B.sub.3).sup.T=(0,0,0,0).sup.T; S45, expressing an evaluation indicator membership function of an expected trajectory decision s in vector form as:
m.sub.s(m.sub.1s,m.sub.2s,m.sub.3s,m.sub.4s).sup.T S46, representing a difference between an actual trajectory decision u and the appropriate expected trajectory decision s by a generalized superior target weight distance d.sub.s.sup.A as follows: d s A = .Math. i = 1 4 [ w s ( A s - m su ) ] p p ; wherein m.sub.su represents one of m.sub.1s,m.sub.2s,m.sub.3s,m.sub.4s; S47, expressing a difference between the actual trajectory decision u and the inappropriate expected trajectory decision by a generalized poor target weight distance d.sub.s.sup.B as follows: d s B = .Math. s = 1 4 [ w s ( B s - m s u ) ] p p wherein , w = ( w 1 , w 2 , w 3 , w 4 ) T , .Math. s = 1 4 w s = 1 ; p is a distance parameter, wherein p is called Hamming distance when p=1; p is called Euclidean distance when p=2; w.sub.s represents a weight for the security e.sub.1, the efficiency e.sub.2, the maneuverability e.sub.3 and the regularity e.sub.4; S48, according to formulas in S46 and S47, obtaining the generalized superior target weight distance d.sub.s.sup.A and the generalized poor target weight distance d.sub.s.sup.B of all decisions in the set D, and calculating a relative proximity index C.sub.s of the appropriate expected trajectory decision for each expected trajectory decision according to the following formula: C s = d s B d s A + d s B , comparing a difference between an actual driving route and an optimal centerline path in a multi-objective decision process of the driver by using the following optimization objective function:
f=max(C.sub.s), wherein when the difference is small, an actual trajectory distribution approaches a road centerline, indicating that a convergence of the road risk assessment model based on the equivalent force distribution is good.

6. A real-time assessment device of driving risk based on equivalent force, comprising: an information collecting unit, wherein 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; and an electronic control unit, wherein 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 the 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 a vehicle i and an equivalent force distribution F.sub.ij between the vehicle i and an object j in different traffic environments, and the object j represents any traffic element other than the vehicle i in the various types of traffic environment use object information, the road traffic risk E is expressed as a sum of kinetic energy E.sub.i of the vehicle i, kinetic energy E.sub.j of the object j, and relative kinetic energy E.sub.ij between the vehicle i and the object j.

7. The real-time assessment device according to claim 6, wherein E.sub.ij and F.sub.ij in S3 are defined as follows: E ij = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * ) ; F ij = 1 2 w ki w kj F ij , max ; wherein F.sub.ij,max represents a maximum equivalent force on the object j loaded by the vehicle i, and is expressed as: F ij , max = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * ) d ij ; wherein, m.sub.i represents a mass of the vehicle i; v.sub.i represents a speed of the vehicle i; v.sub.ij represents a relative speed between the vehicle i and the object j; d.sub.ij represents a relative distance between the vehicle i and the object j; v.sub.i, v.sub.ij, d.sub.ij each is a vector, θ.sub.ij is an angle from d.sub.ij to v.sub.ij, θ.sub.ij.sup.* is an angle from d.sub.ij to v.sub.i, a counterclockwise direction is defined as positive; w.sub.ki is a probability weight of the vehicle i to maintain a current wheel angle and to change the current wheel angle; w.sub.kj is a probability weight of the object j to maintain an angle of a current state and to change the angle of the current state.

8. The real-time assessment device according to claim 7, wherein w ki = p ki ( δ ki ) p 0 ( δ 0 ) ; w kj = p kj ( δ kj ) p 0 ( δ 0 ) ; the object j is defined as a vehicle, w.sub.kj represents a probability weight of a vehicle j to maintain the current wheel angle and to change the current wheel angle; p.sub.ki(δ.sub.ki) represents a steering probability of the vehicle i at a next moment steering angle along a steering angle δ.sub.ki; p.sub.kj(δ.sub.kj) represents a steering probability of the vehicle j at the next moment steering angle along a steering angle δ.sub.kj; δ.sub.0=0 indicates straight-line driving, p.sub.0(δ.sub.0) indicates a probability that the vehicle i and the vehicle j go straight; p.sub.ki(δ.sub.ki), p.sub.kj(δ.sub.kj), p.sub.0(δ.sub.0) are obtained by the following calculation expression: p k ( δ k ) = 1 3 . 7 7 0 4 * 2 π e - δ k 2 28.431 8 , δ k = k * Δδ , k [ - n , n ] , wherein k, n∈Z; Δδ represents an increment of a steering angle; when k is a positive integer, δ.sub.k means turning to left; when k is a negative integer, δ.sub.k means turning to right.

9. The real-time assessment device according to claim 6, further comprising: a verification module, wherein the verification module is used for verifying a rationality of steering probability of the vehicle according to distribution law of a possible trajectory of a driver, based on the equivalent force distribution F.sub.ij.

10. The real-time assessment device according to claim 9, wherein a specific work of the verification module comprises: taking a target weight distance d.sub.s of n feasible expected trajectory decisions s of the driver, s=1 . . . n, and forming a set D to be determined,
D={d.sub.1,d.sub.2,d.sub.3, . . . d.sub.n}; forming an evaluation index set by a security e.sub.1, an efficiency e.sub.2, a maneuverability e.sub.3 and a regularity e.sub.4 as follows:
E={e.sub.1,e.sub.2,e.sub.3,e.sub.4}; through the security e.sub.1, the efficiency e.sub.2, the maneuverability e.sub.3 and the regularity e.sub.4, using a relative membership matrix with evaluation indicators as follows to evaluate the n feasible expected trajectory decisions s, M t = [ m 11 m 12 .Math. m 1 n m 21 m 2 2 .Math. m 2 n m 31 m 3 2 .Math. m 3 n m 41 m 4 2 .Math. m 4 n ] = ( m s u ) 4 * n ; defining an appropriate expected trajectory decision s having a greatest relative membership, in a form of:
A.sub.m=(A.sub.1,A.sub.2,A.sub.3,A.sub.4)T=(1,1,1,1).sup.T; defining an inappropriate expected trajectory decision s having a smallest relative membership, in a form of:
B.sub.m=(B.sub.1,B.sub.2,B.sub.3,B.sub.4).sup.T=(0,0,0,0).sup.T; expressing an evaluation indicator membership function of an expected trajectory decision s in vector form as:
m.sub.s=(m.sub.1s,m.sub.2s,m.sub.3s,m.sub.4s).sup.T representing a difference between an actual trajectory decision u and the appropriate expected trajectory decision s by a generalized superior target weight distance d.sub.s.sup.A as follows: d s A = .Math. i = 1 4 [ w s ( A s - m s u ) ] p p ; wherein m.sub.su represents one of m.sub.1s,m.sub.2s,m.sub.3s,m.sub.4s; expressing a difference between the actual trajectory decision u and the inappropriate expected trajectory decision by a generalized poor target weight distance d.sub.s.sup.B as follows: d s B = .Math. s = 1 4 [ w s ( B s - m s u ) ] p p wherein , w = ( w 1 , w 2 , w 3 , w 4 ) T , .Math. s = 1 4 w s = 1 ; p is a distance parameter, wherein p is called Hamming distance when p=1; p is called Euclidean distance when p=2; w.sub.s represents a weight for the security e.sub.1, the efficiency e.sub.2, the maneuverability e.sub.3 and the regularity e.sub.4; according to formulas as above, obtaining the generalized superior target weight distance d.sub.s.sup.A and the generalized poor target weight distance d.sub.s.sup.B of all the decisions in the set D, and calculating a relative proximity index C.sub.s of the appropriate expected trajectory decision for each expected trajectory decision according to the following formula: C s = d s B d s A + d s B , comparing a difference between an actual driving route and an optimal centerline path a multi-objective decision process of the driver, is compared by using the following optimization objective function:
f=max(C.sub.s), wherein when the difference is small, an actual trajectory distribution approaches a road centerline, indicating that a convergence of the road risk assessment model based on the equivalent force distribution is good.

11. The real-time assessment method according to claim 2, further comprising: S4, based on the equivalent force distribution F.sub.ij obtained in S3, verifying a rationality of steering probability of the vehicle according to distribution law of a possible trajectory of a driver.

12. The real-time assessment method according to claim 3, further comprising: S4, based on the equivalent force distribution F.sub.ij obtained in S3, verifying a rationality of steering probability of the vehicle according to distribution law of a possible trajectory of a driver.

13. The real-time assessment device according to claim 7, further comprising: a verification module, wherein the verification module is used for verifying a rationality of steering probability of the vehicle according to distribution law of a possible trajectory of a driver, based on the equivalent force distribution F.sub.ij.

14. The real-time assessment device according to claim 8, further comprising: a verification module, wherein the verification module is used for verifying a rationality of steering probability of the vehicle according to distribution law of a possible trajectory of a driver, based on the equivalent force distribution F.sub.ij.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0069] FIG. 1 is a schematic diagram of a vehicle following scene according to an embodiment of the present invention;

[0070] FIG. 2 is a schematic diagram of an overtaking scene according to an embodiment of the present invention;

[0071] FIG. 3 is a schematic diagram of a two-vehicles scene according to an embodiment of the present invention;

[0072] FIG. 4 is a schematic diagram of a range of predicted possible motion trajectories according to an embodiment of the present invention;

[0073] FIG. 5 is a schematic diagram of a trajectory based on a turning angle and a turning probability according to an embodiment of the present invention;

[0074] FIG. 6 is an experimental roadmap according to an embodiment of the present invention;

[0075] FIG. 7 is a diagram of the probability distribution of turning on a high-speed road section according to an embodiment of the present invention;

[0076] FIGS. 8A and 8B are is a diagram of an equivalent force distribution in a safety field according to an embodiment of the present invention; wherein, FIG. 8A is a schematic diagram, and FIG. 8B is a traffic risk diagram;

[0077] FIG. 9 is a schematic diagram of an expected trajectory of a vehicle according to an embodiment of the present invention;

[0078] FIG. 10 is a schematic diagram of a driver's vision transfer process according to an embodiment of the present invention;

[0079] FIG. 11 is a schematic diagram of the convergence of the driving trajectory according to an embodiment of the present invention.

DETAILED DESCRIPTION OF THE EMBODIMENTS

[0080] The invention will now be described in detail in conjunction with the drawings and embodiments.

[0081] The real-time assessment method of driving risk based on equivalent force provided by one embodiment includes:

[0082] S1, collecting traffic environment information and various types of traffic environment use object information in a road environment in an area to be assessed.

[0083] “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.

[0084] “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.

[0085] 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.

[0086] 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 F.sub.ij 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 E.sub.i of the vehicle i, kinetic energy E.sub.j of the object j, and the relative kinetic energy E.sub.ij between the vehicle i and the object j.

[0087] In the following, the “E.sub.ij” and “F.sub.ij” in S3 will be described in detail according to various traffic environments or traffic scenes.

[0088] First, “follow-up scene” (or vehicle following scene) and “overtaking scene”, in which object j is defined as a vehicle.

(1) Follow-Up Scene

[0089] FIG. 1 shows the road traffic risk in a follow-up scene. The follow-up scene means that vehicles are driven as queues or clusters on city roads and highways.

[0090] In FIG. 1, s*ij represents the occupied space of the vehicle i and the vehicle j in the traffic environment, sij represents the head distance between the vehicle i and the vehicle j, Lj represents the length of the vehicle j, x.sub.i represents the longitudinal position of the vehicle i, and x.sub.j represents the longitudinal position of the object j, x.sub.i is the longitudinal displacement of the vehicle i, is the longitudinal speed of the vehicle i, is the longitudinal acceleration of the vehicle i, is the longitudinal displacement of the vehicle j, is the longitudinal speed of the vehicle j, and {umlaut over (x)}.sub.j is the longitudinal acceleration of the vehicle j.

[0091] 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:

[00017] E i = 1 2 m i v i .Math. ( v i - 0 ) Δ x i .Math. Δ x i E j = 1 2 m j v j .Math. ( v j - 0 ) Δ x j .Math. Δ x j

[0092] Where m.sub.i represents the mass of the vehicle i, m.sub.j represents the mass of the object j, v.sub.i represents the speed of the vehicle i, v.sub.j represents the speed of the object j, x.sub.i represents the longitudinal position of the vehicle i, x.sub.j represents the longitudinal position of the object j, and Δx.sub.i represents the distance between the vehicle i and its target point in front of it. Δx.sub.j represents the distance between the moving object j and the target point in front of it.

[0093] 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:

[00018] E ij = 1 2 m i v i .Math. ( v i - v j ) .Math. x i - x j .Math. .Math. x i - x j .Math. = 1 2 m i v i .Math. TTCi .Math. .Math. x i - x j .Math.

[0094] This embodiment sets Fij=½mivi*TTCi, and Fij represents the equivalent force on the object j loaded by the vehicle i. “E.sub.ij”, “F.sub.ij”, and “F.sub.ij,max” can be expressed as:

[00019] E ij = F ij , max .Math. d = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * ) d ij .Math. d ij = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * )

[0095] Where F.sub.ij,max is the maximum equivalent force on the object j loaded by the vehicle i, and its specific expression is:

[00020] F ij , max = 1 2 m i v i .fwdarw. .Math. v ij .fwdarw. d ij 2 - d ij * 2 = 1 2 m i v i .Math. v ij cos ( θ ij + θ ij * ) d ij cos θ ij = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * ) d ij

[0096] Where m.sub.i is the mass of vehicle i, v.sub.i is the speed of vehicle i, v.sub.ij is the relative speed between vehicle i and object j; θ.sub.ij is the angle from d.sub.ij to v.sub.ij; θ.sub.ij.sup.* is the angle from d.sub.ij to vi; counterclockwise is defined as positive; d.sub.ij represents the relative distance between vehicle i and object j, ie |x.sub.i−x.sub.1|; TTCi represents the reciprocal of TTC, and TTC is the collision time.

[0097] Therefore, the traffic risk E of the road environment under the follow-up scene can be defined as the sum of the kinetic energy E.sub.i of the vehicle i, the kinetic energy E.sub.j of the object j and the relative kinetic energy E.sub.ij between the vehicle i and the object j.

[0098] The above section describes the relationship between two vehicles in the follow-up scene.

(2) Overtaking Scene

[0099] FIG. 2 Shows the Overtaking Scene.

[0100] In FIG. 2, (x.sub.i, y.sub.i) indicates the position of the vehicle i, (x.sub.j, y.sub.j) indicates the position of the vehicle j, v.sub.i indicates the speed of the vehicle i, and v.sub.j indicates the speed of the vehicle j. v.sub.ij and d.sub.ij represent the relative speed and distance between vehicle i and vehicle j, respectively, d.sub.ij.sup.* is the minimum relative distance between vehicle i and vehicle j, and v.sub.i, v.sub.j, v.sub.ij, d.sub.ij and d.sub.ij.sup.* each is a vector. θ.sub.ij is the angle from d.sub.ij to v.sub.ij, θ.sub.ij.sup.* is the angle from d.sub.ij to vi, and the counterclockwise direction is positive. Therefore, the maximum force on the vehicle j loaded by the vehicle i is calculated as follows:

[00021] F ij , max = 1 2 m i v i .fwdarw. .Math. v ij .fwdarw. d ij 2 - d ij * 2 = 1 2 m i v i .Math. v ij cos ( θ ij + θ ij * ) d ij cos θ ij = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * ) d ij

[0101] Then there is:

[00022] E ij = F ij , max .Math. d ij = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * ) d ij .Math. d ij = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * )

[0102] In addition, FIG. 2 shows a transient scenario where the overtaking behavior of vehicle j is a continuous process, all variables in the graph are time-varying, and F.sub.ij,max has the same properties.

(3) Two-Vehicle Scene

[0103] In two-vehicle scene (FIG. 3), the same method as the overtaking scenario can be used for analysis. The traffic risk between vehicle i and vehicle j is as follows:

[00023] E ij = F ij , max .Math. d ij = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * ) d ij .Math. d ij = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * )

[0104] The maximum force on the vehicle j loaded by i is calculated as follows:

[00024] F ij , max = 1 2 m i v i .fwdarw. .Math. v ij .fwdarw. d ij 2 - d ij * 2 = 1 2 m i v i .Math. v ij cos ( θ ij + θ ij * ) d ij cos θ ij = 1 2 m i v i .Math. v ij ( cos θ ij * - tan θ ij sin θ ij * ) d ij

[0105] In two-vehicle scene, the real-time risk of driving can also be described by mathematical equations.

[0106] As shown in FIG. 4, in a traffic environment, the driving risk is always generated by the interaction of road users and the road traffic environment. The driving risk is related to the road user's movement status and road environmental conditions. When a traffic accident occurs, it is necessary to predict the range of driving risk so as to make better driving route decision-making. Therefore, the present embodiment proposes an evaluation method that considers the range of influence of the vehicle risk, and establishes a road risk assessment model based on the equivalent force distribution.

[0107] 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.

[0108] A schematic diagram of the range of possible motion trajectories is shown in FIG. 4.

[0109] As shown in FIG. 4, (x.sub.i, y.sub.i) represents the current position information of the vehicle i. m.sub.i indicates the mass of the vehicle i. v.sub.i indicates the speed of vehicle i. Δx.sub.i indicates the distance between the vehicle i and the target point in front of it. The dark gray circle in the figure indicates the position of the predicted point (Predictive position), and the curve in which the predicted points are sequentially connected is based on the predicted trajectory (Predictive trajectory) of the predicted positions. F represents the effect of vehicle i on each position, and the turning radius R is calculated as following:

[00025] R ( t ) = [ 1 + Kv i 2 ( t ) ] L δ ( t )

[0110] Where K represents the stability factor, L represents the wheelbase of the vehicle i, and δ represents the steering angle.

[0111] When the vehicle i is driving at a constant speed with a negligible side slip angle, the predicted position (x.sub.ip, y.sub.ip) at the time range t.sub.p with the commanded steering angle δ can be calculated as follows:

[00026] [ x ip y ip ] = [ x t 0 + t 0 t p v i ( t ) .Math. cos v i ( t ) R ( t ) d t y t 0 + t 0 t p v i ( t ) .Math. sin v i ( t ) R ( t ) d t ]

[0112] 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:

[00027] F X 2 + F Y 2 = φ F Z F X = m i gf + C D Av i 2 ( t ) 2 1 . 1 5 F Y m i v i 2 ( t ) R ( t )

[0113] Wherein, F.sub.X and F.sub.Y respectively represent a longitudinal and lateral forces of the vehicle F.sub.Z represents a ground reaction force, φ represents a adhesion coefficient, f represents a rolling resistance coefficient, C.sub.D represents an air resistance coefficient, and A represents the windward area of the vehicle i.

[0114] According to the above, the relationship between the steering angle δ and the speed can be derived as follows:

[0115] According to the above, the relationship between the steering angle δ and the speed v.sub.i can be derived as follows:

[00028] .Math. δ ( t ) .Math. [ K M + 1 M .Math. v i 2 ( t ) ] N - 2 F f W .Math. v i 2 ( t ) - W 2 .Math. v i 4 ( t )

[0116] among them,

[00029] W = C D A 21.15 N = φ 2 F Z 2 - m i 2 g 2 f 2 M = m i / L F f = m i gf

[0117] As the speed of the vehicle increases, the allowable steering angle is obtained as follows:

[00030] .Math. δ ( t ) .Math. [ K M + 1 M .Math. v i 2 ( t ) ] N - 2 F f W .Math. v i 2 ( t ) - W 2 .Math. v i 4 ( t )

[0118] The steering angle δ.sub.i is related to the mechanical design of the vehicle i, the maximum of which is equal to the steering angle limit δ.sub.max. Usually, the passenger vehicle is δ.sub.max ∈[−π/4, π/4].


|δ(t)|≤δ.sub.max

[0119] 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.

[0120] In FIG. 5, (x.sub.i, y.sub.i) represents the current position of the vehicle i, m.sub.i represents the mass of the vehicle i, and v.sub.i represents the speed of the vehicle i. (δ, p) is the steering angle and probability of occurrence of different curves in the graph. As shown in FIG. 5, the outermost dotted line indicates the left and right limits of the predicted trajectory. When the vehicle is going straight on the road, the driver can take the following actions: go straight, turn to the left lane, turn to the right lane. This embodiment assumes that the driver will turn the steering wheel, δk represents the steering angle of the vehicle, and Pk represents the steering probability of the vehicle, and the turning probability Pk can be defined as follows:

[00031] .Math. k = - n n p k = 1 δ k = k * Δ δ , k [ - n , n ]

[0121] 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.

[0122] 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.

[0123] The details of the experimental route are shown in FIG. 6. The free driving database contains a large amount of raw experimental data of actual and experienced drivers, including GPS data and vehicle data. In addition, the database contains measurement points for approximately 32.5 hours and over 110,000 road experimental data. Therefore, this embodiment counts all highway experimental statistics to analyze the steering angle of the driver. The probability of the steering angle of the highway section is basically Gaussian normal distribution.

[0124] The details of the results are shown in FIG. 7. The Gaussian normal distribution is defined as follows:

[00032] p k ( δ k ) = f ( δ k .Math. μ , σ ) = 1 σ 2 π e - ( δ k - μ ) 2 2 σ 2 = 1 3.7704 * 2 π e - δ k 2 28.431 8

[0125] As shown in FIGS. 8A and 8B, the present invention describes a new concept in the field of traffic safety, which uses a series of equivalent forces to describe the potential impact of the traffic environment on road users. Following this principle, when road users, including vehicles, pedestrians and cyclists, are driving on the road, the road environment will be covered by this force. As mentioned earlier, traffic risks are caused by active collision participants (ACP) and passive collision participants (PCP). Active or passive is a relative concept. In a real traffic environment, each road user can be displayed as an ACP or PCP in different time and space. By analyzing the range and distribution of equal effects, the safety rate of the road environment can be quantified. The value of the equivalent force decreases as the distance between the predicted point and the road user increases. Similarly, in FIG. 8A, the weight wk at which the vehicle i or the vehicle j maintains the current state and the probability of changing the steering angle can be defined as:

[00033] w k = p k ( δ k ) p 0 ( δ 0 )

[0126] k∈[−n, n] and k, n∈Z. p.sub.0 (δ.sub.0) indicates the probability that the vehicle will stay at an angle at the next moment; p.sub.k(δ.sub.k) indicates the probability that the vehicle will turn at the angle at the next moment.

[0127] The equivalent force of each predicted point of the vehicle i can be calculated as follows:

[00034] F ki = E Δ x i .Math. w k = 1 2 w k m i v i 2 Δ x i

[0128] Finally, the traffic risk map of the straight-through vehicle i is described by MATLAB, as shown in FIG. 8B (mi=1500 kg, vi=20 m/s). For ease of analysis, the zero value of the equivalent force is set to white. The boundary of the traffic risk-affected area is clearly shown by the curved curve separated by the white area and the deep blue area in FIG. 8B. Furthermore, the value of the equivalent force gradually decreases as the longitudinal and lateral distances increase. Furthermore, it can be seen that the boundaries of the above-mentioned affected areas will vary with vehicle speed and road conditions. It has a property that changes over time. Therefore, the traffic risk map is a map that changes over time.

[0129] Similarly, for the two vehicles, the weight of the equivalent force and equivalent force of the vehicle i may be defined as w.sub.ki. The weight of the equivalent force and equivalent force of the vehicle j may be defined as w.sub.kj.

[00035] w k i = p ki ( δ ki ) p 0 ( δ 0 ) w kj = p kj ( δ kj ) p 0 ( δ 0 )

[0130] Then it can be obtained that the equivalent force on the vehicle j loaded by the vehicle i can be calculated as follows:

[00036] F ij = 1 2 w ki w kj m i v i -> .Math. v ij -> d ij 2 - d ij * 2 = 1 2 w ki w kj m i v i .Math. v ij cos ( θ ij + θ ij * ) d ij cosθ ij = 1 2 w ki w kj m i v i .Math. v ij ( cosθ ij * - tanθ ij sinθ ij * ) d ij

[0131] The equivalent force of vehicle i on the traffic environment F.sub.ki is expressed as:

[00037] F ki = 1 2 w ki m i v i 2 Δ x i .

Then the kinetic energy of the vehicle i is: E.sub.i=F.sub.ki.Math.Δx.sub.i

[0132] The equivalent force of object j on the traffic environment F.sub.kj is expressed as:

[00038] F kj = 1 2 w kj m j v j 2 Δ x j ,

[0133] then the kinetic energy E.sub.j of the object j is:


E.sub.j=F.sub.kj.Math.Δx.sub.j

[0134] On the basis of FIGS. 8A and 8B, according to the distribution law of the possible trajectory of the driver, the probability verification is vehicleried out. In the actual driving process, there may be a certain deviation between the driver's manipulation behavior of the vehicle and the probability distribution of the expected driving trajectory. Therefore, the prediction of the driver's operation of the vehicle can be understood as the process of the driver's pursuit of optimal operation by seeking advantages and avoiding disadvantages. FIG. 9 shows a schematic diagram of the expected trajectory of the vehicle, and the trajectory schematic diagram is obtained through the calculated equivalent force distribution.

[0135] As shown in FIG. 10, the driver's perception range of the surrounding environment of the vehicle during driving has a characteristic of distributed perception to concentrated sensing. During the driving process, the driver's attention distribution law is as shown in FIG. 10. The driver's attention is first focused on the sweeping sector 1 with a radius of R1 centered on the vehicle. Then, under the premise of safety, the driver's line of sight is concentrated, and the line of sight stays in the sweeping sector 2 with the vehicle as the center and a radius of R2. At first, the driver's key visual information only considers the range near the center line of the adjacent road. Finally, under the premise of ensuring the safety of the vehicle, the driver will focus on the area in front of the vehicle lane, that is, area 3. Therefore, in the actual driving process, the driver's reception of visual information also affects the trajectory prediction.

[0136] 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.

[0137] The method of the embodiment of the present invention further includes:

[0138] S4, based on the equivalent force distribution F.sub.ij obtained in S3, the rationality of steering probability of the vehicle is verified according to distribution law of the possible trajectory of the driver.

[0139] S4 includes the following steps:

[0140] S41, taking the target weight distance d.sub.s of all feasible expected trajectory decisions s of the driver, s=1 . . . n, and forming a set D to be determined,


D{d.sub.1,d.sub.2,d.sub.3, . . . d.sub.n};

[0141] S42, security e.sub.1, efficiency e.sub.2, maneuverability e.sub.3 and regularity e.sub.4 forming an evaluation index set as following:


E={e.sub.1,e.sub.2,e.sub.3,e.sub.4};

[0142] through the security e.sub.1, efficiency e.sub.2, maneuverability e.sub.3 and regularity e.sub.4, the n feasible expected trajectory decisions s in S41 are evaluated using a relative membership matrix with following evaluation indicators:

[00039] M t = [ m 11 m 12 .Math. m 1 n m 21 m 22 .Math. m 2 n m 31 m 32 .Math. m 3 n m 41 m 42 .Math. m 4 n ] = ( m su ) 4 * n ;

[0143] S43, defining an appropriate expected trajectory decision s has the greatest relative membership, in the form of:


A.sub.m=(A.sub.1,A.sub.2,A.sub.3,A.sub.4).sup.T=(1,1,1,1).sup.T;

[0144] S44, defining an inappropriate expected trajectory decision s has the smallest relative membership, in the form of:


B.sub.m=(B.sub.1,B.sub.2B.sub.3B.sub.4).sup.T=(0,0,0,0).sup.T

[0145] S45, the evaluation indicators membership function of the expected trajectory decision s is expressed in vector form as:


m.sub.s(m.sub.1s,m.sub.2s,m.sub.3s,m.sub.4s).sup.T

[0146] 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 d.sub.s.sup.A:

[00040] d s A = .Math. i = 1 4 [ w s ( A s - m s u ) ] p p ;

wherein m.sub.su represents one of m.sub.1s,m.sub.2s,m.sub.3s,m.sub.4s;

[0147] S47, the difference between the actual trajectory decision u and the inappropriate expected trajectory decision is expressed by the generalized poor target weight distance d.sub.s.sup.B:

[00041] d s B = .Math. i = 1 4 [ w s ( B s - m s u ) ] p p w = ( w 1 , w 2 , w 3 , w 4 ) T , .Math. s = 1 4 w s = 1 ;

[0148] p is a distance parameter, which is called Hamming distance when p=1; Euclidean distance when p=2;

[0149] w.sub.s represents weight for security e.sub.1, efficiency e.sub.2, maneuverability e.sub.3 and regularity e.sub.4;

[0150] S48, according to formulas in S46 and S47, the generalized superior target weight distance d.sub.s.sup.A and the generalized poor target weight distance d.sub.s.sup.B of all the decisions in the set D are obtained,

[0151] and relative proximity index C.sub.s, C.sub.s of the appropriate expected trajectory decision for each expected trajectory decision, are calculated according to the following formula:

[00042] C s = d s B d s A + d s B

[0152] 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(C.sub.s)

[0153] 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.

[0154] As shown in FIG. 11, it can be seen that the difference between the actual driving route and the optimal centerline path in the driver's multi-objective decision process is small, that is, the actual trajectory distribution approaches the road centerline, which indicates that the convergence of the model is very good. Through the above simulation analysis, it can be considered that the set trajectory distribution probability is in line with the actual driving situation, and the predicted driving trajectory is highly realistic.

[0155] In the above embodiments, the reference coordinate system based on x.sub.i 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.

[0156] 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.

[0157] 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.

[0158] 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.

[0159] 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 F.sub.ij 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 E.sub.i of the vehicle i, kinetic energy E.sub.j of the object j, and the relative kinetic energy E.sub.ij between the vehicle i and the object j.

[0160] In one embodiment, the “E.sub.ij” and “F.sub.ij” obtained by the road risk assessment model based on the equivalent force distribution are as follows:

[00043] E ij = 1 2 m i v i .Math. v ij ( cosθ ij * - tanθ ij sinθ ij * ) ; F ij = 1 2 w ki w kj F ij , max ;

[0161] F.sub.ij,max is the maximum equivalent force on the object j loaded by the vehicle i, and its specific expression is:

[00044] F ij , max = 1 2 m i v i .Math. v ij ( cosθ ij * - tanθ ij sinθ ij * ) d ij ;

[0162] m.sub.i represents a mass of the vehicle v.sub.i; represents a speed of the vehicle i; v.sub.ij represents a relative speed between the vehicle i and the object j; d.sub.ij represents a relative distance between the vehicle i and the object; v.sub.i, v.sub.ij, d.sub.ij each is a vector, θ.sub.ij is an angle from d.sub.ij to v.sub.ij, θ.sub.ij.sup.* is an angle from d.sub.ij to v.sub.i, a counterclockwise direction is defined as positive; w.sub.ki is a probability weight of the vehicle i to maintain a current wheel angle and to change the current wheel angle; w.sub.ki is a probability weight of the object j to maintain an angle of current state and to change the angle.

[0163] The “E.sub.ij” and “F.sub.ij” 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. “E.sub.ij” and “F.sub.ij” 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.

[0164] In one embodiment, “w.sub.ki” and “w.sub.kj” are calculated by the following formulas, respectively,

[00045] w ki = p ki ( δ ki ) p 0 ( δ 0 ) ; w kj = p kj ( δ kj ) p 0 ( δ 0 ) ;

[0165] the object j is defined as a vehicle, w.sub.kj represents a probability weight of the vehicle j to maintain a current wheel angle and to change the current wheel angle; p.sub.ki(δ.sub.ki) represents a steering probability of vehicle i at a next moment steering angle along a steering angle θ.sub.ki; p.sub.kj(δ.sub.kj) represents a steering probability of vehicle j at a next moment steering angle along a steering angle δ.sub.kj; δ.sub.0=0 indicating straight-line driving, p.sub.0(δ.sub.0) indicating the probability that the vehicle i and the vehicle j go straight;

[0166] p.sub.ki(δ.sub.ki), p.sub.kj(δ.sub.kj), p.sub.0(δ.sub.0) can be obtained by the following calculation expression:

[00046] p k ( δ k ) = 1 3.7704 * 2 π e - δ k 2 28.4318 δ k = k * Δδ , k [ - n , n ]

[0167] wherein k, n∈Z; Δδ represents an increment of the steering angle; if k is a positive integer, δ.sub.k means turning to left; if k is a negative integer, δ.sub.k means turning to right.

[0168] 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 F.sub.ij.

[0169] In another embodiment, the specific work of the verification module includes:

[0170] taking the target weight distance d.sub.s of all feasible expected trajectory decisions s of the driver, s=1 . . . n, and forming a set D to be determined,


D={d.sub.1,d.sub.2,d.sub.3, . . . d.sub.n};

[0171] security e.sub.1, efficiency e.sub.2, maneuverability e.sub.3 and regularity e.sub.4 forming an evaluation index set as following:


E={e.sub.1,e.sub.2,e.sub.3,e.sub.4};

[0172] through the security e.sub.1, efficiency e.sub.2, maneuverability e.sub.3 and regularity e.sub.4, using a relative membership matrix with following evaluation indicators to evaluate the n feasible expected trajectory decisions s,

[00047] M t = [ m 11 m 12 .Math. m 1 n m 21 m 22 .Math. m 2 n m 31 m 32 .Math. m 3 n m 41 m 42 .Math. m 4 n ] = ( m su ) 4 * n ;

[0173] defining an appropriate expected trajectory decision s has the greatest relative membership, in the form of:


A.sub.m=(A.sub.1,A.sub.2,A.sub.3,A.sub.4).sup.T=(1,1,1,1).sup.T;

[0174] defining an inappropriate expected trajectory decision s has the smallest relative membership, in the form of:


B.sub.m=(B.sub.1,B.sub.2,B.sub.3,B.sub.4).sup.T=(0,0,0,0).sup.T

[0175] the evaluation indicators membership function of the expected trajectory decision s is expressed in vector form as:


m.sub.s=(m.sub.1s,m.sub.2s,m.sub.3s,m.sub.4s).sup.T

[0176] 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 d.sub.s.sup.A:

[00048] d s A = .Math. i = 1 4 [ w s ( A s - m s u ) ] p p ;

[0177] wherein m.sub.su represents one of m.sub.1s,m.sub.2s,m.sub.3s,m.sub.4s;

[0178] the difference between the actual trajectory decision u and the inappropriate expected trajectory decision is expressed by the generalized poor target weight distance d.sub.s.sup.B:

[00049] d s B = .Math. i = 1 4 [ w s ( B s - m s u ) ] p p w = ( w 1 , w 2 , w 3 , w 4 ) T , .Math. s = 1 4 w s = 1 ;

[0179] p is a distance parameter, which is called Hamming distance when p=1; Euclidean distance when p=2;

[0180] w.sub.s represents weight for security e.sub.1, efficiency e.sub.2, maneuverability e.sub.3 and regularity e.sub.4;

[0181] according to formulas as above, the generalized superior target weight distance d.sub.s.sup.A and the generalized poor target weight distance d.sub.s.sup.B of all the decisions in the set D are obtained,

[0182] and relative proximity index C.sub.s, C.sub.s of the appropriate expected trajectory decision for each expected trajectory decision, are calculated according to the following formula:

[00050] C s = d s B d s A + d s B

[0183] 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(C.sub.s)

[0184] 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.

[0185] 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.