Code is down for calculation of control torque.