fix boot up lock when version change, making accessing the sensors that are not yet initialized!
Merge pull request #339 from Kenny9999/development

fix boot up lock when version change, making accessing the sensors that ...
just some alignment!
Mag default and cleanup implementation
Merge pull request #340 from Kenny9999/development

Development
Fix badly placed include for compas variable!
Merge pull request #341 from Kenny9999/development

Fix badly placed include for compas variable!
change back kp ki for mag because it was drifting in flight!
Merge pull request #342 from Kenny9999/development

change back kp ki for mag because it was drifting in flight!
heading fusion temp fix
Merge pull request #343 from Kenny9999/development

heading fusion temp fix
Heading fusion processor, best I can do!
Merge pull request #344 from Kenny9999/development

Heading fusion processor, best I can do!
Merge branch 'development' into development-myconfig