logger.info("*************************************************");
TextDrawVisitor visitor = new TextDrawVisitor();
planningGraph.accept(visitor);
logger.info("Initial Graph is: "+visitor.toString());
planningGraph.expandGraph();
visitor.reset();
planningGraph.accept(visitor);
logger.info("Expanded Graph is: "+visitor.toString());
logger.info("*************************************************");