The repetitive motion planning movements of the redundant manipulator will cause oscillations and unintended swings of joints, which increase the risk of collisions between the manipulator and its surroundings. Motivated by this phenomenon, this paper presents an inverse kinematics algorithm for the spherical-revolute-spherical manipulator to solve the paradox raised by joint-drift and control the pose with no swing of the elbow. This algorithm takes the joint Cartesian positions set as the intermediary and divides the inverse solution process into two mapping processes within joint limits. Simulations are executed to evaluate this algorithm, and the results show this algorithm is applicable to repetitive motion planning and is capable of producing superior configurations based on its real-time ability and stable solve rate. Experiments using the 7-degree-of-freedom spherical-revolute-spherical manipulator demonstrate the effectiveness of this algorithm to remedy the joint-drift and elbow swing compared to Kinematics and Dynamics Library and TRAC-IK.

Repetitive motion planning (RMP) is important in operating redundant robotic manipulators. In this paper, a new RMP scheme that is based on the pseudoinverse formulation is proposed for redundant robotic manipulators. Such a scheme is derived from the discretization of an existing RMP scheme by utilizing the difference formula. Then, theoretical analysis and results are presented to show the characteristic of the proposed RMP scheme. That is, this scheme possesses the characteristic of cube pattern in the end-effector planning precision. The proposed RMP scheme is further extended and studied for redundant robotic manipulators under joint constraint. Based on a four-link robotic manipulator, simulation results substantiate the effectiveness and superiority of the proposed RMP scheme and its extended one.