The present invention relates generally to the automation of automotive device trajectory tracking.
It is particularly advantageous in the context of motor vehicle driving assistance, but it can also be applied to the field of aeronautics or robotics.
It relates also to a device equipped with a computer adapted to implement this method.
For safety, motor vehicles are increasingly often equipped with driving assist systems or autonomous driving systems.
Among these systems, notably known are the automatic emergency braking (AEB) systems, designed to avoid any collision with obstacles situated in the lane being taken by the vehicle, by acting simply 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 the collision or are simply not usable (for example if a vehicle is following close to the motor vehicle).
For these situations, automatic avoidance systems (better known by the abbreviation AES, which stands for “Automatic Evasive Steering” or “Automatic Emergency Steering”) which make it possible to avoid the obstacle by diverting the vehicle from its trajectory, either by acting on the steering of the vehicle, or by acting on the differential braking system of the vehicle, have been developed.
It may be that this AES system, to avoid an obstacle, comes into conflict with the driver so as to force the vehicle to follow an avoidance trajectory different from that that the driver wanted to take. The result of this is at best a hindrance for the driver (who then risks deactivating the AES system to the detriment of his or her safety), and at worst lack of understanding for the driver potentially causing the latter to have a poor understanding of the situation.
The management of the interaction between the driver and this AES system therefore proves in practice to be difficult.
The present invention therefore proposes enhancing the existing AES systems, by adding to them an additional function guaranteeing a better arbitration between the wishes of the driver and the decisions taken by the AES system.
More particularly, according to the invention, a method is proposed as defined in the introduction, wherein the controlling setpoint is calculated as a function of the parameter and as a function of the position of the device with respect to the reference trajectory.
Thus, by virtue of the invention, the trajectory taken by the automotive device depends not only on the setpoint generated by the AES system, but also on the will expressed by the driver.
The invention then makes it possible to arbitrate and favor the AES system or the will expressed by the driver, as a function of the circumstances encountered, and in particular as a function of the position of the automotive device with respect to the obstacle.
The invention thus makes it possible to avoid having the driver being able to be in situations of lack of understanding, while guaranteeing him or her the best possible driving comfort.
Other advantageous and nonlimiting features of the control method according to the invention, taken individually or according to all technically possible combinations, are as follows:
The invention also proposes an automotive device such as a car, comprising at least one actuator which is adapted to influence the trajectory of the device and a computer for controlling the actuator, which is programmed to implement a method as specified above.
Of course, the various features of the invention can be associated with one another according to various combinations insofar as they are not mutually incompatible or exclusive.
The description given below in light of the attached drawings, given as nonlimiting examples, will give a good understanding of what the invention consists of and how it can be produced.
In the attached drawings:
As
This motor vehicle 10 comprises a conventional steering system 18 that makes it possible to act on the orientation of the front wheels 11 so as to be able to turn the vehicle. In the example considered, the steering system 18 is controlled by an assisted steering actuator 15 which makes it possible to act on the orientation of the front wheels 11 as a function of the orientation of the steering wheel 16 and/or, as the case may be, as a function of a setpoint issued by a computer 13.
In addition, it would be possible to provide for this motor vehicle to include a differential braking system making it possible to act differently on the speeds of rotation of the front wheels 11 (even also on those of the rear wheels 12) so as to slow down the motor vehicle by making it turn. This differential braking system would for example comprise a controlled differential or electric motors placed at the wheels of the vehicle.
Hereinafter in this explanation, the steering system considered will be formed by just the conventional steering system. As a variant, it could be formed by the combination of the conventional steering system and of the differential braking system.
The computer 13 is provided to control the actuator 15. To this end, it comprises at least one processor, at least one memory and different input and output interfaces.
By virtue of its input interfaces, the computer 13 is adapted to receive input signals originating from various sensors.
Among these sensors, the following are for example provided:
By virtue of its output interfaces, the computer 13 is adapted to transmit a setpoint to the assisted steering actuator 15.
It thus makes it possible to ensure that the vehicle follows best, and if conditions justify it, a reference trajectory, formed in the example illustrated in
By virtue of its memory, the computer 13 stores data used in the context of the method described hereinbelow.
It stores in particular a computer application, composed of computer programs, comprising instructions, the execution of which by the processor allows the computer to implement the method described hereinbelow.
It stores notably two computer applications, a first application hereinafter called “AES system 20”, that makes it possible to determine the avoidance trajectory T0 to be followed as well as a steering angle setpoint δc allowing the motor vehicle 10 to follow that avoidance trajectory T0, and a second application hereinafter called “EPS system 21”, that makes it possible to determine the setpoint to be sent to the assisted steering actuator 15, taking into account the abovementioned steering angle setpoint δc and the will expressed by the driver.
The will expressed by the driver is, here, deduced from the torque exerted by the driver on the steering wheel 16, which will hereinafter be called “steering wheel torque Cc”. As a variant, it could be deduced as a combination of this steering wheel torque and other factors such as, for example, the angular position of the steering wheel.
Before describing these two systems AES and EPS in detail, the different variables which will be used in the context of the control method described hereinbelow, and some of which are illustrated in
The steering angle that the front drive wheels make with the longitudinal axis A1 of the motor vehicle 10 will be denoted “δ” and will be expressed in radians.
The lateral deviation between the longitudinal axis A1 of the motor vehicle 10 (passing through the center of gravity CG) and the avoidance trajectory T0, at a sighting distance “ls” situated in front of the vehicle, will be denoted “yL” and will be expressed in meters.
The abovementioned sighting distance “ls” will be measured from the center of gravity CG and will be expressed in meters.
The speed of the motor vehicle on the longitudinal axis A1 will be denoted “V” and will be expressed in m/s.
When the motor vehicle 10 travels on a road along an initial trajectory (not represented and substantially parallel to the road) and a potentially dangerous obstacle 100 is detected, the AES system is activated.
A potentially dangerous obstacle is a fixed obstacle situated on the initial trajectory or in proximity thereto, or a moving obstacle whose trajectory risks intersecting the initial trajectory.
This system AES 20 then receives as inputs parameters P1 that make it possible to characterize the attitude of the motor vehicle 10 in its environment. These are, for example, its lateral deviation yL at the sighting distance ls, its heading with respect to the road, its yaw speed, etc.
It is also adapted to determine, or to receive from another computer, an obstacle 100 avoidance trajectory T0. This avoidance trajectory T0 is for example generated as a function of the abovementioned parameters P1 and of the characteristics of the obstacle 100 (dimensions, speed, etc.).
In
The first protection limit 101, of rectangular form, has a form which is a function of the form of the obstacle 100 and of any measurement errors of the sensors with which the motor vehicle is equipped. It has a position which takes account of the possible speed of the obstacle 100.
The second protection limit 102 has dimensions chosen as a function of the safety margin that is wanted to be given. Here, it takes the form of a circle whose center is situated on the corner of the first protection limit 101 which is located closest to the avoidance trajectory T0.
The way in which the avoidance trajectory T0 is generated is not here specifically the object of the present invention and will not therefore be described in detail.
Given the parameters P1 and the avoidance trajectory T0, the AES system 20 is able to determine a preliminary steering angle setpoint δc of the front wheels 11 of the vehicle, which would allow the vehicle to best follow this avoidance trajectory T0.
The EPS system 21, which receives as input this preliminary steering angle setpoint δc, uses a controller 22 to determine a filtered steering angle setpoint δs, which is saturated in amplitude and in rate of variation.
In other words, the preliminary steering angle setpoint δc is capped if it exceeds (in absolute value) a predetermined threshold, and it is regulated so as not to be able to vary faster than another predetermined limit.
These thresholds are chosen such that the motor vehicle 10 remains controllable by the driver at any moment, in the eventuality of possibly taking over sole control of the vehicle.
The deviation between this filtered steering angle setpoint δc and the instantaneous steering angle δ of the drive wheels 11 (measured by an angle sensor) is then used to determine a preliminary torque setpoint Ca which, if it were directly sent to the assisted steering actuator 15, would make it possible to control the steering of the wheels in accordance with the filtered steering angle setpoint δs.
This preliminary torque setpoint Ca is then multiplied by a parameter K1rt, the calculation of which will be explained hereinbelow, which makes it possible to obtain an intermediate torque setpoint Ci.
The deviation between this intermediate torque setpoint Ci and the steering wheel torque Cc (to within a multiplying term) makes it possible to obtain a final torque setpoint Cr which is sent to the assisted steering actuator 15.
The invention relates here more specifically to the calculation of the abovementioned parameter K1rt.
This parameter, hereinafter called “corrected gain K1rt”, is used to deactivate the AES system 20 when the conditions allow it and the driver seems to want to take back control of the driving of the motor vehicle 10.
To check whether the conditions allow it, provision here is made to determine the zone of the environment of the obstacle 100 in which the motor vehicle 10 is located.
Before detailing how this corrected gain K1rt is calculated, the zones of the environment which will be considered to implement these calculations can be detailed.
As
Here, these four zones are defined with respect to the avoidance trajectory T0, with respect to the obstacle 100 and with respect to a protection line L1 beyond which any collision with the obstacle 100 is avoided.
This protection line L1 corresponds more specifically to a virtual line which is parallel to the road (here it is rectilinear, but it could be curved if the road were curved) and which passes through the point P1 of the second protection limit 102 which is furthest away from the obstacle 100.
The crossing of this line by the motor vehicle 10 (and more specifically by its center of gravity CG) makes it possible to ensure that the obstacle 100 is well avoided.
The four zones are defined as follows.
The first zone Z1 is situated upstream of the obstacle (more specifically here, upstream of the first protection limit 101), between the avoidance trajectory T0 and the protection line L1.
In this first zone Z1, the will of the driver is supposed to be close to the setpoint calculated by the AES system 20, so that, for safety, there is no wish for the operation of the AES system to be able to be suspended.
The second zone Z2 is situated level with and downstream of the obstacle (more specifically here level with and downstream of the first protection limit 101), between the avoidance trajectory T0 and the protection line L1.
Because this zone is situated behind the obstacle 100 and there is therefore no longer any danger, it is desirable here to allow the driver the possibility of entirely taking back control of the vehicle, as long as he or she has both hands on the steering wheel.
The third zone Z3 is situated upstream of the obstacle 100 (more specifically here upstream of the first protection limit 101), on the other side of the reference trajectory T0 with respect to the first zone Z1.
In this zone, the wish is to be able to allow the driver the possibility of taking back control of the driving of the vehicle provided that he or she firmly counters the AES system 20.
The fourth zone Z4 covers the rest of the environment.
In this fourth zone, the wish is to be able to allow the driver the possibility of taking back control of the driving of the vehicle if he or she counters the AES system 20. Thus, in the fourth zone, as soon as the driver opposes the maneuver ordered by the AES system, however softly, the AES request is interrupted.
To calculate the corrected gain K1rt, the computer 13 determines in which of these four zones the motor vehicle 1 is located, then it uses a computation algorithm which is not the same from one zone to another.
When the motor vehicle 10 changes zone, the computer does not immediately change computation algorithm, so as not to generate instability. It then changes algorithm only when the vehicle goes beyond a so-called hysteresis trajectory, calculated as a function of the avoidance trajectory T0.
In
When the motor vehicle 10 passes from the zone Z1 to the zone Z3 (or vice versa), or from the zone Z2 to the zone Z4 (or vice versa), the computer changes computation algorithm only after the vehicle has crossed not only the avoidance trajectory T0, but also these two hysteresis trajectories T01, T02, which notably makes it possible to avoid the phenomenon of oscillation between the zones.
The way in which the corrected gain K1rt is calculated can now be described in detail.
The value of this corrected gain K1rt is deduced from the value of a gain K1 which is a boolean whose value is determined as follows.
If the motor vehicle is located in the first zone Z1, this gain K1 is set equal to one, which means that there is no wish to interrupt the AES system 20.
If the motor vehicle is located in the second zone Z2, the driver has both hands on the steering wheel and the steering wheel torque Cc is, in absolute value, above a first threshold Cc2, the gain K1 is set equal to zero, which means that there is a wish to interrupt the AES system 20.
In any other situation in the third zone Z2, the gain K1 is set equal to one.
If the motor vehicle is located in the third zone Z3 and the driver intends to avoid the obstacle on the right (contrary to the AES system 20), while remaining in zone Z3, that is to say by shifting minimally with respect to the obstacle 100, the gain K1 is set equal to zero, which means that there is a wish to interrupt the AES system 20.
For the computer 13 to consider that the driver intends to avoid the obstacle on the right by shifting minimally, it checks whether the steering wheel torque Cc is negative and whether it is below a negative threshold Cc3min (for example −2 Nm).
Mirroring this, if the motor vehicle is located in the third zone Z3, the driver intends to avoid the obstacle on the left (contrary to the AES system 20) by exerting a steering wheel torque CC above a threshold Cc3max (for example 2 Nm), and the AES system generates a negative torque, the gain K1 is also set equal to zero, which means that there is a wish to interrupt the AES system 20.
In any other situation in the third zone Z3, the gain K1 is set equal to one, which means that there is a wish to maintain the AES system 20.
If the motor vehicle is located in the fourth zone Z4 and the driver wants to revert to his or her initial lane or at least cancel the lateral speed of the motor vehicle 10 by imposing a steering wheel torque Cc that is negative and below a threshold Cc4min in which is itself negative (for example −3 Nm), and the AES system generates a positive torque, the gain K1 is set equal to zero.
If the motor vehicle is located in the fourth zone Z4 and the driver wants to change lane by continuing to move away to the maximum from the obstacle 100 by imposing a positive steering wheel torque Cc above a threshold Cc4max that is itself positive (for example 3 Nm), and the AES system generates a negative torque, the gain K1 is set equal to zero.
In any other situation in the fourth zone Z4, the gain K1 is set equal to one.
It will be noted that, in the case where the gain K1 is equal to zero and at least one of the abovementioned conditions is no longer fulfilled, it is immediately set once again to one.
The computer 13 is then able to calculate the corrected gain K1rt which, here, is a real number lying between zero and one and which varies continually.
This corrected gain K1rt is determined so as to avoid any abrupt modification in the control of the motor vehicle 10.
Provision is made to vary with a constant gradient. In other words, the rate of variation of this corrected gain K1rt is either zero (when its value is equal to zero or one), or constant and equal to a predetermined speed. Thus, as
Provision will be able to be made for the rate of variation on the rising edge to be greater than that exhibited on the falling edge. Each rising edge will begin when the gain K1 changes from zero to one, and each falling edge will be triggered when the gain K1 changes from one to zero.
The rate of variation upon each rising or falling edge is determined as a function of the speed V of the vehicle and of the radius of curvature of the road, such that the lateral acceleration of the vehicle does not exceed a threshold (for example of 1 m·s−2).
The gradient used will therefore be commensurately lower when the speed V is high, and commensurately greater when the radius of curvature of the road is great. A mapping that makes it possible to determine the gradient to be used will be able to be used.
Once the corrected gain K1rt is obtained, the latter is multiplied with the preliminary torque setpoint Ca.
When this corrected gain K1rt is equal to one, which means that the AES system 20 is operational, this preliminary torque setpoint Ca is not modified, and the assisted steering actuator 15 is controlled by only the AES system 20.
When the corrected gain K1rt is equal to zero, which means that the operation of the AES system 20 must be suspended, this preliminary torque setpoint Ca is canceled, and the assisted steering actuator 15 is controlled by only the steering wheel 16.
The variations of the corrected gain K1rt between zero and one make it possible to transition gradually and gently from one mode of operation to the other, avoiding the threshold effects.
In
These two reset signals SA, SB make it possible, notably, to reset to zero the calculation of the preliminary torque setpoint Ca and assign the measured steering angle value δ to the filtered steering angle setpoint δs when the corrected gain K1rt changes from zero to a non-zero value.
The benefit of these two signals will become clearly apparent hereinafter in the present explanation, with reference to
Several particular cases illustrating the benefit of the invention can now be described.
The first particular case, illustrated in
In this situation, the driver turns the steering wheel to the right by exerting a steering wheel torque Cc which is negative. This steering wheel torque is illustrated in
In this situation, the AES system 20 calculates a positive torque (that is to say taking the vehicle to the left) that makes it possible to bring the motor vehicle 10 to the avoidance trajectory T0. This torque is illustrated in
It is then understood that, without the invention, that is to say without this possibility of interrupting the AES system 20, the steering wheel torque and the torque generated by the AES system will be opposite, which will create a bad feeling for the driver.
Now, since the situation envisaged here is not dangerous, it does not impose countering the will of the driver.
Then, by virtue of the invention, the gain K1 is chosen equal to zero, so that the corrected gain K1rt will transition continually from one to zero. The intermediate torque setpoint Ci will then decrease gradually until it is canceled (see the curve C2 in
The second particular case, illustrated in
In this situation, after having gone beyond the obstacle 100, the driver continues to turn the steering wheel to the left by exerting a steering wheel torque Cc which is positive. This steering wheel torque is illustrated in
The AES system 20 for its part calculates a negative torque (that is to say taking the vehicle to the right) that makes it possible to bring the motor vehicle 10 to the avoidance trajectory T0. This torque is illustrated in
It is then understood that, without the invention, the steering wheel torque and the torque generated by the AES system will be opposite. Since this situation is not dangerous, it does not impose countering the will of the driver.
Then, by virtue of the invention, the gain K1 is chosen equal to zero, so that the corrected gain K1rt will transition continually from one to zero. The intermediate torque setpoint Ci will then increase gradually until it is canceled (see the curve C5 in
The third particular case, illustrated in
At the start of the avoidance, the driver turns the steering wheel strongly to the left then, when the vehicle enters into the fourth zone Z4, he or she on the contrary exerts a negative torque on the steering wheel. This steering wheel torque is illustrated in
From the start of the avoidance, to bring the motor vehicle 10 to the avoidance trajectory T0, the AES system 20 then calculates a negative torque (that is to say taking the vehicle to the right). This torque is illustrated in
As long as the vehicle is in the zone Z4 and it is deemed undesirable to interrupt the operation of the AES system 20, the gain K1 is kept equal to one.
On the other hand, when the vehicle enters into the second zone Z2, and the driver maintains his or her will to return rapidly to the initial traffic lane, there will come a moment where the steering wheel torque Cc and the torque generated by the AES system are of opposite signs. Since this situation is considered not to be dangerous, it does not impose countering the will of the driver.
Then, by virtue of the invention, the gain K1 is chosen equal to zero, so that the corrected gain K1rt will transition continually from one to zero. The intermediate torque setpoint Ci imposed by the actuator 15 will then decrease gradually until it is canceled (see the curve C8 in
The fourth particular case, illustrated in
In this situation, the driver therefore exerts a steering wheel torque Cc that is positive and sufficiently high only when he or she detects the obstacle, then he or she relaxes this force too rapidly. This steering wheel torque is illustrated in
In this situation, as long as the motor vehicle 10 is upstream of the obstacle 100, in the zone Z3, the AES system 20 calculates a positive torque (that is to say taking the vehicle to the left) that makes it possible to bring the motor vehicle 10 to the avoidance trajectory T0. This torque is illustrated in
This situation is therefore potentially dangerous, so that it imposes countering the will of the driver and not interrupting the operation of the AES system 20.
Then, by virtue of the invention, the gain K1 is kept equal to one, so that the steering wheel torque Cc has a reduced influence on the trajectory taken by the vehicle.
The curve T7 illustrated in
The fifth particular case, illustrated in
In this situation, the driver initially turns the steering wheel to the left by exerting a steering wheel torque Cc which is positive, then he or she brings the steering wheel to the right by exerting a negative torque before even the motor vehicle 10 is level with the obstacle 100. This steering wheel torque is illustrated in
In this situation, the AES system 20 calculates a torque which is positive (that is to say taking the vehicle to the left) as long as the vehicle is upstream of the obstacle 100. This torque is illustrated in
The curve T10 illustrated in
It is then understood that, without the invention, that is to say without the possibility of interrupting the operation of the AES system 20, the steering wheel torque and the torque generated by the AES system will initially be of the same signs and then will be opposite, which will create a bad feeling for the driver.
Since the situation considered here is not dangerous, it does not impose countering the will of the driver.
Then, by virtue of the invention, the gain K1 is initially kept equal to one, then it will be brought to zero at the moment when the steering wheel torque Cc becomes negative and lower than the threshold Cc3min (−2 Nm). Consequently, the corrected gain K1rt will transition continually from one to zero. The intermediate torque setpoint Ci will then decrease gradually until it is canceled (see the curve C14 in
The sixth particular case, illustrated in
In this situation, the driver, for his or her part, turns the steering wheel to the right by exerting a steering wheel torque Cc which is always negative and high. This steering wheel torque is illustrated in
In this situation, the AES system 20 calculates a torque which is positive (that is to say taking the vehicle to the left). This torque is illustrated in
The curve T12 illustrated in
In this situation, it is therefore desirable to be able to allow the driver the choice of the side by which he or she wants to avoid the obstacle 100.
Then, by virtue of the invention, the gain K1 is set equal to zero, so that the corrected gain K1rt will transition continually from one to zero. The final torque setpoint Cr imposed by the actuator 15 will then decrease gradually until it is canceled (see the curve C16 in
In
In
It can be seen that, at the instant to of detection of the obstacle, it would be necessary for the steering angle to be directly higher than that actually measured.
By virtue of the controller which saturates the preliminary steering angle setpoint δc, the rate of variation of the saturated steering angle setpoint δs remains, between the instants t0 and t1, restricted so as not to generate instability.
Between the instants t1 and t2, it will no longer be necessary to saturate, in terms of amplitude or of rate of variation, the preliminary steering angle setpoint δc, so that the saturated steering angle setpoint δs will be equal to the latter.
At the instant t2, as
The corrected gain K1rt then decreases linearly to reach, at an instant t3, the value zero.
While the preliminary steering angle setpoint δc continues to increase, the saturated steering angle setpoint δs will then be kept constant between the instants t2 and t3, by virtue of the reset signals SA, SB.
At the instant t3 and until the instant t4, the saturated steering angle setpoint δs will then be kept equal to the measured steering angle δ. In this way, the intermediate torque setpoint Ci is kept equal to zero, which leaves the driver solely in control of the maneuver.
At the instant t4, as
The corrected gain K1rt then increases linearly to also reach the value one.
At that instant t4, by virtue of the reset signals SA, SB, the preliminary steering angle setpoint δc will then be brought equal to the measured steering angle δ. It then increases very rapidly.
By virtue of the controller which saturates the preliminary steering angle setpoint δc, the rate of variation of the saturated steering angle setpoint δs remains, in this situation, restricted so as not to generate instability.
It can be seen in
The present invention is in no way limited to the embodiments described and represented, but the person skilled in the art will be able to add to it any variant according to the invention.
Thus, the method will be able to be applied to other types of areas in which a particular trajectory must be followed, for example in aeronautics or in robotics.
Number | Date | Country | Kind |
---|---|---|---|
FR1913862 | Dec 2019 | FR | national |
This application is a U.S. national stage application of International Application No. PCT/EP2020/081825, filed on Nov. 12, 2020, which claims priority to French Application No. 1,913,862, filed on Dec. 6, 2019.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/EP2020/081825 | 11/12/2020 | WO |