Add VFR HUD to telemetry
fixed Thalamus-Hypo mode reporting, cleaned up Thalamus states code
Merge branch 'Reorg' of https://github.com/madcowswe/Mavrx-firmware into Reorg