Pass an actual dt to sensfusion6UpdateQ (it's usually around 9 ms) instead of a predefined constant (4 ms). This fix makes a Crazyflie a little bit more stable.