Kalman filter replaced by complementary

I feel like I'm smacking my head against a wall with this thing.