Servo Motor Torque Calculation