Added MPU6050 code, with aux HMC8553 data acquisition