Skip to content
Snippets Groups Projects
Commit e57d936d authored by Julian Oes's avatar Julian Oes
Browse files

attitude_estimator_q: be specific about the error

parent 67597a60
No related branches found
No related tags found
No related merge requests found
......@@ -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;
}
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment