/* -*- C++ -*-

  *

  * This file is a part of LEMON, a generic C++ optimization library

  *

  * Copyright (C) 2003-2008

  * Egervary Jeno Kombinatorikus Optimalizalasi Kutatocsoport

  * (Egervary Research Group on Combinatorial Optimization, EGRES).

  *

  * Permission to use, modify and distribute this software is granted

  * provided that this copyright notice appears in all copies. For

  * precise terms see the accompanying LICENSE file.

  *

  * This software is provided "AS IS" with no warranty of any kind,

  * express or implied, and with no claim as to its suitability for any

  * purpose.

  *

  */

 #ifndef LEMON_CAPACITY_SCALING_H

 #define LEMON_CAPACITY_SCALING_H

 /// \ingroup min_cost_flow

 ///

 /// \file

 /// \brief Capacity scaling algorithm for finding a minimum cost flow.

 #include <vector>

 #include <lemon/bin_heap.h>

 namespace lemon {

   /// \addtogroup min_cost_flow

   /// @{

   /// \brief Implementation of the capacity scaling algorithm for

   /// finding a minimum cost flow.

   ///

   /// \ref CapacityScaling implements the capacity scaling version

   /// of the successive shortest path algorithm for finding a minimum

   /// cost flow.

   ///

   /// \tparam Digraph The digraph type the algorithm runs on.

   /// \tparam LowerMap The type of the lower bound map.

   /// \tparam CapacityMap The type of the capacity (upper bound) map.

   /// \tparam CostMap The type of the cost (length) map.

   /// \tparam SupplyMap The type of the supply map.

   ///

   /// \warning

   /// - Arc capacities and costs should be \e non-negative \e integers.

   /// - Supply values should be \e signed \e integers.

   /// - The value types of the maps should be convertible to each other.

   /// - \c CostMap::Value must be signed type.

   ///

   /// \author Peter Kovacs

   template < typename Digraph,

              typename LowerMap = typename Digraph::template ArcMap<int>,

              typename CapacityMap = typename Digraph::template ArcMap<int>,

              typename CostMap = typename Digraph::template ArcMap<int>,

              typename SupplyMap = typename Digraph::template NodeMap<int> >

   class CapacityScaling

   {

     TEMPLATE_DIGRAPH_TYPEDEFS(Digraph);

     typedef typename CapacityMap::Value Capacity;

     typedef typename CostMap::Value Cost;

     typedef typename SupplyMap::Value Supply;

     typedef typename Digraph::template ArcMap<Capacity> CapacityArcMap;

     typedef typename Digraph::template NodeMap<Supply> SupplyNodeMap;

     typedef typename Digraph::template NodeMap<Arc> PredMap;

   public:

     /// The type of the flow map.

     typedef typename Digraph::template ArcMap<Capacity> FlowMap;

     /// The type of the potential map.

     typedef typename Digraph::template NodeMap<Cost> PotentialMap;

   private:

     /// \brief Special implementation of the \ref Dijkstra algorithm

     /// for finding shortest paths in the residual network.

     ///

     /// \ref ResidualDijkstra is a special implementation of the

     /// \ref Dijkstra algorithm for finding shortest paths in the

     /// residual network of the digraph with respect to the reduced arc

     /// costs and modifying the node potentials according to the

     /// distance of the nodes.

     class ResidualDijkstra

     {

       typedef typename Digraph::template NodeMap<int> HeapCrossRef;

       typedef BinHeap<Cost, HeapCrossRef> Heap;

     private:

       // The digraph the algorithm runs on

       const Digraph &_graph;

       // The main maps

       const FlowMap &_flow;

       const CapacityArcMap &_res_cap;

       const CostMap &_cost;

       const SupplyNodeMap &_excess;

       PotentialMap &_potential;

       // The distance map

       PotentialMap _dist;

       // The pred arc map

       PredMap &_pred;

       // The processed (i.e. permanently labeled) nodes

       std::vector<Node> _proc_nodes;

     public:

       /// Constructor.

       ResidualDijkstra( const Digraph &digraph,

                         const FlowMap &flow,

                         const CapacityArcMap &res_cap,

                         const CostMap &cost,

                         const SupplyMap &excess,

                         PotentialMap &potential,

                         PredMap &pred ) :

         _graph(digraph), _flow(flow), _res_cap(res_cap), _cost(cost),

         _excess(excess), _potential(potential), _dist(digraph),

         _pred(pred)

       {}

       /// Run the algorithm from the given source node.

       Node run(Node s, Capacity delta = 1) {

         HeapCrossRef heap_cross_ref(_graph, Heap::PRE_HEAP);

         Heap heap(heap_cross_ref);

         heap.push(s, 0);

         _pred[s] = INVALID;

         _proc_nodes.clear();

         // Processing nodes

         while (!heap.empty() && _excess[heap.top()] > -delta) {

           Node u = heap.top(), v;

           Cost d = heap.prio() + _potential[u], nd;

           _dist[u] = heap.prio();

           heap.pop();

           _proc_nodes.push_back(u);

           // Traversing outgoing arcs

           for (OutArcIt e(_graph, u); e != INVALID; ++e) {

             if (_res_cap[e] >= delta) {

               v = _graph.target(e);

               switch(heap.state(v)) {

               case Heap::PRE_HEAP:

                 heap.push(v, d + _cost[e] - _potential[v]);

                 _pred[v] = e;

                 break;

               case Heap::IN_HEAP:

                 nd = d + _cost[e] - _potential[v];

                 if (nd < heap[v]) {

                   heap.decrease(v, nd);

                   _pred[v] = e;

                 }

                 break;

               case Heap::POST_HEAP:

                 break;

               }

             }

           }

           // Traversing incoming arcs

           for (InArcIt e(_graph, u); e != INVALID; ++e) {

             if (_flow[e] >= delta) {

               v = _graph.source(e);

               switch(heap.state(v)) {

               case Heap::PRE_HEAP:

                 heap.push(v, d - _cost[e] - _potential[v]);

                 _pred[v] = e;

                 break;

               case Heap::IN_HEAP:

                 nd = d - _cost[e] - _potential[v];

                 if (nd < heap[v]) {

                   heap.decrease(v, nd);

                   _pred[v] = e;

                 }

                 break;

               case Heap::POST_HEAP:

                 break;

               }

             }

           }

         }

         if (heap.empty()) return INVALID;

         // Updating potentials of processed nodes

         Node t = heap.top();

         Cost t_dist = heap.prio();

         for (int i = 0; i < int(_proc_nodes.size()); ++i)

           _potential[_proc_nodes[i]] += _dist[_proc_nodes[i]] - t_dist;

         return t;

       }

     }; //class ResidualDijkstra

   private:

     // The digraph the algorithm runs on

     const Digraph &_graph;

     // The original lower bound map

     const LowerMap *_lower;

     // The modified capacity map

     CapacityArcMap _capacity;

     // The original cost map

     const CostMap &_cost;

     // The modified supply map

     SupplyNodeMap _supply;

     bool _valid_supply;

     // Arc map of the current flow

     FlowMap *_flow;

     bool _local_flow;

     // Node map of the current potentials

     PotentialMap *_potential;

     bool _local_potential;

     // The residual capacity map

     CapacityArcMap _res_cap;

     // The excess map

     SupplyNodeMap _excess;

     // The excess nodes (i.e. nodes with positive excess)

     std::vector<Node> _excess_nodes;

     // The deficit nodes (i.e. nodes with negative excess)

     std::vector<Node> _deficit_nodes;

     // The delta parameter used for capacity scaling

     Capacity _delta;

     // The maximum number of phases

     int _phase_num;

     // The pred arc map

     PredMap _pred;

     // Implementation of the Dijkstra algorithm for finding augmenting

     // shortest paths in the residual network

     ResidualDijkstra *_dijkstra;

   public:

     /// \brief General constructor (with lower bounds).

     ///

     /// General constructor (with lower bounds).

     ///

     /// \param digraph The digraph the algorithm runs on.

     /// \param lower The lower bounds of the arcs.

     /// \param capacity The capacities (upper bounds) of the arcs.

     /// \param cost The cost (length) values of the arcs.

     /// \param supply The supply values of the nodes (signed).

     CapacityScaling( const Digraph &digraph,

                      const LowerMap &lower,

                      const CapacityMap &capacity,

                      const CostMap &cost,

                      const SupplyMap &supply ) :

       _graph(digraph), _lower(&lower), _capacity(digraph), _cost(cost),

       _supply(digraph), _flow(NULL), _local_flow(false),

       _potential(NULL), _local_potential(false),

       _res_cap(digraph), _excess(digraph), _pred(digraph), _dijkstra(NULL)

     {

       Supply sum = 0;

       for (NodeIt n(_graph); n != INVALID; ++n) {

         _supply[n] = supply[n];

         _excess[n] = supply[n];

         sum += supply[n];

       }

       _valid_supply = sum == 0;

       for (ArcIt a(_graph); a != INVALID; ++a) {

         _capacity[a] = capacity[a];

         _res_cap[a] = capacity[a];

       }

       // Remove non-zero lower bounds

       typename LowerMap::Value lcap;

       for (ArcIt e(_graph); e != INVALID; ++e) {

         if ((lcap = lower[e]) != 0) {

           _capacity[e] -= lcap;

           _res_cap[e] -= lcap;

           _supply[_graph.source(e)] -= lcap;

           _supply[_graph.target(e)] += lcap;

           _excess[_graph.source(e)] -= lcap;

           _excess[_graph.target(e)] += lcap;

         }

       }

     }

 /*

     /// \brief General constructor (without lower bounds).

     ///

     /// General constructor (without lower bounds).

     ///

     /// \param digraph The digraph the algorithm runs on.

     /// \param capacity The capacities (upper bounds) of the arcs.

     /// \param cost The cost (length) values of the arcs.

     /// \param supply The supply values of the nodes (signed).

     CapacityScaling( const Digraph &digraph,

                      const CapacityMap &capacity,

                      const CostMap &cost,

                      const SupplyMap &supply ) :

       _graph(digraph), _lower(NULL), _capacity(capacity), _cost(cost),

       _supply(supply), _flow(NULL), _local_flow(false),

       _potential(NULL), _local_potential(false),

       _res_cap(capacity), _excess(supply), _pred(digraph), _dijkstra(NULL)

     {

       // Check the sum of supply values

       Supply sum = 0;

       for (NodeIt n(_graph); n != INVALID; ++n) sum += _supply[n];

       _valid_supply = sum == 0;

     }

     /// \brief Simple constructor (with lower bounds).

     ///

     /// Simple constructor (with lower bounds).

     ///

     /// \param digraph The digraph the algorithm runs on.

     /// \param lower The lower bounds of the arcs.

     /// \param capacity The capacities (upper bounds) of the arcs.

     /// \param cost The cost (length) values of the arcs.

     /// \param s The source node.

     /// \param t The target node.

     /// \param flow_value The required amount of flow from node \c s

     /// to node \c t (i.e. the supply of \c s and the demand of \c t).

     CapacityScaling( const Digraph &digraph,

                      const LowerMap &lower,

                      const CapacityMap &capacity,

                      const CostMap &cost,

                      Node s, Node t,

                      Supply flow_value ) :

       _graph(digraph), _lower(&lower), _capacity(capacity), _cost(cost),

       _supply(digraph, 0), _flow(NULL), _local_flow(false),

       _potential(NULL), _local_potential(false),

       _res_cap(capacity), _excess(digraph, 0), _pred(digraph), _dijkstra(NULL)

     {

       // Remove non-zero lower bounds

       _supply[s] = _excess[s] =  flow_value;

       _supply[t] = _excess[t] = -flow_value;

       typename LowerMap::Value lcap;

       for (ArcIt e(_graph); e != INVALID; ++e) {

         if ((lcap = lower[e]) != 0) {

           _capacity[e] -= lcap;

           _res_cap[e] -= lcap;

           _supply[_graph.source(e)] -= lcap;

           _supply[_graph.target(e)] += lcap;

           _excess[_graph.source(e)] -= lcap;

           _excess[_graph.target(e)] += lcap;

         }

       }

       _valid_supply = true;

     }

     /// \brief Simple constructor (without lower bounds).

     ///

     /// Simple constructor (without lower bounds).

     ///

     /// \param digraph The digraph the algorithm runs on.

     /// \param capacity The capacities (upper bounds) of the arcs.

     /// \param cost The cost (length) values of the arcs.

     /// \param s The source node.

     /// \param t The target node.

     /// \param flow_value The required amount of flow from node \c s

     /// to node \c t (i.e. the supply of \c s and the demand of \c t).

     CapacityScaling( const Digraph &digraph,

                      const CapacityMap &capacity,

                      const CostMap &cost,

                      Node s, Node t,

                      Supply flow_value ) :

       _graph(digraph), _lower(NULL), _capacity(capacity), _cost(cost),

       _supply(digraph, 0), _flow(NULL), _local_flow(false),

       _potential(NULL), _local_potential(false),

       _res_cap(capacity), _excess(digraph, 0), _pred(digraph), _dijkstra(NULL)

     {

       _supply[s] = _excess[s] =  flow_value;

       _supply[t] = _excess[t] = -flow_value;

       _valid_supply = true;

     }

 */

     /// Destructor.

     ~CapacityScaling() {

       if (_local_flow) delete _flow;

       if (_local_potential) delete _potential;

       delete _dijkstra;

     }

     /// \brief Set the flow map.

     ///

     /// Set the flow map.

     ///

     /// \return \c (*this)

     CapacityScaling& flowMap(FlowMap &map) {

       if (_local_flow) {

         delete _flow;

         _local_flow = false;

       }

       _flow = ↦

       return *this;

     }

     /// \brief Set the potential map.

     ///

     /// Set the potential map.

     ///

     /// \return \c (*this)

     CapacityScaling& potentialMap(PotentialMap &map) {

       if (_local_potential) {

         delete _potential;

         _local_potential = false;

       }

       _potential = ↦

       return *this;

     }

     /// \name Execution control

     /// @{

     /// \brief Run the algorithm.

     ///

     /// This function runs the algorithm.

     ///

     /// \param scaling Enable or disable capacity scaling.

     /// If the maximum arc capacity and/or the amount of total supply

     /// is rather small, the algorithm could be slightly faster without

     /// scaling.

     ///

     /// \return \c true if a feasible flow can be found.

     bool run(bool scaling = true) {

       return init(scaling) && start();

     }

     /// @}

     /// \name Query Functions

     /// The results of the algorithm can be obtained using these

     /// functions.\n

     /// \ref lemon::CapacityScaling::run() "run()" must be called before

     /// using them.

     /// @{

     /// \brief Return a const reference to the arc map storing the

     /// found flow.

     ///

     /// Return a const reference to the arc map storing the found flow.

     ///

     /// \pre \ref run() must be called before using this function.

     const FlowMap& flowMap() const {

       return *_flow;

     }

     /// \brief Return a const reference to the node map storing the

     /// found potentials (the dual solution).

     ///

     /// Return a const reference to the node map storing the found

     /// potentials (the dual solution).

     ///

     /// \pre \ref run() must be called before using this function.

     const PotentialMap& potentialMap() const {

       return *_potential;

     }

     /// \brief Return the flow on the given arc.

     ///

     /// Return the flow on the given arc.

     ///

     /// \pre \ref run() must be called before using this function.

     Capacity flow(const Arc& arc) const {

       return (*_flow)[arc];

     }

     /// \brief Return the potential of the given node.

     ///

     /// Return the potential of the given node.

     ///

     /// \pre \ref run() must be called before using this function.

     Cost potential(const Node& node) const {

       return (*_potential)[node];

     }

     /// \brief Return the total cost of the found flow.

     ///

     /// Return the total cost of the found flow. The complexity of the

     /// function is \f$ O(e) \f$.

     ///

     /// \pre \ref run() must be called before using this function.

     Cost totalCost() const {

       Cost c = 0;

       for (ArcIt e(_graph); e != INVALID; ++e)

         c += (*_flow)[e] * _cost[e];

       return c;

     }

     /// @}

   private:

     /// Initialize the algorithm.

     bool init(bool scaling) {

       if (!_valid_supply) return false;

       // Initializing maps

       if (!_flow) {

         _flow = new FlowMap(_graph);

         _local_flow = true;

       }

       if (!_potential) {

         _potential = new PotentialMap(_graph);

         _local_potential = true;

       }

       for (ArcIt e(_graph); e != INVALID; ++e) (*_flow)[e] = 0;

       for (NodeIt n(_graph); n != INVALID; ++n) (*_potential)[n] = 0;

       _dijkstra = new ResidualDijkstra( _graph, *_flow, _res_cap, _cost,

                                         _excess, *_potential, _pred );

       // Initializing delta value

       if (scaling) {

         // With scaling

         Supply max_sup = 0, max_dem = 0;

         for (NodeIt n(_graph); n != INVALID; ++n) {

           if ( _supply[n] > max_sup) max_sup =  _supply[n];

           if (-_supply[n] > max_dem) max_dem = -_supply[n];

         }

         Capacity max_cap = 0;

         for (ArcIt e(_graph); e != INVALID; ++e) {

           if (_capacity[e] > max_cap) max_cap = _capacity[e];

         }

         max_sup = std::min(std::min(max_sup, max_dem), max_cap);

         _phase_num = 0;

         for (_delta = 1; 2 * _delta <= max_sup; _delta *= 2)

           ++_phase_num;

       } else {

         // Without scaling

         _delta = 1;

       }

       return true;

     }

     bool start() {

       if (_delta > 1)

         return startWithScaling();

       else

         return startWithoutScaling();

     }

     /// Execute the capacity scaling algorithm.

     bool startWithScaling() {

       // Processing capacity scaling phases

       Node s, t;

       int phase_cnt = 0;

       int factor = 4;

       while (true) {

         // Saturating all arcs not satisfying the optimality condition

         for (ArcIt e(_graph); e != INVALID; ++e) {

           Node u = _graph.source(e), v = _graph.target(e);

           Cost c = _cost[e] + (*_potential)[u] - (*_potential)[v];

           if (c < 0 && _res_cap[e] >= _delta) {

             _excess[u] -= _res_cap[e];

             _excess[v] += _res_cap[e];

             (*_flow)[e] = _capacity[e];

             _res_cap[e] = 0;

           }

           else if (c > 0 && (*_flow)[e] >= _delta) {

             _excess[u] += (*_flow)[e];

             _excess[v] -= (*_flow)[e];

             (*_flow)[e] = 0;

             _res_cap[e] = _capacity[e];

           }

         }

         // Finding excess nodes and deficit nodes

         _excess_nodes.clear();

         _deficit_nodes.clear();

         for (NodeIt n(_graph); n != INVALID; ++n) {

           if (_excess[n] >=  _delta) _excess_nodes.push_back(n);

           if (_excess[n] <= -_delta) _deficit_nodes.push_back(n);

         }

         int next_node = 0, next_def_node = 0;

         // Finding augmenting shortest paths

         while (next_node < int(_excess_nodes.size())) {

           // Checking deficit nodes

           if (_delta > 1) {

             bool delta_deficit = false;

             for ( ; next_def_node < int(_deficit_nodes.size());

                     ++next_def_node ) {

               if (_excess[_deficit_nodes[next_def_node]] <= -_delta) {

                 delta_deficit = true;

                 break;

               }

             }

             if (!delta_deficit) break;

           }

           // Running Dijkstra

           s = _excess_nodes[next_node];

           if ((t = _dijkstra->run(s, _delta)) == INVALID) {

             if (_delta > 1) {

               ++next_node;

               continue;

             }

             return false;

           }

           // Augmenting along a shortest path from s to t.

           Capacity d = std::min(_excess[s], -_excess[t]);

           Node u = t;

           Arc e;

           if (d > _delta) {

             while ((e = _pred[u]) != INVALID) {

               Capacity rc;

               if (u == _graph.target(e)) {

                 rc = _res_cap[e];

                 u = _graph.source(e);

               } else {

                 rc = (*_flow)[e];

                 u = _graph.target(e);

               }

               if (rc < d) d = rc;

             }

           }

           u = t;

           while ((e = _pred[u]) != INVALID) {

             if (u == _graph.target(e)) {

               (*_flow)[e] += d;

               _res_cap[e] -= d;

               u = _graph.source(e);

             } else {

               (*_flow)[e] -= d;

               _res_cap[e] += d;

               u = _graph.target(e);

             }

           }

           _excess[s] -= d;

           _excess[t] += d;

           if (_excess[s] < _delta) ++next_node;

         }

         if (_delta == 1) break;

         if (++phase_cnt > _phase_num / 4) factor = 2;

         _delta = _delta <= factor ? 1 : _delta / factor;

       }

       // Handling non-zero lower bounds

       if (_lower) {

         for (ArcIt e(_graph); e != INVALID; ++e)

           (*_flow)[e] += (*_lower)[e];

       }

       return true;

     }

     /// Execute the successive shortest path algorithm.

     bool startWithoutScaling() {

       // Finding excess nodes

       for (NodeIt n(_graph); n != INVALID; ++n)

         if (_excess[n] > 0) _excess_nodes.push_back(n);

       if (_excess_nodes.size() == 0) return true;

       int next_node = 0;

       // Finding shortest paths

       Node s, t;

       while ( _excess[_excess_nodes[next_node]] > 0 ||

               ++next_node < int(_excess_nodes.size()) )

       {

         // Running Dijkstra

         s = _excess_nodes[next_node];

         if ((t = _dijkstra->run(s)) == INVALID) return false;

         // Augmenting along a shortest path from s to t

         Capacity d = std::min(_excess[s], -_excess[t]);

         Node u = t;

         Arc e;

         if (d > 1) {

           while ((e = _pred[u]) != INVALID) {

             Capacity rc;

             if (u == _graph.target(e)) {

               rc = _res_cap[e];

               u = _graph.source(e);

             } else {

               rc = (*_flow)[e];

               u = _graph.target(e);

             }

             if (rc < d) d = rc;

           }

         }

         u = t;

         while ((e = _pred[u]) != INVALID) {

           if (u == _graph.target(e)) {

             (*_flow)[e] += d;

             _res_cap[e] -= d;

             u = _graph.source(e);

           } else {

             (*_flow)[e] -= d;

             _res_cap[e] += d;

             u = _graph.target(e);

           }

         }

         _excess[s] -= d;

         _excess[t] += d;

       }

       // Handling non-zero lower bounds

       if (_lower) {

         for (ArcIt e(_graph); e != INVALID; ++e)

           (*_flow)[e] += (*_lower)[e];

       }

       return true;

     }

   }; //class CapacityScaling

   ///@}

 } //namespace lemon

 #endif //LEMON_CAPACITY_SCALING_H