A Feedback Linearized Model Predictive Control Strategy for Input-Constrained Self-Driving Cars
Cristian Tiriolo, Walter Lucia
TL;DR
This work tackles trajectory tracking for self-driving cars under longitudinal and steering velocity constraints by integrating input-output feedback linearization with a dual-mode Model Predictive Control framework. It derives a linearized two-state output model with state-dependent, time-varying input constraints and proposes a worst-case circular inner approximation to enable tractable MPC while guaranteeing recursive feasibility and uniformly ultimately bounded tracking error within a robust invariant region. The paper converts the resulting optimization into a convex QCQP via polyhedral inner approximations, yielding a real-time solvable problem and providing theoretical guarantees on feasibility and stability. Experimental validation on a Quanser QCar demonstrates improved tracking performance and lower computation times compared with nonlinear MPC and backstepping, with public code availability enhancing reproducibility and adoption.
Abstract
This paper proposes a novel real-time affordable solution to the trajectory tracking control problem for self-driving cars subject to longitudinal and steering angular velocity constraints. To this end, we develop a dual-mode Model Predictive Control (MPC) solution starting from an input-output feedback linearized description of the vehicle kinematics. First, we derive the state-dependent input constraints acting on the linearized model and characterize their worst-case time-invariant inner approximation. Then, a dual-mode MPC is derived to be real-time affordable and ensuring, by design, constraints fulfillment, recursive feasibility, and uniformly ultimate boundedness of the tracking error in an ad-hoc built robust control invariant region. The approach's effectiveness and performance are experimentally validated via laboratory experiments on a Quanser Qcar. The obtained results show that the proposed solution is computationally affordable and with tracking capabilities that outperform two alternative control schemes.
