Velocity optimization algorithm of 4-DOF robot end-effectors

Abstract

To solve the problem velocity control for robot end-effectors trajectory planning in the Cartesian space, this paper studied the algorithm of the linear acceleration and deceleration. Moreover, it proposed a velocity optimization algorithm based on the displacement equivalent. Adjusting the speed size of the acceleration and deceleration, the algorithm reduced the velocity mutation due to the discretized interpolation equation. The algorithm then was applied to the linear and circular interpolation of 4-degree of freedom industrial robots, establishing the forward and inverse kinematics equation based on Denavit–Hartenberg (D–H) coordinate system with implementing the optimization algorithm in the motion control system. Next, the velocity of the end-effectors was tested using the acceleration sensor and data logger. The results of simulation and experiment showed that velocity optimization algorithm eliminated the acceleration point and decreased the deceleration point on the velocity mutation.