src/work/marci/lp/min_cost_gen_flow.h
changeset 1365 c280de819a73
parent 1074 4a24a46407db
equal deleted inserted replaced
6:a31cbb679b83 -1:000000000000
     1 // -*- c++ -*-
       
     2 #ifndef LEMON_MIN_COST_GEN_FLOW_H
       
     3 #define LEMON_MIN_COST_GEN_FLOW_H
       
     4 #include <iostream>
       
     5 //#include <fstream>
       
     6 
       
     7 #include <lemon/smart_graph.h>
       
     8 #include <lemon/list_graph.h>
       
     9 //#include <lemon/dimacs.h>
       
    10 //#include <lemon/time_measure.h>
       
    11 //#include <graph_wrapper.h>
       
    12 #include <lemon/preflow.h>
       
    13 #include <lemon/min_cost_flow.h>
       
    14 //#include <augmenting_flow.h>
       
    15 //#include <preflow_res.h>
       
    16 #include <work/marci/merge_node_graph_wrapper.h>
       
    17 #include <work/marci/lp/lp_solver_wrapper_3.h>
       
    18 
       
    19 namespace lemon {
       
    20 
       
    21   template<typename Edge, typename EdgeIndexMap> 
       
    22   class PrimalMap {
       
    23   protected:
       
    24     LPGLPK* lp;
       
    25     EdgeIndexMap* edge_index_map;
       
    26   public:
       
    27     PrimalMap(LPGLPK& _lp, EdgeIndexMap& _edge_index_map) : 
       
    28       lp(&_lp), edge_index_map(&_edge_index_map) { }
       
    29     double operator[](Edge e) const { 
       
    30       return lp->getPrimal((*edge_index_map)[e]);
       
    31     }
       
    32   };
       
    33 
       
    34   // excess: rho-delta egyelore csak =0-ra.
       
    35   template <typename Graph, typename Num,
       
    36 	    typename Excess=typename Graph::template NodeMap<Num>, 
       
    37 	    typename LCapMap=typename Graph::template EdgeMap<Num>,
       
    38 	    typename CapMap=typename Graph::template EdgeMap<Num>,
       
    39             typename FlowMap=typename Graph::template EdgeMap<Num>,
       
    40 	    typename CostMap=typename Graph::template EdgeMap<Num> >
       
    41   class MinCostGenFlow {
       
    42   protected:
       
    43     const Graph& g;
       
    44     const Excess& excess;
       
    45     const LCapMap& lcapacity;
       
    46     const CapMap& capacity;
       
    47     FlowMap& flow;
       
    48     const CostMap& cost;
       
    49   public:
       
    50     MinCostGenFlow(const Graph& _g, const Excess& _excess, 
       
    51 		   const LCapMap& _lcapacity, const CapMap& _capacity, 
       
    52 		   FlowMap& _flow, 
       
    53 		   const CostMap& _cost) :
       
    54       g(_g), excess(_excess), lcapacity(_lcapacity),
       
    55       capacity(_capacity), flow(_flow), cost(_cost) { }
       
    56     bool feasible() {
       
    57       //      std::cout << "making new vertices..." << std::endl; 
       
    58       typedef ListGraph Graph2;
       
    59       Graph2 g2;
       
    60       typedef MergeEdgeGraphWrapper<const Graph, Graph2> GW;
       
    61       //      std::cout << "merging..." << std::endl; 
       
    62       GW gw(g, g2);
       
    63       typename GW::Node s(INVALID, g2.addNode(), true);
       
    64       typename GW::Node t(INVALID, g2.addNode(), true);
       
    65       typedef SmartGraph Graph3;
       
    66       //      std::cout << "making extender graph..." << std::endl; 
       
    67       typedef NewEdgeSetGraphWrapper2<GW, Graph3> GWW;
       
    68 //       {
       
    69 // 	checkConcept<StaticGraph, GWW>();   
       
    70 //       }
       
    71       GWW gww(gw);
       
    72       typedef AugmentingGraphWrapper<GW, GWW> GWWW;
       
    73       GWWW gwww(gw, gww);
       
    74 
       
    75       //      std::cout << "making new edges..." << std::endl; 
       
    76       typename GWWW::template EdgeMap<Num> translated_cap(gwww);
       
    77 
       
    78       for (typename GW::EdgeIt e(gw); e!=INVALID; ++e) {
       
    79 	translated_cap.set(typename GWWW::Edge(e,INVALID,false), 
       
    80 			   capacity[e]-lcapacity[e]);
       
    81 	//	cout << "t_cap " << gw.id(e) << " " 
       
    82 	//	     << translated_cap[typename GWWW::Edge(e,INVALID,false)] << endl;
       
    83       }
       
    84 
       
    85       Num expected=0;
       
    86 
       
    87       //      std::cout << "making new edges 2..." << std::endl; 
       
    88       for (typename Graph::NodeIt n(g); n!=INVALID; ++n) {
       
    89 	Num a=0;
       
    90 	for (typename Graph::InEdgeIt e(g, n); e!=INVALID; ++e)
       
    91 	  a+=lcapacity[e];
       
    92 	for (typename Graph::OutEdgeIt e(g, n); e!=INVALID; ++e) 
       
    93 	  a-=lcapacity[e];
       
    94 	if (excess[n]>a) {
       
    95 	  typename GWW::Edge e=
       
    96 	    gww.addEdge(typename GW::Node(n,INVALID,false), t);
       
    97 	  translated_cap.set(typename GWWW::Edge(INVALID, e, true), 
       
    98 			     excess[n]-a);
       
    99 	  //	  std::cout << g.id(n) << "->t " << excess[n]-a << std::endl;
       
   100 	}
       
   101 	if (excess[n]<a) {
       
   102 	  typename GWW::Edge e=
       
   103 	    gww.addEdge(s, typename GW::Node(n,INVALID,false));
       
   104 	  translated_cap.set(typename GWWW::Edge(INVALID, e, true), 
       
   105 			     a-excess[n]);
       
   106 	  expected+=a-excess[n];
       
   107 	  //	  std::cout << "s->" << g.id(n) << " "<< a-excess[n] <<std:: endl;
       
   108 	}
       
   109       }
       
   110 
       
   111       //      std::cout << "preflow..." << std::endl; 
       
   112       typename GWWW::template EdgeMap<Num> translated_flow(gwww, 0);
       
   113       Preflow<GWWW, Num> preflow(gwww, s, t, 
       
   114 				 translated_cap, translated_flow);
       
   115       preflow.run();
       
   116       //      std::cout << "fv: " << preflow.flowValue() << std::endl; 
       
   117       //      std::cout << "expected: " << expected << std::endl; 
       
   118 
       
   119       for (typename Graph::EdgeIt e(g); e!=INVALID; ++e) {
       
   120 	typename GW::Edge ew(e, INVALID, false);
       
   121 	typename GWWW::Edge ewww(ew, INVALID, false);
       
   122 	flow.set(e, translated_flow[ewww]+lcapacity[e]);
       
   123       }
       
   124       return (preflow.flowValue()>=expected);
       
   125     }
       
   126     // for nonnegative costs
       
   127     bool run() {
       
   128       //      std::cout << "making new vertices..." << std::endl; 
       
   129       typedef ListGraph Graph2;
       
   130       Graph2 g2;
       
   131       typedef MergeEdgeGraphWrapper<const Graph, Graph2> GW;
       
   132       //      std::cout << "merging..." << std::endl; 
       
   133       GW gw(g, g2);
       
   134       typename GW::Node s(INVALID, g2.addNode(), true);
       
   135       typename GW::Node t(INVALID, g2.addNode(), true);
       
   136       typedef SmartGraph Graph3;
       
   137       //      std::cout << "making extender graph..." << std::endl; 
       
   138       typedef NewEdgeSetGraphWrapper2<GW, Graph3> GWW;
       
   139 //       {
       
   140 // 	checkConcept<StaticGraph, GWW>();   
       
   141 //       }
       
   142       GWW gww(gw);
       
   143       typedef AugmentingGraphWrapper<GW, GWW> GWWW;
       
   144       GWWW gwww(gw, gww);
       
   145 
       
   146       //      std::cout << "making new edges..." << std::endl; 
       
   147       typename GWWW::template EdgeMap<Num> translated_cap(gwww);
       
   148 
       
   149       for (typename Graph::EdgeIt e(g); e!=INVALID; ++e) {
       
   150 	typename GW::Edge ew(e, INVALID, false);
       
   151 	typename GWWW::Edge ewww(ew, INVALID, false);
       
   152 	translated_cap.set(ewww, capacity[e]-lcapacity[e]);
       
   153 	//	cout << "t_cap " << g.id(e) << " " 
       
   154 	//	     << translated_cap[ewww] << endl;
       
   155       }
       
   156 
       
   157       Num expected=0;
       
   158 
       
   159       //      std::cout << "making new edges 2..." << std::endl; 
       
   160       for (typename Graph::NodeIt n(g); n!=INVALID; ++n) {
       
   161 	//	std::cout << "node: " << g.id(n) << std::endl;
       
   162 	Num a=0;
       
   163 	for (typename Graph::InEdgeIt e(g, n); e!=INVALID; ++e) {
       
   164 	  a+=lcapacity[e];
       
   165 	  //	  std::cout << "bee: " << g.id(e) << " " << lcapacity[e] << std::endl;
       
   166 	}
       
   167 	for (typename Graph::OutEdgeIt e(g, n); e!=INVALID; ++e) {
       
   168 	  a-=lcapacity[e];
       
   169 	  //	  std::cout << "kie: " << g.id(e) << " " << lcapacity[e] << std::endl;
       
   170 	}
       
   171 	//	std::cout << "excess " << g.id(n) << ": " << a << std::endl;
       
   172 	if (0>a) {
       
   173 	  typename GWW::Edge e=
       
   174 	    gww.addEdge(typename GW::Node(n,INVALID,false), t);
       
   175 	  translated_cap.set(typename GWWW::Edge(INVALID, e, true), 
       
   176 			     -a);
       
   177 	  //	  std::cout << g.id(n) << "->t " << -a << std::endl;
       
   178 	}
       
   179 	if (0<a) {
       
   180 	  typename GWW::Edge e=
       
   181 	    gww.addEdge(s, typename GW::Node(n,INVALID,false));
       
   182 	  translated_cap.set(typename GWWW::Edge(INVALID, e, true), 
       
   183 			     a);
       
   184 	  expected+=a;
       
   185 	  //	  std::cout << "s->" << g.id(n) << " "<< a <<std:: endl;
       
   186 	}
       
   187       }
       
   188 
       
   189       //      std::cout << "preflow..." << std::endl; 
       
   190       typename GWWW::template EdgeMap<Num> translated_cost(gwww, 0);
       
   191       for (typename Graph::EdgeIt e(g); e!=INVALID; ++e) {
       
   192 	translated_cost.set(typename GWWW::Edge(
       
   193         typename GW::Edge(e, INVALID, false), INVALID, false), cost[e]);
       
   194       }
       
   195       //      typename GWWW::template EdgeMap<Num> translated_flow(gwww, 0);
       
   196       MinCostFlow<GWWW, typename GWWW::template EdgeMap<Num>, 
       
   197       typename GWWW::template EdgeMap<Num> > 
       
   198       min_cost_flow(gwww, translated_cost, translated_cap, 
       
   199 		    s, t);
       
   200       while (min_cost_flow.augment()) { }
       
   201       std::cout << "fv: " << min_cost_flow.flowValue() << std::endl; 
       
   202       std::cout << "expected: " << expected << std::endl; 
       
   203 
       
   204       for (typename Graph::EdgeIt e(g); e!=INVALID; ++e) {
       
   205 	typename GW::Edge ew(e, INVALID, false);
       
   206 	typename GWWW::Edge ewww(ew, INVALID, false);
       
   207 	//	std::cout << g.id(e) << " " << flow[e] << std::endl;
       
   208 	flow.set(e, lcapacity[e]+
       
   209 		 min_cost_flow.getFlow()[ewww]);
       
   210       }
       
   211       return (min_cost_flow.flowValue()>=expected);
       
   212     }
       
   213     void runByLP() {
       
   214       typedef LPGLPK LPSolver;
       
   215       LPSolver lp;
       
   216       lp.setMinimize();
       
   217       typedef LPSolver::ColIt ColIt;
       
   218       typedef LPSolver::RowIt RowIt;
       
   219       typedef typename Graph::template EdgeMap<ColIt> EdgeIndexMap;
       
   220       EdgeIndexMap edge_index_map(g);
       
   221       PrimalMap<typename Graph::Edge, EdgeIndexMap> lp_flow(lp, edge_index_map);
       
   222       for (typename Graph::EdgeIt e(g); e!=INVALID; ++e) {
       
   223 	ColIt col_it=lp.addCol();
       
   224 	edge_index_map.set(e, col_it);
       
   225 	if (lcapacity[e]==capacity[e])
       
   226 	  lp.setColBounds(col_it, LPSolver::FIXED, lcapacity[e], capacity[e]);
       
   227 	else 
       
   228 	  lp.setColBounds(col_it, LPSolver::DOUBLE, lcapacity[e], capacity[e]);
       
   229 	lp.setObjCoef(col_it, cost[e]);
       
   230       }
       
   231       LPSolver::ColIt col_it;
       
   232       for (lp.col_iter_map.first(col_it, lp.VALID_CLASS); 
       
   233 	   lp.col_iter_map.valid(col_it); 
       
   234 	   lp.col_iter_map.next(col_it)) {
       
   235 //	std::cout << "ize " << lp.col_iter_map[col_it] << std::endl;
       
   236       }
       
   237       for (typename Graph::NodeIt n(g); n!=INVALID; ++n) {
       
   238 	typename Graph::template EdgeMap<Num> coeffs(g, 0);
       
   239 	for (typename Graph::InEdgeIt e(g, n); e!=INVALID; ++e)
       
   240 	coeffs.set(e, coeffs[e]+1);
       
   241 	for (typename Graph::OutEdgeIt e(g, n); e!=INVALID; ++e) 
       
   242 	coeffs.set(e, coeffs[e]-1);
       
   243 	RowIt row_it=lp.addRow();
       
   244 	typename std::vector< std::pair<ColIt, double> > row;
       
   245 	//std::cout << "node:" <<g.id(n)<<std::endl;
       
   246 	for (typename Graph::EdgeIt e(g); e!=INVALID; ++e) {
       
   247 	  if (coeffs[e]!=0) {
       
   248 	    //std::cout << " edge:" <<g.id(e)<<" "<<coeffs[e];
       
   249 	    row.push_back(std::make_pair(edge_index_map[e], coeffs[e]));
       
   250 	  }
       
   251 	}
       
   252 	//std::cout << std::endl;
       
   253 	//std::cout << " " << g.id(n) << " " << row.size() << std::endl;
       
   254 	lp.setRowCoeffs(row_it, row.begin(), row.end());
       
   255 	lp.setRowBounds(row_it, LPSolver::FIXED, 0.0, 0.0);
       
   256       }
       
   257       lp.solveSimplex();
       
   258       //std::cout << lp.colNum() << std::endl;
       
   259       //std::cout << lp.rowNum() << std::endl;
       
   260       //std::cout << "flow value: "<< lp.getObjVal() << std::endl;
       
   261       for (typename Graph::EdgeIt e(g); e!=INVALID; ++e) 
       
   262       flow.set(e, lp_flow[e]);
       
   263     }
       
   264   };
       
   265 
       
   266 } // namespace lemon
       
   267 
       
   268 #endif //LEMON_MIN_COST_GEN_FLOW_H