Calibration

What changed
============

* Added a basic calibration function