attitude_estimator_q: be specific about the error

9 years ago · e57d936d8b
1 changed files with 6 additions and 2 deletions
--- a/src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp
+++ b/src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp
@ -391,8 +391,12 @@ void AttitudeEstimatorQ::task_main()
				@@ -391,8 +391,12 @@ void AttitudeEstimatorQ::task_main()
 			_accel.set(_voter_accel.get_best(curr_time, &best_accel));
 			_mag.set(_voter_mag.get_best(curr_time, &best_mag));

-			if (_accel.length() < 0.01f || _mag.length() < 0.01f) {
-				warnx("WARNING: degenerate accel / mag!");
+			if (_accel.length() < 0.01f) {
+				warnx("WARNING: degenerate accel!");
+				continue;
+			}
+			if (_mag.length() < 0.01f) {
+				warnx("WARNING: degenerate mag!");
 				continue;
 			}