Unit 4 (Velocity and Static Force Analysis)
Unit 4 (Velocity and Static Force Analysis)
COURSE OUTCOMES
On completion of the course the students will be able to
UNIT – II 9
End Effectors: Types of end effectors - Mechanical Gripper - Vacuum cup - Magnetic
gripper - Special types of grippers- Gripper force analysis. Frame Transformation:
Descriptions: Position, Orientation and Frames - Matrix representation: Point, vector,
frame and rigid body - Homogeneous Transformation matrices – Representation:
Translation, Rotational and Combined transformation – simple problems.
UNIT – III 9
Robot Kinematics: Forward and inverse kinematics – Equations for position and
orientation – Denavit- Hartenberg Representation of forward kinematic equations: Two
and Three link planer, PUMA and SCARA - Inverse kinematic equation: Two and three
link planer.
UNIT – IV 9
Velocity and Static Force: Introduction - Linear and angular velocities of a rigid body
- Velocity propagation – Derivation of the Jacobian for serial manipulator –
Identification of Singularities - Static force analysis of serial manipulator.
UNIT – V 9
Robot Dynamics: Acceleration of a rigid body - Inertia of a link - Equation of motion:
Legrangian formulation – Euler- Lagrange formulation - Newton Euler formulation.
Trajectory Planning: Joint space trajectory: Point to point and Continuous path
planning - Cartesian space trajectory – Simple problems.
TOTAL: 45
BOOKS:
1. Groover M.P., “Industrial Robotics, Technology, Programming and Applications”,
2nd Edition, Tata Mcgraw-Hill, New Delhi, 2012.
dt t 0 t
We are calculating the derivative of Q relative to frame B.
Differentiation of position vectors
A velocity vector may be described in
terms of any frame: A
d
A B
VQ
dt
B
Q
We may write it:
A B
VQ R VQ .
A
B
B Speed vector is a free vector
Magnitude of B
A
C C
U
Linear velocity of a rigid body
We wish to describe motion
of {B} relative to frame {A}
A
If rotation R VQ VBORG R VQ
A A A B
B B
is not changing with time:
Rotational velocity of a rigid body
Two frames with coincident origins
The orientation of B with
respect to A is changing
{A}
A
B {B}
B
Q
in time.
Lets consider that vector
Q is constant as viewed
from B.
B
VQ 0
Rotational velocity of a rigid body
In general case: A
VQ A ( BVQ ) A B A Q
A
VQ R VQ B R Q
A
B
B A A
B
B
Simultaneous linear and rotational
velocity
A
VQ VBORG R VQ B R Q
A A
B
B A A
B
B
Motion of the Links of a Robot
Written in frame i
At any instant, each link of a robot in motion has some linear and
angular velocity.
Velocity of a Link
i 1 ˆ
i 1 i Ri1 Z i1.
i i
i 1
i
Velocity Propagation From Link to Link
i 1
0
Note that:
i 1
i 1
Z i 1
0
i 1
By premultiplying both sides of previous
equation to: i 1 R
i
i 1 ˆ
i 1
i R i 1 R i R R i 1 Z i 1.
i i 1
i
i i 1
i i 1
i
i 1 ˆ
i 1 R i i 1 Z i 1.
i 1 i 1
i
i
Linear Velocity
The linear velocity of the origin of frame
{i+1} is the same as that of the origin of
frame {i} plus a new component caused
by rotational velocity of link i.
Linear Velocity
i
vi 1 vi i Pi 1.
i i i
i 1
vi 1 R( vi i Pi 1 ).
i 1
i
i i i
Prismatic Joints Link
For the case that joint i+1 is prismatic:
i 1 R i ,
i 1 i 1
i
i
i 1 ˆ
vi 1 R( vi i Pi 1 ) di1 Z i 1.
i 1 i 1
i
i i i
Velocity Propagation From Link to Link
c1 s1 0 0 c2 s2 0 l1 1 0 0 l2
s c1 0 0 s c2 0 0 0 1 0 0
0
T 1
, 1
T 2
, 3T
2 .
1
0 0 1 0
2
0 0 1 0 0 0 1 0
0 0 0 1 0 0 0 1 0 0 0 1
Example 5.3
Link to link transformation
0 0
1
1 0 , 1
v1 0,
1 0
0 c2 s2 0 0 l1s21
2
2 0 , 2
v2 s2 c2 0 l11 l1c21 ,
1 2 0 0 1 0 0
l1s21
l1s2 0 1
3
3 2 2 , 3
v3 l1c21 l2 (1 2 )
.
l1c2 l2 l2 2
0
Example 5.3
Velocities with respect to non
moving base
c12 s12 0
0
R 0
R 1
R 2
R s c 0 .
3 1 2 3 12 12
0 0 1
l1s11 l2 s12 (1 2 )
l1s1 l2 s12 l2 s12 1
0
v3 3 R v3 l1c11 l2 c12 (1 2 )
0 3
.
l1c1 l2 c12 l2 c12 2
0
Jacobian
A Jacobian is a vector derivative with respect
to another vector
If we have f(x), the Jacobian is a matrix of
partial derivatives- one partial derivative for
each combination of components of the
vectors
The Jacobian is usually written as j(f,x), but
you can really just think of it as df/dx
Jacobian
Y J ( X ) X .
0
v 0
0
V 0 J ( )
.
Jacobian
.
For a 6 joint robot the Jacobian is 6x6, q
is a 6x1 and v is 6x1.
The number of rows in Jacobian is equal
to number of degrees of freedom in
Cartesian space and the number of
columns is equal to the number of joints.
0
V J ( )
0
Jacobian
In example 5.3 we had:
l1s11 l2 s12 (1 2 )
l1s1 l2 s12 l2 s12 1
0
v3 3 R v3 l1c11 l2 c12 (1 2 )
0 3
.
l1c1 l2 c12 l2 c12 2
0
Thus: l1s1 l2 s12 l2 s12
0
J ()
l1c1 l2 c12 l2 c12
And also:
l1s2 0
3
J ()
l1c2 l2 l2
Jacobian
Jacobian might be found by directly
differentiating the kinematic equations of
the mechanism for linear velocity,
however there is no 3x1 orientation vector
whose derivative is rotational velocity.
Thus we get Jacobian using successive
application of:
i 1
vi 1 R( vi i Pi 1 )
i 1
i
i i i
i 1 ˆ
i 1 R i i 1 Z i 1
i 1 i 1
i
i
Singularities
Given a transformation relating joint velocity to
Cartesian velocity then
Is this matrix invertible? ( Is it non singular)
0
V J ( )
0
1
J ( )v
det[ J ] 0 : singularity
det[ J ] 0 : non sin gularity
Singularities
Singularities are categorized into two class:
Workspace boundary singularities:
Occur when the manipulator is fully starched or
folded back on itself.
Workspace interior singularities:
Are away from workspace boundary and are
caused by two or more joint axes lining up.
All manipulators have singularity at boundaries of their
workspace. In a singular configuration one or more degree of
freedom is lost. ( movement is impossible )
Example 5.4
In example 5.3 we had:
l1s2 0
3
J ()
l1c2 l2 l2
l1s2 0
DET[ J ()] | J () | l1l2 s2 0.
l1c2 l2 l2
2 0 ,180
Workspace boundary singularities
Static Forces in Manipulators
Force and moments propagation
i
f i f i 1 0
i