desarrollo y construcción de una plataforma experimental...

6
Desarrollo y Construcci´ on de una Plataforma Experimental de un UAV para pruebas de Control Autom´ atico G. Ortiz-Torres * , R. Schacht-Rodr´ ıguez * , M. E. Guerrero-S´ anchez ** , J. Reyes-Reyes * , C. D. Garc´ ıa-Beltr´ an * * Centro Nacional de Investigaci´on y Desarrollo Tecnol´ogico - CENIDET, Interior Internado Palmira S/N, Col. Palmira, 62490, Cuernavaca, Morelos, M´ exico (e-mail: [email protected]). ** Instituto Tecnol´ogico Superior de Coatzacoalcos - ITESCO, Carretera Antigua Mina-Coatza, km. 16.5, Col. Reserva Territorial, 96536, Coatzacoalcos, Veracruz, M´ exico Resumen: La principal contribuci´ on del presente art´ ıculo es el desarrollo y la construcci´ on de una plataforma experimental para un veh´ ıculo plano de despegue y aterrizaje vertical (PVTOL) considerando la din´ amica de la traslaci´ on y la rotaci´ on del veh´ ıculo. Se presenta la instrumentaci´ on de la plataforma experimental explicando c´ omo el sistema propuesto mide la posici´ on y el desplazamiento rotacional del UAV. Se muestra un controlador Proporcional Integral Derivativo (PID) en cascada aplicado al veh´ ıculo resolviendo el acoplamiento entre la din´ amica traslacional y rotacional en el PVTOL utilizando la plataforma experimental propuesta. Finalmente, se exhibe la efectividad de la plataforma experimental mostrando su capacidad para utilizarse en diferentes estrateg´ ıas de control autom´ atico. Keywords: Control de Sistemas No Lineales; Control robusto; Veh´ ıculo A´ ereo no Tripulado; Implementaci´ on Pr´ actica. 1. INTRODUCCI ´ ON En las ´ ultimas d´ ecadas, ha habido un inter´ es creciente en el control de los veh´ ıculos a´ ereos no tripulados. Esta popularidad se debe a la capacidad de llevar a cabo una amplia gama de aplicaciones, por ejemplo: cinematograf´ ıa erea, misiones de b´ usqueda y de rescate, vigilancia de incendios forestales, detecci´ on de derrame de petr´ oleo, entrega de paqueter´ ıa, agricultura de precisi´ on, monitoreo de sistemas de comunicaciones, entre otros, Derafa et al. (2012). El veh´ ıculo a´ ereo plano con capacidad de despegue y aterrizaje vertical o PVTOL es un sistema din´ amico no lineal que representa un reto desafiante para el control del movimiento. No obstante, el control de cualquier veh´ ıculo a´ ereo que pueda despegar verticalmente como un helic´ optero puede desarrollarse usando el modelo de un PVTOL. As´ ı, el modelo matem´ atico de un PVTOL se ha convertido en un punto de referencia en la ingenier´ ıa aeroespacial. El problema de control del PVTOL es seguir la trayectoria deseada manteniendo el ´ angulo de rotaci´ on de alabeo en cero. La estabilizaci´ on del ´ angulo de alabeo durante el seguimiento de la trayectoria es un desaf´ ıo, debido a la tendencia de los aviones a oscilar alrededor del eje longitudinal por las fuerzas aplicadas. El sistema PVTOL tiene un m´ ınimo n´ umero de estados y entradas, comparado con otros veh´ ıculos a´ ereos, Lara et al. (2014) y Ortiz et al. (2016), sin embargo, el dise˜ no de controladores para el seguimiento de trayectorias del PVTOL no es trivial, debido a que es necesario considerar la dependencia que existe entre las din´ amicas rotacional y traslacional. Existen investigaciones donde se proponen estrategias de control para solucionar este problema, por ejemplo: en Lin et al. (1999) se estudia un controlador robusto, para lo cual se emplea un enfoque de control ´ optimo. En Aguilar-Iba˜ nez et al. (2015) se presenta un control para resolver el problema de regulaci´ on para un PVTOL. El m´ etodo propuesto se divide en dos acciones de control por retroalimentaci´ on simult´ aneas: la primera estabiliza la posici´ on vertical mientras que la segunda con- trola la posici´ on horizontal y el ´ angulo de alabeo. Adem´ as, en Car et al. (2011) se introduce la t´ ecnica de control por modos deslizantes para un PVTOL en simulaci´ on. Por otro lado, en Ortiz-Torres et al. (2016) se presenta un controlador para el seguimiento de trayectorias y un sistema de detecci´ on y aislamiento de fallas utilizando una representaci´ on quasi-Lineal con Par´ ametros Variables (qLPV) del veh´ ıculo PVTOL. Son varias las estrategias de control propuestas en la literatura, sin embargo, la mayor´ ıa no presenta resultados experimentales, es por eso que en el presente trabajo se dise˜ na y elabora una plataforma exper- imental para la implementaci´ on y prueba de sistemas de control de un veh´ ıculo PVTOL. La instrumentaci´ on desar- rollada y software utilizado, permiten la implementaci´ on de otros algoritmos de control, observadores de estado, sistemas de detecci´ on y aislamiento de fallas, rutinas de Congreso Nacional de Control Automático 2017 Monterrey, Nuevo León, Mexico, Octubre 4-6, 2017 143

Upload: others

Post on 17-Mar-2020

15 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Desarrollo Y Construcción De Una Plataforma Experimental ...cnca2017.fime.uanl.mx/MemoriaCNCA17/media/files/0069.pdfrobusto, para lo cual se emplea un enfoque de control optimo

Desarrollo y Construccion de unaPlataforma Experimental de un UAV para

pruebas de Control Automatico

G. Ortiz-Torres ∗, R. Schacht-Rodrıguez ∗,M. E. Guerrero-Sanchez ∗∗, J. Reyes-Reyes ∗,

C. D. Garcıa-Beltran ∗

∗ Centro Nacional de Investigacion y Desarrollo Tecnologico -CENIDET, Interior Internado Palmira S/N, Col. Palmira, 62490,Cuernavaca, Morelos, Mexico (e-mail: [email protected]).∗∗ Instituto Tecnologico Superior de Coatzacoalcos - ITESCO,

Carretera Antigua Mina-Coatza, km. 16.5, Col. Reserva Territorial,96536, Coatzacoalcos, Veracruz, Mexico

Resumen: La principal contribucion del presente artıculo es el desarrollo y la construccionde una plataforma experimental para un vehıculo plano de despegue y aterrizaje vertical(PVTOL) considerando la dinamica de la traslacion y la rotacion del vehıculo. Se presentala instrumentacion de la plataforma experimental explicando como el sistema propuesto midela posicion y el desplazamiento rotacional del UAV. Se muestra un controlador ProporcionalIntegral Derivativo (PID) en cascada aplicado al vehıculo resolviendo el acoplamiento entrela dinamica traslacional y rotacional en el PVTOL utilizando la plataforma experimentalpropuesta. Finalmente, se exhibe la efectividad de la plataforma experimental mostrando sucapacidad para utilizarse en diferentes estrategıas de control automatico.

Keywords: Control de Sistemas No Lineales; Control robusto; Vehıculo Aereo no Tripulado;Implementacion Practica.

1. INTRODUCCION

En las ultimas decadas, ha habido un interes crecienteen el control de los vehıculos aereos no tripulados. Estapopularidad se debe a la capacidad de llevar a cabo unaamplia gama de aplicaciones, por ejemplo: cinematografıaaerea, misiones de busqueda y de rescate, vigilancia deincendios forestales, deteccion de derrame de petroleo,entrega de paqueterıa, agricultura de precision, monitoreode sistemas de comunicaciones, entre otros, Derafa et al.(2012).

El vehıculo aereo plano con capacidad de despegue yaterrizaje vertical o PVTOL es un sistema dinamico nolineal que representa un reto desafiante para el controldel movimiento. No obstante, el control de cualquiervehıculo aereo que pueda despegar verticalmente como unhelicoptero puede desarrollarse usando el modelo de unPVTOL. Ası, el modelo matematico de un PVTOL seha convertido en un punto de referencia en la ingenierıaaeroespacial.

El problema de control del PVTOL es seguir la trayectoriadeseada manteniendo el angulo de rotacion de alabeoen cero. La estabilizacion del angulo de alabeo duranteel seguimiento de la trayectoria es un desafıo, debido ala tendencia de los aviones a oscilar alrededor del ejelongitudinal por las fuerzas aplicadas.

El sistema PVTOL tiene un mınimo numero de estadosy entradas, comparado con otros vehıculos aereos, Lara

et al. (2014) y Ortiz et al. (2016), sin embargo, el disenode controladores para el seguimiento de trayectorias delPVTOL no es trivial, debido a que es necesario considerarla dependencia que existe entre las dinamicas rotacionaly traslacional. Existen investigaciones donde se proponenestrategias de control para solucionar este problema, porejemplo: en Lin et al. (1999) se estudia un controladorrobusto, para lo cual se emplea un enfoque de controloptimo. En Aguilar-Ibanez et al. (2015) se presenta uncontrol para resolver el problema de regulacion para unPVTOL. El metodo propuesto se divide en dos accionesde control por retroalimentacion simultaneas: la primeraestabiliza la posicion vertical mientras que la segunda con-trola la posicion horizontal y el angulo de alabeo. Ademas,en Car et al. (2011) se introduce la tecnica de controlpor modos deslizantes para un PVTOL en simulacion.Por otro lado, en Ortiz-Torres et al. (2016) se presentaun controlador para el seguimiento de trayectorias y unsistema de deteccion y aislamiento de fallas utilizandouna representacion quasi-Lineal con Parametros Variables(qLPV) del vehıculo PVTOL. Son varias las estrategias decontrol propuestas en la literatura, sin embargo, la mayorıano presenta resultados experimentales, es por eso que en elpresente trabajo se disena y elabora una plataforma exper-imental para la implementacion y prueba de sistemas decontrol de un vehıculo PVTOL. La instrumentacion desar-rollada y software utilizado, permiten la implementacionde otros algoritmos de control, observadores de estado,sistemas de deteccion y aislamiento de fallas, rutinas de

Congreso Nacional de Control Automático 2017Monterrey, Nuevo León, Mexico, Octubre 4-6, 2017

143

Page 2: Desarrollo Y Construcción De Una Plataforma Experimental ...cnca2017.fime.uanl.mx/MemoriaCNCA17/media/files/0069.pdfrobusto, para lo cual se emplea un enfoque de control optimo

prediccion de averıas y estrategias de control tolerante afallas.

En este trabajo se presenta el desarrollo y la elaboracionde un sistema experimental PVTOL y de una plataformaexperimental para implementar sistemas de control enel vehıculo aereo. El artıculo se divide de la siguientemanera: la Seccion 2 introduce el modelo matematico delPVTOL. La Seccion 3 muestra el diseno y la elaboraciondel prototipo, tambien introduce la instrumentacion y laspartes electronicas que lo forman. La Seccion 4 presentalos detalles del diseno y de la elaboracion de la plataformaexperimental. La Seccion 5 muestra los resultados experi-mentales aplicando controladores PIDs en cascada. Final-mente, la Seccion 6 presenta las conclusiones.

2. MODELO MATEMATICO DEL PVTOL

El vehıculo PVTOL esta compuesto de dos motores in-dependientes con dos propelas para producir la fuerza deempuje fi y un par τθ en direccion del eje de rotacion delas propelas. La propela 1 gira en direccion contraria alas manecillas del reloj, mientras que la propela 2 gira endireccion de las manecillas del reloj, como se muestra enla Fig. 1. Aumentando o disminuyendo la velocidad de losmotores en la misma magnitud, se logra un desplazamientovertical en el eje z. Cambiando inversamente la velocidadde los motores 1 y 2 se produce una rotacion en alabeo θacoplado a un desplazamiento lateral en el eje x. Se denotaE = Oe, xe, ze como el marco de referencia inercial fijoen tierra, y Q = Oq, xq, zq define el marco fijo al cuerpodel vehıculo, cuyo origen es el centro de masa del PVTOL.

Con el proposito de disenar un algoritmo de controlefectivo, se consideran las siguientes suposiciones:

• La estructura del vehıculo es rıgida y simetrica,• El centro de masa y Oq coinciden,• Las propelas son rıgidas,• El empuje y el arrastre son proporcionales al cuadrado

de las velocidades de las propelas,• El par de alabeo genera una fuerza perpendicular al

eje z.• La dinamica en guinada se ignora.

f2

mg

ze

xe OeE

Q

zq

l

xq 0

Oqf1

Fig. 1. Configuracion del PVTOL.

Utilizando el formalismo de Newton-Euler, la dinamicade un cuerpo rıgido con un desplazamiento plano y bajofuerzas externas se representa por:

Jω = τθ

ξ = v

mv = Rz2∑i=1

fi +mg,

(1)

donde ξ = (x, z)> ∈ R2 denota la posicion del vehıculocon respecto al marco E y (A)> representa la matriztranspuesta de A. La velocidad lineal se denota por v ∈ E,ω = θ es la velocidad de alabeo definida en el marco Q y mes la masa total del vehıculo. El momento de inercia J esexpresado en el marco Q, τθ es el par de alabeo definido enE. La aceleracion producida por la gravedad se representapor g = (0,−9.81)>. La rotacion del marco del vehıculocon respecto al marco inercial esta dada por la matriz derotacion R:

R =

[cosθ −senθsenθ cosθ

]. (2)

Las fuerzas que actuan en el vehıculo son el peso mg y lasdos fuerzas generadas por las propelas fi, las cuales actuanen direccion al eje de rotacion de las propelas z = (0, 1)>.El momento en alabeo se define por:

τθ = l(f1 − f2), (3)

donde l es la distancia respecto a los motores y el centrode gravedad. Cada propela gira alrededor del eje z en elmarco fijo al vehıculo con una velocidad angular Ωi. Lafuerza de empuje y el par generalizado se expresan comouna relacion del cuadrado de la velocidad angular de cadapropela, tal que:

fi = d · Ω2i , (4)

donde d > 0 es un parametro constante que caracterizala eficiencia de las propelas y se llama factor de empuje.Utilizando y aplicando las consideraciones anteriormentemencionadas, se obtiene el siguiente modelo no lineal delPVTOL:

Jθ = lu2mz = −mg + cosθ u1mx = −senθ u1,

(5)

donde u1 y u2 son las entradas de control del sistema,definidas por:

u1 = d · (Ω21 + Ω2

2)

u2 = d · (Ω21 − Ω2

2).(6)

El sistema (5) se puede reescribir mediante la repre-sentacion de espacio de estado utilizando el vector de es-tado x = [θ, θ, z, z, x, x]>, y un vector de entrada definidopor u = [u1, u2]>, tal que se tiene:

x =

0 1 0 0 0 00 0 0 0 0 00 0 0 1 0 00 0 0 0 0 00 0 0 0 0 10 0 0 0 0 0

x +

0 00 l

J0 0

b11m 0

0 0−ux 1

m 0

u +

000−g00

y =

1 0 0 0 0 00 0 1 0 0 00 0 0 0 1 0

x,

(7)

con:b1 = cosθ (8)

ux = senθ, (9)

Page 3: Desarrollo Y Construcción De Una Plataforma Experimental ...cnca2017.fime.uanl.mx/MemoriaCNCA17/media/files/0069.pdfrobusto, para lo cual se emplea un enfoque de control optimo

donde y es el vector de salidas medidas y ux es una entradavirtual, que sera explicada en la seccion de resultadosexperimentales.

A continuacion se presenta la descripcion del prototipoPVTOL y de la plataforma experimental.

3. PROTOTIPO EXPERIMENTAL PVTOL

El PVTOL se disena para que se desplace en un espaciode 2 dimensiones sobre un plano inclinado. El vehıculo secompone de dos motores de corriente directa que giranen direcciones opuestas uno del otro, y cada motor tieneuna propela diferente, dependiendo del sentido de giro delmotor. Las propelas tienen una longitud de 46 mm, eltamano de los motores es de 7×16 mm con un eje de0.8 mm y el voltaje de alimentacion de cada motor esde 3.7 V. Para controlar la velocidad de los motores seutiliza el circuito Dual Driver DRV8835 con un amperajemaximo de 1.2 A por canal. El controlador de velocidadde los motores recibe la senal por Modulacion de Anchode Pulsos (PWM, por sus siglas en ingles) y la envıa a losmotores con el amperaje requerido.

El PVTOL cuenta con dos marcas de color negro (verFig. 2), que seran utilizadas para conocer la posicion y laorientacion del vehıculo, como se explicara en la siguienteseccion.

Propelas y motores

Marcasnegras Señales PWM

Fig. 2. Prototipo PVTOL.

Los parametros del vehıculo se muestran en la Tabla 1.

Tabla 1. Parametros del PVTOL.

Parametro Valor Unidad Parametro Valor Unidad

m 0.017 kg l 0.04 m

g 9.81 m/s2 Ω2max 4.38 × 106 rad2/s2

d 2.47 × 10−8 Ns2/rad2 p1 2.47 × 10−7 PWMs2/rad2

J 1.75 × 10−5 kgm2 p2 −0.049 PWMs2/rad2

El parametro aerodinamico d se calcula realizando pruebasde empuje con una bascula y midiendo la velocidad angularde las propelas con un sensor infrarrojo. Los resultadosexperimentales utilizados para obtener el parametro d semuestran en la Fig. 3(a). En esta figura se observa larelacion lineal que existe entre la fuerza de empuje yla velocidad angular de las propelas. Los parametros p1y p2 representan la relacion lineal entre el cuadrado dela velocidad angular de las propelas y la senal PWM,y se obtienen utilizando la Fig. 3(b). Los parametrosantes mencionados son necesarios para la implementacionexperimental ya que fısicamente no es posible medir en

lınea la fuerza y el par generados. Por otro lado, medirla velocidad angular de las propelas, implica incorporarsensores adicionales, los cuales limitarıan la capacidad devuelo e incrementarıan la instrumentacion del prototipo.Sin embargo, existe una relacion lineal entre las fuerzasde empuje y el par con respecto al cuadrado de la ve-locidad angular de las propelas y la senal PWM, comose muestra en Choi et al. (2015). Entonces, la senal decontrol generada por el controlador sera una fuerza yun par que se transformaran a velocidades angulares y,finalmente, se convertiran a senales PWM necesarias paraque se cumplan los objetivos de control. Cabe senalar queambos actuadores (motor-propela) se consideran iguales.Finalmente, utilizando la ecuacion (6) y la Fig. 3 es posibleencontrar la relacion de las senales de control a las senalesPWM, como se muestra a continuacion:

u =

[d/p1 d/p1d/p1 −d/p1

] [PWM1 − p2PWM2 − p2

]. (10)

1 2 3 4

xp106

0

0.5

1

Ω2 (rad/s)2

Señ

alpP

WM

p(ci

clop

útil)

Experimental

Estimado

1 2 3 4

xp106

0

0.05

0.1

0.15

Ω2 (rad/s)2

Fue

rzap

depe

mpu

jep(

N)

Experimental

Estimado

(a) (b)

Fig. 3. Relacion lineal entre el cuadrado de la velocidadangular de la propela y la: (a) fuerza de empuje, (b)senal PWM.

4. PLATAFORMA EXPERIMENTAL PARA ELPVTOL

La plataforma experimental se compone de una camara devideo, una computadora, una tarjeta de National Instru-ments (NI), llamada NI myRIO R©, una baterıa de polımerode litio de 3.7 V y un plano inclinado, como se muestra enla Fig. 4.

Para calcular la posicion y la orientacion del vehıculo seutilizan herramientas para el reconocimiento y el proce-samiento de imagenes, utilizando un software de Na-tional Instruments, llamado NI LabVIEW R©. Dicho proce-samiento de imagenes implica un elevado gasto computa-cional para ser realizado unicamente con la tarjeta NImyRIO R©, por esta razon se dividen las tareas en dosprogramas: un programa que se ejecuta en la computadora,y otro en la tarjeta NI myRIO R©.

A continuacion se explican los programas realizados encada uno de los sistemas y tambien se explican a detallelas partes mas importantes de la plataforma experimental.

4.1 Camara de video

Se utiliza una camara de video estandar configurada con640×480 pıxeles de resolucion; y se ubica en una ori-entacion igual a la del plano inclinado. Mediante la camarade video y el procesamiento de imagenes adquiridas en lacomputadora se calculan la posicion z − x y el angulo de

Page 4: Desarrollo Y Construcción De Una Plataforma Experimental ...cnca2017.fime.uanl.mx/MemoriaCNCA17/media/files/0069.pdfrobusto, para lo cual se emplea un enfoque de control optimo

Cámaraídeívideo

ComputadoraíconíInterfazíenNIíLabVIEW

TarjetaNIímyRIO

Batería

PVTOL

Planoíinclinado

Fig. 4. Partes de la plataforma experimental.

rotacion de alabeo θ del vehıculo, como se muestra en laFig. 5. Tambien se presenta la deteccion de las marcasnegras del PVTOL. El angulo de rotacion de alabeo θ seobtiene con la siguiente expresion (la cual se emplea paracalcular la pendiente de una recta):

θ = arctan

(z2 − z1x2 − x1

)(11)

donde x1 y x2 son las posiciones en el eje x en pixeles delas marcas 1 y 2, respectivamente. Las posiciones en el ejez en pixeles de las marcas 1 y 2, se representan por z1 yz2.

Marcas negrasidentificadas

Posición delPVTOL

x x xz z z

Fig. 5. Deteccion de marcas negras del PVTOL paracalcular la posicion y la orientacion del vehıculo.

4.2 Computadora con Interfaz de usario

En la computadora se programa la interfaz virtual deusuario, que realiza lo siguiente: i) Procesa la informacionde la posicion y la orientacion del vehıculo para generarla senal de control, ii) Convierte la senal de control de lafuerza de empuje y el par rotacional a una senal PWM yfinalmente, iii) Envıa a la red por medio del puerto USB

la variable con la informacion de la senal de control PWMgenerada.

4.3 Tarjeta NI myRIO

En la tarjeta NI myRIO se programa otra interfaz virtualde usuario, la cual realiza lo siguiente: i) Adquiere de lared por medio del puerto USB las variables con la infor-macion de las senales de control generadas y finalmente,ii) Convierte las variables de PWM a senales de PWM ylas envıa como salidas analogicas de la tarjeta.

5. RESULTADOS EXPERIMENTALES

La presente seccion aborda la prueba experimental delprototipo PVTOL y la plataforma experimental disenaday construida con la finalidad de probar diferentes algo-ritmos de control. El objetivo de control en este artıculoes el seguimiento de una trayectoria de la posicion delvehıculo. Como se observa en (7), el angulo rotacional θ ysus derivadas no dependen de los desplazamientos trasla-cionales z−x. Sin embargo, el desplazamiento traslacionalen el eje x depende del desplazamiento rotacional θ, lo quesignifica que para lograr un desplazamiento en el eje x esnecesario de un desplazamiento rotacional θ. Este hechoconduce a la idea de disenar un esquema de control encascada, como se observa en la Fig. 6.

Control deposición y

altitud

zd

xd

uxEcuaciónde ángulodeseado

Controlrotacional

0d u2

PVTOL

u1

y

Control Traslacional

Fig. 6. Esquema de control en cascada general.

Se disenan dos lazos de control en cascada; el lazo externotiene como objetivo estabilizar y realizar el seguimiento detrayectoria de la posicion en z y en x, y generar los valoresde referencia del angulo rotacional; mientras que el lazointerno toma el valor de referencia deseada generado porel lazo externo para lograr seguir la trayectoria del angulode rotacion θ.

El PVTOL tiene tres salidas y solamente dos entradas, enotras palabras es un sistema sub-actuado. Por esta razon,se utiliza una entrada virtual ux, la cual se llama virtualdebido a que no es ni la fuerza de empuje ni el par, pero seutilizara como entrada de control para generar el angulode alabeo deseado.

Note que la dinamica en el eje x depende de la entradau1, por lo tanto considerando que la entrada virtual uxbrinda la orientacion de u1 en el eje x, es posible calcularun valor deseado de alabeo utilizando la senal de controlux. Finalmente, si se considera que ux se conoce (calculadocon el controlador de la posicion en x), entonces utilizando(9), el valor del angulo de alabeo deseado se puede obtenerde la siguiente forma:

θd = arcsen(ux). (12)

Para probar la plataforma experimental aplicada al pro-totipo PVTOL se programan tres controladores PIDs con

Page 5: Desarrollo Y Construcción De Una Plataforma Experimental ...cnca2017.fime.uanl.mx/MemoriaCNCA17/media/files/0069.pdfrobusto, para lo cual se emplea un enfoque de control optimo

el objetivo del seguimiento de trayectoria de la posicionz − x. Como se menciono anteriormente la dinamica en eleje x generara la referencia rotacional θ, cuyo objetivo delcontrol rotacional sera tambien el seguimiento de trayec-toria.

Los algoritmos de control PIDs utilizados se describen conlas siguientes ecuaciones:

u1(t) = Kz

ez(t) +1

Tiz

t∫0

ez(τ)dτ + Tdzdez(t)

dt

ux(t) = Kx

ex(t) +1

Tix

t∫0

ex(τ)dτ + Tdxdex(t)

dt

u2(t) = Kθ

eθ(t) +1

Tiθ

t∫0

eθ(τ)dτ + Tdθdeθ(t)

dt

,

(13)

donde u1(t), ux(t) y u2(t) son las variables de control parael sistema de posicion en z, en x y en el angulo de alabeo θ,respectivamente. Las senales de error de seguimiento sonez(t), ex(t) y eθ(t) y estan definidas por:

ez(t) = zd(t)− z(t)ex(t) = xd(t)− x(t)

eθ(t) = zθ(t)− θ(t),(14)

donde zd(t), xd(t) y θd(t) son las referencias deseadasen el sistema de posicion en z, en x y en el angulode alabeo θ, respectivamente. Las posiciones en z y enx estan definidas en pixeles mientras que el angulo dealabeo θ en grados. Cada variable de control es la sumade tres terminos: un termino proporcional al error, untermino proporcional a la integral del error y un terminoproporcional a la derivada del error. Los parametros dediseno de los controladores son: la ganancia proporcionalK, la ganancia integral Ti, y la ganancia derivativa Td;cada uno de estos parametros definidos con un subındicede acuerdo al sistema de posicion en z, en x y en elangulo de alabeo θ. Finalmente, el esquema de controlgeneral incluyendo la instrumentacion de la plataformaexperimental y el prototipo PVTOL, se muestran en laFig. 7. Tambien se observan las conexiones al puerto USBcon la camara de video y con la tarjeta NI myRIO, asıcomo los controladores PIDs en cascada.

El tiempo de muestreo del sistema completo de la Fig. 7es de 0.143 s. Las mediciones de la posicion en z y x sonexpresadas en pixeles, de acuerdo al espacio visual de lacamara, mientras que el angulo de rotacion se expresa engrados. Las condiciones iniciales se establecen en z(0)=34.84 pixeles, x(0)= 289.8 pixeles, y θ(0)= −0.34 grados.

La Fig. 8 muestra el seguimiento de las trayectorias en eleje z, en el eje x, y el angulo rotacional de alabeo del pro-totipo PVTOL. Se puede observar un correcto seguimientode las referencias deseadas. Las senales de control gen-eradas con los controladores PIDs cumplen sus objetivosde estabilizacion y de seguimiento de la trayectoria delprototipo PVTOL. El controlador de posicion en el eje xgenera la referencia deseada para el controlador rotacional,como se observa en la Fig. 8(c).

Fig. 7. Esquema de control general con la instrumentacionelectronica.

0 100 200 300 400 500−50

0

50

Tiempo (s)

(gr

ados

)

(c)

0 100 200 300 400 5000

200

400

z (p

ixel

es)

(a)

n

0 100 200 300 400 500100

200

300

400

x (p

ixel

es)

(b)

Actual

Referencia

Fig. 8. (a) Posicion en el eje z, (b) posicion en el eje x, y (c)angulo rotacional de alabeo θ del prototipo PVTOL.

Cabe mencionar que entre el plano inclinado y el pro-totipo PVTOL existe una friccion estatica y una fricciondinamica las cuales no se toman en cuenta en el modelomatematico del prototipo PVTOL. Las caracterısticas derobustez ante incertidumbres en el diseno de los con-troladores PIDs permiten que cumplan sus objetivos decontrol aun sin considerar las fuerzas de friccion presentesen la plataforma experimental. La presencia de la fuerzade friccion estatica se observa al cambiar la referencia de laposicion z−x del vehıculo PVTOL. La friccion estatica esla fuerza que se opone al desplazamiento, es decir, queal cambiar la trayectoria deseada, la accion de controldebe aumentar su valor hasta vencer la fuerza de friccionestatica.

Page 6: Desarrollo Y Construcción De Una Plataforma Experimental ...cnca2017.fime.uanl.mx/MemoriaCNCA17/media/files/0069.pdfrobusto, para lo cual se emplea un enfoque de control optimo

Como se explico en la Seccion 3, las senales de controlaplicadas al prototipo PVTOL son dos senales PWM,las cuales se muestran en la Fig. 9. Se observa que lassenales de PWM se saturan en el ciclo util desde 0 a1, lo que provoca que la posicion z − x y el angulorotacional θ tengan una dinamica lenta para llegar ala referencia deseada en el tiempo en que la accion decontrol se satura; sin embargo, se observa que los con-troladores PIDs cumplen sus objetivos de seguimientode trayectoria de manera correcta, aun con la exis-tencia de la saturacion en los actuadores. Los resulta-dos experimentales se muestran en el siguiente video:https://www.youtube.com/watch?v=H-P4Unwdq80.

0 100 200 300 400 500−0.5

0

0.5

1

1.5

Señ

al P

WM

1(c

iclo

útil

)

0 100 200 300 400 500−0.5

0

0.5

1

1.5

Tiempo (s)

Señ

al P

WM

2(c

iclo

útil

)

Fig. 9. Senales de control aplicadas al prototipo PVTOL:senales PWM (ciclo util).

6. CONCLUSION

La principal contribucion de este artıculo es presentar eldiseno y la implementacion de un prototipo PVTOL, unaplataforma experimental, el diseno y la implementacionpractica de un esquema de control jerarquico para seguirla trayectoria de la posicion z − x y el angulo rotacionalde alabeo θ del vehıculo.

Los resultados experimentales mostraron que las leyes decontrol generadas con los controladores PIDs cumplieronsus objetivos para el seguimiento de las referencias de-seadas, aun ante la presencia de incertidumbres en elmodelado, como son las fuerzas de friccion presentes entreel prototipo PVTOL y la plataforma experimental.

Finalmente, la efectividad de los resultados obtenidos uti-lizando la plataforma experimental para el PVTOL per-mite concluir que con dicha plataforma es posible probardiferentes estrategias de control de una manera eficiente ysencilla. Como trabajo futuro se pretende probar de formaexperimental controladores en cascada y un sistema de de-teccion y aislamiento de fallas en actuadores disenados conel modelo matematico del PVTOL representado en formade qLPV, utilizando el prototipo PVTOL y la plataformaexperimental presentada en este trabajo.

REFERENCIAS

Derafa L., Benallegue A., and Fridman L. (2012). Supertwisting control algorithm for the attitude tracking of

a four rotors UAV. Journal of the Franklin Institute,349(2), 685–699.

Turker T., Gorgun H., and Cansever G. (2012). Stabiliza-tion of uncoupled PVTOL aircraft based on a Lyapunovfunction. Transactions of the Institute of Measurementand Control, 34(5), 578–584.

Venkatesh C., Mehra R., Kazi F., and Singh N. M. (2013).Passivity based controller for underactuated PVTOLsystem. In Electronics, Computing and CommunicationTechnologies (CONECCT), 2013 IEEE InternationalConference on, 1–5. Bangalore, India.

Lara D., Panduro M., Romero G., Alcorta E., and Be-tancourt R. (2014). Robust control design techniquesusing differential evolution algorithms Applied to thePVTOL. Intelligent Automation and Soft Computing,20(3), 451–466.

Ortiz J.P., Minchala L.I., and Reinoso M.J. (2016). Non-linear robust H-Infinity PID controller for the multivari-able system quadrotor. IEEE Latin America Transac-tions, 14(3), 1176–1183.

Lin F., Zhang W., and Brand R.D. (1999). Robust hov-ering control of a PVTOL aircraft. IEEE Transactionson Control Systems Technology, 7(3), 343–351.

Aguilar-Ibanez C., Sossa-Azuela H., and Suarez-CastanonM. S. (2015). PVTOL control: a backstepping approach.In International Conference on Mechatronics, Electron-ics and Automotive Engineering (ICMEAE), 2015 IEEEInternational Conference on, 93–98. Prague, Czech Re-public.

Cardenas R., and Aguilar L. T. (2011). Output feedbacksliding mode control of a PVTOL including actuatorsdynamics. In IEEE International Conference on ControlApplications (CCA), 2011 IEEE International Confer-ence on, 1482–1486, Denver, CO, USA.

Ortiz-Torres G., Lopez-Estrada F. R., Reyes-Reyes J.,Garcıa-Beltran C. D., and Theilliol D. (2016). Anactuator fault detection and isolation method designfor planar vertical take-off and landing unmanned aerialvehicle modelled as a qLPV system. In 4th IFAC Inter-national Conference on Intelligent Control and Automa-tion Sciences (ICONS), 49(5), 272–277. Reims, France.

Meinlschmidt T., Aschemann H., Butt S. S., MeinlschmidtE.T., Aschemann H., and De S.B. (2014). Cascadedbackstepping control of a duocopter including dis-turbance compensation by unscented Kalman filter-ing. In International Conference on Control, Decisionand Information Technologies (CoDIT), 315–320. Metz,France.

Palomino A., Castillo P., Fantoni I., and Lozano R. (2005).Control strategy using vision for the stabilization of anexperimental PVTOL aircraft setup. IEEE Transac-tions on Control Systems Technology, 13(5), 487–850.

Kong F., Chen S., and Wang X. (2015) Developmentof a practical experimental platform for control systemof the quadrotor. In Control and Decision Conference(CCDC), 27th Chinese, 2503–2508. Qingdao, China.

Schedlinski C., and Link M. (2001) A survey of currentinertia parameter identification methods. MechanicalSystems and Signal Processing, 15(1), 189–211.

Choi Y. C., and Ahn H. S. (2015). Nonlinear controlof quadrotor for point tracking: Actual implementationand experimental tests. IEEE/ASME Transactions onMechatronics, 20(3), 1179–1192.