Navigating multi-way stop intersections with an autonomous vehicle
The subject matter described in this specification is directed to a system and techniques for operating an autonomous vehicle (AV) at a multi-way stop intersection. After detecting the AV is at a primary stopline of the multi-way stop intersection, a planned travel path though the multi-way stop intersection is obtained. If the planned travel path of the AV through the multi-way stop intersection satisfies a set of one or more clearance criteria, the AV proceeds past the primary stopline. The clearance criteria include a criterion that is satisfied in response to detecting the AV is clear to safely merge into a travel lane corresponding to the planned travel path.
1. A system, comprising:
one or more computer processors; and
one or more non-transitory storage media storing instructions which, when executed by the one or more computer processors while a first vehicle is operating in an autonomous mode, cause performance of operations comprising:
detecting the first vehicle is at a primary stopline of a multi-way stop intersection;
obtaining a planned travel path through the multi-way stop intersection; and
in response to detecting that the first vehicle is at a primary stopline of a multi-way stop intersection:
detecting one or more other vehicles at one or more tertiary stoplines of the multi-way stop intersection; and
in accordance with i) a determination that the planned travel path of the first vehicle through the multi-way stop intersection satisfies a set of one or more clearance criteria, and ii) a determination that the first vehicle has a higher precedence than the one or more other vehicles at the one or more tertiary stoplines of the multi-way stop intersection, instructing the first vehicle to proceed past the primary stopline and stop at a secondary stopline before entering the multi-way stop intersection to indicate an intent of the first vehicle to proceed through the multi-way stop intersection, wherein the set of one or more clearance criteria include a criterion that is satisfied in response to detecting the first vehicle is clear to safely merge into a travel lane corresponding to the planned travel path.
2. The system of claim 1 , wherein detecting the first vehicle is clear to safely merge into the travel lane includes detecting the first vehicle does not block an expected travel path of another vehicle.
3. The system of claim 2 , wherein the first vehicle does not block the expected travel path of another vehicle when the another vehicle is not expected to change speed by more than a threshold change in speed.
4. The system of claim 1 , wherein detecting the first vehicle is clear to safely merge into the travel lane includes detecting a distance between the first vehicle and another vehicle in the travel lane is greater than a threshold distance.
5. The system of claim 2 , wherein the expected travel path of the another vehicle corresponds to a potential travel path of an undetected vehicle.
6. The system of claim 1 , wherein the secondary stopline corresponds to an edge of the multi-way stop intersection.
7. The system of claim 1 , wherein the instructions further cause performance of operations comprising:
after instructing the first vehicle to proceed past the primary stopline:
detecting one or more other vehicles at one or more tertiary stoplines of the multi-way stop intersection; and
in accordance with a determination that the first vehicle has a higher precedence than the one or more other vehicles at the one or more tertiary stoplines of the multi-way stop intersection and in accordance with the determination that the planned travel path of the first vehicle through the multi-way stop intersection satisfies the set of one or more clearance criteria, instructing the first vehicle to proceed past the secondary stopline.
8. The system of claim 1 , wherein the instructions further cause performance of operations comprising:
detecting one or more other vehicles with expected travel paths that do not intersect with the travel lane of the first vehicle; and
filtering the one or more other vehicles from the determination that the planned travel path of the first vehicle through the multi-way stop intersection satisfies a set of one or more clearance criteria.
9. The system of claim 1 , wherein the set of one or more clearance criteria include a criterion that is not satisfied if another vehicle with a speed more than a threshold speed is detected approaching the multi-way stop intersection.
10. A method, comprising:
while a first vehicle is operating in an autonomous mode:
detecting, using a processing circuit, the first vehicle is at a primary stopline of a multi-way stop intersection;
obtaining, using the processing circuit, a planned travel path through the multi-way stop intersection; and
in response to detecting that the first vehicle is at a primary stopline of a multi-way stop intersection:
detecting one or more other vehicles at one or more tertiary stoplines of the multi-way stop intersection; and
in accordance with: i) a determination that the planned travel path of the first vehicle through the multi-way stop intersection satisfies a set of one or more clearance criteria, and ii) a determination that the first vehicle has a higher precedence than the one or more other vehicles at the one or more tertiary stoplines of the multi-way stop intersection, instructing, using a control circuit, the first vehicle to proceed past the primary stopline and stop at a secondary stopline before entering the multi-way stop intersection to indicate an intent of the first vehicle to proceed through the multi-way stop intersection, wherein the set of one or more clearance criteria include a criterion that is satisfied in response to detecting the first vehicle is clear to safely merge into a travel lane corresponding to the planned travel path.
11. The method of claim 10 , wherein detecting the first vehicle is clear to safely merge into the travel lane includes detecting the first vehicle does not block an expected travel path of another vehicle.
12. The method of claim 11 , wherein the first vehicle does not block the expected travel path of another vehicle when the another vehicle is not expected to change speed by more than a threshold change in speed.
13. The method of claim 10 , wherein detecting the first vehicle is clear to safely merge into the travel lane includes detecting a distance between the first vehicle and another vehicle in the travel lane is greater than a threshold distance.
14. The method of claim 10 , wherein the secondary stopline corresponds to an edge of the multi-way stop intersection.
15. One or more non-transitory storage media storing instructions which, when executed by one or more computing devices while a first vehicle is operating in an autonomous mode, cause performance of operations comprising:
detecting, using a processing circuit, the first vehicle is at a primary stopline of a multi-way stop intersection;
obtaining, using the processing circuit, a planned travel path through the multi-way stop intersection; and
in response to detecting that the first vehicle is at a primary stopline of a multi-way stop intersection:
detecting one or more other vehicles at one or more tertiary stoplines of the multi-way stop intersection; and
in accordance with: i) a determination that the planned travel path of the first vehicle through the multi-way stop intersection satisfies a set of one or more clearance criteria, and ii) a determination that the first vehicle has a higher precedence than the one or more other vehicles at the one or more tertiary stoplines of the multi-way stop intersection, instructing, using a control circuit, the first vehicle to proceed past the primary stopline and stop at a secondary stopline before entering the multi-way stop intersection to indicate an intent of the first vehicle to proceed through the multi-way stop intersection, wherein the set of one or more clearance criteria include a criterion that is satisfied in response to detecting the first vehicle is clear to safely merge into a travel lane corresponding to the planned travel path.