Calibration functions

Added functions to allow calibration of sensors and motors.