Digital servo shaking problem