Vehicle travel track control device

• US 9,168,953 B2
• Filed: 11/08/2011
• Issued: 10/27/2015
• Est. Priority Date: 11/08/2011
• Status: Active Grant

• Current Assignee: Toyota Jidosha Kabushiki Kaisha (Toyota Motor Corporation)
• Original Assignee: Toyota Jidosha Kabushiki Kaisha (Toyota Motor Corporation)
• Inventors: Kojo, Takahiro, Kunihiro, Yoji, Takashima, Toru, Mitsumoto, Hisanori
• Primary Examiner(s): Marc, McDieunel
• Application Number:
  US14/351,303
• Publication Number:
  US 20140257640A1
• Time in Patent Office: 1,449 Days
• Field of Search: 701/41, 701/70, 701/91, 701/28, 701/48, 180/168, 180/170
• US Class Current: 1/1
• CPC Class Codes: B60W 10/20 including control of steering systems
• CPC Class Codes: B60W 2420/403 Image sensing, e.g. optical camera
• CPC Class Codes: B60W 2554/00 Input parameters relating to objects
• CPC Class Codes: B60W 2710/207 Steering angle of wheels
• CPC Class Codes: B60W 30/10 Path keeping cruise control for automatically following a preceding vehicle B60W30/165
• CPC Class Codes: B60W 30/12 Lane keeping
• CPC Class Codes: B60W 40/101 Side slip angle of tyre
• CPC Class Codes: B62D 15/025 Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation B62D1/28 takes precedence

Abstract

A vehicle travel track control device which includes a forward image capture device which captures an image ahead of a vehicle, and side image capture devices which capture an image on the left side and/or the right side of the vehicle. When it is possible to properly execute a travel track control on the basis of captured forward image information ahead of the vehicle, the travel track control is executed on the basis of the captured forward image information sent from the forward image capture device, and when it is not possible to properly execute a travel track control on the basis of the captured forward image information, the travel track control is executed on the basis of at least captured side image information sent from the side image capture devices.

Claims

1. A vehicle travel track control device comprising:

an image capture device which captures a forward image ahead of a vehicle and captures at least one side image on at least one lateral side of the vehicle, the image capture device having at least one of a variable capturing direction and a variable capturing range; and

an electronic control unit which calculates a target steered angle of steered wheels based on captured image information sent from said image capture device and controls a steered angle of the steered wheels based on said target steered angle to control the vehicle to travel along a lane, wherein

in a first mode, the electronic control unit calculates the target steered angle of the steered wheels based on captured forward image information ahead of the vehicle, and

in a situation where the target steered angle of the steered wheels cannot properly be calculated based on the captured forward image information ahead of the vehicle, said electronic control unit changes to a second mode wherein said electronic control unit

controls said image capture device to capture a side image on a side of the vehicle,

determines a line of the lane based on captured side image information,

estimates lateral distances between the vehicle and the line of the lane at reference positions based on the captured side image information,

estimates a lateral difference and a yaw angle of the vehicle relative to the lane based on the lateral distances at the reference positions,

calculates a target lateral difference of the vehicle relative to the lane based on the lateral difference of the vehicle and the yaw angle of the vehicle, and

calculates a target steered angle of the steered wheels based on at least a difference between the lateral difference of the vehicle and the target lateral difference of the vehicle.

2. A vehicle travel track control device according to claim 1, wherein said electronic control unit

estimates a curvature radius of the lane based on the captured side image information,

calculates a target yaw angle of the vehicle relative to the lane based on the curvature radius of the lane, and

calculates the target steered angle of the steered wheels based on a difference between the lateral difference of the vehicle and the target lateral difference of the vehicle, a difference between the yaw angle of the vehicle and the target yaw angle of the vehicle, and the curvature radius of the lane.

3. A vehicle travel track control device according to claim 1, wherein said electronic control unit

estimates yaw angles of the vehicle with respect to three time points based on vehicle travel motion,

estimates positions of the vehicle in rectangular coordinates with respect to the three time points based on the yaw angles of the vehicle and vehicle travel motion,

estimates lateral differences of the vehicle relative to the lane at a reference position of the vehicle with respect to the three time points based on the captured side image information,

estimates a curvature radius of the lane based on the lateral difference of the vehicle relative to the lane, the yaw angle of the vehicle, and the position of the vehicle at the third time point,

calculates a target yaw angle of the vehicle based on the curvature radius of the lane, and

calculates a target steered angle of the steered wheels based on a difference between the lateral difference of the vehicle and the target lateral difference of the vehicle at the third time point, a difference between the yaw angle of the vehicle and the target yaw angle of the vehicle at the third time point, and the curvature radius of the lane.

4. A vehicle travel track control device according to claim 1, wherein said electronic control unit

estimates a lateral difference of the vehicle relative to the lane at a reference position of the vehicle based on the captured side image information,

calculates a target lateral difference of the vehicle relative to the lane based on at least one of the lateral difference of the vehicle and width information of the lane, and

calculates a target steered angle of the steered wheels based on the lateral difference of the vehicle and the target lateral difference of the vehicle.

5. A vehicle travel track control device according to claim 4, wherein said image capture device includes

a left side image capture device which captures a left side image on the left side of the vehicle and

a right side image capture device which captures a right side image on the right side of the vehicle;

and

said electronic control unit

estimates lateral differences of the vehicle relative to edges of the lane on the left and right sides of the vehicle based on captured left and right side image information, and

calculates a target lateral difference of the vehicle relative to the lane based on lateral differences of the vehicle relative to edges of the lane on the left and right sides of the vehicle.

6. A vehicle travel track control device according to claim 1, wherein

said electronic control unit

estimates lateral differences of the vehicle relative to the lane at front and rear reference positions spaced apart from each other longitudinally of the vehicle based on the captured side image information,

estimates the yaw angle of the vehicle relative to the lane based on the lateral differences of the vehicle relative to the lane at the front and rear reference positions,

calculates a curvature radius of the lane based on the lateral differences of the vehicle,

calculates a target yaw angle of the vehicle based on the curvature radius of the lane, and,

with a target lateral difference of the vehicle being one of a value variably set based on width of the lane and a predetermined value,

calculates

a target steered angle of the steered wheels based on a difference between the lateral difference of the vehicle and the target lateral difference of the vehicle and

a difference between the yaw angle of the vehicle and the target yaw angle of the vehicle.

7. A vehicle travel track control device according to claim 1, wherein

said image capture device includes a forward image capture device which captures the forward image ahead of the vehicle and a side image capture device which captures the side image on at least one of the left and right sides of the vehicle;

and

said electronic control unit

calculates a target steered angle of the steered wheels based on captured forward image information from said forward image capture device in a situation where a target steered angle of the steered wheels can properly be calculated based on the captured forward image information ahead of the vehicle and

calculates a target steered angle of the steered wheels based on at least the captured side image information from said side image capture device in the situation where a target steered angle of the steered wheels cannot properly be calculated based on the captured forward image information ahead of the vehicle.

8. A vehicle travel track control device according to claim 1, wherein

said electronic control unit

calculates the target steered angle of the steered wheels based on the captured forward image information sent from said forward image capture device in a situation where the curvature radius of vehicle travel track is larger than a reference value, and

calculates the target steered angle of the steered wheels based on the captured side image information sent from said side image capture device in a situation where the curvature radius of vehicle travel track is not larger than said reference value.

9. A vehicle travel track control device according to claim 8, wherein

in a situation where the curvature radius of vehicle travel track is not larger than said reference value, said electronic control unit calculates a first target steered angle of the steered wheels based on the captured forward image information sent from said forward image capture device and

calculates a second target steered angle of the steered wheels based on the captured side image information sent from said side image capture device,

estimates a forward observing distance of a driver based on a vehicle speed and the curvature radius of vehicle travel track,

variably sets a contribution degree of the second target steered angle so that the degree becomes high when an image-capturable distance of said forward image capture device is shorter relative to the forward observing distance as compared to a case where the image-capturable distance of said forward image capture device is long relative to the forward observing distance, and

calculates a target steered angle of the steered wheels based on the first target steered angle, the second target steered angle, and the contribution degree.

10. A vehicle travel track control device according to claim 1, wherein

said electronic control unit

gradually changes the target steered angle of the steered wheels when vehicle travel track control is interchanged between the first mode where the target steered angle of the steered wheels is calculated based on the captured forward image information and the second mode where the target steered angle of the steered wheels is calculated based on at least the captured side image information.

11. A vehicle travel track control device according to claim 1, wherein

said electronic control unit

decreases vehicle speed to continue the control of vehicle travel track in at least one of

a case where there is a risk for the vehicle to escape from the lane and

a case where the performance of said image capture means deteriorates in image capture accuracy.

12. A vehicle travel track control device according to claim 1, wherein

the situation where the target steered angle of the steered wheels cannot properly be calculated based on captured forward image information ahead of the vehicle arises when the electronic control unit determines that a length of at least one forward lane line is not at least a predetermined minimum length required to be specified to execute a travel track control of the vehicle.

13. A vehicle travel track control device according to claim 1, wherein

a situation where the target steered angle of the steered wheels can properly be calculated based on the captured forward image information ahead of the vehicle arises when the electronic control unit determines that a length of at least one forward lane line is at least a predetermined minimum length required to be specified to execute a travel track control of the vehicle.

14. A vehicle travel track control device according to claim 1, wherein

the electronic control unit estimates the lateral distances between the vehicle and the line of the lane based at reference positions based on the captured side image information according to the following formula:

15. A vehicle travel track control device according to claim 1, wherein

the electronic control unit estimates the yaw angle of the vehicle relative to the lane according to the following formula: