Better debug logging for the parser

Remove the commented-out print statements, instead supply rosout debug messages.