Hast du den mal meinen oben geposteten Code versucht? Der funzt bei mir zu 100% Wenns bei dir nicht geht, liegts wohl an der HW.
Hast du einen MPU6000 oder MPU6050?

Gruß
Chris