Lesson21 Notes
Lesson21 Notes
2
II Inverse Dynamics control IDC
A Joint space IDC SHV 9.3.1
I PD Joint Control
i
Mg if C
q g of Glg u
eliminate it w PD control
gfettf.me
e ki
PE PXq.FI q
where 5 0 is
q tK q qe
1 11
i
diag Is
no is
in s
E L M C G
g if q g q k
q q 0 links
K
Jg
motors
q2 q u
of
2n equations
motion
Define PD control law
Let kpqz ka.ge where
u
q 92 qa
for const set point qd ER
a i e using motorfeedback
collocated
erectroff
SHU Prob 9 3 0,0
q qz g qa qa
is G A S
by Lasalle
because VG is radiallyunbounded
Not
easy with gravity need to use feedback linearization
a
glt Kp ka
Feedforward Ledack
a
qᵈ t Kp q q t Ka q q t
Kaqi Kp q 0
qg 0,0 is G E s q
t q't
t as
tinal control law
u M q
FÉÉkaj ccq.gl Gq
t.fi
IEiiigIf
Outer loop couldalternatively insert desired
dynamics instead of tracking a reference
trajectory
Ag Ñ q5 v
Cq g q Gq
where Ñ ER I C IR I EIR are
and v is new
input in the shaped
dynamics
a
Mq Eqt G v