CS-MPC: Contraction-Certified Sampling-Based MPC for Nonlinear Systems Under Uncertainty

Yashwanth Kumar NakkaarXiv 2026 · arXiv

TL;DR

CS-MPC (Contraction-Certified Sampling-Based MPC) is a novel control framework that brings rigorous stability and safety guarantees to sampling-based robotics. By embedding contraction-certified feedback within every simulation rollout and adding a "safety filter" layer, it achieves superior tracking performance with up to 20 times fewer samples than standard methods like MPPI, all while maintaining a zero-violation safety record.

What Problem Does This Paper Address?

Robotic systems—from planetary rovers to agile drones—often operate in environments where dynamics are nonlinear and parameters (like gravity or terrain friction) are uncertain. Sampling-based Model Predictive Control (MPC), particularly the popular Model Predictive Path Integral (MPPI) algorithm, is a go-to solution because it can handle complex, non-smooth costs without needing gradients.

However, standard MPPI has three major "pain points":

  1. Sample Inefficiency: Rollouts are typically simulated in "open-loop." If the system is unstable, these trajectories spread out like a shotgun blast, requiring thousands of samples to find a good control update.
  2. Safety as a Suggestion: Safety constraints are usually treated as penalties in the cost function. This "shapes" the sampling but doesn't actually guarantee that the final averaged input is safe to execute.
  3. Lack of Theory: It is notoriously difficult to prove that a sampling-based controller will remain stable or safe with a finite number of samples.

Methods

The authors propose CS-MPC, which introduces a two-layer architecture to solve these issues.

1. The Stability & Performance Layer

Instead of open-loop rollouts, CS-MPC uses contraction-certified tracking feedback inside the simulator.

  • Offline: The researchers use a Riccati recursion to synthesize a time-varying metric and a feedback gain along a reference trajectory. This "certifies" that the nonlinear dynamics will contract (converge) toward the reference.
  • Online: Every sampled rollout uses this feedback. This "bundles" the trajectories tightly around the reference, as shown in the inset of Figure 1. This drastically reduces the number of samples needed to get a meaningful control signal.
Overview of CS-MPC showing the offline certification and online execution layers.

2. The Execution Layer

Before any command is sent to the robot's motors, it must pass through a safety filter.

  • Discrete-Time Control Barrier Functions (DCBF): The controller verifies the input against a safety condition.
  • Quantile Tightening: To account for noise and model uncertainty, the safety boundary is "tightened" based on the probability distribution of prediction errors.
  • Backup Policy: If the optimized input isn't certified as safe, the system automatically falls back to a pre-verified backup maneuver (e.g., a rover steering away from a cliff).

Datasets

The paper evaluates CS-MPC through high-fidelity simulations of three challenging robotic scenarios:

  • Skid-Steer Rover: Navigating moving obstacles on terrain with uncertain slip.
  • Quadrotor: Flying a figure-eight through a field of oscillating spherical obstacles.
  • Asteroid Landing: A spacecraft landing on the asteroid Bennu, facing uncertain gravity, spin, and "minimum-impulse" (on/off) thrusters.

Key Insights and Ideas

  • Feedback is a Sample-Efficiency Tool: The biggest "aha" moment is that closing the loop inside the Monte Carlo simulation prevents the "dispersion" problem of MPPI. This allows the controller to work effectively even with very small sample budgets.
  • Certification over Penalization: By moving safety from the "cost function" to an "execution filter," the authors provide a hard probabilistic guarantee of safety ($Pr(safe) \geq 1 - \delta_{mis}$), which is much more robust for real-world deployment.
  • Bridging the Gap: The paper provides a rare theoretical bridge between the "black-box" nature of sampling-based control and the rigorous proofs of contraction theory. They prove that the tracking error remains bounded even with a finite number of samples.

Key Results

The quantitative improvements over standard MPPI are significant:

  • Efficiency: For the rover, CS-MPC achieved the same tracking accuracy as MPPI while using 7 to 20 times fewer rollouts.
  • Accuracy: For the quadrotor, CS-MPC reduced tracking error by 2 to 4 times compared to MPPI at the same sample budget.
  • Reliability: In 200 Monte Carlo missions across all three test cases, CS-MPC recorded zero safety violations, whereas standard MPPI variants frequently collided with obstacles when sample counts were low.

Limitations and Future Work

  • Fixed Reference: Currently, the contraction metric is synthesized offline for a specific reference trajectory. If the robot needs to radically replan its path online (e.g., to avoid a newly discovered dead-end), the offline certificates might need to be recomputed or adapted.
  • Quantile Calibration: The safety tightening relies on having a good model of the prediction error distribution. While the authors use a conformal calibration approach, this still requires some prior knowledge or data.
  • Computational Complexity: While sample-efficient, the per-rollout cost is slightly higher due to the internal feedback calculation. Future work could look at optimizing this for low-power embedded hardware.

For a deeper dive into the information structure and how sampling relates to state realization, see Figure 2:

Fig. 2. Within-step information structure of Definition 1: sampling statements condition on Fk; one-step state and safety statements condition on Hk, after the input is fixed and before wk is realized.

Summary updated

Abstract

We present contraction-certified sampling-based model predictive control (CS-MPC) for tracking and safety of nonlinear robotic systems under parametric uncertainty, disturbances, and safety constraints that are revealed online. CS-MPC uses a contraction-certified tracking feedback inside every sampled rollout, which concentrates the rollouts around the reference, and an execution layer that verifies the applied input using a quantile-tightened discrete-time control barrier function condition. We derive a verification procedure for nonlinear contraction of the feedback-closed dynamics, and we prove a finite-sample stochastic stability bound and a mission-level probabilistic safety guarantee. We validate CS-MPC in simulation on a rover, a quadrotor, and an asteroid landing. When compared with standard model predictive path integral (MPPI) control, CS-MPC attains the same tracking error with 7 to 20 times fewer rollouts for the rover, and a 2 to 4 times lower tracking error for the quadrotor, with no safety violations in 200 Monte Carlo missions.
BibTeX
@misc{nakka2026cs,
  author = {Yashwanth Kumar Nakka},
  title = {{CS-MPC: Contraction-Certified Sampling-Based MPC for Nonlinear Systems Under Uncertainty}},
  year = {2026},
  eprint = {2611.18390},
  archivePrefix = {arXiv},
  url = {https://arxiv.org/abs/2611.18390},
}
Figure