Moved to TelemetryData.h, added I2C and MPL3115A2, updated UAVTalk and control