Nearly Optimal Path Following With Jerk and Torque Rate Limits Using Dynamic Programming

This paper presents a new dynamic programming (DP) approach to the optimal path following problem. The method rests on an interpolation in the phase plane so that the resulting joint accelerations and joint torques are continuous. This allows for taking into account limits on the joint jerks and torque rates in addition to joint velocities, accelerations, torques, and the mechanical power. Most methods proposed in the literature yield values of optimal trajectories at discrete sampling times so that this must be interpolated subsequently to the trajectory optimization. This causes violations of the joint jerk and torque rate limits. The proposed method does not suffer from this problem, which is a main feature of this approach. Unlike most of the previously proposed methods, joint jerk and torque rate limits are addressed with a reasonable increase in the computation time of DP algorithms. Special attention is given to experimental validation of the optimization results. The presented experimental results confirm the importance of taking the motor torque characteristics as well as the Coulomb and viscous friction into account. Neglecting these effects (as most previous publications did) leads to trajectories that cannot be performed by real manipulators. Apart from DP, other approaches with smaller computation times exist. However, most of these methods are either limited to the time optimal case (which might not always be the desired criterion) and are not able to handle all earlier mentioned constraints or cannot take into account viscous friction effects. Apart from that a sequential convex programming (SCP) approach exists, which accounts for the same constraints as the presented approach. Therefore, the proposed DP approach is compared to this SCP method and an example is presented where the time optimal trajectory is performed by a real manipulator.