Professional Documents
Culture Documents
9 Degree of Freedom Problem
9 Degree of Freedom Problem
problem
Gregor Schöner
gregor.schoener@ini.rub.de
Spaces for robotic motion planning
Author'
task level planning is
about end-effector pose564 C. Faubel, G. Schöner
in space (e.g,. 3
translational and 3
rotational degrees of
freedom)
configuration space
planning: joint angles of
actuated degrees of
freedom
Forward kinematics
(x,y)
l2 θ2
where is the hand, given
the joint angles.. l1
θ1
(x,y)
where is the hand moving,
given the joint angles and
velocities l2 θ2
l1
·x = J(θ)θ·
θ1
(x,y)
where is the hand moving,
given the joint angles and
velocities l2 θ2
l1
·x = J(θ)θ·
θ1
0 1 0 1 0 1
B ẋ C B l1 cos(✓1) l1 cos(✓1 + ✓2) l2 cos(✓1 + ✓2) C B ✓˙1 C
@ A = @ A·@ A
ẏ l1 sin(✓1) + l2 sin(✓1 + ✓2) l2 sin(✓1 + ✓2) ✓˙2
Inverse kinematics
(x,y)
exact solution: θ1
θ = f −1(x)
where I want it?
Inverse kinematics
✓1 = arctan2 (y, x) ±
l2
what joint angles are
✓2 = ⇡ ± ↵
needed to put the hand
at a given✓location
2 2
l1 + l2 r 2
◆
l1 (x, y)
1
↵ = cos ↵
exact solution: 2l1 l2
✓ 2 2 2
◆ r
1 r + l 1 l2
= cos
θ = f −1(x) 2l1 l2
(x,y)
which joint velocities to
move the hand in a
particular way l2 θ2
1 0 l1 1 0
ẋ C Bθ· = lJ1−1
cos(✓
(θ)x·1 ) l1 cos(✓1 + ✓2 ) l2 cos(✓1 + ✓θ2) C B ✓˙
A = @ 1 A·@
ẏ l1 sin(✓1) + l2 sin(✓1 + ✓2) l2 sin(✓1 + ✓2) ✓˙
with the inverse of
0 1
B l1 cos(✓1) l1 cos(✓1 + ✓2) l2 cos(✓1 + ✓2) C
J(✓) = @ A
l1 sin(✓1) + l2 sin(✓1 + ✓2) l2 sin(✓1 + ✓2)
if it exists!
Spaces for robotic motion planning
·x = J(θ) ·
Author'
kinematic model x = f(θ) θ
·
inverse kinematic model θ = f −1(x) θ = J−1(θ)x·
564 C. Faubel, G. Schöner
transform end-effector
to configuration space
through inverse
kinematics
problems of singularities
and multiple “leafs” of
inverse…
Redundant kinematics
(x,y) 3
redundant arms/tasks:
more joints than task-level 2
degrees of freedom
(x,y)
·x = J(θ)θ·
motion
·
θ = J+(θ)x·
muscles/muscle groups
1
but: assess to which extent they
can be activated
independently… x= l cos( 1) + l cos( ) + l cos( )
y= l sin( 1 ) + l sin( ) + l sin( )
.. mode picture
Degree of freedom problem
in human movement
for most tasks, there are many more (x,y)
degrees of freedom than task
constraints…
e.g., 10 joints in the upper arm including scapular
joints to control hand position and orientation
(3 to 5 or 6 DoF)
r
DoF/muscles
Classical synergy concept
motor commands
variation here
command varies in
time or across tasks
=> covariation of
these muscle
activations / DoF leads to
movements co-
variation
here DoF/muscles
Classical synergy research strategy
identify distinct synergies with the hope of
finding a limited set => “the” synergies that
explain multi-degree of freedom movement
combine the time series of muscles/DoF under
different conditions (sometimes including
repetitions of movements) into one big data set
and look for structure (e.g. principal
components)
if a small number of PC’s is sufficient to account
for most of the variance, conclude that few
synergies at at work
160 LOW-DIMENSIONAL RECRUITMENT OF
random
leads to co- variance here:
variation here uncorrelated
DoF/muscles
Concept of the UnControlled Manifold
(x,y)
!3 (rads)
align trials in time
hypothesis about task variable r a d s)
!1 (
!2 (
rads
compute null-space (tangent to )
the UCM) 3 C
1.5 1
0.6
Figure 4. Depiction of hypothetical clouds of data points c
0 0.2
relationship to the UCMs depicted in Figure 3. In Figure 4
major axes of the ellipses is oriented parallel to the UCMs
UCM synergy: data analysis
1.5 1
Sternad...)
0.6
0 0.2
1.5 1
0.6
0 0.2
Example 1: pointing with 10 DoF arm at targets in 3D
UCM
orthog UCM
Example 2: shooting with 7 DoF arm at targets in 3D
0.2
shoulder
0.15
back sight
vertical [m]
0.1 of gun
0.05
-0.05 wrist
Elbow
-0.1 0.4
0.4 0.3
0.3 0.2 0.1 0.2
0.1 0 0 ]
anterior-po a t e r a l [m
sterior [m] dial- l
me
0 20 40 60 80 100 0 20 40 60 80 100
percent of trajectory percent of trajectory
[from Scholz, Schöner, Latash: EBR 135:382 (2000)]
variance
within
variance
UCM
perpendicular
to UCM
Synergy: critique of concept
motor commands
variation here
arm in space
T1 [Martin, Reimann, Schöner, 2018]
T2 2
M4 S3 M
M1
M3
S2
S1
on Subject 1
Experimental setup and kinematics.
Subject 2 Subject 3 Model
0.1
Variance (rad2)
on
gue Dr. John Scholz at the University of Delaware.
volunteers between 21 and 35 years of age volun-
to participate in this study. Participants gave in-
d consent. All three participants
Normalized Time wereNormalized
right-handedTime Normalized Time Normalized Time
sed their right arm to reach to the targets.
sterno-clavicular shoulder elbow wrist
Subject 1 Subject 2 Subject 3 Model
Variance/DoF (rad2)
0.08 Ext.
Movement 1
Dir.
0.04
Variance/DoF (rad2)
0.08
Movement 2
0.04
Variance/DoF (rad2)
0.08
Movement 3
0.04
Variance/DoF (rad2)
0.08
Movement 4
0.04
To implement the model, the matrices J(λ), E (λ), J̇(λ), and Ė T (λ) are
puted analytically.
=> control is stable in range space
2.7 Muscle-Joint Model. The virtual joint configuration λ and ve
λ̇ drive the
=> muscle jointstable
marginally systems. These are space
in UCM/null modeled by reducing a de
nonlinear muscle model (Gribble et al., 1998) to its essentials, limitin
number of parameters. First, we fuse all muscles acting onto a given
where does this come from?
start with pseudo-inverse of: v=J˙
˙ = J +v
¨ = J + v̇ ˙ +
[+J v ⇡ 0]
a neuron, n, encoding rate of change of n= ˙
:
+
ṅ = J v̇ <= insert timing signal v̇ = v + u
ṅ = J ( v + u) <= insert v = J ˙
+
ṅ = J ( J ˙ + u) <= replace n = ˙
+
+
ṅ = J ( Jn + u)
ṅ = J + Jn + J + u
where does this come from?
+ +
ṅ = J Jn + J u
+ +
ṅ = n+n J Jn + J u
+ +
ṅ = n + (1 J J)n + J u
projection feed-
onto null- forward
space from timing
command
where does this come from?
feed-
forward
from timing
command
+ +
ṅ = n + (1 J J)n + J u
projection
onto null-
space
how does this do the UCM effect?
projection feed-forward
onto null- from timing
space command
ṅ = n + (1 J + J)n + J + u
within the range-space ṅ
attractor
+
ṅ = n+J u
n
=> stability within the range-space
J +u
how does this do the UCM effect?
projection feed-forward
onto null- from timing
space command
ṅ = n + (1 J + J)n + J + u
within the null-space ṅ
ṅ = n+n+0 no attractor
n
ṅ = 0
=> no stability within the null-space
Conclusion
The problem of inverse kinematics is part of the
broader “degree of freedom problem”
Neither robots nor human movement systems
can use a simple 1:1 optimal solution, but must
allow self-motion to avoid drifts into singular
configurations
Humans have considerable self-motion and
stabilize movement much less within the UCM
(self-motion) space than orthogonal to it
Beyond the feed-forward few-to-many
mappings, this involves compensatory coupling
among motor commands.