start with velocity limit by moving around setpoint slowly