libata: fix device iteration bugs
[linux-2.6/mini2440.git] / kernel / resource.c
blob4089d12af6e0eda2aa15cc8c145940f1bd12056c
1 /*
2 * linux/kernel/resource.c
4 * Copyright (C) 1999 Linus Torvalds
5 * Copyright (C) 1999 Martin Mares <mj@ucw.cz>
7 * Arbitrary resource management.
8 */
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/seq_file.h>
19 #include <linux/device.h>
20 #include <asm/io.h>
23 struct resource ioport_resource = {
24 .name = "PCI IO",
25 .start = 0,
26 .end = IO_SPACE_LIMIT,
27 .flags = IORESOURCE_IO,
29 EXPORT_SYMBOL(ioport_resource);
31 struct resource iomem_resource = {
32 .name = "PCI mem",
33 .start = 0,
34 .end = -1,
35 .flags = IORESOURCE_MEM,
37 EXPORT_SYMBOL(iomem_resource);
39 static DEFINE_RWLOCK(resource_lock);
41 static void *r_next(struct seq_file *m, void *v, loff_t *pos)
43 struct resource *p = v;
44 (*pos)++;
45 if (p->child)
46 return p->child;
47 while (!p->sibling && p->parent)
48 p = p->parent;
49 return p->sibling;
52 #ifdef CONFIG_PROC_FS
54 enum { MAX_IORES_LEVEL = 5 };
56 static void *r_start(struct seq_file *m, loff_t *pos)
57 __acquires(resource_lock)
59 struct resource *p = m->private;
60 loff_t l = 0;
61 read_lock(&resource_lock);
62 for (p = p->child; p && l < *pos; p = r_next(m, p, &l))
64 return p;
67 static void r_stop(struct seq_file *m, void *v)
68 __releases(resource_lock)
70 read_unlock(&resource_lock);
73 static int r_show(struct seq_file *m, void *v)
75 struct resource *root = m->private;
76 struct resource *r = v, *p;
77 int width = root->end < 0x10000 ? 4 : 8;
78 int depth;
80 for (depth = 0, p = r; depth < MAX_IORES_LEVEL; depth++, p = p->parent)
81 if (p->parent == root)
82 break;
83 seq_printf(m, "%*s%0*llx-%0*llx : %s\n",
84 depth * 2, "",
85 width, (unsigned long long) r->start,
86 width, (unsigned long long) r->end,
87 r->name ? r->name : "<BAD>");
88 return 0;
91 static const struct seq_operations resource_op = {
92 .start = r_start,
93 .next = r_next,
94 .stop = r_stop,
95 .show = r_show,
98 static int ioports_open(struct inode *inode, struct file *file)
100 int res = seq_open(file, &resource_op);
101 if (!res) {
102 struct seq_file *m = file->private_data;
103 m->private = &ioport_resource;
105 return res;
108 static int iomem_open(struct inode *inode, struct file *file)
110 int res = seq_open(file, &resource_op);
111 if (!res) {
112 struct seq_file *m = file->private_data;
113 m->private = &iomem_resource;
115 return res;
118 static const struct file_operations proc_ioports_operations = {
119 .open = ioports_open,
120 .read = seq_read,
121 .llseek = seq_lseek,
122 .release = seq_release,
125 static const struct file_operations proc_iomem_operations = {
126 .open = iomem_open,
127 .read = seq_read,
128 .llseek = seq_lseek,
129 .release = seq_release,
132 static int __init ioresources_init(void)
134 proc_create("ioports", 0, NULL, &proc_ioports_operations);
135 proc_create("iomem", 0, NULL, &proc_iomem_operations);
136 return 0;
138 __initcall(ioresources_init);
140 #endif /* CONFIG_PROC_FS */
142 /* Return the conflict entry if you can't request it */
143 static struct resource * __request_resource(struct resource *root, struct resource *new)
145 resource_size_t start = new->start;
146 resource_size_t end = new->end;
147 struct resource *tmp, **p;
149 if (end < start)
150 return root;
151 if (start < root->start)
152 return root;
153 if (end > root->end)
154 return root;
155 p = &root->child;
156 for (;;) {
157 tmp = *p;
158 if (!tmp || tmp->start > end) {
159 new->sibling = tmp;
160 *p = new;
161 new->parent = root;
162 return NULL;
164 p = &tmp->sibling;
165 if (tmp->end < start)
166 continue;
167 return tmp;
171 static int __release_resource(struct resource *old)
173 struct resource *tmp, **p;
175 p = &old->parent->child;
176 for (;;) {
177 tmp = *p;
178 if (!tmp)
179 break;
180 if (tmp == old) {
181 *p = tmp->sibling;
182 old->parent = NULL;
183 return 0;
185 p = &tmp->sibling;
187 return -EINVAL;
191 * request_resource - request and reserve an I/O or memory resource
192 * @root: root resource descriptor
193 * @new: resource descriptor desired by caller
195 * Returns 0 for success, negative error code on error.
197 int request_resource(struct resource *root, struct resource *new)
199 struct resource *conflict;
201 write_lock(&resource_lock);
202 conflict = __request_resource(root, new);
203 write_unlock(&resource_lock);
204 return conflict ? -EBUSY : 0;
207 EXPORT_SYMBOL(request_resource);
210 * release_resource - release a previously reserved resource
211 * @old: resource pointer
213 int release_resource(struct resource *old)
215 int retval;
217 write_lock(&resource_lock);
218 retval = __release_resource(old);
219 write_unlock(&resource_lock);
220 return retval;
223 EXPORT_SYMBOL(release_resource);
225 #if defined(CONFIG_MEMORY_HOTPLUG) && !defined(CONFIG_ARCH_HAS_WALK_MEMORY)
227 * Finds the lowest memory reosurce exists within [res->start.res->end)
228 * the caller must specify res->start, res->end, res->flags.
229 * If found, returns 0, res is overwritten, if not found, returns -1.
231 static int find_next_system_ram(struct resource *res)
233 resource_size_t start, end;
234 struct resource *p;
236 BUG_ON(!res);
238 start = res->start;
239 end = res->end;
240 BUG_ON(start >= end);
242 read_lock(&resource_lock);
243 for (p = iomem_resource.child; p ; p = p->sibling) {
244 /* system ram is just marked as IORESOURCE_MEM */
245 if (p->flags != res->flags)
246 continue;
247 if (p->start > end) {
248 p = NULL;
249 break;
251 if ((p->end >= start) && (p->start < end))
252 break;
254 read_unlock(&resource_lock);
255 if (!p)
256 return -1;
257 /* copy data */
258 if (res->start < p->start)
259 res->start = p->start;
260 if (res->end > p->end)
261 res->end = p->end;
262 return 0;
265 walk_memory_resource(unsigned long start_pfn, unsigned long nr_pages, void *arg,
266 int (*func)(unsigned long, unsigned long, void *))
268 struct resource res;
269 unsigned long pfn, len;
270 u64 orig_end;
271 int ret = -1;
272 res.start = (u64) start_pfn << PAGE_SHIFT;
273 res.end = ((u64)(start_pfn + nr_pages) << PAGE_SHIFT) - 1;
274 res.flags = IORESOURCE_MEM | IORESOURCE_BUSY;
275 orig_end = res.end;
276 while ((res.start < res.end) && (find_next_system_ram(&res) >= 0)) {
277 pfn = (unsigned long)(res.start >> PAGE_SHIFT);
278 len = (unsigned long)((res.end + 1 - res.start) >> PAGE_SHIFT);
279 ret = (*func)(pfn, len, arg);
280 if (ret)
281 break;
282 res.start = res.end + 1;
283 res.end = orig_end;
285 return ret;
288 #endif
291 * Find empty slot in the resource tree given range and alignment.
293 static int find_resource(struct resource *root, struct resource *new,
294 resource_size_t size, resource_size_t min,
295 resource_size_t max, resource_size_t align,
296 void (*alignf)(void *, struct resource *,
297 resource_size_t, resource_size_t),
298 void *alignf_data)
300 struct resource *this = root->child;
302 new->start = root->start;
304 * Skip past an allocated resource that starts at 0, since the assignment
305 * of this->start - 1 to new->end below would cause an underflow.
307 if (this && this->start == 0) {
308 new->start = this->end + 1;
309 this = this->sibling;
311 for(;;) {
312 if (this)
313 new->end = this->start - 1;
314 else
315 new->end = root->end;
316 if (new->start < min)
317 new->start = min;
318 if (new->end > max)
319 new->end = max;
320 new->start = ALIGN(new->start, align);
321 if (alignf)
322 alignf(alignf_data, new, size, align);
323 if (new->start < new->end && new->end - new->start >= size - 1) {
324 new->end = new->start + size - 1;
325 return 0;
327 if (!this)
328 break;
329 new->start = this->end + 1;
330 this = this->sibling;
332 return -EBUSY;
336 * allocate_resource - allocate empty slot in the resource tree given range & alignment
337 * @root: root resource descriptor
338 * @new: resource descriptor desired by caller
339 * @size: requested resource region size
340 * @min: minimum size to allocate
341 * @max: maximum size to allocate
342 * @align: alignment requested, in bytes
343 * @alignf: alignment function, optional, called if not NULL
344 * @alignf_data: arbitrary data to pass to the @alignf function
346 int allocate_resource(struct resource *root, struct resource *new,
347 resource_size_t size, resource_size_t min,
348 resource_size_t max, resource_size_t align,
349 void (*alignf)(void *, struct resource *,
350 resource_size_t, resource_size_t),
351 void *alignf_data)
353 int err;
355 write_lock(&resource_lock);
356 err = find_resource(root, new, size, min, max, align, alignf, alignf_data);
357 if (err >= 0 && __request_resource(root, new))
358 err = -EBUSY;
359 write_unlock(&resource_lock);
360 return err;
363 EXPORT_SYMBOL(allocate_resource);
366 * Insert a resource into the resource tree. If successful, return NULL,
367 * otherwise return the conflicting resource (compare to __request_resource())
369 static struct resource * __insert_resource(struct resource *parent, struct resource *new)
371 struct resource *first, *next;
373 for (;; parent = first) {
374 first = __request_resource(parent, new);
375 if (!first)
376 return first;
378 if (first == parent)
379 return first;
381 if ((first->start > new->start) || (first->end < new->end))
382 break;
383 if ((first->start == new->start) && (first->end == new->end))
384 break;
387 for (next = first; ; next = next->sibling) {
388 /* Partial overlap? Bad, and unfixable */
389 if (next->start < new->start || next->end > new->end)
390 return next;
391 if (!next->sibling)
392 break;
393 if (next->sibling->start > new->end)
394 break;
397 new->parent = parent;
398 new->sibling = next->sibling;
399 new->child = first;
401 next->sibling = NULL;
402 for (next = first; next; next = next->sibling)
403 next->parent = new;
405 if (parent->child == first) {
406 parent->child = new;
407 } else {
408 next = parent->child;
409 while (next->sibling != first)
410 next = next->sibling;
411 next->sibling = new;
413 return NULL;
417 * insert_resource - Inserts a resource in the resource tree
418 * @parent: parent of the new resource
419 * @new: new resource to insert
421 * Returns 0 on success, -EBUSY if the resource can't be inserted.
423 * This function is equivalent to request_resource when no conflict
424 * happens. If a conflict happens, and the conflicting resources
425 * entirely fit within the range of the new resource, then the new
426 * resource is inserted and the conflicting resources become children of
427 * the new resource.
429 int insert_resource(struct resource *parent, struct resource *new)
431 struct resource *conflict;
433 write_lock(&resource_lock);
434 conflict = __insert_resource(parent, new);
435 write_unlock(&resource_lock);
436 return conflict ? -EBUSY : 0;
440 * insert_resource_expand_to_fit - Insert a resource into the resource tree
441 * @root: root resource descriptor
442 * @new: new resource to insert
444 * Insert a resource into the resource tree, possibly expanding it in order
445 * to make it encompass any conflicting resources.
447 void insert_resource_expand_to_fit(struct resource *root, struct resource *new)
449 if (new->parent)
450 return;
452 write_lock(&resource_lock);
453 for (;;) {
454 struct resource *conflict;
456 conflict = __insert_resource(root, new);
457 if (!conflict)
458 break;
459 if (conflict == root)
460 break;
462 /* Ok, expand resource to cover the conflict, then try again .. */
463 if (conflict->start < new->start)
464 new->start = conflict->start;
465 if (conflict->end > new->end)
466 new->end = conflict->end;
468 printk("Expanded resource %s due to conflict with %s\n", new->name, conflict->name);
470 write_unlock(&resource_lock);
474 * adjust_resource - modify a resource's start and size
475 * @res: resource to modify
476 * @start: new start value
477 * @size: new size
479 * Given an existing resource, change its start and size to match the
480 * arguments. Returns 0 on success, -EBUSY if it can't fit.
481 * Existing children of the resource are assumed to be immutable.
483 int adjust_resource(struct resource *res, resource_size_t start, resource_size_t size)
485 struct resource *tmp, *parent = res->parent;
486 resource_size_t end = start + size - 1;
487 int result = -EBUSY;
489 write_lock(&resource_lock);
491 if ((start < parent->start) || (end > parent->end))
492 goto out;
494 for (tmp = res->child; tmp; tmp = tmp->sibling) {
495 if ((tmp->start < start) || (tmp->end > end))
496 goto out;
499 if (res->sibling && (res->sibling->start <= end))
500 goto out;
502 tmp = parent->child;
503 if (tmp != res) {
504 while (tmp->sibling != res)
505 tmp = tmp->sibling;
506 if (start <= tmp->end)
507 goto out;
510 res->start = start;
511 res->end = end;
512 result = 0;
514 out:
515 write_unlock(&resource_lock);
516 return result;
519 static void __init __reserve_region_with_split(struct resource *root,
520 resource_size_t start, resource_size_t end,
521 const char *name)
523 struct resource *parent = root;
524 struct resource *conflict;
525 struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL);
527 if (!res)
528 return;
530 res->name = name;
531 res->start = start;
532 res->end = end;
533 res->flags = IORESOURCE_BUSY;
535 for (;;) {
536 conflict = __request_resource(parent, res);
537 if (!conflict)
538 break;
539 if (conflict != parent) {
540 parent = conflict;
541 if (!(conflict->flags & IORESOURCE_BUSY))
542 continue;
545 /* Uhhuh, that didn't work out.. */
546 kfree(res);
547 res = NULL;
548 break;
551 if (!res) {
552 /* failed, split and try again */
554 /* conflict covered whole area */
555 if (conflict->start <= start && conflict->end >= end)
556 return;
558 if (conflict->start > start)
559 __reserve_region_with_split(root, start, conflict->start-1, name);
560 if (!(conflict->flags & IORESOURCE_BUSY)) {
561 resource_size_t common_start, common_end;
563 common_start = max(conflict->start, start);
564 common_end = min(conflict->end, end);
565 if (common_start < common_end)
566 __reserve_region_with_split(root, common_start, common_end, name);
568 if (conflict->end < end)
569 __reserve_region_with_split(root, conflict->end+1, end, name);
574 void reserve_region_with_split(struct resource *root,
575 resource_size_t start, resource_size_t end,
576 const char *name)
578 write_lock(&resource_lock);
579 __reserve_region_with_split(root, start, end, name);
580 write_unlock(&resource_lock);
583 EXPORT_SYMBOL(adjust_resource);
586 * resource_alignment - calculate resource's alignment
587 * @res: resource pointer
589 * Returns alignment on success, 0 (invalid alignment) on failure.
591 resource_size_t resource_alignment(struct resource *res)
593 switch (res->flags & (IORESOURCE_SIZEALIGN | IORESOURCE_STARTALIGN)) {
594 case IORESOURCE_SIZEALIGN:
595 return resource_size(res);
596 case IORESOURCE_STARTALIGN:
597 return res->start;
598 default:
599 return 0;
604 * This is compatibility stuff for IO resources.
606 * Note how this, unlike the above, knows about
607 * the IO flag meanings (busy etc).
609 * request_region creates a new busy region.
611 * check_region returns non-zero if the area is already busy.
613 * release_region releases a matching busy region.
617 * __request_region - create a new busy resource region
618 * @parent: parent resource descriptor
619 * @start: resource start address
620 * @n: resource region size
621 * @name: reserving caller's ID string
623 struct resource * __request_region(struct resource *parent,
624 resource_size_t start, resource_size_t n,
625 const char *name)
627 struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL);
629 if (!res)
630 return NULL;
632 res->name = name;
633 res->start = start;
634 res->end = start + n - 1;
635 res->flags = IORESOURCE_BUSY;
637 write_lock(&resource_lock);
639 for (;;) {
640 struct resource *conflict;
642 conflict = __request_resource(parent, res);
643 if (!conflict)
644 break;
645 if (conflict != parent) {
646 parent = conflict;
647 if (!(conflict->flags & IORESOURCE_BUSY))
648 continue;
651 /* Uhhuh, that didn't work out.. */
652 kfree(res);
653 res = NULL;
654 break;
656 write_unlock(&resource_lock);
657 return res;
659 EXPORT_SYMBOL(__request_region);
662 * __check_region - check if a resource region is busy or free
663 * @parent: parent resource descriptor
664 * @start: resource start address
665 * @n: resource region size
667 * Returns 0 if the region is free at the moment it is checked,
668 * returns %-EBUSY if the region is busy.
670 * NOTE:
671 * This function is deprecated because its use is racy.
672 * Even if it returns 0, a subsequent call to request_region()
673 * may fail because another driver etc. just allocated the region.
674 * Do NOT use it. It will be removed from the kernel.
676 int __check_region(struct resource *parent, resource_size_t start,
677 resource_size_t n)
679 struct resource * res;
681 res = __request_region(parent, start, n, "check-region");
682 if (!res)
683 return -EBUSY;
685 release_resource(res);
686 kfree(res);
687 return 0;
689 EXPORT_SYMBOL(__check_region);
692 * __release_region - release a previously reserved resource region
693 * @parent: parent resource descriptor
694 * @start: resource start address
695 * @n: resource region size
697 * The described resource region must match a currently busy region.
699 void __release_region(struct resource *parent, resource_size_t start,
700 resource_size_t n)
702 struct resource **p;
703 resource_size_t end;
705 p = &parent->child;
706 end = start + n - 1;
708 write_lock(&resource_lock);
710 for (;;) {
711 struct resource *res = *p;
713 if (!res)
714 break;
715 if (res->start <= start && res->end >= end) {
716 if (!(res->flags & IORESOURCE_BUSY)) {
717 p = &res->child;
718 continue;
720 if (res->start != start || res->end != end)
721 break;
722 *p = res->sibling;
723 write_unlock(&resource_lock);
724 kfree(res);
725 return;
727 p = &res->sibling;
730 write_unlock(&resource_lock);
732 printk(KERN_WARNING "Trying to free nonexistent resource "
733 "<%016llx-%016llx>\n", (unsigned long long)start,
734 (unsigned long long)end);
736 EXPORT_SYMBOL(__release_region);
739 * Managed region resource
741 struct region_devres {
742 struct resource *parent;
743 resource_size_t start;
744 resource_size_t n;
747 static void devm_region_release(struct device *dev, void *res)
749 struct region_devres *this = res;
751 __release_region(this->parent, this->start, this->n);
754 static int devm_region_match(struct device *dev, void *res, void *match_data)
756 struct region_devres *this = res, *match = match_data;
758 return this->parent == match->parent &&
759 this->start == match->start && this->n == match->n;
762 struct resource * __devm_request_region(struct device *dev,
763 struct resource *parent, resource_size_t start,
764 resource_size_t n, const char *name)
766 struct region_devres *dr = NULL;
767 struct resource *res;
769 dr = devres_alloc(devm_region_release, sizeof(struct region_devres),
770 GFP_KERNEL);
771 if (!dr)
772 return NULL;
774 dr->parent = parent;
775 dr->start = start;
776 dr->n = n;
778 res = __request_region(parent, start, n, name);
779 if (res)
780 devres_add(dev, dr);
781 else
782 devres_free(dr);
784 return res;
786 EXPORT_SYMBOL(__devm_request_region);
788 void __devm_release_region(struct device *dev, struct resource *parent,
789 resource_size_t start, resource_size_t n)
791 struct region_devres match_data = { parent, start, n };
793 __release_region(parent, start, n);
794 WARN_ON(devres_destroy(dev, devm_region_release, devm_region_match,
795 &match_data));
797 EXPORT_SYMBOL(__devm_release_region);
800 * Called from init/main.c to reserve IO ports.
802 #define MAXRESERVE 4
803 static int __init reserve_setup(char *str)
805 static int reserved;
806 static struct resource reserve[MAXRESERVE];
808 for (;;) {
809 int io_start, io_num;
810 int x = reserved;
812 if (get_option (&str, &io_start) != 2)
813 break;
814 if (get_option (&str, &io_num) == 0)
815 break;
816 if (x < MAXRESERVE) {
817 struct resource *res = reserve + x;
818 res->name = "reserved";
819 res->start = io_start;
820 res->end = io_start + io_num - 1;
821 res->flags = IORESOURCE_BUSY;
822 res->child = NULL;
823 if (request_resource(res->start >= 0x10000 ? &iomem_resource : &ioport_resource, res) == 0)
824 reserved = x+1;
827 return 1;
830 __setup("reserve=", reserve_setup);
833 * Check if the requested addr and size spans more than any slot in the
834 * iomem resource tree.
836 int iomem_map_sanity_check(resource_size_t addr, unsigned long size)
838 struct resource *p = &iomem_resource;
839 int err = 0;
840 loff_t l;
842 read_lock(&resource_lock);
843 for (p = p->child; p ; p = r_next(NULL, p, &l)) {
845 * We can probably skip the resources without
846 * IORESOURCE_IO attribute?
848 if (p->start >= addr + size)
849 continue;
850 if (p->end < addr)
851 continue;
852 if (p->start <= addr && (p->end >= addr + size - 1))
853 continue;
854 printk(KERN_WARNING "resource map sanity check conflict: "
855 "0x%llx 0x%llx 0x%llx 0x%llx %s\n",
856 (unsigned long long)addr,
857 (unsigned long long)(addr + size - 1),
858 (unsigned long long)p->start,
859 (unsigned long long)p->end,
860 p->name);
861 err = -1;
862 break;
864 read_unlock(&resource_lock);
866 return err;