| /* |
| * Copyright (C) 2011 Red Hat, Inc. |
| * |
| * This file is released under the GPL. |
| */ |
| |
| #include "dm-btree-internal.h" |
| #include "dm-space-map.h" |
| #include "dm-transaction-manager.h" |
| |
| #include <linux/export.h> |
| #include <linux/device-mapper.h> |
| |
| #define DM_MSG_PREFIX "btree" |
| |
| /*---------------------------------------------------------------- |
| * Array manipulation |
| *--------------------------------------------------------------*/ |
| static void memcpy_disk(void *dest, const void *src, size_t len) |
| __dm_written_to_disk(src) |
| { |
| memcpy(dest, src, len); |
| __dm_unbless_for_disk(src); |
| } |
| |
| static void array_insert(void *base, size_t elt_size, unsigned nr_elts, |
| unsigned index, void *elt) |
| __dm_written_to_disk(elt) |
| { |
| if (index < nr_elts) |
| memmove(base + (elt_size * (index + 1)), |
| base + (elt_size * index), |
| (nr_elts - index) * elt_size); |
| |
| memcpy_disk(base + (elt_size * index), elt, elt_size); |
| } |
| |
| /*----------------------------------------------------------------*/ |
| |
| /* makes the assumption that no two keys are the same. */ |
| static int bsearch(struct btree_node *n, uint64_t key, int want_hi) |
| { |
| int lo = -1, hi = le32_to_cpu(n->header.nr_entries); |
| |
| while (hi - lo > 1) { |
| int mid = lo + ((hi - lo) / 2); |
| uint64_t mid_key = le64_to_cpu(n->keys[mid]); |
| |
| if (mid_key == key) |
| return mid; |
| |
| if (mid_key < key) |
| lo = mid; |
| else |
| hi = mid; |
| } |
| |
| return want_hi ? hi : lo; |
| } |
| |
| int lower_bound(struct btree_node *n, uint64_t key) |
| { |
| return bsearch(n, key, 0); |
| } |
| |
| static int upper_bound(struct btree_node *n, uint64_t key) |
| { |
| return bsearch(n, key, 1); |
| } |
| |
| void inc_children(struct dm_transaction_manager *tm, struct btree_node *n, |
| struct dm_btree_value_type *vt) |
| { |
| unsigned i; |
| uint32_t nr_entries = le32_to_cpu(n->header.nr_entries); |
| |
| if (le32_to_cpu(n->header.flags) & INTERNAL_NODE) |
| for (i = 0; i < nr_entries; i++) |
| dm_tm_inc(tm, value64(n, i)); |
| else if (vt->inc) |
| for (i = 0; i < nr_entries; i++) |
| vt->inc(vt->context, value_ptr(n, i)); |
| } |
| |
| static int insert_at(size_t value_size, struct btree_node *node, unsigned index, |
| uint64_t key, void *value) |
| __dm_written_to_disk(value) |
| { |
| uint32_t nr_entries = le32_to_cpu(node->header.nr_entries); |
| uint32_t max_entries = le32_to_cpu(node->header.max_entries); |
| __le64 key_le = cpu_to_le64(key); |
| |
| if (index > nr_entries || |
| index >= max_entries || |
| nr_entries >= max_entries) { |
| DMERR("too many entries in btree node for insert"); |
| __dm_unbless_for_disk(value); |
| return -ENOMEM; |
| } |
| |
| __dm_bless_for_disk(&key_le); |
| |
| array_insert(node->keys, sizeof(*node->keys), nr_entries, index, &key_le); |
| array_insert(value_base(node), value_size, nr_entries, index, value); |
| node->header.nr_entries = cpu_to_le32(nr_entries + 1); |
| |
| return 0; |
| } |
| |
| /*----------------------------------------------------------------*/ |
| |
| /* |
| * We want 3n entries (for some n). This works more nicely for repeated |
| * insert remove loops than (2n + 1). |
| */ |
| static uint32_t calc_max_entries(size_t value_size, size_t block_size) |
| { |
| uint32_t total, n; |
| size_t elt_size = sizeof(uint64_t) + value_size; /* key + value */ |
| |
| block_size -= sizeof(struct node_header); |
| total = block_size / elt_size; |
| n = total / 3; /* rounds down */ |
| |
| return 3 * n; |
| } |
| |
| int dm_btree_empty(struct dm_btree_info *info, dm_block_t *root) |
| { |
| int r; |
| struct dm_block *b; |
| struct btree_node *n; |
| size_t block_size; |
| uint32_t max_entries; |
| |
| r = new_block(info, &b); |
| if (r < 0) |
| return r; |
| |
| block_size = dm_bm_block_size(dm_tm_get_bm(info->tm)); |
| max_entries = calc_max_entries(info->value_type.size, block_size); |
| |
| n = dm_block_data(b); |
| memset(n, 0, block_size); |
| n->header.flags = cpu_to_le32(LEAF_NODE); |
| n->header.nr_entries = cpu_to_le32(0); |
| n->header.max_entries = cpu_to_le32(max_entries); |
| n->header.value_size = cpu_to_le32(info->value_type.size); |
| |
| *root = dm_block_location(b); |
| unlock_block(info, b); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_empty); |
| |
| /*----------------------------------------------------------------*/ |
| |
| /* |
| * Deletion uses a recursive algorithm, since we have limited stack space |
| * we explicitly manage our own stack on the heap. |
| */ |
| #define MAX_SPINE_DEPTH 64 |
| struct frame { |
| struct dm_block *b; |
| struct btree_node *n; |
| unsigned level; |
| unsigned nr_children; |
| unsigned current_child; |
| }; |
| |
| struct del_stack { |
| struct dm_btree_info *info; |
| struct dm_transaction_manager *tm; |
| int top; |
| struct frame spine[MAX_SPINE_DEPTH]; |
| }; |
| |
| static int top_frame(struct del_stack *s, struct frame **f) |
| { |
| if (s->top < 0) { |
| DMERR("btree deletion stack empty"); |
| return -EINVAL; |
| } |
| |
| *f = s->spine + s->top; |
| |
| return 0; |
| } |
| |
| static int unprocessed_frames(struct del_stack *s) |
| { |
| return s->top >= 0; |
| } |
| |
| static void prefetch_children(struct del_stack *s, struct frame *f) |
| { |
| unsigned i; |
| struct dm_block_manager *bm = dm_tm_get_bm(s->tm); |
| |
| for (i = 0; i < f->nr_children; i++) |
| dm_bm_prefetch(bm, value64(f->n, i)); |
| } |
| |
| static bool is_internal_level(struct dm_btree_info *info, struct frame *f) |
| { |
| return f->level < (info->levels - 1); |
| } |
| |
| static int push_frame(struct del_stack *s, dm_block_t b, unsigned level) |
| { |
| int r; |
| uint32_t ref_count; |
| |
| if (s->top >= MAX_SPINE_DEPTH - 1) { |
| DMERR("btree deletion stack out of memory"); |
| return -ENOMEM; |
| } |
| |
| r = dm_tm_ref(s->tm, b, &ref_count); |
| if (r) |
| return r; |
| |
| if (ref_count > 1) |
| /* |
| * This is a shared node, so we can just decrement it's |
| * reference counter and leave the children. |
| */ |
| dm_tm_dec(s->tm, b); |
| |
| else { |
| uint32_t flags; |
| struct frame *f = s->spine + ++s->top; |
| |
| r = dm_tm_read_lock(s->tm, b, &btree_node_validator, &f->b); |
| if (r) { |
| s->top--; |
| return r; |
| } |
| |
| f->n = dm_block_data(f->b); |
| f->level = level; |
| f->nr_children = le32_to_cpu(f->n->header.nr_entries); |
| f->current_child = 0; |
| |
| flags = le32_to_cpu(f->n->header.flags); |
| if (flags & INTERNAL_NODE || is_internal_level(s->info, f)) |
| prefetch_children(s, f); |
| } |
| |
| return 0; |
| } |
| |
| static void pop_frame(struct del_stack *s) |
| { |
| struct frame *f = s->spine + s->top--; |
| |
| dm_tm_dec(s->tm, dm_block_location(f->b)); |
| dm_tm_unlock(s->tm, f->b); |
| } |
| |
| static void unlock_all_frames(struct del_stack *s) |
| { |
| struct frame *f; |
| |
| while (unprocessed_frames(s)) { |
| f = s->spine + s->top--; |
| dm_tm_unlock(s->tm, f->b); |
| } |
| } |
| |
| int dm_btree_del(struct dm_btree_info *info, dm_block_t root) |
| { |
| int r; |
| struct del_stack *s; |
| |
| /* |
| * dm_btree_del() is called via an ioctl, as such should be |
| * considered an FS op. We can't recurse back into the FS, so we |
| * allocate GFP_NOFS. |
| */ |
| s = kmalloc(sizeof(*s), GFP_NOFS); |
| if (!s) |
| return -ENOMEM; |
| s->info = info; |
| s->tm = info->tm; |
| s->top = -1; |
| |
| r = push_frame(s, root, 0); |
| if (r) |
| goto out; |
| |
| while (unprocessed_frames(s)) { |
| uint32_t flags; |
| struct frame *f; |
| dm_block_t b; |
| |
| r = top_frame(s, &f); |
| if (r) |
| goto out; |
| |
| if (f->current_child >= f->nr_children) { |
| pop_frame(s); |
| continue; |
| } |
| |
| flags = le32_to_cpu(f->n->header.flags); |
| if (flags & INTERNAL_NODE) { |
| b = value64(f->n, f->current_child); |
| f->current_child++; |
| r = push_frame(s, b, f->level); |
| if (r) |
| goto out; |
| |
| } else if (is_internal_level(info, f)) { |
| b = value64(f->n, f->current_child); |
| f->current_child++; |
| r = push_frame(s, b, f->level + 1); |
| if (r) |
| goto out; |
| |
| } else { |
| if (info->value_type.dec) { |
| unsigned i; |
| |
| for (i = 0; i < f->nr_children; i++) |
| info->value_type.dec(info->value_type.context, |
| value_ptr(f->n, i)); |
| } |
| pop_frame(s); |
| } |
| } |
| out: |
| if (r) { |
| /* cleanup all frames of del_stack */ |
| unlock_all_frames(s); |
| } |
| kfree(s); |
| |
| return r; |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_del); |
| |
| /*----------------------------------------------------------------*/ |
| |
| static int btree_lookup_raw(struct ro_spine *s, dm_block_t block, uint64_t key, |
| int (*search_fn)(struct btree_node *, uint64_t), |
| uint64_t *result_key, void *v, size_t value_size) |
| { |
| int i, r; |
| uint32_t flags, nr_entries; |
| |
| do { |
| r = ro_step(s, block); |
| if (r < 0) |
| return r; |
| |
| i = search_fn(ro_node(s), key); |
| |
| flags = le32_to_cpu(ro_node(s)->header.flags); |
| nr_entries = le32_to_cpu(ro_node(s)->header.nr_entries); |
| if (i < 0 || i >= nr_entries) |
| return -ENODATA; |
| |
| if (flags & INTERNAL_NODE) |
| block = value64(ro_node(s), i); |
| |
| } while (!(flags & LEAF_NODE)); |
| |
| *result_key = le64_to_cpu(ro_node(s)->keys[i]); |
| memcpy(v, value_ptr(ro_node(s), i), value_size); |
| |
| return 0; |
| } |
| |
| int dm_btree_lookup(struct dm_btree_info *info, dm_block_t root, |
| uint64_t *keys, void *value_le) |
| { |
| unsigned level, last_level = info->levels - 1; |
| int r = -ENODATA; |
| uint64_t rkey; |
| __le64 internal_value_le; |
| struct ro_spine spine; |
| |
| init_ro_spine(&spine, info); |
| for (level = 0; level < info->levels; level++) { |
| size_t size; |
| void *value_p; |
| |
| if (level == last_level) { |
| value_p = value_le; |
| size = info->value_type.size; |
| |
| } else { |
| value_p = &internal_value_le; |
| size = sizeof(uint64_t); |
| } |
| |
| r = btree_lookup_raw(&spine, root, keys[level], |
| lower_bound, &rkey, |
| value_p, size); |
| |
| if (!r) { |
| if (rkey != keys[level]) { |
| exit_ro_spine(&spine); |
| return -ENODATA; |
| } |
| } else { |
| exit_ro_spine(&spine); |
| return r; |
| } |
| |
| root = le64_to_cpu(internal_value_le); |
| } |
| exit_ro_spine(&spine); |
| |
| return r; |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_lookup); |
| |
| static int dm_btree_lookup_next_single(struct dm_btree_info *info, dm_block_t root, |
| uint64_t key, uint64_t *rkey, void *value_le) |
| { |
| int r, i; |
| uint32_t flags, nr_entries; |
| struct dm_block *node; |
| struct btree_node *n; |
| |
| r = bn_read_lock(info, root, &node); |
| if (r) |
| return r; |
| |
| n = dm_block_data(node); |
| flags = le32_to_cpu(n->header.flags); |
| nr_entries = le32_to_cpu(n->header.nr_entries); |
| |
| if (flags & INTERNAL_NODE) { |
| i = lower_bound(n, key); |
| if (i < 0) { |
| /* |
| * avoid early -ENODATA return when all entries are |
| * higher than the search @key. |
| */ |
| i = 0; |
| } |
| if (i >= nr_entries) { |
| r = -ENODATA; |
| goto out; |
| } |
| |
| r = dm_btree_lookup_next_single(info, value64(n, i), key, rkey, value_le); |
| if (r == -ENODATA && i < (nr_entries - 1)) { |
| i++; |
| r = dm_btree_lookup_next_single(info, value64(n, i), key, rkey, value_le); |
| } |
| |
| } else { |
| i = upper_bound(n, key); |
| if (i < 0 || i >= nr_entries) { |
| r = -ENODATA; |
| goto out; |
| } |
| |
| *rkey = le64_to_cpu(n->keys[i]); |
| memcpy(value_le, value_ptr(n, i), info->value_type.size); |
| } |
| out: |
| dm_tm_unlock(info->tm, node); |
| return r; |
| } |
| |
| int dm_btree_lookup_next(struct dm_btree_info *info, dm_block_t root, |
| uint64_t *keys, uint64_t *rkey, void *value_le) |
| { |
| unsigned level; |
| int r = -ENODATA; |
| __le64 internal_value_le; |
| struct ro_spine spine; |
| |
| init_ro_spine(&spine, info); |
| for (level = 0; level < info->levels - 1u; level++) { |
| r = btree_lookup_raw(&spine, root, keys[level], |
| lower_bound, rkey, |
| &internal_value_le, sizeof(uint64_t)); |
| if (r) |
| goto out; |
| |
| if (*rkey != keys[level]) { |
| r = -ENODATA; |
| goto out; |
| } |
| |
| root = le64_to_cpu(internal_value_le); |
| } |
| |
| r = dm_btree_lookup_next_single(info, root, keys[level], rkey, value_le); |
| out: |
| exit_ro_spine(&spine); |
| return r; |
| } |
| |
| EXPORT_SYMBOL_GPL(dm_btree_lookup_next); |
| |
| /* |
| * Splits a node by creating a sibling node and shifting half the nodes |
| * contents across. Assumes there is a parent node, and it has room for |
| * another child. |
| * |
| * Before: |
| * +--------+ |
| * | Parent | |
| * +--------+ |
| * | |
| * v |
| * +----------+ |
| * | A ++++++ | |
| * +----------+ |
| * |
| * |
| * After: |
| * +--------+ |
| * | Parent | |
| * +--------+ |
| * | | |
| * v +------+ |
| * +---------+ | |
| * | A* +++ | v |
| * +---------+ +-------+ |
| * | B +++ | |
| * +-------+ |
| * |
| * Where A* is a shadow of A. |
| */ |
| static int btree_split_sibling(struct shadow_spine *s, unsigned parent_index, |
| uint64_t key) |
| { |
| int r; |
| size_t size; |
| unsigned nr_left, nr_right; |
| struct dm_block *left, *right, *parent; |
| struct btree_node *ln, *rn, *pn; |
| __le64 location; |
| |
| left = shadow_current(s); |
| |
| r = new_block(s->info, &right); |
| if (r < 0) |
| return r; |
| |
| ln = dm_block_data(left); |
| rn = dm_block_data(right); |
| |
| nr_left = le32_to_cpu(ln->header.nr_entries) / 2; |
| nr_right = le32_to_cpu(ln->header.nr_entries) - nr_left; |
| |
| ln->header.nr_entries = cpu_to_le32(nr_left); |
| |
| rn->header.flags = ln->header.flags; |
| rn->header.nr_entries = cpu_to_le32(nr_right); |
| rn->header.max_entries = ln->header.max_entries; |
| rn->header.value_size = ln->header.value_size; |
| memcpy(rn->keys, ln->keys + nr_left, nr_right * sizeof(rn->keys[0])); |
| |
| size = le32_to_cpu(ln->header.flags) & INTERNAL_NODE ? |
| sizeof(uint64_t) : s->info->value_type.size; |
| memcpy(value_ptr(rn, 0), value_ptr(ln, nr_left), |
| size * nr_right); |
| |
| /* |
| * Patch up the parent |
| */ |
| parent = shadow_parent(s); |
| |
| pn = dm_block_data(parent); |
| location = cpu_to_le64(dm_block_location(left)); |
| __dm_bless_for_disk(&location); |
| memcpy_disk(value_ptr(pn, parent_index), |
| &location, sizeof(__le64)); |
| |
| location = cpu_to_le64(dm_block_location(right)); |
| __dm_bless_for_disk(&location); |
| |
| r = insert_at(sizeof(__le64), pn, parent_index + 1, |
| le64_to_cpu(rn->keys[0]), &location); |
| if (r) { |
| unlock_block(s->info, right); |
| return r; |
| } |
| |
| if (key < le64_to_cpu(rn->keys[0])) { |
| unlock_block(s->info, right); |
| s->nodes[1] = left; |
| } else { |
| unlock_block(s->info, left); |
| s->nodes[1] = right; |
| } |
| |
| return 0; |
| } |
| |
| /* |
| * Splits a node by creating two new children beneath the given node. |
| * |
| * Before: |
| * +----------+ |
| * | A ++++++ | |
| * +----------+ |
| * |
| * |
| * After: |
| * +------------+ |
| * | A (shadow) | |
| * +------------+ |
| * | | |
| * +------+ +----+ |
| * | | |
| * v v |
| * +-------+ +-------+ |
| * | B +++ | | C +++ | |
| * +-------+ +-------+ |
| */ |
| static int btree_split_beneath(struct shadow_spine *s, uint64_t key) |
| { |
| int r; |
| size_t size; |
| unsigned nr_left, nr_right; |
| struct dm_block *left, *right, *new_parent; |
| struct btree_node *pn, *ln, *rn; |
| __le64 val; |
| |
| new_parent = shadow_current(s); |
| |
| pn = dm_block_data(new_parent); |
| size = le32_to_cpu(pn->header.flags) & INTERNAL_NODE ? |
| sizeof(__le64) : s->info->value_type.size; |
| |
| /* create & init the left block */ |
| r = new_block(s->info, &left); |
| if (r < 0) |
| return r; |
| |
| ln = dm_block_data(left); |
| nr_left = le32_to_cpu(pn->header.nr_entries) / 2; |
| |
| ln->header.flags = pn->header.flags; |
| ln->header.nr_entries = cpu_to_le32(nr_left); |
| ln->header.max_entries = pn->header.max_entries; |
| ln->header.value_size = pn->header.value_size; |
| memcpy(ln->keys, pn->keys, nr_left * sizeof(pn->keys[0])); |
| memcpy(value_ptr(ln, 0), value_ptr(pn, 0), nr_left * size); |
| |
| /* create & init the right block */ |
| r = new_block(s->info, &right); |
| if (r < 0) { |
| unlock_block(s->info, left); |
| return r; |
| } |
| |
| rn = dm_block_data(right); |
| nr_right = le32_to_cpu(pn->header.nr_entries) - nr_left; |
| |
| rn->header.flags = pn->header.flags; |
| rn->header.nr_entries = cpu_to_le32(nr_right); |
| rn->header.max_entries = pn->header.max_entries; |
| rn->header.value_size = pn->header.value_size; |
| memcpy(rn->keys, pn->keys + nr_left, nr_right * sizeof(pn->keys[0])); |
| memcpy(value_ptr(rn, 0), value_ptr(pn, nr_left), |
| nr_right * size); |
| |
| /* new_parent should just point to l and r now */ |
| pn->header.flags = cpu_to_le32(INTERNAL_NODE); |
| pn->header.nr_entries = cpu_to_le32(2); |
| pn->header.max_entries = cpu_to_le32( |
| calc_max_entries(sizeof(__le64), |
| dm_bm_block_size( |
| dm_tm_get_bm(s->info->tm)))); |
| pn->header.value_size = cpu_to_le32(sizeof(__le64)); |
| |
| val = cpu_to_le64(dm_block_location(left)); |
| __dm_bless_for_disk(&val); |
| pn->keys[0] = ln->keys[0]; |
| memcpy_disk(value_ptr(pn, 0), &val, sizeof(__le64)); |
| |
| val = cpu_to_le64(dm_block_location(right)); |
| __dm_bless_for_disk(&val); |
| pn->keys[1] = rn->keys[0]; |
| memcpy_disk(value_ptr(pn, 1), &val, sizeof(__le64)); |
| |
| unlock_block(s->info, left); |
| unlock_block(s->info, right); |
| return 0; |
| } |
| |
| static int btree_insert_raw(struct shadow_spine *s, dm_block_t root, |
| struct dm_btree_value_type *vt, |
| uint64_t key, unsigned *index) |
| { |
| int r, i = *index, top = 1; |
| struct btree_node *node; |
| |
| for (;;) { |
| r = shadow_step(s, root, vt); |
| if (r < 0) |
| return r; |
| |
| node = dm_block_data(shadow_current(s)); |
| |
| /* |
| * We have to patch up the parent node, ugly, but I don't |
| * see a way to do this automatically as part of the spine |
| * op. |
| */ |
| if (shadow_has_parent(s) && i >= 0) { /* FIXME: second clause unness. */ |
| __le64 location = cpu_to_le64(dm_block_location(shadow_current(s))); |
| |
| __dm_bless_for_disk(&location); |
| memcpy_disk(value_ptr(dm_block_data(shadow_parent(s)), i), |
| &location, sizeof(__le64)); |
| } |
| |
| node = dm_block_data(shadow_current(s)); |
| |
| if (node->header.nr_entries == node->header.max_entries) { |
| if (top) |
| r = btree_split_beneath(s, key); |
| else |
| r = btree_split_sibling(s, i, key); |
| |
| if (r < 0) |
| return r; |
| } |
| |
| node = dm_block_data(shadow_current(s)); |
| |
| i = lower_bound(node, key); |
| |
| if (le32_to_cpu(node->header.flags) & LEAF_NODE) |
| break; |
| |
| if (i < 0) { |
| /* change the bounds on the lowest key */ |
| node->keys[0] = cpu_to_le64(key); |
| i = 0; |
| } |
| |
| root = value64(node, i); |
| top = 0; |
| } |
| |
| if (i < 0 || le64_to_cpu(node->keys[i]) != key) |
| i++; |
| |
| *index = i; |
| return 0; |
| } |
| |
| static bool need_insert(struct btree_node *node, uint64_t *keys, |
| unsigned level, unsigned index) |
| { |
| return ((index >= le32_to_cpu(node->header.nr_entries)) || |
| (le64_to_cpu(node->keys[index]) != keys[level])); |
| } |
| |
| static int insert(struct dm_btree_info *info, dm_block_t root, |
| uint64_t *keys, void *value, dm_block_t *new_root, |
| int *inserted) |
| __dm_written_to_disk(value) |
| { |
| int r; |
| unsigned level, index = -1, last_level = info->levels - 1; |
| dm_block_t block = root; |
| struct shadow_spine spine; |
| struct btree_node *n; |
| struct dm_btree_value_type le64_type; |
| |
| init_le64_type(info->tm, &le64_type); |
| init_shadow_spine(&spine, info); |
| |
| for (level = 0; level < (info->levels - 1); level++) { |
| r = btree_insert_raw(&spine, block, &le64_type, keys[level], &index); |
| if (r < 0) |
| goto bad; |
| |
| n = dm_block_data(shadow_current(&spine)); |
| |
| if (need_insert(n, keys, level, index)) { |
| dm_block_t new_tree; |
| __le64 new_le; |
| |
| r = dm_btree_empty(info, &new_tree); |
| if (r < 0) |
| goto bad; |
| |
| new_le = cpu_to_le64(new_tree); |
| __dm_bless_for_disk(&new_le); |
| |
| r = insert_at(sizeof(uint64_t), n, index, |
| keys[level], &new_le); |
| if (r) |
| goto bad; |
| } |
| |
| if (level < last_level) |
| block = value64(n, index); |
| } |
| |
| r = btree_insert_raw(&spine, block, &info->value_type, |
| keys[level], &index); |
| if (r < 0) |
| goto bad; |
| |
| n = dm_block_data(shadow_current(&spine)); |
| |
| if (need_insert(n, keys, level, index)) { |
| if (inserted) |
| *inserted = 1; |
| |
| r = insert_at(info->value_type.size, n, index, |
| keys[level], value); |
| if (r) |
| goto bad_unblessed; |
| } else { |
| if (inserted) |
| *inserted = 0; |
| |
| if (info->value_type.dec && |
| (!info->value_type.equal || |
| !info->value_type.equal( |
| info->value_type.context, |
| value_ptr(n, index), |
| value))) { |
| info->value_type.dec(info->value_type.context, |
| value_ptr(n, index)); |
| } |
| memcpy_disk(value_ptr(n, index), |
| value, info->value_type.size); |
| } |
| |
| *new_root = shadow_root(&spine); |
| exit_shadow_spine(&spine); |
| |
| return 0; |
| |
| bad: |
| __dm_unbless_for_disk(value); |
| bad_unblessed: |
| exit_shadow_spine(&spine); |
| return r; |
| } |
| |
| int dm_btree_insert(struct dm_btree_info *info, dm_block_t root, |
| uint64_t *keys, void *value, dm_block_t *new_root) |
| __dm_written_to_disk(value) |
| { |
| return insert(info, root, keys, value, new_root, NULL); |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_insert); |
| |
| int dm_btree_insert_notify(struct dm_btree_info *info, dm_block_t root, |
| uint64_t *keys, void *value, dm_block_t *new_root, |
| int *inserted) |
| __dm_written_to_disk(value) |
| { |
| return insert(info, root, keys, value, new_root, inserted); |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_insert_notify); |
| |
| /*----------------------------------------------------------------*/ |
| |
| static int find_key(struct ro_spine *s, dm_block_t block, bool find_highest, |
| uint64_t *result_key, dm_block_t *next_block) |
| { |
| int i, r; |
| uint32_t flags; |
| |
| do { |
| r = ro_step(s, block); |
| if (r < 0) |
| return r; |
| |
| flags = le32_to_cpu(ro_node(s)->header.flags); |
| i = le32_to_cpu(ro_node(s)->header.nr_entries); |
| if (!i) |
| return -ENODATA; |
| else |
| i--; |
| |
| if (find_highest) |
| *result_key = le64_to_cpu(ro_node(s)->keys[i]); |
| else |
| *result_key = le64_to_cpu(ro_node(s)->keys[0]); |
| |
| if (next_block || flags & INTERNAL_NODE) { |
| if (find_highest) |
| block = value64(ro_node(s), i); |
| else |
| block = value64(ro_node(s), 0); |
| } |
| |
| } while (flags & INTERNAL_NODE); |
| |
| if (next_block) |
| *next_block = block; |
| return 0; |
| } |
| |
| static int dm_btree_find_key(struct dm_btree_info *info, dm_block_t root, |
| bool find_highest, uint64_t *result_keys) |
| { |
| int r = 0, count = 0, level; |
| struct ro_spine spine; |
| |
| init_ro_spine(&spine, info); |
| for (level = 0; level < info->levels; level++) { |
| r = find_key(&spine, root, find_highest, result_keys + level, |
| level == info->levels - 1 ? NULL : &root); |
| if (r == -ENODATA) { |
| r = 0; |
| break; |
| |
| } else if (r) |
| break; |
| |
| count++; |
| } |
| exit_ro_spine(&spine); |
| |
| return r ? r : count; |
| } |
| |
| int dm_btree_find_highest_key(struct dm_btree_info *info, dm_block_t root, |
| uint64_t *result_keys) |
| { |
| return dm_btree_find_key(info, root, true, result_keys); |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_find_highest_key); |
| |
| int dm_btree_find_lowest_key(struct dm_btree_info *info, dm_block_t root, |
| uint64_t *result_keys) |
| { |
| return dm_btree_find_key(info, root, false, result_keys); |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_find_lowest_key); |
| |
| /*----------------------------------------------------------------*/ |
| |
| /* |
| * FIXME: We shouldn't use a recursive algorithm when we have limited stack |
| * space. Also this only works for single level trees. |
| */ |
| static int walk_node(struct dm_btree_info *info, dm_block_t block, |
| int (*fn)(void *context, uint64_t *keys, void *leaf), |
| void *context) |
| { |
| int r; |
| unsigned i, nr; |
| struct dm_block *node; |
| struct btree_node *n; |
| uint64_t keys; |
| |
| r = bn_read_lock(info, block, &node); |
| if (r) |
| return r; |
| |
| n = dm_block_data(node); |
| |
| nr = le32_to_cpu(n->header.nr_entries); |
| for (i = 0; i < nr; i++) { |
| if (le32_to_cpu(n->header.flags) & INTERNAL_NODE) { |
| r = walk_node(info, value64(n, i), fn, context); |
| if (r) |
| goto out; |
| } else { |
| keys = le64_to_cpu(*key_ptr(n, i)); |
| r = fn(context, &keys, value_ptr(n, i)); |
| if (r) |
| goto out; |
| } |
| } |
| |
| out: |
| dm_tm_unlock(info->tm, node); |
| return r; |
| } |
| |
| int dm_btree_walk(struct dm_btree_info *info, dm_block_t root, |
| int (*fn)(void *context, uint64_t *keys, void *leaf), |
| void *context) |
| { |
| BUG_ON(info->levels > 1); |
| return walk_node(info, root, fn, context); |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_walk); |
| |
| /*----------------------------------------------------------------*/ |
| |
| static void prefetch_values(struct dm_btree_cursor *c) |
| { |
| unsigned i, nr; |
| __le64 value_le; |
| struct cursor_node *n = c->nodes + c->depth - 1; |
| struct btree_node *bn = dm_block_data(n->b); |
| struct dm_block_manager *bm = dm_tm_get_bm(c->info->tm); |
| |
| BUG_ON(c->info->value_type.size != sizeof(value_le)); |
| |
| nr = le32_to_cpu(bn->header.nr_entries); |
| for (i = 0; i < nr; i++) { |
| memcpy(&value_le, value_ptr(bn, i), sizeof(value_le)); |
| dm_bm_prefetch(bm, le64_to_cpu(value_le)); |
| } |
| } |
| |
| static bool leaf_node(struct dm_btree_cursor *c) |
| { |
| struct cursor_node *n = c->nodes + c->depth - 1; |
| struct btree_node *bn = dm_block_data(n->b); |
| |
| return le32_to_cpu(bn->header.flags) & LEAF_NODE; |
| } |
| |
| static int push_node(struct dm_btree_cursor *c, dm_block_t b) |
| { |
| int r; |
| struct cursor_node *n = c->nodes + c->depth; |
| |
| if (c->depth >= DM_BTREE_CURSOR_MAX_DEPTH - 1) { |
| DMERR("couldn't push cursor node, stack depth too high"); |
| return -EINVAL; |
| } |
| |
| r = bn_read_lock(c->info, b, &n->b); |
| if (r) |
| return r; |
| |
| n->index = 0; |
| c->depth++; |
| |
| if (c->prefetch_leaves || !leaf_node(c)) |
| prefetch_values(c); |
| |
| return 0; |
| } |
| |
| static void pop_node(struct dm_btree_cursor *c) |
| { |
| c->depth--; |
| unlock_block(c->info, c->nodes[c->depth].b); |
| } |
| |
| static int inc_or_backtrack(struct dm_btree_cursor *c) |
| { |
| struct cursor_node *n; |
| struct btree_node *bn; |
| |
| for (;;) { |
| if (!c->depth) |
| return -ENODATA; |
| |
| n = c->nodes + c->depth - 1; |
| bn = dm_block_data(n->b); |
| |
| n->index++; |
| if (n->index < le32_to_cpu(bn->header.nr_entries)) |
| break; |
| |
| pop_node(c); |
| } |
| |
| return 0; |
| } |
| |
| static int find_leaf(struct dm_btree_cursor *c) |
| { |
| int r = 0; |
| struct cursor_node *n; |
| struct btree_node *bn; |
| __le64 value_le; |
| |
| for (;;) { |
| n = c->nodes + c->depth - 1; |
| bn = dm_block_data(n->b); |
| |
| if (le32_to_cpu(bn->header.flags) & LEAF_NODE) |
| break; |
| |
| memcpy(&value_le, value_ptr(bn, n->index), sizeof(value_le)); |
| r = push_node(c, le64_to_cpu(value_le)); |
| if (r) { |
| DMERR("push_node failed"); |
| break; |
| } |
| } |
| |
| if (!r && (le32_to_cpu(bn->header.nr_entries) == 0)) |
| return -ENODATA; |
| |
| return r; |
| } |
| |
| int dm_btree_cursor_begin(struct dm_btree_info *info, dm_block_t root, |
| bool prefetch_leaves, struct dm_btree_cursor *c) |
| { |
| int r; |
| |
| c->info = info; |
| c->root = root; |
| c->depth = 0; |
| c->prefetch_leaves = prefetch_leaves; |
| |
| r = push_node(c, root); |
| if (r) |
| return r; |
| |
| return find_leaf(c); |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_cursor_begin); |
| |
| void dm_btree_cursor_end(struct dm_btree_cursor *c) |
| { |
| while (c->depth) |
| pop_node(c); |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_cursor_end); |
| |
| int dm_btree_cursor_next(struct dm_btree_cursor *c) |
| { |
| int r = inc_or_backtrack(c); |
| if (!r) { |
| r = find_leaf(c); |
| if (r) |
| DMERR("find_leaf failed"); |
| } |
| |
| return r; |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_cursor_next); |
| |
| int dm_btree_cursor_skip(struct dm_btree_cursor *c, uint32_t count) |
| { |
| int r = 0; |
| |
| while (count-- && !r) |
| r = dm_btree_cursor_next(c); |
| |
| return r; |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_cursor_skip); |
| |
| int dm_btree_cursor_get_value(struct dm_btree_cursor *c, uint64_t *key, void *value_le) |
| { |
| if (c->depth) { |
| struct cursor_node *n = c->nodes + c->depth - 1; |
| struct btree_node *bn = dm_block_data(n->b); |
| |
| if (le32_to_cpu(bn->header.flags) & INTERNAL_NODE) |
| return -EINVAL; |
| |
| *key = le64_to_cpu(*key_ptr(bn, n->index)); |
| memcpy(value_le, value_ptr(bn, n->index), c->info->value_type.size); |
| return 0; |
| |
| } else |
| return -ENODATA; |
| } |
| EXPORT_SYMBOL_GPL(dm_btree_cursor_get_value); |