Starting work on documentation that is compliant to Doxygen.

Adding some temporary prints for debug.
Getting finally parsing of incoming commands correct.

Now am able to parse incoming commands and see that the incoming command was either what we were looking for or not.
(Note to self. NEVER use Putty as telnet client!!!!)