added debug code for rrt planner and changed default colors for renderer