Integrate MadgwickAHRS OSS lib