Arduino AHRS for LSM9DS0 using Madgwick/Mohony filter