METHOD AND SYSTEM FOR OBSTACLE AVOIDANCE, INVOLVING THE CONTROL OF STEERING AND DIFFERENTIAL BRAKING SYSTEMS
20220001860 · 2022-01-06
Assignee
Inventors
Cpc classification
B60T2201/022
PERFORMING OPERATIONS; TRANSPORTING
B60T8/17558
PERFORMING OPERATIONS; TRANSPORTING
B60W50/0097
PERFORMING OPERATIONS; TRANSPORTING
International classification
B60W30/09
PERFORMING OPERATIONS; TRANSPORTING
B60T8/1755
PERFORMING OPERATIONS; TRANSPORTING
Abstract
An obstacle-avoidance method includes detecting an obstacle in a vicinity of a motor vehicle and planning an obstacle-avoidance path for avoiding the obstacle; and commanding steering and differential braking systems to handle the avoidance path.
Claims
1-11. (canceled)
12. An obstacle-avoidance method, comprising: detecting an obstacle in a vicinity of a motor vehicle and planning an obstacle-avoidance path for avoiding said obstacle; and commanding steering and differential braking systems configured to handle the avoidance path.
13. The method as claimed in claim 12, wherein, when the steering and differential braking systems are commanded, there is defined a controllability constraint during which a steering torque is limited in amplitude and in gradient and defines a stability constraint during which a slip rate and a yaw rate of the vehicle are bounded.
14. The method as claimed in claim 13, wherein a check is performed to determine whether the controllability constraint is respected, and when said constraint is respected, only the steering of the wheels is commanded.
15. The method as claimed in claim 14, wherein, when said constraint is not respected, the differential braking system is commanded.
16. The method as claimed in claim 12, wherein the following hypotheses are postulated: the steering torque does not exceed the controllability limit in amplitude and in gradient, the avoidance path is predefined, the behavior of the differential braking is modeled by a yaw moment; and the curvature of the road is zero.
17. A module configured to control steering and differential braking systems and configured to issue a wheel steering setpoint to a wheel-steering computer of a motor vehicle and a yaw moment setpoint to a braking computer of said motor vehicle.
18. The module as claimed in claim 17, further comprising a closed-loop controller for the steering system configured to follow a reference avoidance path and responding to a vehicle stability constraint.
19. The module as claimed in claim 17, further comprising a feedforward controller configured to compensate for an effect of a deviation of a path on a path following error.
20. The module as claimed in claim 17, further comprising a closed-loop controller for the differential braking system configured to improve performance of a steering loop and a stability of the vehicle.
21. An obstacle-avoidance system, comprising: an obstacle detection module configured to detect an obstacle in a vicinity of a motor vehicle and plan an obstacle-avoidance path for avoiding said obstacle, and the module configured to control the steering and differential braking systems as claimed in claim 17.
22. A motor vehicle, comprising: a system configured to locate a motor vehicle with respect to its traffic lane and to determine a lateral offset with respect to lane markings at a sighting distance and a relative heading angle of said vehicle; an obstacle detection system configured to detect obstacles in a path of the vehicle and configured to determine a longitudinal distance and overlap of the obstacle with respect to said vehicle, a gyrometer, an automatic power steering, the control module configured to control the steering and differential braking systems as claimed in claim 17, a computer configured to convert said steering angle setpoint from said control module into a torque limit for the power steering in order to perform steering, a computer configured to convert a yaw moment setpoint from said control module into torques at wheels of the vehicle in order to perform differential braking, and a sensor measuring an angle and a rate of turning of a steering wheel of the vehicle.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0034] Further objects, features and advantages of the invention will become apparent from reading the following description, given solely by way of nonlimiting example, and made with reference to the attached drawings in which:
[0035]
[0036]
[0037]
[0038]
[0039]
[0040] The obstacle-avoidance system 10 comprises an obstacle detection module 12 detecting an obstacle 1 in the vicinity of a motor vehicle 2 and planning an obstacle-avoidance path to avoid said obstacle, a control module controlling the steering (DAE) and/or differential braking systems configured to manage the avoidance path and a module 16 for stopping operation of the steering (DAE) and/or differential braking systems as soon as the motor vehicle is a predetermined distance from said obstacle 1.
[0041] The motor vehicle 2 comprises a system for locating the motor vehicle with respect to its traffic lane, such as, for example, a front-mounted camera, and capable of determining the lateral offset with respect to the lane markings at a sighting distance yL and the angle of relative heading of said vehicle ψL. The motor vehicle is also provided with an obstacle-detection system detecting obstacles in the path of the vehicle, for example a front-mounted radar, configured to determine the longitudinal distance and overlap of the obstacle with respect to said vehicle.
[0042] As illustrated in
[0043] The steering (DAE) and/or differential braking systems control module 14 is configured to issue a wheel steering setpoint δref to the wheel steering computer and a yaw moment setpoint MDB_Ref to the computer 22.
[0044] The steering (DAE) and/or differential braking systems control module 14 comprises a closed-loop controller 24 for the steering system, configured to follow the reference avoidance path and responding to the vehicle stability constraint.
[0045] The steering (DAE) and/or differential braking systems control module 14 further comprises a feedforward controller 26 configured to compensate for the effect of the deviation of the path on the path-following error.
[0046] Finally, the steering (DAE) and/or differential braking systems control module 14 comprises a closed-loop controller 28 for the differential braking system and configured to improve the performance of the steering loop, notably in the event of torque saturation and the stability of the vehicle.
[0047] As illustrated in
[0048]
[0049] In order to model the dynamics of the motor vehicle controlled by the steering system and the differential braking system, the following hypotheses are made in step 40:
[0050] When the steering torque does not exceed the controllability limit in amplitude and in gradient, the behavior of the power steering is modeled by the following equation:
[0051] Where
[0052] Where: δ is the angle between the front wheels and the longitudinal axis of the vehicle, expressed in rad; δ.sub.ref, is the setpoint angle for the front wheels, expressed in rad; and ξ and ω are two constants representing the characteristics of the actual angle of the front wheels.
[0053] Another hypothesis made is that the avoidance path is predetermined, that the behavior of the differential braking is modeled by a yawing moment. Specifically, this yawing moment is created by the braking units controlled by a computer carried on board the vehicle and which translates the yaw moment setpoint into braking torques applied to each wheel.
[0054] A final hypothesis made is that the curvature is assumed to be zero. If the curvature is nonzero, then a controller K.sub.δ.sup.ffwrd, for example of the feedforward type, can easily be calculated to eliminate the effect of the curvature on the following of the path.
[0055] If the yawing moment by differential braking cannot be estimated, then the following equation is considered:
[0056] Where:
[0057] β is the drift angle, expressed in rad;
[0058] r is the yaw rate, expressed in rad/s; y.sub.L is the lateral offset between the axis of the vehicle and the tangent to the forward path of the vehicle, expressed in m;
[0059] ψ.sub.L is the relative heading angle between the axis of the vehicle and the tangent to the reference path, expressed in rad/s; and δ is the angle between the front wheels and the longitudinal axis of the vehicle, expressed in rad;
[0060] c.sub.f is the cornering stiffness of the front wheels, expressed in N/rad;
[0061] c.sub.r is the cornering stiffness of the front wheels, expressed in N/rad;
[0062] V is the speed of the vehicle along the longitudinal axis, expressed in m/s;
[0063] M.sub.DB_ref is the yaw moment setpoint, expressed in N.m;
[0064] α.sub.DB is the yaw angle, expressed in rad.
[0065] If the yaw moment through differential braking can be estimated, then the following equation is considered:
[0066] Where:
[0067] {circumflex over ({dot over (M)})}.sub.DB is the yaw moment, expressed in N.m.
[0068] The dynamics of the differential braking system can be written according to the following equation:
{circumflex over ({dot over (M)})}.sub.DB=−t{circumflex over (M)}.sub.DB+tM.sub.DB_ref [Math 4]
[0069] Where:
[0070] M.sub.DB_ref is the yaw moment setpoint, expressed in N.m; and {circumflex over (M)}.sub.DB, is the yaw moment, expressed in N.m.
[0071] Thus, the yaw moment (rotation) and its dynamics are introduced into the control of the differential braking system. In addition, the introduction of the parameter α.sub.DD ∈[0,1] allows the actions of the steering and of the differential braking to be handled at the same time. When α.sub.DB =0, the differential braking is not needed; the steering alone is sufficient to follow the avoidance path. When α.sub.DB =1, the full capability of the differential braking will be of benefit in assisting the steering in achieving a dynamic avoidance maneuver. However, the use of 100% of the differential braking is not always necessary, and it is in these instances that α adopts values comprised between 0 and 1.
[0072] The step 34 of commanding the steering (DAE) and/or differential braking systems further comprises a step of defining a controllability constraint during which the torque TAES is limited in amplitude and gradient and a step 44 of defining a stability constraint during which the slip and yaw rate r of the vehicle are bounded.
[0073] The equation Math 3 can be rewritten as follows:
[0074] The equation Math 4 can be written in the form of a system of variable linear parameters, as follows:
[0075] Step 34 of commanding the steering (DAE) and/or differential braking systems further comprises a step 45 of verifying whether the controllability constraint is or is not or is no longer being respected and a step of commanding the steering system in instances in which the controllability constraint is being respected. The steering of the wheels alone is sufficient to effect the avoidance maneuver once the steering torque demanded is bounded by the controllability barriers. The contribution of the differential braking is zero in this instance.
[0076] In this case, the following model is considered for synthesizing the control law:
[0077] Equation Math 9 can be written according to the following equation:
[0078] The gain K.sub.δ.sup.cl can be calculated using the following equation:
K.sub.δ.sup.cl=[k.sub.1, k.sub.2 k.sub.3 k.sub.4 k.sub.5 k.sub.6] [Math 17]
[0079] Substituting δ.sub.ref=K.sub.δ.sup.cl
[0080] The feedforward k.sub.δ.sup.ffwrd is calculated to reduce the error e.sub.yL to zero in the steady state (correct following of the path in the steady state):
[0081] Solving equation Math 19 gives:
[0082] Step 34 of commanding the steering (DAE) and/or differential braking systems further comprises a step of commanding the differential braking system in instances in which the controllability constraint is not or is no longer being respected. For example, when the ratio between the lateral avoidance offset and the longitudinal avoidance distance is too great.
[0083] The differential braking needs to contribute in this case to assisting the steering and correctly following the avoidance path. Without the contribution of the differential braking, the path followed would be incorrect and could endanger the motor vehicle.
[0084] The parameter α.sub.DB is the only parameter to be controlled in order to manage the steering and differential braking system.
[0085] The parameter α.sub.DB is calculated using the following equation:
[0086] Δ.sub.T.sub.
Δ.sub.T.sub.
[0087] Where d.sub.a≥0, d.sub.s≥0 are weighting parameters (to be selected during the development phase). For example, if d.sub.s≥d.sub.a, then the gradient saturation carries more weight than the amplitude saturation in the differential braking demand, and vice versa.
[0088] Finally, the function ƒ(Δ.sub.T.sub.
[0089] a.sub.o>0 and A.sub.o0 are two parameters to be selected during on-vehicle development in order to achieve desired vehicle behaviors. With (a.sub.0=4, Δ.sub.o=2) the differential braking reacts less quickly (on saturation of the steering by the controllability constraint) than with (a.sub.o=4, Δ.sub.o=1).
[0090] Making the assumption that:
δ.sub.ref=K.sub.δ.sup.cl
[0091] together with the fact that the feed-forward gain K.sub.δ.sup.ffwrd is able to eliminate the impact of {dot over (y)}.sub.L_ref on the path-following error in the steady state, equation [Math 7]can be written:
{dot over (x)}=(A(α.sub.DB)+(1−α.sub.DB)B.sub.δK.sub.δ.sup.cl)x+B.sub.MM.sub.DB.sub.
[0092] The last objective is to find the following static state return control law:
M.sub.DB_ref=K.sub.Mx [Math 25 ]
[0093] To do this, consider the following generic system:
{dot over (x)}.sub.s=A.sub.s(θ)x.sub.s+B.sub.su.sub.s [Math 26]
[0094] Where:
[0095] x.sub.s is the state vector;
[0096] u.sub.s is the control input;
[0097] A.sub.s and B.sub.s are matrices of appropriate dimensions; and θ is the vector of known and bounded exogenous parameters in an X.sub.θpolytope of 2.sup.Nθ ends.
X.sub.θ={θ.sub.i_min≤θ.sub.i≤θ.sub.i_max, i=1: N.sub.θ} [Math 27]
[0098] Consider a controller based on static state return of the form:
u.sub.s=K.sub.sx.sub.s [Math 25 ]
[0099] Some states need to be bounded. That condition is represented by the following equations:
X.sub.0={x ∈ R.sup.n: |H.sub.0jx|≤h.sub.0j, j=1: N.sub.X.sub.
[0100] Where:
[0101] N.sub.X.sub.
[0102] This criterion is used to ensure the stability of the vehicle during an emergency (dynamic) maneuver. The stability constraint is guaranteed by applying the following inequalities:
|[0 1 0 0 0 0 0]x |≤r.sub.max [Math 30 ]
|[1 0 0 0 0 0 0]x|≤β.sub.max
[0103] The poles of the closed-loop system need to be bounded in a zone defined by a radius γ, a minimum distance with respect to the imaginary axis μ, an angle of opening φ. This criterion is used in order to have control setpoints that are reasonable and achievable by the actuators.
[0104] In order to respond to the criterion regarding the bounded states, the following conditions need to be satisfied.
[0105] In order to respond to the criterion regarding the poles of the closed loop, the following LMI conditions need to be satisfied:
[0106] In the above equations, A.sub.k is the A.sub.s(θ) matrix calculated at the k.sup.th end of the X.sub.θpolytope.
[0107] Once equations 31 to 35 have been solved, this gives the value of the static state return vector K to be applied to the control law for the steering and differential braking systems.
[0108] By virtue of the invention, the automatic calculation of the gains K for the controllers makes it possible to reduce the design time for the steering and braking systems control method. The two-step steering and differential braking control method allows for traceability and therefore makes development easier. Specifically, the step of commanding the steering is performed to meet a need in nominal cases. The step of commanding the differential braking is then performed for special cases (saturation of torques, etc.).
[0109] In addition, the management of the steering and differential braking systems while at the same time respecting the controllability and stability constraint is simple, with the use of just one parameter α.sub.DB.
[0110] Throughout the present application, the curvature obviously corresponds to the curvature of the road, the invention being able to be applied whatever the curvature and when the curvature is non-zero, the controller K.sub.δ.sup.ffwrd, for example of the feed-forward type, allows the effect of the curvature on the following of the path to be eliminated.