Detect oscillation, unstability of servo and change gain to stabilize again