För mpu6050 är det bäst att snå denna kod då den ger all data man vill ha direkt, beehöver bara skriva om den lite
Merge branch 'master' of https://github.com/chrolss/Quadvisio