Better debug logging for the parser

Remove the commented-out print statements, instead supply rosout debug messages.
Avoiding a dependency on rospy was precisely why there wasn't any nice logging before, so this change is great.