106b4bf3eSWarner Losh /*- 206b4bf3eSWarner Losh * Copyright (c) 1998 Matthew Dillon. All Rights Reserved. 306b4bf3eSWarner Losh * Redistribution and use in source and binary forms, with or without 406b4bf3eSWarner Losh * modification, are permitted provided that the following conditions 506b4bf3eSWarner Losh * are met: 606b4bf3eSWarner Losh * 1. Redistributions of source code must retain the above copyright 706b4bf3eSWarner Losh * notice, this list of conditions and the following disclaimer. 806b4bf3eSWarner Losh * 2. Redistributions in binary form must reproduce the above copyright 906b4bf3eSWarner Losh * notice, this list of conditions and the following disclaimer in the 1006b4bf3eSWarner Losh * documentation and/or other materials provided with the distribution. 1169a28758SEd Maste * 3. Neither the name of the University nor the names of its contributors 1206b4bf3eSWarner Losh * may be used to endorse or promote products derived from this software 1306b4bf3eSWarner Losh * without specific prior written permission. 1406b4bf3eSWarner Losh * 1506b4bf3eSWarner Losh * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS 1606b4bf3eSWarner Losh * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 1706b4bf3eSWarner Losh * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1806b4bf3eSWarner Losh * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY 1906b4bf3eSWarner Losh * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2006b4bf3eSWarner Losh * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE 2106b4bf3eSWarner Losh * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 2206b4bf3eSWarner Losh * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 2306b4bf3eSWarner Losh * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 2406b4bf3eSWarner Losh * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 2506b4bf3eSWarner Losh * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 2606b4bf3eSWarner Losh */ 277090df5aSMatthew Dillon /* 287090df5aSMatthew Dillon * BLIST.C - Bitmap allocator/deallocator, using a radix tree with hinting 297090df5aSMatthew Dillon * 307090df5aSMatthew Dillon * This module implements a general bitmap allocator/deallocator. The 317090df5aSMatthew Dillon * allocator eats around 2 bits per 'block'. The module does not 32f565f395SEitan Adler * try to interpret the meaning of a 'block' other than to return 337090df5aSMatthew Dillon * SWAPBLK_NONE on an allocation failure. 347090df5aSMatthew Dillon * 357090df5aSMatthew Dillon * A radix tree is used to maintain the bitmap. Two radix constants are 367090df5aSMatthew Dillon * involved: One for the bitmaps contained in the leaf nodes (typically 377090df5aSMatthew Dillon * 32), and one for the meta nodes (typically 16). Both meta and leaf 387090df5aSMatthew Dillon * nodes have a hint field. This field gives us a hint as to the largest 397090df5aSMatthew Dillon * free contiguous range of blocks under the node. It may contain a 407090df5aSMatthew Dillon * value that is too high, but will never contain a value that is too 417090df5aSMatthew Dillon * low. When the radix tree is searched, allocation failures in subtrees 427090df5aSMatthew Dillon * update the hint. 437090df5aSMatthew Dillon * 447090df5aSMatthew Dillon * The radix tree also implements two collapsed states for meta nodes: 457090df5aSMatthew Dillon * the ALL-ALLOCATED state and the ALL-FREE state. If a meta node is 467090df5aSMatthew Dillon * in either of these two states, all information contained underneath 477090df5aSMatthew Dillon * the node is considered stale. These states are used to optimize 487090df5aSMatthew Dillon * allocation and freeing operations. 497090df5aSMatthew Dillon * 507090df5aSMatthew Dillon * The hinting greatly increases code efficiency for allocations while 517090df5aSMatthew Dillon * the general radix structure optimizes both allocations and frees. The 527090df5aSMatthew Dillon * radix tree should be able to operate well no matter how much 537090df5aSMatthew Dillon * fragmentation there is and no matter how large a bitmap is used. 547090df5aSMatthew Dillon * 5551dc4feaSSergey Kandaurov * The blist code wires all necessary memory at creation time. Neither 5651dc4feaSSergey Kandaurov * allocations nor frees require interaction with the memory subsystem. 5751dc4feaSSergey Kandaurov * The non-blocking features of the blist code are used in the swap code 5851dc4feaSSergey Kandaurov * (vm/swap_pager.c). 597090df5aSMatthew Dillon * 60e3043798SPedro F. Giffuni * LAYOUT: The radix tree is laid out recursively using a 61e3043798SPedro F. Giffuni * linear array. Each meta node is immediately followed (laid out 627090df5aSMatthew Dillon * sequentially in memory) by BLIST_META_RADIX lower level nodes. This 637090df5aSMatthew Dillon * is a recursive structure but one that can be easily scanned through 647090df5aSMatthew Dillon * a very simple 'skip' calculation. In order to support large radixes, 657090df5aSMatthew Dillon * portions of the tree may reside outside our memory allocation. We 667090df5aSMatthew Dillon * handle this with an early-termination optimization (when bighint is 677090df5aSMatthew Dillon * set to -1) on the scan. The memory allocation is only large enough 687090df5aSMatthew Dillon * to cover the number of blocks requested at creation time even if it 697090df5aSMatthew Dillon * must be encompassed in larger root-node radix. 707090df5aSMatthew Dillon * 71f565f395SEitan Adler * NOTE: the allocator cannot currently allocate more than 727090df5aSMatthew Dillon * BLIST_BMAP_RADIX blocks per call. It will panic with 'allocation too 737090df5aSMatthew Dillon * large' if you try. This is an area that could use improvement. The 747090df5aSMatthew Dillon * radix is large enough that this restriction does not effect the swap 757090df5aSMatthew Dillon * system, though. Currently only the allocation code is effected by 767090df5aSMatthew Dillon * this algorithmic unfeature. The freeing code can handle arbitrary 777090df5aSMatthew Dillon * ranges. 787090df5aSMatthew Dillon * 797090df5aSMatthew Dillon * This code can be compiled stand-alone for debugging. 807090df5aSMatthew Dillon */ 817090df5aSMatthew Dillon 82677b542eSDavid E. O'Brien #include <sys/cdefs.h> 83677b542eSDavid E. O'Brien __FBSDID("$FreeBSD$"); 84677b542eSDavid E. O'Brien 85c4473420SPeter Wemm #ifdef _KERNEL 867090df5aSMatthew Dillon 877090df5aSMatthew Dillon #include <sys/param.h> 887090df5aSMatthew Dillon #include <sys/systm.h> 897090df5aSMatthew Dillon #include <sys/lock.h> 907090df5aSMatthew Dillon #include <sys/kernel.h> 917090df5aSMatthew Dillon #include <sys/blist.h> 927090df5aSMatthew Dillon #include <sys/malloc.h> 930cddd8f0SMatthew Dillon #include <sys/proc.h> 9423955314SAlfred Perlstein #include <sys/mutex.h> 957090df5aSMatthew Dillon 967090df5aSMatthew Dillon #else 977090df5aSMatthew Dillon 987090df5aSMatthew Dillon #ifndef BLIST_NO_DEBUG 997090df5aSMatthew Dillon #define BLIST_DEBUG 1007090df5aSMatthew Dillon #endif 1017090df5aSMatthew Dillon 1027090df5aSMatthew Dillon #include <sys/types.h> 103d90bf7d8SAlan Cox #include <sys/malloc.h> 1047090df5aSMatthew Dillon #include <stdio.h> 1057090df5aSMatthew Dillon #include <string.h> 1067090df5aSMatthew Dillon #include <stdlib.h> 1077090df5aSMatthew Dillon #include <stdarg.h> 108*d3783724SAlan Cox #include <stdbool.h> 1097090df5aSMatthew Dillon 1104be4fd5dSAlan Cox #define bitcount64(x) __bitcount64((uint64_t)(x)) 11192da00bbSMatthew Dillon #define malloc(a,b,c) calloc(a, 1) 1127090df5aSMatthew Dillon #define free(a,b) free(a) 1137090df5aSMatthew Dillon 1147090df5aSMatthew Dillon #include <sys/blist.h> 1157090df5aSMatthew Dillon 1167090df5aSMatthew Dillon void panic(const char *ctl, ...); 1177090df5aSMatthew Dillon 1187090df5aSMatthew Dillon #endif 1197090df5aSMatthew Dillon 1207090df5aSMatthew Dillon /* 1217090df5aSMatthew Dillon * static support functions 1227090df5aSMatthew Dillon */ 1237090df5aSMatthew Dillon 1247090df5aSMatthew Dillon static daddr_t blst_leaf_alloc(blmeta_t *scan, daddr_t blk, int count); 125d4e3484bSAlan Cox static daddr_t blst_meta_alloc(blmeta_t *scan, daddr_t blk, daddr_t count, 126d4e3484bSAlan Cox daddr_t radix, daddr_t skip, daddr_t cursor); 1277090df5aSMatthew Dillon static void blst_leaf_free(blmeta_t *scan, daddr_t relblk, int count); 1287090df5aSMatthew Dillon static void blst_meta_free(blmeta_t *scan, daddr_t freeBlk, daddr_t count, 129*d3783724SAlan Cox daddr_t radix, daddr_t skip, daddr_t blk); 1307090df5aSMatthew Dillon static void blst_copy(blmeta_t *scan, daddr_t blk, daddr_t radix, 1317090df5aSMatthew Dillon daddr_t skip, blist_t dest, daddr_t count); 132a7249a6cSAlan Cox static daddr_t blst_leaf_fill(blmeta_t *scan, daddr_t blk, int count); 133a7249a6cSAlan Cox static daddr_t blst_meta_fill(blmeta_t *scan, daddr_t allocBlk, daddr_t count, 134*d3783724SAlan Cox daddr_t radix, daddr_t skip, daddr_t blk); 135*d3783724SAlan Cox static daddr_t blst_radix_init(blmeta_t *scan, daddr_t radix, daddr_t skip, 136*d3783724SAlan Cox daddr_t count); 137c4473420SPeter Wemm #ifndef _KERNEL 138*d3783724SAlan Cox static void blst_radix_print(blmeta_t *scan, daddr_t blk, daddr_t radix, 139*d3783724SAlan Cox daddr_t skip, int tab); 1407090df5aSMatthew Dillon #endif 1417090df5aSMatthew Dillon 142c4473420SPeter Wemm #ifdef _KERNEL 1437090df5aSMatthew Dillon static MALLOC_DEFINE(M_SWAP, "SWAP", "Swap space"); 1447090df5aSMatthew Dillon #endif 1457090df5aSMatthew Dillon 1467090df5aSMatthew Dillon /* 1477090df5aSMatthew Dillon * blist_create() - create a blist capable of handling up to the specified 1487090df5aSMatthew Dillon * number of blocks 1497090df5aSMatthew Dillon * 150f565f395SEitan Adler * blocks - must be greater than 0 151c8c7ad92SKip Macy * flags - malloc flags 1527090df5aSMatthew Dillon * 1537090df5aSMatthew Dillon * The smallest blist consists of a single leaf node capable of 1547090df5aSMatthew Dillon * managing BLIST_BMAP_RADIX blocks. 1557090df5aSMatthew Dillon */ 1567090df5aSMatthew Dillon 1577090df5aSMatthew Dillon blist_t 158c8c7ad92SKip Macy blist_create(daddr_t blocks, int flags) 1597090df5aSMatthew Dillon { 1607090df5aSMatthew Dillon blist_t bl; 161*d3783724SAlan Cox daddr_t nodes, radix, skip; 1627090df5aSMatthew Dillon 1637090df5aSMatthew Dillon /* 1647090df5aSMatthew Dillon * Calculate radix and skip field used for scanning. 1657090df5aSMatthew Dillon */ 1667090df5aSMatthew Dillon radix = BLIST_BMAP_RADIX; 167*d3783724SAlan Cox skip = 0; 1687090df5aSMatthew Dillon while (radix < blocks) { 16957e6d29bSMatthew Dillon radix *= BLIST_META_RADIX; 17057e6d29bSMatthew Dillon skip = (skip + 1) * BLIST_META_RADIX; 1717090df5aSMatthew Dillon } 172*d3783724SAlan Cox nodes = 1 + blst_radix_init(NULL, radix, skip, blocks); 1737090df5aSMatthew Dillon 1744be4fd5dSAlan Cox bl = malloc(sizeof(struct blist), M_SWAP, flags); 175015d7db6SAlan Cox if (bl == NULL) 176015d7db6SAlan Cox return (NULL); 1777090df5aSMatthew Dillon 1787090df5aSMatthew Dillon bl->bl_blocks = blocks; 1797090df5aSMatthew Dillon bl->bl_radix = radix; 1807090df5aSMatthew Dillon bl->bl_skip = skip; 181d4e3484bSAlan Cox bl->bl_cursor = 0; 182015d7db6SAlan Cox bl->bl_root = malloc(nodes * sizeof(blmeta_t), M_SWAP, flags); 183015d7db6SAlan Cox if (bl->bl_root == NULL) { 184015d7db6SAlan Cox free(bl, M_SWAP); 185015d7db6SAlan Cox return (NULL); 186015d7db6SAlan Cox } 187*d3783724SAlan Cox blst_radix_init(bl->bl_root, radix, skip, blocks); 1887090df5aSMatthew Dillon 1897090df5aSMatthew Dillon #if defined(BLIST_DEBUG) 1907090df5aSMatthew Dillon printf( 19192da00bbSMatthew Dillon "BLIST representing %lld blocks (%lld MB of swap)" 19292da00bbSMatthew Dillon ", requiring %lldK of ram\n", 19392da00bbSMatthew Dillon (long long)bl->bl_blocks, 19492da00bbSMatthew Dillon (long long)bl->bl_blocks * 4 / 1024, 195015d7db6SAlan Cox (long long)(nodes * sizeof(blmeta_t) + 1023) / 1024 1967090df5aSMatthew Dillon ); 19792da00bbSMatthew Dillon printf("BLIST raw radix tree contains %lld records\n", 198015d7db6SAlan Cox (long long)nodes); 1997090df5aSMatthew Dillon #endif 2007090df5aSMatthew Dillon 2017090df5aSMatthew Dillon return (bl); 2027090df5aSMatthew Dillon } 2037090df5aSMatthew Dillon 2047090df5aSMatthew Dillon void 2057090df5aSMatthew Dillon blist_destroy(blist_t bl) 2067090df5aSMatthew Dillon { 2077090df5aSMatthew Dillon free(bl->bl_root, M_SWAP); 2087090df5aSMatthew Dillon free(bl, M_SWAP); 2097090df5aSMatthew Dillon } 2107090df5aSMatthew Dillon 2117090df5aSMatthew Dillon /* 2127090df5aSMatthew Dillon * blist_alloc() - reserve space in the block bitmap. Return the base 2137090df5aSMatthew Dillon * of a contiguous region or SWAPBLK_NONE if space could 2147090df5aSMatthew Dillon * not be allocated. 2157090df5aSMatthew Dillon */ 2167090df5aSMatthew Dillon 2177090df5aSMatthew Dillon daddr_t 2187090df5aSMatthew Dillon blist_alloc(blist_t bl, daddr_t count) 2197090df5aSMatthew Dillon { 2204be4fd5dSAlan Cox daddr_t blk; 2217090df5aSMatthew Dillon 222d4e3484bSAlan Cox /* 223d4e3484bSAlan Cox * This loop iterates at most twice. An allocation failure in the 224d4e3484bSAlan Cox * first iteration leads to a second iteration only if the cursor was 225d4e3484bSAlan Cox * non-zero. When the cursor is zero, an allocation failure will 226d4e3484bSAlan Cox * reduce the hint, stopping further iterations. 227d4e3484bSAlan Cox */ 228d4e3484bSAlan Cox while (count <= bl->bl_root->bm_bighint) { 2297090df5aSMatthew Dillon if (bl->bl_radix == BLIST_BMAP_RADIX) 2307090df5aSMatthew Dillon blk = blst_leaf_alloc(bl->bl_root, 0, count); 2317090df5aSMatthew Dillon else 2324be4fd5dSAlan Cox blk = blst_meta_alloc(bl->bl_root, 0, count, 233d4e3484bSAlan Cox bl->bl_radix, bl->bl_skip, bl->bl_cursor); 234d4e3484bSAlan Cox if (blk != SWAPBLK_NONE) { 235d4e3484bSAlan Cox bl->bl_cursor = blk + count; 2367090df5aSMatthew Dillon return (blk); 237d4e3484bSAlan Cox } else if (bl->bl_cursor != 0) 238d4e3484bSAlan Cox bl->bl_cursor = 0; 2397090df5aSMatthew Dillon } 2404be4fd5dSAlan Cox return (SWAPBLK_NONE); 2414be4fd5dSAlan Cox } 2424be4fd5dSAlan Cox 2434be4fd5dSAlan Cox /* 2444be4fd5dSAlan Cox * blist_avail() - return the number of free blocks. 2454be4fd5dSAlan Cox */ 2464be4fd5dSAlan Cox 2474be4fd5dSAlan Cox daddr_t 2484be4fd5dSAlan Cox blist_avail(blist_t bl) 2494be4fd5dSAlan Cox { 2504be4fd5dSAlan Cox 2514be4fd5dSAlan Cox if (bl->bl_radix == BLIST_BMAP_RADIX) 2524be4fd5dSAlan Cox return (bitcount64(bl->bl_root->u.bmu_bitmap)); 2534be4fd5dSAlan Cox else 2544be4fd5dSAlan Cox return (bl->bl_root->u.bmu_avail); 2554be4fd5dSAlan Cox } 2567090df5aSMatthew Dillon 2577090df5aSMatthew Dillon /* 2587090df5aSMatthew Dillon * blist_free() - free up space in the block bitmap. Return the base 2597090df5aSMatthew Dillon * of a contiguous region. Panic if an inconsistancy is 2607090df5aSMatthew Dillon * found. 2617090df5aSMatthew Dillon */ 2627090df5aSMatthew Dillon 2637090df5aSMatthew Dillon void 2647090df5aSMatthew Dillon blist_free(blist_t bl, daddr_t blkno, daddr_t count) 2657090df5aSMatthew Dillon { 2667090df5aSMatthew Dillon if (bl) { 2677090df5aSMatthew Dillon if (bl->bl_radix == BLIST_BMAP_RADIX) 2687090df5aSMatthew Dillon blst_leaf_free(bl->bl_root, blkno, count); 2697090df5aSMatthew Dillon else 2704be4fd5dSAlan Cox blst_meta_free(bl->bl_root, blkno, count, 2714be4fd5dSAlan Cox bl->bl_radix, bl->bl_skip, 0); 2727090df5aSMatthew Dillon } 2737090df5aSMatthew Dillon } 2747090df5aSMatthew Dillon 2757090df5aSMatthew Dillon /* 27692da00bbSMatthew Dillon * blist_fill() - mark a region in the block bitmap as off-limits 27792da00bbSMatthew Dillon * to the allocator (i.e. allocate it), ignoring any 27892da00bbSMatthew Dillon * existing allocations. Return the number of blocks 27992da00bbSMatthew Dillon * actually filled that were free before the call. 28092da00bbSMatthew Dillon */ 28192da00bbSMatthew Dillon 282a7249a6cSAlan Cox daddr_t 28392da00bbSMatthew Dillon blist_fill(blist_t bl, daddr_t blkno, daddr_t count) 28492da00bbSMatthew Dillon { 285a7249a6cSAlan Cox daddr_t filled; 28692da00bbSMatthew Dillon 28792da00bbSMatthew Dillon if (bl) { 28892da00bbSMatthew Dillon if (bl->bl_radix == BLIST_BMAP_RADIX) 28992da00bbSMatthew Dillon filled = blst_leaf_fill(bl->bl_root, blkno, count); 29092da00bbSMatthew Dillon else 29192da00bbSMatthew Dillon filled = blst_meta_fill(bl->bl_root, blkno, count, 29292da00bbSMatthew Dillon bl->bl_radix, bl->bl_skip, 0); 2934be4fd5dSAlan Cox return (filled); 2944be4fd5dSAlan Cox } 2954be4fd5dSAlan Cox return (0); 29692da00bbSMatthew Dillon } 29792da00bbSMatthew Dillon 29892da00bbSMatthew Dillon /* 2997090df5aSMatthew Dillon * blist_resize() - resize an existing radix tree to handle the 3007090df5aSMatthew Dillon * specified number of blocks. This will reallocate 3017090df5aSMatthew Dillon * the tree and transfer the previous bitmap to the new 3027090df5aSMatthew Dillon * one. When extending the tree you can specify whether 3037090df5aSMatthew Dillon * the new blocks are to left allocated or freed. 3047090df5aSMatthew Dillon */ 3057090df5aSMatthew Dillon 3067090df5aSMatthew Dillon void 307c8c7ad92SKip Macy blist_resize(blist_t *pbl, daddr_t count, int freenew, int flags) 3087090df5aSMatthew Dillon { 309c8c7ad92SKip Macy blist_t newbl = blist_create(count, flags); 3107090df5aSMatthew Dillon blist_t save = *pbl; 3117090df5aSMatthew Dillon 3127090df5aSMatthew Dillon *pbl = newbl; 3137090df5aSMatthew Dillon if (count > save->bl_blocks) 3147090df5aSMatthew Dillon count = save->bl_blocks; 3157090df5aSMatthew Dillon blst_copy(save->bl_root, 0, save->bl_radix, save->bl_skip, newbl, count); 3167090df5aSMatthew Dillon 3177090df5aSMatthew Dillon /* 3187090df5aSMatthew Dillon * If resizing upwards, should we free the new space or not? 3197090df5aSMatthew Dillon */ 3207090df5aSMatthew Dillon if (freenew && count < newbl->bl_blocks) { 3217090df5aSMatthew Dillon blist_free(newbl, count, newbl->bl_blocks - count); 3227090df5aSMatthew Dillon } 3237090df5aSMatthew Dillon blist_destroy(save); 3247090df5aSMatthew Dillon } 3257090df5aSMatthew Dillon 3267090df5aSMatthew Dillon #ifdef BLIST_DEBUG 3277090df5aSMatthew Dillon 3287090df5aSMatthew Dillon /* 3297090df5aSMatthew Dillon * blist_print() - dump radix tree 3307090df5aSMatthew Dillon */ 3317090df5aSMatthew Dillon 3327090df5aSMatthew Dillon void 3337090df5aSMatthew Dillon blist_print(blist_t bl) 3347090df5aSMatthew Dillon { 3357090df5aSMatthew Dillon printf("BLIST {\n"); 3367090df5aSMatthew Dillon blst_radix_print(bl->bl_root, 0, bl->bl_radix, bl->bl_skip, 4); 3377090df5aSMatthew Dillon printf("}\n"); 3387090df5aSMatthew Dillon } 3397090df5aSMatthew Dillon 3407090df5aSMatthew Dillon #endif 3417090df5aSMatthew Dillon 3427090df5aSMatthew Dillon /************************************************************************ 3437090df5aSMatthew Dillon * ALLOCATION SUPPORT FUNCTIONS * 3447090df5aSMatthew Dillon ************************************************************************ 3457090df5aSMatthew Dillon * 3467090df5aSMatthew Dillon * These support functions do all the actual work. They may seem 3477090df5aSMatthew Dillon * rather longish, but that's because I've commented them up. The 3487090df5aSMatthew Dillon * actual code is straight forward. 3497090df5aSMatthew Dillon * 3507090df5aSMatthew Dillon */ 3517090df5aSMatthew Dillon 3527090df5aSMatthew Dillon /* 3537090df5aSMatthew Dillon * blist_leaf_alloc() - allocate at a leaf in the radix tree (a bitmap). 3547090df5aSMatthew Dillon * 3557090df5aSMatthew Dillon * This is the core of the allocator and is optimized for the 1 block 3567090df5aSMatthew Dillon * and the BLIST_BMAP_RADIX block allocation cases. Other cases are 3577090df5aSMatthew Dillon * somewhat slower. The 1 block allocation case is log2 and extremely 3587090df5aSMatthew Dillon * quick. 3597090df5aSMatthew Dillon */ 3607090df5aSMatthew Dillon 3617090df5aSMatthew Dillon static daddr_t 3627090df5aSMatthew Dillon blst_leaf_alloc( 3637090df5aSMatthew Dillon blmeta_t *scan, 3647090df5aSMatthew Dillon daddr_t blk, 3657090df5aSMatthew Dillon int count 3667090df5aSMatthew Dillon ) { 3677090df5aSMatthew Dillon u_daddr_t orig = scan->u.bmu_bitmap; 3687090df5aSMatthew Dillon 3697090df5aSMatthew Dillon if (orig == 0) { 3707090df5aSMatthew Dillon /* 3717090df5aSMatthew Dillon * Optimize bitmap all-allocated case. Also, count = 1 3727090df5aSMatthew Dillon * case assumes at least 1 bit is free in the bitmap, so 3737090df5aSMatthew Dillon * we have to take care of this case here. 3747090df5aSMatthew Dillon */ 3757090df5aSMatthew Dillon scan->bm_bighint = 0; 3767090df5aSMatthew Dillon return(SWAPBLK_NONE); 3777090df5aSMatthew Dillon } 3787090df5aSMatthew Dillon if (count == 1) { 3797090df5aSMatthew Dillon /* 3807090df5aSMatthew Dillon * Optimized code to allocate one bit out of the bitmap 3817090df5aSMatthew Dillon */ 3827090df5aSMatthew Dillon u_daddr_t mask; 3837090df5aSMatthew Dillon int j = BLIST_BMAP_RADIX/2; 3847090df5aSMatthew Dillon int r = 0; 3857090df5aSMatthew Dillon 3867090df5aSMatthew Dillon mask = (u_daddr_t)-1 >> (BLIST_BMAP_RADIX/2); 3877090df5aSMatthew Dillon 3887090df5aSMatthew Dillon while (j) { 3897090df5aSMatthew Dillon if ((orig & mask) == 0) { 3907090df5aSMatthew Dillon r += j; 3917090df5aSMatthew Dillon orig >>= j; 3927090df5aSMatthew Dillon } 3937090df5aSMatthew Dillon j >>= 1; 3947090df5aSMatthew Dillon mask >>= j; 3957090df5aSMatthew Dillon } 396064650c1SAlan Cox scan->u.bmu_bitmap &= ~((u_daddr_t)1 << r); 3977090df5aSMatthew Dillon return(blk + r); 3987090df5aSMatthew Dillon } 3997090df5aSMatthew Dillon if (count <= BLIST_BMAP_RADIX) { 4007090df5aSMatthew Dillon /* 4017090df5aSMatthew Dillon * non-optimized code to allocate N bits out of the bitmap. 4027090df5aSMatthew Dillon * The more bits, the faster the code runs. It will run 4037090df5aSMatthew Dillon * the slowest allocating 2 bits, but since there aren't any 4047090df5aSMatthew Dillon * memory ops in the core loop (or shouldn't be, anyway), 4057090df5aSMatthew Dillon * you probably won't notice the difference. 4067090df5aSMatthew Dillon */ 4077090df5aSMatthew Dillon int j; 4087090df5aSMatthew Dillon int n = BLIST_BMAP_RADIX - count; 4097090df5aSMatthew Dillon u_daddr_t mask; 4107090df5aSMatthew Dillon 4117090df5aSMatthew Dillon mask = (u_daddr_t)-1 >> n; 4127090df5aSMatthew Dillon 4137090df5aSMatthew Dillon for (j = 0; j <= n; ++j) { 4147090df5aSMatthew Dillon if ((orig & mask) == mask) { 4157090df5aSMatthew Dillon scan->u.bmu_bitmap &= ~mask; 4167090df5aSMatthew Dillon return(blk + j); 4177090df5aSMatthew Dillon } 4187090df5aSMatthew Dillon mask = (mask << 1); 4197090df5aSMatthew Dillon } 4207090df5aSMatthew Dillon } 4217090df5aSMatthew Dillon /* 4227090df5aSMatthew Dillon * We couldn't allocate count in this subtree, update bighint. 4237090df5aSMatthew Dillon */ 4247090df5aSMatthew Dillon scan->bm_bighint = count - 1; 4257090df5aSMatthew Dillon return(SWAPBLK_NONE); 4267090df5aSMatthew Dillon } 4277090df5aSMatthew Dillon 4287090df5aSMatthew Dillon /* 4297090df5aSMatthew Dillon * blist_meta_alloc() - allocate at a meta in the radix tree. 4307090df5aSMatthew Dillon * 4317090df5aSMatthew Dillon * Attempt to allocate at a meta node. If we can't, we update 4327090df5aSMatthew Dillon * bighint and return a failure. Updating bighint optimize future 4337090df5aSMatthew Dillon * calls that hit this node. We have to check for our collapse cases 4347090df5aSMatthew Dillon * and we have a few optimizations strewn in as well. 4357090df5aSMatthew Dillon */ 4367090df5aSMatthew Dillon 4377090df5aSMatthew Dillon static daddr_t 438d4e3484bSAlan Cox blst_meta_alloc(blmeta_t *scan, daddr_t blk, daddr_t count, daddr_t radix, 439d4e3484bSAlan Cox daddr_t skip, daddr_t cursor) 440d4e3484bSAlan Cox { 441d4e3484bSAlan Cox daddr_t i, next_skip, r; 442d4e3484bSAlan Cox int child; 443d4e3484bSAlan Cox bool scan_from_start; 4447090df5aSMatthew Dillon 4454be4fd5dSAlan Cox if (scan->u.bmu_avail < count) { 4467090df5aSMatthew Dillon /* 4474be4fd5dSAlan Cox * The meta node's hint must be too large if the allocation 4484be4fd5dSAlan Cox * exceeds the number of free blocks. Reduce the hint, and 4494be4fd5dSAlan Cox * return failure. 4507090df5aSMatthew Dillon */ 4514be4fd5dSAlan Cox scan->bm_bighint = scan->u.bmu_avail; 4527090df5aSMatthew Dillon return (SWAPBLK_NONE); 4537090df5aSMatthew Dillon } 454d4e3484bSAlan Cox next_skip = skip / BLIST_META_RADIX; 4557090df5aSMatthew Dillon 4564be4fd5dSAlan Cox /* 4574be4fd5dSAlan Cox * An ALL-FREE meta node requires special handling before allocating 4584be4fd5dSAlan Cox * any of its blocks. 4594be4fd5dSAlan Cox */ 4607090df5aSMatthew Dillon if (scan->u.bmu_avail == radix) { 46157e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 4627090df5aSMatthew Dillon 4637090df5aSMatthew Dillon /* 4644be4fd5dSAlan Cox * Reinitialize each of the meta node's children. An ALL-FREE 4654be4fd5dSAlan Cox * meta node cannot have a terminator in any subtree. 4667090df5aSMatthew Dillon */ 4677090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 468d4e3484bSAlan Cox if (next_skip == 1) 4697090df5aSMatthew Dillon scan[i].u.bmu_bitmap = (u_daddr_t)-1; 470d4e3484bSAlan Cox else 4717090df5aSMatthew Dillon scan[i].u.bmu_avail = radix; 472d4e3484bSAlan Cox scan[i].bm_bighint = radix; 4737090df5aSMatthew Dillon } 4747090df5aSMatthew Dillon } else { 47557e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 4767090df5aSMatthew Dillon } 4777090df5aSMatthew Dillon 4784be4fd5dSAlan Cox if (count > radix) { 4794be4fd5dSAlan Cox /* 4804be4fd5dSAlan Cox * The allocation exceeds the number of blocks that are 4814be4fd5dSAlan Cox * managed by a subtree of this meta node. 4824be4fd5dSAlan Cox */ 4834be4fd5dSAlan Cox panic("allocation too large"); 4844be4fd5dSAlan Cox } 485d4e3484bSAlan Cox scan_from_start = cursor == blk; 486d4e3484bSAlan Cox child = (cursor - blk) / radix; 487d4e3484bSAlan Cox blk += child * radix; 488d4e3484bSAlan Cox for (i = 1 + child * next_skip; i <= skip; i += next_skip) { 4897090df5aSMatthew Dillon if (count <= scan[i].bm_bighint) { 4907090df5aSMatthew Dillon /* 4914be4fd5dSAlan Cox * The allocation might fit in the i'th subtree. 4927090df5aSMatthew Dillon */ 4937090df5aSMatthew Dillon if (next_skip == 1) { 4947090df5aSMatthew Dillon r = blst_leaf_alloc(&scan[i], blk, count); 4957090df5aSMatthew Dillon } else { 4964be4fd5dSAlan Cox r = blst_meta_alloc(&scan[i], blk, count, 497d4e3484bSAlan Cox radix, next_skip - 1, cursor > blk ? 498d4e3484bSAlan Cox cursor : blk); 4997090df5aSMatthew Dillon } 5007090df5aSMatthew Dillon if (r != SWAPBLK_NONE) { 5017090df5aSMatthew Dillon scan->u.bmu_avail -= count; 5027090df5aSMatthew Dillon return (r); 5037090df5aSMatthew Dillon } 5047090df5aSMatthew Dillon } else if (scan[i].bm_bighint == (daddr_t)-1) { 5057090df5aSMatthew Dillon /* 5067090df5aSMatthew Dillon * Terminator 5077090df5aSMatthew Dillon */ 5087090df5aSMatthew Dillon break; 5097090df5aSMatthew Dillon } 5107090df5aSMatthew Dillon blk += radix; 5117090df5aSMatthew Dillon } 5127090df5aSMatthew Dillon 5137090df5aSMatthew Dillon /* 5147090df5aSMatthew Dillon * We couldn't allocate count in this subtree, update bighint. 5157090df5aSMatthew Dillon */ 516d4e3484bSAlan Cox if (scan_from_start && scan->bm_bighint >= count) 5177090df5aSMatthew Dillon scan->bm_bighint = count - 1; 518d4e3484bSAlan Cox 5197090df5aSMatthew Dillon return (SWAPBLK_NONE); 5207090df5aSMatthew Dillon } 5217090df5aSMatthew Dillon 5227090df5aSMatthew Dillon /* 5237090df5aSMatthew Dillon * BLST_LEAF_FREE() - free allocated block from leaf bitmap 5247090df5aSMatthew Dillon * 5257090df5aSMatthew Dillon */ 5267090df5aSMatthew Dillon 5277090df5aSMatthew Dillon static void 5287090df5aSMatthew Dillon blst_leaf_free( 5297090df5aSMatthew Dillon blmeta_t *scan, 5307090df5aSMatthew Dillon daddr_t blk, 5317090df5aSMatthew Dillon int count 5327090df5aSMatthew Dillon ) { 5337090df5aSMatthew Dillon /* 5347090df5aSMatthew Dillon * free some data in this bitmap 5357090df5aSMatthew Dillon * 5367090df5aSMatthew Dillon * e.g. 5377090df5aSMatthew Dillon * 0000111111111110000 5387090df5aSMatthew Dillon * \_________/\__/ 5397090df5aSMatthew Dillon * v n 5407090df5aSMatthew Dillon */ 5417090df5aSMatthew Dillon int n = blk & (BLIST_BMAP_RADIX - 1); 5427090df5aSMatthew Dillon u_daddr_t mask; 5437090df5aSMatthew Dillon 5447090df5aSMatthew Dillon mask = ((u_daddr_t)-1 << n) & 5457090df5aSMatthew Dillon ((u_daddr_t)-1 >> (BLIST_BMAP_RADIX - count - n)); 5467090df5aSMatthew Dillon 5477090df5aSMatthew Dillon if (scan->u.bmu_bitmap & mask) 5487090df5aSMatthew Dillon panic("blst_radix_free: freeing free block"); 5497090df5aSMatthew Dillon scan->u.bmu_bitmap |= mask; 5507090df5aSMatthew Dillon 5517090df5aSMatthew Dillon /* 5527090df5aSMatthew Dillon * We could probably do a better job here. We are required to make 5537090df5aSMatthew Dillon * bighint at least as large as the biggest contiguous block of 5547090df5aSMatthew Dillon * data. If we just shoehorn it, a little extra overhead will 5557090df5aSMatthew Dillon * be incured on the next allocation (but only that one typically). 5567090df5aSMatthew Dillon */ 5577090df5aSMatthew Dillon scan->bm_bighint = BLIST_BMAP_RADIX; 5587090df5aSMatthew Dillon } 5597090df5aSMatthew Dillon 5607090df5aSMatthew Dillon /* 5617090df5aSMatthew Dillon * BLST_META_FREE() - free allocated blocks from radix tree meta info 5627090df5aSMatthew Dillon * 5637090df5aSMatthew Dillon * This support routine frees a range of blocks from the bitmap. 5647090df5aSMatthew Dillon * The range must be entirely enclosed by this radix node. If a 5657090df5aSMatthew Dillon * meta node, we break the range down recursively to free blocks 5667090df5aSMatthew Dillon * in subnodes (which means that this code can free an arbitrary 5677090df5aSMatthew Dillon * range whereas the allocation code cannot allocate an arbitrary 5687090df5aSMatthew Dillon * range). 5697090df5aSMatthew Dillon */ 5707090df5aSMatthew Dillon 5717090df5aSMatthew Dillon static void 572*d3783724SAlan Cox blst_meta_free(blmeta_t *scan, daddr_t freeBlk, daddr_t count, daddr_t radix, 573*d3783724SAlan Cox daddr_t skip, daddr_t blk) 574*d3783724SAlan Cox { 575*d3783724SAlan Cox daddr_t i, next_skip, v; 576*d3783724SAlan Cox int child; 5777090df5aSMatthew Dillon 5787090df5aSMatthew Dillon #if 0 5791ede983cSDag-Erling Smørgrav printf("free (%llx,%lld) FROM (%llx,%lld)\n", 58092da00bbSMatthew Dillon (long long)freeBlk, (long long)count, 58192da00bbSMatthew Dillon (long long)blk, (long long)radix 5827090df5aSMatthew Dillon ); 5837090df5aSMatthew Dillon #endif 584*d3783724SAlan Cox next_skip = skip / BLIST_META_RADIX; 5857090df5aSMatthew Dillon 5867090df5aSMatthew Dillon if (scan->u.bmu_avail == 0) { 5877090df5aSMatthew Dillon /* 5887090df5aSMatthew Dillon * ALL-ALLOCATED special case, with possible 5897090df5aSMatthew Dillon * shortcut to ALL-FREE special case. 5907090df5aSMatthew Dillon */ 5917090df5aSMatthew Dillon scan->u.bmu_avail = count; 5927090df5aSMatthew Dillon scan->bm_bighint = count; 5937090df5aSMatthew Dillon 5947090df5aSMatthew Dillon if (count != radix) { 5957090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 5967090df5aSMatthew Dillon if (scan[i].bm_bighint == (daddr_t)-1) 5977090df5aSMatthew Dillon break; 5987090df5aSMatthew Dillon scan[i].bm_bighint = 0; 5997090df5aSMatthew Dillon if (next_skip == 1) { 6007090df5aSMatthew Dillon scan[i].u.bmu_bitmap = 0; 6017090df5aSMatthew Dillon } else { 6027090df5aSMatthew Dillon scan[i].u.bmu_avail = 0; 6037090df5aSMatthew Dillon } 6047090df5aSMatthew Dillon } 6057090df5aSMatthew Dillon /* fall through */ 6067090df5aSMatthew Dillon } 6077090df5aSMatthew Dillon } else { 6087090df5aSMatthew Dillon scan->u.bmu_avail += count; 6097090df5aSMatthew Dillon /* scan->bm_bighint = radix; */ 6107090df5aSMatthew Dillon } 6117090df5aSMatthew Dillon 6127090df5aSMatthew Dillon /* 6137090df5aSMatthew Dillon * ALL-FREE special case. 6147090df5aSMatthew Dillon */ 6157090df5aSMatthew Dillon 6167090df5aSMatthew Dillon if (scan->u.bmu_avail == radix) 6177090df5aSMatthew Dillon return; 6187090df5aSMatthew Dillon if (scan->u.bmu_avail > radix) 619bdc9a8d0SJohn Baldwin panic("blst_meta_free: freeing already free blocks (%lld) %lld/%lld", 620bdc9a8d0SJohn Baldwin (long long)count, (long long)scan->u.bmu_avail, 621bdc9a8d0SJohn Baldwin (long long)radix); 6227090df5aSMatthew Dillon 6237090df5aSMatthew Dillon /* 6247090df5aSMatthew Dillon * Break the free down into its components 6257090df5aSMatthew Dillon */ 6267090df5aSMatthew Dillon 62757e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 6287090df5aSMatthew Dillon 629*d3783724SAlan Cox child = (freeBlk - blk) / radix; 630*d3783724SAlan Cox blk += child * radix; 631*d3783724SAlan Cox i = 1 + child * next_skip; 6327090df5aSMatthew Dillon while (i <= skip && blk < freeBlk + count) { 6337090df5aSMatthew Dillon v = blk + radix - freeBlk; 6347090df5aSMatthew Dillon if (v > count) 6357090df5aSMatthew Dillon v = count; 6367090df5aSMatthew Dillon 6377090df5aSMatthew Dillon if (scan->bm_bighint == (daddr_t)-1) 6387090df5aSMatthew Dillon panic("blst_meta_free: freeing unexpected range"); 6397090df5aSMatthew Dillon 6407090df5aSMatthew Dillon if (next_skip == 1) { 6417090df5aSMatthew Dillon blst_leaf_free(&scan[i], freeBlk, v); 6427090df5aSMatthew Dillon } else { 6437090df5aSMatthew Dillon blst_meta_free(&scan[i], freeBlk, v, radix, next_skip - 1, blk); 6447090df5aSMatthew Dillon } 6457090df5aSMatthew Dillon if (scan->bm_bighint < scan[i].bm_bighint) 6467090df5aSMatthew Dillon scan->bm_bighint = scan[i].bm_bighint; 6477090df5aSMatthew Dillon count -= v; 6487090df5aSMatthew Dillon freeBlk += v; 6497090df5aSMatthew Dillon blk += radix; 6507090df5aSMatthew Dillon i += next_skip; 6517090df5aSMatthew Dillon } 6527090df5aSMatthew Dillon } 6537090df5aSMatthew Dillon 6547090df5aSMatthew Dillon /* 6557090df5aSMatthew Dillon * BLIST_RADIX_COPY() - copy one radix tree to another 6567090df5aSMatthew Dillon * 6577090df5aSMatthew Dillon * Locates free space in the source tree and frees it in the destination 6587090df5aSMatthew Dillon * tree. The space may not already be free in the destination. 6597090df5aSMatthew Dillon */ 6607090df5aSMatthew Dillon 6617090df5aSMatthew Dillon static void blst_copy( 6627090df5aSMatthew Dillon blmeta_t *scan, 6637090df5aSMatthew Dillon daddr_t blk, 6647090df5aSMatthew Dillon daddr_t radix, 6657090df5aSMatthew Dillon daddr_t skip, 6667090df5aSMatthew Dillon blist_t dest, 6677090df5aSMatthew Dillon daddr_t count 6687090df5aSMatthew Dillon ) { 669*d3783724SAlan Cox daddr_t i, next_skip; 6707090df5aSMatthew Dillon 6717090df5aSMatthew Dillon /* 6727090df5aSMatthew Dillon * Leaf node 6737090df5aSMatthew Dillon */ 6747090df5aSMatthew Dillon 6757090df5aSMatthew Dillon if (radix == BLIST_BMAP_RADIX) { 6767090df5aSMatthew Dillon u_daddr_t v = scan->u.bmu_bitmap; 6777090df5aSMatthew Dillon 6787090df5aSMatthew Dillon if (v == (u_daddr_t)-1) { 6797090df5aSMatthew Dillon blist_free(dest, blk, count); 6807090df5aSMatthew Dillon } else if (v != 0) { 6817090df5aSMatthew Dillon int i; 6827090df5aSMatthew Dillon 6837090df5aSMatthew Dillon for (i = 0; i < BLIST_BMAP_RADIX && i < count; ++i) { 684064650c1SAlan Cox if (v & ((u_daddr_t)1 << i)) 6857090df5aSMatthew Dillon blist_free(dest, blk + i, 1); 6867090df5aSMatthew Dillon } 6877090df5aSMatthew Dillon } 6887090df5aSMatthew Dillon return; 6897090df5aSMatthew Dillon } 6907090df5aSMatthew Dillon 6917090df5aSMatthew Dillon /* 6927090df5aSMatthew Dillon * Meta node 6937090df5aSMatthew Dillon */ 6947090df5aSMatthew Dillon 6957090df5aSMatthew Dillon if (scan->u.bmu_avail == 0) { 6967090df5aSMatthew Dillon /* 6977090df5aSMatthew Dillon * Source all allocated, leave dest allocated 6987090df5aSMatthew Dillon */ 6997090df5aSMatthew Dillon return; 7007090df5aSMatthew Dillon } 7017090df5aSMatthew Dillon if (scan->u.bmu_avail == radix) { 7027090df5aSMatthew Dillon /* 7037090df5aSMatthew Dillon * Source all free, free entire dest 7047090df5aSMatthew Dillon */ 7057090df5aSMatthew Dillon if (count < radix) 7067090df5aSMatthew Dillon blist_free(dest, blk, count); 7077090df5aSMatthew Dillon else 7087090df5aSMatthew Dillon blist_free(dest, blk, radix); 7097090df5aSMatthew Dillon return; 7107090df5aSMatthew Dillon } 7117090df5aSMatthew Dillon 7127090df5aSMatthew Dillon 71357e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 714*d3783724SAlan Cox next_skip = skip / BLIST_META_RADIX; 7157090df5aSMatthew Dillon 7167090df5aSMatthew Dillon for (i = 1; count && i <= skip; i += next_skip) { 7177090df5aSMatthew Dillon if (scan[i].bm_bighint == (daddr_t)-1) 7187090df5aSMatthew Dillon break; 7197090df5aSMatthew Dillon 7207090df5aSMatthew Dillon if (count >= radix) { 7217090df5aSMatthew Dillon blst_copy( 7227090df5aSMatthew Dillon &scan[i], 7237090df5aSMatthew Dillon blk, 7247090df5aSMatthew Dillon radix, 7257090df5aSMatthew Dillon next_skip - 1, 7267090df5aSMatthew Dillon dest, 7277090df5aSMatthew Dillon radix 7287090df5aSMatthew Dillon ); 7297090df5aSMatthew Dillon count -= radix; 7307090df5aSMatthew Dillon } else { 7317090df5aSMatthew Dillon if (count) { 7327090df5aSMatthew Dillon blst_copy( 7337090df5aSMatthew Dillon &scan[i], 7347090df5aSMatthew Dillon blk, 7357090df5aSMatthew Dillon radix, 7367090df5aSMatthew Dillon next_skip - 1, 7377090df5aSMatthew Dillon dest, 7387090df5aSMatthew Dillon count 7397090df5aSMatthew Dillon ); 7407090df5aSMatthew Dillon } 7417090df5aSMatthew Dillon count = 0; 7427090df5aSMatthew Dillon } 7437090df5aSMatthew Dillon blk += radix; 7447090df5aSMatthew Dillon } 7457090df5aSMatthew Dillon } 7467090df5aSMatthew Dillon 7477090df5aSMatthew Dillon /* 74892da00bbSMatthew Dillon * BLST_LEAF_FILL() - allocate specific blocks in leaf bitmap 74992da00bbSMatthew Dillon * 75092da00bbSMatthew Dillon * This routine allocates all blocks in the specified range 75192da00bbSMatthew Dillon * regardless of any existing allocations in that range. Returns 75292da00bbSMatthew Dillon * the number of blocks allocated by the call. 75392da00bbSMatthew Dillon */ 75492da00bbSMatthew Dillon 755a7249a6cSAlan Cox static daddr_t 75692da00bbSMatthew Dillon blst_leaf_fill(blmeta_t *scan, daddr_t blk, int count) 75792da00bbSMatthew Dillon { 75892da00bbSMatthew Dillon int n = blk & (BLIST_BMAP_RADIX - 1); 759a7249a6cSAlan Cox daddr_t nblks; 7604be4fd5dSAlan Cox u_daddr_t mask; 76192da00bbSMatthew Dillon 76292da00bbSMatthew Dillon mask = ((u_daddr_t)-1 << n) & 76392da00bbSMatthew Dillon ((u_daddr_t)-1 >> (BLIST_BMAP_RADIX - count - n)); 76492da00bbSMatthew Dillon 7654be4fd5dSAlan Cox /* Count the number of blocks that we are allocating. */ 7664be4fd5dSAlan Cox nblks = bitcount64(scan->u.bmu_bitmap & mask); 76792da00bbSMatthew Dillon 76892da00bbSMatthew Dillon scan->u.bmu_bitmap &= ~mask; 7694be4fd5dSAlan Cox return (nblks); 77092da00bbSMatthew Dillon } 77192da00bbSMatthew Dillon 77292da00bbSMatthew Dillon /* 77392da00bbSMatthew Dillon * BLIST_META_FILL() - allocate specific blocks at a meta node 77492da00bbSMatthew Dillon * 77592da00bbSMatthew Dillon * This routine allocates the specified range of blocks, 77692da00bbSMatthew Dillon * regardless of any existing allocations in the range. The 77792da00bbSMatthew Dillon * range must be within the extent of this node. Returns the 77892da00bbSMatthew Dillon * number of blocks allocated by the call. 77992da00bbSMatthew Dillon */ 780a7249a6cSAlan Cox static daddr_t 781*d3783724SAlan Cox blst_meta_fill(blmeta_t *scan, daddr_t allocBlk, daddr_t count, daddr_t radix, 782*d3783724SAlan Cox daddr_t skip, daddr_t blk) 783*d3783724SAlan Cox { 784*d3783724SAlan Cox daddr_t i, nblks, next_skip, v; 785*d3783724SAlan Cox int child; 78692da00bbSMatthew Dillon 7874be4fd5dSAlan Cox if (count > radix) { 7884be4fd5dSAlan Cox /* 7894be4fd5dSAlan Cox * The allocation exceeds the number of blocks that are 7904be4fd5dSAlan Cox * managed by this meta node. 7914be4fd5dSAlan Cox */ 7924be4fd5dSAlan Cox panic("allocation too large"); 7934be4fd5dSAlan Cox } 79492da00bbSMatthew Dillon if (count == radix || scan->u.bmu_avail == 0) { 79592da00bbSMatthew Dillon /* 79692da00bbSMatthew Dillon * ALL-ALLOCATED special case 79792da00bbSMatthew Dillon */ 79892da00bbSMatthew Dillon nblks = scan->u.bmu_avail; 79992da00bbSMatthew Dillon scan->u.bmu_avail = 0; 80086dd278fSAlan Cox scan->bm_bighint = 0; 80192da00bbSMatthew Dillon return nblks; 80292da00bbSMatthew Dillon } 803*d3783724SAlan Cox next_skip = skip / BLIST_META_RADIX; 80492da00bbSMatthew Dillon 8054be4fd5dSAlan Cox /* 8064be4fd5dSAlan Cox * An ALL-FREE meta node requires special handling before allocating 8074be4fd5dSAlan Cox * any of its blocks. 8084be4fd5dSAlan Cox */ 80992da00bbSMatthew Dillon if (scan->u.bmu_avail == radix) { 81057e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 81192da00bbSMatthew Dillon 81292da00bbSMatthew Dillon /* 8134be4fd5dSAlan Cox * Reinitialize each of the meta node's children. An ALL-FREE 8144be4fd5dSAlan Cox * meta node cannot have a terminator in any subtree. 81592da00bbSMatthew Dillon */ 81692da00bbSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 81792da00bbSMatthew Dillon if (next_skip == 1) { 81892da00bbSMatthew Dillon scan[i].u.bmu_bitmap = (u_daddr_t)-1; 81992da00bbSMatthew Dillon scan[i].bm_bighint = BLIST_BMAP_RADIX; 82092da00bbSMatthew Dillon } else { 82192da00bbSMatthew Dillon scan[i].bm_bighint = radix; 82292da00bbSMatthew Dillon scan[i].u.bmu_avail = radix; 82392da00bbSMatthew Dillon } 82492da00bbSMatthew Dillon } 82592da00bbSMatthew Dillon } else { 82657e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 82792da00bbSMatthew Dillon } 82892da00bbSMatthew Dillon 829*d3783724SAlan Cox nblks = 0; 830*d3783724SAlan Cox child = (allocBlk - blk) / radix; 831*d3783724SAlan Cox blk += child * radix; 832*d3783724SAlan Cox i = 1 + child * next_skip; 83392da00bbSMatthew Dillon while (i <= skip && blk < allocBlk + count) { 83492da00bbSMatthew Dillon v = blk + radix - allocBlk; 83592da00bbSMatthew Dillon if (v > count) 83692da00bbSMatthew Dillon v = count; 83792da00bbSMatthew Dillon 83892da00bbSMatthew Dillon if (scan->bm_bighint == (daddr_t)-1) 83992da00bbSMatthew Dillon panic("blst_meta_fill: filling unexpected range"); 84092da00bbSMatthew Dillon 84192da00bbSMatthew Dillon if (next_skip == 1) { 84292da00bbSMatthew Dillon nblks += blst_leaf_fill(&scan[i], allocBlk, v); 84392da00bbSMatthew Dillon } else { 84492da00bbSMatthew Dillon nblks += blst_meta_fill(&scan[i], allocBlk, v, 84592da00bbSMatthew Dillon radix, next_skip - 1, blk); 84692da00bbSMatthew Dillon } 84792da00bbSMatthew Dillon count -= v; 84892da00bbSMatthew Dillon allocBlk += v; 84992da00bbSMatthew Dillon blk += radix; 85092da00bbSMatthew Dillon i += next_skip; 85192da00bbSMatthew Dillon } 85292da00bbSMatthew Dillon scan->u.bmu_avail -= nblks; 85392da00bbSMatthew Dillon return nblks; 85492da00bbSMatthew Dillon } 85592da00bbSMatthew Dillon 85692da00bbSMatthew Dillon /* 8577090df5aSMatthew Dillon * BLST_RADIX_INIT() - initialize radix tree 8587090df5aSMatthew Dillon * 8597090df5aSMatthew Dillon * Initialize our meta structures and bitmaps and calculate the exact 8607090df5aSMatthew Dillon * amount of space required to manage 'count' blocks - this space may 861f565f395SEitan Adler * be considerably less than the calculated radix due to the large 8627090df5aSMatthew Dillon * RADIX values we use. 8637090df5aSMatthew Dillon */ 8647090df5aSMatthew Dillon 8657090df5aSMatthew Dillon static daddr_t 866*d3783724SAlan Cox blst_radix_init(blmeta_t *scan, daddr_t radix, daddr_t skip, daddr_t count) 8677090df5aSMatthew Dillon { 868*d3783724SAlan Cox daddr_t i, memindex, next_skip; 869*d3783724SAlan Cox 870*d3783724SAlan Cox memindex = 0; 8717090df5aSMatthew Dillon 8727090df5aSMatthew Dillon /* 8737090df5aSMatthew Dillon * Leaf node 8747090df5aSMatthew Dillon */ 8757090df5aSMatthew Dillon 8767090df5aSMatthew Dillon if (radix == BLIST_BMAP_RADIX) { 8777090df5aSMatthew Dillon if (scan) { 8787090df5aSMatthew Dillon scan->bm_bighint = 0; 8797090df5aSMatthew Dillon scan->u.bmu_bitmap = 0; 8807090df5aSMatthew Dillon } 8817090df5aSMatthew Dillon return(memindex); 8827090df5aSMatthew Dillon } 8837090df5aSMatthew Dillon 8847090df5aSMatthew Dillon /* 8857090df5aSMatthew Dillon * Meta node. If allocating the entire object we can special 8867090df5aSMatthew Dillon * case it. However, we need to figure out how much memory 8877090df5aSMatthew Dillon * is required to manage 'count' blocks, so we continue on anyway. 8887090df5aSMatthew Dillon */ 8897090df5aSMatthew Dillon 8907090df5aSMatthew Dillon if (scan) { 8917090df5aSMatthew Dillon scan->bm_bighint = 0; 8927090df5aSMatthew Dillon scan->u.bmu_avail = 0; 8937090df5aSMatthew Dillon } 8947090df5aSMatthew Dillon 89557e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 896*d3783724SAlan Cox next_skip = skip / BLIST_META_RADIX; 8977090df5aSMatthew Dillon 8987090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 8997090df5aSMatthew Dillon if (count >= radix) { 9007090df5aSMatthew Dillon /* 9017090df5aSMatthew Dillon * Allocate the entire object 9027090df5aSMatthew Dillon */ 9037090df5aSMatthew Dillon memindex = i + blst_radix_init( 9047090df5aSMatthew Dillon ((scan) ? &scan[i] : NULL), 9057090df5aSMatthew Dillon radix, 9067090df5aSMatthew Dillon next_skip - 1, 9077090df5aSMatthew Dillon radix 9087090df5aSMatthew Dillon ); 9097090df5aSMatthew Dillon count -= radix; 9107090df5aSMatthew Dillon } else if (count > 0) { 9117090df5aSMatthew Dillon /* 9127090df5aSMatthew Dillon * Allocate a partial object 9137090df5aSMatthew Dillon */ 9147090df5aSMatthew Dillon memindex = i + blst_radix_init( 9157090df5aSMatthew Dillon ((scan) ? &scan[i] : NULL), 9167090df5aSMatthew Dillon radix, 9177090df5aSMatthew Dillon next_skip - 1, 9187090df5aSMatthew Dillon count 9197090df5aSMatthew Dillon ); 9207090df5aSMatthew Dillon count = 0; 9217090df5aSMatthew Dillon } else { 9227090df5aSMatthew Dillon /* 9237090df5aSMatthew Dillon * Add terminator and break out 9247090df5aSMatthew Dillon */ 9257090df5aSMatthew Dillon if (scan) 9267090df5aSMatthew Dillon scan[i].bm_bighint = (daddr_t)-1; 9277090df5aSMatthew Dillon break; 9287090df5aSMatthew Dillon } 9297090df5aSMatthew Dillon } 9307090df5aSMatthew Dillon if (memindex < i) 9317090df5aSMatthew Dillon memindex = i; 9327090df5aSMatthew Dillon return(memindex); 9337090df5aSMatthew Dillon } 9347090df5aSMatthew Dillon 9357090df5aSMatthew Dillon #ifdef BLIST_DEBUG 9367090df5aSMatthew Dillon 9377090df5aSMatthew Dillon static void 938*d3783724SAlan Cox blst_radix_print(blmeta_t *scan, daddr_t blk, daddr_t radix, daddr_t skip, 939*d3783724SAlan Cox int tab) 9407090df5aSMatthew Dillon { 941*d3783724SAlan Cox daddr_t i, next_skip; 9427090df5aSMatthew Dillon 9437090df5aSMatthew Dillon if (radix == BLIST_BMAP_RADIX) { 9447090df5aSMatthew Dillon printf( 945d90bf7d8SAlan Cox "%*.*s(%08llx,%lld): bitmap %016llx big=%lld\n", 9467090df5aSMatthew Dillon tab, tab, "", 94792da00bbSMatthew Dillon (long long)blk, (long long)radix, 94892da00bbSMatthew Dillon (long long)scan->u.bmu_bitmap, 94992da00bbSMatthew Dillon (long long)scan->bm_bighint 9507090df5aSMatthew Dillon ); 9517090df5aSMatthew Dillon return; 9527090df5aSMatthew Dillon } 9537090df5aSMatthew Dillon 9547090df5aSMatthew Dillon if (scan->u.bmu_avail == 0) { 9557090df5aSMatthew Dillon printf( 95692da00bbSMatthew Dillon "%*.*s(%08llx,%lld) ALL ALLOCATED\n", 9577090df5aSMatthew Dillon tab, tab, "", 95892da00bbSMatthew Dillon (long long)blk, 95992da00bbSMatthew Dillon (long long)radix 9607090df5aSMatthew Dillon ); 9617090df5aSMatthew Dillon return; 9627090df5aSMatthew Dillon } 9637090df5aSMatthew Dillon if (scan->u.bmu_avail == radix) { 9647090df5aSMatthew Dillon printf( 96592da00bbSMatthew Dillon "%*.*s(%08llx,%lld) ALL FREE\n", 9667090df5aSMatthew Dillon tab, tab, "", 96792da00bbSMatthew Dillon (long long)blk, 96892da00bbSMatthew Dillon (long long)radix 9697090df5aSMatthew Dillon ); 9707090df5aSMatthew Dillon return; 9717090df5aSMatthew Dillon } 9727090df5aSMatthew Dillon 9737090df5aSMatthew Dillon printf( 97492da00bbSMatthew Dillon "%*.*s(%08llx,%lld): subtree (%lld/%lld) big=%lld {\n", 9757090df5aSMatthew Dillon tab, tab, "", 97692da00bbSMatthew Dillon (long long)blk, (long long)radix, 97792da00bbSMatthew Dillon (long long)scan->u.bmu_avail, 97892da00bbSMatthew Dillon (long long)radix, 97992da00bbSMatthew Dillon (long long)scan->bm_bighint 9807090df5aSMatthew Dillon ); 9817090df5aSMatthew Dillon 98257e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 983*d3783724SAlan Cox next_skip = skip / BLIST_META_RADIX; 9847090df5aSMatthew Dillon tab += 4; 9857090df5aSMatthew Dillon 9867090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 9877090df5aSMatthew Dillon if (scan[i].bm_bighint == (daddr_t)-1) { 9887090df5aSMatthew Dillon printf( 98992da00bbSMatthew Dillon "%*.*s(%08llx,%lld): Terminator\n", 9907090df5aSMatthew Dillon tab, tab, "", 99192da00bbSMatthew Dillon (long long)blk, (long long)radix 9927090df5aSMatthew Dillon ); 9937090df5aSMatthew Dillon break; 9947090df5aSMatthew Dillon } 9957090df5aSMatthew Dillon blst_radix_print( 9967090df5aSMatthew Dillon &scan[i], 9977090df5aSMatthew Dillon blk, 9987090df5aSMatthew Dillon radix, 9997090df5aSMatthew Dillon next_skip - 1, 10007090df5aSMatthew Dillon tab 10017090df5aSMatthew Dillon ); 10027090df5aSMatthew Dillon blk += radix; 10037090df5aSMatthew Dillon } 10047090df5aSMatthew Dillon tab -= 4; 10057090df5aSMatthew Dillon 10067090df5aSMatthew Dillon printf( 10077090df5aSMatthew Dillon "%*.*s}\n", 10087090df5aSMatthew Dillon tab, tab, "" 10097090df5aSMatthew Dillon ); 10107090df5aSMatthew Dillon } 10117090df5aSMatthew Dillon 10127090df5aSMatthew Dillon #endif 10137090df5aSMatthew Dillon 10147090df5aSMatthew Dillon #ifdef BLIST_DEBUG 10157090df5aSMatthew Dillon 10167090df5aSMatthew Dillon int 10177090df5aSMatthew Dillon main(int ac, char **av) 10187090df5aSMatthew Dillon { 10197090df5aSMatthew Dillon int size = 1024; 10207090df5aSMatthew Dillon int i; 10217090df5aSMatthew Dillon blist_t bl; 10227090df5aSMatthew Dillon 10237090df5aSMatthew Dillon for (i = 1; i < ac; ++i) { 10247090df5aSMatthew Dillon const char *ptr = av[i]; 10257090df5aSMatthew Dillon if (*ptr != '-') { 10267090df5aSMatthew Dillon size = strtol(ptr, NULL, 0); 10277090df5aSMatthew Dillon continue; 10287090df5aSMatthew Dillon } 10297090df5aSMatthew Dillon ptr += 2; 10307090df5aSMatthew Dillon fprintf(stderr, "Bad option: %s\n", ptr - 2); 10317090df5aSMatthew Dillon exit(1); 10327090df5aSMatthew Dillon } 1033c8c7ad92SKip Macy bl = blist_create(size, M_WAITOK); 10347090df5aSMatthew Dillon blist_free(bl, 0, size); 10357090df5aSMatthew Dillon 10367090df5aSMatthew Dillon for (;;) { 10377090df5aSMatthew Dillon char buf[1024]; 1038d90bf7d8SAlan Cox long long da = 0; 1039d90bf7d8SAlan Cox long long count = 0; 10407090df5aSMatthew Dillon 10414be4fd5dSAlan Cox printf("%lld/%lld/%lld> ", (long long)blist_avail(bl), 104292da00bbSMatthew Dillon (long long)size, (long long)bl->bl_radix); 10437090df5aSMatthew Dillon fflush(stdout); 10447090df5aSMatthew Dillon if (fgets(buf, sizeof(buf), stdin) == NULL) 10457090df5aSMatthew Dillon break; 10467090df5aSMatthew Dillon switch(buf[0]) { 10477090df5aSMatthew Dillon case 'r': 104892da00bbSMatthew Dillon if (sscanf(buf + 1, "%lld", &count) == 1) { 1049d90bf7d8SAlan Cox blist_resize(&bl, count, 1, M_WAITOK); 10507090df5aSMatthew Dillon } else { 10517090df5aSMatthew Dillon printf("?\n"); 10527090df5aSMatthew Dillon } 10537090df5aSMatthew Dillon case 'p': 10547090df5aSMatthew Dillon blist_print(bl); 10557090df5aSMatthew Dillon break; 10567090df5aSMatthew Dillon case 'a': 105792da00bbSMatthew Dillon if (sscanf(buf + 1, "%lld", &count) == 1) { 10587090df5aSMatthew Dillon daddr_t blk = blist_alloc(bl, count); 105992da00bbSMatthew Dillon printf(" R=%08llx\n", (long long)blk); 10607090df5aSMatthew Dillon } else { 10617090df5aSMatthew Dillon printf("?\n"); 10627090df5aSMatthew Dillon } 10637090df5aSMatthew Dillon break; 10647090df5aSMatthew Dillon case 'f': 1065d90bf7d8SAlan Cox if (sscanf(buf + 1, "%llx %lld", &da, &count) == 2) { 10667090df5aSMatthew Dillon blist_free(bl, da, count); 10677090df5aSMatthew Dillon } else { 10687090df5aSMatthew Dillon printf("?\n"); 10697090df5aSMatthew Dillon } 10707090df5aSMatthew Dillon break; 107192da00bbSMatthew Dillon case 'l': 1072d90bf7d8SAlan Cox if (sscanf(buf + 1, "%llx %lld", &da, &count) == 2) { 1073a7249a6cSAlan Cox printf(" n=%jd\n", 1074a7249a6cSAlan Cox (intmax_t)blist_fill(bl, da, count)); 107592da00bbSMatthew Dillon } else { 107692da00bbSMatthew Dillon printf("?\n"); 107792da00bbSMatthew Dillon } 107892da00bbSMatthew Dillon break; 10797090df5aSMatthew Dillon case '?': 10807090df5aSMatthew Dillon case 'h': 10817090df5aSMatthew Dillon puts( 10827090df5aSMatthew Dillon "p -print\n" 10837090df5aSMatthew Dillon "a %d -allocate\n" 10847090df5aSMatthew Dillon "f %x %d -free\n" 108592da00bbSMatthew Dillon "l %x %d -fill\n" 10867090df5aSMatthew Dillon "r %d -resize\n" 10877090df5aSMatthew Dillon "h/? -help" 10887090df5aSMatthew Dillon ); 10897090df5aSMatthew Dillon break; 10907090df5aSMatthew Dillon default: 10917090df5aSMatthew Dillon printf("?\n"); 10927090df5aSMatthew Dillon break; 10937090df5aSMatthew Dillon } 10947090df5aSMatthew Dillon } 10957090df5aSMatthew Dillon return(0); 10967090df5aSMatthew Dillon } 10977090df5aSMatthew Dillon 10987090df5aSMatthew Dillon void 10997090df5aSMatthew Dillon panic(const char *ctl, ...) 11007090df5aSMatthew Dillon { 11017090df5aSMatthew Dillon va_list va; 11027090df5aSMatthew Dillon 11037090df5aSMatthew Dillon va_start(va, ctl); 11047090df5aSMatthew Dillon vfprintf(stderr, ctl, va); 11057090df5aSMatthew Dillon fprintf(stderr, "\n"); 11067090df5aSMatthew Dillon va_end(va); 11077090df5aSMatthew Dillon exit(1); 11087090df5aSMatthew Dillon } 11097090df5aSMatthew Dillon 11107090df5aSMatthew Dillon #endif 11117090df5aSMatthew Dillon 1112