MPC-based motion planning for non-holonomic systems in non-convex domains
Matthias Lorenzen, Teodoro Alamo, Martina Mammarella, Fabrizio Dabbene · 2025
Read MPC-based motion planning for non-holonomic systems in non-convex domains by Matthias Lorenzen, Teodoro Alamo, Martina Mammarella, Fabrizio Dabbene (2025) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2510-18402.txt.
Introduction
Matthias Lorenzen, joined by Teodoro Alamo, Martina Mammarella, and Fabrizio Dabbene, studies motion planning for mobile robots that cannot move sideways, such as wheeled vehicles. Model predictive control, which repeatedly plans a short stretch of motion and then replans, is popular for this job. Most theory behind it, though, quietly assumes the robot can move in any direction and that the allowed region is convex, meaning free of dents and blocked pockets.
Real spaces break both assumptions, so proofs that a robot will always reach its target have been scarce. The authors present a new formulation of the control method built for non-holonomic robots in non-convex spaces. Under stated conditions that can be checked in realistic settings, their version guarantees the robot converges to the desired target, closing a gap between daily practice and formal proof.
Catalog record
| CREATOR | Matthias Lorenzen, Teodoro Alamo, Martina Mammarella, Fabrizio Dabbene |
|---|---|
| YEAR | 2025 |
| COLLECTION | PAPERS |
| FORMAT | TXT |
| FILE SIZE | 33 KB |
| VERSION | 1.0 |
| LICENSE | http://creativecommons.org/licenses/by/4.0/ |
| RIGHTS | CC BY |
| SOURCE | arXiv |
Source: https://arxiv.org/abs/2510-18402
Browse the full library · About the Tower of Babel
Full text
The opening of the work, from the library's hosted text:
MPC-based motion planning for non-holonomic systems in non-convex domains Matthias Lorenzen, Teodoro Alamo, Martina Mammarella, Fabrizio Dabbene Abstract Motivated by the application of using model predictive control (MPC) for motion planning of autonomous mobile robots, a form of output tracking MPC for non-holonomic systems and with non-convex constraints is studied. Although the advantages of using MPC for motion planning have been demonstrated in several papers, in most of the available fundamental literature on output tracking MPC it is assumed, often implicitly, that the model is holonomic and generally the state or output constraints must be convex. Thus, in application-oriented publications, empirical results dominate and the topic of proving completeness, in particular under which assumptions the target is always reached, has received comparatively little attention. To address this gap, we present a novel MPC formulation that guarantees convergence to the desired target under realistic assumptions, which can be verified in relevant real-world scenarios. I Introduction Model predictive control (MPC) has proven effective beyond classical process control tasks, showing, among other areas, particular promise for mobile robot motion planning in unstructured or dynamic environments. A broad body of work has addressed path following, trajectory tracking or guaranteed obstacle avoidance. Results have been derived for dynamic obstacles, e.g., [ 1 , 2 ] , under uncertainty, e.g., [ 2 , 3 ] , and on numerically efficient re-formulations of the collision avoidance constraints either through approximations, e.g., [ 4 , 5 ] , or exact formulations, e.g., [ 6 , 7 ] . Nonetheless, deriving an MPC-based algorithm that guarantees target reaching under non-restrictive assumptions has received far less attention. Classical MPC convergence proofs typically rely on a terminal constraint, which would often result in a too long prediction horizon and therefore is frequently omitted in practice. A widespread implementation can be found in the ROS2 software package NAV2 [ 8 ] , which, e.g., implements as local controller the MPC algorithm presented in [ 9 ] . However, without a suitable terminal constraint, most algorithms have a local and greedy nature, and thus can easily get trapped in local minima, as shown, e.g., in [ 10 ] . Moreover, many general output tracking MPC formulations, e.g., [ 11 ] , crucially rely on convex constraints, which is generally violated in the presence of obstacles. To circumvent this, attempts to handle obstacle avoidance using penalty methods have shown promising results in [ 12 ] , but offer no strict guarantees on collision avoidance and target reaching. In [ 13 ] , the authors extend the results to solve the related problem of path following for constrained systems. For exactly followable paths, convergence to the path and reaching of the goal is proven. Furthermore, different simulation results suggest that the outcome suitably extends if the path is not exactly followable due to, e.g., obstacles or discontinuities. The output-tracking MPC algorithm presented in [ 14 ] can be used for robot navigation with guaranteed convergence to the target. However, the online optimization includes solving a global path planning problem, which significantly increases the complexity and is only tractable in very simple scenarios. In contrast to the above cited papers, we present an algorithm which guarantees convergence to the target under hard state and input constraints, including obstacle avoidance, without the need to solve the global path planning problem at each iteration or assumptions which cannot be verified in the considered application. The main novelty and key concept is a different formulation of the optimization problem that includes an artificial reference tied to a reference path. While the results apply to general output tracking MPC, we focus on the application to motion planning of autonomous mobile robots. The remainder of the paper is structured as follows. Section II introduces the robot motion planning problem and definitions. Section III presents the proposed MPC scheme alongside theoretical guarantees. Simulation results in Section IV illustrate the main advantages, and concluding remarks are given in Section V . II Problem Setup The goal is to derive a control strategy to move an autonomous mobile robot (AMR) from an initial pose to a target pose while respecting kinematic and dynamic constraints and avoiding collisions with obstacles. To solve this intricate task, a layered approach is usually taken, see, e.g., [ 8 ] . A global planner generates a reference path based on a map of the environment and a simplified robot model. Several algorithms exist to this end, e.g., the well known A ∗ , D ∗ , or RRT algorithms (see [ 15 ] for an overview). In a second layer, running at a higher frequency, this path is refined by a reactive local planner, based on the observed environment. The final motor commands are then computed by low-level controllers. In this paper, we address the middle layer, deriving a local planning and control algorithm. The discrete-time, nonlinear dynamic system is given by x_{k+1}=f(x_{k},u_{k}), (1) where f:\mathbb{R}^{{n_{x}}}\times\mathbb{R}^{{n_{u}}}\mapsto\mathbb{R}^{{n_{x}}} is a continuous function, modelling the dynamics of the robot and x_{k}\in\mathbb{R}^{{n_{x}}} and u_{k}\in\mathbb{R}^{{n_{u}}} are the state and input at sampling time k, respectively. To model kinematic and dynamic constraints, e.g., maximum acceleration, velocity, or turn rate, the state and input are assumed to be subject to constraints of the form (x_{k},u_{k})\in\mathbb{Z}, (2) with a non-empty closed set \mathbb{Z}\subset\mathbb{R}^{{n_{x}}+{n_{u}}} . For technical reasons, it is assumed that the projection of \mathbb{Z} onto the input space is compact. To explicitly model obstacle avoidance, we define the footprint of the robot, i.e., the space it occupies, at state x by the set \mathbb{B}(x)\subset\mathbb{R}^{2} . Moreover, we assume that the robot is operated in an environment with N_{o} static obstacles, modelled by the sets \mathbb{O}_{i}\subset\mathbb{R}^{2} , i=[1,N_{o}] . Collision avoidance constraints are then given by \mathbb{B}(x_{k})\cap\mathbb{O}_{i}=\emptyset,\quad\forall i\in[1,N_{o}]. (3) We assume that a global planner provides a reference path p:[0,1]\mapsto\mathbb{R}^{{n_{p}}}, (4) which is a continuous function, where p(0) is the initial configuration of the robot and p(1) is the target configuration. We denote by \mathcal{P} the image of p , i.e., all points of the path. Remark Generally, global path planning algorithms do not produce optimal paths in finite time, especially when kinematic and dynamic constraints are considered. For this reason, we do not aim to track p exactly. Instead, it serves merely as guidance, ensuring that the MPC solution can be appropriately extended beyond the prediction horizon. Next, we introduce the function g:\mathbb{R}^{n_{x}}\mapsto\mathbb{R}^{n_{p}} , mapping the state of the robot to its configuration, and function g_{p}:[0,1]\mapsto\mathbb{R}^{{n_{x}}} , mapping a path variable s\in[0,1] to the corresponding steady state. Assumption 1 The following holds: 1. The function f is continuous, \mathbb{Z} is closed and the projection of \mathbb{Z} onto the input space is compact. 2. The function p is continuous, the start of the path corresponds to the initial configuration of the robot, i.e., p(0)=g(x_{0}) , and the end to the desired target configuration, i.e., p(1)=g(x_{T}) . 3. For each configuration p(s) with s\in[0,1] , there exists a unique corresponding steady state (x_{s},u_{s}) in the interior of \mathbb{Z} such that g(x_{s})=p(s) and \mathbb{B}(x_{s})\cap\mathbb{O}_{i}=\emptyset,\penalty\ \forall i\in[1,N_{o}] . 4. There exists a Lipschitz continuous function g_{p}:[0,1]\mapsto\mathbb{R}^{{n_{x}}} , such that g\circ g_{p}=p , with Lipschitz constant L_{g_{p}} . Note that the assumption related to the reference trajectory being in the interior