Torque compensation computation fixed, TODO: remove hypothesis of uniform density