Académique Documents
Professionnel Documents
Culture Documents
X =
1
m
[T sin() Lcos( + ) Dsin( + )] (5.1)
Z =
1
m
[T cos() +Lsin( + ) Dcos( + )] g (5.2)
=
1
I
yy
[l
w
Lcos() +M] (5.3)
donde
X,
Z y
son la aceleracin, altitud y ngulo pitch, respectivamente. La
masa est representada por la letra m, la gravedad de la tierra por la letra g, la matriz
de inercia est dada por I
yy
y la distancia del motor al centro de gravedad por l
w
.
Las letras T, L, D, M se reeren al empuje generado por el motor, al levantamiento,
al arrastre y al momento de pitch en el eje y positivo respectivamente.
5.2. Accin de control aplicada al prototipo
Antes de centrar la atencin en el diagrama de ujo empleado para el control
del prototipo se denirn algunos conceptos importantes para entender la accin de
control aplicada.
Controladores Automticos. Un controlador automtico compara el valor
real de la salida de la planta (sistema fsico a controlar) con la entrada de
referencia (el valor deseado) referencia en [1]; posteriormente ste determina
la desviacin o diferencia entre estas dos variables y produce una seal de
control para disminuir la diferencia o mejor conocida como error a un valor
de cero o a un valor pequeo. La manera en la cual el controlador automtico
produce la seal de control se denomina accin de control.
52
5. Control del Prototipo
Entrada de Referencia o Set Point. Es el valor que se desea que tenga la
variable controlada.
Variable Controlada. Es la seal que debe mantenerse en un valor deseado.
Actuadores. Es el elemento nal de control que modica directamente a la
planta de acuerdo a la seal enviada por el controlador automtico.
Planta. Es todo sistema fsico al cual se le aplica una accin de control.
Sensores. Dispositivo en el cual se produce un fenmeno mecnico, elctrico
o similar, relacionado con la variable de salida de la planta.
En el diagrama a bloques del control de la orientacin del prototipo mostrado en
la gura 5.2 se pueden identicar los conceptos denidos anteriormente. Por ejemplo,
la entrada de referencia corresponde al ngulo deseado de Roll, Pitch y Yaw; el
controlador automtico se identica como el microcontrolador, donde la variable
controlada es la seal PWM emitida por el mismo microcontrolador, tambin se
puede identicar a los servomotores como los actuadores, los cuales mediante el
cambio de su posicin modican las supercies de control del UAV que son la planta
en este caso, y por ltimo estn los sensores, los cuales transmiten el valor real de
la seal obtenida a la salida para ser comparada con la entrada de referencia o valor
deseado y as reducir el error.
Figura 5.2: Diagrama a bloques del Control de la Orientacin Prototipo
5.2.1. Controlador Proporcional-Derivativo (PD)
De acuerdo a la accin de control que desempea cada controlador, estos pueden
ser clasicados de la siguiente forma referencia en [1]:
Controlador On-O.
Controlador Proporcional (P)
53
5.2. Accin de control aplicada al prototipo
Controlador Integral (I)
Controlador Derivativo (D)
Controlador Proporcional-Integral (PI)
Controlador Proporcional-Derivativo (PD)
Controlador Proporcional-Integral-Derivativo (PID)
El tipo de controlador a emplear se elije de acuerdo a la planta y a las condiciones
de operacin del sistema. Por lo tanto, se eligo un Controlador Proporcional-
Derivativo (PD) respecto a los dems controladores.
La eleccin del Controlador Proporcional-Derivativo (PD) es debido a
que los acelermetros (miden la posicin angular del vehculo) representan la parte
proporcional y los gyros (miden la velocidad angular del vehculo) representan la
parte derivativa, es decir, la Accin Proporcional (P); se considera como un
amplicador con ganancia ajustable sin importar cual sea el mecanismo real, pero
esta accin siempre debe de ir acompaada por otra accin de control ya que los
valores obtenidos del producto de la ganancia proporcional (K
p
) y el error, solo
funcionan para un cierto rango de valores del sistema.
En conjunto, con la accin proporcional (P) se uso la Accin Derivativa (D).
Su funcin principal es mantener al mnimo el error corrigindolo proporcionalmente
a la misma velocidad que se produce, de tal forma que el error no incrementa. En la
accin derivativa (D), se deriva el error respecto al tiempo y se multiplica por una
constante T
d
para as sumarse a la seal proporcional (P).
Otro aspecto importante a considerar en este tipo de control, es que debemos
de adaptar la respuesta de control a los cambios en el sistema ya que una mayor
derivativa corresponde a un cambio ms rpido y el controlador pueda responder
acordemente. En el programa realizado para el control de la orientacin se emplea
la rutina de saturacin para adaptar la respuesta respecto a los cambios de posicin
de los servomotores.
Donde para la accin proporcional (P), la relacin entre la salida del controlador
u(t) y el error e(t) corresponde a la ecuacin 5.4 y para la accin derivativa (D) esta
representada por la ecuacin 5.5:
u(t) +k
p
e(t) (5.4)
54
5. Control del Prototipo
u(t) +k
d
de(t)
d(t)
(5.5)
donde k
p
es la ganancia proporcional ajustable y k
d
es la ganancia derivativa.
Aplicando la transformada de Laplace a las ecuaciones 5.4 y 5.5, se obtienen sus
funciones de transferencia (es la relacin salida entre la entrada del sistema) respec-
tivamente, teniendo de esta forma las ecuaciones 5.6 y 5.7 las cuales se sumarn
para formar el Controlador Proporcional-Derivativo (PD) (ecuacin 5.9).
U(s)
E(s)
= kp (5.6)
U(s)
E(s)
= kds (5.7)
La ecuacin 5.8 representa la relacin entre la salida del controlador u(t) y el
error e(t) para el controlador proporcional-derivativo (PD)
u(t) = k
p
e(t) +k
p
T
d
de(t)
d(t)
(5.8)
U(s)
E(s)
= k
p
(1 +T
d
s) (5.9)
donde T
d
es el tiempo derivativo, el cual se reere al tiempo de accin derivada
en minutos de anticipo.
La accin Proporcional-Integral (PI) Proporcional-Integral-Derivativo (PID)
no fueron empleadas para el control del prototipo ya que no se realiza una prome-
diacin del error en un perodo determinado para corregirlo.
5.3. Control de la orientacin
Para realizar el control de la orientacin del vehculo, es necesario controlar los
tres movimientos rotativos del vehculo dados por Roll, Pitch y Yaw en los ejes X,
Y y Z respectivamente.
5.3.1. Control del ngulo pitch, roll y yaw del prototipo
En modo aeronave, la dinmica de pitch es estable en lazo abierto, debido a que
el centro de gravedad est ubicado adelante del centro aerodinmico del ala. Por lo
55
5.3. Control de la orientacin
que el avin efectua un movimiento hacia adelante debido al empuje (T), las varia-
ciones de la altura son modicadas por y T; que a su vez el pitch () es generado
por el cambio de posicin de
e
. La variacin proporcional de estos parmetros afecta
al levantamiento (L).
La estrategia de control que estabiliza la dinmica de pitch referencia en [5] es:
=
x
l
w
(5.10)
donde,
x
= K
v
e
+ K
p
e
(
d
) con K
v
e
y K
p
e
> 0 que son las ganancias de
la velocidad angular y posicin angular respectivamente.
Considerando que el ngulo de ataque es muy pequeo decimos que cos() 1.
Al aplicar el control Proporcional-Derivativo (PD) la ecuacin 5.3 se reduce de
la siguiente forma
= [K
v
e
+ K
p
e
(
d
)] (5.11)
donde,
d
cuando t nf. La deseada es representa como
d
.
la primera parte de la ecuacin correspondiente a
representa la velocidad an-
gular que es la parte de control derivativo (D) y la segunda parte que involucra a
(
d
) representa la posicin angular que es el control proporcional (P). Aplicando
la transformada de Laplace e igualando a cero la ecuacin 5.11 obtenemos
s
2
(s) +K
v
e
s(s) +K
p
e
(s) = 0 (5.12)
Aplicando el Criterio de Estabilidad de Routh-Hurwitz a la ecuacin 5.13 obte-
nemos las ganancias del controlador de orientacin
K
v
e
> 0
K
p
e
> 0 (5.13)
Por ltimo se ja la orientacin, eligiendo las ganancias del controlador de ori-
entacin de tal forma que converjan rapidamente a
= 0 (gura 5.3) en un tiempo
de aproximadamente 1,4s y
d
=
9
(gura 5.4), donde es sumamente pequeo
para evitar que el avin llege a su punto mximo de elevacin tambin conocido
como stall y despus caiga abruptamente referencia en [5]. Esto ocurre con un n-
gulo de ataque 15 grados dependiendo del perl aerodinmico utilizado para la
construccin del ala.
Como podemos ver en la gura 5.4, la grca inicia en el valor propuesto para
0
10 grados e incremente hasta llegar al valor nal de
d
15 grados, que es el
56
5. Control del Prototipo
Figura 5.3: Velocidad
= 0
Figura 5.4: Control del ngulo pitch
57
5.4. Diagrama de ujo del algoritmo de control
punto deseado para que se mantenga el ngulo pitch durante el vuelo del avin.
Para realizar el control del ngulo roll y yaw se partio del mismo esquema de
control de pitch el cual consiste en la deexin del elevador para controlar el desplaza-
miento del vehculo. El control de roll es mediante la deexin de los alerones los
cuales generan fuerzas de igual magnitud pero en direccin y sentido opuesto. Se
emplea el acelermetro ubicado en el eje Y y el girmetro ubicado en el eje X para
medir la posicin angular y la velocidad angular de la aeronave, respectivamente.
En lo que corresponde al control de yaw se emplea el girmetro ubicado en el eje
Y y el magenetmetro; donde, las seales enviadas por estos sensores son procesadas
por el microcontrolador modicando la posicin del rudder para lograr el control de
la orientacin en el eje Z.
5.4. Diagrama de ujo del algoritmo de control
Para realizar el control de la orientacin del vehculo, primeramente se realiz un
diagrama de ujo que sirvi de apoyo para la realizacin del programa en el software
llamado Dynamic C.
Una vez que se acab el programa, se cargo al mdulo RCM3400 conectando el
cable de programacin del Rabbit de la computadora a la tarjeta donde se encuentra
montado el microprocesador.
Se debe de tener especial cuidado en mantener el prototipo en posicin horizontal
y sin movimientos, mientras se carga el programa de la computadora al microcon-
trolador y al encender el prototipo para hacer las pruebas de vuelo; ya que se lleva
a cabo la promedicin de los sensores para eliminar el oset. De lo contrario, la
promediacin ser respecto a otra posicin del prototipo ocasionando que no vuele
en lnea recta como se pretende.
El diagrama de ujo realizado es el siguiente:
58
5. Control del Prototipo
59
5.4. Diagrama de ujo del algoritmo de control
60
5. Control del Prototipo
61
5.4. Diagrama de ujo del algoritmo de control
62
Captulo 6
Resultados Experimentales
Despus de haber instrumentado el prototipo y programado el microcontrolador,
se procedi a realizar las pruebas de vuelo de forma manual como automtica para
adquirir las grcas correspondientes a los vuelos con y sin control de la orientacin.
Para poder obtener las grcas representativas de los movimientos de rotacin
de la aeronave, se debe utilizar un modem para enviar y recibir los datos. El modem
utilizado para la adquisicin de los datos es el Xbee Pro serie 1. Se cuenta con un
dispositivo maestro y uno esclavo, donde cada uno es conectado a una computadora
a travs del puerto USB de la misma. Mediante el uso de un software, los modem
son congurados, uno como transmisor y otro como receptor a la misma velocidad
de transmisn/recepcin, con la misma cantidad de bits a enviar y recibir, etc.
Una vez nalizada la conguracin del modem, es necesario leer el puerto serie
del microcontrolador al cual se conectar el modem. Una vez que se conect el
transmisor al microcontrolador y el receptor al puerto USB de la computadora, se
efectuan los vuelos necesarios para que mediante el uso del software de MatLab se
puedan recibir y procesar los datos de acuerdo a las condiciones establecidas en el
programa elaborado.
Las grcas obtenidas de los vuelos con control de la orientacin son las siguientes
para cada uno de los movimientos de rotacin de la aeronave.
63
Control en Roll
La intencin de hacer el control del movimiento de rotacin en roll del vehculo,
es mantener en 0 lo ms cercano posible a est valor el ngulo roll, para estabilizar
los alerones sobre la horizontal. La gura 6.1 muestra como el control en roll sigue
la referencia dada de 0.
Figura 6.1: Control del ngulo roll
64
6. Resultados Experimentales
Control en Pitch
La gura 6.2 muestra la comparacin entre el ngulo real del vehculo y la medi-
cin del ngulo una vez aplicado el control sobre el mismo. En la primer grca se
puede ver el comportamiento del ngulo pitch; donde, el parmetro de inicial es
de 5 y la deseada es de 15, como se indica en el apartado referente al control del
prototipo. La segunda grca muestra el comportamiento de la aeronave una vez
aplicado el control en pitch, el cual sigue a la referencia propuesta anteriormente.
Figura 6.2: Control del ngulo pitch
65
Control en Yaw
Por ltimo, al realizar el control de yaw (gura 6.3) se establece la referencia en
0, la cual es seguida por el prototipo correctamente.
Figura 6.3: Control del ngulo yaw
66
Captulo 7
Conclusiones y Trabajos Futuros
La nalidad de construir fsicamente el prototipo y realizar las pruebas de vuelo
correspondientes es corroborar que el diseo, la instrumentacin y el control utili-
zado estn funcionando en conjunto para lograr el objetivo principal que es controlar
la orientacin del UAV para la realizacin de vuelos automticos en lnea recta.
Durante el desarrollo de este proyecto pude aprender nuevos conocimientos, am-
pliar los existentes y generarme an ms preguntas. Por ejemplo, en un principio no
tena idea de los factores aerodinmicos que inuan para el control de una aeronave,
posteriormente me di cuenta que tener un conocimiento de los principales factores
aerodinmicos y de las diferentes estrategias de control existentes, es fundamental
para poder llegar a controlar un vehculo con caractersticas iguales o similares de
manera ecaz y eciente.
Por otra parte, a lo largo de este tiempo se presentaron diferentes contratiempos
para llevar a cabo el proyecto, los cuales se fueron solucionando poco a poco con
la ayuda de los investigadores que colaboraron conmigo. Lo anterior me permiti
realizar el control de la orientacin del vehculo, cumpliendo as con la totalidad de
los objetivos planteados en un inicio.
Debido al xito obtenido en cuanto a que se pudo llevar a cabo el control de la
orientacin del vehculo, se concluye que podran aadirse a ste sensores de velo-
cidad y un GPS (Sistema de Posicionamiento Global) para lograr un mejor control
del vehculo.
A largo plazo quiz se podra realizar el control de la posicin del vehculo ya sea
en movimiento o en punto jo mediante visin; para ello, se tendra que profundizar
en la teora del control, proponer nuevas leyes al respecto, en caso de que no existan,
lo sucientemente slidas para lograr tal n o tambin migrar haca otros tipos de
67
vehculos areos.
68
Apndice A
Glosario
A
Aceleracin: Magnitud vectorial que indica el cambio de la velocidad de un
cuerpo por unidad de tiempo. En otras palabras la aceleracin es la derivada
del vector velocidad respecto al tiempo. Expresada en [
m
s
2
].
Aceleracin Angular: Es la variacin de la velocidad angular () por unidad
de tiempo, expresada en [
rad
seg
2
]. Se representa con la letra y se calcula de la
siguiente forma:
=
d
dt
(A.1)
Acelermetro: Es cualquier instrumento destinado a medir aceleraciones
lneales.
Alcance: Es la diferencia algebrica entre los valores superior e inferior del
campo de medida del instrumento. Ejemplo, el receptor utilizado para la
comunicacin entre el radio control y el avin tiene un alcance de 3km.
Automtico: Es todo aquello que se mueve, regula y opera, por s solo,
independientemente del medio que lo rodea.
Automatizacin: Cosiste en un sistema de control automtico, por medio
del cual el sistema verica su propio funcionamiento, efectuando mediciones y
correcciones sin la intervencin del ser humano.
Autnomo: Sistema que tiene la libertad de gobernarse por sus propias leyes
de control.
C
69
Control: Accin ejercida con el n de poder mantener una variable dentro de
un rango de valores predeterminados.
Control Automtico: Cosiste en desarrollar la accin de control, sin la
participacin directa de un ser humano (operario).
D
Desplazamiento: (Fsica). Es la longitud de la trayectoria comprendida entre
la posicin inicial y la posicin nal de un objeto.
E
Eje de Rotacin: Lnea alrededor de la cual se realiza un giro.
F
Frecuencia (f ): Es la inversa del periodo (ecuacin A.2), es decir, es el nmero
de revoluciones o vueltas que da un mvil por unidad de tiempo. Se mide en
s
1
o hertz (Hz).
f =
1
T
=
2
(A.2)
I
Inercia: Es la propiedad de los cuerpos de resistirse al cambio del movimiento,
es decir, es la resistencia al efecto de una fuerza que se ejerce sobre ellos.
L
Ley de conservacin: Las leyes de conservacin se reeren a las leyes fsicas
que postulan que durante la evolucin temporal de un sistema aislado ciertas
magnitudes tienen un valor constante. Puesto que el universo entero constituye
un sistema aislado pueden aplicrsele diversas leyes de conservacin.
M
Momento Angular: Es una magnitud fsica importante en todas las teoras
fsicas, ya que est relacionada con las simetras rotacionales de los sistemas
fsicos. Bajo ciertas condiciones de simetra rotacional de los sistemas es una
magnitud que se mantiene constante con el tiempo a medida que el sistema
evoluciona, lo cual da lugar a una Ley de conservacin conocida como Ley de
conservacin del Momento Angular. El momento angular se mide en el Sistema
Internacional (SI) en [
kg m
2
s
].
70
A. Glosario
Momento de Fuerza Par Motor: Es la fuerza aplicada por la distancia
al eje de rotacin.
Momento de Inercia Inercia Rotacional: Es una medida de la inercia
rotacional de un cuerpo. Expresado mediante el smbolo I.
O
Operacin de Control: Conjunto de acciones que buscan mantener una
variable dentro de los rangos de funcionamiento deseados.
Orientacin: La orientacin de un objeto en el espacio es cada una de las
posibles elecciones para colocarlo sin cambiar un punto jo de referencia, es
decir, el objeto puede ser rotado alrededor de un punto jo. Por lo tanto, la
orientacin puede ser denida por ngulos de rotacin sobre un punto jo.
P
Perodo (T): Indica el tiempo que tarda un mvil en dar una vuelta a la
circunferencia que recorre. Su ecuacin (A.3) es la siguiente:
T =
2
(A.3)
Posicin: La posicin de una partcula fsica se reere a la localizacin en
el espacio-tiempo de la misma, normalmente se expresa por un conjunto de
coordenadas.
Posicin Angular: Es el arco de la circunferencia, medido en radianes, que
realiza un movimiento (ecuacin A.4). Se representa con la letra y se calcula
de la siguiente forma:
e(t) = R (t) (A.4)
Donde e(t) es el espacio recorrido a lo largo de una circunferencia de radio R.
R
Rango: Son el conjunto de valores comprendidos entre los lmites superior e
inferior de la capacidad de medida o de transmisin del instrumento. Ejemplo,
la central inercial (IMU) tiene un rango de operacin de 1,96 a 3,0V olts.
71
Rapidez Celeridad: Es la relacin entre la distancia recorrida y el tiempo
empleado en recorrerla. La rapidez es una magnitud escalar la cual se mide
en las mismas unidades que la velocidad, pero no es un vector como est. La
rapidez representa justamente el mdulo de la velocidad.
S
Sistema: Es el conjunto de partes o elementos organizadas y relacionados,
que interactan entre en s, para llegar a un mismo objetivo.
Sistemas de Automatizacin: Conjunto de equipos, sistemas de infor-
macin, y procedimientos que van a permitir y asegurar un desempeo in-
dependiente del proceso, a travs de operaciones de control y supervisin.
Supervisin y Monitoreo: Es el proceso de lectura de valores de las diversas
variable del proceso, con el objetivo de identicar el estado en el que se viene
desarrollando el proceso en un tiempo determinado.
T
Trayectoria: Es el lugar geomtrico de las sucesivas posiciones que va ocu-
pando un cuerpo durante su movimiento.
V
Velocidad: Magnitud fsica de carcter vectorial que expresa el desplaza-
miento de un objeto por unidad de tiempo. En otras palabras la velocidad es
la derivada del vector posicin con respecto al tiempo. Expresada en [
m
s
].
Velocidad Angular: Es la variacin de la posicin angular () respecto al
tiempo (ecuacin A.5). Se expresa en [
rad
seg
] y se representa con la letra y se
calcula de la siguiente forma:
=
d
dt
(A.5)
72
Bibliografa
[1] Ogata, Katsuhiko. Ingeniera de control moderna. 4
a
.ed. Espaa: Prentice Hall,
2002.
[2] Palacios Municio, Enrique. Microcontrolador PIC16F84. 2
a
.ed. Mxico: Alfa-
omega, 2006.
[3] Stengel, R. Flight Dynamics. Princeton University Press, 2004.
[4] Barnes W., McComick. Aerodynamics, Aeronautics and Flight Mechanics.
2
a
.ed. Jonh Wiley and Sons Inc., 1995.
[5] Flores Colunga, Ramn Gerardo. Modelado, control e implementacin de mi-
ni vehculos areos autnomos convertibles. Tesis de Maestra. CINVESTAV,
2010.
[6] Escareo Castro, Juan Antonio. Localizacin de un helicptero miniatura utili-
zando visin articial. Tesis de Doctorado. CINVESTAV, 2008.
[7] Gonzlez Hernndez, Ivn. Control de la orientacin y altura de un helicptero
miniatura de cuatro hlices. Tesis de Maestra. CINVESTAV, 2009.
[8] Efkhanian, Ludovic. Cration et commande en stabilit d un drone avion.
Ecoles dOcier de lArme de lAir, 2010.
[9] Carter, Bruce. Designing Gain and Oset in Thirty Seconds. S.l. Texas
Instruments, 2002.
[10] Mancini, Ron. Single Supply Op Amp Design Techniques. S.l. Texas Instru-
ments, s.f.
[11] Users Manual. Dynamic C. Digi International Inc., 2007-2008.
[12] Users Manual. Rabbit Core RCM3400. Rabbit Semiconductor Inc., 2002-
2007.
[13] Wikipedia, http://es.wikipedia.org
73
BIBLIOGRAFA
[14] NASA, http://www.grc.nasa.gov
[15] Manual de vuelo, http://www.manualvuelo.com
[16] Diseo aerodinmico, http://www.aerospaceweb.org
[17] Perles alares, http://www.mexicorc.com
[18] Orientacin, http://www.worldlingo.com
[19] Magnetmetro, http://www.robot-electronics.co.uk
[20] Central Inercial, http://www.robodacta.com
[21] Presin atmosfrica, http://www.cneq.unam.mx
74