Fixed mistake with new jerk time step criterion