IMU working with interrupts and worker thread