dm-table.c 23.8 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/*
 * Copyright (C) 2001 Sistina Software (UK) Limited.
3
 * Copyright (C) 2004-2008 Red Hat, Inc. All rights reserved.
L
Linus Torvalds 已提交
4 5 6 7 8 9 10 11 12 13 14 15 16
 *
 * This file is released under the GPL.
 */

#include "dm.h"

#include <linux/module.h>
#include <linux/vmalloc.h>
#include <linux/blkdev.h>
#include <linux/namei.h>
#include <linux/ctype.h>
#include <linux/slab.h>
#include <linux/interrupt.h>
A
Arjan van de Ven 已提交
17
#include <linux/mutex.h>
18
#include <linux/delay.h>
L
Linus Torvalds 已提交
19 20
#include <asm/atomic.h>

21 22
#define DM_MSG_PREFIX "table"

L
Linus Torvalds 已提交
23 24 25 26 27
#define MAX_DEPTH 16
#define NODE_SIZE L1_CACHE_BYTES
#define KEYS_PER_NODE (NODE_SIZE / sizeof(sector_t))
#define CHILDREN_PER_NODE (KEYS_PER_NODE + 1)

28 29 30 31 32 33 34 35 36 37 38 39 40
/*
 * The table has always exactly one reference from either mapped_device->map
 * or hash_cell->new_map. This reference is not counted in table->holders.
 * A pair of dm_create_table/dm_destroy_table functions is used for table
 * creation/destruction.
 *
 * Temporary references from the other code increase table->holders. A pair
 * of dm_table_get/dm_table_put functions is used to manipulate it.
 *
 * When the table is about to be destroyed, we wait for table->holders to
 * drop to zero.
 */

L
Linus Torvalds 已提交
41
struct dm_table {
M
Mike Anderson 已提交
42
	struct mapped_device *md;
L
Linus Torvalds 已提交
43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59
	atomic_t holders;

	/* btree table */
	unsigned int depth;
	unsigned int counts[MAX_DEPTH];	/* in nodes */
	sector_t *index[MAX_DEPTH];

	unsigned int num_targets;
	unsigned int num_allocated;
	sector_t *highs;
	struct dm_target *targets;

	/*
	 * Indicates the rw permissions for the new logical
	 * device.  This should be a combination of FMODE_READ
	 * and FMODE_WRITE.
	 */
60
	fmode_t mode;
L
Linus Torvalds 已提交
61 62 63 64 65 66 67 68

	/* a list of devices used by this table */
	struct list_head devices;

	/*
	 * These are optimistic limits taken from all the
	 * targets, some targets will need smaller limits.
	 */
69
	struct queue_limits limits;
L
Linus Torvalds 已提交
70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172

	/* events get handed up using this callback */
	void (*event_fn)(void *);
	void *event_context;
};

/*
 * Similar to ceiling(log_size(n))
 */
static unsigned int int_log(unsigned int n, unsigned int base)
{
	int result = 0;

	while (n > 1) {
		n = dm_div_up(n, base);
		result++;
	}

	return result;
}

/*
 * Calculate the index of the child node of the n'th node k'th key.
 */
static inline unsigned int get_child(unsigned int n, unsigned int k)
{
	return (n * CHILDREN_PER_NODE) + k;
}

/*
 * Return the n'th node of level l from table t.
 */
static inline sector_t *get_node(struct dm_table *t,
				 unsigned int l, unsigned int n)
{
	return t->index[l] + (n * KEYS_PER_NODE);
}

/*
 * Return the highest key that you could lookup from the n'th
 * node on level l of the btree.
 */
static sector_t high(struct dm_table *t, unsigned int l, unsigned int n)
{
	for (; l < t->depth - 1; l++)
		n = get_child(n, CHILDREN_PER_NODE - 1);

	if (n >= t->counts[l])
		return (sector_t) - 1;

	return get_node(t, l, n)[KEYS_PER_NODE - 1];
}

/*
 * Fills in a level of the btree based on the highs of the level
 * below it.
 */
static int setup_btree_index(unsigned int l, struct dm_table *t)
{
	unsigned int n, k;
	sector_t *node;

	for (n = 0U; n < t->counts[l]; n++) {
		node = get_node(t, l, n);

		for (k = 0U; k < KEYS_PER_NODE; k++)
			node[k] = high(t, l + 1, get_child(n, k));
	}

	return 0;
}

void *dm_vcalloc(unsigned long nmemb, unsigned long elem_size)
{
	unsigned long size;
	void *addr;

	/*
	 * Check that we're not going to overflow.
	 */
	if (nmemb > (ULONG_MAX / elem_size))
		return NULL;

	size = nmemb * elem_size;
	addr = vmalloc(size);
	if (addr)
		memset(addr, 0, size);

	return addr;
}

/*
 * highs, and targets are managed as dynamic arrays during a
 * table load.
 */
static int alloc_targets(struct dm_table *t, unsigned int num)
{
	sector_t *n_highs;
	struct dm_target *n_targets;
	int n = t->num_targets;

	/*
	 * Allocate both the target array and offset array at once.
173 174
	 * Append an empty entry to catch sectors beyond the end of
	 * the device.
L
Linus Torvalds 已提交
175
	 */
176
	n_highs = (sector_t *) dm_vcalloc(num + 1, sizeof(struct dm_target) +
L
Linus Torvalds 已提交
177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197
					  sizeof(sector_t));
	if (!n_highs)
		return -ENOMEM;

	n_targets = (struct dm_target *) (n_highs + num);

	if (n) {
		memcpy(n_highs, t->highs, sizeof(*n_highs) * n);
		memcpy(n_targets, t->targets, sizeof(*n_targets) * n);
	}

	memset(n_highs + n, -1, sizeof(*n_highs) * (num - n));
	vfree(t->highs);

	t->num_allocated = num;
	t->highs = n_highs;
	t->targets = n_targets;

	return 0;
}

198
int dm_table_create(struct dm_table **result, fmode_t mode,
M
Mike Anderson 已提交
199
		    unsigned num_targets, struct mapped_device *md)
L
Linus Torvalds 已提交
200
{
D
Dmitry Monakhov 已提交
201
	struct dm_table *t = kzalloc(sizeof(*t), GFP_KERNEL);
L
Linus Torvalds 已提交
202 203 204 205 206

	if (!t)
		return -ENOMEM;

	INIT_LIST_HEAD(&t->devices);
207
	atomic_set(&t->holders, 0);
L
Linus Torvalds 已提交
208 209 210 211 212 213 214 215 216 217 218 219 220

	if (!num_targets)
		num_targets = KEYS_PER_NODE;

	num_targets = dm_round_up(num_targets, KEYS_PER_NODE);

	if (alloc_targets(t, num_targets)) {
		kfree(t);
		t = NULL;
		return -ENOMEM;
	}

	t->mode = mode;
M
Mike Anderson 已提交
221
	t->md = md;
L
Linus Torvalds 已提交
222 223 224 225 226 227 228 229
	*result = t;
	return 0;
}

static void free_devices(struct list_head *devices)
{
	struct list_head *tmp, *next;

P
Paul Jimenez 已提交
230
	list_for_each_safe(tmp, next, devices) {
M
Mikulas Patocka 已提交
231 232
		struct dm_dev_internal *dd =
		    list_entry(tmp, struct dm_dev_internal, list);
233 234
		DMWARN("dm_table_destroy: dm_put_device call missing for %s",
		       dd->dm_dev.name);
L
Linus Torvalds 已提交
235 236 237 238
		kfree(dd);
	}
}

239
void dm_table_destroy(struct dm_table *t)
L
Linus Torvalds 已提交
240 241 242
{
	unsigned int i;

243 244 245 246
	while (atomic_read(&t->holders))
		msleep(1);
	smp_mb();

L
Linus Torvalds 已提交
247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263
	/* free the indexes (see dm_table_complete) */
	if (t->depth >= 2)
		vfree(t->index[t->depth - 2]);

	/* free the targets */
	for (i = 0; i < t->num_targets; i++) {
		struct dm_target *tgt = t->targets + i;

		if (tgt->type->dtr)
			tgt->type->dtr(tgt);

		dm_put_target_type(tgt->type);
	}

	vfree(t->highs);

	/* free the device list */
264
	if (t->devices.next != &t->devices)
L
Linus Torvalds 已提交
265 266 267 268 269 270 271 272 273 274 275 276 277 278 279
		free_devices(&t->devices);

	kfree(t);
}

void dm_table_get(struct dm_table *t)
{
	atomic_inc(&t->holders);
}

void dm_table_put(struct dm_table *t)
{
	if (!t)
		return;

280 281
	smp_mb__before_atomic_dec();
	atomic_dec(&t->holders);
L
Linus Torvalds 已提交
282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297
}

/*
 * Checks to see if we need to extend highs or targets.
 */
static inline int check_space(struct dm_table *t)
{
	if (t->num_targets >= t->num_allocated)
		return alloc_targets(t, t->num_allocated * 2);

	return 0;
}

/*
 * See if we've already got a device in the list.
 */
M
Mikulas Patocka 已提交
298
static struct dm_dev_internal *find_device(struct list_head *l, dev_t dev)
L
Linus Torvalds 已提交
299
{
M
Mikulas Patocka 已提交
300
	struct dm_dev_internal *dd;
L
Linus Torvalds 已提交
301 302

	list_for_each_entry (dd, l, list)
M
Mikulas Patocka 已提交
303
		if (dd->dm_dev.bdev->bd_dev == dev)
L
Linus Torvalds 已提交
304 305 306 307 308 309 310 311
			return dd;

	return NULL;
}

/*
 * Open a device so we can use it as a map destination.
 */
M
Mikulas Patocka 已提交
312 313
static int open_dev(struct dm_dev_internal *d, dev_t dev,
		    struct mapped_device *md)
L
Linus Torvalds 已提交
314 315 316 317 318 319
{
	static char *_claim_ptr = "I belong to device-mapper";
	struct block_device *bdev;

	int r;

M
Mikulas Patocka 已提交
320
	BUG_ON(d->dm_dev.bdev);
L
Linus Torvalds 已提交
321

M
Mikulas Patocka 已提交
322
	bdev = open_by_devnum(dev, d->dm_dev.mode);
L
Linus Torvalds 已提交
323 324
	if (IS_ERR(bdev))
		return PTR_ERR(bdev);
325
	r = bd_claim_by_disk(bdev, _claim_ptr, dm_disk(md));
L
Linus Torvalds 已提交
326
	if (r)
A
Al Viro 已提交
327
		blkdev_put(bdev, d->dm_dev.mode);
L
Linus Torvalds 已提交
328
	else
M
Mikulas Patocka 已提交
329
		d->dm_dev.bdev = bdev;
L
Linus Torvalds 已提交
330 331 332 333 334 335
	return r;
}

/*
 * Close a device that we've been using.
 */
M
Mikulas Patocka 已提交
336
static void close_dev(struct dm_dev_internal *d, struct mapped_device *md)
L
Linus Torvalds 已提交
337
{
M
Mikulas Patocka 已提交
338
	if (!d->dm_dev.bdev)
L
Linus Torvalds 已提交
339 340
		return;

M
Mikulas Patocka 已提交
341
	bd_release_from_disk(d->dm_dev.bdev, dm_disk(md));
A
Al Viro 已提交
342
	blkdev_put(d->dm_dev.bdev, d->dm_dev.mode);
M
Mikulas Patocka 已提交
343
	d->dm_dev.bdev = NULL;
L
Linus Torvalds 已提交
344 345 346
}

/*
M
Mike Anderson 已提交
347
 * If possible, this checks an area of a destination device is valid.
L
Linus Torvalds 已提交
348
 */
349 350
static int device_area_is_valid(struct dm_target *ti, struct block_device *bdev,
			     sector_t start, sector_t len)
L
Linus Torvalds 已提交
351
{
352 353 354 355
	sector_t dev_size = i_size_read(bdev->bd_inode) >> SECTOR_SHIFT;
	unsigned short logical_block_size_sectors =
		ti->limits.logical_block_size >> SECTOR_SHIFT;
	char b[BDEVNAME_SIZE];
M
Mike Anderson 已提交
356 357 358 359

	if (!dev_size)
		return 1;

360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387
	if ((start >= dev_size) || (start + len > dev_size)) {
		DMWARN("%s: %s too small for target",
		       dm_device_name(ti->table->md), bdevname(bdev, b));
		return 0;
	}

	if (logical_block_size_sectors <= 1)
		return 1;

	if (start & (logical_block_size_sectors - 1)) {
		DMWARN("%s: start=%llu not aligned to h/w "
		       "logical block size %hu of %s",
		       dm_device_name(ti->table->md),
		       (unsigned long long)start,
		       ti->limits.logical_block_size, bdevname(bdev, b));
		return 0;
	}

	if (len & (logical_block_size_sectors - 1)) {
		DMWARN("%s: len=%llu not aligned to h/w "
		       "logical block size %hu of %s",
		       dm_device_name(ti->table->md),
		       (unsigned long long)len,
		       ti->limits.logical_block_size, bdevname(bdev, b));
		return 0;
	}

	return 1;
L
Linus Torvalds 已提交
388 389 390
}

/*
391
 * This upgrades the mode on an already open dm_dev, being
L
Linus Torvalds 已提交
392
 * careful to leave things as they were if we fail to reopen the
393 394
 * device and not to touch the existing bdev field in case
 * it is accessed concurrently inside dm_table_any_congested().
L
Linus Torvalds 已提交
395
 */
396
static int upgrade_mode(struct dm_dev_internal *dd, fmode_t new_mode,
M
Mikulas Patocka 已提交
397
			struct mapped_device *md)
L
Linus Torvalds 已提交
398 399
{
	int r;
400
	struct dm_dev_internal dd_new, dd_old;
L
Linus Torvalds 已提交
401

402 403 404 405 406 407 408 409
	dd_new = dd_old = *dd;

	dd_new.dm_dev.mode |= new_mode;
	dd_new.dm_dev.bdev = NULL;

	r = open_dev(&dd_new, dd->dm_dev.bdev->bd_dev, md);
	if (r)
		return r;
L
Linus Torvalds 已提交
410

M
Mikulas Patocka 已提交
411
	dd->dm_dev.mode |= new_mode;
412
	close_dev(&dd_old, md);
L
Linus Torvalds 已提交
413

414
	return 0;
L
Linus Torvalds 已提交
415 416 417 418 419 420 421 422
}

/*
 * Add a device to the list, or just increment the usage count if
 * it's already present.
 */
static int __table_get_device(struct dm_table *t, struct dm_target *ti,
			      const char *path, sector_t start, sector_t len,
423
			      fmode_t mode, struct dm_dev **result)
L
Linus Torvalds 已提交
424 425
{
	int r;
A
Andrew Morton 已提交
426
	dev_t uninitialized_var(dev);
M
Mikulas Patocka 已提交
427
	struct dm_dev_internal *dd;
L
Linus Torvalds 已提交
428 429
	unsigned int major, minor;

430
	BUG_ON(!t);
L
Linus Torvalds 已提交
431 432 433 434 435 436 437 438

	if (sscanf(path, "%u:%u", &major, &minor) == 2) {
		/* Extract the major/minor numbers */
		dev = MKDEV(major, minor);
		if (MAJOR(dev) != major || MINOR(dev) != minor)
			return -EOVERFLOW;
	} else {
		/* convert the path to a device */
439 440 441 442 443 444
		struct block_device *bdev = lookup_bdev(path);

		if (IS_ERR(bdev))
			return PTR_ERR(bdev);
		dev = bdev->bd_dev;
		bdput(bdev);
L
Linus Torvalds 已提交
445 446 447 448 449 450 451 452
	}

	dd = find_device(&t->devices, dev);
	if (!dd) {
		dd = kmalloc(sizeof(*dd), GFP_KERNEL);
		if (!dd)
			return -ENOMEM;

M
Mikulas Patocka 已提交
453 454
		dd->dm_dev.mode = mode;
		dd->dm_dev.bdev = NULL;
L
Linus Torvalds 已提交
455

456
		if ((r = open_dev(dd, dev, t->md))) {
L
Linus Torvalds 已提交
457 458 459 460
			kfree(dd);
			return r;
		}

M
Mikulas Patocka 已提交
461
		format_dev_t(dd->dm_dev.name, dev);
L
Linus Torvalds 已提交
462 463 464 465

		atomic_set(&dd->count, 0);
		list_add(&dd->list, &t->devices);

M
Mikulas Patocka 已提交
466
	} else if (dd->dm_dev.mode != (mode | dd->dm_dev.mode)) {
467
		r = upgrade_mode(dd, mode, t->md);
L
Linus Torvalds 已提交
468 469 470 471 472
		if (r)
			return r;
	}
	atomic_inc(&dd->count);

M
Mikulas Patocka 已提交
473
	*result = &dd->dm_dev;
L
Linus Torvalds 已提交
474 475 476
	return 0;
}

477 478 479 480 481
/*
 * Returns the minimum that is _not_ zero, unless both are zero.
 */
#define min_not_zero(l, r) (l == 0) ? r : ((r == 0) ? l : min(l, r))

482
void dm_set_device_limits(struct dm_target *ti, struct block_device *bdev)
L
Linus Torvalds 已提交
483
{
484
	struct request_queue *q = bdev_get_queue(bdev);
A
Alasdair G Kergon 已提交
485 486 487 488 489 490 491
	char b[BDEVNAME_SIZE];

	if (unlikely(!q)) {
		DMWARN("%s: Cannot set limits for nonexistent device %s",
		       dm_device_name(ti->table->md), bdevname(bdev, b));
		return;
	}
492

493 494 495
	if (blk_stack_limits(&ti->limits, &q->limits, 0) < 0)
		DMWARN("%s: target device %s is misaligned",
		       dm_device_name(ti->table->md), bdevname(bdev, b));
496

497 498 499 500
	/*
	 * Check if merge fn is supported.
	 * If not we'll force DM to use PAGE_SIZE or
	 * smaller I/O, just to be safe.
501
	 */
502 503

	if (q->merge_bvec_fn && !ti->type->merge)
504 505
		ti->limits.max_sectors =
			min_not_zero(ti->limits.max_sectors,
506 507 508
				     (unsigned int) (PAGE_SIZE >> 9));
}
EXPORT_SYMBOL_GPL(dm_set_device_limits);
509

510
int dm_get_device(struct dm_target *ti, const char *path, sector_t start,
511
		  sector_t len, fmode_t mode, struct dm_dev **result)
512 513 514 515
{
	int r = __table_get_device(ti->table, ti, path,
				   start, len, mode, result);

516 517 518 519 520 521 522 523 524 525
	if (r)
		return r;

	dm_set_device_limits(ti, (*result)->bdev);

	if (!device_area_is_valid(ti, (*result)->bdev, start, len)) {
		dm_put_device(ti, *result);
		*result = NULL;
		return -EINVAL;
	}
L
Linus Torvalds 已提交
526 527 528 529 530 531 532

	return r;
}

/*
 * Decrement a devices use count and remove it if necessary.
 */
M
Mikulas Patocka 已提交
533
void dm_put_device(struct dm_target *ti, struct dm_dev *d)
L
Linus Torvalds 已提交
534
{
M
Mikulas Patocka 已提交
535 536 537
	struct dm_dev_internal *dd = container_of(d, struct dm_dev_internal,
						  dm_dev);

L
Linus Torvalds 已提交
538
	if (atomic_dec_and_test(&dd->count)) {
539
		close_dev(dd, ti->table->md);
L
Linus Torvalds 已提交
540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586
		list_del(&dd->list);
		kfree(dd);
	}
}

/*
 * Checks to see if the target joins onto the end of the table.
 */
static int adjoin(struct dm_table *table, struct dm_target *ti)
{
	struct dm_target *prev;

	if (!table->num_targets)
		return !ti->begin;

	prev = &table->targets[table->num_targets - 1];
	return (ti->begin == (prev->begin + prev->len));
}

/*
 * Used to dynamically allocate the arg array.
 */
static char **realloc_argv(unsigned *array_size, char **old_argv)
{
	char **argv;
	unsigned new_size;

	new_size = *array_size ? *array_size * 2 : 64;
	argv = kmalloc(new_size * sizeof(*argv), GFP_KERNEL);
	if (argv) {
		memcpy(argv, old_argv, *array_size * sizeof(*argv));
		*array_size = new_size;
	}

	kfree(old_argv);
	return argv;
}

/*
 * Destructively splits up the argument list to pass to ctr.
 */
int dm_split_args(int *argc, char ***argvp, char *input)
{
	char *start, *end = input, *out, **argv = NULL;
	unsigned array_size = 0;

	*argc = 0;
587 588 589 590 591 592

	if (!input) {
		*argvp = NULL;
		return 0;
	}

L
Linus Torvalds 已提交
593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643
	argv = realloc_argv(&array_size, argv);
	if (!argv)
		return -ENOMEM;

	while (1) {
		start = end;

		/* Skip whitespace */
		while (*start && isspace(*start))
			start++;

		if (!*start)
			break;	/* success, we hit the end */

		/* 'out' is used to remove any back-quotes */
		end = out = start;
		while (*end) {
			/* Everything apart from '\0' can be quoted */
			if (*end == '\\' && *(end + 1)) {
				*out++ = *(end + 1);
				end += 2;
				continue;
			}

			if (isspace(*end))
				break;	/* end of token */

			*out++ = *end++;
		}

		/* have we already filled the array ? */
		if ((*argc + 1) > array_size) {
			argv = realloc_argv(&array_size, argv);
			if (!argv)
				return -ENOMEM;
		}

		/* we know this is whitespace */
		if (*end)
			end++;

		/* terminate the string and put it in the array */
		*out = '\0';
		argv[*argc] = start;
		(*argc)++;
	}

	*argvp = argv;
	return 0;
}

644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669
static void init_valid_queue_limits(struct queue_limits *limits)
{
	if (!limits->max_sectors)
		limits->max_sectors = SAFE_MAX_SECTORS;
	if (!limits->max_hw_sectors)
		limits->max_hw_sectors = SAFE_MAX_SECTORS;
	if (!limits->max_phys_segments)
		limits->max_phys_segments = MAX_PHYS_SEGMENTS;
	if (!limits->max_hw_segments)
		limits->max_hw_segments = MAX_HW_SEGMENTS;
	if (!limits->logical_block_size)
		limits->logical_block_size = 1 << SECTOR_SHIFT;
	if (!limits->physical_block_size)
		limits->physical_block_size = 1 << SECTOR_SHIFT;
	if (!limits->io_min)
		limits->io_min = 1 << SECTOR_SHIFT;
	if (!limits->max_segment_size)
		limits->max_segment_size = MAX_SEGMENT_SIZE;
	if (!limits->seg_boundary_mask)
		limits->seg_boundary_mask = BLK_SEG_BOUNDARY_MASK;
	if (!limits->bounce_pfn)
		limits->bounce_pfn = -1;
	/*
	 * The other fields (alignment_offset, io_opt, misaligned)
	 * hold 0 from the kzalloc().
	 */
L
Linus Torvalds 已提交
670 671
}

672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736
/*
 * Impose necessary and sufficient conditions on a devices's table such
 * that any incoming bio which respects its logical_block_size can be
 * processed successfully.  If it falls across the boundary between
 * two or more targets, the size of each piece it gets split into must
 * be compatible with the logical_block_size of the target processing it.
 */
static int validate_hardware_logical_block_alignment(struct dm_table *table)
{
	/*
	 * This function uses arithmetic modulo the logical_block_size
	 * (in units of 512-byte sectors).
	 */
	unsigned short device_logical_block_size_sects =
		table->limits.logical_block_size >> SECTOR_SHIFT;

	/*
	 * Offset of the start of the next table entry, mod logical_block_size.
	 */
	unsigned short next_target_start = 0;

	/*
	 * Given an aligned bio that extends beyond the end of a
	 * target, how many sectors must the next target handle?
	 */
	unsigned short remaining = 0;

	struct dm_target *uninitialized_var(ti);
	unsigned i = 0;

	/*
	 * Check each entry in the table in turn.
	 */
	while (i < dm_table_get_num_targets(table)) {
		ti = dm_table_get_target(table, i++);

		/*
		 * If the remaining sectors fall entirely within this
		 * table entry are they compatible with its logical_block_size?
		 */
		if (remaining < ti->len &&
		    remaining & ((ti->limits.logical_block_size >>
				  SECTOR_SHIFT) - 1))
			break;	/* Error */

		next_target_start =
		    (unsigned short) ((next_target_start + ti->len) &
				      (device_logical_block_size_sects - 1));
		remaining = next_target_start ?
		    device_logical_block_size_sects - next_target_start : 0;
	}

	if (remaining) {
		DMWARN("%s: table line %u (start sect %llu len %llu) "
		       "not aligned to hardware logical block size %hu",
		       dm_device_name(table->md), i,
		       (unsigned long long) ti->begin,
		       (unsigned long long) ti->len,
		       table->limits.logical_block_size);
		return -EINVAL;
	}

	return 0;
}

L
Linus Torvalds 已提交
737 738 739 740 741 742 743 744 745 746 747 748 749 750
int dm_table_add_target(struct dm_table *t, const char *type,
			sector_t start, sector_t len, char *params)
{
	int r = -EINVAL, argc;
	char **argv;
	struct dm_target *tgt;

	if ((r = check_space(t)))
		return r;

	tgt = t->targets + t->num_targets;
	memset(tgt, 0, sizeof(*tgt));

	if (!len) {
751
		DMERR("%s: zero-length target", dm_device_name(t->md));
L
Linus Torvalds 已提交
752 753 754 755 756
		return -EINVAL;
	}

	tgt->type = dm_get_target_type(type);
	if (!tgt->type) {
757 758
		DMERR("%s: %s: unknown target type", dm_device_name(t->md),
		      type);
L
Linus Torvalds 已提交
759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788
		return -EINVAL;
	}

	tgt->table = t;
	tgt->begin = start;
	tgt->len = len;
	tgt->error = "Unknown error";

	/*
	 * Does this target adjoin the previous one ?
	 */
	if (!adjoin(t, tgt)) {
		tgt->error = "Gap in table";
		r = -EINVAL;
		goto bad;
	}

	r = dm_split_args(&argc, &argv, params);
	if (r) {
		tgt->error = "couldn't split parameters (insufficient memory)";
		goto bad;
	}

	r = tgt->type->ctr(tgt, argc, argv);
	kfree(argv);
	if (r)
		goto bad;

	t->highs[t->num_targets++] = tgt->begin + tgt->len - 1;

789 790 791 792 793 794
	if (blk_stack_limits(&t->limits, &tgt->limits, 0) < 0)
		DMWARN("%s: target device (start sect %llu len %llu) "
		       "is misaligned",
		       dm_device_name(t->md),
		       (unsigned long long) tgt->begin,
		       (unsigned long long) tgt->len);
L
Linus Torvalds 已提交
795 796 797
	return 0;

 bad:
798
	DMERR("%s: %s: %s", dm_device_name(t->md), type, tgt->error);
L
Linus Torvalds 已提交
799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819
	dm_put_target_type(tgt->type);
	return r;
}

static int setup_indexes(struct dm_table *t)
{
	int i;
	unsigned int total = 0;
	sector_t *indexes;

	/* allocate the space for *all* the indexes */
	for (i = t->depth - 2; i >= 0; i--) {
		t->counts[i] = dm_div_up(t->counts[i + 1], CHILDREN_PER_NODE);
		total += t->counts[i];
	}

	indexes = (sector_t *) dm_vcalloc(total, (unsigned long) NODE_SIZE);
	if (!indexes)
		return -ENOMEM;

	/* set up internal nodes, bottom-up */
J
Jun'ichi Nomura 已提交
820
	for (i = t->depth - 2; i >= 0; i--) {
L
Linus Torvalds 已提交
821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836
		t->index[i] = indexes;
		indexes += (KEYS_PER_NODE * t->counts[i]);
		setup_btree_index(i, t);
	}

	return 0;
}

/*
 * Builds the btree to index the map.
 */
int dm_table_complete(struct dm_table *t)
{
	int r = 0;
	unsigned int leaf_nodes;

837
	init_valid_queue_limits(&t->limits);
L
Linus Torvalds 已提交
838

839 840 841 842
	r = validate_hardware_logical_block_alignment(t);
	if (r)
		return r;

L
Linus Torvalds 已提交
843 844 845 846 847 848 849 850 851 852 853 854 855 856
	/* how many indexes will the btree have ? */
	leaf_nodes = dm_div_up(t->num_targets, KEYS_PER_NODE);
	t->depth = 1 + int_log(leaf_nodes, CHILDREN_PER_NODE);

	/* leaf layer has already been set up */
	t->counts[t->depth - 1] = leaf_nodes;
	t->index[t->depth - 1] = t->highs;

	if (t->depth >= 2)
		r = setup_indexes(t);

	return r;
}

A
Arjan van de Ven 已提交
857
static DEFINE_MUTEX(_event_lock);
L
Linus Torvalds 已提交
858 859 860
void dm_table_event_callback(struct dm_table *t,
			     void (*fn)(void *), void *context)
{
A
Arjan van de Ven 已提交
861
	mutex_lock(&_event_lock);
L
Linus Torvalds 已提交
862 863
	t->event_fn = fn;
	t->event_context = context;
A
Arjan van de Ven 已提交
864
	mutex_unlock(&_event_lock);
L
Linus Torvalds 已提交
865 866 867 868 869 870 871 872 873 874
}

void dm_table_event(struct dm_table *t)
{
	/*
	 * You can no longer call dm_table_event() from interrupt
	 * context, use a bottom half instead.
	 */
	BUG_ON(in_interrupt());

A
Arjan van de Ven 已提交
875
	mutex_lock(&_event_lock);
L
Linus Torvalds 已提交
876 877
	if (t->event_fn)
		t->event_fn(t->event_context);
A
Arjan van de Ven 已提交
878
	mutex_unlock(&_event_lock);
L
Linus Torvalds 已提交
879 880 881 882 883 884 885 886 887
}

sector_t dm_table_get_size(struct dm_table *t)
{
	return t->num_targets ? (t->highs[t->num_targets - 1] + 1) : 0;
}

struct dm_target *dm_table_get_target(struct dm_table *t, unsigned int index)
{
888
	if (index >= t->num_targets)
L
Linus Torvalds 已提交
889 890 891 892 893 894 895
		return NULL;

	return t->targets + index;
}

/*
 * Search the btree for the correct target.
896 897 898
 *
 * Caller should check returned pointer with dm_target_is_valid()
 * to trap I/O beyond end of device.
L
Linus Torvalds 已提交
899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916
 */
struct dm_target *dm_table_find_target(struct dm_table *t, sector_t sector)
{
	unsigned int l, n = 0, k = 0;
	sector_t *node;

	for (l = 0; l < t->depth; l++) {
		n = get_child(n, k);
		node = get_node(t, l, n);

		for (k = 0; k < KEYS_PER_NODE; k++)
			if (node[k] >= sector)
				break;
	}

	return &t->targets[(KEYS_PER_NODE * n) + k];
}

M
Martin K. Petersen 已提交
917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955
/*
 * Set the integrity profile for this device if all devices used have
 * matching profiles.
 */
static void dm_table_set_integrity(struct dm_table *t)
{
	struct list_head *devices = dm_table_get_devices(t);
	struct dm_dev_internal *prev = NULL, *dd = NULL;

	if (!blk_get_integrity(dm_disk(t->md)))
		return;

	list_for_each_entry(dd, devices, list) {
		if (prev &&
		    blk_integrity_compare(prev->dm_dev.bdev->bd_disk,
					  dd->dm_dev.bdev->bd_disk) < 0) {
			DMWARN("%s: integrity not set: %s and %s mismatch",
			       dm_device_name(t->md),
			       prev->dm_dev.bdev->bd_disk->disk_name,
			       dd->dm_dev.bdev->bd_disk->disk_name);
			goto no_integrity;
		}
		prev = dd;
	}

	if (!prev || !bdev_get_integrity(prev->dm_dev.bdev))
		goto no_integrity;

	blk_integrity_register(dm_disk(t->md),
			       bdev_get_integrity(prev->dm_dev.bdev));

	return;

no_integrity:
	blk_integrity_register(dm_disk(t->md), NULL);

	return;
}

L
Linus Torvalds 已提交
956 957 958
void dm_table_set_restrictions(struct dm_table *t, struct request_queue *q)
{
	/*
959
	 * Copy table's limits to the DM device's request_queue
L
Linus Torvalds 已提交
960
	 */
961
	q->limits = t->limits;
962

963
	if (t->limits.no_cluster)
964
		queue_flag_clear_unlocked(QUEUE_FLAG_CLUSTER, q);
965
	else
966
		queue_flag_set_unlocked(QUEUE_FLAG_CLUSTER, q);
967

M
Martin K. Petersen 已提交
968
	dm_table_set_integrity(t);
L
Linus Torvalds 已提交
969 970 971 972 973 974 975 976 977 978 979 980
}

unsigned int dm_table_get_num_targets(struct dm_table *t)
{
	return t->num_targets;
}

struct list_head *dm_table_get_devices(struct dm_table *t)
{
	return &t->devices;
}

981
fmode_t dm_table_get_mode(struct dm_table *t)
L
Linus Torvalds 已提交
982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003
{
	return t->mode;
}

static void suspend_targets(struct dm_table *t, unsigned postsuspend)
{
	int i = t->num_targets;
	struct dm_target *ti = t->targets;

	while (i--) {
		if (postsuspend) {
			if (ti->type->postsuspend)
				ti->type->postsuspend(ti);
		} else if (ti->type->presuspend)
			ti->type->presuspend(ti);

		ti++;
	}
}

void dm_table_presuspend_targets(struct dm_table *t)
{
1004 1005 1006
	if (!t)
		return;

1007
	suspend_targets(t, 0);
L
Linus Torvalds 已提交
1008 1009 1010 1011
}

void dm_table_postsuspend_targets(struct dm_table *t)
{
1012 1013 1014
	if (!t)
		return;

1015
	suspend_targets(t, 1);
L
Linus Torvalds 已提交
1016 1017
}

1018
int dm_table_resume_targets(struct dm_table *t)
L
Linus Torvalds 已提交
1019
{
1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031
	int i, r = 0;

	for (i = 0; i < t->num_targets; i++) {
		struct dm_target *ti = t->targets + i;

		if (!ti->type->preresume)
			continue;

		r = ti->type->preresume(ti);
		if (r)
			return r;
	}
L
Linus Torvalds 已提交
1032 1033 1034 1035 1036 1037 1038

	for (i = 0; i < t->num_targets; i++) {
		struct dm_target *ti = t->targets + i;

		if (ti->type->resume)
			ti->type->resume(ti);
	}
1039 1040

	return 0;
L
Linus Torvalds 已提交
1041 1042 1043 1044
}

int dm_table_any_congested(struct dm_table *t, int bdi_bits)
{
M
Mikulas Patocka 已提交
1045
	struct dm_dev_internal *dd;
P
Paul Jimenez 已提交
1046
	struct list_head *devices = dm_table_get_devices(t);
L
Linus Torvalds 已提交
1047 1048
	int r = 0;

P
Paul Jimenez 已提交
1049
	list_for_each_entry(dd, devices, list) {
M
Mikulas Patocka 已提交
1050
		struct request_queue *q = bdev_get_queue(dd->dm_dev.bdev);
A
Alasdair G Kergon 已提交
1051 1052 1053 1054 1055 1056 1057 1058
		char b[BDEVNAME_SIZE];

		if (likely(q))
			r |= bdi_congested(&q->backing_dev_info, bdi_bits);
		else
			DMWARN_LIMIT("%s: any_congested: nonexistent device %s",
				     dm_device_name(t->md),
				     bdevname(dd->dm_dev.bdev, b));
L
Linus Torvalds 已提交
1059 1060 1061 1062 1063 1064 1065
	}

	return r;
}

void dm_table_unplug_all(struct dm_table *t)
{
M
Mikulas Patocka 已提交
1066
	struct dm_dev_internal *dd;
P
Paul Jimenez 已提交
1067
	struct list_head *devices = dm_table_get_devices(t);
L
Linus Torvalds 已提交
1068

P
Paul Jimenez 已提交
1069
	list_for_each_entry(dd, devices, list) {
M
Mikulas Patocka 已提交
1070
		struct request_queue *q = bdev_get_queue(dd->dm_dev.bdev);
A
Alasdair G Kergon 已提交
1071 1072 1073 1074 1075 1076 1077 1078
		char b[BDEVNAME_SIZE];

		if (likely(q))
			blk_unplug(q);
		else
			DMWARN_LIMIT("%s: Cannot unplug nonexistent device %s",
				     dm_device_name(t->md),
				     bdevname(dd->dm_dev.bdev, b));
L
Linus Torvalds 已提交
1079 1080 1081
	}
}

M
Mike Anderson 已提交
1082 1083 1084 1085 1086 1087 1088
struct mapped_device *dm_table_get_md(struct dm_table *t)
{
	dm_get(t->md);

	return t->md;
}

L
Linus Torvalds 已提交
1089 1090 1091 1092
EXPORT_SYMBOL(dm_vcalloc);
EXPORT_SYMBOL(dm_get_device);
EXPORT_SYMBOL(dm_put_device);
EXPORT_SYMBOL(dm_table_event);
1093
EXPORT_SYMBOL(dm_table_get_size);
L
Linus Torvalds 已提交
1094
EXPORT_SYMBOL(dm_table_get_mode);
M
Mike Anderson 已提交
1095
EXPORT_SYMBOL(dm_table_get_md);
L
Linus Torvalds 已提交
1096 1097 1098
EXPORT_SYMBOL(dm_table_put);
EXPORT_SYMBOL(dm_table_get);
EXPORT_SYMBOL(dm_table_unplug_all);