Quick judging method for singular configuration of six-degree-of-freedom mechanical arm

Abstract

The invention belongs to the field of judgment of singular configurations of mechanical arms, in particular relates to a quick judging method for a singular configuration of a six-degree-of-freedom mechanical arm. The method comprises the steps of: reading present angle values of six joints from an angle encoder of the six-degree-of-freedom mechanical arm; judging if the angles of the six joints do not exceed respective actual movement ranges; judging the angle of the third joint; judging the angle of the second joint; and judging the angle of the fifth joint. The method applies a plane geometry method to the judgment of the singular configuration of the mechanical arm. The method theoretically has no errors to guarantee the judgment precision of the singular configuration of the six-degree-of-freedom mechanical arm; and the judgment process of the method is simpler compared with the calculation of a singular value of a jacobian matrix so as to guarantee the judgment speed of the singular configuration of the six-degree-of-freedom mechanical arm.

Description

technical field [0001] The invention belongs to the field of singular configuration judgment of a mechanical arm, and in particular relates to a method for rapidly judging the singular configuration of a six-degree-of-freedom mechanical arm. Background technique [0002] The kinematic singularity of the manipulator is an inherent characteristic of all types of manipulators. Near the singularity point, the determinant of the Jacobian matrix will approach zero infinitely, because the Jacobian matrix reflects the relationship between the tool speed at the end of the manipulator and the angular velocity of each joint. , so when the determinant of the Jacobian matrix tends to zero, the angular velocity of each joint obtained by using the inverse of the Jacobian matrix tends to infinity. In the actual control of the manipulator, try to avoid this situation from happening , otherwise it may cause irreversible damage to the drive motor of the manipulator joint, so the analysis of th...

AI Technical Summary

Problems solved by technology

The above methods can theoretically obtain the singular value of the Jacobian matrix, but the amount of calculation is often large, which is not conducive to the real-time singularity avoidance control of the industrial manipulator

Images