We present a model predictive control (MPC) framework for efficient navigation of mobile robots in cluttered environments. The proposed approach integrates a finite-segment shortest path planner into the finite-horizon trajectory optimization of the MPC. This formulation ensures convergence to dynamically selected targets and guarantees collision avoidance, even under general nonlinear dynamics and cluttered environments. The approach is validated through hardware experiments on a small ground robot, where a human operator dynamically assigns target locations that a robot should reach while avoiding obstacles. The robot reached new targets within 2-3 seconds and responded to new commands within 50 ms to 100 ms, immediately adjusting its motion even while still moving at high speeds toward a previous target.
@article{arxiv.2509.15917,
title = {An MPC framework for efficient navigation of mobile robots in cluttered environments},
author = {Johannes Köhler and Daniel Zhang and Raffaele Soloperto and Andrea Carron and Melanie Zeilinger},
journal= {arXiv preprint arXiv:2509.15917},
year = {2026}
}
Comments
- Code available at: https://github.com/IntelligentControlSystems/ClutteredEnvironment - Supplementary video: https://youtu.be/Hn_hpAmGgq0