The present invention relates in general to automation of the following of trajectories of motor vehicles.
It has a particularly advantageous application in the context of aids for the driving of motor vehicles.
It more particularly relates to a process for automated piloting of a motor vehicle, allowing this vehicle to follow an obstacle evasion trajectory.
It also relates to a motor vehicle equipped with a computer adapted to carry out this process.
With a view to the safety of motor vehicles, they are currently equipped with driving assistance systems or self-driving systems.
Among these systems, automatic emergency braking systems (more commonly known by the abbreviation AEB) are known, which are designed to avoid any collision with obstacles located on the path taken by the vehicle. These systems are designed to detect an obstacle on the road and, in this situation, to intervene on the conventional braking system of the motor vehicle.
There are, however, situations in which these emergency braking systems do not make it possible to avoid a collision or cannot be used (for example if another vehicle is following too close behind the motor vehicle).
For these situations, automatic evasion systems (more commonly known by the abbreviation AES for “Automatic Evasive Steering” or “Automatic Emergency Steering”) have been developed, which make it possible to avoid the obstacle by diverting the vehicle from its trajectory, by intervening either on the steering of the vehicle or on the differential-braking system of the vehicle.
An obstacle evasion process is also known from the document WO2020099098, in which the steering-angle and differential-braking systems are commanded in combination in order to manage the evasive trajectory. The steering-angle system is used to ensure good stability at medium speeds, while the braking system is used at high speeds.
It sometimes happens that this AES system imposes on the vehicle a trajectory that is at the limit in terms of controllability, which does not allow the driver to take over the driving of the vehicle again in full capacity.
In order to overcome the aforementioned drawback of the prior art, the present invention proposes to use a mixed controller which intervenes both on the steering angle of the steered wheels and on the differential braking of the right and left wheels of the vehicle, and which is adapted to create a piloting setpoint that limits the amplitude and/or the rate of the steering change imposed on the motor vehicle.
More particularly, the invention provides a process for automated piloting of a motor vehicle, having steps of:
Thus, by virtue of the invention, it is possible to use a mixed control law that intervenes on the steering angle and on the differential braking so that the vehicle follows an obstacle evasion trajectory. This control law is optimized in order to ensure a control of the vehicle which performs well (that is to say it is rapid enough to ensure the obstacle evasion) and is stable and robust.
For this purpose, the invention proposes to apply constraints in terms of amplitude and rate (that is to say of setpoint variation). It preferably furthermore proposes to inhibit the calculation of the piloting setpoints, when this proves necessary, that is to say to stop the control of the brakes or of the steering angle when the conditions so require. This stopping may be temporary or permanent, until a new activation of the AES system.
Other advantageous and nonlimiting characteristics of the process according to the invention, taken individually or in any technically feasible combinations, are as follows:
The invention also provides a method for creating controllers with a view to their use in a piloting process as mentioned above, wherein provision is made:
The invention also provides a motor vehicle comprising a steering-angle actuator of the steered wheels, a differential-braking actuator of the wheels, and a computer for piloting said actuators, which is programmed in order to carry out a process as mentioned above.
The various characteristics, variants and embodiments of the invention may of course be combined with one another in various combinations so long as they are not mutually incompatible or exclusive.
The description that follows with reference to the appended drawings, which are given by way of nonlimiting examples, will clearly explain what the invention consists in and how it may be carried out.
In the appended drawings:
This motor vehicle 10 has a conventional steering system making it possible to intervene on the orientation of the front wheels 11 so as to be able to turn the vehicle. This conventional steering system has in particular a steering wheel connected to tie rods in order to make the front wheels 11 pivot. In the example considered, it also has an actuator 31 (represented in
In addition, this motor vehicle has a differential-braking system making it possible to intervene directly on the front wheels 11 (and on the rear wheels 12) so as to decelerate the motor vehicle while making it turn. This differential-braking system comprises, for example, a piloted differential or electric motors, which are positioned at the wheels of the vehicle, or brake calipers that are piloted independently of one another. It also has at least one actuator 32 (represented in
The computer 13 is then intended to pilot the assisted-steering actuator 31 and the actuators 32 of the differential-braking system as a function of the traffic conditions encountered. For this purpose, it has at least one processor, at least one memory, and an input and output interface.
By virtue of its interface, the computer 13 is adapted to receive input signals coming from various sensors.
Among these sensors, the following are for example provided:
By virtue of its interface, the computer 13 is adapted to transmit one setpoint to the assisted-steering actuator 31 and another setpoint to the actuators 32 of the differential-braking system.
It also makes it possible to force the vehicle to follow a trajectory T0 for avoiding the obstacle 20 (see
By virtue of its memory, the computer 13 stores data used in the scope of the process described below.
In particular, it stores application software consisting of computer programs comprising instructions, the execution of which by the processor makes it possible for the process described below to be carried out by the computer.
Before describing this process, the different variables that will be used may be introduced, some of which are illustrated in
The total mass of the motor vehicle will be denoted “m”, and will be expressed in kg.
The inertia of the motor vehicle about a vertical axis passing through its center of gravity CG will be denoted “J” or “Iz”, and will be expressed in N.m.
The distance between the center of gravity CG and the front axle of the vehicle will be denoted “If”, and will be expressed in meters.
The distance between the center of gravity CG and the rear axle will be denoted “Ir”, and will be expressed in meters.
The cornering stiffness coefficient of the front wheels will be denoted “Cf”, and will be expressed in N/rad.
The cornering stiffness coefficient of the rear wheels will be denoted “Cr”, and will be expressed in N/rad.
These cornering stiffness coefficients of the wheels are concepts well known to a person skilled in the art. By way of example, the cornering stiffness coefficient of the front wheels is thus that which allows the equation Ff=2·Cf·αf to be written, with Ff the lateral slip force of the front wheels and αf the drift angle of the front wheels.
The steering angle that the steered front wheels make with the longitudinal axis A1 of the motor vehicle 10 will be denoted “δ”, and will be expressed in rad.
The variable δref, expressed in rad, will denote the saturated steering-angle setpoint, as will be transmitted to the assisted-steering actuator.
The variable δK, expressed in rad, will denote the non-saturated steering-angle setpoint. At this stage, it may only be stated that the concept of saturation will be linked with limits of value or value variation.
The yaw velocity of the vehicle (about the vertical axis passing through its center of gravity CG) will be denoted “r”, and will be expressed in rad/s.
The relative heading angle between the longitudinal axis A1 of the vehicle and the tangent to the evasion trajectory T0 (desired trajectory of the vehicle) will be denoted “ΨL”, and will be expressed in rad.
The lateral deviation between the longitudinal axis A1 of the motor vehicle 10 (passing through the center of gravity CG) and the evasion trajectory T0, at a sighting distance “Is” lying in front of the vehicle, will be denoted “yL”, and will be expressed in meters.
The setpoint of lateral deviation between the longitudinal axis A1 of the motor vehicle 10 (passing through the center of gravity CG) and the evasion trajectory T0, at a sighting distance “Is” lying in front of the vehicle, will be denoted “yL-ref”, and will be expressed in meters.
The trajectory following error will be denoted “eyL”, and will be expressed in meters. It will be equal to the difference between the lateral deviation setpoint yL-ref and the lateral deviation yL.
The aforementioned sighting distance “Is” will be measured from the center of gravity CG, and will be expressed in meters.
The drift angle of the motor vehicle 10 (the angle which the velocity vector of the motor vehicle makes with its longitudinal axis A1) will be denoted “β”, and will be expressed in rad.
The velocity of the motor vehicle along the longitudinal axis A1 will be denoted “V”, and will be expressed in m/s.
The constant “g” will be the acceleration due to gravity, expressed in m·s−2.
The average curvature of the road level with the motor vehicle will denoted ρref, and will be expressed in m−1.
The setpoint of yaw moment to be applied by virtue of the differential-braking means will be denoted “Mz_ref”, and will be expressed in N.m.
The constants “ξ” and “ω” will represent dynamic characteristics of the steering angle of the front wheels of the vehicle.
The constant “ωf” will for its part represent a dynamic characteristic of an arbitrary bounded perturbation “w” applied to the vehicle.
The steering-angle velocity will denote the steering angular velocity of the steered front wheels.
As an assumption, the road on which the motor vehicle is moving is presumed to be straight and flat. They extend along a principal axis.
Before describing the process that will be performed by the computer 13 in order to carry out the invention, in a first part of this explanation the constraints that are selected in order to ensure effective piloting of the motor vehicle may be summarized, then the calculations that have made it possible to achieve the controllers allowing the invention to be implemented may be described, so as to understand clearly where these calculations come from and on what they are based.
In the part X1 of
The part X2 is in turn given over to schematizing the way in which these setpoints interact with the actuators 31, 32.
This second part X2 shows the constraints that are applied to the aforementioned setpoints so as to ensure stability and controllability of the vehicle by the driver when a driving assistance system of the AES type is activated.
The first constraint Z5, which is applied to the saturated steering-angle setpoint δref, is a velocity saturation. It is more precisely a limitation of the steering-angle velocity of the vehicle. The steering angular velocity threshold used is denoted υ.
This first constraint, by virtue of a feedback loop that provides the current steering angle δ_meas, and a controller KDAE, makes it possible to obtain a provisional engine torque.
The second constraint Z7, which is applied to the output of the controller KDAE, is an amplitude saturation. It is more precisely a limitation of the absolute value of the aforementioned provisional engine torque. The engine torque threshold used is denoted neEPS_saturation_1.
The block Z6 illustrates a first mechanism for inhibiting the regulation of the saturated steering-angle setpoint δref. This first mechanism is intended to block the regulation, and therefore the calculation of any engine torque to be provided to the assisted-steering actuator 31, when the absolute value of the torque exerted by the driver on the steering wheel exceeds a threshold denoted TDriver_δctrl.
The third constraint Z8, which is applied to the yaw-moment setpoint Mz_ref, is an amplitude saturation. It is more precisely a limitation of the value of this yaw-moment setpoint Mz_ref, the aim of which is to prevent the differential braking from being too great and preventing satisfactory stability and controllability of the vehicle from being ensured. The yaw moment threshold used is referred to as limit Mz_max.
The limit Mz_max used for this saturation will preferably be variable. It will be calculated (in block Z10) as a function of at least the yaw velocity r and the velocity V of the vehicle. It may optionally also depend on the torque exerted by the driver on the steering wheel.
The fourth constraint Z9, which is applied to the amplitude-saturated yaw-moment setpoint Mz_ref, is a velocity saturation. It is more precisely a limitation of the rate of variation of the yaw-moment setpoint Mz_ref. The yaw moment variation rate threshold used is denoted ∇Mzctrl (it will also appear with the simplified notation ∇).
This fourth constraint, by virtue of a controller KBrake, makes it possible to obtain a braking torque to be provided to the actuators 32 of the differential-braking system.
This fourth constraint is considered to be preferable in order to improve the controllability of the vehicle when turning off or resuming the yaw-moment setpoint Mz_ref.
The block Z11 illustrates a second mechanism for inhibiting the regulation of the yaw-moment setpoint Mz_ref. This second mechanism is intended to block the regulation and therefore the calculation of any differential engine torque, when the absolute value of the torque exerted by the driver on the steering wheel exceeds a threshold denoted TDriver_Mzctrl.
The aforementioned thresholds υ, TEPS_saturation_1 and ∇Mzctrl are obtained by carrying out road trials with the aid of a test vehicle of the same model as the vehicles on which the invention will be implemented.
In particular, the threshold TEPS_saturation_1 is obtained for different velocities V of the vehicle since it varies as a function of this parameter. It is obtained by carrying out trials while the differential-braking function is deactivated.
Likewise, the thresholds υ and ∇Mzctrl are obtained by means of road trials for different velocities V of the vehicle since they vary as a function of this parameter.
The limit Mz_max is for its part obtained in a particular way, with the aid of the block Z10.
This limit is selected to be equal to a variable, denoted
This may be written in the form of the following equation Math1:
It may also be represented graphically, as shown by the part W1 of
The yaw velocity threshold rctrl corresponds to the maximum yaw velocity at which the vehicle is still controllable by the driver, at a given velocity V.
The yaw velocity threshold rctrl and the variable
For this purpose, during a first step, the differential-braking function of the test vehicle is deactivated then controllability trials of the vehicle are carried out in order to determine the thresholds usable for the constraints Z5 and Z7.
Next, during a second step, the differential-braking function of the vehicle is reactivated then new controllability trials are carried out in order to determine the maximum steering angle thresholds δmax(V) for a plurality of different velocities (for example with an increment of 5 km/h). As a variant, these steering angle thresholds could be obtained by calculation.
Finally, during a third step, the yaw velocity threshold rctrl and the variable
The yaw velocity threshold rctrl is more precisely obtained by modeling the vehicle by means of a bicycle model (described in more detail below), then by deducing the following equation therefrom:
In this equation, k is the understeer gradient, which is calculated by means of the following equation:
By virtue of the same modeling, it is possible to obtain the variable Mzctrl by means of the following equation:
The two inhibition mechanisms represented in
The threshold TDriver_δctrl used to negate the steering-angle setpoint δref is determined by controllability trials carried out on the vehicle when the differential-braking function is deactivated. This threshold varies as a function of the velocity V of the vehicle.
The threshold TDriver_Mzctrl used to negate the yaw-moment setpoint Mz_ref is determined by controllability trials when the differential-braking system is active. This threshold also varies as a function of the velocity V of the vehicle.
It may be noted that these thresholds satisfy the following inequality:
T
Driver_Mz
ctrl(V)≤TDriver_Saturation_1ctrl(V)≤TDriver_δctrl(V) [Math. 5]
In this inequality, the variable TDriver_Saturation_1ctrl is obtained from the threshold TEPS_Saturation_1. For this purpose, taking into account the function f corresponding to the assistance law of the assisted-steering actuator 31, the following may be written:
T
Driver_Saturation_1
ctrl(V)=f−1(TEPS_Saturation_1,V) [Math. 6]
At this stage of the description, the procedure making it possible to obtain the values of the aforementioned thresholds and variables in order to guarantee controllability of the vehicle may be summarized by using
As this figure shows, during a first step E1, while the differential-braking function of the test vehicle is deactivated, controllability trials are performed in order to obtain the values of the thresholds TEPS_Saturation_1 and TDriver_δctrl.
Next, during a second step E2, the differential-braking function being reactivated, a new series of controllability trials is performed in order to obtain the values of the maximum steering angles δmax.
In this step, the value of the threshold TDriver_Saturation_1ctrl is also calculated.
During a third step E3, the thresholds
Finally, during a fourth step E4, the results of the controllability trials are used in order to refine the values of the thresholds
The various constraints mentioned above, and the way in which the choice between the steering angle of the steering wheel and the differential-braking system is made in order to pilot the vehicle, may now be formulated.
For this purpose, reference may be made to the left part X1 of
In this figure, the block Z1 corresponds to the block that makes it possible to determine the trajectory to be followed in order to avoid the obstacle 20. Since the way in which this trajectory is determined does not form part of the subject matter of the present invention, it will not be described here. This block Z1 then makes it possible, when the AES function is activated, to determine the lateral deviation setpoint yL-ref and the relative heading angle LPL.
The block Z2 is the one that makes it possible to make a choice between the steering system and the differential-braking system in order to follow the evasion trajectory optimally. It makes it possible to determine the value of a coefficient αDB that illustrates the proportion of the differential braking and of the steering angle which is to be applied. When its value is zero, the differential braking is deactivated, and when its value is maximum (equal to 1), it is the steering angle that is deactivated. This block will be described in detail below.
The block Z3 corresponds to the mathematical function that makes it possible to model the aforementioned constraints Z5 and Z7. It receives as input the non-saturated steering-angle setpoint δK.
The block Z4 corresponds to the mathematical function that makes it possible to model the aforementioned constraints Z8 and Z9. It receives as input the non-saturated yaw-moment setpoint MKz.
These non-saturated setpoints are obtained with the aid of controllers denoted Kδ for the calculation of the non-saturated steering-angle setpoint δK, and KM for the calculation of the non-saturated yaw-moment setpoint MKz. They depend on the coefficient αDB.
In order to understand the calculations underlying these two blocks, it may be assumed that the dynamic behavior of the vehicle can be modeled by means of the following equation Math7.
This model is an improved bicycle model.
But it does not thereby make it possible to limit the steering-angle amplitude and velocity of the front wheels 11 of the vehicle, or the differential-braking moment applied to the wheels of the vehicle, or the variation of this braking moment. However, these limitations prove particularly important for ensuring that the driver of the vehicle can be capable of resuming control of the vehicle at any moment.
The saturation of the steering-angle velocity may be formulated in the following way:
|{dot over (δ)}ref|≤υ
In this equation Math 8, the threshold υ is for example equal to 0.0491 rad/s, which corresponds to 0.785 rad/s at the steering wheel (i.e. 45°/s) if the gear reduction coefficient of the steering is equal to 16.
As shown by
A function of the hyperbolic tangent type is intended to mean the various functions that have a form similar to the hyperbolic tangent function, which includes in particular inverse trigonometric functions (such as the arctangent), the error function (commonly denoted erf), the Gudermannian function (commonly denoted gd) and the hyperbolic trigonometric function (such as hyperbolic tangent).
It receives as input the non-saturated steering-angle setpoint δref and transmits as output the saturated steering-angle setpoint δref.
In this figure, the coefficient Δ corresponds to the deviation between the variables δK and δref. The coefficient α is a constant between 0 and infinity, which is the only parameter making it possible to affect the rapid or flexible nature of the steering-angle limiter.
This steering-angle velocity limiter thus has the advantage of being simple to tune, since it is sufficient to adjust the coefficient α. It makes it possible to ensure continuous and smooth (infinitely differentiable) command.
For this purpose, taking into account the form of this steering-angle velocity limiter L2, the following equation Math9 may be written:
{dot over (δ)}ref=υ·tanh(∝(δK−δref)) [Math 9]
A controllability model of the vehicle is thus obtained which is pseudo-linear.
More precisely, the following parameter es may then be introduced:
and then the equation Math 10 may be rewritten in the form:
{dot over (δ)}ref=−υ·α·θδ·δref+υ·α·θδ·δK [Math 11]
This equation Math 11 is characteristic of a state representation, and it shows that the setpoint variation limiting model is linear as a function of the parameter es.
On this basis, it is then possible to determine the controller which ensures good following of the evasion trajectory T0, which satisfies the setpoint variation limiting model and which complies with the condition stipulated by the coefficient αDB.
The saturation of the yaw-moment setpoint Mz_ref may be formulated in the following way:
|Mz_ref|≤Mz_max [Math 12]
The saturation of the rate of variation of the yaw-moment setpoint Mz_ref may be formulated in the following way:
|{dot over (M)}z_ref|≤∇Mzctrl [Math 13]
According to the invention, the amplitude and the rate of variation of the yaw-moment setpoint Mz_ref are intended to be limited not by imposing a severe threshold, but instead by using a setpoint amplitude limiter and a setpoint variation limiter.
Referring to
This amplitude limiter is noteworthy insofar as it forms a closed-loop pseudo-controller which has:
In this
The use of such a pseudo-controller makes it possible not only to time-limit the yaw-moment setpoint Mz_ref well, but furthermore to ensure continuity of the variation of this setpoint.
Taking into account the form of this amplitude limiter, the equation Math14 may be written:
M
z_sat
=M
z_max·tanh(β1·(Mz_sat−MKz)) [Math 14]
As shown by
It receives as input the semi-saturated yaw-moment setpoint Mz_sat and transmits as output the yaw-moment setpoint Mz_ref.
In this figure, the coefficient ε2 corresponds to the deviation between the variables Mz_ref and Mz_sat. The coefficient β2 is a constant between 0 and infinity, which is the only parameter making it possible to affect the rapid or flexible nature of the velocity limiter.
The use of such a corrector makes it possible not only to time-limit the yaw-moment variations well, but furthermore to ensure continuity of this variation.
Taking into account the form of this velocity limiter, the equation Math15 may be written:
{dot over (M)}
z_ref=∇Mzctrl·tanh(ε2(Mz_sat−Mz_ref)) [Math 15]
A controllability model of the vehicle is thus obtained which is pseudo-linear.
Some variables may now be introduced to simplify the expressions of equations Math 14 and Math 15, in order to represent the full model quasi-linearly (that is to say in the manner of LPV, Linear Parameter Varying), in the form of a state representation.
The equation Math 14 may be written in the form of an equation Math16:
The following parameter θΔ may then be introduced:
Next, the equation Math 15 may be rewritten in the form of an equation Math19:
The equation Math 19 is characteristic of a state representation, and it shows that the full yaw-moment amplitude and velocity limiting model is quasi-linear as a function of the exogenous parameters θ∇Δ and θ∇ (parameters which can be calculated when the vehicle is in motion).
The bicycle model of equation Math 7 may then be enhanced with this state representation in order to obtain a new usable model.
In this way, it is possible to synthesize the controllers (represented in
These controllers may then be implemented in the computers 13 of motor vehicles 10 of the production series of the motor vehicle on which the trials were carried out.
By way of example, the way in which the synthesis of the first controller (the one that makes it possible to obtain the steering-angle setpoint δref) is carried out may be described. The synthesis of the second controller (the one that makes it possible to obtain the yaw-moment setpoint) will be performed in a corresponding way, and will therefore not be described in detail here.
The enhanced bicycle model of equation Math 7 is written:
A state vector x may then be considered, which can be written in the form:
x=(βrΨLey
The aim is then to determine the form of the controller Ks which is the state feedback making it possible to calculate the non-saturated steering-angle setpoint δK on the basis of this state vector x.
In order to understand how to determine a controller Ks that is suitable in terms of both stability and rapidity, our behavioral model may now be written in a generic form:
In this equation, Cy is the identity matrix, A is a dynamic matrix, Bu is a command matrix and Bw is a perturbation matrix, which may be written in the form:
The controller Kδ, which is defined as a static state feedback, may for its part be expressed in the form:
δK=Kδ·x [Math 28]
In order to find an optimal controller Kδ, various methods may be used.
The method used here is that of linear matrix inequalities. It is thus carried out on the basis of convex-optimization criteria under constraints of linear matrix inequalities.
The aim is more precisely to optimize the gains of the closed loop defined by the controller Kδ by varying on the choice of the poles.
Three matrix inequalities are used, and these are defined by the following inequalities.
In these inequalities, i is equal to 1 or 2, and the matrices Ai and Bi may then be defined in the following way:
A
1
=A(θδmin)
A
2
=A(θδmax)
B
1
=B
u(θδmin)
B
2
=B
u(θδmax) [Math 32]
A matrix of the form
is written in the form
The controller Kδ is defined by the equation:
K
δ
=R·Q
−1 [Math 33]
The velocity of the vehicle is assumed to be constant (and all the matrices of the system are therefore deemed to be constant).
The three inequalities make it possible to ensure that the dynamics of the closed loop remain limited. This is because, by virtue of these constraints, the poles of the closed loop become bounded in a zone defined by a radius γ, a minimum distance from the imaginary axis μ, and an aperture angle φ.
This method proves effective because it involves determining the steering-wheel angle at each instant in a way which is reasonable (and can be mastered by a driver with average competence) and in a way which can be performed by the actuator. These constraints also ensure stability of the closed loop.
The aim here is to minimize the radius γ. Once the controller Kδ has been obtained, the non-saturated steering-angle setpoint may be obtained calculated by means of the following formula:
The values θδmin and θδmax have been introduced into the three matrix inequalities.
The value of θδ, which is linked to the deviation between δK and δref, reflects the level of violation by the controller Ks of the controllability limit set down by the equation Math 8.
By definition, θδ lies between 0 (exclusive) and 1 (inclusive). When θδ is equal to 1, the calculated non-saturated setpoint of the angle at the steering wheel δK complies well with the controllability limit. When it is close to 0, the calculated non-saturated setpoint of the angle at the steering wheel δK has a value which imposes steering dynamics that are too great, which generates a risk of instability of the vehicle. When θδ takes intermediate values between 0 and 1, the controllability limit is not complied with but it is possible for there to be no risk of instability of the vehicle.
In other words, the choice of the values θδmin and θδmax has a direct impact on the performance and the robustness of the controller Ks. The larger the interval [θδmin, θδmax] is, the less well the controller Kδ performs, but the more robust it is. Conversely, the smaller this interval is, the better the controller Kδ performs but the less robust it is.
Logically, the value θδmax is selected to be equal to 1 (a case according to which the controller Kδ functions in linear mode, as is moreover generally the case, without controllability constraint violation).
The determination of the value θδmin, on the other hand, requires making a compromise between performance and robustness. The determination of this value equates to imposing a maximum threshold for the deviation, in absolute value, between δK and δref.
In summary, the method for calculating the controller Ks that is suitable for a particular motor vehicle model consists in fixing on values of αDB, v, α, θδmin and θδmax.
It next consists in determining the coefficients of the matrices Ai, Bi, then in solving the equations Math 29 to Math 31 in order to deduce therefrom a controller Kδ that ensures good following of the evasion trajectory T0 and satisfies the steering-angle setpoint variation limiting model.
The block Z2 may now be described in more detail.
The way in which the coefficient αDB is obtained, which it will be recalled illustrates the proportion of differential braking and steering angle to be applied, may now be described.
For this purpose, a preliminary variable αDB_raw is initially selected.
This choice is made only if the torque exerted by the driver on the steering wheel is less than or equal to, in absolute value, the threshold TDriver_Mzctrl.
Specifically, if it is greater than this threshold, no setpoint will be calculated.
In the case in which it is less than or equal to the threshold TDriver_Mzctrl, the preliminary variable αDB_raw is selected to be equal to 1 if the two following cumulative conditions are fulfilled. Otherwise, it is selected to be equal to zero.
The first condition is that the variable θδ, in absolute value, is less than or equal to a variable θδmin in absolute value.
This variable θδmin is the minimum value of the variable θδ at which the steering-angle controller Kδ on its own can stabilize the vehicle. It is a variable since it depends on the velocity V of the vehicle.
In other words, the first condition consists in checking whether or not the steering-angle setpoint is saturated.
The second condition is that the yaw velocity is less than or equal to, in absolute value, the yaw velocity threshold rctrl in absolute value.
Once the value (0 or 1) of the preliminary variable αDB_raw has been chosen, it is possible to calculate the coefficient αDB by means of the following equation:
In this equation, the parameter τDB is a time constant that makes it possible to filter any abrupt change of the coefficient αDB in order to guarantee a good feel for the driver. The value of this parameter is therefore adjustable according to the feel that the driver wishes to have.
The parameters is the Laplace variable.
At this stage, the process that will be executed by the computer 13 of one of the motor vehicles of the aforementioned production series, in order to carry out the invention, may be described.
Here, the computer 13 is programmed in order to carry out this process recursively, that is to say step-by-step, and in a loop.
For this purpose, during a first step, the computer 13 checks that the automatic obstacle evasion function (AES) is activated.
If this is the case, it attempts to detect the presence of a possible obstacle lying on the path of the motor vehicle 10. For this purpose, it uses its RADAR or LIDAR remote detector.
In the absence of an obstacle, this step is repeated in loops.
As soon as an obstacle 20 is detected (see
The computer 13 will then try to define piloting setpoints for the conventional steering system and for the differential-braking system, which make it possible to follow this evasion trajectory T0 optimally.
For this purpose, it starts by calculating or measuring parameters, these parameters characterizing in particular the dynamic behavior of the vehicle, such as:
As shown by
The pseudo-controllers represented in
In other words, it is therefore the combination of the controller Kδ and the pseudo-controller represented by the block Z3 which will form a first overall controller making it possible to determine the steering-angle setpoint δref on the basis of the parameters listed above.
Likewise, it is the combination of the controller KM and the pseudo-controller represented by the block Z4 which will form a second overall controller making it possible to determine the yaw-moment setpoint Mz_ref on the basis of the parameters listed above.
The present invention is in no way limited to the embodiment described. Rather, a person skilled in the art will know how to add thereto any variant according to the invention.
Number | Date | Country | Kind |
---|---|---|---|
2012064 | Nov 2020 | FR | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/EP2021/081746 | 11/15/2021 | WO |