Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
Unidad 3b
Diseño de Sistemas de Seguimiento y
Observadores de Estado
Temario
• Consideraciones Preliminares
• Diseño de servosistemas o sistemas de seguimiento.
• Diseño de observadores de estado de orden completo y
de orden mínimo.
• Uso de Matlab.
1
Consideraciones Preliminares
Consideraciones preliminares
Variables de estado 𝑖, w
Variable de salida
R L +
J,B
+ um(t)
u(t) (t)=d/dt
-
-
𝑥ሶ = 𝐀𝑥 + 𝐁𝑢
𝑦 = 𝐂𝑥 + D𝑢 donde 𝑥 0 = 𝑥0
𝑠(𝑠) = 𝑊(𝑠)
𝑦 = 1 0 0 𝑥 + 0𝑢
Consideraciones preliminares
La representación numérica en EE está dada por
𝑥ሶ 1 0 1 0 𝑥1 0
𝑥ሶ 2 = 0 −500 −300 𝑥2 + 0 𝑢
𝑥ሶ 3 0 −0.0002 −2 𝑥3 2
𝑦 = 1 0 0 𝑥 + 0𝑢
La matriz de controlabilidad es
0 1 −600
𝐂𝐨 = 𝐁 𝐀𝐁 𝐀𝟐 𝐁 = 0 −600 301200
2 −4 203/25
El sistema es controlable
2
r es un escalón
𝑥ሶ = 𝐀𝑥 + 𝐁𝑢
𝑦 = 𝐂𝑥
Como 𝑢 = 𝑘1 𝑟 − 𝑥1 − 0 𝑘2 ⋯ 𝑘𝑛 𝑥
𝑢 = 𝑘1 𝑟 − 𝑥1 − 0 𝑘2 ⋯ 𝑘𝑛 𝑥 = −𝐾𝑥 + 𝑘1 𝑟
𝑥ሶ 1 0 1 0 𝑥1 0
𝑥ሶ 2 = 0 0 1 𝑥2 + 0 𝑢
𝑥ሶ 3 0 −6 −5 𝑥3 1
𝑦= 1 0 0 𝑥 + 0𝑢
[y1,x1]=lsim(A-B*K,B*K(1),C,0,u,t,x0);
figure(2)
plot(t,x1(:,1),t,x1(:,2),t,x1(:,3))
grid
Ejemplo de aplicación
𝐂𝐨 = 𝐁 𝐀𝐁 𝐀𝟐 𝐁
0 0 1
= 0 1 −5
1 −5 19
El sistema es controlable
𝑠 −1 0 0 0 0
0 𝑠 −1 + 0 0 0 = 𝑠 3 + 10𝑠 2 + 19𝑠 + 24
0 6 𝑠+5 𝑘1 𝑘2 𝑘3
𝑠 −1 0
0 𝑠 −1 = 𝑠 3 + 10𝑠 2 + 19𝑠 + 24
𝑘1 6 + 𝑘2 𝑠 + 5 + 𝑘3
𝑘1 + 𝑘2 + 6 𝑠 + 𝑠 + 𝑘2 + 5 𝑠 2 = 𝑠 3 + 𝑘2 + 5 𝑠 2 + 𝑘2 + 6 𝑠 + 𝑘1
Ejemplo de aplicación
Al igualar los coeficientes
𝑘1 = 24 𝑘2 = 13 𝑘3 = 5
La matriz K está dada por
𝐊 = [24 13 5]
La ley de control u resulta
𝑢 = −24𝑥1 − 13𝑥2 − 5𝑥3 + 24𝑟
𝑥1
𝑢 = − 24 13 5 𝑥2 + 24𝑟
𝑥3
1
Nota. 𝑘1 se puede obtener de esta otra manera 𝑘1 = −
𝐂(𝐀 − 𝐁𝐊)−1 𝐁
−1
0 1 0 0 0 1 1
1 0 0 0 0 1 − 0 24 13 1 0 =− 𝑘1 = − = 24
24 −1Τ24
0 −6 −5 1 1
Ejemplo de aplicación
El nuevo sistema de lazo cerrado queda definido de la siguiente manera
𝑥ሶ = 𝐀 − 𝐁𝐊 𝑥 + 𝐁𝑘1 𝑟
0 1 0 0 0
𝑥ሶ = 0 0 1 − 0 24 13 5 𝑥 + 0 [24] 𝑟
0 −6 −5 1 1
0 1 0 0 0 0 0
𝑥ሶ = 0 0 1 − 0 0 0 𝑥+ 0 𝑟
0 −6 −5 24 13 5 24
%realimentación de estados
p1=-1+j*sqrt(2);
p2=-1-j*sqrt(2);
p3=-8;
K=place(A,B,[p1 p2 p3]);
[y1,x1]=lsim(A-B*K,B*K(1),C,0,u,t,x0);
figure(2)
plot(t,x1(:,1),t,x1(:,2),t,x1(:,3))
grid
Diseño de servosistema de tipo 1 cuando la
planta no tiene un integrador.
Supóngase que la planta se 𝑥ሶ = 𝐀𝑥 + 𝐁𝑢
define mediante:
𝑦 = 𝐂𝑥
ሶ = 𝑟 − 𝑦 = 𝑟 − 𝐂𝑥 𝑢 = −𝐊𝑥 + 𝑘𝐼
Acción integral
𝑥ሶ = 𝐀𝑥 + 𝐁𝑢
ሶ = −𝐂𝑥 + 𝑟
𝑦 = 𝐂𝑥
Donde la ley de control
𝑢 = −𝐊𝑥 + 𝑘𝐼
La nueva ecuación 𝑥ሶ 𝐀 0 𝑥 𝐁 0
matricial del sistema es la ሶ = + 𝑢 + 𝑟 (1)
−𝐂 0 0 𝐈
siguiente
𝑥ሶ 𝐀 − 𝐁𝐊 𝐁𝑘𝐼 𝑥 0
ሶ = + 𝑟
O bien −𝐂 0 𝐈
Diseño de servosistema de tipo 1 cuando la
planta no tiene un integrador.
El sistema final puede der representado de la siguiente manera
𝑥ሶ 𝐀 − 𝐁𝐊 𝐁𝑘𝐼 𝑥 0
ሶ = + 𝑟
−𝐂 0 𝐈
𝑥
𝑦 = 𝐂 0 + 𝐷𝑢 Con D usualmente de valor 0
𝑢 = −𝐊𝑥 + 𝑘𝐼
= 𝐊
𝐊 −𝑘𝐼
Ejemplo de aplicación
0 1 0
𝑥ሶ = 𝑥+ 𝑢
−2 −3 1
𝑦= 1 0𝑥
𝑥ሶ 𝐀 − 𝐁𝐊 𝐁𝑘𝐼 𝑥 0
= + 𝑟
ሶ −𝐂 0 𝐈
𝑥
𝑦 = 𝐂 0 + 𝐷𝑢
𝑠𝐈 −
𝐀 − 𝐁𝐊 𝐁𝑘𝐼 = 𝑠 3 + 4𝑠 2 + 5𝑠 + 2
−𝐂 0
Desarrollando la determinante
0 1 0 𝑘 0 0 1 0 0 0
− 𝑘2 𝑘𝐼 −
−2 −3 1 1 1 = −2 −3 𝑘1 𝑘2 𝑘𝐼
−1 0 0 −1 0 0
𝑠 0 0 0 1 0
0 𝑠 0 − −2 − 𝑘1 −3 − 𝑘2 𝑘𝐼
0 0 𝑠 −1 0 𝑠
𝑠 −1 0
2 + 𝑘1 𝑠 + 3 + 𝑘2 −𝑘𝐼 = 𝑠 3 + 4𝑠 2 + 5𝑠 + 2
1 0 𝑠
Ejemplo de aplicación
𝑘1 + 2 𝑠 + 𝑠 + 𝑘2 + 3 𝑠 2 + 𝑘𝐼 = 𝑠 3 + 4𝑠 2 + 5𝑠 + 2
𝑠 3 + 𝑘2 + 3 𝑠 2 + 𝑘1 + 2 𝑠 + 𝑘𝐼 = 𝑠 3 + 4𝑠 2 + 5𝑠 + 2
𝑘1 = 3, 𝑘2 = 1, 𝑘𝐼 = 2
= 𝐊 −𝑘𝐼 = 3 1
𝐊 −2
𝑥ሶ1 0 1 0 0 0 𝑥1 0
𝑥ሶ 2 = − 𝑥2 + 0 𝑟
−2 −3 𝑘1 𝑘2 𝑘𝐼
ሶ −1 0 0 1
𝑥ሶ1 0 1 0 𝑥1 0
𝑥ሶ 2 = −5 −4 2 𝑥2 + 0 𝑟
ሶ −1 0 0 1
𝑥1
𝑦= 1 0 0 𝑥2
Ejemplo de aplicación
clc
Ai=[0 1; -2 -3];
Bi=[0;1];
Ci=[1 0];
% definiendo la amplitud Amp
Amp=1; 𝑥1
t=0:0.005:10;
u=Amp*exp(0*t);
x0=[0 1];
[y,x]=lsim(Ai,Bi,Ci,0,u,t,x0);
figure(1)
plot(t,x(:,1),t,x(:,2))
grid
𝑥2
Ejemplo de aplicación
[y1,x1]=lsim(A,B,C,0,u,t,x01);
figure(2)
plot(t,x1(:,1),t,x1(:,2),t,x1(:,3))
grid 𝑥1
𝑥2
Observadores de Estado
Observadores de Estado
Donde:
𝑥ሶ 𝑥ሶ = 𝐀𝑥 + 𝐁𝑢 𝑦 = 𝐂𝑥
𝑥ሶ = 𝐀𝑥 + 𝐁𝑢 + 𝐋(𝑦 − 𝐂𝑥)
= (𝐀 − 𝐋𝐂) 𝑥 + 𝐁𝑢 + 𝐋𝑦
Si definimos el error:
𝐞 = 𝑥 − 𝑥
𝐋 𝐞ሶ = 𝐀 − 𝐋𝐂 𝐞
Considere el sistema
𝑥ሶ = 𝐀𝑥 + 𝐁𝑢
𝑦 = 𝐂𝑥
0 20.6 0
donde 𝐀= , 𝐁= , 𝐂= 0 1
1 0 1
Se utiliza la realimentación de estado observada tal que 𝑢 = −𝐊𝑥
Diseñe un observador de estado de orden completo suponiendo que la configuración
del sistema es idéntica a la que se observa en la figura. Suponga que los valores
propios deseados de la matriz del observador son 1 = −10 y 2 = −10.
Solución:
Método 1 𝑛 − 𝑎𝑛
𝑇 −1
𝑛−1 − 𝑎𝑛−1
Para determinar la matriz 𝐋 = 𝐖 𝐎𝐛 ⋮
identidad
1 − 𝑎1
𝐎𝐛 = 𝐂 𝑇 ⋮ 𝐀𝑇 𝐂 𝑇 ⋮ … ⋮ 𝐀𝑇 𝑛−1 𝐂 𝑇
𝑎𝑛−1 𝑎𝑛−2 ⋯ 𝑎1 1
𝑎𝑛−2 𝑎𝑛−3 ⋯ 1 0
𝐖= ⋮ ⋮ ⋱ ⋮ ⋮
𝑎1 1 ⋯ 0 0
1 0 ⋯ 0 0
Ob = Matriz de observabilidad
Diseño de observadores de Estado de orden completo
𝑇 −1
2 𝑎2 2 𝑎2
Para n=2 𝐋 = 𝐖 𝐎𝐛 1 𝑎1 = 𝐈 1 𝑎1
𝑠𝐈 − (𝐀 − 𝐋𝐂) = 0
𝑠 0 0 20.6 𝑙1 𝑠 −20.6 + 𝑙1
− + 0 1 = = 𝑠 2 + 𝑙2 𝑠 − 20.6 + 𝑙1 = 0 (1)
0 𝑠 1 0 𝑙2 −1 𝑠 + 𝑙2
120.6
𝑙1 = 120.6, 𝑙2 = 20 𝐋=
20
Diseño de observadores de Estado de orden completo
−1
Método 3 Se utilizará la fórmula de Ackermann 𝐋 = (𝐀) 𝐂 0
𝐂𝐀 1
𝐀 = 𝐀2 + 20𝐀 + 100𝐈
−1
2 0 1 0
luego 𝐋 = 𝐀 + 20𝐀 + 100𝐈
1 0 1
120.6 412 0 1 0 120.6
𝐋= =
20 120.6 1 0 1 20
La ecuación para el observador de estado de orden completo
Considere el sistema
𝑥ሶ = 𝐀𝑥 + 𝐁𝑢
𝑦 = 𝐂𝑥
1 0 0 0
donde
𝐀= 0 2 1 , 𝐁= 0 , 𝐂= 1 1 0
0 0 2 1
𝐂 1 1 0
Aplicando el test de observabilidad 𝐎𝐛 = 𝐂𝐀 = 1 2 1
𝐂𝐀2 1 4 4
−1
𝐂 4 −4 1
𝐂𝐀 = −3 4 −1
𝐂𝐀2 2 −3 1
4 −4 1 0
luego 𝐋 = 𝐀3 + 12𝐀2 + 47𝐀 + 60𝐈 −3 4 −1 0
2 −3 1 1
120 0 0 4 −4 1 0 120
𝐋= 0 210 107 −3 4 −1 0 = −103
0 0 210 2 −3 1 1 210
L
A
Ejemplo de aplicación
𝐔(𝑠)
= 𝐊(𝑠𝐈 − 𝐀 + 𝐋𝐂 + 𝐁𝐊)−1 𝐋
−𝐘(𝑠)
−1
𝐔(𝑠) 𝑠 0 0 0 1 0 19 0 19
= [24 13 5] 0 𝑠 0 − 0 0 1 + 91 1 0 0 + 0 [24 13 5] 91
−𝐘(𝑠)
0 0 𝑠 0 −6 −5 −57 1 −57
−1
𝐔(𝑠) 𝑠 0 0 −19 1 0 19
= 24 13 5 0 𝑠 0 − −91 0 1 91
−𝐘(𝑠)
0 0 𝑠 33 −19 −10 −57
−1
𝑠 + 19 −1 0 19
= [24 13 5] 91 𝑠 −1 91
−33 19 𝑠 + 10 −57
Ejemplo de aplicación
El determinante es
= 𝑠 + 19 𝑠 2 + 10𝑠 + 19 + 91 𝑠 + 10 − 33 = 𝑠 3 + 29𝑠 2 + 300𝑠 + 1238
𝑠 + 19 −1 0 −1 𝑠 2 + 10𝑠 + 19 (𝑠 + 10) 1
1
91 𝑠 −1 = −(91𝑠 + 877) 𝑠 2 + 29𝑠 + 190 𝑠 + 19
−33 19 𝑠 + 10 33𝑠 + 1729 −(19𝑠 + 328) 𝑠 2 + 19𝑠 + 91
𝑠 2 + 10𝑠 + 19 (𝑠 + 10) 1 19
𝐔(𝑠) 1
= [24 13 5] −(91𝑠 + 877) 𝑠 2 + 29𝑠 + 190 𝑠 + 19 91
−𝐘(𝑠)
33𝑠 + 1729 −(19𝑠 + 328) 𝑠 2 + 19𝑠 + 91 −57
𝐔(𝑠) 1 19
= [24𝑠 2 − 778𝑠 − 2300 13𝑠 2 + 306𝑠 + 1070 5𝑠 2 + 108𝑠 + 726] 91
−𝐘(𝑠)
−57
Sistema de control
realimentado con
estado observado
con un observador
de orden mínimo.
Observadores de Estado de orden mínimo
Cambios de variable
Observador de Observador de estado
estado de orden de orden mínimo
completo
𝑥 𝑥𝑏
𝐀 𝐀𝑏𝑏
𝐁𝑢 𝐀𝑏𝑎 𝑥𝑎 + 𝐁𝑏 𝑢
𝑦 𝑥ሶ 𝑎 − 𝐴𝑎𝑎 𝑥𝑎 − 𝐵𝑎 𝑢
𝐂 𝐀𝑎𝑏
𝐋 (matriz 𝑛 × 1) 𝐋 [matriz (𝑛 − 1) × 1]
Se asume que 𝑚 = 1
= 𝐀𝑏𝑏 − 𝐋𝐀𝑎𝑏
𝐀
=𝐀
𝐁 𝐋 + 𝐀𝑏𝑎 − 𝐋𝐴𝑎𝑎
𝐅 = 𝐁𝑏 − 𝐋𝐵𝑎
0 = 1
𝐂 = 𝐃
𝐈𝑛−1 𝐋
Sistema con realimentación de estado observado donde el observador es de orden mínimo.
Observadores de Estado de orden mínimo
Para presentar la idea básica del observador de orden mínimo, sin complicaciones matemáticas
innecesarias, se expondrá el caso en el que la salida es un escalar (es decir, m=1) y se derivará la
ecuación de estado para el observador de orden mínimo.
Sea el sistema
𝑥ሶ = 𝐀𝑥 + 𝐁𝑢
𝑦 = 𝐂𝑥
Se desglosa el sistema de ecuaciones de la siguiente manera
Sea el sistema
𝑥ሶ = 𝐀𝑥 + 𝐁𝑢
𝑦 = 𝐂𝑥
0 1 0 0
donde 𝐀= 0 0 1 𝐁= 0 𝐂= 1 0 0
−6 −11 −6 1
𝑠1 = −2 + 𝑗2 3, 𝑠2 = −2 − 𝑗2 3, 𝑠3 = −6
𝐀 = 𝐀3 + 1 𝐀2 + 2 𝐀 + 𝟑 𝐈
90 29 4
𝐀 = 𝐀3 + 10𝐀2 + 40𝐀 + 96𝐈 = −24 46 5
−30 −79 16
11 6 1 90 29 4
Luego 𝐊= 0 0 1 6 1 0 −24 46 5 = 90 29 4
1 0 0 −30 −79 16
Diseño de observadores de estado de orden mínimo
Suponga que la salida y se puede medir con precisión, de forma que la variable de
estado x1 (que es igual a y), no necesita estimarse. Diseñe un observador de orden
mínimo. (El observador de orden mínimo es de segundo orden.) Suponga también
que los polos del observador deseados se seleccionan en
1 = −10, 2 = −10
La ecuación característica para el observador de orden mínimo es
𝑥ሶ 𝑎 = 𝐴𝑎𝑎 𝑥𝑎 + 𝐀𝑎𝑏 𝑥𝑏 + 𝐵𝑎 𝑢
𝑠𝐈 − 𝐀 𝑏𝑏 + 𝐋𝐀 𝑎𝑏 = (𝑠 − 1 )(𝑠 − 2 )
𝑥ሶ 𝑏 = 𝐀𝑏𝑎 𝑥𝑎 + 𝐀𝑏𝑏 𝑥𝑏 + 𝐁𝑏 𝑢
= (𝑠 + 10)(𝑠 + 10)
= 𝑠 2 + 20𝑠 + 100 = 𝑠 2 +
ෝ1 𝑠 +
ෝ2
−1
𝐀 𝑎𝑏 0
𝐋 = (𝐀 𝑏𝑏 )
𝐀 𝑎𝑏 𝐀 𝑏𝑏 1
Diseño de observadores de estado de orden mínimo
donde 𝐀 𝑏𝑏 = 𝐀2𝑏𝑏 +
ෝ1 𝐀𝑏𝑏 +
ෝ 2 𝐈 = 𝐀2𝑏𝑏 + 20𝐀 𝑏𝑏 + 100𝐈 Observador de Observador de estado
estado de orden de orden mínimo
completo
𝑥1 0 1 0 0 Ba 𝐀 𝐀𝑏𝑏
𝑥𝑎
Como 𝑥 = 𝑥 = 𝑥2 𝐀= 0 0 1 𝐁= 0
𝐁𝑢 𝐀𝑏𝑎 𝑥𝑎 + 𝐁𝑏 𝑢
𝑏
𝑥3 Bb 𝑦 𝑥ሶ 𝑎 − 𝐴𝑎𝑎 𝑥𝑎 − 𝐵𝑎 𝑢
−6 −11 −6 1 𝐂 𝐀𝑎𝑏
Aba Abb 𝐋 (matriz 𝑛 × 1) 𝐋 [matriz (𝑛 − 1) × 1]
Se tiene que
−1 −1
𝐀 𝑎𝑏 0 𝐀 𝑎𝑏 0
𝐋 = 𝐀 𝑏𝑏 = (𝐀2𝑏𝑏 + 20𝐀 𝑏𝑏 + 100𝐈)
𝐀 𝑎𝑏 𝐀 𝑏𝑏 1 𝐀 𝑎𝑏 𝐀 𝑏𝑏 1
−1
0 1 2
0 1 1 0 1 0
0 1 0
𝐋=( + 20 + 100 )
−11 −6 −11 −6 0 1 1 0 1
−11 −6
−1
89 14 1 0 0 89 14 0
𝐋= =
−154 5 0 1 1 −154 5 1
Luego 14
𝐋=
5
Diseño de observadores de estado de orden mínimo
la ecuación para el observador de orden mínimo
ሶ se obtiene mediante = 𝐀 𝑏𝑏 − 𝐋𝐀 𝑎𝑏
𝐀
=𝐀
𝐁 𝐋 + 𝐀 𝑏𝑎 − 𝐋𝐴𝑎𝑎
ሶ = 𝐀 𝑦 + 𝐅𝑢
+𝐁
𝐅 = 𝐁𝑏 − 𝐋𝐵𝑎
ሶ = 𝐀 𝐋 + 𝐀𝑏𝑎 − 𝐋𝐴𝑎𝑎 ) 𝑦 + 𝐅𝑢
+ (𝐀 𝐂 =
0
𝐈𝑛−1
= 1
𝐃
𝐋
ሶ = 𝐀𝑏𝑏 − 𝐋𝐀𝑎𝑏
+ 𝐀𝑏𝑏 − 𝐋𝐀𝑎𝑏 𝐋 + 𝐀𝑏𝑎 − 𝐋𝐴𝑎𝑎 𝑦 + 𝐁𝑏 − 𝐋𝐵𝑎 𝑢
donde
= 𝑥𝑏 − 𝐋𝑦 = 𝑥𝑏 − 𝐋𝑥1
0 1 14 −14 1
𝐀 𝑏𝑏 − 𝐋𝐀 𝑎𝑏 = − 1 0 =
−11 −6 5 −16 −6
la ecuación para el observador de orden mínimo, resulta
ሶ 2 −14 1
2 −14 1 14 0 14 0 14
= + + − 0 𝑦+ − 0 𝑢
ሶ 3 −16 −6
3 −16 −6 5 −6 5 1 5
ሶ 2 −14 1 2 −191 0
= + 𝑦+ 𝑢
ሶ
3 −16 −6
3 −260 1
Diseño de observadores de estado de orden mínimo
donde
2 𝑥
= 2 − 𝐋𝑦
3 𝑥3
o bien
𝑥2
= 2 + 𝐋𝑥1
𝑥3
3
Si se usa la realimentación
del estado observado,
la señal de control u
se convierte en:
𝑥1
𝑢 = −𝐊𝑥 = 𝑥2
𝑥3
Diseño de Compensadores de Estado
El problema de regulación se da cuando la referencia es nula r = 0; se pretende
básicamente que el sistema sea asintóticamente estable y que la respuesta a
condiciones iniciales producidas por perturbaciones tienda a cero.
1
𝑁=−
𝐂(𝐀 − 𝐁𝐊)−1 𝐁
A este parámetro N se le llama ganancia de precompensación o prefiiltro
Bibliografía