Torque-Squared Trajectory works well