Fix calculateTorque