fixed up a lot of the bugs in mpu6050 driver