Time-Optimal and Smooth Trajectory Planning Based On Continuous Pseudo-Acceleration

The current time-optimal trajectory planning based on dynamics does not take into account the continuity of joint torque. Although the time obtained by the solution of the original time-optimal path parameterization (TOPP) algorithm is optimal, the joint torque obtained by the solution is not continuous, and the discontinuous joint torque will cause the manipulator to resonate, which will reduce the accuracy of the trajectory, making the obtained trajectory in practical engineering applications cannot be effectively applied. Therefore, this paper improves the problem of discontinuous torque on the basis of the TOPP algorithm, and proposes to use a quadratic polynomial curve to deal with the discontinuous part of the pseudo-acceleration in the phase plane composed of position and pseudo-acceleration, which not only ensures the integrity of the path, but also makes the joint torque continuous and smoothes the joint torque trajectory to some extent. This method is verified by the simulation experiment of the two-link manipulator.