Time optimal trajectory planning of five degrees of freedom manipulator based on PSO algorithm

According to the kinematic constraints of the manipulator, a time-optimized 3-5-3 polynomial interpolation algorithm based on particle swarm optimization in joint space is proposed, which solves the shortcomings of polynomial interpolation trajectory planning with high order and no convex hull. Particle swarm optimization is simple in structure, easy to implement, and easy to adjust parameters. It directly selects the polynomial interpolation time as a variable, searches in the target space, and obtains the shortest interpolation time under the specified speed constraint. The simulation is carried out on the experimental platform, and compared with the traditional 3-5-3 polynomial interpolation of position, velocity and acceleration curves, it is proved that the method can achieve shorter running time and better stability of the manipulator.