AP_Compass_MPU9250 read problems