position_estimator_inav: added NaN checks
Merge pull request #764 from PX4/inav_nan_checks

position_estimator_inav: added NaN checks