Académique Documents
Professionnel Documents
Culture Documents
I. I NTRODUCTION
Avoiding harms ways requires the employment of intelligent autonomous vehicles. This, along with recent advances in miniature technology, brings a global spotlight
on the development of Unmanned Aerial Vehicles (UAVs).
Currently, the use of UAVs plays a crucial role in preventing exposure of human beings to uncertain and hostile
environments, therefore avoiding any danger to the lives of
operators. For instance, after being struck by the biggest
recorded earthquake and a devastating tsunami, Japan has
been fighting a potential nuclear catastrophe by deploying
UAVs in situations where the presence of human operators
was hazardous.
From a design point of view, and with a slight abuse of
terminology, UAVs can be classified in two main categories:
fixed-wings and rotatory-wings. Compared to the fixed-wings
which cannot freely move in any direction (rotate) or
hold a constant position, rotorcrafts can be deployed in
a much wider variety of scenarios. Among rotatory-wings
aircraft, quadrotors play an important role in research areas
as prototypes for real-life missions, including monitoring and
exploration of small areas.
A quadrotor consists of four blades, whose motion control
is achieved by adjusting the angular rate of one or more
rotor discs. Control of quadrotors is quite challenging and
Research is supported in part by USSOCOM, ONR, AFOSR, ARO, and
CO3AUVs of the EU.
V. Cichella, E. Xargay, and N. Hovakimyan are with UIUC, Urbana,
IL 61801, e-mail: {cichell2,xargay,nhovakim}@illinois.edu. I. Kaminer
and V. Dobrokhodov are with NPS, Monterey, CA 93943, email:
{kaminer,vldobr}@nps.edu. P. Aguiar and A. Pascoal are with IST, Lisbon,
1049 Portugal, email: pedro,antonio@isr.ist.utl.pt.
Form Approved
OMB No. 0704-0188
Public reporting burden for the collection of information is estimated to average 1 hour per response, including the time for reviewing instructions, searching existing data sources, gathering and
maintaining the data needed, and completing and reviewing the collection of information. Send comments regarding this burden estimate or any other aspect of this collection of information,
including suggestions for reducing this burden, to Washington Headquarters Services, Directorate for Information Operations and Reports, 1215 Jefferson Davis Highway, Suite 1204, Arlington
VA 22202-4302. Respondents should be aware that notwithstanding any other provision of law, no person shall be subject to a penalty for failing to comply with a collection of information if it
does not display a currently valid OMB control number.
1. REPORT DATE
3. DATES COVERED
2. REPORT TYPE
DEC 2012
00-00-2012 to 00-00-2012
6. AUTHOR(S)
8. PERFORMING ORGANIZATION
REPORT NUMBER
UIUC,Urbana,IL,61801
9. SPONSORING/MONITORING AGENCY NAME(S) AND ADDRESS(ES)
Preprint Conference on Decision and Control, December 2012,Government or Federal Purpose Rights
License.
14. ABSTRACT
b. ABSTRACT
c. THIS PAGE
unclassified
unclassified
unclassified
17. LIMITATION OF
ABSTRACT
18. NUMBER
OF PAGES
Same as
Report (SAR)
19a. NAME OF
RESPONSIBLE PERSON
Quadrotors
Path
Generation
ui
xd,i (i )
PFi
xi
PF
errors
i
Time
Coordination
i
Network
Exchange
i
Fig. 1.
xP F,i = e
R12 .
(6)
, e,i
x,i , ev,i , eR,i
for some 0 < vd max,i < vmax , where vmax is the maximum
operational speed of the quadrotors. The choice of the
parameterizing variable i will be discussed later.
Then, we can define the position error vector as
ex,i = xd,i (i ) xi R3
(2)
xd,i (i )
i x i = x d,i (i ) x R3 .
i
Rd,i
Ri Ri Rd,i ,
eR,i
=
2
e,i = i Ri Rd,i d,i ,
3
(3)
(4)
(5)
where Ri SO(3) and i R are, respectively, the rotation matrix from the body-fixed frame Bi to the inertial
frame I and the angular velocity of the ith quadrotor in the
r > 0.
Next,
letting
(t) = [1 (t), . . . , n (t)]
and (t)
Rn1 ,
z(t) = (t)
1n
Rn .
(9)
(10)
i (0) = 0 ,
i (0) = 1 ,
i (xP F,i ) =
kx d,i k + kx d,i k +
(0) = 0n , (0)
= 1n ,
(11)
where
xP F = [x
P F,1 , . . . , xP F,n ]
R12n ,
(xP F ) = [
1 (xP F,1 ), . . . ,
n (xP F,n )]
Rn .
,
2T (1 + n2 T )2
(13)
(14)
WITH
AR.D RONES
x = [(x) , e
3 x] ,
v = [(v) , e
3 v] ,
where v = x,
while and e3 are defined as
0
1 0 0
=
,
e3 = 0 .
0 1 0
1
xP F = [e
xxy , exz , evxy , e ] R
cc ssc cs
= cs sss + cc
s
sc
csc + ss
css sc .
cc
u1 =
(17)
.
evxy = (x d x)
(18)
(19)
d
e
3 (x
(20)
evz =
x)
.
Rd R = R
R R R R R
d
thus leading to
= R
R
d
c(d ) s(d ) 0
= s(d ) c(d ) 0 ,
0
0
1
u 2 = e
3 v,
u3 =
u2 = e
d + kz exz ,
3x
u3 = d k e ,
(24)
0
.
0
eR =
s(d )
D = {xP F R6 : kxP F k r } ,
(25)
e = s(d ) R .
If we now consider small heading deviations with respect to
the desired value d , then e can be approximated by
e = d .
Notice that, in contrast to the general formulation in Section II, the generalized error vector defined here does not
consider the error states evz and e . This is due to the
fact that these two error signals are directly controlled by
the AR.drone autopilot, ensuring their convergence to a
neighborhood of zero.
With this in mind, we can now write the PF error dynamics
as
e xxy = evxy ,
c s
xd (e
v
+
g)
e vxy =
u1 ,
3
s c
(23)
e xz = e3 x d u2 ,
e = u3 d ,
where
s c
(16)
(
e3 x = e3 v
V:
f
g
e3 v = m
(22)
(21)
3D trajectories
z axis, m
P F
UAV
2
T C <
,
2T (1 + n2 T )2
Desired Orbit
1
0
2
0
y axis, m
x axis, m
(26)
300
250
, degrees
Remark 3: The bound r in (25) for which the linearization of the quadrotor dynamics is valid will depend on the
choice of the control gains kp , kd , kz , and k . A relation
between these control gains and r can be obtained from the
control laws in (24).
350
200
150
100
50
TEST RESULTS
VI. C ONCLUSION
This paper addressed the problem of steering a fleet of
quadrotor UAVs along predefined spatial paths, while coordinating with each other according to mission requirements.
Cooperative control is achieved in the presence of timevarying communication networks, and stringent temporal
constraints. The constraints include collision-free maneuvers
(generated off line) and simultaneous arrival at the desired
70
80
90
100
time, s
110
120
PF error UAV1
PF error UAV
PF errors, m
0.5
0.5
70
80
90
100
time, s
110
120
(c) PF error.
Derivative of shifted time; UAV1 and UAV2
1
0.98
1
2
0.96
70
80
90
time, s 100
110
120
110
120
Coordination variable (L )
0.2
V. F LIGHT
UAV
0.2
70
80
90
100
time, s
R EFERENCES
[1] S. Bouabdallah, P. P. Murrieri, and R. Siegwart, Design and control of
an indoor micro quadrotor, in Proc. of The International Conference
on Robotics and Automation (ICRA), 2004.
[2] A. Dzul, P. Castillo, and R. Lozano, Real-time stabilization and
tracking of a four rotor mini rotorcraft, in IEEE Transaction on
Control System Technology, vol. 12(4), 2004, pp. 510516.
[3] A. Tayebi and S. McGilvray, Attitude stabilization of a vtol quadrotor
aircraft, in IEEE Transaction on Control System Technology, vol.
14(3), May 2006, pp. 562571.
[4] S. Bouabdallah, A. Noth, and R. Siegwart, Pid vs lqr control
techniques applied to an indoor micro quadrotor, in International
Conference on Intelligent Robots and Systems, 2004.
[5] N. Guenard, T. Hamel, and V. Moreau, Dynamic modeling and
intuitive control strategy for an x4-flyer, in International Conference
on Robotics and Automation (ICRA), 2005, pp. 141146.
[6] E. Altug, J. P. Ostrowski, and R. Mahony, Control of a quadrotor
helicopter using visual feedback, in Proc. of the 2002 IEEE International Conference on Robotics and Automation (ICRA), 2002, pp.
7277.
[7] N. Guenard, T. Hamel, and R. Mahony, A practical visual servo
control for an unmanned aerial vehicle, in IEEE Transaction on
Robotics, vol. 24(2), 2008, pp. 331340.
[8] C. Coza and C. J. B. Macnab, A new robust adaptive-fuzzy control method applied to quadrotor helicopter stabilization, in Annual
meeting of the North American Fuzzy Information Processing Society,
2006, pp. 454458.
[9] M. Tarbouchi, J. Dunfied, and G. Labonte, Neural network based
control of a four rotor helicopter, in International Conference on
Industrial Technology, 2004, pp. 15431548.
[10] S. L. Waslander, G. M. Hoffman, J. S. Jang, and C. J. Tomlin,
Multi-agent quadrotor testbed control design: integral sliding mode
vs reinforcement learning, in International Conference on Intelligent
Robots and Systems, 2005, pp. 468473.
[11] T. Lee, M. Leok, and N. H. McClamroch, Control of complex
maneuvers for a quadrotor UAV using geometric methods on SE(3),
IEEE Transactions on Automatic Control, 2010, submitted. Available
online: arXiv:1003.2005v3.
[12] M. Mesbahi and F. Y. Hadaegh, Formation flying control of multiple
spacecraft via graphs, matrix inequalities, and switching, Journal of
Guidance, Control and Dynamics, vol. 24, no. 2, pp. 369377, March
April 2001.
[13] Y. D. Song, Y. Li, and X. H. Liao, Orthogonal transformation based
robust adaptive close formation control of multi-UAVs, in American
Control Conference, vol. 5, Portland, OR, June 2005, pp. 29832988.
[14] D. M. Stipanovic, G. Inalhan, R. Teo, and C. J. Tomlin, Decentralized
overlapping control of a formation of unmanned aerial vehicles,
Automatica, vol. 40, no. 8, pp. 12851296, August 2004.
[15] R. Ghabcheloo, A. M. Pascoal, C. Silvestre, and I. Kaminer, Coordinated path following control of multiple wheeled robots using
linearization techniques, International Journal of Systems Science,
vol. 37, no. 6, pp. 399414, May 2006.
[16] R. Ghabcheloo, A. P. Aguiar, A. M. Pascoal, C. Silvestre, I. Kaminer,
and J. P. Hespanha, Coordinated path-following control of multiple
underactuated autonomous vehicles in presence of communication
failures, in IEEE Conference on Decision and Control, San Diego,
CA, December 2006, pp. 43454350.
[17] F. L. Pereira and J. B. de Sousa, Coordinated control of networked
vehicles: An autonomous underwater system, Automation and Remote
Control, vol. 65, no. 7, pp. 10371045, July 2004.
[18] I. Kaminer, A. M. Pascoal, E. Hallberg, and C. Silvestreo, Trajectory
tracking for autonomous vehicles: An integrated approach to guidance
and control, Journal of Guidance, Control and Dynamics, vol. 21,
no. 1, pp. 2938, JanuaryFebruary 1998.
[19] Y. Kim and M. Mesbahi, On maximizing the second smallest
eigenvalue of state-dependent graph Laplacian, IEEE Transactions
on Automatic Control, vol. 51, no. 1, pp. 116120, January 2006.
[20] N. Biggs, Algebraic Graph Theory.
New York, NY: Cambridge
University Press, 1993.
[21] E. Xargay, I. Kaminer, A. Pascoal, N. Hovakimyan, V. Dobrokhodov,
V. Cichella, A. P. Aguiar, and R. Ghabcheloo, Time-critical cooperative path following of multiple uavs over time-varying networks,
2012, accepted for publication in AIAA Journal of Guidance, Control
and Dynamics.
S KETCH
A PPENDIX
OF THE PROOF OF
L EMMA 1
(t)
= L(t)
.
Since the
the result
is GUES
following
(28)
c4
c3
I Pc (t)
I , c2 I
2n
2
c Pc L
P c LP
c3 I .
0 < c1 I ,
(29)
2
c2 d
||||2
2
vd max +
vd max
||z||2
1 b n 2d
vd max +
V = VP F +
+ (Pc QL 1 QL)z .
At this point, one can show that there exist b, d, , c2 , and c3 such
that
V 2V ,
vmax
,
kk
vd max
where was defined in (12). The second bound above is required
to show feasibility of the commanded speed profile. This completes
the proof.