d dt - LaDiSpe

Transcript

d dt - LaDiSpe
116
CAPITOLO 5. DINAMICA DEL MANIPOLATORE
d
Primo termine:
dt
∂L
∂ q̇i
.
Considerando le (5.32) e (5.33) risulta
d ∂L
d ∂ (C(q, q̇) − P(q))
=
dt ∂ q̇i
dt
∂ q̇i
d ∂C(q, q̇)
=
dt
∂ q̇i
!
d P
=
Hij (q)q̇j
dt j
=
P
Hij (q)q̈j +
j
dove
(5.38)
P dHij (q)
q̇j
dt
j
X ∂Hij (q)
dHij (q)
q̇j =
q̇k
dt
∂qk
(5.39)
k
da cui risulta alla fine:
X
X X ∂Hij (q)
d ∂L
=
q̇k q̇j
Hij (q)q̈j +
dt ∂ q̇i
∂qk
j
j
(5.40)
k
Secondo termine: −
∂L
∂C
∂P
=−
+
.
∂qi
∂qi
∂qi
Esaminiamo i due contributi a destra del segno di uguaglianza:
primo contributo:


n
n
n
n
1 X X ∂Hjk (q)
∂ 1 X X
∂C
Hjk (q)q̇j q̇k  = −
=−
q̇j q̇k
−
∂qi
∂qi 2 j=1
2 j=1
∂qi
k=1
k=1
(5.41)
secondo contributo:
n
n
X
X
∂r 0,cj (q)
∂P
(j)
=−
=−
mj γ T
mj γ T J Li (q)
∂qi
∂q
i
j=1
j=1
(5.42)
Sostituendo le espressioni dei due contributi nella formula (5.20), ed evidenziando la dipendenza dalle variabili giunto, avremo alla fine la seguente espressione:
X
X
X dHij (q)
1 X X ∂Hjk (q)
(j)
q̇j −
q̇j q̇k −
mj γ T J Li (q) = Fi
Hij (q)q̈j +
dt
2
∂q
i
j
j
j
j
k
ovvero
X X ∂Hij (q)
X
1 X X ∂Hjk (q)
q̇k q̇j −
q̇j q̇k
Hij (q)q̈j +
∂qk
2 j
∂qi
j
j
k
k
X
(j)
−
mj γ T J Li (q) = Fi
j