Complementary Filter v1.1

Bug fixed.