Pro-active trajectory tracking control for automated driving during elevation transitions

A system comprising:

• one or more sensors configured to at least facilitate obtaining dynamic measurements and path information for a vehicle;
• one or more location systems configured to at least facilitate obtaining location data pertaining to a location of the vehicle;
• a computer memory configured to store map data pertaining to a path corresponding to the location;
• and
• a processor configured to at least facilitate:
• generating an elevation profile along the path using the sensor data and the map data;
• and
• providing instructions for controlling the vehicle using the elevation profile.

A vehicle comprising:

• a body;
• a propulsion system configured to generate movement of the body;
• one or more sensors disposed onboard the vehicle and configured to at least facilitate obtaining sensor data for the vehicle;
• one or more location systems configured to at least facilitate obtaining location data pertaining to a location of the vehicle;
• a computer memory configured to store map data pertaining to a path corresponding to the location;
• and
• a processor disposed onboard the vehicle and configured to at least facilitate:
• generating an elevation profile along the path using the sensor data and the map data;
• and
• providing instructions for controlling the vehicle using the elevation profile.