Taller Linealización
Taller Linealización
Taller Linealización
q1
m1
m2
r1
T1
r2
y
y
q2
la longitud
T2
es el par
donde,
m2
r2
q2
m1
r1
q1
m2=1.5 kg ,
J 1=J 2=0.5 kg -m y
r 1=1 m ,
g=9.81m/seg 2 .
r 2=0.8 m ,
m1=0.5 kg ,
x 1=q1 ,
y=h ( x , u) . Siendo
x 2=q a 2 ,
q1
b. Encuentre
x 4= q 2 . Considere
q 2 y las entradas
q 2 de la ecuacin de
Sugerencia: despeje
ecuacin de
x 3=q 1
T2
x =f (x , u) ,
T1
T2 .
y reemplcela en la
T1 .
T1
T2
para que
q1 = /2 ,
q 2= /4 ,
q 1 =0
q 2=0
x ,
( )( ) (
)() ( )
2
a b q 1 + d q12 d q 1 q 2 + e = T 1
b c q 2
f
T2
d q 22
Donde:
c=r 2 m2 +J 2
d=r 1 r 2 m2 sin ( q 2 )
e=r 2 m2 gcos(q1 +q 2)+ ( m1 +m2 ) r 1 g cos ( q 2 )
f =r 2 m2 gcos ( q 1+ q2 )
1
T
Despejando
q 2
de (2) tenemos:
T 2b q 1d q 22f
q 2=
(3)
c
T 1 =a q 1 +b
(T 2b q1d q 22f )
d q 122 d q 1 q 2+ e
c
q 1
Ahora, despejo
2
b T 2 b q 1
bd q22
bf
T 1 =a q 1 +
d q212 d q 1 q 2 +e
c
c
c
c
2
b T2
bd q22
b
bf
T 1 =q 1 (a )+
d q212 d q 1 q 2 +e
c
c
c
c
bd q
bf
+ + d q 21+ 2 d q 1 q 2e
bT
c
c
T 1 2 +
c
b2
(a )
c
q 1=
2
2
+d q 1+2 d q 1 q 2e
b
T 1 (T 2d q 22f )
c
b2
(a )
c
q 1=
Ahora reemplazamos
b
T 1 (T 2d q 22f )
c
q 1
en la ecuacin (3)
2
+d q 1+2 d q 1 q 2e
2
( a
T 2b
q 2=
b
)
c
d q22f
x 1=q
x 2=q
3= x 1=q1
x
4= x 2=q 2
x
Entonces, tenemos:
x 1=x3
x 2=x 4
x 3=q 1
x 4= q 2
+d x3 +2 d x3 x 4e
b
T 1 (T 2d x 24f )
c
b2
(a )
c
x3 =
2
+ d x 3 +2 d x 3 x 4 e
b
T 1 (T 2d x 24 f )
d x 24 f
2
c
b
(a )
c
T 2 b
c
x 4 =
y=
x1
x2
()
x 1=x3 =0
x 2=x 4=0
b
x 3=0=T 1 (T 2f )e
c
x 4=0=T 2f
Reemplazando en
b
0=T 1 (f f )e
c
T 2 =f
x 3 :
T 1 =e
Entonces, reemplazando f y e:
r 1=1 m ,
r 2=0.8 m ,
m1=0.5 kg ,
m2=1.5 kg ,
J 1=J 2=0.5 kg -m
g=9.81m/seg 2 .
Punto de equilibrio:
q1 = /2 ,
q 2= /4 ,
Reemplazando valores:
( 2 + 4 )
T 1 =5,55
T 2 =8,32
x=
x3
x4
()
u=
T 15,55
T 2 +8,32
y=
x1 /2
x 2 /4