(22) |

The following section will explain in detail how the Jacobian matrix is computed and finally the entire Jacobian matrix for the 5-DOF robotic arm is computed. Consider a simple 2D robot arm with two 1-DOF rotational joints:

The Jacobian matrix shows how each component of varies with respect to each joint angle. Here is a point on the end effector and is the joint angle. and are the components of in the 2D plane.

(23) |

Jacobian matrix can be determined either by differentiation of the forward kinematics equation or by iterative recursive equation[31]. The iterative recursive equation describes a relationship between joint angle rate of change and the translational and rotational velocities of the end effector which is expressed as,

(24) |

The above equation can be expanded to,

(25) |

The linear translational and rotational velocity can be iteratively computed as follows,

In the above equation and are the rotation and translation parameters related to adjacent joints and this can be calculated by assigning coordinate frames to each joints as mentioned in [31]. Denavit-Hartenberg parameters, link length ( ) , link twist ( ) and link offset ( ) which are constant geometric quantities, are identified for each joint, after the coordinate frame assignment. A homogeneous transformation matrix which refers the position and orientation of the frame to the position and orientation of the frame can be calculated from the D-H parameters and following generalized matrix form,

(28) |

Where , and is the joint angle between the two joint axis. In this homogeneous transformation matrix upper left matrix refer to the rotation which constitutes of two parts. One, ( ) is due to the rotation of joint axis and the other,( ) due to link twist. The right matrix refer to the translation part whose components are link length and link offset .

Rotation and translation parameters for each joint required in equations (26) and (27) can be obtained from this homogeneous transformation matrix and Jacobian matrix can be expressed stacking the result for all joints.

Following is the image of the robot arm under consideration whose coordinate frames are assigned for all joints.

The D-H parameters can be expressed as,

The Jacobian matrix calculated using iterative recursive estimation is as follows. The complete calculation steps are given in the appendix.

(29) |

Where, l1, l2 l3, l4, l5 are link lengths, d1 is the link offset at joint,

, , , , are joint angles,

s1,s2,s3,s4,s5 corresponds to sine , sine , sine , sine , sine ,

c1,c2,c3,c4,c5 corresponds to cosine , cosine , cosine , cosine , cosine . Jimesh Thomas 2007-10-20