position_estimator_inav: added NaN checks

Added some NaN checks to protect estimation from invalid data.