Professional Documents
Culture Documents
Real Time Stabilization of An Eight Roto
Real Time Stabilization of An Eight Roto
generalized force
d ∂L ∂L
− =F (7)
dt ∂ q̇ ∂q
where F = (Fξ , τ ). Fξ defines the translational force applied to
the aerial robot due to the control inputs and relative to the frame
I, and τ is the generalized moments vector. The small body
forces are ignored, and we only consider the principal control
inputs u, ux , uy , and τ , where u represents the total thrust, ux is
the control input for x-axis displacement, uy is the control input
for the y-axis displacement, and τ is the generalized moment.
Then, the force applied to the mini-helicopter relative to the
frame B is defined as
F̄ = uxı̄ + uy j̄ + uz k̄ (8)
where
ux = ux r − ux l = f5 − f7 (9)
Fig. 3. Eight-rotor rotorcraft scheme. Where fi is the force produced by uy = uy r − uy l = f8 − f6 (10)
the motor M i with i = 1, 2, . . . , 8, and fj with j = 9, 10, 11, and 12 are the
additional forces produced by the lateral motors. uz = u + f9 + f10 + f11 + f12 (11)
where ux r and ux l are the control inputs for the front motor
external reference set of axis, and let B = ı̄, j̄ , k̄ denote a set and the rear motor in x-axis respectively, and uy r and uy l are
of coordinates fixed to the rigid aircraft, as shown in Fig. 3. defined similarly for the right motor and the left motor in y-axis.
Let q = (x, y, z, ψ, θ, φ) ∈ IR6 be the generalized coordi- u is defined as
nates vector for the flying machine, where (x, y, z) denote the
u = f1 + f2 + f3 + f4
position of the center of mass of the rotorcraft relative to the
frame I, and (ψ, θ, φ) are the three Euler angles (yaw, pitch, and with
roll) that describe the orientation of the aerial vehicle. There-
fore, the model could be separated in two coordinate subsystems: fi = ki ωi2 , i = 1, . . . , 8
translational and rotational. They are defined, respectively, by where ki > 0 is a parameter depending on the density of air,
ξ = (x, y, z) ∈ IR3 (1) the radius, the shape, the pitch angle of the blade, and ωi is the
angular speed of the each motor “i” (Mi ,i = 1, . . . , 8). There
η = (ψ, θ, φ) ∈ IR3 . (2) exist additional forces f9 to f12 acting on each one of the four
The translational kinetic energy of the rotorcraft is expressed as main rotors (see Fig. 3). These forces are due to the airflow
generated by the lateral rotors, which means that the magnitude
m ˙T ˙ △
Ttrans =
ξ ξ (3) of vectors f9 to f12 are functions of the lateral airflow produced
2 by the corresponding lateral rotor. The induced wind speed in a
where m denotes the mass of the rotorcraft. The rotational ki- propeller is defined as follows:
netic energy is given by 12
f
△ 1 V = (12)
Trot = η̇ T Jη̇ (4) 2ρA
2
where J is the inertia matrix. where f is the thrust generated by the propeller, ρ is the air
The only potential energy which needs to be considered is density, and A is the propeller area [7]. In order to clarify the
due to the standard gravitational force g. Therefore, potential notation, we will use the subscripts p for the main rotor and
energy is expressed as subscript s for the lateral rotor. The thrust f generated by the
main rotor and the lateral rotor can be expressed as
U = mgz. (5)
Following the approach, the Lagrangian is given by fp = 2ρAp V̂ Vp (13)
L (q, q̇) = Ttrans + Trot − U where Vp is the induced wind speed in the main propeller, and
V̂ is the total induced wind speed by the set of rotors, which is
m ˙T ˙ 1 T
ξ ξ + η̇ J η̇ − mgz.
= (6) given by
2 2
The model for the full eight-rotor aircraft dynamics is 12
obtained from the Euler–Lagrange equations with external V̂ = (Vs cos α + Vp )2 + (Vs sin α)2 (14)
812 IEEE TRANSACTIONS ON ROBOTICS, VOL. 25, NO. 4, AUGUST 2009
where ū = ux r + uy r + ux l + uy l . Consequently
Fξ = RF̄
where R is the transformation matrix representing the orienta-
tion of the rotorcraft from B to I. We use cθ to denote cos θ and
sθ for sin θ.
cψ cθ cψ sθ sφ − sψ cφ cψ sθ cφ + sψ sφ
R = sψ cθ sψ sθ sφ + cψ cφ sψ sθ cφ − cψ sφ . (19)
−sθ cθ sφ cθ cφ
The generalized moment is given by
4
τψ j = 1 τM j
△
Fig. 4. Main thrust behavior with incoming lateral wind due to lateral τ = τθ = (f3 − f1 ) dc (20)
propeller. τφ (f4 − f2 ) dc
where dc is the distance from the center of gravity to any in-
where α is the angle between the main rotor axis and the lateral ternal rotor, and τM j is the couple produced by motor Mj . The
rotor axis. It is important to note that without extra lateral rotor moment-compensation vector is
Vs = 0, this implies that V̂ = Vp , and (13) becomes
0
fp = 2ρAp Vp2 . (15) △
τc = bux . (21)
◦ buy
Introducing (14) into (13) with α = 90 , we obtain
1 Therefore, the Euler–Lagrange equation can be rewritten as
Vs2 2
2
fp = 2ρAp Vp 1 + 2 . (16)
Vp mξ¨ + [0 0 mg]T = Fξ (22)
The additional nonlinear term Vs2 /Vp2 appearing in this
1 ∂ T
Jη̈ + J̇η̇ − η̇ Jη̇ = τ + τc. (23)
equation is related to the airflow produced by the corresponding 2 ∂η
lateral rotor, which does not appear in (15). Nevertheless, this
Note that the Lagrangian function (6) does not contain cross
extra term has an almost linear behavior mainly for large values
terms in the kinetic energy combining ξ˙ and η̇. Defining the
of Vs . In practice, we consider the parameter Vp as constant at
Coriolis vector as
hover, since this parameter depends on the thrust generated by
the main rotor to stabilize the mini-helicopter. In our experiment, 1 ∂ T
C (η, η̇) = J̇ − η̇ J (24)
we work in a region where the relationship (Vs /Vp ) ≤ 1 holds. 2 ∂η
It then follows that we can rewrite (23) as
1
Vs2 2 √
1+ 2 ≤ 2. (17) Jη̈ + C (η, η̇) η̇ = τ + τc (25)
Vp
Finally, the equations of motion for the eight-rotor mini-
The thrust behavior with respect to (Vs /Vp ) is shown in rotorcraft are expressed as
Fig. 4. Fig. 4(a) shows the region defined by Vs ≤ Vp where
the nonlinear model is approximated by a straight line with mξ¨ = Fξ + [0 0 − mg]T (26)
slope m̄ = 0.64 that intercepts the vertical axis at yb = 0.77. Jη̈ = τ + τc − C (η, η̇) η.
˙ (27)
Fig. 4(b) shows the nonlinear behavior of (17) when Vs > Vp ,
which is approximately a straight line with slope m̄ = 1 without IV. CONTROL STRATEGY DESIGN
drift in the vertical axis.
The additional term in (16) will be compensated to effectively In this section, we present a feedback control scheme for the
decouple the translational and rotational displacements. attitude stabilization and position of the eight-rotor aircraft. Tak-
The force in each one of the four main rotors is affected by the ing advantage of the fact that by compensating the perturbation
lateral thrust fs of the corresponding lateral rotor. The lateral forces the resulting system has translational and rotational dy-
thrust, in turn, depends on the control actions ux and uy applied namics that are decoupled, we are able to propose a simple linear
to lateral motors. Considering identical lateral motors, forces f9 control strategy. In order to further simplify the analysis, and
to f12 can be expressed as follows: since J is nonsingular, let us consider the following linearizing
control law:
f9 = bux r f10 = buy r f11 = bux l f12 = buy l
τ = C(η, η̇)η̇ + J(τ̃ + τc ) − τc (28)
where b ≥ 0 is the approximate slope in Fig. 4(a). Then, the
force vector F̄ can be rewritten as follows: where
T
F̄ = [ux uy u + bū] (18) τ̃ = [τ̃ψ τ̃θ τ̃φ ]T (29)
ROMERO et al.: REAL-TIME STABILIZATION OF AN EIGHT-ROTOR UAV USING OPTICAL FLOW 813
A. OF Measurement
Computer vision is an important tool for robotics. Extract-
ing the relevant information from image sequences from the
scene may allow robots to perform missions autonomously [4].
In this paper, we use the OF from image sequences to esti-
mate the translational speed of the rotorcraft. The estimate of
the horizontal speed will be used to perform autonomous hover
flights without lateral displacement. There exist many different
methods for computing the OF [6], [8]. There exist intensity-
based differential methods, frequency-based filtering methods,
or correlation-based methods. In this paper, we tested the Lucas–
Kanade pyramidal method, which is an intensity-based differ-
ential method [1].
Consider two discrete functions I1 , I2 ∈ Rm u ×n v represent-
ing two gray-scale images at different time instants, and let
Gp i be the gray-scale value of a particular pixel p = (ui , vi )T . Fig. 5. OF basic scheme.
Then, the gray-scale values for pi that appear in two consecutive
images are defined, respectively, as
TABLE I
Gp 1 = I1 (u1 , v1 ), Gp 2 = I2 (u2 , v2 ) CONTROLLER PARAMETERS VALUES
where wu and wv are two integers that define the size of the
integration window. The Lucas–Kanade OF algorithm has an a maximal interval when the mini-helicopter is appropriately
adaptive integration window, which means that it is able to stabilized at hover. The measurement of the angular speed ω
handle large pixel motions and this representation acts as a low- is obtained by using the gyro information on each axis. An
pass filter (see [1] for a complete description). altitude-stabilization algorithm in closed loop is used to keep
OF can be generated by two kinds of observer motion: trans- the distance d constant and equal to some desired value.
lational motion (Ft ) and rotational motion (Fr ). Let us assume
that the camera is moving with translational velocity v and an-
gular velocity ω while viewing an object at distance d and offset VI. PRACTICAL RESULTS
β from the direction of travel, as depicted in Fig. 5. The OF can Real-time experiment results are presented in this section to
be mathematically expressed as follows: validate the performance of the eight-rotor rotorcraft during au-
v tonomous hover flight. We have observed, in practice, that the
OF = sin β − ω. (57)
d decoupling strategy presented in Section IV does not exactly de-
The maximal OF is obviously generated when the plane that couple the flying vehicle due to unsymmetrical rotor structures.
contains the features is perpendicular to translational motion To compensate for these modeling errors, we have trimmed the
direction (β = 90◦ ) [8]. The velocity can be estimated from gains in the radio control before the experiments.
(57) as follows: The control gains of (41)–(43) and (50)–(52) were adjusted,
in practice, to obtain a fast aircraft response but avoiding me-
OF + ω
v= d. (58) chanical oscillations as much as possible, and they are shown in
sin β Table I. Table II shows the saturation values using in the attitude
Note that singularities in the previous equation appear when and horizontal control law. The parameters were also chosen
β = 0◦ . Nevertheless, in our case, the roll and pitch angles in such a way that the aircraft attitude remains very close to a
are very close to zero, which implies that β = 90◦ ± 3◦ as desired point.
ROMERO et al.: REAL-TIME STABILIZATION OF AN EIGHT-ROTOR UAV USING OPTICAL FLOW 815
GPS. Figs. 17–20 show the control signals applied to each one
of the lateral motors.
VII. CONCLUSION
In this paper, we have proposed a novel multirotorcraft aero-
dynamical configuration whose translational and rotational dis-
placements are decoupled. This feature is particularly useful for
Fig. 17. Input control signal of x-right motor. vision application since the orientation of the aircraft can be held
constant independently of the lateral displacements. Indeed, a
camera can be used to estimate the translation speed from the
disturbance in the pitch angle at around 55 s, we think this noise OF without having to compensate for the errors induced by the
may come from the radio communication link. The estimated angular displacements. A precompensation has been introduced
linear position and linear velocities using the OF approach are to improve the decoupling of the translational and rotational
plotted in Figs. 9–12, while the same variables are shown in the movements. This precompensation cancels the additional lift
Figs. 13–16, but in this case, the estimation was obtained using of the inner rotors produced by the airflow coming from the
ROMERO et al.: REAL-TIME STABILIZATION OF AN EIGHT-ROTOR UAV USING OPTICAL FLOW 817
lateral rotors. The simplified dynamical model of the rotorcraft Hugo Romero was born in Ixmiquilpan Hidalgo,
is given by six independent double integrators that have been Mexico, on November 7, 1972. He received the Bach-
elor’s degree in electrical engineering from the Insti-
stabilized using PD controllers. An eight-rotor aircraft proto- tuto Tecnológico de Pachuca, Pachuca, Mexico, in
type has been built and tested experimentally with the proposed 1996, the M.Sc. degree in electrical engineering in
on-board control strategy. automatic control from the Centro de Investigación
y de Estudios Avanzados (CINVESTAV), Mexico
We have used two different strategies to estimate the trans- City, Mexico, in 2001, and the Ph.D. degree in auto-
lational speed: OF indoor and GPS outdoor. The OF measure- matic control from the University of Technology of
ments were carried out keeping the aircraft at a desired altitude. Compiègne, Compiègne, France, in 2008.
He is currently an Assistant Professor with the
Under such conditions the OF technique provided more precise Center for Research on Information Technologies and Systems, Universidad
measurements of the translational speed than GPS. However, Autónoma del Estado de Hidalgo, Pachuca, Mexico. He also holds a Post-
the OF technique has several limitations when used outdoors. doctoral position with the Laboratorio Franco-Mexicano de Informática y Au-
tomática Aplicada, UMI-CNRS, CINVESTAV. His current research interests
Indeed, the light intensity and the contrast of the image pro- include computer vision, real-time control applications, nonlinear dynamics
duce errors in the estimation of the speed. Therefore, GPS and control, unmanned aerial vehicles, embedded systems, and underactuated
sensors give, in general, better results outdoors than the OF mechanical systems.
technique.
It has been experimentally shown that the proposed eight-
rotor configuration is appropriate to achieve velocity damping
indoors using OF and outdoors using GPS. This is an important Sergio Salazar was born in Tlaxcala, Mexico, on
October 7, 1966. He received the B.S. degree in elec-
step toward autonomous navigation. tronics engineering form the Benemérita Universidad
Autónoma of Puebla, Puebla, Mexico, in 1992, the
M.Sc. degree in electrical engineering from the Cen-
tro de Investigación y de Estudios Avanzados, Mexico
REFERENCES City, Mexico, in 1995, and the Ph.D. degree in auto-
matic control from the University of Technology of
[1] J. Y. Bouguet, “Pyramidal implementation of the Lucas Kanade feature
Compiègne (UTC), Compiègne, France, in 2005.
tracker,” Tech. Rep., Intel Corp., Santa Clara, CA, 1999. From January to December 2006 and January to
[2] S. Salazar-Cruz, J. J. Escareño, D. Lara, and R. Lozan, “Embedded control
December 2008, he holds a Postdoctoral position
system for a four-rotor UAV,” Int. J. Adaptive Control Signal Process.,
at the Laboratorio Franco-Mexicano de Informática y Automática Aplicada,
vol. 21, no. 2–3, pp. 189–204, Mar./Apr. 2007.
Franco-Mexicano de Informática y Automática Aplicadas, Centre National de
[3] D. Lyon, “A military perspective on small unmanned aerial vehicles,” la Recherche Scientific, Centro de Investigación y de Estudios Avanzados. His
IEEE Instrum. Meas. Mag., vol. 7, no. 3, pp. 27–31, Sep. 2004.
current research interests include real-time control applications, embedded sys-
[4] W. E. Green, P. Y. Oh, and G. L. Barrows, “Flying insect inspired vision
tems, unmanned aerial vehicles, and nonlinear dynamics and control.
for autonomous aerial robot maneuvers in near-earth environments,” in
Proc. IEEE Int. Conf. Robot. Autom., 2004, pp. 2347–2352.
[5] H. Romero, R. Benosman, and R. Lozano, “Stabilization and location of
a four rotors helicopter applying vision,” in Proc. Amer. Control Conf.,
2006, pp. 3931–3936.
[6] R. Hartley and A. Zisserman, Multiple View Geometry in Computer Vi- Rogelio Lozano (M’04) was born in Monterrey,
sion, 2nd ed. Cambridge, U.K.: Cambridge Univ. Press, 2004, ISBN Mexico, on July 12, 1954. He received the B.S.
0521540518. degree in electronic engineering from the National
[7] B. W. McCormick, Jr., Aerodynamics of V/STOL Flight. New York: Polytechnic Institute, Mexico City, Mexico, in 1975,
Dover, 1999. the M.S. degree in electrical engineering from the
[8] S. S. Beauchemin and J. L. Barron, “The computation of optical flow,” Centro de Investigación y de Estudios Avanzados
ACM Comput. Surveys, vol. 27, pp. 433–467, 1995. (CINVESTAV), Mexico City, in 1977, and the Ph.D.
[9] C. Y. King, “Virtual instrumentation-based system in a real-time appli- degree in automatic control from the Laboratoire
cations of GPS/GIS,” in Proc. Conf. Recent Adv. Space Technol., 2003, d’Automatique de Grenoble, Grenoble, France, in
pp. 403–408. 1981.
[10] J. Z. Sasiadek and P. Hartana, “Sensor fusion for navigation of an au- From 1981 to 1989, he was with the Department
tonomous unmanned aerial vehicle,” in Proc. Int. Conf. Robot. Autom., of Electrical Engineering, CINVESTAV, where he was the Head of the Section
2004, vol. 4, pp. 429–434. of Automatic Control from June 1985 to August 1987. He held visiting positions
[11] C.-S. Yoo and I.-K. Ahn, “Low cost GPS/INS sensor fusion system for at the University of Newcastle, Australia, from November 1983 to November
UAV navigation,” in Proc. Digital Avionics Syst. Conf., 2003, vol. 2, 1984, NASA Langley Research Center, Langley, VA, from August 1987 to
pp. 8.A.1-1–8.A.1-9. August 1988, and the Laboratoire d’Automatique de Grenoble from February
[12] H. Sussman and Y. Yang, “On the stabilizability of multiple integrators by 1989 to July 1990. He was promoted to first-class CNRS Research Director in
means of bounded feedback controls,” in Proc. 30th IEEE Conf. Decision 1997. From January 1995 to December 2007, he was the Head of the Laboratory
Control, New York: IEEE, Dec. 1991, pp. 70–72. Heudiasyc, UMR 6599, CNRS-University of Technology of Compiègne (UTC),
[13] P. Castillo, A. Dzul, and R. Lozano, “Real-time stabilization and tracking Compiègne, France. Since 1990, he has been the CNRS Research Director at
of a four rotor mini rotorcraft,” in IEEE Trans. Control Syst. Technol., UTC. He is currently the Head of Laboratorio Franco-Mexicano de Informática
vol. 12, no. 4, pp. 510–516, Jul. 2004. y Automática Aplicada, UMI-CNRS, CINVESTAV. From 1987 to 2000, he was
[14] A. Palomino, P. Castillo, I. Fantoni, R. Lozano, and C. Pégard, “Control an Associate Editor of Automatica and has been an Associate Editor of Inter-
strategy using vision for the stabilization of an experimental PVTOL national Journal of Adaptive Control and Signal Processing since 1993. His
aircraft setup,” IEEE Trans. Control Syst. Technol., vol. 13, no. 5, pp. 847– current research interests include adaptive control of linear and nonlinear sys-
850, Sep. 2005. tems, robot manipulators, passive systems, teleoperation, and unmanned aerial
vehicles.