X-Git-Url: https://ruin.nu/git/?a=blobdiff_plain;f=planner.cpp;h=1210d0479309df2ed3af1a2fe0b8f783fa5d1a33;hb=895d43297511597e9d8734c0fd5ba534f551de5f;hp=a15028e29a3175e8fa316e2e6e6a37e2dc41194f;hpb=09f6dfa65b66103c27dc831271d961de9ab0109e;p=popboot.git diff --git a/planner.cpp b/planner.cpp index a15028e..1210d04 100644 --- a/planner.cpp +++ b/planner.cpp @@ -7,12 +7,11 @@ using namespace __gnu_cxx; Planner::Planner(std::vector actions, literals init, literals goal){ _start = new Node(Action("start",literals(), init)); - addNode(_start); 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 +19,26 @@ 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; + + addNode(node); 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()){ @@ -40,7 +50,6 @@ void Planner::makePlan(Node* node){ cerr << "Adding new node" << endl; Node* newnode = new Node(action->second); newnode->addChild(node); - addNode(newnode); makePlan(newnode); }else{ cerr << "Action with effect: " << *precond << " not found!" << endl; @@ -51,9 +60,9 @@ 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; }