put back default to 2000 degree sec mpu6000
Improvement try for accro mode, try to have it more locked by using back gyroADC data since it offer a greater gyro movement resolution