pcmcia: do not meddle with already assigned resources
[linux-2.6-block.git] / drivers / pcmcia / rsrc_nonstatic.c
CommitLineData
1da177e4
LT
1/*
2 * rsrc_nonstatic.c -- Resource management routines for !SS_CAP_STATIC_MAP sockets
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
7 *
8 * The initial developer of the original code is David A. Hinds
9 * <dahinds@users.sourceforge.net>. Portions created by David A. Hinds
10 * are Copyright (C) 1999 David A. Hinds. All Rights Reserved.
11 *
12 * (C) 1999 David A. Hinds
13 */
14
1da177e4
LT
15#include <linux/module.h>
16#include <linux/moduleparam.h>
17#include <linux/init.h>
18#include <linux/interrupt.h>
19#include <linux/kernel.h>
20#include <linux/errno.h>
21#include <linux/types.h>
22#include <linux/slab.h>
23#include <linux/ioport.h>
24#include <linux/timer.h>
25#include <linux/pci.h>
26#include <linux/device.h>
9fea84f4 27#include <linux/io.h>
1da177e4
LT
28
29#include <asm/irq.h>
1da177e4
LT
30
31#include <pcmcia/cs_types.h>
32#include <pcmcia/ss.h>
33#include <pcmcia/cs.h>
1da177e4
LT
34#include <pcmcia/cistpl.h>
35#include "cs_internal.h"
36
37MODULE_AUTHOR("David A. Hinds, Dominik Brodowski");
38MODULE_LICENSE("GPL");
39
40/* Parameters that can be set with 'insmod' */
41
42#define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0444)
43
44INT_MODULE_PARM(probe_mem, 1); /* memory probe? */
45#ifdef CONFIG_PCMCIA_PROBE
46INT_MODULE_PARM(probe_io, 1); /* IO port probe? */
47INT_MODULE_PARM(mem_limit, 0x10000);
48#endif
49
50/* for io_db and mem_db */
51struct resource_map {
52 u_long base, num;
53 struct resource_map *next;
54};
55
56struct socket_data {
57 struct resource_map mem_db;
58 struct resource_map io_db;
59 unsigned int rsrc_mem_probe;
60};
61
7fe908dd 62static DEFINE_MUTEX(rsrc_mutex);
1da177e4
LT
63#define MEM_PROBE_LOW (1 << 0)
64#define MEM_PROBE_HIGH (1 << 1)
65
66
67/*======================================================================
68
69 Linux resource management extensions
70
71======================================================================*/
72
73static struct resource *
25096986 74make_resource(resource_size_t b, resource_size_t n, int flags, const char *name)
1da177e4 75{
8084b372 76 struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL);
1da177e4
LT
77
78 if (res) {
1da177e4
LT
79 res->name = name;
80 res->start = b;
81 res->end = b + n - 1;
82 res->flags = flags;
83 }
84 return res;
85}
86
87static struct resource *
2427ddd8
GKH
88claim_region(struct pcmcia_socket *s, resource_size_t base,
89 resource_size_t size, int type, char *name)
1da177e4
LT
90{
91 struct resource *res, *parent;
92
93 parent = type & IORESOURCE_MEM ? &iomem_resource : &ioport_resource;
94 res = make_resource(base, size, type | IORESOURCE_BUSY, name);
95
96 if (res) {
97#ifdef CONFIG_PCI
98 if (s && s->cb_dev)
99 parent = pci_find_parent_resource(s->cb_dev, res);
100#endif
101 if (!parent || request_resource(parent, res)) {
102 kfree(res);
103 res = NULL;
104 }
105 }
106 return res;
107}
108
109static void free_region(struct resource *res)
110{
111 if (res) {
112 release_resource(res);
113 kfree(res);
114 }
115}
116
117/*======================================================================
118
119 These manage the internal databases of available resources.
120
121======================================================================*/
122
123static int add_interval(struct resource_map *map, u_long base, u_long num)
124{
1168386a 125 struct resource_map *p, *q;
1da177e4 126
1168386a
DB
127 for (p = map; ; p = p->next) {
128 if ((p != map) && (p->base+p->num-1 >= base))
129 return -1;
130 if ((p->next == map) || (p->next->base > base+num-1))
131 break;
132 }
133 q = kmalloc(sizeof(struct resource_map), GFP_KERNEL);
134 if (!q) {
135 printk(KERN_WARNING "out of memory to update resources\n");
136 return -ENOMEM;
137 }
138 q->base = base; q->num = num;
139 q->next = p->next; p->next = q;
140 return 0;
1da177e4
LT
141}
142
143/*====================================================================*/
144
145static int sub_interval(struct resource_map *map, u_long base, u_long num)
146{
9fea84f4
DB
147 struct resource_map *p, *q;
148
149 for (p = map; ; p = q) {
150 q = p->next;
151 if (q == map)
152 break;
153 if ((q->base+q->num > base) && (base+num > q->base)) {
154 if (q->base >= base) {
155 if (q->base+q->num <= base+num) {
156 /* Delete whole block */
157 p->next = q->next;
158 kfree(q);
159 /* don't advance the pointer yet */
160 q = p;
161 } else {
162 /* Cut off bit from the front */
163 q->num = q->base + q->num - base - num;
164 q->base = base + num;
165 }
166 } else if (q->base+q->num <= base+num) {
167 /* Cut off bit from the end */
168 q->num = base - q->base;
169 } else {
170 /* Split the block into two pieces */
171 p = kmalloc(sizeof(struct resource_map),
172 GFP_KERNEL);
173 if (!p) {
174 printk(KERN_WARNING "out of memory to update resources\n");
175 return -ENOMEM;
176 }
177 p->base = base+num;
178 p->num = q->base+q->num - p->base;
179 q->num = base - q->base;
180 p->next = q->next ; q->next = p;
181 }
1168386a 182 }
9fea84f4
DB
183 }
184 return 0;
1da177e4
LT
185}
186
187/*======================================================================
188
189 These routines examine a region of IO or memory addresses to
190 determine what ranges might be genuinely available.
191
192======================================================================*/
193
194#ifdef CONFIG_PCMCIA_PROBE
906da809
OJ
195static void do_io_probe(struct pcmcia_socket *s, unsigned int base,
196 unsigned int num)
1da177e4 197{
9fea84f4
DB
198 struct resource *res;
199 struct socket_data *s_data = s->resource_data;
200 unsigned int i, j, bad;
201 int any;
202 u_char *b, hole, most;
203
204 dev_printk(KERN_INFO, &s->dev, "cs: IO port probe %#x-%#x:",
205 base, base+num-1);
206
207 /* First, what does a floating port look like? */
208 b = kzalloc(256, GFP_KERNEL);
209 if (!b) {
210 printk("\n");
211 dev_printk(KERN_ERR, &s->dev,
212 "do_io_probe: unable to kmalloc 256 bytes");
213 return;
214 }
215 for (i = base, most = 0; i < base+num; i += 8) {
216 res = claim_region(NULL, i, 8, IORESOURCE_IO, "PCMCIA ioprobe");
217 if (!res)
218 continue;
219 hole = inb(i);
220 for (j = 1; j < 8; j++)
221 if (inb(i+j) != hole)
222 break;
223 free_region(res);
224 if ((j == 8) && (++b[hole] > b[most]))
225 most = hole;
226 if (b[most] == 127)
227 break;
228 }
229 kfree(b);
230
231 bad = any = 0;
232 for (i = base; i < base+num; i += 8) {
233 res = claim_region(NULL, i, 8, IORESOURCE_IO, "PCMCIA ioprobe");
234 if (!res)
235 continue;
236 for (j = 0; j < 8; j++)
237 if (inb(i+j) != most)
238 break;
239 free_region(res);
240 if (j < 8) {
241 if (!any)
242 printk(" excluding");
243 if (!bad)
244 bad = any = i;
245 } else {
246 if (bad) {
247 sub_interval(&s_data->io_db, bad, i-bad);
248 printk(" %#x-%#x", bad, i-1);
249 bad = 0;
250 }
251 }
252 }
253 if (bad) {
254 if ((num > 16) && (bad == base) && (i == base+num)) {
255 printk(" nothing: probe failed.\n");
256 return;
257 } else {
258 sub_interval(&s_data->io_db, bad, i-bad);
259 printk(" %#x-%#x", bad, i-1);
260 }
261 }
262
263 printk(any ? "\n" : " clean.\n");
1da177e4
LT
264}
265#endif
266
267/*======================================================================
268
269 This is tricky... when we set up CIS memory, we try to validate
270 the memory window space allocations.
271
272======================================================================*/
273
274/* Validation function for cards with a valid CIS */
c5081d5f
DB
275static int readable(struct pcmcia_socket *s, struct resource *res,
276 unsigned int *count)
1da177e4
LT
277{
278 int ret = -1;
279
280 s->cis_mem.res = res;
281 s->cis_virt = ioremap(res->start, s->map_size);
282 if (s->cis_virt) {
84897fc0 283 ret = pccard_validate_cis(s, count);
1da177e4
LT
284 /* invalidate mapping and CIS cache */
285 iounmap(s->cis_virt);
286 s->cis_virt = NULL;
287 destroy_cis_cache(s);
288 }
289 s->cis_mem.res = NULL;
0e09c863 290 if ((ret != 0) || (*count == 0))
1da177e4
LT
291 return 0;
292 return 1;
293}
294
295/* Validation function for simple memory cards */
296static int checksum(struct pcmcia_socket *s, struct resource *res)
297{
298 pccard_mem_map map;
299 int i, a = 0, b = -1, d;
300 void __iomem *virt;
301
302 virt = ioremap(res->start, s->map_size);
303 if (virt) {
304 map.map = 0;
305 map.flags = MAP_ACTIVE;
306 map.speed = 0;
307 map.res = res;
308 map.card_start = 0;
309 s->ops->set_mem_map(s, &map);
310
311 /* Don't bother checking every word... */
312 for (i = 0; i < s->map_size; i += 44) {
313 d = readl(virt+i);
314 a += d;
315 b &= d;
316 }
317
318 map.flags = 0;
319 s->ops->set_mem_map(s, &map);
320
321 iounmap(virt);
322 }
323
324 return (b == -1) ? -1 : (a>>1);
325}
326
327static int
328cis_readable(struct pcmcia_socket *s, unsigned long base, unsigned long size)
329{
330 struct resource *res1, *res2;
c5081d5f 331 unsigned int info1, info2;
1da177e4
LT
332 int ret = 0;
333
9fea84f4
DB
334 res1 = claim_region(s, base, size/2, IORESOURCE_MEM, "PCMCIA memprobe");
335 res2 = claim_region(s, base + size/2, size/2, IORESOURCE_MEM,
336 "PCMCIA memprobe");
1da177e4
LT
337
338 if (res1 && res2) {
339 ret = readable(s, res1, &info1);
340 ret += readable(s, res2, &info2);
341 }
342
343 free_region(res2);
344 free_region(res1);
345
c5081d5f 346 return (ret == 2) && (info1 == info2);
1da177e4
LT
347}
348
349static int
350checksum_match(struct pcmcia_socket *s, unsigned long base, unsigned long size)
351{
352 struct resource *res1, *res2;
353 int a = -1, b = -1;
354
9fea84f4
DB
355 res1 = claim_region(s, base, size/2, IORESOURCE_MEM, "PCMCIA memprobe");
356 res2 = claim_region(s, base + size/2, size/2, IORESOURCE_MEM,
357 "PCMCIA memprobe");
1da177e4
LT
358
359 if (res1 && res2) {
360 a = checksum(s, res1);
361 b = checksum(s, res2);
362 }
363
364 free_region(res2);
365 free_region(res1);
366
367 return (a == b) && (a >= 0);
368}
369
370/*======================================================================
371
372 The memory probe. If the memory list includes a 64K-aligned block
373 below 1MB, we probe in 64K chunks, and as soon as we accumulate at
374 least mem_limit free space, we quit.
375
376======================================================================*/
377
378static int do_mem_probe(u_long base, u_long num, struct pcmcia_socket *s)
379{
9fea84f4
DB
380 struct socket_data *s_data = s->resource_data;
381 u_long i, j, bad, fail, step;
382
383 dev_printk(KERN_INFO, &s->dev, "cs: memory probe 0x%06lx-0x%06lx:",
384 base, base+num-1);
385 bad = fail = 0;
386 step = (num < 0x20000) ? 0x2000 : ((num>>4) & ~0x1fff);
387 /* don't allow too large steps */
388 if (step > 0x800000)
389 step = 0x800000;
390 /* cis_readable wants to map 2x map_size */
391 if (step < 2 * s->map_size)
392 step = 2 * s->map_size;
393 for (i = j = base; i < base+num; i = j + step) {
394 if (!fail) {
395 for (j = i; j < base+num; j += step) {
396 if (cis_readable(s, j, step))
397 break;
398 }
399 fail = ((i == base) && (j == base+num));
400 }
401 if (fail) {
402 for (j = i; j < base+num; j += 2*step)
403 if (checksum_match(s, j, step) &&
404 checksum_match(s, j + step, step))
405 break;
406 }
407 if (i != j) {
408 if (!bad)
409 printk(" excluding");
410 printk(" %#05lx-%#05lx", i, j-1);
411 sub_interval(&s_data->mem_db, i, j-i);
412 bad += j-i;
413 }
414 }
415 printk(bad ? "\n" : " clean.\n");
416 return num - bad;
1da177e4
LT
417}
418
419#ifdef CONFIG_PCMCIA_PROBE
420
421static u_long inv_probe(struct resource_map *m, struct pcmcia_socket *s)
422{
de75914e
DB
423 struct socket_data *s_data = s->resource_data;
424 u_long ok;
425 if (m == &s_data->mem_db)
426 return 0;
427 ok = inv_probe(m->next, s);
428 if (ok) {
429 if (m->base >= 0x100000)
430 sub_interval(&s_data->mem_db, m->base, m->num);
431 return ok;
432 }
433 if (m->base < 0x100000)
434 return 0;
435 return do_mem_probe(m->base, m->num, s);
1da177e4
LT
436}
437
de75914e 438static int validate_mem(struct pcmcia_socket *s, unsigned int probe_mask)
1da177e4 439{
de75914e
DB
440 struct resource_map *m, mm;
441 static unsigned char order[] = { 0xd0, 0xe0, 0xc0, 0xf0 };
442 unsigned long b, i, ok = 0;
443 struct socket_data *s_data = s->resource_data;
1da177e4 444
de75914e
DB
445 /* We do up to four passes through the list */
446 if (probe_mask & MEM_PROBE_HIGH) {
447 if (inv_probe(s_data->mem_db.next, s) > 0)
448 return 0;
dbe4ea5f
DB
449 dev_printk(KERN_NOTICE, &s->dev,
450 "cs: warning: no high memory space available!\n");
de75914e 451 return -ENODEV;
1da177e4 452 }
de75914e
DB
453
454 for (m = s_data->mem_db.next; m != &s_data->mem_db; m = mm.next) {
455 mm = *m;
456 /* Only probe < 1 MB */
457 if (mm.base >= 0x100000)
458 continue;
459 if ((mm.base | mm.num) & 0xffff) {
460 ok += do_mem_probe(mm.base, mm.num, s);
461 continue;
462 }
463 /* Special probe for 64K-aligned block */
464 for (i = 0; i < 4; i++) {
465 b = order[i] << 12;
466 if ((b >= mm.base) && (b+0x10000 <= mm.base+mm.num)) {
467 if (ok >= mem_limit)
468 sub_interval(&s_data->mem_db, b, 0x10000);
469 else
470 ok += do_mem_probe(b, 0x10000, s);
471 }
472 }
1da177e4 473 }
de75914e
DB
474
475 if (ok > 0)
476 return 0;
477
478 return -ENODEV;
1da177e4
LT
479}
480
481#else /* CONFIG_PCMCIA_PROBE */
482
2cff9447 483static int validate_mem(struct pcmcia_socket *s, unsigned int probe_mask)
1da177e4
LT
484{
485 struct resource_map *m, mm;
486 struct socket_data *s_data = s->resource_data;
2cff9447 487 unsigned long ok = 0;
1da177e4
LT
488
489 for (m = s_data->mem_db.next; m != &s_data->mem_db; m = mm.next) {
490 mm = *m;
2cff9447 491 ok += do_mem_probe(mm.base, mm.num, s);
1da177e4 492 }
2cff9447
AM
493 if (ok > 0)
494 return 0;
495 return -ENODEV;
1da177e4
LT
496}
497
498#endif /* CONFIG_PCMCIA_PROBE */
499
500
501/*
7fe908dd 502 * Locking note: Must be called with skt_mutex held!
1da177e4 503 */
de75914e 504static int pcmcia_nonstatic_validate_mem(struct pcmcia_socket *s)
1da177e4
LT
505{
506 struct socket_data *s_data = s->resource_data;
de75914e
DB
507 unsigned int probe_mask = MEM_PROBE_LOW;
508 int ret = 0;
509
510 if (!probe_mem)
511 return 0;
1da177e4 512
7fe908dd 513 mutex_lock(&rsrc_mutex);
1da177e4 514
de75914e
DB
515 if (s->features & SS_CAP_PAGE_REGS)
516 probe_mask = MEM_PROBE_HIGH;
1da177e4 517
de75914e
DB
518 if (probe_mask & ~s_data->rsrc_mem_probe) {
519 if (s->state & SOCKET_PRESENT)
520 ret = validate_mem(s, probe_mask);
521 if (!ret)
1da177e4 522 s_data->rsrc_mem_probe |= probe_mask;
de75914e 523 }
1da177e4 524
7fe908dd 525 mutex_unlock(&rsrc_mutex);
1da177e4 526
de75914e 527 return ret;
1da177e4
LT
528}
529
530struct pcmcia_align_data {
531 unsigned long mask;
532 unsigned long offset;
533 struct resource_map *map;
534};
535
536static void
537pcmcia_common_align(void *align_data, struct resource *res,
2427ddd8 538 resource_size_t size, resource_size_t align)
1da177e4
LT
539{
540 struct pcmcia_align_data *data = align_data;
2427ddd8 541 resource_size_t start;
1da177e4
LT
542 /*
543 * Ensure that we have the correct start address
544 */
545 start = (res->start & ~data->mask) + data->offset;
546 if (start < res->start)
547 start += data->mask + 1;
548 res->start = start;
549}
550
551static void
2427ddd8
GKH
552pcmcia_align(void *align_data, struct resource *res, resource_size_t size,
553 resource_size_t align)
1da177e4
LT
554{
555 struct pcmcia_align_data *data = align_data;
556 struct resource_map *m;
557
558 pcmcia_common_align(data, res, size, align);
559
560 for (m = data->map->next; m != data->map; m = m->next) {
561 unsigned long start = m->base;
562 unsigned long end = m->base + m->num - 1;
563
564 /*
565 * If the lower resources are not available, try aligning
566 * to this entry of the resource database to see if it'll
567 * fit here.
568 */
569 if (res->start < start) {
570 res->start = start;
571 pcmcia_common_align(data, res, size, align);
572 }
573
574 /*
575 * If we're above the area which was passed in, there's
576 * no point proceeding.
577 */
578 if (res->start >= res->end)
579 break;
580
581 if ((res->start + size - 1) <= end)
582 break;
583 }
584
585 /*
586 * If we failed to find something suitable, ensure we fail.
587 */
588 if (m == data->map)
589 res->start = res->end;
590}
591
592/*
593 * Adjust an existing IO region allocation, but making sure that we don't
594 * encroach outside the resources which the user supplied.
595 */
596static int nonstatic_adjust_io_region(struct resource *res, unsigned long r_start,
597 unsigned long r_end, struct pcmcia_socket *s)
598{
599 struct resource_map *m;
600 struct socket_data *s_data = s->resource_data;
601 int ret = -ENOMEM;
602
7fe908dd 603 mutex_lock(&rsrc_mutex);
1da177e4
LT
604 for (m = s_data->io_db.next; m != &s_data->io_db; m = m->next) {
605 unsigned long start = m->base;
606 unsigned long end = m->base + m->num - 1;
607
608 if (start > r_start || r_end > end)
609 continue;
610
611 ret = adjust_resource(res, r_start, r_end - r_start + 1);
612 break;
613 }
7fe908dd 614 mutex_unlock(&rsrc_mutex);
1da177e4
LT
615
616 return ret;
617}
618
619/*======================================================================
620
621 These find ranges of I/O ports or memory addresses that are not
622 currently allocated by other devices.
623
624 The 'align' field should reflect the number of bits of address
625 that need to be preserved from the initial value of *base. It
626 should be a power of two, greater than or equal to 'num'. A value
627 of 0 means that all bits of *base are significant. *base should
628 also be strictly less than 'align'.
629
630======================================================================*/
631
e94e15f7 632static struct resource *nonstatic_find_io_region(unsigned long base, int num,
1da177e4
LT
633 unsigned long align, struct pcmcia_socket *s)
634{
25096986 635 struct resource *res = make_resource(0, num, IORESOURCE_IO, dev_name(&s->dev));
1da177e4
LT
636 struct socket_data *s_data = s->resource_data;
637 struct pcmcia_align_data data;
638 unsigned long min = base;
639 int ret;
640
641 if (align == 0)
642 align = 0x10000;
643
644 data.mask = align - 1;
645 data.offset = base & data.mask;
646 data.map = &s_data->io_db;
647
7fe908dd 648 mutex_lock(&rsrc_mutex);
1da177e4
LT
649#ifdef CONFIG_PCI
650 if (s->cb_dev) {
651 ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1,
652 min, 0, pcmcia_align, &data);
653 } else
654#endif
655 ret = allocate_resource(&ioport_resource, res, num, min, ~0UL,
656 1, pcmcia_align, &data);
7fe908dd 657 mutex_unlock(&rsrc_mutex);
1da177e4
LT
658
659 if (ret != 0) {
660 kfree(res);
661 res = NULL;
662 }
663 return res;
664}
665
9fea84f4 666static struct resource *nonstatic_find_mem_region(u_long base, u_long num,
e94e15f7 667 u_long align, int low, struct pcmcia_socket *s)
1da177e4 668{
25096986 669 struct resource *res = make_resource(0, num, IORESOURCE_MEM, dev_name(&s->dev));
1da177e4
LT
670 struct socket_data *s_data = s->resource_data;
671 struct pcmcia_align_data data;
672 unsigned long min, max;
673 int ret, i;
674
675 low = low || !(s->features & SS_CAP_PAGE_REGS);
676
677 data.mask = align - 1;
678 data.offset = base & data.mask;
679 data.map = &s_data->mem_db;
680
681 for (i = 0; i < 2; i++) {
682 if (low) {
683 max = 0x100000UL;
684 min = base < max ? base : 0;
685 } else {
686 max = ~0UL;
687 min = 0x100000UL + base;
688 }
689
7fe908dd 690 mutex_lock(&rsrc_mutex);
1da177e4
LT
691#ifdef CONFIG_PCI
692 if (s->cb_dev) {
693 ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num,
694 1, min, 0,
695 pcmcia_align, &data);
696 } else
697#endif
698 ret = allocate_resource(&iomem_resource, res, num, min,
699 max, 1, pcmcia_align, &data);
7fe908dd 700 mutex_unlock(&rsrc_mutex);
1da177e4
LT
701 if (ret == 0 || low)
702 break;
703 low = 1;
704 }
705
706 if (ret != 0) {
707 kfree(res);
708 res = NULL;
709 }
710 return res;
711}
712
713
22916638 714static int adjust_memory(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
1da177e4 715{
1da177e4 716 struct socket_data *data = s->resource_data;
22916638
DB
717 unsigned long size = end - start + 1;
718 int ret = 0;
1da177e4 719
1146bc74 720 if (end < start)
22916638 721 return -EINVAL;
1da177e4 722
7fe908dd 723 mutex_lock(&rsrc_mutex);
22916638 724 switch (action) {
1da177e4 725 case ADD_MANAGED_RESOURCE:
22916638 726 ret = add_interval(&data->mem_db, start, size);
1da177e4
LT
727 break;
728 case REMOVE_MANAGED_RESOURCE:
22916638 729 ret = sub_interval(&data->mem_db, start, size);
1da177e4
LT
730 break;
731 default:
22916638 732 ret = -EINVAL;
1da177e4 733 }
7fe908dd 734 mutex_unlock(&rsrc_mutex);
1da177e4
LT
735
736 return ret;
737}
738
739
22916638 740static int adjust_io(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
1da177e4
LT
741{
742 struct socket_data *data = s->resource_data;
22916638
DB
743 unsigned long size = end - start + 1;
744 int ret = 0;
1da177e4 745
1146bc74 746 if (end < start)
22916638
DB
747 return -EINVAL;
748
749 if (end > IO_SPACE_LIMIT)
750 return -EINVAL;
1da177e4 751
7fe908dd 752 mutex_lock(&rsrc_mutex);
22916638 753 switch (action) {
1da177e4 754 case ADD_MANAGED_RESOURCE:
22916638
DB
755 if (add_interval(&data->io_db, start, size) != 0) {
756 ret = -EBUSY;
1da177e4
LT
757 break;
758 }
759#ifdef CONFIG_PCMCIA_PROBE
760 if (probe_io)
22916638 761 do_io_probe(s, start, size);
1da177e4
LT
762#endif
763 break;
764 case REMOVE_MANAGED_RESOURCE:
22916638 765 sub_interval(&data->io_db, start, size);
1da177e4
LT
766 break;
767 default:
22916638 768 ret = -EINVAL;
1da177e4
LT
769 break;
770 }
7fe908dd 771 mutex_unlock(&rsrc_mutex);
1da177e4
LT
772
773 return ret;
774}
775
776
3c29976a
DB
777#ifdef CONFIG_PCI
778static int nonstatic_autoadd_resources(struct pcmcia_socket *s)
779{
780 struct resource *res;
781 int i, done = 0;
782
783 if (!s->cb_dev || !s->cb_dev->bus)
784 return -ENODEV;
785
0d078f6f 786#if defined(CONFIG_X86)
b6d00f0d
DB
787 /* If this is the root bus, the risk of hitting
788 * some strange system devices which aren't protected
789 * by either ACPI resource tables or properly requested
790 * resources is too big. Therefore, don't do auto-adding
791 * of resources at the moment.
792 */
793 if (s->cb_dev->bus->number == 0)
794 return -EINVAL;
795#endif
796
9fea84f4 797 for (i = 0; i < PCI_BUS_NUM_RESOURCES; i++) {
3c29976a
DB
798 res = s->cb_dev->bus->resource[i];
799 if (!res)
800 continue;
801
802 if (res->flags & IORESOURCE_IO) {
803 if (res == &ioport_resource)
804 continue;
dbe4ea5f
DB
805 dev_printk(KERN_INFO, &s->cb_dev->dev,
806 "pcmcia: parent PCI bridge I/O "
807 "window: 0x%llx - 0x%llx\n",
808 (unsigned long long)res->start,
809 (unsigned long long)res->end);
3c29976a
DB
810 if (!adjust_io(s, ADD_MANAGED_RESOURCE, res->start, res->end))
811 done |= IORESOURCE_IO;
812
813 }
814
815 if (res->flags & IORESOURCE_MEM) {
816 if (res == &iomem_resource)
817 continue;
dbe4ea5f
DB
818 dev_printk(KERN_INFO, &s->cb_dev->dev,
819 "pcmcia: parent PCI bridge Memory "
820 "window: 0x%llx - 0x%llx\n",
821 (unsigned long long)res->start,
822 (unsigned long long)res->end);
3c29976a
DB
823 if (!adjust_memory(s, ADD_MANAGED_RESOURCE, res->start, res->end))
824 done |= IORESOURCE_MEM;
825 }
826 }
827
828 /* if we got at least one of IO, and one of MEM, we can be glad and
829 * activate the PCMCIA subsystem */
54bb5675 830 if (done == (IORESOURCE_MEM | IORESOURCE_IO))
3c29976a
DB
831 s->resource_setup_done = 1;
832
833 return 0;
834}
835
836#else
837
838static inline int nonstatic_autoadd_resources(struct pcmcia_socket *s)
839{
840 return -ENODEV;
841}
842
843#endif
844
845
1da177e4
LT
846static int nonstatic_init(struct pcmcia_socket *s)
847{
848 struct socket_data *data;
849
8084b372 850 data = kzalloc(sizeof(struct socket_data), GFP_KERNEL);
1da177e4
LT
851 if (!data)
852 return -ENOMEM;
1da177e4
LT
853
854 data->mem_db.next = &data->mem_db;
855 data->io_db.next = &data->io_db;
856
857 s->resource_data = (void *) data;
858
3c29976a
DB
859 nonstatic_autoadd_resources(s);
860
1da177e4
LT
861 return 0;
862}
863
864static void nonstatic_release_resource_db(struct pcmcia_socket *s)
865{
866 struct socket_data *data = s->resource_data;
867 struct resource_map *p, *q;
868
7fe908dd 869 mutex_lock(&rsrc_mutex);
1da177e4
LT
870 for (p = data->mem_db.next; p != &data->mem_db; p = q) {
871 q = p->next;
872 kfree(p);
873 }
874 for (p = data->io_db.next; p != &data->io_db; p = q) {
875 q = p->next;
876 kfree(p);
877 }
7fe908dd 878 mutex_unlock(&rsrc_mutex);
1da177e4
LT
879}
880
881
882struct pccard_resource_ops pccard_nonstatic_ops = {
883 .validate_mem = pcmcia_nonstatic_validate_mem,
884 .adjust_io_region = nonstatic_adjust_io_region,
885 .find_io = nonstatic_find_io_region,
886 .find_mem = nonstatic_find_mem_region,
c5023801
DB
887 .add_io = adjust_io,
888 .add_mem = adjust_memory,
1da177e4
LT
889 .init = nonstatic_init,
890 .exit = nonstatic_release_resource_db,
891};
892EXPORT_SYMBOL(pccard_nonstatic_ops);
893
894
895/* sysfs interface to the resource database */
896
87373318
GKH
897static ssize_t show_io_db(struct device *dev,
898 struct device_attribute *attr, char *buf)
1da177e4 899{
87373318 900 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4
LT
901 struct socket_data *data;
902 struct resource_map *p;
903 ssize_t ret = 0;
904
7fe908dd 905 mutex_lock(&rsrc_mutex);
1da177e4
LT
906 data = s->resource_data;
907
908 for (p = data->io_db.next; p != &data->io_db; p = p->next) {
909 if (ret > (PAGE_SIZE - 10))
910 continue;
9fea84f4
DB
911 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
912 "0x%08lx - 0x%08lx\n",
913 ((unsigned long) p->base),
914 ((unsigned long) p->base + p->num - 1));
1da177e4
LT
915 }
916
7fe908dd 917 mutex_unlock(&rsrc_mutex);
9fea84f4 918 return ret;
1da177e4
LT
919}
920
87373318
GKH
921static ssize_t store_io_db(struct device *dev,
922 struct device_attribute *attr,
923 const char *buf, size_t count)
1da177e4 924{
87373318 925 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4 926 unsigned long start_addr, end_addr;
22916638 927 unsigned int add = ADD_MANAGED_RESOURCE;
1da177e4
LT
928 ssize_t ret = 0;
929
9fea84f4 930 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
1da177e4 931 if (ret != 2) {
9fea84f4 932 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
22916638 933 add = REMOVE_MANAGED_RESOURCE;
1da177e4 934 if (ret != 2) {
9fea84f4
DB
935 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
936 &end_addr);
22916638 937 add = ADD_MANAGED_RESOURCE;
1da177e4
LT
938 if (ret != 2)
939 return -EINVAL;
940 }
941 }
1146bc74 942 if (end_addr < start_addr)
1da177e4
LT
943 return -EINVAL;
944
22916638 945 ret = adjust_io(s, add, start_addr, end_addr);
3c29976a
DB
946 if (!ret)
947 s->resource_setup_new = 1;
1da177e4
LT
948
949 return ret ? ret : count;
950}
87373318 951static DEVICE_ATTR(available_resources_io, 0600, show_io_db, store_io_db);
1da177e4 952
87373318
GKH
953static ssize_t show_mem_db(struct device *dev,
954 struct device_attribute *attr, char *buf)
1da177e4 955{
87373318 956 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4
LT
957 struct socket_data *data;
958 struct resource_map *p;
959 ssize_t ret = 0;
960
7fe908dd 961 mutex_lock(&rsrc_mutex);
1da177e4
LT
962 data = s->resource_data;
963
964 for (p = data->mem_db.next; p != &data->mem_db; p = p->next) {
965 if (ret > (PAGE_SIZE - 10))
966 continue;
9fea84f4
DB
967 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
968 "0x%08lx - 0x%08lx\n",
969 ((unsigned long) p->base),
970 ((unsigned long) p->base + p->num - 1));
1da177e4
LT
971 }
972
7fe908dd 973 mutex_unlock(&rsrc_mutex);
9fea84f4 974 return ret;
1da177e4
LT
975}
976
87373318
GKH
977static ssize_t store_mem_db(struct device *dev,
978 struct device_attribute *attr,
979 const char *buf, size_t count)
1da177e4 980{
87373318 981 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4 982 unsigned long start_addr, end_addr;
22916638 983 unsigned int add = ADD_MANAGED_RESOURCE;
1da177e4
LT
984 ssize_t ret = 0;
985
9fea84f4 986 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
1da177e4 987 if (ret != 2) {
9fea84f4 988 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
22916638 989 add = REMOVE_MANAGED_RESOURCE;
1da177e4 990 if (ret != 2) {
9fea84f4
DB
991 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
992 &end_addr);
22916638 993 add = ADD_MANAGED_RESOURCE;
1da177e4
LT
994 if (ret != 2)
995 return -EINVAL;
996 }
997 }
1146bc74 998 if (end_addr < start_addr)
1da177e4
LT
999 return -EINVAL;
1000
22916638 1001 ret = adjust_memory(s, add, start_addr, end_addr);
3c29976a
DB
1002 if (!ret)
1003 s->resource_setup_new = 1;
1da177e4
LT
1004
1005 return ret ? ret : count;
1006}
87373318 1007static DEVICE_ATTR(available_resources_mem, 0600, show_mem_db, store_mem_db);
1da177e4 1008
7d578961
DB
1009static struct attribute *pccard_rsrc_attributes[] = {
1010 &dev_attr_available_resources_io.attr,
1011 &dev_attr_available_resources_mem.attr,
1da177e4
LT
1012 NULL,
1013};
1014
7d578961
DB
1015static const struct attribute_group rsrc_attributes = {
1016 .attrs = pccard_rsrc_attributes,
1017};
1018
87373318 1019static int __devinit pccard_sysfs_add_rsrc(struct device *dev,
d8539d81 1020 struct class_interface *class_intf)
1da177e4 1021{
87373318 1022 struct pcmcia_socket *s = dev_get_drvdata(dev);
7d578961 1023
1da177e4
LT
1024 if (s->resource_ops != &pccard_nonstatic_ops)
1025 return 0;
7d578961 1026 return sysfs_create_group(&dev->kobj, &rsrc_attributes);
1da177e4
LT
1027}
1028
87373318 1029static void __devexit pccard_sysfs_remove_rsrc(struct device *dev,
d8539d81 1030 struct class_interface *class_intf)
1da177e4 1031{
87373318 1032 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4
LT
1033
1034 if (s->resource_ops != &pccard_nonstatic_ops)
1035 return;
7d578961 1036 sysfs_remove_group(&dev->kobj, &rsrc_attributes);
1da177e4
LT
1037}
1038
ed49f5d0 1039static struct class_interface pccard_rsrc_interface __refdata = {
1da177e4 1040 .class = &pcmcia_socket_class,
87373318
GKH
1041 .add_dev = &pccard_sysfs_add_rsrc,
1042 .remove_dev = __devexit_p(&pccard_sysfs_remove_rsrc),
1da177e4
LT
1043};
1044
1045static int __init nonstatic_sysfs_init(void)
1046{
1047 return class_interface_register(&pccard_rsrc_interface);
1048}
1049
1050static void __exit nonstatic_sysfs_exit(void)
1051{
1052 class_interface_unregister(&pccard_rsrc_interface);
1053}
1054
1055module_init(nonstatic_sysfs_init);
1056module_exit(nonstatic_sysfs_exit);