Continue work on the complementary filter