drivers/md/dm-table.c

   1 /*
   2  * Copyright (C) 2001 Sistina Software (UK) Limited.
   3  * Copyright (C) 2004-2008 Red Hat, Inc. All rights reserved.
   4  *
   5  * This file is released under the GPL.
   6  */
   7
   8 #include "dm.h"
   9
  10 #include <linux/module.h>
  11 #include <linux/vmalloc.h>
  12 #include <linux/blkdev.h>
  13 #include <linux/namei.h>
  14 #include <linux/ctype.h>
  15 #include <linux/string.h>
  16 #include <linux/slab.h>
  17 #include <linux/interrupt.h>
  18 #include <linux/mutex.h>
  19 #include <linux/delay.h>
  20 #include <asm/atomic.h>
  21
  22 #define DM_MSG_PREFIX "table"
  23
  24 #define MAX_DEPTH 16
  25 #define NODE_SIZE L1_CACHE_BYTES
  26 #define KEYS_PER_NODE (NODE_SIZE / sizeof(sector_t))
  27 #define CHILDREN_PER_NODE (KEYS_PER_NODE + 1)
  28
  29 /*
  30  * The table has always exactly one reference from either mapped_device->map
  31  * or hash_cell->new_map. This reference is not counted in table->holders.
  32  * A pair of dm_create_table/dm_destroy_table functions is used for table
  33  * creation/destruction.
  34  *
  35  * Temporary references from the other code increase table->holders. A pair
  36  * of dm_table_get/dm_table_put functions is used to manipulate it.
  37  *
  38  * When the table is about to be destroyed, we wait for table->holders to
  39  * drop to zero.
  40  */
  41
  42 struct dm_table {
  43         struct mapped_device *md;
  44         atomic_t holders;
  45         unsigned type;
  46
  47         /* btree table */
  48         unsigned int depth;
  49         unsigned int counts[MAX_DEPTH]; /* in nodes */
  50         sector_t *index[MAX_DEPTH];
  51
  52         unsigned int num_targets;
  53         unsigned int num_allocated;
  54         sector_t *highs;
  55         struct dm_target *targets;
  56
  57         unsigned discards_supported:1;
  58
  59         /*
  60          * Indicates the rw permissions for the new logical
  61          * device.  This should be a combination of FMODE_READ
  62          * and FMODE_WRITE.
  63          */
  64         fmode_t mode;
  65
  66         /* a list of devices used by this table */
  67         struct list_head devices;
  68
  69         /* events get handed up using this callback */
  70         void (*event_fn)(void *);
  71         void *event_context;
  72
  73         struct dm_md_mempools *mempools;
  74 };
  75
  76 /*
  77  * Similar to ceiling(log_size(n))
  78  */
  79 static unsigned int int_log(unsigned int n, unsigned int base)
  80 {
  81         int result = 0;
  82
  83         while (n > 1) {
  84                 n = dm_div_up(n, base);
  85                 result++;
  86         }
  87
  88         return result;
  89 }
  90
  91 /*
  92  * Calculate the index of the child node of the n'th node k'th key.
  93  */
  94 static inline unsigned int get_child(unsigned int n, unsigned int k)
  95 {
  96         return (n * CHILDREN_PER_NODE) + k;
  97 }
  98
  99 /*
 100  * Return the n'th node of level l from table t.
 101  */
 102 static inline sector_t *get_node(struct dm_table *t,
 103                                  unsigned int l, unsigned int n)
 104 {
 105         return t->index[l] + (n * KEYS_PER_NODE);
 106 }
 107
 108 /*
 109  * Return the highest key that you could lookup from the n'th
 110  * node on level l of the btree.
 111  */
 112 static sector_t high(struct dm_table *t, unsigned int l, unsigned int n)
 113 {
 114         for (; l < t->depth - 1; l++)
 115                 n = get_child(n, CHILDREN_PER_NODE - 1);
 116
 117         if (n >= t->counts[l])
 118                 return (sector_t) - 1;
 119
 120         return get_node(t, l, n)[KEYS_PER_NODE - 1];
 121 }
 122
 123 /*
 124  * Fills in a level of the btree based on the highs of the level
 125  * below it.
 126  */
 127 static int setup_btree_index(unsigned int l, struct dm_table *t)
 128 {
 129         unsigned int n, k;
 130         sector_t *node;
 131
 132         for (n = 0U; n < t->counts[l]; n++) {
 133                 node = get_node(t, l, n);
 134
 135                 for (k = 0U; k < KEYS_PER_NODE; k++)
 136                         node[k] = high(t, l + 1, get_child(n, k));
 137         }
 138
 139         return 0;
 140 }
 141
 142 void *dm_vcalloc(unsigned long nmemb, unsigned long elem_size)
 143 {
 144         unsigned long size;
 145         void *addr;
 146
 147         /*
 148          * Check that we're not going to overflow.
 149          */
 150         if (nmemb > (ULONG_MAX / elem_size))
 151                 return NULL;
 152
 153         size = nmemb * elem_size;
 154         addr = vmalloc(size);
 155         if (addr)
 156                 memset(addr, 0, size);
 157
 158         return addr;
 159 }
 160
 161 /*
 162  * highs, and targets are managed as dynamic arrays during a
 163  * table load.
 164  */
 165 static int alloc_targets(struct dm_table *t, unsigned int num)
 166 {
 167         sector_t *n_highs;
 168         struct dm_target *n_targets;
 169         int n = t->num_targets;
 170
 171         /*
 172          * Allocate both the target array and offset array at once.
 173          * Append an empty entry to catch sectors beyond the end of
 174          * the device.
 175          */
 176         n_highs = (sector_t *) dm_vcalloc(num + 1, sizeof(struct dm_target) +
 177                                           sizeof(sector_t));
 178         if (!n_highs)
 179                 return -ENOMEM;
 180
 181         n_targets = (struct dm_target *) (n_highs + num);
 182
 183         if (n) {
 184                 memcpy(n_highs, t->highs, sizeof(*n_highs) * n);
 185                 memcpy(n_targets, t->targets, sizeof(*n_targets) * n);
 186         }
 187
 188         memset(n_highs + n, -1, sizeof(*n_highs) * (num - n));
 189         vfree(t->highs);
 190
 191         t->num_allocated = num;
 192         t->highs = n_highs;
 193         t->targets = n_targets;
 194
 195         return 0;
 196 }
 197
 198 int dm_table_create(struct dm_table **result, fmode_t mode,
 199                     unsigned num_targets, struct mapped_device *md)
 200 {
 201         struct dm_table *t = kzalloc(sizeof(*t), GFP_KERNEL);
 202
 203         if (!t)
 204                 return -ENOMEM;
 205
 206         INIT_LIST_HEAD(&t->devices);
 207         atomic_set(&t->holders, 0);
 208         t->discards_supported = 1;
 209
 210         if (!num_targets)
 211                 num_targets = KEYS_PER_NODE;
 212
 213         num_targets = dm_round_up(num_targets, KEYS_PER_NODE);
 214
 215         if (alloc_targets(t, num_targets)) {
 216                 kfree(t);
 217                 t = NULL;
 218                 return -ENOMEM;
 219         }
 220
 221         t->mode = mode;
 222         t->md = md;
 223         *result = t;
 224         return 0;
 225 }
 226
 227 static void free_devices(struct list_head *devices)
 228 {
 229         struct list_head *tmp, *next;
 230
 231         list_for_each_safe(tmp, next, devices) {
 232                 struct dm_dev_internal *dd =
 233                     list_entry(tmp, struct dm_dev_internal, list);
 234                 DMWARN("dm_table_destroy: dm_put_device call missing for %s",
 235                        dd->dm_dev.name);
 236                 kfree(dd);
 237         }
 238 }
 239
 240 void dm_table_destroy(struct dm_table *t)
 241 {
 242         unsigned int i;
 243
 244         if (!t)
 245                 return;
 246
 247         while (atomic_read(&t->holders))
 248                 msleep(1);
 249         smp_mb();
 250
 251         /* free the indexes */
 252         if (t->depth >= 2)
 253                 vfree(t->index[t->depth - 2]);
 254
 255         /* free the targets */
 256         for (i = 0; i < t->num_targets; i++) {
 257                 struct dm_target *tgt = t->targets + i;
 258
 259                 if (tgt->type->dtr)
 260                         tgt->type->dtr(tgt);
 261
 262                 dm_put_target_type(tgt->type);
 263         }
 264
 265         vfree(t->highs);
 266
 267         /* free the device list */
 268         if (t->devices.next != &t->devices)
 269                 free_devices(&t->devices);
 270
 271         dm_free_md_mempools(t->mempools);
 272
 273         kfree(t);
 274 }
 275
 276 void dm_table_get(struct dm_table *t)
 277 {
 278         atomic_inc(&t->holders);
 279 }
 280
 281 void dm_table_put(struct dm_table *t)
 282 {
 283         if (!t)
 284                 return;
 285
 286         smp_mb__before_atomic_dec();
 287         atomic_dec(&t->holders);
 288 }
 289
 290 /*
 291  * Checks to see if we need to extend highs or targets.
 292  */
 293 static inline int check_space(struct dm_table *t)
 294 {
 295         if (t->num_targets >= t->num_allocated)
 296                 return alloc_targets(t, t->num_allocated * 2);
 297
 298         return 0;
 299 }
 300
 301 /*
 302  * See if we've already got a device in the list.
 303  */
 304 static struct dm_dev_internal *find_device(struct list_head *l, dev_t dev)
 305 {
 306         struct dm_dev_internal *dd;
 307
 308         list_for_each_entry (dd, l, list)
 309                 if (dd->dm_dev.bdev->bd_dev == dev)
 310                         return dd;
 311
 312         return NULL;
 313 }
 314
 315 /*
 316  * Open a device so we can use it as a map destination.
 317  */
 318 static int open_dev(struct dm_dev_internal *d, dev_t dev,
 319                     struct mapped_device *md)
 320 {
 321         static char *_claim_ptr = "I belong to device-mapper";
 322         struct block_device *bdev;
 323
 324         int r;
 325
 326         BUG_ON(d->dm_dev.bdev);
 327
 328         bdev = blkdev_get_by_dev(dev, d->dm_dev.mode | FMODE_EXCL, _claim_ptr);
 329         if (IS_ERR(bdev))
 330                 return PTR_ERR(bdev);
 331
 332         r = bd_link_disk_holder(bdev, dm_disk(md));
 333         if (r) {
 334                 blkdev_put(bdev, d->dm_dev.mode | FMODE_EXCL);
 335                 return r;
 336         }
 337
 338         d->dm_dev.bdev = bdev;
 339         return 0;
 340 }
 341
 342 /*
 343  * Close a device that we've been using.
 344  */
 345 static void close_dev(struct dm_dev_internal *d, struct mapped_device *md)
 346 {
 347         if (!d->dm_dev.bdev)
 348                 return;
 349
 350         blkdev_put(d->dm_dev.bdev, d->dm_dev.mode | FMODE_EXCL);
 351         d->dm_dev.bdev = NULL;
 352 }
 353
 354 /*
 355  * If possible, this checks an area of a destination device is invalid.
 356  */
 357 static int device_area_is_invalid(struct dm_target *ti, struct dm_dev *dev,
 358                                   sector_t start, sector_t len, void *data)
 359 {
 360         struct queue_limits *limits = data;
 361         struct block_device *bdev = dev->bdev;
 362         sector_t dev_size =
 363                 i_size_read(bdev->bd_inode) >> SECTOR_SHIFT;
 364         unsigned short logical_block_size_sectors =
 365                 limits->logical_block_size >> SECTOR_SHIFT;
 366         char b[BDEVNAME_SIZE];
 367
 368         if (!dev_size)
 369                 return 0;
 370
 371         if ((start >= dev_size) || (start + len > dev_size)) {
 372                 DMWARN("%s: %s too small for target: "
 373                        "start=%llu, len=%llu, dev_size=%llu",
 374                        dm_device_name(ti->table->md), bdevname(bdev, b),
 375                        (unsigned long long)start,
 376                        (unsigned long long)len,
 377                        (unsigned long long)dev_size);
 378                 return 1;
 379         }
 380
 381         if (logical_block_size_sectors <= 1)
 382                 return 0;
 383
 384         if (start & (logical_block_size_sectors - 1)) {
 385                 DMWARN("%s: start=%llu not aligned to h/w "
 386                        "logical block size %u of %s",
 387                        dm_device_name(ti->table->md),
 388                        (unsigned long long)start,
 389                        limits->logical_block_size, bdevname(bdev, b));
 390                 return 1;
 391         }
 392
 393         if (len & (logical_block_size_sectors - 1)) {
 394                 DMWARN("%s: len=%llu not aligned to h/w "
 395                        "logical block size %u of %s",
 396                        dm_device_name(ti->table->md),
 397                        (unsigned long long)len,
 398                        limits->logical_block_size, bdevname(bdev, b));
 399                 return 1;
 400         }
 401
 402         return 0;
 403 }
 404
 405 /*
 406  * This upgrades the mode on an already open dm_dev, being
 407  * careful to leave things as they were if we fail to reopen the
 408  * device and not to touch the existing bdev field in case
 409  * it is accessed concurrently inside dm_table_any_congested().
 410  */
 411 static int upgrade_mode(struct dm_dev_internal *dd, fmode_t new_mode,
 412                         struct mapped_device *md)
 413 {
 414         int r;
 415         struct dm_dev_internal dd_new, dd_old;
 416
 417         dd_new = dd_old = *dd;
 418
 419         dd_new.dm_dev.mode |= new_mode;
 420         dd_new.dm_dev.bdev = NULL;
 421
 422         r = open_dev(&dd_new, dd->dm_dev.bdev->bd_dev, md);
 423         if (r)
 424                 return r;
 425
 426         dd->dm_dev.mode |= new_mode;
 427         close_dev(&dd_old, md);
 428
 429         return 0;
 430 }
 431
 432 /*
 433  * Add a device to the list, or just increment the usage count if
 434  * it's already present.
 435  */
 436 static int __table_get_device(struct dm_table *t, struct dm_target *ti,
 437                       const char *path, fmode_t mode, struct dm_dev **result)
 438 {
 439         int r;
 440         dev_t uninitialized_var(dev);
 441         struct dm_dev_internal *dd;
 442         unsigned int major, minor;
 443
 444         BUG_ON(!t);
 445
 446         if (sscanf(path, "%u:%u", &major, &minor) == 2) {
 447                 /* Extract the major/minor numbers */
 448                 dev = MKDEV(major, minor);
 449                 if (MAJOR(dev) != major || MINOR(dev) != minor)
 450                         return -EOVERFLOW;
 451         } else {
 452                 /* convert the path to a device */
 453                 struct block_device *bdev = lookup_bdev(path);
 454
 455                 if (IS_ERR(bdev))
 456                         return PTR_ERR(bdev);
 457                 dev = bdev->bd_dev;
 458                 bdput(bdev);
 459         }
 460
 461         dd = find_device(&t->devices, dev);
 462         if (!dd) {
 463                 dd = kmalloc(sizeof(*dd), GFP_KERNEL);
 464                 if (!dd)
 465                         return -ENOMEM;
 466
 467                 dd->dm_dev.mode = mode;
 468                 dd->dm_dev.bdev = NULL;
 469
 470                 if ((r = open_dev(dd, dev, t->md))) {
 471                         kfree(dd);
 472                         return r;
 473                 }
 474
 475                 format_dev_t(dd->dm_dev.name, dev);
 476
 477                 atomic_set(&dd->count, 0);
 478                 list_add(&dd->list, &t->devices);
 479
 480         } else if (dd->dm_dev.mode != (mode | dd->dm_dev.mode)) {
 481                 r = upgrade_mode(dd, mode, t->md);
 482                 if (r)
 483                         return r;
 484         }
 485         atomic_inc(&dd->count);
 486
 487         *result = &dd->dm_dev;
 488         return 0;
 489 }
 490
 491 int dm_set_device_limits(struct dm_target *ti, struct dm_dev *dev,
 492                          sector_t start, sector_t len, void *data)
 493 {
 494         struct queue_limits *limits = data;
 495         struct block_device *bdev = dev->bdev;
 496         struct request_queue *q = bdev_get_queue(bdev);
 497         char b[BDEVNAME_SIZE];
 498
 499         if (unlikely(!q)) {
 500                 DMWARN("%s: Cannot set limits for nonexistent device %s",
 501                        dm_device_name(ti->table->md), bdevname(bdev, b));
 502                 return 0;
 503         }
 504
 505         if (bdev_stack_limits(limits, bdev, start) < 0)
 506                 DMWARN("%s: adding target device %s caused an alignment inconsistency: "
 507                        "physical_block_size=%u, logical_block_size=%u, "
 508                        "alignment_offset=%u, start=%llu",
 509                        dm_device_name(ti->table->md), bdevname(bdev, b),
 510                        q->limits.physical_block_size,
 511                        q->limits.logical_block_size,
 512                        q->limits.alignment_offset,
 513                        (unsigned long long) start << SECTOR_SHIFT);
 514
 515         /*
 516          * Check if merge fn is supported.
 517          * If not we'll force DM to use PAGE_SIZE or
 518          * smaller I/O, just to be safe.
 519          */
 520
 521         if (q->merge_bvec_fn && !ti->type->merge)
 522                 blk_limits_max_hw_sectors(limits,
 523                                           (unsigned int) (PAGE_SIZE >> 9));
 524         return 0;
 525 }
 526 EXPORT_SYMBOL_GPL(dm_set_device_limits);
 527
 528 int dm_get_device(struct dm_target *ti, const char *path, fmode_t mode,
 529                   struct dm_dev **result)
 530 {
 531         return __table_get_device(ti->table, ti, path, mode, result);
 532 }
 533
 534
 535 /*
 536  * Decrement a devices use count and remove it if necessary.
 537  */
 538 void dm_put_device(struct dm_target *ti, struct dm_dev *d)
 539 {
 540         struct dm_dev_internal *dd = container_of(d, struct dm_dev_internal,
 541                                                   dm_dev);
 542
 543         if (atomic_dec_and_test(&dd->count)) {
 544                 close_dev(dd, ti->table->md);
 545                 list_del(&dd->list);
 546                 kfree(dd);
 547         }
 548 }
 549
 550 /*
 551  * Checks to see if the target joins onto the end of the table.
 552  */
 553 static int adjoin(struct dm_table *table, struct dm_target *ti)
 554 {
 555         struct dm_target *prev;
 556
 557         if (!table->num_targets)
 558                 return !ti->begin;
 559
 560         prev = &table->targets[table->num_targets - 1];
 561         return (ti->begin == (prev->begin + prev->len));
 562 }
 563
 564 /*
 565  * Used to dynamically allocate the arg array.
 566  */
 567 static char **realloc_argv(unsigned *array_size, char **old_argv)
 568 {
 569         char **argv;
 570         unsigned new_size;
 571
 572         new_size = *array_size ? *array_size * 2 : 64;
 573         argv = kmalloc(new_size * sizeof(*argv), GFP_KERNEL);
 574         if (argv) {
 575                 memcpy(argv, old_argv, *array_size * sizeof(*argv));
 576                 *array_size = new_size;
 577         }
 578
 579         kfree(old_argv);
 580         return argv;
 581 }
 582
 583 /*
 584  * Destructively splits up the argument list to pass to ctr.
 585  */
 586 int dm_split_args(int *argc, char ***argvp, char *input)
 587 {
 588         char *start, *end = input, *out, **argv = NULL;
 589         unsigned array_size = 0;
 590
 591         *argc = 0;
 592
 593         if (!input) {
 594                 *argvp = NULL;
 595                 return 0;
 596         }
 597
 598         argv = realloc_argv(&array_size, argv);
 599         if (!argv)
 600                 return -ENOMEM;
 601
 602         while (1) {
 603                 /* Skip whitespace */
 604                 start = skip_spaces(end);
 605
 606                 if (!*start)
 607                         break;  /* success, we hit the end */
 608
 609                 /* 'out' is used to remove any back-quotes */
 610                 end = out = start;
 611                 while (*end) {
 612                         /* Everything apart from '\0' can be quoted */
 613                         if (*end == '\\' && *(end + 1)) {
 614                                 *out++ = *(end + 1);
 615                                 end += 2;
 616                                 continue;
 617                         }
 618
 619                         if (isspace(*end))
 620                                 break;  /* end of token */
 621
 622                         *out++ = *end++;
 623                 }
 624
 625                 /* have we already filled the array ? */
 626                 if ((*argc + 1) > array_size) {
 627                         argv = realloc_argv(&array_size, argv);
 628                         if (!argv)
 629                                 return -ENOMEM;
 630                 }
 631
 632                 /* we know this is whitespace */
 633                 if (*end)
 634                         end++;
 635
 636                 /* terminate the string and put it in the array */
 637                 *out = '\0';
 638                 argv[*argc] = start;
 639                 (*argc)++;
 640         }
 641
 642         *argvp = argv;
 643         return 0;
 644 }
 645
 646 /*
 647  * Impose necessary and sufficient conditions on a devices's table such
 648  * that any incoming bio which respects its logical_block_size can be
 649  * processed successfully.  If it falls across the boundary between
 650  * two or more targets, the size of each piece it gets split into must
 651  * be compatible with the logical_block_size of the target processing it.
 652  */
 653 static int validate_hardware_logical_block_alignment(struct dm_table *table,
 654                                                  struct queue_limits *limits)
 655 {
 656         /*
 657          * This function uses arithmetic modulo the logical_block_size
 658          * (in units of 512-byte sectors).
 659          */
 660         unsigned short device_logical_block_size_sects =
 661                 limits->logical_block_size >> SECTOR_SHIFT;
 662
 663         /*
 664          * Offset of the start of the next table entry, mod logical_block_size.
 665          */
 666         unsigned short next_target_start = 0;
 667
 668         /*
 669          * Given an aligned bio that extends beyond the end of a
 670          * target, how many sectors must the next target handle?
 671          */
 672         unsigned short remaining = 0;
 673
 674         struct dm_target *uninitialized_var(ti);
 675         struct queue_limits ti_limits;
 676         unsigned i = 0;
 677
 678         /*
 679          * Check each entry in the table in turn.
 680          */
 681         while (i < dm_table_get_num_targets(table)) {
 682                 ti = dm_table_get_target(table, i++);
 683
 684                 blk_set_default_limits(&ti_limits);
 685
 686                 /* combine all target devices' limits */
 687                 if (ti->type->iterate_devices)
 688                         ti->type->iterate_devices(ti, dm_set_device_limits,
 689                                                   &ti_limits);
 690
 691                 /*
 692                  * If the remaining sectors fall entirely within this
 693                  * table entry are they compatible with its logical_block_size?
 694                  */
 695                 if (remaining < ti->len &&
 696                     remaining & ((ti_limits.logical_block_size >>
 697                                   SECTOR_SHIFT) - 1))
 698                         break;  /* Error */
 699
 700                 next_target_start =
 701                     (unsigned short) ((next_target_start + ti->len) &
 702                                       (device_logical_block_size_sects - 1));
 703                 remaining = next_target_start ?
 704                     device_logical_block_size_sects - next_target_start : 0;
 705         }
 706
 707         if (remaining) {
 708                 DMWARN("%s: table line %u (start sect %llu len %llu) "
 709                        "not aligned to h/w logical block size %u",
 710                        dm_device_name(table->md), i,
 711                        (unsigned long long) ti->begin,
 712                        (unsigned long long) ti->len,
 713                        limits->logical_block_size);
 714                 return -EINVAL;
 715         }
 716
 717         return 0;
 718 }
 719
 720 int dm_table_add_target(struct dm_table *t, const char *type,
 721                         sector_t start, sector_t len, char *params)
 722 {
 723         int r = -EINVAL, argc;
 724         char **argv;
 725         struct dm_target *tgt;
 726
 727         if ((r = check_space(t)))
 728                 return r;
 729
 730         tgt = t->targets + t->num_targets;
 731         memset(tgt, 0, sizeof(*tgt));
 732
 733         if (!len) {
 734                 DMERR("%s: zero-length target", dm_device_name(t->md));
 735                 return -EINVAL;
 736         }
 737
 738         tgt->type = dm_get_target_type(type);
 739         if (!tgt->type) {
 740                 DMERR("%s: %s: unknown target type", dm_device_name(t->md),
 741                       type);
 742                 return -EINVAL;
 743         }
 744
 745         tgt->table = t;
 746         tgt->begin = start;
 747         tgt->len = len;
 748         tgt->error = "Unknown error";
 749
 750         /*
 751          * Does this target adjoin the previous one ?
 752          */
 753         if (!adjoin(t, tgt)) {
 754                 tgt->error = "Gap in table";
 755                 r = -EINVAL;
 756                 goto bad;
 757         }
 758
 759         r = dm_split_args(&argc, &argv, params);
 760         if (r) {
 761                 tgt->error = "couldn't split parameters (insufficient memory)";
 762                 goto bad;
 763         }
 764
 765         r = tgt->type->ctr(tgt, argc, argv);
 766         kfree(argv);
 767         if (r)
 768                 goto bad;
 769
 770         t->highs[t->num_targets++] = tgt->begin + tgt->len - 1;
 771
 772         if (!tgt->num_discard_requests)
 773                 t->discards_supported = 0;
 774
 775         return 0;
 776
 777  bad:
 778         DMERR("%s: %s: %s", dm_device_name(t->md), type, tgt->error);
 779         dm_put_target_type(tgt->type);
 780         return r;
 781 }
 782
 783 static int dm_table_set_type(struct dm_table *t)
 784 {
 785         unsigned i;
 786         unsigned bio_based = 0, request_based = 0;
 787         struct dm_target *tgt;
 788         struct dm_dev_internal *dd;
 789         struct list_head *devices;
 790
 791         for (i = 0; i < t->num_targets; i++) {
 792                 tgt = t->targets + i;
 793                 if (dm_target_request_based(tgt))
 794                         request_based = 1;
 795                 else
 796                         bio_based = 1;
 797
 798                 if (bio_based && request_based) {
 799                         DMWARN("Inconsistent table: different target types"
 800                                " can't be mixed up");
 801                         return -EINVAL;
 802                 }
 803         }
 804
 805         if (bio_based) {
 806                 /* We must use this table as bio-based */
 807                 t->type = DM_TYPE_BIO_BASED;
 808                 return 0;
 809         }
 810
 811         BUG_ON(!request_based); /* No targets in this table */
 812
 813         /* Non-request-stackable devices can't be used for request-based dm */
 814         devices = dm_table_get_devices(t);
 815         list_for_each_entry(dd, devices, list) {
 816                 if (!blk_queue_stackable(bdev_get_queue(dd->dm_dev.bdev))) {
 817                         DMWARN("table load rejected: including"
 818                                " non-request-stackable devices");
 819                         return -EINVAL;
 820                 }
 821         }
 822
 823         /*
 824          * Request-based dm supports only tables that have a single target now.
 825          * To support multiple targets, request splitting support is needed,
 826          * and that needs lots of changes in the block-layer.
 827          * (e.g. request completion process for partial completion.)
 828          */
 829         if (t->num_targets > 1) {
 830                 DMWARN("Request-based dm doesn't support multiple targets yet");
 831                 return -EINVAL;
 832         }
 833
 834         t->type = DM_TYPE_REQUEST_BASED;
 835
 836         return 0;
 837 }
 838
 839 unsigned dm_table_get_type(struct dm_table *t)
 840 {
 841         return t->type;
 842 }
 843
 844 bool dm_table_request_based(struct dm_table *t)
 845 {
 846         return dm_table_get_type(t) == DM_TYPE_REQUEST_BASED;
 847 }
 848
 849 int dm_table_alloc_md_mempools(struct dm_table *t)
 850 {
 851         unsigned type = dm_table_get_type(t);
 852
 853         if (unlikely(type == DM_TYPE_NONE)) {
 854                 DMWARN("no table type is set, can't allocate mempools");
 855                 return -EINVAL;
 856         }
 857
 858         t->mempools = dm_alloc_md_mempools(type);
 859         if (!t->mempools)
 860                 return -ENOMEM;
 861
 862         return 0;
 863 }
 864
 865 void dm_table_free_md_mempools(struct dm_table *t)
 866 {
 867         dm_free_md_mempools(t->mempools);
 868         t->mempools = NULL;
 869 }
 870
 871 struct dm_md_mempools *dm_table_get_md_mempools(struct dm_table *t)
 872 {
 873         return t->mempools;
 874 }
 875
 876 static int setup_indexes(struct dm_table *t)
 877 {
 878         int i;
 879         unsigned int total = 0;
 880         sector_t *indexes;
 881
 882         /* allocate the space for *all* the indexes */
 883         for (i = t->depth - 2; i >= 0; i--) {
 884                 t->counts[i] = dm_div_up(t->counts[i + 1], CHILDREN_PER_NODE);
 885                 total += t->counts[i];
 886         }
 887
 888         indexes = (sector_t *) dm_vcalloc(total, (unsigned long) NODE_SIZE);
 889         if (!indexes)
 890                 return -ENOMEM;
 891
 892         /* set up internal nodes, bottom-up */
 893         for (i = t->depth - 2; i >= 0; i--) {
 894                 t->index[i] = indexes;
 895                 indexes += (KEYS_PER_NODE * t->counts[i]);
 896                 setup_btree_index(i, t);
 897         }
 898
 899         return 0;
 900 }
 901
 902 /*
 903  * Builds the btree to index the map.
 904  */
 905 static int dm_table_build_index(struct dm_table *t)
 906 {
 907         int r = 0;
 908         unsigned int leaf_nodes;
 909
 910         /* how many indexes will the btree have ? */
 911         leaf_nodes = dm_div_up(t->num_targets, KEYS_PER_NODE);
 912         t->depth = 1 + int_log(leaf_nodes, CHILDREN_PER_NODE);
 913
 914         /* leaf layer has already been set up */
 915         t->counts[t->depth - 1] = leaf_nodes;
 916         t->index[t->depth - 1] = t->highs;
 917
 918         if (t->depth >= 2)
 919                 r = setup_indexes(t);
 920
 921         return r;
 922 }
 923
 924 /*
 925  * Register the mapped device for blk_integrity support if
 926  * the underlying devices support it.
 927  */
 928 static int dm_table_prealloc_integrity(struct dm_table *t, struct mapped_device *md)
 929 {
 930         struct list_head *devices = dm_table_get_devices(t);
 931         struct dm_dev_internal *dd;
 932
 933         list_for_each_entry(dd, devices, list)
 934                 if (bdev_get_integrity(dd->dm_dev.bdev))
 935                         return blk_integrity_register(dm_disk(md), NULL);
 936
 937         return 0;
 938 }
 939
 940 /*
 941  * Prepares the table for use by building the indices,
 942  * setting the type, and allocating mempools.
 943  */
 944 int dm_table_complete(struct dm_table *t)
 945 {
 946         int r;
 947
 948         r = dm_table_set_type(t);
 949         if (r) {
 950                 DMERR("unable to set table type");
 951                 return r;
 952         }
 953
 954         r = dm_table_build_index(t);
 955         if (r) {
 956                 DMERR("unable to build btrees");
 957                 return r;
 958         }
 959
 960         r = dm_table_prealloc_integrity(t, t->md);
 961         if (r) {
 962                 DMERR("could not register integrity profile.");
 963                 return r;
 964         }
 965
 966         r = dm_table_alloc_md_mempools(t);
 967         if (r)
 968                 DMERR("unable to allocate mempools");
 969
 970         return r;
 971 }
 972
 973 static DEFINE_MUTEX(_event_lock);
 974 void dm_table_event_callback(struct dm_table *t,
 975                              void (*fn)(void *), void *context)
 976 {
 977         mutex_lock(&_event_lock);
 978         t->event_fn = fn;
 979         t->event_context = context;
 980         mutex_unlock(&_event_lock);
 981 }
 982
 983 void dm_table_event(struct dm_table *t)
 984 {
 985         /*
 986          * You can no longer call dm_table_event() from interrupt
 987          * context, use a bottom half instead.
 988          */
 989         BUG_ON(in_interrupt());
 990
 991         mutex_lock(&_event_lock);
 992         if (t->event_fn)
 993                 t->event_fn(t->event_context);
 994         mutex_unlock(&_event_lock);
 995 }
 996
 997 sector_t dm_table_get_size(struct dm_table *t)
 998 {
 999         return t->num_targets ? (t->highs[t->num_targets - 1] + 1) : 0;
1000 }
1001
1002 struct dm_target *dm_table_get_target(struct dm_table *t, unsigned int index)
1003 {
1004         if (index >= t->num_targets)
1005                 return NULL;
1006
1007         return t->targets + index;
1008 }
1009
1010 /*
1011  * Search the btree for the correct target.
1012  *
1013  * Caller should check returned pointer with dm_target_is_valid()
1014  * to trap I/O beyond end of device.
1015  */
1016 struct dm_target *dm_table_find_target(struct dm_table *t, sector_t sector)
1017 {
1018         unsigned int l, n = 0, k = 0;
1019         sector_t *node;
1020
1021         for (l = 0; l < t->depth; l++) {
1022                 n = get_child(n, k);
1023                 node = get_node(t, l, n);
1024
1025                 for (k = 0; k < KEYS_PER_NODE; k++)
1026                         if (node[k] >= sector)
1027                                 break;
1028         }
1029
1030         return &t->targets[(KEYS_PER_NODE * n) + k];
1031 }
1032
1033 /*
1034  * Establish the new table's queue_limits and validate them.
1035  */
1036 int dm_calculate_queue_limits(struct dm_table *table,
1037                               struct queue_limits *limits)
1038 {
1039         struct dm_target *uninitialized_var(ti);
1040         struct queue_limits ti_limits;
1041         unsigned i = 0;
1042
1043         blk_set_default_limits(limits);
1044
1045         while (i < dm_table_get_num_targets(table)) {
1046                 blk_set_default_limits(&ti_limits);
1047
1048                 ti = dm_table_get_target(table, i++);
1049
1050                 if (!ti->type->iterate_devices)
1051                         goto combine_limits;
1052
1053                 /*
1054                  * Combine queue limits of all the devices this target uses.
1055                  */
1056                 ti->type->iterate_devices(ti, dm_set_device_limits,
1057                                           &ti_limits);
1058
1059                 /* Set I/O hints portion of queue limits */
1060                 if (ti->type->io_hints)
1061                         ti->type->io_hints(ti, &ti_limits);
1062
1063                 /*
1064                  * Check each device area is consistent with the target's
1065                  * overall queue limits.
1066                  */
1067                 if (ti->type->iterate_devices(ti, device_area_is_invalid,
1068                                               &ti_limits))
1069                         return -EINVAL;
1070
1071 combine_limits:
1072                 /*
1073                  * Merge this target's queue limits into the overall limits
1074                  * for the table.
1075                  */
1076                 if (blk_stack_limits(limits, &ti_limits, 0) < 0)
1077                         DMWARN("%s: adding target device "
1078                                "(start sect %llu len %llu) "
1079                                "caused an alignment inconsistency",
1080                                dm_device_name(table->md),
1081                                (unsigned long long) ti->begin,
1082                                (unsigned long long) ti->len);
1083         }
1084
1085         return validate_hardware_logical_block_alignment(table, limits);
1086 }
1087
1088 /*
1089  * Set the integrity profile for this device if all devices used have
1090  * matching profiles.
1091  */
1092 static void dm_table_set_integrity(struct dm_table *t)
1093 {
1094         struct list_head *devices = dm_table_get_devices(t);
1095         struct dm_dev_internal *prev = NULL, *dd = NULL;
1096
1097         if (!blk_get_integrity(dm_disk(t->md)))
1098                 return;
1099
1100         list_for_each_entry(dd, devices, list) {
1101                 if (prev &&
1102                     blk_integrity_compare(prev->dm_dev.bdev->bd_disk,
1103                                           dd->dm_dev.bdev->bd_disk) < 0) {
1104                         DMWARN("%s: integrity not set: %s and %s mismatch",
1105                                dm_device_name(t->md),
1106                                prev->dm_dev.bdev->bd_disk->disk_name,
1107                                dd->dm_dev.bdev->bd_disk->disk_name);
1108                         goto no_integrity;
1109                 }
1110                 prev = dd;
1111         }
1112
1113         if (!prev || !bdev_get_integrity(prev->dm_dev.bdev))
1114                 goto no_integrity;
1115
1116         blk_integrity_register(dm_disk(t->md),
1117                                bdev_get_integrity(prev->dm_dev.bdev));
1118
1119         return;
1120
1121 no_integrity:
1122         blk_integrity_register(dm_disk(t->md), NULL);
1123
1124         return;
1125 }
1126
1127 void dm_table_set_restrictions(struct dm_table *t, struct request_queue *q,
1128                                struct queue_limits *limits)
1129 {
1130         /*
1131          * Copy table's limits to the DM device's request_queue
1132          */
1133         q->limits = *limits;
1134
1135         if (!dm_table_supports_discards(t))
1136                 queue_flag_clear_unlocked(QUEUE_FLAG_DISCARD, q);
1137         else
1138                 queue_flag_set_unlocked(QUEUE_FLAG_DISCARD, q);
1139
1140         dm_table_set_integrity(t);
1141
1142         /*
1143          * QUEUE_FLAG_STACKABLE must be set after all queue settings are
1144          * visible to other CPUs because, once the flag is set, incoming bios
1145          * are processed by request-based dm, which refers to the queue
1146          * settings.
1147          * Until the flag set, bios are passed to bio-based dm and queued to
1148          * md->deferred where queue settings are not needed yet.
1149          * Those bios are passed to request-based dm at the resume time.
1150          */
1151         smp_mb();
1152         if (dm_table_request_based(t))
1153                 queue_flag_set_unlocked(QUEUE_FLAG_STACKABLE, q);
1154 }
1155
1156 unsigned int dm_table_get_num_targets(struct dm_table *t)
1157 {
1158         return t->num_targets;
1159 }
1160
1161 struct list_head *dm_table_get_devices(struct dm_table *t)
1162 {
1163         return &t->devices;
1164 }
1165
1166 fmode_t dm_table_get_mode(struct dm_table *t)
1167 {
1168         return t->mode;
1169 }
1170
1171 static void suspend_targets(struct dm_table *t, unsigned postsuspend)
1172 {
1173         int i = t->num_targets;
1174         struct dm_target *ti = t->targets;
1175
1176         while (i--) {
1177                 if (postsuspend) {
1178                         if (ti->type->postsuspend)
1179                                 ti->type->postsuspend(ti);
1180                 } else if (ti->type->presuspend)
1181                         ti->type->presuspend(ti);
1182
1183                 ti++;
1184         }
1185 }
1186
1187 void dm_table_presuspend_targets(struct dm_table *t)
1188 {
1189         if (!t)
1190                 return;
1191
1192         suspend_targets(t, 0);
1193 }
1194
1195 void dm_table_postsuspend_targets(struct dm_table *t)
1196 {
1197         if (!t)
1198                 return;
1199
1200         suspend_targets(t, 1);
1201 }
1202
1203 int dm_table_resume_targets(struct dm_table *t)
1204 {
1205         int i, r = 0;
1206
1207         for (i = 0; i < t->num_targets; i++) {
1208                 struct dm_target *ti = t->targets + i;
1209
1210                 if (!ti->type->preresume)
1211                         continue;
1212
1213                 r = ti->type->preresume(ti);
1214                 if (r)
1215                         return r;
1216         }
1217
1218         for (i = 0; i < t->num_targets; i++) {
1219                 struct dm_target *ti = t->targets + i;
1220
1221                 if (ti->type->resume)
1222                         ti->type->resume(ti);
1223         }
1224
1225         return 0;
1226 }
1227
1228 int dm_table_any_congested(struct dm_table *t, int bdi_bits)
1229 {
1230         struct dm_dev_internal *dd;
1231         struct list_head *devices = dm_table_get_devices(t);
1232         int r = 0;
1233
1234         list_for_each_entry(dd, devices, list) {
1235                 struct request_queue *q = bdev_get_queue(dd->dm_dev.bdev);
1236                 char b[BDEVNAME_SIZE];
1237
1238                 if (likely(q))
1239                         r |= bdi_congested(&q->backing_dev_info, bdi_bits);
1240                 else
1241                         DMWARN_LIMIT("%s: any_congested: nonexistent device %s",
1242                                      dm_device_name(t->md),
1243                                      bdevname(dd->dm_dev.bdev, b));
1244         }
1245
1246         return r;
1247 }
1248
1249 int dm_table_any_busy_target(struct dm_table *t)
1250 {
1251         unsigned i;
1252         struct dm_target *ti;
1253
1254         for (i = 0; i < t->num_targets; i++) {
1255                 ti = t->targets + i;
1256                 if (ti->type->busy && ti->type->busy(ti))
1257                         return 1;
1258         }
1259
1260         return 0;
1261 }
1262
1263 void dm_table_unplug_all(struct dm_table *t)
1264 {
1265         struct dm_dev_internal *dd;
1266         struct list_head *devices = dm_table_get_devices(t);
1267
1268         list_for_each_entry(dd, devices, list) {
1269                 struct request_queue *q = bdev_get_queue(dd->dm_dev.bdev);
1270                 char b[BDEVNAME_SIZE];
1271
1272                 if (likely(q))
1273                         blk_unplug(q);
1274                 else
1275                         DMWARN_LIMIT("%s: Cannot unplug nonexistent device %s",
1276                                      dm_device_name(t->md),
1277                                      bdevname(dd->dm_dev.bdev, b));
1278         }
1279 }
1280
1281 struct mapped_device *dm_table_get_md(struct dm_table *t)
1282 {
1283         return t->md;
1284 }
1285
1286 static int device_discard_capable(struct dm_target *ti, struct dm_dev *dev,
1287                                   sector_t start, sector_t len, void *data)
1288 {
1289         struct request_queue *q = bdev_get_queue(dev->bdev);
1290
1291         return q && blk_queue_discard(q);
1292 }
1293
1294 bool dm_table_supports_discards(struct dm_table *t)
1295 {
1296         struct dm_target *ti;
1297         unsigned i = 0;
1298
1299         if (!t->discards_supported)
1300                 return 0;
1301
1302         /*
1303          * Ensure that at least one underlying device supports discards.
1304          * t->devices includes internal dm devices such as mirror logs
1305          * so we need to use iterate_devices here, which targets
1306          * supporting discard must provide.
1307          */
1308         while (i < dm_table_get_num_targets(t)) {
1309                 ti = dm_table_get_target(t, i++);
1310
1311                 if (ti->type->iterate_devices &&
1312                     ti->type->iterate_devices(ti, device_discard_capable, NULL))
1313                         return 1;
1314         }
1315
1316         return 0;
1317 }
1318
1319 EXPORT_SYMBOL(dm_vcalloc);
1320 EXPORT_SYMBOL(dm_get_device);
1321 EXPORT_SYMBOL(dm_put_device);
1322 EXPORT_SYMBOL(dm_table_event);
1323 EXPORT_SYMBOL(dm_table_get_size);
1324 EXPORT_SYMBOL(dm_table_get_mode);
1325 EXPORT_SYMBOL(dm_table_get_md);
1326 EXPORT_SYMBOL(dm_table_put);
1327 EXPORT_SYMBOL(dm_table_get);
1328 EXPORT_SYMBOL(dm_table_unplug_all);