Problem z mpu6050 + hmc5883l

[stylusc84]

Witam, mam problem z powyższymi czujnikami. Używam tego pod arduino i używam biblioteki FreeIMU. Problem polega na tym że dobrze wskazuje tylko kąty roll i yaw. Tzn gdy zmieniam kąt roll to tylko on sie zmienia a yaw i pitch są bliskie zera. Natomiast gdy zmieniam kąt pitch w pewnym momencie w okolicy 70 stopni nagle roll się zaczyna zmieniać. Nagrałem filmik na którym dobrze to widać do którego link jest poniżej. Dodam że czujniki są skalibrowane. Dziwne jest też to że w momencie gdy jest te 70 stopni na pitch i nagle roll zaczyna się zmieniać to kostka na monitorze nie skacze ani nie zmienia pozycji tylko dobrze pokazuje. Czy ma ktoś jakiś pomysł co może być powodem? Męczę to już długi czas i zero efektów.