Added new calibration function in setup