Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Robótica II - Notas de La Clase 3 - 14 de Mayo 2020 PDF
Robótica II - Notas de La Clase 3 - 14 de Mayo 2020 PDF
Se puede utilizar un controlador PI para controlar la dinámica eléctrica del motor y ası́ asegurar que sea más
rápida que la dinámica mecánica. La perturbación kb puede tomarse como constante, la cual será contrarrestada
por la acción integral del PI.
Control 1 1
Notas de la clase 3 Vázquez Garcı́a Carlos Ernesto
Tenemos un sistema MIMO definido por las siguientes entradas U (s), salidas Y (s) y matriz de transferencia G(s):
" # " #
θ(s) V (s)
Y (s) = ; U (s) =
I(s) τl (s)
Y (s) = G(s)U (s)
θ(s) θ(s)
V (s) τl (s)
G(s) =
I(s) I(s)
V (s) τl (s)
1 Km Ls + R
G(s) =
d(s) (Js + B)s Kb s
Control 1 2
Notas de la clase 3 Vázquez Garcı́a Carlos Ernesto
J
Mecánica: J θ̈ + B θ̇ = km i − τl = τe − τl =⇒ τM =
B
di L
Eléctrica: L + Ri = V − Kb θ̇ =⇒ τE =
dt R
θ x1
el estado x del sistema podrı́a definirse con las variables x = θ̇ = x2
i x3
x2
θ̇
1
τl
θ
θ̈ (−Bx + K x − τ )
ẋ = = J 2 m 3 l u= ; y=
di 1
v i
dt (−Kb x 2 − Rx 3 + V )
L
0 1 0 0 0
B Km 1
0 − − 0
A= J J ;
B=
J
Kb R 1
0 − − 0 −
L L L
1 0 0 0 0
C= ; D=
0 0 1 0 0
Mecánica: J θ̈ + B θ̇ = τe − τl
Eléctrica: Lτ˙l + Rτe = Km V − Km Kb θ̇
θ x1
el estado x del sistema podrı́a definirse con las variables x = θ̇ = x2
τe x3
x2
θ̇ 1
(−Bx + x − τ )
τl θ
ẋ = θ̈ =
J
2 3 l u= ; y=
1
v i
τ˙e (−Km Kb x2 − Rx3 + Km V )
L
0 x2 0 0 0
B −1
0 − 1 ; 0
A= J B=
J
Km Kb R km
0 − − 0 −
L L L
1 0 0
0 0
C= 1 ; D=
0 0 0 0
Km
Control 1 3
Notas de la clase 3 Vázquez Garcı́a Carlos Ernesto
Mecánica: J θ̈ + B θ̇ = τe − τl
...
... J θ + B θ̈ = τ˙e − τ˙l
L(J θ + B θ̈ + τ˙l ) + R(J θ̈ + B θ̇ + τl ) = Km (V − Kb θ̇)
...
LJ θ + (LB + RJ)θ̈ + (RB + Km Kb )θ̇ = Km V − Lτ˙l − Rτl
θ x1
el estado x del sistema podrı́a definirse con las variables x = θ̇ = x2
θ̈ x3
Note que es un estado puramente mecánico.
x2
θ̇
ẋ = θ̈ =
x3
... 1
θ (−(RB + Km Kb )x2 − (LB + RJ)x3 + Km V − Lτ˙l − Rτl )
LJ
0 1 0
0 0
∂f 0 0 1 ∂f 0 0
A= = ; B= =
∂x −(RB + Km Kb ) −(LB + RJ) ∂u R km
0 − − − −
LJ LJ LJ LJ
1 0 0 0 0
C= B J ; D= 1
0 0
Km Km Km
τe 1
i= = (J θ̈ + B + θ̇ + τl )
Km Km
Para comprobar que las realizaciones son correctas, la matriz de transferencia resulta en:
Control 1 4
Notas de la clase 3 Vázquez Garcı́a Carlos Ernesto
1
=⇒
(Jef f s + Bef f )s
4.1. Control P
C(t) = Kp
Control 1 5
Notas de la clase 3 Vázquez Garcı́a Carlos Ernesto
4.2. Control PD
Kp + Kd s −Kp
C(t) = , donde β =
Kd (s + β) Kd
Control 1 6
Notas de la clase 3 Vázquez Garcı́a Carlos Ernesto
4.3. Control PI
Ki Kp s + Ki Kp (s + γ) Ki
C(t) = Kp + = = , donde γ =
s s s Kp
Control 1 7
Notas de la clase 3 Vázquez Garcı́a Carlos Ernesto
Control 1 8
Notas de la clase 3 Vázquez Garcı́a Carlos Ernesto
Control 1 9
Notas de la clase 3 Vázquez Garcı́a Carlos Ernesto
∂f ∂f ∂2f ∂2f
ẋ = f (x, u) = f (xo , yo ) + (x − xo ) + (u − uo ) + 2
(x − xo )2 + (u − uo )2 + ...
∂x ∂u ∂x ∂u2
∂f ∂f
ẋ = f (x, u) = f (xo , yo ) + (x − xo ) + (u − uo )
∂x ∂u
Redefiniendo las variables:
x̄ = x − xo
ū = u − uo
∂f
A=
∂x
∂f
B=
∂u
Derivando x̄:
u = ū + uo
ū =⇒ P D
u¯o =⇒ g(q d )
Control 1 10
Notas de la clase 3 Vázquez Garcı́a Carlos Ernesto
1
(KpS + Ki)
G(s) = L
(s + ωn )2
Ki
go = lı́ms→∞ G(s) = L2
ωn
Control 1 11