Minor bug fixes

Modified some data types for compatibilty with Teensy 3.1; fixed magnetic declination correction