#ifndef EDMONDS_KARP_HH

#define EDMONDS_KARP_HH

#include <algorithm>

#include <bfs_iterator.hh>

namespace marci {

  template<typename Graph, typename T, typename FlowMap, typename CapacityMap>

  class ResGraph {

    typedef typename Graph::NodeIt NodeIt;

    typedef typename Graph::EachNodeIt EachNodeIt;

    typedef typename Graph::SymEdgeIt OldSymEdgeIt;

    const Graph& G;

    FlowMap& flow;

    const CapacityMap& capacity;

  public:

    ResGraph(const Graph& _G, FlowMap& _flow, 

	     const CapacityMap& _capacity) : 

      G(_G), flow(_flow), capacity(_capacity) { }

    class EdgeIt; 

    class OutEdgeIt; 

    friend class EdgeIt; 

    friend class OutEdgeIt; 

    class EdgeIt {

      friend class ResGraph<Graph, T, FlowMap, CapacityMap>;

    protected:

      const ResGraph<Graph, T, FlowMap, CapacityMap>* resG;

      OldSymEdgeIt sym;

    public:

      EdgeIt() { } 

      //EdgeIt(const EdgeIt& e) : resG(e.resG), sym(e.sym) { }

      T free() const { 

	if (resG->G.aNode(sym)==resG->G.tail(sym)) { 

	  return (resG->capacity.get(sym)-resG->flow.get(sym)); 

	} else { 

	  return (resG->flow.get(sym)); 

	}

      }

      bool valid() const { return sym.valid(); }

      void augment(const T a) const {

	if (resG->G.aNode(sym)==resG->G.tail(sym)) { 

	  resG->flow.set(sym, resG->flow.get(sym)+a);

	} else { 

	  resG->flow.set(sym, resG->flow.get(sym)-a);

	}

      }

    };

    class OutEdgeIt : public EdgeIt {

      friend class ResGraph<Graph, T, FlowMap, CapacityMap>;

    public:

      OutEdgeIt() { }

      //OutEdgeIt(const OutEdgeIt& e) { resG=e.resG; sym=e.sym; }

    private:

      OutEdgeIt(const ResGraph<Graph, T, FlowMap, CapacityMap>& _resG, const NodeIt v) { 

      	resG=&_resG;

	sym=resG->G.template first<OldSymEdgeIt>(v);

	while( sym.valid() && !(free()>0) ) { ++sym; }

      }

    public:

      OutEdgeIt& operator++() { 

	++sym; 

	while( sym.valid() && !(free()>0) ) { ++sym; }

	return *this; 

      }

    };

    void getFirst(OutEdgeIt& e, const NodeIt v) const { 

      e=OutEdgeIt(*this, v); 

    }

    void getFirst(EachNodeIt& v) const { G.getFirst(v); }

    template< typename It >

    It first() const { 

      It e;

      getFirst(e);

      return e; 

    }

    template< typename It >

    It first(const NodeIt v) const { 

      It e;

      getFirst(e, v);

      return e; 

    }

    NodeIt tail(const EdgeIt e) const { return G.aNode(e.sym); }

    NodeIt head(const EdgeIt e) const { return G.bNode(e.sym); }

    NodeIt aNode(const OutEdgeIt e) const { return G.aNode(e.sym); }

    NodeIt bNode(const OutEdgeIt e) const { return G.bNode(e.sym); }

    int id(const NodeIt v) const { return G.id(v); }

    template <typename ValueType>

    class NodeMap {

      typename Graph::NodeMap<ValueType> node_map; 

    public:

      NodeMap(const ResGraph<Graph, T, FlowMap, CapacityMap>& _G) : node_map(_G.G) { }

      NodeMap(const ResGraph<Graph, T, FlowMap, CapacityMap>& _G, const ValueType a) : node_map(_G.G, a) { }

      void set(const NodeIt nit, const ValueType a) { node_map.set(nit, a); }

      ValueType get(const NodeIt nit) const { return node_map.get(nit); }

    };

  };

  template <typename Graph, typename T, typename FlowMap, typename CapacityMap>

  class MaxFlow {

    typedef typename Graph::NodeIt NodeIt;

    typedef typename Graph::EdgeIt EdgeIt;

    typedef typename Graph::EachEdgeIt EachEdgeIt;

    typedef typename Graph::OutEdgeIt OutEdgeIt;

    typedef typename Graph::InEdgeIt InEdgeIt;

    const Graph& G;

    const NodeIt s;

    const NodeIt t;

    FlowMap& flow;

    const CapacityMap& capacity;

    typedef ResGraph<Graph, T, FlowMap, CapacityMap > AugGraph;

    typedef typename AugGraph::OutEdgeIt AugOutEdgeIt;

    typedef typename AugGraph::EdgeIt AugEdgeIt;

  public:

    MaxFlow(const Graph& _G, const NodeIt _s, const NodeIt _t, FlowMap& _flow, const CapacityMap& _capacity) : G(_G), s(_s), t(_t), flow(_flow), capacity(_capacity) { }

    bool augment() {

      AugGraph res_graph(G, flow, capacity);

      bool _augment=false;

      typedef typename AugGraph::NodeMap<bool> ReachedMap;

      BfsIterator2< AugGraph, AugOutEdgeIt, ReachedMap > res_bfs(res_graph);

      res_bfs.pushAndSetReached(s);

      typename AugGraph::NodeMap<AugEdgeIt> pred(res_graph); 

      //filled with invalid iterators

      typename AugGraph::NodeMap<int> free(res_graph);

      //searching for augmenting path

      while ( !res_bfs.finished() ) { 

	//std::queue<AugOutEdgeIt> bfs_copy(res_bfs.getBfsQueue());

	//while (!bfs_copy.empty()) {

	//  AugOutEdgeIt e=bfs_copy.front();

	//  bfs_copy.pop();

	//  if (e.valid()) {

	//    std::cout<<"queue:"<<res_graph.tail(e)<<"->"<<res_graph.head(e)<<" ";

	//  } else {

	//    std::cout<<"queue:"<<res_graph.aNode(e)<<"->"<<" ";

	//  }

	//}

	//std::cout<<std::endl;

	AugOutEdgeIt e=AugOutEdgeIt(res_bfs);

	//if (e.valid()) {

	//  std::cout<<"actual:"<<res_graph.tail(e)<<"->"<<res_graph.head(e)<<std::endl;

	//} else {

	//  std::cout<<"actual:"<<res_graph.aNode(e)<<"->"<<std::endl;

	//}

	if (e.valid() && res_bfs.isBNodeNewlyReached()) {

	  NodeIt v=res_graph.tail(e);

	  NodeIt w=res_graph.head(e);

	  //std::cout<<v<<"->"<<w<<std::endl;

	  pred.set(w, e);

	  if (pred.get(v).valid()) {

	    free.set(w, std::min(free.get(v), e.free()));

	  } else {

	    free.set(w, e.free()); 

	  }

	  if (res_graph.head(e)==t) { _augment=true; break; }

	}

	++res_bfs;

      } //end of searching augmenting path

      if (_augment) {

	NodeIt n=t;

	T augment_value=free.get(t);

	//std::cout<<"augmentation: ";

	while (pred.get(n).valid()) { 

	  AugEdgeIt e=pred.get(n);

	  e.augment(augment_value); 

	  //std::cout<<"("<<res_graph.tail(e)<< "->"<<res_graph.head(e)<<") ";

	  n=res_graph.tail(e);

	}

	//std::cout<<std::endl;

      }

      //std::cout << "actual flow: "<< std::endl;

      //for(EachEdgeIt e=G.template first<EachEdgeIt>(); e.valid(); ++e) { 

      //std::cout<<"("<<G.tail(e)<< "-"<<flow.get(e)<<"->"<<G.head(e)<<") ";

      //}

      //std::cout<<std::endl;

      return _augment;

    }

    void run() {

      while (augment()) { } 

    }

  };

} // namespace marci

#endif //EDMONDS_KARP_HH