162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci *  linux/fs/hfsplus/btree.c
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2001
662306a36Sopenharmony_ci * Brad Boyer (flar@allandria.com)
762306a36Sopenharmony_ci * (C) 2003 Ardis Technologies <roman@ardistech.com>
862306a36Sopenharmony_ci *
962306a36Sopenharmony_ci * Handle opening/closing btree
1062306a36Sopenharmony_ci */
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ci#include <linux/slab.h>
1362306a36Sopenharmony_ci#include <linux/pagemap.h>
1462306a36Sopenharmony_ci#include <linux/log2.h>
1562306a36Sopenharmony_ci
1662306a36Sopenharmony_ci#include "hfsplus_fs.h"
1762306a36Sopenharmony_ci#include "hfsplus_raw.h"
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_ci/*
2062306a36Sopenharmony_ci * Initial source code of clump size calculation is gotten
2162306a36Sopenharmony_ci * from http://opensource.apple.com/tarballs/diskdev_cmds/
2262306a36Sopenharmony_ci */
2362306a36Sopenharmony_ci#define CLUMP_ENTRIES	15
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_cistatic short clumptbl[CLUMP_ENTRIES * 3] = {
2662306a36Sopenharmony_ci/*
2762306a36Sopenharmony_ci *	    Volume	Attributes	 Catalog	 Extents
2862306a36Sopenharmony_ci *	     Size	Clump (MB)	Clump (MB)	Clump (MB)
2962306a36Sopenharmony_ci */
3062306a36Sopenharmony_ci	/*   1GB */	  4,		  4,		 4,
3162306a36Sopenharmony_ci	/*   2GB */	  6,		  6,		 4,
3262306a36Sopenharmony_ci	/*   4GB */	  8,		  8,		 4,
3362306a36Sopenharmony_ci	/*   8GB */	 11,		 11,		 5,
3462306a36Sopenharmony_ci	/*
3562306a36Sopenharmony_ci	 * For volumes 16GB and larger, we want to make sure that a full OS
3662306a36Sopenharmony_ci	 * install won't require fragmentation of the Catalog or Attributes
3762306a36Sopenharmony_ci	 * B-trees.  We do this by making the clump sizes sufficiently large,
3862306a36Sopenharmony_ci	 * and by leaving a gap after the B-trees for them to grow into.
3962306a36Sopenharmony_ci	 *
4062306a36Sopenharmony_ci	 * For SnowLeopard 10A298, a FullNetInstall with all packages selected
4162306a36Sopenharmony_ci	 * results in:
4262306a36Sopenharmony_ci	 * Catalog B-tree Header
4362306a36Sopenharmony_ci	 *	nodeSize:          8192
4462306a36Sopenharmony_ci	 *	totalNodes:       31616
4562306a36Sopenharmony_ci	 *	freeNodes:         1978
4662306a36Sopenharmony_ci	 * (used = 231.55 MB)
4762306a36Sopenharmony_ci	 * Attributes B-tree Header
4862306a36Sopenharmony_ci	 *	nodeSize:          8192
4962306a36Sopenharmony_ci	 *	totalNodes:       63232
5062306a36Sopenharmony_ci	 *	freeNodes:          958
5162306a36Sopenharmony_ci	 * (used = 486.52 MB)
5262306a36Sopenharmony_ci	 *
5362306a36Sopenharmony_ci	 * We also want Time Machine backup volumes to have a sufficiently
5462306a36Sopenharmony_ci	 * large clump size to reduce fragmentation.
5562306a36Sopenharmony_ci	 *
5662306a36Sopenharmony_ci	 * The series of numbers for Catalog and Attribute form a geometric
5762306a36Sopenharmony_ci	 * series. For Catalog (16GB to 512GB), each term is 8**(1/5) times
5862306a36Sopenharmony_ci	 * the previous term.  For Attributes (16GB to 512GB), each term is
5962306a36Sopenharmony_ci	 * 4**(1/5) times the previous term.  For 1TB to 16TB, each term is
6062306a36Sopenharmony_ci	 * 2**(1/5) times the previous term.
6162306a36Sopenharmony_ci	 */
6262306a36Sopenharmony_ci	/*  16GB */	 64,		 32,		 5,
6362306a36Sopenharmony_ci	/*  32GB */	 84,		 49,		 6,
6462306a36Sopenharmony_ci	/*  64GB */	111,		 74,		 7,
6562306a36Sopenharmony_ci	/* 128GB */	147,		111,		 8,
6662306a36Sopenharmony_ci	/* 256GB */	194,		169,		 9,
6762306a36Sopenharmony_ci	/* 512GB */	256,		256,		11,
6862306a36Sopenharmony_ci	/*   1TB */	294,		294,		14,
6962306a36Sopenharmony_ci	/*   2TB */	338,		338,		16,
7062306a36Sopenharmony_ci	/*   4TB */	388,		388,		20,
7162306a36Sopenharmony_ci	/*   8TB */	446,		446,		25,
7262306a36Sopenharmony_ci	/*  16TB */	512,		512,		32
7362306a36Sopenharmony_ci};
7462306a36Sopenharmony_ci
7562306a36Sopenharmony_ciu32 hfsplus_calc_btree_clump_size(u32 block_size, u32 node_size,
7662306a36Sopenharmony_ci					u64 sectors, int file_id)
7762306a36Sopenharmony_ci{
7862306a36Sopenharmony_ci	u32 mod = max(node_size, block_size);
7962306a36Sopenharmony_ci	u32 clump_size;
8062306a36Sopenharmony_ci	int column;
8162306a36Sopenharmony_ci	int i;
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_ci	/* Figure out which column of the above table to use for this file. */
8462306a36Sopenharmony_ci	switch (file_id) {
8562306a36Sopenharmony_ci	case HFSPLUS_ATTR_CNID:
8662306a36Sopenharmony_ci		column = 0;
8762306a36Sopenharmony_ci		break;
8862306a36Sopenharmony_ci	case HFSPLUS_CAT_CNID:
8962306a36Sopenharmony_ci		column = 1;
9062306a36Sopenharmony_ci		break;
9162306a36Sopenharmony_ci	default:
9262306a36Sopenharmony_ci		column = 2;
9362306a36Sopenharmony_ci		break;
9462306a36Sopenharmony_ci	}
9562306a36Sopenharmony_ci
9662306a36Sopenharmony_ci	/*
9762306a36Sopenharmony_ci	 * The default clump size is 0.8% of the volume size. And
9862306a36Sopenharmony_ci	 * it must also be a multiple of the node and block size.
9962306a36Sopenharmony_ci	 */
10062306a36Sopenharmony_ci	if (sectors < 0x200000) {
10162306a36Sopenharmony_ci		clump_size = sectors << 2;	/*  0.8 %  */
10262306a36Sopenharmony_ci		if (clump_size < (8 * node_size))
10362306a36Sopenharmony_ci			clump_size = 8 * node_size;
10462306a36Sopenharmony_ci	} else {
10562306a36Sopenharmony_ci		/* turn exponent into table index... */
10662306a36Sopenharmony_ci		for (i = 0, sectors = sectors >> 22;
10762306a36Sopenharmony_ci		     sectors && (i < CLUMP_ENTRIES - 1);
10862306a36Sopenharmony_ci		     ++i, sectors = sectors >> 1) {
10962306a36Sopenharmony_ci			/* empty body */
11062306a36Sopenharmony_ci		}
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_ci		clump_size = clumptbl[column + (i) * 3] * 1024 * 1024;
11362306a36Sopenharmony_ci	}
11462306a36Sopenharmony_ci
11562306a36Sopenharmony_ci	/*
11662306a36Sopenharmony_ci	 * Round the clump size to a multiple of node and block size.
11762306a36Sopenharmony_ci	 * NOTE: This rounds down.
11862306a36Sopenharmony_ci	 */
11962306a36Sopenharmony_ci	clump_size /= mod;
12062306a36Sopenharmony_ci	clump_size *= mod;
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_ci	/*
12362306a36Sopenharmony_ci	 * Rounding down could have rounded down to 0 if the block size was
12462306a36Sopenharmony_ci	 * greater than the clump size.  If so, just use one block or node.
12562306a36Sopenharmony_ci	 */
12662306a36Sopenharmony_ci	if (clump_size == 0)
12762306a36Sopenharmony_ci		clump_size = mod;
12862306a36Sopenharmony_ci
12962306a36Sopenharmony_ci	return clump_size;
13062306a36Sopenharmony_ci}
13162306a36Sopenharmony_ci
13262306a36Sopenharmony_ci/* Get a reference to a B*Tree and do some initial checks */
13362306a36Sopenharmony_cistruct hfs_btree *hfs_btree_open(struct super_block *sb, u32 id)
13462306a36Sopenharmony_ci{
13562306a36Sopenharmony_ci	struct hfs_btree *tree;
13662306a36Sopenharmony_ci	struct hfs_btree_header_rec *head;
13762306a36Sopenharmony_ci	struct address_space *mapping;
13862306a36Sopenharmony_ci	struct inode *inode;
13962306a36Sopenharmony_ci	struct page *page;
14062306a36Sopenharmony_ci	unsigned int size;
14162306a36Sopenharmony_ci
14262306a36Sopenharmony_ci	tree = kzalloc(sizeof(*tree), GFP_KERNEL);
14362306a36Sopenharmony_ci	if (!tree)
14462306a36Sopenharmony_ci		return NULL;
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_ci	mutex_init(&tree->tree_lock);
14762306a36Sopenharmony_ci	spin_lock_init(&tree->hash_lock);
14862306a36Sopenharmony_ci	tree->sb = sb;
14962306a36Sopenharmony_ci	tree->cnid = id;
15062306a36Sopenharmony_ci	inode = hfsplus_iget(sb, id);
15162306a36Sopenharmony_ci	if (IS_ERR(inode))
15262306a36Sopenharmony_ci		goto free_tree;
15362306a36Sopenharmony_ci	tree->inode = inode;
15462306a36Sopenharmony_ci
15562306a36Sopenharmony_ci	if (!HFSPLUS_I(tree->inode)->first_blocks) {
15662306a36Sopenharmony_ci		pr_err("invalid btree extent records (0 size)\n");
15762306a36Sopenharmony_ci		goto free_inode;
15862306a36Sopenharmony_ci	}
15962306a36Sopenharmony_ci
16062306a36Sopenharmony_ci	mapping = tree->inode->i_mapping;
16162306a36Sopenharmony_ci	page = read_mapping_page(mapping, 0, NULL);
16262306a36Sopenharmony_ci	if (IS_ERR(page))
16362306a36Sopenharmony_ci		goto free_inode;
16462306a36Sopenharmony_ci
16562306a36Sopenharmony_ci	/* Load the header */
16662306a36Sopenharmony_ci	head = (struct hfs_btree_header_rec *)(kmap_local_page(page) +
16762306a36Sopenharmony_ci		sizeof(struct hfs_bnode_desc));
16862306a36Sopenharmony_ci	tree->root = be32_to_cpu(head->root);
16962306a36Sopenharmony_ci	tree->leaf_count = be32_to_cpu(head->leaf_count);
17062306a36Sopenharmony_ci	tree->leaf_head = be32_to_cpu(head->leaf_head);
17162306a36Sopenharmony_ci	tree->leaf_tail = be32_to_cpu(head->leaf_tail);
17262306a36Sopenharmony_ci	tree->node_count = be32_to_cpu(head->node_count);
17362306a36Sopenharmony_ci	tree->free_nodes = be32_to_cpu(head->free_nodes);
17462306a36Sopenharmony_ci	tree->attributes = be32_to_cpu(head->attributes);
17562306a36Sopenharmony_ci	tree->node_size = be16_to_cpu(head->node_size);
17662306a36Sopenharmony_ci	tree->max_key_len = be16_to_cpu(head->max_key_len);
17762306a36Sopenharmony_ci	tree->depth = be16_to_cpu(head->depth);
17862306a36Sopenharmony_ci
17962306a36Sopenharmony_ci	/* Verify the tree and set the correct compare function */
18062306a36Sopenharmony_ci	switch (id) {
18162306a36Sopenharmony_ci	case HFSPLUS_EXT_CNID:
18262306a36Sopenharmony_ci		if (tree->max_key_len != HFSPLUS_EXT_KEYLEN - sizeof(u16)) {
18362306a36Sopenharmony_ci			pr_err("invalid extent max_key_len %d\n",
18462306a36Sopenharmony_ci				tree->max_key_len);
18562306a36Sopenharmony_ci			goto fail_page;
18662306a36Sopenharmony_ci		}
18762306a36Sopenharmony_ci		if (tree->attributes & HFS_TREE_VARIDXKEYS) {
18862306a36Sopenharmony_ci			pr_err("invalid extent btree flag\n");
18962306a36Sopenharmony_ci			goto fail_page;
19062306a36Sopenharmony_ci		}
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_ci		tree->keycmp = hfsplus_ext_cmp_key;
19362306a36Sopenharmony_ci		break;
19462306a36Sopenharmony_ci	case HFSPLUS_CAT_CNID:
19562306a36Sopenharmony_ci		if (tree->max_key_len != HFSPLUS_CAT_KEYLEN - sizeof(u16)) {
19662306a36Sopenharmony_ci			pr_err("invalid catalog max_key_len %d\n",
19762306a36Sopenharmony_ci				tree->max_key_len);
19862306a36Sopenharmony_ci			goto fail_page;
19962306a36Sopenharmony_ci		}
20062306a36Sopenharmony_ci		if (!(tree->attributes & HFS_TREE_VARIDXKEYS)) {
20162306a36Sopenharmony_ci			pr_err("invalid catalog btree flag\n");
20262306a36Sopenharmony_ci			goto fail_page;
20362306a36Sopenharmony_ci		}
20462306a36Sopenharmony_ci
20562306a36Sopenharmony_ci		if (test_bit(HFSPLUS_SB_HFSX, &HFSPLUS_SB(sb)->flags) &&
20662306a36Sopenharmony_ci		    (head->key_type == HFSPLUS_KEY_BINARY))
20762306a36Sopenharmony_ci			tree->keycmp = hfsplus_cat_bin_cmp_key;
20862306a36Sopenharmony_ci		else {
20962306a36Sopenharmony_ci			tree->keycmp = hfsplus_cat_case_cmp_key;
21062306a36Sopenharmony_ci			set_bit(HFSPLUS_SB_CASEFOLD, &HFSPLUS_SB(sb)->flags);
21162306a36Sopenharmony_ci		}
21262306a36Sopenharmony_ci		break;
21362306a36Sopenharmony_ci	case HFSPLUS_ATTR_CNID:
21462306a36Sopenharmony_ci		if (tree->max_key_len != HFSPLUS_ATTR_KEYLEN - sizeof(u16)) {
21562306a36Sopenharmony_ci			pr_err("invalid attributes max_key_len %d\n",
21662306a36Sopenharmony_ci				tree->max_key_len);
21762306a36Sopenharmony_ci			goto fail_page;
21862306a36Sopenharmony_ci		}
21962306a36Sopenharmony_ci		tree->keycmp = hfsplus_attr_bin_cmp_key;
22062306a36Sopenharmony_ci		break;
22162306a36Sopenharmony_ci	default:
22262306a36Sopenharmony_ci		pr_err("unknown B*Tree requested\n");
22362306a36Sopenharmony_ci		goto fail_page;
22462306a36Sopenharmony_ci	}
22562306a36Sopenharmony_ci
22662306a36Sopenharmony_ci	if (!(tree->attributes & HFS_TREE_BIGKEYS)) {
22762306a36Sopenharmony_ci		pr_err("invalid btree flag\n");
22862306a36Sopenharmony_ci		goto fail_page;
22962306a36Sopenharmony_ci	}
23062306a36Sopenharmony_ci
23162306a36Sopenharmony_ci	size = tree->node_size;
23262306a36Sopenharmony_ci	if (!is_power_of_2(size))
23362306a36Sopenharmony_ci		goto fail_page;
23462306a36Sopenharmony_ci	if (!tree->node_count)
23562306a36Sopenharmony_ci		goto fail_page;
23662306a36Sopenharmony_ci
23762306a36Sopenharmony_ci	tree->node_size_shift = ffs(size) - 1;
23862306a36Sopenharmony_ci
23962306a36Sopenharmony_ci	tree->pages_per_bnode =
24062306a36Sopenharmony_ci		(tree->node_size + PAGE_SIZE - 1) >>
24162306a36Sopenharmony_ci		PAGE_SHIFT;
24262306a36Sopenharmony_ci
24362306a36Sopenharmony_ci	kunmap_local(head);
24462306a36Sopenharmony_ci	put_page(page);
24562306a36Sopenharmony_ci	return tree;
24662306a36Sopenharmony_ci
24762306a36Sopenharmony_ci fail_page:
24862306a36Sopenharmony_ci	kunmap_local(head);
24962306a36Sopenharmony_ci	put_page(page);
25062306a36Sopenharmony_ci free_inode:
25162306a36Sopenharmony_ci	tree->inode->i_mapping->a_ops = &hfsplus_aops;
25262306a36Sopenharmony_ci	iput(tree->inode);
25362306a36Sopenharmony_ci free_tree:
25462306a36Sopenharmony_ci	kfree(tree);
25562306a36Sopenharmony_ci	return NULL;
25662306a36Sopenharmony_ci}
25762306a36Sopenharmony_ci
25862306a36Sopenharmony_ci/* Release resources used by a btree */
25962306a36Sopenharmony_civoid hfs_btree_close(struct hfs_btree *tree)
26062306a36Sopenharmony_ci{
26162306a36Sopenharmony_ci	struct hfs_bnode *node;
26262306a36Sopenharmony_ci	int i;
26362306a36Sopenharmony_ci
26462306a36Sopenharmony_ci	if (!tree)
26562306a36Sopenharmony_ci		return;
26662306a36Sopenharmony_ci
26762306a36Sopenharmony_ci	for (i = 0; i < NODE_HASH_SIZE; i++) {
26862306a36Sopenharmony_ci		while ((node = tree->node_hash[i])) {
26962306a36Sopenharmony_ci			tree->node_hash[i] = node->next_hash;
27062306a36Sopenharmony_ci			if (atomic_read(&node->refcnt))
27162306a36Sopenharmony_ci				pr_crit("node %d:%d "
27262306a36Sopenharmony_ci						"still has %d user(s)!\n",
27362306a36Sopenharmony_ci					node->tree->cnid, node->this,
27462306a36Sopenharmony_ci					atomic_read(&node->refcnt));
27562306a36Sopenharmony_ci			hfs_bnode_free(node);
27662306a36Sopenharmony_ci			tree->node_hash_cnt--;
27762306a36Sopenharmony_ci		}
27862306a36Sopenharmony_ci	}
27962306a36Sopenharmony_ci	iput(tree->inode);
28062306a36Sopenharmony_ci	kfree(tree);
28162306a36Sopenharmony_ci}
28262306a36Sopenharmony_ci
28362306a36Sopenharmony_ciint hfs_btree_write(struct hfs_btree *tree)
28462306a36Sopenharmony_ci{
28562306a36Sopenharmony_ci	struct hfs_btree_header_rec *head;
28662306a36Sopenharmony_ci	struct hfs_bnode *node;
28762306a36Sopenharmony_ci	struct page *page;
28862306a36Sopenharmony_ci
28962306a36Sopenharmony_ci	node = hfs_bnode_find(tree, 0);
29062306a36Sopenharmony_ci	if (IS_ERR(node))
29162306a36Sopenharmony_ci		/* panic? */
29262306a36Sopenharmony_ci		return -EIO;
29362306a36Sopenharmony_ci	/* Load the header */
29462306a36Sopenharmony_ci	page = node->page[0];
29562306a36Sopenharmony_ci	head = (struct hfs_btree_header_rec *)(kmap_local_page(page) +
29662306a36Sopenharmony_ci		sizeof(struct hfs_bnode_desc));
29762306a36Sopenharmony_ci
29862306a36Sopenharmony_ci	head->root = cpu_to_be32(tree->root);
29962306a36Sopenharmony_ci	head->leaf_count = cpu_to_be32(tree->leaf_count);
30062306a36Sopenharmony_ci	head->leaf_head = cpu_to_be32(tree->leaf_head);
30162306a36Sopenharmony_ci	head->leaf_tail = cpu_to_be32(tree->leaf_tail);
30262306a36Sopenharmony_ci	head->node_count = cpu_to_be32(tree->node_count);
30362306a36Sopenharmony_ci	head->free_nodes = cpu_to_be32(tree->free_nodes);
30462306a36Sopenharmony_ci	head->attributes = cpu_to_be32(tree->attributes);
30562306a36Sopenharmony_ci	head->depth = cpu_to_be16(tree->depth);
30662306a36Sopenharmony_ci
30762306a36Sopenharmony_ci	kunmap_local(head);
30862306a36Sopenharmony_ci	set_page_dirty(page);
30962306a36Sopenharmony_ci	hfs_bnode_put(node);
31062306a36Sopenharmony_ci	return 0;
31162306a36Sopenharmony_ci}
31262306a36Sopenharmony_ci
31362306a36Sopenharmony_cistatic struct hfs_bnode *hfs_bmap_new_bmap(struct hfs_bnode *prev, u32 idx)
31462306a36Sopenharmony_ci{
31562306a36Sopenharmony_ci	struct hfs_btree *tree = prev->tree;
31662306a36Sopenharmony_ci	struct hfs_bnode *node;
31762306a36Sopenharmony_ci	struct hfs_bnode_desc desc;
31862306a36Sopenharmony_ci	__be32 cnid;
31962306a36Sopenharmony_ci
32062306a36Sopenharmony_ci	node = hfs_bnode_create(tree, idx);
32162306a36Sopenharmony_ci	if (IS_ERR(node))
32262306a36Sopenharmony_ci		return node;
32362306a36Sopenharmony_ci
32462306a36Sopenharmony_ci	tree->free_nodes--;
32562306a36Sopenharmony_ci	prev->next = idx;
32662306a36Sopenharmony_ci	cnid = cpu_to_be32(idx);
32762306a36Sopenharmony_ci	hfs_bnode_write(prev, &cnid, offsetof(struct hfs_bnode_desc, next), 4);
32862306a36Sopenharmony_ci
32962306a36Sopenharmony_ci	node->type = HFS_NODE_MAP;
33062306a36Sopenharmony_ci	node->num_recs = 1;
33162306a36Sopenharmony_ci	hfs_bnode_clear(node, 0, tree->node_size);
33262306a36Sopenharmony_ci	desc.next = 0;
33362306a36Sopenharmony_ci	desc.prev = 0;
33462306a36Sopenharmony_ci	desc.type = HFS_NODE_MAP;
33562306a36Sopenharmony_ci	desc.height = 0;
33662306a36Sopenharmony_ci	desc.num_recs = cpu_to_be16(1);
33762306a36Sopenharmony_ci	desc.reserved = 0;
33862306a36Sopenharmony_ci	hfs_bnode_write(node, &desc, 0, sizeof(desc));
33962306a36Sopenharmony_ci	hfs_bnode_write_u16(node, 14, 0x8000);
34062306a36Sopenharmony_ci	hfs_bnode_write_u16(node, tree->node_size - 2, 14);
34162306a36Sopenharmony_ci	hfs_bnode_write_u16(node, tree->node_size - 4, tree->node_size - 6);
34262306a36Sopenharmony_ci
34362306a36Sopenharmony_ci	return node;
34462306a36Sopenharmony_ci}
34562306a36Sopenharmony_ci
34662306a36Sopenharmony_ci/* Make sure @tree has enough space for the @rsvd_nodes */
34762306a36Sopenharmony_ciint hfs_bmap_reserve(struct hfs_btree *tree, int rsvd_nodes)
34862306a36Sopenharmony_ci{
34962306a36Sopenharmony_ci	struct inode *inode = tree->inode;
35062306a36Sopenharmony_ci	struct hfsplus_inode_info *hip = HFSPLUS_I(inode);
35162306a36Sopenharmony_ci	u32 count;
35262306a36Sopenharmony_ci	int res;
35362306a36Sopenharmony_ci
35462306a36Sopenharmony_ci	if (rsvd_nodes <= 0)
35562306a36Sopenharmony_ci		return 0;
35662306a36Sopenharmony_ci
35762306a36Sopenharmony_ci	while (tree->free_nodes < rsvd_nodes) {
35862306a36Sopenharmony_ci		res = hfsplus_file_extend(inode, hfs_bnode_need_zeroout(tree));
35962306a36Sopenharmony_ci		if (res)
36062306a36Sopenharmony_ci			return res;
36162306a36Sopenharmony_ci		hip->phys_size = inode->i_size =
36262306a36Sopenharmony_ci			(loff_t)hip->alloc_blocks <<
36362306a36Sopenharmony_ci				HFSPLUS_SB(tree->sb)->alloc_blksz_shift;
36462306a36Sopenharmony_ci		hip->fs_blocks =
36562306a36Sopenharmony_ci			hip->alloc_blocks << HFSPLUS_SB(tree->sb)->fs_shift;
36662306a36Sopenharmony_ci		inode_set_bytes(inode, inode->i_size);
36762306a36Sopenharmony_ci		count = inode->i_size >> tree->node_size_shift;
36862306a36Sopenharmony_ci		tree->free_nodes += count - tree->node_count;
36962306a36Sopenharmony_ci		tree->node_count = count;
37062306a36Sopenharmony_ci	}
37162306a36Sopenharmony_ci	return 0;
37262306a36Sopenharmony_ci}
37362306a36Sopenharmony_ci
37462306a36Sopenharmony_cistruct hfs_bnode *hfs_bmap_alloc(struct hfs_btree *tree)
37562306a36Sopenharmony_ci{
37662306a36Sopenharmony_ci	struct hfs_bnode *node, *next_node;
37762306a36Sopenharmony_ci	struct page **pagep;
37862306a36Sopenharmony_ci	u32 nidx, idx;
37962306a36Sopenharmony_ci	unsigned off;
38062306a36Sopenharmony_ci	u16 off16;
38162306a36Sopenharmony_ci	u16 len;
38262306a36Sopenharmony_ci	u8 *data, byte, m;
38362306a36Sopenharmony_ci	int i, res;
38462306a36Sopenharmony_ci
38562306a36Sopenharmony_ci	res = hfs_bmap_reserve(tree, 1);
38662306a36Sopenharmony_ci	if (res)
38762306a36Sopenharmony_ci		return ERR_PTR(res);
38862306a36Sopenharmony_ci
38962306a36Sopenharmony_ci	nidx = 0;
39062306a36Sopenharmony_ci	node = hfs_bnode_find(tree, nidx);
39162306a36Sopenharmony_ci	if (IS_ERR(node))
39262306a36Sopenharmony_ci		return node;
39362306a36Sopenharmony_ci	len = hfs_brec_lenoff(node, 2, &off16);
39462306a36Sopenharmony_ci	off = off16;
39562306a36Sopenharmony_ci
39662306a36Sopenharmony_ci	off += node->page_offset;
39762306a36Sopenharmony_ci	pagep = node->page + (off >> PAGE_SHIFT);
39862306a36Sopenharmony_ci	data = kmap_local_page(*pagep);
39962306a36Sopenharmony_ci	off &= ~PAGE_MASK;
40062306a36Sopenharmony_ci	idx = 0;
40162306a36Sopenharmony_ci
40262306a36Sopenharmony_ci	for (;;) {
40362306a36Sopenharmony_ci		while (len) {
40462306a36Sopenharmony_ci			byte = data[off];
40562306a36Sopenharmony_ci			if (byte != 0xff) {
40662306a36Sopenharmony_ci				for (m = 0x80, i = 0; i < 8; m >>= 1, i++) {
40762306a36Sopenharmony_ci					if (!(byte & m)) {
40862306a36Sopenharmony_ci						idx += i;
40962306a36Sopenharmony_ci						data[off] |= m;
41062306a36Sopenharmony_ci						set_page_dirty(*pagep);
41162306a36Sopenharmony_ci						kunmap_local(data);
41262306a36Sopenharmony_ci						tree->free_nodes--;
41362306a36Sopenharmony_ci						mark_inode_dirty(tree->inode);
41462306a36Sopenharmony_ci						hfs_bnode_put(node);
41562306a36Sopenharmony_ci						return hfs_bnode_create(tree,
41662306a36Sopenharmony_ci							idx);
41762306a36Sopenharmony_ci					}
41862306a36Sopenharmony_ci				}
41962306a36Sopenharmony_ci			}
42062306a36Sopenharmony_ci			if (++off >= PAGE_SIZE) {
42162306a36Sopenharmony_ci				kunmap_local(data);
42262306a36Sopenharmony_ci				data = kmap_local_page(*++pagep);
42362306a36Sopenharmony_ci				off = 0;
42462306a36Sopenharmony_ci			}
42562306a36Sopenharmony_ci			idx += 8;
42662306a36Sopenharmony_ci			len--;
42762306a36Sopenharmony_ci		}
42862306a36Sopenharmony_ci		kunmap_local(data);
42962306a36Sopenharmony_ci		nidx = node->next;
43062306a36Sopenharmony_ci		if (!nidx) {
43162306a36Sopenharmony_ci			hfs_dbg(BNODE_MOD, "create new bmap node\n");
43262306a36Sopenharmony_ci			next_node = hfs_bmap_new_bmap(node, idx);
43362306a36Sopenharmony_ci		} else
43462306a36Sopenharmony_ci			next_node = hfs_bnode_find(tree, nidx);
43562306a36Sopenharmony_ci		hfs_bnode_put(node);
43662306a36Sopenharmony_ci		if (IS_ERR(next_node))
43762306a36Sopenharmony_ci			return next_node;
43862306a36Sopenharmony_ci		node = next_node;
43962306a36Sopenharmony_ci
44062306a36Sopenharmony_ci		len = hfs_brec_lenoff(node, 0, &off16);
44162306a36Sopenharmony_ci		off = off16;
44262306a36Sopenharmony_ci		off += node->page_offset;
44362306a36Sopenharmony_ci		pagep = node->page + (off >> PAGE_SHIFT);
44462306a36Sopenharmony_ci		data = kmap_local_page(*pagep);
44562306a36Sopenharmony_ci		off &= ~PAGE_MASK;
44662306a36Sopenharmony_ci	}
44762306a36Sopenharmony_ci}
44862306a36Sopenharmony_ci
44962306a36Sopenharmony_civoid hfs_bmap_free(struct hfs_bnode *node)
45062306a36Sopenharmony_ci{
45162306a36Sopenharmony_ci	struct hfs_btree *tree;
45262306a36Sopenharmony_ci	struct page *page;
45362306a36Sopenharmony_ci	u16 off, len;
45462306a36Sopenharmony_ci	u32 nidx;
45562306a36Sopenharmony_ci	u8 *data, byte, m;
45662306a36Sopenharmony_ci
45762306a36Sopenharmony_ci	hfs_dbg(BNODE_MOD, "btree_free_node: %u\n", node->this);
45862306a36Sopenharmony_ci	BUG_ON(!node->this);
45962306a36Sopenharmony_ci	tree = node->tree;
46062306a36Sopenharmony_ci	nidx = node->this;
46162306a36Sopenharmony_ci	node = hfs_bnode_find(tree, 0);
46262306a36Sopenharmony_ci	if (IS_ERR(node))
46362306a36Sopenharmony_ci		return;
46462306a36Sopenharmony_ci	len = hfs_brec_lenoff(node, 2, &off);
46562306a36Sopenharmony_ci	while (nidx >= len * 8) {
46662306a36Sopenharmony_ci		u32 i;
46762306a36Sopenharmony_ci
46862306a36Sopenharmony_ci		nidx -= len * 8;
46962306a36Sopenharmony_ci		i = node->next;
47062306a36Sopenharmony_ci		if (!i) {
47162306a36Sopenharmony_ci			/* panic */;
47262306a36Sopenharmony_ci			pr_crit("unable to free bnode %u. "
47362306a36Sopenharmony_ci					"bmap not found!\n",
47462306a36Sopenharmony_ci				node->this);
47562306a36Sopenharmony_ci			hfs_bnode_put(node);
47662306a36Sopenharmony_ci			return;
47762306a36Sopenharmony_ci		}
47862306a36Sopenharmony_ci		hfs_bnode_put(node);
47962306a36Sopenharmony_ci		node = hfs_bnode_find(tree, i);
48062306a36Sopenharmony_ci		if (IS_ERR(node))
48162306a36Sopenharmony_ci			return;
48262306a36Sopenharmony_ci		if (node->type != HFS_NODE_MAP) {
48362306a36Sopenharmony_ci			/* panic */;
48462306a36Sopenharmony_ci			pr_crit("invalid bmap found! "
48562306a36Sopenharmony_ci					"(%u,%d)\n",
48662306a36Sopenharmony_ci				node->this, node->type);
48762306a36Sopenharmony_ci			hfs_bnode_put(node);
48862306a36Sopenharmony_ci			return;
48962306a36Sopenharmony_ci		}
49062306a36Sopenharmony_ci		len = hfs_brec_lenoff(node, 0, &off);
49162306a36Sopenharmony_ci	}
49262306a36Sopenharmony_ci	off += node->page_offset + nidx / 8;
49362306a36Sopenharmony_ci	page = node->page[off >> PAGE_SHIFT];
49462306a36Sopenharmony_ci	data = kmap_local_page(page);
49562306a36Sopenharmony_ci	off &= ~PAGE_MASK;
49662306a36Sopenharmony_ci	m = 1 << (~nidx & 7);
49762306a36Sopenharmony_ci	byte = data[off];
49862306a36Sopenharmony_ci	if (!(byte & m)) {
49962306a36Sopenharmony_ci		pr_crit("trying to free free bnode "
50062306a36Sopenharmony_ci				"%u(%d)\n",
50162306a36Sopenharmony_ci			node->this, node->type);
50262306a36Sopenharmony_ci		kunmap_local(data);
50362306a36Sopenharmony_ci		hfs_bnode_put(node);
50462306a36Sopenharmony_ci		return;
50562306a36Sopenharmony_ci	}
50662306a36Sopenharmony_ci	data[off] = byte & ~m;
50762306a36Sopenharmony_ci	set_page_dirty(page);
50862306a36Sopenharmony_ci	kunmap_local(data);
50962306a36Sopenharmony_ci	hfs_bnode_put(node);
51062306a36Sopenharmony_ci	tree->free_nodes++;
51162306a36Sopenharmony_ci	mark_inode_dirty(tree->inode);
51262306a36Sopenharmony_ci}
513