Using position estimate error bounds for safe vehicle navigation
A system that performs a method is disclosed. The system receives information about a map, which includes information about one or more zones in the map. While navigating a vehicle along a driving path within the map, the system receives information about the location of the vehicle in the map. The system estimates an error bounds of the location of the vehicle, and determines in which of the one or more zones in the map the error bounds is located within. In response to the determination: in accordance with a determination that the error bounds is located within a first zone in the map, the system causes the vehicle to perform a driving operation. In accordance with a determination that the error bounds is located within a second zone of the one or more zones in the map, the system causes the vehicle to perform a different driving operation.
1. A system comprising:
one or more sensors;
one or more processors coupled to the one or more sensors; and
a memory including instructions, which when executed by the one or more processors, cause the one or more processors to perform a method comprising:
receiving information about a map comprising one or more zones; and
while navigating a vehicle along a driving path within the map:
receiving, via the one or more sensors, information about a location of the vehicle in the map;
estimating an error bounds of the location of the vehicle in the map;
determining in which of the one or more zones in the map the error bounds is located within; and
in response to the determination:
in accordance with a determination that the error bounds is located within a first zone of the one or more zones in the map, performing a first driving operation; and
in accordance with a determination that the error bounds is located within a second zone, and not within the first zone, of the one or more zones in the map, performing a second driving operation, different from the first driving operation.
2. The system of claim 1 , wherein:
the one or more zones in the map includes a safe zone and a warning zone;
the first zone is the warning zone;
the first driving operation comprises determining a new driving path, wherein the new driving path navigates the vehicle away from the warning zone and toward the safe zone;
the second zone is the safe zone; and
the second driving operation comprises the vehicle maintaining the driving path.
3. The system of claim 2 , wherein the first driving operation further comprises notifying a third party.
4. The system of claim 1 , wherein:
determining that the error bounds is located within the first zone comprises determining that a partial area of the error bounds is located within the first zone.
5. The system of claim 4 , wherein the partial area of the error bounds is equal to or above a threshold, and the new driving path includes a sharp turn away from the warning zone.
6. The system of claim 5 , wherein the partial area of the error bounds is below the threshold, and the new driving path includes a slight turn away from the warning zone.
7. The system of claim 4 , wherein:
the vehicle is navigating in a forward direction along the driving path within the map;
the partial area of the error bounds is in a front facing direction of the vehicle; and
the new driving path includes reversing away from the warning zone and toward the safe zone.
8. The system of claim 4 , wherein:
the vehicle is navigating in a backward direction along the driving path within the map;
the partial area of the error bounds is in a backward facing direction of the vehicle; and
the new driving path includes driving forward away from the warning zone and toward the safe zone.
9. The system of claim 4 , wherein:
the vehicle is navigating in a backward direction along the driving path within the map;
the partial area of the error bounds is in a backward facing direction of the vehicle; and
the new driving path includes driving forward away from the warning zone and toward the safe zone.
10. The system of claim 4 , wherein the error bounds is smaller than a threshold size, and the new driving path includes a sharp turn away from the warning zone.
11. The system of claim 1 , wherein:
the one or more zones in the map includes a safe zone and a stop zone;
the first zone is the stop zone;
the first driving operation comprises the vehicle entering into an emergency stop mode;
the second zone is the safe zone; and
the second driving operation comprises the vehicle maintaining the driving path.
12. The system of claim 11 , wherein the emergency stop mode comprises stopping the vehicle.
13. The system of claim 12 , wherein the emergency stop mode further comprises activating an indicator in the vehicle.
14. The system of claim 13 , wherein the indicator is one or more of a headlight, a hazard light, a smog light, a horn, a speaker, and an alarm system in the vehicle.
15. The system of claim 11 , wherein the emergency stop mode further comprises notifying a third party.
16. The system of claim 1 , wherein the location of the vehicle in the map comprises the vehicle's position and orientation in the map.
17. The system of claim 1 , wherein the information about the location of the vehicle in the map comprises one or more of GPS information, sensor information, camera information, and dead reckoning information from the vehicle.
18. The system of claim 1 , wherein the driving path is part of an automated parking procedure.
19. A non-transitory computer-readable medium including instructions, which when executed by one or more processors, cause the one or more processors to perform a method comprising:
receiving information about a map comprising one or more zones; and
while navigating a vehicle along a driving path within the map:
receiving, via one or more sensors, information about a location of the vehicle in the map;
estimating an error bounds of the location of the vehicle in the map;
determining in which of the one or more zones in the map the error bounds is located within; and
in response to the determination:
in accordance with a determination that the error bounds is located within a first zone of the one or more zones in the map, performing a first driving operation; and
in accordance with a determination that the error bounds is located within a second zone, and not within the first zone, of the one or more zones in the map, performing a second driving operation, different from the first driving operation.
20. A vehicle comprising:
one or more sensors;
one or more processors; and
a memory including instructions, which when executed by the one or more processors, cause the one or more processors to perform a method comprising:
receiving information about a map comprising one or more zones; and
while navigating a vehicle along a driving path within the map:
receiving, via the one or more sensors, information about a location of the vehicle in the map;
estimating an error bounds of the location of the vehicle in the map;
determining in which of the one or more zones in the map the error bounds is located within; and
in response to the determination:
in accordance with a determination that the error bounds is located within a first zone of the one or more zones in the map, performing a first driving operation; and
in accordance with a determination that the error bounds is located within a second zone, and not within the first zone, of the one or more zones in the map, performing a second driving operation, different from the first driving operation.