Working calibration and weight compensation, TODO: check torque values compensation