Aded beginning of compass calibration program, tweaked compass libraries