Académique Documents
Professionnel Documents
Culture Documents
Unidad de Aprendizaje:
Sistemas Dinámicos II
Profesor:
Manuel Mera Hernández
Alumno:
o Medellín Serafín Ángel Eduardo
Diseñe utilizando backstepping una señal de control tal que el origen sea
asintóticamente estable.
Se observa que la derivada de la función de Lyapunov tiene valor negativo para todo
𝜂 ℰ ℝ, por lo tanto, es asintóticamente estable.
Para la siguiente expresión
𝑥2 = 𝜑𝑥1
𝜑𝑥1 = −𝑠𝑖𝑛(𝑥1 ) − 𝑥1 (5)
Sustituyendo 𝑥2 en 𝑥̇ 1 resulta:
𝑥̇ 1 = −𝑠𝑖𝑛(𝑥1 ) − 𝑥1 + 𝑠𝑖𝑛(𝑥1 )
𝑥̇ 1 = − 𝑥1
x˙1= 𝒙𝟐 + 𝒔𝒊𝒏(𝒙𝟏)
−𝒙 𝟐 −𝒙 −𝟐𝒙 −𝒔𝒊𝒏(𝒙𝟏 )−[𝒄𝒐𝒔(𝒙𝟏 )+𝟏][𝒙𝟐 +𝒔𝒊𝒏(𝒙𝟏 )]
x˙2= 𝒙𝟐 + 𝟐 𝟏 𝟐 𝟏 𝟐
1
40
0
-1
30
-2
x2
20
x2
-3
-4
10
-5
0 -6
-7
-10
-20 -15 -10 -5 0 5 10 -8
-1 0 1 2 3 4 5
x1
x1
G RÁFICA 5: S IMULACIÓN DEL SISTEMA CON CONDICIONES GRÁFICA 6 S IMULACIÓN DEL SISTEMA CON CONDICIONES
INICIALES (-20,50) SE OBSERVA QUE TIENDE AL ORIGEN INICIALES (5,-8) SE OBSERVA QUE TIENDE AL ORIGEN
4 6
3
4
2
2
1
x2
0
x2
-1
-2
-2
-4
-3
-6
-4 -1 0 1 2 3 4 5 6 7
-4 -3.5 -3 -2.5 -2 -1.5 -1 -0.5 0 0.5 1
x1
x1
G RÁFICA 7 S IMULACIÓN DEL SISTEMA CON CONDICIONES GRÁFICA 8: S IMULACIÓN DEL SISTEMA CON CONDICIONES
INICIALES (-3,-4) SE OBSERVA QUE TIENDE AL ORIGEN INICIALES (6,6) SE OBSERVA QUE TIENDE AL ORIGEN
𝒙𝟏̇ = −𝒙𝟑𝟏 + 𝒙𝟐
𝒙𝟐̇ = 𝒙𝟑𝟐 + 𝒙𝟑
𝒙𝟑̇ = 𝟓𝒙𝟑𝟏 + 𝑼
Se identificaron tres variables en el sistema por lo que la solución tendrá dos pasos
Tomando las ecuaciones de 𝑥1̇ y de 𝑥2̇ para el diseño de la entrada estabilizante y
sustituyéndola en la ecuación del algoritmo de backstepping y realizando los siguientes
cambios de variable: 𝑥1 = 𝜂, 𝑥2 = 𝜉 resulta:
𝜂̇ = −𝜂3 + 𝜉 (5)
𝜉̇ = 𝜉 3 + 𝑈
̃
1
Utilizando la función de Lyapunov 𝑉(𝜂) = 2 𝜂2 y además sistema hay que cumplir con
que :
𝑉̇ (𝜂) = 𝜂𝜂̇ < 0
sustituyendo en 𝑉̇ (𝜂):
𝑉̇ (𝜂) = −𝜂4 −𝜉 2
quien es definida negativa 𝜂, 𝜉 ∈ ℝ2 .
Entonces:
𝑑𝜙 𝑑𝑉𝑜
𝜉=[ ] [𝑓(𝑛) + 𝑔(𝑛)𝜉] − ( ) 𝑔(𝑛) − 𝑘[𝜉 − 𝜙(𝑛)]
𝑑𝑛 𝑑𝑛
𝑢 = −𝑘(𝑥23 + 𝑥3 + 𝑥25 + 𝑥3) + (2𝑥25 + 𝑥3) − 𝑥25 + 𝑥3 (𝑥13 + 𝜉) (6)
𝑉𝑜 𝑉𝑜 0 ∅1 ∅1
Ui = -K (x3-∅1 (𝑥1, 𝑥2) − [ 𝜉2 𝜉2 ] [ ] … [ 𝜉2
−𝑛12 + 𝑛2] + [0] 𝜉
𝜉2 ] [
𝑛1 𝑛1
1 𝑛1 𝑛1
0 1
𝑛̇ = 𝑓(𝑛, 𝜉) + 𝑔(𝑛)𝜉
𝜉 = 𝑓𝑎 (𝑛, 𝜉) + 𝑔𝑎(𝑛, 𝜉)𝑢
GRÁFICA 9: COMPORTAMIENTO DE LAS VARIABLES X 1, X 2 Y X3 GRÁFICA 10 :SIMULACIÓN DEL PUNTO INICIAL (-2,-0.5,-
CON RESPECTO AL TIEMPO EN CONDICIONES INICIALES (-2,- 7), SE OBSERVA QUE LA TRAYECTORIA TIENDE AL PUNTO
0.5,-7), SE OBSERVA QUE LAS TRES SEÑALES TIENDEN A CERO , (0,0,0)
GRÁFICA 11: COMPORTAMIENTO DE LAS VARIABLES X1, X2 Y GRÁFICA 13 :SIMULACIÓN DEL PUNTO INICIAL (10,-
X 3 CON RESPECTO AL TIEMPO EN CONDICIONES INICIALES (10,- 0.5.20), SE OBSERVA QUE LA TRAYECTORIA TIENDE AL
0.5,20), SE OBSERVA QUE LAS TRES SEÑALES TIENDEN A CERO , PUNTO (0,0,0)
𝑧̇1 = 𝑧2
𝑧̇2 = 𝑧3
𝑧̇3 = 𝑧4
2
−𝑧2 2 𝑚𝑔ℎ 𝑚2 𝑔2 ℎ
𝑧̇4 = 𝑠𝑒𝑛(𝑧1 ) + 𝑠𝑒𝑛(𝑧1 )𝑐𝑜𝑠(𝑧1 )
𝐽𝑙 𝐽𝑙 2
𝑘𝑠 𝐽ℎ 𝐽𝑙 𝑚𝑔ℎ𝐶𝑜𝑠(𝑧1 ) − 𝐽𝑙 2 𝐾𝑠 2 − 𝐽ℎ 𝐽𝑙 𝐾𝑠 2 𝑚𝑔ℎ
+( 2 ) (𝑧3 + 𝑠𝑒𝑛(𝑧1 ))
𝐽ℎ 𝐾𝑠 𝐽𝑙 𝐽𝑙
𝐾𝑠 𝐾𝑚 2 𝐾𝑔 2 𝐽𝑙 𝑚𝑔ℎ
− ( 𝑧4 − 𝑧 cos(𝑧1 ) + 𝑧2 )
𝐽ℎ 𝐽𝑙 𝑅𝑚 𝐾𝑠 𝐾𝑠 2
𝐾𝑠 𝐾𝑚 𝐾𝑔
+ 𝑢 (9)
𝐽ℎ 𝐽𝑙 𝑅𝑚
1
𝑉(𝜂) = 2 𝜂2 → 𝑉̇ (𝜂) = 𝜂𝜂̇ ∴ 𝑉̇ (𝜂) = 𝜂𝜉
Si 𝜉 = 𝜑(𝜂) → 𝑉̇ (𝜂) = 𝜂𝜑(𝜂)
Proponemos . 𝜑(𝜂) = −𝜂𝜉 2 → 𝑉̇ (𝜂) = −𝜂2 𝜉 2
𝜑=𝑢 ̂1
𝜀 = 𝑧3
𝑧 =𝜀−𝜑
𝜂
𝑓 = [ 2]
0
1
𝑔=[ ]
0
Por lo tanto queda de la siguiente manera:
𝜕𝑉 𝜕𝜑 𝜕𝜑 𝜕𝜑
= 𝜂1 + (𝜀 − 𝜑)(−)( ) 𝜂2 + (𝜑 − 𝜀)( ) 𝜂3 + (𝜑 − 𝜀)( )
𝜕𝜂 𝜕𝜂1 𝜕𝜂2 𝜕𝜂3
Si tenemos que:
𝜕𝜑 𝜕𝜑 𝜕𝜑 𝜕𝜑
=[ ]
𝜕𝜂 𝜕𝜂1 𝜕𝜂2 𝜕𝜂3
𝜕𝑉 𝜕𝜑 𝜕𝜑 𝜕𝜑
= [𝜂1 + (𝜖 + 𝜑) 𝜂2 + (𝜖 + 𝜑) 𝜂3 + (𝜖 + 𝜑) ] (13)
𝜕𝜂 𝜕𝜂1 𝜕𝜂2 𝜕𝜂3
𝐾(𝑍) = 𝐾𝜀 − 𝜑
𝑧2
𝑓(𝜂, 𝜀) = [𝑧3 ]
1
0
𝑔(𝜂, 𝜉) = [0]
𝜀
1 𝜕𝜑 𝜕𝜑 𝜕𝜑 𝑍2 𝜕𝜑
𝑈= (−𝐶 + [ ] [ 𝑍3 ] − 𝜉𝜂3 + 𝜉(𝜑 − 𝜀) )
𝐶 𝜕𝜂1 𝜕𝜂2 𝜕𝜂3 𝜕𝜂3
1 + 𝑍𝜀
1 𝜕𝜑 𝜕𝜑 𝜕𝜑 𝜕𝜑
𝑈= (−𝐶 + 𝑍2 + 𝑍3 + (1 + 𝑍𝜀) − 𝜉𝜂3 + 𝜉(𝜑 − 𝜀) )
𝐶 𝜕𝜂1 𝜕𝜂2 𝜕𝜂3 𝜕𝜂3
2.1.- Considere el siguiente sistema
𝒙˙ = 𝑨𝒙 + 𝑩𝒖
𝟏𝟎 𝟎
𝟎
𝟎𝟎 𝟎
𝑨=[ 𝟏 ] , 𝑩 = [𝟏 ]
−𝟏 −𝟏 𝟏
𝟑
diseñe un controlador por modos deslizantes tal qué los valores propios de la
dinámica equivalente sobre la superficie deslizamiento estén todos en −1.
0 1 −1
𝑇 = [1 0 0]
0 0 1
𝐴̅ = 𝑇𝐴𝑇 −1 (2)
1 0 0 0 1 0
0 1 -1 1 0 0
0 0 1 0 0 1
1 0 0 0 1 0
0 1 0 1 0 1
0 0 1 0 0 1
Resultado:
𝟎 𝟏 𝟎
−𝟏
𝑻 = [𝟏 𝟎 𝟏]
𝟎 𝟎 𝟏
0 1 −1 0 1 0 0 1 0
𝐴̅ = 𝑇𝐴𝑇 −1
= [1 0 0 ] [ 0 01 0 ] [1 0 1]
0 0 1 −1 3 −1 0 0 1
𝟏 𝟒
𝟏 𝟏 𝟒
𝟑 𝟑
̅ = [𝟏 𝟎 𝟏
𝑨 𝟏 ] Donde 𝑨𝟏𝟏 = [ 𝟑 ], 𝑨𝟏𝟐 = [ 𝟑 ]
𝟏
−𝟏
𝟐
−𝟑 𝟏 𝟎 𝟏
𝟑
De la expresión 3 tenemos:
𝟏 𝟒 𝟏 𝟒 4
𝟏] − [ ] [𝑀 𝑀 ] = [ 𝟏] − [ 𝑀1 𝑀
𝐴11 − 𝐴12 𝑀 = [𝟑 𝟑 1 2 𝟑 𝟑 3 2]
𝟏 𝟎 𝟏 𝟏 𝟎 𝑀1 𝑀2
𝟏 𝟒 4
− 𝑀 𝟏 − 𝑀2
𝐴11 − 𝐴12 𝑀 = [𝟑 𝟑 1 3 ]
1 − 𝑀1 −𝑀2
𝟏 𝟒 4
𝜆𝟎 − 𝑀 𝟏 − 𝑀2
𝜆𝐼 − (𝐴11 − 𝐴12 𝑀) = [ ] − [𝟑 𝟑 1 3 ]
𝟎𝜆
1 − 𝑀1 −𝑀2
𝟏 𝟒 4
𝜆 − ( − 𝑀1 ) 𝑀 −1
𝜆𝐼 − (𝐴11 − 𝐴12 𝑀) = [ 𝟑 𝟑 3 2 ]
𝑀1 − 1 𝜆 + 𝑀2
𝟏 𝟒 4
det(𝜆𝐼 − (𝐴11 − 𝐴12 𝑀)) = (𝜆 − ( − 𝑀1 )) (𝜆 + 𝑀2 ) − ( 𝑀2 − 1) ( 1 − 𝑀1 )
𝟑 𝟑 3
𝒅𝒆𝒕(𝜆𝐼 − 𝐴11 − 𝐴12 𝑀)
1 4 1 4 4 4
= 𝜆2 + 𝜆 𝑀2 − 𝜆 + 𝜆 𝑀1 − 𝑀2 + 𝑀1 𝑀2 − 𝑀2 + 𝑀1 𝑀2
3 3 3 3 3 3
+ 1 − 𝑀1
(𝑥 + 1)(𝑥 + 1) = 𝑥 2 + 2𝑥 + 1 (5)
1 4
𝑀2 −+ 𝑀 =2 (6)
3 3 1
5 8
1 − 𝑀2 + 𝑀1 𝑀2 − 𝑀1 = 1 (7)
3 3
5 7 4 8 7 4
1 − ( − 𝑀1 ) + 𝑀1 ( − 𝑀1 ) − 𝑀1 = 1
3 3 3 3 3 3
5 7 4 8 7 4
− ( − 𝑀1 ) + 𝑀1 ( − 𝑀1 ) − 𝑀1 = 0
3 3 3 3 3 3
32 20 56 35
−( ) 𝑀12 + ( + − 1) 𝑀1 =
9 9 9 9
32 67 35
−( ) 𝑀12 + ( ) 𝑀1 =
9 9 9
35
𝑀11 =
32
𝑀12 =1
Tomando
𝑀1 = 1
̅ de la siguiente manera
Determinamos la matriz 𝐻
̅=𝐻
𝐻 ̅2 [𝑀 𝐼] (8)
̅2 = [1]
Donde I es la matriz identidad y 𝐻
̅2 , 𝑀 𝑒 𝐼 en la expresión (3)
Sustituyendo 𝐻
̅ = [1][1
𝐻 1 1] = [1 1 1]
De la siguiente expresión:
𝐻=𝐻 ̅𝑇
0 1 −1
𝐻 = [1 1 1] [1 0 0]
0 0 1
𝐻 = [1 1 0]
Sabiendo que:
𝑈𝑒𝑞 = −[(𝐻 𝐵)−1 𝐻𝐴]𝑥
𝑈𝑒𝑞 = −𝐾 𝑥 (5)
𝐻𝑥
𝑈 = 𝑈𝑒𝑞 − 𝜌 ||𝐻𝑥|| (6)
𝐾 = (𝐻 𝐵)−1 𝐻𝐴
0 1 0
0 −𝟏
0 0 0
𝐾 = ([1 1 0] [1]) [1 1 0] [ 1 ]
1 −1 −1
3
Calculando la pseudoinversa de HB en Matlab
1
(𝐻 𝐵)−1 = [ ]
2
0 1 0
1 0 0 0
𝐾 = [ ] [1 1 0] [ 1 ]
2
−1 −1
3
0 1 0
1 1 0 0 0
𝐾=[ 0] [ 1 ]
2 2
−1 −1
3
𝟏
𝑲 = [𝟎 𝟎]
𝟐
𝟏
𝑥̇ (𝑿𝟏 , 𝑿𝟐 , 𝑿𝟑 ) = [𝑿𝟐 −𝑿𝟏 + 𝑿𝟐 − 𝑿𝟑 ]
𝟎
𝟑
𝟏 𝑿𝟏 + 𝑿𝟐 𝟏 𝑿𝟏 + 𝑿𝟐
𝟎 − 𝑿𝟐 − 𝝆 − 𝑿𝟐 − 𝝆
+[ 𝟐 𝟐 ]
√𝑿𝟐𝟏 + 𝑿𝟐𝟐 √𝑿𝟐𝟏 + 𝑿𝟐𝟐
𝑿𝟏̇ = 𝑿𝟐
𝟏 𝑿𝟏 + 𝑿𝟐
𝑿𝟐̇ = − 𝑿𝟐 − 𝝆
𝟐
√𝑿𝟐𝟏 + 𝑿𝟐𝟐
𝟏 𝟏 𝑿𝟏 + 𝑿𝟐
𝑿𝟑̇ = −𝑿𝟏 + 𝑿𝟐 − 𝑿𝟑 − 𝑿𝟐 − 𝝆
𝟑 𝟐
√𝑿𝟐𝟏 + 𝑿𝟐𝟐
Metiendo el sistema final en Matlab para simularlo con las siguientes condiciones
iniciales y 𝝆 = 10 resulta:
GRÁFICA 16: SIMULACIÓN DEL PUNTO INICIAL (10,-23,2),
GRÁFICA 15: COMPORTAMIENTO DE LAS VARIABLES X 1, X2 Y SE OBSERVA QUE TIENDE A LA SUPERFICIE X 1+ X2=0 Y
X 3 CON RESPECTO AL TIEMPO EN CONDICIONES INICIALES (10,- DESPUÉS AL ORIGEN
23,2) SE OBSERVA QUE LAS TRES SEÑALES TIENDEN A CERO ,
𝜃(0) = 0.2𝑟𝑎𝑑
0𝑟𝑎𝑑
𝜃̇(0) = 𝑠. 𝑥(0) = 0𝑚
𝑠
𝑥̇ (0) = 0𝑚/𝑠
Considerar los parámetros a1=0.415, a2=0.0198, b1=0.0111, b2=1.43, n=6.27 y
g=9.81
𝑥 = 𝑞3
𝑥̇ = 𝑞4 = 𝑞3̇
𝑥̈ = 𝑞4̇
𝑞2̇ = −𝑞1 𝑞2 − 𝑏𝑞4 + 𝑛𝛿
𝑞4̇ = 𝑔𝑞1 − 𝑎2 𝑞2 − 𝑏2 𝑞4 + 𝑔𝛿 (13)
𝑞1̇ = 𝑞2
𝑞2̇ = −𝑞1 𝑞2 − 𝑏𝑞4 + 𝑛𝛿
𝑞3̇ = 𝑞4
𝑞4̇ = 𝑔𝑞1 − 𝑎2 𝑞2 − 𝑏2 𝑞4 + 𝑔𝛿
𝑦 = 𝜃 − 𝜃𝑑 → 𝑦𝑞1 − 𝑞𝑑 = 𝛿
𝜋
𝑦̇ = 𝑞1̇ − cos(𝑡) = 𝛿̇
12
𝜋
𝑦̈ = −𝑎1 𝑞2 − 𝑏𝑞4 + 𝑛𝛿 − cos(𝑡) = 𝛿̈ (14)
12
0 < 𝑘𝑚 ≤ 𝑔(𝑡, 𝑥) ≤ 𝐾𝑀
Donde
|ℎ(𝑡, 𝑥)| ≤ 𝐶
En general sólo conocemos C, 𝑘𝑚 𝑦 𝐾𝑀 , que son parámetros que nosotros conocemos, mas
no conocemos las funciones h(x) ni g(x), por lo que se reajusta a lo siguiente:
𝛿̈ ∈ [−𝐶, 𝐶] + [𝑘𝑚 , 𝐾𝑀 ]𝑢
Con:
𝑧1 = 𝛿
𝑧2 = 𝛿̇
𝑧̇1 = 𝑧2
𝑧̇2 = ℎ + 𝑔𝑢
Despejando u:
1
𝑢= [−ℎ + 𝑘1 𝑧1 + 𝑘2 𝑧2 ] (15)
𝑔
De la dunción
𝑓(𝑡) = cos(2(3𝑡 − 5)) + 4𝑡
Se proponen el difeomorfismo
𝑧̇0 = 𝑣; 𝜎0 = 𝑧0 − 𝑓0 (𝑡) ; 𝜎0 = 0;
𝑧0 = 𝑓0 (𝑡) → 𝑓0 (𝑡) = 𝑣
𝜎̇0 = −𝑓0 (𝑡) + 𝑣, |𝑓0̈ | ≤ 𝐿
Donde
̇
𝑓0 𝑒𝑠 𝐿𝑖𝑝𝑐ℎ𝑖𝑡𝑧
𝑧 = 𝑓0 𝑣 = 𝑓0
𝜎(𝑡) = 𝑧0 − 𝑓0 (𝑡)
𝜎̇0 = 𝑧̇0 − 𝑓0̇ (𝑡) → 𝑓0̇ (𝑡) − 𝑣
1
𝑧̇0 = −𝜌1 |𝑧0 − 𝑓0 |2 𝑠𝑖𝑔𝑛(𝑧0 − 𝑓0 ) + 𝑧1 (9)
𝑧̇1 = −𝜌2 𝑠𝑖𝑔𝑛(𝑧0 − 𝑓0 ) (8)
G RÁFICA 23: R ESULTADO DEL SUPER TWISTING , LA SEÑAL SE QUEDA OSCILANDO Y YA NO CRECE
Ejercicio extra en clase
x* = A x + B u;
1 0 2
𝐴 = [−1 1 0]
2 2 −1
1 2
𝐵=[ 0 1]
−1 −1
T*B=𝐵̅
−1 1 −1
𝑇 = [ 1 −2 0 ] ;
1 0 1
2 1 2
𝑇 −1 = [ 1 0 1 ];
−2 −1 −1
Así 𝐵̅ 𝑟𝑒𝑠𝑢𝑙𝑡𝑎:
0 0
̅
𝐵 = [ 1 0]
0 1
𝐴̅ =T*A T;
−1
𝑀 = [ ];
−2
Caluclando:
̅=𝐻
𝐻 ̅2 [𝑀 𝐼] (9)
̅2 = [1
Donde I es la matriz identidad y 𝐻
0
]
0 1
̅2 , 𝑀 𝑒 𝐼 en la expresión (3)
Sustituyendo 𝐻
̅ = [1 0] [−1 1 0] = [−1 1
𝐻
0
]
0 1 −2 0 1 −2 0 1
De la siguiente expresión:
𝐻=𝐻 ̅𝑇
−1 1 −1
−1 1 0
𝐻=[ ] [ 1 −2 0 ]
−2 0 1
1 0 1
2 −3 1
𝐻=[ ]
3 −2 3
Sabiendo que:
𝑈𝑒𝑞 = −[(𝐻 𝐵)−1 𝐻𝐴]𝑥
𝑈𝑒𝑞 = 𝐾 𝑥 (10)
(11)
Por lo tanto y realizando el producto de las matrices, resulta:
𝐾 = (𝐻 𝐵)−1 𝐻𝐴
1 2 −1 1 0 2
2 −3 1 2 −3 1
𝐾=[ ][0 1] [ ] [−1 1 0]
3 −2 3 3 −2 3
−1 −1 2 2 −1
𝐾=[
1 0] [ 7 −1 3]
0 1 11 4 3
7 −1 3
𝐾=[ ]
11 4 3
Finalmente U queda:
𝐻𝑥
𝑈 = −𝑘𝑥 − 𝜌
||𝐻𝑥||
G RÁFICA 25: SIMULACIÓN DEL PUNTO INICIAL (-6-2-1), SE OBSERVA QUE TIENDE A LA
INTERSECCIÓN DE LAS SUPERFICIES 3 X1-2 X2+3X3=0 CON 2X1-3X2+X3=0 Y DESPUÉS AL ORIGEN