Professional Documents
Culture Documents
Objective Of My Project:
Basics of Robotics.
Forward Kinematics.
Inverse Kinematics.
Implementation of Pseudo-Inverse and DLS method for finding the Inverse and their
Comparison.
Velocity Kinematics.
Study of Manipulability.
Introduction:
Rotation Matrices.
Translation Matrices.
Successive Transformations.
DH Parameters:
Joint Offset - bi / di
Joint Angle - i
Link Length - ai
Twist Angle -
DH Parameters:
Of these 4 Joint Parameters, 3 are fixed for a specific Manipulator only [ ] changes
with time.
So a 4x4 Transformation Matrix can be formed which changes only when [] changes
for a specific Manipulator.
=
This is the matrix which transforms the i-1 coordinate frame to i th frame.
Forward Kinematics:
e= f ()
Determining the position and orientation of every link by knowing the joint variables of
the robot.
It is used for the transformation of base frame to the End Manipulator frame.
Jacobian Matrix:
Jacobian can be normally calculated by partial differentiation of vectors X,Y, Z which are
functions of the Joint Variable []=[1, 2, 3, .. , n ] where n = No. of Links
And in a Robot, we need to calculate the Jacobian matrix in a very short time for every
configuration of the robot.
So the another way of calculating each column separately.
For Revolute
For Prismatic
Inverse Kinematics:
= f-1 ( e )
Multiple solutions
n-1
Tn =
n-1
0
1
Tn
Tn =
2.
3.
:
Iterative Technique ( Newton- Ralphsons method ).
I = n-1Tn-1 ... 1T2-1 0T1-1 0Tn
T1-1 0Tn
START
POSITION
INVERSE KINEMATICS
Forward Kinematics:
[e] = f ()
[error] = [g] [e]
No
[error]
<
Tol
Yes
[e] = x [error]
Compute [J]
Inverse of
Jacobian [J]
Record values of
[]
STOP
Inverse
Kinematics:
[] = [J] x [e]
[]i+1 = []I + []
Save []
Inverse Kinematics:
2.
3.
(rev/s)
Time(s)
(rev/s)
Time(s)
Velocity Kinematics:
START
VELOCITY
INVERSE KINEMATICS
Forward Kinematics:
[e] = f ()
[error] = [g] [e]
No
[error]
<
Tol
Yes
Duration= [error] /
V
Compute [J]
Inverse of
Jacobian [J]
Inverse
Kinematics:
[]= []=[J] x
[V]
[]i+1 = []I + []
Save [], , t
Record values of
[], , t
STOP
Manipulability:
Yoshikawa
T
x =1
vT x [(JJT)-1] x v=1
Manipulability
Circles.
Thank You