Method and system for assisting a driver in the event of a road departure

Abstract

The present invention relates to a method for assisting a driver of a host vehicle in the event of a road departure. Collecting a set of drive parameter values, wherein each drive parameter is indicative of a present driving condition parameter for the vehicle. Calculating a collective road departure value based on the set of drive parameter values. When the road departure value exceeds a road departure threshold value, adapt at least one of the speed of the vehicle or the steering torque applied by the steering control system to the steerable wheels of the vehicle, until the road departure value is below the road departure threshold value.

Claims

1. A method for assisting a driver of a host vehicle in the event of a road departure, the method comprising: collecting a set of drive parameter values, wherein each drive parameter is indicative of a present driving condition parameter for the host vehicle; calculating a collective road departure value based on the set of drive parameter values; and when the collective road departure value exceeds a road departure threshold value indicating an amount of road departure that is a safety concern, adapting at least one of a speed of the host vehicle or a steering torque applied by a steering control system to steerable wheels of the host vehicle, until the collective road departure value is below the road departure threshold value.

2. The method according to claim 1, further comprising: determining that the road departure was intentional or unintentional; and adapting at least one of the speed of the host vehicle or the steering torque only when the road departure was unintentional.

3. The method according to claim 2, wherein determining that the road departure was intentional or unintentional is based on prior driving style data indicative of a driving style for a specific driver, or based on historical travelling path data indicative of traveling paths for a plurality of vehicles at a specific location.

4. The method according to claim 1, further comprising: detecting a driver initiated driving action; and adapting at least one of the speed of the host vehicle or the steering torque also based on the driver initiated driving action.

5. The method according to claim 1, wherein: adapting at least one of the speed of the host vehicle or the steering torque is performed for an additional margin time duration after the collective road departure value is determined to be below the road departure threshold value.

6. The method according to claim 1, wherein the drive parameter values are counters indicative of whether or not a measured driving condition parameter values exceeds a respective threshold value.

7. The method according to claim 6, wherein the collective road departure value is a weighted sum of the counters.

8. The method according to claim 7, wherein the weights are selected based on an accuracy of the respective measured driving condition parameter.

9. The method according to claim 1, wherein the driving condition parameters are at least one of: time derivative of rack force in steering system, vertical jerk, angular jerk, suspension travel energy differences, time derivative of wheel speed, longitudinal jerk, time derivative of acceleration, and visual detection of host vehicle location with respect to road surface.

10. The method according to claim 1, wherein the set of drive parameter values comprises an indication of a detected presence of a secondary vehicle on collision course with the host vehicle, wherein adapting at least one of the speed of the host vehicle or the steering torque is performed to avoid a collision with the secondary vehicle.

11. The method according to claim 1, further comprising: calculating a safe path for the host vehicle based on the set of drive parameter values; and adapting at least one of the speed of the host vehicle or the steering torque based on the calculated safe path.

12. A drive assist system for a host vehicle for assisting a driver of the host vehicle in the event of a road departure, the drive assist system comprising: a set of sensors configured to detect driving condition parameters for the host vehicle; a steering control system configured to control a steering torque applied to steerable wheels of the host vehicle; a wheel torque control system for controlling a propulsion or brake torque applied to at least one of the steerable wheels of the host vehicle; and a vehicle control unit configured to: determine a set of drive parameter values based on detected driving condition parameters; calculate a collective road departure value based on the set of drive parameter values; and control at least one of the steering control system and the wheel torque control system to adapt a speed of the host vehicle or the steering torque applied to the steerable wheels of the host vehicle until the collective road departure value is below a road departure threshold value indicating an amount of road departure that is a safety concern.

13. The drive assist system according to claim 12, wherein the set of sensor comprises at least one of an image capturing device, an inertial measurement unit, and suspension travel sensors.

14. The drive assist system according to claim 12, wherein the vehicle control unit is further configured to: calculate a safe path for the host vehicle based on the set of drive parameter values; and control at least one of the steering control system and the wheel torque control system to adapt at least one of the speed of the host vehicle and the steering torque based on the calculated safe path.

15. A vehicle comprising drive assist system for assisting a driver of the vehicle in the event of a road departure, the drive assist system comprising: a set of sensors configured to detect driving condition parameters for the vehicle; a steering control system configured to control a steering torque applied to steerable wheels of the vehicle; a wheel torque control system for controlling a propulsion or brake torque applied to at least one of the steerable wheels of the vehicle; and a vehicle control unit configured to; determine a set of drive parameter values based on detected driving condition parameters; calculate a collective road departure value based on the set of drive parameter values; and control at least one of the steering control system and the wheel torque control system to adapt a speed of the vehicle or the steering torque applied to the steerable wheels of the vehicle until the collective road departure value is below a road departure threshold value indicating an amount of road departure that is a safety concern.

16. The vehicle according to claim 15, wherein the set of sensor comprises at least one of an image capturing device, an inertial measurement unit, and suspension travel sensors.

17. The vehicle according to claim 15, wherein the vehicle control unit is further configured to: calculate a safe path for the vehicle based on the set of drive parameter values; and control at least one of the steering control system and the wheel torque control system to adapt at least one of the speed of the vehicle and the steering torque based on the calculated safe path.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) These and other aspects of the present invention will now be described in more detail, with reference to the appended drawings showing example embodiments of the invention, wherein:

(2) FIG. 1 illustrates a schematic overview of exemplifying application of embodiments of the invention;

(3) FIG. 2 is a box diagram of a drive assist system according to embodiments of the invention; and

(4) FIG. 3 is a flow-chart of method steps according to embodiments of the invention.

DETAILED DESCRIPTION OF EXAMPLE EMBODIMENTS

(5) In the present detailed description, various embodiments of the system and method according to the present invention are described. However, this invention may be embodied in many different forms and should not be construed as limited to the embodiments set forth herein; rather, these embodiments are provided for thoroughness and completeness, and fully convey the scope of the invention to the skilled person. Like reference characters refer to like elements throughout.

(6) FIG. 1 illustrates a schematic overview of exemplifying application of embodiments of the invention. A drive assist system is comprised in a host vehicle 100 here shown travelling next to the road 102. The road is delimited by outer edges 105 and 107. The road is here shown to have two lanes, the lane 103a which is the intended ego-lane of the host vehicle 100 and an opposing lane 103b.

(7) The host vehicle 100 comprises set of sensors (not shown) configured to detect driving condition parameters for the vehicle 100. The host vehicle 100 further comprises a wheel torque control system 203 for controlling a propulsion or brake torque applied to at least one of the wheels of the vehicle 100 and a steering control system 202 configured to control the steering torque applied to the steerable wheels of the vehicle 100.

(8) A vehicle control unit 210 is comprised in the vehicle 100 and is configured to control the steering control system 202 and the wheel torque control system 203. Thus the vehicle control unit 210 can communicate with the steering control system 202 and the wheel torque control system 203 via suitable communication means such as e.g. CAN-buses or wireless communication such that the vehicle control unit 210 can send control signal to the steering control system 202 and the wheel torque control system 203.

(9) As illustrated in FIG. 1, the host vehicle 100 has departed the road 102. In this case the vehicle 100 has fully departed the road, i.e. all wheels of the vehicle 100 are outside the road surface 102, however, this is not a requirement for the inventive concept.

(10) Path 104 is one of two illustrated hazardous paths that may occur in the event of a road departure. The vehicle 100 may have unintentionally departed the road surface, and the driver may attempt to steer back to the road 102 but fail. For example, large off-road banking, high road edge 105, and poor off-road grip may be conditions that prevent the driver to by himself/herself return the vehicle to the ego lane 103a. Instead, the vehicle 100 may unintentionally and hazardously pursue the deviating path 104.

(11) As a further example of a hazardous situation is path 106 illustrated. The path 106 is typical for an overshoot control of the vehicle 100 and may be caused by e.g. an unexperienced driver driving the vehicle 100, unexpected high grip on the road 102, or generally an excessive steering angle.

(12) Instead, with the inventive concept, a set of drive parameter values are collected that are indicative of the present driving condition for the vehicle 100. Analyzing the present driving condition by means of comparing a collective road departure value to a threshold value enables to adapt the speed or steering torque of the vehicle such that the driver safely can return the vehicle 100 to ego lane 103a via the exemplary path 108 without deviating or overshooting the vehicle path.

(13) FIG. 2 is a box diagram of a drive assist system 200 for a vehicle according to example embodiments of the invention. The system 200 comprises a set of sensors 204, 206, 208 configured to detect driving condition parameters for the vehicle. The sensors may comprise an image capturing device 204, an inertial measurement unit 206, and suspension travel sensors 208.

(14) The drive assist system 200 further comprises a steering control system 202 configured to control the steering torque applied to the steerable wheels of the vehicle, and a wheel torque control system 203 for controlling a propulsion or brake torque applied to at least one of the wheels of the vehicle.

(15) A vehicle control unit 210 is configured to receive driving condition parameter data from the sensors 204, 206, 208. Based on the data, the vehicle control unit 210 determines a set of drive parameter values. The vehicle control unit 210 processes the set of drive parameter values to calculate a collective road departure value which is compared to a road departure threshold value. Then, the vehicle control unit 210 is configured to control the steering control system 202 and/or the wheel torque control system 203 via control signals to adapt at least one of the speed of the vehicle or the steering torque applied to the steerable wheels of the vehicle, until the road departure value is below the road departure threshold value.

(16) In some embodiments, the vehicle control unit 210 is configured to calculate a safe drive path, i.e. path 108 in FIG. 1, and to control at least one of the steering control system 202 and the wheel torque control system 203 to adapt at least one of the speed of the vehicle and the steering torque based on the calculated safe path. In other words, the adaptation of the speed of the vehicle and the steering torque together with the drivers input is such that to assist the driver in a safe way to the safe path 108 after a road departure.

(17) The steering control system 203 may comprise an electrically powered assisted steering system. Thus, the vehicle control unit 210 may request a steering torque to be added to the steering system by the electrically powered assisted steering system. The requested steering torque (T.sub.steer) may be given by:
T.sub.steer=K.sub.p(A.sub.ref−A.sub.actual)
where K.sub.fb is a feedback gain factor and is a tunable constant, A.sub.ref is a reference steering angle which is calculated with regards to the required steering profile to steer the vehicle along the safe path 108, and A.sub.actual is the present actual steering angle.

(18) Accordingly, the steering control system 203 comprised in the system 200 is configured to control the curvature of the present path for the host vehicle 100, by applying an overlay steering torque. The steering torque is used for turning the steerable wheels of the vehicle to a desirable wheel angle which corresponds to a desired curvature.

(19) The steering control system 203 may comprise a controller which calculates the required steering angle in order to follow a desired curvature, using e.g. a vehicle model. In addition, the steering control system 203 may comprise an electric machine to provide the overlay steering torque.

(20) Next, embodiments of the invention will be described with reference to a flow-chart of method step shown in FIG. 3.

(21) In step S102 is a set of drive parameter values collected. Each drive parameter is indicative of a present driving condition parameter for the vehicle.

(22) A collective road departure value is calculated based on the set of drive parameter values in step S104.

(23) The road departure value is compared to a road departure threshold value. When the road departure value exceeds the road departure threshold value, at least one of the speed of the vehicle or the steering torque applied by the steering control system to the steerable wheels of the vehicle is adapted in step S106.

(24) The invention will now be exemplified with a non-limiting example.

(25) Environmental sensors such as a camera may be used to detect whether the vehicle is on the road or not. If the vehicle is on the road then the corresponding drive parameter value d.sub.1=0, otherwise d.sub.1=1.

(26) Wheel speed sensors and/or accelerometers (i.e. part of an inertial measurement unit) may be used to detect a present increase in translational acceleration of a wheel and/or the wheel speed. If the increase is above a threshold, then the corresponding drive parameter value d.sub.2=1, otherwise d.sub.2=0.

(27) The rack force in steering system may be detected. If a change in rack force, i.e. the time derivative during a time frame exceeds a threshold, then the corresponding drive parameter value d.sub.3=1, otherwise d.sub.3=0.

(28) The vertical jerk, i.e. the time derivative of the vertical acceleration may be used as an indicator of rough road. Departure from the road will cause noticeable jerk. If a change vertical jerk during a time frame exceeds a threshold, then the corresponding drive parameter value d.sub.4=1, otherwise d.sub.4=0.

(29) The angular jerk level may be used as an additional indicator of rough road. Departure from the road will cause noticeable jerk. If change angular jerk (time derivative) during a time frame exceeds a threshold, then the corresponding drive parameter value d.sub.5=1, otherwise d.sub.5=0.

(30) Suspension travel sensors may be used for assessing the roughness of the road. Rough road on one side of the vehicle will mean significant difference in energy levels between left and right suspension side. If the suspension travel difference exceeds a threshold then the corresponding drive parameter value d.sub.6=1, otherwise d.sub.6=0.

(31) In the above example, the drive parameter values are counters indicative of whether or not a measured driving condition parameter values exceeds a respective threshold value.

(32) The collective road departure value is calculated based on the drive parameter values. For example, the road departure value (d.sub.tot) may generally be calculated as:

(33) $d_{\mathrm{tot}}=\frac{w_1\times d_1+w_2\times d_2+w_3\times d_3+w_4\times d_4+w_5\times d_5+w_6\times d_6}{w_1+w_2+w_3+w_4+w_5+w_6},$
in other words as a weighted sum. The weights w.sub.1, w.sub.2, w.sub.3, w.sub.4, w.sub.5, w.sub.6 may depend on how reliable the respective measurement method is or the relevance of the respective parameter is for the assessment of a road departure.

(34) If d.sub.tot>d.sub.threshold, then the vehicle is estimated to have departed the road.

(35) The calculation of the road departure value and comparison with the threshold value may be performed continuously such that the adaptation of the steering torque and vehicle speed may be continued adaptively until the road departure value no longer exceeds the threshold. In some embodiments the adaption continues for a time margin after the road departure value no longer exceeds the threshold.

(36) Alongside with the adaptation of the vehicle speed and steering torque, a driver initiated driving action is detected. The speed and wheel torque added by the wheel torque control system and the steering control system takes the driver initiated driving action into account. A driver initiated driving action may be detected by detecting a driver initiated turn of the steerable wheels of the vehicle, or a driver initiated turning of the steering wheel, or detecting an altered steering wheel angular speed, or detecting a torsion bar torque in the steering mechanism, to mention some examples.

(37) A vehicle in accordance with the invention may be any vehicle operative on a road, such as a car, a truck, a lorry, a bus, etc.

(38) The vehicle control unit may include a microprocessor, microcontroller, programmable digital signal processor or another programmable device. The control functionality of the present disclosure may be implemented using existing computer processors, or by a special purpose computer processor for an appropriate system, incorporated for this or another purpose, or by a hardwire system. Embodiments within the scope of the present disclosure include program products comprising machine-readable medium for carrying or having machine-executable instructions or data structures stored thereon. Such machine-readable media can be any available media that can be accessed by a general purpose or special purpose computer or other machine with a processor. By way of example, such machine-readable media can comprise RAM, ROM, EPROM, EEPROM, CD-ROM or other optical disk storage, magnetic disk storage or other magnetic storage devices, or any other medium which can be used to carry or store desired program code in the form of machine-executable instructions or data structures and which can be accessed by a general purpose or special purpose computer or other machine with a processor. When information is transferred or provided over a network or another communications connection (either hardwired, wireless, or a combination of hardwired or wireless) to a machine, the machine properly views the connection as a machine-readable medium. Thus, any such connection is properly termed a machine-readable medium. Combinations of the above are also included within the scope of machine-readable media. Machine-executable instructions include, for example, instructions and data which cause a general purpose computer, special purpose computer, or special purpose processing machines to perform a certain function or group of functions.

(39) Although the figures may show a sequence the order of the steps may differ from what is depicted. Also two or more steps may be performed concurrently or with partial concurrence. Such variation will depend on the software and hardware systems chosen and on designer choice. All such variations are within the scope of the disclosure. Likewise, software implementations could be accomplished with standard programming techniques with rule based logic and other logic to accomplish the various connection steps, processing steps, comparison steps and decision steps.

(40) The person skilled in the art realizes that the present invention by no means is limited to the preferred embodiments described above. On the contrary, many modifications and variations are possible within the scope of the appended claims.

(41) In the claims, the word “comprising” does not exclude other elements or steps, and the indefinite article “a” or “an” does not exclude a plurality. A single processor or other unit may fulfill the functions of several items recited in the claims. The mere fact that certain measures are recited in mutually different dependent claims does not indicate that a combination of these measured cannot be used to advantage. Any reference signs in the claims should not be construed as limiting the scope.