Calibration Program & fixed Menu

The Autonomous program has been fixed and a menu now works. Additionally
we added a new compass calibration method that isn't complete