diff --git a/Main/IMU.ino b/Main/IMU.ino index a7da9f2..2a7d5a5 100644 --- a/Main/IMU.ino +++ b/Main/IMU.ino @@ -55,7 +55,7 @@ void readIMU() { //Complementary filter dAngle = pitch_rate * dT_s; - pitch = acc_pitch * (1 - alpha) + (dAngle + pitch_prev * alpha); + pitch = acc_pitch * (1 - alpha) + ((dAngle + pitch_prev) * alpha); pitch_prev = pitch;