Made it work. LOL
It was a lot of bugs at receiving FrSky Messages so I refactored the
code.