checked that it stll works on the real thing.
Seems ok in debug but stops in release when enabling te mpu6050. Must be investigated. Could be interrupt related