2023-03-03 04:27:42 +08:00
|
|
|
|
|
|
|
|
|
|
|
|
2023-02-21 16:46:49 +08:00
|
|
|
|
2023-02-21 19:55:44 +08:00
|
|
|
use roaring::RoaringBitmap;
|
|
|
|
|
2023-02-21 16:46:49 +08:00
|
|
|
use super::cheapest_paths::Path;
|
2023-03-03 04:27:42 +08:00
|
|
|
|
2023-02-21 16:46:49 +08:00
|
|
|
|
2023-02-23 20:13:19 +08:00
|
|
|
#[derive(Debug, Clone)]
|
2023-02-21 16:46:49 +08:00
|
|
|
pub struct PathsMap<V> {
|
2023-02-23 20:13:19 +08:00
|
|
|
pub nodes: Vec<(u32, PathsMap<V>)>,
|
|
|
|
pub value: Option<V>,
|
2023-02-21 16:46:49 +08:00
|
|
|
}
|
|
|
|
impl<V> Default for PathsMap<V> {
|
|
|
|
fn default() -> Self {
|
|
|
|
Self { nodes: vec![], value: None }
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
impl PathsMap<u64> {
|
|
|
|
pub fn from_paths(paths: &[Path]) -> Self {
|
|
|
|
let mut result = Self::default();
|
|
|
|
for p in paths {
|
|
|
|
result.add_path(p);
|
|
|
|
}
|
|
|
|
result
|
|
|
|
}
|
|
|
|
pub fn add_path(&mut self, path: &Path) {
|
|
|
|
self.insert(path.edges.iter().copied(), path.cost);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
impl<V> PathsMap<V> {
|
|
|
|
pub fn is_empty(&self) -> bool {
|
|
|
|
self.nodes.is_empty() && self.value.is_none()
|
|
|
|
}
|
|
|
|
|
2023-02-21 19:55:44 +08:00
|
|
|
pub fn insert(&mut self, mut edges: impl Iterator<Item = u32>, value: V) {
|
2023-02-21 16:46:49 +08:00
|
|
|
match edges.next() {
|
|
|
|
None => {
|
|
|
|
self.value = Some(value);
|
|
|
|
}
|
|
|
|
Some(first_edge) => {
|
|
|
|
// comment
|
|
|
|
for (edge, next_node) in &mut self.nodes {
|
|
|
|
if edge == &first_edge {
|
|
|
|
return next_node.insert(edges, value);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
let mut rest = PathsMap::default();
|
|
|
|
rest.insert(edges, value);
|
|
|
|
self.nodes.push((first_edge, rest));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2023-02-21 19:55:44 +08:00
|
|
|
fn remove_first_rec(&mut self, cur: &mut Vec<u32>) -> (bool, V) {
|
2023-02-21 16:46:49 +08:00
|
|
|
let Some((first_edge, rest)) = self.nodes.first_mut() else {
|
|
|
|
// The PathsMap has to be correct by construction here, otherwise
|
|
|
|
// the unwrap() will crash
|
|
|
|
return (true, self.value.take().unwrap())
|
|
|
|
};
|
|
|
|
cur.push(*first_edge);
|
|
|
|
let (rest_is_empty, value) = rest.remove_first_rec(cur);
|
|
|
|
if rest_is_empty {
|
|
|
|
self.nodes.remove(0);
|
|
|
|
(self.nodes.is_empty(), value)
|
|
|
|
} else {
|
|
|
|
(false, value)
|
|
|
|
}
|
|
|
|
}
|
2023-02-21 19:55:44 +08:00
|
|
|
pub fn remove_first(&mut self) -> Option<(Vec<u32>, V)> {
|
2023-02-21 16:46:49 +08:00
|
|
|
if self.is_empty() {
|
2023-02-21 20:57:34 +08:00
|
|
|
return None;
|
2023-02-21 16:46:49 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
let mut result = vec![];
|
2023-02-21 20:57:34 +08:00
|
|
|
let (_, value) = self.remove_first_rec(&mut result);
|
2023-02-21 16:46:49 +08:00
|
|
|
Some((result, value))
|
|
|
|
}
|
2023-02-21 19:55:44 +08:00
|
|
|
pub fn iterate_rec(&self, cur: &mut Vec<u32>, visit: &mut impl FnMut(&Vec<u32>, &V)) {
|
2023-02-21 16:46:49 +08:00
|
|
|
if let Some(value) = &self.value {
|
|
|
|
visit(cur, value);
|
|
|
|
}
|
|
|
|
for (first_edge, rest) in self.nodes.iter() {
|
2023-02-21 20:57:34 +08:00
|
|
|
cur.push(*first_edge);
|
2023-02-21 16:46:49 +08:00
|
|
|
rest.iterate_rec(cur, visit);
|
|
|
|
cur.pop();
|
|
|
|
}
|
|
|
|
}
|
2023-02-21 19:55:44 +08:00
|
|
|
pub fn iterate(&self, mut visit: impl FnMut(&Vec<u32>, &V)) {
|
2023-02-21 16:46:49 +08:00
|
|
|
self.iterate_rec(&mut vec![], &mut visit)
|
|
|
|
}
|
|
|
|
|
|
|
|
pub fn remove_prefixes<U>(&mut self, prefixes: &PathsMap<U>) {
|
|
|
|
prefixes.iterate(|prefix, _v| {
|
|
|
|
self.remove_prefix(prefix);
|
|
|
|
});
|
|
|
|
}
|
2023-02-21 19:55:44 +08:00
|
|
|
pub fn remove_edges(&mut self, forbidden_edges: &RoaringBitmap) {
|
2023-02-21 16:46:49 +08:00
|
|
|
let mut i = 0;
|
|
|
|
while i < self.nodes.len() {
|
2023-02-21 19:55:44 +08:00
|
|
|
let should_remove = if forbidden_edges.contains(self.nodes[i].0) {
|
2023-02-21 16:46:49 +08:00
|
|
|
true
|
|
|
|
} else if !self.nodes[i].1.nodes.is_empty() {
|
|
|
|
self.nodes[i].1.remove_edges(forbidden_edges);
|
|
|
|
self.nodes[i].1.nodes.is_empty()
|
|
|
|
} else {
|
|
|
|
false
|
|
|
|
};
|
|
|
|
if should_remove {
|
|
|
|
self.nodes.remove(i);
|
|
|
|
} else {
|
|
|
|
i += 1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2023-02-21 19:55:44 +08:00
|
|
|
pub fn remove_edge(&mut self, forbidden_edge: &u32) {
|
2023-02-21 16:46:49 +08:00
|
|
|
let mut i = 0;
|
|
|
|
while i < self.nodes.len() {
|
|
|
|
let should_remove = if &self.nodes[i].0 == forbidden_edge {
|
|
|
|
true
|
|
|
|
} else if !self.nodes[i].1.nodes.is_empty() {
|
|
|
|
self.nodes[i].1.remove_edge(forbidden_edge);
|
|
|
|
self.nodes[i].1.nodes.is_empty()
|
|
|
|
} else {
|
|
|
|
false
|
|
|
|
};
|
|
|
|
if should_remove {
|
|
|
|
self.nodes.remove(i);
|
|
|
|
} else {
|
|
|
|
i += 1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2023-02-21 19:55:44 +08:00
|
|
|
pub fn remove_prefix(&mut self, forbidden_prefix: &[u32]) {
|
2023-02-21 16:46:49 +08:00
|
|
|
let [first_edge, remaining_prefix @ ..] = forbidden_prefix else {
|
|
|
|
self.nodes.clear();
|
|
|
|
self.value = None;
|
|
|
|
return;
|
|
|
|
};
|
|
|
|
|
|
|
|
let mut i = 0;
|
|
|
|
while i < self.nodes.len() {
|
|
|
|
let edge = self.nodes[i].0;
|
|
|
|
let should_remove = if edge == *first_edge {
|
|
|
|
self.nodes[i].1.remove_prefix(remaining_prefix);
|
|
|
|
self.nodes[i].1.nodes.is_empty()
|
|
|
|
} else {
|
|
|
|
false
|
|
|
|
};
|
|
|
|
if should_remove {
|
|
|
|
self.nodes.remove(i);
|
|
|
|
} else {
|
|
|
|
i += 1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2023-03-03 04:27:42 +08:00
|
|
|
pub fn final_edges_ater_prefix(&self, prefix: &[u32]) -> Vec<u32> {
|
|
|
|
let [first_edge, remaining_prefix @ ..] = prefix else {
|
|
|
|
return self.nodes.iter().filter_map(|n| {
|
|
|
|
if n.1.value.is_some() {
|
|
|
|
Some(n.0)
|
|
|
|
} else {
|
|
|
|
None
|
|
|
|
}
|
|
|
|
}).collect();
|
|
|
|
};
|
|
|
|
for (edge, rest) in self.nodes.iter() {
|
|
|
|
if edge == first_edge {
|
|
|
|
return rest.final_edges_ater_prefix(remaining_prefix);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
vec![]
|
|
|
|
}
|
|
|
|
|
2023-02-21 19:55:44 +08:00
|
|
|
pub fn edge_indices_after_prefix(&self, prefix: &[u32]) -> Vec<u32> {
|
2023-02-21 16:46:49 +08:00
|
|
|
let [first_edge, remaining_prefix @ ..] = prefix else {
|
|
|
|
return self.nodes.iter().map(|n| n.0).collect();
|
|
|
|
};
|
2023-02-21 20:57:34 +08:00
|
|
|
for (edge, rest) in self.nodes.iter() {
|
2023-02-21 16:46:49 +08:00
|
|
|
if edge == first_edge {
|
|
|
|
return rest.edge_indices_after_prefix(remaining_prefix);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
vec![]
|
|
|
|
}
|
|
|
|
|
2023-02-21 19:55:44 +08:00
|
|
|
pub fn contains_prefix_of_path(&self, path: &[u32]) -> bool {
|
2023-02-21 16:46:49 +08:00
|
|
|
if self.value.is_some() {
|
2023-02-21 20:57:34 +08:00
|
|
|
return true;
|
2023-02-21 16:46:49 +08:00
|
|
|
}
|
|
|
|
match path {
|
2023-02-21 20:57:34 +08:00
|
|
|
[] => false,
|
2023-02-21 16:46:49 +08:00
|
|
|
[first_edge, remaining_path @ ..] => {
|
2023-02-21 20:57:34 +08:00
|
|
|
for (edge, rest) in self.nodes.iter() {
|
2023-02-21 16:46:49 +08:00
|
|
|
if edge == first_edge {
|
|
|
|
return rest.contains_prefix_of_path(remaining_path);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
false
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|