X-Git-Url: https://ruin.nu/git/index.pl?a=blobdiff_plain;f=planner.cpp;h=6d70ae40df2114d32e6cf4f3ab611155e96b6aa6;hb=7b9821d42d980e5788bbc65563973eddd6e4c40d;hp=b675ce061f6f8b29a3e0ee0352548616ab22e715;hpb=f42886c46e17e6e429efa36aab69e0cbd22cf87a;p=popboot.git diff --git a/planner.cpp b/planner.cpp index b675ce0..6d70ae4 100644 --- a/planner.cpp +++ b/planner.cpp @@ -6,13 +6,13 @@ using namespace __gnu_cxx; Planner::Planner(std::vector actions, literals init, literals goal){ - _start = new Node(Action("",literals(), init)); + _start = new Node(Action("start",literals(), init)); addNode(_start); - Node* finish = new Node(Action("",goal,literals())); + Node* finish = new Node(Action("finish",goal,literals())); for(vector::iterator action = actions.begin(); action != actions.end(); ++action){ - literals effects = action->effects(); - for (literals::iterator effect = effects.begin(); effect != effects.end(); ++effect){ + const literals& effects = action->effects(); + for (literals::const_iterator effect = effects.begin(); effect != effects.end(); ++effect){ cerr << "Adding effect: " << *effect << endl; _actions[*effect] = *action; } @@ -20,15 +20,24 @@ Planner::Planner(std::vector actions, literals init, literals goal){ makePlan(finish); } +Planner::~Planner(){ + for (hash_map::iterator node = _addedNodes.begin(); node != _addedNodes.end(); ++node){ + cerr << "Deleting node " << node->second->action().executable() << endl; + delete node->second; + } +} + void Planner::makePlan(Node* node){ - literals preconds = node->action().preconditions(); + cerr << "Fetching preconditions for action: " << node->action().executable() << ".. "; + const literals& preconds = node->action().preconditions(); + cerr << "done" << endl; if (preconds.size() == 0){ cerr << "Found no preconds" << endl; _start->addChild(node); }else{ - for (literals::iterator precond = preconds.begin(); precond != preconds.end(); ++precond){ + for (literals::const_iterator precond = preconds.begin(); precond != preconds.end(); ++precond){ cerr << "Looking for: " << *precond << endl; hash_map::iterator addedNode = _addedNodes.find(*precond); if(addedNode != _addedNodes.end()){ @@ -51,10 +60,15 @@ void Planner::makePlan(Node* node){ } void Planner::addNode(Node* node){ - literals effects = node->action().effects(); + const literals& effects = node->action().effects(); - for (literals::iterator effect = effects.begin(); effect != effects.end(); ++effect){ + for (literals::const_iterator effect = effects.begin(); effect != effects.end(); ++effect){ cout << "Adding node for effect: " << *effect << endl; _addedNodes[*effect] = node; } } + + +void Planner::execute(){ + _start->execute(literals()); +}