@Wim-Stockman I will take a look at it during the next week. Thanks for the tip.
I did not check the code much but there should be some time buffer while decoding the correct input. The messages does not always come at the same time, there might be a tens of ms gap between each and you shoudl tie those together...