The present invention relates to a driving assistance device and a driving assistance method for a vehicle.
In recent years, development of a driving assistance device and a driving assistance method for a vehicle using a map has been actively promoted, and PTL 1 is known as an example of such an attempt.
In PTL 1, for the purpose of preventing unnecessary determination that autonomous traveling control is not allowed in front of a point where estimation accuracy is required when allowability of autonomous traveling control is determined according to estimation accuracy of self-position estimation required at the point ahead on a scheduled travel route, “there is provided a driving assistance method of setting a scheduled travel route of own vehicle, estimating a self-position that is a current position of the own vehicle, and controlling a driving behavior of own vehicle to assist traveling along the traveling plan route based on the scheduled travel route and the self-position. In this driving assistance method, by estimating an estimation error of the self-position, and setting an allowable error of the self position corresponding to the driving behavior of the own vehicle scheduled at a point ahead of the self-position, on a scheduled travel route and ahead of the self-position, the allowable error of the self position being larger as the point is farther from the self position if the driving behavior of the own vehicle is the same, allowability of control of driving behavior of own vehicle is determined according to whether or not the estimation error of the self-position is within the allowable error”.
According to PTL 1, when allowability of autonomous traveling control is determined according to the allowable error of the self-position required at the point ahead of the self-position on the scheduled travel route, it is possible to suppress unnecessary determination that autonomous traveling control is not allowed in front of the point.
However, according to PTL 1, in a case in which accuracy of a map is low, driving assistance and automatic driving may not be continued at an inappropriate timing. As a typical example, a case is assumed in which, regarding a position of a target feature in a right forward direction, particularly when a vehicle turns right during the left-side driving based on a scheduled travel route determined in advance and on the self-position, it is found that, at the time of right turning, the position of the target feature actually measured is closer to the own position than an expected position is on the scheduled travel route.
In such a state, there is a possibility that continuation of automatic driving becomes impossible as the vehicle needs to move backward, but backward movement in an intersection may cause a safety problem. Although there is a case where driving can be continued by emergent correction of the scheduled travel route, passengers may feel uncomfortable because ride quality decreases.
From the above, an object of the present invention is to provide a driving assistance device and a driving assistance method that are capable of determining, at an appropriate timing, suspension of driving assistance and automatic driving due to a feature error of a map.
From the above, the present invention provides “a driving assistance device including: a determination point setting unit that sets a determination point in which an assumed self-position of own vehicle that is assumed on a map, a position of a measurement target feature on the map, and an error predicted as a difference between the position on the map and an actual position of the measurement target feature are associated with each other, the measurement target feature being measurable from the assumed self-position; a target feature measurement unit that obtains a measurement position of the measurement target feature based on external information acquired by an external sensor mounted on the own vehicle; a self-position estimation unit that estimates a self-position of the own vehicle on the map based on the external information; and a driving assistance state setting unit that sets a control mode of a driving assistance system of the own vehicle based on the determination point, the measurement position of the measurement target feature measured by the target feature measurement unit, and the self-position of the own vehicle estimated by the self-position estimation unit”.
The present invention further provides “a driving assistance method, by a computing machine, for generating a travel track of a vehicle on a map and assisting driving of the vehicle along the travel track, the driving assistance method including: setting, as a determination point, a limit position on the travel track that allows a stable operation at a time of turning right or left according to a given vehicle motion allowable amount on the travel track generated using a feature position on a map, in consideration of a feature error; and determining allowability of driving assistance in accordance with a measured feature position when a measured vehicle position reaches the determination point during actual traveling of the vehicle”.
It is possible to provide a driving assistance device and a driving assistance method that are capable of determining, at an appropriate timing, suspension of driving assistance and automatic driving due to a feature error of a map.
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
Among these, the track creation processing unit 11 stores a vehicle motion allowable amount D1 and map information D2 in a storage unit such as a ROM in advance, and a track generation unit 16 creates a travel track on the map in advance using these pieces of information. In the present invention, a determination point setting unit 15 sets a determination point to be described later in detail on the travel track.
The method of creating the travel track PL in the track generation unit 16 is already a well-known method, and the description of this method is omitted, but to put it simply, as illustrated in
As the map, for example, an SD map widely facilitated in general roads is used. The SD map has a feature error D2b larger than that of the high precision map, and when the track generation unit 16 generates the travel track PL, the travel track PL is set in consideration of the feature error D2b for the feature position D2a in the map information. In addition, a map generated from a measurement result of a sensor mounted on the vehicle 1 (self-generated map) may be used as the map.
In the present invention, the determination point setting unit 15 sets a determination point Dp illustrated in
Before the determination point Dp, it is possible to travel by turning moderately even if the feature error D2b exists, but it is necessary to make a sudden turn if the feature error D2b is found after the determination point Dp. In some cases, in addition to a sudden turn, there is a risk of a contact with a feature in front on the right side (particularly referred to as a measurement target feature). A limit point leading to such an event is the determination point Dp. The determination point Dp is defined as information including a position on the travel track PL and a position of the measurement target feature.
As described above, the track creation processing unit 11 sets the determination point Dp including the position on the map and the position of the measurement target feature from the vehicle motion allowable amount D1 as well as the feature position D2a and the error D2b on the map. It can be said that the determination point Dp defines a limit point at which traveling on the travel track PL is continued in order to give passengers a sense of security or to protect safety.
In the above description, a concept of the processing of the determination point setting unit 15 and the track generation unit 16 has been described. The processing is virtually treated on the map, and the determination point setting unit 15 can be said to “set a determination point in which an assumed self-position of own vehicle that is assumed on a map, a position of a measurement target feature on the map, and an error predicted as a difference between the position on the map and an actual position of the measurement target feature are associated with each other, the measurement target feature being measurable from the assumed self-position”.
Further, to describe the processing of the determination point setting unit 15 in detail, “when the track generation unit is unable to generate the travel track that satisfies a vehicle motion allowable amount of the own vehicle, the determination point setting unit sets a determination point by associating the assumed self-position with the position and the error of the measurement target feature on the map, the assumed self-position being a start point of the travel track, the measurement target feature being measurable from the assumed self-position”.
Further, the track generation unit 16 “generates a travel track of the own vehicle starting from the assumed self-position based on the assumed self-position on the map and on a position and an error of the measurement target feature on the map”.
On the other hand, the track travel confirmation processing unit 12 of
In addition, a driving assistance state setting unit 13 in the track travel confirmation processing unit 12 sets a control mode of driving assistance and automatic driving based on the travel track PL created in advance by the track creation processing unit 11 and current states confirmed by the track travel confirmation processing unit 12 (an external recognition result, a self-position estimation result, and a determination point). The control mode is allowability of continuation of the automatic driving, for example, and it is determined that the continuation of the automatic driving is not possible when the own vehicle passes the position of the determination point Dp and the measurement target feature is not recognized.
In the above, a concept of the processing of the track travel confirmation processing unit 12 has been described. The track travel confirmation processing unit 12 can be said to “set a control mode of a driving assistance system of the own vehicle based on the determination point, the measurement position of the measurement target feature measured by the target feature measurement unit, and the self-position of the own vehicle estimated by the self-position estimation unit”.
This loop is a large loop, including a middle loop which is a loop process of repeatedly executing processing on a direction of a map error, and the direction of the map error is sequentially called and the processing steps S2 to S9 are sequentially executed.
The middle loop further includes a small loop which is a loop process of repeatedly executing processing on sampling points, and the sampling points are sequentially called to sequentially execute the processing steps S4 to S8.
Thus, in the flowchart of
In the processing step S3, the feature position and the target position are calculated based on the directions of the feature and the map error under extracted conditions. For example,
In the processing step S4, the processing is performed to a sampling point SP set on the travel track PL of
In the processing step S6, it is determined that the track of the vehicle up to the target position Po (or the modified target position Pn) can be calculated based on the turning radius set as the vehicle motion allowable amount D1, and when the track can be calculated, the process returns from the processing step S8 to the processing step S4, and similar processing and determination are repeated for a subsequent sampling point SP2.
As a result, it is assumed that track calculation is successful up to a sampling point SP5, but the track calculation cannot be performed at a sampling point SP6. In this case, in the processing step S7, the sampling point SP6 at which the track cannot be calculated is recognized as the determination point Dp, and the determination point Dp at this time is recorded as information including the position on the travel track PL and the position of the measurement target feature D2a. Note that the sampling point SP5 before the sampling point SP6 at which the track cannot be calculated may be identified as the determination point Dp.
The above-described repetitive processing in
According to the above processing, it is determined that the vehicle can calculate the track to the target position Po (or the modified target position Pn) at the final sampling point SP5 before the determination point Dp (sampling point SP6), and the track cannot be calculated at the determination point Dp. Regarding the treating of the travel track PL at this time, the following two ways are conceivable, but the present invention may adopt either of these.
One method keeps the information on the determination point Dp assigned to the travel track PL, and the other method assigns the information on the determination point Dp as a new travel track PL created at the corrected target position Pn.
Returning to
In
As a countermeasure, the determination point setting unit 15 sets, in addition to the determination point Dp as the limit point, a determination point for notification or preparation on the travel track PL at a position before the determination point Dp as the limit point.
Among these, assuming that a determination point at which the preparation for manual driving by the driver is completed and thus handover from the automatic driving to driving by the driver is performed is set as a handover point Pc for handover from the automatic driving to driving by the driver, it is conceivable that the determination point is set to Pc1 or Pc2 before the determination point Dp. Since a handover point Pc1 is a position at which a steering angle of a steering wheel becomes 0 degrees and at which the vehicle may have already entered the intersection, a position before the road structure before an entrance of the intersection changes is set as a handover point Pc2.
In setting of the handover point Pc by the determination point setting unit 15, it is preferable that the position of the handover point Pc is set to a position before the determination point Dp based on at least one of the steering angle of the own vehicle at the assumed self-position, the switching of the road region on the map, and reaction time of the driver.
In addition, regarding the determination point (hereinafter, notification point) for guide and notification for the driver, since the handover point Pc assumes a position when the driver becomes prepared for driving, it is preferable to set the timing of the notification point for guiding the driver to switch the driving from the driving assistance device to the driver at T seconds before the determination point (handover point Pc) and to switch the driving to the driver's driving at the handover point Pc, or to notify the driver of possibility of switching of driving before T and extra seconds.
According to the correspondence in
In this case, it is preferable that the control mode in a section between the determination points Dp1 and Dp2 is a control mode in which driving is performed so as to reduce the speed in preparation for turning with a small turning radius R, and the control mode in a section after the determination point Dp1 is a control mode in which handover of the driving to the driver is performed.
Therefore, it is preferable that the information on the determination point Dp is defined as information including, in addition to the position on the travel track PL and the position of the measurement target feature, the control mode in the section between the determination points Dp1 and Dp2.
When the determination points Dp1 and Dp2 of the plurality of levels are calculated, a plurality of combinations of the vehicle motion allowable amount and the speed upper limit may be prepared. For example, it is possible to calculate the determination points of a plurality of levels by changing at least one of the determination condition for successful track calculation and the vehicle motion allowable amount D1 so that the determination point Dp when the vehicle enters the intersection at a relatively high speed and the determination point Dp when the vehicle enters the intersection at a relatively low speed take different positions, and thus it is possible to set the control mode according to the level of the determination point. As a result, an effect that the control mode can be appropriately set is provided.
Here, there is a case where the determination point setting unit 15 allows only forward movement and does not allow backward movement as the vehicle motion allowable amount D1, and in this case, it is preferable to set the determination point Dp at which driving assistance is uncontinuable and handover to driving by the driver is performed with the possibility of the backward movement.
In addition, when the turning radius of the own vehicle is used as the vehicle motion allowable amount D1, it is possible to treat as a variable value in which the upper speed limit of the driving assistance system is set to be smaller as the turning radius is smaller.
In the embodiment 1, the travel track PL is created for the feature. On the other hand, in an embodiment 2, the determination is made in consideration of road conditions other than the feature.
In this case, processing steps S20 and S21 are repeated, but internal processing thereof is the same as that in
As an obstacle to be temporarily set, for example, a vehicle 1X that is parked at regular intervals along a road boundary is assumed, and it is preferable to set the travel track PL and the determination point Dp assuming a situation particularly where a bus is stopped at a bus stop.
At this time, the driving assistance continuation determination unit 13 determines that continuation of the automatic driving is not possible when the own vehicle passes the position of the determination point Dp and it is unclear that there is no obstacle at the temporary obstacle position. This is realized, for example, when the driving assistance state setting unit fails to recognize that there is no assumed obstacle corresponding to the assumed self position after the self-position matches the assumed self-position, the driving assistance state setting unit determines that automatic driving of the own vehicle by the driving assistance system is uncontinuable.
In the embodiment 1, the feature error D2b is treated as the information included in the map (the SD map or the self-generated map), but this may be further treated as an error based on actual measurement.
Then, in an embodiment 3 of the present invention, a map error as the past measurement result is treated as a map error at a future point. Specifically, the map error is used to set the travel track PL and the determination point Dp at the intersection where the turning to the right is scheduled from now. In this case, which one or both of the map error obtained from the map and the map error obtained from the measurement result should be used can be appropriately determined and applied.
In this process, the determination point setting unit 15 sets the magnitude of the error of another measurement target feature existing around the own vehicle by using the measurement position of the measurement target feature measured by the target feature measurement unit 18 and comparing the measurement position with the position of the measurement target feature on the map.
In the above embodiments, in configuring the driving assistance device 10 using the computing machine, the calculation load is not considered. Therefore, in an embodiment 4, a method for reducing the calculation load will be described.
An upper part of
As described above, the calculation load can be reduced by performing recognition processing focusing on the measurement target feature when the position of the determination point Dp comes closer. Alternatively, there is an effect that, by taking time for the recognition processing of the measurement target feature, the recognition of the measurement target feature is facilitated, and suspension of driving assistance and automatic driving is reduced.
In this case, preferably, the target feature measurement unit 18 performs external recognition process based on the position of the measurement target feature by using the determination point when the target feature measurement unit 18 approaches the position of the determination point.
In an embodiment 5, a countermeasure is taken against a problem of occlusion in which a rear object that is to be originally measured is hidden by a front object.
As described above, the driving assistance state setting unit recognizes occlusion by a moving object as a reason that recognition of the measurement target feature fails, and the track planning unit 14 plans the speed of the own vehicle based on the distance to the position of the determination point Dp and the speed of the moving object, the speed being planned such that the occlusion by the moving object is resolved before the own vehicle reaches the position of the determination point Dp.
As a result, the occlusion is eliminated at the determination point Dp, and the measurement target feature D2a becomes measurable. According to the embodiment 5, there is an effect that the suspension of driving assistance and automatic driving is reduced.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2021/044095 | 12/1/2021 | WO |