AP_NavEKF : Add calculation for IMU selection weighting