1use std::cmp::Ordering;
8
9pub trait Summary: Clone + Default {
12 fn then(&self, next: &Self) -> Self;
13}
14
15pub trait Item {
17 type Sum: Summary;
18 fn summary(&self) -> Self::Sum;
19}
20
21type Link = Option<u32>;
22
23struct Node<K, V: Item> {
24 key: K,
25 value: V,
26 priority: u64,
27 left: Link,
28 right: Link,
29 sum: V::Sum,
31 count: usize,
32}
33
34pub struct Sums<K, V: Item> {
36 nodes: Vec<Option<Node<K, V>>>,
37 free: Vec<u32>,
38 root: Link,
39 seed: u64,
40}
41
42impl<K: Ord + Clone, V: Item> Default for Sums<K, V> {
43 fn default() -> Self {
44 Sums::new()
45 }
46}
47
48impl<K: Ord + Clone, V: Item> Sums<K, V> {
49 pub fn new() -> Self {
50 Sums {
51 nodes: Vec::new(),
52 free: Vec::new(),
53 root: None,
54 seed: 0x9e37_79b9_7f4a_7c15,
55 }
56 }
57
58 pub fn len(&self) -> usize {
59 self.root.map_or(0, |r| self.node(r).count)
60 }
61
62 pub fn is_empty(&self) -> bool {
63 self.root.is_none()
64 }
65
66 pub fn total(&self) -> V::Sum {
68 self.sum(self.root)
69 }
70
71 pub fn get(&self, key: &K) -> Option<&V> {
72 let mut at = self.root;
73 while let Some(i) = at {
74 let n = self.node(i);
75 at = match key.cmp(&n.key) {
76 Ordering::Less => n.left,
77 Ordering::Greater => n.right,
78 Ordering::Equal => return Some(&n.value),
79 };
80 }
81 None
82 }
83
84 pub fn insert(&mut self, key: K, value: V) -> Option<V> {
86 let old = self.remove(&key);
87 let (l, r) = self.split(self.root, &key, false);
88 let priority = self.next_priority();
89 let sum = value.summary();
90 let n = self.alloc(Node {
91 key,
92 value,
93 priority,
94 left: None,
95 right: None,
96 sum,
97 count: 1,
98 });
99 let m = self.merge(l, Some(n));
100 self.root = self.merge(m, r);
101 old
102 }
103
104 pub fn remove(&mut self, key: &K) -> Option<V> {
106 let (l, r) = self.split(self.root, key, false);
107 let (m, r) = self.split(r, key, true);
108 self.root = self.merge(l, r);
109 let m = m?;
110 let node = self.nodes[m as usize].take().expect("a live node");
111 self.free.push(m);
112 Some(node.value)
113 }
114
115 pub fn before(&self, key: &K) -> V::Sum {
117 let mut acc = V::Sum::default();
118 let mut at = self.root;
119 while let Some(i) = at {
120 let n = self.node(i);
121 if *key <= n.key {
122 at = n.left;
123 } else {
124 acc = acc.then(&self.sum(n.left)).then(&n.value.summary());
125 at = n.right;
126 }
127 }
128 acc
129 }
130
131 pub fn seek(&self, reaches: impl Fn(&V::Sum) -> bool) -> Option<(&K, &V, V::Sum)> {
135 let mut acc = V::Sum::default();
136 let mut at = self.root;
137 let mut found = None;
138 while let Some(i) = at {
139 let n = self.node(i);
140 let left = acc.then(&self.sum(n.left));
141 let with = left.then(&n.value.summary());
142 if reaches(&with) {
143 found = Some((&n.key, &n.value, left.clone()));
144 at = n.left;
145 } else {
146 acc = with;
147 at = n.right;
148 }
149 }
150 found
151 }
152
153 pub fn from<'a>(&'a self, key: &K) -> impl Iterator<Item = (&'a K, &'a V)> + 'a {
155 let mut stack = Vec::new();
156 let mut at = self.root;
157 while let Some(i) = at {
158 let n = self.node(i);
159 if n.key >= *key {
160 stack.push(i);
161 at = n.left;
162 } else {
163 at = n.right;
164 }
165 }
166 Walk { sums: self, stack }
167 }
168
169 pub fn iter(&self) -> impl Iterator<Item = (&K, &V)> {
171 let mut stack = Vec::new();
172 let mut at = self.root;
173 while let Some(i) = at {
174 stack.push(i);
175 at = self.node(i).left;
176 }
177 Walk { sums: self, stack }
178 }
179
180 fn node(&self, i: u32) -> &Node<K, V> {
181 self.nodes[i as usize].as_ref().expect("a live node")
182 }
183
184 fn node_mut(&mut self, i: u32) -> &mut Node<K, V> {
185 self.nodes[i as usize].as_mut().expect("a live node")
186 }
187
188 fn sum(&self, at: Link) -> V::Sum {
189 at.map_or_else(V::Sum::default, |i| self.node(i).sum.clone())
190 }
191
192 fn count(&self, at: Link) -> usize {
193 at.map_or(0, |i| self.node(i).count)
194 }
195
196 fn next_priority(&mut self) -> u64 {
197 self.seed ^= self.seed >> 12;
199 self.seed ^= self.seed << 25;
200 self.seed ^= self.seed >> 27;
201 self.seed.wrapping_mul(0x2545_f491_4f6c_dd1d)
202 }
203
204 fn alloc(&mut self, node: Node<K, V>) -> u32 {
205 match self.free.pop() {
206 Some(i) => {
207 self.nodes[i as usize] = Some(node);
208 i
209 }
210 None => {
211 self.nodes.push(Some(node));
212 (self.nodes.len() - 1) as u32
213 }
214 }
215 }
216
217 fn fix(&mut self, i: u32) {
218 let (l, r) = {
219 let n = self.node(i);
220 (n.left, n.right)
221 };
222 let sum = self
223 .sum(l)
224 .then(&self.node(i).value.summary())
225 .then(&self.sum(r));
226 let count = self.count(l) + 1 + self.count(r);
227 let n = self.node_mut(i);
228 n.sum = sum;
229 n.count = count;
230 }
231
232 fn split(&mut self, at: Link, key: &K, through: bool) -> (Link, Link) {
235 let Some(i) = at else {
236 return (None, None);
237 };
238 let goes_left = if through {
239 self.node(i).key <= *key
240 } else {
241 self.node(i).key < *key
242 };
243 if goes_left {
244 let right = self.node(i).right;
245 let (l, r) = self.split(right, key, through);
246 self.node_mut(i).right = l;
247 self.fix(i);
248 (Some(i), r)
249 } else {
250 let left = self.node(i).left;
251 let (l, r) = self.split(left, key, through);
252 self.node_mut(i).left = r;
253 self.fix(i);
254 (l, Some(i))
255 }
256 }
257
258 fn merge(&mut self, a: Link, b: Link) -> Link {
260 match (a, b) {
261 (None, b) => b,
262 (a, None) => a,
263 (Some(x), Some(y)) => {
264 if self.node(x).priority > self.node(y).priority {
265 let right = self.node(x).right;
266 let m = self.merge(right, Some(y));
267 self.node_mut(x).right = m;
268 self.fix(x);
269 Some(x)
270 } else {
271 let left = self.node(y).left;
272 let m = self.merge(Some(x), left);
273 self.node_mut(y).left = m;
274 self.fix(y);
275 Some(y)
276 }
277 }
278 }
279 }
280}
281
282struct Walk<'a, K, V: Item> {
283 sums: &'a Sums<K, V>,
284 stack: Vec<u32>,
285}
286
287impl<'a, K: Ord + Clone, V: Item> Iterator for Walk<'a, K, V> {
288 type Item = (&'a K, &'a V);
289 fn next(&mut self) -> Option<Self::Item> {
290 let i = self.stack.pop()?;
291 let n = self.sums.node(i);
292 let mut at = n.right;
293 while let Some(j) = at {
294 self.stack.push(j);
295 at = self.sums.node(j).left;
296 }
297 Some((&n.key, &n.value))
298 }
299}
300
301#[cfg(test)]
302mod tests;