lemon/network_simplex.h
author Alpar Juttner <alpar@cs.elte.hu>
Wed, 17 Mar 2010 10:23:17 +0100
branch1.1
changeset 723 1248d23d6e93
parent 639 f3792d5bb294
child 729 5205145fabf6
permissions -rw-r--r--
Merge bugfix #356 to branch 1.1
kpeter@593
     1
/* -*- mode: C++; indent-tabs-mode: nil; -*-
kpeter@593
     2
 *
kpeter@593
     3
 * This file is a part of LEMON, a generic C++ optimization library.
kpeter@593
     4
 *
kpeter@593
     5
 * Copyright (C) 2003-2009
kpeter@593
     6
 * Egervary Jeno Kombinatorikus Optimalizalasi Kutatocsoport
kpeter@593
     7
 * (Egervary Research Group on Combinatorial Optimization, EGRES).
kpeter@593
     8
 *
kpeter@593
     9
 * Permission to use, modify and distribute this software is granted
kpeter@593
    10
 * provided that this copyright notice appears in all copies. For
kpeter@593
    11
 * precise terms see the accompanying LICENSE file.
kpeter@593
    12
 *
kpeter@593
    13
 * This software is provided "AS IS" with no warranty of any kind,
kpeter@593
    14
 * express or implied, and with no claim as to its suitability for any
kpeter@593
    15
 * purpose.
kpeter@593
    16
 *
kpeter@593
    17
 */
kpeter@593
    18
kpeter@593
    19
#ifndef LEMON_NETWORK_SIMPLEX_H
kpeter@593
    20
#define LEMON_NETWORK_SIMPLEX_H
kpeter@593
    21
kpeter@661
    22
/// \ingroup min_cost_flow_algs
kpeter@593
    23
///
kpeter@593
    24
/// \file
kpeter@597
    25
/// \brief Network Simplex algorithm for finding a minimum cost flow.
kpeter@593
    26
kpeter@593
    27
#include <vector>
kpeter@593
    28
#include <limits>
kpeter@593
    29
#include <algorithm>
kpeter@593
    30
kpeter@595
    31
#include <lemon/core.h>
kpeter@593
    32
#include <lemon/math.h>
kpeter@593
    33
kpeter@593
    34
namespace lemon {
kpeter@593
    35
kpeter@661
    36
  /// \addtogroup min_cost_flow_algs
kpeter@593
    37
  /// @{
kpeter@593
    38
kpeter@597
    39
  /// \brief Implementation of the primal Network Simplex algorithm
kpeter@593
    40
  /// for finding a \ref min_cost_flow "minimum cost flow".
kpeter@593
    41
  ///
kpeter@597
    42
  /// \ref NetworkSimplex implements the primal Network Simplex algorithm
kpeter@593
    43
  /// for finding a \ref min_cost_flow "minimum cost flow".
kpeter@598
    44
  /// This algorithm is a specialized version of the linear programming
kpeter@598
    45
  /// simplex method directly for the minimum cost flow problem.
kpeter@598
    46
  /// It is one of the most efficient solution methods.
kpeter@598
    47
  ///
kpeter@598
    48
  /// In general this class is the fastest implementation available
kpeter@598
    49
  /// in LEMON for the minimum cost flow problem.
kpeter@636
    50
  /// Moreover it supports both directions of the supply/demand inequality
kpeter@636
    51
  /// constraints. For more information see \ref SupplyType.
kpeter@636
    52
  ///
kpeter@636
    53
  /// Most of the parameters of the problem (except for the digraph)
kpeter@636
    54
  /// can be given using separate functions, and the algorithm can be
kpeter@636
    55
  /// executed using the \ref run() function. If some parameters are not
kpeter@636
    56
  /// specified, then default values will be used.
kpeter@593
    57
  ///
kpeter@597
    58
  /// \tparam GR The digraph type the algorithm runs on.
kpeter@637
    59
  /// \tparam V The value type used for flow amounts, capacity bounds
kpeter@599
    60
  /// and supply values in the algorithm. By default it is \c int.
kpeter@599
    61
  /// \tparam C The value type used for costs and potentials in the
kpeter@637
    62
  /// algorithm. By default it is the same as \c V.
kpeter@593
    63
  ///
kpeter@600
    64
  /// \warning Both value types must be signed and all input data must
kpeter@600
    65
  /// be integer.
kpeter@593
    66
  ///
kpeter@597
    67
  /// \note %NetworkSimplex provides five different pivot rule
kpeter@601
    68
  /// implementations, from which the most efficient one is used
kpeter@601
    69
  /// by default. For more information see \ref PivotRule.
kpeter@637
    70
  template <typename GR, typename V = int, typename C = V>
kpeter@593
    71
  class NetworkSimplex
kpeter@593
    72
  {
kpeter@597
    73
  public:
kpeter@593
    74
kpeter@638
    75
    /// The type of the flow amounts, capacity bounds and supply values
kpeter@637
    76
    typedef V Value;
kpeter@638
    77
    /// The type of the arc costs
kpeter@599
    78
    typedef C Cost;
kpeter@597
    79
kpeter@597
    80
  public:
kpeter@597
    81
kpeter@636
    82
    /// \brief Problem type constants for the \c run() function.
kpeter@597
    83
    ///
kpeter@636
    84
    /// Enum type containing the problem type constants that can be
kpeter@636
    85
    /// returned by the \ref run() function of the algorithm.
kpeter@636
    86
    enum ProblemType {
kpeter@636
    87
      /// The problem has no feasible solution (flow).
kpeter@636
    88
      INFEASIBLE,
kpeter@636
    89
      /// The problem has optimal solution (i.e. it is feasible and
kpeter@636
    90
      /// bounded), and the algorithm has found optimal flow and node
kpeter@636
    91
      /// potentials (primal and dual solutions).
kpeter@636
    92
      OPTIMAL,
kpeter@636
    93
      /// The objective function of the problem is unbounded, i.e.
kpeter@636
    94
      /// there is a directed cycle having negative total cost and
kpeter@636
    95
      /// infinite upper bound.
kpeter@636
    96
      UNBOUNDED
kpeter@636
    97
    };
kpeter@636
    98
    
kpeter@636
    99
    /// \brief Constants for selecting the type of the supply constraints.
kpeter@636
   100
    ///
kpeter@636
   101
    /// Enum type containing constants for selecting the supply type,
kpeter@636
   102
    /// i.e. the direction of the inequalities in the supply/demand
kpeter@636
   103
    /// constraints of the \ref min_cost_flow "minimum cost flow problem".
kpeter@636
   104
    ///
kpeter@661
   105
    /// The default supply type is \c GEQ, the \c LEQ type can be
kpeter@661
   106
    /// selected using \ref supplyType().
kpeter@661
   107
    /// The equality form is a special case of both supply types.
kpeter@636
   108
    enum SupplyType {
kpeter@636
   109
      /// This option means that there are <em>"greater or equal"</em>
kpeter@661
   110
      /// supply/demand constraints in the definition of the problem.
kpeter@636
   111
      GEQ,
kpeter@636
   112
      /// This option means that there are <em>"less or equal"</em>
kpeter@661
   113
      /// supply/demand constraints in the definition of the problem.
kpeter@661
   114
      LEQ
kpeter@636
   115
    };
kpeter@636
   116
    
kpeter@636
   117
    /// \brief Constants for selecting the pivot rule.
kpeter@636
   118
    ///
kpeter@636
   119
    /// Enum type containing constants for selecting the pivot rule for
kpeter@636
   120
    /// the \ref run() function.
kpeter@636
   121
    ///
kpeter@597
   122
    /// \ref NetworkSimplex provides five different pivot rule
kpeter@597
   123
    /// implementations that significantly affect the running time
kpeter@597
   124
    /// of the algorithm.
kpeter@597
   125
    /// By default \ref BLOCK_SEARCH "Block Search" is used, which
kpeter@597
   126
    /// proved to be the most efficient and the most robust on various
kpeter@597
   127
    /// test inputs according to our benchmark tests.
kpeter@597
   128
    /// However another pivot rule can be selected using the \ref run()
kpeter@597
   129
    /// function with the proper parameter.
kpeter@597
   130
    enum PivotRule {
kpeter@597
   131
kpeter@597
   132
      /// The First Eligible pivot rule.
kpeter@597
   133
      /// The next eligible arc is selected in a wraparound fashion
kpeter@597
   134
      /// in every iteration.
kpeter@597
   135
      FIRST_ELIGIBLE,
kpeter@597
   136
kpeter@597
   137
      /// The Best Eligible pivot rule.
kpeter@597
   138
      /// The best eligible arc is selected in every iteration.
kpeter@597
   139
      BEST_ELIGIBLE,
kpeter@597
   140
kpeter@597
   141
      /// The Block Search pivot rule.
kpeter@597
   142
      /// A specified number of arcs are examined in every iteration
kpeter@597
   143
      /// in a wraparound fashion and the best eligible arc is selected
kpeter@597
   144
      /// from this block.
kpeter@597
   145
      BLOCK_SEARCH,
kpeter@597
   146
kpeter@597
   147
      /// The Candidate List pivot rule.
kpeter@597
   148
      /// In a major iteration a candidate list is built from eligible arcs
kpeter@597
   149
      /// in a wraparound fashion and in the following minor iterations
kpeter@597
   150
      /// the best eligible arc is selected from this list.
kpeter@597
   151
      CANDIDATE_LIST,
kpeter@597
   152
kpeter@597
   153
      /// The Altering Candidate List pivot rule.
kpeter@597
   154
      /// It is a modified version of the Candidate List method.
kpeter@597
   155
      /// It keeps only the several best eligible arcs from the former
kpeter@597
   156
      /// candidate list and extends this list in every iteration.
kpeter@597
   157
      ALTERING_LIST
kpeter@597
   158
    };
kpeter@601
   159
    
kpeter@597
   160
  private:
kpeter@597
   161
kpeter@597
   162
    TEMPLATE_DIGRAPH_TYPEDEFS(GR);
kpeter@597
   163
kpeter@593
   164
    typedef std::vector<Arc> ArcVector;
kpeter@593
   165
    typedef std::vector<Node> NodeVector;
kpeter@593
   166
    typedef std::vector<int> IntVector;
kpeter@593
   167
    typedef std::vector<bool> BoolVector;
kpeter@638
   168
    typedef std::vector<Value> ValueVector;
kpeter@599
   169
    typedef std::vector<Cost> CostVector;
kpeter@593
   170
kpeter@593
   171
    // State constants for arcs
kpeter@593
   172
    enum ArcStateEnum {
kpeter@593
   173
      STATE_UPPER = -1,
kpeter@593
   174
      STATE_TREE  =  0,
kpeter@593
   175
      STATE_LOWER =  1
kpeter@593
   176
    };
kpeter@593
   177
kpeter@593
   178
  private:
kpeter@593
   179
kpeter@597
   180
    // Data related to the underlying digraph
kpeter@597
   181
    const GR &_graph;
kpeter@597
   182
    int _node_num;
kpeter@597
   183
    int _arc_num;
kpeter@661
   184
    int _all_arc_num;
kpeter@661
   185
    int _search_arc_num;
kpeter@597
   186
kpeter@597
   187
    // Parameters of the problem
kpeter@638
   188
    bool _have_lower;
kpeter@636
   189
    SupplyType _stype;
kpeter@637
   190
    Value _sum_supply;
kpeter@593
   191
kpeter@597
   192
    // Data structures for storing the digraph
kpeter@595
   193
    IntNodeMap _node_id;
kpeter@638
   194
    IntArcMap _arc_id;
kpeter@595
   195
    IntVector _source;
kpeter@595
   196
    IntVector _target;
kpeter@595
   197
kpeter@597
   198
    // Node and arc data
kpeter@638
   199
    ValueVector _lower;
kpeter@638
   200
    ValueVector _upper;
kpeter@638
   201
    ValueVector _cap;
kpeter@599
   202
    CostVector _cost;
kpeter@638
   203
    ValueVector _supply;
kpeter@638
   204
    ValueVector _flow;
kpeter@599
   205
    CostVector _pi;
kpeter@593
   206
kpeter@595
   207
    // Data for storing the spanning tree structure
kpeter@593
   208
    IntVector _parent;
kpeter@593
   209
    IntVector _pred;
kpeter@593
   210
    IntVector _thread;
kpeter@596
   211
    IntVector _rev_thread;
kpeter@596
   212
    IntVector _succ_num;
kpeter@596
   213
    IntVector _last_succ;
kpeter@596
   214
    IntVector _dirty_revs;
kpeter@593
   215
    BoolVector _forward;
kpeter@593
   216
    IntVector _state;
kpeter@593
   217
    int _root;
kpeter@593
   218
kpeter@593
   219
    // Temporary data used in the current pivot iteration
kpeter@595
   220
    int in_arc, join, u_in, v_in, u_out, v_out;
kpeter@595
   221
    int first, second, right, last;
kpeter@593
   222
    int stem, par_stem, new_stem;
kpeter@637
   223
    Value delta;
kpeter@593
   224
kpeter@636
   225
  public:
kpeter@636
   226
  
kpeter@636
   227
    /// \brief Constant for infinite upper bounds (capacities).
kpeter@636
   228
    ///
kpeter@636
   229
    /// Constant for infinite upper bounds (capacities).
kpeter@637
   230
    /// It is \c std::numeric_limits<Value>::infinity() if available,
kpeter@637
   231
    /// \c std::numeric_limits<Value>::max() otherwise.
kpeter@637
   232
    const Value INF;
kpeter@636
   233
kpeter@593
   234
  private:
kpeter@593
   235
kpeter@597
   236
    // Implementation of the First Eligible pivot rule
kpeter@593
   237
    class FirstEligiblePivotRule
kpeter@593
   238
    {
kpeter@593
   239
    private:
kpeter@593
   240
kpeter@593
   241
      // References to the NetworkSimplex class
kpeter@593
   242
      const IntVector  &_source;
kpeter@593
   243
      const IntVector  &_target;
kpeter@599
   244
      const CostVector &_cost;
kpeter@593
   245
      const IntVector  &_state;
kpeter@599
   246
      const CostVector &_pi;
kpeter@593
   247
      int &_in_arc;
kpeter@661
   248
      int _search_arc_num;
kpeter@593
   249
kpeter@593
   250
      // Pivot rule data
kpeter@593
   251
      int _next_arc;
kpeter@593
   252
kpeter@593
   253
    public:
kpeter@593
   254
kpeter@597
   255
      // Constructor
kpeter@593
   256
      FirstEligiblePivotRule(NetworkSimplex &ns) :
kpeter@595
   257
        _source(ns._source), _target(ns._target),
kpeter@593
   258
        _cost(ns._cost), _state(ns._state), _pi(ns._pi),
kpeter@661
   259
        _in_arc(ns.in_arc), _search_arc_num(ns._search_arc_num),
kpeter@661
   260
        _next_arc(0)
kpeter@593
   261
      {}
kpeter@593
   262
kpeter@597
   263
      // Find next entering arc
kpeter@593
   264
      bool findEnteringArc() {
kpeter@599
   265
        Cost c;
kpeter@661
   266
        for (int e = _next_arc; e < _search_arc_num; ++e) {
kpeter@593
   267
          c = _state[e] * (_cost[e] + _pi[_source[e]] - _pi[_target[e]]);
kpeter@593
   268
          if (c < 0) {
kpeter@593
   269
            _in_arc = e;
kpeter@593
   270
            _next_arc = e + 1;
kpeter@593
   271
            return true;
kpeter@593
   272
          }
kpeter@593
   273
        }
kpeter@593
   274
        for (int e = 0; e < _next_arc; ++e) {
kpeter@593
   275
          c = _state[e] * (_cost[e] + _pi[_source[e]] - _pi[_target[e]]);
kpeter@593
   276
          if (c < 0) {
kpeter@593
   277
            _in_arc = e;
kpeter@593
   278
            _next_arc = e + 1;
kpeter@593
   279
            return true;
kpeter@593
   280
          }
kpeter@593
   281
        }
kpeter@593
   282
        return false;
kpeter@593
   283
      }
kpeter@593
   284
kpeter@593
   285
    }; //class FirstEligiblePivotRule
kpeter@593
   286
kpeter@593
   287
kpeter@597
   288
    // Implementation of the Best Eligible pivot rule
kpeter@593
   289
    class BestEligiblePivotRule
kpeter@593
   290
    {
kpeter@593
   291
    private:
kpeter@593
   292
kpeter@593
   293
      // References to the NetworkSimplex class
kpeter@593
   294
      const IntVector  &_source;
kpeter@593
   295
      const IntVector  &_target;
kpeter@599
   296
      const CostVector &_cost;
kpeter@593
   297
      const IntVector  &_state;
kpeter@599
   298
      const CostVector &_pi;
kpeter@593
   299
      int &_in_arc;
kpeter@661
   300
      int _search_arc_num;
kpeter@593
   301
kpeter@593
   302
    public:
kpeter@593
   303
kpeter@597
   304
      // Constructor
kpeter@593
   305
      BestEligiblePivotRule(NetworkSimplex &ns) :
kpeter@595
   306
        _source(ns._source), _target(ns._target),
kpeter@593
   307
        _cost(ns._cost), _state(ns._state), _pi(ns._pi),
kpeter@661
   308
        _in_arc(ns.in_arc), _search_arc_num(ns._search_arc_num)
kpeter@593
   309
      {}
kpeter@593
   310
kpeter@597
   311
      // Find next entering arc
kpeter@593
   312
      bool findEnteringArc() {
kpeter@599
   313
        Cost c, min = 0;
kpeter@661
   314
        for (int e = 0; e < _search_arc_num; ++e) {
kpeter@593
   315
          c = _state[e] * (_cost[e] + _pi[_source[e]] - _pi[_target[e]]);
kpeter@593
   316
          if (c < min) {
kpeter@593
   317
            min = c;
kpeter@593
   318
            _in_arc = e;
kpeter@593
   319
          }
kpeter@593
   320
        }
kpeter@593
   321
        return min < 0;
kpeter@593
   322
      }
kpeter@593
   323
kpeter@593
   324
    }; //class BestEligiblePivotRule
kpeter@593
   325
kpeter@593
   326
kpeter@597
   327
    // Implementation of the Block Search pivot rule
kpeter@593
   328
    class BlockSearchPivotRule
kpeter@593
   329
    {
kpeter@593
   330
    private:
kpeter@593
   331
kpeter@593
   332
      // References to the NetworkSimplex class
kpeter@593
   333
      const IntVector  &_source;
kpeter@593
   334
      const IntVector  &_target;
kpeter@599
   335
      const CostVector &_cost;
kpeter@593
   336
      const IntVector  &_state;
kpeter@599
   337
      const CostVector &_pi;
kpeter@593
   338
      int &_in_arc;
kpeter@661
   339
      int _search_arc_num;
kpeter@593
   340
kpeter@593
   341
      // Pivot rule data
kpeter@593
   342
      int _block_size;
kpeter@593
   343
      int _next_arc;
kpeter@593
   344
kpeter@593
   345
    public:
kpeter@593
   346
kpeter@597
   347
      // Constructor
kpeter@593
   348
      BlockSearchPivotRule(NetworkSimplex &ns) :
kpeter@595
   349
        _source(ns._source), _target(ns._target),
kpeter@593
   350
        _cost(ns._cost), _state(ns._state), _pi(ns._pi),
kpeter@661
   351
        _in_arc(ns.in_arc), _search_arc_num(ns._search_arc_num),
kpeter@661
   352
        _next_arc(0)
kpeter@593
   353
      {
kpeter@593
   354
        // The main parameters of the pivot rule
kpeter@661
   355
        const double BLOCK_SIZE_FACTOR = 0.5;
kpeter@593
   356
        const int MIN_BLOCK_SIZE = 10;
kpeter@593
   357
alpar@604
   358
        _block_size = std::max( int(BLOCK_SIZE_FACTOR *
kpeter@661
   359
                                    std::sqrt(double(_search_arc_num))),
kpeter@593
   360
                                MIN_BLOCK_SIZE );
kpeter@593
   361
      }
kpeter@593
   362
kpeter@597
   363
      // Find next entering arc
kpeter@593
   364
      bool findEnteringArc() {
kpeter@599
   365
        Cost c, min = 0;
kpeter@593
   366
        int cnt = _block_size;
kpeter@593
   367
        int e, min_arc = _next_arc;
kpeter@661
   368
        for (e = _next_arc; e < _search_arc_num; ++e) {
kpeter@593
   369
          c = _state[e] * (_cost[e] + _pi[_source[e]] - _pi[_target[e]]);
kpeter@593
   370
          if (c < min) {
kpeter@593
   371
            min = c;
kpeter@593
   372
            min_arc = e;
kpeter@593
   373
          }
kpeter@593
   374
          if (--cnt == 0) {
kpeter@593
   375
            if (min < 0) break;
kpeter@593
   376
            cnt = _block_size;
kpeter@593
   377
          }
kpeter@593
   378
        }
kpeter@593
   379
        if (min == 0 || cnt > 0) {
kpeter@593
   380
          for (e = 0; e < _next_arc; ++e) {
kpeter@593
   381
            c = _state[e] * (_cost[e] + _pi[_source[e]] - _pi[_target[e]]);
kpeter@593
   382
            if (c < min) {
kpeter@593
   383
              min = c;
kpeter@593
   384
              min_arc = e;
kpeter@593
   385
            }
kpeter@593
   386
            if (--cnt == 0) {
kpeter@593
   387
              if (min < 0) break;
kpeter@593
   388
              cnt = _block_size;
kpeter@593
   389
            }
kpeter@593
   390
          }
kpeter@593
   391
        }
kpeter@593
   392
        if (min >= 0) return false;
kpeter@593
   393
        _in_arc = min_arc;
kpeter@593
   394
        _next_arc = e;
kpeter@593
   395
        return true;
kpeter@593
   396
      }
kpeter@593
   397
kpeter@593
   398
    }; //class BlockSearchPivotRule
kpeter@593
   399
kpeter@593
   400
kpeter@597
   401
    // Implementation of the Candidate List pivot rule
kpeter@593
   402
    class CandidateListPivotRule
kpeter@593
   403
    {
kpeter@593
   404
    private:
kpeter@593
   405
kpeter@593
   406
      // References to the NetworkSimplex class
kpeter@593
   407
      const IntVector  &_source;
kpeter@593
   408
      const IntVector  &_target;
kpeter@599
   409
      const CostVector &_cost;
kpeter@593
   410
      const IntVector  &_state;
kpeter@599
   411
      const CostVector &_pi;
kpeter@593
   412
      int &_in_arc;
kpeter@661
   413
      int _search_arc_num;
kpeter@593
   414
kpeter@593
   415
      // Pivot rule data
kpeter@593
   416
      IntVector _candidates;
kpeter@593
   417
      int _list_length, _minor_limit;
kpeter@593
   418
      int _curr_length, _minor_count;
kpeter@593
   419
      int _next_arc;
kpeter@593
   420
kpeter@593
   421
    public:
kpeter@593
   422
kpeter@593
   423
      /// Constructor
kpeter@593
   424
      CandidateListPivotRule(NetworkSimplex &ns) :
kpeter@595
   425
        _source(ns._source), _target(ns._target),
kpeter@593
   426
        _cost(ns._cost), _state(ns._state), _pi(ns._pi),
kpeter@661
   427
        _in_arc(ns.in_arc), _search_arc_num(ns._search_arc_num),
kpeter@661
   428
        _next_arc(0)
kpeter@593
   429
      {
kpeter@593
   430
        // The main parameters of the pivot rule
kpeter@593
   431
        const double LIST_LENGTH_FACTOR = 1.0;
kpeter@593
   432
        const int MIN_LIST_LENGTH = 10;
kpeter@593
   433
        const double MINOR_LIMIT_FACTOR = 0.1;
kpeter@593
   434
        const int MIN_MINOR_LIMIT = 3;
kpeter@593
   435
alpar@604
   436
        _list_length = std::max( int(LIST_LENGTH_FACTOR *
kpeter@661
   437
                                     std::sqrt(double(_search_arc_num))),
kpeter@593
   438
                                 MIN_LIST_LENGTH );
kpeter@593
   439
        _minor_limit = std::max( int(MINOR_LIMIT_FACTOR * _list_length),
kpeter@593
   440
                                 MIN_MINOR_LIMIT );
kpeter@593
   441
        _curr_length = _minor_count = 0;
kpeter@593
   442
        _candidates.resize(_list_length);
kpeter@593
   443
      }
kpeter@593
   444
kpeter@593
   445
      /// Find next entering arc
kpeter@593
   446
      bool findEnteringArc() {
kpeter@599
   447
        Cost min, c;
kpeter@593
   448
        int e, min_arc = _next_arc;
kpeter@593
   449
        if (_curr_length > 0 && _minor_count < _minor_limit) {
kpeter@593
   450
          // Minor iteration: select the best eligible arc from the
kpeter@593
   451
          // current candidate list
kpeter@593
   452
          ++_minor_count;
kpeter@593
   453
          min = 0;
kpeter@593
   454
          for (int i = 0; i < _curr_length; ++i) {
kpeter@593
   455
            e = _candidates[i];
kpeter@593
   456
            c = _state[e] * (_cost[e] + _pi[_source[e]] - _pi[_target[e]]);
kpeter@593
   457
            if (c < min) {
kpeter@593
   458
              min = c;
kpeter@593
   459
              min_arc = e;
kpeter@593
   460
            }
kpeter@593
   461
            if (c >= 0) {
kpeter@593
   462
              _candidates[i--] = _candidates[--_curr_length];
kpeter@593
   463
            }
kpeter@593
   464
          }
kpeter@593
   465
          if (min < 0) {
kpeter@593
   466
            _in_arc = min_arc;
kpeter@593
   467
            return true;
kpeter@593
   468
          }
kpeter@593
   469
        }
kpeter@593
   470
kpeter@593
   471
        // Major iteration: build a new candidate list
kpeter@593
   472
        min = 0;
kpeter@593
   473
        _curr_length = 0;
kpeter@661
   474
        for (e = _next_arc; e < _search_arc_num; ++e) {
kpeter@593
   475
          c = _state[e] * (_cost[e] + _pi[_source[e]] - _pi[_target[e]]);
kpeter@593
   476
          if (c < 0) {
kpeter@593
   477
            _candidates[_curr_length++] = e;
kpeter@593
   478
            if (c < min) {
kpeter@593
   479
              min = c;
kpeter@593
   480
              min_arc = e;
kpeter@593
   481
            }
kpeter@593
   482
            if (_curr_length == _list_length) break;
kpeter@593
   483
          }
kpeter@593
   484
        }
kpeter@593
   485
        if (_curr_length < _list_length) {
kpeter@593
   486
          for (e = 0; e < _next_arc; ++e) {
kpeter@593
   487
            c = _state[e] * (_cost[e] + _pi[_source[e]] - _pi[_target[e]]);
kpeter@593
   488
            if (c < 0) {
kpeter@593
   489
              _candidates[_curr_length++] = e;
kpeter@593
   490
              if (c < min) {
kpeter@593
   491
                min = c;
kpeter@593
   492
                min_arc = e;
kpeter@593
   493
              }
kpeter@593
   494
              if (_curr_length == _list_length) break;
kpeter@593
   495
            }
kpeter@593
   496
          }
kpeter@593
   497
        }
kpeter@593
   498
        if (_curr_length == 0) return false;
kpeter@593
   499
        _minor_count = 1;
kpeter@593
   500
        _in_arc = min_arc;
kpeter@593
   501
        _next_arc = e;
kpeter@593
   502
        return true;
kpeter@593
   503
      }
kpeter@593
   504
kpeter@593
   505
    }; //class CandidateListPivotRule
kpeter@593
   506
kpeter@593
   507
kpeter@597
   508
    // Implementation of the Altering Candidate List pivot rule
kpeter@593
   509
    class AlteringListPivotRule
kpeter@593
   510
    {
kpeter@593
   511
    private:
kpeter@593
   512
kpeter@593
   513
      // References to the NetworkSimplex class
kpeter@593
   514
      const IntVector  &_source;
kpeter@593
   515
      const IntVector  &_target;
kpeter@599
   516
      const CostVector &_cost;
kpeter@593
   517
      const IntVector  &_state;
kpeter@599
   518
      const CostVector &_pi;
kpeter@593
   519
      int &_in_arc;
kpeter@661
   520
      int _search_arc_num;
kpeter@593
   521
kpeter@593
   522
      // Pivot rule data
kpeter@593
   523
      int _block_size, _head_length, _curr_length;
kpeter@593
   524
      int _next_arc;
kpeter@593
   525
      IntVector _candidates;
kpeter@599
   526
      CostVector _cand_cost;
kpeter@593
   527
kpeter@593
   528
      // Functor class to compare arcs during sort of the candidate list
kpeter@593
   529
      class SortFunc
kpeter@593
   530
      {
kpeter@593
   531
      private:
kpeter@599
   532
        const CostVector &_map;
kpeter@593
   533
      public:
kpeter@599
   534
        SortFunc(const CostVector &map) : _map(map) {}
kpeter@593
   535
        bool operator()(int left, int right) {
kpeter@593
   536
          return _map[left] > _map[right];
kpeter@593
   537
        }
kpeter@593
   538
      };
kpeter@593
   539
kpeter@593
   540
      SortFunc _sort_func;
kpeter@593
   541
kpeter@593
   542
    public:
kpeter@593
   543
kpeter@597
   544
      // Constructor
kpeter@593
   545
      AlteringListPivotRule(NetworkSimplex &ns) :
kpeter@595
   546
        _source(ns._source), _target(ns._target),
kpeter@593
   547
        _cost(ns._cost), _state(ns._state), _pi(ns._pi),
kpeter@661
   548
        _in_arc(ns.in_arc), _search_arc_num(ns._search_arc_num),
kpeter@661
   549
        _next_arc(0), _cand_cost(ns._search_arc_num), _sort_func(_cand_cost)
kpeter@593
   550
      {
kpeter@593
   551
        // The main parameters of the pivot rule
kpeter@593
   552
        const double BLOCK_SIZE_FACTOR = 1.5;
kpeter@593
   553
        const int MIN_BLOCK_SIZE = 10;
kpeter@593
   554
        const double HEAD_LENGTH_FACTOR = 0.1;
kpeter@593
   555
        const int MIN_HEAD_LENGTH = 3;
kpeter@593
   556
alpar@604
   557
        _block_size = std::max( int(BLOCK_SIZE_FACTOR *
kpeter@661
   558
                                    std::sqrt(double(_search_arc_num))),
kpeter@593
   559
                                MIN_BLOCK_SIZE );
kpeter@593
   560
        _head_length = std::max( int(HEAD_LENGTH_FACTOR * _block_size),
kpeter@593
   561
                                 MIN_HEAD_LENGTH );
kpeter@593
   562
        _candidates.resize(_head_length + _block_size);
kpeter@593
   563
        _curr_length = 0;
kpeter@593
   564
      }
kpeter@593
   565
kpeter@597
   566
      // Find next entering arc
kpeter@593
   567
      bool findEnteringArc() {
kpeter@593
   568
        // Check the current candidate list
kpeter@593
   569
        int e;
kpeter@593
   570
        for (int i = 0; i < _curr_length; ++i) {
kpeter@593
   571
          e = _candidates[i];
kpeter@593
   572
          _cand_cost[e] = _state[e] *
kpeter@593
   573
            (_cost[e] + _pi[_source[e]] - _pi[_target[e]]);
kpeter@593
   574
          if (_cand_cost[e] >= 0) {
kpeter@593
   575
            _candidates[i--] = _candidates[--_curr_length];
kpeter@593
   576
          }
kpeter@593
   577
        }
kpeter@593
   578
kpeter@593
   579
        // Extend the list
kpeter@593
   580
        int cnt = _block_size;
kpeter@595
   581
        int last_arc = 0;
kpeter@593
   582
        int limit = _head_length;
kpeter@593
   583
kpeter@661
   584
        for (int e = _next_arc; e < _search_arc_num; ++e) {
kpeter@593
   585
          _cand_cost[e] = _state[e] *
kpeter@593
   586
            (_cost[e] + _pi[_source[e]] - _pi[_target[e]]);
kpeter@593
   587
          if (_cand_cost[e] < 0) {
kpeter@593
   588
            _candidates[_curr_length++] = e;
kpeter@595
   589
            last_arc = e;
kpeter@593
   590
          }
kpeter@593
   591
          if (--cnt == 0) {
kpeter@593
   592
            if (_curr_length > limit) break;
kpeter@593
   593
            limit = 0;
kpeter@593
   594
            cnt = _block_size;
kpeter@593
   595
          }
kpeter@593
   596
        }
kpeter@593
   597
        if (_curr_length <= limit) {
kpeter@593
   598
          for (int e = 0; e < _next_arc; ++e) {
kpeter@593
   599
            _cand_cost[e] = _state[e] *
kpeter@593
   600
              (_cost[e] + _pi[_source[e]] - _pi[_target[e]]);
kpeter@593
   601
            if (_cand_cost[e] < 0) {
kpeter@593
   602
              _candidates[_curr_length++] = e;
kpeter@595
   603
              last_arc = e;
kpeter@593
   604
            }
kpeter@593
   605
            if (--cnt == 0) {
kpeter@593
   606
              if (_curr_length > limit) break;
kpeter@593
   607
              limit = 0;
kpeter@593
   608
              cnt = _block_size;
kpeter@593
   609
            }
kpeter@593
   610
          }
kpeter@593
   611
        }
kpeter@593
   612
        if (_curr_length == 0) return false;
kpeter@595
   613
        _next_arc = last_arc + 1;
kpeter@593
   614
kpeter@593
   615
        // Make heap of the candidate list (approximating a partial sort)
kpeter@593
   616
        make_heap( _candidates.begin(), _candidates.begin() + _curr_length,
kpeter@593
   617
                   _sort_func );
kpeter@593
   618
kpeter@593
   619
        // Pop the first element of the heap
kpeter@593
   620
        _in_arc = _candidates[0];
kpeter@593
   621
        pop_heap( _candidates.begin(), _candidates.begin() + _curr_length,
kpeter@593
   622
                  _sort_func );
kpeter@593
   623
        _curr_length = std::min(_head_length, _curr_length - 1);
kpeter@593
   624
        return true;
kpeter@593
   625
      }
kpeter@593
   626
kpeter@593
   627
    }; //class AlteringListPivotRule
kpeter@593
   628
kpeter@593
   629
  public:
kpeter@593
   630
kpeter@597
   631
    /// \brief Constructor.
kpeter@593
   632
    ///
kpeter@601
   633
    /// The constructor of the class.
kpeter@593
   634
    ///
kpeter@595
   635
    /// \param graph The digraph the algorithm runs on.
kpeter@597
   636
    NetworkSimplex(const GR& graph) :
kpeter@638
   637
      _graph(graph), _node_id(graph), _arc_id(graph),
kpeter@637
   638
      INF(std::numeric_limits<Value>::has_infinity ?
kpeter@637
   639
          std::numeric_limits<Value>::infinity() :
kpeter@637
   640
          std::numeric_limits<Value>::max())
kpeter@597
   641
    {
kpeter@636
   642
      // Check the value types
kpeter@637
   643
      LEMON_ASSERT(std::numeric_limits<Value>::is_signed,
kpeter@636
   644
        "The flow type of NetworkSimplex must be signed");
kpeter@636
   645
      LEMON_ASSERT(std::numeric_limits<Cost>::is_signed,
kpeter@636
   646
        "The cost type of NetworkSimplex must be signed");
kpeter@638
   647
        
kpeter@638
   648
      // Resize vectors
kpeter@638
   649
      _node_num = countNodes(_graph);
kpeter@638
   650
      _arc_num = countArcs(_graph);
kpeter@638
   651
      int all_node_num = _node_num + 1;
kpeter@661
   652
      int max_arc_num = _arc_num + 2 * _node_num;
kpeter@593
   653
kpeter@661
   654
      _source.resize(max_arc_num);
kpeter@661
   655
      _target.resize(max_arc_num);
kpeter@638
   656
kpeter@661
   657
      _lower.resize(_arc_num);
kpeter@661
   658
      _upper.resize(_arc_num);
kpeter@661
   659
      _cap.resize(max_arc_num);
kpeter@661
   660
      _cost.resize(max_arc_num);
kpeter@638
   661
      _supply.resize(all_node_num);
kpeter@661
   662
      _flow.resize(max_arc_num);
kpeter@638
   663
      _pi.resize(all_node_num);
kpeter@638
   664
kpeter@638
   665
      _parent.resize(all_node_num);
kpeter@638
   666
      _pred.resize(all_node_num);
kpeter@638
   667
      _forward.resize(all_node_num);
kpeter@638
   668
      _thread.resize(all_node_num);
kpeter@638
   669
      _rev_thread.resize(all_node_num);
kpeter@638
   670
      _succ_num.resize(all_node_num);
kpeter@638
   671
      _last_succ.resize(all_node_num);
kpeter@661
   672
      _state.resize(max_arc_num);
kpeter@638
   673
kpeter@638
   674
      // Copy the graph (store the arcs in a mixed order)
kpeter@638
   675
      int i = 0;
kpeter@638
   676
      for (NodeIt n(_graph); n != INVALID; ++n, ++i) {
kpeter@638
   677
        _node_id[n] = i;
kpeter@638
   678
      }
kpeter@638
   679
      int k = std::max(int(std::sqrt(double(_arc_num))), 10);
kpeter@638
   680
      i = 0;
kpeter@638
   681
      for (ArcIt a(_graph); a != INVALID; ++a) {
kpeter@638
   682
        _arc_id[a] = i;
kpeter@638
   683
        _source[i] = _node_id[_graph.source(a)];
kpeter@638
   684
        _target[i] = _node_id[_graph.target(a)];
kpeter@638
   685
        if ((i += k) >= _arc_num) i = (i % k) + 1;
kpeter@638
   686
      }
kpeter@638
   687
      
kpeter@638
   688
      // Initialize maps
kpeter@638
   689
      for (int i = 0; i != _node_num; ++i) {
kpeter@638
   690
        _supply[i] = 0;
kpeter@638
   691
      }
kpeter@638
   692
      for (int i = 0; i != _arc_num; ++i) {
kpeter@638
   693
        _lower[i] = 0;
kpeter@638
   694
        _upper[i] = INF;
kpeter@638
   695
        _cost[i] = 1;
kpeter@638
   696
      }
kpeter@638
   697
      _have_lower = false;
kpeter@638
   698
      _stype = GEQ;
kpeter@593
   699
    }
kpeter@593
   700
kpeter@601
   701
    /// \name Parameters
kpeter@601
   702
    /// The parameters of the algorithm can be specified using these
kpeter@601
   703
    /// functions.
kpeter@601
   704
kpeter@601
   705
    /// @{
kpeter@601
   706
kpeter@597
   707
    /// \brief Set the lower bounds on the arcs.
kpeter@597
   708
    ///
kpeter@597
   709
    /// This function sets the lower bounds on the arcs.
kpeter@636
   710
    /// If it is not used before calling \ref run(), the lower bounds
kpeter@636
   711
    /// will be set to zero on all arcs.
kpeter@597
   712
    ///
kpeter@597
   713
    /// \param map An arc map storing the lower bounds.
kpeter@637
   714
    /// Its \c Value type must be convertible to the \c Value type
kpeter@597
   715
    /// of the algorithm.
kpeter@597
   716
    ///
kpeter@597
   717
    /// \return <tt>(*this)</tt>
kpeter@636
   718
    template <typename LowerMap>
kpeter@636
   719
    NetworkSimplex& lowerMap(const LowerMap& map) {
kpeter@638
   720
      _have_lower = true;
kpeter@597
   721
      for (ArcIt a(_graph); a != INVALID; ++a) {
kpeter@638
   722
        _lower[_arc_id[a]] = map[a];
kpeter@597
   723
      }
kpeter@597
   724
      return *this;
kpeter@597
   725
    }
kpeter@597
   726
kpeter@597
   727
    /// \brief Set the upper bounds (capacities) on the arcs.
kpeter@597
   728
    ///
kpeter@597
   729
    /// This function sets the upper bounds (capacities) on the arcs.
kpeter@636
   730
    /// If it is not used before calling \ref run(), the upper bounds
kpeter@636
   731
    /// will be set to \ref INF on all arcs (i.e. the flow value will be
kpeter@636
   732
    /// unbounded from above on each arc).
kpeter@597
   733
    ///
kpeter@597
   734
    /// \param map An arc map storing the upper bounds.
kpeter@637
   735
    /// Its \c Value type must be convertible to the \c Value type
kpeter@597
   736
    /// of the algorithm.
kpeter@597
   737
    ///
kpeter@597
   738
    /// \return <tt>(*this)</tt>
kpeter@636
   739
    template<typename UpperMap>
kpeter@636
   740
    NetworkSimplex& upperMap(const UpperMap& map) {
kpeter@597
   741
      for (ArcIt a(_graph); a != INVALID; ++a) {
kpeter@638
   742
        _upper[_arc_id[a]] = map[a];
kpeter@597
   743
      }
kpeter@597
   744
      return *this;
kpeter@597
   745
    }
kpeter@597
   746
kpeter@597
   747
    /// \brief Set the costs of the arcs.
kpeter@597
   748
    ///
kpeter@597
   749
    /// This function sets the costs of the arcs.
kpeter@597
   750
    /// If it is not used before calling \ref run(), the costs
kpeter@597
   751
    /// will be set to \c 1 on all arcs.
kpeter@597
   752
    ///
kpeter@597
   753
    /// \param map An arc map storing the costs.
kpeter@599
   754
    /// Its \c Value type must be convertible to the \c Cost type
kpeter@597
   755
    /// of the algorithm.
kpeter@597
   756
    ///
kpeter@597
   757
    /// \return <tt>(*this)</tt>
kpeter@636
   758
    template<typename CostMap>
kpeter@636
   759
    NetworkSimplex& costMap(const CostMap& map) {
kpeter@597
   760
      for (ArcIt a(_graph); a != INVALID; ++a) {
kpeter@638
   761
        _cost[_arc_id[a]] = map[a];
kpeter@597
   762
      }
kpeter@597
   763
      return *this;
kpeter@597
   764
    }
kpeter@597
   765
kpeter@597
   766
    /// \brief Set the supply values of the nodes.
kpeter@597
   767
    ///
kpeter@597
   768
    /// This function sets the supply values of the nodes.
kpeter@597
   769
    /// If neither this function nor \ref stSupply() is used before
kpeter@597
   770
    /// calling \ref run(), the supply of each node will be set to zero.
kpeter@597
   771
    /// (It makes sense only if non-zero lower bounds are given.)
kpeter@597
   772
    ///
kpeter@597
   773
    /// \param map A node map storing the supply values.
kpeter@637
   774
    /// Its \c Value type must be convertible to the \c Value type
kpeter@597
   775
    /// of the algorithm.
kpeter@597
   776
    ///
kpeter@597
   777
    /// \return <tt>(*this)</tt>
kpeter@636
   778
    template<typename SupplyMap>
kpeter@636
   779
    NetworkSimplex& supplyMap(const SupplyMap& map) {
kpeter@597
   780
      for (NodeIt n(_graph); n != INVALID; ++n) {
kpeter@638
   781
        _supply[_node_id[n]] = map[n];
kpeter@597
   782
      }
kpeter@597
   783
      return *this;
kpeter@597
   784
    }
kpeter@597
   785
kpeter@597
   786
    /// \brief Set single source and target nodes and a supply value.
kpeter@597
   787
    ///
kpeter@597
   788
    /// This function sets a single source node and a single target node
kpeter@597
   789
    /// and the required flow value.
kpeter@597
   790
    /// If neither this function nor \ref supplyMap() is used before
kpeter@597
   791
    /// calling \ref run(), the supply of each node will be set to zero.
kpeter@597
   792
    /// (It makes sense only if non-zero lower bounds are given.)
kpeter@597
   793
    ///
kpeter@636
   794
    /// Using this function has the same effect as using \ref supplyMap()
kpeter@636
   795
    /// with such a map in which \c k is assigned to \c s, \c -k is
kpeter@636
   796
    /// assigned to \c t and all other nodes have zero supply value.
kpeter@636
   797
    ///
kpeter@597
   798
    /// \param s The source node.
kpeter@597
   799
    /// \param t The target node.
kpeter@597
   800
    /// \param k The required amount of flow from node \c s to node \c t
kpeter@597
   801
    /// (i.e. the supply of \c s and the demand of \c t).
kpeter@597
   802
    ///
kpeter@597
   803
    /// \return <tt>(*this)</tt>
kpeter@637
   804
    NetworkSimplex& stSupply(const Node& s, const Node& t, Value k) {
kpeter@638
   805
      for (int i = 0; i != _node_num; ++i) {
kpeter@638
   806
        _supply[i] = 0;
kpeter@638
   807
      }
kpeter@638
   808
      _supply[_node_id[s]] =  k;
kpeter@638
   809
      _supply[_node_id[t]] = -k;
kpeter@597
   810
      return *this;
kpeter@597
   811
    }
kpeter@601
   812
    
kpeter@636
   813
    /// \brief Set the type of the supply constraints.
kpeter@601
   814
    ///
kpeter@636
   815
    /// This function sets the type of the supply/demand constraints.
kpeter@636
   816
    /// If it is not used before calling \ref run(), the \ref GEQ supply
kpeter@601
   817
    /// type will be used.
kpeter@601
   818
    ///
kpeter@636
   819
    /// For more information see \ref SupplyType.
kpeter@601
   820
    ///
kpeter@601
   821
    /// \return <tt>(*this)</tt>
kpeter@636
   822
    NetworkSimplex& supplyType(SupplyType supply_type) {
kpeter@636
   823
      _stype = supply_type;
kpeter@601
   824
      return *this;
kpeter@601
   825
    }
kpeter@597
   826
kpeter@601
   827
    /// @}
kpeter@593
   828
kpeter@597
   829
    /// \name Execution Control
kpeter@597
   830
    /// The algorithm can be executed using \ref run().
kpeter@597
   831
kpeter@593
   832
    /// @{
kpeter@593
   833
kpeter@593
   834
    /// \brief Run the algorithm.
kpeter@593
   835
    ///
kpeter@593
   836
    /// This function runs the algorithm.
kpeter@601
   837
    /// The paramters can be specified using functions \ref lowerMap(),
kpeter@636
   838
    /// \ref upperMap(), \ref costMap(), \ref supplyMap(), \ref stSupply(), 
kpeter@638
   839
    /// \ref supplyType().
kpeter@601
   840
    /// For example,
kpeter@597
   841
    /// \code
kpeter@597
   842
    ///   NetworkSimplex<ListDigraph> ns(graph);
kpeter@636
   843
    ///   ns.lowerMap(lower).upperMap(upper).costMap(cost)
kpeter@597
   844
    ///     .supplyMap(sup).run();
kpeter@597
   845
    /// \endcode
kpeter@593
   846
    ///
kpeter@598
   847
    /// This function can be called more than once. All the parameters
kpeter@598
   848
    /// that have been given are kept for the next call, unless
kpeter@598
   849
    /// \ref reset() is called, thus only the modified parameters
kpeter@598
   850
    /// have to be set again. See \ref reset() for examples.
kpeter@638
   851
    /// However the underlying digraph must not be modified after this
kpeter@638
   852
    /// class have been constructed, since it copies and extends the graph.
kpeter@598
   853
    ///
kpeter@597
   854
    /// \param pivot_rule The pivot rule that will be used during the
kpeter@597
   855
    /// algorithm. For more information see \ref PivotRule.
kpeter@593
   856
    ///
kpeter@636
   857
    /// \return \c INFEASIBLE if no feasible flow exists,
kpeter@636
   858
    /// \n \c OPTIMAL if the problem has optimal solution
kpeter@636
   859
    /// (i.e. it is feasible and bounded), and the algorithm has found
kpeter@636
   860
    /// optimal flow and node potentials (primal and dual solutions),
kpeter@636
   861
    /// \n \c UNBOUNDED if the objective function of the problem is
kpeter@636
   862
    /// unbounded, i.e. there is a directed cycle having negative total
kpeter@636
   863
    /// cost and infinite upper bound.
kpeter@636
   864
    ///
kpeter@636
   865
    /// \see ProblemType, PivotRule
kpeter@636
   866
    ProblemType run(PivotRule pivot_rule = BLOCK_SEARCH) {
kpeter@636
   867
      if (!init()) return INFEASIBLE;
kpeter@636
   868
      return start(pivot_rule);
kpeter@593
   869
    }
kpeter@593
   870
kpeter@598
   871
    /// \brief Reset all the parameters that have been given before.
kpeter@598
   872
    ///
kpeter@598
   873
    /// This function resets all the paramaters that have been given
kpeter@601
   874
    /// before using functions \ref lowerMap(), \ref upperMap(),
kpeter@638
   875
    /// \ref costMap(), \ref supplyMap(), \ref stSupply(), \ref supplyType().
kpeter@598
   876
    ///
kpeter@598
   877
    /// It is useful for multiple run() calls. If this function is not
kpeter@598
   878
    /// used, all the parameters given before are kept for the next
kpeter@598
   879
    /// \ref run() call.
kpeter@638
   880
    /// However the underlying digraph must not be modified after this
kpeter@638
   881
    /// class have been constructed, since it copies and extends the graph.
kpeter@598
   882
    ///
kpeter@598
   883
    /// For example,
kpeter@598
   884
    /// \code
kpeter@598
   885
    ///   NetworkSimplex<ListDigraph> ns(graph);
kpeter@598
   886
    ///
kpeter@598
   887
    ///   // First run
kpeter@636
   888
    ///   ns.lowerMap(lower).upperMap(upper).costMap(cost)
kpeter@598
   889
    ///     .supplyMap(sup).run();
kpeter@598
   890
    ///
kpeter@598
   891
    ///   // Run again with modified cost map (reset() is not called,
kpeter@598
   892
    ///   // so only the cost map have to be set again)
kpeter@598
   893
    ///   cost[e] += 100;
kpeter@598
   894
    ///   ns.costMap(cost).run();
kpeter@598
   895
    ///
kpeter@598
   896
    ///   // Run again from scratch using reset()
kpeter@598
   897
    ///   // (the lower bounds will be set to zero on all arcs)
kpeter@598
   898
    ///   ns.reset();
kpeter@636
   899
    ///   ns.upperMap(capacity).costMap(cost)
kpeter@598
   900
    ///     .supplyMap(sup).run();
kpeter@598
   901
    /// \endcode
kpeter@598
   902
    ///
kpeter@598
   903
    /// \return <tt>(*this)</tt>
kpeter@598
   904
    NetworkSimplex& reset() {
kpeter@638
   905
      for (int i = 0; i != _node_num; ++i) {
kpeter@638
   906
        _supply[i] = 0;
kpeter@638
   907
      }
kpeter@638
   908
      for (int i = 0; i != _arc_num; ++i) {
kpeter@638
   909
        _lower[i] = 0;
kpeter@638
   910
        _upper[i] = INF;
kpeter@638
   911
        _cost[i] = 1;
kpeter@638
   912
      }
kpeter@638
   913
      _have_lower = false;
kpeter@636
   914
      _stype = GEQ;
kpeter@598
   915
      return *this;
kpeter@598
   916
    }
kpeter@598
   917
kpeter@593
   918
    /// @}
kpeter@593
   919
kpeter@593
   920
    /// \name Query Functions
kpeter@593
   921
    /// The results of the algorithm can be obtained using these
kpeter@593
   922
    /// functions.\n
kpeter@597
   923
    /// The \ref run() function must be called before using them.
kpeter@597
   924
kpeter@593
   925
    /// @{
kpeter@593
   926
kpeter@597
   927
    /// \brief Return the total cost of the found flow.
kpeter@597
   928
    ///
kpeter@597
   929
    /// This function returns the total cost of the found flow.
kpeter@636
   930
    /// Its complexity is O(e).
kpeter@597
   931
    ///
kpeter@597
   932
    /// \note The return type of the function can be specified as a
kpeter@597
   933
    /// template parameter. For example,
kpeter@597
   934
    /// \code
kpeter@597
   935
    ///   ns.totalCost<double>();
kpeter@597
   936
    /// \endcode
kpeter@599
   937
    /// It is useful if the total cost cannot be stored in the \c Cost
kpeter@597
   938
    /// type of the algorithm, which is the default return type of the
kpeter@597
   939
    /// function.
kpeter@597
   940
    ///
kpeter@597
   941
    /// \pre \ref run() must be called before using this function.
kpeter@638
   942
    template <typename Number>
kpeter@638
   943
    Number totalCost() const {
kpeter@638
   944
      Number c = 0;
kpeter@638
   945
      for (ArcIt a(_graph); a != INVALID; ++a) {
kpeter@638
   946
        int i = _arc_id[a];
kpeter@638
   947
        c += Number(_flow[i]) * Number(_cost[i]);
kpeter@597
   948
      }
kpeter@597
   949
      return c;
kpeter@597
   950
    }
kpeter@597
   951
kpeter@597
   952
#ifndef DOXYGEN
kpeter@599
   953
    Cost totalCost() const {
kpeter@599
   954
      return totalCost<Cost>();
kpeter@597
   955
    }
kpeter@597
   956
#endif
kpeter@597
   957
kpeter@597
   958
    /// \brief Return the flow on the given arc.
kpeter@597
   959
    ///
kpeter@597
   960
    /// This function returns the flow on the given arc.
kpeter@597
   961
    ///
kpeter@597
   962
    /// \pre \ref run() must be called before using this function.
kpeter@637
   963
    Value flow(const Arc& a) const {
kpeter@638
   964
      return _flow[_arc_id[a]];
kpeter@597
   965
    }
kpeter@597
   966
kpeter@638
   967
    /// \brief Return the flow map (the primal solution).
kpeter@593
   968
    ///
kpeter@638
   969
    /// This function copies the flow value on each arc into the given
kpeter@638
   970
    /// map. The \c Value type of the algorithm must be convertible to
kpeter@638
   971
    /// the \c Value type of the map.
kpeter@593
   972
    ///
kpeter@593
   973
    /// \pre \ref run() must be called before using this function.
kpeter@638
   974
    template <typename FlowMap>
kpeter@638
   975
    void flowMap(FlowMap &map) const {
kpeter@638
   976
      for (ArcIt a(_graph); a != INVALID; ++a) {
kpeter@638
   977
        map.set(a, _flow[_arc_id[a]]);
kpeter@638
   978
      }
kpeter@593
   979
    }
kpeter@593
   980
kpeter@597
   981
    /// \brief Return the potential (dual value) of the given node.
kpeter@597
   982
    ///
kpeter@597
   983
    /// This function returns the potential (dual value) of the
kpeter@597
   984
    /// given node.
kpeter@597
   985
    ///
kpeter@597
   986
    /// \pre \ref run() must be called before using this function.
kpeter@599
   987
    Cost potential(const Node& n) const {
kpeter@638
   988
      return _pi[_node_id[n]];
kpeter@597
   989
    }
kpeter@597
   990
kpeter@638
   991
    /// \brief Return the potential map (the dual solution).
kpeter@593
   992
    ///
kpeter@638
   993
    /// This function copies the potential (dual value) of each node
kpeter@638
   994
    /// into the given map.
kpeter@638
   995
    /// The \c Cost type of the algorithm must be convertible to the
kpeter@638
   996
    /// \c Value type of the map.
kpeter@593
   997
    ///
kpeter@593
   998
    /// \pre \ref run() must be called before using this function.
kpeter@638
   999
    template <typename PotentialMap>
kpeter@638
  1000
    void potentialMap(PotentialMap &map) const {
kpeter@638
  1001
      for (NodeIt n(_graph); n != INVALID; ++n) {
kpeter@638
  1002
        map.set(n, _pi[_node_id[n]]);
kpeter@638
  1003
      }
kpeter@593
  1004
    }
kpeter@593
  1005
kpeter@593
  1006
    /// @}
kpeter@593
  1007
kpeter@593
  1008
  private:
kpeter@593
  1009
kpeter@593
  1010
    // Initialize internal data structures
kpeter@593
  1011
    bool init() {
kpeter@597
  1012
      if (_node_num == 0) return false;
kpeter@593
  1013
kpeter@638
  1014
      // Check the sum of supply values
kpeter@638
  1015
      _sum_supply = 0;
kpeter@638
  1016
      for (int i = 0; i != _node_num; ++i) {
kpeter@638
  1017
        _sum_supply += _supply[i];
kpeter@638
  1018
      }
alpar@639
  1019
      if ( !((_stype == GEQ && _sum_supply <= 0) ||
alpar@639
  1020
             (_stype == LEQ && _sum_supply >= 0)) ) return false;
kpeter@593
  1021
kpeter@638
  1022
      // Remove non-zero lower bounds
kpeter@638
  1023
      if (_have_lower) {
kpeter@638
  1024
        for (int i = 0; i != _arc_num; ++i) {
kpeter@638
  1025
          Value c = _lower[i];
kpeter@638
  1026
          if (c >= 0) {
kpeter@638
  1027
            _cap[i] = _upper[i] < INF ? _upper[i] - c : INF;
kpeter@638
  1028
          } else {
kpeter@638
  1029
            _cap[i] = _upper[i] < INF + c ? _upper[i] - c : INF;
kpeter@638
  1030
          }
kpeter@638
  1031
          _supply[_source[i]] -= c;
kpeter@638
  1032
          _supply[_target[i]] += c;
kpeter@638
  1033
        }
kpeter@638
  1034
      } else {
kpeter@638
  1035
        for (int i = 0; i != _arc_num; ++i) {
kpeter@638
  1036
          _cap[i] = _upper[i];
kpeter@638
  1037
        }
kpeter@597
  1038
      }
kpeter@593
  1039
kpeter@601
  1040
      // Initialize artifical cost
kpeter@636
  1041
      Cost ART_COST;
kpeter@601
  1042
      if (std::numeric_limits<Cost>::is_exact) {
kpeter@661
  1043
        ART_COST = std::numeric_limits<Cost>::max() / 2 + 1;
kpeter@601
  1044
      } else {
kpeter@636
  1045
        ART_COST = std::numeric_limits<Cost>::min();
kpeter@601
  1046
        for (int i = 0; i != _arc_num; ++i) {
kpeter@636
  1047
          if (_cost[i] > ART_COST) ART_COST = _cost[i];
kpeter@601
  1048
        }
kpeter@636
  1049
        ART_COST = (ART_COST + 1) * _node_num;
kpeter@601
  1050
      }
kpeter@601
  1051
kpeter@638
  1052
      // Initialize arc maps
kpeter@638
  1053
      for (int i = 0; i != _arc_num; ++i) {
kpeter@638
  1054
        _flow[i] = 0;
kpeter@638
  1055
        _state[i] = STATE_LOWER;
kpeter@638
  1056
      }
kpeter@638
  1057
      
kpeter@593
  1058
      // Set data for the artificial root node
kpeter@593
  1059
      _root = _node_num;
kpeter@593
  1060
      _parent[_root] = -1;
kpeter@593
  1061
      _pred[_root] = -1;
kpeter@593
  1062
      _thread[_root] = 0;
kpeter@596
  1063
      _rev_thread[0] = _root;
kpeter@638
  1064
      _succ_num[_root] = _node_num + 1;
kpeter@596
  1065
      _last_succ[_root] = _root - 1;
kpeter@636
  1066
      _supply[_root] = -_sum_supply;
kpeter@661
  1067
      _pi[_root] = 0;
kpeter@593
  1068
kpeter@593
  1069
      // Add artificial arcs and initialize the spanning tree data structure
kpeter@661
  1070
      if (_sum_supply == 0) {
kpeter@661
  1071
        // EQ supply constraints
kpeter@661
  1072
        _search_arc_num = _arc_num;
kpeter@661
  1073
        _all_arc_num = _arc_num + _node_num;
kpeter@661
  1074
        for (int u = 0, e = _arc_num; u != _node_num; ++u, ++e) {
kpeter@661
  1075
          _parent[u] = _root;
kpeter@661
  1076
          _pred[u] = e;
kpeter@661
  1077
          _thread[u] = u + 1;
kpeter@661
  1078
          _rev_thread[u + 1] = u;
kpeter@661
  1079
          _succ_num[u] = 1;
kpeter@661
  1080
          _last_succ[u] = u;
kpeter@661
  1081
          _cap[e] = INF;
kpeter@661
  1082
          _state[e] = STATE_TREE;
kpeter@661
  1083
          if (_supply[u] >= 0) {
kpeter@661
  1084
            _forward[u] = true;
kpeter@661
  1085
            _pi[u] = 0;
kpeter@661
  1086
            _source[e] = u;
kpeter@661
  1087
            _target[e] = _root;
kpeter@661
  1088
            _flow[e] = _supply[u];
kpeter@661
  1089
            _cost[e] = 0;
kpeter@661
  1090
          } else {
kpeter@661
  1091
            _forward[u] = false;
kpeter@661
  1092
            _pi[u] = ART_COST;
kpeter@661
  1093
            _source[e] = _root;
kpeter@661
  1094
            _target[e] = u;
kpeter@661
  1095
            _flow[e] = -_supply[u];
kpeter@661
  1096
            _cost[e] = ART_COST;
kpeter@661
  1097
          }
kpeter@593
  1098
        }
kpeter@593
  1099
      }
kpeter@661
  1100
      else if (_sum_supply > 0) {
kpeter@661
  1101
        // LEQ supply constraints
kpeter@661
  1102
        _search_arc_num = _arc_num + _node_num;
kpeter@661
  1103
        int f = _arc_num + _node_num;
kpeter@661
  1104
        for (int u = 0, e = _arc_num; u != _node_num; ++u, ++e) {
kpeter@661
  1105
          _parent[u] = _root;
kpeter@661
  1106
          _thread[u] = u + 1;
kpeter@661
  1107
          _rev_thread[u + 1] = u;
kpeter@661
  1108
          _succ_num[u] = 1;
kpeter@661
  1109
          _last_succ[u] = u;
kpeter@661
  1110
          if (_supply[u] >= 0) {
kpeter@661
  1111
            _forward[u] = true;
kpeter@661
  1112
            _pi[u] = 0;
kpeter@661
  1113
            _pred[u] = e;
kpeter@661
  1114
            _source[e] = u;
kpeter@661
  1115
            _target[e] = _root;
kpeter@661
  1116
            _cap[e] = INF;
kpeter@661
  1117
            _flow[e] = _supply[u];
kpeter@661
  1118
            _cost[e] = 0;
kpeter@661
  1119
            _state[e] = STATE_TREE;
kpeter@661
  1120
          } else {
kpeter@661
  1121
            _forward[u] = false;
kpeter@661
  1122
            _pi[u] = ART_COST;
kpeter@661
  1123
            _pred[u] = f;
kpeter@661
  1124
            _source[f] = _root;
kpeter@661
  1125
            _target[f] = u;
kpeter@661
  1126
            _cap[f] = INF;
kpeter@661
  1127
            _flow[f] = -_supply[u];
kpeter@661
  1128
            _cost[f] = ART_COST;
kpeter@661
  1129
            _state[f] = STATE_TREE;
kpeter@661
  1130
            _source[e] = u;
kpeter@661
  1131
            _target[e] = _root;
kpeter@661
  1132
            _cap[e] = INF;
kpeter@661
  1133
            _flow[e] = 0;
kpeter@661
  1134
            _cost[e] = 0;
kpeter@661
  1135
            _state[e] = STATE_LOWER;
kpeter@661
  1136
            ++f;
kpeter@661
  1137
          }
kpeter@661
  1138
        }
kpeter@661
  1139
        _all_arc_num = f;
kpeter@661
  1140
      }
kpeter@661
  1141
      else {
kpeter@661
  1142
        // GEQ supply constraints
kpeter@661
  1143
        _search_arc_num = _arc_num + _node_num;
kpeter@661
  1144
        int f = _arc_num + _node_num;
kpeter@661
  1145
        for (int u = 0, e = _arc_num; u != _node_num; ++u, ++e) {
kpeter@661
  1146
          _parent[u] = _root;
kpeter@661
  1147
          _thread[u] = u + 1;
kpeter@661
  1148
          _rev_thread[u + 1] = u;
kpeter@661
  1149
          _succ_num[u] = 1;
kpeter@661
  1150
          _last_succ[u] = u;
kpeter@661
  1151
          if (_supply[u] <= 0) {
kpeter@661
  1152
            _forward[u] = false;
kpeter@661
  1153
            _pi[u] = 0;
kpeter@661
  1154
            _pred[u] = e;
kpeter@661
  1155
            _source[e] = _root;
kpeter@661
  1156
            _target[e] = u;
kpeter@661
  1157
            _cap[e] = INF;
kpeter@661
  1158
            _flow[e] = -_supply[u];
kpeter@661
  1159
            _cost[e] = 0;
kpeter@661
  1160
            _state[e] = STATE_TREE;
kpeter@661
  1161
          } else {
kpeter@661
  1162
            _forward[u] = true;
kpeter@661
  1163
            _pi[u] = -ART_COST;
kpeter@661
  1164
            _pred[u] = f;
kpeter@661
  1165
            _source[f] = u;
kpeter@661
  1166
            _target[f] = _root;
kpeter@661
  1167
            _cap[f] = INF;
kpeter@661
  1168
            _flow[f] = _supply[u];
kpeter@661
  1169
            _state[f] = STATE_TREE;
kpeter@661
  1170
            _cost[f] = ART_COST;
kpeter@661
  1171
            _source[e] = _root;
kpeter@661
  1172
            _target[e] = u;
kpeter@661
  1173
            _cap[e] = INF;
kpeter@661
  1174
            _flow[e] = 0;
kpeter@661
  1175
            _cost[e] = 0;
kpeter@661
  1176
            _state[e] = STATE_LOWER;
kpeter@661
  1177
            ++f;
kpeter@661
  1178
          }
kpeter@661
  1179
        }
kpeter@661
  1180
        _all_arc_num = f;
kpeter@661
  1181
      }
kpeter@593
  1182
kpeter@593
  1183
      return true;
kpeter@593
  1184
    }
kpeter@593
  1185
kpeter@593
  1186
    // Find the join node
kpeter@593
  1187
    void findJoinNode() {
kpeter@595
  1188
      int u = _source[in_arc];
kpeter@595
  1189
      int v = _target[in_arc];
kpeter@593
  1190
      while (u != v) {
kpeter@596
  1191
        if (_succ_num[u] < _succ_num[v]) {
kpeter@596
  1192
          u = _parent[u];
kpeter@596
  1193
        } else {
kpeter@596
  1194
          v = _parent[v];
kpeter@596
  1195
        }
kpeter@593
  1196
      }
kpeter@593
  1197
      join = u;
kpeter@593
  1198
    }
kpeter@593
  1199
kpeter@593
  1200
    // Find the leaving arc of the cycle and returns true if the
kpeter@593
  1201
    // leaving arc is not the same as the entering arc
kpeter@593
  1202
    bool findLeavingArc() {
kpeter@593
  1203
      // Initialize first and second nodes according to the direction
kpeter@593
  1204
      // of the cycle
kpeter@595
  1205
      if (_state[in_arc] == STATE_LOWER) {
kpeter@595
  1206
        first  = _source[in_arc];
kpeter@595
  1207
        second = _target[in_arc];
kpeter@593
  1208
      } else {
kpeter@595
  1209
        first  = _target[in_arc];
kpeter@595
  1210
        second = _source[in_arc];
kpeter@593
  1211
      }
kpeter@595
  1212
      delta = _cap[in_arc];
kpeter@593
  1213
      int result = 0;
kpeter@637
  1214
      Value d;
kpeter@593
  1215
      int e;
kpeter@593
  1216
kpeter@593
  1217
      // Search the cycle along the path form the first node to the root
kpeter@593
  1218
      for (int u = first; u != join; u = _parent[u]) {
kpeter@593
  1219
        e = _pred[u];
kpeter@636
  1220
        d = _forward[u] ?
kpeter@636
  1221
          _flow[e] : (_cap[e] == INF ? INF : _cap[e] - _flow[e]);
kpeter@593
  1222
        if (d < delta) {
kpeter@593
  1223
          delta = d;
kpeter@593
  1224
          u_out = u;
kpeter@593
  1225
          result = 1;
kpeter@593
  1226
        }
kpeter@593
  1227
      }
kpeter@593
  1228
      // Search the cycle along the path form the second node to the root
kpeter@593
  1229
      for (int u = second; u != join; u = _parent[u]) {
kpeter@593
  1230
        e = _pred[u];
kpeter@636
  1231
        d = _forward[u] ? 
kpeter@636
  1232
          (_cap[e] == INF ? INF : _cap[e] - _flow[e]) : _flow[e];
kpeter@593
  1233
        if (d <= delta) {
kpeter@593
  1234
          delta = d;
kpeter@593
  1235
          u_out = u;
kpeter@593
  1236
          result = 2;
kpeter@593
  1237
        }
kpeter@593
  1238
      }
kpeter@593
  1239
kpeter@593
  1240
      if (result == 1) {
kpeter@593
  1241
        u_in = first;
kpeter@593
  1242
        v_in = second;
kpeter@593
  1243
      } else {
kpeter@593
  1244
        u_in = second;
kpeter@593
  1245
        v_in = first;
kpeter@593
  1246
      }
kpeter@593
  1247
      return result != 0;
kpeter@593
  1248
    }
kpeter@593
  1249
kpeter@593
  1250
    // Change _flow and _state vectors
kpeter@593
  1251
    void changeFlow(bool change) {
kpeter@593
  1252
      // Augment along the cycle
kpeter@593
  1253
      if (delta > 0) {
kpeter@637
  1254
        Value val = _state[in_arc] * delta;
kpeter@595
  1255
        _flow[in_arc] += val;
kpeter@595
  1256
        for (int u = _source[in_arc]; u != join; u = _parent[u]) {
kpeter@593
  1257
          _flow[_pred[u]] += _forward[u] ? -val : val;
kpeter@593
  1258
        }
kpeter@595
  1259
        for (int u = _target[in_arc]; u != join; u = _parent[u]) {
kpeter@593
  1260
          _flow[_pred[u]] += _forward[u] ? val : -val;
kpeter@593
  1261
        }
kpeter@593
  1262
      }
kpeter@593
  1263
      // Update the state of the entering and leaving arcs
kpeter@593
  1264
      if (change) {
kpeter@595
  1265
        _state[in_arc] = STATE_TREE;
kpeter@593
  1266
        _state[_pred[u_out]] =
kpeter@593
  1267
          (_flow[_pred[u_out]] == 0) ? STATE_LOWER : STATE_UPPER;
kpeter@593
  1268
      } else {
kpeter@595
  1269
        _state[in_arc] = -_state[in_arc];
kpeter@593
  1270
      }
kpeter@593
  1271
    }
kpeter@593
  1272
kpeter@596
  1273
    // Update the tree structure
kpeter@596
  1274
    void updateTreeStructure() {
kpeter@596
  1275
      int u, w;
kpeter@596
  1276
      int old_rev_thread = _rev_thread[u_out];
kpeter@596
  1277
      int old_succ_num = _succ_num[u_out];
kpeter@596
  1278
      int old_last_succ = _last_succ[u_out];
kpeter@593
  1279
      v_out = _parent[u_out];
kpeter@593
  1280
kpeter@596
  1281
      u = _last_succ[u_in];  // the last successor of u_in
kpeter@596
  1282
      right = _thread[u];    // the node after it
kpeter@596
  1283
kpeter@596
  1284
      // Handle the case when old_rev_thread equals to v_in
kpeter@596
  1285
      // (it also means that join and v_out coincide)
kpeter@596
  1286
      if (old_rev_thread == v_in) {
kpeter@596
  1287
        last = _thread[_last_succ[u_out]];
kpeter@596
  1288
      } else {
kpeter@596
  1289
        last = _thread[v_in];
kpeter@593
  1290
      }
kpeter@593
  1291
kpeter@596
  1292
      // Update _thread and _parent along the stem nodes (i.e. the nodes
kpeter@596
  1293
      // between u_in and u_out, whose parent have to be changed)
kpeter@593
  1294
      _thread[v_in] = stem = u_in;
kpeter@596
  1295
      _dirty_revs.clear();
kpeter@596
  1296
      _dirty_revs.push_back(v_in);
kpeter@593
  1297
      par_stem = v_in;
kpeter@593
  1298
      while (stem != u_out) {
kpeter@596
  1299
        // Insert the next stem node into the thread list
kpeter@596
  1300
        new_stem = _parent[stem];
kpeter@596
  1301
        _thread[u] = new_stem;
kpeter@596
  1302
        _dirty_revs.push_back(u);
kpeter@593
  1303
kpeter@596
  1304
        // Remove the subtree of stem from the thread list
kpeter@596
  1305
        w = _rev_thread[stem];
kpeter@596
  1306
        _thread[w] = right;
kpeter@596
  1307
        _rev_thread[right] = w;
kpeter@593
  1308
kpeter@596
  1309
        // Change the parent node and shift stem nodes
kpeter@593
  1310
        _parent[stem] = par_stem;
kpeter@593
  1311
        par_stem = stem;
kpeter@593
  1312
        stem = new_stem;
kpeter@593
  1313
kpeter@596
  1314
        // Update u and right
kpeter@596
  1315
        u = _last_succ[stem] == _last_succ[par_stem] ?
kpeter@596
  1316
          _rev_thread[par_stem] : _last_succ[stem];
kpeter@593
  1317
        right = _thread[u];
kpeter@593
  1318
      }
kpeter@593
  1319
      _parent[u_out] = par_stem;
kpeter@593
  1320
      _thread[u] = last;
kpeter@596
  1321
      _rev_thread[last] = u;
kpeter@596
  1322
      _last_succ[u_out] = u;
kpeter@593
  1323
kpeter@596
  1324
      // Remove the subtree of u_out from the thread list except for
kpeter@596
  1325
      // the case when old_rev_thread equals to v_in
kpeter@596
  1326
      // (it also means that join and v_out coincide)
kpeter@596
  1327
      if (old_rev_thread != v_in) {
kpeter@596
  1328
        _thread[old_rev_thread] = right;
kpeter@596
  1329
        _rev_thread[right] = old_rev_thread;
kpeter@596
  1330
      }
kpeter@596
  1331
kpeter@596
  1332
      // Update _rev_thread using the new _thread values
kpeter@596
  1333
      for (int i = 0; i < int(_dirty_revs.size()); ++i) {
kpeter@596
  1334
        u = _dirty_revs[i];
kpeter@596
  1335
        _rev_thread[_thread[u]] = u;
kpeter@596
  1336
      }
kpeter@596
  1337
kpeter@596
  1338
      // Update _pred, _forward, _last_succ and _succ_num for the
kpeter@596
  1339
      // stem nodes from u_out to u_in
kpeter@596
  1340
      int tmp_sc = 0, tmp_ls = _last_succ[u_out];
kpeter@596
  1341
      u = u_out;
kpeter@596
  1342
      while (u != u_in) {
kpeter@596
  1343
        w = _parent[u];
kpeter@596
  1344
        _pred[u] = _pred[w];
kpeter@596
  1345
        _forward[u] = !_forward[w];
kpeter@596
  1346
        tmp_sc += _succ_num[u] - _succ_num[w];
kpeter@596
  1347
        _succ_num[u] = tmp_sc;
kpeter@596
  1348
        _last_succ[w] = tmp_ls;
kpeter@596
  1349
        u = w;
kpeter@596
  1350
      }
kpeter@596
  1351
      _pred[u_in] = in_arc;
kpeter@596
  1352
      _forward[u_in] = (u_in == _source[in_arc]);
kpeter@596
  1353
      _succ_num[u_in] = old_succ_num;
kpeter@596
  1354
kpeter@596
  1355
      // Set limits for updating _last_succ form v_in and v_out
kpeter@596
  1356
      // towards the root
kpeter@596
  1357
      int up_limit_in = -1;
kpeter@596
  1358
      int up_limit_out = -1;
kpeter@596
  1359
      if (_last_succ[join] == v_in) {
kpeter@596
  1360
        up_limit_out = join;
kpeter@593
  1361
      } else {
kpeter@596
  1362
        up_limit_in = join;
kpeter@596
  1363
      }
kpeter@596
  1364
kpeter@596
  1365
      // Update _last_succ from v_in towards the root
kpeter@596
  1366
      for (u = v_in; u != up_limit_in && _last_succ[u] == v_in;
kpeter@596
  1367
           u = _parent[u]) {
kpeter@596
  1368
        _last_succ[u] = _last_succ[u_out];
kpeter@596
  1369
      }
kpeter@596
  1370
      // Update _last_succ from v_out towards the root
kpeter@596
  1371
      if (join != old_rev_thread && v_in != old_rev_thread) {
kpeter@596
  1372
        for (u = v_out; u != up_limit_out && _last_succ[u] == old_last_succ;
kpeter@596
  1373
             u = _parent[u]) {
kpeter@596
  1374
          _last_succ[u] = old_rev_thread;
kpeter@596
  1375
        }
kpeter@596
  1376
      } else {
kpeter@596
  1377
        for (u = v_out; u != up_limit_out && _last_succ[u] == old_last_succ;
kpeter@596
  1378
             u = _parent[u]) {
kpeter@596
  1379
          _last_succ[u] = _last_succ[u_out];
kpeter@596
  1380
        }
kpeter@596
  1381
      }
kpeter@596
  1382
kpeter@596
  1383
      // Update _succ_num from v_in to join
kpeter@596
  1384
      for (u = v_in; u != join; u = _parent[u]) {
kpeter@596
  1385
        _succ_num[u] += old_succ_num;
kpeter@596
  1386
      }
kpeter@596
  1387
      // Update _succ_num from v_out to join
kpeter@596
  1388
      for (u = v_out; u != join; u = _parent[u]) {
kpeter@596
  1389
        _succ_num[u] -= old_succ_num;
kpeter@593
  1390
      }
kpeter@593
  1391
    }
kpeter@593
  1392
kpeter@596
  1393
    // Update potentials
kpeter@596
  1394
    void updatePotential() {
kpeter@599
  1395
      Cost sigma = _forward[u_in] ?
kpeter@593
  1396
        _pi[v_in] - _pi[u_in] - _cost[_pred[u_in]] :
kpeter@593
  1397
        _pi[v_in] - _pi[u_in] + _cost[_pred[u_in]];
kpeter@600
  1398
      // Update potentials in the subtree, which has been moved
kpeter@600
  1399
      int end = _thread[_last_succ[u_in]];
kpeter@600
  1400
      for (int u = u_in; u != end; u = _thread[u]) {
kpeter@600
  1401
        _pi[u] += sigma;
kpeter@593
  1402
      }
kpeter@593
  1403
    }
kpeter@593
  1404
kpeter@593
  1405
    // Execute the algorithm
kpeter@636
  1406
    ProblemType start(PivotRule pivot_rule) {
kpeter@593
  1407
      // Select the pivot rule implementation
kpeter@593
  1408
      switch (pivot_rule) {
kpeter@597
  1409
        case FIRST_ELIGIBLE:
kpeter@593
  1410
          return start<FirstEligiblePivotRule>();
kpeter@597
  1411
        case BEST_ELIGIBLE:
kpeter@593
  1412
          return start<BestEligiblePivotRule>();
kpeter@597
  1413
        case BLOCK_SEARCH:
kpeter@593
  1414
          return start<BlockSearchPivotRule>();
kpeter@597
  1415
        case CANDIDATE_LIST:
kpeter@593
  1416
          return start<CandidateListPivotRule>();
kpeter@597
  1417
        case ALTERING_LIST:
kpeter@593
  1418
          return start<AlteringListPivotRule>();
kpeter@593
  1419
      }
kpeter@636
  1420
      return INFEASIBLE; // avoid warning
kpeter@593
  1421
    }
kpeter@593
  1422
kpeter@597
  1423
    template <typename PivotRuleImpl>
kpeter@636
  1424
    ProblemType start() {
kpeter@597
  1425
      PivotRuleImpl pivot(*this);
kpeter@593
  1426
kpeter@597
  1427
      // Execute the Network Simplex algorithm
kpeter@593
  1428
      while (pivot.findEnteringArc()) {
kpeter@593
  1429
        findJoinNode();
kpeter@593
  1430
        bool change = findLeavingArc();
kpeter@636
  1431
        if (delta >= INF) return UNBOUNDED;
kpeter@593
  1432
        changeFlow(change);
kpeter@593
  1433
        if (change) {
kpeter@596
  1434
          updateTreeStructure();
kpeter@596
  1435
          updatePotential();
kpeter@593
  1436
        }
kpeter@593
  1437
      }
kpeter@636
  1438
      
kpeter@636
  1439
      // Check feasibility
kpeter@661
  1440
      for (int e = _search_arc_num; e != _all_arc_num; ++e) {
kpeter@661
  1441
        if (_flow[e] != 0) return INFEASIBLE;
kpeter@636
  1442
      }
kpeter@593
  1443
kpeter@638
  1444
      // Transform the solution and the supply map to the original form
kpeter@638
  1445
      if (_have_lower) {
kpeter@593
  1446
        for (int i = 0; i != _arc_num; ++i) {
kpeter@638
  1447
          Value c = _lower[i];
kpeter@638
  1448
          if (c != 0) {
kpeter@638
  1449
            _flow[i] += c;
kpeter@638
  1450
            _supply[_source[i]] += c;
kpeter@638
  1451
            _supply[_target[i]] -= c;
kpeter@638
  1452
          }
kpeter@593
  1453
        }
kpeter@593
  1454
      }
kpeter@661
  1455
      
kpeter@661
  1456
      // Shift potentials to meet the requirements of the GEQ/LEQ type
kpeter@661
  1457
      // optimality conditions
kpeter@661
  1458
      if (_sum_supply == 0) {
kpeter@661
  1459
        if (_stype == GEQ) {
kpeter@661
  1460
          Cost max_pot = std::numeric_limits<Cost>::min();
kpeter@661
  1461
          for (int i = 0; i != _node_num; ++i) {
kpeter@661
  1462
            if (_pi[i] > max_pot) max_pot = _pi[i];
kpeter@661
  1463
          }
kpeter@661
  1464
          if (max_pot > 0) {
kpeter@661
  1465
            for (int i = 0; i != _node_num; ++i)
kpeter@661
  1466
              _pi[i] -= max_pot;
kpeter@661
  1467
          }
kpeter@661
  1468
        } else {
kpeter@661
  1469
          Cost min_pot = std::numeric_limits<Cost>::max();
kpeter@661
  1470
          for (int i = 0; i != _node_num; ++i) {
kpeter@661
  1471
            if (_pi[i] < min_pot) min_pot = _pi[i];
kpeter@661
  1472
          }
kpeter@661
  1473
          if (min_pot < 0) {
kpeter@661
  1474
            for (int i = 0; i != _node_num; ++i)
kpeter@661
  1475
              _pi[i] -= min_pot;
kpeter@661
  1476
          }
kpeter@661
  1477
        }
kpeter@661
  1478
      }
kpeter@593
  1479
kpeter@636
  1480
      return OPTIMAL;
kpeter@593
  1481
    }
kpeter@593
  1482
kpeter@593
  1483
  }; //class NetworkSimplex
kpeter@593
  1484
kpeter@593
  1485
  ///@}
kpeter@593
  1486
kpeter@593
  1487
} //namespace lemon
kpeter@593
  1488
kpeter@593
  1489
#endif //LEMON_NETWORK_SIMPLEX_H