View
52
Download
0
Category
Preview:
Citation preview
Screw Kinematics
THE CAUSATION OF EVENTS
• A special kind of mechanical event involving two detached objects and two successive displacements is an articulation, in which the first displacement causes the second. It is a superordinate event with two subordinate events.
• Joints are modeled using unit twists.• The question of whether or not such causation
could be perceived.
A linear chain of rigid bodies
Velocity Kinematics• Twists are used to describe the motion of rigid bodies. The
relative motion twist between two joined bodies is split into two parts.
• The unit twist conveys the geometrical information; whereas, the constitutive portion is the magnitude. If the joint has a single degree of freedom then it can be modeled by a screw. For example, a revolute joint is modeled by a zero pitch screw and a prismatic joint by an infinite pitch screw. The joint axis thus represented by a unit twist s. The twist magnitude represents the joint speed.
rv sq where s is a unit twist and 𝑞ሶ is the twist magnitude
• This notation is extended to multiple degrees of freedom with multiple sequential screws, such that
1 1 2 2 ...r
k ks q s q s qv
Where k is the number of degrees of freedom, 1s through ks the unit twists representing each joint,
and 1q through kq each joint speed.
Equation 1 1 2 2 ...r
k ks q s q s qv is compacted into
r sqv
Where s is the 6 k joint matrix
1 2 ... ks s ss
And q the 1k joint speed matrix
A slider pin joint model
And q the 1k joint speed matrix
1
2
k
q
q
Each column of s represents a base screw for the subspace of relative motions between joined bodies.
A slider pin joint is modeled with the slider in the x the direction and the pin about z axis. The individual joint axes are
1
00000
x
s
2
00000z
s
The 6x2 matrix joint space is
1 2
00
s s
xz
s
The Basis Screw
• Joints are modeled as the basis screw of the relative motion between bodies.
• The velocity difference between two successive bodies is proportional to the screw axis of the joint between them.
• The relative acceleration between bodies contains a part along the joint axes as well as bias acceleration in other direction.
The knee joint connects femur to tibia
1i i i is qv v
Acceleration Kinematics
The acceleration kinematics are defined by
substituting 1i i i is qv v into vt
a
for each body i
The change of the velocity twist with time is the spatial acceleration.
1
1
1
( )
( )
i i
i i i
i i i
ii i i i
vt
v s qt
a s qt
sa s q qt
a
where ia and 1ia are the spatial accelerations of bodies i and i-1. is is the joint axis, iq the joint speed, and iq the joint acceleration. In order to calculate the rate of change of is the joint axis
is expanded from 0P
rv
into
i
e r es
e
Where is the joint axis pitch, e is its direction, and r its location. It is known from
[1]
1. Featherstone, R. Robot dynamics algorithms. Kluwer: 1987.
The rate of change of any vector e fixed to a moving rigid body is
e et
The rate of change of the joint axis
( ) ( )
( ) ( )
0
i e r eset t
e r et t
et
re r e et
e
v e r ee
Which is generalized as
ii
s v st
Where v is the velocity twist
And v is the spatial cross product operator.
0
vv
Let joint i connect body i to body i-1, then the accelerations are related by
1i i i i i i ia a s q v s q
The bias acceleration term i i iv s q is the
convective acceleration of the joint is .
Recommended