Vector Field Path Following For Miniature Air Vehicles
Vector Field Path Following For Miniature Air Vehicles
Abstract—In this paper, a method for accurate path following achievable tracking precision. For MAVs, wind speeds are com-
for miniature air vehicles is developed. The method is based on monly 20%–60% of the desired airspeed. Effective path tracking
the notion of vector fields, which are used to generate desired strategies must overcome the effect of this ever present distur-
course inputs to inner-loop attitude control laws. Vector-field
bance. For most fixed-wing MAVs, the minimum turn radius is
path-following control laws are developed for straight-line paths
and circular arcs and orbits. Lyapunov stability arguments are in the range of 10–50 m. This places a fundamental limit on
used to demonstrate asymptotic decay of path-following errors in the spatial frequency of paths that can be tracked. Thus, it is
the presence of constant wind disturbances. Experimental flight important that the path-tracking algorithms utilize the full ca-
tests have demonstrated mean path-following errors on less than pability of the MAV. Finally, high-resolution state sensors with
one wingspan for straight-line and orbit paths and less than three high-frequency updates are not typically available for MAVs.
wingspans for paths with frequent changes in direction. Successful tracking approaches must exploit fully those sensors
Index Terms—Miniature aerial vehicle (MAV), path following, that are readily available.
trajectory tracking, unmanned aerial vehicle (UAV). Several approaches have been proposed for UAV trajectory
tracking. An approach for tight tracking of curved trajectories
is presented in [1]. For straight-line paths, the approach approx-
I. INTRODUCTION
imates PD control. For curved paths, an additional anticipatory
NMANNED aerial vehicles (UAVs), large and small, have
U demonstrated their usefulness in military applications.
Furthermore, there are numerous potential uses for UAVs in
control element that improves the tracking capability is imple-
mented. The approach accommodates the addition of an adap-
tive element to account for disturbances such as wind. This ap-
civil and commercial applications and the prospects for broad proach is validated with flight experiments.
impact are strong. To extend the usefulness of UAVs beyond In [2], Kaminer et al. describe an integrated approach for de-
their current applications, the capability to plan paths and to veloping guidance and control algorithms for autonomous ve-
follow them accurately is of great importance. Unlike piloted hicle trajectory tracking. Their approach builds upon the theory
vehicles, which rely on the pilot to navigate over demanding of gain scheduling and produces controllers for tracking trajec-
terrain or to avoid obstructions, UAVs rely on automation tories that are defined in an inertial reference frame. The ap-
to provide this functionality. As applications such as urban proach is illustrated through simulations of a small UAV.
surveillance and rural search and rescue require UAVs to fly Implicit in the notion of trajectory tracking is that the vehicle
down city streets surrounded by buildings or near the surface is commanded to be in a particular location at a particular time
of abruptly changing mountainous terrain, the ability to follow and that this location typically varies in time, thus causing the
preplanned paths with precision is essential. For missions vehicle to move in the desired fashion. With fixed-wing MAVs,
involving cooperation among a team of UAVs, precise path the desired position is constantly moving (at the desired ground
tracking is often crucial to achieving the cooperation objective. speed). The approach of tracking a moving point can result in
For miniature aerial vehicles (MAVs),1 such as those of pri- significant problems for MAVs if disturbances, such as those
mary interest in this study, wind disturbances, dynamic char- due to wind, are not accounted for properly. If the MAV is flying
acteristics, and the quality of sensing and control all limit the into a strong wind (relative to its commanded ground speed),
the progression of the trajectory point must be slowed accord-
Manuscript received December 14, 2005; revised September 15, 2006. This ingly. Similarly, if the MAV is flying down wind, the speed of
paper was recommended for publication by Associate Editor G. Sukhatme and
Editor K. Lynch upon evaluation of the reviewers’ comments. This work was
the tracking point must be increased to keep the MAV from over-
supported by AFRL/MNK Grant F08630-03-1-0017 and by the Air Force Office running the desired position. Given that wind disturbances vary
of Scientific Research under Grant FA9550-04-1-0209 and Grant FA9550-04-C- and are often not easily predicted, trajectory tracking can be very
0032. challenging in anything other than calm conditions.
D. R. Nelson is with the Unmanned Systems Division, Northrop Grumman
Corporation, San Diego, CA 92127 USA. Rather than pursuing the trajectory tracking approach, this
D. B. Barber and T. W. McLain are with the Mechanical Engineering Depart- paper explores path following where the objective is to be on
ment, Brigham Young University, Provo, UT 84602 USA (e-mail: mclain@byu. the path rather than at a certain point at a particular time. With
edu).
R. W. Beard is with the Electrical and Computer Engineering Department, path following, the time dependence of the problem is removed.
Brigham Young University, Provo, UT 84602 USA. In [3] and [4], performance limits for reference-tracking and
Digital Object Identifier 10.1109/TRO.2007.898976 path-following controllers are investigated and the difference
1We consider MAVs to be those with wingspans in the 0.3–2-m range and
between them is highlighted. It is shown that there is not a fun-
micro aerial vehicles to be those with wingspans under 0.3 m. Here, the abbre- damental performance limitation for path following for systems
viation MAV denotes miniature aerial vehicle. with unstable zero dynamics as there is for reference tracking.
1552-3098/$25.00 © 2007 IEEE
520 IEEE TRANSACTIONS ON ROBOTICS, VOL. 23, NO. 3, JUNE 2007
Fig. 1. Illustration of the vector field idea for straight-line and circular path following. The desired course of the MAV is specified the by direction of the vector field.
Building on the work presented in [5] on maneuver modi- of a potential field to navigate through heavily populated areas
fied trajectory tracking, Encarnação and Pascoal develop an ap- safely while still aggressively approaching their targets. Vector
proach that combines the features of trajectory tracking and path fields are different from potential fields in that they do not nec-
following for marine vehicles [6]. Similar to this work is that essarily represent the gradient of a potential. Rather, the vector
of Skjetne et al. [7], which develops an output maneuvering field simply indicates a desired direction of travel. In [11], the
method composed of two tasks: forcing the output to converge concept of vector fields is used to direct autonomous aircraft in
to the desired path and then satisfying a desired speed assign- the stand-off tracking of a moving target. Precision tracking of
ment along the path. The method is demonstrated using a ma- a predefined path is not considered. Instead, the vector field is
rine vessel simulation. Reference [8] presents a path-following utilized to direct a team of two aircraft into an orbit around a
method for UAVs that provides a constant line of sight between moving target.
the UAV and an observation target. This paper considers the navigation of a fixed-wing MAV
The study presented in this paper builds on the concept of path with the assumption that altitude and airspeed are held con-
following through the construction of vector fields surrounding stant (or nearly so) by the control of the longitudinal dynamics.
the path to be followed. The vectors of the fields provide course
The following is a simple model of the navigational dynamics
commands to guide the MAV toward the desired path. As with
that will be used to study the path following behavior of the pro-
other path-following methods, the objective is not to track a
posed approach:
moving point, but to get onto the path while flying at a pre-
scribed airspeed. A unique contribution of this paper is the uti- (1)
lization of course measurements in the path-following control
(2)
which, in combination with the vector field strategy, guarantees
that tracking errors asymptotically approach zero even in the where represent the and components of the wind
presence of constant wind disturbances. Implementation of the velocity. Heading will be controlled by the vector-field
approach is feasible on small MAVs and experimental results path-following approaches presented in this paper. An alter-
validate the potential value of the approach for MAVs flying in native representation of these equations can be developed by
windy conditions.
noting the relationship between groundspeed , airspeed
, and wind speed as depicted in Fig. 2 as
II. PROBLEM DESCRIPTION
(3)
The objective of this paper is to develop a method for accurate
path following for MAVs in the presence of wind. The method (4)
calculates a vector field around the path to be tracked. The vec- Drawing on (3) and (4) and the definition of course shown
tors in the field are directed toward the path to be followed and in Fig. 2, (1) and (2) can be expressed as
represent the desired direction of flight. The vectors in the field
serve as course commands to the MAV. The method is currently (5)
applicable to paths composed of straight lines and arcs. This re- (6)
striction is insignificant for most practical applications. Fig. 1
shows examples of vector fields for linear and circular paths. The key distinction is that the equations of motion are expressed
The notion of vector fields is similar to that of potential fields, in terms of groundspeed and course and are independent of the
which have been widely used as a tool for path planning in the wind velocity. We will show that, by using ground-referenced
robotics community (see, e.g., [9]). It has also been suggested measurements (i.e., course and groundspeed instead of heading
in [10] that potential fields can be used in UAV navigation for and airspeed) in conjunction with the vector field approach to
obstacle and collision-avoidance applications. The method of control the path of the vehicle, wind-disturbance rejection is
[10] provides a way for groups of UAVs to use the gradient improved significantly, which is vitally important for small low-
NELSON et al.: VECTOR FIELD PATH FOLLOWING FOR MINIATURE AIR VEHICLES 521
Fig. 3. Vector field for straight-line path following. Far away from the waypoint
path, the vector field is directed with an angle from the perpendicular to the
path.
(7)
(9)
Fig. 5. State trajectories onto the sliding surface (y ) for various initial
conditions.
(11)
where is a positive scale factor used to weight the terms so for , then for . Note
that they are similar in magnitude. Differentiating, we obtain that when
Therefore
if
Noting that
Therefore, if
Let
(16)
(17)
where the and are the ground track speed and relative
Fig. 6. Vector field geometry for orbit tracking. When the radial distance to the
MAV is much greater than the orbit radius, the desired course is calculated so course, respectively. We will again assume that the course dy-
that the MAV is directed toward the orbit center. As the radial distance becomes namics are given by
smaller, the desired course becomes tangential to the orbit.
(18)
Exponential stability comes from the fact that and the right- Defining , then we can argue that asymp-
hand side of (14) are quadratic [12]. totically when by using the Lyapunov function
For , we get , whose Lie derivative is
which is less than zero if positively invariant and to ensure that the system trajectory
reaches in finite time. As before, define and
differentiate to obtain
B. Orbit Following
The algorithm for circular orbits creates vector fields in a
manner similar to the straight-line algorithm. Consider the de- where
sired orbit path shown in Fig. 6. In this discussion, a counter-
clockwise orbit will be considered. The development for clock-
wise orbits is similar with the exception of several sign changes.
The desired orbit is assumed to have a known center and radius has been defined for brevity. Letting gives
. When the distance between the MAV and the center of the
orbit is large, it is desirable for the MAV to fly toward the orbit
center. If we define as the radial distance of the MAV from
the center of the orbit, then, when is significantly larger than If we choose the control signal as
, the desired course is
(19)
where is defined as the angular position of the MAV with
respect to the orbit center, as shown in Fig. 6. where , then
When , the desired course is . Therefore,
let the desired course be given by
(20)
(21)
where
and is arbitrary.
Proof: The proof follows a similar line of reasoning as the
proof of Theorem III.1. If , then the set
Fig. 7. Straight-line paths and circular orbits can be combined to produce a
is positively invariant and converges to in finite time. Inside variety of paths. The top figure shows the combination of two straight-line paths
the boundary region, we use the Lyapunov function candidate and three circular orbits that are arranged so that, if the MAV is on the path, the
path length is equal to the original waypoint path. The middle figure arranges
the orbits so that the desired path transitions over the waypoint. In the bottom
figure, a single orbit is used to transition between straight-line segments.
with to obtain
For , we obtain
(23)
TABLE I
CONTROL PARAMETER VALUES
Fig. 10. Telemetry plot for orbits with radii of 150, 100, and 70 m. Fig. 12. Telemetry plot for equal path-length following.
Fig. 11. Telemetry plot for straight-line following. Fig. 13. Combination of equal path length and corner cutting following.
of the MAV. The data indicate that tight tracking is more dif- the straight-line and smoothed path lengths. The mean path-fol-
ficult to achieve as the orbit radius decreases. This is expected lowing error and standard deviation were 3.6 and 5.1 m, respec-
since control adjustments for loss in altitude in turns must be tively. Although the transitions from the straight line to the orbit
mixed with those used to control the lateral error and since the portions show some lateral following errors, the length of the
states associated with a smaller orbit are further away from the path flown and the desired length are similar. The length of the
nominal wings-level trim condition. straight-line path shown in Fig. 12 was 2897 m. The actual dis-
Fig. 11 illustrates the ability of the MAV to follow straight tance flown was 27 m less than the desired distance, which is an
line segments with acute angles. Excluding the transient errors error of only 0.93%.
from the turns, the mean following error on the straight-line To further test the robustness and capabilities of the proposed
portions of the path was 0.74 m with a standard deviation of path-following algorithms, many other types of paths have been
0.66 m. flown. The path shown in Fig. 13 illustrates both obtuse and
A combination of the straight-line and arc-following methods acute angles and the decision of the path follower to cut the cor-
was also tested. The techniques described in Section III-C were ners of the obtuse angles and flare out and around on the acute
implemented, and the results are plotted in Fig. 12. The thicker angles. Considering the path-following error over the full path
line represents the desired path that was planned to equalize gave a mean error of 3.6 m and a standard deviation of 4.7 m.
528 IEEE TRANSACTIONS ON ROBOTICS, VOL. 23, NO. 3, JUNE 2007
Fig. 14. Urban terrain following using straight-line following. Fig. 16. Straight-line following in high-wind conditions. Wind speed was 46%
of commanded airspeed.
V. CONCLUSION
In this paper, a new method for MAV path following, based
on the concept of vector fields, has been introduced. Using
Lyapunov stability criteria, it has been shown that the vector
field approach provides asymptotic following for straight-line
Fig. 15. Orbit following in high-wind conditions. Wind speed was 50% of com- and circular paths in the presence of constant wind disturbances.
manded airspeed. The effectiveness of the vector field method has been demon-
strated experimentally using a fixed-wing MAV. For both
straight-line and circular paths, following errors averaged less
Fig. 14 shows a path representative of an urban scenario. Al- than one wingspan in steady straight-line or orbit paths and less
though these are actual flight results, the terrain is synthetic. The than three wingspans for paths involving frequent transitions
straight-line follower was used to follow this path. The mean between straight-line and arc segments.
lateral error over the full path was 3.4 m, while the standard de-
viation was 4.8 m. REFERENCES
To demonstrate the feasibility of the approach for high-wind
[1] S. Park, J. Deyst, and J. How, “A new nonlinear guidance logic for tra-
conditions, an orbit path and a straight-line path were flown on jectory tracking,” in Proc. AIAA Guidance, Navigation Control Conf.,
days where the average wind speeds were 9 and 6 m/s, respec- Aug. 2004, paper no. AIAA-2004-4900.
tively. A plot of the orbit results is shown in Fig. 15. For these [2] I. Kaminer, A. Pascoal, E. Hallberg, and C. Silvestre, “Trajectory
tracking for autonomous vehicles: An integrated approach to guidance
results, the high wind required an airspeed of 18 m/s to enable and control,” AIAA J. Guidance, Control Dynam., vol. 21, no. 1, pp.
the MAV to make steady progress upwind. The wind speed was 29–38, 1998.
approximately 50% of the commanded airspeed. Under these [3] P. Aguiar, D. Dačić, J. Hespanha, and P. Kokotivić, “Path-following
or reference-tracking? An answer relaxing the limits to performance,”
conditions, the mean following error was 0.5 m with a standard in Proc. 5th IFAC/EURON Symp. Intell. Autonomous Vehicles, Lisbon,
deviation of 4.2 m. Portugal, 2004.
NELSON et al.: VECTOR FIELD PATH FOLLOWING FOR MINIATURE AIR VEHICLES 529
[4] P. Aguiar, J. Hespanha, and P. Kokotović, “Path-following for nonmin- D. Blake Barber received the B.S. degree in
imum phase systems removes performance limitations,” IEEE Trans. mechanical engineering from Brigham Young
Automat. Control, vol. 50, no. 2, pp. 234–239, Mar. 2005. University (BYU), Provo, UT, in 2005, where he is
[5] J. Hauser and R. Hindman, “Maneuver regulation from trajectory currently working toward the M.S. degree.
tracking: Feedback linearizable systems,” in Proc. IFAC Symp. Non- He has been actively involved in researching and
linear Control Syst. Design, Tahoe City, CA, Jun. 1995, pp. 595–600. testing new flight control algorithms and sensor plat-
[6] P. Encarnaçã and A. Pascoal, “Combined trajectory tracking and path forms for miniature UAVs. His research includes the
following: An application to the coordinated control of marine craft,” in use of optic flow sensors and vision algorithms for
Proc. IEEE Conf. Decision Control, Orlando, FL, 2001, pp. 964–969. range measurement, autonomous landing, path fol-
[7] R. Skjetne, T. Fossen, and P. Kokotović, “Robust output maneuvering lowing, and target localization.
for a class of nonlinear systems,” Automatica, vol. 40, pp. 373–383,
2004.
[8] R. Rysdyk, “UAV path following for constant line-of-sight,” in Proc.
2nd AIAA Unmanned Unlimited Conf., 2003, paper no. AIAA-2003-
6626. Timothy W. McLain (S’91–M’93–SM’03) received
[9] O. Khatib, “Real-time obstacle avoidance for manipulators and mo- B.S. and M.S. degrees from Brigham Young Univer-
bile robots,” in Proc. IEEE Int. Conf. Robot. Autom., 1985, vol. 2, pp. sity (BYU), Provo, UT, in 1986, and 1987, respec-
500–505. tively, and the Ph.D. degree from Stanford University,
[10] K. Sigurd and J. P. How, “UAV trajectory design using total field col- Stanford, CA, in 1995, all in mechanical engineering.
lision avoidance,” in Proc. AIAA Guidance, Navigation Control Conf., He is currently an Associate Professor with the
Aug. 2003, paper no. AIAA-2003-538. Mechanical Engineering Department, BYU. He
[11] E. Frew and D. Lawrence, “Cooperative stand-off tracking of moving has been actively involved in the control of air and
targets by a team of autonomous aircraft,” in Proc. AIAA Guidance, underwater vehicles and robotic systems for the past
Navigation Control Conf., Aug. 2005, paper no. AIAA-2005-6363. 18 years. During the summers of 1999 and 2000, he
[12] H. K. Khalil, Nonlinear Systems, 3rd ed. Upper Saddle River, NJ: was a Visiting Scientist with the Air Force Research
Prentice-Hall, 2002. Laboratory. Since that time, he has pursued research involving the modeling
[13] E. Anderson, R. Beard, and T. McLain, “Real-time dynamic trajec- and control of miniature UAVs, real-time trajectory generation for UAVs, and
tory smoothing for unmanned air vehicles,” IEEE Trans. Control Syst. cooperative control of UAV teams.
Technol., vol. 13, no. 3, pp. 471–477, May 2005.
[14] The Kestrel Autopilot. Procerus Technologies. [Online]. Available:
http://procerusuav.com/
[15] R. Beard, D. Kingston, M. Quigley, D. Snyder, R. Christiansen, W. Randal W. Beard (S’91–M’92–SM’03) received the
Johnson, T. McLain, and M. Goodrich, “Autonomous vehicle tech- B.S. degree in electrical engineering from the Uni-
nologies for small fixed wing UAVs,” AIAA J. Aerosp., Comput., Inf., versity of Utah, Salt Lake City, in 1991, and the M.S.
Commun., vol. 2, no. 1, pp. 92–108, Jan. 2005. degree in electrical engineering, the M.S. degree in
[16] R. W. Beard, D. Lee, S. Thakoor, and S. Zornetzer, “A new approach mathematics, and the Ph.D. degree in electrical engi-
to observation of descent and landing of future Mars mission using neering from Rensselaer Polytechnic Institute, Troy,
bioin-spired technology innovations,” AIAA J. Aerosp., Comput., Inf., NY, in 1993, 1994, and 1995, respectively.
Commun., vol. 2, no. 1, pp. 65–91, Jan. 2005. Since 1996, he has been with the Electrical and
Computer Engineering Department, Brigham Young
Derek R. Nelson received the B.S. and M.S. degrees University, Provo, UT, where he is currently an Asso-
from Brigham Young University, Provo, UT, in ciate Professor. In 1997 and 1998, he was a Summer
2004 and 2005, respectively, both in mechanical Faculty Fellow at the Jet Propulsion Laboratory, California Institute of Tech-
engineering. nology, Pasadena. In 2006 and 2007, he was a Visiting Research Fellow with
He is currently a Guidance and Controls Engineer the Air Force Research Laboratory, Munitions Directorate, Eglin AFB, FL. His
working on the Global Hawk Program at Northrop primary research focus is autonomous control of miniature air vehicles and mul-
Grumman Corporation, San Diego, CA. At BYU, he tivehicle coordination and control. He is currently an Associate Editor for the
was involved with UAV research, focusing on path IEEE Control Systems Magazine and the Journal of Intelligent and Robotic
following and cooperative control algorithms. Systems.