System and method for routing using intersection costs
A method includes generating a cost model for routing an autonomous vehicle. The cost model includes, for an intersection, a plurality of costs for distinct maneuvers through the intersection. The cost model is represented as a graph of nodes and edges, the edges having respective edge weights that represent costs in the cost model. Each edge of the representation of the intersection represents a respective maneuver through the intersection. The method further includes, in response to a request to route an autonomous vehicle: selecting a route in accordance with the cost model, wherein the selecting is based at least in part on one of the plurality of costs for the distinct maneuvers through the intersection; and routing the autonomous vehicle in accordance with the selected route.
1. A method of routing autonomous vehicles, comprising:
at a computer system including one or more processors and memory:
generating a cost model for routing an autonomous vehicle, wherein:
the cost model includes, for an intersection, a plurality of costs for distinct maneuvers through the intersection;
the cost model is represented as a graph of nodes and edges, the edges having respective edge weights that represent costs in the cost model;
the intersection is represented as a plurality of the nodes and a plurality of the edges of the graph, wherein each edge of the representation of the intersection represents a respective maneuver through the intersection;
receiving a request to route the autonomous vehicle from a first location to a second location; and
in response to the request to route the autonomous vehicle:
selecting a route from the first location to the second location in accordance with the cost model, wherein the selecting is based at least in part on one of the plurality of costs for the distinct maneuvers through the intersection; and
routing the autonomous vehicle in accordance with the selected route.
2. The method of claim 1 , wherein the plurality of the edges that represent the intersection comprise transition edges that do not have a cost associated with a distance of travel.
3. The method of claim 1 , wherein the plurality of the edges that represent the intersection comprise transition edges that are not associated with a street.
4. The method of claim 1 , wherein the intersection is an intersection of a plurality of roads, each road in the plurality of roads having one or more costs distinct from the plurality of costs of the distinct maneuvers through the intersection.
5. The method of claim 1 , wherein the distinct maneuvers include one or more of a lane change, a right turn, a left turn, an unprotected left turn, a U-turn, and a highway merge.
6. The method of claim 1 , wherein:
the cost model is a first cost model for the autonomous vehicle; and
the method includes:
receiving a request to route a non-autonomous vehicle; and
generating a second cost model for routing the non-autonomous vehicle, wherein the second cost model is distinct from the first cost model and includes a different cost for one or more of the plurality of the edges that represent the intersection;
in response to the request to route the non-autonomous vehicle:
selecting a route for the non-autonomous vehicle in accordance with the second cost model; and
routing the non-autonomous vehicle along the selected route for the non-autonomous vehicle.
7. The method of claim 1 , further comprising, at the computer system, forgoing representation of a forbidden maneuver through the intersection.
8. The method of claim 1 , further including:
producing the graph by modifying an existing graph, the existing graph including a single node representing the intersection, the modifying including replacing the single node with the plurality of the nodes and the plurality of the edges representing the intersection.
9. A computer system, comprising:
one or more processors; and
memory storing one or more programs, the one or more programs storing instructions that, when executed by the one or more processors, cause the computer system to performing a set of operations including:
generating a cost model for routing an autonomous vehicle, wherein:
the cost model includes, for an intersection, a plurality of costs for distinct maneuvers through the intersection;
the cost model is represented as a graph of nodes and edges, the edges having respective edge weights that represent costs in the cost model;
the intersection is represented as a plurality of the nodes and a plurality of the edges of the graph, wherein each edge of the representation of the intersection represents a distinct maneuver through the intersection;
receiving a request to route the autonomous vehicle from a first location to a second location; and
in response to the request to route the autonomous vehicle:
selecting a route from the first location to the second location in accordance with the cost model, wherein the selecting is based at least in part on one of the plurality of costs for the distinct maneuvers through the intersection; and
routing the autonomous vehicle in accordance with the selected route.
10. A non-transitory computer readable storage medium storing instructions that, when executed by a computer system having one or more processors, cause the computer system to perform a set of operations, including:
generating a cost model for routing an autonomous vehicle, wherein:
the cost model includes, for an intersection, a plurality of costs for distinct maneuvers through the intersection;
the cost model is represented as a graph of nodes and edges, the edges having respective edge weights that represent costs in the cost model;
the intersection is represented as a plurality of the nodes and a plurality of the edges of the graph, wherein each edge of the representation of the intersection represents a distinct maneuver through the intersection;
receiving a request to route the autonomous vehicle from a first location to a second location; and
in response to the request to route the autonomous vehicle:
selecting a route from the first location to the second location in accordance with the cost model, wherein the selecting is based at least in part on one of the plurality of costs for the distinct maneuvers through the intersection; and
routing the autonomous vehicle in accordance with the selected route.