From 028f5b33920514423f7cf49d5d1e52b89653c289 Mon Sep 17 00:00:00 2001 From: Julian Oes Date: Wed, 17 Feb 2016 10:19:20 +0100 Subject: [PATCH] attitude_estimator_q: astyle --- src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp | 3 +++ 1 file changed, 3 insertions(+) diff --git a/src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp b/src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp index 9270b44890..719da03513 100644 --- a/src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp +++ b/src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp @@ -325,10 +325,12 @@ void AttitudeEstimatorQ::task_main() int ret = px4_poll(fds, 1, 1000); #ifndef __PX4_QURT + if (_mavlink_fd < 0) { /* TODO: This call currently stalls the thread on QURT */ _mavlink_fd = open(MAVLINK_LOG_DEVICE, 0); } + #endif if (ret < 0) { @@ -398,6 +400,7 @@ void AttitudeEstimatorQ::task_main() warnx("WARNING: degenerate accel!"); continue; } + if (_mag.length() < 0.01f) { warnx("WARNING: degenerate mag!"); continue;