mirror of
https://bitbucket.org/librepilot/librepilot.git
synced 2025-02-20 10:54:14 +01:00
OP-1374 hotfix to filtercf on checking of magnetometer calibration fabsf()
This commit is contained in:
parent
30491c7992
commit
80d3d7c954
@ -234,7 +234,7 @@ static filterResult complementaryFilter(struct data *this, float gyro[3], float
|
||||
float magBias[3];
|
||||
RevoCalibrationmag_biasArrayGet(magBias);
|
||||
// don't trust Mag for initial orientation if it has not been calibrated
|
||||
if (magBias[0] < 1e-6f && magBias[1] < 1e-6f && magBias[2] < 1e-6f) {
|
||||
if (fabsf(magBias[0]) < 1e-6f && fabsf(magBias[1]) < 1e-6f && fabsf(magBias[2]) < 1e-6f) {
|
||||
this->magCalibrated = false;
|
||||
mag[0] = 100.0f;
|
||||
mag[1] = 0.0f;
|
||||
|
Loading…
x
Reference in New Issue
Block a user