First compiled version

Its missing some flight variables, checking the servo output units (PWM
vs %) and DataFlash log write.