GNU Linux-libre 5.10.219-gnu1
[releases.git] / fs / hfs / btree.c
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  *  linux/fs/hfs/btree.c
4  *
5  * Copyright (C) 2001
6  * Brad Boyer (flar@allandria.com)
7  * (C) 2003 Ardis Technologies <roman@ardistech.com>
8  *
9  * Handle opening/closing btree
10  */
11
12 #include <linux/pagemap.h>
13 #include <linux/slab.h>
14 #include <linux/log2.h>
15
16 #include "btree.h"
17
18 /* Get a reference to a B*Tree and do some initial checks */
19 struct hfs_btree *hfs_btree_open(struct super_block *sb, u32 id, btree_keycmp keycmp)
20 {
21         struct hfs_btree *tree;
22         struct hfs_btree_header_rec *head;
23         struct address_space *mapping;
24         struct page *page;
25         unsigned int size;
26
27         tree = kzalloc(sizeof(*tree), GFP_KERNEL);
28         if (!tree)
29                 return NULL;
30
31         mutex_init(&tree->tree_lock);
32         spin_lock_init(&tree->hash_lock);
33         /* Set the correct compare function */
34         tree->sb = sb;
35         tree->cnid = id;
36         tree->keycmp = keycmp;
37
38         tree->inode = iget_locked(sb, id);
39         if (!tree->inode)
40                 goto free_tree;
41         BUG_ON(!(tree->inode->i_state & I_NEW));
42         {
43         struct hfs_mdb *mdb = HFS_SB(sb)->mdb;
44         HFS_I(tree->inode)->flags = 0;
45         mutex_init(&HFS_I(tree->inode)->extents_lock);
46         switch (id) {
47         case HFS_EXT_CNID:
48                 hfs_inode_read_fork(tree->inode, mdb->drXTExtRec, mdb->drXTFlSize,
49                                     mdb->drXTFlSize, be32_to_cpu(mdb->drXTClpSiz));
50                 if (HFS_I(tree->inode)->alloc_blocks >
51                                         HFS_I(tree->inode)->first_blocks) {
52                         pr_err("invalid btree extent records\n");
53                         unlock_new_inode(tree->inode);
54                         goto free_inode;
55                 }
56
57                 tree->inode->i_mapping->a_ops = &hfs_btree_aops;
58                 break;
59         case HFS_CAT_CNID:
60                 hfs_inode_read_fork(tree->inode, mdb->drCTExtRec, mdb->drCTFlSize,
61                                     mdb->drCTFlSize, be32_to_cpu(mdb->drCTClpSiz));
62
63                 if (!HFS_I(tree->inode)->first_blocks) {
64                         pr_err("invalid btree extent records (0 size)\n");
65                         unlock_new_inode(tree->inode);
66                         goto free_inode;
67                 }
68
69                 tree->inode->i_mapping->a_ops = &hfs_btree_aops;
70                 break;
71         default:
72                 BUG();
73         }
74         }
75         unlock_new_inode(tree->inode);
76
77         mapping = tree->inode->i_mapping;
78         page = read_mapping_page(mapping, 0, NULL);
79         if (IS_ERR(page))
80                 goto free_inode;
81
82         /* Load the header */
83         head = (struct hfs_btree_header_rec *)(kmap(page) + sizeof(struct hfs_bnode_desc));
84         tree->root = be32_to_cpu(head->root);
85         tree->leaf_count = be32_to_cpu(head->leaf_count);
86         tree->leaf_head = be32_to_cpu(head->leaf_head);
87         tree->leaf_tail = be32_to_cpu(head->leaf_tail);
88         tree->node_count = be32_to_cpu(head->node_count);
89         tree->free_nodes = be32_to_cpu(head->free_nodes);
90         tree->attributes = be32_to_cpu(head->attributes);
91         tree->node_size = be16_to_cpu(head->node_size);
92         tree->max_key_len = be16_to_cpu(head->max_key_len);
93         tree->depth = be16_to_cpu(head->depth);
94
95         size = tree->node_size;
96         if (!is_power_of_2(size))
97                 goto fail_page;
98         if (!tree->node_count)
99                 goto fail_page;
100         switch (id) {
101         case HFS_EXT_CNID:
102                 if (tree->max_key_len != HFS_MAX_EXT_KEYLEN) {
103                         pr_err("invalid extent max_key_len %d\n",
104                                tree->max_key_len);
105                         goto fail_page;
106                 }
107                 break;
108         case HFS_CAT_CNID:
109                 if (tree->max_key_len != HFS_MAX_CAT_KEYLEN) {
110                         pr_err("invalid catalog max_key_len %d\n",
111                                tree->max_key_len);
112                         goto fail_page;
113                 }
114                 break;
115         default:
116                 BUG();
117         }
118
119         tree->node_size_shift = ffs(size) - 1;
120         tree->pages_per_bnode = (tree->node_size + PAGE_SIZE - 1) >> PAGE_SHIFT;
121
122         kunmap(page);
123         put_page(page);
124         return tree;
125
126 fail_page:
127         put_page(page);
128 free_inode:
129         tree->inode->i_mapping->a_ops = &hfs_aops;
130         iput(tree->inode);
131 free_tree:
132         kfree(tree);
133         return NULL;
134 }
135
136 /* Release resources used by a btree */
137 void hfs_btree_close(struct hfs_btree *tree)
138 {
139         struct hfs_bnode *node;
140         int i;
141
142         if (!tree)
143                 return;
144
145         for (i = 0; i < NODE_HASH_SIZE; i++) {
146                 while ((node = tree->node_hash[i])) {
147                         tree->node_hash[i] = node->next_hash;
148                         if (atomic_read(&node->refcnt))
149                                 pr_err("node %d:%d still has %d user(s)!\n",
150                                        node->tree->cnid, node->this,
151                                        atomic_read(&node->refcnt));
152                         hfs_bnode_free(node);
153                         tree->node_hash_cnt--;
154                 }
155         }
156         iput(tree->inode);
157         kfree(tree);
158 }
159
160 void hfs_btree_write(struct hfs_btree *tree)
161 {
162         struct hfs_btree_header_rec *head;
163         struct hfs_bnode *node;
164         struct page *page;
165
166         node = hfs_bnode_find(tree, 0);
167         if (IS_ERR(node))
168                 /* panic? */
169                 return;
170         /* Load the header */
171         page = node->page[0];
172         head = (struct hfs_btree_header_rec *)(kmap(page) + sizeof(struct hfs_bnode_desc));
173
174         head->root = cpu_to_be32(tree->root);
175         head->leaf_count = cpu_to_be32(tree->leaf_count);
176         head->leaf_head = cpu_to_be32(tree->leaf_head);
177         head->leaf_tail = cpu_to_be32(tree->leaf_tail);
178         head->node_count = cpu_to_be32(tree->node_count);
179         head->free_nodes = cpu_to_be32(tree->free_nodes);
180         head->attributes = cpu_to_be32(tree->attributes);
181         head->depth = cpu_to_be16(tree->depth);
182
183         kunmap(page);
184         set_page_dirty(page);
185         hfs_bnode_put(node);
186 }
187
188 static struct hfs_bnode *hfs_bmap_new_bmap(struct hfs_bnode *prev, u32 idx)
189 {
190         struct hfs_btree *tree = prev->tree;
191         struct hfs_bnode *node;
192         struct hfs_bnode_desc desc;
193         __be32 cnid;
194
195         node = hfs_bnode_create(tree, idx);
196         if (IS_ERR(node))
197                 return node;
198
199         if (!tree->free_nodes)
200                 panic("FIXME!!!");
201         tree->free_nodes--;
202         prev->next = idx;
203         cnid = cpu_to_be32(idx);
204         hfs_bnode_write(prev, &cnid, offsetof(struct hfs_bnode_desc, next), 4);
205
206         node->type = HFS_NODE_MAP;
207         node->num_recs = 1;
208         hfs_bnode_clear(node, 0, tree->node_size);
209         desc.next = 0;
210         desc.prev = 0;
211         desc.type = HFS_NODE_MAP;
212         desc.height = 0;
213         desc.num_recs = cpu_to_be16(1);
214         desc.reserved = 0;
215         hfs_bnode_write(node, &desc, 0, sizeof(desc));
216         hfs_bnode_write_u16(node, 14, 0x8000);
217         hfs_bnode_write_u16(node, tree->node_size - 2, 14);
218         hfs_bnode_write_u16(node, tree->node_size - 4, tree->node_size - 6);
219
220         return node;
221 }
222
223 /* Make sure @tree has enough space for the @rsvd_nodes */
224 int hfs_bmap_reserve(struct hfs_btree *tree, int rsvd_nodes)
225 {
226         struct inode *inode = tree->inode;
227         u32 count;
228         int res;
229
230         while (tree->free_nodes < rsvd_nodes) {
231                 res = hfs_extend_file(inode);
232                 if (res)
233                         return res;
234                 HFS_I(inode)->phys_size = inode->i_size =
235                                 (loff_t)HFS_I(inode)->alloc_blocks *
236                                 HFS_SB(tree->sb)->alloc_blksz;
237                 HFS_I(inode)->fs_blocks = inode->i_size >>
238                                           tree->sb->s_blocksize_bits;
239                 inode_set_bytes(inode, inode->i_size);
240                 count = inode->i_size >> tree->node_size_shift;
241                 tree->free_nodes += count - tree->node_count;
242                 tree->node_count = count;
243         }
244         return 0;
245 }
246
247 struct hfs_bnode *hfs_bmap_alloc(struct hfs_btree *tree)
248 {
249         struct hfs_bnode *node, *next_node;
250         struct page **pagep;
251         u32 nidx, idx;
252         unsigned off;
253         u16 off16;
254         u16 len;
255         u8 *data, byte, m;
256         int i, res;
257
258         res = hfs_bmap_reserve(tree, 1);
259         if (res)
260                 return ERR_PTR(res);
261
262         nidx = 0;
263         node = hfs_bnode_find(tree, nidx);
264         if (IS_ERR(node))
265                 return node;
266         len = hfs_brec_lenoff(node, 2, &off16);
267         off = off16;
268
269         off += node->page_offset;
270         pagep = node->page + (off >> PAGE_SHIFT);
271         data = kmap(*pagep);
272         off &= ~PAGE_MASK;
273         idx = 0;
274
275         for (;;) {
276                 while (len) {
277                         byte = data[off];
278                         if (byte != 0xff) {
279                                 for (m = 0x80, i = 0; i < 8; m >>= 1, i++) {
280                                         if (!(byte & m)) {
281                                                 idx += i;
282                                                 data[off] |= m;
283                                                 set_page_dirty(*pagep);
284                                                 kunmap(*pagep);
285                                                 tree->free_nodes--;
286                                                 mark_inode_dirty(tree->inode);
287                                                 hfs_bnode_put(node);
288                                                 return hfs_bnode_create(tree, idx);
289                                         }
290                                 }
291                         }
292                         if (++off >= PAGE_SIZE) {
293                                 kunmap(*pagep);
294                                 data = kmap(*++pagep);
295                                 off = 0;
296                         }
297                         idx += 8;
298                         len--;
299                 }
300                 kunmap(*pagep);
301                 nidx = node->next;
302                 if (!nidx) {
303                         printk(KERN_DEBUG "create new bmap node...\n");
304                         next_node = hfs_bmap_new_bmap(node, idx);
305                 } else
306                         next_node = hfs_bnode_find(tree, nidx);
307                 hfs_bnode_put(node);
308                 if (IS_ERR(next_node))
309                         return next_node;
310                 node = next_node;
311
312                 len = hfs_brec_lenoff(node, 0, &off16);
313                 off = off16;
314                 off += node->page_offset;
315                 pagep = node->page + (off >> PAGE_SHIFT);
316                 data = kmap(*pagep);
317                 off &= ~PAGE_MASK;
318         }
319 }
320
321 void hfs_bmap_free(struct hfs_bnode *node)
322 {
323         struct hfs_btree *tree;
324         struct page *page;
325         u16 off, len;
326         u32 nidx;
327         u8 *data, byte, m;
328
329         hfs_dbg(BNODE_MOD, "btree_free_node: %u\n", node->this);
330         tree = node->tree;
331         nidx = node->this;
332         node = hfs_bnode_find(tree, 0);
333         if (IS_ERR(node))
334                 return;
335         len = hfs_brec_lenoff(node, 2, &off);
336         while (nidx >= len * 8) {
337                 u32 i;
338
339                 nidx -= len * 8;
340                 i = node->next;
341                 if (!i) {
342                         /* panic */;
343                         pr_crit("unable to free bnode %u. bmap not found!\n",
344                                 node->this);
345                         hfs_bnode_put(node);
346                         return;
347                 }
348                 hfs_bnode_put(node);
349                 node = hfs_bnode_find(tree, i);
350                 if (IS_ERR(node))
351                         return;
352                 if (node->type != HFS_NODE_MAP) {
353                         /* panic */;
354                         pr_crit("invalid bmap found! (%u,%d)\n",
355                                 node->this, node->type);
356                         hfs_bnode_put(node);
357                         return;
358                 }
359                 len = hfs_brec_lenoff(node, 0, &off);
360         }
361         off += node->page_offset + nidx / 8;
362         page = node->page[off >> PAGE_SHIFT];
363         data = kmap(page);
364         off &= ~PAGE_MASK;
365         m = 1 << (~nidx & 7);
366         byte = data[off];
367         if (!(byte & m)) {
368                 pr_crit("trying to free free bnode %u(%d)\n",
369                         node->this, node->type);
370                 kunmap(page);
371                 hfs_bnode_put(node);
372                 return;
373         }
374         data[off] = byte & ~m;
375         set_page_dirty(page);
376         kunmap(page);
377         hfs_bnode_put(node);
378         tree->free_nodes++;
379         mark_inode_dirty(tree->inode);
380 }