AP_NavEKF : Add IMU weighting to use of Z acc bias