Cleaned some comments.  Added Check Self Collision to Herb for planner.