Working calibration phase, TODO: check torque values (compensation) and test with known weights