Use binary operator~ instead of logical operator!

This commit is contained in:
Julien Lecoeur 2017-06-01 15:16:33 +02:00 committed by Lorenz Meier
parent c323b64742
commit d0b4f1e225

View File

@ -149,9 +149,9 @@ void Ekf::fuseMag()
_mag_test_ratio[index] = sq(_mag_innov[index]) / (sq(math::max(_params.mag_innov_gate, 1.0f)) * _mag_innov_var[index]);
if (_mag_test_ratio[index] > 1.0f) {
healthy = false;
_innov_check_fail_status.value |= ((1 << (index + 3)) != 0);
_innov_check_fail_status.value |= (1 << (index + 3));
} else {
_innov_check_fail_status.value &= !((1 << (index + 3)) != 0);
_innov_check_fail_status.value &= ~(1 << (index + 3));
}
}