Removed Complementary filter
Configured Madgwik AHRS
Added unit tests to AHRS library