6.Control de Posicion Por Espacio de Estados
-
Upload
armando-vazquez-ramirez -
Category
Documents
-
view
227 -
download
0
Transcript of 6.Control de Posicion Por Espacio de Estados
-
8/4/2019 6.Control de Posicion Por Espacio de Estados
1/10
1
Laboratorio deControl Automatico
Instituto Tecnolgico y de Estudios
Superiores de Monterrey
Campus Tampico
Profesor: Dr. Roberto Rodrguez Said
Armando Vzquez Ramrez 508371
Miguel ngel Martnez Banda 509346
Omar Artemio Flores Flores 510484
Control de un proceso de 2
Orden por Modelo de espaciode estados
-
8/4/2019 6.Control de Posicion Por Espacio de Estados
2/10
2
Tabla de contenido
Tabla de contenido .............................................................................................................................. 2
Objetivo ............................................................................................................................................... 3
Marco Terico ..................................................................................................................................... 3
Diagrama de Bloques .......................................................................................................................... 4
Diagramas elctricos con el procedimiento de diseo ....................................................................... 5
Cdigo comentado .............................................................................................................................. 6
Resultados ........................................................................................................................................... 7
Conclusiones ....................................................................................................................................... 8
Bibliografa .......................................................................................................................................... 8
Anexo: Cdigo en Matlab .................................................................................................................. 10
-
8/4/2019 6.Control de Posicion Por Espacio de Estados
3/10
3
Objetivo
Controlar un proceso de 2do orden en este caso la posicin de un motor decorriente directa con encoder ptico usando el modelo de espacio de estados. Elcontrol se hace a travs de un vector de ganancias K retroalimentado a cada
variable de estado.Marco Terico
El modelado por espacio de estados es una representacin matricial del procesoa controlar en el tiempo continuo o discreto a partir de las ecuacionesdiferenciales que componen la dinmica del sistema. La principal ventaja deeste modelo es que facilita la representacin de sistemas con mltiplesentradas y mltiples salidas, adems que toda la dinmica del sistema serepresenta por ecuaciones diferenciales o de diferencia de primer orden.
Esta representacin matemticamente se realiza de la siguiente manera:
Donde x(t) son las variables de estados, y(t) es la salida del sistema y u(t) es laentrada.Para el diseo de la ley de control se supone que se cuenta en todo momentocon el valor de cada uno de los estados de la planta a controlar, y se determinala accin de control u (entrada de control a la planta) como una combinacinlineal de los estados. Los coeficientes de esa retroalimentacin de estados lo
agrupamos en el vector que denominamosK. La determinacin de K, para lossistemas controlables, est ligada a los valores propios (eigenvalores) del
sistema retroalimentado y el problema se reduce en asignar un conjunto devalores propios que correspondan con una performance temporal satisfactoriaen trminos de tiempo de crecimiento, tiempo de establecimiento, sobrepico,etc.
-
8/4/2019 6.Control de Posicion Por Espacio de Estados
4/10
4
Metodologa
Se plante el modelo de espacio de estados de la planta a controlar. Con los criterios de diseo (sobretiro del 15% y 0.5 segundos de tiempo
de establecimiento), se encontraron los polos deseados. En MATLAB, usando la instruccin place, se encontraron las gananciasdel controlador. Se construy un puente H para ser usado como driver. Se implement en LABVIEW el controlador propuesto.
Diagrama de Bloques
Los recuadros rellenos son hardware y los recuadros blancos son parte del VIen LABVIEW.
Referencia RESTA
Plantamodelada
como
espacio deestados
Controlador(Vector K)
PWM
Salida
Analgica
de la DAQ
Driver
Puente H
Motor
DC
Encoder
ptico
Entrada
Analgica
de la DAQ
-
8/4/2019 6.Control de Posicion Por Espacio de Estados
5/10
5
Diagramas elctricos con el procedimiento de diseo
Se realiz un driver con acoplamiento ptico con el fin de aislar la DAQ delcircuito de potencia y evitar daar la tarjeta DAQ.
Cantidad Componente Modelo2 R1 27 2 R2 1k 4 Diodos 1N40044 Q1 2N22224 Q2 TIP 321 M Motor pololu de
12V
-
8/4/2019 6.Control de Posicion Por Espacio de Estados
6/10
6
Cdigo comentado
1. DAQ assistant de adquisicin de posicin configurado como contador digital2. Variable local de posicin3. Variable local de velocidad4a Grfica de posicin deseada vs posicin real
4b Grfica de velocidad
5. Ganancia K16. Ganancia K27. Suma de las aportaciones del vector K como valor escalar.8. Variable local de posicin deseada.9. Seal error. Resta de posicin deseada menos seal manipuladora obtenida en (7).10.Switch de encendido del controlador.11.Esta condicin sirve para prender o apagar el controlador. Esto es til debido a que
en ocasiones al darle stop al VI, se queda prendida la salida de la DAQ. Por eso se
utiliz para apagar el controlador antes de apagar el VI.
12.Generador de la onda cuadrada del PWM a 800 Hz con amplitud de 2.5 V y offsetde 2.5V
13.Salida de la DAQ analgica con giro en sentido positivo.
-
8/4/2019 6.Control de Posicion Por Espacio de Estados
7/10
7
14.Salida de la DAQ analgica con giro en sentido negativo.15.Condicin de la estructura de casos en donde se busca el signo del error
para decidir el sentido de giro
16.Estructura de casos que modifica la salida del PWM al canal ao0 o ao1dependiendo del signo del error para modificar el sentido de giro.
17.Tiempo de muestreo del proceso de control y escritura a puertosanalgicos de la DAQ. Este tiempo es de 1 ms para que el control de
posicin sea fino.
18.Tiempo de muestreo del proceso de lectura de posicin y clculo de lavelocidad. Este tiempo es de 45 ms para que la resolucin de la velocidad
se mantenga con poco ruido, ya que a menor tiempo la lectura se mostr
ruidosa.
Resultados
El modelo espacio de estados con el que se trabaj, obtenido en MATLAB es el siguiente:
A C
x1 x2x1 0 1
x2 0.04684 -1.981
x1 x2y1 1 0
B Du1
x1 -11.17x2 2495
u1
y1 0
Donde las variables de estado son x1=posicin; x2=velocidad. De acuerdo a los criterios
de diseo ya mencionados, sobretiro del 15% y 0.5 segundos de tiempo deestablecimiento se obtuvieron los siguientes polos deseados.
De ah se obtuvieron los siguientes valores propios para el vector K:
[]
-
8/4/2019 6.Control de Posicion Por Espacio de Estados
8/10
8
Posteriormente se implementaron estos valores en el VI arriba comentado con
los resultados mostrados en la siguiente grfica:
En la grfica se pueden apreciar cambios de referencia de 1080 a 0, de 0 a -1080, de -1080
a 0, de 0 a 360, de 360 a -360, de -360 a -1500, de -1500 a 1500. La lnea roja es la posicin
deseada y la lnea blanca es la seal de posicin real generada por el encoder ptico.Claramente se puede apreciar que comportamiento del sistema coincide con el de diseo
sin importar la magnitud del escaln ni el sentido de giro.
Conclusiones
El desempeo del controlador fue el esperado ante los diferentes cambios dereferencia que se le dieron. Gracias a la correcta caracterizacin por laSecuencia Binaria Pseudo-aleatoria (PRBS, por sus siglas en ingls) el modelocon el que se trabaj y el controlador diseado funcion de acuerdo a lodiseado en todos los cambios de referencia sin importar la magnitud delescaln. Esto se menciona a raz de los resultados de prcticas anteriores en lasque la caracterizacin se realiz nicamente con una entrada escaln, pues eldesempeo de su controlador vari con respecto de la magnitud del escaln.Este controlador ha tenido un desempeo ms fino que los implementadosanteriormente.
BibliografaFernndez , R., Flury, C., & Di Benedetto, A. (s.f.).Dinmica de sistemas y control.
Recuperado el 26 de abril de 2011, de CAPITULO VIII: Diseo en el espacio de
estados: http://www.ib.cnea.gov.ar/~dsc/capitulo8/Capitulo8.htmLopez Hurtado, I. (2010). Control Engineering Lab Notes.
-
8/4/2019 6.Control de Posicion Por Espacio de Estados
9/10
9
-
8/4/2019 6.Control de Posicion Por Espacio de Estados
10/10
10
Anexo: Cdigo en Matlab
%% Entradas
Mp=15;Tss=.5;
sigma=-4/Tss;ji=sqrt((log(Mp/100)^2/(pi^2+(log(Mp/100))^2)));
wn=sigma/ji;
wd=wn*sqrt(1-ji^2);
p1=sigma+j*wd;
p2=sigma-j*wd;
P=[p1 p2];K=place(A,B,P);
%% VERIFICANDOAF=A-B*K;
test=eig(AF);
% los valores de test deben de ser igual a los de P
%% Grfica de la respuesta
modelo=ss(AF,B,C,D);
step(modelo)