AP_NavEKF : clean up convoluted logic used in sensor health checks

This doesn't change the behavior, but does make the code easier to
understand