Steering control method and system of self-driving vehicle
11345399 · 2022-05-31
Assignee
Inventors
- Yan Jiang (Beijing, CN)
- Jinzhan Peng (Beijing, CN)
- Xin Zhou (Beijing, CN)
- Dan ZHANG (Beijing, CN)
- Xiaocheng Zhou (Beijing, CN)
- Sai LUO (Beijing, CN)
Cpc classification
B62D6/10
PERFORMING OPERATIONS; TRANSPORTING
B62D6/002
PERFORMING OPERATIONS; TRANSPORTING
B62D6/08
PERFORMING OPERATIONS; TRANSPORTING
International classification
B62D6/10
PERFORMING OPERATIONS; TRANSPORTING
B62D6/00
PERFORMING OPERATIONS; TRANSPORTING
B62D6/08
PERFORMING OPERATIONS; TRANSPORTING
Abstract
The present disclosure provides for a steering control method and a steering control system for self-driving of a vehicle. The method comprises the steps of: obtaining information about an expected steering angle of a vehicle based on an automatic planning control operation; detecting whether an effective torque is applied to a steering wheel by a driver; and when it is detected that the driver has applied the effective torque to the steering wheel, computing a difference between a turning angle of the steering wheel controlled by the driver and the expected steering angle of a vehicle, and determining a self-driving intent prompt torque according to the difference between the two, wherein the self-driving intent prompt torque is to be applied to a steering system.
Claims
1. A method for self-driving a vehicle, comprising: obtaining information about an expected steering angle of the vehicle based on an automatic planning control operation; detecting whether an effective torque is applied to a steering wheel by a driver; and determining a self-driving intent prompt torque, comprising: in response to detecting that the driver has applied the effective torque to the steering wheel, computing a difference between a turning angle of the steering wheel controlled by the driver and the expected steering angle of the vehicle; and determining a self-driving intent prompt torque based on a positive correlation function of a value of the difference and a direction of a steering torque applied by the driver; and applying a steering torque to the steering wheel, wherein when the driver has applied the effective torque to the steering wheel, the steering torque applied to the steering wheel comprises a combination of the steering torque applied by the driver, a steering assistance torque applied by a vehicle steering assistance system, and the self-driving intent prompt torque, and wherein the self-driving intent prompt torque is opposite to the steering torque applied by the driver.
2. The method of claim 1, wherein determining the self-driving intent prompt torque based on the positive correlation function of the value of the difference and the direction of the steering torque applied by the driver comprises: determining a larger self-driving intent prompt torque when the difference is larger, and wherein a torque that the driver is to provide is larger if the difference is larger.
3. The method of claim 1, wherein the self-driving intent prompt torque is determined based on the following formula:
τ.sub.c=−sig(τ.sub.driver).Math.ƒ(ƒ abs(Δβ)) wherein τ.sub.c is the self-driving intent prompt torque, wherein Δβ is determined based on the following formula:
Δβ=β.sub.e−β.sub.driver, wherein τ.sub.driver denotes the steering torque applied by the driver, β.sub.e denotes the expected steering angle of the vehicle, β.sub.driver denotes the turning angle of the steering wheel, and sig(τ.sub.driver) denotes the direction of the steering torque applied by the driver; wherein ƒ is the positive correlation function of an absolute value of Δβ and satisfies the following conditions:
4. The method of claim 1, further comprising: determining a reliability status of operations of a self-driving system; and adjusting the self-driving intent prompt torque based on the reliability status of operations of the self-driving system.
5. The method of claim 4, wherein the method for determining the reliability status of operations of the self-driving system comprises: determining the reliability status of operations of the self-driving system based on a complexity of a current self-driving road environment and a severity of a lighting condition.
6. The method of claim 1, further comprising: in response to detecting that the driver has not applied the effective torque to the steering wheel, controlling the turning angle of the steering wheel to reach the expected steering angle of the vehicle.
7. The method of claim 1, wherein the steering torque applied to the steering wheel is determined based on the following formula:
τ=τ.sub.driver+τ.sub.eps+τ.sub.c, wherein τ denotes the steering toque applied to the steering wheel, wherein τ.sub.driver denotes the steering torque applied by the driver, wherein τ.sub.eps denotes the steering assistance torque applied by the vehicle steering assistance system, and wherein τ.sub.c denotes the self-driving intent prompt torque.
8. The method of claim 1, wherein detecting that the driver has applied the effective torque to the steering wheel comprises determining that the driver is operating the steering wheel.
9. A system for controlling a vehicle, comprising: an expected vehicle steering angle computation unit configured to obtain information about an expected steering angle of the vehicle based on an automatic planning control operation; a driver operation detection unit configured to detect whether an effective torque has been applied to a steering wheel by a driver; and a self-driving intent prompt torque determination unit configured to: compute a difference between a turning angle of the steering wheel controlled by the driver and the expected steering angle of the vehicle in response to detecting that the driver has applied the effective torque to the steering wheel; and determine a self-driving intent prompt torque based on a positive correlation function of a value of the difference and a direction of a steering torque applied by the driver; and a steering torque application unit configured to apply a steering torque to the steering wheel, wherein when the driver has applied the effective torque to the steering wheel, the steering torque applied to the steering wheel comprises a combination of the steering torque applied by the driver, a steering assistance torque applied by a vehicle steering assistance system, and the self-driving intent prompt torque, and wherein the self-driving intent prompt torque is opposite to the steering torque applied by the driver.
10. The system of claim 9, wherein, to determine the self-driving intent prompt torque based on the positive correlation function of the value the difference and the direction of the steering torque applied by the driver, the driver's operation detection unit is further to determine a larger self-driving intent prompt torque when the difference is larger, and wherein a torque that the driver is to provide is larger if the difference is larger.
11. The system of claim 9, wherein the self-driving intent prompt torque determination unit determines the self-driving intent prompt torque based on the following formula:
τ.sub.c=−sig(τ.sub.driver).Math.ƒ(ƒ abs(Δβ)) wherein Δβ is determined based on the following formula:
Δβ=β.sub.e−β.sub.driver wherein τ.sub.driver denotes the steering torque applied by the driver, β.sub.e denotes the expected steering angle of the vehicle, β.sub.driver denotes the turning angle of the steering wheel, and sig(τ.sub.driver) denotes the direction of the steering torque applied by the driver; wherein ƒ is the positive correlation function of an absolute value of Δβ and satisfies the following conditions:
12. The system of claim 9, a self-driving system operating state determination unit configured to: determine a reliability status of operations of a self-driving system; and adjust the self-driving intent prompt torque based on the reliability status of operations of the self-driving system.
13. The system of claim 12, wherein the self-driving system operating state determination unit is further configured to: determine the reliability status of operations of the self-driving system based on a complexity of a current self-driving road environment and a severity of a lighting condition.
14. The system of claim 9, further comprising: an automatic steering control unit configured to control the turning angle of the steering wheel to reach the expected steering angle of the vehicle in response to detecting that the driver has not applied the effective torque to the steering wheel.
15. The system of claim 9, wherein the steering torque application unit is configured to determine the steering torque applied to the steering wheel based on the following formula:
τ=τ.sub.driver+τ.sub.eps+τ.sub.c, wherein τ denotes the steering toque applied to the steering wheel, wherein τ.sub.driver denotes the steering torque applied by the driver, wherein τ.sub.eps denotes the steering assistance torque applied by the vehicle steering assistance system, and wherein τ.sub.c denotes the self-driving intent prompt torque.
16. The system of claim 9, wherein, to detect that the driver has applied the effective torque to the steering wheel, the driver operation detection unit is further configured to detect that the driver is operating the steering wheel.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) These and/or other aspects and advantages of the present invention will become clearer and be understood more easily from the following detailed description of the embodiments of the present invention in combination with the accompanying drawings, in which:
(2)
(3)
(4)
(5)
DETAILED DESCRIPTION OF EMBODIMENTS
(6) In order that those skilled in the art better understand the present invention, the present invention will be further described in detail below in combination with the accompanying drawings and specific embodiments.
(7)
(8) The steering control system 100 may include the following units: a driver's operation detection unit 110, an expected vehicle steering angle computation unit 120, and a self-driving intent prompt torque determination unit 130.
(9) Optionally, the steering control system 100 may further include a steering torque application unit 140.
(10) The driver's operation detection unit 110 may be configured to detect whether an effective torque is applied to a steering wheel by a driver.
(11) Generally, a torque sensor is provided on the steering wheel. When the driver turns the steering wheel, the torque sensor may detect a torque input. At this time, it is determined that the driver is operating the steering wheel, that is, an effective torque is applied to the steering wheel. If the torque sensor does not detect a torque input, it may be determined that the driver does not operate the steering wheel, that is, no effective torque is applied to the steering wheel.
(12) The expected vehicle steering angle computation unit 120 may be configured to obtain information about an expected steering angle of a vehicle based on an automatic planning control operation.
(13) For example, the expected steering angle of the vehicle may be obtained based on a planning control operation carried out according to a sensing and positioning input.
(14) The self-driving intent prompt torque determination unit 130 may be configured to compute a difference between a turning angle of the steering wheel controlled by the driver and the expected steering angle of a vehicle and determine a self-driving intent prompt torque according to the difference, when it is detected that the driver has applied the effective torque to the steering wheel, wherein the self-driving intent prompt torque is to be applied to a steering system.
(15) In one example, when the self-driving intent prompt torque determination unit 130 determines a larger self-driving intent prompt torque when the difference between the turning angle of the steering wheel controlled by the driver and the expected steering angle of the vehicle is larger when determining a self-driving intent prompt torque, wherein the self-driving intent prompt torque is opposite to a torque that the driver needs to provide, so that the torque that the driver needs to provide is larger. Thus, when the driver operates the steering wheel, as the steering wheel gradually approaches the expected steering angle of the vehicle, the driver may feel more and more labor-saving and can thus realize that his driving process is consistent with the self-driving control intent. Otherwise, when the steering angle gradually deviates from the expected steering angle, the driver may feel more and more laborious and can thus realize that his driving process is contrary to the self-driving control intent.
(16) After the driver realizes the self-driving control intent, he can determine whether he made a mistake in the previous operation. If he confirms that he did not make a mistake, he can make adjustments in time. If he confirms that his operation has not been mistaken, he can, for example, ignore the self-driving control intent, continue to operate as originally planned or temporarily turn off the self-driving control (for example, via an option button for exiting the self-driving control provided by the vehicle), and concentrate on driving the vehicle according to the driver's own intent.
(17) In the conventional EPS systems, the torque for driving the steering of the wheel is composed of a steering torque applied by the driver and a steering assistance torque of the steering assistance system.
(18) According to the steering control system of the embodiment of the present invention, when it is detected that the driver has applied the effective torque to the steering wheel, the self-driving system and the driver jointly participate in the steering process by applying the self-driving intent prompt torque.
(19) According to an embodiment of the present invention, when the driver has applied the effective torque to the steering wheel, the steering torque applied to the steering wheel by the steering torque application unit 140 may include a steering torque applied by the driver, a steering assistance torque of a vehicle EPS system and the self-driving intent prompt torque.
(20) That is, the steering torque at this time may be determined based on the following formula (1):
τ=τ.sub.driver+τ.sub.eps+τ.sub.c (1)
(21) wherein τ.sub.driver is a driver's steering torque, τ.sub.eps is an EPS steering assistance torque, and τ.sub.c is a self-driving intent prompt torque.
(22) When the specified steering angle is zero, the torque may be zero, the counterclockwise torque is positive, and the clockwise torque is negative.
(23) In one example, the self-driving intent prompt torque τ.sub.c may be determined based on the following formula (2):
τ.sub.c=−sig(τ.sub.driver).Math.ƒ(ƒ abs(Δβ)) (2)
(24) wherein Δβ is determined based on the following formula (3):
Δβ=β.sub.e−β.sub.driver (3)
(25) wherein τ.sub.driver denotes a torque currently applied by the driver, β.sub.e denotes an expected turning angle of self-driving, β.sub.driver denotes a turning angle where the steering wheel is located, and sig (τ.sub.driver) denotes the direction of the torque currently applied by the driver;
(26) ƒ is a positive correlation function of an absolute value of Δβ and may satisfy conditions (4):
(27)
(28) wherein cτ.sub.eps denotes a steering assistance torque, and ƒ abs(τ.sub.c) denotes an absolute value of τ.sub.c.
(29) According to the steering control system of the embodiment of the present invention, after the self-driving intent prompt torque is increased, the system may make the driver feels that it is more labor-saving to control the steering wheel to turn to the expected steering angle of the self-driving system, and that it is more laborious to control the steering wheel to turn opposite to the expected steering angle of the self-driving system.
(30) In one example, the steering control system may adopt a self-driving intent prompt torque strategy in consideration of an operating state of the self-driving system in addition to the difference between the driver's operation and the expected turning angle of the self-driving system, and may change the magnitude of the self-driving intent prompt torque according to the reliability of the self-driving state, thereby changing the degree of participation of the machine driving in the driving process. The steering control system that determines the self-driving intent prompt torque in consideration of the operating state of the self-driving system will be described below in combination with
(31)
(32) As shown in
(33) The self-driving system operating state determination unit 250 may be configured to determine a reliability status of operation of the self-driving system. For example, the self-driving system operating state determination unit 250 may determine a reliability status of operation of the self-driving system in combination with the surrounding environment (geography, weather, lighting, etc.) where the vehicle is located and/or feedback given by the driver, etc.
(34) For example, if the self-driving system detects that the current environment is complex or the lighting condition is bad, the self-driving system operating state determination unit 250 may determine that there may be a high probability that the self-driving system is in a low-reliability operating state. Alternatively, if the self-driving system detects that the current environment is simple and the lighting condition is good, the self-driving system operating state determination unit 250 may determine that the self-driving system is in a high-reliability operating state.
(35) When the self-driving system operating state determination unit 250 determines that there is a high probability that the self-driving system is in a low-reliability operating state, the self-driving intent prompt torque determination unit 230 may reduce (lower) the amplitude of the self-driving intent prompt torque, and the system at this time may be similar to the conventional EPS systems. Alternatively, when the self-driving system operating state determination unit 250 determines that there is a high probability that the self-driving system is in a high-reliability operating state, the self-driving intent prompt torque determination unit 230 may increase the magnitude of the self-driving intent prompt torque to provide an obvious enhanced driving experience for the driver's steering operations.
(36) As an example, the steering control system for self-driving of the vehicle according to an embodiment of the present invention may further include an automatic steering control unit for, when the driver's operation detection unit does not detect that the driver has operated the steering wheel, i.e., the driver has not applied the effective torque to the steering wheel, controlling the turning angle of the steering wheel to reach the expected turning angle of the self-driving system, and the automatic steering control unit at this time is consistent with the conventional self-driving steering control system in function.
(37)
(38) Compared with the steering control system 200 of
(39) A steering control method in accordance with the above-described steering control system according to an embodiment of the present invention will be described below in combination with
(40)
(41) As shown in
(42) In step S410, information about an expected steering angle of a vehicle may be obtained based on an automatic planning control operation.
(43) In step S420, whether an effective torque has applied to a steering wheel by a driver is detected.
(44) In step S430, when it is detected that the driver has applied the effective torque to the steering wheel, a difference between a turning angle of the steering wheel controlled by the driver and the expected steering angle of the vehicle is computed, and a self-driving intent prompt torque is determined according to the difference between the two and applied to a steering system.
(45) According to the steering control method of the embodiment of the present invention, when it is detected that the driver has applied the effective torque to the steering wheel, the self-driving system and the driver jointly participate in the steering process by applying the self-driving intent prompt torque.
(46) In one example, in step S430, when the self-driving intent prompt torque is determined according to the difference between the turning angle of the steering wheel controlled by the driver and the expected steering angle of the vehicle, and the difference between the turning angle of the steering wheel controlled by the driver and the expected steering angle of the vehicle is larger, a larger self-driving intent prompt torque is determined, and the self-driving intent prompt torque is opposite to a torque that the driver needs to provide, so that the torque that the driver needs to provide is larger.
(47) Specifically, the steering torque applied to the steering wheel may include a steering torque applied by the driver, a steering assistance torque of a vehicle steering assistance system and the self-driving intent prompt torque. That is, the steering torque T at this moment may be determined based on the following formula:
τ=τ.sub.driver+τ.sub.eps+τ.sub.c,
(48) wherein τ.sub.driver is a driver's steering torque, τ.sub.eps is a steering assistance torque, and τ.sub.c is a self-driving intent prompt torque. When the specified steering angle is zero, the torque is zero, the counterclockwise torque is positive, and the clockwise torque is negative. The computational formula of the compensation torque, that is, the self-driving intent prompt torque τ.sub.c, is determined based on the following formula:
τ.sub.c=−sig(τ.sub.driver).Math.ƒ(ƒ abs(Δβ))
(49) wherein Δβ is determined based on the following formula:
Δβ=β.sub.e−β.sub.driver
(50) wherein τ.sub.driver denotes a torque currently applied by the driver, β.sub.e denotes an expected turning angle of self-driving, β.sub.driver denotes a turning angle where the steering wheel is located, and sig (τ.sub.driver) denotes the direction of the torque currently applied by the driver;
(51) ƒ is a positive correlation function of an absolute value of Δβ and may satisfy the following condition:
(52)
(53) wherein τ.sub.eps denotes a steering assistance torque, and ƒ abs(τ.sub.c) denotes an absolute value of τ.sub.c. It should be noted that the steering torque τ required for steering at a certain moment is definite, and is determined by a resistance torque fed back by the ground. The self-driving intent prompt torque is opposite to the driver's torque. Thus, when the self-driving intent prompt torque is large (the difference between the steering angle and the expected turning angle of the vehicle is large), a larger driver torque is required to obtain the required steering torque τ; as the steering angle changes, the difference between the steering angle and the expected turning angle of the vehicle changes, then the self-driving intent prompt torque changes, and the torque that the driver needs to provide also changes, thereby achieving the purpose of providing a self-driving intent to the driver.
(54) It can be clearly seen from the above formula and analysis that, according to the steering control method of the embodiment of the present invention, after the self-driving intent prompt torque is increased, the driver may feel that it is more labor-saving to control the steering wheel to turn to the expected steering angle of the self-driving system, and it is more laborious to control the steering wheel to turn opposite to the expected steering angle of the self-driving system.
(55) For example, it is assumed that according to the current steering angle, the total steering torque is 4 Nm (Newton meters), wherein the steering assistance torque is 3 Nm, and that when the self-driving system is not started, the driver provides an additional torque of 1 Nm. After the self-driving system is started, if the difference Δβ between the expected turning angle of the self-driving system and the driver's turning angle is 5 degrees, the self-driving intent prompt torque τ.sub.c is −1 Nm, then the torque that the driver needs to provide is 2 Nm. When the difference Δβ between the expected turning angle of the self-driving system and the driver's turning angle is increased to 10 degrees, the self-driving intent prompt torque τ.sub.c is −3 Nm, then the torque that the driver needs to provide becomes 4 Nm. As a result, the driver needs to provide a larger steering torque for maintaining the current turning angle. Hence, when the difference Δβ between the expected turning angle of the self-driving system and the driver's turning angle is large, the driver feels laborious, thereby being able to realize the inconsistency between his current operation and the expectation of the self-driving system.
(56) According to the steering control method of the embodiment of the present invention, in one example, the self-driving intent prompt torque determination strategy may also consider the operating state of the self-driving system besides the difference between the driver's operation and the expected turning angle of the self-driving system.
(57) For example, a reliability status of operations of the self-driving system can be determined according to the complexity of the current self-driving road environment and the severity of the lighting condition. For example, if the self-driving system detects that the current environment is complex or the lighting condition is bad, it may be in a low-reliability operating state. In such a case, the amplitude of the self-driving intent prompt torque may be reduced and the system may be similar to the conventional EPS systems. Alternatively, if the self-driving system detects that the current environment is simple and the lighting condition is good, it is in a high-reliability operating state, and the amplitude of the self-driving intent prompt torque is increased to provide an obviously enhanced driving feel for the driver's steering operation.
(58) In the steering control method of the present embodiment, when it is not detected that the driver has operated the steering wheel, i.e., the driver has not applied the effective torque to the steering wheel, the self-driving system controls the turning angle of the steering wheel to reach the expected turning angle of the self-driving system, and the self-driving system at this time is consistent with the conventional self-driving steering control system in function.
(59) Compared with the conventional EPS systems, the steering control method and control system for self-driving of a vehicle according to the embodiments of the present invention can inspect whether the driver's operation is consistent with the self-driving expectation according to the computing result of the self-driving system, and determine a self-driving intent prompt torque to be applied according to the degree of inconsistency, thereby being able to prompt the driver of the steering intent of the self-driving system, instead of passively assisting the driver's operation only according to the driver's operation as in the EPS system; and compared with the existing self-driving steering control system, they can affect the torque to be applied by the driver through the change of the self-driving intent prompt torque, thereby prompting the human driver of the steering intent of the self-driving system, but ensuring the coexistence of the human driver and the self-driving to avoid the conflict or exit of the self-driving state due to the difference between the driver's steering intent and the self-driving steering intent in the past.
(60) The steering control method and the steering control system according to the present invention affect a human driving operation by changing the torque mode according to the expected steering angle computed by the self-driving system. The driver will not be forced to change his/her steering operation but can be prompted with a recommended driving behavior from the self-driving, and in most cases, the driver can participate in the process of steering control with nearly zero operation, thereby improving the safety and comfort of a driving process.
(61) It should be noted that the vehicle in the description should be understood in a broad sense, including various large, medium and small vehicles, water vehicles, trans-atmospheric vehicles, etc.
(62) It should be noted that relevant steps of the method may be performed locally in the vehicle, or in the cloud, or both locally and in the cloud.
(63) It should be noted that although the steps in the flow chart are shown in a certain order, this does not mean that the steps can only be performed in this order, but as long as there is no logical interdependence between the steps, the steps may be performed in a reverse order or in parallel.
(64) The above-described embodiments of the present invention are exemplary but not exhaustive and are not limited to the disclosure. Many modifications and alterations will be apparent to those of ordinary skill in the art without departing from the scope and spirit of the embodiments described. Therefore, the scope of the present invention shall be subjected to the scope of the claims.