First version of AP_Compass_MPU9250.cpp