Accelerated Spline-Based Time-Optimal Motion Planning with Continuous Safety Guarantees for Non-Differentially Flat Systems

Dries Dirckx, Jan Swevers, Wilm Decré · 2026

Read Accelerated Spline-Based Time-Optimal Motion Planning with Continuous Safety Guarantees for Non-Differentially Flat Systems by Dries Dirckx, Jan Swevers, Wilm Decré (2026) 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-2603-24133.txt.

Introduction

Dirckx and co-authors speed up time-optimal motion planning for mobile robots with spline paths. Coupled methods put separating hyperplane variables inside one big control problem, which costs much compute. Their method decides the hyperplanes apart from the main problem, as a classification task solved by a linear system or quadratic program. That turns non-convex limits into linear ones and keeps continuous safety guarantees. In obstacle-rich tests, planning time falls by up to almost 60 percent versus fully coupled methods, they report.

Catalog record

CREATORDries Dirckx, Jan Swevers, Wilm Decré
YEAR2026
COLLECTIONPAPERS
FORMATTXT
FILE SIZE25563
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

Source: https://arxiv.org/abs/2603.24133

Browse the full library · About the Tower of Babel

Full text

The opening of the work, from the library's hosted text:

Accelerated Spline-Based Time-Optimal Motion Planning with Continuous Safety Guarantees for Non-Differentially Flat Systems Dries Dirckx, Jan Swevers, Wilm Decré Abstract Generating time-optimal, collision-free trajectories for autonomous mobile robots involves a fundamental trade-off between guaranteeing safety and managing computational complexity. State-of-the-art approaches formulate spline-based motion planning as a single Optimal Control Problem (OCP) but often suffer from high computational cost because they include separating hyperplane parameters as decision variables to enforce continuous collision avoidance. This paper presents a novel method that alleviates this bottleneck by decoupling the determination of separating hyperplanes from the OCP. By treating the separation theorem as an independent classification problem solvable via a linear system or quadratic program, the proposed method eliminates hyperplane parameters from the optimisation variables, effectively transforming non-convex constraints into linear ones. Experimental validation demonstrates that this decoupled approach reduces trajectory computation times up to almost 60% compared to fully coupled methods in obstacle-rich environments, while maintaining rigorous continuous safety guarantees. I Introduction: Autonomous Motion Planning Autonomous Mobile Robots (AMRs) have become indispensable in modern industrial domains, ranging from material transport in workshops and e-commerce warehouses to agricultural applications. Currently, safety is assured by either separating robots and humans in dedicated tracks or imposing tight limits the forward velocity. To further their applicability and ease their deployment, these robots have to navigate vast, dynamic, and uncertain spaces. The primary challenge herein lies in generating trajectories that are not only cost-efficient, e.g., time-optimal, and physically feasible but also guaranteed to be safe at every time instant. This brings about a fundamental trade-off in motion planning between guaranteeing safety, optimality and the computational cost in finding such a trajectory. Traditionally, autonomous navigation is tackled through a decoupled approach, splitting the task into geometric path planning (ignoring system dynamics) followed by trajectory tracking [ 4 , 8 ] . While computationally efficient, this separation often yields suboptimal results or infeasible paths because the planner neglects the vehicle’s kinodynamic limits imposed by the tracking controller. Conversely, recent coupled approaches formulate motion planning as an optimisation problem [ 14 , Schoels2020 ] , yielding better performance and formal safety guarantees but at a higher computational complexity. This paper aims to alleviate the computational load for a specific class of those methods, spline-based motion planners, while maintaining guarantees on continuous collision avoidance. II Related Work Infinite-dimensional OCPs are usually transcribed into a finite-dimensional Nonlinear Program (NLP) through time-gridding methods, such as multiple shooting, single shooting or direct collocation [ 5 ] . They however often suffer from a trade-off between computational cost and safety. Coarse grids allow inter-interval safety violation but are cheap to solve, while fine grids result in computational loads that real-time applicability. Schulman et al. [ 11 ] address that trade-off for a path planning algorithm by penalising the signed distance of the swept volume of the robot’s convex hull to the obstacles with an exact \ell_{1} -penalty. Sundaralingam et al. [ curobo ] implement a similar but parallellisable procedure sweeping spheres over a single interval, allowing to guarantee continuous collision avoidance with respect to neural-network or voxel world representations. These methods either form a conservative approximation of the rotation of the robot over a single interval or limit the geometric representation of the robot to spheres. Currently, Control Barrier Functions (CBF) are a popular technique to guarantee safety through the definition of forward invariant safe sets. Once a system is inside the safe set, future system states remain inside the safe set if the control inputs adhere to the CBF. Several methods have formulated a CBF for guaranteed collision avoidance in Model Predictive Control (MPC), using the Minkowski difference [ 2 ] or a convex optimisation problem [ 15 ] for polytopes, or via polynomial approximations of polygonal shapes [ 13 ] . II-A Spline Parameterisations A subset of direct collocation methods parametrise the states and/or controls as splines over a single interval or over the full horizon. The distinct advantage of this approach lies in the convex hull property of splines. This property ensures that if the coefficients of a spline satisfy a set of bounds, the entire continuous trajectory satisfies those bounds. It effectively eliminates the risk of constraint violation between time steps, while simultaneously allowing for coarse discretisation. Mercy et al. [ 12 ] employ a full-horizon B-spline parameterisation for differentially flat systems and incorporate obstacle avoidance using the concept of separating hyperplanes. Vandewal et al. [ 16 ] extend [ 12 ] to non-differentially flat systems with Bernstein basis functions and link the Bernstein coefficients to the Runge-Kutta integration scheme. Their method allows polynomial parametrisation over a single control interval instead of over the full horizon as [ 12 ] . Both methods consider the hyperplane parameters as decision variables within the OCP. While this provides more numerical freedom to the optimisation solver, it introduces extra optimisation variables and non-convex, bi-linear constraints, rendering the OCP harder and more costly to solve. II-B Contributions This paper presents a novel approach that aims to alleviate this computational bottleneck, applied to the domain of time-optimal motion planning. The determination of the separating hyperplanes is decoupled from the OCP, and instead executed using Least-Squares Support Vector Machine classification problems. It reduces the complexity of the optimisation problem while maintaining the rigorous safety guarantees provided by spline parameterisation. This work extends the results in [ 6 ] to the domain of spline-based motion planning and further improving its computational complexity by adopting a smooth minimum approximation. Section III firstly covers the Bernstein collocation method to create piecewise polynomial state trajectories and guarantee continuous collision avoidance. Section IV introduces the transformation of the decoupled method to spline-based motion planning and lastly, Section V details the experimental results and benchmark. III Spline-based Motion Planning Consider a system with states \bm{x}\in\mathcal{X}\subseteq\mathbb{R}^{l} and \bm{u}\in\mathcal{U}\subseteq\mathbb{R}^{q} , described by a continuous-time dynamical model: \dot{\bm{x}}=\bm{f}(\bm{x},\bm{u},t), (1) where \bm{f} is a continuous function. In time-optimal motion planning, the goal is to reach a specific target state \bm{x}_{T} from an initial state \bm{x}_{0} in the shortest time T possible. Additionally, the system often has to adhere to bounds on its states and controls such as velocity or acceleration limits, detailed as: \displaystyle\bm{\underline{x}}\leq\bm{x}\leq\bm{\bar{x}}, (2) \displaystyle\bm{\underline{u}}\leq\bm{u}\leq\bm{\bar{u}}. (3) III-A Collision Avoidance between Polytopes In this work, the robot’s geometry is a circle and each of the N_{o} obstacles is a polytope. Suppose each obstacle is described by a set \mathcal{O}=\{\,\bm{v}_{j}\mid\bm{v}_{j}\in V_{o}\,\} where V_{o} contains all the vertices of that obstacle’s polytope. The separating hyperplane theorem expresses that the robot and a single obstacle do not overlap if there exists a hyperplane such that: \displaystyle\bm{w}_{l}^{\top}\bm{v}_{r}(\bm{x})+b_{l} \displaystyle\geq\epsilon+r_{v}, (4) \displaystyle\bm{w}_{l}^{\top}\bm{v}_{j}+b_{l} \displaystyle<0, (5) where l\in[1,N_{o}] , \bm{w}_{l}\in\mathbb{R}^{n_{y}} is the normal vector of the hyperplane in n_{y} -dimensional space, b_{l}\in\mathbb{R} is the hyperplane’s offset, \bm{v}_{r} ( \bm{x} ) the state-dependent robot centre, r_{v} the radius of the sphere and \epsilon is a safety margin. For each robot-obstacle pair, a set of parameters \bm{w}_{l} and b_{l} should exist to state that the robot is collision-free. III-B Optimal Control for Time-Optimal Motion Planning All the aforementioned components together lead to the subsequent continuous-time OCP for time-optimal motion planning, with the hyperplane parameters for all robot-obstacle pairs considered as optimisation variables: \displaystyle{}\centering\underset{\begin{subarray}{c}\bm{x},\bm{u},T,\\ \bm{w},\bm{b}\end{subarray}}{\textbf{minimise}} \displaystyle T+\alpha\int_{0}^{T}\ell(\bm{x},\bm{u},T)dt (6) \displaystyle\textbf{subject

Read the complete text