Updating agent strategy to add debug logging.
Also make search algorithm return the cost of the returned path.