A Momentum-based Bipedal Balance Controller Yuting Ye May 10, 2006.
Post on 17-Dec-2015
219 Views
Preview:
Transcript
A Momentum-based Bipedal Balance ControllerYuting Ye
May 10, 2006
Outline
• Motivation
• Resolved momentum control
• Implementation and discussion
• Result and conclusion
• Future work
Motivation
• Motion Capture– Ground truth kinematics– Apply to different skeleton
• Motion retargeting [M. Gleicher 1998]
– Interpolation for motion synthesis• Motion graphs [L. Kovar et al. 2002]
– NO kinetics• Violate physical rules
– Cannot record everything• Falling, martial art combat• Re-capturing is expensive
Motivation
• Physical simulation– Physically correct (somewhat)– Hard to develop, parameters tuning
• Composable [P. Faloutsos et al. 2001]
– What to simulate?• Reactive [V. Zordan et al. 2002]
– Balance is a big problem!
• Constraints– Data driven and physically correct– Objectives and constraints? (momenta)– Expensive
Motivation• The robotics community
– S. Kajita et al. 2003, Resolved momentum control: humanoid motion planning based on the linear and angular momentum
– Simple control schema for whole body motion– Works on humanoid robots -- balanced– Is it general enough?Don’t be scared by the equations, just high school level physics
Resolved momentum control
• Skeleton
head
Hip
WaistLeft
femur
Left tibia Right
humerus
Right femur
Left radius
Right radius
Torso
Left humerus
Right tibia
Right foot
Left foot
Left hand
Right hand
Data from D. A. Winter, 2005, “Biomechanics and Motor Control of Human Movement, 3rd Edition”
Resolved momentum control• Basic idea
–To control the linear and angular momenta with the motion of joints
B
BcB
B
BcBB
H
M
I
rmEm
L
P
HIL
MrmEmP
~ˆ~
0
~
~ˆ~~
~
~
0
0
0
ˆ
01
02
12
rr
rr
rr
r
Resolved momentum control
• Calculate the inertia matrices
jjjj
jjjjj
jjj
jjjjjj
jjjjjjj
Imc
mrc
IPcL
mrcP
hm
hm
~~
~)~(
~~
~)~(
jr
jm~
jc~
Resolved momentum control
• Calculate the inertia matrices
1111
11
~~1111
~~~~1
1111
11
ˆˆ
ˆˆ~~~)~()~~(~
~~
jjjj
jjjj
ccT
ccjjT
jj
ccT
ccjjj
jjjjjjj
jjj
rrmRIR
rrmII
mmcmcmc
mmm
jjjj
jjjjj
Imc
mrc
hm
~~
~)~(
jm
~
1jm
1jcjc
~
j-1
j
Resolved momentum control
• Calculate the inertia matrices
McHH
H
M
n
n
hhhmmm
~̂
...
...
0
210
21
HIL
MrmEmP
B
BcbB
~ˆ~~
~
Resolved momentum control
• Modeling ground contact–Specify motions of the feet
ii leglegB
BifB
if
if JE
rE
0
ˆ
B
BifB
if
if
legleg E
rEJ
ii
0
ˆ1
Resolved momentum control•Calculate the Jacobian matrix
–Same as in inverse kinematics
jj
f
jjj
f r
j
13
2
End Effector
??
? eJ )(1
)( jjj
rSS
S
e
Resolved momentum control
• Putting things together
freefree
freeleg
rli leg
leg
B
BcB
H
M
H
M
I
rmEm
L
Pi
i
i
,
~
~ˆ~
0
~
if
if
legrli leg
leg
free
B
B
free
free
rli
ifBleg
leg
legcB
i
i
i
i
i
i
JH
M
H
M
E
rEJ
H
M
I
rmEm
L
P
1
,
,
1~
0
ˆ~
ˆ~
0
~
B
BifB
if
if
legleg E
rEJ
ii
0
ˆ1
Resolved momentum control• Putting things together
if
if
legrli leg
leg
ref
ref
i
i
i JH
M
L
Py
1
,
free
free
rli
ifBleg
leg
legcB
H
M
E
rEJ
H
M
I
rmEmA
i
i
i
,
1~
0
ˆ~
ˆ~
0
~
free
B
B
Ay
Resolved momentum control• Putting things together
ref
ref
ref
free
B
B
free
B
B
AAEyA
)(
B
BifB
if
if
legleg E
rEJ
ii
0
ˆ1
Implementation and Discussion• ODE – Physical simulation
–Compensation for resolving collision: small timestep–30 frames/sec, 30/10 iterations per frame
• Select what to control
Ts
Ts
le
e
S ...1
ise -- a 6x1 column vector that has
1 at sith row and 0 for the rest
free
B
B
ASyS
TeeeeS ][ 5210e.g.
Implementation and Discussion•Analogy to inverse kinematics
–Replace the end effector with momenta and velocities
•Partial derivative, SINGULARITY
–Matrix inversion•Pseudo Inverse
• SVD•Damped Least Squares
11 )()( TTT JJJJJJ
0)( JJEJ
121 )( EJJJJ TT
Implementation and Discussion•Example
Implementation and Discussion• PD servo for reference values
–Proportional Plus Derivative (PD) Feedback System
Kp is the spring factor and Kd is the damping factor
• Get the reference values
0
~)~~(~
ref
dpref
L
cKccKmP ref
dp KKref
)()()( xxKxxmKxf refdp
ref
Implementation and Discussion• PD Controller
–For one leg–Tune the gains for each joint – scale by inertia
jjj
refd
refpjj KKI
11~
)()(
Results•Simplest case
Max Force: 100, 250
Push: [-600 600]
Results•Single leg, multiple 1D joints
Max Force: 200
Push: -350, 350
Results•Unstable
Results•Humanoid - stand
Results•Humanoid – slightly pushed
Max Force: 1500
Push: 900
Conclusion
• A simple control schema– Few parameters to tune
• Stable
• Fits well in data-driven simulation
• Matrix singularity– Highly sensitive to any error
• Good understanding of physics required
Future work
• Ground contact
• Integrated with motion capture data– Obtain the reference values
• Walking, protective steps
– Replicate the motion with reaction
• Interpolation– Finding transition points; as constraints
• Motion composition– Momenta of kicking + jumping
= jumping kick?
Thank YOU!!!
• Questions and comments?
top related