Add calibration routine
Add calibration routine