- Add boundary constraints for staying on the "map" and staying within operating limits of vehicle inputs - Add helper functions to get indices of things
MPC_Class