Adjusted PID control to compensate for natural tendencies of robot