SYSTEMS AND METHODS FOR SPEED AND LANE ADVISORY

Systems and methods for speed and lane advisory are provided. In one embodiment, a method includes determining a host longitudinal position in a current lane. The method includes identifying at least one candidate lane adjacent the current lane. The method includes calculating a longitudinal maneuver distance for the host agent to execute a maneuver from the current lane to a candidate. The method includes calculating an augmented minimum distance by combining a predetermined minimum distance and the longitudinal maneuver distance. The method includes calculating a current lane headway distance for the current lane and a first candidate lane headway distance for the first candidate lane. The method includes selecting a target lane from a current lane or a candidate lane based on a comparison of the current lane headway distance and the first candidate lane headway distance and controlling the host agent based on the selection of the target lane.