COST MAP FUSION FOR LANE SELECTION

Systems and methods of generating lane selection cost maps to control autonomous vehicles are disclosed. An autonomous vehicle system can receive a plurality of cost values from a plurality of components of an autonomous vehicle; generate a lane selection cost map based on the plurality of cost values; determining that the autonomous vehicle should change lanes based on the lane selection cost map; and transmit a command that causes the autonomous vehicle to change lanes responsive to determining that the autonomous vehicle should change lanes.