fs/hfs/brec.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  *  linux/fs/hfs/brec.c
   4  *
   5  * Copyright (C) 2001
   6  * Brad Boyer (flar@allandria.com)
   7  * (C) 2003 Ardis Technologies <roman@ardistech.com>
   8  *
   9  * Handle individual btree records
  10  */
  11
  12 #include "btree.h"
  13
  14 static struct hfs_bnode *hfs_bnode_split(struct hfs_find_data *fd);
  15 static int hfs_brec_update_parent(struct hfs_find_data *fd);
  16 static int hfs_btree_inc_height(struct hfs_btree *tree);
  17
  18 /* Get the length and offset of the given record in the given node */
  19 u16 hfs_brec_lenoff(struct hfs_bnode *node, u16 rec, u16 *off)
  20 {
  21         __be16 retval[2];
  22         u16 dataoff;
  23
  24         dataoff = node->tree->node_size - (rec + 2) * 2;
  25         hfs_bnode_read(node, retval, dataoff, 4);
  26         *off = be16_to_cpu(retval[1]);
  27         return be16_to_cpu(retval[0]) - *off;
  28 }
  29
  30 /* Get the length of the key from a keyed record */
  31 u16 hfs_brec_keylen(struct hfs_bnode *node, u16 rec)
  32 {
  33         u16 retval, recoff;
  34
  35         if (node->type != HFS_NODE_INDEX && node->type != HFS_NODE_LEAF)
  36                 return 0;
  37
  38         if ((node->type == HFS_NODE_INDEX) &&
  39            !(node->tree->attributes & HFS_TREE_VARIDXKEYS)) {
  40                 if (node->tree->attributes & HFS_TREE_BIGKEYS)
  41                         retval = node->tree->max_key_len + 2;
  42                 else
  43                         retval = node->tree->max_key_len + 1;
  44         } else {
  45                 recoff = hfs_bnode_read_u16(node, node->tree->node_size - (rec + 1) * 2);
  46                 if (!recoff)
  47                         return 0;
  48                 if (node->tree->attributes & HFS_TREE_BIGKEYS) {
  49                         retval = hfs_bnode_read_u16(node, recoff) + 2;
  50                         if (retval > node->tree->max_key_len + 2) {
  51                                 pr_err("keylen %d too large\n", retval);
  52                                 retval = 0;
  53                         }
  54                 } else {
  55                         retval = (hfs_bnode_read_u8(node, recoff) | 1) + 1;
  56                         if (retval > node->tree->max_key_len + 1) {
  57                                 pr_err("keylen %d too large\n", retval);
  58                                 retval = 0;
  59                         }
  60                 }
  61         }
  62         return retval;
  63 }
  64
  65 int hfs_brec_insert(struct hfs_find_data *fd, void *entry, int entry_len)
  66 {
  67         struct hfs_btree *tree;
  68         struct hfs_bnode *node, *new_node;
  69         int size, key_len, rec;
  70         int data_off, end_off;
  71         int idx_rec_off, data_rec_off, end_rec_off;
  72         __be32 cnid;
  73
  74         tree = fd->tree;
  75         if (!fd->bnode) {
  76                 if (!tree->root)
  77                         hfs_btree_inc_height(tree);
  78                 node = hfs_bnode_find(tree, tree->leaf_head);
  79                 if (IS_ERR(node))
  80                         return PTR_ERR(node);
  81                 fd->bnode = node;
  82                 fd->record = -1;
  83         }
  84         new_node = NULL;
  85         key_len = (fd->search_key->key_len | 1) + 1;
  86 again:
  87         /* new record idx and complete record size */
  88         rec = fd->record + 1;
  89         size = key_len + entry_len;
  90
  91         node = fd->bnode;
  92         hfs_bnode_dump(node);
  93         /* get last offset */
  94         end_rec_off = tree->node_size - (node->num_recs + 1) * 2;
  95         end_off = hfs_bnode_read_u16(node, end_rec_off);
  96         end_rec_off -= 2;
  97         hfs_dbg(BNODE_MOD, "insert_rec: %d, %d, %d, %d\n",
  98                 rec, size, end_off, end_rec_off);
  99         if (size > end_rec_off - end_off) {
 100                 if (new_node)
 101                         panic("not enough room!\n");
 102                 new_node = hfs_bnode_split(fd);
 103                 if (IS_ERR(new_node))
 104                         return PTR_ERR(new_node);
 105                 goto again;
 106         }
 107         if (node->type == HFS_NODE_LEAF) {
 108                 tree->leaf_count++;
 109                 mark_inode_dirty(tree->inode);
 110         }
 111         node->num_recs++;
 112         /* write new last offset */
 113         hfs_bnode_write_u16(node, offsetof(struct hfs_bnode_desc, num_recs), node->num_recs);
 114         hfs_bnode_write_u16(node, end_rec_off, end_off + size);
 115         data_off = end_off;
 116         data_rec_off = end_rec_off + 2;
 117         idx_rec_off = tree->node_size - (rec + 1) * 2;
 118         if (idx_rec_off == data_rec_off)
 119                 goto skip;
 120         /* move all following entries */
 121         do {
 122                 data_off = hfs_bnode_read_u16(node, data_rec_off + 2);
 123                 hfs_bnode_write_u16(node, data_rec_off, data_off + size);
 124                 data_rec_off += 2;
 125         } while (data_rec_off < idx_rec_off);
 126
 127         /* move data away */
 128         hfs_bnode_move(node, data_off + size, data_off,
 129                        end_off - data_off);
 130
 131 skip:
 132         hfs_bnode_write(node, fd->search_key, data_off, key_len);
 133         hfs_bnode_write(node, entry, data_off + key_len, entry_len);
 134         hfs_bnode_dump(node);
 135
 136         /*
 137          * update parent key if we inserted a key
 138          * at the start of the node and it is not the new node
 139          */
 140         if (!rec && new_node != node) {
 141                 hfs_bnode_read_key(node, fd->search_key, data_off + size);
 142                 hfs_brec_update_parent(fd);
 143         }
 144
 145         if (new_node) {
 146                 hfs_bnode_put(fd->bnode);
 147                 if (!new_node->parent) {
 148                         hfs_btree_inc_height(tree);
 149                         new_node->parent = tree->root;
 150                 }
 151                 fd->bnode = hfs_bnode_find(tree, new_node->parent);
 152
 153                 /* create index data entry */
 154                 cnid = cpu_to_be32(new_node->this);
 155                 entry = &cnid;
 156                 entry_len = sizeof(cnid);
 157
 158                 /* get index key */
 159                 hfs_bnode_read_key(new_node, fd->search_key, 14);
 160                 __hfs_brec_find(fd->bnode, fd);
 161
 162                 hfs_bnode_put(new_node);
 163                 new_node = NULL;
 164
 165                 if (tree->attributes & HFS_TREE_VARIDXKEYS)
 166                         key_len = fd->search_key->key_len + 1;
 167                 else {
 168                         fd->search_key->key_len = tree->max_key_len;
 169                         key_len = tree->max_key_len + 1;
 170                 }
 171                 goto again;
 172         }
 173
 174         return 0;
 175 }
 176
 177 int hfs_brec_remove(struct hfs_find_data *fd)
 178 {
 179         struct hfs_btree *tree;
 180         struct hfs_bnode *node, *parent;
 181         int end_off, rec_off, data_off, size;
 182
 183         tree = fd->tree;
 184         node = fd->bnode;
 185 again:
 186         rec_off = tree->node_size - (fd->record + 2) * 2;
 187         end_off = tree->node_size - (node->num_recs + 1) * 2;
 188
 189         if (node->type == HFS_NODE_LEAF) {
 190                 tree->leaf_count--;
 191                 mark_inode_dirty(tree->inode);
 192         }
 193         hfs_bnode_dump(node);
 194         hfs_dbg(BNODE_MOD, "remove_rec: %d, %d\n",
 195                 fd->record, fd->keylength + fd->entrylength);
 196         if (!--node->num_recs) {
 197                 hfs_bnode_unlink(node);
 198                 if (!node->parent)
 199                         return 0;
 200                 parent = hfs_bnode_find(tree, node->parent);
 201                 if (IS_ERR(parent))
 202                         return PTR_ERR(parent);
 203                 hfs_bnode_put(node);
 204                 node = fd->bnode = parent;
 205
 206                 __hfs_brec_find(node, fd);
 207                 goto again;
 208         }
 209         hfs_bnode_write_u16(node, offsetof(struct hfs_bnode_desc, num_recs), node->num_recs);
 210
 211         if (rec_off == end_off)
 212                 goto skip;
 213         size = fd->keylength + fd->entrylength;
 214
 215         do {
 216                 data_off = hfs_bnode_read_u16(node, rec_off);
 217                 hfs_bnode_write_u16(node, rec_off + 2, data_off - size);
 218                 rec_off -= 2;
 219         } while (rec_off >= end_off);
 220
 221         /* fill hole */
 222         hfs_bnode_move(node, fd->keyoffset, fd->keyoffset + size,
 223                        data_off - fd->keyoffset - size);
 224 skip:
 225         hfs_bnode_dump(node);
 226         if (!fd->record)
 227                 hfs_brec_update_parent(fd);
 228         return 0;
 229 }
 230
 231 static struct hfs_bnode *hfs_bnode_split(struct hfs_find_data *fd)
 232 {
 233         struct hfs_btree *tree;
 234         struct hfs_bnode *node, *new_node, *next_node;
 235         struct hfs_bnode_desc node_desc;
 236         int num_recs, new_rec_off, new_off, old_rec_off;
 237         int data_start, data_end, size;
 238
 239         tree = fd->tree;
 240         node = fd->bnode;
 241         new_node = hfs_bmap_alloc(tree);
 242         if (IS_ERR(new_node))
 243                 return new_node;
 244         hfs_bnode_get(node);
 245         hfs_dbg(BNODE_MOD, "split_nodes: %d - %d - %d\n",
 246                 node->this, new_node->this, node->next);
 247         new_node->next = node->next;
 248         new_node->prev = node->this;
 249         new_node->parent = node->parent;
 250         new_node->type = node->type;
 251         new_node->height = node->height;
 252
 253         if (node->next)
 254                 next_node = hfs_bnode_find(tree, node->next);
 255         else
 256                 next_node = NULL;
 257
 258         if (IS_ERR(next_node)) {
 259                 hfs_bnode_put(node);
 260                 hfs_bnode_put(new_node);
 261                 return next_node;
 262         }
 263
 264         size = tree->node_size / 2 - node->num_recs * 2 - 14;
 265         old_rec_off = tree->node_size - 4;
 266         num_recs = 1;
 267         for (;;) {
 268                 data_start = hfs_bnode_read_u16(node, old_rec_off);
 269                 if (data_start > size)
 270                         break;
 271                 old_rec_off -= 2;
 272                 if (++num_recs < node->num_recs)
 273                         continue;
 274                 /* panic? */
 275                 hfs_bnode_put(node);
 276                 hfs_bnode_put(new_node);
 277                 if (next_node)
 278                         hfs_bnode_put(next_node);
 279                 return ERR_PTR(-ENOSPC);
 280         }
 281
 282         if (fd->record + 1 < num_recs) {
 283                 /* new record is in the lower half,
 284                  * so leave some more space there
 285                  */
 286                 old_rec_off += 2;
 287                 num_recs--;
 288                 data_start = hfs_bnode_read_u16(node, old_rec_off);
 289         } else {
 290                 hfs_bnode_put(node);
 291                 hfs_bnode_get(new_node);
 292                 fd->bnode = new_node;
 293                 fd->record -= num_recs;
 294                 fd->keyoffset -= data_start - 14;
 295                 fd->entryoffset -= data_start - 14;
 296         }
 297         new_node->num_recs = node->num_recs - num_recs;
 298         node->num_recs = num_recs;
 299
 300         new_rec_off = tree->node_size - 2;
 301         new_off = 14;
 302         size = data_start - new_off;
 303         num_recs = new_node->num_recs;
 304         data_end = data_start;
 305         while (num_recs) {
 306                 hfs_bnode_write_u16(new_node, new_rec_off, new_off);
 307                 old_rec_off -= 2;
 308                 new_rec_off -= 2;
 309                 data_end = hfs_bnode_read_u16(node, old_rec_off);
 310                 new_off = data_end - size;
 311                 num_recs--;
 312         }
 313         hfs_bnode_write_u16(new_node, new_rec_off, new_off);
 314         hfs_bnode_copy(new_node, 14, node, data_start, data_end - data_start);
 315
 316         /* update new bnode header */
 317         node_desc.next = cpu_to_be32(new_node->next);
 318         node_desc.prev = cpu_to_be32(new_node->prev);
 319         node_desc.type = new_node->type;
 320         node_desc.height = new_node->height;
 321         node_desc.num_recs = cpu_to_be16(new_node->num_recs);
 322         node_desc.reserved = 0;
 323         hfs_bnode_write(new_node, &node_desc, 0, sizeof(node_desc));
 324
 325         /* update previous bnode header */
 326         node->next = new_node->this;
 327         hfs_bnode_read(node, &node_desc, 0, sizeof(node_desc));
 328         node_desc.next = cpu_to_be32(node->next);
 329         node_desc.num_recs = cpu_to_be16(node->num_recs);
 330         hfs_bnode_write(node, &node_desc, 0, sizeof(node_desc));
 331
 332         /* update next bnode header */
 333         if (next_node) {
 334                 next_node->prev = new_node->this;
 335                 hfs_bnode_read(next_node, &node_desc, 0, sizeof(node_desc));
 336                 node_desc.prev = cpu_to_be32(next_node->prev);
 337                 hfs_bnode_write(next_node, &node_desc, 0, sizeof(node_desc));
 338                 hfs_bnode_put(next_node);
 339         } else if (node->this == tree->leaf_tail) {
 340                 /* if there is no next node, this might be the new tail */
 341                 tree->leaf_tail = new_node->this;
 342                 mark_inode_dirty(tree->inode);
 343         }
 344
 345         hfs_bnode_dump(node);
 346         hfs_bnode_dump(new_node);
 347         hfs_bnode_put(node);
 348
 349         return new_node;
 350 }
 351
 352 static int hfs_brec_update_parent(struct hfs_find_data *fd)
 353 {
 354         struct hfs_btree *tree;
 355         struct hfs_bnode *node, *new_node, *parent;
 356         int newkeylen, diff;
 357         int rec, rec_off, end_rec_off;
 358         int start_off, end_off;
 359
 360         tree = fd->tree;
 361         node = fd->bnode;
 362         new_node = NULL;
 363         if (!node->parent)
 364                 return 0;
 365
 366 again:
 367         parent = hfs_bnode_find(tree, node->parent);
 368         if (IS_ERR(parent))
 369                 return PTR_ERR(parent);
 370         __hfs_brec_find(parent, fd);
 371         if (fd->record < 0)
 372                 return -ENOENT;
 373         hfs_bnode_dump(parent);
 374         rec = fd->record;
 375
 376         /* size difference between old and new key */
 377         if (tree->attributes & HFS_TREE_VARIDXKEYS)
 378                 newkeylen = (hfs_bnode_read_u8(node, 14) | 1) + 1;
 379         else
 380                 fd->keylength = newkeylen = tree->max_key_len + 1;
 381         hfs_dbg(BNODE_MOD, "update_rec: %d, %d, %d\n",
 382                 rec, fd->keylength, newkeylen);
 383
 384         rec_off = tree->node_size - (rec + 2) * 2;
 385         end_rec_off = tree->node_size - (parent->num_recs + 1) * 2;
 386         diff = newkeylen - fd->keylength;
 387         if (!diff)
 388                 goto skip;
 389         if (diff > 0) {
 390                 end_off = hfs_bnode_read_u16(parent, end_rec_off);
 391                 if (end_rec_off - end_off < diff) {
 392
 393                         printk(KERN_DEBUG "splitting index node...\n");
 394                         fd->bnode = parent;
 395                         new_node = hfs_bnode_split(fd);
 396                         if (IS_ERR(new_node))
 397                                 return PTR_ERR(new_node);
 398                         parent = fd->bnode;
 399                         rec = fd->record;
 400                         rec_off = tree->node_size - (rec + 2) * 2;
 401                         end_rec_off = tree->node_size - (parent->num_recs + 1) * 2;
 402                 }
 403         }
 404
 405         end_off = start_off = hfs_bnode_read_u16(parent, rec_off);
 406         hfs_bnode_write_u16(parent, rec_off, start_off + diff);
 407         start_off -= 4; /* move previous cnid too */
 408
 409         while (rec_off > end_rec_off) {
 410                 rec_off -= 2;
 411                 end_off = hfs_bnode_read_u16(parent, rec_off);
 412                 hfs_bnode_write_u16(parent, rec_off, end_off + diff);
 413         }
 414         hfs_bnode_move(parent, start_off + diff, start_off,
 415                        end_off - start_off);
 416 skip:
 417         hfs_bnode_copy(parent, fd->keyoffset, node, 14, newkeylen);
 418         if (!(tree->attributes & HFS_TREE_VARIDXKEYS))
 419                 hfs_bnode_write_u8(parent, fd->keyoffset, newkeylen - 1);
 420         hfs_bnode_dump(parent);
 421
 422         hfs_bnode_put(node);
 423         node = parent;
 424
 425         if (new_node) {
 426                 __be32 cnid;
 427
 428                 if (!new_node->parent) {
 429                         hfs_btree_inc_height(tree);
 430                         new_node->parent = tree->root;
 431                 }
 432                 fd->bnode = hfs_bnode_find(tree, new_node->parent);
 433                 /* create index key and entry */
 434                 hfs_bnode_read_key(new_node, fd->search_key, 14);
 435                 cnid = cpu_to_be32(new_node->this);
 436
 437                 __hfs_brec_find(fd->bnode, fd);
 438                 hfs_brec_insert(fd, &cnid, sizeof(cnid));
 439                 hfs_bnode_put(fd->bnode);
 440                 hfs_bnode_put(new_node);
 441
 442                 if (!rec) {
 443                         if (new_node == node)
 444                                 goto out;
 445                         /* restore search_key */
 446                         hfs_bnode_read_key(node, fd->search_key, 14);
 447                 }
 448                 new_node = NULL;
 449         }
 450
 451         if (!rec && node->parent)
 452                 goto again;
 453 out:
 454         fd->bnode = node;
 455         return 0;
 456 }
 457
 458 static int hfs_btree_inc_height(struct hfs_btree *tree)
 459 {
 460         struct hfs_bnode *node, *new_node;
 461         struct hfs_bnode_desc node_desc;
 462         int key_size, rec;
 463         __be32 cnid;
 464
 465         node = NULL;
 466         if (tree->root) {
 467                 node = hfs_bnode_find(tree, tree->root);
 468                 if (IS_ERR(node))
 469                         return PTR_ERR(node);
 470         }
 471         new_node = hfs_bmap_alloc(tree);
 472         if (IS_ERR(new_node)) {
 473                 hfs_bnode_put(node);
 474                 return PTR_ERR(new_node);
 475         }
 476
 477         tree->root = new_node->this;
 478         if (!tree->depth) {
 479                 tree->leaf_head = tree->leaf_tail = new_node->this;
 480                 new_node->type = HFS_NODE_LEAF;
 481                 new_node->num_recs = 0;
 482         } else {
 483                 new_node->type = HFS_NODE_INDEX;
 484                 new_node->num_recs = 1;
 485         }
 486         new_node->parent = 0;
 487         new_node->next = 0;
 488         new_node->prev = 0;
 489         new_node->height = ++tree->depth;
 490
 491         node_desc.next = cpu_to_be32(new_node->next);
 492         node_desc.prev = cpu_to_be32(new_node->prev);
 493         node_desc.type = new_node->type;
 494         node_desc.height = new_node->height;
 495         node_desc.num_recs = cpu_to_be16(new_node->num_recs);
 496         node_desc.reserved = 0;
 497         hfs_bnode_write(new_node, &node_desc, 0, sizeof(node_desc));
 498
 499         rec = tree->node_size - 2;
 500         hfs_bnode_write_u16(new_node, rec, 14);
 501
 502         if (node) {
 503                 /* insert old root idx into new root */
 504                 node->parent = tree->root;
 505                 if (node->type == HFS_NODE_LEAF ||
 506                     tree->attributes & HFS_TREE_VARIDXKEYS)
 507                         key_size = hfs_bnode_read_u8(node, 14) + 1;
 508                 else
 509                         key_size = tree->max_key_len + 1;
 510                 hfs_bnode_copy(new_node, 14, node, 14, key_size);
 511
 512                 if (!(tree->attributes & HFS_TREE_VARIDXKEYS)) {
 513                         key_size = tree->max_key_len + 1;
 514                         hfs_bnode_write_u8(new_node, 14, tree->max_key_len);
 515                 }
 516                 key_size = (key_size + 1) & -2;
 517                 cnid = cpu_to_be32(node->this);
 518                 hfs_bnode_write(new_node, &cnid, 14 + key_size, 4);
 519
 520                 rec -= 2;
 521                 hfs_bnode_write_u16(new_node, rec, 14 + key_size + 4);
 522
 523                 hfs_bnode_put(node);
 524         }
 525         hfs_bnode_put(new_node);
 526         mark_inode_dirty(tree->inode);
 527
 528         return 0;
 529 }