A method for a six-degree-of-freedom industrial robot to pass through a singular field

Abstract

The invention discloses a method of a six-DOF industrial robot passing a singular region. The method includes the steps of 1, planning a motion curve of the six-DOF industrial robot in the Cartesian space; 2, subjecting coordinates and attitudes of interpolation points in the motion curve to inverse kinematic solution so as to obtain angular displacements, angular velocities and angular acceleration joint variables of joints of the six-DOF industrial robot at the interpolation points; 3, setting the singular region for the six-DOF industrial robot, calculating the joint variables of the interpolation points, judging whether the interpolation points are in the singular region or not, and if yes, further judging the type of singular configuration; 4, allowing the six-DOF industrial robot to pass the singular region. The method has the advantages that the method is simple and feasible and the problem that at present, the six-DOF industrial robot moves unstably due to abrupt change in the joint angular velocity when the six-DOF industrial robot encounters the singular region is well solved.

Description

technical field [0001] The invention relates to a singular field passing technology in trajectory planning of a six-degree-of-freedom industrial robot, in particular to a method for a six-degree-of-freedom industrial robot to pass through a singular field. Background technique [0002] Singular configuration is an important kinematics characteristic of the robot mechanism. It refers to the corresponding configuration of the manipulator when the reference point of the hand cannot realize small displacement or rotation along any direction in the working space of the manipulator. Singularity is the inherent nature of robots, and the existence of singularity is likely to cause vibration and impact of the mechanical arm. Therefore, it is very important to analyze and study the singularity problem of robots and the method of passing through the singularity domain. The singularity of industrial robots is mainly divided into two types: posture singularity and position singularity. ...

AI Technical Summary

Problems solved by technology

[0006] The purpose of the present invention is to overcome the shortcomings and deficiencies of the prior art, and provide a method for a six-degree-of-freedom industrial robot to pass through a singular field. Unstable problems, so that the angular displacement and angular velocity of each joint of the robot can smoothly transition through the singular domain

Images