MPU-6050 driver working (without triggers)