A Terrain-Adaptive ϵ \epsilon -Constraint MPC for Uneven Terrain Kinodynamic Planning

Otobong Jerome, Geesara Kalathunga, Tiago Nascimento · 2026

Read A Terrain-Adaptive ϵ \epsilon -Constraint MPC for Uneven Terrain Kinodynamic Planning by Otobong Jerome, Geesara Kalathunga, Tiago Nascimento (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-2605-21188.txt.

Introduction

Otobong Jerome, Geesara Kalathunga, and Tiago Nascimento present an adaptive epsilon-constraint method inside model predictive control for car-like vehicles on uneven ground. Bounds shift with terrain descriptors, letting the planner explore trade-offs between path efficiency and pose stability in real time. A semi-parametric model mixes analytic vehicle dynamics with a sparse Gaussian process learned on the same descriptors. Tests report a ninety-four percent success rate with smaller orientation deviation.

Catalog record

CREATOROtobong Jerome, Geesara Kalathunga, Tiago Nascimento
YEAR2026
COLLECTIONPAPERS
FORMATTXT
FILE SIZE41185
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

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

Browse the full library · About the Tower of Babel

Full text

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

A Terrain-Adaptive ϵ \epsilon -Constraint MPC for Uneven Terrain Kinodynamic Planning Otobong Jerome, Geesara Kalathunga, Tiago Nascimento Abstract Kinodynamic planning for car-like vehicles on uneven terrain requires simultaneously optimizing competing objectives such as path efficiency and pose stability. This work presents an adaptive ϵ \epsilon -constraint method integrated into a Model Predictive Control (MPC) framework, where the ϵ \epsilon bounds are dynamically adjusted based on terrain descriptors to explore the Pareto front in real time. To capture vehicle-terrain dynamics, we develop a semi-parametric model combining analytical vehicle dynamics with a Sparse Gaussian Process (SGP) trained on the same terrain descriptors. The proposed ϵ \epsilon -MPC is evaluated against MPPI and GAKD baselines, achieving a 94 % 94\% navigation success rate while reducing maximum orientation deviation by 24 % 24\% and improving multi-objective trade-off quality by 23 % 23\% . I Introduction Various methods have been proposed for generating triangular meshes from sensor data [ 29 , 30 ] , including applications in large-scale environments. Robotics frameworks such as Move Base Flex (MBF) [ 19 ] offer adaptable tools for creating so-called Navigation Meshes and enabling robot navigation within these environments. However, navigating through complex terrains still poses significant challenges for autonomous robots, especially in unstructured environments such as outdoor construction sites, disaster zones, or planetary exploration. Robust navigation in these settings requires planners that not only compute collision-free paths but also respect the kinodynamic constraints imposed by the robot’s dynamics, including velocity, acceleration limits however accurate vehicle-terrain modelling is challenging due to the effects of the terrain. Traditional mesh planners, such as the continuous vector planner (CVP) [ 20 ] , effectively leverage the Fast Marching Method (FMM) [ 10 ] on multilayer 3D triangular meshes to generate smooth geodesic paths over rough terrains. These planners provide a global, continuous shortest-path vector field that encapsulates detailed terrain attributes such as roughness and elevation. Despite their success in producing terrain-aware geometric paths, they do not explicitly incorporate kinodynamic constraints, limiting their applicability to scenarios where dynamic feasibility is critical. Kinodynamic planning addresses motion planning problems under both kinematic and dynamic constraints. The first polynomial-time, provably good approximation to the solution was presented in [ 2 ] , along with a corresponding complexity analysis. Earlier work also explored solutions using randomized approaches, variants of RRT and RRT⁢, which incorporate kinodynamic cost optimization [ 12 , 4 ] . Recent kinodynamic planning research falls into two main categories: non-data-driven and data-driven approaches. Gradient-free methods like Model Predictive Path Integral (MPPI) control are favoured in the former for managing complex dynamics without explicit gradients. Data-driven methods use models such as Recurrent Neural Networks (RNN) and Deep Reinforcement Learning (DRL) to learn system dynamics and optimize planning in high-dimensional or partially observed settings. Recent advances in DRL have demonstrated potential for learning complex navigation policies in dynamic environments [ 9 , 13 ] , yet several critical limitations persist. Most existing approaches are confined to 2D planning and sparse reward functions, with poor generalization across diverse start-goal configurations. Furthermore, current DRL-based planners lack integration with continuous global guidance structures and do not account for kinodynamic constraints, particularly on uneven terrain. Standard RL reward formulations also fail to capture the multi-objective nature of kinodynamic planning, which can be solved using an \epsilon -constraint methods, where path optimality and physical stability must be jointly considered. Although, \epsilon -constraint methods have been extensively applied in multi-objective optimization research, their use in uneven terrain kinodynamic planning remains under-explored in the existing literature. Hence the contributions of this work are: • A semi-parametric model of car-like vehicle motion on uneven terrain represented as a triangular mesh. • A cost function for mesh navigation based on a continuous vector field. • A solution approach based on terrain-adaptive epsilon-constraint optimization within a receding horizon control framework for generating non-dominated trajectories. • A Robot Operating System (ROS) planner compatible with Move Base Flex (MBF) [ 19 ] . II Related Work \begin{overpic}[drawio.png] \end{overpic} Fig. 1: Flow chart of the proposed kinodynamic planner: A terrain-adaptive \epsilon -constraint optimization is used to find the sequence of controls with that best satisfies both objectives (f_{1},f_{2}) while ensuring all the controls in the sequence are from the space of valid controls. Kinodynamic planning on 3D triangular meshes draws heavily from geodesic computation on triangular meshes. Classic discrete geodesic methods include the MMP [ 16 ] and CH [ 3 ] algorithms (and their variants [ 32 , 21 ] ), known for precision on smaller meshes, alongside the fast marching method (FMM) [ 10 ] and heat method [ 5 ] , which scale better to larger datasets. The more recent edge-flip method [ 25 ] refines geodesic paths via local mesh modifications, though at higher computational cost. Comprehensive surveys of these approaches are provided in [ 1 , 8 ] . Kinodynamic planning on such meshes then requires balancing proximity to the optimal geodesic against the robot’s kinematic and dynamic constraints. Gradient-based kinodynamic planning methods including Sequential Quadratic Programming (SQP) [ 6 ] , Model Predictive Control (MPC) [ 18 ] , Covariant Hamiltonian Optimization for Motion Planning (CHOMP) [ 35 , 22 ] , and Iterative Linear Quadratic Regulator (ILQR) [ 27 ] offer strong convergence properties but face limitations such as sensitivity to initial conditions, local optima trapping, and high online computation costs, particularly in non-linear and non-convex settings. Gradient-free alternatives like Model Predictive Path Integral Control (MPPI) [ 31 ] and Genetic Algorithmic Kinodynamic (GAKD) planning [ 7 ] circumvent these issues by avoiding gradient computations entirely: MPPI evaluates multiple independent control sequences in parallel for broad solution space coverage, while GAKD extends this by replacing cost-weighted trajectory averaging with a genetic algorithm that selects and recombines the best trajectory segments [ 7 ] , enabling robust real-time performance in dynamically challenging environments. However, these methods rely on accurate dynamics models that can be difficult to derive analytically for car-like vehicles on arbitrary 3D mesh terrain; to this end, one contributions of this paper is to provide a semi-parametric approach blending data-driven flexibility with physical structure. Moreover, in MPPI and GAKD, weighted scalarization typically allows the path length objective to dominate the solution, so we propose a cost formulation that prevents this dominance and yields a balanced multi-objective outcome. Reinforcement Learning (RL) has shown promise for mobile robot navigation but faces challenges including sparse rewards, slow convergence, poor generalizability, and limited interpretability. Various hybrid strategies address these limitations, hierarchical architectures combining global planners with local RL agents [ 28 , 33 ] , sensor-based feedback and transfer learning [ 34 , 11 ] , modular designs decoupling deep learning components [ 24 , 26 ] , and attention mechanisms for improved interpretability [ 9 ] , with a comprehensive review available in [ 23 ] . However, these approaches are predominantly designed for 2D planar environments or rely on elevation maps that do not fully capture the intricacies of uneven 3D mesh terrain. Hence, there is a need for a planner that explicitly addresses the inherent multi-objective nature of kinodynamic planning, balancing path optimality against physical stability, while generalizing to unseen uneven terrain configurations. The \epsilon -constraint method is a classical technique in

Read the complete text