Guide to gyro and accelerometer with Arduino including Kalman filtering

Maybe you forgot that gyroXrate should be in degrees per second and not degrees in this line:

Angle = kalmanCalculateX(accXangle, gyroXrate, dtime);
  • Lauszus