A Step-by-step Guide on Nonlinear Model Predictive Control for Safe Mobile Robot Navigation

Dennis Benders, Laura Ferranti, Johannes KöhlerarXiv 2025 · arXiv · OpenReview

Abstract

Designing a model predictive control (MPC) scheme that enables a mobile robot to safely navigate through an obstacle-filled environment is a complicated yet essential task in robotics. In this technical report, safety refers to ensuring that the robot respects state and input constraints while avoiding collisions with obstacles despite the presence of disturbances and measurement noise. This report offers a step-by-step approach to implementing nonlinear model predictive control (NMPC) schemes addressing these safety requirements. It focuses specifically on NMPC as a foundation for safe mobile robot navigation, providing a practical path from theoretical concepts to mathematical proofs and implementation.

Introduction

While Nonlinear Model Predictive Control (NMPC) is a powerful tool for robot navigation, a significant gap often exists between theoretical formulations and real-world implementation. In practice, robots encounter disturbances (e.g., wind, uneven terrain) and measurement noise from imperfect sensors. Without accounting for these uncertainties, an NMPC scheme may lead to "infeasible" states—mathematical dead-ends where no safe path forward exists, potentially resulting in collisions. This report serves as a pedagogical bridge, providing a framework to guarantee recursive feasibility (ensuring a safe path always exists) and stability (ensuring the target is reached) under realistic conditions.

Methodology: A Three-Stage Design

The NMPC design is structured into three progressive levels of complexity:

  1. Tracking MPC (Nominal): This baseline assumes a perfect model. It introduces "terminal ingredients"—a terminal cost, a terminal control law, and a terminal set. These components act as a "safe harbor" at the end of the finite prediction horizon, ensuring the optimization problem remains solvable indefinitely.
  2. Robust MPC (Disturbances): This stage introduces unknown but bounded external disturbances. The authors employ Constraint Tightening, creating a "buffer zone" or tube around the planned trajectory to account for potential deviations.
  3. Robust Output-Feedback MPC (Noise + Disturbances): The most advanced case addresses scenarios where the robot's state must be estimated via an observer. A second layer of constraint tightening is added to compensate for estimation errors.
Illustration of recursive feasibility and terminal ingredients in NMPC over multiple time steps. The figure shows how the optimized trajectory and terminal sets evolve to ensure continuous safety.

A critical component of this methodology is the use of Control Contraction Metrics (CCMs). By solving Linear Matrix Inequalities (LMIs), a metric is derived that guarantees the robot's actual trajectory will "contract" toward the desired reference, allowing for formal quantification of safety buffer sizes.

Theoretical Insights

  • The "Safe Harbor" Concept: NMPC safety depends on the state at the end of the prediction horizon. The "terminal set" defines a region where a simple auxiliary controller can maintain safety indefinitely.
  • Dynamic Tightening: Unlike rigid tube MPC, this approach allows safety buffers to grow over the horizon, reflecting increasing uncertainty over time.
  • Geometric-Control Integration: The framework converts non-convex collision-free spaces into sequences of convex polytopic constraints, enabling efficient real-time optimization.
  • Observer-Aware Safety: Safety margins explicitly incorporate observer error; higher sensor noise necessitates larger safety buffers.

Results and Guarantees

The report provides rigorous mathematical proofs for Recursive Feasibility and Asymptotic Convergence across all three control levels. It offers concrete "design recipes" using Semi-Definite Programs (SDPs) to pre-compute optimal control gains ($K$) and safety tube shapes ($P$). While noise may prevent perfect target tracking, the error is guaranteed to remain within a calculable bound proportional to noise and disturbance levels.

Limitations and Future Work

Despite its strengths, the approach faces challenges:

  • Computational Complexity: Solving LMIs and SDPs for high-degree-of-freedom robots can be expensive.
  • Conservatism: Polytopic approximations and fixed tubes may lead to overly cautious behavior in narrow passages.
  • Dynamic Environments: Current proofs assume moving obstacles can be over-approximated by known sets. Handling highly unpredictable, reactive agents like humans remains a key area for future research.

Summary updated

Abstract

Designing a model predictive control (MPC) scheme that enables a mobile robot to safely navigate through an obstacle-filled environment is a complicated yet essential task in robotics. In this technical report, safety refers to ensuring that the robot respects state and input constraints while avoiding collisions with obstacles despite the presence of disturbances and measurement noise. This report offers a step-by-step approach to implementing nonlinear model predictive control (NMPC) schemes addressing these safety requirements. Numerous books and survey papers provide comprehensive overviews of linear MPC (LMPC), NMPC, and their applications in various domains, including robotics. This report does not aim to replicate those exhaustive reviews. Instead, it focuses specifically on NMPC as a foundation for safe mobile robot navigation. The goal is to provide a practical and accessible path from theoretical concepts to mathematical proofs and implementation, emphasizing safety and performance guarantees. It is intended for researchers, robotics engineers, and practitioners seeking to bridge the gap between theoretical NMPC formulations and real-world robotic applications. This report is not necessarily meant to remain fixed over time. If someone finds an error in the presented theory, please reach out via the given email addresses. We are happy to update the document if necessary.
BibTeX
@misc{benders2025step,
  author = {Dennis Benders and Laura Ferranti and Johannes Köhler},
  title = {{A Step-by-step Guide on Nonlinear Model Predictive Control for Safe Mobile Robot Navigation}},
  year = {2025},
  eprint = {2507.17856},
  archivePrefix = {arXiv},
  url = {https://arxiv.org/abs/2507.17856},
}
Figure