Minor corrections to fix errors; improved I2C write/read functions

Please take alook at the Wire.h read and write functions. I believe they have been improved. I noticed about a 5% speed up as a result of removing some unnecesary calls and rearranging some. Also fixed magnetic declination corrections, and changed some data types to allow compatibility with Teensy 3.1.