| /* | |
| * 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); | |
| __le64 key_le = cpu_to_le64(key); | |
| if (index > nr_entries || | |
| index >= le32_to_cpu(node->header.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); |