Sensor Calibration

Added a working sensor calibration.
More changes, yay