Better debug logging for the parser

Remove the commented-out print statements, instead supply rosout debug messages.
Nifty. I didn't know that you could do this.