AP_NavEKF: Add protection for negative height above ground