mpu6050 working
mpu6050 improvements