This paper proposes a novel two-level model predictive control (MPC) speed control algorithm for autonomous vehicles as a successive convex optimization problem focused on both energy use and arrival time. Internal losses such as detailed motor/inverter efficiency and battery loss. as well as external losses. such as wind and grade. https://www.campicon.com/