Real-time Planning of Minimum-time Trajectories for Agile UAV Flight
Krystof Teissing, Matej Novosad, Robert Penicka, Martin Saska
TL;DR
This work tackles real-time planning of minimum-time UAV trajectories across multiple waypoints by employing a point-mass model with Limited Thrust Decomposition (LTD) to fully utilize collective thrust. It integrates gravity and drag into the planning process and uses a gradient-based optimization to determine waypoint velocities, achieving millisecond-scale computation suitable for onboard NMPC. Key contributions include closed-form solutions for time-optimal PMM segments, axis synchronization, an iterative LTD algorithm, and a gradient-based multi-waypoint velocity optimization, all validated in both simulation and real-world flights with accelerations up to $3.5g$ and speeds over $100\,\text{km/h}$. The approach yields trajectories with comparable or better tracking errors than full-dynamics time-optimal plans, while significantly reducing planning time, and is released as open-source for community use.
Abstract
We address the challenge of real-time planning of minimum-time trajectories over multiple waypoints, onboard multirotor UAVs. Previous works demonstrated that achieving a truly time-optimal trajectory is computationally too demanding to enable frequent replanning during agile flight, especially on less powerful flight computers. Our approach overcomes this stumbling block by utilizing a point-mass model with a novel iterative thrust decomposition algorithm, enabling the UAV to use all of its collective thrust, something previous point-mass approaches could not achieve. The approach enables gravity and drag modeling integration, significantly reducing tracking errors in high-speed trajectories, which is proven through an ablation study. When combined with a new multi-waypoint optimization algorithm, which uses a gradient-based method to converge to optimal velocities in waypoints, the proposed method generates minimum-time multi-waypoint trajectories within milliseconds. The proposed approach, which we provide as open-source package, is validated both in simulation and in real-world, using Nonlinear Model Predictive Control. With accelerations of up to 3.5g and speeds over 100 km/h, trajectories generated by the proposed method yield similar or even smaller tracking errors than the trajectories generated for a full multirotor model.
