Merge pull request #53 from davetcoleman/groovy-devel

Added debug output info for planning_scene (with Ioan)