Better debug logging for the parser

Remove the commented-out print statements, instead supply rosout debug messages.
That's a good point. I'll revise the PR to remove the publish-once behaviour.