lemon/network_simplex.h
author Peter Kovacs <kpeter@inf.elte.hu>
Wed, 25 Mar 2009 15:58:44 +0100
changeset 605 5232721b3f14
parent 604 8c3112a66878
child 606 c7d160f73d52
permissions -rw-r--r--
Rework the interface of NetworkSimplex (#234)

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