blob: 89d50412508c1cc27093df24d402a766e5425f64 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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
Linus Torvalds1da177e2005-04-16 15:20:36 -070010#include <linux/module.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070011#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>
Alan Cox8b6d0432010-03-29 19:38:00 +020018#include <linux/sched.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070019#include <linux/seq_file.h>
Tejun Heo9ac78492007-01-20 16:00:26 +090020#include <linux/device.h>
Suresh Siddhad68612b2008-10-28 11:45:42 -070021#include <linux/pfn.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070022#include <asm/io.h>
23
24
25struct resource ioport_resource = {
26 .name = "PCI IO",
Greg Kroah-Hartman6550e072006-06-12 17:11:31 -070027 .start = 0,
Linus Torvalds1da177e2005-04-16 15:20:36 -070028 .end = IO_SPACE_LIMIT,
29 .flags = IORESOURCE_IO,
30};
Linus Torvalds1da177e2005-04-16 15:20:36 -070031EXPORT_SYMBOL(ioport_resource);
32
33struct resource iomem_resource = {
34 .name = "PCI mem",
Greg Kroah-Hartman6550e072006-06-12 17:11:31 -070035 .start = 0,
36 .end = -1,
Linus Torvalds1da177e2005-04-16 15:20:36 -070037 .flags = IORESOURCE_MEM,
38};
Linus Torvalds1da177e2005-04-16 15:20:36 -070039EXPORT_SYMBOL(iomem_resource);
40
41static DEFINE_RWLOCK(resource_lock);
42
Linus Torvalds1da177e2005-04-16 15:20:36 -070043static void *r_next(struct seq_file *m, void *v, loff_t *pos)
44{
45 struct resource *p = v;
46 (*pos)++;
47 if (p->child)
48 return p->child;
49 while (!p->sibling && p->parent)
50 p = p->parent;
51 return p->sibling;
52}
53
Ingo Molnar13eb8372008-09-26 10:10:12 +020054#ifdef CONFIG_PROC_FS
55
56enum { MAX_IORES_LEVEL = 5 };
57
Linus Torvalds1da177e2005-04-16 15:20:36 -070058static void *r_start(struct seq_file *m, loff_t *pos)
59 __acquires(resource_lock)
60{
61 struct resource *p = m->private;
62 loff_t l = 0;
63 read_lock(&resource_lock);
64 for (p = p->child; p && l < *pos; p = r_next(m, p, &l))
65 ;
66 return p;
67}
68
69static void r_stop(struct seq_file *m, void *v)
70 __releases(resource_lock)
71{
72 read_unlock(&resource_lock);
73}
74
75static int r_show(struct seq_file *m, void *v)
76{
77 struct resource *root = m->private;
78 struct resource *r = v, *p;
79 int width = root->end < 0x10000 ? 4 : 8;
80 int depth;
81
82 for (depth = 0, p = r; depth < MAX_IORES_LEVEL; depth++, p = p->parent)
83 if (p->parent == root)
84 break;
Greg Kroah-Hartman685143a2006-06-12 15:18:31 -070085 seq_printf(m, "%*s%0*llx-%0*llx : %s\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -070086 depth * 2, "",
Greg Kroah-Hartman685143a2006-06-12 15:18:31 -070087 width, (unsigned long long) r->start,
88 width, (unsigned long long) r->end,
Linus Torvalds1da177e2005-04-16 15:20:36 -070089 r->name ? r->name : "<BAD>");
90 return 0;
91}
92
Helge Deller15ad7cd2006-12-06 20:40:36 -080093static const struct seq_operations resource_op = {
Linus Torvalds1da177e2005-04-16 15:20:36 -070094 .start = r_start,
95 .next = r_next,
96 .stop = r_stop,
97 .show = r_show,
98};
99
100static int ioports_open(struct inode *inode, struct file *file)
101{
102 int res = seq_open(file, &resource_op);
103 if (!res) {
104 struct seq_file *m = file->private_data;
105 m->private = &ioport_resource;
106 }
107 return res;
108}
109
110static int iomem_open(struct inode *inode, struct file *file)
111{
112 int res = seq_open(file, &resource_op);
113 if (!res) {
114 struct seq_file *m = file->private_data;
115 m->private = &iomem_resource;
116 }
117 return res;
118}
119
Helge Deller15ad7cd2006-12-06 20:40:36 -0800120static const struct file_operations proc_ioports_operations = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121 .open = ioports_open,
122 .read = seq_read,
123 .llseek = seq_lseek,
124 .release = seq_release,
125};
126
Helge Deller15ad7cd2006-12-06 20:40:36 -0800127static const struct file_operations proc_iomem_operations = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128 .open = iomem_open,
129 .read = seq_read,
130 .llseek = seq_lseek,
131 .release = seq_release,
132};
133
134static int __init ioresources_init(void)
135{
Denis V. Lunevc33fff02008-04-29 01:02:31 -0700136 proc_create("ioports", 0, NULL, &proc_ioports_operations);
137 proc_create("iomem", 0, NULL, &proc_iomem_operations);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700138 return 0;
139}
140__initcall(ioresources_init);
141
142#endif /* CONFIG_PROC_FS */
143
144/* Return the conflict entry if you can't request it */
145static struct resource * __request_resource(struct resource *root, struct resource *new)
146{
Greg Kroah-Hartmand75fc8b2006-06-12 16:09:23 -0700147 resource_size_t start = new->start;
148 resource_size_t end = new->end;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149 struct resource *tmp, **p;
150
151 if (end < start)
152 return root;
153 if (start < root->start)
154 return root;
155 if (end > root->end)
156 return root;
157 p = &root->child;
158 for (;;) {
159 tmp = *p;
160 if (!tmp || tmp->start > end) {
161 new->sibling = tmp;
162 *p = new;
163 new->parent = root;
164 return NULL;
165 }
166 p = &tmp->sibling;
167 if (tmp->end < start)
168 continue;
169 return tmp;
170 }
171}
172
173static int __release_resource(struct resource *old)
174{
175 struct resource *tmp, **p;
176
177 p = &old->parent->child;
178 for (;;) {
179 tmp = *p;
180 if (!tmp)
181 break;
182 if (tmp == old) {
183 *p = tmp->sibling;
184 old->parent = NULL;
185 return 0;
186 }
187 p = &tmp->sibling;
188 }
189 return -EINVAL;
190}
191
Yinghai Lu5eeec0e2009-12-22 15:02:22 -0800192static void __release_child_resources(struct resource *r)
193{
194 struct resource *tmp, *p;
195 resource_size_t size;
196
197 p = r->child;
198 r->child = NULL;
199 while (p) {
200 tmp = p;
201 p = p->sibling;
202
203 tmp->parent = NULL;
204 tmp->sibling = NULL;
205 __release_child_resources(tmp);
206
207 printk(KERN_DEBUG "release child resource %pR\n", tmp);
208 /* need to restore size, and keep flags */
209 size = resource_size(tmp);
210 tmp->start = 0;
211 tmp->end = size - 1;
212 }
213}
214
215void release_child_resources(struct resource *r)
216{
217 write_lock(&resource_lock);
218 __release_child_resources(r);
219 write_unlock(&resource_lock);
220}
221
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700222/**
Bjorn Helgaas66f12072010-03-11 17:01:09 -0700223 * request_resource_conflict - request and reserve an I/O or memory resource
224 * @root: root resource descriptor
225 * @new: resource descriptor desired by caller
226 *
227 * Returns 0 for success, conflict resource on error.
228 */
229struct resource *request_resource_conflict(struct resource *root, struct resource *new)
230{
231 struct resource *conflict;
232
233 write_lock(&resource_lock);
234 conflict = __request_resource(root, new);
235 write_unlock(&resource_lock);
236 return conflict;
237}
238
239/**
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700240 * request_resource - 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, negative error code on error.
245 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700246int request_resource(struct resource *root, struct resource *new)
247{
248 struct resource *conflict;
249
Bjorn Helgaas66f12072010-03-11 17:01:09 -0700250 conflict = request_resource_conflict(root, new);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700251 return conflict ? -EBUSY : 0;
252}
253
254EXPORT_SYMBOL(request_resource);
255
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700256/**
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700257 * release_resource - release a previously reserved resource
258 * @old: resource pointer
259 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700260int release_resource(struct resource *old)
261{
262 int retval;
263
264 write_lock(&resource_lock);
265 retval = __release_resource(old);
266 write_unlock(&resource_lock);
267 return retval;
268}
269
270EXPORT_SYMBOL(release_resource);
271
KAMEZAWA Hiroyuki908eedc2009-09-22 16:45:46 -0700272#if !defined(CONFIG_ARCH_HAS_WALK_MEMORY)
KAMEZAWA Hiroyuki2842f112006-06-27 02:53:36 -0700273/*
274 * Finds the lowest memory reosurce exists within [res->start.res->end)
KAMEZAWA Hiroyuki908eedc2009-09-22 16:45:46 -0700275 * the caller must specify res->start, res->end, res->flags and "name".
KAMEZAWA Hiroyuki2842f112006-06-27 02:53:36 -0700276 * If found, returns 0, res is overwritten, if not found, returns -1.
277 */
KAMEZAWA Hiroyuki908eedc2009-09-22 16:45:46 -0700278static int find_next_system_ram(struct resource *res, char *name)
KAMEZAWA Hiroyuki2842f112006-06-27 02:53:36 -0700279{
280 resource_size_t start, end;
281 struct resource *p;
282
283 BUG_ON(!res);
284
285 start = res->start;
286 end = res->end;
KAMEZAWA Hiroyuki58c1b5b2006-08-05 12:15:01 -0700287 BUG_ON(start >= end);
KAMEZAWA Hiroyuki2842f112006-06-27 02:53:36 -0700288
289 read_lock(&resource_lock);
290 for (p = iomem_resource.child; p ; p = p->sibling) {
291 /* system ram is just marked as IORESOURCE_MEM */
292 if (p->flags != res->flags)
293 continue;
KAMEZAWA Hiroyuki908eedc2009-09-22 16:45:46 -0700294 if (name && strcmp(p->name, name))
295 continue;
KAMEZAWA Hiroyuki2842f112006-06-27 02:53:36 -0700296 if (p->start > end) {
297 p = NULL;
298 break;
299 }
KAMEZAWA Hiroyuki58c1b5b2006-08-05 12:15:01 -0700300 if ((p->end >= start) && (p->start < end))
KAMEZAWA Hiroyuki2842f112006-06-27 02:53:36 -0700301 break;
302 }
303 read_unlock(&resource_lock);
304 if (!p)
305 return -1;
306 /* copy data */
KAMEZAWA Hiroyuki0f04ab52006-08-05 12:14:59 -0700307 if (res->start < p->start)
308 res->start = p->start;
309 if (res->end > p->end)
310 res->end = p->end;
KAMEZAWA Hiroyuki2842f112006-06-27 02:53:36 -0700311 return 0;
312}
KAMEZAWA Hiroyuki908eedc2009-09-22 16:45:46 -0700313
314/*
315 * This function calls callback against all memory range of "System RAM"
316 * which are marked as IORESOURCE_MEM and IORESOUCE_BUSY.
317 * Now, this function is only for "System RAM".
318 */
319int walk_system_ram_range(unsigned long start_pfn, unsigned long nr_pages,
320 void *arg, int (*func)(unsigned long, unsigned long, void *))
KAMEZAWA Hiroyuki75884fb2007-10-16 01:26:10 -0700321{
322 struct resource res;
Wu Fengguang37b99dd2010-03-01 21:55:51 +0800323 unsigned long pfn, end_pfn;
KAMEZAWA Hiroyuki75884fb2007-10-16 01:26:10 -0700324 u64 orig_end;
325 int ret = -1;
KAMEZAWA Hiroyuki908eedc2009-09-22 16:45:46 -0700326
KAMEZAWA Hiroyuki75884fb2007-10-16 01:26:10 -0700327 res.start = (u64) start_pfn << PAGE_SHIFT;
328 res.end = ((u64)(start_pfn + nr_pages) << PAGE_SHIFT) - 1;
Yasunori Goto887c3cb2007-11-14 16:59:20 -0800329 res.flags = IORESOURCE_MEM | IORESOURCE_BUSY;
KAMEZAWA Hiroyuki75884fb2007-10-16 01:26:10 -0700330 orig_end = res.end;
KAMEZAWA Hiroyuki908eedc2009-09-22 16:45:46 -0700331 while ((res.start < res.end) &&
332 (find_next_system_ram(&res, "System RAM") >= 0)) {
Wu Fengguang37b99dd2010-03-01 21:55:51 +0800333 pfn = (res.start + PAGE_SIZE - 1) >> PAGE_SHIFT;
334 end_pfn = (res.end + 1) >> PAGE_SHIFT;
335 if (end_pfn > pfn)
H. Peter Anvinf4149662010-03-02 11:21:09 -0800336 ret = (*func)(pfn, end_pfn - pfn, arg);
KAMEZAWA Hiroyuki75884fb2007-10-16 01:26:10 -0700337 if (ret)
338 break;
339 res.start = res.end + 1;
340 res.end = orig_end;
341 }
342 return ret;
343}
344
KAMEZAWA Hiroyuki2842f112006-06-27 02:53:36 -0700345#endif
346
Wu Fengguang61ef2482010-01-22 16:16:19 +0800347static int __is_ram(unsigned long pfn, unsigned long nr_pages, void *arg)
348{
349 return 1;
350}
351/*
352 * This generic page_is_ram() returns true if specified address is
353 * registered as "System RAM" in iomem_resource list.
354 */
Andrew Mortone5273002010-01-26 16:31:19 -0800355int __weak page_is_ram(unsigned long pfn)
Wu Fengguang61ef2482010-01-22 16:16:19 +0800356{
357 return walk_system_ram_range(pfn, 1, NULL, __is_ram) == 1;
358}
359
Bjorn Helgaasa9cea012010-10-26 15:41:13 -0600360static resource_size_t simple_align_resource(void *data,
361 const struct resource *avail,
362 resource_size_t size,
363 resource_size_t align)
364{
365 return avail->start;
366}
367
Bjorn Helgaas5d6b1fa2010-10-26 15:41:18 -0600368static void resource_clip(struct resource *res, resource_size_t min,
369 resource_size_t max)
370{
371 if (res->start < min)
372 res->start = min;
373 if (res->end > max)
374 res->end = max;
375}
376
Bjorn Helgaas6909ba12010-10-26 15:41:23 -0600377static bool resource_contains(struct resource *res1, struct resource *res2)
378{
379 return res1->start <= res2->start && res1->end >= res2->end;
380}
381
Linus Torvalds1da177e2005-04-16 15:20:36 -0700382/*
383 * Find empty slot in the resource tree given range and alignment.
384 */
385static int find_resource(struct resource *root, struct resource *new,
Greg Kroah-Hartmand75fc8b2006-06-12 16:09:23 -0700386 resource_size_t size, resource_size_t min,
387 resource_size_t max, resource_size_t align,
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100388 resource_size_t (*alignf)(void *,
Dominik Brodowski3b7a17f2010-01-01 17:40:50 +0100389 const struct resource *,
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100390 resource_size_t,
391 resource_size_t),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392 void *alignf_data)
393{
394 struct resource *this = root->child;
Bjorn Helgaas6909ba12010-10-26 15:41:23 -0600395 struct resource tmp = *new, alloc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396
Dominik Brodowski0e2c8b82009-12-20 10:50:02 +0100397 tmp.start = root->start;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700398 /*
399 * Skip past an allocated resource that starts at 0, since the assignment
Dominik Brodowski0e2c8b82009-12-20 10:50:02 +0100400 * of this->start - 1 to tmp->end below would cause an underflow.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401 */
402 if (this && this->start == 0) {
Dominik Brodowski0e2c8b82009-12-20 10:50:02 +0100403 tmp.start = this->end + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404 this = this->sibling;
405 }
406 for(;;) {
407 if (this)
Dominik Brodowski0e2c8b82009-12-20 10:50:02 +0100408 tmp.end = this->start - 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700409 else
Dominik Brodowski0e2c8b82009-12-20 10:50:02 +0100410 tmp.end = root->end;
Bjorn Helgaas5d6b1fa2010-10-26 15:41:18 -0600411
412 resource_clip(&tmp, min, max);
Dominik Brodowski0e2c8b82009-12-20 10:50:02 +0100413 tmp.start = ALIGN(tmp.start, align);
Bjorn Helgaasa9cea012010-10-26 15:41:13 -0600414
Bjorn Helgaas6909ba12010-10-26 15:41:23 -0600415 alloc.start = alignf(alignf_data, &tmp, size, align);
416 alloc.end = alloc.start + size - 1;
417 if (resource_contains(&tmp, &alloc)) {
418 new->start = alloc.start;
419 new->end = alloc.end;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700420 return 0;
421 }
422 if (!this)
423 break;
Dominik Brodowski0e2c8b82009-12-20 10:50:02 +0100424 tmp.start = this->end + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425 this = this->sibling;
426 }
427 return -EBUSY;
428}
429
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700430/**
431 * allocate_resource - allocate empty slot in the resource tree given range & alignment
432 * @root: root resource descriptor
433 * @new: resource descriptor desired by caller
434 * @size: requested resource region size
435 * @min: minimum size to allocate
436 * @max: maximum size to allocate
437 * @align: alignment requested, in bytes
438 * @alignf: alignment function, optional, called if not NULL
439 * @alignf_data: arbitrary data to pass to the @alignf function
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440 */
441int allocate_resource(struct resource *root, struct resource *new,
Greg Kroah-Hartmand75fc8b2006-06-12 16:09:23 -0700442 resource_size_t size, resource_size_t min,
443 resource_size_t max, resource_size_t align,
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100444 resource_size_t (*alignf)(void *,
Dominik Brodowski3b7a17f2010-01-01 17:40:50 +0100445 const struct resource *,
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100446 resource_size_t,
447 resource_size_t),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700448 void *alignf_data)
449{
450 int err;
451
Bjorn Helgaasa9cea012010-10-26 15:41:13 -0600452 if (!alignf)
453 alignf = simple_align_resource;
454
Linus Torvalds1da177e2005-04-16 15:20:36 -0700455 write_lock(&resource_lock);
456 err = find_resource(root, new, size, min, max, align, alignf, alignf_data);
457 if (err >= 0 && __request_resource(root, new))
458 err = -EBUSY;
459 write_unlock(&resource_lock);
460 return err;
461}
462
463EXPORT_SYMBOL(allocate_resource);
464
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700465/*
466 * Insert a resource into the resource tree. If successful, return NULL,
467 * otherwise return the conflicting resource (compare to __request_resource())
Linus Torvalds1da177e2005-04-16 15:20:36 -0700468 */
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700469static struct resource * __insert_resource(struct resource *parent, struct resource *new)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700470{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700471 struct resource *first, *next;
472
Matthew Wilcoxd33b6fb2006-06-30 02:31:24 -0700473 for (;; parent = first) {
Matthew Wilcoxd33b6fb2006-06-30 02:31:24 -0700474 first = __request_resource(parent, new);
475 if (!first)
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700476 return first;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700477
Matthew Wilcoxd33b6fb2006-06-30 02:31:24 -0700478 if (first == parent)
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700479 return first;
Matthew Wilcoxd33b6fb2006-06-30 02:31:24 -0700480
481 if ((first->start > new->start) || (first->end < new->end))
482 break;
483 if ((first->start == new->start) && (first->end == new->end))
484 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485 }
486
487 for (next = first; ; next = next->sibling) {
488 /* Partial overlap? Bad, and unfixable */
489 if (next->start < new->start || next->end > new->end)
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700490 return next;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700491 if (!next->sibling)
492 break;
493 if (next->sibling->start > new->end)
494 break;
495 }
496
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497 new->parent = parent;
498 new->sibling = next->sibling;
499 new->child = first;
500
501 next->sibling = NULL;
502 for (next = first; next; next = next->sibling)
503 next->parent = new;
504
505 if (parent->child == first) {
506 parent->child = new;
507 } else {
508 next = parent->child;
509 while (next->sibling != first)
510 next = next->sibling;
511 next->sibling = new;
512 }
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700513 return NULL;
514}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700515
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700516/**
Bjorn Helgaas66f12072010-03-11 17:01:09 -0700517 * insert_resource_conflict - Inserts resource in the resource tree
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700518 * @parent: parent of the new resource
519 * @new: new resource to insert
520 *
Bjorn Helgaas66f12072010-03-11 17:01:09 -0700521 * Returns 0 on success, conflict resource if the resource can't be inserted.
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700522 *
Bjorn Helgaas66f12072010-03-11 17:01:09 -0700523 * This function is equivalent to request_resource_conflict when no conflict
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700524 * happens. If a conflict happens, and the conflicting resources
525 * entirely fit within the range of the new resource, then the new
526 * resource is inserted and the conflicting resources become children of
527 * the new resource.
528 */
Bjorn Helgaas66f12072010-03-11 17:01:09 -0700529struct resource *insert_resource_conflict(struct resource *parent, struct resource *new)
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700530{
531 struct resource *conflict;
532
533 write_lock(&resource_lock);
534 conflict = __insert_resource(parent, new);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535 write_unlock(&resource_lock);
Bjorn Helgaas66f12072010-03-11 17:01:09 -0700536 return conflict;
537}
538
539/**
540 * insert_resource - Inserts a resource in the resource tree
541 * @parent: parent of the new resource
542 * @new: new resource to insert
543 *
544 * Returns 0 on success, -EBUSY if the resource can't be inserted.
545 */
546int insert_resource(struct resource *parent, struct resource *new)
547{
548 struct resource *conflict;
549
550 conflict = insert_resource_conflict(parent, new);
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700551 return conflict ? -EBUSY : 0;
552}
553
554/**
555 * insert_resource_expand_to_fit - Insert a resource into the resource tree
Randy Dunlap6781f4a2008-08-31 20:31:55 -0700556 * @root: root resource descriptor
Linus Torvaldsbef69ea2008-08-29 20:18:31 -0700557 * @new: new resource to insert
558 *
559 * Insert a resource into the resource tree, possibly expanding it in order
560 * to make it encompass any conflicting resources.
561 */
562void insert_resource_expand_to_fit(struct resource *root, struct resource *new)
563{
564 if (new->parent)
565 return;
566
567 write_lock(&resource_lock);
568 for (;;) {
569 struct resource *conflict;
570
571 conflict = __insert_resource(root, new);
572 if (!conflict)
573 break;
574 if (conflict == root)
575 break;
576
577 /* Ok, expand resource to cover the conflict, then try again .. */
578 if (conflict->start < new->start)
579 new->start = conflict->start;
580 if (conflict->end > new->end)
581 new->end = conflict->end;
582
583 printk("Expanded resource %s due to conflict with %s\n", new->name, conflict->name);
584 }
585 write_unlock(&resource_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700586}
587
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700588/**
589 * adjust_resource - modify a resource's start and size
590 * @res: resource to modify
591 * @start: new start value
592 * @size: new size
593 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700594 * Given an existing resource, change its start and size to match the
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700595 * arguments. Returns 0 on success, -EBUSY if it can't fit.
596 * Existing children of the resource are assumed to be immutable.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700597 */
Greg Kroah-Hartmand75fc8b2006-06-12 16:09:23 -0700598int adjust_resource(struct resource *res, resource_size_t start, resource_size_t size)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700599{
600 struct resource *tmp, *parent = res->parent;
Greg Kroah-Hartmand75fc8b2006-06-12 16:09:23 -0700601 resource_size_t end = start + size - 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700602 int result = -EBUSY;
603
604 write_lock(&resource_lock);
605
606 if ((start < parent->start) || (end > parent->end))
607 goto out;
608
609 for (tmp = res->child; tmp; tmp = tmp->sibling) {
610 if ((tmp->start < start) || (tmp->end > end))
611 goto out;
612 }
613
614 if (res->sibling && (res->sibling->start <= end))
615 goto out;
616
617 tmp = parent->child;
618 if (tmp != res) {
619 while (tmp->sibling != res)
620 tmp = tmp->sibling;
621 if (start <= tmp->end)
622 goto out;
623 }
624
625 res->start = start;
626 res->end = end;
627 result = 0;
628
629 out:
630 write_unlock(&resource_lock);
631 return result;
632}
633
Yinghai Lu268364a2008-09-04 21:02:44 +0200634static void __init __reserve_region_with_split(struct resource *root,
635 resource_size_t start, resource_size_t end,
636 const char *name)
637{
638 struct resource *parent = root;
639 struct resource *conflict;
Linus Torvalds42c02022008-11-01 09:53:58 -0700640 struct resource *res = kzalloc(sizeof(*res), GFP_ATOMIC);
Yinghai Lu268364a2008-09-04 21:02:44 +0200641
642 if (!res)
643 return;
644
645 res->name = name;
646 res->start = start;
647 res->end = end;
648 res->flags = IORESOURCE_BUSY;
649
Linus Torvaldsff542502009-04-18 21:44:24 -0700650 conflict = __request_resource(parent, res);
651 if (!conflict)
652 return;
Yinghai Lu268364a2008-09-04 21:02:44 +0200653
Linus Torvaldsff542502009-04-18 21:44:24 -0700654 /* failed, split and try again */
655 kfree(res);
Yinghai Lu268364a2008-09-04 21:02:44 +0200656
Linus Torvaldsff542502009-04-18 21:44:24 -0700657 /* conflict covered whole area */
658 if (conflict->start <= start && conflict->end >= end)
659 return;
Yinghai Lu268364a2008-09-04 21:02:44 +0200660
Linus Torvaldsff542502009-04-18 21:44:24 -0700661 if (conflict->start > start)
662 __reserve_region_with_split(root, start, conflict->start-1, name);
663 if (conflict->end < end)
664 __reserve_region_with_split(root, conflict->end+1, end, name);
Yinghai Lu268364a2008-09-04 21:02:44 +0200665}
666
Paul Mundtbea92112008-10-22 19:31:11 +0900667void __init reserve_region_with_split(struct resource *root,
Yinghai Lu268364a2008-09-04 21:02:44 +0200668 resource_size_t start, resource_size_t end,
669 const char *name)
670{
671 write_lock(&resource_lock);
672 __reserve_region_with_split(root, start, end, name);
673 write_unlock(&resource_lock);
674}
675
Linus Torvalds1da177e2005-04-16 15:20:36 -0700676EXPORT_SYMBOL(adjust_resource);
677
Ivan Kokshaysky88452562008-03-30 19:50:14 +0400678/**
679 * resource_alignment - calculate resource's alignment
680 * @res: resource pointer
681 *
682 * Returns alignment on success, 0 (invalid alignment) on failure.
683 */
684resource_size_t resource_alignment(struct resource *res)
685{
686 switch (res->flags & (IORESOURCE_SIZEALIGN | IORESOURCE_STARTALIGN)) {
687 case IORESOURCE_SIZEALIGN:
Magnus Damm1a4e5642008-07-29 22:32:57 -0700688 return resource_size(res);
Ivan Kokshaysky88452562008-03-30 19:50:14 +0400689 case IORESOURCE_STARTALIGN:
690 return res->start;
691 default:
692 return 0;
693 }
694}
695
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696/*
697 * This is compatibility stuff for IO resources.
698 *
699 * Note how this, unlike the above, knows about
700 * the IO flag meanings (busy etc).
701 *
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700702 * request_region creates a new busy region.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700703 *
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700704 * check_region returns non-zero if the area is already busy.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700705 *
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700706 * release_region releases a matching busy region.
707 */
708
Alan Cox8b6d0432010-03-29 19:38:00 +0200709static DECLARE_WAIT_QUEUE_HEAD(muxed_resource_wait);
710
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700711/**
712 * __request_region - create a new busy resource region
713 * @parent: parent resource descriptor
714 * @start: resource start address
715 * @n: resource region size
716 * @name: reserving caller's ID string
Randy Dunlap6ae301e2009-01-15 13:51:01 -0800717 * @flags: IO resource flags
Linus Torvalds1da177e2005-04-16 15:20:36 -0700718 */
Greg Kroah-Hartmand75fc8b2006-06-12 16:09:23 -0700719struct resource * __request_region(struct resource *parent,
720 resource_size_t start, resource_size_t n,
Arjan van de Vene8de1482008-10-22 19:55:31 -0700721 const char *name, int flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700722{
Alan Cox8b6d0432010-03-29 19:38:00 +0200723 DECLARE_WAITQUEUE(wait, current);
Pekka J Enbergdd392712005-09-06 15:18:31 -0700724 struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700725
Bjorn Helgaasc26ec882008-10-15 22:05:14 -0700726 if (!res)
727 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700728
Bjorn Helgaasc26ec882008-10-15 22:05:14 -0700729 res->name = name;
730 res->start = start;
731 res->end = start + n - 1;
732 res->flags = IORESOURCE_BUSY;
Arjan van de Vene8de1482008-10-22 19:55:31 -0700733 res->flags |= flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700734
Bjorn Helgaasc26ec882008-10-15 22:05:14 -0700735 write_lock(&resource_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700736
Bjorn Helgaasc26ec882008-10-15 22:05:14 -0700737 for (;;) {
738 struct resource *conflict;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700739
Bjorn Helgaasc26ec882008-10-15 22:05:14 -0700740 conflict = __request_resource(parent, res);
741 if (!conflict)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742 break;
Bjorn Helgaasc26ec882008-10-15 22:05:14 -0700743 if (conflict != parent) {
744 parent = conflict;
745 if (!(conflict->flags & IORESOURCE_BUSY))
746 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700747 }
Alan Cox8b6d0432010-03-29 19:38:00 +0200748 if (conflict->flags & flags & IORESOURCE_MUXED) {
749 add_wait_queue(&muxed_resource_wait, &wait);
750 write_unlock(&resource_lock);
751 set_current_state(TASK_UNINTERRUPTIBLE);
752 schedule();
753 remove_wait_queue(&muxed_resource_wait, &wait);
754 write_lock(&resource_lock);
755 continue;
756 }
Bjorn Helgaasc26ec882008-10-15 22:05:14 -0700757 /* Uhhuh, that didn't work out.. */
758 kfree(res);
759 res = NULL;
760 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761 }
Bjorn Helgaasc26ec882008-10-15 22:05:14 -0700762 write_unlock(&resource_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700763 return res;
764}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700765EXPORT_SYMBOL(__request_region);
766
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700767/**
768 * __check_region - check if a resource region is busy or free
769 * @parent: parent resource descriptor
770 * @start: resource start address
771 * @n: resource region size
772 *
773 * Returns 0 if the region is free at the moment it is checked,
774 * returns %-EBUSY if the region is busy.
775 *
776 * NOTE:
777 * This function is deprecated because its use is racy.
778 * Even if it returns 0, a subsequent call to request_region()
779 * may fail because another driver etc. just allocated the region.
780 * Do NOT use it. It will be removed from the kernel.
781 */
Greg Kroah-Hartmand75fc8b2006-06-12 16:09:23 -0700782int __check_region(struct resource *parent, resource_size_t start,
783 resource_size_t n)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700784{
785 struct resource * res;
786
Arjan van de Vene8de1482008-10-22 19:55:31 -0700787 res = __request_region(parent, start, n, "check-region", 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700788 if (!res)
789 return -EBUSY;
790
791 release_resource(res);
792 kfree(res);
793 return 0;
794}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700795EXPORT_SYMBOL(__check_region);
796
Randy Dunlape1ca66d2006-10-03 01:13:51 -0700797/**
798 * __release_region - release a previously reserved resource region
799 * @parent: parent resource descriptor
800 * @start: resource start address
801 * @n: resource region size
802 *
803 * The described resource region must match a currently busy region.
804 */
Greg Kroah-Hartmand75fc8b2006-06-12 16:09:23 -0700805void __release_region(struct resource *parent, resource_size_t start,
806 resource_size_t n)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700807{
808 struct resource **p;
Greg Kroah-Hartmand75fc8b2006-06-12 16:09:23 -0700809 resource_size_t end;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700810
811 p = &parent->child;
812 end = start + n - 1;
813
814 write_lock(&resource_lock);
815
816 for (;;) {
817 struct resource *res = *p;
818
819 if (!res)
820 break;
821 if (res->start <= start && res->end >= end) {
822 if (!(res->flags & IORESOURCE_BUSY)) {
823 p = &res->child;
824 continue;
825 }
826 if (res->start != start || res->end != end)
827 break;
828 *p = res->sibling;
829 write_unlock(&resource_lock);
Alan Cox8b6d0432010-03-29 19:38:00 +0200830 if (res->flags & IORESOURCE_MUXED)
831 wake_up(&muxed_resource_wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832 kfree(res);
833 return;
834 }
835 p = &res->sibling;
836 }
837
838 write_unlock(&resource_lock);
839
Greg Kroah-Hartman685143a2006-06-12 15:18:31 -0700840 printk(KERN_WARNING "Trying to free nonexistent resource "
841 "<%016llx-%016llx>\n", (unsigned long long)start,
842 (unsigned long long)end);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700843}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844EXPORT_SYMBOL(__release_region);
845
846/*
Tejun Heo9ac78492007-01-20 16:00:26 +0900847 * Managed region resource
848 */
849struct region_devres {
850 struct resource *parent;
851 resource_size_t start;
852 resource_size_t n;
853};
854
855static void devm_region_release(struct device *dev, void *res)
856{
857 struct region_devres *this = res;
858
859 __release_region(this->parent, this->start, this->n);
860}
861
862static int devm_region_match(struct device *dev, void *res, void *match_data)
863{
864 struct region_devres *this = res, *match = match_data;
865
866 return this->parent == match->parent &&
867 this->start == match->start && this->n == match->n;
868}
869
870struct resource * __devm_request_region(struct device *dev,
871 struct resource *parent, resource_size_t start,
872 resource_size_t n, const char *name)
873{
874 struct region_devres *dr = NULL;
875 struct resource *res;
876
877 dr = devres_alloc(devm_region_release, sizeof(struct region_devres),
878 GFP_KERNEL);
879 if (!dr)
880 return NULL;
881
882 dr->parent = parent;
883 dr->start = start;
884 dr->n = n;
885
Arjan van de Vene8de1482008-10-22 19:55:31 -0700886 res = __request_region(parent, start, n, name, 0);
Tejun Heo9ac78492007-01-20 16:00:26 +0900887 if (res)
888 devres_add(dev, dr);
889 else
890 devres_free(dr);
891
892 return res;
893}
894EXPORT_SYMBOL(__devm_request_region);
895
896void __devm_release_region(struct device *dev, struct resource *parent,
897 resource_size_t start, resource_size_t n)
898{
899 struct region_devres match_data = { parent, start, n };
900
901 __release_region(parent, start, n);
902 WARN_ON(devres_destroy(dev, devm_region_release, devm_region_match,
903 &match_data));
904}
905EXPORT_SYMBOL(__devm_release_region);
906
907/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700908 * Called from init/main.c to reserve IO ports.
909 */
910#define MAXRESERVE 4
911static int __init reserve_setup(char *str)
912{
913 static int reserved;
914 static struct resource reserve[MAXRESERVE];
915
916 for (;;) {
Zhang Rui8bc1ad72009-06-30 11:41:31 -0700917 unsigned int io_start, io_num;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700918 int x = reserved;
919
920 if (get_option (&str, &io_start) != 2)
921 break;
922 if (get_option (&str, &io_num) == 0)
923 break;
924 if (x < MAXRESERVE) {
925 struct resource *res = reserve + x;
926 res->name = "reserved";
927 res->start = io_start;
928 res->end = io_start + io_num - 1;
929 res->flags = IORESOURCE_BUSY;
930 res->child = NULL;
931 if (request_resource(res->start >= 0x10000 ? &iomem_resource : &ioport_resource, res) == 0)
932 reserved = x+1;
933 }
934 }
935 return 1;
936}
937
938__setup("reserve=", reserve_setup);
Suresh Siddha379daf62008-09-25 18:43:34 -0700939
940/*
941 * Check if the requested addr and size spans more than any slot in the
942 * iomem resource tree.
943 */
944int iomem_map_sanity_check(resource_size_t addr, unsigned long size)
945{
946 struct resource *p = &iomem_resource;
947 int err = 0;
948 loff_t l;
949
950 read_lock(&resource_lock);
951 for (p = p->child; p ; p = r_next(NULL, p, &l)) {
952 /*
953 * We can probably skip the resources without
954 * IORESOURCE_IO attribute?
955 */
956 if (p->start >= addr + size)
957 continue;
958 if (p->end < addr)
959 continue;
Suresh Siddhad68612b2008-10-28 11:45:42 -0700960 if (PFN_DOWN(p->start) <= PFN_DOWN(addr) &&
961 PFN_DOWN(p->end) >= PFN_DOWN(addr + size - 1))
Suresh Siddha379daf62008-09-25 18:43:34 -0700962 continue;
Arjan van de Ven3ac52662008-12-13 09:15:27 -0800963 /*
964 * if a resource is "BUSY", it's not a hardware resource
965 * but a driver mapping of such a resource; we don't want
966 * to warn for those; some drivers legitimately map only
967 * partial hardware resources. (example: vesafb)
968 */
969 if (p->flags & IORESOURCE_BUSY)
970 continue;
971
Suresh Siddha379daf62008-09-25 18:43:34 -0700972 printk(KERN_WARNING "resource map sanity check conflict: "
973 "0x%llx 0x%llx 0x%llx 0x%llx %s\n",
Ingo Molnar13eb8372008-09-26 10:10:12 +0200974 (unsigned long long)addr,
975 (unsigned long long)(addr + size - 1),
976 (unsigned long long)p->start,
977 (unsigned long long)p->end,
978 p->name);
Suresh Siddha379daf62008-09-25 18:43:34 -0700979 err = -1;
980 break;
981 }
982 read_unlock(&resource_lock);
983
984 return err;
985}
Arjan van de Vene8de1482008-10-22 19:55:31 -0700986
987#ifdef CONFIG_STRICT_DEVMEM
988static int strict_iomem_checks = 1;
989#else
990static int strict_iomem_checks;
991#endif
992
993/*
994 * check if an address is reserved in the iomem resource tree
995 * returns 1 if reserved, 0 if not reserved.
996 */
997int iomem_is_exclusive(u64 addr)
998{
999 struct resource *p = &iomem_resource;
1000 int err = 0;
1001 loff_t l;
1002 int size = PAGE_SIZE;
1003
1004 if (!strict_iomem_checks)
1005 return 0;
1006
1007 addr = addr & PAGE_MASK;
1008
1009 read_lock(&resource_lock);
1010 for (p = p->child; p ; p = r_next(NULL, p, &l)) {
1011 /*
1012 * We can probably skip the resources without
1013 * IORESOURCE_IO attribute?
1014 */
1015 if (p->start >= addr + size)
1016 break;
1017 if (p->end < addr)
1018 continue;
1019 if (p->flags & IORESOURCE_BUSY &&
1020 p->flags & IORESOURCE_EXCLUSIVE) {
1021 err = 1;
1022 break;
1023 }
1024 }
1025 read_unlock(&resource_lock);
1026
1027 return err;
1028}
1029
1030static int __init strict_iomem(char *str)
1031{
1032 if (strstr(str, "relaxed"))
1033 strict_iomem_checks = 0;
1034 if (strstr(str, "strict"))
1035 strict_iomem_checks = 1;
1036 return 1;
1037}
1038
1039__setup("iomem=", strict_iomem);