pauls estimator: Added NaN guard before publishing

11 years ago · 63dae04c22
1 changed files with 1 additions and 1 deletions
--- a/src/modules/fw_att_pos_estimator/fw_att_pos_estimator_main.cpp
+++ b/src/modules/fw_att_pos_estimator/fw_att_pos_estimator_main.cpp
@ -959,7 +959,7 @@ FixedwingEstimator::task_main()
				@@ -959,7 +959,7 @@ FixedwingEstimator::task_main()
 			}

 			// Publish results
-			if (_initialized) {
+			if (_initialized && (check == OK)) {