Solve problems with compass ang gyro fusion in mpu6050 library

[JanWielgus]

I forget to close the issue. Probably there was a problem, because compass value was extrapolated and sometimes exceeded 360 degrees or were less than zero. This caused value jumps when angle was around 0 degrees