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. */ 8490710f4aSDoug 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 /* 16890710f4aSDoug Moore * Get the child of a node. 16990710f4aSDoug Moore */ 17090710f4aSDoug Moore static __inline smr_pctnode_t * 17190710f4aSDoug Moore pctrie_child(struct pctrie *ptree, struct pctrie_node *node, uint64_t index) 17290710f4aSDoug Moore { 17390710f4aSDoug Moore return (node == NULL ? pctrie_root(ptree) : 17490710f4aSDoug Moore &node->pn_child[pctrie_slot(node, index)]); 17590710f4aSDoug Moore } 17690710f4aSDoug Moore 17790710f4aSDoug 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 /* 21490710f4aSDoug Moore * Make 'parent' a parent of 'child'. 21590710f4aSDoug Moore */ 21690710f4aSDoug Moore static __inline void 21790710f4aSDoug Moore pctrie_setparent(struct pctrie_node *child, struct pctrie_node *parent) 21890710f4aSDoug Moore { 21990710f4aSDoug Moore pctrie_node_store(&child->pn_parent, parent, PCTRIE_UNSERIALIZED); 22090710f4aSDoug Moore } 22190710f4aSDoug Moore 22290710f4aSDoug Moore /* 22390710f4aSDoug Moore * Return the parent of 'node'. 22490710f4aSDoug Moore */ 22590710f4aSDoug Moore static __inline struct pctrie_node * 22690710f4aSDoug Moore pctrie_parent(struct pctrie_node *node) 22790710f4aSDoug Moore { 22890710f4aSDoug Moore return (pctrie_node_load(&node->pn_parent, NULL, PCTRIE_UNSERIALIZED)); 22990710f4aSDoug Moore } 23090710f4aSDoug Moore 23190710f4aSDoug 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, 28090710f4aSDoug 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); 30390710f4aSDoug Moore *parent_out = parent; 3043b7ffacdSDoug Moore return (NULL); 305f2cc1285SJeff Roberson } 306bbf81f46SRyan Libby if (*pctrie_toval(node) == index) { 307bbf81f46SRyan Libby *found_out = pctrie_toval(node); 30890710f4aSDoug 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 */ 32590710f4aSDoug 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 * 33490710f4aSDoug Moore pctrie_insert_lookup_strict(struct pctrie *ptree, uint64_t *val, 33590710f4aSDoug Moore struct pctrie_node **parent_out) 336bbf81f46SRyan Libby { 337bbf81f46SRyan Libby void *parentp; 338bbf81f46SRyan Libby uint64_t *found; 339bbf81f46SRyan Libby 340bbf81f46SRyan Libby found = NULL; 34190710f4aSDoug Moore parentp = pctrie_insert_lookup_compound(ptree, val, parent_out, 34290710f4aSDoug 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, 35590710f4aSDoug Moore struct pctrie_node **parent_out, uint64_t **found_out) 356bbf81f46SRyan Libby { 357bbf81f46SRyan Libby *found_out = NULL; 35890710f4aSDoug Moore return (pctrie_insert_lookup_compound(ptree, val, parent_out, 35990710f4aSDoug Moore found_out)); 360bbf81f46SRyan Libby } 361bbf81f46SRyan Libby 362bbf81f46SRyan Libby /* 36390710f4aSDoug Moore * Inserts newly allocated node 'child' into trie at location 'parentp', with 36490710f4aSDoug Moore * parent 'parent' and two children, 'val' and whatever non-NULL node or leaf 36590710f4aSDoug Moore * was at 'parentp' to begin with. 3663b7ffacdSDoug Moore */ 3673b7ffacdSDoug Moore void 36890710f4aSDoug Moore pctrie_insert_node(uint64_t *val, struct pctrie_node *parent, void *parentp, 36990710f4aSDoug Moore struct pctrie_node *child) 3703b7ffacdSDoug Moore { 3713b7ffacdSDoug Moore struct pctrie_node *node; 3723b7ffacdSDoug Moore uint64_t index, newind; 3733b7ffacdSDoug Moore 3743b7ffacdSDoug Moore /* 37590710f4aSDoug 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 */ 38090710f4aSDoug Moore if (child->pn_popmap != 0) { 38190710f4aSDoug Moore pctrie_node_store(&child->pn_child[ffs(child->pn_popmap) - 1], 3823b7ffacdSDoug Moore PCTRIE_NULL, PCTRIE_UNSERIALIZED); 38390710f4aSDoug Moore child->pn_popmap = 0; 3843b7ffacdSDoug Moore } 3853b7ffacdSDoug Moore 3863b7ffacdSDoug Moore /* 38790710f4aSDoug 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); 39390710f4aSDoug Moore pctrie_setparent(child, parent); 39490710f4aSDoug Moore if (!pctrie_isleaf(node)) 39590710f4aSDoug 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 <= 40690710f4aSDoug Moore (1 << (sizeof(child->pn_clev) * NBBY)), "pn_clev too narrow"); 40790710f4aSDoug Moore child->pn_clev = rounddown(ilog2(index ^ newind), PCTRIE_WIDTH); 40890710f4aSDoug Moore child->pn_owner = PCTRIE_COUNT; 40990710f4aSDoug 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. */ 41390710f4aSDoug Moore pctrie_addnode(child, index, pctrie_toleaf(val), PCTRIE_UNSERIALIZED); 41490710f4aSDoug Moore pctrie_addnode(child, newind, node, PCTRIE_UNSERIALIZED); 4153c30b235SConrad Meyer /* Synchronize to make the above visible. */ 41690710f4aSDoug 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 /* 48190710f4aSDoug Moore * Returns the last node examined in the search for the index, and sets the 48290710f4aSDoug Moore * parent of that node. 483fd1d6662SDoug Moore */ 484fd1d6662SDoug Moore static __always_inline struct pctrie_node * 48590710f4aSDoug Moore _pctrie_lookup_node(struct pctrie *ptree, struct pctrie_node *node, 48690710f4aSDoug Moore uint64_t index, struct pctrie_node **parent_out, 48790710f4aSDoug Moore smr_t smr, enum pctrie_access access) 488fd1d6662SDoug Moore { 48990710f4aSDoug 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 */ 49690710f4aSDoug Moore while (node != NULL) { 497fd1d6662SDoug Moore KASSERT(!powerof2(node->pn_popmap), 498fd1d6662SDoug Moore ("%s: freed node in iter path", __func__)); 49990710f4aSDoug Moore if (!pctrie_keybarr(node, index, &slot)) 500fd1d6662SDoug Moore break; 50190710f4aSDoug Moore node = pctrie_parent(node); 502fd1d6662SDoug Moore } 50390710f4aSDoug Moore 50490710f4aSDoug Moore if (node == NULL) { 50590710f4aSDoug Moore parent = NULL; 50690710f4aSDoug Moore node = pctrie_root_load(ptree, smr, access); 50790710f4aSDoug Moore } else { 50890710f4aSDoug Moore parent = node; 50990710f4aSDoug 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)) { 51490710f4aSDoug Moore parent = node; 515fd1d6662SDoug Moore node = pctrie_node_load(&node->pn_child[slot], smr, access); 516fd1d6662SDoug Moore } 51790710f4aSDoug Moore if (parent_out != NULL) 51890710f4aSDoug 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; 53290710f4aSDoug Moore node = _pctrie_lookup_node(it->ptree, it->node, index, &it->node, 53390710f4aSDoug 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; 55790710f4aSDoug Moore node = _pctrie_lookup_node(it->ptree, it->node, *val, &it->node, 55890710f4aSDoug Moore NULL, PCTRIE_LOCKED); 559d0b225d1SDoug Moore if (node == PCTRIE_NULL) { 56090710f4aSDoug Moore if (it->node == NULL) 561a905c589SDoug Moore pctrie_node_store(pctrie_root(it->ptree), 562d0b225d1SDoug Moore pctrie_toleaf(val), PCTRIE_LOCKED); 563d0b225d1SDoug Moore else 56490710f4aSDoug 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 */ 57790710f4aSDoug 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 /* 63190710f4aSDoug Moore * Find first leaf >= index, and fill iter with the path to the parent of that 63290710f4aSDoug Moore * leaf. Return NULL if there is no such leaf less than limit. 633f2cc1285SJeff Roberson */ 634bbf81f46SRyan Libby static __inline uint64_t * 63590710f4aSDoug Moore _pctrie_lookup_ge(struct pctrie *ptree, struct pctrie_node *node, 63690710f4aSDoug Moore uint64_t index, struct pctrie_node **parent_out, uint64_t limit) 637f2cc1285SJeff Roberson { 63890710f4aSDoug Moore struct pctrie_node *parent; 639f2cc1285SJeff Roberson uint64_t *m; 640d1139b52SConrad Meyer int slot; 641f2cc1285SJeff Roberson 64290710f4aSDoug Moore /* Seek a node that matches index. */ 64390710f4aSDoug Moore node = _pctrie_lookup_node(ptree, node, index, &parent, 64490710f4aSDoug Moore NULL, PCTRIE_LOCKED); 645f2cc1285SJeff Roberson 646f2cc1285SJeff Roberson /* 64790710f4aSDoug Moore * If no such node was found, and instead this path leads only to nodes 64890710f4aSDoug Moore * < index, back up to find a subtrie with the least value > index. 649f2cc1285SJeff Roberson */ 65090710f4aSDoug Moore if (node == PCTRIE_NULL || *pctrie_toval(node) < index) { 65190710f4aSDoug Moore /* Climb the path to find a node with a descendant > index. */ 65290710f4aSDoug Moore for (node = parent; node != NULL; node = pctrie_parent(node)) { 65390710f4aSDoug Moore slot = pctrie_slot(node, index) + 1; 65490710f4aSDoug Moore if ((node->pn_popmap >> slot) != 0) 65590710f4aSDoug Moore break; 65690710f4aSDoug Moore } 65790710f4aSDoug Moore if (node == NULL) { 65890710f4aSDoug Moore if (parent_out != NULL) 65990710f4aSDoug Moore *parent_out = NULL; 66090710f4aSDoug Moore return (NULL); 66190710f4aSDoug Moore } 66290710f4aSDoug Moore 66390710f4aSDoug Moore /* Step to the least child with a descendant > index. */ 66490710f4aSDoug Moore slot += ffs(node->pn_popmap >> slot) - 1; 66590710f4aSDoug Moore parent = node; 6666f251ef2SDoug Moore node = pctrie_node_load(&node->pn_child[slot], NULL, 6676f251ef2SDoug Moore PCTRIE_LOCKED); 668f2cc1285SJeff Roberson } 66990710f4aSDoug Moore /* Descend to the least leaf of the subtrie. */ 67090710f4aSDoug Moore while (!pctrie_isleaf(node)) { 67190710f4aSDoug Moore if (limit != 0 && node->pn_owner >= limit) 6726f251ef2SDoug Moore return (NULL); 67390710f4aSDoug Moore slot = ffs(node->pn_popmap) - 1; 67490710f4aSDoug Moore parent = node; 67590710f4aSDoug Moore node = pctrie_node_load(&node->pn_child[slot], NULL, 6766f251ef2SDoug Moore PCTRIE_LOCKED); 6776f251ef2SDoug Moore } 67890710f4aSDoug Moore if (parent_out != NULL) 67990710f4aSDoug Moore *parent_out = parent; 68090710f4aSDoug Moore m = pctrie_toval(node); 68190710f4aSDoug Moore if (limit != 0 && *m >= limit) 68290710f4aSDoug Moore return (NULL); 68390710f4aSDoug Moore return (m); 6846f251ef2SDoug Moore } 6856f251ef2SDoug Moore 686bbf81f46SRyan Libby uint64_t * 687bbf81f46SRyan Libby pctrie_lookup_ge(struct pctrie *ptree, uint64_t index) 688bbf81f46SRyan Libby { 68990710f4aSDoug 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 70190710f4aSDoug Moore m = _pctrie_lookup_ge(it->ptree, it->node, index, &it->node, it->limit); 70290710f4aSDoug 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 /* 72590710f4aSDoug Moore * Find first leaf <= index, and fill iter with the path to the parent of that 72690710f4aSDoug Moore * leaf. Return NULL if there is no such leaf greater than limit. 727f2cc1285SJeff Roberson */ 728bbf81f46SRyan Libby static __inline uint64_t * 72990710f4aSDoug Moore _pctrie_lookup_le(struct pctrie *ptree, struct pctrie_node *node, 73090710f4aSDoug Moore uint64_t index, struct pctrie_node **parent_out, uint64_t limit) 731f2cc1285SJeff Roberson { 73290710f4aSDoug Moore struct pctrie_node *parent; 733f2cc1285SJeff Roberson uint64_t *m; 734d1139b52SConrad Meyer int slot; 735f2cc1285SJeff Roberson 73690710f4aSDoug Moore /* Seek a node that matches index. */ 73790710f4aSDoug Moore node = _pctrie_lookup_node(ptree, node, index, &parent, NULL, 73890710f4aSDoug Moore PCTRIE_LOCKED); 73990710f4aSDoug Moore 7406f251ef2SDoug Moore /* 74190710f4aSDoug Moore * If no such node was found, and instead this path leads only to nodes 74290710f4aSDoug Moore * > index, back up to find a subtrie with the greatest value < index. 7436f251ef2SDoug Moore */ 74490710f4aSDoug Moore if (node == PCTRIE_NULL || *pctrie_toval(node) > index) { 74590710f4aSDoug Moore /* Climb the path to find a node with a descendant < index. */ 74690710f4aSDoug Moore for (node = parent; node != NULL; node = pctrie_parent(node)) { 74790710f4aSDoug Moore slot = pctrie_slot(node, index); 7486f251ef2SDoug Moore if ((node->pn_popmap & ((1 << slot) - 1)) != 0) 74990710f4aSDoug Moore break; 75090710f4aSDoug Moore } 75190710f4aSDoug Moore if (node == NULL) { 75290710f4aSDoug Moore if (parent_out != NULL) 75390710f4aSDoug Moore *parent_out = NULL; 75490710f4aSDoug Moore return (NULL); 75590710f4aSDoug Moore } 75690710f4aSDoug Moore 75790710f4aSDoug Moore /* Step to the greatest child with a descendant < index. */ 75890710f4aSDoug Moore slot = ilog2(node->pn_popmap & ((1 << slot) - 1)); 75990710f4aSDoug Moore parent = node; 7606f251ef2SDoug Moore node = pctrie_node_load(&node->pn_child[slot], NULL, 7613c30b235SConrad Meyer PCTRIE_LOCKED); 7628df38859SDoug Moore } 76390710f4aSDoug Moore /* Descend to the greatest leaf of the subtrie. */ 76490710f4aSDoug Moore while (!pctrie_isleaf(node)) { 76590710f4aSDoug Moore if (limit != 0 && limit >= node->pn_owner + 76690710f4aSDoug Moore ((uint64_t)PCTRIE_COUNT << node->pn_clev) - 1) 7676f251ef2SDoug Moore return (NULL); 76890710f4aSDoug Moore slot = ilog2(node->pn_popmap); 76990710f4aSDoug Moore parent = node; 77090710f4aSDoug Moore node = pctrie_node_load(&node->pn_child[slot], NULL, 7716f251ef2SDoug Moore PCTRIE_LOCKED); 772f2cc1285SJeff Roberson } 77390710f4aSDoug Moore if (parent_out != NULL) 77490710f4aSDoug Moore *parent_out = parent; 77590710f4aSDoug Moore m = pctrie_toval(node); 77690710f4aSDoug Moore if (limit != 0 && *m <= limit) 77790710f4aSDoug Moore return (NULL); 77890710f4aSDoug Moore return (m); 779f2cc1285SJeff Roberson } 780f2cc1285SJeff Roberson 781bbf81f46SRyan Libby uint64_t * 782bbf81f46SRyan Libby pctrie_lookup_le(struct pctrie *ptree, uint64_t index) 783bbf81f46SRyan Libby { 78490710f4aSDoug Moore return (_pctrie_lookup_le(ptree, NULL, index, NULL, 0)); 785bbf81f46SRyan Libby } 786bbf81f46SRyan Libby 787bbf81f46SRyan Libby uint64_t * 78890710f4aSDoug Moore pctrie_subtree_lookup_lt(struct pctrie *ptree, struct pctrie_node *node, 78990710f4aSDoug Moore uint64_t index) 790bbf81f46SRyan Libby { 79190710f4aSDoug Moore if (index == 0) 792bbf81f46SRyan Libby return (NULL); 79390710f4aSDoug 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 80590710f4aSDoug Moore m = _pctrie_lookup_le(it->ptree, it->node, index, &it->node, it->limit); 80690710f4aSDoug 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 82890710f4aSDoug Moore /* 829bba883dfSDoug Moore * Remove the non-NULL child identified by 'index' from the set of children of 830bba883dfSDoug Moore * 'node'. If doing so causes 'node' to have only one child, purge it from the 831bba883dfSDoug Moore * pctrie and save it in *freenode for later disposal. 83290710f4aSDoug Moore */ 833bba883dfSDoug Moore static void 83490710f4aSDoug Moore pctrie_remove(struct pctrie *ptree, struct pctrie_node *node, uint64_t index, 835bba883dfSDoug Moore struct pctrie_node **freenode) 836bbf81f46SRyan Libby { 837*c301c584SDoug Moore smr_pctnode_t *parentp; 838bba883dfSDoug Moore struct pctrie_node *child; 8398df38859SDoug Moore int slot; 840f2cc1285SJeff Roberson 84190710f4aSDoug Moore *freenode = NULL; 842*c301c584SDoug Moore parentp = pctrie_child(ptree, node, index); 8432d2bcba7SDoug Moore if (node == NULL) { 844*c301c584SDoug Moore pctrie_node_store(parentp, PCTRIE_NULL, PCTRIE_LOCKED); 845bba883dfSDoug Moore return; 846f2cc1285SJeff Roberson } 847fd1d6662SDoug Moore slot = pctrie_slot(node, index); 8488df38859SDoug Moore KASSERT((node->pn_popmap & (1 << slot)) != 0, 8498df38859SDoug Moore ("%s: bad popmap slot %d in node %p", 8508df38859SDoug Moore __func__, slot, node)); 8518df38859SDoug Moore node->pn_popmap ^= 1 << slot; 852*c301c584SDoug Moore if (!powerof2(node->pn_popmap)) { 853*c301c584SDoug Moore pctrie_node_store(parentp, PCTRIE_NULL, PCTRIE_LOCKED); 854bba883dfSDoug Moore return; 855*c301c584SDoug Moore } 856*c301c584SDoug Moore pctrie_node_store(parentp, PCTRIE_NULL, PCTRIE_UNSERIALIZED); 8572d2bcba7SDoug Moore KASSERT(node->pn_popmap != 0, ("%s: bad popmap all zeroes", __func__)); 8588df38859SDoug Moore slot = ffs(node->pn_popmap) - 1; 859*c301c584SDoug Moore *freenode = node; 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)); 86390710f4aSDoug Moore node = pctrie_parent(node); 86490710f4aSDoug Moore if (!pctrie_isleaf(child)) 86590710f4aSDoug Moore pctrie_setparent(child, node); 866*c301c584SDoug Moore parentp = pctrie_child(ptree, node, index); 867*c301c584SDoug Moore pctrie_node_store(parentp, child, PCTRIE_LOCKED); 868fd1d6662SDoug Moore } 869fd1d6662SDoug Moore 870fd1d6662SDoug Moore /* 871fd1d6662SDoug Moore * Remove the specified index from the tree, and return the value stored at 872fd1d6662SDoug Moore * that index. If the index is not present, return NULL. 873fd1d6662SDoug Moore */ 874fd1d6662SDoug Moore uint64_t * 875fd1d6662SDoug Moore pctrie_remove_lookup(struct pctrie *ptree, uint64_t index, 876fd1d6662SDoug Moore struct pctrie_node **freenode) 877fd1d6662SDoug Moore { 87890710f4aSDoug Moore struct pctrie_node *child, *node; 879bba883dfSDoug Moore uint64_t *m; 880fd1d6662SDoug Moore int slot; 881fd1d6662SDoug Moore 88290710f4aSDoug Moore node = NULL; 883fd1d6662SDoug Moore child = pctrie_root_load(ptree, NULL, PCTRIE_LOCKED); 884fd1d6662SDoug Moore while (!pctrie_isleaf(child)) { 885fd1d6662SDoug Moore node = child; 886fd1d6662SDoug Moore slot = pctrie_slot(node, index); 887fd1d6662SDoug Moore child = pctrie_node_load(&node->pn_child[slot], NULL, 888fd1d6662SDoug Moore PCTRIE_LOCKED); 889fd1d6662SDoug Moore } 890bba883dfSDoug Moore if ((m = pctrie_match_value(child, index)) != NULL) 891bba883dfSDoug Moore pctrie_remove(ptree, node, index, freenode); 892bba883dfSDoug Moore else 893bba883dfSDoug Moore *freenode = NULL; 894bba883dfSDoug Moore return (m); 895f2cc1285SJeff Roberson } 896f2cc1285SJeff Roberson 897f2cc1285SJeff Roberson /* 898fd1d6662SDoug Moore * Remove from the trie the leaf last chosen by the iterator, and 899fd1d6662SDoug Moore * adjust the path if it's last member is to be freed. 900fd1d6662SDoug Moore */ 901bba883dfSDoug Moore void 902fd1d6662SDoug Moore pctrie_iter_remove(struct pctrie_iter *it, struct pctrie_node **freenode) 903fd1d6662SDoug Moore { 904bba883dfSDoug Moore KASSERT(NULL != pctrie_match_value(pctrie_node_load(pctrie_child( 905bba883dfSDoug Moore it->ptree, it->node, it->index), NULL, PCTRIE_LOCKED), it->index), 9063f850550SDoug Moore ("%s: removing value %jx not at iter", __func__, 9073f850550SDoug Moore (uintmax_t)it->index)); 908bba883dfSDoug Moore pctrie_remove(it->ptree, it->node, it->index, freenode); 909fd1d6662SDoug Moore if (*freenode != NULL) 91090710f4aSDoug Moore it->node = pctrie_parent(it->node); 911fd1d6662SDoug Moore } 912fd1d6662SDoug Moore 913fd1d6662SDoug Moore /* 914fd1d6662SDoug Moore * Return the current leaf, assuming access is externally synchronized by a 915fd1d6662SDoug Moore * lock. 916fd1d6662SDoug Moore */ 917fd1d6662SDoug Moore uint64_t * 918fd1d6662SDoug Moore pctrie_iter_value(struct pctrie_iter *it) 919fd1d6662SDoug Moore { 920fd1d6662SDoug Moore struct pctrie_node *node; 921fd1d6662SDoug Moore 92290710f4aSDoug Moore node = pctrie_node_load(pctrie_child(it->ptree, it->node, it->index), 92390710f4aSDoug Moore NULL, PCTRIE_LOCKED); 924fd1d6662SDoug Moore return (pctrie_toval(node)); 925fd1d6662SDoug Moore } 926fd1d6662SDoug Moore 927fd1d6662SDoug Moore /* 92890710f4aSDoug Moore * Walk the subtrie rooted at *pnode in order, invoking callback on leaves, 92990710f4aSDoug Moore * until an interior node is stripped of all children, and returned for 93090710f4aSDoug Moore * deallocation, with *pnode left pointing to the parent of that node. 931f2cc1285SJeff Roberson */ 932c0d0bc2bSDoug Moore static __always_inline struct pctrie_node * 933c0d0bc2bSDoug Moore pctrie_reclaim_prune(struct pctrie_node **pnode, struct pctrie_node *parent, 934c0d0bc2bSDoug Moore pctrie_cb_t callback, int keyoff, void *arg) 935f2cc1285SJeff Roberson { 9363b7ffacdSDoug Moore struct pctrie_node *child, *node; 9373b7ffacdSDoug Moore int slot; 938f2cc1285SJeff Roberson 9393b7ffacdSDoug Moore node = *pnode; 9403b7ffacdSDoug Moore while (node->pn_popmap != 0) { 9413b7ffacdSDoug Moore slot = ffs(node->pn_popmap) - 1; 9423b7ffacdSDoug Moore node->pn_popmap ^= 1 << slot; 9433b7ffacdSDoug Moore child = pctrie_node_load(&node->pn_child[slot], NULL, 9443b7ffacdSDoug Moore PCTRIE_UNSERIALIZED); 9453b7ffacdSDoug Moore pctrie_node_store(&node->pn_child[slot], PCTRIE_NULL, 9463b7ffacdSDoug Moore PCTRIE_UNSERIALIZED); 947c0d0bc2bSDoug Moore if (pctrie_isleaf(child)) { 948c0d0bc2bSDoug Moore if (callback != NULL) 949c0d0bc2bSDoug Moore callback(pctrie_toptr(child, keyoff), arg); 9503b7ffacdSDoug Moore continue; 951c0d0bc2bSDoug Moore } 9523b7ffacdSDoug Moore /* Climb one level down the trie. */ 9533b7ffacdSDoug Moore parent = node; 9543b7ffacdSDoug Moore node = child; 9553b7ffacdSDoug Moore } 9563b7ffacdSDoug Moore *pnode = parent; 9573b7ffacdSDoug Moore return (node); 9583b7ffacdSDoug Moore } 9593b7ffacdSDoug Moore 9603b7ffacdSDoug Moore /* 9613b7ffacdSDoug Moore * Recover the node parent from its first child and continue pruning. 9623b7ffacdSDoug Moore */ 963c0d0bc2bSDoug Moore static __always_inline struct pctrie_node * 964c0d0bc2bSDoug Moore pctrie_reclaim_resume_compound(struct pctrie_node **pnode, 965c0d0bc2bSDoug Moore pctrie_cb_t callback, int keyoff, void *arg) 9663b7ffacdSDoug Moore { 96790710f4aSDoug Moore if (*pnode == NULL) 9683b7ffacdSDoug Moore return (NULL); 9693b7ffacdSDoug Moore /* Climb one level up the trie. */ 97090710f4aSDoug Moore return (pctrie_reclaim_prune(pnode, pctrie_parent(*pnode), callback, 97190710f4aSDoug Moore keyoff, arg)); 9723b7ffacdSDoug Moore } 9733b7ffacdSDoug Moore 9743b7ffacdSDoug Moore /* 9753b7ffacdSDoug Moore * Find the trie root, and start pruning with a NULL parent. 9763b7ffacdSDoug Moore */ 977c0d0bc2bSDoug Moore static __always_inline struct pctrie_node * 978c0d0bc2bSDoug Moore pctrie_reclaim_begin_compound(struct pctrie_node **pnode, 979c0d0bc2bSDoug Moore struct pctrie *ptree, 980c0d0bc2bSDoug Moore pctrie_cb_t callback, int keyoff, void *arg) 9813b7ffacdSDoug Moore { 9823b7ffacdSDoug Moore struct pctrie_node *node; 9833b7ffacdSDoug Moore 9843b7ffacdSDoug Moore node = pctrie_root_load(ptree, NULL, PCTRIE_UNSERIALIZED); 985a905c589SDoug Moore pctrie_node_store(pctrie_root(ptree), PCTRIE_NULL, PCTRIE_UNSERIALIZED); 986c0d0bc2bSDoug Moore if (pctrie_isleaf(node)) { 987c0d0bc2bSDoug Moore if (callback != NULL && node != PCTRIE_NULL) 988c0d0bc2bSDoug Moore callback(pctrie_toptr(node, keyoff), arg); 9893b7ffacdSDoug Moore return (NULL); 990c0d0bc2bSDoug Moore } 9913b7ffacdSDoug Moore *pnode = node; 992c0d0bc2bSDoug Moore return (pctrie_reclaim_prune(pnode, NULL, callback, keyoff, arg)); 993c0d0bc2bSDoug Moore } 994c0d0bc2bSDoug Moore 995c0d0bc2bSDoug Moore struct pctrie_node * 996c0d0bc2bSDoug Moore pctrie_reclaim_resume(struct pctrie_node **pnode) 997c0d0bc2bSDoug Moore { 998c0d0bc2bSDoug Moore return (pctrie_reclaim_resume_compound(pnode, NULL, 0, NULL)); 999c0d0bc2bSDoug Moore } 1000c0d0bc2bSDoug Moore 1001c0d0bc2bSDoug Moore struct pctrie_node * 1002c0d0bc2bSDoug Moore pctrie_reclaim_begin(struct pctrie_node **pnode, struct pctrie *ptree) 1003c0d0bc2bSDoug Moore { 1004c0d0bc2bSDoug Moore return (pctrie_reclaim_begin_compound(pnode, ptree, NULL, 0, NULL)); 1005c0d0bc2bSDoug Moore } 1006c0d0bc2bSDoug Moore 1007c0d0bc2bSDoug Moore struct pctrie_node * 1008c0d0bc2bSDoug Moore pctrie_reclaim_resume_cb(struct pctrie_node **pnode, 1009c0d0bc2bSDoug Moore pctrie_cb_t callback, int keyoff, void *arg) 1010c0d0bc2bSDoug Moore { 1011c0d0bc2bSDoug Moore return (pctrie_reclaim_resume_compound(pnode, callback, keyoff, arg)); 1012c0d0bc2bSDoug Moore } 1013c0d0bc2bSDoug Moore 1014c0d0bc2bSDoug Moore struct pctrie_node * 1015c0d0bc2bSDoug Moore pctrie_reclaim_begin_cb(struct pctrie_node **pnode, struct pctrie *ptree, 1016c0d0bc2bSDoug Moore pctrie_cb_t callback, int keyoff, void *arg) 1017c0d0bc2bSDoug Moore { 1018c0d0bc2bSDoug Moore return (pctrie_reclaim_begin_compound(pnode, ptree, 1019c0d0bc2bSDoug Moore callback, keyoff, arg)); 10203b7ffacdSDoug Moore } 10213b7ffacdSDoug Moore 10223b7ffacdSDoug Moore /* 10233b7ffacdSDoug Moore * Replace an existing value in the trie with another one. 10243b7ffacdSDoug Moore * Panics if there is not an old value in the trie at the new value's index. 10253b7ffacdSDoug Moore */ 10263b7ffacdSDoug Moore uint64_t * 10273b7ffacdSDoug Moore pctrie_replace(struct pctrie *ptree, uint64_t *newval) 10283b7ffacdSDoug Moore { 10293b7ffacdSDoug Moore struct pctrie_node *leaf, *parent, *node; 10303b7ffacdSDoug Moore uint64_t *m; 10313b7ffacdSDoug Moore uint64_t index; 10323b7ffacdSDoug Moore int slot; 10333b7ffacdSDoug Moore 10343b7ffacdSDoug Moore leaf = pctrie_toleaf(newval); 10353b7ffacdSDoug Moore index = *newval; 10363b7ffacdSDoug Moore node = pctrie_root_load(ptree, NULL, PCTRIE_LOCKED); 10373b7ffacdSDoug Moore parent = NULL; 10383b7ffacdSDoug Moore for (;;) { 10393b7ffacdSDoug Moore if (pctrie_isleaf(node)) { 10403b7ffacdSDoug Moore if ((m = pctrie_toval(node)) != NULL && *m == index) { 10413b7ffacdSDoug Moore if (parent == NULL) 1042a905c589SDoug Moore pctrie_node_store(pctrie_root(ptree), 10439147a0c9SDoug Moore leaf, PCTRIE_LOCKED); 10443b7ffacdSDoug Moore else 10453b7ffacdSDoug Moore pctrie_node_store( 10463b7ffacdSDoug Moore &parent->pn_child[slot], leaf, 10473b7ffacdSDoug Moore PCTRIE_LOCKED); 10483b7ffacdSDoug Moore return (m); 10493b7ffacdSDoug Moore } 10503b7ffacdSDoug Moore break; 10513b7ffacdSDoug Moore } 10523b7ffacdSDoug Moore if (pctrie_keybarr(node, index, &slot)) 10533b7ffacdSDoug Moore break; 10543b7ffacdSDoug Moore parent = node; 10553b7ffacdSDoug Moore node = pctrie_node_load(&node->pn_child[slot], NULL, 10563b7ffacdSDoug Moore PCTRIE_LOCKED); 10573b7ffacdSDoug Moore } 10583b7ffacdSDoug Moore panic("%s: original replacing value not found", __func__); 1059f2cc1285SJeff Roberson } 1060f2cc1285SJeff Roberson 1061f2cc1285SJeff Roberson #ifdef DDB 1062f2cc1285SJeff Roberson /* 1063f2cc1285SJeff Roberson * Show details about the given node. 1064f2cc1285SJeff Roberson */ 1065f2cc1285SJeff Roberson DB_SHOW_COMMAND(pctrienode, db_show_pctrienode) 1066f2cc1285SJeff Roberson { 10673c30b235SConrad Meyer struct pctrie_node *node, *tmp; 10688df38859SDoug Moore int slot; 10698df38859SDoug Moore pn_popmap_t popmap; 1070f2cc1285SJeff Roberson 1071f2cc1285SJeff Roberson if (!have_addr) 1072f2cc1285SJeff Roberson return; 1073f2cc1285SJeff Roberson node = (struct pctrie_node *)addr; 10748df38859SDoug Moore db_printf("node %p, owner %jx, children popmap %04x, level %u:\n", 10758df38859SDoug Moore (void *)node, (uintmax_t)node->pn_owner, node->pn_popmap, 107638f5cb1bSDoug Moore node->pn_clev / PCTRIE_WIDTH); 10778df38859SDoug Moore for (popmap = node->pn_popmap; popmap != 0; popmap ^= 1 << slot) { 10788df38859SDoug Moore slot = ffs(popmap) - 1; 10798df38859SDoug Moore tmp = pctrie_node_load(&node->pn_child[slot], NULL, 10803c30b235SConrad Meyer PCTRIE_UNSERIALIZED); 1081f2cc1285SJeff Roberson db_printf("slot: %d, val: %p, value: %p, clev: %d\n", 10828df38859SDoug Moore slot, (void *)tmp, 10833c30b235SConrad Meyer pctrie_isleaf(tmp) ? pctrie_toval(tmp) : NULL, 108438f5cb1bSDoug Moore node->pn_clev / PCTRIE_WIDTH); 1085f2cc1285SJeff Roberson } 10863c30b235SConrad Meyer } 1087f2cc1285SJeff Roberson #endif /* DDB */ 1088