How to Fix Servo Drive’s Erratic Motion?