Handle "bad" pose estimates

Improved RelNAV.h to handle NaN data from vision subsystem (occurs when
localization estimate cannot be updated).