| 1 | /* SPDX-License-Identifier: GPL-2.0-or-later */ | 
|---|
| 2 | /* | 
|---|
| 3 | Red Black Trees | 
|---|
| 4 | (C) 1999  Andrea Arcangeli <andrea@suse.de> | 
|---|
| 5 | (C) 2002  David Woodhouse <dwmw2@infradead.org> | 
|---|
| 6 | (C) 2012  Michel Lespinasse <walken@google.com> | 
|---|
| 7 |  | 
|---|
| 8 |  | 
|---|
| 9 | linux/include/linux/rbtree_augmented.h | 
|---|
| 10 | */ | 
|---|
| 11 |  | 
|---|
| 12 | #ifndef _LINUX_RBTREE_AUGMENTED_H | 
|---|
| 13 | #define _LINUX_RBTREE_AUGMENTED_H | 
|---|
| 14 |  | 
|---|
| 15 | #include <linux/compiler.h> | 
|---|
| 16 | #include <linux/rbtree.h> | 
|---|
| 17 | #include <linux/rcupdate.h> | 
|---|
| 18 |  | 
|---|
| 19 | /* | 
|---|
| 20 | * Please note - only struct rb_augment_callbacks and the prototypes for | 
|---|
| 21 | * rb_insert_augmented() and rb_erase_augmented() are intended to be public. | 
|---|
| 22 | * The rest are implementation details you are not expected to depend on. | 
|---|
| 23 | * | 
|---|
| 24 | * See Documentation/core-api/rbtree.rst for documentation and samples. | 
|---|
| 25 | */ | 
|---|
| 26 |  | 
|---|
| 27 | struct rb_augment_callbacks { | 
|---|
| 28 | void (*propagate)(struct rb_node *node, struct rb_node *stop); | 
|---|
| 29 | void (*copy)(struct rb_node *old, struct rb_node *new); | 
|---|
| 30 | void (*rotate)(struct rb_node *old, struct rb_node *new); | 
|---|
| 31 | }; | 
|---|
| 32 |  | 
|---|
| 33 | extern void __rb_insert_augmented(struct rb_node *node, struct rb_root *root, | 
|---|
| 34 | void (*augment_rotate)(struct rb_node *old, struct rb_node *new)); | 
|---|
| 35 |  | 
|---|
| 36 | /* | 
|---|
| 37 | * Fixup the rbtree and update the augmented information when rebalancing. | 
|---|
| 38 | * | 
|---|
| 39 | * On insertion, the user must update the augmented information on the path | 
|---|
| 40 | * leading to the inserted node, then call rb_link_node() as usual and | 
|---|
| 41 | * rb_insert_augmented() instead of the usual rb_insert_color() call. | 
|---|
| 42 | * If rb_insert_augmented() rebalances the rbtree, it will callback into | 
|---|
| 43 | * a user provided function to update the augmented information on the | 
|---|
| 44 | * affected subtrees. | 
|---|
| 45 | */ | 
|---|
| 46 | static inline void | 
|---|
| 47 | rb_insert_augmented(struct rb_node *node, struct rb_root *root, | 
|---|
| 48 | const struct rb_augment_callbacks *augment) | 
|---|
| 49 | { | 
|---|
| 50 | __rb_insert_augmented(node, root, augment_rotate: augment->rotate); | 
|---|
| 51 | } | 
|---|
| 52 |  | 
|---|
| 53 | static inline void | 
|---|
| 54 | rb_insert_augmented_cached(struct rb_node *node, | 
|---|
| 55 | struct rb_root_cached *root, bool newleft, | 
|---|
| 56 | const struct rb_augment_callbacks *augment) | 
|---|
| 57 | { | 
|---|
| 58 | if (newleft) | 
|---|
| 59 | root->rb_leftmost = node; | 
|---|
| 60 | rb_insert_augmented(node, root: &root->rb_root, augment); | 
|---|
| 61 | } | 
|---|
| 62 |  | 
|---|
| 63 | static __always_inline struct rb_node * | 
|---|
| 64 | rb_add_augmented_cached(struct rb_node *node, struct rb_root_cached *tree, | 
|---|
| 65 | bool (*less)(struct rb_node *, const struct rb_node *), | 
|---|
| 66 | const struct rb_augment_callbacks *augment) | 
|---|
| 67 | { | 
|---|
| 68 | struct rb_node **link = &tree->rb_root.rb_node; | 
|---|
| 69 | struct rb_node *parent = NULL; | 
|---|
| 70 | bool leftmost = true; | 
|---|
| 71 |  | 
|---|
| 72 | while (*link) { | 
|---|
| 73 | parent = *link; | 
|---|
| 74 | if (less(node, parent)) { | 
|---|
| 75 | link = &parent->rb_left; | 
|---|
| 76 | } else { | 
|---|
| 77 | link = &parent->rb_right; | 
|---|
| 78 | leftmost = false; | 
|---|
| 79 | } | 
|---|
| 80 | } | 
|---|
| 81 |  | 
|---|
| 82 | rb_link_node(node, parent, rb_link: link); | 
|---|
| 83 | augment->propagate(parent, NULL); /* suboptimal */ | 
|---|
| 84 | rb_insert_augmented_cached(node, root: tree, newleft: leftmost, augment); | 
|---|
| 85 |  | 
|---|
| 86 | return leftmost ? node : NULL; | 
|---|
| 87 | } | 
|---|
| 88 |  | 
|---|
| 89 | /* | 
|---|
| 90 | * Template for declaring augmented rbtree callbacks (generic case) | 
|---|
| 91 | * | 
|---|
| 92 | * RBSTATIC:    'static' or empty | 
|---|
| 93 | * RBNAME:      name of the rb_augment_callbacks structure | 
|---|
| 94 | * RBSTRUCT:    struct type of the tree nodes | 
|---|
| 95 | * RBFIELD:     name of struct rb_node field within RBSTRUCT | 
|---|
| 96 | * RBAUGMENTED: name of field within RBSTRUCT holding data for subtree | 
|---|
| 97 | * RBCOMPUTE:   name of function that recomputes the RBAUGMENTED data | 
|---|
| 98 | */ | 
|---|
| 99 |  | 
|---|
| 100 | #define RB_DECLARE_CALLBACKS(RBSTATIC, RBNAME,				\ | 
|---|
| 101 | RBSTRUCT, RBFIELD, RBAUGMENTED, RBCOMPUTE)	\ | 
|---|
| 102 | static inline void							\ | 
|---|
| 103 | RBNAME ## _propagate(struct rb_node *rb, struct rb_node *stop)		\ | 
|---|
| 104 | {									\ | 
|---|
| 105 | while (rb != stop) {						\ | 
|---|
| 106 | RBSTRUCT *node = rb_entry(rb, RBSTRUCT, RBFIELD);	\ | 
|---|
| 107 | if (RBCOMPUTE(node, true))				\ | 
|---|
| 108 | break;						\ | 
|---|
| 109 | rb = rb_parent(&node->RBFIELD);				\ | 
|---|
| 110 | }								\ | 
|---|
| 111 | }									\ | 
|---|
| 112 | static inline void							\ | 
|---|
| 113 | RBNAME ## _copy(struct rb_node *rb_old, struct rb_node *rb_new)		\ | 
|---|
| 114 | {									\ | 
|---|
| 115 | RBSTRUCT *old = rb_entry(rb_old, RBSTRUCT, RBFIELD);		\ | 
|---|
| 116 | RBSTRUCT *new = rb_entry(rb_new, RBSTRUCT, RBFIELD);		\ | 
|---|
| 117 | new->RBAUGMENTED = old->RBAUGMENTED;				\ | 
|---|
| 118 | }									\ | 
|---|
| 119 | static void								\ | 
|---|
| 120 | RBNAME ## _rotate(struct rb_node *rb_old, struct rb_node *rb_new)	\ | 
|---|
| 121 | {									\ | 
|---|
| 122 | RBSTRUCT *old = rb_entry(rb_old, RBSTRUCT, RBFIELD);		\ | 
|---|
| 123 | RBSTRUCT *new = rb_entry(rb_new, RBSTRUCT, RBFIELD);		\ | 
|---|
| 124 | new->RBAUGMENTED = old->RBAUGMENTED;				\ | 
|---|
| 125 | RBCOMPUTE(old, false);						\ | 
|---|
| 126 | }									\ | 
|---|
| 127 | RBSTATIC const struct rb_augment_callbacks RBNAME = {			\ | 
|---|
| 128 | .propagate = RBNAME ## _propagate,				\ | 
|---|
| 129 | .copy = RBNAME ## _copy,					\ | 
|---|
| 130 | .rotate = RBNAME ## _rotate					\ | 
|---|
| 131 | }; | 
|---|
| 132 |  | 
|---|
| 133 | /* | 
|---|
| 134 | * Template for declaring augmented rbtree callbacks, | 
|---|
| 135 | * computing RBAUGMENTED scalar as max(RBCOMPUTE(node)) for all subtree nodes. | 
|---|
| 136 | * | 
|---|
| 137 | * RBSTATIC:    'static' or empty | 
|---|
| 138 | * RBNAME:      name of the rb_augment_callbacks structure | 
|---|
| 139 | * RBSTRUCT:    struct type of the tree nodes | 
|---|
| 140 | * RBFIELD:     name of struct rb_node field within RBSTRUCT | 
|---|
| 141 | * RBTYPE:      type of the RBAUGMENTED field | 
|---|
| 142 | * RBAUGMENTED: name of RBTYPE field within RBSTRUCT holding data for subtree | 
|---|
| 143 | * RBCOMPUTE:   name of function that returns the per-node RBTYPE scalar | 
|---|
| 144 | */ | 
|---|
| 145 |  | 
|---|
| 146 | #define RB_DECLARE_CALLBACKS_MAX(RBSTATIC, RBNAME, RBSTRUCT, RBFIELD,	      \ | 
|---|
| 147 | RBTYPE, RBAUGMENTED, RBCOMPUTE)	      \ | 
|---|
| 148 | static inline bool RBNAME ## _compute_max(RBSTRUCT *node, bool exit)	      \ | 
|---|
| 149 | {									      \ | 
|---|
| 150 | RBSTRUCT *child;						      \ | 
|---|
| 151 | RBTYPE max = RBCOMPUTE(node);					      \ | 
|---|
| 152 | if (node->RBFIELD.rb_left) {					      \ | 
|---|
| 153 | child = rb_entry(node->RBFIELD.rb_left, RBSTRUCT, RBFIELD);   \ | 
|---|
| 154 | if (child->RBAUGMENTED > max)				      \ | 
|---|
| 155 | max = child->RBAUGMENTED;			      \ | 
|---|
| 156 | }								      \ | 
|---|
| 157 | if (node->RBFIELD.rb_right) {					      \ | 
|---|
| 158 | child = rb_entry(node->RBFIELD.rb_right, RBSTRUCT, RBFIELD);  \ | 
|---|
| 159 | if (child->RBAUGMENTED > max)				      \ | 
|---|
| 160 | max = child->RBAUGMENTED;			      \ | 
|---|
| 161 | }								      \ | 
|---|
| 162 | if (exit && node->RBAUGMENTED == max)				      \ | 
|---|
| 163 | return true;						      \ | 
|---|
| 164 | node->RBAUGMENTED = max;					      \ | 
|---|
| 165 | return false;							      \ | 
|---|
| 166 | }									      \ | 
|---|
| 167 | RB_DECLARE_CALLBACKS(RBSTATIC, RBNAME,					      \ | 
|---|
| 168 | RBSTRUCT, RBFIELD, RBAUGMENTED, RBNAME ## _compute_max) | 
|---|
| 169 |  | 
|---|
| 170 |  | 
|---|
| 171 | #define	RB_RED		0 | 
|---|
| 172 | #define	RB_BLACK	1 | 
|---|
| 173 |  | 
|---|
| 174 | #define __rb_parent(pc)    ((struct rb_node *)(pc & ~3)) | 
|---|
| 175 |  | 
|---|
| 176 | #define __rb_color(pc)     ((pc) & 1) | 
|---|
| 177 | #define __rb_is_black(pc)  __rb_color(pc) | 
|---|
| 178 | #define __rb_is_red(pc)    (!__rb_color(pc)) | 
|---|
| 179 | #define rb_color(rb)       __rb_color((rb)->__rb_parent_color) | 
|---|
| 180 | #define rb_is_red(rb)      __rb_is_red((rb)->__rb_parent_color) | 
|---|
| 181 | #define rb_is_black(rb)    __rb_is_black((rb)->__rb_parent_color) | 
|---|
| 182 |  | 
|---|
| 183 | static inline void rb_set_parent(struct rb_node *rb, struct rb_node *p) | 
|---|
| 184 | { | 
|---|
| 185 | rb->__rb_parent_color = rb_color(rb) + (unsigned long)p; | 
|---|
| 186 | } | 
|---|
| 187 |  | 
|---|
| 188 | static inline void rb_set_parent_color(struct rb_node *rb, | 
|---|
| 189 | struct rb_node *p, int color) | 
|---|
| 190 | { | 
|---|
| 191 | rb->__rb_parent_color = (unsigned long)p + color; | 
|---|
| 192 | } | 
|---|
| 193 |  | 
|---|
| 194 | static inline void | 
|---|
| 195 | __rb_change_child(struct rb_node *old, struct rb_node *new, | 
|---|
| 196 | struct rb_node *parent, struct rb_root *root) | 
|---|
| 197 | { | 
|---|
| 198 | if (parent) { | 
|---|
| 199 | if (parent->rb_left == old) | 
|---|
| 200 | WRITE_ONCE(parent->rb_left, new); | 
|---|
| 201 | else | 
|---|
| 202 | WRITE_ONCE(parent->rb_right, new); | 
|---|
| 203 | } else | 
|---|
| 204 | WRITE_ONCE(root->rb_node, new); | 
|---|
| 205 | } | 
|---|
| 206 |  | 
|---|
| 207 | static inline void | 
|---|
| 208 | __rb_change_child_rcu(struct rb_node *old, struct rb_node *new, | 
|---|
| 209 | struct rb_node *parent, struct rb_root *root) | 
|---|
| 210 | { | 
|---|
| 211 | if (parent) { | 
|---|
| 212 | if (parent->rb_left == old) | 
|---|
| 213 | rcu_assign_pointer(parent->rb_left, new); | 
|---|
| 214 | else | 
|---|
| 215 | rcu_assign_pointer(parent->rb_right, new); | 
|---|
| 216 | } else | 
|---|
| 217 | rcu_assign_pointer(root->rb_node, new); | 
|---|
| 218 | } | 
|---|
| 219 |  | 
|---|
| 220 | extern void __rb_erase_color(struct rb_node *parent, struct rb_root *root, | 
|---|
| 221 | void (*augment_rotate)(struct rb_node *old, struct rb_node *new)); | 
|---|
| 222 |  | 
|---|
| 223 | static __always_inline struct rb_node * | 
|---|
| 224 | __rb_erase_augmented(struct rb_node *node, struct rb_root *root, | 
|---|
| 225 | const struct rb_augment_callbacks *augment) | 
|---|
| 226 | { | 
|---|
| 227 | struct rb_node *child = node->rb_right; | 
|---|
| 228 | struct rb_node *tmp = node->rb_left; | 
|---|
| 229 | struct rb_node *parent, *rebalance; | 
|---|
| 230 | unsigned long pc; | 
|---|
| 231 |  | 
|---|
| 232 | if (!tmp) { | 
|---|
| 233 | /* | 
|---|
| 234 | * Case 1: node to erase has no more than 1 child (easy!) | 
|---|
| 235 | * | 
|---|
| 236 | * Note that if there is one child it must be red due to 5) | 
|---|
| 237 | * and node must be black due to 4). We adjust colors locally | 
|---|
| 238 | * so as to bypass __rb_erase_color() later on. | 
|---|
| 239 | */ | 
|---|
| 240 | pc = node->__rb_parent_color; | 
|---|
| 241 | parent = __rb_parent(pc); | 
|---|
| 242 | __rb_change_child(old: node, new: child, parent, root); | 
|---|
| 243 | if (child) { | 
|---|
| 244 | child->__rb_parent_color = pc; | 
|---|
| 245 | rebalance = NULL; | 
|---|
| 246 | } else | 
|---|
| 247 | rebalance = __rb_is_black(pc) ? parent : NULL; | 
|---|
| 248 | tmp = parent; | 
|---|
| 249 | } else if (!child) { | 
|---|
| 250 | /* Still case 1, but this time the child is node->rb_left */ | 
|---|
| 251 | tmp->__rb_parent_color = pc = node->__rb_parent_color; | 
|---|
| 252 | parent = __rb_parent(pc); | 
|---|
| 253 | __rb_change_child(old: node, new: tmp, parent, root); | 
|---|
| 254 | rebalance = NULL; | 
|---|
| 255 | tmp = parent; | 
|---|
| 256 | } else { | 
|---|
| 257 | struct rb_node *successor = child, *child2; | 
|---|
| 258 |  | 
|---|
| 259 | tmp = child->rb_left; | 
|---|
| 260 | if (!tmp) { | 
|---|
| 261 | /* | 
|---|
| 262 | * Case 2: node's successor is its right child | 
|---|
| 263 | * | 
|---|
| 264 | *    (n)          (s) | 
|---|
| 265 | *    / \          / \ | 
|---|
| 266 | *  (x) (s)  ->  (x) (c) | 
|---|
| 267 | *        \ | 
|---|
| 268 | *        (c) | 
|---|
| 269 | */ | 
|---|
| 270 | parent = successor; | 
|---|
| 271 | child2 = successor->rb_right; | 
|---|
| 272 |  | 
|---|
| 273 | augment->copy(node, successor); | 
|---|
| 274 | } else { | 
|---|
| 275 | /* | 
|---|
| 276 | * Case 3: node's successor is leftmost under | 
|---|
| 277 | * node's right child subtree | 
|---|
| 278 | * | 
|---|
| 279 | *    (n)          (s) | 
|---|
| 280 | *    / \          / \ | 
|---|
| 281 | *  (x) (y)  ->  (x) (y) | 
|---|
| 282 | *      /            / | 
|---|
| 283 | *    (p)          (p) | 
|---|
| 284 | *    /            / | 
|---|
| 285 | *  (s)          (c) | 
|---|
| 286 | *    \ | 
|---|
| 287 | *    (c) | 
|---|
| 288 | */ | 
|---|
| 289 | do { | 
|---|
| 290 | parent = successor; | 
|---|
| 291 | successor = tmp; | 
|---|
| 292 | tmp = tmp->rb_left; | 
|---|
| 293 | } while (tmp); | 
|---|
| 294 | child2 = successor->rb_right; | 
|---|
| 295 | WRITE_ONCE(parent->rb_left, child2); | 
|---|
| 296 | WRITE_ONCE(successor->rb_right, child); | 
|---|
| 297 | rb_set_parent(rb: child, p: successor); | 
|---|
| 298 |  | 
|---|
| 299 | augment->copy(node, successor); | 
|---|
| 300 | augment->propagate(parent, successor); | 
|---|
| 301 | } | 
|---|
| 302 |  | 
|---|
| 303 | tmp = node->rb_left; | 
|---|
| 304 | WRITE_ONCE(successor->rb_left, tmp); | 
|---|
| 305 | rb_set_parent(rb: tmp, p: successor); | 
|---|
| 306 |  | 
|---|
| 307 | pc = node->__rb_parent_color; | 
|---|
| 308 | tmp = __rb_parent(pc); | 
|---|
| 309 | __rb_change_child(old: node, new: successor, parent: tmp, root); | 
|---|
| 310 |  | 
|---|
| 311 | if (child2) { | 
|---|
| 312 | rb_set_parent_color(rb: child2, p: parent, RB_BLACK); | 
|---|
| 313 | rebalance = NULL; | 
|---|
| 314 | } else { | 
|---|
| 315 | rebalance = rb_is_black(successor) ? parent : NULL; | 
|---|
| 316 | } | 
|---|
| 317 | successor->__rb_parent_color = pc; | 
|---|
| 318 | tmp = successor; | 
|---|
| 319 | } | 
|---|
| 320 |  | 
|---|
| 321 | augment->propagate(tmp, NULL); | 
|---|
| 322 | return rebalance; | 
|---|
| 323 | } | 
|---|
| 324 |  | 
|---|
| 325 | static __always_inline void | 
|---|
| 326 | rb_erase_augmented(struct rb_node *node, struct rb_root *root, | 
|---|
| 327 | const struct rb_augment_callbacks *augment) | 
|---|
| 328 | { | 
|---|
| 329 | struct rb_node *rebalance = __rb_erase_augmented(node, root, augment); | 
|---|
| 330 | if (rebalance) | 
|---|
| 331 | __rb_erase_color(parent: rebalance, root, augment_rotate: augment->rotate); | 
|---|
| 332 | } | 
|---|
| 333 |  | 
|---|
| 334 | static __always_inline void | 
|---|
| 335 | rb_erase_augmented_cached(struct rb_node *node, struct rb_root_cached *root, | 
|---|
| 336 | const struct rb_augment_callbacks *augment) | 
|---|
| 337 | { | 
|---|
| 338 | if (root->rb_leftmost == node) | 
|---|
| 339 | root->rb_leftmost = rb_next(node); | 
|---|
| 340 | rb_erase_augmented(node, root: &root->rb_root, augment); | 
|---|
| 341 | } | 
|---|
| 342 |  | 
|---|
| 343 | #endif	/* _LINUX_RBTREE_AUGMENTED_H */ | 
|---|
| 344 |  | 
|---|