Robotics Kinematics and Dynamics/Serial Manipulator Statics

Propagation of Force and Torque edit

This section deals with solving for the joint torques of serial manipulator, needed to keep it in equilibrium. This will require writing down the force and torque equations for each link.

 
The forces and torques acting on a single manipulator link.

For link  , as depicted in the figure on the right, this results in:

here,

 

and:

 

In this last equation,   is the vector pointing from the origin of frame   to that of frame  .

The above can also be written as:

 

and:

 

The above formulas form the expressions of static force propagation from link to link. For the system to be in equilibrium, the component of   along the Z-axis   must equal the joint torque  . Hence the expression for the joint torque:

 

Example: the Two-Link Planar Manipulator edit

 
The two-link planar manipulator.

Suppose a force vector   is applied to the end-effector of the manipulator on the right. A joint torque is taken positive if it increases the joint angle and negative otherwise. Applying the above equations leads to:

 
 
 
 

Hence, the joint torques required for the system to be in equilibrium are:

 

Virtual Work and Jacobians edit

In general, work is the dot-product of a force or torque and a displacement, or angular displacement. According to the principle of virtual work, let these displacements become infinitesimally small:

 ,

where the left-hand side of the equation expresses the virtual work in the Cartesian, end-effector workspace, and the right-hand side corresponds with the virtual work in the joint displacements. The both of them must, of course, be the same.

The same expression may also be written as:

 

As the definition of the Jacobian is  , the above equation becomes:

 

This must be true for all  , so:

 ,

or:

 

In the above example about the two-link planar manipulator, the matrix is indeed the transpose of the Jacobian, expressed with respect to frame  . With respect to the base frame  , the following expression is valid: