18a36da99SPedro F. Giffuni /*- 24d846d26SWarner Losh * SPDX-License-Identifier: BSD-2-Clause 38a36da99SPedro F. Giffuni * 4f2cc1285SJeff Roberson * Copyright (c) 2013 EMC Corp. 5f2cc1285SJeff Roberson * Copyright (c) 2011 Jeffrey Roberson <jeff@freebsd.org> 6f2cc1285SJeff Roberson * Copyright (c) 2008 Mayur Shardul <mayur.shardul@gmail.com> 7f2cc1285SJeff Roberson * All rights reserved. 8f2cc1285SJeff Roberson * 9f2cc1285SJeff Roberson * Redistribution and use in source and binary forms, with or without 10f2cc1285SJeff Roberson * modification, are permitted provided that the following conditions 11f2cc1285SJeff Roberson * are met: 12f2cc1285SJeff Roberson * 1. Redistributions of source code must retain the above copyright 13f2cc1285SJeff Roberson * notice, this list of conditions and the following disclaimer. 14f2cc1285SJeff Roberson * 2. Redistributions in binary form must reproduce the above copyright 15f2cc1285SJeff Roberson * notice, this list of conditions and the following disclaimer in the 16f2cc1285SJeff Roberson * documentation and/or other materials provided with the distribution. 17f2cc1285SJeff Roberson * 18f2cc1285SJeff Roberson * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 19f2cc1285SJeff Roberson * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20f2cc1285SJeff Roberson * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21f2cc1285SJeff Roberson * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 22f2cc1285SJeff Roberson * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23f2cc1285SJeff Roberson * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24f2cc1285SJeff Roberson * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25f2cc1285SJeff Roberson * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26f2cc1285SJeff Roberson * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27f2cc1285SJeff Roberson * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28f2cc1285SJeff Roberson * SUCH DAMAGE. 29f2cc1285SJeff Roberson * 30f2cc1285SJeff Roberson */ 31f2cc1285SJeff Roberson 32f2cc1285SJeff Roberson /* 33f2cc1285SJeff Roberson * Path-compressed radix trie implementation. 34f2cc1285SJeff Roberson * 35f2cc1285SJeff Roberson * The implementation takes into account the following rationale: 36f2cc1285SJeff Roberson * - Size of the nodes should be as small as possible but still big enough 37f2cc1285SJeff Roberson * to avoid a large maximum depth for the trie. This is a balance 38f2cc1285SJeff Roberson * between the necessity to not wire too much physical memory for the nodes 39f2cc1285SJeff Roberson * and the necessity to avoid too much cache pollution during the trie 40f2cc1285SJeff Roberson * operations. 41f2cc1285SJeff Roberson * - There is not a huge bias toward the number of lookup operations over 42f2cc1285SJeff Roberson * the number of insert and remove operations. This basically implies 43f2cc1285SJeff Roberson * that optimizations supposedly helping one operation but hurting the 44f2cc1285SJeff Roberson * other might be carefully evaluated. 45f2cc1285SJeff Roberson * - On average not many nodes are expected to be fully populated, hence 46f2cc1285SJeff Roberson * level compression may just complicate things. 47f2cc1285SJeff Roberson */ 48f2cc1285SJeff Roberson 49f2cc1285SJeff Roberson #include <sys/cdefs.h> 50f2cc1285SJeff Roberson #include "opt_ddb.h" 51f2cc1285SJeff Roberson 52f2cc1285SJeff Roberson #include <sys/param.h> 53f2cc1285SJeff Roberson #include <sys/systm.h> 54f2cc1285SJeff Roberson #include <sys/kernel.h> 5505963ea4SDoug Moore #include <sys/libkern.h> 56f2cc1285SJeff Roberson #include <sys/pctrie.h> 573c30b235SConrad Meyer #include <sys/proc.h> /* smr.h depends on struct thread. */ 583c30b235SConrad Meyer #include <sys/smr.h> 593c30b235SConrad Meyer #include <sys/smr_types.h> 60f2cc1285SJeff Roberson 61f2cc1285SJeff Roberson #ifdef DDB 62f2cc1285SJeff Roberson #include <ddb/ddb.h> 63f2cc1285SJeff Roberson #endif 64f2cc1285SJeff Roberson 658df38859SDoug Moore #if PCTRIE_WIDTH == 3 668df38859SDoug Moore typedef uint8_t pn_popmap_t; 678df38859SDoug Moore #elif PCTRIE_WIDTH == 4 688df38859SDoug Moore typedef uint16_t pn_popmap_t; 698df38859SDoug Moore #elif PCTRIE_WIDTH == 5 708df38859SDoug Moore typedef uint32_t pn_popmap_t; 718df38859SDoug Moore #else 728df38859SDoug Moore #error Unsupported width 738df38859SDoug Moore #endif 748df38859SDoug Moore _Static_assert(sizeof(pn_popmap_t) <= sizeof(int), 758df38859SDoug Moore "pn_popmap_t too wide"); 768df38859SDoug Moore 773c30b235SConrad Meyer struct pctrie_node; 783c30b235SConrad Meyer typedef SMR_POINTER(struct pctrie_node *) smr_pctnode_t; 793c30b235SConrad Meyer 80f2cc1285SJeff Roberson struct pctrie_node { 81f2cc1285SJeff Roberson uint64_t pn_owner; /* Owner of record. */ 828df38859SDoug Moore pn_popmap_t pn_popmap; /* Valid children. */ 8338f5cb1bSDoug Moore uint8_t pn_clev; /* Level * WIDTH. */ 84*90710f4aSDoug Moore smr_pctnode_t pn_parent; /* Parent node. */ 853c30b235SConrad Meyer smr_pctnode_t pn_child[PCTRIE_COUNT]; /* Child nodes. */ 86f2cc1285SJeff Roberson }; 87f2cc1285SJeff Roberson 88f2cc1285SJeff Roberson /* 89ac0572e6SDoug Moore * Map index to an array position for the children of node, 90da72505fSDoug Moore */ 91da72505fSDoug Moore static __inline int 92ac0572e6SDoug Moore pctrie_slot(struct pctrie_node *node, uint64_t index) 93da72505fSDoug Moore { 94fd1d6662SDoug Moore return ((index >> node->pn_clev) & (PCTRIE_COUNT - 1)); 95da72505fSDoug Moore } 96da72505fSDoug Moore 97ac0572e6SDoug Moore /* 98ac0572e6SDoug Moore * Returns true if index does not belong to the specified node. Otherwise, 99ac0572e6SDoug Moore * sets slot value, and returns false. 100ac0572e6SDoug Moore */ 101ac0572e6SDoug Moore static __inline bool 102ac0572e6SDoug Moore pctrie_keybarr(struct pctrie_node *node, uint64_t index, int *slot) 103da72505fSDoug Moore { 104ac0572e6SDoug Moore index = (index - node->pn_owner) >> node->pn_clev; 105ac0572e6SDoug Moore if (index >= PCTRIE_COUNT) 106ac0572e6SDoug Moore return (true); 107ac0572e6SDoug Moore *slot = index; 108ac0572e6SDoug Moore return (false); 109da72505fSDoug Moore } 110da72505fSDoug Moore 111fd1d6662SDoug Moore enum pctrie_access { PCTRIE_SMR, PCTRIE_LOCKED, PCTRIE_UNSERIALIZED }; 112fd1d6662SDoug Moore 113f2cc1285SJeff Roberson /* 1143c30b235SConrad Meyer * Fetch a node pointer from a slot. 1153c30b235SConrad Meyer */ 1163c30b235SConrad Meyer static __inline struct pctrie_node * 1173c30b235SConrad Meyer pctrie_node_load(smr_pctnode_t *p, smr_t smr, enum pctrie_access access) 1183c30b235SConrad Meyer { 1193c30b235SConrad Meyer switch (access) { 1203c30b235SConrad Meyer case PCTRIE_UNSERIALIZED: 1213c30b235SConrad Meyer return (smr_unserialized_load(p, true)); 1223c30b235SConrad Meyer case PCTRIE_LOCKED: 1233c30b235SConrad Meyer return (smr_serialized_load(p, true)); 1243c30b235SConrad Meyer case PCTRIE_SMR: 1253c30b235SConrad Meyer return (smr_entered_load(p, smr)); 1263c30b235SConrad Meyer } 1273c30b235SConrad Meyer __assert_unreachable(); 1283c30b235SConrad Meyer } 1293c30b235SConrad Meyer 1303c30b235SConrad Meyer static __inline void 1313c30b235SConrad Meyer pctrie_node_store(smr_pctnode_t *p, void *v, enum pctrie_access access) 1323c30b235SConrad Meyer { 1333c30b235SConrad Meyer switch (access) { 1343c30b235SConrad Meyer case PCTRIE_UNSERIALIZED: 1353c30b235SConrad Meyer smr_unserialized_store(p, v, true); 1363c30b235SConrad Meyer break; 1373c30b235SConrad Meyer case PCTRIE_LOCKED: 1383c30b235SConrad Meyer smr_serialized_store(p, v, true); 1393c30b235SConrad Meyer break; 1403c30b235SConrad Meyer case PCTRIE_SMR: 1413c30b235SConrad Meyer panic("%s: Not supported in SMR section.", __func__); 1423c30b235SConrad Meyer break; 1433c30b235SConrad Meyer default: 1443c30b235SConrad Meyer __assert_unreachable(); 1453c30b235SConrad Meyer break; 1463c30b235SConrad Meyer } 1473c30b235SConrad Meyer } 1483c30b235SConrad Meyer 1493c30b235SConrad Meyer /* 150a905c589SDoug Moore * Get the root address, cast to proper type for load/store. 151a905c589SDoug Moore */ 152a905c589SDoug Moore static __inline smr_pctnode_t * 153a905c589SDoug Moore pctrie_root(struct pctrie *ptree) 154a905c589SDoug Moore { 155a905c589SDoug Moore return ((smr_pctnode_t *)&ptree->pt_root); 156a905c589SDoug Moore } 157a905c589SDoug Moore 158a905c589SDoug Moore /* 159f2cc1285SJeff Roberson * Get the root node for a tree. 160f2cc1285SJeff Roberson */ 161f2cc1285SJeff Roberson static __inline struct pctrie_node * 1623c30b235SConrad Meyer pctrie_root_load(struct pctrie *ptree, smr_t smr, enum pctrie_access access) 163f2cc1285SJeff Roberson { 164a905c589SDoug Moore return (pctrie_node_load(pctrie_root(ptree), smr, access)); 165f2cc1285SJeff Roberson } 166f2cc1285SJeff Roberson 167f2cc1285SJeff Roberson /* 168*90710f4aSDoug Moore * Get the child of a node. 169*90710f4aSDoug Moore */ 170*90710f4aSDoug Moore static __inline smr_pctnode_t * 171*90710f4aSDoug Moore pctrie_child(struct pctrie *ptree, struct pctrie_node *node, uint64_t index) 172*90710f4aSDoug Moore { 173*90710f4aSDoug Moore return (node == NULL ? pctrie_root(ptree) : 174*90710f4aSDoug Moore &node->pn_child[pctrie_slot(node, index)]); 175*90710f4aSDoug Moore } 176*90710f4aSDoug Moore 177*90710f4aSDoug Moore /* 178f2cc1285SJeff Roberson * Returns TRUE if the specified node is a leaf and FALSE otherwise. 179f2cc1285SJeff Roberson */ 18004f9afaeSConrad Meyer static __inline bool 181f2cc1285SJeff Roberson pctrie_isleaf(struct pctrie_node *node) 182f2cc1285SJeff Roberson { 183f2cc1285SJeff Roberson return (((uintptr_t)node & PCTRIE_ISLEAF) != 0); 184f2cc1285SJeff Roberson } 185f2cc1285SJeff Roberson 186f2cc1285SJeff Roberson /* 1879cfed089SDoug Moore * Returns val with leaf bit set. 1889cfed089SDoug Moore */ 1899cfed089SDoug Moore static __inline void * 1909cfed089SDoug Moore pctrie_toleaf(uint64_t *val) 1919cfed089SDoug Moore { 1929cfed089SDoug Moore return ((void *)((uintptr_t)val | PCTRIE_ISLEAF)); 1939cfed089SDoug Moore } 1949cfed089SDoug Moore 1959cfed089SDoug Moore /* 196f2cc1285SJeff Roberson * Returns the associated val extracted from node. 197f2cc1285SJeff Roberson */ 198f2cc1285SJeff Roberson static __inline uint64_t * 199f2cc1285SJeff Roberson pctrie_toval(struct pctrie_node *node) 200f2cc1285SJeff Roberson { 201f2cc1285SJeff Roberson return ((uint64_t *)((uintptr_t)node & ~PCTRIE_FLAGS)); 202f2cc1285SJeff Roberson } 203f2cc1285SJeff Roberson 204f2cc1285SJeff Roberson /* 205c0d0bc2bSDoug Moore * Returns the associated pointer extracted from node and field offset. 206c0d0bc2bSDoug Moore */ 207c0d0bc2bSDoug Moore static __inline void * 208c0d0bc2bSDoug Moore pctrie_toptr(struct pctrie_node *node, int keyoff) 209c0d0bc2bSDoug Moore { 210c0d0bc2bSDoug Moore return ((void *)(((uintptr_t)node & ~PCTRIE_FLAGS) - keyoff)); 211c0d0bc2bSDoug Moore } 212c0d0bc2bSDoug Moore 213c0d0bc2bSDoug Moore /* 214*90710f4aSDoug Moore * Make 'parent' a parent of 'child'. 215*90710f4aSDoug Moore */ 216*90710f4aSDoug Moore static __inline void 217*90710f4aSDoug Moore pctrie_setparent(struct pctrie_node *child, struct pctrie_node *parent) 218*90710f4aSDoug Moore { 219*90710f4aSDoug Moore pctrie_node_store(&child->pn_parent, parent, PCTRIE_UNSERIALIZED); 220*90710f4aSDoug Moore } 221*90710f4aSDoug Moore 222*90710f4aSDoug Moore /* 223*90710f4aSDoug Moore * Return the parent of 'node'. 224*90710f4aSDoug Moore */ 225*90710f4aSDoug Moore static __inline struct pctrie_node * 226*90710f4aSDoug Moore pctrie_parent(struct pctrie_node *node) 227*90710f4aSDoug Moore { 228*90710f4aSDoug Moore return (pctrie_node_load(&node->pn_parent, NULL, PCTRIE_UNSERIALIZED)); 229*90710f4aSDoug Moore } 230*90710f4aSDoug Moore 231*90710f4aSDoug Moore /* 23216e01c05SDoug Moore * Make 'child' a child of 'node'. 233f2cc1285SJeff Roberson */ 234f2cc1285SJeff Roberson static __inline void 23538f5cb1bSDoug Moore pctrie_addnode(struct pctrie_node *node, uint64_t index, 23616e01c05SDoug Moore struct pctrie_node *child, enum pctrie_access access) 237f2cc1285SJeff Roberson { 238f2cc1285SJeff Roberson int slot; 239f2cc1285SJeff Roberson 240ac0572e6SDoug Moore slot = pctrie_slot(node, index); 24116e01c05SDoug Moore pctrie_node_store(&node->pn_child[slot], child, access); 2428df38859SDoug Moore node->pn_popmap ^= 1 << slot; 2438df38859SDoug Moore KASSERT((node->pn_popmap & (1 << slot)) != 0, 2448df38859SDoug Moore ("%s: bad popmap slot %d in node %p", __func__, slot, node)); 245f2cc1285SJeff Roberson } 246f2cc1285SJeff Roberson 247f2cc1285SJeff Roberson /* 248f2cc1285SJeff Roberson * pctrie node zone initializer. 249f2cc1285SJeff Roberson */ 250f2cc1285SJeff Roberson int 251f2cc1285SJeff Roberson pctrie_zone_init(void *mem, int size __unused, int flags __unused) 252f2cc1285SJeff Roberson { 253f2cc1285SJeff Roberson struct pctrie_node *node; 254f2cc1285SJeff Roberson 255f2cc1285SJeff Roberson node = mem; 2568df38859SDoug Moore node->pn_popmap = 0; 2572d2bcba7SDoug Moore for (int i = 0; i < nitems(node->pn_child); i++) 2582d2bcba7SDoug Moore pctrie_node_store(&node->pn_child[i], PCTRIE_NULL, 2592d2bcba7SDoug Moore PCTRIE_UNSERIALIZED); 260f2cc1285SJeff Roberson return (0); 261f2cc1285SJeff Roberson } 262f2cc1285SJeff Roberson 263f2cc1285SJeff Roberson size_t 264f2cc1285SJeff Roberson pctrie_node_size(void) 265f2cc1285SJeff Roberson { 266f2cc1285SJeff Roberson 267f2cc1285SJeff Roberson return (sizeof(struct pctrie_node)); 268f2cc1285SJeff Roberson } 269f2cc1285SJeff Roberson 270f2cc1285SJeff Roberson /* 271bbf81f46SRyan Libby * Look for where to insert the key-value pair into the trie. Complete the 272bbf81f46SRyan Libby * insertion if it replaces a null leaf. Return the insertion location if the 273bbf81f46SRyan Libby * insertion needs to be completed by the caller; otherwise return NULL. 274bbf81f46SRyan Libby * 275bbf81f46SRyan Libby * If the key is already present in the trie, populate *found_out as if by 276bbf81f46SRyan Libby * pctrie_lookup(). 277f2cc1285SJeff Roberson */ 278bbf81f46SRyan Libby static __always_inline void * 279bbf81f46SRyan Libby pctrie_insert_lookup_compound(struct pctrie *ptree, uint64_t *val, 280*90710f4aSDoug Moore struct pctrie_node **parent_out, uint64_t **found_out) 281f2cc1285SJeff Roberson { 2823b7ffacdSDoug Moore uint64_t index; 2833b7ffacdSDoug Moore struct pctrie_node *node, *parent; 284f2cc1285SJeff Roberson int slot; 285f2cc1285SJeff Roberson 286f2cc1285SJeff Roberson index = *val; 287f2cc1285SJeff Roberson 288f2cc1285SJeff Roberson /* 289f2cc1285SJeff Roberson * The owner of record for root is not really important because it 290f2cc1285SJeff Roberson * will never be used. 291f2cc1285SJeff Roberson */ 2923c30b235SConrad Meyer node = pctrie_root_load(ptree, NULL, PCTRIE_LOCKED); 2932d2bcba7SDoug Moore parent = NULL; 2942d2bcba7SDoug Moore for (;;) { 2952d2bcba7SDoug Moore if (pctrie_isleaf(node)) { 2962d2bcba7SDoug Moore if (node == PCTRIE_NULL) { 2972d2bcba7SDoug Moore if (parent == NULL) 298a905c589SDoug Moore pctrie_node_store(pctrie_root(ptree), 2999147a0c9SDoug Moore pctrie_toleaf(val), PCTRIE_LOCKED); 3002d2bcba7SDoug Moore else 3013b7ffacdSDoug Moore pctrie_addnode(parent, index, 3023b7ffacdSDoug Moore pctrie_toleaf(val), PCTRIE_LOCKED); 303*90710f4aSDoug Moore *parent_out = parent; 3043b7ffacdSDoug Moore return (NULL); 305f2cc1285SJeff Roberson } 306bbf81f46SRyan Libby if (*pctrie_toval(node) == index) { 307bbf81f46SRyan Libby *found_out = pctrie_toval(node); 308*90710f4aSDoug Moore *parent_out = parent; 309bbf81f46SRyan Libby return (NULL); 310bbf81f46SRyan Libby } 311f2cc1285SJeff Roberson break; 3122d2bcba7SDoug Moore } 3133b7ffacdSDoug Moore if (pctrie_keybarr(node, index, &slot)) 31416e01c05SDoug Moore break; 3152d2bcba7SDoug Moore parent = node; 3162d2bcba7SDoug Moore node = pctrie_node_load(&node->pn_child[slot], NULL, 3173c30b235SConrad Meyer PCTRIE_LOCKED); 318f2cc1285SJeff Roberson } 319f2cc1285SJeff Roberson 320f2cc1285SJeff Roberson /* 3213b7ffacdSDoug Moore * 'node' must be replaced in the tree with a new branch node, with 3223b7ffacdSDoug Moore * children 'node' and 'val'. Return the place that points to 'node' 3233b7ffacdSDoug Moore * now, and will point to to the new branching node later. 324f2cc1285SJeff Roberson */ 325*90710f4aSDoug Moore *parent_out = parent; 326a905c589SDoug Moore return ((parent == NULL) ? pctrie_root(ptree): &parent->pn_child[slot]); 3273b7ffacdSDoug Moore } 3283b7ffacdSDoug Moore 3293b7ffacdSDoug Moore /* 330bbf81f46SRyan Libby * Wrap pctrie_insert_lookup_compound to implement a strict insertion. Panic 331bbf81f46SRyan Libby * if the key already exists, and do not look for neighboring entries. 332bbf81f46SRyan Libby */ 333bbf81f46SRyan Libby void * 334*90710f4aSDoug Moore pctrie_insert_lookup_strict(struct pctrie *ptree, uint64_t *val, 335*90710f4aSDoug Moore struct pctrie_node **parent_out) 336bbf81f46SRyan Libby { 337bbf81f46SRyan Libby void *parentp; 338bbf81f46SRyan Libby uint64_t *found; 339bbf81f46SRyan Libby 340bbf81f46SRyan Libby found = NULL; 341*90710f4aSDoug Moore parentp = pctrie_insert_lookup_compound(ptree, val, parent_out, 342*90710f4aSDoug Moore &found); 343bbf81f46SRyan Libby if (__predict_false(found != NULL)) 344bbf81f46SRyan Libby panic("%s: key %jx is already present", __func__, 345bbf81f46SRyan Libby (uintmax_t)*val); 346bbf81f46SRyan Libby return (parentp); 347bbf81f46SRyan Libby } 348bbf81f46SRyan Libby 349bbf81f46SRyan Libby /* 350bbf81f46SRyan Libby * Wrap pctrie_insert_lookup_compound to implement find-or-insert. Do not look 351bbf81f46SRyan Libby * for neighboring entries. 352bbf81f46SRyan Libby */ 353bbf81f46SRyan Libby void * 354bbf81f46SRyan Libby pctrie_insert_lookup(struct pctrie *ptree, uint64_t *val, 355*90710f4aSDoug Moore struct pctrie_node **parent_out, uint64_t **found_out) 356bbf81f46SRyan Libby { 357bbf81f46SRyan Libby *found_out = NULL; 358*90710f4aSDoug Moore return (pctrie_insert_lookup_compound(ptree, val, parent_out, 359*90710f4aSDoug Moore found_out)); 360bbf81f46SRyan Libby } 361bbf81f46SRyan Libby 362bbf81f46SRyan Libby /* 363*90710f4aSDoug Moore * Inserts newly allocated node 'child' into trie at location 'parentp', with 364*90710f4aSDoug Moore * parent 'parent' and two children, 'val' and whatever non-NULL node or leaf 365*90710f4aSDoug Moore * was at 'parentp' to begin with. 3663b7ffacdSDoug Moore */ 3673b7ffacdSDoug Moore void 368*90710f4aSDoug Moore pctrie_insert_node(uint64_t *val, struct pctrie_node *parent, void *parentp, 369*90710f4aSDoug Moore struct pctrie_node *child) 3703b7ffacdSDoug Moore { 3713b7ffacdSDoug Moore struct pctrie_node *node; 3723b7ffacdSDoug Moore uint64_t index, newind; 3733b7ffacdSDoug Moore 3743b7ffacdSDoug Moore /* 375*90710f4aSDoug Moore * Clear the last child pointer of the newly allocated child. We want 3763b7ffacdSDoug Moore * to clear it after the final section has exited so lookup can not 3773b7ffacdSDoug Moore * return false negatives. It is done here because it will be 3783b7ffacdSDoug Moore * cache-cold in the dtor callback. 3793b7ffacdSDoug Moore */ 380*90710f4aSDoug Moore if (child->pn_popmap != 0) { 381*90710f4aSDoug Moore pctrie_node_store(&child->pn_child[ffs(child->pn_popmap) - 1], 3823b7ffacdSDoug Moore PCTRIE_NULL, PCTRIE_UNSERIALIZED); 383*90710f4aSDoug Moore child->pn_popmap = 0; 3843b7ffacdSDoug Moore } 3853b7ffacdSDoug Moore 3863b7ffacdSDoug Moore /* 387*90710f4aSDoug Moore * Recover the values of the two children of the new child node. If 3883b7ffacdSDoug Moore * 'node' is not a leaf, this stores into 'newind' the 'owner' field, 3893b7ffacdSDoug Moore * which must be first in the node. 3903b7ffacdSDoug Moore */ 3913b7ffacdSDoug Moore index = *val; 3923b7ffacdSDoug Moore node = pctrie_node_load(parentp, NULL, PCTRIE_UNSERIALIZED); 393*90710f4aSDoug Moore pctrie_setparent(child, parent); 394*90710f4aSDoug Moore if (!pctrie_isleaf(node)) 395*90710f4aSDoug Moore pctrie_setparent(node, child); 3963b7ffacdSDoug Moore newind = *pctrie_toval(node); 3973b7ffacdSDoug Moore 3983b7ffacdSDoug Moore /* 3993b7ffacdSDoug Moore * From the highest-order bit where the indexes differ, 4003b7ffacdSDoug Moore * compute the highest level in the trie where they differ. Then, 4013b7ffacdSDoug Moore * compute the least index of this subtrie. 4023b7ffacdSDoug Moore */ 4033b7ffacdSDoug Moore _Static_assert(sizeof(long long) >= sizeof(uint64_t), 4043b7ffacdSDoug Moore "uint64 too wide"); 4053b7ffacdSDoug Moore _Static_assert(sizeof(uint64_t) * NBBY <= 406*90710f4aSDoug Moore (1 << (sizeof(child->pn_clev) * NBBY)), "pn_clev too narrow"); 407*90710f4aSDoug Moore child->pn_clev = rounddown(ilog2(index ^ newind), PCTRIE_WIDTH); 408*90710f4aSDoug Moore child->pn_owner = PCTRIE_COUNT; 409*90710f4aSDoug Moore child->pn_owner = index & -(child->pn_owner << child->pn_clev); 4103b7ffacdSDoug Moore 4113b7ffacdSDoug Moore 4123c30b235SConrad Meyer /* These writes are not yet visible due to ordering. */ 413*90710f4aSDoug Moore pctrie_addnode(child, index, pctrie_toleaf(val), PCTRIE_UNSERIALIZED); 414*90710f4aSDoug Moore pctrie_addnode(child, newind, node, PCTRIE_UNSERIALIZED); 4153c30b235SConrad Meyer /* Synchronize to make the above visible. */ 416*90710f4aSDoug Moore pctrie_node_store(parentp, child, PCTRIE_LOCKED); 417f2cc1285SJeff Roberson } 418f2cc1285SJeff Roberson 419f2cc1285SJeff Roberson /* 420fd1d6662SDoug Moore * Return the value associated with the node, if the node is a leaf that matches 421fd1d6662SDoug Moore * the index; otherwise NULL. 422fd1d6662SDoug Moore */ 423fd1d6662SDoug Moore static __always_inline uint64_t * 424fd1d6662SDoug Moore pctrie_match_value(struct pctrie_node *node, uint64_t index) 425fd1d6662SDoug Moore { 426fd1d6662SDoug Moore uint64_t *m; 427fd1d6662SDoug Moore 428fd1d6662SDoug Moore if (!pctrie_isleaf(node) || (m = pctrie_toval(node)) == NULL || 429fd1d6662SDoug Moore *m != index) 430fd1d6662SDoug Moore m = NULL; 431fd1d6662SDoug Moore return (m); 432fd1d6662SDoug Moore } 433fd1d6662SDoug Moore 434fd1d6662SDoug Moore /* 435f2cc1285SJeff Roberson * Returns the value stored at the index. If the index is not present, 436f2cc1285SJeff Roberson * NULL is returned. 437f2cc1285SJeff Roberson */ 4383c30b235SConrad Meyer static __always_inline uint64_t * 4393c30b235SConrad Meyer _pctrie_lookup(struct pctrie *ptree, uint64_t index, smr_t smr, 4403c30b235SConrad Meyer enum pctrie_access access) 441f2cc1285SJeff Roberson { 442f2cc1285SJeff Roberson struct pctrie_node *node; 443f2cc1285SJeff Roberson int slot; 444f2cc1285SJeff Roberson 4453c30b235SConrad Meyer node = pctrie_root_load(ptree, smr, access); 446fd1d6662SDoug Moore /* Seek a node that matches index. */ 447fd1d6662SDoug Moore while (!pctrie_isleaf(node) && !pctrie_keybarr(node, index, &slot)) 4483c30b235SConrad Meyer node = pctrie_node_load(&node->pn_child[slot], smr, access); 449fd1d6662SDoug Moore return (pctrie_match_value(node, index)); 450f2cc1285SJeff Roberson } 451f2cc1285SJeff Roberson 452f2cc1285SJeff Roberson /* 4533c30b235SConrad Meyer * Returns the value stored at the index, assuming access is externally 4543c30b235SConrad Meyer * synchronized by a lock. 4553c30b235SConrad Meyer * 4563c30b235SConrad Meyer * If the index is not present, NULL is returned. 4573c30b235SConrad Meyer */ 4583c30b235SConrad Meyer uint64_t * 4593c30b235SConrad Meyer pctrie_lookup(struct pctrie *ptree, uint64_t index) 4603c30b235SConrad Meyer { 4613c30b235SConrad Meyer return (_pctrie_lookup(ptree, index, NULL, PCTRIE_LOCKED)); 4623c30b235SConrad Meyer } 4633c30b235SConrad Meyer 4643c30b235SConrad Meyer /* 4653c30b235SConrad Meyer * Returns the value stored at the index without requiring an external lock. 4663c30b235SConrad Meyer * 4673c30b235SConrad Meyer * If the index is not present, NULL is returned. 4683c30b235SConrad Meyer */ 4693c30b235SConrad Meyer uint64_t * 4703c30b235SConrad Meyer pctrie_lookup_unlocked(struct pctrie *ptree, uint64_t index, smr_t smr) 4713c30b235SConrad Meyer { 4723c30b235SConrad Meyer uint64_t *res; 4733c30b235SConrad Meyer 4743c30b235SConrad Meyer smr_enter(smr); 4753c30b235SConrad Meyer res = _pctrie_lookup(ptree, index, smr, PCTRIE_SMR); 4763c30b235SConrad Meyer smr_exit(smr); 4773c30b235SConrad Meyer return (res); 4783c30b235SConrad Meyer } 4793c30b235SConrad Meyer 4803c30b235SConrad Meyer /* 481*90710f4aSDoug Moore * Returns the last node examined in the search for the index, and sets the 482*90710f4aSDoug Moore * parent of that node. 483fd1d6662SDoug Moore */ 484fd1d6662SDoug Moore static __always_inline struct pctrie_node * 485*90710f4aSDoug Moore _pctrie_lookup_node(struct pctrie *ptree, struct pctrie_node *node, 486*90710f4aSDoug Moore uint64_t index, struct pctrie_node **parent_out, 487*90710f4aSDoug Moore smr_t smr, enum pctrie_access access) 488fd1d6662SDoug Moore { 489*90710f4aSDoug Moore struct pctrie_node *parent; 490fd1d6662SDoug Moore int slot; 491fd1d6662SDoug Moore 492fd1d6662SDoug Moore /* 493fd1d6662SDoug Moore * Climb the search path to find the lowest node from which to start the 494fd1d6662SDoug Moore * search for a value matching 'index'. 495fd1d6662SDoug Moore */ 496*90710f4aSDoug Moore while (node != NULL) { 497fd1d6662SDoug Moore KASSERT(!powerof2(node->pn_popmap), 498fd1d6662SDoug Moore ("%s: freed node in iter path", __func__)); 499*90710f4aSDoug Moore if (!pctrie_keybarr(node, index, &slot)) 500fd1d6662SDoug Moore break; 501*90710f4aSDoug Moore node = pctrie_parent(node); 502fd1d6662SDoug Moore } 503*90710f4aSDoug Moore 504*90710f4aSDoug Moore if (node == NULL) { 505*90710f4aSDoug Moore parent = NULL; 506*90710f4aSDoug Moore node = pctrie_root_load(ptree, smr, access); 507*90710f4aSDoug Moore } else { 508*90710f4aSDoug Moore parent = node; 509*90710f4aSDoug Moore node = pctrie_node_load(&node->pn_child[slot], smr, access); 510fd1d6662SDoug Moore } 511fd1d6662SDoug Moore 512fd1d6662SDoug Moore /* Seek a node that matches index. */ 513fd1d6662SDoug Moore while (!pctrie_isleaf(node) && !pctrie_keybarr(node, index, &slot)) { 514*90710f4aSDoug Moore parent = node; 515fd1d6662SDoug Moore node = pctrie_node_load(&node->pn_child[slot], smr, access); 516fd1d6662SDoug Moore } 517*90710f4aSDoug Moore if (parent_out != NULL) 518*90710f4aSDoug Moore *parent_out = parent; 519fd1d6662SDoug Moore return (node); 520fd1d6662SDoug Moore } 521fd1d6662SDoug Moore 522fd1d6662SDoug Moore /* 523fd1d6662SDoug Moore * Returns the value stored at a given index value, possibly NULL. 524fd1d6662SDoug Moore */ 525fd1d6662SDoug Moore static __always_inline uint64_t * 526fd1d6662SDoug Moore _pctrie_iter_lookup(struct pctrie_iter *it, uint64_t index, smr_t smr, 527fd1d6662SDoug Moore enum pctrie_access access) 528fd1d6662SDoug Moore { 529fd1d6662SDoug Moore struct pctrie_node *node; 530fd1d6662SDoug Moore 531fd1d6662SDoug Moore it->index = index; 532*90710f4aSDoug Moore node = _pctrie_lookup_node(it->ptree, it->node, index, &it->node, 533*90710f4aSDoug Moore smr, access); 534fd1d6662SDoug Moore return (pctrie_match_value(node, index)); 535fd1d6662SDoug Moore } 536fd1d6662SDoug Moore 537fd1d6662SDoug Moore /* 538fd1d6662SDoug Moore * Returns the value stored at a given index value, possibly NULL. 539fd1d6662SDoug Moore */ 540fd1d6662SDoug Moore uint64_t * 541fd1d6662SDoug Moore pctrie_iter_lookup(struct pctrie_iter *it, uint64_t index) 542fd1d6662SDoug Moore { 543fd1d6662SDoug Moore return (_pctrie_iter_lookup(it, index, NULL, PCTRIE_LOCKED)); 544fd1d6662SDoug Moore } 545fd1d6662SDoug Moore 546fd1d6662SDoug Moore /* 547d0b225d1SDoug Moore * Insert the val in the trie, starting search with iterator. Return a pointer 548d0b225d1SDoug Moore * to indicate where a new node must be allocated to complete insertion. 549d0b225d1SDoug Moore * Assumes access is externally synchronized by a lock. 550d0b225d1SDoug Moore */ 551d0b225d1SDoug Moore void * 552d0b225d1SDoug Moore pctrie_iter_insert_lookup(struct pctrie_iter *it, uint64_t *val) 553d0b225d1SDoug Moore { 554d0b225d1SDoug Moore struct pctrie_node *node; 555d0b225d1SDoug Moore 556d0b225d1SDoug Moore it->index = *val; 557*90710f4aSDoug Moore node = _pctrie_lookup_node(it->ptree, it->node, *val, &it->node, 558*90710f4aSDoug Moore NULL, PCTRIE_LOCKED); 559d0b225d1SDoug Moore if (node == PCTRIE_NULL) { 560*90710f4aSDoug Moore if (it->node == NULL) 561a905c589SDoug Moore pctrie_node_store(pctrie_root(it->ptree), 562d0b225d1SDoug Moore pctrie_toleaf(val), PCTRIE_LOCKED); 563d0b225d1SDoug Moore else 564*90710f4aSDoug Moore pctrie_addnode(it->node, it->index, 565d0b225d1SDoug Moore pctrie_toleaf(val), PCTRIE_LOCKED); 566d0b225d1SDoug Moore return (NULL); 567d0b225d1SDoug Moore } 568d0b225d1SDoug Moore if (__predict_false(pctrie_match_value(node, it->index) != NULL)) 569d0b225d1SDoug Moore panic("%s: key %jx is already present", __func__, 570d0b225d1SDoug Moore (uintmax_t)it->index); 571d0b225d1SDoug Moore 572d0b225d1SDoug Moore /* 573d0b225d1SDoug Moore * 'node' must be replaced in the tree with a new branch node, with 574d0b225d1SDoug Moore * children 'node' and 'val'. Return the place that points to 'node' 575d0b225d1SDoug Moore * now, and will point to to the new branching node later. 576d0b225d1SDoug Moore */ 577*90710f4aSDoug Moore return (pctrie_child(it->ptree, it->node, it->index)); 578d0b225d1SDoug Moore } 579d0b225d1SDoug Moore 580d0b225d1SDoug Moore /* 581fd1d6662SDoug Moore * Returns the value stored at a fixed offset from the current index value, 582fd1d6662SDoug Moore * possibly NULL. 583fd1d6662SDoug Moore */ 584fd1d6662SDoug Moore static __always_inline uint64_t * 585fd1d6662SDoug Moore _pctrie_iter_stride(struct pctrie_iter *it, int stride, smr_t smr, 586fd1d6662SDoug Moore enum pctrie_access access) 587fd1d6662SDoug Moore { 588fd1d6662SDoug Moore uint64_t index = it->index + stride; 589fd1d6662SDoug Moore 590fd1d6662SDoug Moore /* Detect stride overflow. */ 591fd1d6662SDoug Moore if ((stride > 0) != (index > it->index)) 592fd1d6662SDoug Moore return (NULL); 593fd1d6662SDoug Moore /* Detect crossing limit */ 594fd1d6662SDoug Moore if ((index < it->limit) != (it->index < it->limit)) 595fd1d6662SDoug Moore return (NULL); 596fd1d6662SDoug Moore 597fd1d6662SDoug Moore return (_pctrie_iter_lookup(it, index, smr, access)); 598fd1d6662SDoug Moore } 599fd1d6662SDoug Moore 600fd1d6662SDoug Moore /* 601fd1d6662SDoug Moore * Returns the value stored at a fixed offset from the current index value, 602fd1d6662SDoug Moore * possibly NULL. 603fd1d6662SDoug Moore */ 604fd1d6662SDoug Moore uint64_t * 605fd1d6662SDoug Moore pctrie_iter_stride(struct pctrie_iter *it, int stride) 606fd1d6662SDoug Moore { 607fd1d6662SDoug Moore return (_pctrie_iter_stride(it, stride, NULL, PCTRIE_LOCKED)); 608fd1d6662SDoug Moore } 609fd1d6662SDoug Moore 610fd1d6662SDoug Moore /* 611fd1d6662SDoug Moore * Returns the value stored at one more than the current index value, possibly 612fd1d6662SDoug Moore * NULL, assuming access is externally synchronized by a lock. 613fd1d6662SDoug Moore */ 614fd1d6662SDoug Moore uint64_t * 615fd1d6662SDoug Moore pctrie_iter_next(struct pctrie_iter *it) 616fd1d6662SDoug Moore { 617fd1d6662SDoug Moore return (_pctrie_iter_stride(it, 1, NULL, PCTRIE_LOCKED)); 618fd1d6662SDoug Moore } 619fd1d6662SDoug Moore 620fd1d6662SDoug Moore /* 621fd1d6662SDoug Moore * Returns the value stored at one less than the current index value, possibly 622fd1d6662SDoug Moore * NULL, assuming access is externally synchronized by a lock. 623fd1d6662SDoug Moore */ 624fd1d6662SDoug Moore uint64_t * 625fd1d6662SDoug Moore pctrie_iter_prev(struct pctrie_iter *it) 626fd1d6662SDoug Moore { 627fd1d6662SDoug Moore return (_pctrie_iter_stride(it, -1, NULL, PCTRIE_LOCKED)); 628fd1d6662SDoug Moore } 629fd1d6662SDoug Moore 630fd1d6662SDoug Moore /* 631*90710f4aSDoug Moore * Find first leaf >= index, and fill iter with the path to the parent of that 632*90710f4aSDoug Moore * leaf. Return NULL if there is no such leaf less than limit. 633f2cc1285SJeff Roberson */ 634bbf81f46SRyan Libby static __inline uint64_t * 635*90710f4aSDoug Moore _pctrie_lookup_ge(struct pctrie *ptree, struct pctrie_node *node, 636*90710f4aSDoug Moore uint64_t index, struct pctrie_node **parent_out, uint64_t limit) 637f2cc1285SJeff Roberson { 638*90710f4aSDoug Moore struct pctrie_node *parent; 639f2cc1285SJeff Roberson uint64_t *m; 640d1139b52SConrad Meyer int slot; 641f2cc1285SJeff Roberson 642*90710f4aSDoug Moore /* Seek a node that matches index. */ 643*90710f4aSDoug Moore node = _pctrie_lookup_node(ptree, node, index, &parent, 644*90710f4aSDoug Moore NULL, PCTRIE_LOCKED); 645f2cc1285SJeff Roberson 646f2cc1285SJeff Roberson /* 647*90710f4aSDoug Moore * If no such node was found, and instead this path leads only to nodes 648*90710f4aSDoug Moore * < index, back up to find a subtrie with the least value > index. 649f2cc1285SJeff Roberson */ 650*90710f4aSDoug Moore if (node == PCTRIE_NULL || *pctrie_toval(node) < index) { 651*90710f4aSDoug Moore /* Climb the path to find a node with a descendant > index. */ 652*90710f4aSDoug Moore for (node = parent; node != NULL; node = pctrie_parent(node)) { 653*90710f4aSDoug Moore slot = pctrie_slot(node, index) + 1; 654*90710f4aSDoug Moore if ((node->pn_popmap >> slot) != 0) 655*90710f4aSDoug Moore break; 656*90710f4aSDoug Moore } 657*90710f4aSDoug Moore if (node == NULL) { 658*90710f4aSDoug Moore if (parent_out != NULL) 659*90710f4aSDoug Moore *parent_out = NULL; 660*90710f4aSDoug Moore return (NULL); 661*90710f4aSDoug Moore } 662*90710f4aSDoug Moore 663*90710f4aSDoug Moore /* Step to the least child with a descendant > index. */ 664*90710f4aSDoug Moore slot += ffs(node->pn_popmap >> slot) - 1; 665*90710f4aSDoug Moore parent = node; 6666f251ef2SDoug Moore node = pctrie_node_load(&node->pn_child[slot], NULL, 6676f251ef2SDoug Moore PCTRIE_LOCKED); 668f2cc1285SJeff Roberson } 669*90710f4aSDoug Moore /* Descend to the least leaf of the subtrie. */ 670*90710f4aSDoug Moore while (!pctrie_isleaf(node)) { 671*90710f4aSDoug Moore if (limit != 0 && node->pn_owner >= limit) 6726f251ef2SDoug Moore return (NULL); 673*90710f4aSDoug Moore slot = ffs(node->pn_popmap) - 1; 674*90710f4aSDoug Moore parent = node; 675*90710f4aSDoug Moore node = pctrie_node_load(&node->pn_child[slot], NULL, 6766f251ef2SDoug Moore PCTRIE_LOCKED); 6776f251ef2SDoug Moore } 678*90710f4aSDoug Moore if (parent_out != NULL) 679*90710f4aSDoug Moore *parent_out = parent; 680*90710f4aSDoug Moore m = pctrie_toval(node); 681*90710f4aSDoug Moore if (limit != 0 && *m >= limit) 682*90710f4aSDoug Moore return (NULL); 683*90710f4aSDoug Moore return (m); 6846f251ef2SDoug Moore } 6856f251ef2SDoug Moore 686bbf81f46SRyan Libby uint64_t * 687bbf81f46SRyan Libby pctrie_lookup_ge(struct pctrie *ptree, uint64_t index) 688bbf81f46SRyan Libby { 689*90710f4aSDoug Moore return (_pctrie_lookup_ge(ptree, NULL, index, NULL, 0)); 690bbf81f46SRyan Libby } 691bbf81f46SRyan Libby 692fd1d6662SDoug Moore /* 693fd1d6662SDoug Moore * Find first leaf >= index, and fill iter with the path to the parent of that 694fd1d6662SDoug Moore * leaf. Return NULL if there is no such leaf less than limit. 695fd1d6662SDoug Moore */ 696fd1d6662SDoug Moore uint64_t * 697fd1d6662SDoug Moore pctrie_iter_lookup_ge(struct pctrie_iter *it, uint64_t index) 698fd1d6662SDoug Moore { 699fd1d6662SDoug Moore uint64_t *m; 700fd1d6662SDoug Moore 701*90710f4aSDoug Moore m = _pctrie_lookup_ge(it->ptree, it->node, index, &it->node, it->limit); 702*90710f4aSDoug Moore if (m != NULL) 703fd1d6662SDoug Moore it->index = *m; 704fd1d6662SDoug Moore return (m); 705fd1d6662SDoug Moore } 706fd1d6662SDoug Moore 707fd1d6662SDoug Moore /* 708fd1d6662SDoug Moore * Find the first leaf with value at least 'jump' greater than the previous 709fd1d6662SDoug Moore * leaf. Return NULL if that value is >= limit. 710fd1d6662SDoug Moore */ 711fd1d6662SDoug Moore uint64_t * 712fd1d6662SDoug Moore pctrie_iter_jump_ge(struct pctrie_iter *it, int64_t jump) 713fd1d6662SDoug Moore { 714fd1d6662SDoug Moore uint64_t index = it->index + jump; 715fd1d6662SDoug Moore 716fd1d6662SDoug Moore /* Detect jump overflow. */ 717fd1d6662SDoug Moore if ((jump > 0) != (index > it->index)) 718fd1d6662SDoug Moore return (NULL); 719fd1d6662SDoug Moore if (it->limit != 0 && index >= it->limit) 720fd1d6662SDoug Moore return (NULL); 721fd1d6662SDoug Moore return (pctrie_iter_lookup_ge(it, index)); 722fd1d6662SDoug Moore } 723fd1d6662SDoug Moore 7246f251ef2SDoug Moore /* 725*90710f4aSDoug Moore * Find first leaf <= index, and fill iter with the path to the parent of that 726*90710f4aSDoug Moore * leaf. Return NULL if there is no such leaf greater than limit. 727f2cc1285SJeff Roberson */ 728bbf81f46SRyan Libby static __inline uint64_t * 729*90710f4aSDoug Moore _pctrie_lookup_le(struct pctrie *ptree, struct pctrie_node *node, 730*90710f4aSDoug Moore uint64_t index, struct pctrie_node **parent_out, uint64_t limit) 731f2cc1285SJeff Roberson { 732*90710f4aSDoug Moore struct pctrie_node *parent; 733f2cc1285SJeff Roberson uint64_t *m; 734d1139b52SConrad Meyer int slot; 735f2cc1285SJeff Roberson 736*90710f4aSDoug Moore /* Seek a node that matches index. */ 737*90710f4aSDoug Moore node = _pctrie_lookup_node(ptree, node, index, &parent, NULL, 738*90710f4aSDoug Moore PCTRIE_LOCKED); 739*90710f4aSDoug Moore 7406f251ef2SDoug Moore /* 741*90710f4aSDoug Moore * If no such node was found, and instead this path leads only to nodes 742*90710f4aSDoug Moore * > index, back up to find a subtrie with the greatest value < index. 7436f251ef2SDoug Moore */ 744*90710f4aSDoug Moore if (node == PCTRIE_NULL || *pctrie_toval(node) > index) { 745*90710f4aSDoug Moore /* Climb the path to find a node with a descendant < index. */ 746*90710f4aSDoug Moore for (node = parent; node != NULL; node = pctrie_parent(node)) { 747*90710f4aSDoug Moore slot = pctrie_slot(node, index); 7486f251ef2SDoug Moore if ((node->pn_popmap & ((1 << slot) - 1)) != 0) 749*90710f4aSDoug Moore break; 750*90710f4aSDoug Moore } 751*90710f4aSDoug Moore if (node == NULL) { 752*90710f4aSDoug Moore if (parent_out != NULL) 753*90710f4aSDoug Moore *parent_out = NULL; 754*90710f4aSDoug Moore return (NULL); 755*90710f4aSDoug Moore } 756*90710f4aSDoug Moore 757*90710f4aSDoug Moore /* Step to the greatest child with a descendant < index. */ 758*90710f4aSDoug Moore slot = ilog2(node->pn_popmap & ((1 << slot) - 1)); 759*90710f4aSDoug Moore parent = node; 7606f251ef2SDoug Moore node = pctrie_node_load(&node->pn_child[slot], NULL, 7613c30b235SConrad Meyer PCTRIE_LOCKED); 7628df38859SDoug Moore } 763*90710f4aSDoug Moore /* Descend to the greatest leaf of the subtrie. */ 764*90710f4aSDoug Moore while (!pctrie_isleaf(node)) { 765*90710f4aSDoug Moore if (limit != 0 && limit >= node->pn_owner + 766*90710f4aSDoug Moore ((uint64_t)PCTRIE_COUNT << node->pn_clev) - 1) 7676f251ef2SDoug Moore return (NULL); 768*90710f4aSDoug Moore slot = ilog2(node->pn_popmap); 769*90710f4aSDoug Moore parent = node; 770*90710f4aSDoug Moore node = pctrie_node_load(&node->pn_child[slot], NULL, 7716f251ef2SDoug Moore PCTRIE_LOCKED); 772f2cc1285SJeff Roberson } 773*90710f4aSDoug Moore if (parent_out != NULL) 774*90710f4aSDoug Moore *parent_out = parent; 775*90710f4aSDoug Moore m = pctrie_toval(node); 776*90710f4aSDoug Moore if (limit != 0 && *m <= limit) 777*90710f4aSDoug Moore return (NULL); 778*90710f4aSDoug Moore return (m); 779f2cc1285SJeff Roberson } 780f2cc1285SJeff Roberson 781bbf81f46SRyan Libby uint64_t * 782bbf81f46SRyan Libby pctrie_lookup_le(struct pctrie *ptree, uint64_t index) 783bbf81f46SRyan Libby { 784*90710f4aSDoug Moore return (_pctrie_lookup_le(ptree, NULL, index, NULL, 0)); 785bbf81f46SRyan Libby } 786bbf81f46SRyan Libby 787bbf81f46SRyan Libby uint64_t * 788*90710f4aSDoug Moore pctrie_subtree_lookup_lt(struct pctrie *ptree, struct pctrie_node *node, 789*90710f4aSDoug Moore uint64_t index) 790bbf81f46SRyan Libby { 791*90710f4aSDoug Moore if (index == 0) 792bbf81f46SRyan Libby return (NULL); 793*90710f4aSDoug Moore return (_pctrie_lookup_le(ptree, node, index - 1, NULL, 0)); 794bbf81f46SRyan Libby } 795bbf81f46SRyan Libby 796fd1d6662SDoug Moore /* 797fd1d6662SDoug Moore * Find first leaf <= index, and fill iter with the path to the parent of that 798fd1d6662SDoug Moore * leaf. Return NULL if there is no such leaf greater than limit. 799fd1d6662SDoug Moore */ 800fd1d6662SDoug Moore uint64_t * 801fd1d6662SDoug Moore pctrie_iter_lookup_le(struct pctrie_iter *it, uint64_t index) 802fd1d6662SDoug Moore { 803fd1d6662SDoug Moore uint64_t *m; 804fd1d6662SDoug Moore 805*90710f4aSDoug Moore m = _pctrie_lookup_le(it->ptree, it->node, index, &it->node, it->limit); 806*90710f4aSDoug Moore if (m != NULL) 807fd1d6662SDoug Moore it->index = *m; 808fd1d6662SDoug Moore return (m); 809fd1d6662SDoug Moore } 810fd1d6662SDoug Moore 811fd1d6662SDoug Moore /* 812fd1d6662SDoug Moore * Find the first leaf with value at most 'jump' less than the previous 813fd1d6662SDoug Moore * leaf. Return NULL if that value is <= limit. 814fd1d6662SDoug Moore */ 815fd1d6662SDoug Moore uint64_t * 816fd1d6662SDoug Moore pctrie_iter_jump_le(struct pctrie_iter *it, int64_t jump) 817fd1d6662SDoug Moore { 818fd1d6662SDoug Moore uint64_t index = it->index - jump; 819fd1d6662SDoug Moore 820fd1d6662SDoug Moore /* Detect jump overflow. */ 821fd1d6662SDoug Moore if ((jump > 0) != (index < it->index)) 822fd1d6662SDoug Moore return (NULL); 823fd1d6662SDoug Moore if (it->limit != 0 && index <= it->limit) 824fd1d6662SDoug Moore return (NULL); 825fd1d6662SDoug Moore return (pctrie_iter_lookup_le(it, index)); 826fd1d6662SDoug Moore } 827fd1d6662SDoug Moore 828*90710f4aSDoug Moore /* 829*90710f4aSDoug Moore * If 'child', a leaf and a child of 'parent', is not NULL and has key 'index', 830*90710f4aSDoug Moore * then remove it from the pctrie and return its value. If doing so produces an 831*90710f4aSDoug Moore * internal node with only one child, purge it from the pctrie and save it in 832*90710f4aSDoug Moore * *freenode for later disposal. 833*90710f4aSDoug Moore */ 834*90710f4aSDoug Moore static uint64_t * 835*90710f4aSDoug Moore pctrie_remove(struct pctrie *ptree, struct pctrie_node *node, uint64_t index, 836*90710f4aSDoug Moore struct pctrie_node *child, struct pctrie_node **freenode) 837bbf81f46SRyan Libby { 838*90710f4aSDoug Moore uint64_t *m; 8398df38859SDoug Moore int slot; 840f2cc1285SJeff Roberson 841*90710f4aSDoug Moore *freenode = NULL; 842*90710f4aSDoug Moore m = pctrie_match_value(child, index); 843*90710f4aSDoug Moore if (m == NULL) 844*90710f4aSDoug Moore return (m); 8452d2bcba7SDoug Moore if (node == NULL) { 846a905c589SDoug Moore pctrie_node_store(pctrie_root(ptree), 847a905c589SDoug Moore PCTRIE_NULL, PCTRIE_LOCKED); 848*90710f4aSDoug Moore return (m); 849f2cc1285SJeff Roberson } 850fd1d6662SDoug Moore slot = pctrie_slot(node, index); 8518df38859SDoug Moore KASSERT((node->pn_popmap & (1 << slot)) != 0, 8528df38859SDoug Moore ("%s: bad popmap slot %d in node %p", 8538df38859SDoug Moore __func__, slot, node)); 8548df38859SDoug Moore node->pn_popmap ^= 1 << slot; 8552d2bcba7SDoug Moore pctrie_node_store(&node->pn_child[slot], PCTRIE_NULL, PCTRIE_LOCKED); 8568df38859SDoug Moore if (!powerof2(node->pn_popmap)) 857*90710f4aSDoug Moore return (m); 8582d2bcba7SDoug Moore KASSERT(node->pn_popmap != 0, ("%s: bad popmap all zeroes", __func__)); 8598df38859SDoug Moore slot = ffs(node->pn_popmap) - 1; 8602d2bcba7SDoug Moore child = pctrie_node_load(&node->pn_child[slot], NULL, PCTRIE_LOCKED); 8612d2bcba7SDoug Moore KASSERT(child != PCTRIE_NULL, 8622d2bcba7SDoug Moore ("%s: bad popmap slot %d in node %p", __func__, slot, node)); 8633b7ffacdSDoug Moore *freenode = node; 864*90710f4aSDoug Moore node = pctrie_parent(node); 865*90710f4aSDoug Moore if (!pctrie_isleaf(child)) 866*90710f4aSDoug Moore pctrie_setparent(child, node); 867*90710f4aSDoug Moore pctrie_node_store(pctrie_child(ptree, node, index), child, 868*90710f4aSDoug Moore PCTRIE_LOCKED); 869*90710f4aSDoug Moore return (m); 870fd1d6662SDoug Moore } 871fd1d6662SDoug Moore 872fd1d6662SDoug Moore /* 873fd1d6662SDoug Moore * Remove the specified index from the tree, and return the value stored at 874fd1d6662SDoug Moore * that index. If the index is not present, return NULL. 875fd1d6662SDoug Moore */ 876fd1d6662SDoug Moore uint64_t * 877fd1d6662SDoug Moore pctrie_remove_lookup(struct pctrie *ptree, uint64_t index, 878fd1d6662SDoug Moore struct pctrie_node **freenode) 879fd1d6662SDoug Moore { 880*90710f4aSDoug Moore struct pctrie_node *child, *node; 881fd1d6662SDoug Moore int slot; 882fd1d6662SDoug Moore 883*90710f4aSDoug Moore node = NULL; 884fd1d6662SDoug Moore child = pctrie_root_load(ptree, NULL, PCTRIE_LOCKED); 885fd1d6662SDoug Moore while (!pctrie_isleaf(child)) { 886fd1d6662SDoug Moore node = child; 887fd1d6662SDoug Moore slot = pctrie_slot(node, index); 888fd1d6662SDoug Moore child = pctrie_node_load(&node->pn_child[slot], NULL, 889fd1d6662SDoug Moore PCTRIE_LOCKED); 890fd1d6662SDoug Moore } 891*90710f4aSDoug Moore return (pctrie_remove(ptree, node, index, child, freenode)); 892f2cc1285SJeff Roberson } 893f2cc1285SJeff Roberson 894f2cc1285SJeff Roberson /* 895fd1d6662SDoug Moore * Remove from the trie the leaf last chosen by the iterator, and 896fd1d6662SDoug Moore * adjust the path if it's last member is to be freed. 897fd1d6662SDoug Moore */ 898fd1d6662SDoug Moore uint64_t * 899fd1d6662SDoug Moore pctrie_iter_remove(struct pctrie_iter *it, struct pctrie_node **freenode) 900fd1d6662SDoug Moore { 901*90710f4aSDoug Moore struct pctrie_node *child; 902fd1d6662SDoug Moore uint64_t *m; 903fd1d6662SDoug Moore 904*90710f4aSDoug Moore child = pctrie_node_load(pctrie_child(it->ptree, it->node, it->index), 905*90710f4aSDoug Moore NULL, PCTRIE_LOCKED); 906*90710f4aSDoug Moore m = pctrie_remove(it->ptree, it->node, it->index, child, freenode); 907fd1d6662SDoug Moore if (*freenode != NULL) 908*90710f4aSDoug Moore it->node = pctrie_parent(it->node); 909fd1d6662SDoug Moore return (m); 910fd1d6662SDoug Moore } 911fd1d6662SDoug Moore 912fd1d6662SDoug Moore /* 913fd1d6662SDoug Moore * Return the current leaf, assuming access is externally synchronized by a 914fd1d6662SDoug Moore * lock. 915fd1d6662SDoug Moore */ 916fd1d6662SDoug Moore uint64_t * 917fd1d6662SDoug Moore pctrie_iter_value(struct pctrie_iter *it) 918fd1d6662SDoug Moore { 919fd1d6662SDoug Moore struct pctrie_node *node; 920fd1d6662SDoug Moore 921*90710f4aSDoug Moore node = pctrie_node_load(pctrie_child(it->ptree, it->node, it->index), 922*90710f4aSDoug Moore NULL, PCTRIE_LOCKED); 923fd1d6662SDoug Moore return (pctrie_toval(node)); 924fd1d6662SDoug Moore } 925fd1d6662SDoug Moore 926fd1d6662SDoug Moore /* 927*90710f4aSDoug Moore * Walk the subtrie rooted at *pnode in order, invoking callback on leaves, 928*90710f4aSDoug Moore * until an interior node is stripped of all children, and returned for 929*90710f4aSDoug Moore * deallocation, with *pnode left pointing to the parent of that node. 930f2cc1285SJeff Roberson */ 931c0d0bc2bSDoug Moore static __always_inline struct pctrie_node * 932c0d0bc2bSDoug Moore pctrie_reclaim_prune(struct pctrie_node **pnode, struct pctrie_node *parent, 933c0d0bc2bSDoug Moore pctrie_cb_t callback, int keyoff, void *arg) 934f2cc1285SJeff Roberson { 9353b7ffacdSDoug Moore struct pctrie_node *child, *node; 9363b7ffacdSDoug Moore int slot; 937f2cc1285SJeff Roberson 9383b7ffacdSDoug Moore node = *pnode; 9393b7ffacdSDoug Moore while (node->pn_popmap != 0) { 9403b7ffacdSDoug Moore slot = ffs(node->pn_popmap) - 1; 9413b7ffacdSDoug Moore node->pn_popmap ^= 1 << slot; 9423b7ffacdSDoug Moore child = pctrie_node_load(&node->pn_child[slot], NULL, 9433b7ffacdSDoug Moore PCTRIE_UNSERIALIZED); 9443b7ffacdSDoug Moore pctrie_node_store(&node->pn_child[slot], PCTRIE_NULL, 9453b7ffacdSDoug Moore PCTRIE_UNSERIALIZED); 946c0d0bc2bSDoug Moore if (pctrie_isleaf(child)) { 947c0d0bc2bSDoug Moore if (callback != NULL) 948c0d0bc2bSDoug Moore callback(pctrie_toptr(child, keyoff), arg); 9493b7ffacdSDoug Moore continue; 950c0d0bc2bSDoug Moore } 9513b7ffacdSDoug Moore /* Climb one level down the trie. */ 9523b7ffacdSDoug Moore parent = node; 9533b7ffacdSDoug Moore node = child; 9543b7ffacdSDoug Moore } 9553b7ffacdSDoug Moore *pnode = parent; 9563b7ffacdSDoug Moore return (node); 9573b7ffacdSDoug Moore } 9583b7ffacdSDoug Moore 9593b7ffacdSDoug Moore /* 9603b7ffacdSDoug Moore * Recover the node parent from its first child and continue pruning. 9613b7ffacdSDoug Moore */ 962c0d0bc2bSDoug Moore static __always_inline struct pctrie_node * 963c0d0bc2bSDoug Moore pctrie_reclaim_resume_compound(struct pctrie_node **pnode, 964c0d0bc2bSDoug Moore pctrie_cb_t callback, int keyoff, void *arg) 9653b7ffacdSDoug Moore { 966*90710f4aSDoug Moore if (*pnode == NULL) 9673b7ffacdSDoug Moore return (NULL); 9683b7ffacdSDoug Moore /* Climb one level up the trie. */ 969*90710f4aSDoug Moore return (pctrie_reclaim_prune(pnode, pctrie_parent(*pnode), callback, 970*90710f4aSDoug Moore keyoff, arg)); 9713b7ffacdSDoug Moore } 9723b7ffacdSDoug Moore 9733b7ffacdSDoug Moore /* 9743b7ffacdSDoug Moore * Find the trie root, and start pruning with a NULL parent. 9753b7ffacdSDoug Moore */ 976c0d0bc2bSDoug Moore static __always_inline struct pctrie_node * 977c0d0bc2bSDoug Moore pctrie_reclaim_begin_compound(struct pctrie_node **pnode, 978c0d0bc2bSDoug Moore struct pctrie *ptree, 979c0d0bc2bSDoug Moore pctrie_cb_t callback, int keyoff, void *arg) 9803b7ffacdSDoug Moore { 9813b7ffacdSDoug Moore struct pctrie_node *node; 9823b7ffacdSDoug Moore 9833b7ffacdSDoug Moore node = pctrie_root_load(ptree, NULL, PCTRIE_UNSERIALIZED); 984a905c589SDoug Moore pctrie_node_store(pctrie_root(ptree), PCTRIE_NULL, PCTRIE_UNSERIALIZED); 985c0d0bc2bSDoug Moore if (pctrie_isleaf(node)) { 986c0d0bc2bSDoug Moore if (callback != NULL && node != PCTRIE_NULL) 987c0d0bc2bSDoug Moore callback(pctrie_toptr(node, keyoff), arg); 9883b7ffacdSDoug Moore return (NULL); 989c0d0bc2bSDoug Moore } 9903b7ffacdSDoug Moore *pnode = node; 991c0d0bc2bSDoug Moore return (pctrie_reclaim_prune(pnode, NULL, callback, keyoff, arg)); 992c0d0bc2bSDoug Moore } 993c0d0bc2bSDoug Moore 994c0d0bc2bSDoug Moore struct pctrie_node * 995c0d0bc2bSDoug Moore pctrie_reclaim_resume(struct pctrie_node **pnode) 996c0d0bc2bSDoug Moore { 997c0d0bc2bSDoug Moore return (pctrie_reclaim_resume_compound(pnode, NULL, 0, NULL)); 998c0d0bc2bSDoug Moore } 999c0d0bc2bSDoug Moore 1000c0d0bc2bSDoug Moore struct pctrie_node * 1001c0d0bc2bSDoug Moore pctrie_reclaim_begin(struct pctrie_node **pnode, struct pctrie *ptree) 1002c0d0bc2bSDoug Moore { 1003c0d0bc2bSDoug Moore return (pctrie_reclaim_begin_compound(pnode, ptree, NULL, 0, NULL)); 1004c0d0bc2bSDoug Moore } 1005c0d0bc2bSDoug Moore 1006c0d0bc2bSDoug Moore struct pctrie_node * 1007c0d0bc2bSDoug Moore pctrie_reclaim_resume_cb(struct pctrie_node **pnode, 1008c0d0bc2bSDoug Moore pctrie_cb_t callback, int keyoff, void *arg) 1009c0d0bc2bSDoug Moore { 1010c0d0bc2bSDoug Moore return (pctrie_reclaim_resume_compound(pnode, callback, keyoff, arg)); 1011c0d0bc2bSDoug Moore } 1012c0d0bc2bSDoug Moore 1013c0d0bc2bSDoug Moore struct pctrie_node * 1014c0d0bc2bSDoug Moore pctrie_reclaim_begin_cb(struct pctrie_node **pnode, struct pctrie *ptree, 1015c0d0bc2bSDoug Moore pctrie_cb_t callback, int keyoff, void *arg) 1016c0d0bc2bSDoug Moore { 1017c0d0bc2bSDoug Moore return (pctrie_reclaim_begin_compound(pnode, ptree, 1018c0d0bc2bSDoug Moore callback, keyoff, arg)); 10193b7ffacdSDoug Moore } 10203b7ffacdSDoug Moore 10213b7ffacdSDoug Moore /* 10223b7ffacdSDoug Moore * Replace an existing value in the trie with another one. 10233b7ffacdSDoug Moore * Panics if there is not an old value in the trie at the new value's index. 10243b7ffacdSDoug Moore */ 10253b7ffacdSDoug Moore uint64_t * 10263b7ffacdSDoug Moore pctrie_replace(struct pctrie *ptree, uint64_t *newval) 10273b7ffacdSDoug Moore { 10283b7ffacdSDoug Moore struct pctrie_node *leaf, *parent, *node; 10293b7ffacdSDoug Moore uint64_t *m; 10303b7ffacdSDoug Moore uint64_t index; 10313b7ffacdSDoug Moore int slot; 10323b7ffacdSDoug Moore 10333b7ffacdSDoug Moore leaf = pctrie_toleaf(newval); 10343b7ffacdSDoug Moore index = *newval; 10353b7ffacdSDoug Moore node = pctrie_root_load(ptree, NULL, PCTRIE_LOCKED); 10363b7ffacdSDoug Moore parent = NULL; 10373b7ffacdSDoug Moore for (;;) { 10383b7ffacdSDoug Moore if (pctrie_isleaf(node)) { 10393b7ffacdSDoug Moore if ((m = pctrie_toval(node)) != NULL && *m == index) { 10403b7ffacdSDoug Moore if (parent == NULL) 1041a905c589SDoug Moore pctrie_node_store(pctrie_root(ptree), 10429147a0c9SDoug Moore leaf, PCTRIE_LOCKED); 10433b7ffacdSDoug Moore else 10443b7ffacdSDoug Moore pctrie_node_store( 10453b7ffacdSDoug Moore &parent->pn_child[slot], leaf, 10463b7ffacdSDoug Moore PCTRIE_LOCKED); 10473b7ffacdSDoug Moore return (m); 10483b7ffacdSDoug Moore } 10493b7ffacdSDoug Moore break; 10503b7ffacdSDoug Moore } 10513b7ffacdSDoug Moore if (pctrie_keybarr(node, index, &slot)) 10523b7ffacdSDoug Moore break; 10533b7ffacdSDoug Moore parent = node; 10543b7ffacdSDoug Moore node = pctrie_node_load(&node->pn_child[slot], NULL, 10553b7ffacdSDoug Moore PCTRIE_LOCKED); 10563b7ffacdSDoug Moore } 10573b7ffacdSDoug Moore panic("%s: original replacing value not found", __func__); 1058f2cc1285SJeff Roberson } 1059f2cc1285SJeff Roberson 1060f2cc1285SJeff Roberson #ifdef DDB 1061f2cc1285SJeff Roberson /* 1062f2cc1285SJeff Roberson * Show details about the given node. 1063f2cc1285SJeff Roberson */ 1064f2cc1285SJeff Roberson DB_SHOW_COMMAND(pctrienode, db_show_pctrienode) 1065f2cc1285SJeff Roberson { 10663c30b235SConrad Meyer struct pctrie_node *node, *tmp; 10678df38859SDoug Moore int slot; 10688df38859SDoug Moore pn_popmap_t popmap; 1069f2cc1285SJeff Roberson 1070f2cc1285SJeff Roberson if (!have_addr) 1071f2cc1285SJeff Roberson return; 1072f2cc1285SJeff Roberson node = (struct pctrie_node *)addr; 10738df38859SDoug Moore db_printf("node %p, owner %jx, children popmap %04x, level %u:\n", 10748df38859SDoug Moore (void *)node, (uintmax_t)node->pn_owner, node->pn_popmap, 107538f5cb1bSDoug Moore node->pn_clev / PCTRIE_WIDTH); 10768df38859SDoug Moore for (popmap = node->pn_popmap; popmap != 0; popmap ^= 1 << slot) { 10778df38859SDoug Moore slot = ffs(popmap) - 1; 10788df38859SDoug Moore tmp = pctrie_node_load(&node->pn_child[slot], NULL, 10793c30b235SConrad Meyer PCTRIE_UNSERIALIZED); 1080f2cc1285SJeff Roberson db_printf("slot: %d, val: %p, value: %p, clev: %d\n", 10818df38859SDoug Moore slot, (void *)tmp, 10823c30b235SConrad Meyer pctrie_isleaf(tmp) ? pctrie_toval(tmp) : NULL, 108338f5cb1bSDoug Moore node->pn_clev / PCTRIE_WIDTH); 1084f2cc1285SJeff Roberson } 10853c30b235SConrad Meyer } 1086f2cc1285SJeff Roberson #endif /* DDB */ 1087