Added mutex to sensor calibration
Added calibration functionality
Added calibration to test