REFERENCE TRACKING FOR TWO AUTONOMOUS DRIVING MODES USING ONE CONTROL SCHEME

Systems and methods of using a common control scheme to autonomously controlling a vehicle during two different autonomous driving modes are provided. In particular, embodiments of the presently disclosed technology incorporate reference tracking for driving input and vehicle state into this common control scheme. In some embodiments, this common control scheme may be implemented using Model Predictive Control (MPC).