1be0e5c09SChris Mason #include <stdio.h> 2be0e5c09SChris Mason #include <stdlib.h> 3be0e5c09SChris Mason #include "kerncompat.h" 4eb60ceacSChris Mason #include "radix-tree.h" 5eb60ceacSChris Mason #include "ctree.h" 6eb60ceacSChris Mason #include "disk-io.h" 75de08d7dSChris Mason #include "print-tree.h" 89a8dd150SChris Mason 9aa5d6bedSChris Mason static int split_node(struct ctree_root *root, struct ctree_path *path, 10aa5d6bedSChris Mason int level); 11aa5d6bedSChris Mason static int split_leaf(struct ctree_root *root, struct ctree_path *path, 12aa5d6bedSChris Mason int data_size); 13aa5d6bedSChris Mason static int push_node_left(struct ctree_root *root, struct ctree_path *path, 14aa5d6bedSChris Mason int level); 15aa5d6bedSChris Mason static int push_node_right(struct ctree_root *root, 165de08d7dSChris Mason struct ctree_path *path, int level); 17aa5d6bedSChris Mason static int del_ptr(struct ctree_root *root, struct ctree_path *path, int level); 18d97e63b6SChris Mason 195de08d7dSChris Mason inline void init_path(struct ctree_path *p) 20be0e5c09SChris Mason { 21be0e5c09SChris Mason memset(p, 0, sizeof(*p)); 22be0e5c09SChris Mason } 23be0e5c09SChris Mason 245de08d7dSChris Mason void release_path(struct ctree_root *root, struct ctree_path *p) 25eb60ceacSChris Mason { 26eb60ceacSChris Mason int i; 27eb60ceacSChris Mason for (i = 0; i < MAX_LEVEL; i++) { 28eb60ceacSChris Mason if (!p->nodes[i]) 29eb60ceacSChris Mason break; 30eb60ceacSChris Mason tree_block_release(root, p->nodes[i]); 31eb60ceacSChris Mason } 32aa5d6bedSChris Mason memset(p, 0, sizeof(*p)); 33eb60ceacSChris Mason } 34eb60ceacSChris Mason 3574123bd7SChris Mason /* 3674123bd7SChris Mason * The leaf data grows from end-to-front in the node. 3774123bd7SChris Mason * this returns the address of the start of the last item, 3874123bd7SChris Mason * which is the stop of the leaf data stack 3974123bd7SChris Mason */ 40be0e5c09SChris Mason static inline unsigned int leaf_data_end(struct leaf *leaf) 41be0e5c09SChris Mason { 42be0e5c09SChris Mason unsigned int nr = leaf->header.nritems; 43be0e5c09SChris Mason if (nr == 0) 44d97e63b6SChris Mason return sizeof(leaf->data); 45be0e5c09SChris Mason return leaf->items[nr-1].offset; 46be0e5c09SChris Mason } 47be0e5c09SChris Mason 4874123bd7SChris Mason /* 4974123bd7SChris Mason * The space between the end of the leaf items and 5074123bd7SChris Mason * the start of the leaf data. IOW, how much room 5174123bd7SChris Mason * the leaf has left for both items and data 5274123bd7SChris Mason */ 535de08d7dSChris Mason int leaf_free_space(struct leaf *leaf) 54be0e5c09SChris Mason { 55be0e5c09SChris Mason int data_end = leaf_data_end(leaf); 56be0e5c09SChris Mason int nritems = leaf->header.nritems; 57be0e5c09SChris Mason char *items_end = (char *)(leaf->items + nritems + 1); 58be0e5c09SChris Mason return (char *)(leaf->data + data_end) - (char *)items_end; 59be0e5c09SChris Mason } 60be0e5c09SChris Mason 6174123bd7SChris Mason /* 6274123bd7SChris Mason * compare two keys in a memcmp fashion 6374123bd7SChris Mason */ 64be0e5c09SChris Mason int comp_keys(struct key *k1, struct key *k2) 65be0e5c09SChris Mason { 66be0e5c09SChris Mason if (k1->objectid > k2->objectid) 67be0e5c09SChris Mason return 1; 68be0e5c09SChris Mason if (k1->objectid < k2->objectid) 69be0e5c09SChris Mason return -1; 70be0e5c09SChris Mason if (k1->flags > k2->flags) 71be0e5c09SChris Mason return 1; 72be0e5c09SChris Mason if (k1->flags < k2->flags) 73be0e5c09SChris Mason return -1; 74be0e5c09SChris Mason if (k1->offset > k2->offset) 75be0e5c09SChris Mason return 1; 76be0e5c09SChris Mason if (k1->offset < k2->offset) 77be0e5c09SChris Mason return -1; 78be0e5c09SChris Mason return 0; 79be0e5c09SChris Mason } 8074123bd7SChris Mason 81aa5d6bedSChris Mason int check_node(struct ctree_path *path, int level) 82aa5d6bedSChris Mason { 83aa5d6bedSChris Mason int i; 84aa5d6bedSChris Mason struct node *parent = NULL; 85aa5d6bedSChris Mason struct node *node = &path->nodes[level]->node; 86aa5d6bedSChris Mason int parent_slot; 87aa5d6bedSChris Mason 88aa5d6bedSChris Mason if (path->nodes[level + 1]) 89aa5d6bedSChris Mason parent = &path->nodes[level + 1]->node; 90aa5d6bedSChris Mason parent_slot = path->slots[level + 1]; 91aa5d6bedSChris Mason if (parent && node->header.nritems > 0) { 92aa5d6bedSChris Mason struct key *parent_key; 93aa5d6bedSChris Mason parent_key = &parent->keys[parent_slot]; 94aa5d6bedSChris Mason BUG_ON(memcmp(parent_key, node->keys, sizeof(struct key))); 95aa5d6bedSChris Mason BUG_ON(parent->blockptrs[parent_slot] != node->header.blocknr); 96aa5d6bedSChris Mason } 97aa5d6bedSChris Mason BUG_ON(node->header.nritems > NODEPTRS_PER_BLOCK); 98aa5d6bedSChris Mason for (i = 0; i < node->header.nritems - 2; i++) { 99aa5d6bedSChris Mason BUG_ON(comp_keys(&node->keys[i], &node->keys[i+1]) >= 0); 100aa5d6bedSChris Mason } 101aa5d6bedSChris Mason return 0; 102aa5d6bedSChris Mason } 103aa5d6bedSChris Mason 104aa5d6bedSChris Mason int check_leaf(struct ctree_path *path, int level) 105aa5d6bedSChris Mason { 106aa5d6bedSChris Mason int i; 107aa5d6bedSChris Mason struct leaf *leaf = &path->nodes[level]->leaf; 108aa5d6bedSChris Mason struct node *parent = NULL; 109aa5d6bedSChris Mason int parent_slot; 110aa5d6bedSChris Mason 111aa5d6bedSChris Mason if (path->nodes[level + 1]) 112aa5d6bedSChris Mason parent = &path->nodes[level + 1]->node; 113aa5d6bedSChris Mason parent_slot = path->slots[level + 1]; 114aa5d6bedSChris Mason if (parent && leaf->header.nritems > 0) { 115aa5d6bedSChris Mason struct key *parent_key; 116aa5d6bedSChris Mason parent_key = &parent->keys[parent_slot]; 117aa5d6bedSChris Mason BUG_ON(memcmp(parent_key, &leaf->items[0].key, 118aa5d6bedSChris Mason sizeof(struct key))); 119aa5d6bedSChris Mason BUG_ON(parent->blockptrs[parent_slot] != leaf->header.blocknr); 120aa5d6bedSChris Mason } 121aa5d6bedSChris Mason for (i = 0; i < leaf->header.nritems - 2; i++) { 122aa5d6bedSChris Mason BUG_ON(comp_keys(&leaf->items[i].key, 123aa5d6bedSChris Mason &leaf->items[i+1].key) >= 0); 124aa5d6bedSChris Mason BUG_ON(leaf->items[i].offset != leaf->items[i + 1].offset + 125aa5d6bedSChris Mason leaf->items[i + 1].size); 126aa5d6bedSChris Mason if (i == 0) { 127aa5d6bedSChris Mason BUG_ON(leaf->items[i].offset + leaf->items[i].size != 128aa5d6bedSChris Mason LEAF_DATA_SIZE); 129aa5d6bedSChris Mason } 130aa5d6bedSChris Mason } 131aa5d6bedSChris Mason BUG_ON(leaf_free_space(leaf) < 0); 132aa5d6bedSChris Mason return 0; 133aa5d6bedSChris Mason } 134aa5d6bedSChris Mason 135aa5d6bedSChris Mason int check_block(struct ctree_path *path, int level) 136aa5d6bedSChris Mason { 137aa5d6bedSChris Mason if (level == 0) 138aa5d6bedSChris Mason return check_leaf(path, level); 139aa5d6bedSChris Mason return check_node(path, level); 140aa5d6bedSChris Mason } 141aa5d6bedSChris Mason 14274123bd7SChris Mason /* 14374123bd7SChris Mason * search for key in the array p. items p are item_size apart 14474123bd7SChris Mason * and there are 'max' items in p 14574123bd7SChris Mason * the slot in the array is returned via slot, and it points to 14674123bd7SChris Mason * the place where you would insert key if it is not found in 14774123bd7SChris Mason * the array. 14874123bd7SChris Mason * 14974123bd7SChris Mason * slot may point to max if the key is bigger than all of the keys 15074123bd7SChris Mason */ 151be0e5c09SChris Mason int generic_bin_search(char *p, int item_size, struct key *key, 152be0e5c09SChris Mason int max, int *slot) 153be0e5c09SChris Mason { 154be0e5c09SChris Mason int low = 0; 155be0e5c09SChris Mason int high = max; 156be0e5c09SChris Mason int mid; 157be0e5c09SChris Mason int ret; 158be0e5c09SChris Mason struct key *tmp; 159be0e5c09SChris Mason 160be0e5c09SChris Mason while(low < high) { 161be0e5c09SChris Mason mid = (low + high) / 2; 162be0e5c09SChris Mason tmp = (struct key *)(p + mid * item_size); 163be0e5c09SChris Mason ret = comp_keys(tmp, key); 164be0e5c09SChris Mason 165be0e5c09SChris Mason if (ret < 0) 166be0e5c09SChris Mason low = mid + 1; 167be0e5c09SChris Mason else if (ret > 0) 168be0e5c09SChris Mason high = mid; 169be0e5c09SChris Mason else { 170be0e5c09SChris Mason *slot = mid; 171be0e5c09SChris Mason return 0; 172be0e5c09SChris Mason } 173be0e5c09SChris Mason } 174be0e5c09SChris Mason *slot = low; 175be0e5c09SChris Mason return 1; 176be0e5c09SChris Mason } 177be0e5c09SChris Mason 17897571fd0SChris Mason /* 17997571fd0SChris Mason * simple bin_search frontend that does the right thing for 18097571fd0SChris Mason * leaves vs nodes 18197571fd0SChris Mason */ 182be0e5c09SChris Mason int bin_search(struct node *c, struct key *key, int *slot) 183be0e5c09SChris Mason { 184be0e5c09SChris Mason if (is_leaf(c->header.flags)) { 185be0e5c09SChris Mason struct leaf *l = (struct leaf *)c; 186be0e5c09SChris Mason return generic_bin_search((void *)l->items, sizeof(struct item), 187be0e5c09SChris Mason key, c->header.nritems, slot); 188be0e5c09SChris Mason } else { 189be0e5c09SChris Mason return generic_bin_search((void *)c->keys, sizeof(struct key), 190be0e5c09SChris Mason key, c->header.nritems, slot); 191be0e5c09SChris Mason } 192be0e5c09SChris Mason return -1; 193be0e5c09SChris Mason } 194be0e5c09SChris Mason 19574123bd7SChris Mason /* 19674123bd7SChris Mason * look for key in the tree. path is filled in with nodes along the way 19774123bd7SChris Mason * if key is found, we return zero and you can find the item in the leaf 19874123bd7SChris Mason * level of the path (level 0) 19974123bd7SChris Mason * 20074123bd7SChris Mason * If the key isn't found, the path points to the slot where it should 201aa5d6bedSChris Mason * be inserted, and 1 is returned. If there are other errors during the 202aa5d6bedSChris Mason * search a negative error number is returned. 20397571fd0SChris Mason * 20497571fd0SChris Mason * if ins_len > 0, nodes and leaves will be split as we walk down the 20597571fd0SChris Mason * tree. if ins_len < 0, nodes will be merged as we walk down the tree (if 20697571fd0SChris Mason * possible) 20774123bd7SChris Mason */ 2085de08d7dSChris Mason int search_slot(struct ctree_root *root, struct key *key, 2095de08d7dSChris Mason struct ctree_path *p, int ins_len) 210be0e5c09SChris Mason { 211eb60ceacSChris Mason struct tree_buffer *b = root->node; 212eb60ceacSChris Mason struct node *c; 213be0e5c09SChris Mason int slot; 214be0e5c09SChris Mason int ret; 215be0e5c09SChris Mason int level; 2165c680ed6SChris Mason 217eb60ceacSChris Mason b->count++; 218eb60ceacSChris Mason while (b) { 219eb60ceacSChris Mason c = &b->node; 220be0e5c09SChris Mason level = node_level(c->header.flags); 221eb60ceacSChris Mason p->nodes[level] = b; 222aa5d6bedSChris Mason ret = check_block(p, level); 223aa5d6bedSChris Mason if (ret) 224aa5d6bedSChris Mason return -1; 225be0e5c09SChris Mason ret = bin_search(c, key, &slot); 226be0e5c09SChris Mason if (!is_leaf(c->header.flags)) { 227be0e5c09SChris Mason if (ret && slot > 0) 228be0e5c09SChris Mason slot -= 1; 229be0e5c09SChris Mason p->slots[level] = slot; 2305de08d7dSChris Mason if (ins_len > 0 && 2315de08d7dSChris Mason c->header.nritems == NODEPTRS_PER_BLOCK) { 2325c680ed6SChris Mason int sret = split_node(root, p, level); 2335c680ed6SChris Mason BUG_ON(sret > 0); 2345c680ed6SChris Mason if (sret) 2355c680ed6SChris Mason return sret; 2365c680ed6SChris Mason b = p->nodes[level]; 2375c680ed6SChris Mason c = &b->node; 2385c680ed6SChris Mason slot = p->slots[level]; 2395c680ed6SChris Mason } 240eb60ceacSChris Mason b = read_tree_block(root, c->blockptrs[slot]); 241be0e5c09SChris Mason continue; 242be0e5c09SChris Mason } else { 2435c680ed6SChris Mason struct leaf *l = (struct leaf *)c; 244be0e5c09SChris Mason p->slots[level] = slot; 2455de08d7dSChris Mason if (ins_len > 0 && leaf_free_space(l) < 2465de08d7dSChris Mason sizeof(struct item) + ins_len) { 2475c680ed6SChris Mason int sret = split_leaf(root, p, ins_len); 2485c680ed6SChris Mason BUG_ON(sret > 0); 2495c680ed6SChris Mason if (sret) 2505c680ed6SChris Mason return sret; 2515c680ed6SChris Mason } 252be0e5c09SChris Mason return ret; 253be0e5c09SChris Mason } 254be0e5c09SChris Mason } 255aa5d6bedSChris Mason return 1; 256be0e5c09SChris Mason } 257be0e5c09SChris Mason 25874123bd7SChris Mason /* 25974123bd7SChris Mason * adjust the pointers going up the tree, starting at level 26074123bd7SChris Mason * making sure the right key of each node is points to 'key'. 26174123bd7SChris Mason * This is used after shifting pointers to the left, so it stops 26274123bd7SChris Mason * fixing up pointers when a given leaf/node is not in slot 0 of the 26374123bd7SChris Mason * higher levels 264aa5d6bedSChris Mason * 265aa5d6bedSChris Mason * If this fails to write a tree block, it returns -1, but continues 266aa5d6bedSChris Mason * fixing up the blocks in ram so the tree is consistent. 26774123bd7SChris Mason */ 268aa5d6bedSChris Mason static int fixup_low_keys(struct ctree_root *root, 269eb60ceacSChris Mason struct ctree_path *path, struct key *key, 270be0e5c09SChris Mason int level) 271be0e5c09SChris Mason { 272be0e5c09SChris Mason int i; 273aa5d6bedSChris Mason int ret = 0; 274aa5d6bedSChris Mason int wret; 275be0e5c09SChris Mason for (i = level; i < MAX_LEVEL; i++) { 276eb60ceacSChris Mason struct node *t; 277be0e5c09SChris Mason int tslot = path->slots[i]; 278eb60ceacSChris Mason if (!path->nodes[i]) 279be0e5c09SChris Mason break; 280eb60ceacSChris Mason t = &path->nodes[i]->node; 281be0e5c09SChris Mason memcpy(t->keys + tslot, key, sizeof(*key)); 282aa5d6bedSChris Mason wret = write_tree_block(root, path->nodes[i]); 283aa5d6bedSChris Mason if (wret) 284aa5d6bedSChris Mason ret = wret; 285be0e5c09SChris Mason if (tslot != 0) 286be0e5c09SChris Mason break; 287be0e5c09SChris Mason } 288aa5d6bedSChris Mason return ret; 289be0e5c09SChris Mason } 290be0e5c09SChris Mason 29174123bd7SChris Mason /* 29274123bd7SChris Mason * try to push data from one node into the next node left in the 29374123bd7SChris Mason * tree. The src node is found at specified level in the path. 29474123bd7SChris Mason * If some bytes were pushed, return 0, otherwise return 1. 29574123bd7SChris Mason * 29674123bd7SChris Mason * Lower nodes/leaves in the path are not touched, higher nodes may 29774123bd7SChris Mason * be modified to reflect the push. 29874123bd7SChris Mason * 29974123bd7SChris Mason * The path is altered to reflect the push. 300aa5d6bedSChris Mason * 301aa5d6bedSChris Mason * returns 0 if some ptrs were pushed left, < 0 if there was some horrible 302aa5d6bedSChris Mason * error, and > 0 if there was no room in the left hand block. 30374123bd7SChris Mason */ 304aa5d6bedSChris Mason static int push_node_left(struct ctree_root *root, struct ctree_path *path, 305aa5d6bedSChris Mason int level) 306be0e5c09SChris Mason { 307be0e5c09SChris Mason int slot; 308be0e5c09SChris Mason struct node *left; 309be0e5c09SChris Mason struct node *right; 310be0e5c09SChris Mason int push_items = 0; 311be0e5c09SChris Mason int left_nritems; 312be0e5c09SChris Mason int right_nritems; 313eb60ceacSChris Mason struct tree_buffer *t; 314eb60ceacSChris Mason struct tree_buffer *right_buf; 315aa5d6bedSChris Mason int ret = 0; 316aa5d6bedSChris Mason int wret; 317be0e5c09SChris Mason 318be0e5c09SChris Mason if (level == MAX_LEVEL - 1 || path->nodes[level + 1] == 0) 319be0e5c09SChris Mason return 1; 320be0e5c09SChris Mason slot = path->slots[level + 1]; 321be0e5c09SChris Mason if (slot == 0) 322be0e5c09SChris Mason return 1; 323be0e5c09SChris Mason 324eb60ceacSChris Mason t = read_tree_block(root, 325eb60ceacSChris Mason path->nodes[level + 1]->node.blockptrs[slot - 1]); 326eb60ceacSChris Mason left = &t->node; 327eb60ceacSChris Mason right_buf = path->nodes[level]; 328eb60ceacSChris Mason right = &right_buf->node; 329be0e5c09SChris Mason left_nritems = left->header.nritems; 330be0e5c09SChris Mason right_nritems = right->header.nritems; 331be0e5c09SChris Mason push_items = NODEPTRS_PER_BLOCK - (left_nritems + 1); 332eb60ceacSChris Mason if (push_items <= 0) { 333eb60ceacSChris Mason tree_block_release(root, t); 334be0e5c09SChris Mason return 1; 335eb60ceacSChris Mason } 336be0e5c09SChris Mason 337be0e5c09SChris Mason if (right_nritems < push_items) 338be0e5c09SChris Mason push_items = right_nritems; 339be0e5c09SChris Mason memcpy(left->keys + left_nritems, right->keys, 340be0e5c09SChris Mason push_items * sizeof(struct key)); 341be0e5c09SChris Mason memcpy(left->blockptrs + left_nritems, right->blockptrs, 342be0e5c09SChris Mason push_items * sizeof(u64)); 343be0e5c09SChris Mason memmove(right->keys, right->keys + push_items, 344be0e5c09SChris Mason (right_nritems - push_items) * sizeof(struct key)); 345be0e5c09SChris Mason memmove(right->blockptrs, right->blockptrs + push_items, 346be0e5c09SChris Mason (right_nritems - push_items) * sizeof(u64)); 347be0e5c09SChris Mason right->header.nritems -= push_items; 348be0e5c09SChris Mason left->header.nritems += push_items; 349be0e5c09SChris Mason 350be0e5c09SChris Mason /* adjust the pointers going up the tree */ 351aa5d6bedSChris Mason wret = fixup_low_keys(root, path, right->keys, level + 1); 352aa5d6bedSChris Mason if (wret < 0) 353aa5d6bedSChris Mason ret = wret; 354eb60ceacSChris Mason 355aa5d6bedSChris Mason wret = write_tree_block(root, t); 356aa5d6bedSChris Mason if (wret < 0) 357aa5d6bedSChris Mason ret = wret; 358aa5d6bedSChris Mason 359aa5d6bedSChris Mason wret = write_tree_block(root, right_buf); 360aa5d6bedSChris Mason if (wret < 0) 361aa5d6bedSChris Mason ret = wret; 362be0e5c09SChris Mason 363be0e5c09SChris Mason /* then fixup the leaf pointer in the path */ 364be0e5c09SChris Mason if (path->slots[level] < push_items) { 365be0e5c09SChris Mason path->slots[level] += left_nritems; 366eb60ceacSChris Mason tree_block_release(root, path->nodes[level]); 367eb60ceacSChris Mason path->nodes[level] = t; 368be0e5c09SChris Mason path->slots[level + 1] -= 1; 369be0e5c09SChris Mason } else { 370be0e5c09SChris Mason path->slots[level] -= push_items; 371eb60ceacSChris Mason tree_block_release(root, t); 372be0e5c09SChris Mason } 373aa5d6bedSChris Mason return ret; 374be0e5c09SChris Mason } 375be0e5c09SChris Mason 37674123bd7SChris Mason /* 37774123bd7SChris Mason * try to push data from one node into the next node right in the 37874123bd7SChris Mason * tree. The src node is found at specified level in the path. 37974123bd7SChris Mason * If some bytes were pushed, return 0, otherwise return 1. 38074123bd7SChris Mason * 38174123bd7SChris Mason * Lower nodes/leaves in the path are not touched, higher nodes may 38274123bd7SChris Mason * be modified to reflect the push. 38374123bd7SChris Mason * 38474123bd7SChris Mason * The path is altered to reflect the push. 385aa5d6bedSChris Mason * 386aa5d6bedSChris Mason * returns 0 if some ptrs were pushed, < 0 if there was some horrible 387aa5d6bedSChris Mason * error, and > 0 if there was no room in the right hand block. 38874123bd7SChris Mason */ 389aa5d6bedSChris Mason static int push_node_right(struct ctree_root *root, struct ctree_path *path, 390aa5d6bedSChris Mason int level) 391be0e5c09SChris Mason { 392be0e5c09SChris Mason int slot; 393eb60ceacSChris Mason struct tree_buffer *t; 394eb60ceacSChris Mason struct tree_buffer *src_buffer; 395be0e5c09SChris Mason struct node *dst; 396be0e5c09SChris Mason struct node *src; 397be0e5c09SChris Mason int push_items = 0; 398be0e5c09SChris Mason int dst_nritems; 399be0e5c09SChris Mason int src_nritems; 400be0e5c09SChris Mason 40174123bd7SChris Mason /* can't push from the root */ 402be0e5c09SChris Mason if (level == MAX_LEVEL - 1 || path->nodes[level + 1] == 0) 403be0e5c09SChris Mason return 1; 40474123bd7SChris Mason 40574123bd7SChris Mason /* only try to push inside the node higher up */ 406be0e5c09SChris Mason slot = path->slots[level + 1]; 407be0e5c09SChris Mason if (slot == NODEPTRS_PER_BLOCK - 1) 408be0e5c09SChris Mason return 1; 409be0e5c09SChris Mason 410eb60ceacSChris Mason if (slot >= path->nodes[level + 1]->node.header.nritems -1) 411be0e5c09SChris Mason return 1; 412be0e5c09SChris Mason 413eb60ceacSChris Mason t = read_tree_block(root, 414eb60ceacSChris Mason path->nodes[level + 1]->node.blockptrs[slot + 1]); 415eb60ceacSChris Mason dst = &t->node; 416eb60ceacSChris Mason src_buffer = path->nodes[level]; 417eb60ceacSChris Mason src = &src_buffer->node; 418be0e5c09SChris Mason dst_nritems = dst->header.nritems; 419be0e5c09SChris Mason src_nritems = src->header.nritems; 420be0e5c09SChris Mason push_items = NODEPTRS_PER_BLOCK - (dst_nritems + 1); 421eb60ceacSChris Mason if (push_items <= 0) { 422eb60ceacSChris Mason tree_block_release(root, t); 423be0e5c09SChris Mason return 1; 424eb60ceacSChris Mason } 425be0e5c09SChris Mason 426be0e5c09SChris Mason if (src_nritems < push_items) 427be0e5c09SChris Mason push_items = src_nritems; 428be0e5c09SChris Mason memmove(dst->keys + push_items, dst->keys, 429be0e5c09SChris Mason dst_nritems * sizeof(struct key)); 430be0e5c09SChris Mason memcpy(dst->keys, src->keys + src_nritems - push_items, 431be0e5c09SChris Mason push_items * sizeof(struct key)); 432be0e5c09SChris Mason 433be0e5c09SChris Mason memmove(dst->blockptrs + push_items, dst->blockptrs, 434be0e5c09SChris Mason dst_nritems * sizeof(u64)); 435be0e5c09SChris Mason memcpy(dst->blockptrs, src->blockptrs + src_nritems - push_items, 436be0e5c09SChris Mason push_items * sizeof(u64)); 437be0e5c09SChris Mason 438be0e5c09SChris Mason src->header.nritems -= push_items; 439be0e5c09SChris Mason dst->header.nritems += push_items; 440be0e5c09SChris Mason 441be0e5c09SChris Mason /* adjust the pointers going up the tree */ 442eb60ceacSChris Mason memcpy(path->nodes[level + 1]->node.keys + path->slots[level + 1] + 1, 443be0e5c09SChris Mason dst->keys, sizeof(struct key)); 444eb60ceacSChris Mason 445eb60ceacSChris Mason write_tree_block(root, path->nodes[level + 1]); 446eb60ceacSChris Mason write_tree_block(root, t); 447eb60ceacSChris Mason write_tree_block(root, src_buffer); 448eb60ceacSChris Mason 44974123bd7SChris Mason /* then fixup the pointers in the path */ 450be0e5c09SChris Mason if (path->slots[level] >= src->header.nritems) { 451be0e5c09SChris Mason path->slots[level] -= src->header.nritems; 452eb60ceacSChris Mason tree_block_release(root, path->nodes[level]); 453eb60ceacSChris Mason path->nodes[level] = t; 454be0e5c09SChris Mason path->slots[level + 1] += 1; 455eb60ceacSChris Mason } else { 456eb60ceacSChris Mason tree_block_release(root, t); 457be0e5c09SChris Mason } 458be0e5c09SChris Mason return 0; 459be0e5c09SChris Mason } 460be0e5c09SChris Mason 46197571fd0SChris Mason /* 46297571fd0SChris Mason * helper function to insert a new root level in the tree. 46397571fd0SChris Mason * A new node is allocated, and a single item is inserted to 46497571fd0SChris Mason * point to the existing root 465aa5d6bedSChris Mason * 466aa5d6bedSChris Mason * returns zero on success or < 0 on failure. 46797571fd0SChris Mason */ 4685de08d7dSChris Mason static int insert_new_root(struct ctree_root *root, 4695de08d7dSChris Mason struct ctree_path *path, int level) 47074123bd7SChris Mason { 47174123bd7SChris Mason struct tree_buffer *t; 4725c680ed6SChris Mason struct node *lower; 4735c680ed6SChris Mason struct node *c; 4745c680ed6SChris Mason struct key *lower_key; 4755c680ed6SChris Mason 4765c680ed6SChris Mason BUG_ON(path->nodes[level]); 4775c680ed6SChris Mason BUG_ON(path->nodes[level-1] != root->node); 4785c680ed6SChris Mason 47974123bd7SChris Mason t = alloc_free_block(root); 48074123bd7SChris Mason c = &t->node; 48174123bd7SChris Mason memset(c, 0, sizeof(c)); 4825c680ed6SChris Mason c->header.nritems = 1; 48374123bd7SChris Mason c->header.flags = node_level(level); 48474123bd7SChris Mason c->header.blocknr = t->blocknr; 485cfaa7295SChris Mason c->header.parentid = root->node->node.header.parentid; 48674123bd7SChris Mason lower = &path->nodes[level-1]->node; 48774123bd7SChris Mason if (is_leaf(lower->header.flags)) 48874123bd7SChris Mason lower_key = &((struct leaf *)lower)->items[0].key; 48974123bd7SChris Mason else 49074123bd7SChris Mason lower_key = lower->keys; 49174123bd7SChris Mason memcpy(c->keys, lower_key, sizeof(struct key)); 49274123bd7SChris Mason c->blockptrs[0] = path->nodes[level-1]->blocknr; 493cfaa7295SChris Mason /* the super has an extra ref to root->node */ 49474123bd7SChris Mason tree_block_release(root, root->node); 49574123bd7SChris Mason root->node = t; 49674123bd7SChris Mason t->count++; 49774123bd7SChris Mason write_tree_block(root, t); 49874123bd7SChris Mason path->nodes[level] = t; 49974123bd7SChris Mason path->slots[level] = 0; 50074123bd7SChris Mason return 0; 50174123bd7SChris Mason } 5025c680ed6SChris Mason 5035c680ed6SChris Mason /* 5045c680ed6SChris Mason * worker function to insert a single pointer in a node. 5055c680ed6SChris Mason * the node should have enough room for the pointer already 50697571fd0SChris Mason * 5075c680ed6SChris Mason * slot and level indicate where you want the key to go, and 5085c680ed6SChris Mason * blocknr is the block the key points to. 509aa5d6bedSChris Mason * 510aa5d6bedSChris Mason * returns zero on success and < 0 on any error 5115c680ed6SChris Mason */ 512aa5d6bedSChris Mason static int insert_ptr(struct ctree_root *root, 5135c680ed6SChris Mason struct ctree_path *path, struct key *key, 5145c680ed6SChris Mason u64 blocknr, int slot, int level) 5155c680ed6SChris Mason { 5165c680ed6SChris Mason struct node *lower; 5175c680ed6SChris Mason int nritems; 5185c680ed6SChris Mason 5195c680ed6SChris Mason BUG_ON(!path->nodes[level]); 52074123bd7SChris Mason lower = &path->nodes[level]->node; 52174123bd7SChris Mason nritems = lower->header.nritems; 52274123bd7SChris Mason if (slot > nritems) 52374123bd7SChris Mason BUG(); 52474123bd7SChris Mason if (nritems == NODEPTRS_PER_BLOCK) 52574123bd7SChris Mason BUG(); 52674123bd7SChris Mason if (slot != nritems) { 52774123bd7SChris Mason memmove(lower->keys + slot + 1, lower->keys + slot, 52874123bd7SChris Mason (nritems - slot) * sizeof(struct key)); 52974123bd7SChris Mason memmove(lower->blockptrs + slot + 1, lower->blockptrs + slot, 53074123bd7SChris Mason (nritems - slot) * sizeof(u64)); 53174123bd7SChris Mason } 53274123bd7SChris Mason memcpy(lower->keys + slot, key, sizeof(struct key)); 53374123bd7SChris Mason lower->blockptrs[slot] = blocknr; 53474123bd7SChris Mason lower->header.nritems++; 53574123bd7SChris Mason if (lower->keys[1].objectid == 0) 53674123bd7SChris Mason BUG(); 53774123bd7SChris Mason write_tree_block(root, path->nodes[level]); 53874123bd7SChris Mason return 0; 53974123bd7SChris Mason } 54074123bd7SChris Mason 54197571fd0SChris Mason /* 54297571fd0SChris Mason * split the node at the specified level in path in two. 54397571fd0SChris Mason * The path is corrected to point to the appropriate node after the split 54497571fd0SChris Mason * 54597571fd0SChris Mason * Before splitting this tries to make some room in the node by pushing 54697571fd0SChris Mason * left and right, if either one works, it returns right away. 547aa5d6bedSChris Mason * 548aa5d6bedSChris Mason * returns 0 on success and < 0 on failure 54997571fd0SChris Mason */ 550aa5d6bedSChris Mason static int split_node(struct ctree_root *root, struct ctree_path *path, 551aa5d6bedSChris Mason int level) 552be0e5c09SChris Mason { 5535c680ed6SChris Mason struct tree_buffer *t; 5545c680ed6SChris Mason struct node *c; 5555c680ed6SChris Mason struct tree_buffer *split_buffer; 5565c680ed6SChris Mason struct node *split; 557be0e5c09SChris Mason int mid; 5585c680ed6SChris Mason int ret; 559aa5d6bedSChris Mason int wret; 560be0e5c09SChris Mason 5615c680ed6SChris Mason ret = push_node_left(root, path, level); 5625c680ed6SChris Mason if (!ret) 5635c680ed6SChris Mason return 0; 564aa5d6bedSChris Mason if (ret < 0) 565aa5d6bedSChris Mason return ret; 5665c680ed6SChris Mason ret = push_node_right(root, path, level); 5675c680ed6SChris Mason if (!ret) 5685c680ed6SChris Mason return 0; 569aa5d6bedSChris Mason if (ret < 0) 570aa5d6bedSChris Mason return ret; 5715c680ed6SChris Mason t = path->nodes[level]; 572eb60ceacSChris Mason c = &t->node; 5735c680ed6SChris Mason if (t == root->node) { 5745c680ed6SChris Mason /* trying to split the root, lets make a new one */ 5755c680ed6SChris Mason ret = insert_new_root(root, path, level + 1); 5765c680ed6SChris Mason if (ret) 5775c680ed6SChris Mason return ret; 5785c680ed6SChris Mason } 5795c680ed6SChris Mason split_buffer = alloc_free_block(root); 5805c680ed6SChris Mason split = &split_buffer->node; 5815c680ed6SChris Mason split->header.flags = c->header.flags; 5825c680ed6SChris Mason split->header.blocknr = split_buffer->blocknr; 5835c680ed6SChris Mason split->header.parentid = root->node->node.header.parentid; 584be0e5c09SChris Mason mid = (c->header.nritems + 1) / 2; 5855c680ed6SChris Mason memcpy(split->keys, c->keys + mid, 586be0e5c09SChris Mason (c->header.nritems - mid) * sizeof(struct key)); 5875c680ed6SChris Mason memcpy(split->blockptrs, c->blockptrs + mid, 588be0e5c09SChris Mason (c->header.nritems - mid) * sizeof(u64)); 5895c680ed6SChris Mason split->header.nritems = c->header.nritems - mid; 590be0e5c09SChris Mason c->header.nritems = mid; 591aa5d6bedSChris Mason ret = 0; 592aa5d6bedSChris Mason 593aa5d6bedSChris Mason wret = write_tree_block(root, t); 594aa5d6bedSChris Mason if (wret) 595aa5d6bedSChris Mason ret = wret; 596aa5d6bedSChris Mason wret = write_tree_block(root, split_buffer); 597aa5d6bedSChris Mason if (wret) 598aa5d6bedSChris Mason ret = wret; 599aa5d6bedSChris Mason wret = insert_ptr(root, path, split->keys, split_buffer->blocknr, 6005c680ed6SChris Mason path->slots[level + 1] + 1, level + 1); 601aa5d6bedSChris Mason if (wret) 602aa5d6bedSChris Mason ret = wret; 603aa5d6bedSChris Mason 6045de08d7dSChris Mason if (path->slots[level] >= mid) { 6055c680ed6SChris Mason path->slots[level] -= mid; 6065c680ed6SChris Mason tree_block_release(root, t); 6075c680ed6SChris Mason path->nodes[level] = split_buffer; 6085c680ed6SChris Mason path->slots[level + 1] += 1; 609eb60ceacSChris Mason } else { 6105c680ed6SChris Mason tree_block_release(root, split_buffer); 611be0e5c09SChris Mason } 612aa5d6bedSChris Mason return ret; 613be0e5c09SChris Mason } 614be0e5c09SChris Mason 61574123bd7SChris Mason /* 61674123bd7SChris Mason * how many bytes are required to store the items in a leaf. start 61774123bd7SChris Mason * and nr indicate which items in the leaf to check. This totals up the 61874123bd7SChris Mason * space used both by the item structs and the item data 61974123bd7SChris Mason */ 620aa5d6bedSChris Mason static int leaf_space_used(struct leaf *l, int start, int nr) 621be0e5c09SChris Mason { 622be0e5c09SChris Mason int data_len; 623be0e5c09SChris Mason int end = start + nr - 1; 624be0e5c09SChris Mason 625be0e5c09SChris Mason if (!nr) 626be0e5c09SChris Mason return 0; 627be0e5c09SChris Mason data_len = l->items[start].offset + l->items[start].size; 628be0e5c09SChris Mason data_len = data_len - l->items[end].offset; 629be0e5c09SChris Mason data_len += sizeof(struct item) * nr; 630be0e5c09SChris Mason return data_len; 631be0e5c09SChris Mason } 632be0e5c09SChris Mason 63374123bd7SChris Mason /* 63400ec4c51SChris Mason * push some data in the path leaf to the right, trying to free up at 63500ec4c51SChris Mason * least data_size bytes. returns zero if the push worked, nonzero otherwise 636aa5d6bedSChris Mason * 637aa5d6bedSChris Mason * returns 1 if the push failed because the other node didn't have enough 638aa5d6bedSChris Mason * room, 0 if everything worked out and < 0 if there were major errors. 63900ec4c51SChris Mason */ 640aa5d6bedSChris Mason static int push_leaf_right(struct ctree_root *root, struct ctree_path *path, 64100ec4c51SChris Mason int data_size) 64200ec4c51SChris Mason { 64300ec4c51SChris Mason struct tree_buffer *left_buf = path->nodes[0]; 64400ec4c51SChris Mason struct leaf *left = &left_buf->leaf; 64500ec4c51SChris Mason struct leaf *right; 64600ec4c51SChris Mason struct tree_buffer *right_buf; 64700ec4c51SChris Mason struct tree_buffer *upper; 64800ec4c51SChris Mason int slot; 64900ec4c51SChris Mason int i; 65000ec4c51SChris Mason int free_space; 65100ec4c51SChris Mason int push_space = 0; 65200ec4c51SChris Mason int push_items = 0; 65300ec4c51SChris Mason struct item *item; 65400ec4c51SChris Mason 65500ec4c51SChris Mason slot = path->slots[1]; 65600ec4c51SChris Mason if (!path->nodes[1]) { 65700ec4c51SChris Mason return 1; 65800ec4c51SChris Mason } 65900ec4c51SChris Mason upper = path->nodes[1]; 66000ec4c51SChris Mason if (slot >= upper->node.header.nritems - 1) { 66100ec4c51SChris Mason return 1; 66200ec4c51SChris Mason } 66300ec4c51SChris Mason right_buf = read_tree_block(root, upper->node.blockptrs[slot + 1]); 66400ec4c51SChris Mason right = &right_buf->leaf; 66500ec4c51SChris Mason free_space = leaf_free_space(right); 66600ec4c51SChris Mason if (free_space < data_size + sizeof(struct item)) { 66700ec4c51SChris Mason tree_block_release(root, right_buf); 66800ec4c51SChris Mason return 1; 66900ec4c51SChris Mason } 67000ec4c51SChris Mason for (i = left->header.nritems - 1; i >= 0; i--) { 67100ec4c51SChris Mason item = left->items + i; 67200ec4c51SChris Mason if (path->slots[0] == i) 67300ec4c51SChris Mason push_space += data_size + sizeof(*item); 67400ec4c51SChris Mason if (item->size + sizeof(*item) + push_space > free_space) 67500ec4c51SChris Mason break; 67600ec4c51SChris Mason push_items++; 67700ec4c51SChris Mason push_space += item->size + sizeof(*item); 67800ec4c51SChris Mason } 67900ec4c51SChris Mason if (push_items == 0) { 68000ec4c51SChris Mason tree_block_release(root, right_buf); 68100ec4c51SChris Mason return 1; 68200ec4c51SChris Mason } 68300ec4c51SChris Mason /* push left to right */ 68400ec4c51SChris Mason push_space = left->items[left->header.nritems - push_items].offset + 68500ec4c51SChris Mason left->items[left->header.nritems - push_items].size; 68600ec4c51SChris Mason push_space -= leaf_data_end(left); 68700ec4c51SChris Mason /* make room in the right data area */ 68800ec4c51SChris Mason memmove(right->data + leaf_data_end(right) - push_space, 68900ec4c51SChris Mason right->data + leaf_data_end(right), 69000ec4c51SChris Mason LEAF_DATA_SIZE - leaf_data_end(right)); 69100ec4c51SChris Mason /* copy from the left data area */ 69200ec4c51SChris Mason memcpy(right->data + LEAF_DATA_SIZE - push_space, 69300ec4c51SChris Mason left->data + leaf_data_end(left), 69400ec4c51SChris Mason push_space); 69500ec4c51SChris Mason memmove(right->items + push_items, right->items, 69600ec4c51SChris Mason right->header.nritems * sizeof(struct item)); 69700ec4c51SChris Mason /* copy the items from left to right */ 69800ec4c51SChris Mason memcpy(right->items, left->items + left->header.nritems - push_items, 69900ec4c51SChris Mason push_items * sizeof(struct item)); 70000ec4c51SChris Mason 70100ec4c51SChris Mason /* update the item pointers */ 70200ec4c51SChris Mason right->header.nritems += push_items; 70300ec4c51SChris Mason push_space = LEAF_DATA_SIZE; 70400ec4c51SChris Mason for (i = 0; i < right->header.nritems; i++) { 70500ec4c51SChris Mason right->items[i].offset = push_space - right->items[i].size; 70600ec4c51SChris Mason push_space = right->items[i].offset; 70700ec4c51SChris Mason } 70800ec4c51SChris Mason left->header.nritems -= push_items; 70900ec4c51SChris Mason 71000ec4c51SChris Mason write_tree_block(root, left_buf); 71100ec4c51SChris Mason write_tree_block(root, right_buf); 71200ec4c51SChris Mason memcpy(upper->node.keys + slot + 1, 71300ec4c51SChris Mason &right->items[0].key, sizeof(struct key)); 71400ec4c51SChris Mason write_tree_block(root, upper); 71500ec4c51SChris Mason /* then fixup the leaf pointer in the path */ 71600ec4c51SChris Mason if (path->slots[0] >= left->header.nritems) { 71700ec4c51SChris Mason path->slots[0] -= left->header.nritems; 71800ec4c51SChris Mason tree_block_release(root, path->nodes[0]); 71900ec4c51SChris Mason path->nodes[0] = right_buf; 72000ec4c51SChris Mason path->slots[1] += 1; 72100ec4c51SChris Mason } else { 72200ec4c51SChris Mason tree_block_release(root, right_buf); 72300ec4c51SChris Mason } 72400ec4c51SChris Mason return 0; 72500ec4c51SChris Mason } 72600ec4c51SChris Mason /* 72774123bd7SChris Mason * push some data in the path leaf to the left, trying to free up at 72874123bd7SChris Mason * least data_size bytes. returns zero if the push worked, nonzero otherwise 72974123bd7SChris Mason */ 730aa5d6bedSChris Mason static int push_leaf_left(struct ctree_root *root, struct ctree_path *path, 731be0e5c09SChris Mason int data_size) 732be0e5c09SChris Mason { 733eb60ceacSChris Mason struct tree_buffer *right_buf = path->nodes[0]; 734eb60ceacSChris Mason struct leaf *right = &right_buf->leaf; 735eb60ceacSChris Mason struct tree_buffer *t; 736be0e5c09SChris Mason struct leaf *left; 737be0e5c09SChris Mason int slot; 738be0e5c09SChris Mason int i; 739be0e5c09SChris Mason int free_space; 740be0e5c09SChris Mason int push_space = 0; 741be0e5c09SChris Mason int push_items = 0; 742be0e5c09SChris Mason struct item *item; 743be0e5c09SChris Mason int old_left_nritems; 744aa5d6bedSChris Mason int ret = 0; 745aa5d6bedSChris Mason int wret; 746be0e5c09SChris Mason 747be0e5c09SChris Mason slot = path->slots[1]; 748be0e5c09SChris Mason if (slot == 0) { 749be0e5c09SChris Mason return 1; 750be0e5c09SChris Mason } 751be0e5c09SChris Mason if (!path->nodes[1]) { 752be0e5c09SChris Mason return 1; 753be0e5c09SChris Mason } 754eb60ceacSChris Mason t = read_tree_block(root, path->nodes[1]->node.blockptrs[slot - 1]); 755eb60ceacSChris Mason left = &t->leaf; 756be0e5c09SChris Mason free_space = leaf_free_space(left); 757be0e5c09SChris Mason if (free_space < data_size + sizeof(struct item)) { 758eb60ceacSChris Mason tree_block_release(root, t); 759be0e5c09SChris Mason return 1; 760be0e5c09SChris Mason } 761be0e5c09SChris Mason for (i = 0; i < right->header.nritems; i++) { 762be0e5c09SChris Mason item = right->items + i; 763be0e5c09SChris Mason if (path->slots[0] == i) 764be0e5c09SChris Mason push_space += data_size + sizeof(*item); 765be0e5c09SChris Mason if (item->size + sizeof(*item) + push_space > free_space) 766be0e5c09SChris Mason break; 767be0e5c09SChris Mason push_items++; 768be0e5c09SChris Mason push_space += item->size + sizeof(*item); 769be0e5c09SChris Mason } 770be0e5c09SChris Mason if (push_items == 0) { 771eb60ceacSChris Mason tree_block_release(root, t); 772be0e5c09SChris Mason return 1; 773be0e5c09SChris Mason } 774be0e5c09SChris Mason /* push data from right to left */ 775be0e5c09SChris Mason memcpy(left->items + left->header.nritems, 776be0e5c09SChris Mason right->items, push_items * sizeof(struct item)); 777be0e5c09SChris Mason push_space = LEAF_DATA_SIZE - right->items[push_items -1].offset; 778be0e5c09SChris Mason memcpy(left->data + leaf_data_end(left) - push_space, 779be0e5c09SChris Mason right->data + right->items[push_items - 1].offset, 780be0e5c09SChris Mason push_space); 781be0e5c09SChris Mason old_left_nritems = left->header.nritems; 782eb60ceacSChris Mason BUG_ON(old_left_nritems < 0); 783eb60ceacSChris Mason 784be0e5c09SChris Mason for(i = old_left_nritems; i < old_left_nritems + push_items; i++) { 785be0e5c09SChris Mason left->items[i].offset -= LEAF_DATA_SIZE - 786be0e5c09SChris Mason left->items[old_left_nritems -1].offset; 787be0e5c09SChris Mason } 788be0e5c09SChris Mason left->header.nritems += push_items; 789be0e5c09SChris Mason 790be0e5c09SChris Mason /* fixup right node */ 791be0e5c09SChris Mason push_space = right->items[push_items-1].offset - leaf_data_end(right); 792be0e5c09SChris Mason memmove(right->data + LEAF_DATA_SIZE - push_space, right->data + 793be0e5c09SChris Mason leaf_data_end(right), push_space); 794be0e5c09SChris Mason memmove(right->items, right->items + push_items, 795be0e5c09SChris Mason (right->header.nritems - push_items) * sizeof(struct item)); 796be0e5c09SChris Mason right->header.nritems -= push_items; 797be0e5c09SChris Mason push_space = LEAF_DATA_SIZE; 798eb60ceacSChris Mason 799be0e5c09SChris Mason for (i = 0; i < right->header.nritems; i++) { 800be0e5c09SChris Mason right->items[i].offset = push_space - right->items[i].size; 801be0e5c09SChris Mason push_space = right->items[i].offset; 802be0e5c09SChris Mason } 803eb60ceacSChris Mason 804aa5d6bedSChris Mason wret = write_tree_block(root, t); 805aa5d6bedSChris Mason if (wret) 806aa5d6bedSChris Mason ret = wret; 807aa5d6bedSChris Mason wret = write_tree_block(root, right_buf); 808aa5d6bedSChris Mason if (wret) 809aa5d6bedSChris Mason ret = wret; 810eb60ceacSChris Mason 811aa5d6bedSChris Mason wret = fixup_low_keys(root, path, &right->items[0].key, 1); 812aa5d6bedSChris Mason if (wret) 813aa5d6bedSChris Mason ret = wret; 814be0e5c09SChris Mason 815be0e5c09SChris Mason /* then fixup the leaf pointer in the path */ 816be0e5c09SChris Mason if (path->slots[0] < push_items) { 817be0e5c09SChris Mason path->slots[0] += old_left_nritems; 818eb60ceacSChris Mason tree_block_release(root, path->nodes[0]); 819eb60ceacSChris Mason path->nodes[0] = t; 820be0e5c09SChris Mason path->slots[1] -= 1; 821be0e5c09SChris Mason } else { 822eb60ceacSChris Mason tree_block_release(root, t); 823be0e5c09SChris Mason path->slots[0] -= push_items; 824be0e5c09SChris Mason } 825eb60ceacSChris Mason BUG_ON(path->slots[0] < 0); 826aa5d6bedSChris Mason return ret; 827be0e5c09SChris Mason } 828be0e5c09SChris Mason 82974123bd7SChris Mason /* 83074123bd7SChris Mason * split the path's leaf in two, making sure there is at least data_size 83174123bd7SChris Mason * available for the resulting leaf level of the path. 832aa5d6bedSChris Mason * 833aa5d6bedSChris Mason * returns 0 if all went well and < 0 on failure. 83474123bd7SChris Mason */ 835aa5d6bedSChris Mason static int split_leaf(struct ctree_root *root, struct ctree_path *path, 836aa5d6bedSChris Mason int data_size) 837be0e5c09SChris Mason { 838aa5d6bedSChris Mason struct tree_buffer *l_buf; 839aa5d6bedSChris Mason struct leaf *l; 840eb60ceacSChris Mason int nritems; 841eb60ceacSChris Mason int mid; 842eb60ceacSChris Mason int slot; 843be0e5c09SChris Mason struct leaf *right; 844eb60ceacSChris Mason struct tree_buffer *right_buffer; 845be0e5c09SChris Mason int space_needed = data_size + sizeof(struct item); 846be0e5c09SChris Mason int data_copy_size; 847be0e5c09SChris Mason int rt_data_off; 848be0e5c09SChris Mason int i; 849be0e5c09SChris Mason int ret; 850aa5d6bedSChris Mason int wret; 851be0e5c09SChris Mason 852aa5d6bedSChris Mason wret = push_leaf_left(root, path, data_size); 853aa5d6bedSChris Mason if (wret < 0) 854aa5d6bedSChris Mason return wret; 855aa5d6bedSChris Mason if (wret) { 856aa5d6bedSChris Mason wret = push_leaf_right(root, path, data_size); 857aa5d6bedSChris Mason if (wret < 0) 858aa5d6bedSChris Mason return wret; 859aa5d6bedSChris Mason } 860eb60ceacSChris Mason l_buf = path->nodes[0]; 861eb60ceacSChris Mason l = &l_buf->leaf; 862aa5d6bedSChris Mason 863aa5d6bedSChris Mason /* did the pushes work? */ 864eb60ceacSChris Mason if (leaf_free_space(l) >= sizeof(struct item) + data_size) 865be0e5c09SChris Mason return 0; 866aa5d6bedSChris Mason 8675c680ed6SChris Mason if (!path->nodes[1]) { 8685c680ed6SChris Mason ret = insert_new_root(root, path, 1); 8695c680ed6SChris Mason if (ret) 8705c680ed6SChris Mason return ret; 8715c680ed6SChris Mason } 872eb60ceacSChris Mason slot = path->slots[0]; 873eb60ceacSChris Mason nritems = l->header.nritems; 874eb60ceacSChris Mason mid = (nritems + 1)/ 2; 875eb60ceacSChris Mason 876eb60ceacSChris Mason right_buffer = alloc_free_block(root); 877eb60ceacSChris Mason BUG_ON(!right_buffer); 878eb60ceacSChris Mason BUG_ON(mid == nritems); 879eb60ceacSChris Mason right = &right_buffer->leaf; 880be0e5c09SChris Mason memset(right, 0, sizeof(*right)); 881be0e5c09SChris Mason if (mid <= slot) { 88297571fd0SChris Mason /* FIXME, just alloc a new leaf here */ 883be0e5c09SChris Mason if (leaf_space_used(l, mid, nritems - mid) + space_needed > 884be0e5c09SChris Mason LEAF_DATA_SIZE) 885be0e5c09SChris Mason BUG(); 886be0e5c09SChris Mason } else { 88797571fd0SChris Mason /* FIXME, just alloc a new leaf here */ 888be0e5c09SChris Mason if (leaf_space_used(l, 0, mid + 1) + space_needed > 889be0e5c09SChris Mason LEAF_DATA_SIZE) 890be0e5c09SChris Mason BUG(); 891be0e5c09SChris Mason } 892be0e5c09SChris Mason right->header.nritems = nritems - mid; 893eb60ceacSChris Mason right->header.blocknr = right_buffer->blocknr; 894eb60ceacSChris Mason right->header.flags = node_level(0); 895cfaa7295SChris Mason right->header.parentid = root->node->node.header.parentid; 896be0e5c09SChris Mason data_copy_size = l->items[mid].offset + l->items[mid].size - 897be0e5c09SChris Mason leaf_data_end(l); 898be0e5c09SChris Mason memcpy(right->items, l->items + mid, 899be0e5c09SChris Mason (nritems - mid) * sizeof(struct item)); 900be0e5c09SChris Mason memcpy(right->data + LEAF_DATA_SIZE - data_copy_size, 901be0e5c09SChris Mason l->data + leaf_data_end(l), data_copy_size); 902be0e5c09SChris Mason rt_data_off = LEAF_DATA_SIZE - 903be0e5c09SChris Mason (l->items[mid].offset + l->items[mid].size); 90474123bd7SChris Mason 90574123bd7SChris Mason for (i = 0; i < right->header.nritems; i++) 906be0e5c09SChris Mason right->items[i].offset += rt_data_off; 90774123bd7SChris Mason 908be0e5c09SChris Mason l->header.nritems = mid; 909aa5d6bedSChris Mason ret = 0; 910aa5d6bedSChris Mason wret = insert_ptr(root, path, &right->items[0].key, 9115c680ed6SChris Mason right_buffer->blocknr, path->slots[1] + 1, 1); 912aa5d6bedSChris Mason if (wret) 913aa5d6bedSChris Mason ret = wret; 914aa5d6bedSChris Mason wret = write_tree_block(root, right_buffer); 915aa5d6bedSChris Mason if (wret) 916aa5d6bedSChris Mason ret = wret; 917aa5d6bedSChris Mason wret = write_tree_block(root, l_buf); 918aa5d6bedSChris Mason if (wret) 919aa5d6bedSChris Mason ret = wret; 920eb60ceacSChris Mason 921eb60ceacSChris Mason BUG_ON(path->slots[0] != slot); 922be0e5c09SChris Mason if (mid <= slot) { 923eb60ceacSChris Mason tree_block_release(root, path->nodes[0]); 924eb60ceacSChris Mason path->nodes[0] = right_buffer; 925be0e5c09SChris Mason path->slots[0] -= mid; 926be0e5c09SChris Mason path->slots[1] += 1; 927eb60ceacSChris Mason } else 928eb60ceacSChris Mason tree_block_release(root, right_buffer); 929eb60ceacSChris Mason BUG_ON(path->slots[0] < 0); 930be0e5c09SChris Mason return ret; 931be0e5c09SChris Mason } 932be0e5c09SChris Mason 93374123bd7SChris Mason /* 93474123bd7SChris Mason * Given a key and some data, insert an item into the tree. 93574123bd7SChris Mason * This does all the path init required, making room in the tree if needed. 93674123bd7SChris Mason */ 937be0e5c09SChris Mason int insert_item(struct ctree_root *root, struct key *key, 938be0e5c09SChris Mason void *data, int data_size) 939be0e5c09SChris Mason { 940aa5d6bedSChris Mason int ret = 0; 941aa5d6bedSChris Mason int wret; 942be0e5c09SChris Mason int slot; 943eb60ceacSChris Mason int slot_orig; 944be0e5c09SChris Mason struct leaf *leaf; 945eb60ceacSChris Mason struct tree_buffer *leaf_buf; 946be0e5c09SChris Mason unsigned int nritems; 947be0e5c09SChris Mason unsigned int data_end; 948be0e5c09SChris Mason struct ctree_path path; 949be0e5c09SChris Mason 95074123bd7SChris Mason /* create a root if there isn't one */ 9515c680ed6SChris Mason if (!root->node) 952cfaa7295SChris Mason BUG(); 953be0e5c09SChris Mason init_path(&path); 9545c680ed6SChris Mason ret = search_slot(root, key, &path, data_size); 955eb60ceacSChris Mason if (ret == 0) { 956eb60ceacSChris Mason release_path(root, &path); 957be0e5c09SChris Mason return -EEXIST; 958eb60ceacSChris Mason } 959aa5d6bedSChris Mason if (ret < 0) { 960aa5d6bedSChris Mason release_path(root, &path); 961aa5d6bedSChris Mason return ret; 962aa5d6bedSChris Mason } 963be0e5c09SChris Mason 964eb60ceacSChris Mason slot_orig = path.slots[0]; 965eb60ceacSChris Mason leaf_buf = path.nodes[0]; 966eb60ceacSChris Mason leaf = &leaf_buf->leaf; 96774123bd7SChris Mason 968be0e5c09SChris Mason nritems = leaf->header.nritems; 969be0e5c09SChris Mason data_end = leaf_data_end(leaf); 970eb60ceacSChris Mason 971be0e5c09SChris Mason if (leaf_free_space(leaf) < sizeof(struct item) + data_size) 972be0e5c09SChris Mason BUG(); 973be0e5c09SChris Mason 974be0e5c09SChris Mason slot = path.slots[0]; 975eb60ceacSChris Mason BUG_ON(slot < 0); 976be0e5c09SChris Mason if (slot != nritems) { 977be0e5c09SChris Mason int i; 978be0e5c09SChris Mason unsigned int old_data = leaf->items[slot].offset + 979be0e5c09SChris Mason leaf->items[slot].size; 980be0e5c09SChris Mason 981be0e5c09SChris Mason /* 982be0e5c09SChris Mason * item0..itemN ... dataN.offset..dataN.size .. data0.size 983be0e5c09SChris Mason */ 984be0e5c09SChris Mason /* first correct the data pointers */ 985be0e5c09SChris Mason for (i = slot; i < nritems; i++) 986be0e5c09SChris Mason leaf->items[i].offset -= data_size; 987be0e5c09SChris Mason 988be0e5c09SChris Mason /* shift the items */ 989be0e5c09SChris Mason memmove(leaf->items + slot + 1, leaf->items + slot, 990be0e5c09SChris Mason (nritems - slot) * sizeof(struct item)); 991be0e5c09SChris Mason 992be0e5c09SChris Mason /* shift the data */ 993be0e5c09SChris Mason memmove(leaf->data + data_end - data_size, leaf->data + 994be0e5c09SChris Mason data_end, old_data - data_end); 995be0e5c09SChris Mason data_end = old_data; 996be0e5c09SChris Mason } 99774123bd7SChris Mason /* copy the new data in */ 998be0e5c09SChris Mason memcpy(&leaf->items[slot].key, key, sizeof(struct key)); 999be0e5c09SChris Mason leaf->items[slot].offset = data_end - data_size; 1000be0e5c09SChris Mason leaf->items[slot].size = data_size; 1001be0e5c09SChris Mason memcpy(leaf->data + data_end - data_size, data, data_size); 1002be0e5c09SChris Mason leaf->header.nritems += 1; 1003aa5d6bedSChris Mason 1004aa5d6bedSChris Mason ret = 0; 10058e19f2cdSChris Mason if (slot == 0) 1006aa5d6bedSChris Mason ret = fixup_low_keys(root, &path, key, 1); 1007aa5d6bedSChris Mason 1008aa5d6bedSChris Mason wret = write_tree_block(root, leaf_buf); 1009aa5d6bedSChris Mason if (wret) 1010aa5d6bedSChris Mason ret = wret; 1011aa5d6bedSChris Mason 1012be0e5c09SChris Mason if (leaf_free_space(leaf) < 0) 1013be0e5c09SChris Mason BUG(); 1014eb60ceacSChris Mason release_path(root, &path); 1015aa5d6bedSChris Mason return ret; 1016be0e5c09SChris Mason } 1017be0e5c09SChris Mason 101874123bd7SChris Mason /* 10195de08d7dSChris Mason * delete the pointer from a given node. 102074123bd7SChris Mason * 102174123bd7SChris Mason * If the delete empties a node, the node is removed from the tree, 102274123bd7SChris Mason * continuing all the way the root if required. The root is converted into 102374123bd7SChris Mason * a leaf if all the nodes are emptied. 102474123bd7SChris Mason */ 1025aa5d6bedSChris Mason static int del_ptr(struct ctree_root *root, struct ctree_path *path, int level) 1026be0e5c09SChris Mason { 1027be0e5c09SChris Mason int slot; 1028eb60ceacSChris Mason struct tree_buffer *t; 1029be0e5c09SChris Mason struct node *node; 1030be0e5c09SChris Mason int nritems; 10319a8dd150SChris Mason u64 blocknr; 1032aa5d6bedSChris Mason int wret; 1033aa5d6bedSChris Mason int ret = 0; 1034be0e5c09SChris Mason 1035be0e5c09SChris Mason while(1) { 1036eb60ceacSChris Mason t = path->nodes[level]; 1037eb60ceacSChris Mason if (!t) 1038be0e5c09SChris Mason break; 1039eb60ceacSChris Mason node = &t->node; 1040be0e5c09SChris Mason slot = path->slots[level]; 1041be0e5c09SChris Mason nritems = node->header.nritems; 1042be0e5c09SChris Mason 1043be0e5c09SChris Mason if (slot != nritems -1) { 1044be0e5c09SChris Mason memmove(node->keys + slot, node->keys + slot + 1, 1045be0e5c09SChris Mason sizeof(struct key) * (nritems - slot - 1)); 1046be0e5c09SChris Mason memmove(node->blockptrs + slot, 1047be0e5c09SChris Mason node->blockptrs + slot + 1, 1048be0e5c09SChris Mason sizeof(u64) * (nritems - slot - 1)); 1049be0e5c09SChris Mason } 1050be0e5c09SChris Mason node->header.nritems--; 10519a8dd150SChris Mason blocknr = t->blocknr; 10528e19f2cdSChris Mason write_tree_block(root, t); 1053be0e5c09SChris Mason if (node->header.nritems != 0) { 10548e19f2cdSChris Mason int tslot; 1055aa5d6bedSChris Mason if (slot == 0) { 1056aa5d6bedSChris Mason wret = fixup_low_keys(root, path, 1057aa5d6bedSChris Mason node->keys, 1058eb60ceacSChris Mason level + 1); 1059aa5d6bedSChris Mason if (wret) 1060aa5d6bedSChris Mason ret = wret; 1061aa5d6bedSChris Mason } 10628e19f2cdSChris Mason tslot = path->slots[level + 1]; 10638e19f2cdSChris Mason t->count++; 1064aa5d6bedSChris Mason wret = push_node_left(root, path, level); 1065aa5d6bedSChris Mason if (wret < 0) { 1066aa5d6bedSChris Mason ret = wret; 1067aa5d6bedSChris Mason break; 1068aa5d6bedSChris Mason } 1069aa5d6bedSChris Mason if (node->header.nritems != 0) { 1070aa5d6bedSChris Mason wret = push_node_right(root, path, level); 1071aa5d6bedSChris Mason if (wret < 0) { 1072aa5d6bedSChris Mason ret = wret; 1073aa5d6bedSChris Mason break; 1074aa5d6bedSChris Mason } 1075aa5d6bedSChris Mason } 10768e19f2cdSChris Mason path->slots[level + 1] = tslot; 10778e19f2cdSChris Mason if (node->header.nritems != 0) { 10788e19f2cdSChris Mason tree_block_release(root, t); 1079be0e5c09SChris Mason break; 1080eb60ceacSChris Mason } 10818e19f2cdSChris Mason tree_block_release(root, t); 10828e19f2cdSChris Mason } 1083eb60ceacSChris Mason if (t == root->node) { 1084eb60ceacSChris Mason /* just turn the root into a leaf and break */ 1085eb60ceacSChris Mason root->node->node.header.flags = node_level(0); 1086eb60ceacSChris Mason write_tree_block(root, t); 1087be0e5c09SChris Mason break; 1088be0e5c09SChris Mason } 1089be0e5c09SChris Mason level++; 10909a8dd150SChris Mason free_extent(root, blocknr, 1); 1091be0e5c09SChris Mason if (!path->nodes[level]) 1092be0e5c09SChris Mason BUG(); 1093be0e5c09SChris Mason } 1094aa5d6bedSChris Mason return ret; 1095be0e5c09SChris Mason } 1096be0e5c09SChris Mason 109774123bd7SChris Mason /* 109874123bd7SChris Mason * delete the item at the leaf level in path. If that empties 109974123bd7SChris Mason * the leaf, remove it from the tree 110074123bd7SChris Mason */ 11014920c9acSChris Mason int del_item(struct ctree_root *root, struct ctree_path *path) 1102be0e5c09SChris Mason { 1103be0e5c09SChris Mason int slot; 1104be0e5c09SChris Mason struct leaf *leaf; 1105eb60ceacSChris Mason struct tree_buffer *leaf_buf; 1106be0e5c09SChris Mason int doff; 1107be0e5c09SChris Mason int dsize; 1108aa5d6bedSChris Mason int ret = 0; 1109aa5d6bedSChris Mason int wret; 1110be0e5c09SChris Mason 1111eb60ceacSChris Mason leaf_buf = path->nodes[0]; 1112eb60ceacSChris Mason leaf = &leaf_buf->leaf; 11134920c9acSChris Mason slot = path->slots[0]; 1114be0e5c09SChris Mason doff = leaf->items[slot].offset; 1115be0e5c09SChris Mason dsize = leaf->items[slot].size; 1116be0e5c09SChris Mason 1117be0e5c09SChris Mason if (slot != leaf->header.nritems - 1) { 1118be0e5c09SChris Mason int i; 1119be0e5c09SChris Mason int data_end = leaf_data_end(leaf); 1120be0e5c09SChris Mason memmove(leaf->data + data_end + dsize, 1121be0e5c09SChris Mason leaf->data + data_end, 1122be0e5c09SChris Mason doff - data_end); 1123be0e5c09SChris Mason for (i = slot + 1; i < leaf->header.nritems; i++) 1124be0e5c09SChris Mason leaf->items[i].offset += dsize; 1125be0e5c09SChris Mason memmove(leaf->items + slot, leaf->items + slot + 1, 1126be0e5c09SChris Mason sizeof(struct item) * 1127be0e5c09SChris Mason (leaf->header.nritems - slot - 1)); 1128be0e5c09SChris Mason } 1129be0e5c09SChris Mason leaf->header.nritems -= 1; 113074123bd7SChris Mason /* delete the leaf if we've emptied it */ 1131be0e5c09SChris Mason if (leaf->header.nritems == 0) { 1132eb60ceacSChris Mason if (leaf_buf == root->node) { 1133eb60ceacSChris Mason leaf->header.flags = node_level(0); 1134eb60ceacSChris Mason write_tree_block(root, leaf_buf); 11359a8dd150SChris Mason } else { 1136aa5d6bedSChris Mason wret = del_ptr(root, path, 1); 1137aa5d6bedSChris Mason if (wret) 1138aa5d6bedSChris Mason ret = wret; 11399a8dd150SChris Mason free_extent(root, leaf_buf->blocknr, 1); 11409a8dd150SChris Mason } 1141be0e5c09SChris Mason } else { 11425de08d7dSChris Mason int used = leaf_space_used(leaf, 0, leaf->header.nritems); 1143aa5d6bedSChris Mason if (slot == 0) { 1144aa5d6bedSChris Mason wret = fixup_low_keys(root, path, 1145aa5d6bedSChris Mason &leaf->items[0].key, 1); 1146aa5d6bedSChris Mason if (wret) 1147aa5d6bedSChris Mason ret = wret; 1148aa5d6bedSChris Mason } 1149aa5d6bedSChris Mason wret = write_tree_block(root, leaf_buf); 1150aa5d6bedSChris Mason if (wret) 1151aa5d6bedSChris Mason ret = wret; 1152aa5d6bedSChris Mason 115374123bd7SChris Mason /* delete the leaf if it is mostly empty */ 11545de08d7dSChris Mason if (used < LEAF_DATA_SIZE / 3) { 1155be0e5c09SChris Mason /* push_leaf_left fixes the path. 1156be0e5c09SChris Mason * make sure the path still points to our leaf 1157be0e5c09SChris Mason * for possible call to del_ptr below 1158be0e5c09SChris Mason */ 11594920c9acSChris Mason slot = path->slots[1]; 1160eb60ceacSChris Mason leaf_buf->count++; 1161aa5d6bedSChris Mason wret = push_leaf_left(root, path, 1); 1162aa5d6bedSChris Mason if (wret < 0) 1163aa5d6bedSChris Mason ret = wret; 1164aa5d6bedSChris Mason if (leaf->header.nritems) { 1165aa5d6bedSChris Mason wret = push_leaf_right(root, path, 1); 1166aa5d6bedSChris Mason if (wret < 0) 1167aa5d6bedSChris Mason ret = wret; 1168aa5d6bedSChris Mason } 1169be0e5c09SChris Mason if (leaf->header.nritems == 0) { 11705de08d7dSChris Mason u64 blocknr = leaf_buf->blocknr; 11714920c9acSChris Mason path->slots[1] = slot; 1172aa5d6bedSChris Mason wret = del_ptr(root, path, 1); 1173aa5d6bedSChris Mason if (wret) 1174aa5d6bedSChris Mason ret = wret; 11755de08d7dSChris Mason tree_block_release(root, leaf_buf); 11765de08d7dSChris Mason free_extent(root, blocknr, 1); 11775de08d7dSChris Mason } else { 1178eb60ceacSChris Mason tree_block_release(root, leaf_buf); 1179be0e5c09SChris Mason } 1180be0e5c09SChris Mason } 11819a8dd150SChris Mason } 1182aa5d6bedSChris Mason return ret; 11839a8dd150SChris Mason } 11849a8dd150SChris Mason 118597571fd0SChris Mason /* 118697571fd0SChris Mason * walk up the tree as far as required to find the next leaf. 118797571fd0SChris Mason * returns 0 if it found something or -1 if there are no greater leaves. 118897571fd0SChris Mason */ 1189d97e63b6SChris Mason int next_leaf(struct ctree_root *root, struct ctree_path *path) 1190d97e63b6SChris Mason { 1191d97e63b6SChris Mason int slot; 1192d97e63b6SChris Mason int level = 1; 1193d97e63b6SChris Mason u64 blocknr; 1194d97e63b6SChris Mason struct tree_buffer *c; 1195cfaa7295SChris Mason struct tree_buffer *next = NULL; 1196d97e63b6SChris Mason 1197d97e63b6SChris Mason while(level < MAX_LEVEL) { 1198d97e63b6SChris Mason if (!path->nodes[level]) 1199d97e63b6SChris Mason return -1; 1200d97e63b6SChris Mason slot = path->slots[level] + 1; 1201d97e63b6SChris Mason c = path->nodes[level]; 1202d97e63b6SChris Mason if (slot >= c->node.header.nritems) { 1203d97e63b6SChris Mason level++; 1204d97e63b6SChris Mason continue; 1205d97e63b6SChris Mason } 1206d97e63b6SChris Mason blocknr = c->node.blockptrs[slot]; 1207cfaa7295SChris Mason if (next) 1208cfaa7295SChris Mason tree_block_release(root, next); 1209d97e63b6SChris Mason next = read_tree_block(root, blocknr); 1210d97e63b6SChris Mason break; 1211d97e63b6SChris Mason } 1212d97e63b6SChris Mason path->slots[level] = slot; 1213d97e63b6SChris Mason while(1) { 1214d97e63b6SChris Mason level--; 1215d97e63b6SChris Mason c = path->nodes[level]; 1216d97e63b6SChris Mason tree_block_release(root, c); 1217d97e63b6SChris Mason path->nodes[level] = next; 1218d97e63b6SChris Mason path->slots[level] = 0; 1219d97e63b6SChris Mason if (!level) 1220d97e63b6SChris Mason break; 1221d97e63b6SChris Mason next = read_tree_block(root, next->node.blockptrs[0]); 1222d97e63b6SChris Mason } 1223d97e63b6SChris Mason return 0; 1224d97e63b6SChris Mason } 1225d97e63b6SChris Mason 1226