Академический Документы
Профессиональный Документы
Культура Документы
Resumen: En este artı́culo se presenta un observador Takagi-Sugeno (T-S) que estima las
variables de programación y estados no medidos de un quadrotor. También se presenta el diseño
de dos controladores T-S; un controlador T-S no robusto para estabilizar los ángulos de Euler,
y un controlador T-S robusto con el objetivo de estabilizar los ángulos de Euler y atenuar la
señal de perturbación. La principal aportación de este trabajo es la aplicación del observador
T-S y de los controladores T-S a un quadrotor. Las pruebas en simulación muestran que el
observador T-S estima correctamente las variables de programación y los estados no medidos
del quadrotor, con y sin perturbación. Mientras que el controlador robusto cumple sus objetivos
de estabilización y de atenuación de la perturbación.
referencia inercial fijo en tierra y B = {Ob , xb , yb , zb } es donde b y d son factores constantes positivos de empuje
el sistema fijo al cuerpo rı́gido cuyo origen es el centro y de arrastre, respectivamente. Kv es una constante de
de masa del quadrotor, tal como se muestra en la Fig. 1. transformación para representar la proporción lineal entre
El modelo dinámico se obtiene usando el formalismo de el cuadrado de la velocidad de los motores con el cuadrado
Newton-Euler como se muestra a continuación (Carrillo del voltaje aplicado. Se considera que el voltaje de entrada
et al., 2012): para cada motor Vi , con i = 1, 2, . . . , 4, está acotado, Vi ∈
[Vmin , Vmax ] con Vmin = −10V y Vmax = 10V. También
ξ˙ = v (1a)
se considera que las velocidades angulares φ̇, θ̇ y ψ̇ están
mv̇ = F (1b)
acotadas φ̇, θ̇, ψ̇ ∈ [dαmin , dαmax ] con dαmin = −π/4 y
Ṙ = Rω̂ (1c) dαmax = π/4. En este artı́culo sólo se utilizará el segundo
I ω̇ = −ω × Iω + τa (1d) subsistema (3), con U2 , U3 y U4 ; por lo que la dinámica de
los desplazamientos en los ejes x, y y z no se consideran en
donde ξ = (x, y, z)> ∈ R3 denota la posición del centro este trabajo.
de masa del vehı́culo con respecto al sistema inercial E
en relación a un origen fijo, η = (φ, θ, ψ)> ∈ R3 es Table 1. Parámetros fı́sicos del quadrotor.
la orientación del vehı́culo (ángulos de Euler, alabeo φ,
Parámetro Valor Unidad Parámetro Valor Unidad
cabeceo θ y guiñada ψ). v ∈ E denota la velocidad lineal m 2.85 Kg Ix 0.0552 Kg.m2
expresada en el sistema inercial, ω ∈ B denota la velocidad g 9.81 m.s−2 Iy 0.0552 Kg.m2
angular del vehı́culo expresada en el sistema fijo al cuerpo. d 1.192464e−7 N.m.s2 Iz 0.1104 Kg.m2
b 3.935139e−6 N.s2 l 0.1969 m
La masa del cuerpo rı́gido se denota por m, I ∈ R3×3 es Jr 6e−5 Kg.m2 Kv 54.945 rad/sV
una matriz inercial constante alrededor del centro de masa
(expresada en el sistema de referencia fijo al cuerpo B), ω̂
es una matriz antisimétrica del vector ω, F ∈ E representa
el vector de las fuerzas no conservativas aplicadas al 3. MODELADO TAKAGI-SUGENO DE UN
objeto. Finalmente, τa ∈ E se deriva del empuje diferencial QUADROTOR
asociado con los pares de los rotores junto con los efectos
aerodinámicos y giroscópicos. Resolviendo (1), el modelo
La representación T-S del quadrotor se obtiene mediante la
dinámico del quadrotor se divide en dos subsistemas, (2)
técnica de aproximación del sector no lineal. Esta técnica
y (3).
fue descrita por (Ohtake et al., 2001). Considerando un
ẍ = (cψsθcφ + sψsφ)U1 sistema no lineal de la forma:
ÿ = (sψsθcφ − cψsφ)U1 (2) ẋ = f m (x, u)x + g m (x, u)u
z̈ = −g + (cθcφ)U1 (6)
y = hm (x, u)x
Iy − Iz Jr donde f m , g m y hm son funciones suaves de matrices no
φ̈ = θ̇ψ̇ − θ̇Ωr + U2
Ix Ix lineales, x ∈ Rnx es el vector de estados, u ∈ Rnu es el
vector de entrada, e y ∈ Rny es el vector de la salida
!
Iz − Ix Jr
θ̈ = φ̇ψ̇ + φ̇Ωr + U3 (3) medida. Las variables de programación se definen como
Iy Iy zj (·) ∈ [nlj , nlj ], con j = 1, 2, . . . , p. Para cada zj , se
Ix − Iy definen dos funciones de ponderación:
ψ̈ = φ̇θ̇ + U4
Iz nlj − zj (·)
η0j (·) = ; η1j (·) = 1 − η0j (·) (7)
donde c y s indican las funciones trigonométricas coseno nlj − nlj
y seno, respectivamente. Jr es el momento de inercia Los conjuntos difusos correspondientes a ambas funciones
rotacional alrededor del eje de la propela. Los actuadores de ponderación (7) son definidas en el dominio [nlj , nlj ],
se consideran motores de corriente directa, por lo que j
el cuadrado de la velocidad angular de los motores será para todo zj . Estos conjuntos difusos se denotan por Z 0
j
aproximadamente proporcional al cuadrado del voltaje y Z 1 . Las reglas del sistema T-S se construyen tal que
aplicado a cada uno de ellos (Lendek et al., 2011). Las todos los términos zj , con j = 1, 2, . . . , p, son utilizados.
entradas U1 , U2 , U3 y U4 y el efecto giroscópico Ωr , de- El sistema T-S consiste en m reglas, donde m = 2p ; y las
penden del voltaje aplicado Vi , con i = 1, 2, . . . , 4, y se funciones de pertenencia se calculan con (8).
representan de la siguiente forma: p
Y
wi (z) = ωij (zj ) (8)
bKv2 (V12 + V22 + V32 + V42 ) j=1
U1 =
m Las funciones de pertenencia son normalizadas:
blKv2 (V32 − V42 ) m
U2 = X
Ix wi (z) ≥ 0, wi (z) = 1 (9)
(4)
blKv2 (V12 − V22 ) i=1
U3 = Las matrices Ai , Bi y Ci son construidas sustituyendo los
Iy
elementos correspondientes a las funciones de ponderación
dKv2 (V12 + V22 − V32 − V42 )
U4 = usadas en la regla i. Utilizando las funciones de pertenencia
Iz (8), el sistema no lineal (6) es representado exactamente
Ωr = Kv (−V1 − V2 + V3 + V4 ) (5) por un modelo T-S difuso, dado por:
Octubre 14-16, 2015.
Congreso Nacional de Control
Automático, AMCA 2015,
61
Cuernavaca, Morelos, México.
m
X estados no medidos x2 y x4 forman las variables de
ẋ = wi (z)(Ai x + Bi u) programación. Es por eso que se diseñará un observador
i=1 T-S para estimar el vector de estados (por consiguiente,
m (10)
y=
X
wi (z)(Ci x) las variables de programación). Ésto permitirá probar el
controlador T-S por retroalimentación de estados en el
i=1
quadrotor. El objetivo de control será la estabilización de
Note que (6) no es único, por lo tanto la representación T- los ángulos de Euler.
S tampoco será única. El modelo no lineal del quadrotor
(3) puede ser reescrito de la forma (6), con el vector de
entradas U = [U2 , U3 , U4 ]> de la forma (4) y el vector 3.1 Diseño del Observador T-S
de estados x = [φ, φ̇, θ, θ̇, ψ, ψ̇]> = [x1 , x2 , x3 , x4 , x5 , x6 ]> ,
como semuestra a continuación: Se diseña un observador para el sistema (10) de la forma:
0 1 0 0 0 0 0 0 0 Xm
0 0 0 a2 Ωr 0 x4 a1 1 0 0 x̂˙ = wi (ẑ)(Ai x̂ + Bu + Li (y − ŷ))
0 0 0 1 0 0
0 0 0
i=1
(18)
ẋ = x + U (11)
0 a4 Ωr 0 0 0 x2 a3 0 1 0 ŷ = C x̂
0 0 0 0 0 1 0 0 0
donde x̂ denota el vector de estados estimados, ŷ denota
0 x4 a5 0 0 0 0 0 0 1
el vector de salida estimada, ẑ es el vector de variables de
a1 = (Iy − Iz )/Ix programación estimada, y Li , con i = 1, 2, . . . , m, son las
1 0 0 0 0 0 a2 = −Jr /Ix ganancias del observador a diseñar. La dinámica del error
y = 0 0 1 0 0 0x ; con : a3 = (Iz − Ix )/Iy (12) de seguimiento puede ser expresado como:
0 0 0 0 1 0 a4 = Jr /Iy m
X m
X
a5 = (Ix − Iy )/Iz ė = wi (ẑ)(Ai − Li C)e + (wi (z) − wi (ẑ))(Ai x + Bu)
Las variables de programación son: z1 =Ωr , z2 = x4 y i=1 i=1
z3 = x2 . Para cada uno de estos tres términos se generan (19)
dos funciones de ponderación, de la siguiente forma: Para el sistema (19), en (Bergsten, 2001) se presentan
(1) z1 = Ωr ∈ [4Kv Vmin , 4Kv Vmax ], con las funciones de condiciones suficientes de estabilidad:
ponderación de la forma: Teorema 1. (Bergsten, 2001) Considerando el error de
4Kv Vmax − Ωr (t) seguimiento (19) y asumiendo que:
η01 (z1 ) = ; η 1 (z1 ) = 1 − η01 (z1 )
4Kv Vmax − 4Kv Vmin 1
m
X
(13)
(wi (z) − wi (ẑ))(Ai x + Bu)
≤ µkek (20)
(2) z2 = x4 ∈ [dαmin , dαmax ], las funciones de pon-
i=1
deración son:
donde µ > 0 es una constante conocida. Entonces, el error
dαmax − x4 (t)
η02 (z2 ) = ; η 2 (z2 ) = 1 − η02 (z2 ) (14) de seguimiento (19) es exponencialmente estable, si existe
dαmax − dαmin 1 una matriz simétrica definida positiva P = P > > 0, una
(3) z3 = x2 ∈ [dαmin , dαmax ], las funciones de pon- matriz simétrica definida positiva Q = Q> > 0, y matrices
deración serán de la forma (15). Li , con i = 1, 2, . . . , m, tales que:
dαmax − x2 (t) He{Ai − Li C} ≤ − Q
η03 (z3 ) = ; η 3 (z3 ) = 1 − η03 (z3 ) (15)
dαmax − dαmin 1
Q − µ2 I P (21)
>0
En este caso se tendrán 23 = 8 reglas. A continuación se P I
realiza la regla con la primera función de pertenencia y su donde He{X} denota X + X > , I es una matriz identidad
correspondiente matriz A1 : de las dimensiones apropiadas, e i = 1, 2, . . . , m.
Regla 1 del modelo:
1 2 3
Si z1 es Z 0 y z2 es Z 0 y z3 es Z 0 entonces:
3.2 Diseño del Controlador T-S no Robusto
ẋ = A1 x + Bu
y = Cx Para estabilizar el sistema se utiliza el esquema de Com-
pensación Distribuida Paralela (PDC), propuesto por
0 1 0 0 0 0
0 0 0 a2 4Kv Vmin 0 dαmin a1 (Wang et al., 1996).
0 0 0 1 0 0
m
A1 = (16)
X
0 a4 4Kv Vmin 0 0 0 dαmin a3
u=− wi (z)Ki x (22)
0 0 0 0 0 1
i=1
0 dαmin a5 0 0 0 0 Introduciendo (22) al modelo (10), se obtiene el siguiente
con la función de pertenencia: sistema en lazo cerrado (23), con m2 modelos lineales.
w1 (z) = η01 η02 η03 (17) Xm X m
obtiene la siguiente derivada de la función de Lyapunov otras palabras, el objetivo es encontrar la mejor L2 →
(24) a lo largo de las trayectorias de (23). ganancia L2 , para minimizar el peor caso
m X m
X
y(t)
V̇ = wi (z)wj (z) x> sup
2 ≤ γ (30)
d(t)6=0 d(t)
i=1 j=1 (24) 2
>
· (Ai + Bi Kj ) P + P (Ai + Bi Kj ) x Teorema 3. (Lendek et al., 2010) El sistema continuo
T-S (29) con la ley de control PDC (22) es GAS y la
V̇ < 0 si se satisface el problema de la negatividad de la atenuación de la perturbación d es al menos γ, si existen
doble sumatoria (25). matrices X > 0 y Mi , con i = 1, 2, . . . , m, tales que con:
m X m
XA> > > >
i + Ai X − Mj Bi − Bi Mj Bdi XCi
X
wi (z)wj (z) Γij (x) < 0 (25) >
Γij = Bdi γ2I 0
i=1 j=1
Ci X 0 −I
donde Γij (x) son matrices simétricas, en este caso Γij (x) (31)
tiene la forma:
m X m las condiciones (28) se cumplen, entonces las ganancias
PDC serán Ki = Mi X −1 , con i = 1, 2, . . . , m.
X
wi (z)wj (z)
i=1 j=1 (26)
· (A> > > 4. RESULTADOS EN SIMULACIÓN
i P + P Ai − P Bi Kj − Kj Bi P ) < 0
La desigualdad (26) no es una LMI debido a las matrices Los parámetros utilizados para esta simulación se mues-
P Bi Li . Es por eso que se realiza el siguiente cambio de tran en la Tabla 1. Las ganancias del observador y de
variables: X = P −1 , Mi = Ki X, con i = 1, 2, . . . , m y X los controladores se calculan utilizando el toolbox Yalmip
de rango completo. Por lo tanto (26) se reescribe de la (Lofberg, 2004). A continuación se presentan las ganancias
siguiente forma: del observador y del controlador robusto.
m X
X
m 5.73 0 0 5.73 0 0
wi (z)wj (z)
(27) 11.54 0 0 11.54 0 0
i=1 j=1
0 5.73 0 0 5.73 0
· (XA> > > L1 = ; L2 = ;
i + Ai X − B i M j − M j B i ) < 0 0 11.54 0 0 11.54 0
−0.91 0.91 4.95 −0.91 −0.91 4.95
dando como resultado el siguiente lema y teorema:
−1.73 1.73 6.85 −1.73 −1.73 6.85
Lema 1. (Tuan et al., 2001) La ecuación (25) se satisface
si se cumplen las siguientes condiciones 5.73 0 0 5.73 0 0
Γii < 0 11.54 0 0 11.54 0 0
0 5.73 0 0 5.73 0
2 (28) L3 = ; L4 = ;
Γii + Γij + Γji < 0 0 11.54 0 0 11.54 0
m−1 0.91 0.91 4.95 0.91 −0.91 4.95
donde i = 1, 2, . . . , m y j = 1, 2, . . . , m, con i 6= j. 1.73 1.73 6.85 1.73 −1.73 6.85
Teorema 2. (Lendek et al., 2010) El sistema continuo
52.30 5.91 −1.64 −0.48 −2.19 0.15
T-S (10) con la ley de control PDC (22) es Globalmente K1 = −1.64 −0.48 52.30 5.91 2.19 −0.15 ;
Asintóticamente Estable (GAS) si existen matrices X > 2.14 0.63 −2.14 −0.63 51.65 5.82
0 y Mi , con i = 1, 2, . . . , m, tales que se cumplen las
condiciones (28), con Γij = (XA> i + Ai X − B i M j −
52.30 5.91 1.64 0.48 −2.19 0.15
Mj> Bi> ). Si las condiciones se cumplen, entonces las K2 = 1.64 0.48 52.30 5.91 −2.19 0.15 ;
ganancias PDC son: Ki = Mi X −1 , con i = 1, 2, . . . , m. 2.14 0.63 2.14 0.63 51.65 5.82
3.3 Diseño del Controlador T-S Robusto H∞ 52.30 5.91 1.64 0.48 2.19 −0.15
K3 = 1.64 0.48 52.30 5.91 2.19 −0.15 ;
Algunos autores (Merheb et al., 2014; Sharifi et al., 2010) −2.14 −0.63 −2.14 −0.63 51.65 5.82
consideran el efecto giroscópico (Ωr ) como una pertur-
bación al sistema. Si se hace esta consideración, el modelo 52.30 5.91 −1.64 −0.48 2.19 −0.15
T-S (10) se reescribe de la forma (29). K4 = −1.64 −0.48 52.30 5.91 −2.19 0.15 ;
m
−2.14 −0.63 2.14 0.63 51.65 5.82
X
ẋ = wi (z)(Ai x + Bi u + Bdi d) γ = 3.9234e − 04
i=1
m (29) La perturbación es una señal aleatoria uniformemente
2 2
distribuida en [2Vmin Kv , 2Vmax Kv ]. Para el diseño del
X
y= wi (Ci x)
observador se utiliza µ = 0.03. Las condiciones inicales
i=1
del sistema son x(0) = [−0.2, −0.4, −0.7, 0.2, −0.5, 0.4]> y
donde Bdi son matrices de perturbación y d es la señal
las condiciones iniciales del observador T-S se establecen
de perturbación. La representación (29) del modelo T-S en x̂(0) = [0.7, 0.7, 0.7, 0.7, 0.7, 0.7]> .
del quadrotor ahora tendrá dos variables de programación:
z1 = x4 y z2 = x2 . El objetivo, aparte de estabilizar los El observador y los controladores T-S diseñados en este
ángulos de Euler, es la atenuación de la perturbación. En artı́culo, se prueban en el modelo no lineal del quadrotor.
Octubre 14-16, 2015.
Congreso Nacional de Control
Automático, AMCA 2015,
63
Cuernavaca, Morelos, México.
Se presentan tres casos en simulación para evaluar el incapaz de estabilizar los ángulos de cabeceo y alabeo
comportamiento del observador y los controladores: en un tiempo corto. La Fig. 5 presenta una correcta
estimación de los estados no medidos, pero se muestra que
(1) Prueba del observador y controlador no robusto T-S, la ley de control no robusta no logra estabilizar el sistema
sin perturbación al sistema. rápidamente y es afectado por la perturbación.
(2) Prueba del observador y controlador no robusto T-S,
agregando perturbación al sistema. 1 x1
(3) Prueba del observador y controlador robusto T-S, 0.5 ^
x1
rad
0
agregando perturbación al sistema.
−0.5
−1
0 5 10 15 20 25 30
4.1 Simulación 1
1 x3
rad
0
1. En la Fig. 2 se muestra que la salida es estimada cor- −0.5
rad
0
T-S, la ley de control no robusta permite estabilizar las
−0.5
velocidades rotacionales también en 15 segundos, aproxi- 0 5 10 15
Tiempo (seg)
20 25 30
madamente.
1
x1
Fig. 4. Salidas medidas y estimadas de simulación 2.
0.5
^
x1
rad
−0.5 1 x2
−1 ^
x2
rad/seg
0 5 10 15 20 25 30
0
1
0.5
x3
−1
^
x3 0 5 10 15
Tiempo (seg)
20 25 30
rad
−0.5 2 x4
−1 ^
x4
rad/seg
0 5 10 15 20 25 30
0
1
x5
−2
0.5
^5
x 0 5 10 15
Tiempo (seg)
20 25 30
rad
0
1 x6
−0.5 ^
x6
rad/seg
0 5 10 15 20 25 30
Tiempo (seg)
0
−1
Fig. 2. Salidas medidas y estimadas de simulación 1. 0 5 10 15
Tiempo (seg)
20 25 30
1
Fig. 5. Velocidades rotacionales y sus estimaciones de
0
simulación 2.
rad/seg
x2
−1
^2
x
−2
0 5 10 15 20 25 30
Tiempo (seg) 4.3 Simulación 3
1
x4
−1
^4
x 3. En la Fig. 6 se muestra que la salida es estimada
−2
0 5 10 15 20 25 30
correctamente por el observador T-S. Al agregar una
Tiempo (seg) perturbación al sistema, el controlador robusto es capaz de
1
x6 estabilizar correctamente, en un tiempo corto, los ángulos
0.5
^
x6 de Euler. La Fig. 7 presenta una correcta estimación de
rad/seg
0
los estados no medidos y se muestra que la ley de control
−0.5
0 5 10 15 20 25 30
robusta logra estabilizar el sistema rápidamente y no es
Tiempo (seg)
afectado por la perturbación.
Fig. 3. Velocidades rotacionales y sus estimaciones de
simulación 1. 5. CONCLUSIÓN
1
x1 Chadli, M. and Guerra, T.M. (2012). Lmi solution for
0.5
^x1 robust static output feedback control of discrete takagi–
rad
0
sugeno fuzzy models. Fuzzy Systems, IEEE Transac-
tions on, 20(6), 1160–1165.
−0.5
0 5 10 15 20 25 30 Dydek, Z.T., Annaswamy, A.M., and Lavretsky, E. (2010).
1 Adaptive control of quadrotor uavs in the presence of
x3
0.5 actuator uncertainties. AIAA Infotech@ Aerospace, 20–
^3
x
22.
rad
0 7535. IEEE.
−2 Lendek, Z., Guerra, T.M., Babuska, R., and De Schutter,
−4
0 5 10 15 20 25 30
B. (2010). Stability analysis and nonlinear observer
Tiempo (seg) design using Takagi-Sugeno fuzzy models, volume 262.
4
x4 Springer.
2
^
x4 Lofberg, J. (2004). A toolbox for modeling and optimiza-
rad/seg
0
tion in matlab. In Proceedings of the Computer Aided
−2
Control System Design Conference.
−4
0 5 10 15
Tiempo (seg)
20 25 30 Lopez-Estrada, F.R., Ponsart, J.C., Theilliol, D., Astorga-
4
Zaragoza, C., and Zhang, Y. (2014). Robust sensor fault
x6 diagnosis and tracking controller for a uav modelled as
2
^x6
rad/seg