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> 1087090df5aSMatthew Dillon 1094be4fd5dSAlan Cox #define bitcount64(x) __bitcount64((uint64_t)(x)) 11092da00bbSMatthew Dillon #define malloc(a,b,c) calloc(a, 1) 1117090df5aSMatthew Dillon #define free(a,b) free(a) 1127090df5aSMatthew Dillon 1137090df5aSMatthew Dillon #include <sys/blist.h> 1147090df5aSMatthew Dillon 1157090df5aSMatthew Dillon void panic(const char *ctl, ...); 1167090df5aSMatthew Dillon 1177090df5aSMatthew Dillon #endif 1187090df5aSMatthew Dillon 1197090df5aSMatthew Dillon /* 1207090df5aSMatthew Dillon * static support functions 1217090df5aSMatthew Dillon */ 1227090df5aSMatthew Dillon 1237090df5aSMatthew Dillon static daddr_t blst_leaf_alloc(blmeta_t *scan, daddr_t blk, int count); 124*d4e3484bSAlan Cox static daddr_t blst_meta_alloc(blmeta_t *scan, daddr_t blk, daddr_t count, 125*d4e3484bSAlan Cox daddr_t radix, daddr_t skip, daddr_t cursor); 1267090df5aSMatthew Dillon static void blst_leaf_free(blmeta_t *scan, daddr_t relblk, int count); 1277090df5aSMatthew Dillon static void blst_meta_free(blmeta_t *scan, daddr_t freeBlk, daddr_t count, 1287090df5aSMatthew Dillon daddr_t radix, int skip, daddr_t blk); 1297090df5aSMatthew Dillon static void blst_copy(blmeta_t *scan, daddr_t blk, daddr_t radix, 1307090df5aSMatthew Dillon daddr_t skip, blist_t dest, daddr_t count); 131a7249a6cSAlan Cox static daddr_t blst_leaf_fill(blmeta_t *scan, daddr_t blk, int count); 132a7249a6cSAlan Cox static daddr_t blst_meta_fill(blmeta_t *scan, daddr_t allocBlk, daddr_t count, 13392da00bbSMatthew Dillon daddr_t radix, int skip, daddr_t blk); 1347090df5aSMatthew Dillon static daddr_t blst_radix_init(blmeta_t *scan, daddr_t radix, 1357090df5aSMatthew Dillon int skip, daddr_t count); 136c4473420SPeter Wemm #ifndef _KERNEL 1377090df5aSMatthew Dillon static void blst_radix_print(blmeta_t *scan, daddr_t blk, 1387090df5aSMatthew Dillon daddr_t radix, int skip, int tab); 1397090df5aSMatthew Dillon #endif 1407090df5aSMatthew Dillon 141c4473420SPeter Wemm #ifdef _KERNEL 1427090df5aSMatthew Dillon static MALLOC_DEFINE(M_SWAP, "SWAP", "Swap space"); 1437090df5aSMatthew Dillon #endif 1447090df5aSMatthew Dillon 1457090df5aSMatthew Dillon /* 1467090df5aSMatthew Dillon * blist_create() - create a blist capable of handling up to the specified 1477090df5aSMatthew Dillon * number of blocks 1487090df5aSMatthew Dillon * 149f565f395SEitan Adler * blocks - must be greater than 0 150c8c7ad92SKip Macy * flags - malloc flags 1517090df5aSMatthew Dillon * 1527090df5aSMatthew Dillon * The smallest blist consists of a single leaf node capable of 1537090df5aSMatthew Dillon * managing BLIST_BMAP_RADIX blocks. 1547090df5aSMatthew Dillon */ 1557090df5aSMatthew Dillon 1567090df5aSMatthew Dillon blist_t 157c8c7ad92SKip Macy blist_create(daddr_t blocks, int flags) 1587090df5aSMatthew Dillon { 1597090df5aSMatthew Dillon blist_t bl; 160015d7db6SAlan Cox daddr_t nodes, radix; 1617090df5aSMatthew Dillon int skip = 0; 1627090df5aSMatthew Dillon 1637090df5aSMatthew Dillon /* 1647090df5aSMatthew Dillon * Calculate radix and skip field used for scanning. 1657090df5aSMatthew Dillon */ 1667090df5aSMatthew Dillon radix = BLIST_BMAP_RADIX; 1677090df5aSMatthew Dillon 1687090df5aSMatthew Dillon while (radix < blocks) { 16957e6d29bSMatthew Dillon radix *= BLIST_META_RADIX; 17057e6d29bSMatthew Dillon skip = (skip + 1) * BLIST_META_RADIX; 1717090df5aSMatthew Dillon } 1727090df5aSMatthew Dillon 1734be4fd5dSAlan Cox bl = malloc(sizeof(struct blist), M_SWAP, flags); 174015d7db6SAlan Cox if (bl == NULL) 175015d7db6SAlan Cox return (NULL); 1767090df5aSMatthew Dillon 1777090df5aSMatthew Dillon bl->bl_blocks = blocks; 1787090df5aSMatthew Dillon bl->bl_radix = radix; 1797090df5aSMatthew Dillon bl->bl_skip = skip; 180*d4e3484bSAlan Cox bl->bl_cursor = 0; 181015d7db6SAlan Cox nodes = 1 + blst_radix_init(NULL, radix, bl->bl_skip, blocks); 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 } 187015d7db6SAlan Cox blst_radix_init(bl->bl_root, radix, bl->bl_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 222*d4e3484bSAlan Cox /* 223*d4e3484bSAlan Cox * This loop iterates at most twice. An allocation failure in the 224*d4e3484bSAlan Cox * first iteration leads to a second iteration only if the cursor was 225*d4e3484bSAlan Cox * non-zero. When the cursor is zero, an allocation failure will 226*d4e3484bSAlan Cox * reduce the hint, stopping further iterations. 227*d4e3484bSAlan Cox */ 228*d4e3484bSAlan 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, 233*d4e3484bSAlan Cox bl->bl_radix, bl->bl_skip, bl->bl_cursor); 234*d4e3484bSAlan Cox if (blk != SWAPBLK_NONE) { 235*d4e3484bSAlan Cox bl->bl_cursor = blk + count; 2367090df5aSMatthew Dillon return (blk); 237*d4e3484bSAlan Cox } else if (bl->bl_cursor != 0) 238*d4e3484bSAlan 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 438*d4e3484bSAlan Cox blst_meta_alloc(blmeta_t *scan, daddr_t blk, daddr_t count, daddr_t radix, 439*d4e3484bSAlan Cox daddr_t skip, daddr_t cursor) 440*d4e3484bSAlan Cox { 441*d4e3484bSAlan Cox daddr_t i, next_skip, r; 442*d4e3484bSAlan Cox int child; 443*d4e3484bSAlan 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 } 454*d4e3484bSAlan 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) { 468*d4e3484bSAlan Cox if (next_skip == 1) 4697090df5aSMatthew Dillon scan[i].u.bmu_bitmap = (u_daddr_t)-1; 470*d4e3484bSAlan Cox else 4717090df5aSMatthew Dillon scan[i].u.bmu_avail = radix; 472*d4e3484bSAlan 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 } 485*d4e3484bSAlan Cox scan_from_start = cursor == blk; 486*d4e3484bSAlan Cox child = (cursor - blk) / radix; 487*d4e3484bSAlan Cox blk += child * radix; 488*d4e3484bSAlan 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, 497*d4e3484bSAlan Cox radix, next_skip - 1, cursor > blk ? 498*d4e3484bSAlan 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 */ 516*d4e3484bSAlan Cox if (scan_from_start && scan->bm_bighint >= count) 5177090df5aSMatthew Dillon scan->bm_bighint = count - 1; 518*d4e3484bSAlan 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 5727090df5aSMatthew Dillon blst_meta_free( 5737090df5aSMatthew Dillon blmeta_t *scan, 5747090df5aSMatthew Dillon daddr_t freeBlk, 5757090df5aSMatthew Dillon daddr_t count, 5767090df5aSMatthew Dillon daddr_t radix, 5777090df5aSMatthew Dillon int skip, 5787090df5aSMatthew Dillon daddr_t blk 5797090df5aSMatthew Dillon ) { 5807090df5aSMatthew Dillon int i; 58157e6d29bSMatthew Dillon int next_skip = ((u_int)skip / BLIST_META_RADIX); 5827090df5aSMatthew Dillon 5837090df5aSMatthew Dillon #if 0 5841ede983cSDag-Erling Smørgrav printf("free (%llx,%lld) FROM (%llx,%lld)\n", 58592da00bbSMatthew Dillon (long long)freeBlk, (long long)count, 58692da00bbSMatthew Dillon (long long)blk, (long long)radix 5877090df5aSMatthew Dillon ); 5887090df5aSMatthew Dillon #endif 5897090df5aSMatthew Dillon 5907090df5aSMatthew Dillon if (scan->u.bmu_avail == 0) { 5917090df5aSMatthew Dillon /* 5927090df5aSMatthew Dillon * ALL-ALLOCATED special case, with possible 5937090df5aSMatthew Dillon * shortcut to ALL-FREE special case. 5947090df5aSMatthew Dillon */ 5957090df5aSMatthew Dillon scan->u.bmu_avail = count; 5967090df5aSMatthew Dillon scan->bm_bighint = count; 5977090df5aSMatthew Dillon 5987090df5aSMatthew Dillon if (count != radix) { 5997090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 6007090df5aSMatthew Dillon if (scan[i].bm_bighint == (daddr_t)-1) 6017090df5aSMatthew Dillon break; 6027090df5aSMatthew Dillon scan[i].bm_bighint = 0; 6037090df5aSMatthew Dillon if (next_skip == 1) { 6047090df5aSMatthew Dillon scan[i].u.bmu_bitmap = 0; 6057090df5aSMatthew Dillon } else { 6067090df5aSMatthew Dillon scan[i].u.bmu_avail = 0; 6077090df5aSMatthew Dillon } 6087090df5aSMatthew Dillon } 6097090df5aSMatthew Dillon /* fall through */ 6107090df5aSMatthew Dillon } 6117090df5aSMatthew Dillon } else { 6127090df5aSMatthew Dillon scan->u.bmu_avail += count; 6137090df5aSMatthew Dillon /* scan->bm_bighint = radix; */ 6147090df5aSMatthew Dillon } 6157090df5aSMatthew Dillon 6167090df5aSMatthew Dillon /* 6177090df5aSMatthew Dillon * ALL-FREE special case. 6187090df5aSMatthew Dillon */ 6197090df5aSMatthew Dillon 6207090df5aSMatthew Dillon if (scan->u.bmu_avail == radix) 6217090df5aSMatthew Dillon return; 6227090df5aSMatthew Dillon if (scan->u.bmu_avail > radix) 623bdc9a8d0SJohn Baldwin panic("blst_meta_free: freeing already free blocks (%lld) %lld/%lld", 624bdc9a8d0SJohn Baldwin (long long)count, (long long)scan->u.bmu_avail, 625bdc9a8d0SJohn Baldwin (long long)radix); 6267090df5aSMatthew Dillon 6277090df5aSMatthew Dillon /* 6287090df5aSMatthew Dillon * Break the free down into its components 6297090df5aSMatthew Dillon */ 6307090df5aSMatthew Dillon 63157e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 6327090df5aSMatthew Dillon 6337090df5aSMatthew Dillon i = (freeBlk - blk) / radix; 6347090df5aSMatthew Dillon blk += i * radix; 6357090df5aSMatthew Dillon i = i * next_skip + 1; 6367090df5aSMatthew Dillon 6377090df5aSMatthew Dillon while (i <= skip && blk < freeBlk + count) { 6387090df5aSMatthew Dillon daddr_t v; 6397090df5aSMatthew Dillon 6407090df5aSMatthew Dillon v = blk + radix - freeBlk; 6417090df5aSMatthew Dillon if (v > count) 6427090df5aSMatthew Dillon v = count; 6437090df5aSMatthew Dillon 6447090df5aSMatthew Dillon if (scan->bm_bighint == (daddr_t)-1) 6457090df5aSMatthew Dillon panic("blst_meta_free: freeing unexpected range"); 6467090df5aSMatthew Dillon 6477090df5aSMatthew Dillon if (next_skip == 1) { 6487090df5aSMatthew Dillon blst_leaf_free(&scan[i], freeBlk, v); 6497090df5aSMatthew Dillon } else { 6507090df5aSMatthew Dillon blst_meta_free(&scan[i], freeBlk, v, radix, next_skip - 1, blk); 6517090df5aSMatthew Dillon } 6527090df5aSMatthew Dillon if (scan->bm_bighint < scan[i].bm_bighint) 6537090df5aSMatthew Dillon scan->bm_bighint = scan[i].bm_bighint; 6547090df5aSMatthew Dillon count -= v; 6557090df5aSMatthew Dillon freeBlk += v; 6567090df5aSMatthew Dillon blk += radix; 6577090df5aSMatthew Dillon i += next_skip; 6587090df5aSMatthew Dillon } 6597090df5aSMatthew Dillon } 6607090df5aSMatthew Dillon 6617090df5aSMatthew Dillon /* 6627090df5aSMatthew Dillon * BLIST_RADIX_COPY() - copy one radix tree to another 6637090df5aSMatthew Dillon * 6647090df5aSMatthew Dillon * Locates free space in the source tree and frees it in the destination 6657090df5aSMatthew Dillon * tree. The space may not already be free in the destination. 6667090df5aSMatthew Dillon */ 6677090df5aSMatthew Dillon 6687090df5aSMatthew Dillon static void blst_copy( 6697090df5aSMatthew Dillon blmeta_t *scan, 6707090df5aSMatthew Dillon daddr_t blk, 6717090df5aSMatthew Dillon daddr_t radix, 6727090df5aSMatthew Dillon daddr_t skip, 6737090df5aSMatthew Dillon blist_t dest, 6747090df5aSMatthew Dillon daddr_t count 6757090df5aSMatthew Dillon ) { 6767090df5aSMatthew Dillon int next_skip; 6777090df5aSMatthew Dillon int i; 6787090df5aSMatthew Dillon 6797090df5aSMatthew Dillon /* 6807090df5aSMatthew Dillon * Leaf node 6817090df5aSMatthew Dillon */ 6827090df5aSMatthew Dillon 6837090df5aSMatthew Dillon if (radix == BLIST_BMAP_RADIX) { 6847090df5aSMatthew Dillon u_daddr_t v = scan->u.bmu_bitmap; 6857090df5aSMatthew Dillon 6867090df5aSMatthew Dillon if (v == (u_daddr_t)-1) { 6877090df5aSMatthew Dillon blist_free(dest, blk, count); 6887090df5aSMatthew Dillon } else if (v != 0) { 6897090df5aSMatthew Dillon int i; 6907090df5aSMatthew Dillon 6917090df5aSMatthew Dillon for (i = 0; i < BLIST_BMAP_RADIX && i < count; ++i) { 692064650c1SAlan Cox if (v & ((u_daddr_t)1 << i)) 6937090df5aSMatthew Dillon blist_free(dest, blk + i, 1); 6947090df5aSMatthew Dillon } 6957090df5aSMatthew Dillon } 6967090df5aSMatthew Dillon return; 6977090df5aSMatthew Dillon } 6987090df5aSMatthew Dillon 6997090df5aSMatthew Dillon /* 7007090df5aSMatthew Dillon * Meta node 7017090df5aSMatthew Dillon */ 7027090df5aSMatthew Dillon 7037090df5aSMatthew Dillon if (scan->u.bmu_avail == 0) { 7047090df5aSMatthew Dillon /* 7057090df5aSMatthew Dillon * Source all allocated, leave dest allocated 7067090df5aSMatthew Dillon */ 7077090df5aSMatthew Dillon return; 7087090df5aSMatthew Dillon } 7097090df5aSMatthew Dillon if (scan->u.bmu_avail == radix) { 7107090df5aSMatthew Dillon /* 7117090df5aSMatthew Dillon * Source all free, free entire dest 7127090df5aSMatthew Dillon */ 7137090df5aSMatthew Dillon if (count < radix) 7147090df5aSMatthew Dillon blist_free(dest, blk, count); 7157090df5aSMatthew Dillon else 7167090df5aSMatthew Dillon blist_free(dest, blk, radix); 7177090df5aSMatthew Dillon return; 7187090df5aSMatthew Dillon } 7197090df5aSMatthew Dillon 7207090df5aSMatthew Dillon 72157e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 72257e6d29bSMatthew Dillon next_skip = ((u_int)skip / BLIST_META_RADIX); 7237090df5aSMatthew Dillon 7247090df5aSMatthew Dillon for (i = 1; count && i <= skip; i += next_skip) { 7257090df5aSMatthew Dillon if (scan[i].bm_bighint == (daddr_t)-1) 7267090df5aSMatthew Dillon break; 7277090df5aSMatthew Dillon 7287090df5aSMatthew Dillon if (count >= radix) { 7297090df5aSMatthew Dillon blst_copy( 7307090df5aSMatthew Dillon &scan[i], 7317090df5aSMatthew Dillon blk, 7327090df5aSMatthew Dillon radix, 7337090df5aSMatthew Dillon next_skip - 1, 7347090df5aSMatthew Dillon dest, 7357090df5aSMatthew Dillon radix 7367090df5aSMatthew Dillon ); 7377090df5aSMatthew Dillon count -= radix; 7387090df5aSMatthew Dillon } else { 7397090df5aSMatthew Dillon if (count) { 7407090df5aSMatthew Dillon blst_copy( 7417090df5aSMatthew Dillon &scan[i], 7427090df5aSMatthew Dillon blk, 7437090df5aSMatthew Dillon radix, 7447090df5aSMatthew Dillon next_skip - 1, 7457090df5aSMatthew Dillon dest, 7467090df5aSMatthew Dillon count 7477090df5aSMatthew Dillon ); 7487090df5aSMatthew Dillon } 7497090df5aSMatthew Dillon count = 0; 7507090df5aSMatthew Dillon } 7517090df5aSMatthew Dillon blk += radix; 7527090df5aSMatthew Dillon } 7537090df5aSMatthew Dillon } 7547090df5aSMatthew Dillon 7557090df5aSMatthew Dillon /* 75692da00bbSMatthew Dillon * BLST_LEAF_FILL() - allocate specific blocks in leaf bitmap 75792da00bbSMatthew Dillon * 75892da00bbSMatthew Dillon * This routine allocates all blocks in the specified range 75992da00bbSMatthew Dillon * regardless of any existing allocations in that range. Returns 76092da00bbSMatthew Dillon * the number of blocks allocated by the call. 76192da00bbSMatthew Dillon */ 76292da00bbSMatthew Dillon 763a7249a6cSAlan Cox static daddr_t 76492da00bbSMatthew Dillon blst_leaf_fill(blmeta_t *scan, daddr_t blk, int count) 76592da00bbSMatthew Dillon { 76692da00bbSMatthew Dillon int n = blk & (BLIST_BMAP_RADIX - 1); 767a7249a6cSAlan Cox daddr_t nblks; 7684be4fd5dSAlan Cox u_daddr_t mask; 76992da00bbSMatthew Dillon 77092da00bbSMatthew Dillon mask = ((u_daddr_t)-1 << n) & 77192da00bbSMatthew Dillon ((u_daddr_t)-1 >> (BLIST_BMAP_RADIX - count - n)); 77292da00bbSMatthew Dillon 7734be4fd5dSAlan Cox /* Count the number of blocks that we are allocating. */ 7744be4fd5dSAlan Cox nblks = bitcount64(scan->u.bmu_bitmap & mask); 77592da00bbSMatthew Dillon 77692da00bbSMatthew Dillon scan->u.bmu_bitmap &= ~mask; 7774be4fd5dSAlan Cox return (nblks); 77892da00bbSMatthew Dillon } 77992da00bbSMatthew Dillon 78092da00bbSMatthew Dillon /* 78192da00bbSMatthew Dillon * BLIST_META_FILL() - allocate specific blocks at a meta node 78292da00bbSMatthew Dillon * 78392da00bbSMatthew Dillon * This routine allocates the specified range of blocks, 78492da00bbSMatthew Dillon * regardless of any existing allocations in the range. The 78592da00bbSMatthew Dillon * range must be within the extent of this node. Returns the 78692da00bbSMatthew Dillon * number of blocks allocated by the call. 78792da00bbSMatthew Dillon */ 788a7249a6cSAlan Cox static daddr_t 78992da00bbSMatthew Dillon blst_meta_fill( 79092da00bbSMatthew Dillon blmeta_t *scan, 79192da00bbSMatthew Dillon daddr_t allocBlk, 79292da00bbSMatthew Dillon daddr_t count, 79392da00bbSMatthew Dillon daddr_t radix, 79492da00bbSMatthew Dillon int skip, 79592da00bbSMatthew Dillon daddr_t blk 79692da00bbSMatthew Dillon ) { 79792da00bbSMatthew Dillon int i; 79857e6d29bSMatthew Dillon int next_skip = ((u_int)skip / BLIST_META_RADIX); 799a7249a6cSAlan Cox daddr_t nblks = 0; 80092da00bbSMatthew Dillon 8014be4fd5dSAlan Cox if (count > radix) { 8024be4fd5dSAlan Cox /* 8034be4fd5dSAlan Cox * The allocation exceeds the number of blocks that are 8044be4fd5dSAlan Cox * managed by this meta node. 8054be4fd5dSAlan Cox */ 8064be4fd5dSAlan Cox panic("allocation too large"); 8074be4fd5dSAlan Cox } 80892da00bbSMatthew Dillon if (count == radix || scan->u.bmu_avail == 0) { 80992da00bbSMatthew Dillon /* 81092da00bbSMatthew Dillon * ALL-ALLOCATED special case 81192da00bbSMatthew Dillon */ 81292da00bbSMatthew Dillon nblks = scan->u.bmu_avail; 81392da00bbSMatthew Dillon scan->u.bmu_avail = 0; 81486dd278fSAlan Cox scan->bm_bighint = 0; 81592da00bbSMatthew Dillon return nblks; 81692da00bbSMatthew Dillon } 81792da00bbSMatthew Dillon 8184be4fd5dSAlan Cox /* 8194be4fd5dSAlan Cox * An ALL-FREE meta node requires special handling before allocating 8204be4fd5dSAlan Cox * any of its blocks. 8214be4fd5dSAlan Cox */ 82292da00bbSMatthew Dillon if (scan->u.bmu_avail == radix) { 82357e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 82492da00bbSMatthew Dillon 82592da00bbSMatthew Dillon /* 8264be4fd5dSAlan Cox * Reinitialize each of the meta node's children. An ALL-FREE 8274be4fd5dSAlan Cox * meta node cannot have a terminator in any subtree. 82892da00bbSMatthew Dillon */ 82992da00bbSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 83092da00bbSMatthew Dillon if (next_skip == 1) { 83192da00bbSMatthew Dillon scan[i].u.bmu_bitmap = (u_daddr_t)-1; 83292da00bbSMatthew Dillon scan[i].bm_bighint = BLIST_BMAP_RADIX; 83392da00bbSMatthew Dillon } else { 83492da00bbSMatthew Dillon scan[i].bm_bighint = radix; 83592da00bbSMatthew Dillon scan[i].u.bmu_avail = radix; 83692da00bbSMatthew Dillon } 83792da00bbSMatthew Dillon } 83892da00bbSMatthew Dillon } else { 83957e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 84092da00bbSMatthew Dillon } 84192da00bbSMatthew Dillon 84292da00bbSMatthew Dillon i = (allocBlk - blk) / radix; 84392da00bbSMatthew Dillon blk += i * radix; 84492da00bbSMatthew Dillon i = i * next_skip + 1; 84592da00bbSMatthew Dillon 84692da00bbSMatthew Dillon while (i <= skip && blk < allocBlk + count) { 84792da00bbSMatthew Dillon daddr_t v; 84892da00bbSMatthew Dillon 84992da00bbSMatthew Dillon v = blk + radix - allocBlk; 85092da00bbSMatthew Dillon if (v > count) 85192da00bbSMatthew Dillon v = count; 85292da00bbSMatthew Dillon 85392da00bbSMatthew Dillon if (scan->bm_bighint == (daddr_t)-1) 85492da00bbSMatthew Dillon panic("blst_meta_fill: filling unexpected range"); 85592da00bbSMatthew Dillon 85692da00bbSMatthew Dillon if (next_skip == 1) { 85792da00bbSMatthew Dillon nblks += blst_leaf_fill(&scan[i], allocBlk, v); 85892da00bbSMatthew Dillon } else { 85992da00bbSMatthew Dillon nblks += blst_meta_fill(&scan[i], allocBlk, v, 86092da00bbSMatthew Dillon radix, next_skip - 1, blk); 86192da00bbSMatthew Dillon } 86292da00bbSMatthew Dillon count -= v; 86392da00bbSMatthew Dillon allocBlk += v; 86492da00bbSMatthew Dillon blk += radix; 86592da00bbSMatthew Dillon i += next_skip; 86692da00bbSMatthew Dillon } 86792da00bbSMatthew Dillon scan->u.bmu_avail -= nblks; 86892da00bbSMatthew Dillon return nblks; 86992da00bbSMatthew Dillon } 87092da00bbSMatthew Dillon 87192da00bbSMatthew Dillon /* 8727090df5aSMatthew Dillon * BLST_RADIX_INIT() - initialize radix tree 8737090df5aSMatthew Dillon * 8747090df5aSMatthew Dillon * Initialize our meta structures and bitmaps and calculate the exact 8757090df5aSMatthew Dillon * amount of space required to manage 'count' blocks - this space may 876f565f395SEitan Adler * be considerably less than the calculated radix due to the large 8777090df5aSMatthew Dillon * RADIX values we use. 8787090df5aSMatthew Dillon */ 8797090df5aSMatthew Dillon 8807090df5aSMatthew Dillon static daddr_t 8817090df5aSMatthew Dillon blst_radix_init(blmeta_t *scan, daddr_t radix, int skip, daddr_t count) 8827090df5aSMatthew Dillon { 8837090df5aSMatthew Dillon int i; 8847090df5aSMatthew Dillon int next_skip; 8857090df5aSMatthew Dillon daddr_t memindex = 0; 8867090df5aSMatthew Dillon 8877090df5aSMatthew Dillon /* 8887090df5aSMatthew Dillon * Leaf node 8897090df5aSMatthew Dillon */ 8907090df5aSMatthew Dillon 8917090df5aSMatthew Dillon if (radix == BLIST_BMAP_RADIX) { 8927090df5aSMatthew Dillon if (scan) { 8937090df5aSMatthew Dillon scan->bm_bighint = 0; 8947090df5aSMatthew Dillon scan->u.bmu_bitmap = 0; 8957090df5aSMatthew Dillon } 8967090df5aSMatthew Dillon return(memindex); 8977090df5aSMatthew Dillon } 8987090df5aSMatthew Dillon 8997090df5aSMatthew Dillon /* 9007090df5aSMatthew Dillon * Meta node. If allocating the entire object we can special 9017090df5aSMatthew Dillon * case it. However, we need to figure out how much memory 9027090df5aSMatthew Dillon * is required to manage 'count' blocks, so we continue on anyway. 9037090df5aSMatthew Dillon */ 9047090df5aSMatthew Dillon 9057090df5aSMatthew Dillon if (scan) { 9067090df5aSMatthew Dillon scan->bm_bighint = 0; 9077090df5aSMatthew Dillon scan->u.bmu_avail = 0; 9087090df5aSMatthew Dillon } 9097090df5aSMatthew Dillon 91057e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 91157e6d29bSMatthew Dillon next_skip = ((u_int)skip / BLIST_META_RADIX); 9127090df5aSMatthew Dillon 9137090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 9147090df5aSMatthew Dillon if (count >= radix) { 9157090df5aSMatthew Dillon /* 9167090df5aSMatthew Dillon * Allocate the entire object 9177090df5aSMatthew Dillon */ 9187090df5aSMatthew Dillon memindex = i + blst_radix_init( 9197090df5aSMatthew Dillon ((scan) ? &scan[i] : NULL), 9207090df5aSMatthew Dillon radix, 9217090df5aSMatthew Dillon next_skip - 1, 9227090df5aSMatthew Dillon radix 9237090df5aSMatthew Dillon ); 9247090df5aSMatthew Dillon count -= radix; 9257090df5aSMatthew Dillon } else if (count > 0) { 9267090df5aSMatthew Dillon /* 9277090df5aSMatthew Dillon * Allocate a partial object 9287090df5aSMatthew Dillon */ 9297090df5aSMatthew Dillon memindex = i + blst_radix_init( 9307090df5aSMatthew Dillon ((scan) ? &scan[i] : NULL), 9317090df5aSMatthew Dillon radix, 9327090df5aSMatthew Dillon next_skip - 1, 9337090df5aSMatthew Dillon count 9347090df5aSMatthew Dillon ); 9357090df5aSMatthew Dillon count = 0; 9367090df5aSMatthew Dillon } else { 9377090df5aSMatthew Dillon /* 9387090df5aSMatthew Dillon * Add terminator and break out 9397090df5aSMatthew Dillon */ 9407090df5aSMatthew Dillon if (scan) 9417090df5aSMatthew Dillon scan[i].bm_bighint = (daddr_t)-1; 9427090df5aSMatthew Dillon break; 9437090df5aSMatthew Dillon } 9447090df5aSMatthew Dillon } 9457090df5aSMatthew Dillon if (memindex < i) 9467090df5aSMatthew Dillon memindex = i; 9477090df5aSMatthew Dillon return(memindex); 9487090df5aSMatthew Dillon } 9497090df5aSMatthew Dillon 9507090df5aSMatthew Dillon #ifdef BLIST_DEBUG 9517090df5aSMatthew Dillon 9527090df5aSMatthew Dillon static void 9537090df5aSMatthew Dillon blst_radix_print(blmeta_t *scan, daddr_t blk, daddr_t radix, int skip, int tab) 9547090df5aSMatthew Dillon { 9557090df5aSMatthew Dillon int i; 9567090df5aSMatthew Dillon int next_skip; 9577090df5aSMatthew Dillon int lastState = 0; 9587090df5aSMatthew Dillon 9597090df5aSMatthew Dillon if (radix == BLIST_BMAP_RADIX) { 9607090df5aSMatthew Dillon printf( 961d90bf7d8SAlan Cox "%*.*s(%08llx,%lld): bitmap %016llx big=%lld\n", 9627090df5aSMatthew Dillon tab, tab, "", 96392da00bbSMatthew Dillon (long long)blk, (long long)radix, 96492da00bbSMatthew Dillon (long long)scan->u.bmu_bitmap, 96592da00bbSMatthew Dillon (long long)scan->bm_bighint 9667090df5aSMatthew Dillon ); 9677090df5aSMatthew Dillon return; 9687090df5aSMatthew Dillon } 9697090df5aSMatthew Dillon 9707090df5aSMatthew Dillon if (scan->u.bmu_avail == 0) { 9717090df5aSMatthew Dillon printf( 97292da00bbSMatthew Dillon "%*.*s(%08llx,%lld) ALL ALLOCATED\n", 9737090df5aSMatthew Dillon tab, tab, "", 97492da00bbSMatthew Dillon (long long)blk, 97592da00bbSMatthew Dillon (long long)radix 9767090df5aSMatthew Dillon ); 9777090df5aSMatthew Dillon return; 9787090df5aSMatthew Dillon } 9797090df5aSMatthew Dillon if (scan->u.bmu_avail == radix) { 9807090df5aSMatthew Dillon printf( 98192da00bbSMatthew Dillon "%*.*s(%08llx,%lld) ALL FREE\n", 9827090df5aSMatthew Dillon tab, tab, "", 98392da00bbSMatthew Dillon (long long)blk, 98492da00bbSMatthew Dillon (long long)radix 9857090df5aSMatthew Dillon ); 9867090df5aSMatthew Dillon return; 9877090df5aSMatthew Dillon } 9887090df5aSMatthew Dillon 9897090df5aSMatthew Dillon printf( 99092da00bbSMatthew Dillon "%*.*s(%08llx,%lld): subtree (%lld/%lld) big=%lld {\n", 9917090df5aSMatthew Dillon tab, tab, "", 99292da00bbSMatthew Dillon (long long)blk, (long long)radix, 99392da00bbSMatthew Dillon (long long)scan->u.bmu_avail, 99492da00bbSMatthew Dillon (long long)radix, 99592da00bbSMatthew Dillon (long long)scan->bm_bighint 9967090df5aSMatthew Dillon ); 9977090df5aSMatthew Dillon 99857e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 99957e6d29bSMatthew Dillon next_skip = ((u_int)skip / BLIST_META_RADIX); 10007090df5aSMatthew Dillon tab += 4; 10017090df5aSMatthew Dillon 10027090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 10037090df5aSMatthew Dillon if (scan[i].bm_bighint == (daddr_t)-1) { 10047090df5aSMatthew Dillon printf( 100592da00bbSMatthew Dillon "%*.*s(%08llx,%lld): Terminator\n", 10067090df5aSMatthew Dillon tab, tab, "", 100792da00bbSMatthew Dillon (long long)blk, (long long)radix 10087090df5aSMatthew Dillon ); 10097090df5aSMatthew Dillon lastState = 0; 10107090df5aSMatthew Dillon break; 10117090df5aSMatthew Dillon } 10127090df5aSMatthew Dillon blst_radix_print( 10137090df5aSMatthew Dillon &scan[i], 10147090df5aSMatthew Dillon blk, 10157090df5aSMatthew Dillon radix, 10167090df5aSMatthew Dillon next_skip - 1, 10177090df5aSMatthew Dillon tab 10187090df5aSMatthew Dillon ); 10197090df5aSMatthew Dillon blk += radix; 10207090df5aSMatthew Dillon } 10217090df5aSMatthew Dillon tab -= 4; 10227090df5aSMatthew Dillon 10237090df5aSMatthew Dillon printf( 10247090df5aSMatthew Dillon "%*.*s}\n", 10257090df5aSMatthew Dillon tab, tab, "" 10267090df5aSMatthew Dillon ); 10277090df5aSMatthew Dillon } 10287090df5aSMatthew Dillon 10297090df5aSMatthew Dillon #endif 10307090df5aSMatthew Dillon 10317090df5aSMatthew Dillon #ifdef BLIST_DEBUG 10327090df5aSMatthew Dillon 10337090df5aSMatthew Dillon int 10347090df5aSMatthew Dillon main(int ac, char **av) 10357090df5aSMatthew Dillon { 10367090df5aSMatthew Dillon int size = 1024; 10377090df5aSMatthew Dillon int i; 10387090df5aSMatthew Dillon blist_t bl; 10397090df5aSMatthew Dillon 10407090df5aSMatthew Dillon for (i = 1; i < ac; ++i) { 10417090df5aSMatthew Dillon const char *ptr = av[i]; 10427090df5aSMatthew Dillon if (*ptr != '-') { 10437090df5aSMatthew Dillon size = strtol(ptr, NULL, 0); 10447090df5aSMatthew Dillon continue; 10457090df5aSMatthew Dillon } 10467090df5aSMatthew Dillon ptr += 2; 10477090df5aSMatthew Dillon fprintf(stderr, "Bad option: %s\n", ptr - 2); 10487090df5aSMatthew Dillon exit(1); 10497090df5aSMatthew Dillon } 1050c8c7ad92SKip Macy bl = blist_create(size, M_WAITOK); 10517090df5aSMatthew Dillon blist_free(bl, 0, size); 10527090df5aSMatthew Dillon 10537090df5aSMatthew Dillon for (;;) { 10547090df5aSMatthew Dillon char buf[1024]; 1055d90bf7d8SAlan Cox long long da = 0; 1056d90bf7d8SAlan Cox long long count = 0; 10577090df5aSMatthew Dillon 10584be4fd5dSAlan Cox printf("%lld/%lld/%lld> ", (long long)blist_avail(bl), 105992da00bbSMatthew Dillon (long long)size, (long long)bl->bl_radix); 10607090df5aSMatthew Dillon fflush(stdout); 10617090df5aSMatthew Dillon if (fgets(buf, sizeof(buf), stdin) == NULL) 10627090df5aSMatthew Dillon break; 10637090df5aSMatthew Dillon switch(buf[0]) { 10647090df5aSMatthew Dillon case 'r': 106592da00bbSMatthew Dillon if (sscanf(buf + 1, "%lld", &count) == 1) { 1066d90bf7d8SAlan Cox blist_resize(&bl, count, 1, M_WAITOK); 10677090df5aSMatthew Dillon } else { 10687090df5aSMatthew Dillon printf("?\n"); 10697090df5aSMatthew Dillon } 10707090df5aSMatthew Dillon case 'p': 10717090df5aSMatthew Dillon blist_print(bl); 10727090df5aSMatthew Dillon break; 10737090df5aSMatthew Dillon case 'a': 107492da00bbSMatthew Dillon if (sscanf(buf + 1, "%lld", &count) == 1) { 10757090df5aSMatthew Dillon daddr_t blk = blist_alloc(bl, count); 107692da00bbSMatthew Dillon printf(" R=%08llx\n", (long long)blk); 10777090df5aSMatthew Dillon } else { 10787090df5aSMatthew Dillon printf("?\n"); 10797090df5aSMatthew Dillon } 10807090df5aSMatthew Dillon break; 10817090df5aSMatthew Dillon case 'f': 1082d90bf7d8SAlan Cox if (sscanf(buf + 1, "%llx %lld", &da, &count) == 2) { 10837090df5aSMatthew Dillon blist_free(bl, da, count); 10847090df5aSMatthew Dillon } else { 10857090df5aSMatthew Dillon printf("?\n"); 10867090df5aSMatthew Dillon } 10877090df5aSMatthew Dillon break; 108892da00bbSMatthew Dillon case 'l': 1089d90bf7d8SAlan Cox if (sscanf(buf + 1, "%llx %lld", &da, &count) == 2) { 1090a7249a6cSAlan Cox printf(" n=%jd\n", 1091a7249a6cSAlan Cox (intmax_t)blist_fill(bl, da, count)); 109292da00bbSMatthew Dillon } else { 109392da00bbSMatthew Dillon printf("?\n"); 109492da00bbSMatthew Dillon } 109592da00bbSMatthew Dillon break; 10967090df5aSMatthew Dillon case '?': 10977090df5aSMatthew Dillon case 'h': 10987090df5aSMatthew Dillon puts( 10997090df5aSMatthew Dillon "p -print\n" 11007090df5aSMatthew Dillon "a %d -allocate\n" 11017090df5aSMatthew Dillon "f %x %d -free\n" 110292da00bbSMatthew Dillon "l %x %d -fill\n" 11037090df5aSMatthew Dillon "r %d -resize\n" 11047090df5aSMatthew Dillon "h/? -help" 11057090df5aSMatthew Dillon ); 11067090df5aSMatthew Dillon break; 11077090df5aSMatthew Dillon default: 11087090df5aSMatthew Dillon printf("?\n"); 11097090df5aSMatthew Dillon break; 11107090df5aSMatthew Dillon } 11117090df5aSMatthew Dillon } 11127090df5aSMatthew Dillon return(0); 11137090df5aSMatthew Dillon } 11147090df5aSMatthew Dillon 11157090df5aSMatthew Dillon void 11167090df5aSMatthew Dillon panic(const char *ctl, ...) 11177090df5aSMatthew Dillon { 11187090df5aSMatthew Dillon va_list va; 11197090df5aSMatthew Dillon 11207090df5aSMatthew Dillon va_start(va, ctl); 11217090df5aSMatthew Dillon vfprintf(stderr, ctl, va); 11227090df5aSMatthew Dillon fprintf(stderr, "\n"); 11237090df5aSMatthew Dillon va_end(va); 11247090df5aSMatthew Dillon exit(1); 11257090df5aSMatthew Dillon } 11267090df5aSMatthew Dillon 11277090df5aSMatthew Dillon #endif 11287090df5aSMatthew Dillon 1129