jueves, 27 de diciembre de 2012

ESTUDIO SOBRE EL CONTROL DEL MOVIMIENTO DE UN AVION CAZA F-35

Para finalizar este curso de Regulación Automática será realizado mediante los programas Matlab y sobretodo de Anylogic un sistema de control del movimiento de un avión caza modelo F-35.

Para comenzar introduciré unos conceptos sobre la realización de este sistema y sobre todo de las variable a tener en cuenta para la realización de este. Finalmente se introducirán paso a paso todo lo realizado para el diseño del controlador.



MODELO AVION CAZA F-35

NOTACIÓN

El vector velocidad "v" queda definido por:

  • U - Velocidad longitudinal (Forward)
  • V - Velocidad transversal (Transverse)
  • W - Velocidad vertical
  • P - Velocidad angular de giro longitudinal (ROLL)
  • Q - Velocidad angular de cabeceo (PITCH)
  • R - Velocidad angular de giro lateral (YAW)

Los ejes y las variables de fijación serán:
  • Xe - Referencia terrestre de eje X
  • Ye - Referencia terrestre del eje Y
  • Ze, h - Referencia terrestre del eje Z, altitud
  • Phi - Ángulo de giro longitudinal (ROLL)
  • Theta - Ángulo de cabeceo (PITCH)
  • Psi - Ángulo de giro lateral (YAW)
Los momentos y las fuerzas serán definidos por:
  • X - Fuerza longitudinal
  • Y - Fuerza transversal
  • Z - Fuerza vertical
  • L - Momento de giro longitudinal
  • M - Momento de cabeceo
  • N - Momento de giro lateral
En la imagen siguiente se representan las variables anteriormente definidas:


Los sistemas de fijación coordinados para el avión serán tres:
  • Ejes del cuerpo del avión
  • Ejes de estabilidad
  • Ejes del viento
Este sistema de ejes queda representado en la imagen:


Los angulo que aparecen en la imagen que define los ejes son:
  • Ángulo de ataque "alpha"       tan(alpha)=W/U
  • Ángulo de giro lateral "beta"    sin(beta)=V/VT
donde:

La velocidad total del movimiento queda definida con la velocidad del avión y la velocidad del viento.

Los efectos aerodinámicos son clasificados de acuerdo al "Match number":

M=VT / a

siendo:    
    a = 340m/s = 1224km/h    (velocidad del sonido en el aires a una Tª de 20ºC en la superficie del océano)

PARTES DEL AVIÓN RELACIONADAS CON EL MOVIMIENTO
También se definen las partes del avión que son las causantes de que este pueda realizar los movimientos. Estas partes serán controladas para poder controlar a su vez la dirección y la velocidad del avión.
En la figura podemos ver nombradas las principales partes del control del movimiento del avión:

  • δT  THRUST  - Propulsores, fuerza de los motores.
  • δE  ELEVATOR  - Superficies de control en la parte trasera de la aeronave utilizadas para el pitch control de altitud.
  • δAILERON  -  Aletas de control unidas al borde de salida del ala utilizadas para el control del roll / bank.
  • δ FLAPS  -  Superficies con aletas móviles en el borde de fuga de las alas utilizadas para el frenado y para bank-to-turn.
  • δR  RUDDER  -  Superficie de control vertical en la parte trasera del avión utilizada para torcer.



ROTACIÓN
La relación entre los vectores expresados anteriormente en los diferentes sistemas de coordenadas puede ser derivado usando matrices de rotación.

El sistema de coordenadas fijado en el avion es el primero en rotar un ángulo negativo "- beta" sobre el eje Z.

El nuevo sistema de coordenadas está para un ángulo de giro de ataque "+alpha" sobre el nuevo eje Y resultando puntos en el eje X en la dirección de la velocidad total VT.

La primera rotación define los ejes del viento mientras la segunda rotación define los ejes de estabilidad.
Matematicamente expresado es:

Quedando la matriz de rotación:

Despues de la obtención de esta matriz podremos relacionar las velocidades del cuerpo del avión junto con la velocidad del viento para formar la matriz velocidad total:

Que queda finalmente definido en tres ecuaciónes:


Finalmente necesitaremos obtener los vectores de estado para poder obtener los valores de los modelos longitudinal y lateral.

Los vectores de estado son:
Ademas definiremos unos valores determinados como punto de equilibrio del avión. Estos valores son:
  • Velocidad   V= 890 ft/s = 980 km/h
  • Altitud         h = 35000 ft
  • Masa            m = 184000 lbs
  • Match-number    M = 0.8




IMPLEMENTACION DE LOS VECTORES DE ESTADO EN MATLAB

Después de haber definido todas las variables y notaciones del modelo del avión utilizaremos Matlab para obtener los valores de las matrices y posteriormente  el producto de estas en función a la variable que necesitemos ya sea en el modelo longitudinal o lateral.
También mediante Matlab buscaremos obtener los polos mas adecuados a nuestro modelo mediante la utilización de estas matrices y los polos que nosotros deseemos, y que luego hagan del avión lo mas estable posible.

MODELO LONGITUDINAL
Las matrices correspondientes a este modelo son:


MODELO LATERAL
Las matrices correspondientes a este modelo son:

La implementación de Matlab para la obtención de los polos adecuados es esta:



SIMULACION DEL MODELO DEL AVIÓN CAZA F-35 EN ANYLOGIC
 En este apartado indicaré los diversos pasos a realizar para realizar el modelo del caza F-35 mediante el programa Anylogic.

IMPLEMENTACIÓN DE LOS MODELOS
Lo primero que debemos realizar es la estructura correspondiente al modelo lateral y al modelo longitudinal. Estas contaran con un numero de "flows" y "stock" correspondiente al numero de variables que tengamos en el modelo. Para el modelo lateral al igual que para el longitudinal tenemos 4 variables.
Después de haber realizado el diseño de las variables debemos enlazarlas en función de los las variables que afecten a cada una de las que estamos definiendo.
Para saber cuales son estas variables, debemos realizar el producto de matrices para el cada variable a estudiar.
El producto de matrices a introducir en cada modelo será:

MODELO LONGITUDINAL

Dalpha= -0.0164*u - 0.7771*alpha + 0.9945*q + 0.0015*theta - 0.0634*deltaE - 0.0005*deltaT

Dq= -0.0417*u -3.6595*alpha -0.9544*q + 0*theta -3.6942*deltaE + 0.0243*deltaT

Du= -0.0168*u + 0.1121*alpha + 0.0003*q -0.5608*theta -0.0243*deltaE + 0.0519*deltaT

Dtheta= 0*u + 0*alpha + 1.0000*q + 0*theta + 0*deltaE + 0*deltaT

La variables deltaE y deltaT son las variables ELEVATOR Y THRUST que hemos descrito anteriormente y en las cuales modificaremos manualmente el valor para poder controlar el 
movimiento longitudinal del avión.
La estructura del modelo longitudinal es:



MODELO LATERAL

Dbeta= -0.1245*beta + 0.0350*p + 0.0414*phi - 0.9962*r - 0.0049*deltaA + 0.0237*deltaR

Dp= -15.2138*beta - 2.0587*p + 0.0032*phi + 0.6458*r - 4.0379*deltaA + 0.9613*deltaR

Dphi= 0*beta + 1.0000*p + 0*phi + 0.0357*r + 0*deltaA + 0*deltaR

Dr=  1.6447*beta -0.0447*p -0.0022*phi -0.1416*r - 0.0568*deltaA - 1.2168*deltaR

La variables deltaA y deltaR son las variables AILERON y RUDDER que hemos descrito anteriormente y en las cuales modificaremos manualmente el valor para poder controlar el 
movimiento lateral del avión.
La estructura del modelo lateral es:


CONTROL POR REALIMENTACIÓN

Después de haber definido los dos modelos debemos controlarlos de alguna manera, de tal forma que se obtenga una mejora en la estabilidad de los modelos.

En este curso hemos aprendido a realizar dos formas de control: El modelo PID y el control por realimentación del estado.
Para nuestro modelo de avión el modelo PID se nos queda escaso debido a que necesitamos una mayor rapidez en la estabilidad de este por ello utilizamos el modelo por realimentación de estaco.
Las ventajas de este modelo son:
  • Que se usa toda la información del sistema para calcular la entrada manipulada.
  • Que no se usan derivaciones de difícil realización fisica, sino elementos proporcionales.
El esquema de este modelo es:


Que lo podemos simplificar de la manera:




 Como ya he dicho, para esta simulación he utilizado un control por realimentación de las variables de entrada.
La nuevas variables ha introducir en en cada modelo son cuatro:

MODELO LONGITUDINAL:
 Las cuatro nuevas variables de este modelo son: e , t , c1 , c2

"e" y "t" son las que ahora se modifican manualmente por el controlador externo del avión (piloto).
"c1" y "c2" son las variable de realimentación que junto "e" para deltaE y "t" para deltaT alimentan a las dos anteriores variables.
Las variables de realimentación están compuestas por las ecuaciones:

c1 = 0.1279*alpha+0.0215*q+0.0143*u-0.0927*theta

c2 = 0.0799*alpha-3.0079*q+2.1302*u-10.1286*theta

La estructura completa del modelo longitudinal será:

MODELO LATERAL
Las cuatro nuevas variables de este modelo son: A , R , c3 , c4

"A" y "R" son las que ahora se modifican manualmente por el controlador externo del avión (piloto).
"c3" y "c4" son las variable de realimentación que junto "A" para deltaA y "R" para deltaR alimentan a las dos anteriores variables.
Las variables de realimentación están compuestas por las ecuaciones:

c3 = 4.0601*beta+0.2042*p-0.5916*phi-0.7307*r

c4 = -0.6212*beta+0.8291*p+0.9734*phi-1.3896*r

La estructura completa del modelo longitudinal será:






MODELO PARA EL MOVIMIENTO DEL AVION EN EL ESPACIO
Para poder realizar el movimiento en las direcciones de los ejes X,Y,Z  en función del movimiento controlado por las variables de rotación y cabeceo, debemos realizar un nuevo modelo que contenga las variables que afectan a este movimiento. 
Este modelo consta de 3 flows que correspondera cada uno al movimiento en un eje.
Para poder conseguir el movimiento debemos tener presente que mediante los modelos anteriores podemos obtener las velocidades en cada respectivo eje pero que para obtener la posición del avión a lo largo del tiempo deberemos derivar este resultado para obtener los valores buscados.

Las variables correspondientes a cada flow son: vx, vy y vz :
Pero estos valores dependen a su vez de "theta" y de "beta", ademas de la variable a modificar manualmente que es "v".
La ecuaciones para cada respectivo flow serán:

Dvx = v*cos(theta)

Dvy = v*cos(theta)*cos(beta)

Dvz = v*cos(theta)*sin(beta)

La estructura de este modelo quedará:




DISEÑO DE LA PRESENTACIÓN DEL MODELO
Para representar el modelo en el programa Anylogic, la primera norma imprescindible es que lo único que se plasmara en la representación del modelo es lo que este introducido en el cuarto cuadrante de la pantalla de la realización del modelo. Cabe nombrar que también aparecerá lo que este enlazado mediante cámara a una ventana del cuadrante que se visualiza.

El primer paso es introducir una ventana para la representación del avión. Esta ventana aparece en los menús como 3D Window.


Seguidamente introduciremos una figura en 3D, en mi caso la del caza F-35. Para ello la buscaremos en el menú 3d OBJECTS o tambien puedes obtenerlo de otro modelo que haya sido realizado anteriormente. Después de haberlo seleccionado lo dejaremos colocado en el tercer cuadrante.


Después de haber situado el objeto en el tercer cuadrante deberemos introducir una cámara enlazada a la 3D Window antes introducida para que aparezca el avión en esta. La cámara se encuentra también en el menú 3D. Para la colocación de la cámara deberemos jugar bastante para que el avión aparezca en la ventana con un tamaño y posición adecuados. Para ello modificaremos la altura de la cámara y el angulo de disparo de la imagen que tiene esta. Hay que fijarse también en que si la cámara que estamos utilizando en la ventana es la que esta enfocando al avión porque hay casos que no se predetermina automáticamente. 



Para introducir las variables que queremos modificar manualmente hay que introducir en el cuadrante a visualizar uns dispositivos llamados "sliders" que son controladores que dejan modificar con el modelo en funcionamiento los valores que deseemos cambiar. Con lo cual necesitaremos introducir 5 sliders para los 5 variables que queremos controlar.



Finalmente en cuanto al diseño, deberemos realizar un grupo ya que el programa limita el movimiento de un objeto al plano XY y nosotros necesitamos los tres ejes para realizar la traslación del avión en el espacio. Con lo cual explicare como se realiza el grupo para el avión.
Lo primero que debemos hacer es ir al menú 3D e introducir un "group" cerca del avión.

Después de haber introducido el grupo buscaremos (aproximadamente ) el centro de masas del avión en el que situaremos lo situaremos. Para esta tarea deberemos mirar el tamaño que tendrá el avión de alto para colocar el grupo a una cota Z en función de la altura a la que se encuentre el centro de masas. Para ver la altura deberemos visualizar el avión en otra perspectiva. 

Pero luego habrá que volverlo a situar en la misma a la que estaba inicialmente. Para mi avión la Z me a salido de valor 8. Todo esto sirve para que la rotación del avión sea coherente con el movimiento.
Despues de haber realizado todo esto deberemos unir el avion con el grupo; para ello deberemos pinchar con el boton derecho en el avión y elegir la opción "grouping" y luego "add to existing group"





Después de esto ya tenemos finalizado el diseño del modelo que vamos a representar. Si pondríamos el modelo a funcionar nos e debería aparecer el modelo estático.


IMPLEMENTACIÓN  DE LAS VARIABLES EN EL DISEÑO
El ultimo paso para la realización de este modelo es introducir las variables a visualizar y controlar de los modelos creados anteriormente en el diseño que hemos creado del avión.

Lo primero que vamos a enlazar va a ser los "slider" con sus correspondientes valores. A cada slider le introduciremos la variable que queremos asignarle para luego poderla modificar en el funcionamiento del modelo. Las variables se enlazan el el menú del slider "General" y "Link to" donde introduciremos el nombre de la variable a controlar. También deberemos asignar el rango en el cual queremos que estén los valores que queremos que pueda abarcar la variable. Para el caso que represento en la imagen el slider esta enlazado con "e" y el rango de valores esta entre -2 y 2.


Después de haber realizado esto con todos los slider, pasaremos a implementa el movimiento del avion con las variables correspondientes. Ahora deberemos ir al menú del avión y en el apartado de "dynamic" deberemos implementar la rotación con los ángulos de giro alpha y beta y el movimiento de traslación con las variables X, Y, Z . Con todo ello tendremos que conseguir que en función de los valores que demos a las variables de los slider tengamos una inclinación determinada del avión ademas de que si aumentamos la velocidad el avión se trasladara en el espacio.



Finalmente introduzco algunas imágenes de la visualización del modelo en las que se puede observar el avión con distintos ángulos de giro.









miércoles, 5 de diciembre de 2012

PROBLEMA DE LUGAR DE LAS RAICES 2

Este segundo problema relacionado con el lugar de las raíces se plantea de modo diferente al anterior ya que en este debemos buscar un lugar de las raíces determinado en el que consigamos que pase por Sd.

El problema pides que obtengamos los valores de Zc, Pc y k dadas las especificaciones de Mp=0,2 (estabilidad) , ts=4s (rapidez) y E=0,02 (precision o error)








martes, 27 de noviembre de 2012

LUGAR DE LAS RAICES


Para explicar el concepto del lugar de las raíces introduciré una descripción simplificada para comprender que es y cual es su función y después introduciré un ejercicio realizado para la obtención de las raíces de un polinomio característico entre otros apartados.

El lugar de las raíces sirve para estudiar como influye la ganancia en bucle abierto en el comportamiento dinámico de un sistema realimentado.


Es una herramienta para el análisis dinámico de sistemas realimentados:
Estabilidad
Rapidez del sistema en cadena cerrada al variar k 

Oscilaciones 


El lugar de las raíces se define como el lugar geométrico de los polos de la función de transferencia en lazo cerrado, cuando uno o varios parámetros de la función de transferencia varían entre -∞ e ∞. 

Para poder realizar el metodo del lugar de las raíces debemos de cumplir unas reglas para la correcta representación e interpretación. Las reglas a seguir son:

REGLA 1

Una rama del lugar de las raíces es el lugar geométrico de una raíz cuando K varía entre cero e infinito.
El número de ramas del lugar de las raíces es igual al número de polos de la función de transferencia en lazo abierto, o lo que es lo mismo, el orden de la ecuación característica del sistema en lazo cerrado.

REGLA 2 
Cada rama comienza en un polo de la función de transferencia en lazo abierto y finaliza en un cero de la función de transferencia en lazo abierto.

REGLA 3
Un punto en el eje real pertenece al lugar de las raíces (para K>0) si la suma de polos y ceros situados a la derecha del mismo es impar.

REGLA 4
El gráfico del lugar de las raíces es siempre simétrico respecto del eje real.

REGLA 5
Las ramas del lugar de las raíces que terminan en θ =180o(2k+1) el infinito son asintóticas a rectas cuyos ángulos n−m con respecto al eje real vienen dados por un
ángulo θ.

REGLA 6
Las asíntotas cortan al eje real en un punto situado a una distancia σ0 del origen (centroide). 

REGLA 7
Los ángulos de salida de los polos y de llegada a los ceros son los que forman las tangentes a las correspondientes ramas del lugar de las raíces en el polo o cero considerado.

REGLA 8
Los puntos de ruptura son aquellos puntos donde el lugar de las raíces, al aumentar K, pasan del eje real al plano complejo (puntos de dispersión) o pasan del plano complejo al eje real (puntos de confluencia).

Los puntos de ruptura se corresponden con máximos (puntos de dispersión) o mínimos (puntos de confluencia) de la función K respecto de s.

REGLA 9
Los puntos de corte del lugar de las raíces con el eje imaginario se corresponden con los polos que hacen que el sistema en lazo cerrado sea críticamente estable.

Dos métodos:
1. Aplicar Routh-Hurwitz
2. Sustituir s=jω y resolver 


EJERCICIO DE LUGAR DE LAS RAICES

En el ejercicio que introduzco a continuación se ha realizado hasta el apartado 3 ya que los dos siguientes han sido realizados por MATLAB.






martes, 6 de noviembre de 2012

RESPUESTA EN FRECUENCIA

El análisis de respuesta de frecuencia es la técnica donde una señal de prueba senoidal es usada para medir puntos sobre la respuesta de frecuencia de una función de transferencia.

La gran ventaja del análisis de respuesta en frecuencia se basa en su frecuencia selectiva natural. Solo un componente del respecto de frecuencia es extraído y la correspondiente respuesta en esa frecuencia puede ser desarrollada con gran precisión. Esto tiene significativas ventajas donde el sistema bajo consideración tiene resonantes características.

Para analizar la respuesta en frecuencia utilizaremos sistemas distintos de simulación que son Anylogic y Matlab.

SIMULACIÓN CON ANYLOGIC

En este pantallazo se puede observar el diagrama en función del tiempo de la posición del ejercicio del carrito anteriormente realizado. Podemos observar como gracias al controlador PID se estabiliza la posición del carrito a lo largo de un tiempo determinado.




SIMULACIÓN MEDIANTE MATLAB. DIAGRAMAS DE BODE Y NYQUIST

Para realizar esta simulación antes introduciré unos conceptos básicos sobre la representación mediante los diagramas de respuesta en el tiempo, de Bode y de Nyquist.

DIAGRAMA DE RESPUESTA EN EL TIEMPO

Este diagrama representa la misma gráfica que hemos podido obtener mediante la simulación con Anylogic.




DIAGRAMA DE BODE



El diagrama de Bode es un tipo de representación gráfica de funciones complejas (en nuestro caso, funciones de transferencia) dependientes de una variable real (la frecuencia angular o lineal).


page1image5608
page1image5880
page1image6152En un diagrama de Bode se representa por un lado el módulo de la
función ( H(ω)) y por otro la fase(φ(ω)). La figura 1 muestra como ejemplo el diagrama de Bode de un filtro paso baja de primer orden, cuya función de transferencia es:page1image6424

A la hora de elaborar un diagrama de Bode hay que prestar atención al hecho de que la escala correspondiente al eje de frecuencias es logarítmica. ¿Qué es una escala logarítmica y por qué usarla? Las escalas logarítmicas se emplean cuando se quieren representar datos que varían entre sí varios órdenes de magnitud (como en el ejemplo de la figura 1, en el que la frecuencia varía entre 1 rad/s y 106 rad/s). Si hubiésemos empleado una escala lineal, sólo apreciaríamos bien los datos correspondientes a las frecuencias mayores mientras que, por ejemplo, todos los puntos por debajo de 104 rad/s se
20 log |H|
φ (rad)
representarían en la centésima parte del eje de abscisas. Esto se muestra, como ejemplo, en la Figura 2. 



DIAGRAMA DE BODE DEL MODELO DEL CARRITO EN MATLAB





DIAGRAMA DE NYQUIST


La definición de estabilidad adoptada y los criterios de equivalencia nos permiten decidir si
una transferencia dada corresponde a un sistema estable o inestable.
Basta ubicar la posición de los polos de esa transferencia para saberlo.
Este es un criterio de estabilidad absoluto: es decir, nos informa si un sistema es estable o
no.
Muchas veces no alcanza con esa información: es necesario saber si un sistema es estable,
cuán cerca está de dejar de serlo.
Con ese propósito, y para tener una visión más completa del problema se han desarrollado
otros criterios, de los cuales en el presente módulo analizaremos el criterio de Nyquist.

A partir de herramientas de variable compleja, hemos estudiado el criterio de Nyquist, que
es simplemente una técnica que permite detectar mediante la construcción de un diagrama,
la presencia de polos en el semiplano derecho, responsables de la inestabilidad de una
transferencia.
Hemos aplicado ese criterio a diversos casos de complejidad creciente, confirmando
algunos resultados conocidos (caso del integrador), y encontrando otros nuevos.
Definimos parámetros que nos informan sobre la estabilidad relativa (márgenes de ganancia
y fase).
Dimos una visión superficial de los diagramas de Flujo de Señales, que permiten visualizar
con claridad los lazos de realimentación, y finalmente describimos métodos clásicos de
estabilización de sistemas inestables. 


DIAGRAMA DE NYQUIST DEL MODELO DEL CARRITO EN MATLAB