Enable gcc O2 optimization
Merge https://github.com/Khan-drone/ahrs-core