AP_NavEKF: second attempt at higher rate baro fusion