kernel/resource.c

   1 /*
   2  *      linux/kernel/resource.c
   3  *
   4  * Copyright (C) 1999   Linus Torvalds
   5  * Copyright (C) 1999   Martin Mares <mj@ucw.cz>
   6  *
   7  * Arbitrary resource management.
   8  */
   9
  10 #include <linux/module.h>
  11 #include <linux/errno.h>
  12 #include <linux/ioport.h>
  13 #include <linux/init.h>
  14 #include <linux/slab.h>
  15 #include <linux/spinlock.h>
  16 #include <linux/fs.h>
  17 #include <linux/proc_fs.h>
  18 #include <linux/sched.h>
  19 #include <linux/seq_file.h>
  20 #include <linux/device.h>
  21 #include <linux/pfn.h>
  22 #include <asm/io.h>
  23
  24
  25 struct resource ioport_resource = {
  26         .name   = "PCI IO",
  27         .start  = 0,
  28         .end    = IO_SPACE_LIMIT,
  29         .flags  = IORESOURCE_IO,
  30 };
  31 EXPORT_SYMBOL(ioport_resource);
  32
  33 struct resource iomem_resource = {
  34         .name   = "PCI mem",
  35         .start  = 0,
  36         .end    = -1,
  37         .flags  = IORESOURCE_MEM,
  38 };
  39 EXPORT_SYMBOL(iomem_resource);
  40
  41 static DEFINE_RWLOCK(resource_lock);
  42
  43 /*
  44  * By default, we allocate free space bottom-up.  The architecture can request
  45  * top-down by clearing this flag.  The user can override the architecture's
  46  * choice with the "resource_alloc_from_bottom" kernel boot option, but that
  47  * should only be a debugging tool.
  48  */
  49 int resource_alloc_from_bottom = 1;
  50
  51 static __init int setup_alloc_from_bottom(char *s)
  52 {
  53         printk(KERN_INFO
  54                "resource: allocating from bottom-up; please report a bug\n");
  55         resource_alloc_from_bottom = 1;
  56         return 0;
  57 }
  58 early_param("resource_alloc_from_bottom", setup_alloc_from_bottom);
  59
  60 static void *r_next(struct seq_file *m, void *v, loff_t *pos)
  61 {
  62         struct resource *p = v;
  63         (*pos)++;
  64         if (p->child)
  65                 return p->child;
  66         while (!p->sibling && p->parent)
  67                 p = p->parent;
  68         return p->sibling;
  69 }
  70
  71 #ifdef CONFIG_PROC_FS
  72
  73 enum { MAX_IORES_LEVEL = 5 };
  74
  75 static void *r_start(struct seq_file *m, loff_t *pos)
  76         __acquires(resource_lock)
  77 {
  78         struct resource *p = m->private;
  79         loff_t l = 0;
  80         read_lock(&resource_lock);
  81         for (p = p->child; p && l < *pos; p = r_next(m, p, &l))
  82                 ;
  83         return p;
  84 }
  85
  86 static void r_stop(struct seq_file *m, void *v)
  87         __releases(resource_lock)
  88 {
  89         read_unlock(&resource_lock);
  90 }
  91
  92 static int r_show(struct seq_file *m, void *v)
  93 {
  94         struct resource *root = m->private;
  95         struct resource *r = v, *p;
  96         int width = root->end < 0x10000 ? 4 : 8;
  97         int depth;
  98
  99         for (depth = 0, p = r; depth < MAX_IORES_LEVEL; depth++, p = p->parent)
 100                 if (p->parent == root)
 101                         break;
 102         seq_printf(m, "%*s%0*llx-%0*llx : %s\n",
 103                         depth * 2, "",
 104                         width, (unsigned long long) r->start,
 105                         width, (unsigned long long) r->end,
 106                         r->name ? r->name : "<BAD>");
 107         return 0;
 108 }
 109
 110 static const struct seq_operations resource_op = {
 111         .start  = r_start,
 112         .next   = r_next,
 113         .stop   = r_stop,
 114         .show   = r_show,
 115 };
 116
 117 static int ioports_open(struct inode *inode, struct file *file)
 118 {
 119         int res = seq_open(file, &resource_op);
 120         if (!res) {
 121                 struct seq_file *m = file->private_data;
 122                 m->private = &ioport_resource;
 123         }
 124         return res;
 125 }
 126
 127 static int iomem_open(struct inode *inode, struct file *file)
 128 {
 129         int res = seq_open(file, &resource_op);
 130         if (!res) {
 131                 struct seq_file *m = file->private_data;
 132                 m->private = &iomem_resource;
 133         }
 134         return res;
 135 }
 136
 137 static const struct file_operations proc_ioports_operations = {
 138         .open           = ioports_open,
 139         .read           = seq_read,
 140         .llseek         = seq_lseek,
 141         .release        = seq_release,
 142 };
 143
 144 static const struct file_operations proc_iomem_operations = {
 145         .open           = iomem_open,
 146         .read           = seq_read,
 147         .llseek         = seq_lseek,
 148         .release        = seq_release,
 149 };
 150
 151 static int __init ioresources_init(void)
 152 {
 153         proc_create("ioports", 0, NULL, &proc_ioports_operations);
 154         proc_create("iomem", 0, NULL, &proc_iomem_operations);
 155         return 0;
 156 }
 157 __initcall(ioresources_init);
 158
 159 #endif /* CONFIG_PROC_FS */
 160
 161 /* Return the conflict entry if you can't request it */
 162 static struct resource * __request_resource(struct resource *root, struct resource *new)
 163 {
 164         resource_size_t start = new->start;
 165         resource_size_t end = new->end;
 166         struct resource *tmp, **p;
 167
 168         if (end < start)
 169                 return root;
 170         if (start < root->start)
 171                 return root;
 172         if (end > root->end)
 173                 return root;
 174         p = &root->child;
 175         for (;;) {
 176                 tmp = *p;
 177                 if (!tmp || tmp->start > end) {
 178                         new->sibling = tmp;
 179                         *p = new;
 180                         new->parent = root;
 181                         return NULL;
 182                 }
 183                 p = &tmp->sibling;
 184                 if (tmp->end < start)
 185                         continue;
 186                 return tmp;
 187         }
 188 }
 189
 190 static int __release_resource(struct resource *old)
 191 {
 192         struct resource *tmp, **p;
 193
 194         p = &old->parent->child;
 195         for (;;) {
 196                 tmp = *p;
 197                 if (!tmp)
 198                         break;
 199                 if (tmp == old) {
 200                         *p = tmp->sibling;
 201                         old->parent = NULL;
 202                         return 0;
 203                 }
 204                 p = &tmp->sibling;
 205         }
 206         return -EINVAL;
 207 }
 208
 209 static void __release_child_resources(struct resource *r)
 210 {
 211         struct resource *tmp, *p;
 212         resource_size_t size;
 213
 214         p = r->child;
 215         r->child = NULL;
 216         while (p) {
 217                 tmp = p;
 218                 p = p->sibling;
 219
 220                 tmp->parent = NULL;
 221                 tmp->sibling = NULL;
 222                 __release_child_resources(tmp);
 223
 224                 printk(KERN_DEBUG "release child resource %pR\n", tmp);
 225                 /* need to restore size, and keep flags */
 226                 size = resource_size(tmp);
 227                 tmp->start = 0;
 228                 tmp->end = size - 1;
 229         }
 230 }
 231
 232 void release_child_resources(struct resource *r)
 233 {
 234         write_lock(&resource_lock);
 235         __release_child_resources(r);
 236         write_unlock(&resource_lock);
 237 }
 238
 239 /**
 240  * request_resource_conflict - request and reserve an I/O or memory resource
 241  * @root: root resource descriptor
 242  * @new: resource descriptor desired by caller
 243  *
 244  * Returns 0 for success, conflict resource on error.
 245  */
 246 struct resource *request_resource_conflict(struct resource *root, struct resource *new)
 247 {
 248         struct resource *conflict;
 249
 250         write_lock(&resource_lock);
 251         conflict = __request_resource(root, new);
 252         write_unlock(&resource_lock);
 253         return conflict;
 254 }
 255
 256 /**
 257  * request_resource - request and reserve an I/O or memory resource
 258  * @root: root resource descriptor
 259  * @new: resource descriptor desired by caller
 260  *
 261  * Returns 0 for success, negative error code on error.
 262  */
 263 int request_resource(struct resource *root, struct resource *new)
 264 {
 265         struct resource *conflict;
 266
 267         conflict = request_resource_conflict(root, new);
 268         return conflict ? -EBUSY : 0;
 269 }
 270
 271 EXPORT_SYMBOL(request_resource);
 272
 273 /**
 274  * release_resource - release a previously reserved resource
 275  * @old: resource pointer
 276  */
 277 int release_resource(struct resource *old)
 278 {
 279         int retval;
 280
 281         write_lock(&resource_lock);
 282         retval = __release_resource(old);
 283         write_unlock(&resource_lock);
 284         return retval;
 285 }
 286
 287 EXPORT_SYMBOL(release_resource);
 288
 289 #if !defined(CONFIG_ARCH_HAS_WALK_MEMORY)
 290 /*
 291  * Finds the lowest memory reosurce exists within [res->start.res->end)
 292  * the caller must specify res->start, res->end, res->flags and "name".
 293  * If found, returns 0, res is overwritten, if not found, returns -1.
 294  */
 295 static int find_next_system_ram(struct resource *res, char *name)
 296 {
 297         resource_size_t start, end;
 298         struct resource *p;
 299
 300         BUG_ON(!res);
 301
 302         start = res->start;
 303         end = res->end;
 304         BUG_ON(start >= end);
 305
 306         read_lock(&resource_lock);
 307         for (p = iomem_resource.child; p ; p = p->sibling) {
 308                 /* system ram is just marked as IORESOURCE_MEM */
 309                 if (p->flags != res->flags)
 310                         continue;
 311                 if (name && strcmp(p->name, name))
 312                         continue;
 313                 if (p->start > end) {
 314                         p = NULL;
 315                         break;
 316                 }
 317                 if ((p->end >= start) && (p->start < end))
 318                         break;
 319         }
 320         read_unlock(&resource_lock);
 321         if (!p)
 322                 return -1;
 323         /* copy data */
 324         if (res->start < p->start)
 325                 res->start = p->start;
 326         if (res->end > p->end)
 327                 res->end = p->end;
 328         return 0;
 329 }
 330
 331 /*
 332  * This function calls callback against all memory range of "System RAM"
 333  * which are marked as IORESOURCE_MEM and IORESOUCE_BUSY.
 334  * Now, this function is only for "System RAM".
 335  */
 336 int walk_system_ram_range(unsigned long start_pfn, unsigned long nr_pages,
 337                 void *arg, int (*func)(unsigned long, unsigned long, void *))
 338 {
 339         struct resource res;
 340         unsigned long pfn, end_pfn;
 341         u64 orig_end;
 342         int ret = -1;
 343
 344         res.start = (u64) start_pfn << PAGE_SHIFT;
 345         res.end = ((u64)(start_pfn + nr_pages) << PAGE_SHIFT) - 1;
 346         res.flags = IORESOURCE_MEM | IORESOURCE_BUSY;
 347         orig_end = res.end;
 348         while ((res.start < res.end) &&
 349                 (find_next_system_ram(&res, "System RAM") >= 0)) {
 350                 pfn = (res.start + PAGE_SIZE - 1) >> PAGE_SHIFT;
 351                 end_pfn = (res.end + 1) >> PAGE_SHIFT;
 352                 if (end_pfn > pfn)
 353                         ret = (*func)(pfn, end_pfn - pfn, arg);
 354                 if (ret)
 355                         break;
 356                 res.start = res.end + 1;
 357                 res.end = orig_end;
 358         }
 359         return ret;
 360 }
 361
 362 #endif
 363
 364 static int __is_ram(unsigned long pfn, unsigned long nr_pages, void *arg)
 365 {
 366         return 1;
 367 }
 368 /*
 369  * This generic page_is_ram() returns true if specified address is
 370  * registered as "System RAM" in iomem_resource list.
 371  */
 372 int __weak page_is_ram(unsigned long pfn)
 373 {
 374         return walk_system_ram_range(pfn, 1, NULL, __is_ram) == 1;
 375 }
 376
 377 static resource_size_t simple_align_resource(void *data,
 378                                              const struct resource *avail,
 379                                              resource_size_t size,
 380                                              resource_size_t align)
 381 {
 382         return avail->start;
 383 }
 384
 385 static void resource_clip(struct resource *res, resource_size_t min,
 386                           resource_size_t max)
 387 {
 388         if (res->start < min)
 389                 res->start = min;
 390         if (res->end > max)
 391                 res->end = max;
 392 }
 393
 394 static bool resource_contains(struct resource *res1, struct resource *res2)
 395 {
 396         return res1->start <= res2->start && res1->end >= res2->end;
 397 }
 398
 399 /*
 400  * Find the resource before "child" in the sibling list of "root" children.
 401  */
 402 static struct resource *find_sibling_prev(struct resource *root, struct resource *child)
 403 {
 404         struct resource *this;
 405
 406         for (this = root->child; this; this = this->sibling)
 407                 if (this->sibling == child)
 408                         return this;
 409
 410         return NULL;
 411 }
 412
 413 /*
 414  * Find empty slot in the resource tree given range and alignment.
 415  * This version allocates from the end of the root resource first.
 416  */
 417 static int find_resource_from_top(struct resource *root, struct resource *new,
 418                                   resource_size_t size, resource_size_t min,
 419                                   resource_size_t max, resource_size_t align,
 420                                   resource_size_t (*alignf)(void *,
 421                                                    const struct resource *,
 422                                                    resource_size_t,
 423                                                    resource_size_t),
 424                                   void *alignf_data)
 425 {
 426         struct resource *this;
 427         struct resource tmp, avail, alloc;
 428
 429         tmp.start = root->end;
 430         tmp.end = root->end;
 431
 432         this = find_sibling_prev(root, NULL);
 433         for (;;) {
 434                 if (this) {
 435                         if (this->end < root->end)
 436                                 tmp.start = this->end + 1;
 437                 } else
 438                         tmp.start = root->start;
 439
 440                 resource_clip(&tmp, min, max);
 441
 442                 /* Check for overflow after ALIGN() */
 443                 avail = *new;
 444                 avail.start = ALIGN(tmp.start, align);
 445                 avail.end = tmp.end;
 446                 if (avail.start >= tmp.start) {
 447                         alloc.start = alignf(alignf_data, &avail, size, align);
 448                         alloc.end = alloc.start + size - 1;
 449                         if (resource_contains(&avail, &alloc)) {
 450                                 new->start = alloc.start;
 451                                 new->end = alloc.end;
 452                                 return 0;
 453                         }
 454                 }
 455
 456                 if (!this || this->start == root->start)
 457                         break;
 458
 459                 tmp.end = this->start - 1;
 460                 this = find_sibling_prev(root, this);
 461         }
 462         return -EBUSY;
 463 }
 464
 465 /*
 466  * Find empty slot in the resource tree given range and alignment.
 467  * This version allocates from the beginning of the root resource first.
 468  */
 469 static int find_resource(struct resource *root, struct resource *new,
 470                          resource_size_t size, resource_size_t min,
 471                          resource_size_t max, resource_size_t align,
 472                          resource_size_t (*alignf)(void *,
 473                                                    const struct resource *,
 474                                                    resource_size_t,
 475                                                    resource_size_t),
 476                          void *alignf_data)
 477 {
 478         struct resource *this = root->child;
 479         struct resource tmp = *new, avail, alloc;
 480
 481         tmp.start = root->start;
 482         /*
 483          * Skip past an allocated resource that starts at 0, since the
 484          * assignment of this->start - 1 to tmp->end below would cause an
 485          * underflow.
 486          */
 487         if (this && this->start == 0) {
 488                 tmp.start = this->end + 1;
 489                 this = this->sibling;
 490         }
 491         for (;;) {
 492                 if (this)
 493                         tmp.end = this->start - 1;
 494                 else
 495                         tmp.end = root->end;
 496
 497                 resource_clip(&tmp, min, max);
 498
 499                 /* Check for overflow after ALIGN() */
 500                 avail = *new;
 501                 avail.start = ALIGN(tmp.start, align);
 502                 avail.end = tmp.end;
 503                 if (avail.start >= tmp.start) {
 504                         alloc.start = alignf(alignf_data, &avail, size, align);
 505                         alloc.end = alloc.start + size - 1;
 506                         if (resource_contains(&avail, &alloc)) {
 507                                 new->start = alloc.start;
 508                                 new->end = alloc.end;
 509                                 return 0;
 510                         }
 511                 }
 512
 513                 if (!this)
 514                         break;
 515
 516                 tmp.start = this->end + 1;
 517                 this = this->sibling;
 518         }
 519         return -EBUSY;
 520 }
 521
 522 /**
 523  * allocate_resource - allocate empty slot in the resource tree given range & alignment
 524  * @root: root resource descriptor
 525  * @new: resource descriptor desired by caller
 526  * @size: requested resource region size
 527  * @min: minimum size to allocate
 528  * @max: maximum size to allocate
 529  * @align: alignment requested, in bytes
 530  * @alignf: alignment function, optional, called if not NULL
 531  * @alignf_data: arbitrary data to pass to the @alignf function
 532  */
 533 int allocate_resource(struct resource *root, struct resource *new,
 534                       resource_size_t size, resource_size_t min,
 535                       resource_size_t max, resource_size_t align,
 536                       resource_size_t (*alignf)(void *,
 537                                                 const struct resource *,
 538                                                 resource_size_t,
 539                                                 resource_size_t),
 540                       void *alignf_data)
 541 {
 542         int err;
 543
 544         if (!alignf)
 545                 alignf = simple_align_resource;
 546
 547         write_lock(&resource_lock);
 548         if (resource_alloc_from_bottom)
 549                 err = find_resource(root, new, size, min, max, align, alignf, alignf_data);
 550         else
 551                 err = find_resource_from_top(root, new, size, min, max, align, alignf, alignf_data);
 552         if (err >= 0 && __request_resource(root, new))
 553                 err = -EBUSY;
 554         write_unlock(&resource_lock);
 555         return err;
 556 }
 557
 558 EXPORT_SYMBOL(allocate_resource);
 559
 560 /*
 561  * Insert a resource into the resource tree. If successful, return NULL,
 562  * otherwise return the conflicting resource (compare to __request_resource())
 563  */
 564 static struct resource * __insert_resource(struct resource *parent, struct resource *new)
 565 {
 566         struct resource *first, *next;
 567
 568         for (;; parent = first) {
 569                 first = __request_resource(parent, new);
 570                 if (!first)
 571                         return first;
 572
 573                 if (first == parent)
 574                         return first;
 575
 576                 if ((first->start > new->start) || (first->end < new->end))
 577                         break;
 578                 if ((first->start == new->start) && (first->end == new->end))
 579                         break;
 580         }
 581
 582         for (next = first; ; next = next->sibling) {
 583                 /* Partial overlap? Bad, and unfixable */
 584                 if (next->start < new->start || next->end > new->end)
 585                         return next;
 586                 if (!next->sibling)
 587                         break;
 588                 if (next->sibling->start > new->end)
 589                         break;
 590         }
 591
 592         new->parent = parent;
 593         new->sibling = next->sibling;
 594         new->child = first;
 595
 596         next->sibling = NULL;
 597         for (next = first; next; next = next->sibling)
 598                 next->parent = new;
 599
 600         if (parent->child == first) {
 601                 parent->child = new;
 602         } else {
 603                 next = parent->child;
 604                 while (next->sibling != first)
 605                         next = next->sibling;
 606                 next->sibling = new;
 607         }
 608         return NULL;
 609 }
 610
 611 /**
 612  * insert_resource_conflict - Inserts resource in the resource tree
 613  * @parent: parent of the new resource
 614  * @new: new resource to insert
 615  *
 616  * Returns 0 on success, conflict resource if the resource can't be inserted.
 617  *
 618  * This function is equivalent to request_resource_conflict when no conflict
 619  * happens. If a conflict happens, and the conflicting resources
 620  * entirely fit within the range of the new resource, then the new
 621  * resource is inserted and the conflicting resources become children of
 622  * the new resource.
 623  */
 624 struct resource *insert_resource_conflict(struct resource *parent, struct resource *new)
 625 {
 626         struct resource *conflict;
 627
 628         write_lock(&resource_lock);
 629         conflict = __insert_resource(parent, new);
 630         write_unlock(&resource_lock);
 631         return conflict;
 632 }
 633
 634 /**
 635  * insert_resource - Inserts a resource in the resource tree
 636  * @parent: parent of the new resource
 637  * @new: new resource to insert
 638  *
 639  * Returns 0 on success, -EBUSY if the resource can't be inserted.
 640  */
 641 int insert_resource(struct resource *parent, struct resource *new)
 642 {
 643         struct resource *conflict;
 644
 645         conflict = insert_resource_conflict(parent, new);
 646         return conflict ? -EBUSY : 0;
 647 }
 648
 649 /**
 650  * insert_resource_expand_to_fit - Insert a resource into the resource tree
 651  * @root: root resource descriptor
 652  * @new: new resource to insert
 653  *
 654  * Insert a resource into the resource tree, possibly expanding it in order
 655  * to make it encompass any conflicting resources.
 656  */
 657 void insert_resource_expand_to_fit(struct resource *root, struct resource *new)
 658 {
 659         if (new->parent)
 660                 return;
 661
 662         write_lock(&resource_lock);
 663         for (;;) {
 664                 struct resource *conflict;
 665
 666                 conflict = __insert_resource(root, new);
 667                 if (!conflict)
 668                         break;
 669                 if (conflict == root)
 670                         break;
 671
 672                 /* Ok, expand resource to cover the conflict, then try again .. */
 673                 if (conflict->start < new->start)
 674                         new->start = conflict->start;
 675                 if (conflict->end > new->end)
 676                         new->end = conflict->end;
 677
 678                 printk("Expanded resource %s due to conflict with %s\n", new->name, conflict->name);
 679         }
 680         write_unlock(&resource_lock);
 681 }
 682
 683 /**
 684  * adjust_resource - modify a resource's start and size
 685  * @res: resource to modify
 686  * @start: new start value
 687  * @size: new size
 688  *
 689  * Given an existing resource, change its start and size to match the
 690  * arguments.  Returns 0 on success, -EBUSY if it can't fit.
 691  * Existing children of the resource are assumed to be immutable.
 692  */
 693 int adjust_resource(struct resource *res, resource_size_t start, resource_size_t size)
 694 {
 695         struct resource *tmp, *parent = res->parent;
 696         resource_size_t end = start + size - 1;
 697         int result = -EBUSY;
 698
 699         write_lock(&resource_lock);
 700
 701         if ((start < parent->start) || (end > parent->end))
 702                 goto out;
 703
 704         for (tmp = res->child; tmp; tmp = tmp->sibling) {
 705                 if ((tmp->start < start) || (tmp->end > end))
 706                         goto out;
 707         }
 708
 709         if (res->sibling && (res->sibling->start <= end))
 710                 goto out;
 711
 712         tmp = parent->child;
 713         if (tmp != res) {
 714                 while (tmp->sibling != res)
 715                         tmp = tmp->sibling;
 716                 if (start <= tmp->end)
 717                         goto out;
 718         }
 719
 720         res->start = start;
 721         res->end = end;
 722         result = 0;
 723
 724  out:
 725         write_unlock(&resource_lock);
 726         return result;
 727 }
 728
 729 static void __init __reserve_region_with_split(struct resource *root,
 730                 resource_size_t start, resource_size_t end,
 731                 const char *name)
 732 {
 733         struct resource *parent = root;
 734         struct resource *conflict;
 735         struct resource *res = kzalloc(sizeof(*res), GFP_ATOMIC);
 736
 737         if (!res)
 738                 return;
 739
 740         res->name = name;
 741         res->start = start;
 742         res->end = end;
 743         res->flags = IORESOURCE_BUSY;
 744
 745         conflict = __request_resource(parent, res);
 746         if (!conflict)
 747                 return;
 748
 749         /* failed, split and try again */
 750         kfree(res);
 751
 752         /* conflict covered whole area */
 753         if (conflict->start <= start && conflict->end >= end)
 754                 return;
 755
 756         if (conflict->start > start)
 757                 __reserve_region_with_split(root, start, conflict->start-1, name);
 758         if (conflict->end < end)
 759                 __reserve_region_with_split(root, conflict->end+1, end, name);
 760 }
 761
 762 void __init reserve_region_with_split(struct resource *root,
 763                 resource_size_t start, resource_size_t end,
 764                 const char *name)
 765 {
 766         write_lock(&resource_lock);
 767         __reserve_region_with_split(root, start, end, name);
 768         write_unlock(&resource_lock);
 769 }
 770
 771 EXPORT_SYMBOL(adjust_resource);
 772
 773 /**
 774  * resource_alignment - calculate resource's alignment
 775  * @res: resource pointer
 776  *
 777  * Returns alignment on success, 0 (invalid alignment) on failure.
 778  */
 779 resource_size_t resource_alignment(struct resource *res)
 780 {
 781         switch (res->flags & (IORESOURCE_SIZEALIGN | IORESOURCE_STARTALIGN)) {
 782         case IORESOURCE_SIZEALIGN:
 783                 return resource_size(res);
 784         case IORESOURCE_STARTALIGN:
 785                 return res->start;
 786         default:
 787                 return 0;
 788         }
 789 }
 790
 791 /*
 792  * This is compatibility stuff for IO resources.
 793  *
 794  * Note how this, unlike the above, knows about
 795  * the IO flag meanings (busy etc).
 796  *
 797  * request_region creates a new busy region.
 798  *
 799  * check_region returns non-zero if the area is already busy.
 800  *
 801  * release_region releases a matching busy region.
 802  */
 803
 804 static DECLARE_WAIT_QUEUE_HEAD(muxed_resource_wait);
 805
 806 /**
 807  * __request_region - create a new busy resource region
 808  * @parent: parent resource descriptor
 809  * @start: resource start address
 810  * @n: resource region size
 811  * @name: reserving caller's ID string
 812  * @flags: IO resource flags
 813  */
 814 struct resource * __request_region(struct resource *parent,
 815                                    resource_size_t start, resource_size_t n,
 816                                    const char *name, int flags)
 817 {
 818         DECLARE_WAITQUEUE(wait, current);
 819         struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL);
 820
 821         if (!res)
 822                 return NULL;
 823
 824         res->name = name;
 825         res->start = start;
 826         res->end = start + n - 1;
 827         res->flags = IORESOURCE_BUSY;
 828         res->flags |= flags;
 829
 830         write_lock(&resource_lock);
 831
 832         for (;;) {
 833                 struct resource *conflict;
 834
 835                 conflict = __request_resource(parent, res);
 836                 if (!conflict)
 837                         break;
 838                 if (conflict != parent) {
 839                         parent = conflict;
 840                         if (!(conflict->flags & IORESOURCE_BUSY))
 841                                 continue;
 842                 }
 843                 if (conflict->flags & flags & IORESOURCE_MUXED) {
 844                         add_wait_queue(&muxed_resource_wait, &wait);
 845                         write_unlock(&resource_lock);
 846                         set_current_state(TASK_UNINTERRUPTIBLE);
 847                         schedule();
 848                         remove_wait_queue(&muxed_resource_wait, &wait);
 849                         write_lock(&resource_lock);
 850                         continue;
 851                 }
 852                 /* Uhhuh, that didn't work out.. */
 853                 kfree(res);
 854                 res = NULL;
 855                 break;
 856         }
 857         write_unlock(&resource_lock);
 858         return res;
 859 }
 860 EXPORT_SYMBOL(__request_region);
 861
 862 /**
 863  * __check_region - check if a resource region is busy or free
 864  * @parent: parent resource descriptor
 865  * @start: resource start address
 866  * @n: resource region size
 867  *
 868  * Returns 0 if the region is free at the moment it is checked,
 869  * returns %-EBUSY if the region is busy.
 870  *
 871  * NOTE:
 872  * This function is deprecated because its use is racy.
 873  * Even if it returns 0, a subsequent call to request_region()
 874  * may fail because another driver etc. just allocated the region.
 875  * Do NOT use it.  It will be removed from the kernel.
 876  */
 877 int __check_region(struct resource *parent, resource_size_t start,
 878                         resource_size_t n)
 879 {
 880         struct resource * res;
 881
 882         res = __request_region(parent, start, n, "check-region", 0);
 883         if (!res)
 884                 return -EBUSY;
 885
 886         release_resource(res);
 887         kfree(res);
 888         return 0;
 889 }
 890 EXPORT_SYMBOL(__check_region);
 891
 892 /**
 893  * __release_region - release a previously reserved resource region
 894  * @parent: parent resource descriptor
 895  * @start: resource start address
 896  * @n: resource region size
 897  *
 898  * The described resource region must match a currently busy region.
 899  */
 900 void __release_region(struct resource *parent, resource_size_t start,
 901                         resource_size_t n)
 902 {
 903         struct resource **p;
 904         resource_size_t end;
 905
 906         p = &parent->child;
 907         end = start + n - 1;
 908
 909         write_lock(&resource_lock);
 910
 911         for (;;) {
 912                 struct resource *res = *p;
 913
 914                 if (!res)
 915                         break;
 916                 if (res->start <= start && res->end >= end) {
 917                         if (!(res->flags & IORESOURCE_BUSY)) {
 918                                 p = &res->child;
 919                                 continue;
 920                         }
 921                         if (res->start != start || res->end != end)
 922                                 break;
 923                         *p = res->sibling;
 924                         write_unlock(&resource_lock);
 925                         if (res->flags & IORESOURCE_MUXED)
 926                                 wake_up(&muxed_resource_wait);
 927                         kfree(res);
 928                         return;
 929                 }
 930                 p = &res->sibling;
 931         }
 932
 933         write_unlock(&resource_lock);
 934
 935         printk(KERN_WARNING "Trying to free nonexistent resource "
 936                 "<%016llx-%016llx>\n", (unsigned long long)start,
 937                 (unsigned long long)end);
 938 }
 939 EXPORT_SYMBOL(__release_region);
 940
 941 /*
 942  * Managed region resource
 943  */
 944 struct region_devres {
 945         struct resource *parent;
 946         resource_size_t start;
 947         resource_size_t n;
 948 };
 949
 950 static void devm_region_release(struct device *dev, void *res)
 951 {
 952         struct region_devres *this = res;
 953
 954         __release_region(this->parent, this->start, this->n);
 955 }
 956
 957 static int devm_region_match(struct device *dev, void *res, void *match_data)
 958 {
 959         struct region_devres *this = res, *match = match_data;
 960
 961         return this->parent == match->parent &&
 962                 this->start == match->start && this->n == match->n;
 963 }
 964
 965 struct resource * __devm_request_region(struct device *dev,
 966                                 struct resource *parent, resource_size_t start,
 967                                 resource_size_t n, const char *name)
 968 {
 969         struct region_devres *dr = NULL;
 970         struct resource *res;
 971
 972         dr = devres_alloc(devm_region_release, sizeof(struct region_devres),
 973                           GFP_KERNEL);
 974         if (!dr)
 975                 return NULL;
 976
 977         dr->parent = parent;
 978         dr->start = start;
 979         dr->n = n;
 980
 981         res = __request_region(parent, start, n, name, 0);
 982         if (res)
 983                 devres_add(dev, dr);
 984         else
 985                 devres_free(dr);
 986
 987         return res;
 988 }
 989 EXPORT_SYMBOL(__devm_request_region);
 990
 991 void __devm_release_region(struct device *dev, struct resource *parent,
 992                            resource_size_t start, resource_size_t n)
 993 {
 994         struct region_devres match_data = { parent, start, n };
 995
 996         __release_region(parent, start, n);
 997         WARN_ON(devres_destroy(dev, devm_region_release, devm_region_match,
 998                                &match_data));
 999 }
1000 EXPORT_SYMBOL(__devm_release_region);
1001
1002 /*
1003  * Called from init/main.c to reserve IO ports.
1004  */
1005 #define MAXRESERVE 4
1006 static int __init reserve_setup(char *str)
1007 {
1008         static int reserved;
1009         static struct resource reserve[MAXRESERVE];
1010
1011         for (;;) {
1012                 unsigned int io_start, io_num;
1013                 int x = reserved;
1014
1015                 if (get_option (&str, &io_start) != 2)
1016                         break;
1017                 if (get_option (&str, &io_num)   == 0)
1018                         break;
1019                 if (x < MAXRESERVE) {
1020                         struct resource *res = reserve + x;
1021                         res->name = "reserved";
1022                         res->start = io_start;
1023                         res->end = io_start + io_num - 1;
1024                         res->flags = IORESOURCE_BUSY;
1025                         res->child = NULL;
1026                         if (request_resource(res->start >= 0x10000 ? &iomem_resource : &ioport_resource, res) == 0)
1027                                 reserved = x+1;
1028                 }
1029         }
1030         return 1;
1031 }
1032
1033 __setup("reserve=", reserve_setup);
1034
1035 /*
1036  * Check if the requested addr and size spans more than any slot in the
1037  * iomem resource tree.
1038  */
1039 int iomem_map_sanity_check(resource_size_t addr, unsigned long size)
1040 {
1041         struct resource *p = &iomem_resource;
1042         int err = 0;
1043         loff_t l;
1044
1045         read_lock(&resource_lock);
1046         for (p = p->child; p ; p = r_next(NULL, p, &l)) {
1047                 /*
1048                  * We can probably skip the resources without
1049                  * IORESOURCE_IO attribute?
1050                  */
1051                 if (p->start >= addr + size)
1052                         continue;
1053                 if (p->end < addr)
1054                         continue;
1055                 if (PFN_DOWN(p->start) <= PFN_DOWN(addr) &&
1056                     PFN_DOWN(p->end) >= PFN_DOWN(addr + size - 1))
1057                         continue;
1058                 /*
1059                  * if a resource is "BUSY", it's not a hardware resource
1060                  * but a driver mapping of such a resource; we don't want
1061                  * to warn for those; some drivers legitimately map only
1062                  * partial hardware resources. (example: vesafb)
1063                  */
1064                 if (p->flags & IORESOURCE_BUSY)
1065                         continue;
1066
1067                 printk(KERN_WARNING "resource map sanity check conflict: "
1068                        "0x%llx 0x%llx 0x%llx 0x%llx %s\n",
1069                        (unsigned long long)addr,
1070                        (unsigned long long)(addr + size - 1),
1071                        (unsigned long long)p->start,
1072                        (unsigned long long)p->end,
1073                        p->name);
1074                 err = -1;
1075                 break;
1076         }
1077         read_unlock(&resource_lock);
1078
1079         return err;
1080 }
1081
1082 #ifdef CONFIG_STRICT_DEVMEM
1083 static int strict_iomem_checks = 1;
1084 #else
1085 static int strict_iomem_checks;
1086 #endif
1087
1088 /*
1089  * check if an address is reserved in the iomem resource tree
1090  * returns 1 if reserved, 0 if not reserved.
1091  */
1092 int iomem_is_exclusive(u64 addr)
1093 {
1094         struct resource *p = &iomem_resource;
1095         int err = 0;
1096         loff_t l;
1097         int size = PAGE_SIZE;
1098
1099         if (!strict_iomem_checks)
1100                 return 0;
1101
1102         addr = addr & PAGE_MASK;
1103
1104         read_lock(&resource_lock);
1105         for (p = p->child; p ; p = r_next(NULL, p, &l)) {
1106                 /*
1107                  * We can probably skip the resources without
1108                  * IORESOURCE_IO attribute?
1109                  */
1110                 if (p->start >= addr + size)
1111                         break;
1112                 if (p->end < addr)
1113                         continue;
1114                 if (p->flags & IORESOURCE_BUSY &&
1115                      p->flags & IORESOURCE_EXCLUSIVE) {
1116                         err = 1;
1117                         break;
1118                 }
1119         }
1120         read_unlock(&resource_lock);
1121
1122         return err;
1123 }
1124
1125 static int __init strict_iomem(char *str)
1126 {
1127         if (strstr(str, "relaxed"))
1128                 strict_iomem_checks = 0;
1129         if (strstr(str, "strict"))
1130                 strict_iomem_checks = 1;
1131         return 1;
1132 }
1133
1134 __setup("iomem=", strict_iomem);