trapezoid velocity movement with waypoint button