Raise gain at zero speed until position error or speed is zero, then normal gain