working on it. Accelerometer interrupt are broken, meanwhile it will be
read with gyro. The rest seems ok