A Dijkstra Algorithm For Fixed-Wing UAV Motion Planning Based On Terrain Elevation
A Dijkstra Algorithm For Fixed-Wing UAV Motion Planning Based On Terrain Elevation
Instituto de Estudos Avançados, Rod. dos Tamoios, km 5,5, Putim, CEP 12.228-001,
São José dos Campos, São Paulo, Brasil
[email protected]
Instituto Nacional de Pesquisas Espaciais, Av. dos Astronautas 1.758, Jardim da Granja,
CEP 12227-010, São José dos Campos, São Paulo, Brasil
[email protected]
1 Introduction
The automatic motion or trajectory planning is essential for several tasks that lead to
the autonomy increase of Unmanned Aerial Vehicles (UAVs). This work approaches
the problem of trajectory planning for fixed-wing UAVs navigating to constant alti-
tudes. This problem is similar to the trajectory planning for nonholonomic wheeled
mobile robots [1]. A trajectory is a sequence of waypoints connected by straight line
segments and arcs that allow to the fixed-wing UAV navigates between an initial and
a final waypoint of the navigation environment. A trajectory must be collision-free
and dynamically feasible [1], i. e., a trajectory must allow the UAV navigate from a
waypoint to the next waypoint without violating the UAV dynamics and kinematic
constraints. A formal definition of dynamically feasible trajectory is presented in [1].
Fig. 1 presents an example of a dynamically feasible collision-free trajectory planned
for a fixed-wing UAV.
A recent revision of UAV motion planning methods is presented in [2]. As men-
tioned in this revision, Dijkstra algorithms assure optimality when used to plan navi-
gation paths, which are sequences of waypoints connected by straight line segments.
However, the paths planned by these algorithms must be transformed in trajectories
A.C. da Rocha Costa, R.M. Vicari, F. Tonidandel (Eds.): SBIA 2010, LNAI 6404, pp. 213–222, 2010.
© Springer-Verlag Berlin Heidelberg 2010
214 F.L.L. Medeiros and J.D.S. da Silva
EDA presents three main distinctions regarding the MDA. The first distinction is
the elaboration of the proposed algorithm to solve the single-pair shortest trajectory
problem. As second distinction, EDA plans trajectories of the class k-trajectories
proposed in [1]. A k-trajectory is a Dubins curve whose length and form can be ad-
justed by the parameter k. The last distinction is that this work also proposes a grid-
based local search heuristics to verify if a trajectory is collision-free. This heuristics is
invariant to the number of obstacles and presents a computational time of O(np), in the
worst case, where np is the number of verifications. Considering navigation environ-
ments with a large number of obstacles, in comparison with the method used in the
modified Dijkstra algorithm, this heuristics allows a significant decrease of the com-
putational time, becoming the main contribution of this work.
The remainder of this paper is organized as follows. Section 2 presents the con-
struction of visibility graphs which represent the navigation environment used in this
work. Section 3 presents the Dijkstra algorithm proposed in this work and presents the
results of the application of this algorithm. Final conclusions based on the obtained
results are presented in Section 4.