First successful flight on STM32

Harware: STM32H7
Radio protocol: Sbus
Control mode: Stabilized
Cascaded PIDs: AttitudePID -> ratePID -> Mixer -> Motors
AHRS: Madgwick
Use quaternion