Browse Source

Q estimator: Ensure init

sbg
Lorenz Meier 9 years ago
parent
commit
4c60f4d98a
  1. 4
      src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp

4
src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp

@ -299,7 +299,7 @@ void AttitudeEstimatorQ::task_main() @@ -299,7 +299,7 @@ void AttitudeEstimatorQ::task_main()
hrt_abstime last_time = 0;
px4_pollfd_struct_t fds[1];
px4_pollfd_struct_t fds[1] = {};
fds[0].fd = _sensors_sub;
fds[0].events = POLLIN;
@ -313,10 +313,12 @@ void AttitudeEstimatorQ::task_main() @@ -313,10 +313,12 @@ void AttitudeEstimatorQ::task_main()
if (ret < 0) {
// Poll error, sleep and try again
usleep(10000);
PX4_WARN("Q POLL ERROR");
continue;
} else if (ret == 0) {
// Poll timeout, do nothing
PX4_WARN("Q POLL TIMEOUT");
continue;
}

Loading…
Cancel
Save