18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci *  linux/fs/hfsplus/btree.c
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright (C) 2001
68c2ecf20Sopenharmony_ci * Brad Boyer (flar@allandria.com)
78c2ecf20Sopenharmony_ci * (C) 2003 Ardis Technologies <roman@ardistech.com>
88c2ecf20Sopenharmony_ci *
98c2ecf20Sopenharmony_ci * Handle opening/closing btree
108c2ecf20Sopenharmony_ci */
118c2ecf20Sopenharmony_ci
128c2ecf20Sopenharmony_ci#include <linux/slab.h>
138c2ecf20Sopenharmony_ci#include <linux/pagemap.h>
148c2ecf20Sopenharmony_ci#include <linux/log2.h>
158c2ecf20Sopenharmony_ci
168c2ecf20Sopenharmony_ci#include "hfsplus_fs.h"
178c2ecf20Sopenharmony_ci#include "hfsplus_raw.h"
188c2ecf20Sopenharmony_ci
198c2ecf20Sopenharmony_ci/*
208c2ecf20Sopenharmony_ci * Initial source code of clump size calculation is gotten
218c2ecf20Sopenharmony_ci * from http://opensource.apple.com/tarballs/diskdev_cmds/
228c2ecf20Sopenharmony_ci */
238c2ecf20Sopenharmony_ci#define CLUMP_ENTRIES	15
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_cistatic short clumptbl[CLUMP_ENTRIES * 3] = {
268c2ecf20Sopenharmony_ci/*
278c2ecf20Sopenharmony_ci *	    Volume	Attributes	 Catalog	 Extents
288c2ecf20Sopenharmony_ci *	     Size	Clump (MB)	Clump (MB)	Clump (MB)
298c2ecf20Sopenharmony_ci */
308c2ecf20Sopenharmony_ci	/*   1GB */	  4,		  4,		 4,
318c2ecf20Sopenharmony_ci	/*   2GB */	  6,		  6,		 4,
328c2ecf20Sopenharmony_ci	/*   4GB */	  8,		  8,		 4,
338c2ecf20Sopenharmony_ci	/*   8GB */	 11,		 11,		 5,
348c2ecf20Sopenharmony_ci	/*
358c2ecf20Sopenharmony_ci	 * For volumes 16GB and larger, we want to make sure that a full OS
368c2ecf20Sopenharmony_ci	 * install won't require fragmentation of the Catalog or Attributes
378c2ecf20Sopenharmony_ci	 * B-trees.  We do this by making the clump sizes sufficiently large,
388c2ecf20Sopenharmony_ci	 * and by leaving a gap after the B-trees for them to grow into.
398c2ecf20Sopenharmony_ci	 *
408c2ecf20Sopenharmony_ci	 * For SnowLeopard 10A298, a FullNetInstall with all packages selected
418c2ecf20Sopenharmony_ci	 * results in:
428c2ecf20Sopenharmony_ci	 * Catalog B-tree Header
438c2ecf20Sopenharmony_ci	 *	nodeSize:          8192
448c2ecf20Sopenharmony_ci	 *	totalNodes:       31616
458c2ecf20Sopenharmony_ci	 *	freeNodes:         1978
468c2ecf20Sopenharmony_ci	 * (used = 231.55 MB)
478c2ecf20Sopenharmony_ci	 * Attributes B-tree Header
488c2ecf20Sopenharmony_ci	 *	nodeSize:          8192
498c2ecf20Sopenharmony_ci	 *	totalNodes:       63232
508c2ecf20Sopenharmony_ci	 *	freeNodes:          958
518c2ecf20Sopenharmony_ci	 * (used = 486.52 MB)
528c2ecf20Sopenharmony_ci	 *
538c2ecf20Sopenharmony_ci	 * We also want Time Machine backup volumes to have a sufficiently
548c2ecf20Sopenharmony_ci	 * large clump size to reduce fragmentation.
558c2ecf20Sopenharmony_ci	 *
568c2ecf20Sopenharmony_ci	 * The series of numbers for Catalog and Attribute form a geometric
578c2ecf20Sopenharmony_ci	 * series. For Catalog (16GB to 512GB), each term is 8**(1/5) times
588c2ecf20Sopenharmony_ci	 * the previous term.  For Attributes (16GB to 512GB), each term is
598c2ecf20Sopenharmony_ci	 * 4**(1/5) times the previous term.  For 1TB to 16TB, each term is
608c2ecf20Sopenharmony_ci	 * 2**(1/5) times the previous term.
618c2ecf20Sopenharmony_ci	 */
628c2ecf20Sopenharmony_ci	/*  16GB */	 64,		 32,		 5,
638c2ecf20Sopenharmony_ci	/*  32GB */	 84,		 49,		 6,
648c2ecf20Sopenharmony_ci	/*  64GB */	111,		 74,		 7,
658c2ecf20Sopenharmony_ci	/* 128GB */	147,		111,		 8,
668c2ecf20Sopenharmony_ci	/* 256GB */	194,		169,		 9,
678c2ecf20Sopenharmony_ci	/* 512GB */	256,		256,		11,
688c2ecf20Sopenharmony_ci	/*   1TB */	294,		294,		14,
698c2ecf20Sopenharmony_ci	/*   2TB */	338,		338,		16,
708c2ecf20Sopenharmony_ci	/*   4TB */	388,		388,		20,
718c2ecf20Sopenharmony_ci	/*   8TB */	446,		446,		25,
728c2ecf20Sopenharmony_ci	/*  16TB */	512,		512,		32
738c2ecf20Sopenharmony_ci};
748c2ecf20Sopenharmony_ci
758c2ecf20Sopenharmony_ciu32 hfsplus_calc_btree_clump_size(u32 block_size, u32 node_size,
768c2ecf20Sopenharmony_ci					u64 sectors, int file_id)
778c2ecf20Sopenharmony_ci{
788c2ecf20Sopenharmony_ci	u32 mod = max(node_size, block_size);
798c2ecf20Sopenharmony_ci	u32 clump_size;
808c2ecf20Sopenharmony_ci	int column;
818c2ecf20Sopenharmony_ci	int i;
828c2ecf20Sopenharmony_ci
838c2ecf20Sopenharmony_ci	/* Figure out which column of the above table to use for this file. */
848c2ecf20Sopenharmony_ci	switch (file_id) {
858c2ecf20Sopenharmony_ci	case HFSPLUS_ATTR_CNID:
868c2ecf20Sopenharmony_ci		column = 0;
878c2ecf20Sopenharmony_ci		break;
888c2ecf20Sopenharmony_ci	case HFSPLUS_CAT_CNID:
898c2ecf20Sopenharmony_ci		column = 1;
908c2ecf20Sopenharmony_ci		break;
918c2ecf20Sopenharmony_ci	default:
928c2ecf20Sopenharmony_ci		column = 2;
938c2ecf20Sopenharmony_ci		break;
948c2ecf20Sopenharmony_ci	}
958c2ecf20Sopenharmony_ci
968c2ecf20Sopenharmony_ci	/*
978c2ecf20Sopenharmony_ci	 * The default clump size is 0.8% of the volume size. And
988c2ecf20Sopenharmony_ci	 * it must also be a multiple of the node and block size.
998c2ecf20Sopenharmony_ci	 */
1008c2ecf20Sopenharmony_ci	if (sectors < 0x200000) {
1018c2ecf20Sopenharmony_ci		clump_size = sectors << 2;	/*  0.8 %  */
1028c2ecf20Sopenharmony_ci		if (clump_size < (8 * node_size))
1038c2ecf20Sopenharmony_ci			clump_size = 8 * node_size;
1048c2ecf20Sopenharmony_ci	} else {
1058c2ecf20Sopenharmony_ci		/* turn exponent into table index... */
1068c2ecf20Sopenharmony_ci		for (i = 0, sectors = sectors >> 22;
1078c2ecf20Sopenharmony_ci		     sectors && (i < CLUMP_ENTRIES - 1);
1088c2ecf20Sopenharmony_ci		     ++i, sectors = sectors >> 1) {
1098c2ecf20Sopenharmony_ci			/* empty body */
1108c2ecf20Sopenharmony_ci		}
1118c2ecf20Sopenharmony_ci
1128c2ecf20Sopenharmony_ci		clump_size = clumptbl[column + (i) * 3] * 1024 * 1024;
1138c2ecf20Sopenharmony_ci	}
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_ci	/*
1168c2ecf20Sopenharmony_ci	 * Round the clump size to a multiple of node and block size.
1178c2ecf20Sopenharmony_ci	 * NOTE: This rounds down.
1188c2ecf20Sopenharmony_ci	 */
1198c2ecf20Sopenharmony_ci	clump_size /= mod;
1208c2ecf20Sopenharmony_ci	clump_size *= mod;
1218c2ecf20Sopenharmony_ci
1228c2ecf20Sopenharmony_ci	/*
1238c2ecf20Sopenharmony_ci	 * Rounding down could have rounded down to 0 if the block size was
1248c2ecf20Sopenharmony_ci	 * greater than the clump size.  If so, just use one block or node.
1258c2ecf20Sopenharmony_ci	 */
1268c2ecf20Sopenharmony_ci	if (clump_size == 0)
1278c2ecf20Sopenharmony_ci		clump_size = mod;
1288c2ecf20Sopenharmony_ci
1298c2ecf20Sopenharmony_ci	return clump_size;
1308c2ecf20Sopenharmony_ci}
1318c2ecf20Sopenharmony_ci
1328c2ecf20Sopenharmony_ci/* Get a reference to a B*Tree and do some initial checks */
1338c2ecf20Sopenharmony_cistruct hfs_btree *hfs_btree_open(struct super_block *sb, u32 id)
1348c2ecf20Sopenharmony_ci{
1358c2ecf20Sopenharmony_ci	struct hfs_btree *tree;
1368c2ecf20Sopenharmony_ci	struct hfs_btree_header_rec *head;
1378c2ecf20Sopenharmony_ci	struct address_space *mapping;
1388c2ecf20Sopenharmony_ci	struct inode *inode;
1398c2ecf20Sopenharmony_ci	struct page *page;
1408c2ecf20Sopenharmony_ci	unsigned int size;
1418c2ecf20Sopenharmony_ci
1428c2ecf20Sopenharmony_ci	tree = kzalloc(sizeof(*tree), GFP_KERNEL);
1438c2ecf20Sopenharmony_ci	if (!tree)
1448c2ecf20Sopenharmony_ci		return NULL;
1458c2ecf20Sopenharmony_ci
1468c2ecf20Sopenharmony_ci	mutex_init(&tree->tree_lock);
1478c2ecf20Sopenharmony_ci	spin_lock_init(&tree->hash_lock);
1488c2ecf20Sopenharmony_ci	tree->sb = sb;
1498c2ecf20Sopenharmony_ci	tree->cnid = id;
1508c2ecf20Sopenharmony_ci	inode = hfsplus_iget(sb, id);
1518c2ecf20Sopenharmony_ci	if (IS_ERR(inode))
1528c2ecf20Sopenharmony_ci		goto free_tree;
1538c2ecf20Sopenharmony_ci	tree->inode = inode;
1548c2ecf20Sopenharmony_ci
1558c2ecf20Sopenharmony_ci	if (!HFSPLUS_I(tree->inode)->first_blocks) {
1568c2ecf20Sopenharmony_ci		pr_err("invalid btree extent records (0 size)\n");
1578c2ecf20Sopenharmony_ci		goto free_inode;
1588c2ecf20Sopenharmony_ci	}
1598c2ecf20Sopenharmony_ci
1608c2ecf20Sopenharmony_ci	mapping = tree->inode->i_mapping;
1618c2ecf20Sopenharmony_ci	page = read_mapping_page(mapping, 0, NULL);
1628c2ecf20Sopenharmony_ci	if (IS_ERR(page))
1638c2ecf20Sopenharmony_ci		goto free_inode;
1648c2ecf20Sopenharmony_ci
1658c2ecf20Sopenharmony_ci	/* Load the header */
1668c2ecf20Sopenharmony_ci	head = (struct hfs_btree_header_rec *)(kmap(page) +
1678c2ecf20Sopenharmony_ci		sizeof(struct hfs_bnode_desc));
1688c2ecf20Sopenharmony_ci	tree->root = be32_to_cpu(head->root);
1698c2ecf20Sopenharmony_ci	tree->leaf_count = be32_to_cpu(head->leaf_count);
1708c2ecf20Sopenharmony_ci	tree->leaf_head = be32_to_cpu(head->leaf_head);
1718c2ecf20Sopenharmony_ci	tree->leaf_tail = be32_to_cpu(head->leaf_tail);
1728c2ecf20Sopenharmony_ci	tree->node_count = be32_to_cpu(head->node_count);
1738c2ecf20Sopenharmony_ci	tree->free_nodes = be32_to_cpu(head->free_nodes);
1748c2ecf20Sopenharmony_ci	tree->attributes = be32_to_cpu(head->attributes);
1758c2ecf20Sopenharmony_ci	tree->node_size = be16_to_cpu(head->node_size);
1768c2ecf20Sopenharmony_ci	tree->max_key_len = be16_to_cpu(head->max_key_len);
1778c2ecf20Sopenharmony_ci	tree->depth = be16_to_cpu(head->depth);
1788c2ecf20Sopenharmony_ci
1798c2ecf20Sopenharmony_ci	/* Verify the tree and set the correct compare function */
1808c2ecf20Sopenharmony_ci	switch (id) {
1818c2ecf20Sopenharmony_ci	case HFSPLUS_EXT_CNID:
1828c2ecf20Sopenharmony_ci		if (tree->max_key_len != HFSPLUS_EXT_KEYLEN - sizeof(u16)) {
1838c2ecf20Sopenharmony_ci			pr_err("invalid extent max_key_len %d\n",
1848c2ecf20Sopenharmony_ci				tree->max_key_len);
1858c2ecf20Sopenharmony_ci			goto fail_page;
1868c2ecf20Sopenharmony_ci		}
1878c2ecf20Sopenharmony_ci		if (tree->attributes & HFS_TREE_VARIDXKEYS) {
1888c2ecf20Sopenharmony_ci			pr_err("invalid extent btree flag\n");
1898c2ecf20Sopenharmony_ci			goto fail_page;
1908c2ecf20Sopenharmony_ci		}
1918c2ecf20Sopenharmony_ci
1928c2ecf20Sopenharmony_ci		tree->keycmp = hfsplus_ext_cmp_key;
1938c2ecf20Sopenharmony_ci		break;
1948c2ecf20Sopenharmony_ci	case HFSPLUS_CAT_CNID:
1958c2ecf20Sopenharmony_ci		if (tree->max_key_len != HFSPLUS_CAT_KEYLEN - sizeof(u16)) {
1968c2ecf20Sopenharmony_ci			pr_err("invalid catalog max_key_len %d\n",
1978c2ecf20Sopenharmony_ci				tree->max_key_len);
1988c2ecf20Sopenharmony_ci			goto fail_page;
1998c2ecf20Sopenharmony_ci		}
2008c2ecf20Sopenharmony_ci		if (!(tree->attributes & HFS_TREE_VARIDXKEYS)) {
2018c2ecf20Sopenharmony_ci			pr_err("invalid catalog btree flag\n");
2028c2ecf20Sopenharmony_ci			goto fail_page;
2038c2ecf20Sopenharmony_ci		}
2048c2ecf20Sopenharmony_ci
2058c2ecf20Sopenharmony_ci		if (test_bit(HFSPLUS_SB_HFSX, &HFSPLUS_SB(sb)->flags) &&
2068c2ecf20Sopenharmony_ci		    (head->key_type == HFSPLUS_KEY_BINARY))
2078c2ecf20Sopenharmony_ci			tree->keycmp = hfsplus_cat_bin_cmp_key;
2088c2ecf20Sopenharmony_ci		else {
2098c2ecf20Sopenharmony_ci			tree->keycmp = hfsplus_cat_case_cmp_key;
2108c2ecf20Sopenharmony_ci			set_bit(HFSPLUS_SB_CASEFOLD, &HFSPLUS_SB(sb)->flags);
2118c2ecf20Sopenharmony_ci		}
2128c2ecf20Sopenharmony_ci		break;
2138c2ecf20Sopenharmony_ci	case HFSPLUS_ATTR_CNID:
2148c2ecf20Sopenharmony_ci		if (tree->max_key_len != HFSPLUS_ATTR_KEYLEN - sizeof(u16)) {
2158c2ecf20Sopenharmony_ci			pr_err("invalid attributes max_key_len %d\n",
2168c2ecf20Sopenharmony_ci				tree->max_key_len);
2178c2ecf20Sopenharmony_ci			goto fail_page;
2188c2ecf20Sopenharmony_ci		}
2198c2ecf20Sopenharmony_ci		tree->keycmp = hfsplus_attr_bin_cmp_key;
2208c2ecf20Sopenharmony_ci		break;
2218c2ecf20Sopenharmony_ci	default:
2228c2ecf20Sopenharmony_ci		pr_err("unknown B*Tree requested\n");
2238c2ecf20Sopenharmony_ci		goto fail_page;
2248c2ecf20Sopenharmony_ci	}
2258c2ecf20Sopenharmony_ci
2268c2ecf20Sopenharmony_ci	if (!(tree->attributes & HFS_TREE_BIGKEYS)) {
2278c2ecf20Sopenharmony_ci		pr_err("invalid btree flag\n");
2288c2ecf20Sopenharmony_ci		goto fail_page;
2298c2ecf20Sopenharmony_ci	}
2308c2ecf20Sopenharmony_ci
2318c2ecf20Sopenharmony_ci	size = tree->node_size;
2328c2ecf20Sopenharmony_ci	if (!is_power_of_2(size))
2338c2ecf20Sopenharmony_ci		goto fail_page;
2348c2ecf20Sopenharmony_ci	if (!tree->node_count)
2358c2ecf20Sopenharmony_ci		goto fail_page;
2368c2ecf20Sopenharmony_ci
2378c2ecf20Sopenharmony_ci	tree->node_size_shift = ffs(size) - 1;
2388c2ecf20Sopenharmony_ci
2398c2ecf20Sopenharmony_ci	tree->pages_per_bnode =
2408c2ecf20Sopenharmony_ci		(tree->node_size + PAGE_SIZE - 1) >>
2418c2ecf20Sopenharmony_ci		PAGE_SHIFT;
2428c2ecf20Sopenharmony_ci
2438c2ecf20Sopenharmony_ci	kunmap(page);
2448c2ecf20Sopenharmony_ci	put_page(page);
2458c2ecf20Sopenharmony_ci	return tree;
2468c2ecf20Sopenharmony_ci
2478c2ecf20Sopenharmony_ci fail_page:
2488c2ecf20Sopenharmony_ci	put_page(page);
2498c2ecf20Sopenharmony_ci free_inode:
2508c2ecf20Sopenharmony_ci	tree->inode->i_mapping->a_ops = &hfsplus_aops;
2518c2ecf20Sopenharmony_ci	iput(tree->inode);
2528c2ecf20Sopenharmony_ci free_tree:
2538c2ecf20Sopenharmony_ci	kfree(tree);
2548c2ecf20Sopenharmony_ci	return NULL;
2558c2ecf20Sopenharmony_ci}
2568c2ecf20Sopenharmony_ci
2578c2ecf20Sopenharmony_ci/* Release resources used by a btree */
2588c2ecf20Sopenharmony_civoid hfs_btree_close(struct hfs_btree *tree)
2598c2ecf20Sopenharmony_ci{
2608c2ecf20Sopenharmony_ci	struct hfs_bnode *node;
2618c2ecf20Sopenharmony_ci	int i;
2628c2ecf20Sopenharmony_ci
2638c2ecf20Sopenharmony_ci	if (!tree)
2648c2ecf20Sopenharmony_ci		return;
2658c2ecf20Sopenharmony_ci
2668c2ecf20Sopenharmony_ci	for (i = 0; i < NODE_HASH_SIZE; i++) {
2678c2ecf20Sopenharmony_ci		while ((node = tree->node_hash[i])) {
2688c2ecf20Sopenharmony_ci			tree->node_hash[i] = node->next_hash;
2698c2ecf20Sopenharmony_ci			if (atomic_read(&node->refcnt))
2708c2ecf20Sopenharmony_ci				pr_crit("node %d:%d "
2718c2ecf20Sopenharmony_ci						"still has %d user(s)!\n",
2728c2ecf20Sopenharmony_ci					node->tree->cnid, node->this,
2738c2ecf20Sopenharmony_ci					atomic_read(&node->refcnt));
2748c2ecf20Sopenharmony_ci			hfs_bnode_free(node);
2758c2ecf20Sopenharmony_ci			tree->node_hash_cnt--;
2768c2ecf20Sopenharmony_ci		}
2778c2ecf20Sopenharmony_ci	}
2788c2ecf20Sopenharmony_ci	iput(tree->inode);
2798c2ecf20Sopenharmony_ci	kfree(tree);
2808c2ecf20Sopenharmony_ci}
2818c2ecf20Sopenharmony_ci
2828c2ecf20Sopenharmony_ciint hfs_btree_write(struct hfs_btree *tree)
2838c2ecf20Sopenharmony_ci{
2848c2ecf20Sopenharmony_ci	struct hfs_btree_header_rec *head;
2858c2ecf20Sopenharmony_ci	struct hfs_bnode *node;
2868c2ecf20Sopenharmony_ci	struct page *page;
2878c2ecf20Sopenharmony_ci
2888c2ecf20Sopenharmony_ci	node = hfs_bnode_find(tree, 0);
2898c2ecf20Sopenharmony_ci	if (IS_ERR(node))
2908c2ecf20Sopenharmony_ci		/* panic? */
2918c2ecf20Sopenharmony_ci		return -EIO;
2928c2ecf20Sopenharmony_ci	/* Load the header */
2938c2ecf20Sopenharmony_ci	page = node->page[0];
2948c2ecf20Sopenharmony_ci	head = (struct hfs_btree_header_rec *)(kmap(page) +
2958c2ecf20Sopenharmony_ci		sizeof(struct hfs_bnode_desc));
2968c2ecf20Sopenharmony_ci
2978c2ecf20Sopenharmony_ci	head->root = cpu_to_be32(tree->root);
2988c2ecf20Sopenharmony_ci	head->leaf_count = cpu_to_be32(tree->leaf_count);
2998c2ecf20Sopenharmony_ci	head->leaf_head = cpu_to_be32(tree->leaf_head);
3008c2ecf20Sopenharmony_ci	head->leaf_tail = cpu_to_be32(tree->leaf_tail);
3018c2ecf20Sopenharmony_ci	head->node_count = cpu_to_be32(tree->node_count);
3028c2ecf20Sopenharmony_ci	head->free_nodes = cpu_to_be32(tree->free_nodes);
3038c2ecf20Sopenharmony_ci	head->attributes = cpu_to_be32(tree->attributes);
3048c2ecf20Sopenharmony_ci	head->depth = cpu_to_be16(tree->depth);
3058c2ecf20Sopenharmony_ci
3068c2ecf20Sopenharmony_ci	kunmap(page);
3078c2ecf20Sopenharmony_ci	set_page_dirty(page);
3088c2ecf20Sopenharmony_ci	hfs_bnode_put(node);
3098c2ecf20Sopenharmony_ci	return 0;
3108c2ecf20Sopenharmony_ci}
3118c2ecf20Sopenharmony_ci
3128c2ecf20Sopenharmony_cistatic struct hfs_bnode *hfs_bmap_new_bmap(struct hfs_bnode *prev, u32 idx)
3138c2ecf20Sopenharmony_ci{
3148c2ecf20Sopenharmony_ci	struct hfs_btree *tree = prev->tree;
3158c2ecf20Sopenharmony_ci	struct hfs_bnode *node;
3168c2ecf20Sopenharmony_ci	struct hfs_bnode_desc desc;
3178c2ecf20Sopenharmony_ci	__be32 cnid;
3188c2ecf20Sopenharmony_ci
3198c2ecf20Sopenharmony_ci	node = hfs_bnode_create(tree, idx);
3208c2ecf20Sopenharmony_ci	if (IS_ERR(node))
3218c2ecf20Sopenharmony_ci		return node;
3228c2ecf20Sopenharmony_ci
3238c2ecf20Sopenharmony_ci	tree->free_nodes--;
3248c2ecf20Sopenharmony_ci	prev->next = idx;
3258c2ecf20Sopenharmony_ci	cnid = cpu_to_be32(idx);
3268c2ecf20Sopenharmony_ci	hfs_bnode_write(prev, &cnid, offsetof(struct hfs_bnode_desc, next), 4);
3278c2ecf20Sopenharmony_ci
3288c2ecf20Sopenharmony_ci	node->type = HFS_NODE_MAP;
3298c2ecf20Sopenharmony_ci	node->num_recs = 1;
3308c2ecf20Sopenharmony_ci	hfs_bnode_clear(node, 0, tree->node_size);
3318c2ecf20Sopenharmony_ci	desc.next = 0;
3328c2ecf20Sopenharmony_ci	desc.prev = 0;
3338c2ecf20Sopenharmony_ci	desc.type = HFS_NODE_MAP;
3348c2ecf20Sopenharmony_ci	desc.height = 0;
3358c2ecf20Sopenharmony_ci	desc.num_recs = cpu_to_be16(1);
3368c2ecf20Sopenharmony_ci	desc.reserved = 0;
3378c2ecf20Sopenharmony_ci	hfs_bnode_write(node, &desc, 0, sizeof(desc));
3388c2ecf20Sopenharmony_ci	hfs_bnode_write_u16(node, 14, 0x8000);
3398c2ecf20Sopenharmony_ci	hfs_bnode_write_u16(node, tree->node_size - 2, 14);
3408c2ecf20Sopenharmony_ci	hfs_bnode_write_u16(node, tree->node_size - 4, tree->node_size - 6);
3418c2ecf20Sopenharmony_ci
3428c2ecf20Sopenharmony_ci	return node;
3438c2ecf20Sopenharmony_ci}
3448c2ecf20Sopenharmony_ci
3458c2ecf20Sopenharmony_ci/* Make sure @tree has enough space for the @rsvd_nodes */
3468c2ecf20Sopenharmony_ciint hfs_bmap_reserve(struct hfs_btree *tree, int rsvd_nodes)
3478c2ecf20Sopenharmony_ci{
3488c2ecf20Sopenharmony_ci	struct inode *inode = tree->inode;
3498c2ecf20Sopenharmony_ci	struct hfsplus_inode_info *hip = HFSPLUS_I(inode);
3508c2ecf20Sopenharmony_ci	u32 count;
3518c2ecf20Sopenharmony_ci	int res;
3528c2ecf20Sopenharmony_ci
3538c2ecf20Sopenharmony_ci	if (rsvd_nodes <= 0)
3548c2ecf20Sopenharmony_ci		return 0;
3558c2ecf20Sopenharmony_ci
3568c2ecf20Sopenharmony_ci	while (tree->free_nodes < rsvd_nodes) {
3578c2ecf20Sopenharmony_ci		res = hfsplus_file_extend(inode, hfs_bnode_need_zeroout(tree));
3588c2ecf20Sopenharmony_ci		if (res)
3598c2ecf20Sopenharmony_ci			return res;
3608c2ecf20Sopenharmony_ci		hip->phys_size = inode->i_size =
3618c2ecf20Sopenharmony_ci			(loff_t)hip->alloc_blocks <<
3628c2ecf20Sopenharmony_ci				HFSPLUS_SB(tree->sb)->alloc_blksz_shift;
3638c2ecf20Sopenharmony_ci		hip->fs_blocks =
3648c2ecf20Sopenharmony_ci			hip->alloc_blocks << HFSPLUS_SB(tree->sb)->fs_shift;
3658c2ecf20Sopenharmony_ci		inode_set_bytes(inode, inode->i_size);
3668c2ecf20Sopenharmony_ci		count = inode->i_size >> tree->node_size_shift;
3678c2ecf20Sopenharmony_ci		tree->free_nodes += count - tree->node_count;
3688c2ecf20Sopenharmony_ci		tree->node_count = count;
3698c2ecf20Sopenharmony_ci	}
3708c2ecf20Sopenharmony_ci	return 0;
3718c2ecf20Sopenharmony_ci}
3728c2ecf20Sopenharmony_ci
3738c2ecf20Sopenharmony_cistruct hfs_bnode *hfs_bmap_alloc(struct hfs_btree *tree)
3748c2ecf20Sopenharmony_ci{
3758c2ecf20Sopenharmony_ci	struct hfs_bnode *node, *next_node;
3768c2ecf20Sopenharmony_ci	struct page **pagep;
3778c2ecf20Sopenharmony_ci	u32 nidx, idx;
3788c2ecf20Sopenharmony_ci	unsigned off;
3798c2ecf20Sopenharmony_ci	u16 off16;
3808c2ecf20Sopenharmony_ci	u16 len;
3818c2ecf20Sopenharmony_ci	u8 *data, byte, m;
3828c2ecf20Sopenharmony_ci	int i, res;
3838c2ecf20Sopenharmony_ci
3848c2ecf20Sopenharmony_ci	res = hfs_bmap_reserve(tree, 1);
3858c2ecf20Sopenharmony_ci	if (res)
3868c2ecf20Sopenharmony_ci		return ERR_PTR(res);
3878c2ecf20Sopenharmony_ci
3888c2ecf20Sopenharmony_ci	nidx = 0;
3898c2ecf20Sopenharmony_ci	node = hfs_bnode_find(tree, nidx);
3908c2ecf20Sopenharmony_ci	if (IS_ERR(node))
3918c2ecf20Sopenharmony_ci		return node;
3928c2ecf20Sopenharmony_ci	len = hfs_brec_lenoff(node, 2, &off16);
3938c2ecf20Sopenharmony_ci	off = off16;
3948c2ecf20Sopenharmony_ci
3958c2ecf20Sopenharmony_ci	off += node->page_offset;
3968c2ecf20Sopenharmony_ci	pagep = node->page + (off >> PAGE_SHIFT);
3978c2ecf20Sopenharmony_ci	data = kmap(*pagep);
3988c2ecf20Sopenharmony_ci	off &= ~PAGE_MASK;
3998c2ecf20Sopenharmony_ci	idx = 0;
4008c2ecf20Sopenharmony_ci
4018c2ecf20Sopenharmony_ci	for (;;) {
4028c2ecf20Sopenharmony_ci		while (len) {
4038c2ecf20Sopenharmony_ci			byte = data[off];
4048c2ecf20Sopenharmony_ci			if (byte != 0xff) {
4058c2ecf20Sopenharmony_ci				for (m = 0x80, i = 0; i < 8; m >>= 1, i++) {
4068c2ecf20Sopenharmony_ci					if (!(byte & m)) {
4078c2ecf20Sopenharmony_ci						idx += i;
4088c2ecf20Sopenharmony_ci						data[off] |= m;
4098c2ecf20Sopenharmony_ci						set_page_dirty(*pagep);
4108c2ecf20Sopenharmony_ci						kunmap(*pagep);
4118c2ecf20Sopenharmony_ci						tree->free_nodes--;
4128c2ecf20Sopenharmony_ci						mark_inode_dirty(tree->inode);
4138c2ecf20Sopenharmony_ci						hfs_bnode_put(node);
4148c2ecf20Sopenharmony_ci						return hfs_bnode_create(tree,
4158c2ecf20Sopenharmony_ci							idx);
4168c2ecf20Sopenharmony_ci					}
4178c2ecf20Sopenharmony_ci				}
4188c2ecf20Sopenharmony_ci			}
4198c2ecf20Sopenharmony_ci			if (++off >= PAGE_SIZE) {
4208c2ecf20Sopenharmony_ci				kunmap(*pagep);
4218c2ecf20Sopenharmony_ci				data = kmap(*++pagep);
4228c2ecf20Sopenharmony_ci				off = 0;
4238c2ecf20Sopenharmony_ci			}
4248c2ecf20Sopenharmony_ci			idx += 8;
4258c2ecf20Sopenharmony_ci			len--;
4268c2ecf20Sopenharmony_ci		}
4278c2ecf20Sopenharmony_ci		kunmap(*pagep);
4288c2ecf20Sopenharmony_ci		nidx = node->next;
4298c2ecf20Sopenharmony_ci		if (!nidx) {
4308c2ecf20Sopenharmony_ci			hfs_dbg(BNODE_MOD, "create new bmap node\n");
4318c2ecf20Sopenharmony_ci			next_node = hfs_bmap_new_bmap(node, idx);
4328c2ecf20Sopenharmony_ci		} else
4338c2ecf20Sopenharmony_ci			next_node = hfs_bnode_find(tree, nidx);
4348c2ecf20Sopenharmony_ci		hfs_bnode_put(node);
4358c2ecf20Sopenharmony_ci		if (IS_ERR(next_node))
4368c2ecf20Sopenharmony_ci			return next_node;
4378c2ecf20Sopenharmony_ci		node = next_node;
4388c2ecf20Sopenharmony_ci
4398c2ecf20Sopenharmony_ci		len = hfs_brec_lenoff(node, 0, &off16);
4408c2ecf20Sopenharmony_ci		off = off16;
4418c2ecf20Sopenharmony_ci		off += node->page_offset;
4428c2ecf20Sopenharmony_ci		pagep = node->page + (off >> PAGE_SHIFT);
4438c2ecf20Sopenharmony_ci		data = kmap(*pagep);
4448c2ecf20Sopenharmony_ci		off &= ~PAGE_MASK;
4458c2ecf20Sopenharmony_ci	}
4468c2ecf20Sopenharmony_ci}
4478c2ecf20Sopenharmony_ci
4488c2ecf20Sopenharmony_civoid hfs_bmap_free(struct hfs_bnode *node)
4498c2ecf20Sopenharmony_ci{
4508c2ecf20Sopenharmony_ci	struct hfs_btree *tree;
4518c2ecf20Sopenharmony_ci	struct page *page;
4528c2ecf20Sopenharmony_ci	u16 off, len;
4538c2ecf20Sopenharmony_ci	u32 nidx;
4548c2ecf20Sopenharmony_ci	u8 *data, byte, m;
4558c2ecf20Sopenharmony_ci
4568c2ecf20Sopenharmony_ci	hfs_dbg(BNODE_MOD, "btree_free_node: %u\n", node->this);
4578c2ecf20Sopenharmony_ci	BUG_ON(!node->this);
4588c2ecf20Sopenharmony_ci	tree = node->tree;
4598c2ecf20Sopenharmony_ci	nidx = node->this;
4608c2ecf20Sopenharmony_ci	node = hfs_bnode_find(tree, 0);
4618c2ecf20Sopenharmony_ci	if (IS_ERR(node))
4628c2ecf20Sopenharmony_ci		return;
4638c2ecf20Sopenharmony_ci	len = hfs_brec_lenoff(node, 2, &off);
4648c2ecf20Sopenharmony_ci	while (nidx >= len * 8) {
4658c2ecf20Sopenharmony_ci		u32 i;
4668c2ecf20Sopenharmony_ci
4678c2ecf20Sopenharmony_ci		nidx -= len * 8;
4688c2ecf20Sopenharmony_ci		i = node->next;
4698c2ecf20Sopenharmony_ci		if (!i) {
4708c2ecf20Sopenharmony_ci			/* panic */;
4718c2ecf20Sopenharmony_ci			pr_crit("unable to free bnode %u. "
4728c2ecf20Sopenharmony_ci					"bmap not found!\n",
4738c2ecf20Sopenharmony_ci				node->this);
4748c2ecf20Sopenharmony_ci			hfs_bnode_put(node);
4758c2ecf20Sopenharmony_ci			return;
4768c2ecf20Sopenharmony_ci		}
4778c2ecf20Sopenharmony_ci		hfs_bnode_put(node);
4788c2ecf20Sopenharmony_ci		node = hfs_bnode_find(tree, i);
4798c2ecf20Sopenharmony_ci		if (IS_ERR(node))
4808c2ecf20Sopenharmony_ci			return;
4818c2ecf20Sopenharmony_ci		if (node->type != HFS_NODE_MAP) {
4828c2ecf20Sopenharmony_ci			/* panic */;
4838c2ecf20Sopenharmony_ci			pr_crit("invalid bmap found! "
4848c2ecf20Sopenharmony_ci					"(%u,%d)\n",
4858c2ecf20Sopenharmony_ci				node->this, node->type);
4868c2ecf20Sopenharmony_ci			hfs_bnode_put(node);
4878c2ecf20Sopenharmony_ci			return;
4888c2ecf20Sopenharmony_ci		}
4898c2ecf20Sopenharmony_ci		len = hfs_brec_lenoff(node, 0, &off);
4908c2ecf20Sopenharmony_ci	}
4918c2ecf20Sopenharmony_ci	off += node->page_offset + nidx / 8;
4928c2ecf20Sopenharmony_ci	page = node->page[off >> PAGE_SHIFT];
4938c2ecf20Sopenharmony_ci	data = kmap(page);
4948c2ecf20Sopenharmony_ci	off &= ~PAGE_MASK;
4958c2ecf20Sopenharmony_ci	m = 1 << (~nidx & 7);
4968c2ecf20Sopenharmony_ci	byte = data[off];
4978c2ecf20Sopenharmony_ci	if (!(byte & m)) {
4988c2ecf20Sopenharmony_ci		pr_crit("trying to free free bnode "
4998c2ecf20Sopenharmony_ci				"%u(%d)\n",
5008c2ecf20Sopenharmony_ci			node->this, node->type);
5018c2ecf20Sopenharmony_ci		kunmap(page);
5028c2ecf20Sopenharmony_ci		hfs_bnode_put(node);
5038c2ecf20Sopenharmony_ci		return;
5048c2ecf20Sopenharmony_ci	}
5058c2ecf20Sopenharmony_ci	data[off] = byte & ~m;
5068c2ecf20Sopenharmony_ci	set_page_dirty(page);
5078c2ecf20Sopenharmony_ci	kunmap(page);
5088c2ecf20Sopenharmony_ci	hfs_bnode_put(node);
5098c2ecf20Sopenharmony_ci	tree->free_nodes++;
5108c2ecf20Sopenharmony_ci	mark_inode_dirty(tree->inode);
5118c2ecf20Sopenharmony_ci}
512