escuela superior politÉcnica del litoral · polos dominantes:-2 2i controlador método del lgr....
TRANSCRIPT
![Page 1: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/1.jpg)
ESCUELA SUPERIOR
POLITÉCNICA DEL LITORAL
“MODELADO, SIMULACIÓN Y CONTROL DE UN
SISTEMA DINÁMICO MEDIANTE EL USO DE
COMPONENETES ANÁLOGOS”
Autor
Roberth Tinoco
Director
Ing. Eduardo Orces
![Page 2: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/2.jpg)
Contenidos
1. Introducción
2. Modelado y Respuesta a L.A. del Sistema
3. Método del LGR para el análisis del Sistema de Control.
4. Método de Ubicación de Polos para el análisis del Sistema de Control.
5. LQR en el Diseño Final del Sistema de Control.
6. Conclusiones y Recomendaciones.
![Page 3: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/3.jpg)
Problema interesante desde el punto de
vista de control.
Ilustra muchas de las dificultades
asociadas con problemas de control del
mundo real.
Introducción
Control mediante el empleo decomponentes simples análogos
![Page 4: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/4.jpg)
Introducción
Aplicaciones análogas:
• Robótica.
• Posicionamiento satelital con respecto a la
tierra.
• Plataforma para el lanzamiento de cohetes
• Estabilidad de Grúas y edificios, etc.
![Page 5: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/5.jpg)
Introducción
Definición: Consiste enun péndulo que giralibremente por uno de susextremos mediante unaarticulación situada sobreun carro que se muevesobre una guía rectilíneabajo la acción de una
Fuerza de Control.
![Page 6: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/6.jpg)
Objetivo
Construir el prototipo utilizando un bajo
presupuesto
• Diseñar estructuralmente el sistema
• Elegir sensores y actuador.
• Uso de componentes análogos
Controlar el sistema
• Simular distintos controladores lineales
usando MATLAB y SIMULINK
• Implementar controlador mediante LQR
![Page 7: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/7.jpg)
Contenidos
1. Introducción
2. Modelado y Respuesta a L.A. del Sistema
3. Método del LGR para el análisis del Sistema de Control.
4. Método de Ubicación de Polos para el análisis del Sistema de Control.
5.LQR en el Diseño Final del Sistema de Control.
6. Conclusiones y Recomendaciones.
![Page 8: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/8.jpg)
Modelado Dinámico del Sistema
0
1x
mg0
00x
Bo
0bx
0mI
mmM2
![Page 9: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/9.jpg)
Modelado Dinámico del Sistema
Modelado en SIMULINK
![Page 10: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/10.jpg)
Modelado Dinámico del Sistema
q
bmgS
q
mgmMBbS
q
mIbmMBS
Sq
m
sU
s
22
3
Donde:22 mmImMq
![Page 11: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/11.jpg)
Modelado Dinámico del Sistema
Determinación de los Parámetros Físicos:
mM4
mMg32n
Parámetro Descripción Valor
M Masa del Carro 0.425 Kg.
m Masa del Péndulo 0.270 Kg.
l Longitud del Péndulo 0.33 m.
b Constante de amortiguamiento
debido al Carro
0.1 N/m/s.
B Constante de amortiguamiento
debida al Péndulo
0.05
N.m/rad/s.
![Page 12: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/12.jpg)
Modelado Dinámico del Sistema
9.229 s
-----------------------------------------------
s^3 + 7.402 s^2 - 61.83 s – 9.045
Sistema a Lazo Abierto:
![Page 13: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/13.jpg)
Modelado Dinámico del Sistema
Modelado en el Espacio de Estados:
X
X
4
3
2
1
3
1
2
1
Xy
yy
q
mI
0q
m0
q
mIb0
q
Bmg
q
m
1000q
bm0
q
mMBg
q
mmM0010
2
4
3
2
1
22
4
3
2
1
.0
0.
0100
0001
y
y
4
3
2
1
2
1
![Page 14: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/14.jpg)
Modelado Dinámico del Sistema
Sistema a Lazo Abierto:
![Page 15: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/15.jpg)
Modelado Dinámico del Sistema
Modelado en SIMULINK
![Page 16: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/16.jpg)
Modelado Dinámico del Sistema
Estrategia de Control
Conjunto Carro-
Péndulo
Sensor
Amplificador mas
Actuador
Potencia
Externa
Señal Proporcional a
las Variables de
Salida
![Page 17: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/17.jpg)
Contenidos
1. Introducción
2. Modelado y Respuesta a L.A. del Sistema.
3. Método del LGR para el análisis del Sistema de Control.
4. Método de Ubicación de Polos para el análisis del Sistema de Control.
5. LQR en el Diseño Final del Sistema de Control.
6. Conclusiones y Recomendaciones.
![Page 18: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/18.jpg)
Diagrama de Bloques:
CONTROLADOR
K(S)
PLANTA
G(S)
r(S) = 0
+
+
+-
(S)U(S)e(S)
Fd(S)
Diagrama de Bloques Simplificado:
PLANTA
G(S)+-
(S)U(S)Fd(S)
CONTROLADOR
K(S)
sFsGsK1
sGs d
Controlador Método del LGR
![Page 19: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/19.jpg)
Trazo del LGR:
Cero =
0
Polos =
-12.2973
5.0828
-0.1418
Controlador Método del LGR
![Page 20: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/20.jpg)
Especificaciones de Desempeño:
22
4
t
4
2% del criterio 44
t
s
ns
Tiempo de asentamiento:
1/ 2
e=05.0 7.0≈
Sobrepaso Máximo:
Polos Dominantes:-2 2i
Controlador Método del LGR
![Page 21: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/21.jpg)
Ley de Control PID:
Compensador PD:
Sistema no compensado hasta el polo dominante compensado
deseado es -173.12º.
100ssGPD
s
5.0ssGPI
Compensador PI:
Cualquier compensador integral ideal cero funcionará, mientras el
cero se coloque cerca del origen
Controlador Método del LGR
![Page 22: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/22.jpg)
Ley de Control PID:
k = 0.0951
ceros = 0 , 0
polos = 0 , -4.2118, -2.0024 +/- 2.0244i
Controlador Método del LGR
![Page 23: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/23.jpg)
Ley de Control PID:
Controlador Método del LGR
![Page 24: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/24.jpg)
Ley de Control PID:
RESPUESTA
A LAZO
CERRADO
SOBRESALTO TIEMPO DE
ESTABLECIMIENTO
ERROR
EN
ESTADO
ESTABLE
Kp Incrementa No altera Disminuye
Ki Incrementa Incrementa Incrementa
Kd Disminuye Disminuye No altera
Controlador Método del LGR
![Page 25: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/25.jpg)
Ley de Control PID:
9.046 s^2
---------------------------------------------------
s^4 + 188.3 s^3 + 843.1 s^2 + 443.4 s
Kp= 100; Kd= 20; Ki=50
Controlador Método del LGR
![Page 26: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/26.jpg)
Diagrama de Bloques:
CONTROLADOR
K(S)
PLANTA 1
G1(S)
r(S) = 0
+
+
+-
(S)
U(S)
e(S)
Fd(S)
Diagrama de Bloques Simplificado:
+-
X (S)
U(S)Fd(S)
CONTROLADOR
K(S)
Análisis de la Variable no Controlada
PLANTA 2
G2(S)
X(S)
PLANTA1
G1(S)
PLANTA2
G2(S)
sGsK1
sG
sF
sx
1
2
d
Controlador Método del LGR
![Page 27: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/27.jpg)
Controlador Método del LGRAnálisis de la Variable no Controlada
![Page 28: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/28.jpg)
Controlador Método del LGRAnálisis de la Variable no Controlada en SIMULINK
![Page 29: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/29.jpg)
Contenidos
1. Introducción
2. Modelado y Respuesta a L.A. del Sistema.
3. Método del LGR para el análisis del Sistema de Control..
4. Método de Ubicación de Polos para el análisis del Sistema de Control.
5. LQR en el Diseño Final del Sistema de Control.
6. Conclusiones y Recomendaciones.
![Page 30: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/30.jpg)
Controlador por Ubicación de PolosControlabilidad y Observabilidad:
DCxy
BAxx
Controlabilidad: Un sistema es controlable en el tiempo to, si se puede
llevar de cualquier estado inicial X(to) a cualquier otro estado, mediante un
vector de control sin restricciones, en un intervalo de tiempo finito.
BAABB 1n
Condición de Controlabilidad:
Matriz de Controlabilidad no singular
![Page 31: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/31.jpg)
Controlador por Ubicación de PolosControlabilidad y Observabilidad:
DCxy
BAxx
Observabilidad: Un sistema es observable en el tiempo to si, con el
sistema en el estado X(to), es posible determinar este estado a partir de la
observación de la salida durante un intervalo de tiempo finito.
Condición de Observabilidad:
Matriz de Observabilidad no singular
CACAC1n
![Page 32: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/32.jpg)
Controlador por Ubicación de PolosDiseño por Ubicación de Polos:
DCxy
BAxx
Kx xBKAx 0xetx BKA
Los valores característicos de la matriz A-BK se denominan Polos
Reguladores
ABAABB1000K11n
IAAAA n1n1n
1n
Fórmula de Ackermann:
Donde
![Page 33: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/33.jpg)
Controlador por Ubicación de PolosMatriz de Realimentación de Estados:
Kx
Polos:
-2+2*sqrt(3)*i,
-2-2*sqrt(3)*i,
-20,
-20
K =
[135.31 12.64 -72.20 -38.85]
x8.38x2.726.123.135
![Page 34: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/34.jpg)
Controlador por Ubicación de PolosMatriz de Realimentación de Estados:
![Page 35: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/35.jpg)
Controlador por Ubicación de PolosObservadores de Estados de Orden Completo:
Cxy
BAxx
El estado x se aproximará mediante el estado
x̂CyLBx̂Ax̂
x̂CCxLx̂AAxx̂x
x̂xLCAx̂x
Definiendo el error x -
0eLCAe
![Page 36: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/36.jpg)
b
a
b
a
bbba
abaa
b
a
B
B
x
x
AA
AA
x
x
b
a
x
x
01y
ababaaaa BxAxAx
bbbbabab BxAxAx
Controlador por Ubicación de PolosObservadores de Estados de Orden Mínimo:
Ecuación de salida
Ecuación de Estado
abaabaabbbabbb LBByLAALLAA~LAA~
Lyx~~b
Ecuación del Observador de orden mínimo:
![Page 37: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/37.jpg)
Controlador por Ubicación de PolosObservadores de Estados de Orden Mínimo:
L =
15.0940 -1.2452
78.9617 -16.6433
-1.7567 23.9477
-18.3909 145.4249
![Page 38: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/38.jpg)
![Page 39: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/39.jpg)
Contenidos
1. Introducción
2. Modelado y Respuesta a L.A. del Sistema.
3. Método del LGR para el análisis del Sistema de Control.
4. Método de Ubicación de Polos para el análisis del Sistema de Control.
5. LQR en el Diseño Final del Sistema de Control.
6. Conclusiones y Recomendaciones.
![Page 40: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/40.jpg)
Implementación Final LQRSelección del Actuador:
![Page 41: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/41.jpg)
Implementación Final LQRSelección del Actuador:
t1Sene1
Xtx 2t
2
o
1cos
2
2
dt
xdmM
dt
dxbtF
)t(v)t(F)t(Pot
Potencia del Motor
-0,2
-0,15
-0,1
-0,05
0
0,05
0,1
0,15
0 0,5 1 1,5 2 2,5
Tiempo (seg)
Po
ten
cia
(H
P)
MASA
AMORTIGUAMIENTO
POTENCIA
PotenciaPromedio 0.00836HP [6.23 watts]
PotenciaMáxima 0,12573HP [93.8 watts]
![Page 42: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/42.jpg)
Implementación Final LQRModelo dinámico del Motor DC:
aa
12
a
212
0
a
2a1m erR.2
Kx
rR.2
KKx
r.2
J
R
Ke
r.2
K
r.2
JF
1a
ba
2
2
2c
m KR
dt
dKe
dt
d
n
JJ
![Page 43: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/43.jpg)
erqR2
mIK
q
Bm
q
gmx
q
rR2
KKbmI
xa
21
22a
212
erqR2
Kmx
q
mrR2
KKb
gq
r2
JmMm
q
r2
JmMB
a
12
a
21
2o
2o
222
o mmIr2
JmMq
Donde:
Implementación Final LQRConexión dinámica Péndulo - Motor DC:
![Page 44: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/44.jpg)
Implementación Final LQRDeterminación de los Parámetros del Motor:
a
bb
a1
i
gLM2/1
i
TK
![Page 45: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/45.jpg)
Implementación Final LQRDeterminación de los Parámetros del Motor:
1Ke [voltios] ia [A] T [N.m] K1=T/ia
[N.m/A]
1,812 0,22 0,05978 0,27173 O,27173
3,230 0,44 0,11856 0,27173
2Ke [voltios] ia [A] [rpm] K2=e/
[V/rad/s]
6,3 0,18 370 0,16262 O,15584
12,0 0,19 700 0,16367
15,4 0,44 1080 0,14057
aRe [voltios] ia [A] [rpm] Ra=(e-K2)/ia [ ]
8,04 0,40 400 3,78 3,69
8,15 0,45 400 3,60
![Page 46: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/46.jpg)
Implementación Final LQRCaja Reductora:
c
mopt
J
Jn
Inercia del Motor DC:
RLmmMR3/Lm4
2/gLmJ ppm
22p2
p2o
m
![Page 47: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/47.jpg)
Implementación Final LQRRazón de Reducción Óptima:
Inercia de Carga:
2pc r)mM(J 34.1
J
Jn
c
mopt
![Page 48: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/48.jpg)
SqrR2
KNKmgS
q
r2
JmM
mgSq
rR2
KNKmI
S
SrqR2
NKm
SE
S
2a
2122
o
32
a
212
4
2
a
1
Implementación Final LQRRazón de Reducción Óptima:
![Page 49: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/49.jpg)
Implementación Final LQRParámetros Físicos del Sistema:
PARÁMETRO DESCRIPCIÓN VALOR
M Masa del Carro 0,435 Kg.
m Masa del Péndulo 0,270 Kg.
l Longitud media del Péndulo 0,165 m.
b Coeficiente de Fricción Viscosa del Carro 0,1 N.s/m
B Coeficiente de Fricción Viscosa del Péndulo 0,05 N.m/rad/s
K1 Constante del Par Motriz 0,27173 N.m/A
K2 Constante de la Fuerza Contra electromotriz 0,15584 V/rad/s
Ra Resistencia de Armadura del Motor 3,69
K Ganancia del Potenciómetro del Péndulo 1,637 V/rad
Kx Ganancia del Potenciómetro del Carro 4,244 V/m
d Diámetro de la Polea 0,075 m
n Reducción de la caja Reductora 1.5, 3, 7 , 10
![Page 50: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/50.jpg)
Implementación Final LQRRegulador Cuadrático Lineal :
control óptimo implica una equidad entre el desempeño y el costo
de control y busca minimizar el valor del índice de desempeño J.
dtR'Qx'x2
1J
0
El problema de minimizar J con respecto a la entrada de control u(t),
es conocido como el problema Regulador Cuadrático Lineal (LQR)
Teorema del Regulador Óptimo
P'BRK Kx -1opt
Ecuación de Riccati 0P'BPBRQP'APA 1
![Page 51: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/51.jpg)
Implementación Final LQRRegulador Cuadrático Lineal :
Driver del Motor DC
![Page 52: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/52.jpg)
Implementación Final LQRRegulador Cuadrático Lineal :
Matriz de Ganancias de Realimentación de Estados:
K = [87.7593 -31.6228 8.1430 -31.3855];
Matriz de Ganancias del Observador:
L =
7.8260 -0.5693
-0.5693 0.1786
Aplicando la igualdad de la ley de control y del estimador:
21 39.3114.8x91.4141.169
10.17x46.1482.1439.12462.13 211
96.3x18.535.2067.2742.0 212
![Page 53: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/53.jpg)
Implementación Final LQRRegulador Cuadrático Lineal :
Diagrama de Flujo de Señales del Compensador:
![Page 54: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/54.jpg)
Implementación Final LQRCompensador Electrónico
![Page 55: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/55.jpg)
Zona Muerta del Motor0V Si V2.1V
0V Si V8.1VV
in
inout
![Page 56: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/56.jpg)
![Page 57: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/57.jpg)
![Page 58: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/58.jpg)
![Page 59: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/59.jpg)
Conclusiones y Recomendaciones
Dispositivos físicos actúan en estado de saturación..
Limitación de ganancias que inciden en el estado de
saturación.
Reemplazo del driver analizado por un OPA-548.
Uso de aisladores y flitros para disminuir el rizado en las
señales provenientes de los sensores.
Uso de frenado dinámico por parte del motor.
Se delimita la region del actuador por inestabilizar el
sistema
![Page 60: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/60.jpg)
La realimentación reduce el efecto de las perturbaciones y
modera los errores de modelado, no obstante ante la
presencia de perturbaciones y ruido en el sensor se debe
incluir:
• Desempeño de seguimiento.
•Reducir la sensibilidad a ruido en el sensor, ganancia
significativa en la región de baja frecuencia y mínima en la
región de alta frecuencia.
• Se debe delimitar la señal de control para futuras mejoras.
• Reducir la sensibilidad ante errores en el modelado.
• Establecer una estabilidad robusta.
Conclusiones y Recomendaciones
![Page 61: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/61.jpg)
1. Potenciómetro
Lineal.
2. Cilindro Lineal sin
Vástago.
3. Péndulo Invertido.
4. Servopotenciómetro
rotacional.
5. Tarjeta de
Referencia
electrónica.
6. Trasductor de
Presión.
7. Válvula proporcional
5/3.
8. Unidad FLR.
9. Válvula de
Suministro.
10. Interfase electrónica.
11. PC del Ordenador.
![Page 62: ESCUELA SUPERIOR POLITÉCNICA DEL LITORAL · Polos Dominantes:-2 2i Controlador Método del LGR. Ley de Control PID: Compensador PD: Sistema no compensado hasta el polo dominante](https://reader030.vdocuments.co/reader030/viewer/2022013009/5eba7773557d9a6de574f522/html5/thumbnails/62.jpg)