Magnetic Offset Fix

Switched Compass Libraries and added magnetic offset code. Major Fix but
may need more tilt compensated code or tuning.