New functions added to servo drive system