Add compas calibration (using offset) and store in EEPROM.
Modify compas program to perform compas calibration.