Fixed old MPU6050 code