take care of max speed < max Jerk