Abstract:Employing Stochastic Nonlinear Model Predictive Control (SNMPC) for real-time applications is challenging due to the complex task of propagating uncertainties through nonlinear systems. This difficulty becomes more pronounced in high-dimensional systems with extended prediction horizons, such as autonomous vehicles. To enhance closed-loop performance in and feasibility in SNMPCs, we introduce the concept of the Uncertainty Propagation Horizon (UPH). The UPH limits the time for uncertainty propagation through system dynamics, preventing trajectory divergence, optimizing feedback loop advantages, and reducing computational overhead. Our SNMPC approach utilizes Polynomial Chaos Expansion (PCE) to propagate uncertainties and incorporates nonlinear hard constraints on state expectations and nonlinear probabilistic constraints. We transform the probabilistic constraints into deterministic constraints by estimating the nonlinear constraints' expectation and variance. We then showcase our algorithm's effectiveness in real-time control of a high-dimensional, highly nonlinear system-the trajectory following of an autonomous passenger vehicle, modeled with a dynamic nonlinear single-track model. Experimental results demonstrate our approach's robust capability to follow an optimal racetrack trajectory at speeds of up to 37.5m/s while dealing with state estimation disturbances, achieving a minimum solving frequency of 97Hz. Additionally, our experiments illustrate that limiting the UPH renders previously infeasible SNMPC problems feasible, even when incorrect uncertainty assumptions or strong disturbances are present.

Stochastic trajectory optimization for mechanical systems with parametric uncertainties

Non-linear Stochastic Optimal Control of Acceleration Parametrically Excited Systems

Stochastic Optimization of Linear Dynamic Systems with Parametric Uncertainties

Stochastic optimal control for autonomous driving applications via polynomial chaos expansions

Robustness Of Non-Linear Stochastic Optimal Control For Quasi-Hamiltonian Systems With Parametric Uncertainty

Robust Adaptive Iterative Learning Control for Discrete‐time Nonlinear Systems with Both Parametric and Nonparametric Uncertainties

Non-Gaussian Uncertainty Minimization Based Control of Stochastic Nonlinear Robotic Systems

A minimax stochastic optimal semi-active control strategy for uncertain quasi-integrable Hamiltonian systems using magneto-rheological dampers

Trajectory Optimization under Contact Timing Uncertainties

Deterministic Trajectory Optimization through Probabilistic Optimal Control

STOCHASTIC OPTIMAL CONTROL OF UNCERTAIN QUASI-HAMILTONIAN SYSTEMS

A Minimax Stochastic Optimal Control for Bounded-Uncertain Systems

Controlling Multivariable Systems with Significant Uncertainty

Robust Optimal Control for Nonlinear Systems with Parametric Uncertainties via System Level Synthesis

Polynomial mechanics and optimal control

Stochastic Optimization of Large-Scale Parametrized Dynamical Systems

A Multilevel Approach for Stochastic Nonlinear Optimal Control

Distributionally robust uncertainty quantification via data-driven stochastic optimal control

Continuous-time optimal control for trajectory planning under uncertainty

Tube Stochastic Optimal Control for Nonlinear Constrained Trajectory Optimization Problems

A Stochastic Nonlinear Model Predictive Control with an Uncertainty Propagation Horizon for Autonomous Vehicle Motion Control