Added Madgwik AHRS implementation