Method for vehicle following control based on real-time calculation of dynamic safe following distance
11345346 · 2022-05-31
Assignee
Inventors
Cpc classification
B60W2050/0008
PERFORMING OPERATIONS; TRANSPORTING
B60W50/0098
PERFORMING OPERATIONS; TRANSPORTING
B60W10/18
PERFORMING OPERATIONS; TRANSPORTING
G08G1/166
PHYSICS
B60W30/165
PERFORMING OPERATIONS; TRANSPORTING
B60W30/16
PERFORMING OPERATIONS; TRANSPORTING
B60W2050/0037
PERFORMING OPERATIONS; TRANSPORTING
Y02T90/00
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
B60W2556/65
PERFORMING OPERATIONS; TRANSPORTING
International classification
B60W30/165
PERFORMING OPERATIONS; TRANSPORTING
B60W10/18
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A method for vehicle following control based on the real-time calculation of dynamic safe following distance. A preset vehicle deceleration model with three preset behavior adjustment parameters is used to obtain the absolute braking distance models of the leading and following vehicles, then to further establish the dynamic safe following distance model for calculating the dynamic safe following distance between the following vehicle and the leading vehicle in real time. In the process of vehicle following operation, the current dynamic safe following distance is compared with the current actual following distance to determine whether to adjust the following behavior of the following vehicle and how to control the following vehicle to move in safety, efficiency and smoothness.
Claims
1. A method for vehicle following control based on real-time calculation of dynamic safe following distance, comprising: (1) establishing a dynamic safe following distance model for vehicle following control; wherein the dynamic safe following distance model is established through steps of: (1.1) according to a preset control requirement of a vehicle braking from an initial velocity until it stops completely, obtaining a first preset behavior adjustment parameter and a second preset behavior adjustment parameter according to equation (1):
2. The method of claim 1, wherein in step (3), the dynamic safe following distance model established in step (1.5) is used to calculate in real time the current dynamic safe following distance between the following vehicle and the leading vehicle; the dynamic safe following distance model is described as follows:
S(v.sup.f(t),v.sup.p(t))=g.sub.f(v.sup.f(t))−cg.sub.p(v.sup.p(t))+Δs (3); wherein S(v.sup.f(t), v.sup.p(t)) is a function which can be used to calculate in real time the current safe following distance between the following vehicle and the leading vehicle under the current preset control requirement; v.sup.f(t) is the current velocity of the following vehicle; v.sup.p(t) is the current velocity of the leading vehicle; g.sub.f(v.sup.f(t)) is an absolute braking distance model of the following vehicle when it starts to brake at an initial velocity v.sup.f(t); g.sub.p(v.sup.p(t)) is an absolute braking distance model of the leading vehicle when it starts to brake at an initial velocity v.sup.p(t); Δs is a distance margin designed for eliminating calculation error to keep the following vehicle always in a safe following state after considering the time delay of the following vehicle adjusting its behavior in response to the behavior change of the leading vehicle; c is a parameter of the braking mode information, wherein c=0 indicates that the following vehicle adopts the absolute braking mode; c=1 indicates that the following vehicle adopts the relative braking mode.
3. The method of claim 1, wherein in step (1.3), the absolute braking distance of the vehicle travelling from the time it starts to brake at the initial velocity v.sub.0 to another time it stops completely is obtained through equation (4):
S.sub.B=∫.sub.0.sup.2τv(t)dt (4); wherein S.sub.B is an absolute braking distance when the vehicle starts to brake at the initial velocity v.sub.0; v(t) is the time-variable velocity function; and τ is the third preset behavior adjustment parameter; in step (1.4), the curve fitting function is established by using the numerical analysis method to reflect a mapping relationship between values of absolute braking distances S.sub.B and different initial velocity v.sub.0; the curve fitting function established above is the absolute braking distance model of the vehicle, which is further used to construct the dynamic safe following distance model.
4. A vehicular electronic system, comprising: two on-board speed sensors respectively installed on a leading vehicle and a following vehicle; two vehicle positioning devices respectively installed on the leading vehicle and the following vehicle; two wireless communication devices respectively installed on the leading vehicle and the following vehicle; one inter-vehicle distance measuring instrument installed on the following vehicle; at least one processor and a memory connected to the at least one processor, both installed on the following vehicle; wherein at least one external instruction is received by the vehicular electronic system after initialization and executed by the at least one processor to perform the method of claim 1.
5. A non-transitory computer-readable storage medium having stored thereon at least one program, wherein the at least one program is called by at least one processor through executing at least one external instruction, to perform the method of claim 1.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
DETAILED DESCRIPTION OF EMBODIMENTS
(4) The present disclosure will be further described in detail below with reference to the accompanying drawings and embodiments.
(5) The present disclosure provides a method for vehicle following control based on real-time calculation of dynamic safe following distance, which is specifically described as follows.
(6) (1) A dynamic safe following distance model is established as follows.
(7) (1.1) According to a preset control requirement of a vehicle braking from an initial velocity until it stops completely, a first preset behavior adjustment parameter and a second preset behavior adjustment parameter are obtained according to equation (1):
(8)
(9) where v.sub.0 is an initial velocity when the vehicle starts to brake and decelerate; k is the first preset behavior adjustment parameter; δ is the second preset behavior adjustment parameter; a is an acceleration of the vehicle; max( ) is a function that returns a maximum value; and max(|a|) and
(10)
reflect the control requirements for the vehicle to brake smoothly and rapidly.
(11) (1.2) A third preset behavior adjustment parameter is calculated by substituting the values of the first preset behavior adjustment parameter and the second preset behavior adjustment parameter into a preset vehicle deceleration model. The preset vehicle deceleration model is expressed by equation (2):
(12)
(13) where t is a time variable; v(t) is a time-variable velocity function and v(t)|.sub.t=−∞=v.sub.0+δ, v(t)|.sub.t=∞=−δ; tan h( ) is a hyperbolic tangent function; and τ is the third preset behavior adjustment parameter.
(14) (1.3) The absolute braking distance of the vehicle traveling from a time it starts to brake at the initial velocity v.sub.0 to another time it stops completely by substituting the values of the above three preset parameters k, δ, and τ into equation (2) and performing the time integration of equation (2).
(15) (1.4) A plurality of absolute braking distances S.sub.B corresponding to different values of the initial velocity v.sub.0 are respectively obtained by performing the above steps from (1.1) to (1.3), and a curve fitting function of the absolute braking distance changing with the initial velocity is established using a numerical analysis method, the curve fitting function established above is exactly the absolute braking distance model of the vehicle.
(16) In an embodiment, in step (1.3), the absolute braking distance of the vehicle travelling from the time it starts to brake at the initial velocity v.sub.0 to another time it stops completely is obtained through the time integration of equation (2), as shown in the following equation (4):
S.sub.B=∫.sub.0.sup.2τv(t)dt (4);
(17) where S.sub.B is the absolute braking distance when the vehicle starts to brake at the initial velocity v.sub.0; v(t) is the time-variable velocity function; and τ is the third preset behavior adjustment parameter.
(18) According to the absolute braking distances calculated by equation (4) at any initial velocity, a curve fitting function of the absolute braking distance changing with the initial velocity is further established as follows:
S.sub.B=g(v.sub.0) (5);
(19) where g(v.sub.0) is the curve fitting function of the absolute braking distance S.sub.B changing with the initial velocity v.sub.0.
(20) The dynamic safe following distance is closely related to the braking distances of the leading vehicle and the following vehicle. When determining the dynamic safe following distance, the preset control requirements needed to be satisfied respectively by the leading vehicle and the following vehicle are as follows:
(21) i) the requirements of smoothness and rapidity for the following vehicle under common braking, the requirement of safety for the following vehicle to avoid crash with the leading vehicle, and the requirement of vehicle following efficiency improvement for vehicle density increase; and
(22) ii) the requirement of safety when the leading vehicle stops in an emergency.
(23) In the above two situations, max(|a|) and
(24)
both have a unique value to satisfy the control requirements of vehicular behavior adjustment.
(25) According to the preset control requirements that the leading vehicle and the following vehicle need to satisfy during the parking brake, and the above mentioned method for establishing the absolute braking distance model of the vehicle, the absolute braking distance model of the leading vehicle and the absolute braking distance model of the following vehicle at any moment can be obtained in form of equation (5); then respectively through argument substitution, the absolute braking distance model of the leading vehicle is expressed as S.sub.B.sup.p=g.sub.p(v.sup.p(t)), and the absolute braking distance model of the following vehicle is expressed as S.sub.B.sup.f=g.sub.f(v.sup.f(t)), where v.sup.f(t) is the current velocity of the following vehicle; v.sup.p(t) is the current velocity of the leading vehicle; g.sub.f(v.sup.f(t)) is the absolute braking distance model of the following vehicle when it starts to brake at an initial velocity v.sup.f(t); g.sub.p(v.sup.p(t)) is the absolute braking distance model of the leading vehicle when it starts to brake at an initial velocity v.sup.p(t).
(26) Specifically, the deriving process of equation (1) is described as follows.
(27) a) In an actual application process, according to the control requirements for passenger and cargo transportation during vehicular braking process, a preset vehicle deceleration model that reflects the smoothness and rapidity of vehicular behavior adjustment is established below:
(28)
(29) where v.sub.0 is the initial velocity when the vehicle starts to brake; k is the first preset behavior adjustment parameter; δ is the second preset behavior adjustment parameter; k and τ are greater than 0; δ is a small velocity increment greater than 0; t is the time variable; v(t) is a time-variable velocity function and v(t)|.sub.t=−∞=v.sub.0+δ, v(t)|.sub.t=∞=−5; and tan h( ) is the hyperbolic tangent function.
(30) When k=k.sub.1, k.sub.2 and 0<k.sub.2<k.sub.1, a velocity-time curve and an acceleration-time curve are obtained as shown in
(31) Clearly, when the second preset behavior adjustment parameter δ is given, there would be a significant difference in the braking time and distance of the vehicle (from the initial velocity v.sub.0 to 0) if the first preset behavior adjustment parameter k is assigned with different values. The value of k largely determines the steepness of the curve, not only reflects the rapidity and smoothness of vehicular behavior adjustment, but also reflects a control strategy adopted by the vehicle according to the real control requirement at the present moment under a constraint of its own deceleration capacity, so that the deceleration process of the vehicle drove by any driver can be accurately described by the preset vehicle deceleration model.
(32) b) If the vehicle brakes parking according to equation (2) and the initial velocity v.sub.0 of the vehicle starting to brake parking is given, the acceleration function of the vehicle braking can be obtained by taking the time derivative of equation (2), as shown below:
(33)
(34) since tan h.sup.2(k(t−τ))≤1, the acceleration a has the largest absolute value when t=τ. The largest absolute value of the acceleration a is expressed as follows:
(35)
(36) A jerk value (that is, the time derivative of acceleration) during a variable-speed operation of the vehicle is calculated as follows:
(37)
and an second-order derivative of the acceleration is obtained:
(38)
(39) It can be known from equation (9) that, an extreme point of
(40)
occurs at tan h.sup.2(k(t−τ))=1 or tan h.sup.2(k(t−τ))=⅓, correspondingly the maximum absolute value of
(41)
can be obtained. Since tan h.sup.2(k(t−τ))=1 when, and only when t.fwdarw.±∞, it does not satisfy the engineering requirements. Therefore, the maximum absolute value of
(42)
can be obtained only when tan h.sup.2(k(t−τ))=⅓.
(43) When tan h.sup.2(k(t−τ))=⅓, the following equation is obtained:
(44)
and equation (11) is further obtained:
(45)
(46) A simultaneous equation model for calculating the first preset behavior adjustment parameter k and the second preset behavior adjustment parameter δ is established through combining equation (7) with equation (11), as shown in equation (1):
(47)
(48) In the field of vehicle application, max(|a|) and
(49)
not only reflect the performance of the vehicle in speed change operation, but also can be used to evaluate the smoothness and rapidity of the behavior adjustment of the vehicle. If |a| and
(50)
of a controlled vehicle are assigned with the maximum values that satisfy the requirement of smoothness, the behavior adjustment process of the controlled vehicle would be also the fastest. In other words, reasonably determining the values of max(|a|) and
(51)
can have a vehicle controlled to adjust its behavior smoothly and rapidly. When the vehicle brakes in an emergency, in order to ensure safety firstly, max(|a|) and
(52)
can be assigned with the maximum values within the allowable range of vehicle performance, and the smoothness of vehicle operation is sacrificed to achieve the fastest parking of the vehicle.
(53) Clearly, the values of max(|a|) and
(54)
can be determined according to different control requirements of the vehicle during the brake parking, and the values of the first preset behavior adjustment parameter k and the second preset behavior adjustment parameter δ can be obtained by using equation (1). Then, t=0 and the values of v.sub.0, k and δ are plugged into equation (2) to calculate the value of the third preset behavior adjustment parameter τ.
(55) (2) The current braking mode information of the following vehicle during its following operation is obtained in real time.
(56) (3) The current velocity of the leading vehicle and the current velocity of the following vehicle are obtained in real time, respectively.
(57) (4) The current dynamic safe following distance between the following vehicle and the leading vehicle is calculated in real time using the dynamic safe following distance model according to the current preset control requirement of the following vehicle, the current braking mode information of the following vehicle, and the current velocity of the leading vehicle and the following vehicle.
(58) (5) The current dynamic safe following distance is compared with the current actual following distance by a controller during every sampling period, to determine whether it is required to adjust the current following behavior of the following vehicle.
(59) If it is required to adjust the current following behavior of the following vehicle, the following vehicle would be controlled to adjust its behavior, so that the difference between the current actual following distance and the current dynamic safe following distance is gradually shortened until the current actual following distance equals to the current dynamic safe following distance at a certain future sampling period, thereby achieving the real-time tracking of the dynamic safe following distance.
(60) Specifically, the behavior of the following vehicle is controlled as follows.
(61) When the current dynamic safe following distance is greater than the current actual following distance, it indicates that at the present moment the higher following efficiency is achieved at the cost of greater safety risk, the following vehicle must reduce its velocity to expand the actual following distance for safety risk reduction. When the current dynamic safe following distance is less than the current actual following distance, it indicates that at the present moment the following vehicle should speed up to have the current actual following distance to be reduced under the premise of ensuring safe following operation, so that vehicle following efficiency can be improved. The above two behavior adjustment processes of the following vehicle both involve the smoothness and rapidity of vehicular variable-speed operation, and the actual following distance plays a key role in determining the smoothness and rapidity of the behavior adjustment of the following vehicle. When the current dynamic safe following distance is equal to the current actual following distance, it indicates that vehicular following operation is safe and efficient at the present moment; but at this moment if there exists velocity difference between the following vehicle and the leading vehicle, during the next sampling period the actual following distance would be not equal to the dynamic safe following distance; if no velocity difference exists between the following vehicle and the leading vehicle, the current following state would be maintained by the following vehicle under control because it belongs to a safe and efficient steady-following state until it is broken by the behavior change of the leading vehicle. The method for vehicle following control based on the real-time calculation of the dynamic safe following distance described in the present disclosure can provide a scientific and reasonable dynamic safe following distance at any time during vehicular following operation, which serves as an important indicator for evaluating the quality of vehicular following behavior, and is used as a constraint for the behavior control of the following vehicle and the adjustment of the actual following distance.
(62) Therefore, the real time calculation of dynamic safe following distance not only provides a basis for safe and efficient following operation of the following vehicle, but also creates a good condition for the following vehicle to smoothly and rapidly adjust its behavior.
(63) In an embodiment, the dynamic safe following distance between the following vehicle and the leading vehicle in step (4) is calculated by using the dynamic safe following distance model as follows:
S(v.sup.f(t),v.sup.p(t))=g.sub.f(v.sup.f(t))−cg.sub.p(v.sup.p(t))+Δs (3);
(64) where S(v.sup.f(t),v.sup.p(t)) is a function which can be used to calculate in real time the current dynamic safe following distance between the following vehicle and the leading vehicle; v.sup.f(t) is the current velocity of the following vehicle; v.sup.p(t) is the current velocity of the leading vehicle; g.sub.f(v.sup.f(t)) is the absolute braking distance model of the following vehicle when it starts to brake at an initial velocity v.sup.p(t); g.sub.p(v.sup.p(t)) is the absolute braking distance model of the leading vehicle when it starts to brake at an initial velocity v.sup.p(t); Δs is a distance margin designed for eliminating calculation error to keep the following vehicle always in safe following state after considering the time delay of the following vehicle adjusting its behavior in response to the behavior change of the leading vehicle. c is a parameter of the braking mode information, c=0 indicates that the following vehicle adopts the absolute braking mode; c=1 indicates that the following vehicle adopts the relative braking mode.
(65) In an embodiment, when the leading vehicle and the following vehicle are in a safe and efficient steady-following state, the behavior of the following vehicle is controlled by implementing the method described in the present disclosure to track the dynamic safe following distance in real time. The control process is specifically described as follows.
(66) 1) According to the dynamic safe following distance model shown in equation (3), an equation for calculating the acceleration a.sup.f of the following vehicle in a neighborhood of the safe and efficient steady-following state is established as follows:
(67)
(68) where c is a parameter of the braking mode information; v.sup.p is the current velocity of the leading vehicle; v.sup.f the current velocity of the following vehicle; g.sub.f (v.sup.f) is the absolute braking distance model of the following vehicle when it starts to brake at the initial velocity v.sup.f; g.sub.p(v.sup.p) is the absolute braking distance model of the leading vehicle when it starts to brake at the initial velocity v.sup.p; c=0 indicates that the following vehicle adopts the absolute braking mode; c=1 indicates that the following vehicle adopts the relative braking mode; a.sup.p is a current acceleration of the leading vehicle.
(69) 2) A force F.sup.f required for the velocity control of the following vehicle moving at an acceleration of a.sup.f is calculated as follows:
F.sup.f=m.sup.fa.sup.f+W.sup.f (13);
(70) where m.sup.f is the mass of the following vehicle; W.sup.f is a natural resistance acted on the following vehicle during its following operation (W.sup.f>0, including an air resistance, a road surface resistance and a mechanical resistance inside the vehicle), which can be obtained using the Davis formula (W.sup.f=A+BV+CV.sup.2, where A, B and C are constant coefficients, and V is the velocity of the vehicle).
(71) Obviously, if a.sup.f=0, F.sup.f=W.sup.f, where F.sup.f is a traction force applied to the following vehicle which overcomes the natural resistance W.sup.f to make the following vehicle run at a constant velocity; if a.sup.f>0, F.sup.f is a traction force to have the following vehicle accelerate forward; if a.sup.f<0, F.sup.f is a braking force to slow down the vehicle, where F.sup.f=0 is a special situation of a.sup.f<0, which indicates that the vehicle is slowed down completely relied on the natural resistance W.sup.f.
(72) When the leading vehicle and the following vehicle are in the neighborhood of the safe and efficient steady-following state, the following vehicle can maintain the current safe and efficient steady-following state, or recover the previous safe and efficient steady-following state, or enter a new safe and efficient steady-following state from the previous safe and efficient steady-following state. The vehicle behavior is controlled through the following steps.
(73) 3) If the following vehicle adopts the absolute braking mode, c=0; If the following vehicle adopts the relative braking mode, c=1.
(74) 4) The acceleration a.sup.f required for the behavior adjustment of the following vehicle in the current sampling period is calculated by plugging the value of c determined in step 3) into equation (12).
(75) 5) The force F.sup.f that the following vehicle should apply to drive the execution structure is calculated by plugging the acceleration a.sup.f calculated in step 4) into equation (13), enabling the following vehicle to adjust its velocity at the acceleration a.sup.f.
(76) 6) When the current sampling period ends and a next sampling period is entered, that is, a new current sampling period starts, the process is returned to step 3).
(77) As shown in
(78) In an embodiment, in the case that only the position of the leading vehicle is available, the following vehicle adjusts its behavior using a first method.
(79) In the first method, the following vehicle calculates the velocity of the leading vehicle in real time by using the dynamic positions of the leading vehicle. If the position of the leading vehicle changes with time, the following vehicle can adopt the relative braking mode (c=1), or the absolute braking mode (c=0). If the position of the leading vehicle does not change with time, it is indicated that the leading vehicle is parked, so the following vehicle must adopt the absolute braking mode, that is, c=0. After obtaining the braking mode information, the following vehicle calculates the dynamic safe following distance between the following vehicle and the leading vehicle according to the dynamic safe following distance model as shown in equation (3), and then compares the calculated safe following distance with the actual following distance to determine whether to adjust the current following behavior of the following vehicle. If yes, the distance between the following vehicle and the leading vehicle is adjusted to the safe following distance by controlling the behavior of the following vehicle.
(80) In an embodiment, the safety and efficiency of the following behavior of the following vehicle is evaluated by comparing the current dynamic safe following distance with the current actual following distance, and at the same time, the current velocity and the current control strategy of the leading vehicle are taken into consideration to determine the behavior adjustment process of the following vehicle which can satisfy the safety, smoothness and rapidity requirements under the current velocity. If the leading vehicle and the following vehicle are in the neighborhood of the safe and efficient steady-following state, the control strategy and the control method adopted by the following vehicle have been described above, as shown in the steps of the control process that “when the leading vehicle and the following vehicle are in a safe and efficient steady-following state, the behavior of the following vehicle is controlled by implementing the method described in the present disclosure to track the dynamic safe following distance in real time”.
(81) In an embodiment, if the position of the leading vehicle is unavailable, a second method can be adopted to adjust the behavior of the following vehicle.
(82) In the second method, if the position of the leading vehicle cannot be obtained, the following vehicle should immediately calculate the actual following distance based on the position of the leading vehicle obtained in the last sampling period. If the actual following distance is greater than or equal to the current dynamic safe following distance in the absolute braking mode, the following vehicle can adjust its behavior in safety, smoothness, and efficiency, so that the actual following distance between the following vehicle and the leading vehicle at a certain future sampling period is adjusted to the dynamic safe following distance. If the actual following distance is less than the dynamic safe following distance, the emergency braking should be performed immediately to ensure safety.
(83) In comparison with the vehicle following control based on the traditional methods of establishing a fitting function, the method for vehicle following control based on the real-time calculation of dynamic safe following distance in the present disclosure has the following advantages.
(84) The preset vehicle deceleration model as shown in equation (2) can reflect the smoothness and rapidity of a vehicle in the brake parking under different control. Specifically, the fitting function of the absolute braking distance of the vehicle versus its braking initial velocity is established on the preset vehicle deceleration model, and used as the basis to determine the dynamic safe following distance, so that the control requirements for the following vehicle to stop safely, smoothly and rapidly can be fully considered in determining the dynamic safe following distance model.
(85) The curve fitting function is completely established on the preset vehicle deceleration model shown in equation (2) that reflects the smoothness and rapidity of a vehicle during its braking. Compared with the modelling methods of dynamic safe following distance model completely based on engineering experimental data, the method for calculating the dynamic safe following distance between the following vehicle and the leading vehicle described in the present disclosure can avoid excessive engineering experiments, reduce the engineering cost, and improve the accuracy of the curve fitting function and the efficiency of establishing the dynamical safe following distance model.
(86) The braking mode information of the following vehicle at the present moment is considered by the dynamic safe following distance model, which thereby provides an extensive suitability in calculating in real time the current safe following distance between the leading vehicle and the following vehicle for vehicle following control under complex following situations.
(87) When the method for vehicle following control described in the present disclosure is implemented, the following vehicle can control its behavior to track the dynamic safe following distance in real time, thereby integrating the safety, rapidity and smoothness requirements of vehicle following behavior adjustments into the real-time control of the dynamic safe following distance.
(88) The method mentioned above for calculating the dynamic safe following distance in real time is scientific and efficient, and thus the method for vehicle following control based on the real-time calculation of the dynamic safe following distance provided in the present disclosure is more suitable to be used as a standard for vehicle manufacturing, traffic administration and autonomous driving.