diff --git a/src/sensors/mpu9250sensor.cpp b/src/sensors/mpu9250sensor.cpp index 5742188..49b38e0 100644 --- a/src/sensors/mpu9250sensor.cpp +++ b/src/sensors/mpu9250sensor.cpp @@ -171,9 +171,9 @@ void MPU9250Sensor::motionLoop() { last = now; getMPUScaled(); - #if defined(_MAHONY_H_)) + #if defined(_MAHONY_H_) mahonyQuaternionUpdate(q, Axyz[0], Axyz[1], Axyz[2], Gxyz[0], Gxyz[1], Gxyz[2], Mxyz[0], Mxyz[1], Mxyz[2], deltat * 1.0e-6); - #elif defined(_MADGWICK_H_)) + #elif defined(_MADGWICK_H_) madgwickQuaternionUpdate(q, Axyz[0], Axyz[1], Axyz[2], Gxyz[0], Gxyz[1], Gxyz[2], Mxyz[0], Mxyz[1], Mxyz[2], deltat * 1.0e-6); #endif quaternion.set(-q[2], q[1], q[3], q[0]);