US20140200768A1 - Vehicle travel assisting device - Google Patents

Abstract

In a vehicle travel assisting device, a vehicle speed, a yaw rate, a traveling lane of an own vehicle, and a position of a leading vehicle are detected. Target travel coordinates of the own vehicle are calculated, based on the traveling lane and the position of the leading vehicle A travel path curvature of a target travel coordinate group is estimated, based on information related to the target travel coordinate group. A steering quantity to be steered in advance by the own vehicle is calculated, based on the currently estimated travel path curvature. A weight for each of the target travel coordinates for estimating the travel path curvature is adjusted based on the vehicle speed, the yaw rate and the previously estimated travel path curvature. Steering control is performed such that the own vehicle travels so as to follow the estimated travel path curvature, based on the calculated steering quantity.

Description

CROSS-REFERENCE TO RELATED APPLICATION
• This application is based on and claims the benefit of priority from earlier Japanese Patent Application No. 2013-003656 filed Jan. 11, 2013, the description of which is incorporated herein by reference.
BACKGROUND[Technical Field]
• The present invention relates to a technology for assisting vehicle travel.
[Related Art]
• In related art, devices for assisting lane traveling of a vehicle are known. The device premises a traveling lane to be an arc based on positional coordinates of the traveling lane, using the least-squares method. The device then performs travel assistance based on the curvature of the arc and the vehicle state (refer to JP-B-4325363).
• However, in the device for assisting lane traveling of a vehicle such as that described above, the accuracy of curvature estimation varies depending on the accuracy of the positional coordinates of the traveling lane. A problem occurs in that the variation in accuracy may cause the vehicle to drift. In addition, when the road on which the vehicle is traveling changes from a straight line to a curve, the road is recognized as being a curve earlier than it actually is. A problem occurs in that the vehicle travels further to the inner side of the curve than a targeted positional coordinate group.
SUMMARY
• It is thus desired to enhance the reliability of steering control in a vehicle travel assisting device.
• According to an exemplary embodiment of the present disclosure, there is provided a vehicle travel assisting device including travel state quantity detecting means, periphery monitoring means, target travel coordinate recording means, travel path curvature estimating means, steering feed-forward calculating means, and steering control means.
• The travel state quantity detecting means detects a vehicle speed and a yaw rate that are travel state quantities indicating a traveling state of an own vehicle in which the vehicle travel assisting device is mounted.
• The periphery monitoring means detects a traveling lane in which the own vehicle is traveling and a position of a leading vehicle present ahead of the own vehicle.
• The target travel coordinate recording means calculates target travel coordinates that are target coordinates to be traveled by the own vehicle, based on the traveling lane and the position of the leading vehicle detected by the periphery monitoring means.
• The travel path curvature estimating means estimates a travel path curvature that is a curvature of a target travel coordinate group, based on information related to the target travel coordinate group recorded by the target travel coordinate recording means.
• The travel path curvature estimating means includes curvature estimation calculation adjusting means. The curvature estimation calculation adjusting means adjusts a weight for each of the target travel coordinates used to estimate the travel path curvature, based on the vehicle speed and the yaw rate detected by the travel state quantity detecting means and a previously estimated travel path curvature.
• The steering feed-forward calculating means calculates in advance a steering quantity to be steered by the own vehicle, based on the travel path curvature estimated by the travel path curvature estimating means.
• The steering control means performs steering control such that the own vehicle travels such as to follow the travel path curvature estimated by the travel path curvature estimating means, based on the steering quantity calculated by the steering feed-forward calculating means.
• In the vehicle travel assisting device configured as described above, the accuracy of travel path curvature estimation can be improved. Such a steering control that can track the traveling state of the own vehicle and changes in the shape of the road can be actualized. Reliability of steering control can be enhanced.
• The travel path curvature estimating means may estimate the travel path curvature by an approximated curve formed into an arc-like shape which is determined using a least-squares method, based on the target travel coordinate group. The travel path curvature estimating means may determine the approximated curve such that a center of the arc is set on a normal line of a travel vector of the own vehicle.
• The travel path curvature estimating means may determine the approximated curve such that: (i) a center of the arc is set on a normal line of a travel vector of the own vehicle; and (ii) the arc is set on a center of gravity of the own vehicle or a center of rear tires of the own vehicle. The travel path curvature estimating means may determine the approximated curve such that a center of the arc is set at any point.
• The travel path curvature estimating means may include multiple curvature estimation result calculating means for performing calculation based on a plurality of estimation results of the travel path curvature such that the curvature changes smoothly.
• The curvature estimation calculation adjusting means may adjust the weight of each of the target travel coordinates by smoothly deviating the weight near a border of the target travel coordinate group such that the weight becomes zero when each of the target travel coordinates is added to or deleted from the target travel coordinate group.
BRIEF DESCRIPTION OF THE DRAWINGS
• In the accompanying drawings:
• FIG. 1 is a block diagram of a configuration of a travel assisting device according to an embodiment;
• FIG. 2A toFIG. 2D are schematic diagrams for explaining a relationship between target travel coordinates and weights for each of the target travel coordinates used to estimate a travel path curvature;
• FIG. 3A toFIG. 3C are schematic diagrams for explaining the travel path curvature;
• FIG. 4A andFIG. 4B are schematic diagrams for explaining a method for calculating the travel path curvature; and
• FIG. 5 is a flowchart of processing operations in a travel assisting process.
DESCRIPTION OF EMBODIMENTS
• An embodiment of the present invention will hereinafter be described with reference to the drawings. The present invention is not limited to the embodiment described hereafter. Various aspects of the present invention are possible.
• FIG. 1 shows a vehicle travel assisting device (referred to, hereinafter, as a travel assisting device)1 to which the present embodiment is applied. Thetravel assisting device1 is mounted in a vehicle (hereinafter referred to as “own vehicle”, as needed) and includes a vehicle statequantity detecting unit10, aperiphery monitoring unit20, a calculatingunit30, and asteering control unit40. Theperiphery monitoring unit20 detects conditions surrounding the vehicle. The vehicle statequantity detecting unit10 includes a steering angle encoder, a vehicle speed encoder, and a yaw rate sensor.
• The steering angle encoder is a sensor that detects a steering angle of the own vehicle as a traveling state quantity. The traveling state quantity indicates the traveling state of the own vehicle. The steering angle encoder outputs a signal based on the steering angle to the calculatingunit30.
• The vehicle speed encoder is a sensor that detects a traveling speed (vehicle speed) of the own vehicle as the traveling state quantity. The vehicle speed encoder outputs a signal based on the traveling speed to the calculatingunit30.
• The yaw rate sensor is a sensor that detects a rotation speed of a shaft facing a vertical direction of the own vehicle as the traveling state quantity. The yaw rate sensor outputs a signal based on the yaw rate to the calculatingunit30.
• Known sensors can be used as the steering angle encoder, the vehicle speed encoder, and the yaw rate sensor. The sensors are not particularly limited. In addition, the traveling speed of the own vehicle may be detected using the signal outputted from the vehicle speed encoder. Alternatively, the traveling speed of the own vehicle may be determined using a satellite positioning device, such as a global positioning system (GPS) device, instead of the speed encoder. The satellite positioning device locates the position of the own vehicle.
• Theperiphery monitoring unit20 includes at least a front sensor, a left-side sensor, and a right-side sensor. A detection area of the front sensor is a predetermined angular range of which the center is the straight-ahead direction ahead of the vehicle. A detection area of the left-side sensor is a predetermined angular range of which the center is a vehicle-width direction on the left side of the vehicle. A detection area of the right-side sensor is a predetermined angular range on the right side of the vehicle (similar to that of the left-side sensor).
• Theperiphery monitoring unit20 detects the traveling lane on which the own vehicle is traveling. In addition, theperiphery monitoring unit20 detects the position of a leading vehicle present ahead of the own vehicle. The front sensor is composed of an image sensor (camera) or a laser radar. The left- and right-side sensors are each composed of any of an image sensor, a laser radar, a millimeter-wave sensor, or a sonar.
• The calculatingunit30 is mainly provided with a target travel coordinaterecording section31, a travel path curvature estimatingsection32, and a steering feed-forward calculating means33. In addition, the travel path curvature estimatingsection32 is provided with a curvature estimationcalculation adjusting section32aand a multiple curvature estimationresult calculating unit32b.
• In addition, the calculatingunit30 is a microcomputer including a central processing unit (CPU), a read-only memory (ROM), a random access memory (RAM), an input/output interface, and the like. A control program stored in a storage device, such as the ROM, allows the CPU to function as the above-described target travel coordinaterecording section31, the travel path curvature estimating section32 (including the curvature estimationcalculation adjusting section32aand the multiple curvature estimationresult calculating unit32b), and the steering feed-forward calculating means33.
• Thesteering control unit40 performs steering control based on the steering quantity calculated by the calculatingunit30. Thesteering control unit40 performs steering control such that the own vehicle travels such as to follow a travel path curvature estimated by the calculatingunit30.
• Next, a travel assisting process performed by thetravel assisting device1 will be described with reference to the flowchart inFIG. 5.
• The calculatingunit30 repeatedly performs the travel assisting process at a fixed interval, while thetravel assisting device1 has been enabled by the operation of the driver.
• First, at the first step S110, the calculatingunit30 acquires the vehicle state quantities and peripheral information. Here, the vehicle statequantity detecting unit10 detects the steering angle of the own vehicle (referred to, hereinafter, as the steering angle) using the steering angle encoder. The vehicle statequantity detecting unit10 also detects the traveling speed of the own vehicle (referred to, hereinafter, as the vehicle speed) using the vehicle speed encoder. The vehicle statequantity detecting unit10 also detects the yaw rate of the own vehicle using the yaw rate sensor. The vehicle statequantity detecting unit10 then outputs the detected steering angle, vehicle speed, and yaw rate to the calculatingunit30.
• In addition, theperiphery monitoring unit20 detects the traveling lane on which the own vehicle is traveling and the position of a leading vehicle present ahead of the own vehicle using the front sensor, the left-side sensor, the right-side sensor, and the like. Theperiphery monitoring unit20 then outputs the information related to the detected traveling lane and the information related to the leading vehicle to the calculatingunit30 as peripheral information.
• At subsequent step S120, the calculatingunit30 judges whether or not the travel distance or the travel time of the own vehicle is a predetermined value or more. The predetermined value is set in advance based on experiments or the like. When judged that the travel distance or the travel time of the own vehicle is the predetermined value or more (YES at step S120), the calculatingunit30 updates the target travel coordinates (step S130).
• The calculatingunit30 then proceeds to step S140. At this time, the calculatingunit30 updates the target travel coordinates by deleting the oldest target travel coordinates and adding the newest target travel coordinates. On the other hand, when judged that the travel distance or the travel time of the own vehicle is not the predetermined value or more (NO at step S120), the calculatingunit30 proceeds directly to S140.
• At step S140, the calculatingunit30 estimates the travel path curvature. Here, the target travel coordinaterecording section31 calculates the target travel coordinates from the traveling lane of the vehicle and the position of the leading vehicle detected by theperiphery monitoring unit20. The target travel coordinates are target coordinates on which the own vehicle should travel. The target travel coordinaterecording section31 then records the calculated target travel coordinates.
• Next, the travel path curvature estimatingsection32 estimates the travel path curvature based on information related to a target travel coordinate group recorded by the target travel coordinaterecording section31. The travel path curvature is the curvature of the target travel coordinate group.
• In this instance, the curvature estimationcalculation adjusting section32aadjusts the weight for each of the target travel coordinates used to estimate the travel path curvature, based on the vehicle speed and yaw rate currently detected by the vehicle statequantity detecting unit10 and the travel path curvature previously estimated by the travel path curvature estimatingsection32.
• The multiple curvature estimationresult calculating unit32bperforms calculation based on a plurality of estimation results of travel path curvature estimated by the travel path curvature estimatingsection32, such that the curvature changes smoothly.
• The weight adjustment is performed, for example, from the following perspectives.
• (1) When judged that the travel target coordinates are almost straight based on the history of travel path curvature estimations and the vehicle is judged to be traveling in a straight line, the weights of coordinates far from the own vehicle are increased to improve the accuracy of curvature estimation (seeFIG. 2A).
• (2) When the travel target coordinates change from straight to curved based on the history of travel path curvature estimations and the road on which the vehicle is traveling is judged to be changing from a straight road to a curve, the weights for calculating the coordinates near the own vehicle are increased such that the own vehicle does not erroneously recognize a curve on a straight road and steer based on this recognition (seeFIG. 2B).
• (3) When the vehicle speed of the own vehicle is high (higher than a predetermined value), the weights of the coordinates far from the own vehicle are increased (seeFIG. 2C).
• (4) When the vehicle speed is low (less than the predetermined value), the weights of the coordinates near the own vehicle are increased (seeFIG. 2D).
• In the instances (1) to (4), described above, the weights of the coordinates near the border of the target travel coordinate group are smoothly deviated such that, when the target travel coordinate is added to or deleted from the target travel coordinate group, the weight of the added or deleted target travel coordinate becomes zero. In addition, the travel path curvature is estimated by an approximated curve formed into an arc-like shape that is determined by using the least-squares method, based on the target travel coordinate group (see an approximated curve expressed by f(x) determined by using the least-squares method in the X-Y coordinate system shown inFIG. 4A).
• InFIG. 4A, an approximated curve is determined by using the least-squares method, based on n target travel coordinates (x₁, y₁), (x², y₂), . . . (x_i, y_i), . . . , (x_n, y_n) of the target travel coordinate group (n is a natural number) in the X-Y coordinate system. In this case, a residual sum of squares (RSS) is expressed by:
• $\mathrm{RSS}=\sum _{i=1}^n{\left\{y_i-f\left(x\right)\right\}}^2$
• As the approximated curve, f(x) of which the RSS is smallest is obtained. Based on this approximated curve, the travel path curvature is estimated. This estimation is performed based on conditions, such as the following (1) to (3),
• (1) The center of the arc of the approximated curve is set on a normal line of the travel vector of the own vehicle (see an approximatedcurve1 inFIG. 3A). In FIG.3A, the approximatedcurve1 in the X-Y coordinate system is expressed by:
• 
  x²+(y−y₀)²=R²
• where R is a curvature radius of the arc of the approximated curve, and (0, y₀) is the X-Y coordinate of the center. In this example, an estimated curvature (hereinafter referred to as “estimatedcurvature1”) is obtained by an inverse of curvature radius R (i.e., 1/R).
• (2) The center of the arc is set on the normal line of the travel vector of the own vehicle. In addition, the arc is set on the center of gravity of the own vehicle or the center of the rear tires of the own vehicle (see an approximatedcurve2 inFIG. 3B). InFIG. 3B, the approximatedcurve2 in the X-Y coordinate system is expressed by:
• 
  x²+(y−R)²=R²
• where R is a curvature radius of the arc of the approximated curve, and (0, R) is the X-Y coordinate of the center. In this example, an estimated curvature (hereinafter referred to as “estimatedcurvature2”) is obtained by an inverse of curvature radius R (i.e., 1/R).
• (3) The center of the arc is set at an arbitrary point (see an approximatedcurve3 inFIG. 3C). InFIG. 3C, the approximatedcurve1 in the X-Y coordinate system is expressed by:
• 
  (x−x₀)²+(y−y₀)²=R²
• where R is a curvature radius of the arc of the approximated curve, and (x₀, y₀) is the X-Y coordinate of the center. In this example, an estimated curvature (hereinafter referred to as “estimatedcurvature3”) is obtained by an inverse of curvature radius R (i.e., 1/R).
• Furthermore, an average value or a minimum value is calculated from the above-described three travel path curvatures (the estimatedcurvature1, the estimatedcurvature2, and the estimatedcurvature3 inFIG. 3A toFIG. 3C), thereby determining the final travel path curvature (seeFIG. 4B).
• At subsequent step S150, the calculatingunit30 calculates a target steering quantity from the difference between the curvature estimation result and the target travel coordinates, and the own vehicle position. Here, the steering feed-forward calculating means33 calculates the steering quantity to be steered in advance by the own vehicle based on the travel path curvature estimated by the travel path curvature estimatingsection32.
• At subsequent step S160, thesteering control unit40 performs steering control such that the own vehicle travels such as to follow the travel path curvature estimated by the calculatingunit30, based on the steering quantity calculated by the calculatingunit30.
• The travel assisting process is then completed.
• In this way, thetravel assisting device1 according to the present embodiment is capable of improving the accuracy of the travel path curvature estimation. Thetravel assisting device1 also actualizes steering control that can track the traveling state of the own vehicle and changes in the shape of the road. Reliability of steering control can be enhanced.
• According to the present embodiment, the vehicle state quantity detecting unit is equivalent to a travel state quantity detecting means. Theperiphery monitoring unit20 is equivalent to a periphery monitoring means. The target travel coordinaterecording section31 of the calculatingunit30 is equivalent to a target travel coordinate recording means. The travel path curvature estimatingsection32 of the calculatingunit30 is equivalent to a travel path curvature estimating means. The steering feed-forward calculating means33 of the calculatingunit30 is equivalent to a steering feed-forward calculating means. The curvature estimationcalculation adjusting section32aof the calculatingunit30 is equivalent to a curvature estimation calculation adjusting means. The multiple curvature estimationresult calculating unit32bof the calculatingunit30 is equivalent to a multiple curvature estimation result calculating means. Thesteering control unit40 is equivalent to a steering control means.

Claims (17)

What is claimed is:

1. A vehicle travel assisting device, comprising:

travel state quantity detecting means for detecting, at a predetermined interval, a vehicle speed and a yaw rate that are travel state quantities indicating a traveling state of an own vehicle;

periphery monitoring means for detecting, at a predetermined interval, a traveling lane in which the own vehicle is traveling and a position of a leading vehicle present ahead of the own vehicle;

target travel coordinate recording means for calculating, at a predetermined interval, target travel coordinates that are target coordinates through which the own vehicle should travel, based on the traveling lane and the position of the leading vehicle detected by the periphery monitoring means, and recording the calculated target travel coordinates;

travel path curvature estimating means for estimating, at a predetermined interval, a travel path curvature that is a curvature of a target travel coordinate group, based on information related to the target travel coordinate group recorded by the target travel coordinate recording means;

steering feed-forward calculating means for calculating a steering quantity to be steered in advance by the own vehicle, based on the travel path curvature currently estimated by the travel path curvature estimating means; and

steering control means for performing steering control such that the own vehicle travels such as to follow the travel path curvature estimated by the travel path curvature estimating means, based on the steering quantity calculated by the steering feed-forward calculating means,

wherein the travel path curvature estimating means includes curvature estimation calculation adjusting means for adjusting a weight for each of the target travel coordinates used to estimate the travel path curvature, based on the vehicle speed and the yaw rate detected by the travel state quantity detecting means and the previously estimated travel path curvature.

2. The vehicle travel assisting device according toclaim 1, wherein

the travel path curvature estimating means estimates the travel path curvature by an approximated curve formed into an arc-like shape which is determined using a least-squares method, based on the target travel coordinate group.

3. The vehicle travel assisting device according toclaim 2, wherein

the travel path curvature estimating means determines the approximated curve such that a center of the arc is set on a normal line of a travel vector of the own vehicle.

4. The vehicle travel assisting device according toclaim 2, wherein

the travel path curvature estimating means determines the approximated curve such that: (i) a center of the arc is set on a normal line of a travel vector of the own vehicle; and (ii) the arc is set on a center of gravity of the own vehicle or a center of rear tires of the own vehicle.

5. The vehicle travel assisting device according toclaim 2, wherein

the travel path curvature estimating means determines the approximated curve such that a center of the arc is set at any point.

6. The vehicle travel assisting device according toclaim 1, wherein

the travel path curvature estimating means includes multiple curvature estimation result calculating means for performing calculation based on a plurality of estimation results of the travel path curvature such that the curvature changes smoothly.

7. The vehicle travel assisting device according toclaim 1, wherein

the curvature estimation calculation adjusting means adjusts the weight of each of the target travel coordinates by smoothly deviating the weight near a border of the target travel coordinate group such that the weight becomes zero when each of the target travel coordinates is added to or deleted from the target travel coordinate group.

8. The vehicle travel assisting device according toclaim 2, wherein

the travel path curvature estimating means includes multiple curvature estimation result calculating means for performing calculation based on a plurality of estimation results of the travel path curvature such that the curvature changes smoothly.

9. The vehicle travel assisting device according toclaim 2, wherein

the curvature estimation calculation adjusting means adjusts the weight of each of the target travel coordinates by smoothly deviating the weight near a border of the target travel coordinate group such that the weight becomes zero when each of the target travel coordinates is added to or deleted from the target travel coordinate group.

10. The vehicle travel assisting device according toclaim 3, wherein

the travel path curvature estimating means includes multiple curvature estimation result calculating means for performing calculation based on a plurality of estimation results of the travel path curvature such that the curvature changes smoothly.

11. The vehicle travel assisting device according toclaim 3, wherein

the curvature estimation calculation adjusting means adjusts the weight of each of the target travel coordinates by smoothly deviating the weight near a border of the target travel coordinate group such that the weight becomes zero when each of the target travel coordinates is added to or deleted from the target travel coordinate group.

12. The vehicle travel assisting device according toclaim 4, wherein

the travel path curvature estimating means includes multiple curvature estimation result calculating means for performing calculation based on a plurality of estimation results of the travel path curvature such that the curvature changes smoothly.

13. The vehicle travel assisting device according toclaim 4, wherein

the curvature estimation calculation adjusting means adjusts the weight of each of the target travel coordinates by smoothly deviating the weight near a border of the target travel coordinate group such that the weight becomes zero when each of the target travel coordinates is added to or deleted from the target travel coordinate group.

14. The vehicle travel assisting device according toclaim 5, wherein

the travel path curvature estimating means includes multiple curvature estimation result calculating means for performing calculation based on a plurality of estimation results of the travel path curvature such that the curvature changes smoothly.

15. The vehicle travel assisting device according toclaim 5. wherein

the curvature estimation calculation adjusting means adjusts the weight of each of the target travel coordinates by smoothly deviating the weight near a border of the target travel coordinate group such that the weight becomes zero when each of the target travel coordinates is added to or deleted from the target travel coordinate group.

16. The vehicle travel assisting device according toclaim 6, wherein

the curvature estimation calculation adjusting means adjusts the weight of each of the target travel coordinates by smoothly deviating the weight near a border of the target travel coordinate group such that the weight becomes zero when each of the target travel coordinates is added to or deleted from the target travel coordinate group.

17. A vehicle travel assisting method, comprising:

at a vehicle travel assisting device mounted in an own vehicle,

detecting, at a predetermined interval, a vehicle speed and a yaw rate that are travel state quantities indicating a traveling state of the own vehicle;

detecting, at a predetermined interval, a traveling lane in which the own vehicle is traveling and a position of a leading vehicle present ahead of the own vehicle;

calculating, at a predetermined interval, target travel coordinates that are target coordinates on which the own vehicle should travel, based on the detected traveling lane and the detected position of the leading vehicle;

recording the calculated target travel coordinates;

estimating, at a predetermined interval, a travel path curvature that is a curvature of a target travel coordinate group, based on information related to the recorded target travel coordinate group;

adjusting a weight for each of the target travel coordinates used to estimate the travel path curvature, based on the detected vehicle speed and the detected yaw rate and the previously estimated travel path curvature;

calculating a steering quantity to be steered in advance by the own vehicle, based on the estimated travel path curvature currently; and

performing steering control such that the own vehicle travels such as to follow the estimated travel path curvature, based on the calculated steering quantity.

Images