Better debug logging for the parser

Remove the commented-out print statements, instead supply rosout debug messages.
Saves importing rospy— not sure how much that matters, but it seems a shame to add it to an otherwise nice and abstract module just for that.