Systems and method are provided for controlling a vehicle. In one embodiment, a method includes: receiving semantic map data, via a processor, wherein the semantic map data includes traffic light location data, calculating route data using the semantic map data, via a processor; viewing, via a sensing device, a traffic light and assessing a state of the viewed traffic light, via a processor, based on the traffic light location data, and controlling driving of an autonomous vehicle based at least on the route data and the state of the traffic light, via a processor.