Made some USART TX changes, stuff got broken somewhere
After some debugging all previous commands work properly again, but with better code.