AP_NavEKF: Improved health outputs