mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-25 03:17:30 +07:00
e4f9d60138
When btree_split_beneath() splits a node to two new children, it will
allocate two blocks: left and right. If right block's allocation
failed, the left block will be unlocked and marked dirty. If this
happened, the left block'ss content is zero, because it wasn't
initialized with the btree struct before the attempot to allocate the
right block. Upon return, when flushing the left block to disk, the
validator will fail when check this block. Then a BUG_ON is raised.
Fix this by completely initializing the left block before allocating and
initializing the right block.
Fixes: 4dcb8b57df
("dm btree: fix leak of bufio-backed block in btree_split_beneath error path")
Cc: stable@vger.kernel.org
Signed-off-by: ZhangXiaoxu <zhangxiaoxu5@huawei.com>
Signed-off-by: Mike Snitzer <snitzer@redhat.com>
1165 lines
26 KiB
C
1165 lines
26 KiB
C
/*
|
|
* 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);
|