comments
improved RRTPlanner a bit