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