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.