FIX: incorrect reading of the IMU