Vehicle deceleration control system
11634132 · 2023-04-25
Assignee
Inventors
Cpc classification
B60W30/16
PERFORMING OPERATIONS; TRANSPORTING
B60W2554/804
PERFORMING OPERATIONS; TRANSPORTING
B60W50/085
PERFORMING OPERATIONS; TRANSPORTING
B60W30/18163
PERFORMING OPERATIONS; TRANSPORTING
B60W30/09
PERFORMING OPERATIONS; TRANSPORTING
B60W30/08
PERFORMING OPERATIONS; TRANSPORTING
International classification
B60W30/09
PERFORMING OPERATIONS; TRANSPORTING
B60W30/08
PERFORMING OPERATIONS; TRANSPORTING
Abstract
In deceleration set processing, first-class and second-class deceleration are specified. The first-class deceleration is deceleration of the vehicle corresponding to a first-class state. The first-class state is a state of a slowdown target of the vehicle. The second-class deceleration is deceleration of a following moving body corresponding to a second-class state. The second-class state is a state of the vehicle as viewed from the following moving body. If a minimum value of the first-class deceleration (a first-class minimum value) is equal to or greater than a minimum value of the second-class deceleration (a second-class minimum value), target deceleration is set to the first-class minimum value. Otherwise, based on a second-class minimum value phase, the target deceleration is set to deceleration equal to or greater than the second-class minimum value. The second-class minimum value phase is a phase to which the second-class minimum value belongs in a second deceleration feature.
Claims
1. A vehicle control system in which automated driving control of a vehicle is executed, the vehicle control system comprising: an acquiring device which is configured to acquire driving environment information of the vehicle; and a controller which is configured to execute the automated driving control based on the driving environment information, wherein, in the automated driving control, the controller is configured to execute deceleration setting processing in which a target deceleration is set based on first and second deceleration features, wherein: the first deceleration feature defines a relationship between a first-class state indicating a state of a slowdown target of the vehicle and deceleration of the vehicle, wherein the first-class state is divided into multiple phases by a first-class boundary; and the second deceleration feature defines a relationship between a second-class state indicating a state of the vehicle as viewed from a following moving body and deceleration of the following moving body, wherein the second-class state is divided into multiple phases by a second-class boundary, wherein, in the deceleration set processing, the controller is configured to: specify, based on the driving environment information and the first deceleration feature, at least one first-class deceleration indicating deceleration of the vehicle corresponding to the first-class state; specify a first-class minimum value indicating a minimum value of the at least one first-class deceleration; specify, based on the driving environment information and the second deceleration feature, at least one second-class deceleration indicating deceleration of the following moving body corresponding to the second-class state; specify a second-class minimum value indicating a minimum value of the at least one second-class deceleration; compare the first-class minimum value and the second-class minimum value; if the first-class minimum value is equal to or greater than the second-class minimum value, set the target deceleration to the first-class minimum value; and if the first-class minimum value is less than the second-class minimum value, set the target deceleration to deceleration equal to or more than the second-class minimum value, based on a second-class minimum value phase indicating a phase to which the second-class minimum value belongs in the second deceleration feature wherein, in the deceleration set processing, the controller is configured to: if the first-class minimum value is less than the second-class minimum value and the second-class minimum value is located closer to a rapid deceleration side than the second-class boundary deceleration, set the target deceleration to the second-class minimum; and if the first-class minimum value is less than the second-class minimum value and the second-class minimum value is located closer to a slow deceleration side than the second-class boundary deceleration, set the target deceleration to deceleration greater than the second-class minimum.
2. The vehicle control system according to claim 1, wherein: the automated driving control includes lane change control in which a cruising lane of the vehicle is changed from a first lane to a second lane; and the driving environment information includes information on a plurality of objects on the second lane, wherein, in the deceleration set processing which is executed during the execution of the lane change control, the controller is configured to: set a potential position of the vehicle between the plurality of objects adjacent to each other; specify the first-class minimum value by applying the first deceleration feature to a future slowdown target, existing in front of the potential position, among the vehicle of the plurality of objects adjacent to each other; and specify the second-class minimum value by applying the second deceleration feature to a future following moving body, existing behind the potential position, among the plurality of objects adjacent to each other.
3. The vehicle control system according to claim 2, wherein, in the deceleration set processing, the controller is further configured to: set a search area of the potential position; if a plurality of the potential positions are set in the search area, calculate a candidate of the target deceleration for each of the plurality of potential positions; and set the candidate of the target deceleration that minimizes a difference from current acceleration or deceleration of the vehicle as the target deceleration.
4. A vehicle control system in which automated driving control of a vehicle is executed, the vehicle control system comprising: an acquiring device which is configured to acquire driving environment information of the vehicle; and a controller which is configured to execute the automated driving control based on the driving environment information, wherein, in the automated driving control, the controller is configured to execute deceleration setting processing in which a target deceleration is set based on first and second deceleration features, wherein: the first deceleration feature defines a relationship between a first-class state indicating a state of a slowdown target of the vehicle and deceleration of the vehicle, wherein the first-class state is divided into multiple phases by a first-class boundary; and the second deceleration feature defines a relationship between a second-class state indicating a state of the vehicle as viewed from a following moving body and deceleration of the following moving body, wherein the second-class state is divided into multiple phases by a second-class boundary, wherein, in the deceleration set processing, the controller is configured to: specify, based on the driving environment information and the deceleration feature, at least one first-class deceleration indicating deceleration of the vehicle that corresponds to the first-class state; calculate for each of the at least one first-class deceleration a first-class plausibility indicating an accuracy of information on the first-class state or the accuracy of information associated with the first-class state; specify a first-class minimum value of the at least one first-class deceleration; specify, based on the driving environment information and the second deceleration feature, at least one second-class deceleration indicating deceleration of the following moving body corresponding to the second-class state; calculate, for each second-class deceleration, a second-class plausibility indicating an accuracy of information on the second-class state; specify a second-class minimum value of the at least one second-class deceleration; compare the first-class minimum value and the second-class minimum value; if the first-class minimum value is equal to or greater than the second-class minimum value, the first-class minimum value is reflected in a first-class reflection degree of 0 to 100%, based on a first-class minimum value phase indicating a phase to which the first-class minimum value belongs in the second deceleration feature and the first-class plausibility corresponding to the first-class minimum value; and if the first-class minimum value is less than the second-class minimum value, the second-class minimum value is reflected in a second-class reflection degree of 0 to 100%, based on a second-class minimum value phase indicating a phase to which the second-class minimum value belongs in the second deceleration feature and the second-class plausibility corresponding to the second-class minimum value.
5. The vehicle control system according to claim 4, wherein: the first-class boundary includes a first-class maximum deceleration, wherein the first-class maximum deceleration indicates a maximum deceleration of the vehicle; and the controller is configured to, in the deceleration set processing: set the first reflection degree to 100%, if the first-class minimum value is equal to or greater than the second-class minimum value and the first-class minimum value phase is located closer to a rapid deceleration side than the first-class maximum deceleration, regardless of the first-class plausibility corresponding to the first-class minimum value.
6. The vehicle control system according to claim 4, wherein: the first-class boundary deceleration includes a first-class minimum deceleration, wherein the first-class minimum deceleration indicates minimum deceleration of the vehicle; and the controller is configured to, in the deceleration set processing: set the first reflection degree to 0%, if the first-class minimum value is equal to or greater than the second-class minimum value and the first-class minimum value phase is located closer to a slow deceleration side than the first-class minimum deceleration, regardless of the first-class plausibility corresponding to the first-class minimum value.
7. The vehicle control system according to claim 4, wherein: the first-class boundary deceleration includes a first-class maximum deceleration, a first-class minimum deceleration, and a first-class middle deceleration, wherein the first-class maximum deceleration indicates a maximum deceleration of the vehicle, wherein the first-class minimum deceleration indicates minimum deceleration of the vehicle, and wherein the first-class middle deceleration is between the first-class maximum deceleration and the first-class minimum deceleration; and the controller is configured to, in the deceleration set processing: if the first-class minimum value is equal to or greater than the second-class minimum value and the first-class minimum value phase is located between the first-class maximum deceleration and the first-class middle deceleration, change the first reflection degree according to specified total number of the first-class deceleration, wherein the first reflection degree is set to: 100% if the specified total number is one, and a value between 0 and 100% depending on the first-class plausibility corresponding to the first-class minimum value if the specified total number is two or more.
8. The vehicle control system according to claim 4, wherein: the first-class boundary deceleration includes a first-class maximum deceleration, a first-class minimum deceleration, and a first-class middle deceleration, wherein the first-class maximum deceleration indicates a maximum deceleration of the vehicle, wherein the first-class minimum deceleration indicates minimum deceleration of the vehicle, and wherein the first-class middle deceleration is between the first-class maximum deceleration and the first-class minimum deceleration; and the controller is configured to, in the deceleration set processing: if the first-class minimum value is equal to or greater than the second-class minimum value and the first-class minimum value phase is located between the first-class middle deceleration and the first-class minimum deceleration, change the first reflection degree according to a result of comparing the minimum value plausibility corresponding to the first-class minimum value with a first-class threshold, wherein the first reflection degree is set to: 100% if the first-class plausibility corresponding to first-class minimum value is more than the first-class threshold, and 0% if the first-class plausibility corresponding to first-class minimum value is less than the first-class threshold.
9. The vehicle control system according to claim 4, wherein: the second-class boundary includes a second-class maximum deceleration, wherein the second-class maximum deceleration indicates a maximum deceleration of the following moving body; and the controller is configured to, in the deceleration set processing: if the first-class minimum value is less than the second-class minimum value and the second-class minimum value phase is located in a rapid deceleration side than the second-class maximum deceleration, set the second reflection degree to 100%, regardless of the second-class plausibility corresponding to the second-class minimum value.
10. The vehicle control system according to claim 4, wherein: the second-class boundary includes a second-class minimum deceleration, wherein the second-class minimum deceleration indicates a minimum deceleration of the following moving body; and the controller is configured to, in the deceleration set processing: if the first-class minimum value is less than the second-class minimum value and the second-class minimum value phase is located in a slow deceleration side than the second-class minimum deceleration, set the second reflection to 0%, regardless of the second-class plausibility corresponding to the second-class minimum value.
11. The vehicle control system according to claim 4, wherein: the second-class boundary deceleration includes a second-class maximum deceleration, a second-class minimum deceleration, and a second-class middle deceleration, wherein the second-class maximum deceleration indicates a maximum deceleration of the following moving body, wherein the second-class minimum deceleration indicates a minimum deceleration of the following moving body, and wherein the second-class middle deceleration is between the second-class maximum deceleration and the second-class minimum deceleration; and the controller is configured to, in the deceleration set processing: if the first-class minimum value is less than the second-class minimum value and the second-class minimum value phase is located between the second-class maximum deceleration and the second-class middle deceleration, change the second reflection degree according to specified total number of the second-class deceleration, wherein the second reflection degree is set to: 100% if the specified total number is one, and a value between 0 and 100% according to the second-class plausibility corresponding to the second-class minimum value 0% if the specified total number is two or more.
12. The vehicle control system according to claim 4, wherein: the second-class boundary deceleration includes a second-class maximum deceleration, a second-class minimum deceleration, and a second-class middle deceleration, wherein the second-class maximum deceleration indicates a maximum deceleration of the following moving body, wherein the second-class minimum deceleration indicates a minimum deceleration of the following moving body, and wherein the second-class middle deceleration is between the second-class maximum deceleration and the second-class minimum deceleration; and the controller is configured to, in the deceleration set processing: if the first-class minimum value is less than the second-class minimum value and the second-class minimum value phase is located between the second-class middle deceleration and the second-class minimum deceleration, change the second reflection degree according to a result of comparing the second-class plausibility corresponding to the second-class minimum value with a second-class threshold, wherein the second reflection degree is set to: 100% if the second-class plausibility corresponding to the second-class minimum value is equal to or more than the second-class threshold, and 0% if the second-class plausibility corresponding to second-class minimum value is less than the second-class threshold.
13. The vehicle control system according to claim 4, wherein: the slowdown target is a nearest moving or static obstacle of the vehicle on a driving trajectory of the vehicle; the following moving body is a moving body present behind the vehicle; the driving environment information includes a first-class distance indicating a distance from the moving or static obstacle to the vehicle, a second-class distance indicating a distance from the following moving body to the vehicle, first-class relative speed indicating relative speed of the moving or static obstacle, and second-class relative speed indicating relative speed of the following moving body; the first-class state is the first-class distance and the first-class relative speed; the second-class state is the second-class distance and the second-class relative speed; the first-class plausibility is an accuracy of the first-class distance and the first-class relative speed; and the second-class plausibility is an accuracy of the second-class distance and the second-class relative speed.
14. The vehicle control system according to claim 4, wherein: the slowdown target is a nearest traffic signal of the vehicle on a driving trajectory of the vehicle; the following moving body is a moving body present behind the vehicle; the driving environment information includes a first-class distance indicating a distance from the traffic light to the vehicle, a second-class distance indicating a distance from the following moving body to the vehicle, first-class relative speed indicating relative speed of the traffic light, and second-class relative speed indicating relative speed of the following moving body; the first-class state is the first-class distance and the first-class relative speed; the second-class state is the second-class distance and the second-class relative speed; the first-class plausibility is an accuracy where lighting color of traffic light is red or yellow, associated with the first-class distance and the first-class relative speed; and the second-class plausibility is an accuracy of the second-class distance and the second-class relative speed.
Description
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
(15)
(16)
(17)
(18)
(19)
(20)
(21)
(22)
(23)
(24)
(25)
(26)
(27)
(28) Embodiments of the present disclosure are described hereunder with reference to the accompanying drawings. However, structures or steps or the like described in conjunction with the following embodiments are not necessarily essential to embodiments of the present disclosure unless expressly stated or theoretically defined.
1. FIRST EMBODIMENT
(29) First, a first embodiment will be described with reference to
(30) 1.1 Assumption
(31)
(32) The vehicle M1 has a plan to run on a driving trajectory TP at driving speed v.sub.M1 according to automated driving control executed by the system. The driving trajectory TP defines a collection of target positions that a reference position of the vehicle M1 should reach. The reference position includes a gravity center of the vehicle M1 and a center of rear wheel shaft.
(33) In front of the vehicle M1 by a distance of d.sub.A, there is a vehicle M2 running at driving speed v.sub.M2. The vehicle M2 is a preceding vehicle which exists on the driving trajectory TP. The vehicle M2 need not be equipped with a system similar to the system installed in the vehicle M1. Relative speed vs of the vehicle M2 for to vehicle M1 is represented by v.sub.M2-v.sub.M1. The vehicle M2 may be a moving body that differs from a vehicle or may be a stationary body. If the vehicle M2 is the stationary body, the relative speed v.sub.A of the stationary body is represented by −v.sub.M1. For convenience of explanation, the distance d.sub.A is also referred to as a “first-distance d.sub.A” and the relative speed v.sub.A is also referred to as “first-class v.sub.A”.
(34) Behind the vehicle M1 by a distance d.sub.B, a vehicle M3 runs at driving speed v.sub.M3. The vehicle M3 corresponds to a “following moving body FMO”. The vehicle M3 need not be equipped with a system similar to the system installed in the vehicle M1. The relative speed v.sub.B of the vehicle M1 to the vehicle M3 is represented by v.sub.M1-v.sub.M3. The vehicle M3 may be a moving body that differs from a vehicle. For convenience of explanation, the distance d.sub.B is also referred to as a “second-class d.sub.B” and the relative speed v.sub.B is also referred to as “second-class v.sub.B”.
(35) 1.1.1 Conceptual of Deceleration Feature
(36) (1) First Deceleration Feature
(37) Under the situation shown in
(38) Consider a situation where the vehicle M1 running at driving speed vim slows down and stops at a position behind the vehicle M2 by a predetermined amount of a first-class distance d.sub.A0. In this case, a process in which the vehicle M1 approaches the vehicle M2 (hereinafter referred to as an “approaching process” in the first embodiment) is represented by three types of quadratic curves depending on deceleration a.sub.M1 of the vehicle M1. A quadratic curve shown in a top of
(39) The quadratic curve shown in a bottom of
(40) The quadratic curve shown in a middle of
(41) Therefore, the fact that when the first-class state is in a phase between the quadratic curve with the first-class minimum deceleration and that with the first-class middle deceleration has the following meaning. That is, it means that when the slowdown of the vehicle M1 between the first-class minimum deceleration and the first-class middle deceleration is performed after the detection of the vehicle M2, the slowdown similar to the one during the manual driving is performed. Thus, this phase is defined as a “pseudo human phase”.
(42) In addition, the fact that the state of the vehicle M2 is in a phase between the quadratic curve with the first deceleration and that with the third deceleration has the following meaning. That is, it means that when the slowdown of the vehicle M1 with the deceleration between the first deceleration and the third deceleration is performed after the detection of the vehicle M2, a characteristic slowdown is performed. Thus, this phase is defined as an “automated driving peculiar phase”.
(43) In summary, when the vehicle M2 as the slowdown target OBJ exists, the first-class is classified into the “collision phase”, the “free phase”, the “pseudo human phase” or the “automated driving peculiar phase”.
(44) When the vehicle M2 is the dynamic obstacle, the relationship between the first-class distance d.sub.A and the first-class relative speed v.sub.A during the slowdown of the vehicle M1 is explained as follows, using the explanation of
(45) (2) Second Deceleration Feature
(46) The first deceleration feature explained in
(47) Suppose that a typical automated drive system is mounted on the vehicle M3. Then, a process in which the vehicle M3 approaches the vehicle M1 are shown in the second deceleration feature with three deceleration lines depending on the deceleration of the vehicle M3 −a.sub.M3 (hereinafter referred to as “second-class deceleration”). These deceleration are referred to as a “second-class maximum deceleration”, a “second-class minimum deceleration” and a “second-class middle deceleration”. If such the automated drive system is not mounted on the vehicle M3, the second-class maximum deceleration is not expressed in the second deceleration feature. In this case, there is no “automated driving peculiar phase” in the second deceleration feature and the “collision phase” and the “pseudo human phase” are separated by the second-class middle deceleration.
(48) 1.1.2 Problems in First Deceleration Feature
(49) As mentioned in the explanation of
(50) The performance limitation described above also is applied to the system of the vehicle M3 systems to detect the vehicle M1. Therefore, the combinations of the second-class distance d.sub.B and the second-class relative speed v.sub.B when the vehicle M1 is not detected by the system of the vehicle M3 at all should be represented in the second deceleration feature. In addition, the combinations when the vehicle M1 is completely detected by the system of the vehicle M3 should also be represented.
(51)
(52) On the other hand, the curve drawn on the left side of
(53) When such the “undetected state phase” and the “complete detected state phase” are defined, an intermediate phase of the two is defined as an “incomplete detected state phase”. When the first-class state is in the “incomplete detected state phase”, the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A) corresponding to this state is greater than the first-class threshold η.sub.A_th0 and less than first-class threshold η.sub.A_th1. In the following explanation, among the coordinate (d.sub.A, v.sub.A) corresponding to the first-class state, the coordinate (d.sub.A, v.sub.A) having the first-class plausibility η.sub.A greater than the first-class threshold η.sub.A_th0 is referred to as a “coordinate (d.sub.A, v.sub.A|η.sub.A)”.
(54) What is problematic here is that the first-class plausibility η.sub.A of coordinate (d.sub.A, v.sub.A|η.sub.A) is not high in the “incomplete detected state phase”. The fact that the first-class plausibility η.sub.A is not high means that the first-class state is uncertain. If the detection of the first-class state is uncertain, it is difficult not only to determine the first-class state, but also to determine the presence of the vehicle M2.
(55) A further concern is that more than one coordinate (d.sub.A, v.sub.A|η.sub.A) is present in the “incomplete detected state phase” at the same time. In the “complete detected state phase”, a single coordinate (d.sub.A, v.sub.A|η.sub.A) with a high plausibility η.sub.A is specified. On the other hand, in the “incomplete detected state phase”, two or more coordinates (d.sub.A, v.sub.A|η.sub.A) having a lower first-class plausibility η.sub.A exist at the same time. Then, it is difficult to determine which of these coordinates (d.sub.A, v.sub.A|η.sub.A) corresponds to a true state.
(56) And the problems in the first deceleration feature also apply to the second deceleration feature. Therefore, in the explanation of
(57) Also, in the explanation of
(58) 1.2 Characteristic of First Embodiment
(59) In view of the problems mentioned above, the first embodiment determines a driving policy of the vehicle M1 when at least one coordinate (d.sub.A, v.sub.A|η.sub.A) and at least one coordinate (d.sub.B, v.sub.B|η.sub.B) are preset. In addition, the first embodiment reflects the determined driving policy to a driving plan. Hereinafter, these characteristics will be described.
(60) 1.2.1. Determination of Driving Policy
(61) The determination of the driving policy is based on the at least one coordinate (d.sub.A, and the at least one coordinate (d.sub.B, v.sub.B|η.sub.B). The reason for expressing the “at least one coordinate (d.sub.A, v.sub.A|η.sub.A)” is that two cases are assumed: the former is that only one coordinate (d.sub.A, v.sub.A|η.sub.A) exists and the latter is that two or more coordinates (d.sub.A, v.sub.A|η.sub.A) exist. The reason for expressing the “at least one coordinate (d.sub.B, v.sub.B|η.sub.B)” is the same as that for expressing the “at least one coordinate (d.sub.A, v.sub.A|η.sub.A)”.
(62) When the coordinate (d.sub.A, v.sub.A|η.sub.A) and the coordinate (d.sub.B, v.sub.B|η.sub.B) exist one by one, the first-class deceleration −a.sub.M1 corresponding to the coordinate (d.sub.A, v.sub.A|η.sub.A) is compared with the second-class deceleration −a.sub.M3 corresponding to the coordinate (d.sub.B, v.sub.B|η.sub.B). A detailed description of the first-class deceleration −a.sub.M1 corresponding to the coordinate (d.sub.A, v.sub.A|η.sub.A) and that of the second-class deceleration −a.sub.M3 corresponding to the coordinate (d.sub.B, v.sub.B|η.sub.B) are given in the following section “1.3.1”.
(63) When two or more coordinates (d.sub.A, v.sub.A|η.sub.A) or two or more coordinates (d.sub.B, v.sub.B|η.sub.B) are present, a minimum value of the deceleration corresponding to the more than one coordinates is specified. For example, consider a case where two or more coordinates (d.sub.A, v.sub.A|η.sub.A) are present. Here, the minimum value of the first-class deceleration −a.sub.M1 corresponding to each of these coordinates (d.sub.A, v.sub.A|η.sub.A) (hereinafter referred to as a “first-class minimum value −a.sub.M1_min”) is specified. The first-class minimum value −a.sub.M1_min is a safest deceleration of the first-class deceleration −a.sub.M1 expected on the first deceleration feature. The first-class minimum value −a.sub.M1_min is compared with the second-class deceleration −a.sub.M3 corresponding to the coordinate (d.sub.B, v.sub.B|η.sub.B).
(64) Here, if there is only one coordinate (d.sub.A, v.sub.A|η.sub.IA), the first-class deceleration −a.sub.M1 corresponding to the coordinate (d.sub.A, v.sub.A|η.sub.A) is considered to be a substantial first-class minimum value −a.sub.M1_min. If there is only one coordinate (d.sub.B, v.sub.B|η.sub.B), the second-class deceleration −a.sub.M3 corresponding to the coordinate (d.sub.B, v.sub.B|η.sub.B) is considered to be a substantial second-class minimum value −a.sub.M3_min. The “second-class minimum value −a.sub.M3_min” is defined as a minimum value of the second-class decelerations −a.sub.M3 corresponding to each of these coordinates (d.sub.B, v.sub.B|η.sub.B) when there are two or more coordinate (d.sub.B, v.sub.B|η.sub.B). The second-class minimum value −a.sub.M3_min is a safest deceleration of the second-class deceleration −a.sub.M3 expected on the second deceleration feature. In the following description, regardless of the total number of the coordinate (d.sub.A, v.sub.A|η.sub.A) or the coordinate (d.sub.B, v.sub.B|η.sub.B), the coordinate (d.sub.A, v.sub.A|η.sub.A) having the first-class minimum value −a.sub.M1_min is referred to as a “coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min)”, and the coordinate (d.sub.B, v.sub.B|η.sub.B) having the second-class minimum value −a.sub.M3_min called a “coordinate (d.sub.B, v.sub.B|η.sub.B|−a.sub.M3_min)”.
(65) The driving policy is determined by comparing the first-class minimum value −a.sub.M1_min and the second-class minimum value −a.sub.M3_min. The magnitude relation of these minimum values is expressed as follows.
−a.sub.M1_min≥−a.sub.M3_min (i)
−a.sub.M1_min<−a.sub.M3_min (ii)
1.2.1.1 In Case of Magnitude Relationship (i)
(66) The driving policy of the relationship (i) is determined to slowdown the vehicle M1 immediately with the first-class minimum value −a.sub.M1_min. The reason for this is that in the case of the magnitude relationship (i), the rear-end collision from the vehicle M3 does not occur during the slowdown of the vehicle M1. Therefore, by performing the slowdown of the vehicle M1 with the first-class minimum value −a.sub.M1_min, the collision of the vehicle M1 with vehicle M2 can be avoided.
(67) 1.2.1.2 In Case of Magnitude Relationship (ii)
(68) The driving policy of the relationship (ii) is determined based on a second-class minimum value phase. The “second-class minimum value phase” is defined in the second deceleration feature as a phase to which the coordinate (d.sub.B, v.sub.B|η.sub.IB|−a.sub.M3_min) belongs. The reason why the second-class minimum value phase is considered is that, in the case of the magnitude relationship (ii), there is a possibility that a rear-end collision from the vehicle M3 occurs during the slowdown of the vehicle M1.
(69) The driving policy of magnitude relationship (ii) will be described with reference to
(70) The phase I is the part on the left side of the second-class threshold η.sub.B_th0 in the “collision phase” and the “automated driving peculiar phase” described in
(71) The phase II is the part on the left side of the second-class threshold η.sub.B_th0 in the “free phase” and the “pseudo human phase” described in
(72) 1.2.2 Reflection of Driving Policy
(73) The reflection of the driving policy is performed in the driving plan. The driving plan is planned for each preset time elapsed while the automated driving control is executed. The driving plan includes a driving trajectory TP. The target positions that constitutes the driving trajectory TP have the information on the driving state (i.e., a target acceleration a.sub.M1_tgt and target steering angle θ.sub.M1_tgt of the vehicle M1). When the driving policy is determined, the information on the driving state is updated according to contents of the driving policy.
(74) Focusing on the first-class minimum value phase, the second-class minimum value phase and the magnitude relationship between the first-class minimum value −a.sub.M1_min and the second-class minimum value −a.sub.M3_min, the driving policies described above are summarized as follows.
(75) (i) In case of −a.sub.M1_min≥−a.sub.M3_min
(76) Perform the slowdown of the vehicle M1 immediately with the first-class minimum value −a.sub.M1_min
(77) (ii) In case of −a.sub.M1_min<−a.sub.M3_min
(78) (ii-a) In case of the second-class minimum value phase is in the phase I
(79) Perform the slowdown of the vehicle M1 immediately with the second-class minimum value −a.sub.M3_min
(80) (ii-b) In case of the second-class minimum value phase is in the phase II
(81) Postpone the start of the slowdown of the vehicle M1 until the first-class minimum value −a.sub.M1_min is equal to or greater than the second-class minimum value −a.sub.M3_min, or Perform the slowdown of the vehicle M1 with the deceleration greater than the second-class minimum value −a.sub.M3_min
(82) According to the driving policy (i), the first-class minimum value −a.sub.M1_min is immediately reflected to the target acceleration a.sub.M1_tgt. According to the driving policy (ii-a), the second-class minimum value −a.sub.M3_min is immediately reflected to the target acceleration a.sub.M1_tgt. According to the driving policy (ii-b), the deceleration greater than the second-class minimum value −a.sub.M3_min is reflected to target acceleration a.sub.M1_tgt, or neither the first-class minimum value −a.sub.M1_min nor the second-class minimum value −a.sub.M3_min is reflected to the target acceleration a.sub.M1_tgt.
(83) 1.2.3 Effect
(84) According to the characteristics of the first embodiment, the driving policy of the vehicle M1 is determined when the presence of the at least one coordinate (d.sub.A, v.sub.A|η.sub.A) and the at least one coordinate (d.sub.B, v.sub.B|η.sub.B) is found. If the driving policy is determined, the first-class minimum value −a.sub.M1_min or the deceleration equal to or greater the second-class minimum value −a.sub.M3_min is reflected to the target acceleration a.sub.M1_tgt. Depending on the content of the driving policy, these minimum value are not reflected to the target acceleration a.sub.M1_tgt. Therefore, even when the first-class state and the second-class state are uncertain, it is possible to set the target acceleration a.sub.M1_tgt flexibly. Therefore, it is possible to execute the automated driving control in which the driving safety and the driving efficiency are compatible with each other.
(85) 1.3 Vehicle Control System
(86) Next, a configuration example of the system in which the automated driving control including the characteristic processing is executed will be described.
(87) 1.3.1 System Configuration Example
(88)
(89) The internal sensor 11 is a device that detects a driving state of the vehicle M1. The internal sensor 11 includes a vehicle speed sensor, an acceleration sensor and a yaw rate sensor. The vehicle speed sensor detects the driving speed v.sub.M1. The acceleration sensor detects acceleration a.sub.M1 of the vehicle M1. The yaw rate sensor detects yaw rate around a vertical axis of a center of gravity of the vehicle M1. The internal sensor 11 transmits the detected data to the ECU 13.
(90) The external sensor 12 is a device that detects condition around the vehicle M1. The external sensor 12 includes a radar sensor and a camera. The radar sensors use radio waves (e.g., millimeter wave) or lights to detect an object around the vehicle M1. The object include the static object and the moving body. The static object includes a guard rail and a building. The moving body includes a walker, a bicycle, a motorcycle, and a vehicle other than the vehicle M1. The camera images situation outside the vehicle M1. The camera is mounted, for example, on a back side of a windshield. The camera may be mounted not only on the back side of the windshield but also on that of a rear glass. The external sensor 12 transmits the detected data to the ECU 13.
(91) The information on the driving state of the vehicle M1 and the information on the situation around the vehicle M1 are included in the driving environment information of the vehicle M1. That is, the internal sensor 11 and the external sensor 12 are included in the “acquiring device to acquire the driving environment information”.
(92) The ECU 13 is a microcomputer that includes a processor, a memory, and an input interface and an output interface. The ECU 13 receives a variety of information via the input interface. The ECU 13 also executes automated driving control processing based on the received information. The ECU 13 includes a configuration to execute the automated driving control processing. Details of this configuration will be described in the following section “1.3.2”.
(93) The deceleration map 14 is a cell map in which the relationship is specified between the first-class deceleration −a.sub.M1 the state of the slowdown target OBJ (i.e., the first-class distance d.sub.A and the first-class relative speed v.sub.A). The deceleration map 14 is stored in a database that is able to communicate with the ECU 13. The database may be formed in a computer of a facility (e.g., a management center) capable of communicating with the vehicle M1. The deceleration map 14 is set, for example, for each velocity range having a predetermined width. Which deceleration map is used is determined based on a velocity range to which the driving speed v.sub.mi belongs.
(94)
(95) The first-class deceleration −a.sub.M1 assigned to each cell (d.sub.Ai, v.sub.Aj) may not be different values from each other. For example, the first-class deceleration −a (d.sub.Ai, v.sub.Aj) assigned to the cell (d.sub.Ai, v.sub.Aj) and that −a (d.sub.Ai+1, v.sub.Aj) assigned to the cell (d.sub.Ai+1, v.sub.Aj) may be the same. The first-class deceleration −a (d.sub.Ai, v.sub.Aj) and that −a (d.sub.Ai+1, v.sub.Aj+1) assigned to the cell (d.sub.Ai+1, v.sub.Aj+1) may be the same. The first-class deceleration −a (d.sub.Ai, v.sub.Aj) and that −a (d.sub.Ai+2, v.sub.Aj+1) assigned to the cell (d.sub.Ai+2, v.sub.Aj+1) may be the same.
(96) In the deceleration map 14, the cells (d.sub.Ai, v.sub.Aj) whose values of the first-class deceleration −a.sub.M1 are equal to the value of the first-class boundary are connected from each other. Then the cells (d.sub.Ai, v.sub.Aj) of the deceleration map 14 are allocated to one of the two regions partitioned by the first-class boundary deceleration.
(97) The deceleration map 15 is the cell map in which the relationship is specified between the second-class deceleration −a.sub.M3 and the state of vehicle M1 as viewed from the vehicle M3 (i.e., the second-class distance d.sub.B and the second-class relative speed v.sub.B). The basic configuration of the deceleration map 15 is the same as that of the deceleration map 14. In the explanation of
(98) 1.3.2 Configuration Example of ECU
(99) As shown in
(100) The calculation portion 131 calculates a first-class request value. The first-class request value is a request value of the first-class deceleration −a.sub.M1. The first-class request value is calculated by referring to the deceleration map 14. The deceleration map 14 is referenced by using the information on the state of the slowdown target OBJ. The first-class request value corresponds to all of the first-class deceleration −a.sub.M1 that correspond to the cell (d.sub.Ai, v.sub.Aj) corresponding to this information. In other words, if there is only one cell (d.sub.Ai, v.sub.Aj) that corresponds to the information, only the first-class deceleration −a (d.sub.Ai, v.sub.Aj) is the first-class request value. If there are two or more cells (d.sub.Ai, v.sub.Aj) that correspond to the information, each of the first-class deceleration −a.sub.M1 corresponding to the cells is the first-class request value. The calculation portion 131 transmits the first-class request value to the comparison portion 132 and decision portion 133.
(101) The calculation portion 131 also calculates a second-class request value. The second-class request value is a request value of the second-class deceleration −a.sub.M3. The second-class request value is calculated by referring to the deceleration map 15. The deceleration map 15 is referenced by using the information on the state of the following moving body FMO. In the explanation of the first-class request value described above, the “cell (d.sub.Ai, v.sub.Aj)” is replaced with the “cell (d.sub.Bi, v.sub.Bj)”, and the “first-class deceleration −a (d.sub.Ai, v.sub.Aj)” is replaced with the “second-class deceleration −a (d.sub.Bi, v.sub.Bj)”. This replacement explains the second-class request value. The calculation portion 131 transmits the second-class request value to the comparison portion 132 and the decision portion 133.
(102) The comparison portion 132 compares the first-class minimum value −a.sub.M1_min with the second-class minimum value −a.sub.M3_min. The comparison portion 132 first specifies the first-class minimum value −a.sub.M1_min based on the first-class request value received from the calculation portion 131. If only one first-class request value exists, the specified request value is the first-class minimum value −a.sub.M1_min. If two or more first-class request values exist, the minimum request value of the first-class deceleration −a.sub.M1 is the first-class minimum value −a.sub.M1_min. The comparison portion 132 also specifies the second-class minimum value −a.sub.M3_min. The method to specify the second-class minimum value −a.sub.M3_min is the same as that to specify the first-class minimum value −a.sub.M1_min. Then, the comparison portion 132 calculates the magnitude relationship between the two specified types of the minimum values. The comparison portion 132 transmits the result of the comparison to the decision portion 133.
(103) The decision portion 133 determines the driving policy. The decision portion 133 first specifies the first-class minimum value −a.sub.M1_min and the second-class minimum value a.sub.M3_min based on the first-class and second-class request values received from the calculation portion 131. The method to specify these two types of minimum values are described in the explanation of the comparison portion 132. The decision portion 133 subsequently specifies the cell in the deceleration map 15 corresponding to the second-class minimum value −a.sub.M3_min (hereinafter referred to as a “second-class minimum value cell”).
(104) The decision portion 133 determines any one of (i) to (iii) below as the driving policy based on the segmented area to which the second-class minimum value cell belongs and the result of the comparison from the comparison portion 132, and transmits the driving policy to the planning portion 135.
(105) (i) Perform the slowdown of the vehicle M1 immediately with the first-class minimum value −a.sub.M1_min
(106) (ii) Perform the slowdown of the vehicle M1 immediately with the second-class minimum value −a.sub.M3_min
(107) (iii) Postpone the start of the slowdown of the vehicle M1 until the first-class minimum value −a.sub.M1_min is equal to or greater than the second-class minimum value −a.sub.M3_min
(108) The above (iii) may be changed as follows.
(109) (iii) Perform slowdown of the vehicle M1 with the deceleration greater than the second-class minimum value −a.sub.M3_min
(110)
(111) In the second case, the second-class deceleration −a (d.sub.Bi−1, v.sub.Bj−1), −a (d.sub.Bi−1, v.sub.Bj), −a (d.sub.Bi, v.sub.Bj−1), −a (d.sub.Bi, v.sub.Bj), −a (d.sub.Bi, v.sub.Bj+1), −a (d.sub.B+1, v.sub.Bj−1), and −a (d.sub.Bi+1, v.sub.B) are included in the second-class request value. Therefore, in the second case, a most rapid deceleration of these request values is the second-class minimum value −a.sub.M3_min. Then, by comparing the second-class minimum value −a.sub.M3_min with the second-class boundary deceleration, the second-class minimum value −a.sub.M3_min is allocated to one of the two segmented areas.
(112) The detection portion 134 detects the object based on the information detected by the external sensor 12. The detection portion 134 extracts the information on the state of the slowdown target OBJ from the information on the detected object. Further, the detection portion 134 extracts the information on the state of the following moving body FOB from the information on the detected object. The detection portion 134 transmits the extracted data to the calculation portion 131.
(113) The planning portion 135 plans the driving plan of the automated driving. The planning of the driving plan is executed by repeatedly setting the driving trajectory TP every time the preset time has elapsed, with the current time as a reference. The method to set the driving trajectory TP is not particularly limited, and a known method can be applied. When receiving the driving policy from the decision portion 132, the planning portion 135 changes the information on the driving state in the target position while referring to the plausibility η from the calculation portion 134 appropriately. The planning portion 135 transmits to the control portion 136 the information on the driving trajectory TP including the information on the driving state.
(114) From the decision portion 133, one of the driving policies (i) to (iii) is transmitted. Depending on the contents of the received driving policy, the planning portion 135 reflects the first-class minimum value −a.sub.M1_min or the second-class minimum value −a.sub.M3_min to the target acceleration a.sub.M1_tgt, or does not reflect these minimum values to the target acceleration a.sub.M1_tgt. Specifically, when the planning portion 135 receives the driving policy (i), it immediately reflects the first-class minimum value −a.sub.M1_min to target acceleration a.sub.M1_tgt. When the planning portion 135 receives the driving policy (ii), it immediately reflects the second-class minimum value −a.sub.M3_min to the target acceleration a.sub.M1_tgt. When the planning portion 135 receives the driving policy (ii), planning portion 135 prohibits the first-class minimum value −a.sub.M1_min or the second-class minimum value −a.sub.M3_min from being reflected to the target acceleration a.sub.M1_tgt.
(115) The control portion 136 determines control amount of the various driving devices based on the information on the driving state such that the vehicle M1 runs on the driving trajectory TP. The driving device is an electronically controlled device and includes a driving force for running output device, a steering device and a brake device.
(116) 1.4 Processing Example Executed by ECU
(117)
(118) Subsequent to the step S11, the ECU 13 determines whether or not the slowdown target OBJ and the following moving body FMO have been detected (step S12). Specifically, the ECU 13 determines whether or not the information on the object detected in the step S11 includes the information on the state of the slowdown target OBJ and that on the state of the following moving body FOB. If the judgement result of the step S12 is negative, the ECU 13 proceeds to the step S16.
(119) If the judgement result of the step S12 is positive, the ECU 13 calculates the requested deceleration (step S13). Specifically, the ECU 13 calculates required deceleration (i.e., the first-class request value) by referring to the deceleration map 14 with the information on the extracted state of the slowdown target OBJ. The ECU 13 also calculates the requested deceleration (i.e., the second-class request value) by referring to the deceleration map 15 with the information on the extractor state of the following moving body FOB.
(120) Subsequent to the step S13, the ECU 13 compares the requested deceleration (step S14). Specifically, the ECU 13 calculates the first-class minimum value −a.sub.M1_min and the second-class minimum value −a.sub.M3_min based on the requested deceleration calculated in the step S13. Subsequently, the ECU 13 compares the calculated two types of minimum values to determine the magnitude relationship between them.
(121) Subsequent to the step S14, the ECU 13 determines the driving policy (step S15). Specifically, the ECU 13 calculates the first-class minimum value −a.sub.M1_min and the second-class minimum value −a.sub.M3_min based on the requested deceleration calculated in the step S13. Subsequently, the ECU 13 specifies the segmented area to which the second-class minimum value cell belongs. Then, the ECU 13 determines the driving policy based on the specified segmented area and the result of the comparison in the step S14. Note that when the second-class minimum value −a.sub.M3_min matches the second-class boundary deceleration, for example, the segmented area is specified as follows. First, roman numerals of the phases I and II, which are divided by the boundary deceleration are compared. Then a segmented area corresponding to the phase having a smaller roman numeral is defined as the segmented area to be specified.
(122) In the step S16, the ECU 13 formulates the driving plan. Specifically, the ECU 13 sets the driving trajectory TP repeatedly every time preset time elapses. When the driving policy is determined in the step S15, the target acceleration a.sub.M1_tgt is set in accordance with this driving policy. In this way, the driving state in the target position is updated.
(123) 1.5 Another System Configuration Example
(124) In another configuration example of the system, instead of the deceleration maps 14 and 15 described with reference to
2. SECOND EMBODIMENT
(125) Next, a second embodiment will be described with reference to
(126) 2.1 Assumption
(127) The second embodiment assumes the same situation as that of the first embodiment. Note that the vehicle control system related to the second embodiment is also referred to as a “system” in the following explanation of the second embodiment.
(128) 2.1.1 Conceptual of Deceleration Feature
(129) The conceptual of the deceleration feature in the second embodiment is the same as that of the first embodiment. That is, in the second embodiment, the first and second deceleration features are represented.
(130) 2.1.2 Problems in Automated Driving Peculiar Phase
(131) The problems of the first and second deceleration features described in the first embodiment also apply to the deceleration features in the second embodiment. First, in the “incomplete detected state phase”, the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A) and the second-class plausibility η.sub.B of the coordinate (d.sub.B, v.sub.B|η.sub.B) are not so high. Further concern is that there is a possibility that more than one coordinate (d.sub.A, v.sub.A|η.sub.A) exists simultaneously in the “incomplete detected state phase” of the first deceleration feature. The same is applied to the “incomplete detected state phase” of the second deceleration feature. That is, there is a possibility that more than one coordinate (d.sub.B, v.sub.B|η.sub.B) exists simultaneously. Note that the definitions of the first-class plausibility η.sub.A and the second-class plausibility η.sub.B of the second embodiment are the same as those of the first embodiment.
(132) The second embodiment focuses on the “automated driving peculiar phase” in the first deceleration feature described in
(133) As described above, in the first deceleration feature, the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A) in a phase where the “automated driving peculiar phase” and the “incomplete detected state phase” overlap is a problem. The occurrence of this problem is unavoidable as long as the “incomplete detected state phase” is defined. On the other hand, in a phase where the “pseudo human phase” and the “incomplete detected state phase” overlap, it does not lead to such a big problem. This is because if the single coordinate coordinate (d.sub.A, v.sub.A|η.sub.A) is specified and it is found that the first-class state is in the “pseudo human phase”, a slower deceleration than the slowdown in the first-class minimum deceleration will be performed. Under such the slower deceleration, the occupant is hardly anxious about the running behavior of the vehicle M1.
(134) 2.2 Characteristic of Second Embodiment
(135) In view of the problems described above, in the second embodiment, the driving policy of the vehicle M1 is determined and then reflected to the driving plan as follows.
(136) 2.2.1 Determination of Driving Policy
(137) The determination of the driving policy is based on the at least one coordinate (d.sub.A, v.sub.A|η.sub.A), and the at least one coordinate (d.sub.B, v.sub.B|η.sub.B). The significance of the at least one coordinate (d.sub.A, v.sub.A|η.sub.A) and the at least one coordinate (d.sub.B, v.sub.B|η.sub.B) is as described the section “1.1.1” of the first embodiment.
(138) The driving policy is determined based on the result of the comparison between the first-class minimum value −a.sub.M1_min and the second-class minimum value −a.sub.M3_min. The magnitude relationship of these minimum values is as follows.
−a.sub.M1_min≥−a.sub.M3_min (i)
−a.sub.M1_min<−a.sub.M3_min (ii)
2.2.1.1 In Case of Magnitude Relationship (i)
(139) In the first embodiment, the driving policy in the case (i) is determined to “decelerate the vehicle M1 immediately with the first-class minimum value −a.sub.M1_min.” On the other hand, in the second embodiment, the driving policy in the case (i) is determined based on a first-class minimum value phase. The “first-class minimum value phase” is defined in the first deceleration feature as a phase to which the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) belongs.
(140) The idea of the first-class minimum value phase in the second embodiment and determination method of the driving policy will be described with reference to
(141) The phase I is the part on the left side of the first-class threshold η.sub.A_th0 in the “collision phase” described in
(142) The phase II is the part on the left side of the first-class threshold η.sub.A_th1 in the “automated driving peculiar phase” described in
(143) The phase III is a part on the left side of the first-class threshold η.sub.A_th0 in the “free phase” described in
(144) The phase IV is the part on the left side of the first-class threshold η.sub.A_th0 in the “pseudo human phase” described in
(145) The phase V is the part between the first-class thresholds η.sub.A_th0 and η.sub.A_th1 in the “automated driving peculiar phase” described in
(146) 2.2.1.2 In Case of Magnitude Relationship (ii)
(147) The driving policy of the relationship (ii) is determined based on the second-class minimum value phase. However, in the second embodiment, not only the first deceleration feature but also the second deceleration feature are classified into the phases I to V. Note that the phases I to V in the second deceleration feature are explained by replacing the explanation in
(148) If the second-class minimum value phase corresponds to the phase I or II, the driving policy is determined to “perform the slowdown of the vehicle M1 immediately with the second-class minimum value −a.sub.M3_min.” The reason for this is that if the second-class minimum value phase corresponds to the phase I or II, it is determined that the vehicle M1 is more likely to be collided from the vehicle M3. Therefore, if the second-class minimum value phase corresponds to the phase I or II, driving policy is selected to prioritize the driving safety (i.e., to avoid the rear-end collision from the vehicle M3) than the driving efficiency.
(149) If the second-class minimum value phase corresponds to the phase III, the driving policy is determined to “maintain current acceleration or deceleration”. This is because the rear-end collision from the vehicle M3 can be easily avoided without performing the slowdown of the vehicle M1. Therefore, if the second-class minimum value phase corresponds to the phase III, the driving policy is selected to prioritize the driving efficiency than the driving safety. In this case, “speedup of the vehicle M1 such that the driving speed v.sub.M1 does not exceed an upper limit” may be applied as the driving policy.
(150) If the second-class minimum value phase corresponds to the phase IV, the driving policy is determined to “postpone the start of the slowdown until the second-class plausibility η.sub.B of the coordinate (d.sub.B, v.sub.B|η.sub.B|−a.sub.M3_min) is equal to or greater than a second-class threshold η.sub.B_th2. This is because there is a possibility that the rear-end collision from the vehicle M3 is avoided even if the slowdown of the vehicle M1 is not performed immediately. As described above, when the second-class minimum value phase corresponds to the phase IV, the driving policy is selected to perform appropriate driving in accordance with the current situation. The second-class threshold η.sub.B_th2 corresponds to the second-class threshold η.sub.B when a certain accuracy is recognized in the detection of the vehicle M3. The second-class threshold η.sub.B_th2 satisfies η.sub.B_th0<η.sub.B_th2<η.sub.B_th1.
(151) If the second-class minimum value phase corresponds to the phase V, the driving policy is determined to “perform the slowdown by changing the second-class minimum value −a.sub.M3_min according to the second-class plausibility η.sub.B of the coordinate (d.sub.B, v.sub.B|η.sub.B|−a.sub.M3_min)”. The reason for this is that the detection of the state of the vehicle M1 as viewed from the vehicle M3 (hereinafter referred to as a “second-class state” in the following description in the second embodiment) is uncertain if the second-class minimum value phase corresponds to the phase V. As described above, if the second-class minimum value phase corresponds to the phase V, the driving policy is selected to maintain the balance of the driving safety and the driving efficiency.
(152) 2.2.2 Reflection of Driving Policy
(153) The reflection of the driving policy is performed on the driving plan. The method to design the driving plan is basically the same as that of the first embodiment.
(154) Focusing on the first-class minimum value phase, the second-class minimum value phase and the magnitude relationship between the first-class minimum value −a.sub.M1_min and the second-class minimum value −a.sub.M3_min, the driving policies described above are summarized as follows.
(155) (i) In case of −a.sub.M1_min≥−a.sub.M3_min
(156) (i-a) If the first-class minimum value phase corresponds to the phase I or II
(157) Perform the slowdown of the vehicle M1 immediately with the first-class minimum value −a.sub.M1_min
(158) (i-b) If the first-class minimum value phase corresponds to the phase III
(159) Maintain current acceleration or deceleration
(160) (i-c) If the first-class minimum value phase corresponds to the phase IV
(161) Postpone the start of the slowdown until the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) is equal to or greater than the first-class threshold η.sub.A_th2
(162) (i-d) If the first-class minimum value phase corresponds to the phase V
(163) Perform the slowdown by the first-class minimum value −a.sub.M1_min according to the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min)
(164) (ii) In case of −a.sub.M1_min<−a.sub.M3_min
(165) (ii-a) in case of the second-class minimum value phase corresponds to the phase I or II
(166) Perform the slowdown of the vehicle M1 immediately with the second-class minimum value −a.sub.M3_min
(167) (ii-b) In case of the second-class minimum value phase corresponds to the phase III
(168) Maintain current acceleration or deceleration
(169) (ii-c) In case of the second-class minimum value phase corresponds to the phase IV
(170) Postpone the start of the slowdown until the second-class plausibility η.sub.B of the coordinate (d.sub.B, v.sub.B|η.sub.B|−a.sub.M3_min) is equal to or greater than the second-class threshold η.sub.B_th2.
(171) (ii-d) In case of the first-class minimum value phase corresponds to the phase V
(172) Perform the slowdown by changing the second-class minimum value −a.sub.M3_min according to the second-class plausibility η.sub.B of the coordinate (d.sub.B, v.sub.B|η.sub.B|−a.sub.M3_min)
(173) According to the driving policy (i-a), the first-class minimum value −a.sub.M1_min is immediately reflected to the target acceleration a.sub.M1_tgt. On the other hand, according to the driving policy (i-b), the first-class minimum value −a.sub.M1_min is not reflected to the target acceleration a.sub.M1_tgt at all. Here, focusing on a reflection degree of the first-class minimum value −a.sub.M1_min to the target acceleration a.sub.M1_tgt (hereinafter also referred to as a “first reflection degree”). Then the first reflection degree of the driving policy (i-a) is 100% and that of the driving policy (i-b) is 0%.
(174) According to the driving policy (i-c), the first reflection degree is changed according to the result of comparing with the first-class threshold η.sub.A_th2.
(175) According to the driving policy (i-c), if the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) is less than the first-class threshold η.sub.A_th2, the first-class minimum value −a.sub.M1_min is not reflected to the target acceleration a.sub.M1_tgt. If the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) is equal to or greater than the first-class threshold η.sub.A_th2, the first-class minimum value −a.sub.M1_min is reflected to the target acceleration a.sub.M1_tgt. Thus, according to the driving policy (i-c), the first reflection degree is changed between 0% and 100%.
(176) In
(177) According to the driving policy (i-d), the first reflection degree is change in accordance with the first-class threshold η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min).
(178) In
(179) The case 1.2 corresponds to a case where the postponement performed in the case 1 did not result in a problem. The result in the case 1.2 is also applied to the case 2.1. However, in the case 1.1, since the postponement has been performed, the minimum value −a.sub.M1_min becomes smaller after the start of the slowdown (i.e., rapid deceleration is performed). In the case 2.2, a speedup is performed immediately after the start of the slowdown. Therefore, in the cases 1.1 and 2.2, the occupant may anxious about the running behavior of the vehicle M1.
(180) In this regard, according to the driving policy (i-d), the first-class minimum value −a.sub.M1_min is changed in accordance with the first-class plausibility η.sub.A of (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min). In
(181) In
(182) The contents of the driving policies (ii-a) to (ii-d) are basically the same as those of the driving policies (i-a) to (i-d). The description of
(183) 2.2.3 Effect
(184) According to the characteristics of the second embodiment, the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min), or the second-class plausibility η.sub.B of the coordinate (d.sub.B, v.sub.B|η.sub.B|−a.sub.M3_min) is considered to determine the driving policy. The first-class minimum value −a.sub.M1_min or the second-class minimum value −a.sub.M3_min is reflected to the target acceleration a.sub.M1_tgt with the reflection degree of 0 to 100% (that is, the first or second reflection degree). Therefore, it is possible to obtain effects equal to or higher than the effects by the characteristics of the first embodiment.
(185) 2.3 Vehicle Control System
(186) Next, a configuration example of the system in which the automated driving control including the characteristic processing is executed will be described.
(187) 2.3.1 System Configuration Example
(188)
(189) 2.3.2 Configuration Example of ECU
(190) As shown in
(191) The calculation portion 211 calculates the first-class plausibility η.sub.A and the second-class plausibility η.sub.B. The first-class plausibility η.sub.A is calculated, for example, as a probability L of a plausibility model with a probability ρ is used as a variable in which the state of the slowdown target OBJ is correctly detected. If there are more than two states of the slowdown target OBJ, then the first-class plausibility η.sub.A is calculated for each of these state. Second-class plausibility η.sub.B is calculated, for example, by applying a model similar to plausibility model described above to following moving body FOB. The calculation portion 211 transmits the calculated first-class plausibility η.sub.A and the second-class plausibility η.sub.B to the planning portion 212.
(192) The planning portion 212 plans the driving plan of the automated driving. The basic function of the planning portion 212 is the same as that of the planning portion 135 shown in
(193) From the decision portion 133, one of the driving policies (i-a) to (ii-d) is transmitted. The planning portion 212 reflects the first-class minimum value −a.sub.M1_min or the second-class minimum value −a.sub.M3_min to the target acceleration a.sub.M1_tgt, depending on the contents of the received driving policy. Otherwise, the planning portion 212 does not reflect any of these minimum values to the target acceleration a.sub.M1_tgt.
(194) When the driving policy (i-a) is received, the planning portion 212 immediately reflects the first-class minimum value −a.sub.M1_min to the target acceleration a.sub.M1_tgt. When the driving policy (i-c) is received and also the first-class plausibility η.sub.A corresponding to a first-class minimum value cell is equal to or greater than the first-class threshold η.sub.A_th2, the planning portion 212 immediately executes the reflection of the first-class minimum value −a.sub.M1_min. The “first-class minimum value cell” is defined as a cell on the deceleration map 14 that corresponds to the first-class minimum value −a.sub.M1_min.
(195) When the driving policy (i-b) is received, the planning portion 212 prohibits the first-class minimum value −a.sub.M1_min from being reflected to the target acceleration a.sub.M1_tgt. When the driving policy (i-c) is received and also the first-class minimum value cell that corresponds to the first-class plausibility η.sub.A is less than the first-class threshold η.sub.A_th2, the planning portion 212 prohibits the reflection of first-class minimum value −a.sub.M1_min.
(196) When the driving policy (i-d) is received, the planning portion 212 changes the first-class minimum value −a.sub.M1_min in accordance with the first-class plausibility η.sub.A corresponding to the first-class minimum value cell. The first-class minimum value −a.sub.M1_min is changed by multiplying the coefficient α by the first-class minimum value −a.sub.M1_min.
(197) When the driving policy (ii-a) is received, the planning portion 212 immediately reflects the second-class minimum value −a.sub.M3_min to the target acceleration a.sub.M1_tgt. When the driving policy (ii-c) is received and also the second-class minimum value cell that corresponds to the second-class plausibility η.sub.B is equal to or greater than the second-class threshold η.sub.B_th2, the planning portion 212 immediately executes the reflection of the second-class minimum value −a.sub.M3_min.
(198) When the driving policy (ii-b) is received, the planning portion 212 prohibits the second-class minimum value −a.sub.M3_min from being reflected to the tgt target acceleration a.sub.M1. When the driving policy (ii-c) is received and also the second-class minimum value cell that corresponds to the second-class plausibility η.sub.B is less than the second-class threshold η.sub.B_th2, the planning portion 212 prohibits the reflection of the second-class minimum value −a.sub.M1_min.
(199) When the driving policy (ii-d) is received, the planning portion 212 changes the second-class minimum value −a.sub.M3_min in accordance with the second-class plausibility η.sub.B corresponding to the second-class minimum value cell. The second-class minimum value a.sub.M3_min is changed by multiplying the coefficient α by the second-class minimum value −a.sub.M3_min.
(200) 2.4 Processing Example Executed by ECU
(201)
(202) If judgement result of the step S22 is positive, the ECU 21 calculates the first-class plausibility η.sub.A and the second-class η.sub.B (step S23). Specifically, the ECU 21 extracts the information on the state of the slowdown target OBJ from the information on the object and calculates first-class plausibility η.sub.A. If more than one information on the state of the slowdown target OBJ is included in the information on the object, the ECU 21 calculates the first-class plausibility η.sub.A for each of these states. The ECU 21 also extracts the information on the state of the following moving body FOB from the information of the object and then calculates the second-class plausibility η.sub.B.
(203) Subsequent to the step S23, the ECU 21 executes processing of steps from S24 to S26. The processing of these steps is the same as that of the steps from S13 to S15 shown in
(204) In the step S27, the ECU 21 calculates the driving plan. Specifically, the ECU 21 sets the driving trajectory TP repeatedly every time preset time elapses. When the driving policy is determined in the step S26, the ECU 21 reflects the first-class minimum value −a.sub.M1_min and the second-class plausibility η.sub.B calculated in the step S23 to the target acceleration a.sub.M1_tgt with the first reflection degree while appropriately referring to the first-class plausibility η.sub.A. Otherwise, the ECU 21 reflects the second-class minimum value −a.sub.M3_min to the target acceleration a.sub.M1_tgt with the second reflection degree. In this way, the driving state in the target position is updated.
3. THIRD EMBODIMENT
(205) Next, a third embodiment will be described with reference to
(206) 3.1 Assumption
(207)
(208) In front of the vehicle M1 by a first-class distance d.sub.A, there is a stop line SL. The stop line SL is a line attached to a nearest traffic signal TS of the vehicle M1 on the driving trajectory TP. The fact that the traffic light TS is the nearest traffic signal is specified based on the positional information of the vehicle M1 and the map information. According to the positional information of the vehicle M1 and the map information, the first-class distance d.sub.A is also specified. Note that there is no moving or static obstacle between the stop line SL and the vehicle M1. The situation where the moving or static obstacle exists corresponds to the situation described in
(209) The slowdown target OBJ of the first and second embodiments is a nearest moving or static obstacle. In contrast, the slowdown target OBJ of the third embodiment is the traffic light TS. When the slowdown target OBJ is the traffic light TS, the state of the slowdown target OBJ is the first-class relative speed v.sub.A of the traffic light TS (more precisely, the stop line SL) to vehicle M1 and the relative speed v.sub.A of the traffic light TS (more precisely, the stop line SL). However, the first-class distance d.sub.A is specified based on the positional information and the map information of the vehicle M1. The first-class relative speed v.sub.A is represented by −v.sub.M1. That is, when the slowdown target OBJ is the traffic light TS, the accuracy on the detection of the state of it is expected to be high enough. In third embodiment, therefore, the plausibility η.sub.A is associated with the state of the traffic light TS that indicates an accuracy of the detection of lighting color Cs (red or yellow; the same shall apply hereinafter) of the traffic signal TS. In the following explanation of the third embodiment, the plausibility η.sub.A of the lighting color Cs is also referred to as the “first-class plausibility η.sub.A” and the threshold η.sub.A thX is also referred to as the “first-class threshold η.sub.A thX”.
(210) Behind the vehicle M1 by the distance d.sub.B, the vehicle M3 runs at the driving speed v.sub.M3. The vehicle M3 is common to the assumptions of the first and second embodiments.
(211) 3.2 Characteristic of Third Embodiment
(212) When the slowdown target OBJ is the traffic light TS, the first deceleration feature shown in
(213) In the following explanation of third embodiment, among the coordinate (d.sub.A, v.sub.A) corresponding to the state of the traffic light TS, the coordinate (d.sub.A, v.sub.A) having the first-class plausibility η.sub.A greater than the first-class threshold η.sub.A_th0 is referred to as the “coordinate (d.sub.A, v.sub.A|η.sub.A)”.
(214) 3.2.1 Determination of Driving Policy
(215) The driving policy is determined based on a single coordinate (d.sub.A, v.sub.A|η.sub.A). The reason for expressing “single coordinate (d.sub.A, v.sub.A|η.sub.A).sub.” is that the first-class distance d.sub.A and the first-class relative speed v.sub.A are specified in the third embodiment. And, as described in the first embodiment, when there is only one coordinate (d.sub.A, v.sub.A|η.sub.A), the first-class deceleration −a.sub.M1 corresponding to the coordinate (d.sub.A, v.sub.A|η.sub.A) can be regarded as the substantial first-class minimum value −a.sub.M1_min. Therefore, in the following explanation of the third embodiment, the coordinate (d.sub.A, v.sub.A|η.sub.A) having the first-class minimum value −a.sub.M1_min is referred to as the “coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min)”.
(216) The driving policy is determined based on the result of the comparison between the first-class minimum value −a.sub.M1_min and the second-class minimum value −a.sub.M3_min. The magnitude relationship of these minimum values is as follows.
−a.sub.M1_min≥−a.sub.M3_min (i)
−a.sub.M1_min<−a.sub.M3_min (ii)
(217) The driving policy for the case of the relationship (ii) is common to that in the second embodiment. Therefore, the explanation of the determination examples of driving policy for the case of the relationship (ii) is omitted. Hereinafter, examples to determine the driving policy for the case of the relationship (i) will be described. First, thresholds η.sub.A_th used in this description will be described. In
(218) The first-class threshold η.sub.A_th4 corresponds to the first-class threshold η.sub.A when the lighting color Cs is completely detected by the camera. The first-class threshold η.sub.A_th4 satisfies η.sub.A_th4>η.sub.A_th0. The first-class threshold η.sub.A_th5 corresponds to the first-class threshold η.sub.A when a certain accuracy is observed in the detection of the lighting color Cs by the camera. The first-class threshold η.sub.A_th5 satisfies η.sub.A_th0<η.sub.A_th5<η.sub.A_th4. The definition of the first-class threshold η.sub.A_th6 is the same as that of the first-class threshold η.sub.A_th5. The first-class threshold η.sub.A_th6 may be the same as the first-class threshold η.sub.A_th5 or may be different from the first-class threshold η.sub.A_th5.
(219) If the first-class minimum value phase corresponds to the phase I, the driving policy is determined to “decelerate the vehicle M1 immediately at the first-class minimum value −a.sub.M1_min.” The reason for this is to stop the vehicle M1 in front of the stop line SL. Thus, if the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) exists in the phase I, the driving policy is selected to prioritize the driving safety than the driving efficiency.
(220) If the first-class minimum value phase corresponds to the phase III, the driving policy is determined to “maintain current acceleration or deceleration”. This is because the vehicle M1 is able to stop in front of the stop line SL even if the slowdown of the vehicle M1 is not performed. Thus, if the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) exists in the phase III, the driving policy is selected to prioritize the driving efficiency than the driving safety. In this case, “speedup of the vehicle M1 such that the driving speed v.sub.M1 does not exceed an upper limit” may be applied as the driving policy.
(221) If the first-class minimum value phase corresponds to the phase IV, the driving policy is determined to “postpone the start of the slowdown until the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) is equal to or greater than the first-class threshold η.sub.A_th5”. This is because there is a possibility that vehicle M1 stops in front of the stop line SL even if the slowdown of the vehicle M1 is performed immediately. As described above, if the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) exists in the phase IV, the driving policy is selected to perform appropriate driving in accordance with the current situation.
(222) If the first-class minimum value phase corresponds to the phase II or V, the driving policy is determined to “immediately perform the slowdown of the vehicle M1 with the first-class minimum value −a.sub.M1_min if the first-class plausibility η.sub.A of the coordinate (d.sub.A, a.sub.M1_min) is equal to or greater than first-class threshold η.sub.A_th4. Otherwise, perform the slowdown by changing the first-class minimum value a.sub.M1_min in accordance with the first-class plausibility η.sub.A”. Unlike the second embodiment described above, in the third embodiment, the single coordinate (d.sub.A, v.sub.A|η.sub.A) is always specified. On the other hand, at the timing which the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) is specified, it is impossible to narrow down whether this coordinate exists in the phase II or V. Therefore, in third embodiment, a judgment element for narrowing down is added to the driving policy.
(223) 3.2.2 Reflection of Driving Policy
(224) The reflection of the driving policy is performed on the driving plan. The method to design the driving plan is basically the same as that of the first or second embodiment.
(225) Focusing on the first-class and the second-class minimum value phases, and the magnitude relationship between the first-class minimum value −a.sub.M1_min and the second-class minimum value −a.sub.M3_min, the driving policy in the case (i) are summarized as follows.
(226) (i) In case of −a.sub.M1_min≥−a.sub.M3_min
(227) (i-a) If the first-class minimum value phase corresponds to the phase I
(228) Perform the slowdown of the vehicle M1 immediately with the first-class minimum value −a.sub.M1_min
(229) (i-b) If the first-class minimum value phase corresponds to the phase III
(230) Maintain current acceleration or deceleration
(231) (i-c) If the first-class minimum value phase corresponds to the phase IV
(232) Postpone the start of the slowdown until first-class threshold η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) is equal to or greater than the first-class threshold η.sub.A_th5
(233) (i-d) If the first-class minimum value phase corresponds to the phase II or V
(234) Immediately perform the slowdown with the first-class minimum value −a.sub.M1_min if the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) is equal to or greater than the first-class threshold η.sub.A_th4. Otherwise, perform the slowdown by changing the first-class minimum value −a.sub.M1_min in accordance with the first-class plausibility η.sub.A.
(235) According to the driving policy (i-a), the first-class minimum value −a.sub.M1_min is immediately reflected to the target acceleration a.sub.M1_tgt. On the other hand, according to the driving policy (i-b), the first-class minimum value −a.sub.M1_min is not reflected to the target acceleration a.sub.M1_tgt at all. Therefore, the first reflection degree of the driving policy (i-a) is 100% and that of the driving policy (i-b) is 0%.
(236) According to the driving policy (i-c), the first reflection degree is changed according to the result of comparing with the first-class threshold η.sub.A_th5.
(237) According to the driving policy (i-c), the first-class minimum value −a.sub.M1_min is not reflected to the target acceleration a.sub.M1_tgt if the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) is less than the first-class threshold η.sub.A_th5. On the other hand, the first-class minimum value −a.sub.M1_min is reflected to the target acceleration a.sub.M1_tgt if the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) is equal to or greater than the first-class threshold η.sub.A_th5. Thus, according to the driving policy (i-c), the first reflection degree is changed between 0% and 100%.
(238) In
(239) According to the driving policy (i-d), the first reflection degree changes according to the result of the comparison with the first-class threshold η.sub.A_th4 and the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min). If the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) is equal to or greater than the first-class threshold η.sub.A_th4, the first-class minimum value −a.sub.M1_min is reflected to the target acceleration a.sub.M1_tgt. As described above, the first reflection degree according to the driving policy (i-d) is 100% if the first-class plausibility η.sub.A of the coordinate (d.sub.A, v.sub.A|η.sub.A|−a.sub.M1_min) is equal to or greater than the first-class threshold η.sub.A_th4.
(240) On the other hand, if the first-class plausibility η.sub.A of the coordinate (d.sub.A,v.sub.A|η.sub.A|−a.sub.M1_min) is less than first-class threshold η.sub.A_th4, the first-class minimum value −a.sub.M1_min is changed in accordance with the same first-class plausibility η.sub.A.
(241) In
(242) 3.2.3 Effect
(243) According to the characteristics of the third embodiment, it is possible to obtain effects equivalent to those in the second embodiment.
(244) 3.3 Vehicle Control System
(245) Next, a configuration example of the system in which the automated driving control including the characteristic processing is executed will be described.
(246) 3.3.1 System Configuration Example
(247)
(248) The GNSS receiver 31 is a device that receives signals from three or more satellites. The GNSS receiver 31 is also a device to obtain the position of the vehicle M1. The GNSS receiver 31 calculates the position and orientation of the vehicle M1 based on the received signals. The GNSS receiver 31 transmits the calculated information to the ECU 33.
(249) The map database 32 is a data base in which map information is stored. The map information include positional information on roads, road shape information (e.g., curve, line type and curvature), positional information on intersections and divergent points, and positional information on constructions. The map information also includes information on the traffic regulation. The information on the traffic regulation includes a statutory speed which is associated with the positional information on the roads. The map information may include information on regions where the automated driving control is executable. The map database 32 is formed in a storage device (e.g., a hard disk and a flash memory) mounted on the vehicle M1. The map database 32 may be formed in the computer of the facility (e.g., a management center) capable of communicating with the vehicle M1.
(250) The information on the position and orientation of the vehicle M1 and the map information are included in the driving environment information of the vehicle M1. That is, the GNSS receiver 31 and the map database 32 are included in the “acquiring device to acquire the driving environment information”.
(251) The hardware configuration of the ECU 33 is the same as that of the ECU 13 described in
(252) The deceleration map 34 is a cell map in which the relationship is specified between the first-class deceleration −a.sub.M1 and the state of slowdown target OBJ (i.e., the first-class distance d.sub.A and the first-class relative speed v.sub.A). The basic configuration of the deceleration map 34 is the same as that of the deceleration map 14 described in
(253) The deceleration map 35 is a cell map in which the relationship is specified between the second-class deceleration −a.sub.M3 and the state of vehicle M1 (i.e., the second-class distance d.sub.B and the second-class relative speed v.sub.B) as viewed from the vehicle M3. The configuration of the deceleration map 35 is the same as that of the deceleration map 15 described in the first embodiment.
(254) 3.3.2 Configuration Example of ECU
(255) As shown in
(256) The calculation portion 331 calculates the first-class request value and second-class request value. The first-class request value is calculated by referring to the deceleration map 34. The deceleration map 34 is referenced by using the information on the state of the slowdown target OBJ. The second-class request value is calculated by referring to the deceleration map 35. The deceleration map 35 is referenced by using the information on the state of the following moving body FMO. As described above, the calculation of the first-class and second-class request values executed by the calculation portion 331 is essentially the same as that executed by the calculation portion 131 described in
(257) The calculation portion 332 calculates the distance (i.e., the first-class distance d.sub.A) from the vehicle M1 to the stop line SL. The first-class distance d.sub.A is calculated based on the positional information and the map information of the vehicle M1. The positional information of the vehicle M1 is obtained from the GNSS receiver 31. The map information is obtained from the map database 32. The calculation portion 332 transmits the calculated first-class distance d.sub.A to the calculation portion 331.
(258) The detection portion 333 detects a lighting state (i.e., green, yellow, red, or unknown) of the traffic light TS. The lighting state is detected, for example, as follows. First, the traffic light TS is extracted from the images captured by the camera. Then, based on brightness of the extracted traffic light TS, the lighting state is determined. When the brightness of red is highest, the lighting state is determined to be red. The detection portion 333 transmits the detected lighting state to the calculation portions 331 and 334.
(259) The calculation portion 334 calculates the first-class plausibility η.sub.A. The first-class plausibility η.sub.A is calculated as, for example, a probability L of a plausibility model in which a probability p is used as a variable that a red or yellow signal is correctly detected based on the detection information of the camera, the detection history of the camera, the detection information of traffic light around the vehicle M1 which is predicted from the movement of a peripheral vehicle around the vehicle M1. The calculation portion 334 transmits the calculated first-class plausibility η.sub.A to the planning portion 335.
(260) The planning portion 335 plans the driving plan of the automated driving. The basic function of the planning portion 335 is the same as that of the planning portion 135 described in
(261) From the decision portion 133, one of the driving policies (i-a) to (ii-d) is transmitted. The planning portion 335 reflects the first-class minimum value −a.sub.M1_min or the second-class minimum value −a.sub.M3_min to the target acceleration a.sub.M1_tgt, depending on the contents of the received driving policy.
(262) When the driving policy (i-a) is received, the planning portion 335 immediately reflects the first-class minimum value −a.sub.M1_min to the target acceleration a.sub.M1_tgt. When the driving policy (i-c) is received and also the first-class plausibility η.sub.A corresponding to the first-class minimum value cell is equal to or greater than the first-class threshold η.sub.A_th5, the planning portion 335 immediately executes the reflection of the first-class minimum value −a.sub.M1_min. The immediate reflection of the first-class minimum value −a.sub.M1_min is also executed when the driving policy (i-d) is received and also the first-class plausibility η.sub.A corresponding to the first-class minimum value cell is equal to or greater than the first-class threshold η.sub.A_th4. Note that the “first-class minimum value cell” in the third embodiment is defined as a cell on the deceleration map 34 that corresponds to the first-class minimum value −a.sub.M1_min.
(263) When the driving policy (i-b) is received, the planning portion 335 prohibits the first-class minimum value −a.sub.M1_min from being reflected to the target acceleration a.sub.M1_tgt. The reflection of the first-class minimum value −a.sub.M1_min is also prohibited when the driving policy (i-c) is received and the first-class plausibility η.sub.A corresponding to the first-class minimum value cell is less than the first-class threshold η.sub.A_th5.
(264) When the driving policy (i-d) is received and also the first-class plausibility 11A corresponding to the first-class minimum value cell is less than the first-class threshold η.sub.A_th4, the planning portion 335 changes the first-class minimum value −a.sub.M1_min in accordance with the same first-class plausibility η.sub.A. The first-class minimum value −a.sub.M1_min is changed by multiplying the coefficient β by the first-class minimum value −a.sub.M1_min.
(265) The method of reflecting the second-class minimum value −a.sub.M3_min to the target acceleration a.sub.M1_tgt in a case where any one of the driving policies (ii-a) to (ii-d) is received is basically the same as that in the second embodiment. Note that the “second-class minimum value cell” in third embodiment is defined as a cell on the deceleration map 35 that corresponds to the second-class minimum value −a.sub.M3_min.
(266) 3.4 Processing Example Executed by ECU
(267)
(268) Subsequent to the step S31, the ECU 33 determines whether or not the traffic light TS, the stop line SL and the following moving body FMO have been detected (step S32). Specifically, the ECU 33 determines whether or not the information acquired in the step S31 includes the information on the traffic light TS and stop line SL and the information on the state of the following moving body FOB. If the judgement result of the step S32 is negative, the ECU 33 proceeds to step S37.
(269) If the judgement result of the step S32 is positive, the ECU 33 calculates the first-class plausibility η.sub.A and the second-class plausibility η.sub.B (step S33). Specifically, the ECU 33 extracts the traffic light TS from the images captured by the camera and then calculates the first-class plausibility η.sub.A. The ECU 33 also extracts the information on the state of the following moving body FOB from the information on the object and then calculates the second-class plausibility η.sub.B.
(270) Subsequent to the step S33, the ECU 33 executes processing of the steps from S34 to S37. The processing of the steps from S34 to S36 is the same as the processing of the steps from S13 to S15 shown in
4. FOURTH EMBODIMENT
(271) Next, a fourth embodiment will be described with reference to
(272) 4.1 Assumption
(273)
(274) The vehicle M1 will change its cruising lane from the first lane L1 to the second lane L2 according to lane change control executed by the system. The lane change control is executed as a part of the automated driving control. The driving trajectory TP shown in
(275) In front of the vehicle M1 by the first-class distance d.sub.A, there is the vehicle M2 running at the driving speed v.sub.M2. Behind the vehicle M1 by the first-class distance d.sub.B, there is the vehicle M3 running at the driving speed v.sub.M3. The assumptions so far are the same as those in the first or second embodiment. However, in the fourth embodiment, the vehicles M2 and M3 are present on the second lane L2. Note that there is no moving or static obstacle on the first lane L1 between the vehicles M1 and M2. There is no following moving body on the first lane L1 between vehicles M1 and M3. The situation in which such the obstacle or the following moving body exists corresponds to the situation described in
(276) The lane change control is executed such that the vehicle M1 cuts into between the vehicles M2 and M3. In this case, the vehicle M2 is recognized as an object for which the slowdown of the vehicle M1 after the change of the cruising lane should be considered (hereinafter also referred to as a “future slowdown target OBJ*”). The vehicle M3 is recognized as a “future following moving object FMO*” after the change of the cruising lane. For convenience of explanation, the term “future slowdown target OBJ*” is also referred to as the “slowdown target OBJ*”, and the term “future following moving object FMO*” is referred to as the “following moving body FMO*”.
(277) 4.2 Characteristic of Fourth Embodiment
(278) In the fourth embodiment, the first and second deceleration features are applied to the lane change control. However, since the vehicles M2 and M3 exist on the second lane L2, the first and second deceleration features cannot be directly applied to these vehicles. Therefore, in the fourth embodiment, a potential position PP of the vehicle M1 is set in the second lane L2. The “potential position PP” is defined as the position of the vehicle M1 when it is assumed that the vehicle M1 exists on the second lane L2.
(279)
(280) By combining the first and second deceleration features with the potential position PP, it is possible to determine the driving policy regarding the acceleration or deceleration during the execution of the lane change control. As the determination method of the driving policy, the method described in the first or second embodiment is applied. The same is true for the reflection method of the driving policy to the driving plan. Note that there is no particular limitation on the method to determine the driving policy and tp reflection the driving plan relating to the steering angle during the execution on the lane change control, and a known method can be applied thereto.
(281) As described above, according to the characteristics of the fourth embodiment, it is possible to obtain the same effect as that according to the first or second embodiment even during the execution of the lane change control.
(282) 4.3 Vehicle Control System
(283) Next, configuration example of the system to execute the lane change control including the characteristic processing will be described.
(284) 4.3.1 System Configuration Example
(285)
(286) 4.3.2 Configuration Example of ECU
(287) As shown in
(288) The calculation portion 411 calculates the first-class request value and second-class request value. The first-class request value is calculated by referring to the deceleration map 14. The deceleration map 14 is referenced by using the state of the slowdown target OBJ*. The second-class request value is calculated by referring to the deceleration map 15. The deceleration map 15 is referenced by using the state of the following moving body FMO*. The calculation portion 411 transmits the first-class and second-class request values to both the comparison portion 132 and the decision portion 133.
(289) The setting portion 412 sets the potential position PP on the second lane L2. The potential position PP is set when a request for lane change is issued and the slowdown target OBJ* and the following moving body FMO* are detected on the second lane L2. The potential position PP is set between the slowdown target OBJ* and the following moving body FMO*.
(290) The planning portion 413 plans the lane change plan. The planning of the lane change is executed by repeatedly setting the driving trajectory TP for the lane change every time preset time elapses, with the current time as a reference. The method to set the driving trajectory TP for the lane change is not particularly limited, and a known method can be applied. When the planning portion 413 receives the driving policy from the decision portion 133, it changes the information on the driving state in the target position (more precisely, the information on the target acceleration a.sub.M1_tgt). The planning portion 413 transmits to control portion 136 the information on the driving trajectory TP for the lane change, including the information on the driving state.
(291) 4.4 Processing Example Executed by ECU
(292)
(293) In the routine shown in
(294) Subsequent to the step S41, the ECU 41 determines whether or not the slowdown target OBJ* and the following moving body FMO* on the second lane L2 have been detected (step S42). Specifically, the ECU 41 determines whether or not the information on the object detected in the step S41 includes the information on the state of the slowdown target OBJ* and that on the state of the following moving body FOB*. If the judgement result of the step S42 is negative, the ECU 41 proceeds to the step S48.
(295) If the judgement result of the step S42 is positive, the ECU 41 sets the potential position PP (step S43). The ECU 41 specifically sets the potential position PP between the slowdown target OBJ* and the following moving body FOB* detected in the step S41.
(296) Subsequent to the step S43, the ECU 41 calculates the first-class plausibility η.sub.A and the second-class plausibility η.sub.B (step S44). In the fourth embodiment, the “first-class plausibility η.sub.A” is defined as an accuracy of the detection of the slowdown target OBJ*. In addition, the “second-class plausibility η.sub.B” is defined as the accuracy of the detection of the following moving body FOB*.
(297) Subsequent to the step S44, the ECU 41 calculates the requested deceleration (step S45). Specifically, the ECU 41 calculates the requested deceleration (i.e., the first-class request value) by referring to the deceleration map 14 with the information on the extracted state of the slowdown target OBJ*. The ECU 41 also calculates the requested deceleration (i.e., the second-class request value) by referring to the deceleration map 15 with the information on the extracted state of the following moving body FOB*.
(298) Subsequent to the step S45, the ECU 41 executes the processing of the steps S46 and S47. The processing of these steps is the same as that of the steps S14 and S15 shown in
(299) In the step S48, the ECU 41 formulates the driving plan. Specifically, ECU 41 repeatedly sets driving trajectory TP for lane change every time preset time elapses. When the driving policy is determined in the step S47, the ECU 41 reflects the first-class minimum value −a.sub.M1_min to the target acceleration a.sub.M1_tgt with the first reflection degree while appropriately referring to the first-class plausibility η.sub.A and the second-class plausibility η.sub.B calculated in the step S44. Otherwise, the ECU 41 reflects the second-class minimum value −a.sub.M3_min to the target acceleration a.sub.M1_tgt with the second reflection degree.
5. FIFTH EMBODIMENT
(300) Next, a fifth embodiment will be described with reference to
(301) 5.1 Assumption
(302)
(303) The assumption is common with the fourth embodiment where the cruising lane is to be changed from the first lane L1 to the second lane L2 according to the lane change control executed by the system. In addition, the assumption is common with the fourth embodiment where the vehicles M2 and M3 exist on the second lane L2. The vehicle M2 runs in front of the vehicle M1 by a distance d.sub.A at driving speed v.sub.M2. The vehicle M3 runs at driving speed v.sub.M3 behind of the vehicle M1 by a distance d.sub.B.
(304) However, in the situation shown in
(305) 5.2 Characteristic of Fifth Embodiment
(306) In the fourth embodiment, the potential position PP is set between the vehicles M2 and M3 during the execution of the lane change control. In the fifth embodiment, a plurality of candidates of the potential position PP are set. These candidates are set in a search area SA. The search area SA is set to an extent on the second lane L2 where the vehicle M1 is movable from the current position. The search area SA is calculated based on the current position of the vehicle M1, the driving speed v.sub.M, and a physical modeling of the vehicle M1. The map information may be used to calculate the search area SA. This map information includes the information on the length of the first lane L1 and the information on the shape of the first lane L1 (or that of the second lane L2).
(307)
(308) Assume that the lane change is executed to cut into between the vehicles M4 and M2. In this situation, the vehicle M4 is considered as the “slowdown target OBJ*” and the vehicle M2 is considered as the “following moving body FMO*”. Also, the distance d.sub.E from the vehicle M4 to the candidate PP1 is considered as the “first-class distance d.sub.E”, and the distance d.sub.F from the candidate PP1 to the vehicle M2 is considered as the“second-class distance d.sub.F”. Moreover, the relative speed v.sub.E of the vehicle M4 to the vehicle M1 is considered as the “first-class relative speed v.sub.E”, and the relative speed v.sub.F of the vehicle M1 to the vehicle M2 is considered as the “second-class relative speed v.sub.F”.
(309) In the lane change control to cut into between the vehicles M2 and M3, the vehicle M2 is considered as the “slowdown target OBJ*” and the vehicle M3 is considered as the “following moving body FMO*”. Also, the distance d.sub.G from the vehicle M2 to the candidate PP2 is considered as the “first-class distance d.sub.G”, and the distance d.sub.x from candidate PP2 to the vehicle M3 is considered as the “the second-class distance d.sub.H”. Moreover, the relative speed v.sub.G of the vehicle M2 to the vehicle M1 is considered as the “first-class relative speed vs”, and the relative speed v.sub.H of the vehicle M1 to the vehicle M3 is considered as the “second-class relative speed v.sub.H”.
(310) In the lane change control to cut into between the vehicles M3 and M5, the vehicle M3 is considered as the “slowdown target OBJ*” and the vehicle M5 is considered as the “following moving body FMO*”. Also, the distance d.sub.I from the vehicle M3 to the candidate PP3 is considered as the “first-class distance d.sub.I”, and the distance d.sub.J from candidate PP3 to the vehicle M5 is considered as the “the second-class distance d.sub.J”. Moreover, the relative speed v.sub.I of the vehicle M3 to the vehicle M1 is considered as the “first-class relative speed v.sub.I”, and the relative speed v.sub.J of the vehicle M1 to the vehicle M5 is considered as the “second-class relative speed v.sub.J”.
(311) In the fifth embodiment, the first and second deceleration features are combined with each of the candidates PP1 to PP3. Then, for each candidate PP1 to PP3, the driving policy on the speedup or slowdown during the execution of the lane change control is determined. These driving policies include a deceleration candidate to be reflected to the target acceleration a.sub.M1_tgt (for example, the first-class minimum value −a.sub.M1_min, the second-class minimum value −a.sub.M2_min, the second-class minimum value −a.sub.M3_min and the second-class minimum value −a.sub.M5_min).
(312) Here, the “first-class minimum value −a.sub.M1_min” is defined as a minimum value of the first-class deceleration −a.sub.M1 corresponding to each of these coordinates (d.sub.γ, v.sub.γ|η.sub.γ) when there are two or more coordinates (d.sub.γ, v.sub.γ|η.sub.γ) (γ represents E, G, or I). The “second-class minimum value −a.sub.MY_min” is defined as the minimum value of the second-class deceleration −a.sub.MY corresponding to each of these coordinates (d.sub.δ, v.sub.δ|η.sub.δ) when there are two or more coordinates (d.sub.δ, v.sub.δ|η.sub.δ) (MY represents the M2, M3 or M5, and δ represents F, H or J).
(313) In addition, the “coordinate (d.sub.γ, v.sub.γ|η.sub.γ)” is defined as a coordinate (d.sub.γ, v.sub.γ) of the coordinate (d.sub.γ, v.sub.γ) corresponding to the first-class state having the first-class plausibility η.sub.γγ larger than the first-class threshold η.sub.γ_th0. The “first-class state” is defined as a state of the slowdown target OBJ* corresponding to the candidate PP1 (i.e., the vehicle M4), the candidate PP2 (i.e., the vehicle M2), or the candidate PP3 (i.e., the vehicle M3). The “first-class plausibility η.sub.γ” is defined as an accuracy of the detection of the slowdown target OBJ* corresponding to the candidate PP1, PP2 or PP3.
(314) In addition, the “coordinate (d.sub.δ, v.sub.δ|η.sub.δ)” is defined as a coordinate (d.sub.δ, v.sub.δ) of the coordinates (d.sub.δ, v.sub.δ) corresponding to the second-class state having the second-class plausibility η.sub.δ greater than second-class threshold η.sub.δ_th0. The “second-class state” is defined as a state of the following moving body FMO* corresponding to the candidate PP1 (i.e., the vehicle M2), the candidate PP2 (i.e., the vehicle M3) or the candidate PP3 (i.e., the vehicle M5). The “second-class plausibility η.sub.δ” is defined as an accuracy of the detection of the following moving body FMO* corresponding to the candidate PP1, PP2 or PP3.
(315) In the fifth embodiment, a candidate having smallest difference from the current acceleration or deceleration of the vehicle M1 is selected from these pieces of deceleration candidates. Then, the change in deceleration (or acceleration) during the execution of the lane change control is kept low. Therefore, according to the characteristics of the fifth embodiment, it is possible to execute the lane change control focusing on the driving efficiency.
(316) 5.3 Vehicle Control System
(317) Next, configuration example of the system to execute the lane change control including the characteristic processing will be described.
(318) 5.3.1 System Configuration Example
(319)
(320) 5.3.2 Configuration Example of ECU
(321) As shown in
(322) The calculation portion 511 executes calculation of the first-class and second-class request values for each candidate of the potential positions PP. The first-class request value is a request value of the first-class deceleration −a.sub.M1. The first-class request value is calculated by referring to the deceleration map 14. The deceleration map 14 is referenced by using the state of the slowdown target OBJ*. The second-class request value is a request value of the second-class deceleration −a.sub.MY. The second-class request value is calculated by referring to the deceleration map 15. The deceleration map 15 is referenced by using the state of the following moving body FMO*. The calculation portion 511 transmits the first-class and second-class request values to both the comparison portion 512 and the decision portion 513.
(323) The comparative portion 512 compares the first-class minimum value −a.sub.M1_min with the second-class minimum value −a.sub.MY_min for each candidate of the potential positions PP. The method to specify the first-class minimum value −a.sub.M1_min and the second-class minimum value −a.sub.MY_min is basically the same as that executed by the comparison portion 132 described in
(324) The decision portion 513 determines the driving policy for each candidate of potential positions PP. The decision portion 513 first identifies the first-class minimum value −a.sub.M1_min and the second-class minimum value −a.sub.MY_min for each candidate of potential positions PP. The decision portion 513 then specifies the first-class and the second-class minimum value cells for each candidate of potential positions PP. Then, the decision portion 513 determines the driving policy based on the segmented areas to which the first-class and second-class minimum value cells belong and the result of the comparison received from the comparison portion 512, and transmits the driving policy to the planning portion 517. Note that the driving policy is explained by replacing the “second-class minimum value −a.sub.M3_min” with the “second-class minimum value −a.sub.MY_min” in the explanation in the section “2.2.1”.
(325) The setting portion 514 sets the search area SA. The search area SA is calculated based on the current position of the vehicle M1, the driving speed v.sub.M, and the physical model of vehicle M1. The setting portion 514 transmits the set search area SA to the setting portion 515.
(326) The setting portion 515 sets the candidates of the potential positions PP in the search area SA. The potential positions PP are set between two adjacent objects detected in the search area SA. The number of candidates of the potential positions PP varies depending on the number of the objects detected in the search area SA. If the number of the detected object is k, then candidate number of the potential positions PP is k−1 (k represents a natural number equal to or greater than 3).
(327) The calculation portion 516 calculates the first-class plausibility η.sub.γ and the second-class plausibility η.sub.δ. The first-class plausibility η.sub.γ is calculated by applying a model similar to the plausibility model described above to the slowdown target OBJ*. The first-class plausibility η.sub.γ of the first-class state is calculated for each first-class state. The calculation method of the second-class plausibility η.sub.δ is based on that of the first-class plausibility η.sub.γ. The calculation portion 516 transmits the calculated first-class plausibility η.sub.γ and the calculated second-class plausibility 116 to the planning portion 413.
(328) The planning portion 517 plans the lane change plan. When planning portion 517 receives the driving policy from the decision portion 513, it selects the driving policy containing the deceleration candidate with the smallest difference from current acceleration or deceleration of the vehicle M1 as deceleration candidate to be reflected to the target acceleration a.sub.M1_tgt (hereinafter also referred to as “final deceleration”). Then, the planning portion 517 changes the driving state data in the target position based on the final deceleration. The planning portion 517 transmits to the control portion 136 the information on the driving trajectory TP for the lane change, including the information on the driving state.
(329) 5.4 Processing Example Executed by ECU
(330)
(331) In the routine shown in
(332) Subsequent to the step S51, the ECU 51 determines whether or not a plurality of the slowdown target OBJ* and the following moving body FMO* are detected on the second lane L2 (step S52). Specifically, the ECU 51 determines whether or not the information on the object that was detected in the step S51 includes the information on the states of the at least two slowdown target OBJ* and that on the states of the at least two following moving body FOB*. If the judgement result of the step S52 is negative, the ECU 51 proceeds to the step S60.
(333) If judgement result of the step S52 is positive, the ECU 51 sets the search area (step S53), and sets the potential positions PP in this search area (step S54). Specifically, the ECU 51 sets the potential positions PP between the slowdown target OBJ* and the following moving body FOB* adjacent to the same slowdown target OBJ*.
(334) Subsequent to the step S54, the ECU 51 calculates the first-class plausibility η.sub.γ and the second-class plausibility η.sub.δ (step S55). The first-class plausibility η.sub.γ and the second-class plausibility and η.sub.δ are calculated for each potential position PP set in the step S54.
(335) Subsequent to the step S55, the ECU 51 executes the processing of steps from S56 and S58. The processing of the steps from S56 to S58 is executed by executing the processing of the steps from S45 to S47 shown in
(336) In the step S59, the ECU 51 formulates the driving plan. Specifically, the ECU 51 repeatedly sets the driving trajectory TP for the lane change every time preset time elapses. If the driving policy is determined in the step S58, the deceleration candidate (i.e., the final deceleration) having the smallest difference from the current acceleration or deceleration of the vehicle M1 is selected. The ECU 51 also reflect the final deceleration to the target acceleration a.sub.M1_tgt while appropriately referring to the first-class plausibility η.sub.γ and the second-class plausibility η.sub.δ.