A method includes identifying, based on grade data of a route of an autonomous vehicle (AV), a segment of the route that has a grade value that meets a threshold grade value. Responsive to identifying the segment, the method further includes generating, based on the grade data and physical vehicle data of the AV, driving constraint data for the segment of the route. The method further includes causing a routing module of the AV to generate, based on the driving constraint data for the segment of the route, short time horizon routing data corresponding to a portion of the segment. The AV is to travel the portion of the segment of the route based on the short time horizon routing data.