Hi there,
And welcome here…
So which BSP are you using to compile the code with? You may need to roll it back to an earlier one to get it to work. YMMV
You can use the code tags “</>” above and paste it in there sa we can look. Sounds like you have it sort of going.
HTH
GL 
PJ 