Method and device for avoiding kinematic singularity points in robot motion planning

Abstract

The invention relates to a method for avoiding kinematics singularity points in robot motion planning. The method comprises the following steps that a kinematic model of an industrial robot is established; a kinematics inverse solution of path points of a pre-planning path is obtained according to the kinematics model, and a kinematics track of a joint space of the industrial robot is establishedaccording to the obtained kinematics inverse solution; when it is determined that the kinematics track passes through spherical wrist kinematics singularity points, tiny deflection is carried out on the angle of a starting point of the pre-planning path to obtain a new planning path, and then a new kinematics track of the joint space of the industrial robot is established according to the new kinematics inverse solution; when it is determined that the new kinematics track still passes through the spherical wrist kinematics singularity points, the pre-planning path is abandoned to execute; andwhen it is determined that the new kinematics track does not pass through any spherical wrist kinematics singularity point, the new planning path is executed. The invention further relates to a devicefor avoiding the kinematics singularity points in the robot motion planning.

Description

technical field [0001] The present invention relates to a method for avoiding kinematic singularity in robot motion planning, specifically, a method for avoiding kinematic singularity in spherical wrist industrial robot motion planning. The present invention also relates to a device for avoiding kinematic singularity in robot motion planning, in particular, a device for avoiding kinematic singularity in motion planning of a spherical-wrist industrial robot. Background technique [0002] With the continuous improvement of labor costs and the continuous development of industrial robot control, planning, and identification methods, the use of industrial robots to replace manual labor in automated production is getting higher and higher. However, in the current industry, commonly used industrial robots with spherical wrists often encounter kinematic singularities when performing unknown operations in complex environments, which seriously affects their versatility and practicabil...

AI Technical Summary

Problems solved by technology

The singularity will cause the joint rotation speed to be too high when the robot executes the specified path in the space, resulting in reduced performance, reduced practicability, and even possible danger.

Images