Академический Документы
Профессиональный Документы
Культура Документы
PERIODO ACADEMICO:
OCTUBRE 2017– FEBRERO 2018
Trabajo N°4
Contenido
MODELAMIENTO DE POSICION DE UN CUADRICOPTERO-DRONE .................................. 3
INTRODUCCION:............................................................................................................ 3
SISTEMA LINEAL MULTIVARIABLES ............................................................................... 3
No linealidades.............................................................................................................. 4
Sistemas dinámicos no lineales y controladores no lineales ........................................ 5
Mecánica de vuelo de cuadricópteros .......................................................................... 5
Ángulos de Euler ........................................................................................................... 7
SISTEMA DE REFERENCIA .............................................................................................. 8
MOVIMIENTO DE LO ROTORES. .................................................................................. 10
Diagrama de bloques del funcionamiento del dron. .................................................. 11
ESTRATEGIA DE MODELO ........................................................................................... 12
MODELAMIENTO DE MOVIMIENTO EN EL EJE X. ....................................................... 12
Ecuación de movimiento para X ................................................................................. 13
MODELAMIENTO DE MOVIMIENTO EN EL EJE Y. ....................................................... 14
Ecuación de movimiento para Y ................................................................................. 15
MODELAMIENTO DE MOVIMIENTO EN EL EJE Z. ....................................................... 15
Ecuación de movimiento para Z ................................................................................. 16
Ecuación de movimiento para 𝜽 ................................................................................. 16
Ecuación de movimiento para 𝝓 ................................................................................ 19
Ecuación de movimiento para 𝝍 ................................................................................ 19
Bibliografía ...................................................................................................................... 20
MODELAMIENTO DE POSICION DE UN CUADRICOPTERO-DRONE
INTRODUCCION:
En este trabajo se analiza la validación experimental de un control de posición de un
cuadricóptero, consultados por medio de paper´s y tesis que serán citadas
respectivamente, se presenta un modelo matemático que describe la dinámica del
desplazamiento en vuelo desde un punto inicial hacia un punto final deseado,
considerando los aspectos constructivos y la dinámica de los actuadores. Identificando
los diferentes parámetros del cuadricóptero.
𝑋̇ = 𝐴𝑋 + 𝐵𝑈 (1.1)
Ecuación de evolución de los estados
𝑌 = 𝐶𝑋 + 𝐷𝑈 (1.2)
Ecuación de salida
Las ecuaciones Ecuación 1.1 y Ecuación 1.2, representan el modelo matemático de una
planta. Sin embargo, es importante recalcar que dichas ecuaciones pueden llegar a
tener ciertas modificaciones, si se toman en cuenta algunas perturbaciones o no
linealidades. De hecho, el modelo más preciso de un cuadricóptero no es lineal, sino un
modelo no lineal.
Para poder controlar un sistema lineal multivariable, se requiere modelar
matemáticamente al sistema sin utilizar no linealidades y después implementar un
controlador lineal.
No linealidades
El conjunto de técnicas de análisis y diseño para sistemas de control no lineales, se llama
control no lineal. Este aplica para cualquier sistema con al menos un componente no
lineal, lo cual significa que no cumple con la propiedad de homogeneidad o
superposición. Estos sistemas pueden ser univariables o multivariables, así como
contener linealidades diferenciables o no diferenciables (no linealidades fuertes). Los
sistemas multivariables no lineales tienen el principio de los sistemas lineales
multivariables pero sí involucran no linealidades. Las no linealidades más comunes, son
las siguientes:
Saturación
Zona muerta
Todo-nada
Histéresis
Huelgo
Fricciones
Resorte no lineal
Compresibilidad de fluidos
Producto de estados, raíces de estados, polinomios que involucran estados,
funciones trigonométricas de estados, entre otras. (No linealidades
diferenciables)
Sistemas dinámicos no lineales y controladores no lineales
De forma general, un sistema dinámico no lineal diferenciable se representa con las
ecuaciones Ecuación 1.3 y Ecuación 1.4.
En el caso de un cuadricóptero, son 4 hélices las que deben superar al peso y a la fuerza
ejercida por la presión superior. Justamente por ello es que los cuadricópteros requieren
rotores mucho más pequeños, así como hélices de menores dimensiones.
Como siguiente punto, avanzar hacia delante o frenar en un helicóptero es ocasionado
por el cambio de inclinación de las aspas de su hélice, logrando así que el helicóptero se
incline y se consiga una fuerza de sustentación inclinada (ver Figura 3). Dicha fuerza
tiene dos componentes, una vertical que mantiene al helicóptero en vuelo y otra
horizontal, la cual impulsa al helicóptero hacia adelante o hacia atrás, en el caso del
frenado.
El cuadricóptero puede volar hacia cualquier lado sin problemáticas. Dado que puede
ser totalmente simétrico con respecto a su centro, no importa hacia qué lado vuele,
siempre podrá hacerlo sin complicaciones.
Ángulos de Euler
Uno de los grandes matemáticos y físicos que han pisado la tierra fue Leonhard Euler
(1707-1783). Dentro de sus aportaciones a la ciencia, se encontraron numerosos
estudios de mecánica celeste. Dentro de este tema, estableció un teorema que
establece que dos sistemas coordenados ortonormales pueden estar relacionados por
una secuencia de máximo tres rotaciones sobre ejes coordenados, donde dos rotaciones
sucesivas no pueden realizarse sobre el mismo eje.
El ángulo de rotación alrededor de un eje coordenado se llama ángulo de Euler. Una
secuencia de dichas rotaciones se llama secuencia de ángulos de Euler. Dichas
secuencias contienen a dos rotaciones sobre el mismo eje dentro de las tres rotaciones
a realizar. Por consiguiente, sabiendo que no se puede rotar un mismo eje de forma
consecutiva, las posibles secuencias son: XYX, XZX, YXY, YZY, ZXZ y ZYZ. Donde cada
rotación está dada por las siguientes ecuaciones:
La ecuación que describe la rotación 𝑍𝑋𝑍 está dada por, 𝑅𝑍𝑋𝑍 = 𝑅𝑍 𝑅𝑋 𝑅𝑍 .
Teniendo identificada una matriz de rotación, se pueden mapear las coordenadas de un
cuerpo rígido desde un marco de referencia a otro. En un marco de referencia en el cual
un giro en sentido opuesto a las manecillas del reloj es positivo y con el eje 𝑍 siendo
positivo hacia arriba, las rotaciones se realizan pre-multiplicando un vector columna
(𝑣 = [𝑉𝑋 𝑉𝑌 𝑉𝑍 ]𝑇 ) por una matriz de rotación. Un ejemplo es el siguiente:
SISTEMA DE REFERENCIA
Para modelar nuestra aeronave a través de las ecuaciones de la cinemática y la dinámica,
necesitamos definir varios sistemas de ejes. La configuración más extendida en este
momento está representada en la figura 1, donde podemos observar dos sistemas de
referencia. El primero de ellos, {x, y, z}, se denomina sistema inercial y es un sistema fijo
en el espacio. Es el sistema donde se aplican las ecuaciones dinámicas de translación. El
segundo, {i, j, k}, es solidario al cuerpo y a él se refieren los giros del cuadricóptero. Es
importante mencionar que los ejes i y j están alineados con los brazos de la nave, como
se muestra en la figura 1 (Sevilla Fernández, 2014)
Figura 5 Sistemas de Ejes
A fin de crear un modelo consistente, todas las magnitudes deben estar referidas a la
misma base y por tanto definiremos una matriz de cambio de base que transformará
elementos del sistema inercial al sistema móvil y viceversa. A fin de simplificar la
notación de dicha matriz se han representado las funciones seno y coseno con la letra S
y C respectivamente.
(1.9)
Ecuación 1.9: Matriz de ejes coordenados,R
Para describir los giros que realizará nuestro dispositivo utilizaremos los ángulos de
Euler. Así pues, la guiñada (φ) es la rotación intrínseca alrededor del eje vertical
perpendicular al avión, el cabeceo (θ) es una inclinación del morro de la nave, o rotación
respecto al eje ala-ala, el alabeo(ψ) rotación respecto de un eje morro-cola. Para más
claridad se ha incluido la figura 2, que representa los tres giros de la aeronave
anteriormente descritos.
Figura 6 Giros
La figura (7) muestra el diagrama del cuerpo libre de nuestro cuadricóptero con las
fuerzas y momentos analizados en esta sección. Estos serán los que utilizaremos tanto
para el modelado como para su posterior control en las siguientes secciones.
MOVIMIENTO DE LO ROTORES.
Cada par de rotores opuestos giran en el mismo sentido (Figura 8), es así que los rotores
left y right giran en sentido horario, mientras que los rotores front y rear giran en sentido
anti horario, al realizar esta acción de movimiento de los rotores el cuadricóptero estará
en una posición de levitación. (HERNÁNDEZ, 2016)
Los cuadricópteros son sistemas multivariables o MIMO, y no lineales en los que una
entrada afecta a varias salidas y recíprocamente una salida es afectada por varias
entradas, son más laboriosas de modelar, es por eso que la estrategia de modelado se lo
hace como dos sistemas SISO lineal de simple entrada y simple salida. (Coloma Vallejo &
Oyos Piarpuesan, 2015)
𝑋(𝑆) 15.14𝑆+3.332
= 3.629𝑆4 +12.64𝑆3 +7.605 𝑆2 +𝑠 (1.10)
𝜃(𝑆)
(1.11)
Ecuación de energía cinética para el cuadricóptero de estudio de esta tesis
𝑌(𝑆) 2.256𝑆+1.712
= (1.15)
𝜃(𝑆) 1.103𝑆 3 +2.236 𝑆 2 +𝑠
g: Aceleración de la gravedad.
Bz: Constante de arrastre del aire para Z.
Por lo tanto, con esto se obtiene la ecuación de movimiento completa para Z, la cual se
encuentra representada en la Ecuación 1.18
𝐼𝐿 𝜃¨ = 𝐹𝜃 (1.19)
Ecuación de movimiento reducida para 𝜃
Sin embargo, hay que recalcar que la Ecuación 1.19 tiene una fuerza igualada a un
momento de inercia por aceleración angular. Esto no es correcto y por consiguiente, la
fuerza que afecta a la ecuación de q, no es propiamente una fuerza sino más bien, un
torque (𝜏𝜃 ).
Para obtener el torque de esta ecuación de movimiento, se siguió analizando al sistema
desde el marco inercial; tal como se ha hecho en las anteriores ecuaciones de
movimiento. Para ello se requirió tomar en cuenta el diagrama que se muestra en la
Figura 16, con ejes X y Y en el marco inercial.
Figura 16 Diagrama del cuadricóptero para análisis de torques.
𝜋
𝜏1, ∅ = −𝑙𝐹1 cos( 4 − ψ) (1.21)
𝜋
𝜏4, 𝜃 = −𝑙𝐹4 cos( 4 − ψ) (1.26)
Torque con respecto a q generado por la fuerza de sustentación del rotor 4.
𝜋
𝜏4, ∅ = −𝑙𝐹4 cos( 4 + ψ) (1.27)
Analizando las ecuaciones de torques y la Figura 17, en la cual ψ= p=4, se puede deducir
matemáticamente y visualmente que los rotores 1 y 3 tendrán un 𝜏𝜃 = 0. Sin embargo,
el rotor 2 aportará la totalidad de su torque hacia + 𝜃 y el rotor 4 lo aportará hacia −𝜃.
𝜋
Figura 17 Diagrama del cuadricóptero para análisis de torques con 𝜓 = .
2
De igual forma, con la intención de dejar las ecuaciones de torques en términos de las
entradas del sistema, se considera la igualdad 𝐹𝑖 = 𝑘𝑤^2 𝑖 .
Cabe mencionar que además de las torques generadas por las fuerzas de sustentación
de cada rotor, hay torques externos que genera la fricción del aire por razones de
arrastre. Dichos torques de arrastre van en sentido opuesto a los torques que generan
las fuerzas de sustentación. Asimismo, tal como sucede en la traslación, el arrastre es
proporcional a la velocidad del cuerpo. En este caso, proporcional a la velocidad angular.
Por ende, la ecuación de movimiento completa para q, queda expresada por la Ecuación
1.28.
𝜋 𝜋
𝐼𝑙 𝜃̈ = −𝐵𝜃 𝜃̇ + 𝐾𝑙 [−(𝜔12 − 𝜔32 )cos( 4 + 𝜓) + (𝜔22 − 𝜔42 )cos( 4 − 𝜓)] (1.28)
Ecuación de movimiento completa para 𝜃
Donde,
−𝐵𝜓 : Constante de arrastre de aire para 𝜓
Conclusiones.
El modelamiento matemático de los sistemas de control están basados de un
modelo ya establecido y estudiado la cual la ecuación de ángulo de Euler.
Muchos de los modelos de sistemas de control se realiza basándose por el
método de sintonización de tanteo, adquiriendo datos de entrada y salida hasta
lograr una buena estabilidad del cuadricoptero.
Para un modelamiento eficiente se debe de tomar en cuenta todos los aspectos
del ambiente, como por ejemplo el viento el clima la temperatura, ya que estos
elementos de la naturaleza afectan al sistema como perturbaciones, y el sistema
de control debe contrarrestar estos fenómenos.
Recomendaciones.
para el desarrollo de n modelamiento eficiente se debe de tener conocimientos solidos
de matemáticas y de sistemas de control, ya que de lo contrario solo será una pérdida
de tiempo tratando de comprender algo que contiene muchos años de estudio
Bibliografía
Bucio Gallardo, E. M. (2015). Modelado matemático y control inteligente de un
cuadricóptero. México.
Coloma Vallejo, G. F., & Oyos Piarpuesan, K. C. (2015). Diseño e implemtación de un
sistema de control de posición para el cuadricóptero AR.DRONE 2.0 de Parbot.
Sangolquí: ESPE.
FRANKLIN, C. V.-G. (2015). DISEÑO E IMPLEMENTACIÓN DE UN SISTEMA DE CONTROL
DE POSICIÓN PARA EL CUADRICÓPTERO AR.DRONE. 56-93.
HERNÁNDEZ, J. M. (2016). CONTROL REMOTO DE UN DRONE. 23.
Sevilla Fernández, L. (2014). Modelado y control de un cuadricóptero. Madrid: Comillas,
Madrid.