switched to Madgwick's AHRS algorithm, renamed Quaternion struct and removed inconsistencies in the indexing