Pseudo-Kinematic Trajectory Control and Planning of Tracked Vehicles
Michele Focchi, Daniele Fontanelli, Davide Stocco, Riccardo Bussola, Luigi Palopoli
TL;DR
This work tackles the challenge of accurate navigation for tracked vehicles across soft and sloped terrains by combining a faithful distributed-parameter terramechanics simulator with a control-oriented pseudo-kinematic model and a Lyapunov-based tracking controller. It introduces ML-based estimators for lateral and longitudinal slip, links slip parameters to the dynamic model, and develops a spectrum of slippage-aware planning methods—from closed-form Dubins and clothoids to an optimization-based planner. The approach yields certifiable tracking guarantees and improved real-world performance compared with traditional unicycle controllers, demonstrated through extensive simulations and indoor experiments on MaxxII and LIMO platforms under flat and inclined conditions. The framework enables tractable, slippage-aware navigation and planning, with practical implications for precision agriculture and terrain-robust robotic operation, while also outlining pathways for outdoor validation and advanced perception-driven parameter estimation.
Abstract
Tracked vehicles distribute their weight continuously over a large surface area (the tracks). This distinctive feature makes them the preferred choice for vehicles required to traverse soft and uneven terrain. From a robotics perspective, however, this flexibility comes at a cost: the complexity of modelling the system and the resulting difficulty in designing theoretically sound navigation solutions. In this paper, we aim to bridge this gap by proposing a framework for the navigation of tracked vehicles, built upon three key pillars. The first pillar comprises two models: a simulation model and a control-oriented model. The simulation model captures the intricate terramechanics dynamics arising from soil-track interaction and is employed to develop faithful digital twins of the system across a wide range of operating conditions. The control-oriented model is pseudo-kinematic and mathematically tractable, enabling the design of efficient and theoretically robust control schemes. The second pillar is a Lyapunov-based feedback trajectory controller that provides certifiable tracking guarantees. The third pillar is a portfolio of motion planning solutions, each offering different complexity-accuracy trade-offs. The various components of the proposed approach are validated through an extensive set of simulation and experimental data.
