SMOOTH TIME-OPTIMAL PATH TRACKING FOR ROBOT MANIPULATORS WITH KINEMATIC CONSTRAINTS

Previous works solve the time- optimal path tracking problems considering piece-wise constant parametrization for the control input, which may lead to the discontinuous control trajectory. In this paper, a practical smooth minimum time trajectory planning approach for robot manipulators is proposed, which considers complete kinematic constraints including velocity, acceleration and jerk limits. The main contribution of this paper is that the control input is represented as the square root of a polynomial function, which reformulates the velocity and acceleration constraints into linear form and transforms the jerk constraints into the difference of convex form so that the time- optimal problem can be solved through sequential convex programming (SCP). The numerical results of a real 7-DoF manipulator show that the proposed approach can obtain very smooth velocity, acceleration and jerk trajectories with high computation efficiency.