Added bool for calibration code for issue #23
Values will no longer be printed if robot is in calibration mode.
Motors should not turn while robot is calibrating.
Program now prints offsets while in calibration
Declared variables for calibration.
Added some calibration code
Added the rest of the calibration code
We now print mag for each module.