Algorithm to obtain inverse kinematics matrix from the 3D curve and to apply to glue shoe sole

Abstract

Nowadays, manipulator is widely used in industrial applications. The trajectories of manipulator are more and more complicated. In order to do good tracking performance, the end effector position and orientation have to be determined. This paper describes a method to determine position and orientation of manipulator’s end effector base on a reference path. This method will be applied for manipulator 6 DOF to glue shoe sole. Firstly, assume the reference path is arbitrary curve, the path was then discrete to become multi-point. Secondly, the roll – pitch – yaw vectors of the end effector will be determined at each point. Finally, Euler angles and interpolation method in 3D space will be applied to determine inverse kinematics matrix of manipulator for each point on the reference path. In addition, this paper also gives an example of reference path of shoe sole to apply the presented method. To verify the tracking performance of manipulator and reference path, a PID controller was designed for simulation. The result of simulation proved the correction of the algorithm.