multi-vehicle control in a strong flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system...

30
To appear in AIAA J. Guidance, Control, and Dynamics Multi-vehicle Control in a Strong Flowfield with Application to Hurricane Sampling Levi DeVries * and Derek A. Paley University of Maryland, College Park, Maryland, 20742, U.S.A A major obstacle to path-planning and formation-control algorithms in multi-vehicle systems are strong flows in which the flow speed is greater than the vehicle speed relative to the flow. This challenge is especially per- tinent in the application of unmanned aircraft used for collecting targeted observations in a hurricane. The presence of such a flowfield may inhibit a vehicle from making forward progress relative to a ground-fixed frame, thus limiting the directions in which it can travel. This paper presents results for motion coordination in a strong, known flowfield using a self- propelled particle model of vehicle motion in which each particle moves at constant speed relative to the flow. A new formulation of the particle model with respect to a rotating reference frame is provided along with a set of conditions on the flowfield that ensures trajectory feasibility. Re- sults from the Lyapunov-based design of decentralized control algorithms are presented for circular, folium, and spirograph trajectories, which are selected for their potential use as hurricane sampling trajectories. The the- oretical results are illustrated using numerical simulations in an idealized hurricane model. Nomenclature N Number of particles in the system k Particle index k =1,...,N r k/O Position of particle k with respect to O * Graduate Student, Department of Aerospace Engineering, University of Maryland, and AIAA Student Member. Assistant Professor, Department of Aerospace Engineering, University of Maryland, and AIAA Associate Fellow. 1 of 30

Upload: others

Post on 29-Sep-2020

3 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

To appear in AIAA J. Guidance, Control, and Dynamics

Multi-vehicle Control in a Strong Flowfield

with Application to Hurricane Sampling

Levi DeVries∗ and Derek A. Paley†

University of Maryland, College Park, Maryland, 20742, U.S.A

A major obstacle to path-planning and formation-control algorithms in

multi-vehicle systems are strong flows in which the flow speed is greater

than the vehicle speed relative to the flow. This challenge is especially per-

tinent in the application of unmanned aircraft used for collecting targeted

observations in a hurricane. The presence of such a flowfield may inhibit

a vehicle from making forward progress relative to a ground-fixed frame,

thus limiting the directions in which it can travel. This paper presents

results for motion coordination in a strong, known flowfield using a self-

propelled particle model of vehicle motion in which each particle moves

at constant speed relative to the flow. A new formulation of the particle

model with respect to a rotating reference frame is provided along with

a set of conditions on the flowfield that ensures trajectory feasibility. Re-

sults from the Lyapunov-based design of decentralized control algorithms

are presented for circular, folium, and spirograph trajectories, which are

selected for their potential use as hurricane sampling trajectories. The the-

oretical results are illustrated using numerical simulations in an idealized

hurricane model.

Nomenclature

N Number of particles in the system

k Particle index k = 1, . . . , N

rk/O Position of particle k with respect to O

∗Graduate Student, Department of Aerospace Engineering, University of Maryland, and AIAA StudentMember.†Assistant Professor, Department of Aerospace Engineering, University of Maryland, and AIAA Associate

Fellow.

1 of 30

Page 2: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

rk Position coordinates of kth particle with respect to inertial frame

rk Position coordinates of kth particle with respect to rotating frameIvk/O Inertial velocity of kth particle with respect to O

rk Velocity coordinates of kth particle with respect to inertial frame

˙rk Velocity coordinates of kth particle with respect to rotating frame

fk Flow velocity coordinates at rk

fk Flow velocity coordinates at rk relative to rotating frame

θk Orientation of kth flow-relative velocity with respect to inertial frame

θk Orientation of kth flow-relative velocity with respect to rotating frame

γk Orientation of kth total velocity with respect to inertial frame

γk Orientation of kth total velocity with respect to rotating frame

α Orientation of rotating reference frame with respect to inertial reference frame

uk Flow-relative steering control of kth particle with respect to inertial frame

uk Flow-relative steering control of kth particle with respect to rotating frame

νk Total steering control of kth particle with respect to inertial frame

νk Total steering control of kth particle with respect to rotating frame

sk Total speed of kth particle with respect to inertial frame

sk Total speed of kth particle with respect to rotating frame

hk Flow-relative speed of kth particle with respect to inertial frame

hk Flow-relative speed of kth particle with respect to rotating frame

ck Center of the kth particle’s trajectory

ρk Position coordinates of kth particle in ck-centered reference frame

φk Polar angle of kth particle’s position in ck-centered reference frame

κk Curvature of kth particle’s trajectory

ω0 Constant curvature of circle of radius |ω0|−1

K Control gain

n Number of lobes in folium figure

a Maximum radius of folium lobe

i Imaginary unit

vmax Maximum wind speed in idealized hurricane model

rmax Radius of maximum wind speed in idealized hurricane model

µ Decay constant of idealized hurricane model

I Inertial reference frame

B Rotating reference frame

Ck Path frame of kth particle with respect to frame IDk Path frame of kth particle with respect to frame BL Desired trajectory

2 of 30

Page 3: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

ej jth unit vector of frame IIωB Angular velocity of frame B with respect to frame IΩ Constant angular rate of rotating frame

d Distance of circle center from origin

d Non-dimensional distance of circle center from origin

I. Introduction

Unmanned vehicles have shown great value in their ability to explore harsh physical

environments that are too dangerous for manned platforms. For example, autonomous un-

derwater vehicles have shed light on some of the deepest trenches of the sea1 and robotic

rovers have explored expanses of the desolate martian landscape. Recently, autonomous ve-

hicles have been proposed as a safe and effective way to penetrate extreme weather systems

such as hurricanes and tornados.2 In 2006, an Aerosonde unmanned aircraft flying at low

altitude successfully penetrated a typhoon eyewall while streaming temperature, pressure,

and windspeed data to a remote command center.3 In 2010, the Global Hawk UAV flying

at high altitude passed over Hurricane Earl collecting temperature, convection, and precipi-

tation measurements.a In addition, smaller unmanned aircraft are being utilized to sample

within pre-tornadic supercell thunderstorms.4

The assimilation of data from previously inaccessible regions of a storm presents the pos-

sibility of more accurate forecasts of both the intensity and trajectory of a weather system.

For hurricanes, existing data-sampling methods include the use of satellite imagery, manned

flights, and more recently, remotely piloted unmanned flights. New data assimilation tech-

niques are in development for remotely piloted Global Hawk flights,5 which loiter above the

winds associated with a hurricane at altitudes of up to 65,000 ft.6 Manned aircraft eject

one-time-use dropsondes to collect data at low altitudes where it is too dangerous to fly.

By deploying hundreds of dropsondes, meteorologists obtain vertical profiles of atmospheric

data in the storm.

Autonomous unmanned aircraft have been proposed as a safe, efficient alternative to

manned flights for low-altitude penetration of hurricanes,3 collecting observations of temper-

ature, humidity, and wind at altitudes lower than manned aircraft can safely fly. Replacing

dropsondes with a smaller number of unmanned, reusable aircraft flying in a moving forma-

tion would provide continuous, dynamic data from within the hurricane eyewall. Unmanned

aJenner, L. and Dunbar, B. “NASA Science Aircraft Monitor Hurricane Earl on Sept. 2,”http://www.nasa.gov/mission pages/hurricanes/missions/grip/main/GRIP status 09 03 10.html, 11 Oct.,2011

3 of 30

Page 4: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

platforms are designed to withstand the severe winds within the storm and may operate

autonomously using automatic control algorithms.

Sampling a circulating flowfield such as a hurricane for forecasting purposes motivates the

desire to regulate azimuthal and radial sampling densities. In the case of hurricane sampling,

manned flights traverse figure-four patterns in order to sample each quadrant of the storm

while minimizing the overall track length.b Emulating this sampling strategy requires the

development of control algorithms that drive sampling vehicles in non-convex formations.

In addition, these trajectories must be feasible for the sampling platform to achieve in the

presence of a strong wind.

In order to design steering algorithms for unmanned aircraft in a hurricane, the authors

study a planar, self-propelled Newtonian particle model in a strong flowfield (i.e., with flow

speed equal to or exceeding the vehicle speed relative to flow). Decentralized Lyapunov-based

control algorithms that stabilize moving formations of multiple vehicles are derived, extend-

ing previous work for moderate7 (flow speeds between 10% and 99% of vehicle speed) and

flow-free models.8,9,10,11 Using the flow-free model, Sepulchre et al.10 provided theoretically

justified algorithms for stabilization of parallel, circular, and circular symmetric formations.

Arranz et al. expanded this result to the family of radially contracting and expanding9 as

well as spatially translating8 circular formations. Moreover, with the use of curvature func-

tions, Paley et al.12 extended the multi-vehicle formation result to convex loops; Zhang and

Leonard11 used orbit functions to stabilize formations on smooth curves.

In the moderate flow regime, Frew et al.13 utilized Lyapunov analysis to generate guidance

vector fields that globally stabilize circular loitering patterns. Paley and Peterson7 extended

the stability of parallel and circular formations to known, spatially-varying flowfields as well

as circular symmetric formations in uniform flows. Peterson and Paley14 also extended par-

allel and circular formation control to unknown and time-varying flowfields by implementing

onboard flowfield estimators. In the strong flow regime, Kwok and Hernandez15,16 charac-

terized minimum-time trajectories in a flowfield with magnitude strictly greater than the

vehicle speed, deriving cooperative control algorithms to maximize total vehicle coverage

area rather than coordinating vehicle motion with respect to a predefined formation.

The presence of a strong flow inhibits a vehicle from making forward progress in some

areas of the flowfield, thus limiting the range of directions in which it can travel. This presents

an obstacle to multi-vehicle control because the desired formation may not be feasible due

to spatial or temporal variability in the flow. The results of this paper rely on the use

of Lyapunov-based control design, which utilizes scalar artificial potential functions whose

value is minimized by a desired formation see, e.g. [17, p. 111–133]. State-feedback control

laws that ensure negative semi-definiteness of the potential function’s time derivative are

bWilloughby, H. and Majumdar, S., Personal Communication, July 14, 2011

4 of 30

Page 5: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

derived, invoking the invariance principle to establish the stability properties of the closed-

loop system [17, p. 126–133]. The results of this work have additional applications in path

planning for autonomous underwater gliders navigating strong currents,18 navigation of fixed-

wing aircraft in significant and unknown windfields,19,20 and in the navigation and path

planning of micro air vehicles in wind.21

The contributions of the paper are as follows: (1) an idealized model of the dynamics of

unmanned aircraft in strong winds using a self-propelled particle formulation, described with

respect to inertial and rotating reference frames; (2) kinematic conditions that guarantee a

particle can follow a desired trajectory in a strong, known flowfield; and (3) theoretically

justified multi-vehicle control laws stabilizing multi-vehicle formations including circular,

folium, and spirograph patterns, which are selected for potential use as hurricane sampling

patterns. These contributions extend previous results for convex loops in a moderate flow

to closed curves with non-zero curvature in a spatially varying strong flow.

The paper is organized as follows. Section II presents a dynamic model of planar, self-

propelled particle motion, first with respect to an inertial reference frame and then in a

reference frame rotating at a constant angular rate. Section III provides the kinematic

constraints a strong flowfield must satisfy such that a desired trajectory is feasible. Section IV

contains Lyapunov-based decentralized multi-vehicle control algorithms for vehicles traveling

in a strong flow. Section V assesses the feasibility of sampling trajectories in an idealized

hurricane model and illustrates the main results using simulations of the particle motion

under closed-loop control. Section VI summarizes the paper and ongoing work.

II. Self-Propelled Particle Dynamics in a Strong Flowfield

This section reviews the inertial motion of a self-propelled particle subject to a strong

external flowfield and derives a model of self-propelled particle motion with respect to a

reference frame rotating at a constant angular rate relative to an inertial frame. The rotating-

frame dynamics form the foundation for analysis of prospective hurricane sampling patterns

discussed in Section V.

A. Particle Motion With Respect to an Inertial Reference Frame

This paper extends an existing dynamic model common to many works on collective mo-

tion.7,9,12,22,23 The model consists of a collection of N self-propelled Newtonian particles.

Each particle is subject to a control force normal to its velocity and travels at a constant

speed relative to an external flowfield. It is assumed without loss of generality that the

flow-relative speed is unity. Given a ground-fixed inertial reference frame I with origin O

(identified with the complex plane), the kth particle’s position is represented by the vector

5 of 30

Page 6: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

eiθk

fk

rk

rk

Rerk

Imrk

γk θk

I

(a)

eiθk

fk

rk

rk

Rerk

Imrk

γk θk

I

(b)

Figure 1. Illustration of particle motion in a (a) moderate flowfield and (b) strong flowfield.

rk/O, or in complex coordinates [rk/O]I , rk = xk + iyk ∈ C. Given the unit-speed par-

ticle assumption, the kth particle’s velocity orientation can be represented by θk, a point

on the unit circle. Using complex coordinates, the kth particle’s flow-relative velocity is

cos θk + i sin θk = eiθk .

The state-feedback control uk determines the kth particle’s rate of change of velocity

orientation (steering control). The equations of motion for the kth particle in the absence of

a flowfield arec

rk = eiθk

θk = uk (r,θ) , k = 1, . . . , N.(1)

State-feedback control algorithms utilizing r and θ drive each particle to the desired collective

motion. Control algorithms producing collective motion with respect to particle model (1)

have been extensively studied in recent years.8,9,10,12,22,24,25

In the presence of a flowfield fk = f (rk) ∈ C each particle’s velocity is represented by

the vector sum of its velocity relative to the flow and the flow velocity relative to the inertial

frame I, as illustrated in Figure 1. In this case, the kth particle’s motion is governed by the

equations

rk = eiθk + fk

θk = uk (r,θ) , k = 1, . . . , N.(2)

Here the flow magnitude is allowed to exceed the speed of the particle relative to the flow.

Let γk represent the orientation of the kth particle’s inertial velocity and sk its magnitude.

Previous work on motion coordination in a moderate flow,7 i.e., where |fk| < 1, utilized the

cWe drop the subscript and use bold fonts to represent an N × 1 matrix, e.g., r = [r1 r2 ... rN ]T

and

θ = [θ1 θ2 ... θN ]T

.

6 of 30

Page 7: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

following coordinate transformation:

γk , arg(eiθk + fk) (3)

sk , |eiθk + fk|. (4)

Under this transformation, the equations of motion (2) become

rk = skeiγk

γk = νk,(5)

where νk is the control relative to the fixed inertial frame I. Controls uk and νk are related

byd

uk =νk − 〈f ′k, i〉

1− s−1k 〈eiγk , fk〉

=skνk − sk〈f ′k, i〉sk − 〈eiγk , fk〉

, (6)

where f ′k = ∂fk∂rk

. Figure 1 illustrates the particle model in both the moderate (Fig. 1(a)) and

strong flow (Fig. 1(b)) regimes. Note that a unit circle centered at the tip of fk represents

the possible values of rk = eiθk + fk.

Paley and Peterson7 showed that in a moderate flow the transformation (6) defines a one-

to-one mapping between uk (control of the flow-relative velocity orientation) and νk (control

of the velocity relative to I), since the denominator of (6) is never zero. This result allowed

development of control laws for (2), extending those developed for the flow-free model (1).

However, for flow speeds greater than or equal to the vehicle speed, the transformation (6)

from models (2) to (5) is no longer one-to-one. To see this, consider a particle at position

rk subject to a strong flow as shown in Figure 1(b). A unit circle drawn about the tip

of fk defines the possible orientations of the total velocity rk = eiθk + fk. The unit circle

rk = eiθk + fk in a strong flow is not guaranteed to enclose rk, which implies that the set of

possible inertial velocity orientations is a subset of the circle (called the cone of admissable

directions by Bakolas and Tsiotras19). In a moderate flow as illustrated in Figure 1(a) the

unit circle encloses rk, implying that any given θk corresponds to a single γk. Thus, in any

moderate flow a given θk maps to a single γk, but in a strong flow a given γk maps to one of

two possible θk’s. The speed sk is required to determine θk as shown in Figure 1(b). Lemma

1 identifies two singularities in the transformation (6), the proof of which is provided in the

appendix.

Lemma 1. For |fk| ≥ 1, the transformation (6) is singular when θk = arg(fk)±cos−1(|fk|−1).

Lemma 1 shows that strong flows introduce singularities in the coordinate transform (6),

d〈x, y〉 , Re (x∗y), where x∗ is the complex conjugate of x, denotes the inner product of complex numbersx and y.

7 of 30

Page 8: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

resulting in an unbounded turn rate. However, the design of the vehicle and the medium

in which it travels dictate the maximum controlled rate of turn a priori. The turn-rate

constraint can be modeled as saturation of uk, in which case (2) becomes

rk = eiθk + fk

θk = sat (uk (r,θ) ;umax) ,(7)

where

sat (u;umax) =

umax, u > umax

u, −umax ≤ u ≤ umax

−umax, u < −umax.(8)

The saturation model (7) allows use of model (5) to design νk and (6) to map νk to

uk. Unless restricted by the vehicle dynamics, umax must be chosen large enough so that

νmax = νmax(umax) > |κmaxsmax|, where κmax is the maximum desired curvature of the

particle trajectory and smax is the maximum particle speed along the trajectory. (The relation

between umax and νmax is discussed by Peterson and Paley.14) The upper bound on νk is

represented using γk = sat (ν (r, θ) ; νmax). As θk approaches either singularity provided in

Lemma 1, θk remains bounded, passing through the singular point at a constant rate ±umax.

B. Particle Motion with Respect to a Rotating Reference Frame

To achieve adequate radial and azimuthal sampling within a circulating flowfield, a proposed

sampling formation is that of a spirograph. When viewed with respect to a frame rotating

at constant angular rate, a spirograph becomes a circular trajectory. Control algorithms

producing circular trajectories are discussed in Section IV. Here, a dynamic model of self-

propelled particle motion in a rotating reference frame is derived.

Let I = (O, e1, e2, e3) represent an inertial reference frame with origin O and B =

(O,b1,b2,b3), where b3 = e3, represent a rotating reference frame with angular velocityIωB = Ωe3. (Complex notation is used to represent Cartesian coordinates in I and B.) The

orientation α = Ωt+ α(0) of frame B with respect to I satisfies e1 · b1 = cosα, as shown in

Figure 2(a). The inertial kinematics of the kth particle with respect to O are described by

rk , [rk/O]I and Ivk/O ,Iddt

(rk/O). Let the path frame Ck = (k, c1, c2, c3) be a frame with

origin at the kth particle’s position, where c3 = e3, c1 = Ivk/O/hk, and hk , ‖Ivk/O‖ is the

speed of the particle (equal to one when no flow is present). Let θk be the orientation of the

(flow-relative) velocity so that e1 · c1 = cos θk.

Since frame B shares its origin with frame I, the kinematics of the kth particle in frame

B are given by rk , [rk/O]B and Bvk/O ,Bddt

(rk/O). As in frame I, this gives rise to

the path frame Dk = (k,d1,d2,d3), with origin at rk, where d3 = e3, d1 = Bvk/O/hk,

8 of 30

Page 9: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

I

rk

α

B

b1

b2

e2

e1

θk

θk

O

Ω

(a)

Imrk

rk

θk

hkeiθk + fk = skeiγk

γk

B

hkeiθk

fk

RerkO

(b)

Figure 2. The orientation of the kth particle’s velocity (a) in no flow and (b) in flow f .

and hk , ‖Bvk/O‖ represents the speed of the kth particle relative to frame B. In B-

frame coordinates, (xk, yk)B, the position and velocity are given by rk/O = xkb1 + ykb2 andBvk/O = xkb1 + ykb2, respectively, which implies hk =

√x2k + y2

k. Let θk be the orientation

of Bvk/O relative to b1, so that b1 · d1 = cos θk.

The transport equation [26, p. 433–435], Ivk/O = Bvk/O+IωB×rk/O, gives the kinematic

relationship

hkc1 = hkd1 + Ωb3 × (xkb1 + ykb2) = hkd1 + Ω(xkb2 − ykb1). (9)

Noting that c1 = cos θke1 + sin θke2, (9) can be written

hk cos (θk − α) b1 + hk sin (θk − α) b2 =(hk cos θk − Ωyk

)b1 +

(hk sin θk + Ωxk

)b2. (10)

The inertial derivative of (9), assuming hk is constant, gives

hkθkc2 = ˙hkd1 + hk

(˙θk + Ω

)d2 −

(Ωyk + Ω2xk

)b1 +

(Ωxk − Ω2yk

)b2. (11)

By utilizing c2 = − sin (θk − α) b1 + cos (θk − α) b2, (11) results in the following scalar

equations of motion relative to reference frame B:

−hkuk sin(θ − α) = ˙hk cos θk − hk( ˙θk + Ω) sin θk − xkΩ2 − ykΩhkuk cos(θk − α) = ˙hk sin θk + hk(

˙θk + Ω) cos θk − ykΩ2 + xkΩ.(12)

Note that substituting xk = hk cos θk and yk = hk sin θk into (12) and using (10) to

9 of 30

Page 10: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

eliminate θk − α and hk gives

−ukhk sin θk − ukΩxk = ˙hk cos θk − hk( ˙θk + Ω) sin θk − xkΩ2 − hk sin θkΩ

ukhk cos θk − ukΩyk = ˙hk sin θk + hk(˙θk + Ω) cos θk − ykΩ2 + hk cos θkΩ.

(13)

Solving (13) for ˙hk and ˙θk, respectively, with complex notation rk = xk + iyk, results in the

equations of motion of the kth particle relative to frame B:

˙rk = hkeiθk

˙hk = (Ω2 − ukΩ)〈rk, eiθk〉˙θk = uk − 2Ω + h−1

k (Ω2 − uΩ)〈rk, ieiθk〉 , uk.

(14)

Let uk be defined as the flow-relative control with respect to rotating frame B. The

mapping from uk to uk is

uk =ukhk + 2Ωhk − Ω2〈rk, ieiθk〉

hk − Ω〈rk, ieiθk〉. (15)

Equations (14) and (15) are the equations of motion of a self-propelled particle represented

in coordinates relative to a rotating frame with constant angular rate Ω. Note that the

mapping from uk to uk is singular when hk = Ω〈rk, ieiθk〉. Lemma 2 establishes the singular

conditions with respect to the inertial speed hk. (The proof is provided in the appendix.)

Lemma 2. The control transform (15) is singular when hk = Ω〈rk, eiθk〉.

The singularity identified in Lemma 2 occurs when the speed of the vehicle is zero with

respect to frame B. For example, when eiθk is normal to rk and Ω > 0, the singular condition

simplifies to Ω−1 = |rk|.Next, augment the dynamics presented in (14) to include flow terms represented by fk.

Note fk = f(rk) ∈ C, is assumed to be time invariant with respect to frame B, which implies

that the corresponding flowfield with respect to frame I is azimuthally symmetric about O.

Again, adapting the kinematic model of the effect of the flow that is used to derive (2), the

flowfield is incorporated into (14) so that

˙rk = hkeiθk + fk

˙hk = (Ω2 − ukΩ)〈rk, eiθk〉˙θk = uk.

(16)

Note uk is still calculated from uk using (15).

10 of 30

Page 11: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

Path-planning applications desire control of the total velocity of the particle rather than

the flow-relative velocity. For this reason let

sk , |hkeiθk + fk| (17)

γk , arg(hkeiθk + fk), (18)

such that ˙rk = skeiγk . Figure 2(b) illustrates the following relations

sk cos γk = hk cos θk + 〈fk, 1〉sk sin γk = hk sin θk + 〈fk, i〉,

(19)

which after division yield

tan γk =hk sin θk + 〈fk, i〉hk cos θk + 〈fk, 1〉

. (20)

Taking the time derivative of (20) and using (19) gives

˙γk =〈 ˙fk, ie

iγk〉 − (Ω2 − ukΩ)[〈rk, skeiγk〉 − 〈rk, fk〉

]〈fk, ieiγk〉h−2

k +(sk − 〈fk, eiγk〉

)uk

sk, νk,

(21)

where νk represents control of the total velocity orientation with respect to the rotating

frame and ˙fk = ∂fk∂rk

˙rk. Using (21) with (15) yields the following mapping between uk and νk

necessary for implementing a control designed in the rotating frame for use in the inertial

frame:

uk =skνk−〈 ˙

fk,ieiγk 〉+2Ω(sk−〈fk,eiγk 〉)+Ω2〈rk,skeiγk−fk〉〈fk,ieiγk 〉h−2

k −Ω2(sk−〈fk,eiγk 〉)〈rk,iskeiγk−ifk〉h−2k

sk−〈fk,eiγk 〉−Ω|fk|2h−2k 〈rk,ie

iγk 〉+Ωskh−2k (〈rk,ifk〉+〈rk,eiγk 〉〈fk,ieiγk 〉+〈fk,eiγk 〉〈rk,ieiγk 〉)−Ωskh

−2k 〈rk,ie

iγk 〉.

(22)

The equations of motion of the kth particle with respect to a rotating frame subject to a

flowfield are:˙rk = ske

iγk

˙hk = (Ω2 − ukΩ) 〈rk, skeiγk − fk〉h−1k

˙γk = νk,

(23)

where uk is given by (22). Similar to the inertial-frame dynamics, saturation of uk is used

to avoid singularities in the transformations (15) and (22).

For a known, spatially varying flowfield, sk can be calculated as follows.7 Let fk = ηk+iβk

be the flowfield at rk, where ηk = 〈fk, 1〉 and βk = 〈fk, i〉 represent the real and imaginary

11 of 30

Page 12: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

fk

Leiγk

ieiγk

rk

Imrk

Rerk

fk

eiγk

I ieiγk

(a)

L

rk

Imrk

Rerk

eiθk

B

|Ω|−1

rkeiθk

α∗

(b)

Lrk

Imrk

Rerk

eiγk

B

fk

ieiγk

eiγk

ieiγk

fk

(c)

Figure 3. Feasibility constraint for (a) inertial frame, (b) rotating flow-free frame, and (c)rotating with-flow reference frame.

parts of the flow respectively. By definition (17) gives

sk =√h2k − η2

k − β2k + 2sk (ηk cos γk + βk sin γk). (24)

Squaring this result and utilizing the quadratic formula to solve for sk gives

sk = 〈eiγk , fk〉+√h2k − 〈ieiγk , fk〉2, (25)

where the positive root is taken since sk > 0.

III. Trajectory Feasibility in a Strong Flow

Strong flows present the possibility that a desired trajectory or formation is not feasible.

This section derives the kinematic conditions a flowfield must satisfy to ensure trajectory

feasibility. Conditions are derived for trajectories relative to both inertial and rotating

reference frames. These results have similarities to that of Bakolas and Tsiotras in assessing

the reachability of two points within a flowfield for a kinematic model of an aircraft,19 but this

paper considers flowfields that can vary continuously through space rather than flowfields

that are assumed to be regionally uniform.

A. Feasibility With Respect to an Inertial Reference Frame

A strong flowfield presents a challenge to coordinated motion if an individual vehicle is

unable to reach the desired trajectory. Moreover, the desired trajectory itself may not

be achievable if even a portion of the trajectory opposes the flow. The following analysis

describes a set of constraints the flow must satisfy such that a given desired trajectory is

feasible. (Equivalently, one can view the constraints as limiting the possible trajectories in

12 of 30

Page 13: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

(a) (b)

Figure 4. Feasible regions for (a) counterclockwise circular trajectories with radius |ω0|−1 = 20and (b) quadrifolium trajectories with maximum lobe length a = 20.

a given flowfield.)

For a vehicle to travel along curve L, the flow at every point on the path must be such

that the vehicle can maintain velocity tangent to L. That is, for every point on the desired

trajectory, the component of the flow normal to L must be less than the vehicle speed relative

to the flow. For a unit speed particle and tangent vector eiγk , this implies that the absolute

value of the inner product between the normal vector ieiγk and the flow fk must satisfy

|〈ieiγk , fk〉| ≤ 1. If 〈eiγk , fk〉 ≤ 0, then the flow opposes (or is normal to) the direction of the

trajectory and must therefore have magnitude less than one. If 〈eiγk , fk〉 > 0, then the flow

must only satisfy the normal constraint. This result is summarized as follows:

Theorem 1. Trajectory L is feasible in flowfield f if, for all rk ∈ L, fk = f (rk) satisfies

〈eiγk , fk〉 ≤ 0 and |fk| < 1, or

〈eiγk , fk〉 > 0 and |〈ieiγk , fk〉| ≤ 1,(26)

where eiγk is tangent to L at rk.

Theorem 1 implies that the flow vector at a given point on the trajectory must lie within a

U-shaped envelope oriented along the trajectory tangent, shown by the green-shaded region

in Figure 3(a). Trajectories that do not satisfy (26) are not feasible. Theorem 1 allows

one to quantify regions of a known, time-invariant flowfield in which parametric families

of feasible trajectories are found. Analysis over the entire space of candidate trajectory

centers produces a map of regions in which feasible trajectories can be achieved. Figure 4(a)

illustrates the feasible regions for fixed-size circular trajectories of radius |ω0|−1 = 20 in a

randomly generated strong flowfield. Figure 4(b) illustrates quadrifolium trajectories with

maximum lobe length a = 20 (folium trajectories are discussed in Section IV.C). A trajectory

13 of 30

Page 14: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

whose center lies in the shaded region is not feasible; unshaded regions are feasible. Red

arrows along the sampling trajectories indicate where the flow fails to satisfy the conditions

in Theorem 1.

B. Feasibility with Respect to a Rotating Reference Frame

Section II derives the dynamics of a self-propelled particle with respect to a rotating reference

frame. The equations of motion in (14) reveal that the speed of the particle in the rotating

frame is a dynamic variable whose time derivative depends on the position and velocity of the

particle. This subsection defines kinematic constraints on motion with respect to a rotating

reference frame.

In the absence of an external flow, the kinematic terms arising from the rotating reference

frame B affect the speed hk of the vehicle with respect to B. For a constant-speed particle

traveling in the direction of rotation, the speed of the particle with respect to B is a decreasing

function of the rotation rate and the distance to the center of rotation. For a given trajectory

to be feasible with respect to the rotating frame, a particle must maintain forward progress

over the entire trajectory, which implies the following result. It is assumed that a fixed point

in the rotating frame is not a feasible trajectory.

Lemma 3. Trajectory L is a feasible solution to (14) if |rk| < |Ω|−1, or if |rk| ≥ |Ω|−1 and

Ω〈rk, ieiθk〉 > 0 and |Ω〈rk, eiθk〉| ≤ 1, (27)

where eiθk is tangent to L at rk ∈ C.

Proof. Summing the squared components of (10) and using hk = 1 yields

1 = h2k + Ω2

(x2 + y2

)+ 2Ωhk(x sin θk − y cos θk).

Completing the square to solve for hk and simplifying with rk = xk + iyk gives

hk = Ω〈rk, ieiθk〉+√

1− Ω2〈rk, eiθk〉2, (28)

where the positive root is taken since hk > 0 is required to maintain forward progress. Note

that the inner products 〈rk, ieiθk〉 and 〈rk, eiθk〉 differ in phase by π/2 which implies that

for |rk| < |Ω|−1, (28) is real and positive. A trajectory is infeasible if (28) is negative or

complex, implying that for |rk| ≥ |Ω|−1 a feasible trajectory must satisfy (27).

Lemma 3 is illustrated for Ω > 0 in Figure 3(b). Feasible trajectories with |rk| ≥ |Ω|−1

must travel in a direction opposing the rate of rotation in order to maintain forward progress

14 of 30

Page 15: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

with respect to the rotating frame. Where the trajectory becomes infeasible is shown shown

as a dashed line. The range of feasible directions of travel is determined by the position

of the vehicle and rate of rotation of the rotating frame. Notice that in complex notation,

(10) can be written ei(θk−α) = hkeiθk + iΩrk. Therefore, one can represent the velocity with

respect to the rotating frame as hkeiθk = ei(θk−α)− iΩrk. The range of feasible velocities with

respect to the rotating frame is thus defined by a unit circle drawn about the tip of −iΩrk.In a similar manner to a vehicle’s range of travel in a strong flowfield,15 it can be shown that

for |rk| ≥ |Ω|−1, the angular range α∗ of feasible directions of travel about arg(−iΩrk) is

given by α∗ = 2 sin−1 (|Ωrk|−1). α∗ can be calculated by replacing the vector fk with −iΩrkin Figure 1(b) (also see Figure 10 in Appendix) and noting that α∗ is the angle formed

between the two lines tangent to the unit circle. Figure 10 denotes this angle as α∗ = 2ξ,

where ξ = sin−1(|Ωrk|−1).

When an external flowfield is present as in (16), the feasibility constraint on the flow-

field in a rotating frame is similar to Theorem 1. The transport equation [26, p. 433-435]

represented in complex coordinates with respect to frame B gives

ei(θk−α) + fke−iα = ske

iγk + iΩrk. (29)

An external flowfield is represented with respect to the rotating frame via the transport

equation such that in complex coordinates

fk = fkeiα + iΩrke

iα, (30)

where fk represents the flowfield relative to the rotating frame. Rearranging (30) reveals

fke−iα = fk + iΩrk, (31)

which when substituted into (29) gives

skeiγk = ei(θk−α) + fk. (32)

Equation (32) shows that the total velocity of the kth particle with respect to frame Bcan be represented as a unit circle drawn about the tip of fk. Similar to Theorem 1, for a

particle to travel along curve L in rotating frame B, the component of the flow normal to

the trajectory must be less than the vehicle speed with respect to the flow in the inertial

frame. For an inertially unit-speed particle and tangent angle eiγk in the rotating frame, this

implies that the absolute value of the inner product between the normal vector ieiγk and the

flow must satisfy |〈ieiγk , fk〉| ≤ 1. If 〈eiγk , fk〉 ≤ 0 then the flow is normal to or opposes the

15 of 30

Page 16: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

direction of travel and must therefore have magnitude less than one. If 〈eiγk , fk〉 > 0 only

the normal constraint must be satisfied. This implies the following result.

Theorem 2. Trajectory L in rotating reference frame B is a feasible solution to (23) with

flowfield f if for all rk ∈ L, fk = f (rk) is such that

〈eiγk , fk〉 ≤ 0 and |fk| < 1 or

〈eiγk , fk〉 > 0 and |〈ieiγk , fk〉| ≤ 1,(33)

where eiγk is tangent to C at rk.

Note that Theorem 2 has no apparent dependence on rk and Ω as in Lemma 3. The

dependence is implicit in fk, which is a function of both the external flow fk and the kinematic

term iΩrk as shown in (31).

IV. Multi-vehicle Control in a Strong Flowfield

This section reviews the design of multi-vehicle controls for a moderate flowfield and

derives circular and folium control laws for the particle model (7) in a strong flowfield. The

results of this section are also applicable to the model (16) for a rotating reference frame as

discussed in Section V.

A. Review of Curvature Control in a Moderate Flowfield

This section describes individual particle curvature control in a moderate flow, following

the work of Paley et al.,12 who produced decentralized algorithms to stabilize the family of

convex loops called superellipses in a flow-free environment and Techy et al.,23 where the

convex-loop results were extended to the vehicle model with (uniform) flow (5).

Our goal is to drive the kth particle about a smooth, closed curve L with definite, bounded

curvature, κk. To do so, L is parameterized by its center ck. In a ck-centered coordinate

system the particle position ρk is parameterized by the polar angle φk. For a closed curve

L, completion of one rotation about L sweeps through 2π radians. Thus, ρk (φ) ∈ R where

φk ∈ [0, 2π). The orientation of the particle’s inertial velocity relative to the ck centered

coordinate system is γk and it is assumed that a smooth mapping γk 7→ φ (γk) exists. The

derivative dρkdφk

is tangent to L, implying the constraint eiγk =∣∣∣ dρkdφk

∣∣∣−1dρkdφk

.

The local curvature is12

κk (φk) = ±dγkdσ

, (34)

where

σ (φk) =

∫ φk

0

∣∣∣∣dρdφ∣∣∣∣ dφ (35)

16 of 30

Page 17: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

is the arc length along the curve. Note that the sign of κk determines the direction of

rotation about the curve, which is either clockwise or counterclockwise. Equations (34) and

(35) imply12

κ−1k = ±dσk

dφk

dφkdγk

= ±∣∣∣∣dρkdφk

∣∣∣∣ dφkdγk. (36)

Under the tangent constraint, (36) can be written12

eiγkκ−1k = ±dρk

dφk

dφkdγk

=dρkdγk

.

In a reference frame not centered at ck, L has center ck = rk ∓ ρk. The time derivative

along solutions of (5) gives the velocity of the center7,12

ck = skeiγk ∓ dρk

dγk

dγkdt

= eiγk[sk ∓ κ−1

k νk]. (37)

From (37) note that the curvature control algorithm7

νk = ±κksk (38)

forces ck = 0, implying that the kth particle drives about a stationary C.This work uses Lyapunov analysis to design decentralized controls to collectively steer

the particles such that they achieve coincident centers, i.e., c = [c1 c2 ... cN ]T = c01, where

c0 ∈ C and 1 ∈ RN . Consider the potential function23

S (r,γ) =1

2〈c,Pc〉 (39)

where P is an N × N projection matrix, P = IN×N − 1N

11T . P defines the communica-

tion topology of the system and in this paper corresponds to all-to-all communication.27

(Extensions of the flow-free model to limited communication topologies is possible,25,28 but

outside the scope of this paper.) Equation (39) is positive semi-definite with equality to zero

occurring when c = c01, c0 ∈ C. Using (37), the time derivative of (39) is7,12,23

S (r,γ) =N∑k=1

〈ck, Pkc〉 =N∑k=1

〈eiγk ,Pkc〉(sk ∓ κ−1

k νk), (40)

where Pk is the kth row of P. The control12,23

νk = ±κk(sk +K〈eiγk ,Pkc〉

)(41)

17 of 30

Page 18: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

substituted into (40) gives12,23

S (r,γ) = −KN∑k=1

〈eiγk ,Pkc〉2 ≤ 0. (42)

The invariance principle stipulates that solutions of (5) with control (41) converge to the

largest invariant set Λ where12

〈eiγk ,Pkc〉 ≡ 0. (43)

Since eiγk 6= 0, then Pkc = 0 in Λ, which is satisfied when the centers are coincident.

Moreover, when (43) is satisfied the control in (41) simplifies to (38) which implies c = 0.

(Note that this framework does not incorporate collision avoidance between particles.)

A simple example of this control strategy is that of a circular formation. A circle has

constant curvature, κk = ω0 for all k, which defines a radius of |ω0|−1. A particle traversing

a circular trajectory has total velocity tangent to the radius of the circle. Thus, the center

of the kth particle’s trajectory with control νk = ω0sk is7

ck = rk + ω−10

rk|rk|

= rk + ω−10 eiγk . (44)

The vector c is then used to calculate the control of kth particle according to (41) with

κk = ω0.

B. Decentralized Multi-vehicle Control in a Strong Flowfield

This section describes the design of a multi-vehicle control law that steers individual particles

to a desired feasible formation in a strong flowfield. Lyapunov analysis is used to establish

the stability of multi-vehicle formations in a strong flow when the initial formation centers lie

within a feasible ball about a feasible steady-state reference center c0. The notation B (x, a)

is used to represent a ball of radius a centered about x ∈ C.

Theorem 3. Consider a strong flow fk. Let F be a feasible region and c0 ∈ C. Let

νmax > maxk,t|ω0sk(t)|

and B (c0, |ck (0)− c0|) ⊂ F . The model (7) with the mapping (6) and

νk = sat(ω0

(sk +K〈eiγk , ck − c0〉

); νmax

)(45)

forces convergence of the kth particle to a circular formation of radius |ω0|−1 centered at c0.

18 of 30

Page 19: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

Proof. Consider the candidate potential function

V =1

2|ck − c0|2, (46)

where ck is given by (44). The time derivative of (46) is

V = 〈ck − c0, ck〉 = 〈ck − c0, eiγk〉

(sk − ω−1

0 νk). (47)

Note from (45) that for |νk| < νmax

〈ck − c0, eiγk〉 =

νk − ω0skKω0

. (48)

Substituting this result into (47) gives

V =

(νk − ω0skKω0

)(sk − ω−1

0 νk)

= −(νk − ω0sk)2

Kω20

≤ 0. (49)

When |νk| = νmax, V < 0 since νmax > maxk,t |ω0sk(t)|. Consequently, ck is contained by

B (c0, |ck (0)− c0|) ⊂ F . Moreover, solutions converge to the largest invariant set in which

V = 0. From (45) and (47) this set contains solutions for which νk = ω0sk, which implies

ck = c0.

Theorem 3 shows that an individual particle will converge to a reference center provided

that the reference center and a ball containing the initial particle centers lie within a feasible

region. We call this reference center a prescribed center and any particle with information of

the prescribed center an informed particle. The following result shows that a multi-vehicle

system having initial centers in a feasible region and at least one informed particle will

converge to a prescribed center in the same feasible region.

Theorem 4. Consider a strong flowfield fk. Let F be a feasible region and c0 ∈ C. Also, let

νmax > maxk,t|ω0sk(t)| ,

and

B(c0,maxk|ck (0)− c0|) ⊂ F . (50)

The model (7) with the mapping (6) and

νk = sat(ω0

[sk +K

(〈eiγk ,Pkc〉+ ak0〈eiγk , ck − c0〉

)]; νmax

), K > 0, (51)

where ak0 = 1 for at least one particle and zero otherwise, forces convergence to the circular

19 of 30

Page 20: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

formation of radius |ω0|−1 centered at c0.

Proof. Consider the composite potential function10

S = 12〈c,Pc〉+ 1

2

∑Nk=1 ak0 |ck − c0|2 . (52)

The time derivative of (52) along solutions of (7) is

S =N∑k=1

(〈eiγk , Pkc〉+ ak0〈eiγk , ck − c0〉

) (sk − ω−1

0 νk).

For νk < νmax notice from (51)

νk − ω0skKω0

= 〈eiγk , Pkc〉+ ak0〈eiγk , ck − c0〉

giving

S = −∑Nk=1

(νk−ω0sk)2

Kω20≤ 0. (53)

When νk = νmax, S < 0 since νmax > maxk,t |ω0sk(t)|. Therefore the collection of particle

centers is bounded within the ball (50). Solutions converge to the largest invariant set for

which S = 0, which occurs when νk = ω0sk for all k, implying from (51)

〈eiγk ,Pkc〉+ ak0〈eiγk , ck − c0〉 = 0 (54)

for all k.

If ak0 = 0 for at least one and at most N − 1 particles, then (54) is satisfied only if

Pkc = 0, which occurs when ck = cj for all k and j. For k with ak0 = 1, (54) is satisfied

only if ck = c0. Therefore, c must satisfy c = c01.7

Note that the control is calculated based on the inertial variable γk, which corresponds to

one of two values of θk. This implies that the control does not differentiate between aligning

of opposing the flowfield. In circulating flowfields, simulation results show that particles with

random initial conditions converge to a circular formation in which particles aligned with

the flow travelled faster than those anti-aligned. Simulations also showed that increasing the

gain K in (51) tends to align particles with the flow.

Figure 5(a) shows simulation results in the randomly generated strong flowfield previ-

ously shown in Figure 4. Particle trajectories are shown in light grey and the final particle

formation is shown in dark grey. The circular control parameters were |ω0|−1 = 20, K = 0.01,

and c0 = −40 + 30i. Note c0 was chosen to be consistent with the feasibility analysis shown

in Figure 4(a). The value of νmax was calculated from umax = π/2 rad/s. Note from Figures

20 of 30

Page 21: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

60 40 20 0 20 40 60

60

40

20

0

20

40

60

Re(r)

Im(r)

(a)

60 40 20 0 20 40 60

60

40

20

0

20

40

60

Re(r)

Im(r)

(b)

Figure 5. Simulation of N = 10 particles in an arbitrary strong flow (a) with circular controlalgorithm (51) and (b) with curvature control (59) to a quadrifolium formation.

4(a) and 5(a) that B(maxk |ck(0) − c0|) does not lie entirely in a feasible region, yet the

particle centers still converge to c0. Simulation results also indicate that a circular formation

converges even when a formation center is not prescribed.

C. Stabilization of Folium Formations

An existing strategy for data collection in a hurricane is to fly a figure-four pattern through

the center of the hurricane.e A continuously differentiable flight path covering similar spatial

densities is that of the n-petalled folium, or polar rose, where n ≥ 3.f Specifically, the

quadrifolium (n = 4) is a pattern similar to a figure-four with continuous curvature. In

polar coordinates, the equation of the n-folium is ρk = a sin (gk (n)φk), where ρk is the

distance of the kth particle from the ck, n is the number of lobesg, φ ∈ [0, 2π] is the central

or polar angle, a is the maximum radius of the lobes, and

g(n) =

n, n odd

n/2, n even.

Section IV.A reviews how the control νk = κksk, where κk = κk (γk) is the curvature,

drives the particle along the desired curve. Previous work required the curvature to be

nonzero and the figure to be convex.11,12,23 Here this convexity assumption is relaxed. The

n-folium is not convex; however, its curvature is strictly positive (or negative). In traversing

one rotation about the figure the particle velocity rotates through 2π (g (n)− 1) radians for

eWilloughby, H. and Majumdar, S., Personal Communication, July 14, 2011fWeisstein, E. C., “Quadrifolium”, http://mathworld.wolfram.com/Quadrifolium.html, 11 Oct., 2011gn must be odd or divisible by four to be considered a folium.

21 of 30

Page 22: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

n odd and 2π (g (n) + 1) radians for n even. Using curvature control νk = κk(γk)sk requires

γk to be defined over 2π (g (n)± 1) radians. To accomplish this, one can augment the state-

space equations with an integer lobe-counter, lk ∈ N, which represents the number of lobes

a particle has traversed. When a particle’s inertial velocity orientation γk reaches 2π rad, lk

increases by one and the orientation angle γk is reset to zero. Utilizing the curvature control

as a function of γk and lk gives

νk = κk (γk (θk) + 2πlk) sk. (55)

Equation (55) drives the kth particle about a non-convex figure with strictly positive (nega-

tive) curvature.

In the case of the folium, the curvature is the following function of the polar angle φk:f

κk (φk) =|ρ2k + 2ρ′2k − ρkρ′′k|(ρ2k + ρ′2k )

3/2=

n2 + n2 sin2 (nφk) + cos2 (nφk)

a[cos2 (nφk) + n2 sin2 (nφk)

]3/2 . (56)

In order to provide state feedback, one must specify φk as a function of the tangent angle γk

such that the curvature control law is valid. This relation for the quadrifolium isf

γk (φk) =1

2π + φk − tan−1 (cotφk − tanφk) + πb2φk/πc. (57)

Note the tangent angle is a function of the polar angle, not vice versa. To numerically

implement (57) requires use of a look-up table. From (56) and (57) one can calculate the

curvature as a function of the inertial orientation, such that the control (55) drives the

particle around the quadrifolium trajectory. The following result extends Theorem 4 to

curves with definite curvature.

Proposition 1. Consider a strong flow fk. Let F be a feasible region and c0 ∈ C. Also let

νmax > maxk,t|κk(γk(t))sk(t)| ,

and

B(c0,maxk|ck (0)− c0|) ⊂ F . (58)

Consider the quadrifolium with curvature κk given by (56) and γk given by (57). For the

model (7), the mapping (6) with

νk = sat(κk[sk +K

(〈eiγk ,Pkc〉+ ak0〈eiγk , ck − c0〉

)]; νmax

), (59)

where ck = ck(γk) is the instantaneous center of the quadrifolium, forces convergence of the

22 of 30

Page 23: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

(a)

80 60 40 20 0 20 40 60 8080

60

40

20

0

20

40

60

80

Re(r)

Im(r)

(b)

Figure 6. (a) Regions of achievable centers for counterclockwise circular trajectories of radius

|ω0|−1 = 30; (b) simulation of the control (51) for N = 10 particles with c0 = 0.

kth particle about a quadrifolium formation centered at c0.

Simulation results for N = 10 particles in a quadrifolium formation centered at c0 =

−50 + 50i are shown in Figure 5(b) where c0 was chosen consistent with the feasibility

analysis of Figure 4(b). Note from Figure 4(b) that a ball containing initial particle centers

defined in (50) does not entirely lie in a feasible region, implying that Proposition 1 is overly

conservative.

V. Design and Stabilization of Hurricane Sampling Patterns

This section considers multi-vehicle sampling patterns in an azimuthally symmetric vor-

tex model of an idealized hurricane. In a Rankine vortex29 the tangential windspeed varies

linearly with radius to its maximum vmax at the radius of maximum wind rmax and exponen-

tially decreases for radii greater than rmax with exponential decay constant µ. The Rankine

vortex model is arg(fk) = arg(irk) and

|f(rk)| =

vmax (|rk|/rmax) , 0 < |rk| < rmax

vmax (|rk|/rmax)−µ , |rk| > rmax,

where radius r = rmax represents the eyewall of an idealized hurricane. The following analysis

uses the Rankine vortex parameters vmax = 1.5, rmax = 30, and µ = 0.6.

Circular formations are an attractive sampling option in a circulating flowfield because

large regions of the flowfield are feasible centers of rotation. Figure 6(a) shows the result of

evaluating the kinematic constraint (26) for a circular trajectory of radius |ω0|−1 = rmax. A

23 of 30

Page 24: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

(a)

60 40 20 0 20 40 6060

40

20

0

20

40

60

Re(r)

Im(r)

(b)

Figure 7. (a) Regions of achievable centers for quadrifolium trajectories of radius a = 20; (b)simulation of control (51) with N = 10 particles.

drawback of this formation is the resulting limitations of the azimuthal and radial sampling

densities. For example, a circular formation centered at the origin of a vortex provides good

azimuthal sampling but poor radial sampling. A formation not centered at the origin of

the vortex provides measurements at multiple radii at the expense of under-sampling some

quadrants of the vortex. Figure 6(b) shows simulation results of the control algorithm in (51)

with c0 = 0 and |ω0|−1 = rmax, which provides sampling of the idealized hurricane eyewall.

Figure 7(a) illustrates analysis of the feasibility of quadrifolium with a = 20 over a space

of centers contained within the Rankine vortex. Figure 7(b) illustrates simulation of the

control (59) with N = 10 particles and reference center c0 = 0. rmax is depicted by a

black circle. Feasibility analysis reveals that feasible folia are centered close to the origin.

Moreover, quadrifolia centered about the origin with a = 20 are in a moderate flow regime

for the majority of the trajectory. This analysis implies that quadrifolium formations may

be a poor candidate sampling trajectory in strong flows due to their infeasibility over large

areas and lack of sampling both inside and outside rmax.

An alternative to circular and folium trajectories that achieves good sampling density

and is feasible in a strong Rankine vortex is a spirograph trajectory. A spirograph is achieved

by traversing a circle with respect to a rotating frame. The spirograph family of formations

combines the advantages of circular and folia formations in that they generally align with

the vortex while criss-crossing the radius of maximum wind. For a given rate of rotation Ω,

circle radius |ω0|−1, and radius of circle center d, the feasibility of the resulting formation can

be analyzed using Theorem 2. Figure 8 shows the feasibility of various spirograph parameter

sets in the presence of a Rankine vortex. In each figure, the results are generalized by using

non-dimensional parameter sets (Ω, ω−10 , ρ) in terms of the Rankine vortex parameters rmax

and vmax, where Ω , (2πΩrmax)/vmax (the period of revolution of a passive particle at rmax),

d , d/rmax, and |ω0|−1 , |ω0|−1/rmax. In Figure 8(a), the feasibility of rate of rotation Ω

24 of 30

Page 25: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

(a) (b)

Figure 8. (a) Feasibility of spirograph formations for varying non-dimensional Ω and d values

with fixed radius ω−10 = 2/3, (b) spirograph feasibility for varying Ω and ω−10 with d = 1.

is plotted versus the distance of circle center from the origin for a counterclockwise circle of

constant radius, |ω0|−1 = 2/3. In 8(b), the feasibility of Ω is plotted versus the radius of the

circle for a fixed distance, d = 1. Dark areas indicate where the parameter set (Ω, ω−10 , d) is

infeasible.

Figure 9 shows simulations of the steering control (51) used in the equations of motion

(23) for N = 10 particles. The formation parameters are Ω = 0.0125 rad/s, ω−10 = 40, and

ρ = 30 (Ω = 1.57, |ω0|−1 = 4/3 and d = 1). Note from Figure 8(b) that this parameter

set corresponds to a feasible formation as required. A circular formation with respect to a

rotating reference frame produces a spirograph formation in an inertial reference frame. By

manipulating Ω, ω−10 , and d, spirograph trajectories can be made to concentrate radial and

azimuthal sampling densities to areas of interest within the vortex. This technique potentially

provides superior sampling coverage as compared to the circular and quadrifolium formations

of Figures 6 and 7.

VI. Conclusion

A strong flow presents challenges to multi-vehicle autonomous formation control. The

presence of strong flows limit the authority of the vehicle to completely dictate its inertial

direction of travel, making path planning and collective formation control algorithms more

difficult to design. However, decentralized multi-vehicle control algorithms driving particles

to desired formations are feasible in circulating flowfields. This paper utilizes an idealized

vehicle model consisting of identical unit-speed Newtonian particles with gyroscopic steering

control in a flowfield whose magnitude can exceed one. The authors address the properties

a flowfield must satisfy such that given trajectory is feasible and show that circular for-

25 of 30

Page 26: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

80 60 40 20 0 20 40 60 8080

60

40

20

0

20

40

60

80

Re(r)

Im(r)

(a)

80 60 40 20 0 20 40 60 8080

60

40

20

0

20

40

60

80

Re(r)

Im(r)

(b)

Figure 9. Spirograph formation produced by utilizing circular control with respect to rotatingframe with flow; in (a) an inertial reference frame and (b) a rotating reference frame.

mations will converge to a reference center as long as the reference center is feasible. By

using a lobe-counting variable, this work numerically derives and illustrates a control law

driving a collection of particles to a family of non-convex curves called folia, specifically the

quadrifolium. This curve closely matches that of existing hurricane sampling trajectories

of manned, and remotely piloted vehicles. Finally, the dynamics of an inertially unit speed

particle with respect to a rotating frame are derived to produce spirograph sampling forma-

tions. The authors derive the kinematic feasibility constraints of motion with respect to the

rotating frame and simulate vehicle motion in an idealized hurricane model.

This paper not only expands the applicability of multi-vehicle control to strong flow-

fields but also derives control algorithms to steer vehicles to non-convex patterns, namely

the quadrifolium and the spirograph. These formations may produce better data in environ-

mental sampling missions than those currently in use. Coupled with kinematic constraints

analyzing the feasibility of families of sampling trajectories, the control algorithms derived

in this paper can be used to provide vital information for multi-vehicle sampling missions al-

lowing researchers to choose from various families of sampling trajectories based on both the

goals of the sampling mission and the feasibility of the various sampling trajectories. This

concept was applied to an idealized hurricane model which revealed that spirograph trajec-

tories may be superior to both circular and quadrifolium trajectories in terms of feasibility

and radial and azimuthal sampling density.

Ongoing work seeks to derive control laws converging to a wider set of strong flows and

continues investigation of general flowfield properties that dictate the convergence of multi-

vehicle formations. In addition, the authors seek to optimize over the feasible parameter

space of spirograph sampling formations using the anticipated reduction in forecast error as

a performance metric.

26 of 30

Page 27: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

eiθk

fk

Rerk

Imrk

rk

eiθk + fk Rerk

Imrk

φk

φk

θk

λ

ξ

Figure 10. Orientation relations corresponding to singularities of (6).

Appendix

Proof of Lemma 1: Substituting eiγk = |eiθk +fk|−1(eiθk +fk) and (4) into the denominator

of (6) implies that uk is singular when

sk = 〈eiγk , fk〉 = |eiθk + fk|−1〈eiθk + fk, fk〉 = sk−1(〈eiθk , fk〉+ |fk|2

). (60)

If one considers the flow fk in its polar form fk = |fk|eiψk , where ψk = arg (fk), substitution

into (60) and solving for 〈eiθk , eiψk〉 gives

〈eiθk , eiψk〉 = cos(ψk − θk) = |fk|−1(s2k − |fk|2

)= |fk|−1

(|eiθk + fk|2 − |fk|2

). (61)

Figure 10 shows that when eiθk is drawn such that∣∣eiθk + fk

∣∣ is tangent to a unit circle

drawn about fk, a right triangle is formed with hypotenuse |fk| and sides∣∣eiθk + fk

∣∣ and∣∣eiθk∣∣. Since the vector triad forms a right triangle15 let ξ , sin−1(|fk|−1), and since the sum

of the interior angles of a triangle are supplementary,

ξ + λ+π

2= π. (62)

By projecting fk, we observe

θk − ψk + λ = π. (63)

Equating (63) and (62) and taking the cosine of the result implies

cos (θk − ψk) = −|fk|−1, (64)

which when substituted into (61) gives the Pythagorean Theorem, |eiθk + fk|2 + 1 = |fk|2.

Thus, when sk = 〈eiγk , fk〉, θk is such that eiθk , fk, and eiθk +fk form a right triangle. Solving

27 of 30

Page 28: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

(64) for θk while noting cos (θk − ψk) = cos (ψk − θk) completes the proof.

Proof of Lemma 2: The absolute value of (9) squared gives

h2k = h2

k + Ω2〈r, r〉 − 2Ω〈r, ieiθk〉. (65)

Substituting the singular condition hk = Ω〈rk, ieiθk〉 into (65) yields

h2k = Ω2〈rk, ieiθk 〉2 + Ω2〈rk, rk〉 − 2Ω2〈rk, ieiθk〉2

= Ω2〈rk, eiθk〉2,

revealing a relation between the speed of a particle and its position. The mapping can

become singular when

hk = Ω〈rk, eiθk〉. (66)

Specifically, if the vehicle is assumed to travel at unit speed in the inertial frame the mapping

is singular if Ω−1 = 〈rk, eiθk〉.

Acknowledgments

The authors would like to acknowledge discussions with Angela Maki, Doug Koch, and

Sharan Majumdar related to this work. In addition, acknowledgement is owed to Hugh

Willoughby and Sharan Majumdar for personal communications regarding current hurricane

sampling methods of manned aircraft flights. This material is based upon research supported

by the National Science Foundation under Grant No. CMMI0928416 and the Office of Naval

Research under Grant No. N00014-09-1-1058.

References

1Whitcomb, L., Jakuba, M., Kinsey, J., Martin, S., Webster, S., Howland, J., Taylor, C., Gomez-

Ibanez, D., and Yoerger, D., “Navigation and control of the Nereus hybrid underwater vehicle for global ocean

science to 10,903 m depth: Preliminary results,” Robotics and Automation (ICRA), 2010 IEEE International

Conference on, May 2010, pp. 594–600.

2Elston, J., Argrow, B., Frew, E., and Houston, A., “Evaluation of UAS Concepts of Operation for Se-

vere Storm Penetration using Hardware-in-the-Loop Simulations,” AIAA Guidance, Navigation, and Control

Conference, Toronto, Canada, August 2010, pp. 8178–8193.

3Lin, P., “OBSERVATIONS: The First Successful Typhoon Eyewall-Penetration Reconnaissance Flight

Mission Conducted by the Unmanned Aerial Vehicle, Aerosonde,” Bulletin of the American Meteorological

Society , Vol. 87, 2006, pp. 1481–1483.

4Elston, J., Semi-Autonomous Small Unmanned Aircraft Systems for Sampling Tornadic Supercell

Thunderstorms, Ph.D. thesis, University of Colorado, 2011.

28 of 30

Page 29: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

5Amarin, R. A., Jones, L., Johnson, J., Ruf, C., Miller, T., and Chen, S., “Estimates of Hurricane Wind

Speed Measurement Accuracy Using the Airborne Hurricane Imaging Radiometer,” Proceedings of the 29th

Conference on Hurricane and Tropical Meteorology , Tucson, AZ, May 2010.

6Ivancic, W. and Sullivan, D., “Delivery of Unmanned Aerial Vehicle DATA,” Earth Science Technology

Forum, Arlington, VA, June 2010.

7Paley, D. A. and Peterson, C., “Stabilization of Collective Motion in a Time-Invariant Flowfield,”

AIAA Journal of Guidance, Control, and Dynamics, Vol. 32, June 2009, pp. 771–779.

8Brinon Arranz, L., Seuret, A., and Canudas de Wit, C., “Translation Control of a Fleet Circular

Formation of AUVs under Finite Communication Range,” Proceedings of the 48th IEEE Conference on

Decision and Control , Shanghai, China, December 2009, pp. 8345–8350.

9Brinon Arranz, L., Seuret, A., and Canudas de Wit, C., “Contraction Control of a Fleet Circular

Formation of AUVs under Limited Communication Range,” Proceeding of the 2010 American Control Con-

ference - ACC2010 , Baltimore, MD, June 2010, pp. 5991–5996.

10Sepulchre, R., Paley, D. A., and Leonard, N. E., “Stabilization of Planar Collective Motion: All-to-All

Communication,” IEEE Transactions on Automatic Control , Vol. 52, May 2007, pp. 811–824.

11Zhang, F. and Leonard, N. E., “Coordinated Patterns of Unit Speed Particles on a Closed Curve,”

Systems and Control Letters, Vol. 56, 2007, pp. 397–407.

12Paley, D. A., Leonard, N., and Sepulchre, R., “Stabilization of Symmetric Formations to Motion

around Convex Loops,” Systems and Control Letters, Vol. 57, December 2006, pp. 209–215.

13Frew, E., Lawrence, D., and Morris, S., “Coordinated Standoff Tracking of Moving Targets Using

Lyapunov Guidance Vector Fields,” AIAA Journal of Guidance, Control, and Dynamics, Vol. 31, March

2008, pp. 290–306.

14Peterson, C. and Paley, D. A., “Multi-Vehicle Coordination in an Estimated Time-Varying Flowfield,”

AIAA Journal of Guidance, Control, and Dynamics, Vol. 34, 2011, pp. 177–191.

15Kwok, A. and Martınez, S., “Deployment of Drifters in a Piecewise Constant Flow Environment,”

Proceedings of the IEEE Int. Conference on Decision and Control , Atlanta, GA, December 2010.

16Kwok, A. and Martınez, S., “A Coverage Algorithm for Drifters in a River Environment,” Proceedings

of the 2010 American Control Conference, Baltimore, MD, 2010, pp. 6436–6441.

17Khalil, H. K., Nonlinear Systems, Prentice Hall, 3rd ed., 2002.

18Thompson, D. R., Chien, S., Chao, Y., Li, P., Cahill, B., Levin, J., Schofield, O., Balasuriya, A.,

Petillo, S., Arrott, M., and Meisinger, M., “Spatiotemporal Path Planning in Strong, Dynamic, Uncertain

Currents,” IEEE International Conference on Robotics and Automation, Anchorage, AK, 2010, pp. 4778–

4783.

19Bakolas, E. and Tsiotras, P., “Minimum-Time Paths for a Light Aircraft in the Presence of Regionally-

Varying Strong Winds,” In AIAA Infotech at Aerospace, AIAA Paper 2010-3380, Atlanta, GA, April 2010.

20Rysdyk, R., “Course and Heading Changes in Significant Wind,” AIAA Journal of Guidance, Control,

and Dynamics, Vol. 30, July-August 2007, pp. 1168–1171.

21Ceccarelli, N., Enright, J. J., Frazzoli, E., Rasmussen, S. J., and Schumacher, C. J., “Micro UAV Path

Planning for Reconnaissance in Wind,” Proceedings of the 2007 American Control Conference, New York

City, USA, July 2007, pp. 5310–5315.

22Justh, E. W. and Krishnaprasad, P. S., “Equilibria and Steering Laws for Planar Formations,” Systems

and Control Letters, Vol. 52, 2003, pp. 25–38.

29 of 30

Page 30: Multi-vehicle Control in a Strong Flow eld with ...cdcl.umd.edu/papers/jgcd11.pdf · loop system [17, p. 126{133]. The results of this work have additional applications in path planning

23Techy, L., Paley, D. A., and Woolsey, C., “UAV Coordination on Closed Convex Paths in Wind,”

AIAA Journal of Guidance, Control, and Dynamics, Vol. 33, 2010, pp. 1946–1951.

24Justh, E. W. and Krishnaprasad, P. S., “Steering Laws and Continuum Models for Planar,” Proceedings

of the 42nd IEEE Conference on Decision and Control , Maui, HI, December 2003, pp. 3609–3614.

25Sepulchre, R., Paley, D. A., and Leonard, N. E., “Stabilization of Planar Collective Motion with

Limited Communication,” IEEE Transactions on Automatic Control , Vol. 53, April 2008, pp. 706–719.

26Kasdin, N. and Paley, D. A., Engineering Dynamics: A Comprehensive Introduction, Princeton Uni-

versity Press, 2011.

27Fax, J. A. and Murray, R. M., “Information Flow and Cooperative Control of Vehicle Formations,”

IEEE Transactions on Automatic Control , Vol. 49, No. 9, September 2004, pp. 1465–1476.

28Almeida, J., Silvestre, C., and Pascoal, A., “Coordinated Control of Multiple Vehicles with Discrete-

Time Periodic Communications,” Proceedings of the 46th IEEE Conference on Decision and Control , New

Orleans, LA, December 2007, pp. 2888–2893.

29Krener, A. and Ide, K., “Measures of Unobservability,” Proceedings of the 48th IEEE Conference on

Decision and Control , Shanghai, China, December 2009, pp. 6401–6406.

30 of 30