Bugs and some documentation

What changed
------------------
* bit debugging
* adding documentation for messages

Next steps
-------------
* adding end stop info
* testing with g-code