Method of controlling a seven degree of freedom manipulator arm

摘要

The present invention is a control system for a seven-degree-of-freedom robotic arm. The robotic arm (10) includes two links (12 and 14), each having two degrees of freedom, and a spherical wrist (26) having three degrees of freedom. The kinematics of the spherical wrist are decoupled from the kinematics of the arm. The four degrees of freedom of the arm create a redundancy which provides versatility in the positioning of the arm. Fixing the redundant arm parameter and locating the end point (24) of the end effectuator path away from areas of limited mobility results in a marked simplification of the algorithms which describe the equations of motion of the arm. Additionally, further computation reduction can be achieved by updating the control gains less frequently than every microprocessor cycle, such as updating once for every five degrees of pitch angle rotation of either joint.