fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-06 13:48:52 +08:00
Code Issues Packages Projects Releases Wiki Activity

attitude_estimator_q: be specific about the error

Browse Source
This commit is contained in:
Julian Oes
2016-02-19 16:59:47 +01:00
parent 67597a604e
commit e57d936d8b
1 changed files with 6 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp
+6 -2
View File
@@ -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;
}