Sugestion to make debugging easyer
Add a debug mode that can be enabled where each message has a Number (maybe hex) with that we could report small mistakes such as typos very easy and for you easy to find aswell
You could also add other stuff to that debug mode if wanted