This algorithm is appropriate to PTP trajectory and CP trajectory.

• 这种算法对于PTP运动和沿CP运动都是适用的。