AHRS: make orientation more stable

Apply magnetometer to all axes.
Remove all DEBUG stuff
Change altitude output scale
Add Quat class
AHRS: use new quat class
ControlCenter: use new Quat class
Merge branch 'feature/add_quat_class' into develop
Quat: remove extra spaces