I know you need help here… but, there’s like a million things that can go wrong. I can’t possibly debug your issue.
So, I recommend to look at how our driver works and how yours does. Note that you need to look at our HAL too as we’ve patched bugs in it.