Simple Trajectory Smoothing for UAV Reference Path Planning Based on Decoupling, Spatial Modeling and Linear Programming

Mogens Plessen* · 2026

Read Simple Trajectory Smoothing for UAV Reference Path Planning Based on Decoupling, Spatial Modeling and Linear Programming by Mogens Plessen* (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-21713.txt.

Introduction

Plessen presents a simple method to smooth flight paths for unmanned aerial vehicles. The method builds on a Dubins airplane model of the craft's motion. A decoupling step yields direct control laws for flight path angle and speed. Only roll angle control needs an optimization step, and that step is a small linear program. Two variants differ in how they track a reference centerline and shape the path. Plessen also outlines extensions to aerobatic flight and to tractor path planning over 3D terrain. Simulations validate the approach.

Catalog record

CREATORMogens Plessen*
YEAR2026
COLLECTIONPAPERS
FORMATTXT
FILE SIZE30329
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

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

Browse the full library · About the Tower of Babel

Full text

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

Simple Trajectory Smoothing for UAV Reference Path Planning Based on Decoupling, Spatial Modeling and Linear Programming Mogens Plessen* Abstract A method for trajectory smoothing for UAV reference path planning is presented. It is derived based on the dynamics of a Dubins airplane model, and involves a decoupling step, spatial modeling and linear programming. The decoupling step enables algebraic control laws for flight-path angle and speed control. Only for roll angle control an optimization step is applied, involving the solution of a small linear program. Two variations are discussed. They differ by reference centerline tracking and the introduction of a path shaping constraint. The benefit of natural dimensionality reduction for spatial modeling is discussed. The simplicity of the overall method is highlighted. An extension to acrobative flight is outlined, which comes at the cost of a model approximation, however at the gain of maintaining the general model structure. An extension of the method to tractor path planning along 3D terrain is discussed. The method is validated in simulations. I Introduction In 2D, a Dubins path [ 5 , 24 ] connects a start and end pose (position and heading) along the shortest possible path. This path is composed of 2 arcs of minimimum turning radius of the vehicle and a straight-line segment. In 3D, for the equivalent problem path planning for Uncrewed Aerial Vehicles (UAVs) is more complex. Depending on the start and end pose there may be an infinite number of paths with minimum pathlength. Connecting a start and end pose along the shortest possible path is useful in many scenarios. It comes, however, at two costs. First, motion is constrained to either a maximal sharp left turn, a maximal sharp right turn or straight driving. Second, the simplifying assumption is made that paths with instantaneous change from a maximal sharp left turn to a maximal sharp right turn and vice versa are possible. In many scenarios paths are desired that do not only operate at steering limits and instead may satisfy other constraints. The development of a method for this purpose provided the motivation for this article. Starting from the Dubins airplane model proposed in [ 11 ] , an extensive search of all its citing work revealed a research gap for an UAV reference path planning technique that exploits the special structure of the Dubins airplane model for controls decoupling, spatial modeling and linear programming. This is the contribution of this paper. A literature review is provided. First, the term ’Dubins airplane model’ is not unique. For example, the Dubins airplane models in [ 3 , 9 , 11 ] are all different. The latter reference relates heading angle to roll angle. Its model includes 3D position coordinates as well as airspeed, flight-path, heading and roll angle. It is therefore our preferred model. Starting from a chosen Dubins airplane model a plethora of model-based control algorithms can be applied [ 8 ] . This paper paper focuses on an optimization-based approach, which can account for constraints in a structured manner [ 7 ] . For this purpose, the simplest class of convex optimization problems is linear programming. x y z \phi \gamma v \psi Fig. 1 : Illustration of the Dubins airplane model. For simplicity it is depicted as a triangle. States and control variables are annotated. Different colors are used to differentiate positions, angles and velocity. See ( 1 ) for interpretation. In [ 20 ] a method for 3D Dubins path planning with bounded curvature and pitch angle is presented. The problem is decoupled into horizonal and vertical problems, before both are solved separately using 2D Dubins paths. The focus is exclusively on Dubins paths between start and end pose. The method is not generalizable to trajectory smoothing tasks. Their Dubins airplane model does not include roll angle. Transforming time-dependent to spatially-dependent dynamics, typically in combination with respect to a reference trajectory, is a technique for problem reformulations [ 19 , 12 ] . It was found to often facilitate problem solutions to account for spatial constraints, and is also the approach taken here. In 2D for planar path planning the spatial problem reformulation is often referred to as planning in the Frenet frame [ 4 , 22 ] . An extension to 3D is referred to as the Frenet-Serret frame, however, there exist more and modeling is much more complex [ 1 , 6 , 18 ] . Within a typical hierarchical framework, the presented method follows after an upstream planning step. For example, given a first high-level routing result [ 23 , 15 ] , a second trajectory smoothing step is required to prepare a reference path plan, before a subsequent third low-level path tracking step follows. Thus, the method can be classified as a trajectory smoothing step in-between routing and low-level tracking. The remaining paper is organized as follows: problem formulation, problem solution, numerical examples, discussion and the conclusion are described in Sect. I - VI . II Problem Formulation The addressed problem can be formulated as follows. Given an initial (rough) path trajectory in 3D, \{x_{i}^{\text{ref}},y_{i}^{\text{ref}},z_{i}^{\text{ref}}\}_{i=0}^{N_{\text{ref}}} , it is sought to smooth this trajectory subject to (i) UAV dynamics according to a Dubins airplane model, and (ii) additional trajectory shaping constraints. A desired result is a smoothed reference path plan that improves upon the initial trajectory. The initial path trajectory may consist of a sequence of waypoints or an interpolated path connecting multiple waypoints. The path may initially not be feasible with respect to UAV dynamics. The Dubins airplane model used for the remainder shall be described by the following set of differential equations [ 11 ] , \displaystyle\begin{bmatrix}\dot{x}\\ \dot{y}\\ \dot{z}\\ \dot{\psi}\end{bmatrix} \displaystyle=\begin{bmatrix}v\cos(\gamma)\cos(\psi)\\ v\cos(\gamma)\sin(\psi)\\ v\sin(\gamma)\\ \frac{g}{v}\tan(\phi)\end{bmatrix}, (1) where (x,y,z) denote the intertial position of the UAV. The remaining variables are airspeed v , yaw (heading) angle \psi , flight-path angle \gamma , roll angle \phi , and g the acceleration due to gravity. See Fig. 1 for illustration. Several comments can be made. First, the Dubins airplane model is a simplified model. It does not account for effects such as aerodynamics, wind, sideslip and transients resulting from low-level control delays. However, for high-level path planning it is well suited [ 11 ] . Second, it is noted that there exist a variety of alternative models, that in their respective papers are also referred to as Dubins airplane model [ 3 , 9 , 10 ] . Thus, ( 1 ) does not represent the Dubins airplane model. However, its formulation appears favorable since it involves all 6 variables typical for UAV path planning: 3 inertial position coordinates, yaw, roll and flight-path angle. This serves well for fixed-wing path planning, but in general likewise also for quadrotor path planning [ 10 ] . Finally, it is explicitly stressed that the topic of this paper is reference path planning. Low-level control (such as, e.g., necessary for weather-dependent wind rejection) is not a topic of this paper. Generating smoothed nominal and deterministic reference path plans, that account for nonholonomic robot dynamics in 3D (Dubins airplane model) and spatial precision constraints is important for high-level mission planning. Agricultural area coverage is an example application [ 15 ] . III Problem Solution The proposed solution to the

Read the complete text