Vielleicht hast du deinen IMU Würfel falsch wieder drauf gebaut? Auf jeden Fall ist in dem Video die Wirkrichtung von Yaw falsch. Check doch mal die Realtime Daten und mach evtl. davon ein Video.