Trajectory Distribution Control for Model Predictive Path Integral Control using Covariance Steering

Abstract

This paper presents a novel control approach for autonomous systems operating under uncertainty. We combine Model Predictive Path Integral (MPPI) control with Covariance Steering (CS) theory to obtain a robust controller for general nonlinear systems. The proposed Covariance-Controlled Model Predictive Path Integral (CC-MPPI) controller addresses the performance degradation observed in some MPPI implementations owing to unexpected disturbances and uncertainties. Namely, in cases where the environment changes too fast or the simulated dynamics during the MPPI rollouts do not capture the noise and uncertainty in the actual dynamics, the baseline MPPI implementation may lead to divergence. The proposed CC-MPPI controller avoids divergence by controlling the dispersion of the rollout trajectories at the end of the prediction horizon. Furthermore, the CC-MPPI has adjustable trajectory sampling distributions that can be changed according to the environment to achieve efficient sampling. Numerical examples using a ground vehicle navigating in challenging environments demonstrate the proposed approach.

"Previously titled "Improving Model Predictive Path Integral Using Covariance Steering", this paper is one of the Outstanding Planning Paper Award finalists in ICRA 2022. For associated video, see https://www.youtube.com/watch?v=cZq4tnBTIqc ."

Cited by in corpus (6)

• Smooth Model Predictive Path Integral Control without Smoothing
• Biased-MPPI: Informing Sampling-Based Model Predictive Control by Fusing Ancillary Controllers
• Spatiotemporal Receding Horizon Control with Proactive Interaction Towards Autonomous Driving in Dense Traffic
• Output-Sampled Model Predictive Path Integral Control (o-MPPI) for Increased Efficiency
• Distributed Model Predictive Covariance Steering
• Safety on the Fly: Constructing Robust Safety Filters via Policy Control Barrier Functions at Runtime