thanks to Justin for the suggestion
this is the first step to creating a general AHRS class for ArduPilot