Set mpu6050 to gyro ppl, documentation recomend this
Test with madgwick algorithm
Stabilizing fly