X-Git-Url: https://ruin.nu/git/?a=blobdiff_plain;f=planner.cpp;h=1210d0479309df2ed3af1a2fe0b8f783fa5d1a33;hb=13441470b3b895e08b4165e2154665863f1c3b33;hp=5e1719e11b48619a3a805801893e4bb0fa46408f;hpb=9811871585fa6028362c8910bfac18159c286323;p=popboot.git diff --git a/planner.cpp b/planner.cpp index 5e1719e..1210d04 100644 --- a/planner.cpp +++ b/planner.cpp @@ -6,12 +6,12 @@ using namespace __gnu_cxx; Planner::Planner(std::vector actions, literals init, literals goal){ - _start = new Node(Action("",literals(), init)); - Node* finish = new Node(Action("",goal,literals())); + _start = new Node(Action("start",literals(), init)); + 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; } @@ -19,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()){ @@ -39,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; @@ -50,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()); +}