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 10992da00bbSMatthew Dillon #define malloc(a,b,c) calloc(a, 1) 1107090df5aSMatthew Dillon #define free(a,b) free(a) 1117090df5aSMatthew Dillon 1127090df5aSMatthew Dillon #include <sys/blist.h> 1137090df5aSMatthew Dillon 1147090df5aSMatthew Dillon void panic(const char *ctl, ...); 1157090df5aSMatthew Dillon 1167090df5aSMatthew Dillon #endif 1177090df5aSMatthew Dillon 1187090df5aSMatthew Dillon /* 1197090df5aSMatthew Dillon * static support functions 1207090df5aSMatthew Dillon */ 1217090df5aSMatthew Dillon 1227090df5aSMatthew Dillon static daddr_t blst_leaf_alloc(blmeta_t *scan, daddr_t blk, int count); 1237090df5aSMatthew Dillon static daddr_t blst_meta_alloc(blmeta_t *scan, daddr_t blk, 1247090df5aSMatthew Dillon daddr_t count, daddr_t radix, int skip); 1257090df5aSMatthew Dillon static void blst_leaf_free(blmeta_t *scan, daddr_t relblk, int count); 1267090df5aSMatthew Dillon static void blst_meta_free(blmeta_t *scan, daddr_t freeBlk, daddr_t count, 1277090df5aSMatthew Dillon daddr_t radix, int skip, daddr_t blk); 1287090df5aSMatthew Dillon static void blst_copy(blmeta_t *scan, daddr_t blk, daddr_t radix, 1297090df5aSMatthew Dillon daddr_t skip, blist_t dest, daddr_t count); 130*a7249a6cSAlan Cox static daddr_t blst_leaf_fill(blmeta_t *scan, daddr_t blk, int count); 131*a7249a6cSAlan Cox static daddr_t blst_meta_fill(blmeta_t *scan, daddr_t allocBlk, daddr_t count, 13292da00bbSMatthew Dillon daddr_t radix, int skip, daddr_t blk); 1337090df5aSMatthew Dillon static daddr_t blst_radix_init(blmeta_t *scan, daddr_t radix, 1347090df5aSMatthew Dillon int skip, daddr_t count); 135c4473420SPeter Wemm #ifndef _KERNEL 1367090df5aSMatthew Dillon static void blst_radix_print(blmeta_t *scan, daddr_t blk, 1377090df5aSMatthew Dillon daddr_t radix, int skip, int tab); 1387090df5aSMatthew Dillon #endif 1397090df5aSMatthew Dillon 140c4473420SPeter Wemm #ifdef _KERNEL 1417090df5aSMatthew Dillon static MALLOC_DEFINE(M_SWAP, "SWAP", "Swap space"); 1427090df5aSMatthew Dillon #endif 1437090df5aSMatthew Dillon 1447090df5aSMatthew Dillon /* 1457090df5aSMatthew Dillon * blist_create() - create a blist capable of handling up to the specified 1467090df5aSMatthew Dillon * number of blocks 1477090df5aSMatthew Dillon * 148f565f395SEitan Adler * blocks - must be greater than 0 149c8c7ad92SKip Macy * flags - malloc flags 1507090df5aSMatthew Dillon * 1517090df5aSMatthew Dillon * The smallest blist consists of a single leaf node capable of 1527090df5aSMatthew Dillon * managing BLIST_BMAP_RADIX blocks. 1537090df5aSMatthew Dillon */ 1547090df5aSMatthew Dillon 1557090df5aSMatthew Dillon blist_t 156c8c7ad92SKip Macy blist_create(daddr_t blocks, int flags) 1577090df5aSMatthew Dillon { 1587090df5aSMatthew Dillon blist_t bl; 1597090df5aSMatthew Dillon int radix; 1607090df5aSMatthew Dillon int skip = 0; 1617090df5aSMatthew Dillon 1627090df5aSMatthew Dillon /* 1637090df5aSMatthew Dillon * Calculate radix and skip field used for scanning. 1647090df5aSMatthew Dillon */ 1657090df5aSMatthew Dillon radix = BLIST_BMAP_RADIX; 1667090df5aSMatthew Dillon 1677090df5aSMatthew Dillon while (radix < blocks) { 16857e6d29bSMatthew Dillon radix *= BLIST_META_RADIX; 16957e6d29bSMatthew Dillon skip = (skip + 1) * BLIST_META_RADIX; 1707090df5aSMatthew Dillon } 1717090df5aSMatthew Dillon 172c8c7ad92SKip Macy bl = malloc(sizeof(struct blist), M_SWAP, flags | M_ZERO); 1737090df5aSMatthew Dillon 1747090df5aSMatthew Dillon bl->bl_blocks = blocks; 1757090df5aSMatthew Dillon bl->bl_radix = radix; 1767090df5aSMatthew Dillon bl->bl_skip = skip; 1777090df5aSMatthew Dillon bl->bl_rootblks = 1 + 1787090df5aSMatthew Dillon blst_radix_init(NULL, bl->bl_radix, bl->bl_skip, blocks); 179c8c7ad92SKip Macy bl->bl_root = malloc(sizeof(blmeta_t) * bl->bl_rootblks, M_SWAP, flags); 1807090df5aSMatthew Dillon 1817090df5aSMatthew Dillon #if defined(BLIST_DEBUG) 1827090df5aSMatthew Dillon printf( 18392da00bbSMatthew Dillon "BLIST representing %lld blocks (%lld MB of swap)" 18492da00bbSMatthew Dillon ", requiring %lldK of ram\n", 18592da00bbSMatthew Dillon (long long)bl->bl_blocks, 18692da00bbSMatthew Dillon (long long)bl->bl_blocks * 4 / 1024, 18792da00bbSMatthew Dillon (long long)(bl->bl_rootblks * sizeof(blmeta_t) + 1023) / 1024 1887090df5aSMatthew Dillon ); 18992da00bbSMatthew Dillon printf("BLIST raw radix tree contains %lld records\n", 19092da00bbSMatthew Dillon (long long)bl->bl_rootblks); 1917090df5aSMatthew Dillon #endif 1927090df5aSMatthew Dillon blst_radix_init(bl->bl_root, bl->bl_radix, bl->bl_skip, blocks); 1937090df5aSMatthew Dillon 1947090df5aSMatthew Dillon return(bl); 1957090df5aSMatthew Dillon } 1967090df5aSMatthew Dillon 1977090df5aSMatthew Dillon void 1987090df5aSMatthew Dillon blist_destroy(blist_t bl) 1997090df5aSMatthew Dillon { 2007090df5aSMatthew Dillon free(bl->bl_root, M_SWAP); 2017090df5aSMatthew Dillon free(bl, M_SWAP); 2027090df5aSMatthew Dillon } 2037090df5aSMatthew Dillon 2047090df5aSMatthew Dillon /* 2057090df5aSMatthew Dillon * blist_alloc() - reserve space in the block bitmap. Return the base 2067090df5aSMatthew Dillon * of a contiguous region or SWAPBLK_NONE if space could 2077090df5aSMatthew Dillon * not be allocated. 2087090df5aSMatthew Dillon */ 2097090df5aSMatthew Dillon 2107090df5aSMatthew Dillon daddr_t 2117090df5aSMatthew Dillon blist_alloc(blist_t bl, daddr_t count) 2127090df5aSMatthew Dillon { 2137090df5aSMatthew Dillon daddr_t blk = SWAPBLK_NONE; 2147090df5aSMatthew Dillon 2157090df5aSMatthew Dillon if (bl) { 2167090df5aSMatthew Dillon if (bl->bl_radix == BLIST_BMAP_RADIX) 2177090df5aSMatthew Dillon blk = blst_leaf_alloc(bl->bl_root, 0, count); 2187090df5aSMatthew Dillon else 2197090df5aSMatthew Dillon blk = blst_meta_alloc(bl->bl_root, 0, count, bl->bl_radix, bl->bl_skip); 2207090df5aSMatthew Dillon if (blk != SWAPBLK_NONE) 2217090df5aSMatthew Dillon bl->bl_free -= count; 2227090df5aSMatthew Dillon } 2237090df5aSMatthew Dillon return(blk); 2247090df5aSMatthew Dillon } 2257090df5aSMatthew Dillon 2267090df5aSMatthew Dillon /* 2277090df5aSMatthew Dillon * blist_free() - free up space in the block bitmap. Return the base 2287090df5aSMatthew Dillon * of a contiguous region. Panic if an inconsistancy is 2297090df5aSMatthew Dillon * found. 2307090df5aSMatthew Dillon */ 2317090df5aSMatthew Dillon 2327090df5aSMatthew Dillon void 2337090df5aSMatthew Dillon blist_free(blist_t bl, daddr_t blkno, daddr_t count) 2347090df5aSMatthew Dillon { 2357090df5aSMatthew Dillon if (bl) { 2367090df5aSMatthew Dillon if (bl->bl_radix == BLIST_BMAP_RADIX) 2377090df5aSMatthew Dillon blst_leaf_free(bl->bl_root, blkno, count); 2387090df5aSMatthew Dillon else 2397090df5aSMatthew Dillon blst_meta_free(bl->bl_root, blkno, count, bl->bl_radix, bl->bl_skip, 0); 2407090df5aSMatthew Dillon bl->bl_free += count; 2417090df5aSMatthew Dillon } 2427090df5aSMatthew Dillon } 2437090df5aSMatthew Dillon 2447090df5aSMatthew Dillon /* 24592da00bbSMatthew Dillon * blist_fill() - mark a region in the block bitmap as off-limits 24692da00bbSMatthew Dillon * to the allocator (i.e. allocate it), ignoring any 24792da00bbSMatthew Dillon * existing allocations. Return the number of blocks 24892da00bbSMatthew Dillon * actually filled that were free before the call. 24992da00bbSMatthew Dillon */ 25092da00bbSMatthew Dillon 251*a7249a6cSAlan Cox daddr_t 25292da00bbSMatthew Dillon blist_fill(blist_t bl, daddr_t blkno, daddr_t count) 25392da00bbSMatthew Dillon { 254*a7249a6cSAlan Cox daddr_t filled; 25592da00bbSMatthew Dillon 25692da00bbSMatthew Dillon if (bl) { 25792da00bbSMatthew Dillon if (bl->bl_radix == BLIST_BMAP_RADIX) 25892da00bbSMatthew Dillon filled = blst_leaf_fill(bl->bl_root, blkno, count); 25992da00bbSMatthew Dillon else 26092da00bbSMatthew Dillon filled = blst_meta_fill(bl->bl_root, blkno, count, 26192da00bbSMatthew Dillon bl->bl_radix, bl->bl_skip, 0); 26292da00bbSMatthew Dillon bl->bl_free -= filled; 26392da00bbSMatthew Dillon return filled; 26492da00bbSMatthew Dillon } else 26592da00bbSMatthew Dillon return 0; 26692da00bbSMatthew Dillon } 26792da00bbSMatthew Dillon 26892da00bbSMatthew Dillon /* 2697090df5aSMatthew Dillon * blist_resize() - resize an existing radix tree to handle the 2707090df5aSMatthew Dillon * specified number of blocks. This will reallocate 2717090df5aSMatthew Dillon * the tree and transfer the previous bitmap to the new 2727090df5aSMatthew Dillon * one. When extending the tree you can specify whether 2737090df5aSMatthew Dillon * the new blocks are to left allocated or freed. 2747090df5aSMatthew Dillon */ 2757090df5aSMatthew Dillon 2767090df5aSMatthew Dillon void 277c8c7ad92SKip Macy blist_resize(blist_t *pbl, daddr_t count, int freenew, int flags) 2787090df5aSMatthew Dillon { 279c8c7ad92SKip Macy blist_t newbl = blist_create(count, flags); 2807090df5aSMatthew Dillon blist_t save = *pbl; 2817090df5aSMatthew Dillon 2827090df5aSMatthew Dillon *pbl = newbl; 2837090df5aSMatthew Dillon if (count > save->bl_blocks) 2847090df5aSMatthew Dillon count = save->bl_blocks; 2857090df5aSMatthew Dillon blst_copy(save->bl_root, 0, save->bl_radix, save->bl_skip, newbl, count); 2867090df5aSMatthew Dillon 2877090df5aSMatthew Dillon /* 2887090df5aSMatthew Dillon * If resizing upwards, should we free the new space or not? 2897090df5aSMatthew Dillon */ 2907090df5aSMatthew Dillon if (freenew && count < newbl->bl_blocks) { 2917090df5aSMatthew Dillon blist_free(newbl, count, newbl->bl_blocks - count); 2927090df5aSMatthew Dillon } 2937090df5aSMatthew Dillon blist_destroy(save); 2947090df5aSMatthew Dillon } 2957090df5aSMatthew Dillon 2967090df5aSMatthew Dillon #ifdef BLIST_DEBUG 2977090df5aSMatthew Dillon 2987090df5aSMatthew Dillon /* 2997090df5aSMatthew Dillon * blist_print() - dump radix tree 3007090df5aSMatthew Dillon */ 3017090df5aSMatthew Dillon 3027090df5aSMatthew Dillon void 3037090df5aSMatthew Dillon blist_print(blist_t bl) 3047090df5aSMatthew Dillon { 3057090df5aSMatthew Dillon printf("BLIST {\n"); 3067090df5aSMatthew Dillon blst_radix_print(bl->bl_root, 0, bl->bl_radix, bl->bl_skip, 4); 3077090df5aSMatthew Dillon printf("}\n"); 3087090df5aSMatthew Dillon } 3097090df5aSMatthew Dillon 3107090df5aSMatthew Dillon #endif 3117090df5aSMatthew Dillon 3127090df5aSMatthew Dillon /************************************************************************ 3137090df5aSMatthew Dillon * ALLOCATION SUPPORT FUNCTIONS * 3147090df5aSMatthew Dillon ************************************************************************ 3157090df5aSMatthew Dillon * 3167090df5aSMatthew Dillon * These support functions do all the actual work. They may seem 3177090df5aSMatthew Dillon * rather longish, but that's because I've commented them up. The 3187090df5aSMatthew Dillon * actual code is straight forward. 3197090df5aSMatthew Dillon * 3207090df5aSMatthew Dillon */ 3217090df5aSMatthew Dillon 3227090df5aSMatthew Dillon /* 3237090df5aSMatthew Dillon * blist_leaf_alloc() - allocate at a leaf in the radix tree (a bitmap). 3247090df5aSMatthew Dillon * 3257090df5aSMatthew Dillon * This is the core of the allocator and is optimized for the 1 block 3267090df5aSMatthew Dillon * and the BLIST_BMAP_RADIX block allocation cases. Other cases are 3277090df5aSMatthew Dillon * somewhat slower. The 1 block allocation case is log2 and extremely 3287090df5aSMatthew Dillon * quick. 3297090df5aSMatthew Dillon */ 3307090df5aSMatthew Dillon 3317090df5aSMatthew Dillon static daddr_t 3327090df5aSMatthew Dillon blst_leaf_alloc( 3337090df5aSMatthew Dillon blmeta_t *scan, 3347090df5aSMatthew Dillon daddr_t blk, 3357090df5aSMatthew Dillon int count 3367090df5aSMatthew Dillon ) { 3377090df5aSMatthew Dillon u_daddr_t orig = scan->u.bmu_bitmap; 3387090df5aSMatthew Dillon 3397090df5aSMatthew Dillon if (orig == 0) { 3407090df5aSMatthew Dillon /* 3417090df5aSMatthew Dillon * Optimize bitmap all-allocated case. Also, count = 1 3427090df5aSMatthew Dillon * case assumes at least 1 bit is free in the bitmap, so 3437090df5aSMatthew Dillon * we have to take care of this case here. 3447090df5aSMatthew Dillon */ 3457090df5aSMatthew Dillon scan->bm_bighint = 0; 3467090df5aSMatthew Dillon return(SWAPBLK_NONE); 3477090df5aSMatthew Dillon } 3487090df5aSMatthew Dillon if (count == 1) { 3497090df5aSMatthew Dillon /* 3507090df5aSMatthew Dillon * Optimized code to allocate one bit out of the bitmap 3517090df5aSMatthew Dillon */ 3527090df5aSMatthew Dillon u_daddr_t mask; 3537090df5aSMatthew Dillon int j = BLIST_BMAP_RADIX/2; 3547090df5aSMatthew Dillon int r = 0; 3557090df5aSMatthew Dillon 3567090df5aSMatthew Dillon mask = (u_daddr_t)-1 >> (BLIST_BMAP_RADIX/2); 3577090df5aSMatthew Dillon 3587090df5aSMatthew Dillon while (j) { 3597090df5aSMatthew Dillon if ((orig & mask) == 0) { 3607090df5aSMatthew Dillon r += j; 3617090df5aSMatthew Dillon orig >>= j; 3627090df5aSMatthew Dillon } 3637090df5aSMatthew Dillon j >>= 1; 3647090df5aSMatthew Dillon mask >>= j; 3657090df5aSMatthew Dillon } 366064650c1SAlan Cox scan->u.bmu_bitmap &= ~((u_daddr_t)1 << r); 3677090df5aSMatthew Dillon return(blk + r); 3687090df5aSMatthew Dillon } 3697090df5aSMatthew Dillon if (count <= BLIST_BMAP_RADIX) { 3707090df5aSMatthew Dillon /* 3717090df5aSMatthew Dillon * non-optimized code to allocate N bits out of the bitmap. 3727090df5aSMatthew Dillon * The more bits, the faster the code runs. It will run 3737090df5aSMatthew Dillon * the slowest allocating 2 bits, but since there aren't any 3747090df5aSMatthew Dillon * memory ops in the core loop (or shouldn't be, anyway), 3757090df5aSMatthew Dillon * you probably won't notice the difference. 3767090df5aSMatthew Dillon */ 3777090df5aSMatthew Dillon int j; 3787090df5aSMatthew Dillon int n = BLIST_BMAP_RADIX - count; 3797090df5aSMatthew Dillon u_daddr_t mask; 3807090df5aSMatthew Dillon 3817090df5aSMatthew Dillon mask = (u_daddr_t)-1 >> n; 3827090df5aSMatthew Dillon 3837090df5aSMatthew Dillon for (j = 0; j <= n; ++j) { 3847090df5aSMatthew Dillon if ((orig & mask) == mask) { 3857090df5aSMatthew Dillon scan->u.bmu_bitmap &= ~mask; 3867090df5aSMatthew Dillon return(blk + j); 3877090df5aSMatthew Dillon } 3887090df5aSMatthew Dillon mask = (mask << 1); 3897090df5aSMatthew Dillon } 3907090df5aSMatthew Dillon } 3917090df5aSMatthew Dillon /* 3927090df5aSMatthew Dillon * We couldn't allocate count in this subtree, update bighint. 3937090df5aSMatthew Dillon */ 3947090df5aSMatthew Dillon scan->bm_bighint = count - 1; 3957090df5aSMatthew Dillon return(SWAPBLK_NONE); 3967090df5aSMatthew Dillon } 3977090df5aSMatthew Dillon 3987090df5aSMatthew Dillon /* 3997090df5aSMatthew Dillon * blist_meta_alloc() - allocate at a meta in the radix tree. 4007090df5aSMatthew Dillon * 4017090df5aSMatthew Dillon * Attempt to allocate at a meta node. If we can't, we update 4027090df5aSMatthew Dillon * bighint and return a failure. Updating bighint optimize future 4037090df5aSMatthew Dillon * calls that hit this node. We have to check for our collapse cases 4047090df5aSMatthew Dillon * and we have a few optimizations strewn in as well. 4057090df5aSMatthew Dillon */ 4067090df5aSMatthew Dillon 4077090df5aSMatthew Dillon static daddr_t 4087090df5aSMatthew Dillon blst_meta_alloc( 4097090df5aSMatthew Dillon blmeta_t *scan, 4107090df5aSMatthew Dillon daddr_t blk, 4117090df5aSMatthew Dillon daddr_t count, 4127090df5aSMatthew Dillon daddr_t radix, 4137090df5aSMatthew Dillon int skip 4147090df5aSMatthew Dillon ) { 4157090df5aSMatthew Dillon int i; 41657e6d29bSMatthew Dillon int next_skip = ((u_int)skip / BLIST_META_RADIX); 4177090df5aSMatthew Dillon 4187090df5aSMatthew Dillon if (scan->u.bmu_avail == 0) { 4197090df5aSMatthew Dillon /* 4207090df5aSMatthew Dillon * ALL-ALLOCATED special case 4217090df5aSMatthew Dillon */ 42286dd278fSAlan Cox scan->bm_bighint = 0; 4237090df5aSMatthew Dillon return(SWAPBLK_NONE); 4247090df5aSMatthew Dillon } 4257090df5aSMatthew Dillon 4267090df5aSMatthew Dillon if (scan->u.bmu_avail == radix) { 42757e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 4287090df5aSMatthew Dillon 4297090df5aSMatthew Dillon /* 4307090df5aSMatthew Dillon * ALL-FREE special case, initialize uninitialize 4317090df5aSMatthew Dillon * sublevel. 4327090df5aSMatthew Dillon */ 4337090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 4347090df5aSMatthew Dillon if (scan[i].bm_bighint == (daddr_t)-1) 4357090df5aSMatthew Dillon break; 4367090df5aSMatthew Dillon if (next_skip == 1) { 4377090df5aSMatthew Dillon scan[i].u.bmu_bitmap = (u_daddr_t)-1; 4387090df5aSMatthew Dillon scan[i].bm_bighint = BLIST_BMAP_RADIX; 4397090df5aSMatthew Dillon } else { 4407090df5aSMatthew Dillon scan[i].bm_bighint = radix; 4417090df5aSMatthew Dillon scan[i].u.bmu_avail = radix; 4427090df5aSMatthew Dillon } 4437090df5aSMatthew Dillon } 4447090df5aSMatthew Dillon } else { 44557e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 4467090df5aSMatthew Dillon } 4477090df5aSMatthew Dillon 4487090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 4497090df5aSMatthew Dillon if (count <= scan[i].bm_bighint) { 4507090df5aSMatthew Dillon /* 4517090df5aSMatthew Dillon * count fits in object 4527090df5aSMatthew Dillon */ 4537090df5aSMatthew Dillon daddr_t r; 4547090df5aSMatthew Dillon if (next_skip == 1) { 4557090df5aSMatthew Dillon r = blst_leaf_alloc(&scan[i], blk, count); 4567090df5aSMatthew Dillon } else { 4577090df5aSMatthew Dillon r = blst_meta_alloc(&scan[i], blk, count, radix, next_skip - 1); 4587090df5aSMatthew Dillon } 4597090df5aSMatthew Dillon if (r != SWAPBLK_NONE) { 4607090df5aSMatthew Dillon scan->u.bmu_avail -= count; 4617090df5aSMatthew Dillon if (scan->bm_bighint > scan->u.bmu_avail) 4627090df5aSMatthew Dillon scan->bm_bighint = scan->u.bmu_avail; 4637090df5aSMatthew Dillon return(r); 4647090df5aSMatthew Dillon } 4657090df5aSMatthew Dillon } else if (scan[i].bm_bighint == (daddr_t)-1) { 4667090df5aSMatthew Dillon /* 4677090df5aSMatthew Dillon * Terminator 4687090df5aSMatthew Dillon */ 4697090df5aSMatthew Dillon break; 4707090df5aSMatthew Dillon } else if (count > radix) { 4717090df5aSMatthew Dillon /* 4727090df5aSMatthew Dillon * count does not fit in object even if it were 4737090df5aSMatthew Dillon * complete free. 4747090df5aSMatthew Dillon */ 4757090df5aSMatthew Dillon panic("blist_meta_alloc: allocation too large"); 4767090df5aSMatthew Dillon } 4777090df5aSMatthew Dillon blk += radix; 4787090df5aSMatthew Dillon } 4797090df5aSMatthew Dillon 4807090df5aSMatthew Dillon /* 4817090df5aSMatthew Dillon * We couldn't allocate count in this subtree, update bighint. 4827090df5aSMatthew Dillon */ 4837090df5aSMatthew Dillon if (scan->bm_bighint >= count) 4847090df5aSMatthew Dillon scan->bm_bighint = count - 1; 4857090df5aSMatthew Dillon return(SWAPBLK_NONE); 4867090df5aSMatthew Dillon } 4877090df5aSMatthew Dillon 4887090df5aSMatthew Dillon /* 4897090df5aSMatthew Dillon * BLST_LEAF_FREE() - free allocated block from leaf bitmap 4907090df5aSMatthew Dillon * 4917090df5aSMatthew Dillon */ 4927090df5aSMatthew Dillon 4937090df5aSMatthew Dillon static void 4947090df5aSMatthew Dillon blst_leaf_free( 4957090df5aSMatthew Dillon blmeta_t *scan, 4967090df5aSMatthew Dillon daddr_t blk, 4977090df5aSMatthew Dillon int count 4987090df5aSMatthew Dillon ) { 4997090df5aSMatthew Dillon /* 5007090df5aSMatthew Dillon * free some data in this bitmap 5017090df5aSMatthew Dillon * 5027090df5aSMatthew Dillon * e.g. 5037090df5aSMatthew Dillon * 0000111111111110000 5047090df5aSMatthew Dillon * \_________/\__/ 5057090df5aSMatthew Dillon * v n 5067090df5aSMatthew Dillon */ 5077090df5aSMatthew Dillon int n = blk & (BLIST_BMAP_RADIX - 1); 5087090df5aSMatthew Dillon u_daddr_t mask; 5097090df5aSMatthew Dillon 5107090df5aSMatthew Dillon mask = ((u_daddr_t)-1 << n) & 5117090df5aSMatthew Dillon ((u_daddr_t)-1 >> (BLIST_BMAP_RADIX - count - n)); 5127090df5aSMatthew Dillon 5137090df5aSMatthew Dillon if (scan->u.bmu_bitmap & mask) 5147090df5aSMatthew Dillon panic("blst_radix_free: freeing free block"); 5157090df5aSMatthew Dillon scan->u.bmu_bitmap |= mask; 5167090df5aSMatthew Dillon 5177090df5aSMatthew Dillon /* 5187090df5aSMatthew Dillon * We could probably do a better job here. We are required to make 5197090df5aSMatthew Dillon * bighint at least as large as the biggest contiguous block of 5207090df5aSMatthew Dillon * data. If we just shoehorn it, a little extra overhead will 5217090df5aSMatthew Dillon * be incured on the next allocation (but only that one typically). 5227090df5aSMatthew Dillon */ 5237090df5aSMatthew Dillon scan->bm_bighint = BLIST_BMAP_RADIX; 5247090df5aSMatthew Dillon } 5257090df5aSMatthew Dillon 5267090df5aSMatthew Dillon /* 5277090df5aSMatthew Dillon * BLST_META_FREE() - free allocated blocks from radix tree meta info 5287090df5aSMatthew Dillon * 5297090df5aSMatthew Dillon * This support routine frees a range of blocks from the bitmap. 5307090df5aSMatthew Dillon * The range must be entirely enclosed by this radix node. If a 5317090df5aSMatthew Dillon * meta node, we break the range down recursively to free blocks 5327090df5aSMatthew Dillon * in subnodes (which means that this code can free an arbitrary 5337090df5aSMatthew Dillon * range whereas the allocation code cannot allocate an arbitrary 5347090df5aSMatthew Dillon * range). 5357090df5aSMatthew Dillon */ 5367090df5aSMatthew Dillon 5377090df5aSMatthew Dillon static void 5387090df5aSMatthew Dillon blst_meta_free( 5397090df5aSMatthew Dillon blmeta_t *scan, 5407090df5aSMatthew Dillon daddr_t freeBlk, 5417090df5aSMatthew Dillon daddr_t count, 5427090df5aSMatthew Dillon daddr_t radix, 5437090df5aSMatthew Dillon int skip, 5447090df5aSMatthew Dillon daddr_t blk 5457090df5aSMatthew Dillon ) { 5467090df5aSMatthew Dillon int i; 54757e6d29bSMatthew Dillon int next_skip = ((u_int)skip / BLIST_META_RADIX); 5487090df5aSMatthew Dillon 5497090df5aSMatthew Dillon #if 0 5501ede983cSDag-Erling Smørgrav printf("free (%llx,%lld) FROM (%llx,%lld)\n", 55192da00bbSMatthew Dillon (long long)freeBlk, (long long)count, 55292da00bbSMatthew Dillon (long long)blk, (long long)radix 5537090df5aSMatthew Dillon ); 5547090df5aSMatthew Dillon #endif 5557090df5aSMatthew Dillon 5567090df5aSMatthew Dillon if (scan->u.bmu_avail == 0) { 5577090df5aSMatthew Dillon /* 5587090df5aSMatthew Dillon * ALL-ALLOCATED special case, with possible 5597090df5aSMatthew Dillon * shortcut to ALL-FREE special case. 5607090df5aSMatthew Dillon */ 5617090df5aSMatthew Dillon scan->u.bmu_avail = count; 5627090df5aSMatthew Dillon scan->bm_bighint = count; 5637090df5aSMatthew Dillon 5647090df5aSMatthew Dillon if (count != radix) { 5657090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 5667090df5aSMatthew Dillon if (scan[i].bm_bighint == (daddr_t)-1) 5677090df5aSMatthew Dillon break; 5687090df5aSMatthew Dillon scan[i].bm_bighint = 0; 5697090df5aSMatthew Dillon if (next_skip == 1) { 5707090df5aSMatthew Dillon scan[i].u.bmu_bitmap = 0; 5717090df5aSMatthew Dillon } else { 5727090df5aSMatthew Dillon scan[i].u.bmu_avail = 0; 5737090df5aSMatthew Dillon } 5747090df5aSMatthew Dillon } 5757090df5aSMatthew Dillon /* fall through */ 5767090df5aSMatthew Dillon } 5777090df5aSMatthew Dillon } else { 5787090df5aSMatthew Dillon scan->u.bmu_avail += count; 5797090df5aSMatthew Dillon /* scan->bm_bighint = radix; */ 5807090df5aSMatthew Dillon } 5817090df5aSMatthew Dillon 5827090df5aSMatthew Dillon /* 5837090df5aSMatthew Dillon * ALL-FREE special case. 5847090df5aSMatthew Dillon */ 5857090df5aSMatthew Dillon 5867090df5aSMatthew Dillon if (scan->u.bmu_avail == radix) 5877090df5aSMatthew Dillon return; 5887090df5aSMatthew Dillon if (scan->u.bmu_avail > radix) 589bdc9a8d0SJohn Baldwin panic("blst_meta_free: freeing already free blocks (%lld) %lld/%lld", 590bdc9a8d0SJohn Baldwin (long long)count, (long long)scan->u.bmu_avail, 591bdc9a8d0SJohn Baldwin (long long)radix); 5927090df5aSMatthew Dillon 5937090df5aSMatthew Dillon /* 5947090df5aSMatthew Dillon * Break the free down into its components 5957090df5aSMatthew Dillon */ 5967090df5aSMatthew Dillon 59757e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 5987090df5aSMatthew Dillon 5997090df5aSMatthew Dillon i = (freeBlk - blk) / radix; 6007090df5aSMatthew Dillon blk += i * radix; 6017090df5aSMatthew Dillon i = i * next_skip + 1; 6027090df5aSMatthew Dillon 6037090df5aSMatthew Dillon while (i <= skip && blk < freeBlk + count) { 6047090df5aSMatthew Dillon daddr_t v; 6057090df5aSMatthew Dillon 6067090df5aSMatthew Dillon v = blk + radix - freeBlk; 6077090df5aSMatthew Dillon if (v > count) 6087090df5aSMatthew Dillon v = count; 6097090df5aSMatthew Dillon 6107090df5aSMatthew Dillon if (scan->bm_bighint == (daddr_t)-1) 6117090df5aSMatthew Dillon panic("blst_meta_free: freeing unexpected range"); 6127090df5aSMatthew Dillon 6137090df5aSMatthew Dillon if (next_skip == 1) { 6147090df5aSMatthew Dillon blst_leaf_free(&scan[i], freeBlk, v); 6157090df5aSMatthew Dillon } else { 6167090df5aSMatthew Dillon blst_meta_free(&scan[i], freeBlk, v, radix, next_skip - 1, blk); 6177090df5aSMatthew Dillon } 6187090df5aSMatthew Dillon if (scan->bm_bighint < scan[i].bm_bighint) 6197090df5aSMatthew Dillon scan->bm_bighint = scan[i].bm_bighint; 6207090df5aSMatthew Dillon count -= v; 6217090df5aSMatthew Dillon freeBlk += v; 6227090df5aSMatthew Dillon blk += radix; 6237090df5aSMatthew Dillon i += next_skip; 6247090df5aSMatthew Dillon } 6257090df5aSMatthew Dillon } 6267090df5aSMatthew Dillon 6277090df5aSMatthew Dillon /* 6287090df5aSMatthew Dillon * BLIST_RADIX_COPY() - copy one radix tree to another 6297090df5aSMatthew Dillon * 6307090df5aSMatthew Dillon * Locates free space in the source tree and frees it in the destination 6317090df5aSMatthew Dillon * tree. The space may not already be free in the destination. 6327090df5aSMatthew Dillon */ 6337090df5aSMatthew Dillon 6347090df5aSMatthew Dillon static void blst_copy( 6357090df5aSMatthew Dillon blmeta_t *scan, 6367090df5aSMatthew Dillon daddr_t blk, 6377090df5aSMatthew Dillon daddr_t radix, 6387090df5aSMatthew Dillon daddr_t skip, 6397090df5aSMatthew Dillon blist_t dest, 6407090df5aSMatthew Dillon daddr_t count 6417090df5aSMatthew Dillon ) { 6427090df5aSMatthew Dillon int next_skip; 6437090df5aSMatthew Dillon int i; 6447090df5aSMatthew Dillon 6457090df5aSMatthew Dillon /* 6467090df5aSMatthew Dillon * Leaf node 6477090df5aSMatthew Dillon */ 6487090df5aSMatthew Dillon 6497090df5aSMatthew Dillon if (radix == BLIST_BMAP_RADIX) { 6507090df5aSMatthew Dillon u_daddr_t v = scan->u.bmu_bitmap; 6517090df5aSMatthew Dillon 6527090df5aSMatthew Dillon if (v == (u_daddr_t)-1) { 6537090df5aSMatthew Dillon blist_free(dest, blk, count); 6547090df5aSMatthew Dillon } else if (v != 0) { 6557090df5aSMatthew Dillon int i; 6567090df5aSMatthew Dillon 6577090df5aSMatthew Dillon for (i = 0; i < BLIST_BMAP_RADIX && i < count; ++i) { 658064650c1SAlan Cox if (v & ((u_daddr_t)1 << i)) 6597090df5aSMatthew Dillon blist_free(dest, blk + i, 1); 6607090df5aSMatthew Dillon } 6617090df5aSMatthew Dillon } 6627090df5aSMatthew Dillon return; 6637090df5aSMatthew Dillon } 6647090df5aSMatthew Dillon 6657090df5aSMatthew Dillon /* 6667090df5aSMatthew Dillon * Meta node 6677090df5aSMatthew Dillon */ 6687090df5aSMatthew Dillon 6697090df5aSMatthew Dillon if (scan->u.bmu_avail == 0) { 6707090df5aSMatthew Dillon /* 6717090df5aSMatthew Dillon * Source all allocated, leave dest allocated 6727090df5aSMatthew Dillon */ 6737090df5aSMatthew Dillon return; 6747090df5aSMatthew Dillon } 6757090df5aSMatthew Dillon if (scan->u.bmu_avail == radix) { 6767090df5aSMatthew Dillon /* 6777090df5aSMatthew Dillon * Source all free, free entire dest 6787090df5aSMatthew Dillon */ 6797090df5aSMatthew Dillon if (count < radix) 6807090df5aSMatthew Dillon blist_free(dest, blk, count); 6817090df5aSMatthew Dillon else 6827090df5aSMatthew Dillon blist_free(dest, blk, radix); 6837090df5aSMatthew Dillon return; 6847090df5aSMatthew Dillon } 6857090df5aSMatthew Dillon 6867090df5aSMatthew Dillon 68757e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 68857e6d29bSMatthew Dillon next_skip = ((u_int)skip / BLIST_META_RADIX); 6897090df5aSMatthew Dillon 6907090df5aSMatthew Dillon for (i = 1; count && i <= skip; i += next_skip) { 6917090df5aSMatthew Dillon if (scan[i].bm_bighint == (daddr_t)-1) 6927090df5aSMatthew Dillon break; 6937090df5aSMatthew Dillon 6947090df5aSMatthew Dillon if (count >= radix) { 6957090df5aSMatthew Dillon blst_copy( 6967090df5aSMatthew Dillon &scan[i], 6977090df5aSMatthew Dillon blk, 6987090df5aSMatthew Dillon radix, 6997090df5aSMatthew Dillon next_skip - 1, 7007090df5aSMatthew Dillon dest, 7017090df5aSMatthew Dillon radix 7027090df5aSMatthew Dillon ); 7037090df5aSMatthew Dillon count -= radix; 7047090df5aSMatthew Dillon } else { 7057090df5aSMatthew Dillon if (count) { 7067090df5aSMatthew Dillon blst_copy( 7077090df5aSMatthew Dillon &scan[i], 7087090df5aSMatthew Dillon blk, 7097090df5aSMatthew Dillon radix, 7107090df5aSMatthew Dillon next_skip - 1, 7117090df5aSMatthew Dillon dest, 7127090df5aSMatthew Dillon count 7137090df5aSMatthew Dillon ); 7147090df5aSMatthew Dillon } 7157090df5aSMatthew Dillon count = 0; 7167090df5aSMatthew Dillon } 7177090df5aSMatthew Dillon blk += radix; 7187090df5aSMatthew Dillon } 7197090df5aSMatthew Dillon } 7207090df5aSMatthew Dillon 7217090df5aSMatthew Dillon /* 72292da00bbSMatthew Dillon * BLST_LEAF_FILL() - allocate specific blocks in leaf bitmap 72392da00bbSMatthew Dillon * 72492da00bbSMatthew Dillon * This routine allocates all blocks in the specified range 72592da00bbSMatthew Dillon * regardless of any existing allocations in that range. Returns 72692da00bbSMatthew Dillon * the number of blocks allocated by the call. 72792da00bbSMatthew Dillon */ 72892da00bbSMatthew Dillon 729*a7249a6cSAlan Cox static daddr_t 73092da00bbSMatthew Dillon blst_leaf_fill(blmeta_t *scan, daddr_t blk, int count) 73192da00bbSMatthew Dillon { 73292da00bbSMatthew Dillon int n = blk & (BLIST_BMAP_RADIX - 1); 733*a7249a6cSAlan Cox daddr_t nblks; 73492da00bbSMatthew Dillon u_daddr_t mask, bitmap; 73592da00bbSMatthew Dillon 73692da00bbSMatthew Dillon mask = ((u_daddr_t)-1 << n) & 73792da00bbSMatthew Dillon ((u_daddr_t)-1 >> (BLIST_BMAP_RADIX - count - n)); 73892da00bbSMatthew Dillon 73992da00bbSMatthew Dillon /* Count the number of blocks we're about to allocate */ 74092da00bbSMatthew Dillon bitmap = scan->u.bmu_bitmap & mask; 74192da00bbSMatthew Dillon for (nblks = 0; bitmap != 0; nblks++) 74292da00bbSMatthew Dillon bitmap &= bitmap - 1; 74392da00bbSMatthew Dillon 74492da00bbSMatthew Dillon scan->u.bmu_bitmap &= ~mask; 74592da00bbSMatthew Dillon return nblks; 74692da00bbSMatthew Dillon } 74792da00bbSMatthew Dillon 74892da00bbSMatthew Dillon /* 74992da00bbSMatthew Dillon * BLIST_META_FILL() - allocate specific blocks at a meta node 75092da00bbSMatthew Dillon * 75192da00bbSMatthew Dillon * This routine allocates the specified range of blocks, 75292da00bbSMatthew Dillon * regardless of any existing allocations in the range. The 75392da00bbSMatthew Dillon * range must be within the extent of this node. Returns the 75492da00bbSMatthew Dillon * number of blocks allocated by the call. 75592da00bbSMatthew Dillon */ 756*a7249a6cSAlan Cox static daddr_t 75792da00bbSMatthew Dillon blst_meta_fill( 75892da00bbSMatthew Dillon blmeta_t *scan, 75992da00bbSMatthew Dillon daddr_t allocBlk, 76092da00bbSMatthew Dillon daddr_t count, 76192da00bbSMatthew Dillon daddr_t radix, 76292da00bbSMatthew Dillon int skip, 76392da00bbSMatthew Dillon daddr_t blk 76492da00bbSMatthew Dillon ) { 76592da00bbSMatthew Dillon int i; 76657e6d29bSMatthew Dillon int next_skip = ((u_int)skip / BLIST_META_RADIX); 767*a7249a6cSAlan Cox daddr_t nblks = 0; 76892da00bbSMatthew Dillon 76903bdd65fSAlan Cox if (count > radix) 77003bdd65fSAlan Cox panic("blist_meta_fill: allocation too large"); 77192da00bbSMatthew Dillon if (count == radix || scan->u.bmu_avail == 0) { 77292da00bbSMatthew Dillon /* 77392da00bbSMatthew Dillon * ALL-ALLOCATED special case 77492da00bbSMatthew Dillon */ 77592da00bbSMatthew Dillon nblks = scan->u.bmu_avail; 77692da00bbSMatthew Dillon scan->u.bmu_avail = 0; 77786dd278fSAlan Cox scan->bm_bighint = 0; 77892da00bbSMatthew Dillon return nblks; 77992da00bbSMatthew Dillon } 78092da00bbSMatthew Dillon 78192da00bbSMatthew Dillon if (scan->u.bmu_avail == radix) { 78257e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 78392da00bbSMatthew Dillon 78492da00bbSMatthew Dillon /* 78592da00bbSMatthew Dillon * ALL-FREE special case, initialize sublevel 78692da00bbSMatthew Dillon */ 78792da00bbSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 78892da00bbSMatthew Dillon if (scan[i].bm_bighint == (daddr_t)-1) 78992da00bbSMatthew Dillon break; 79092da00bbSMatthew Dillon if (next_skip == 1) { 79192da00bbSMatthew Dillon scan[i].u.bmu_bitmap = (u_daddr_t)-1; 79292da00bbSMatthew Dillon scan[i].bm_bighint = BLIST_BMAP_RADIX; 79392da00bbSMatthew Dillon } else { 79492da00bbSMatthew Dillon scan[i].bm_bighint = radix; 79592da00bbSMatthew Dillon scan[i].u.bmu_avail = radix; 79692da00bbSMatthew Dillon } 79792da00bbSMatthew Dillon } 79892da00bbSMatthew Dillon } else { 79957e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 80092da00bbSMatthew Dillon } 80192da00bbSMatthew Dillon 80292da00bbSMatthew Dillon i = (allocBlk - blk) / radix; 80392da00bbSMatthew Dillon blk += i * radix; 80492da00bbSMatthew Dillon i = i * next_skip + 1; 80592da00bbSMatthew Dillon 80692da00bbSMatthew Dillon while (i <= skip && blk < allocBlk + count) { 80792da00bbSMatthew Dillon daddr_t v; 80892da00bbSMatthew Dillon 80992da00bbSMatthew Dillon v = blk + radix - allocBlk; 81092da00bbSMatthew Dillon if (v > count) 81192da00bbSMatthew Dillon v = count; 81292da00bbSMatthew Dillon 81392da00bbSMatthew Dillon if (scan->bm_bighint == (daddr_t)-1) 81492da00bbSMatthew Dillon panic("blst_meta_fill: filling unexpected range"); 81592da00bbSMatthew Dillon 81692da00bbSMatthew Dillon if (next_skip == 1) { 81792da00bbSMatthew Dillon nblks += blst_leaf_fill(&scan[i], allocBlk, v); 81892da00bbSMatthew Dillon } else { 81992da00bbSMatthew Dillon nblks += blst_meta_fill(&scan[i], allocBlk, v, 82092da00bbSMatthew Dillon radix, next_skip - 1, blk); 82192da00bbSMatthew Dillon } 82292da00bbSMatthew Dillon count -= v; 82392da00bbSMatthew Dillon allocBlk += v; 82492da00bbSMatthew Dillon blk += radix; 82592da00bbSMatthew Dillon i += next_skip; 82692da00bbSMatthew Dillon } 82792da00bbSMatthew Dillon scan->u.bmu_avail -= nblks; 82892da00bbSMatthew Dillon return nblks; 82992da00bbSMatthew Dillon } 83092da00bbSMatthew Dillon 83192da00bbSMatthew Dillon /* 8327090df5aSMatthew Dillon * BLST_RADIX_INIT() - initialize radix tree 8337090df5aSMatthew Dillon * 8347090df5aSMatthew Dillon * Initialize our meta structures and bitmaps and calculate the exact 8357090df5aSMatthew Dillon * amount of space required to manage 'count' blocks - this space may 836f565f395SEitan Adler * be considerably less than the calculated radix due to the large 8377090df5aSMatthew Dillon * RADIX values we use. 8387090df5aSMatthew Dillon */ 8397090df5aSMatthew Dillon 8407090df5aSMatthew Dillon static daddr_t 8417090df5aSMatthew Dillon blst_radix_init(blmeta_t *scan, daddr_t radix, int skip, daddr_t count) 8427090df5aSMatthew Dillon { 8437090df5aSMatthew Dillon int i; 8447090df5aSMatthew Dillon int next_skip; 8457090df5aSMatthew Dillon daddr_t memindex = 0; 8467090df5aSMatthew Dillon 8477090df5aSMatthew Dillon /* 8487090df5aSMatthew Dillon * Leaf node 8497090df5aSMatthew Dillon */ 8507090df5aSMatthew Dillon 8517090df5aSMatthew Dillon if (radix == BLIST_BMAP_RADIX) { 8527090df5aSMatthew Dillon if (scan) { 8537090df5aSMatthew Dillon scan->bm_bighint = 0; 8547090df5aSMatthew Dillon scan->u.bmu_bitmap = 0; 8557090df5aSMatthew Dillon } 8567090df5aSMatthew Dillon return(memindex); 8577090df5aSMatthew Dillon } 8587090df5aSMatthew Dillon 8597090df5aSMatthew Dillon /* 8607090df5aSMatthew Dillon * Meta node. If allocating the entire object we can special 8617090df5aSMatthew Dillon * case it. However, we need to figure out how much memory 8627090df5aSMatthew Dillon * is required to manage 'count' blocks, so we continue on anyway. 8637090df5aSMatthew Dillon */ 8647090df5aSMatthew Dillon 8657090df5aSMatthew Dillon if (scan) { 8667090df5aSMatthew Dillon scan->bm_bighint = 0; 8677090df5aSMatthew Dillon scan->u.bmu_avail = 0; 8687090df5aSMatthew Dillon } 8697090df5aSMatthew Dillon 87057e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 87157e6d29bSMatthew Dillon next_skip = ((u_int)skip / BLIST_META_RADIX); 8727090df5aSMatthew Dillon 8737090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 8747090df5aSMatthew Dillon if (count >= radix) { 8757090df5aSMatthew Dillon /* 8767090df5aSMatthew Dillon * Allocate the entire object 8777090df5aSMatthew Dillon */ 8787090df5aSMatthew Dillon memindex = i + blst_radix_init( 8797090df5aSMatthew Dillon ((scan) ? &scan[i] : NULL), 8807090df5aSMatthew Dillon radix, 8817090df5aSMatthew Dillon next_skip - 1, 8827090df5aSMatthew Dillon radix 8837090df5aSMatthew Dillon ); 8847090df5aSMatthew Dillon count -= radix; 8857090df5aSMatthew Dillon } else if (count > 0) { 8867090df5aSMatthew Dillon /* 8877090df5aSMatthew Dillon * Allocate a partial object 8887090df5aSMatthew Dillon */ 8897090df5aSMatthew Dillon memindex = i + blst_radix_init( 8907090df5aSMatthew Dillon ((scan) ? &scan[i] : NULL), 8917090df5aSMatthew Dillon radix, 8927090df5aSMatthew Dillon next_skip - 1, 8937090df5aSMatthew Dillon count 8947090df5aSMatthew Dillon ); 8957090df5aSMatthew Dillon count = 0; 8967090df5aSMatthew Dillon } else { 8977090df5aSMatthew Dillon /* 8987090df5aSMatthew Dillon * Add terminator and break out 8997090df5aSMatthew Dillon */ 9007090df5aSMatthew Dillon if (scan) 9017090df5aSMatthew Dillon scan[i].bm_bighint = (daddr_t)-1; 9027090df5aSMatthew Dillon break; 9037090df5aSMatthew Dillon } 9047090df5aSMatthew Dillon } 9057090df5aSMatthew Dillon if (memindex < i) 9067090df5aSMatthew Dillon memindex = i; 9077090df5aSMatthew Dillon return(memindex); 9087090df5aSMatthew Dillon } 9097090df5aSMatthew Dillon 9107090df5aSMatthew Dillon #ifdef BLIST_DEBUG 9117090df5aSMatthew Dillon 9127090df5aSMatthew Dillon static void 9137090df5aSMatthew Dillon blst_radix_print(blmeta_t *scan, daddr_t blk, daddr_t radix, int skip, int tab) 9147090df5aSMatthew Dillon { 9157090df5aSMatthew Dillon int i; 9167090df5aSMatthew Dillon int next_skip; 9177090df5aSMatthew Dillon int lastState = 0; 9187090df5aSMatthew Dillon 9197090df5aSMatthew Dillon if (radix == BLIST_BMAP_RADIX) { 9207090df5aSMatthew Dillon printf( 921d90bf7d8SAlan Cox "%*.*s(%08llx,%lld): bitmap %016llx big=%lld\n", 9227090df5aSMatthew Dillon tab, tab, "", 92392da00bbSMatthew Dillon (long long)blk, (long long)radix, 92492da00bbSMatthew Dillon (long long)scan->u.bmu_bitmap, 92592da00bbSMatthew Dillon (long long)scan->bm_bighint 9267090df5aSMatthew Dillon ); 9277090df5aSMatthew Dillon return; 9287090df5aSMatthew Dillon } 9297090df5aSMatthew Dillon 9307090df5aSMatthew Dillon if (scan->u.bmu_avail == 0) { 9317090df5aSMatthew Dillon printf( 93292da00bbSMatthew Dillon "%*.*s(%08llx,%lld) ALL ALLOCATED\n", 9337090df5aSMatthew Dillon tab, tab, "", 93492da00bbSMatthew Dillon (long long)blk, 93592da00bbSMatthew Dillon (long long)radix 9367090df5aSMatthew Dillon ); 9377090df5aSMatthew Dillon return; 9387090df5aSMatthew Dillon } 9397090df5aSMatthew Dillon if (scan->u.bmu_avail == radix) { 9407090df5aSMatthew Dillon printf( 94192da00bbSMatthew Dillon "%*.*s(%08llx,%lld) ALL FREE\n", 9427090df5aSMatthew Dillon tab, tab, "", 94392da00bbSMatthew Dillon (long long)blk, 94492da00bbSMatthew Dillon (long long)radix 9457090df5aSMatthew Dillon ); 9467090df5aSMatthew Dillon return; 9477090df5aSMatthew Dillon } 9487090df5aSMatthew Dillon 9497090df5aSMatthew Dillon printf( 95092da00bbSMatthew Dillon "%*.*s(%08llx,%lld): subtree (%lld/%lld) big=%lld {\n", 9517090df5aSMatthew Dillon tab, tab, "", 95292da00bbSMatthew Dillon (long long)blk, (long long)radix, 95392da00bbSMatthew Dillon (long long)scan->u.bmu_avail, 95492da00bbSMatthew Dillon (long long)radix, 95592da00bbSMatthew Dillon (long long)scan->bm_bighint 9567090df5aSMatthew Dillon ); 9577090df5aSMatthew Dillon 95857e6d29bSMatthew Dillon radix /= BLIST_META_RADIX; 95957e6d29bSMatthew Dillon next_skip = ((u_int)skip / BLIST_META_RADIX); 9607090df5aSMatthew Dillon tab += 4; 9617090df5aSMatthew Dillon 9627090df5aSMatthew Dillon for (i = 1; i <= skip; i += next_skip) { 9637090df5aSMatthew Dillon if (scan[i].bm_bighint == (daddr_t)-1) { 9647090df5aSMatthew Dillon printf( 96592da00bbSMatthew Dillon "%*.*s(%08llx,%lld): Terminator\n", 9667090df5aSMatthew Dillon tab, tab, "", 96792da00bbSMatthew Dillon (long long)blk, (long long)radix 9687090df5aSMatthew Dillon ); 9697090df5aSMatthew Dillon lastState = 0; 9707090df5aSMatthew Dillon break; 9717090df5aSMatthew Dillon } 9727090df5aSMatthew Dillon blst_radix_print( 9737090df5aSMatthew Dillon &scan[i], 9747090df5aSMatthew Dillon blk, 9757090df5aSMatthew Dillon radix, 9767090df5aSMatthew Dillon next_skip - 1, 9777090df5aSMatthew Dillon tab 9787090df5aSMatthew Dillon ); 9797090df5aSMatthew Dillon blk += radix; 9807090df5aSMatthew Dillon } 9817090df5aSMatthew Dillon tab -= 4; 9827090df5aSMatthew Dillon 9837090df5aSMatthew Dillon printf( 9847090df5aSMatthew Dillon "%*.*s}\n", 9857090df5aSMatthew Dillon tab, tab, "" 9867090df5aSMatthew Dillon ); 9877090df5aSMatthew Dillon } 9887090df5aSMatthew Dillon 9897090df5aSMatthew Dillon #endif 9907090df5aSMatthew Dillon 9917090df5aSMatthew Dillon #ifdef BLIST_DEBUG 9927090df5aSMatthew Dillon 9937090df5aSMatthew Dillon int 9947090df5aSMatthew Dillon main(int ac, char **av) 9957090df5aSMatthew Dillon { 9967090df5aSMatthew Dillon int size = 1024; 9977090df5aSMatthew Dillon int i; 9987090df5aSMatthew Dillon blist_t bl; 9997090df5aSMatthew Dillon 10007090df5aSMatthew Dillon for (i = 1; i < ac; ++i) { 10017090df5aSMatthew Dillon const char *ptr = av[i]; 10027090df5aSMatthew Dillon if (*ptr != '-') { 10037090df5aSMatthew Dillon size = strtol(ptr, NULL, 0); 10047090df5aSMatthew Dillon continue; 10057090df5aSMatthew Dillon } 10067090df5aSMatthew Dillon ptr += 2; 10077090df5aSMatthew Dillon fprintf(stderr, "Bad option: %s\n", ptr - 2); 10087090df5aSMatthew Dillon exit(1); 10097090df5aSMatthew Dillon } 1010c8c7ad92SKip Macy bl = blist_create(size, M_WAITOK); 10117090df5aSMatthew Dillon blist_free(bl, 0, size); 10127090df5aSMatthew Dillon 10137090df5aSMatthew Dillon for (;;) { 10147090df5aSMatthew Dillon char buf[1024]; 1015d90bf7d8SAlan Cox long long da = 0; 1016d90bf7d8SAlan Cox long long count = 0; 10177090df5aSMatthew Dillon 101892da00bbSMatthew Dillon printf("%lld/%lld/%lld> ", (long long)bl->bl_free, 101992da00bbSMatthew Dillon (long long)size, (long long)bl->bl_radix); 10207090df5aSMatthew Dillon fflush(stdout); 10217090df5aSMatthew Dillon if (fgets(buf, sizeof(buf), stdin) == NULL) 10227090df5aSMatthew Dillon break; 10237090df5aSMatthew Dillon switch(buf[0]) { 10247090df5aSMatthew Dillon case 'r': 102592da00bbSMatthew Dillon if (sscanf(buf + 1, "%lld", &count) == 1) { 1026d90bf7d8SAlan Cox blist_resize(&bl, count, 1, M_WAITOK); 10277090df5aSMatthew Dillon } else { 10287090df5aSMatthew Dillon printf("?\n"); 10297090df5aSMatthew Dillon } 10307090df5aSMatthew Dillon case 'p': 10317090df5aSMatthew Dillon blist_print(bl); 10327090df5aSMatthew Dillon break; 10337090df5aSMatthew Dillon case 'a': 103492da00bbSMatthew Dillon if (sscanf(buf + 1, "%lld", &count) == 1) { 10357090df5aSMatthew Dillon daddr_t blk = blist_alloc(bl, count); 103692da00bbSMatthew Dillon printf(" R=%08llx\n", (long long)blk); 10377090df5aSMatthew Dillon } else { 10387090df5aSMatthew Dillon printf("?\n"); 10397090df5aSMatthew Dillon } 10407090df5aSMatthew Dillon break; 10417090df5aSMatthew Dillon case 'f': 1042d90bf7d8SAlan Cox if (sscanf(buf + 1, "%llx %lld", &da, &count) == 2) { 10437090df5aSMatthew Dillon blist_free(bl, da, count); 10447090df5aSMatthew Dillon } else { 10457090df5aSMatthew Dillon printf("?\n"); 10467090df5aSMatthew Dillon } 10477090df5aSMatthew Dillon break; 104892da00bbSMatthew Dillon case 'l': 1049d90bf7d8SAlan Cox if (sscanf(buf + 1, "%llx %lld", &da, &count) == 2) { 1050*a7249a6cSAlan Cox printf(" n=%jd\n", 1051*a7249a6cSAlan Cox (intmax_t)blist_fill(bl, da, count)); 105292da00bbSMatthew Dillon } else { 105392da00bbSMatthew Dillon printf("?\n"); 105492da00bbSMatthew Dillon } 105592da00bbSMatthew Dillon break; 10567090df5aSMatthew Dillon case '?': 10577090df5aSMatthew Dillon case 'h': 10587090df5aSMatthew Dillon puts( 10597090df5aSMatthew Dillon "p -print\n" 10607090df5aSMatthew Dillon "a %d -allocate\n" 10617090df5aSMatthew Dillon "f %x %d -free\n" 106292da00bbSMatthew Dillon "l %x %d -fill\n" 10637090df5aSMatthew Dillon "r %d -resize\n" 10647090df5aSMatthew Dillon "h/? -help" 10657090df5aSMatthew Dillon ); 10667090df5aSMatthew Dillon break; 10677090df5aSMatthew Dillon default: 10687090df5aSMatthew Dillon printf("?\n"); 10697090df5aSMatthew Dillon break; 10707090df5aSMatthew Dillon } 10717090df5aSMatthew Dillon } 10727090df5aSMatthew Dillon return(0); 10737090df5aSMatthew Dillon } 10747090df5aSMatthew Dillon 10757090df5aSMatthew Dillon void 10767090df5aSMatthew Dillon panic(const char *ctl, ...) 10777090df5aSMatthew Dillon { 10787090df5aSMatthew Dillon va_list va; 10797090df5aSMatthew Dillon 10807090df5aSMatthew Dillon va_start(va, ctl); 10817090df5aSMatthew Dillon vfprintf(stderr, ctl, va); 10827090df5aSMatthew Dillon fprintf(stderr, "\n"); 10837090df5aSMatthew Dillon va_end(va); 10847090df5aSMatthew Dillon exit(1); 10857090df5aSMatthew Dillon } 10867090df5aSMatthew Dillon 10877090df5aSMatthew Dillon #endif 10887090df5aSMatthew Dillon 1089