petgraph/algo/
ford_fulkerson.rs1use std::{collections::VecDeque, ops::Sub};
2
3use crate::{
4    data::DataMap,
5    visit::{
6        EdgeCount, EdgeIndexable, IntoEdges, IntoEdgesDirected, NodeCount, NodeIndexable, VisitMap,
7        Visitable,
8    },
9};
10
11use super::{EdgeRef, PositiveMeasure};
12use crate::prelude::Direction;
13
14fn residual_capacity<N>(
15    network: N,
16    edge: N::EdgeRef,
17    vertex: N::NodeId,
18    flow: N::EdgeWeight,
19) -> N::EdgeWeight
20where
21    N: NodeIndexable + IntoEdges,
22    N::EdgeWeight: Sub<Output = N::EdgeWeight> + PositiveMeasure,
23{
24    if vertex == edge.source() {
25        flow
27    } else if vertex == edge.target() {
28        return *edge.weight() - flow;
30    } else {
31        let end_point = NodeIndexable::to_index(&network, vertex);
32        panic!("Illegal endpoint {}", end_point);
33    }
34}
35
36fn other_endpoint<N>(network: N, edge: N::EdgeRef, vertex: N::NodeId) -> N::NodeId
38where
39    N: NodeIndexable + IntoEdges,
40{
41    if vertex == edge.source() {
42        edge.target()
43    } else if vertex == edge.target() {
44        edge.source()
45    } else {
46        let end_point = NodeIndexable::to_index(&network, vertex);
47        panic!("Illegal endpoint {}", end_point);
48    }
49}
50
51fn has_augmented_path<N>(
53    network: N,
54    source: N::NodeId,
55    destination: N::NodeId,
56    edge_to: &mut [Option<N::EdgeRef>],
57    flows: &[N::EdgeWeight],
58) -> bool
59where
60    N: NodeCount + IntoEdgesDirected + NodeIndexable + EdgeIndexable + Visitable,
61    N::EdgeWeight: Sub<Output = N::EdgeWeight> + PositiveMeasure,
62{
63    let mut visited = network.visit_map();
64    let mut queue = VecDeque::new();
65    visited.visit(source);
66    queue.push_back(source);
67
68    while let Some(vertex) = queue.pop_front() {
69        let out_edges = network.edges_directed(vertex, Direction::Outgoing);
70        let in_edges = network.edges_directed(vertex, Direction::Incoming);
71        for edge in out_edges.chain(in_edges) {
72            let next = other_endpoint(&network, edge, vertex);
73            let edge_index: usize = EdgeIndexable::to_index(&network, edge.id());
74            let residual_cap = residual_capacity(&network, edge, next, flows[edge_index]);
75            if !visited.is_visited(&next) && (residual_cap > N::EdgeWeight::zero()) {
76                visited.visit(next);
77                edge_to[NodeIndexable::to_index(&network, next)] = Some(edge);
78                if destination == next {
79                    return true;
80                }
81                queue.push_back(next);
82            }
83        }
84    }
85    false
86}
87
88fn adjust_residual_flow<N>(
89    network: N,
90    edge: N::EdgeRef,
91    vertex: N::NodeId,
92    flow: N::EdgeWeight,
93    delta: N::EdgeWeight,
94) -> N::EdgeWeight
95where
96    N: NodeIndexable + IntoEdges,
97    N::EdgeWeight: Sub<Output = N::EdgeWeight> + PositiveMeasure,
98{
99    if vertex == edge.source() {
100        flow - delta
102    } else if vertex == edge.target() {
103        flow + delta
105    } else {
106        let end_point = NodeIndexable::to_index(&network, vertex);
107        panic!("Illegal endpoint {}", end_point);
108    }
109}
110
111pub fn ford_fulkerson<N>(
147    network: N,
148    source: N::NodeId,
149    destination: N::NodeId,
150) -> (N::EdgeWeight, Vec<N::EdgeWeight>)
151where
152    N: NodeCount
153        + EdgeCount
154        + IntoEdgesDirected
155        + EdgeIndexable
156        + NodeIndexable
157        + DataMap
158        + Visitable,
159    N::EdgeWeight: Sub<Output = N::EdgeWeight> + PositiveMeasure,
160{
161    let mut edge_to = vec![None; network.node_count()];
162    let mut flows = vec![N::EdgeWeight::zero(); network.edge_count()];
163    let mut max_flow = N::EdgeWeight::zero();
164    while has_augmented_path(&network, source, destination, &mut edge_to, &flows) {
165        let mut path_flow = N::EdgeWeight::max();
166
167        let mut vertex = destination;
169        let mut vertex_index = NodeIndexable::to_index(&network, vertex);
170        while let Some(edge) = edge_to[vertex_index] {
171            let edge_index = EdgeIndexable::to_index(&network, edge.id());
172            let residual_capacity = residual_capacity(&network, edge, vertex, flows[edge_index]);
173            path_flow = if path_flow > residual_capacity {
175                residual_capacity
176            } else {
177                path_flow
178            };
179            vertex = other_endpoint(&network, edge, vertex);
180            vertex_index = NodeIndexable::to_index(&network, vertex);
181        }
182
183        let mut vertex = destination;
185        let mut vertex_index = NodeIndexable::to_index(&network, vertex);
186        while let Some(edge) = edge_to[vertex_index] {
187            let edge_index = EdgeIndexable::to_index(&network, edge.id());
188            flows[edge_index] =
189                adjust_residual_flow(&network, edge, vertex, flows[edge_index], path_flow);
190            vertex = other_endpoint(&network, edge, vertex);
191            vertex_index = NodeIndexable::to_index(&network, vertex);
192        }
193        max_flow = max_flow + path_flow;
194    }
195    (max_flow, flows)
196}