Complementary filter now working for sure. Adding a timer to filter was key. Various other changes made as well.