]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/pcmcia/rsrc_nonstatic.c
pcmcia: add locking to set_mem_map()
[net-next-2.6.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
3f32b3c0 267/*======================================================================*/
1da177e4 268
3f32b3c0
DB
269/**
270 * readable() - iomem validation function for cards with a valid CIS
271 */
c5081d5f
DB
272static int readable(struct pcmcia_socket *s, struct resource *res,
273 unsigned int *count)
1da177e4 274{
3f32b3c0 275 int ret = -EINVAL;
1da177e4 276
6b8e087b 277 mutex_lock(&s->ops_mutex);
1da177e4
LT
278 s->cis_mem.res = res;
279 s->cis_virt = ioremap(res->start, s->map_size);
280 if (s->cis_virt) {
6b8e087b 281 mutex_unlock(&s->ops_mutex);
6e7b51a7
DB
282 /* as we're only called from pcmcia.c, we're safe */
283 if (s->callback->validate)
284 ret = s->callback->validate(s, count);
904e3777 285 /* invalidate mapping */
6b8e087b 286 mutex_lock(&s->ops_mutex);
1da177e4
LT
287 iounmap(s->cis_virt);
288 s->cis_virt = NULL;
1da177e4
LT
289 }
290 s->cis_mem.res = NULL;
6b8e087b 291 mutex_unlock(&s->ops_mutex);
3f32b3c0
DB
292 if ((ret) || (*count == 0))
293 return -EINVAL;
294 return 0;
1da177e4
LT
295}
296
3f32b3c0
DB
297/**
298 * checksum() - iomem validation function for simple memory cards
299 */
300static int checksum(struct pcmcia_socket *s, struct resource *res,
301 unsigned int *value)
1da177e4
LT
302{
303 pccard_mem_map map;
304 int i, a = 0, b = -1, d;
305 void __iomem *virt;
306
6b8e087b
DB
307 mutex_lock(&s->ops_mutex);
308
1da177e4
LT
309 virt = ioremap(res->start, s->map_size);
310 if (virt) {
311 map.map = 0;
312 map.flags = MAP_ACTIVE;
313 map.speed = 0;
314 map.res = res;
315 map.card_start = 0;
316 s->ops->set_mem_map(s, &map);
317
318 /* Don't bother checking every word... */
319 for (i = 0; i < s->map_size; i += 44) {
320 d = readl(virt+i);
321 a += d;
322 b &= d;
323 }
324
325 map.flags = 0;
326 s->ops->set_mem_map(s, &map);
327
328 iounmap(virt);
329 }
330
6b8e087b
DB
331 mutex_unlock(&s->ops_mutex);
332
3f32b3c0
DB
333 if (b == -1)
334 return -EINVAL;
1da177e4 335
3f32b3c0 336 *value = a;
1da177e4 337
3f32b3c0 338 return 0;
1da177e4
LT
339}
340
3f32b3c0
DB
341/**
342 * do_validate_mem() - low level validate a memory region for PCMCIA use
343 * @s: PCMCIA socket to validate
344 * @base: start address of resource to check
345 * @size: size of resource to check
346 * @validate: validation function to use
347 *
348 * do_validate_mem() splits up the memory region which is to be checked
349 * into two parts. Both are passed to the @validate() function. If
350 * @validate() returns non-zero, or the value parameter to @validate()
351 * is zero, or the value parameter is different between both calls,
352 * the check fails, and -EINVAL is returned. Else, 0 is returned.
353 */
354static int do_validate_mem(struct pcmcia_socket *s,
355 unsigned long base, unsigned long size,
356 int validate (struct pcmcia_socket *s,
357 struct resource *res,
358 unsigned int *value))
1da177e4
LT
359{
360 struct resource *res1, *res2;
3f32b3c0
DB
361 unsigned int info1 = 1, info2 = 1;
362 int ret = -EINVAL;
1da177e4 363
9fea84f4
DB
364 res1 = claim_region(s, base, size/2, IORESOURCE_MEM, "PCMCIA memprobe");
365 res2 = claim_region(s, base + size/2, size/2, IORESOURCE_MEM,
366 "PCMCIA memprobe");
1da177e4
LT
367
368 if (res1 && res2) {
3f32b3c0
DB
369 ret = 0;
370 if (validate) {
371 ret = validate(s, res1, &info1);
372 ret += validate(s, res2, &info2);
373 }
1da177e4
LT
374 }
375
376 free_region(res2);
377 free_region(res1);
378
3f32b3c0
DB
379 dev_dbg(&s->dev, "cs: memory probe 0x%06lx-0x%06lx: %p %p %u %u %u",
380 base, base+size-1, res1, res2, ret, info1, info2);
1da177e4 381
3f32b3c0
DB
382 if ((ret) || (info1 != info2) || (info1 == 0))
383 return -EINVAL;
1da177e4 384
3f32b3c0
DB
385 return 0;
386}
1da177e4 387
1da177e4 388
3f32b3c0
DB
389/**
390 * do_mem_probe() - validate a memory region for PCMCIA use
391 * @s: PCMCIA socket to validate
392 * @base: start address of resource to check
393 * @num: size of resource to check
394 * @validate: validation function to use
395 * @fallback: validation function to use if validate fails
396 *
397 * do_mem_probe() checks a memory region for use by the PCMCIA subsystem.
398 * To do so, the area is split up into sensible parts, and then passed
399 * into the @validate() function. Only if @validate() and @fallback() fail,
400 * the area is marked as unavaibale for use by the PCMCIA subsystem. The
401 * function returns the size of the usable memory area.
402 */
403static int do_mem_probe(struct pcmcia_socket *s, u_long base, u_long num,
404 int validate (struct pcmcia_socket *s,
405 struct resource *res,
406 unsigned int *value),
407 int fallback (struct pcmcia_socket *s,
408 struct resource *res,
409 unsigned int *value))
1da177e4 410{
9fea84f4
DB
411 struct socket_data *s_data = s->resource_data;
412 u_long i, j, bad, fail, step;
413
414 dev_printk(KERN_INFO, &s->dev, "cs: memory probe 0x%06lx-0x%06lx:",
415 base, base+num-1);
416 bad = fail = 0;
417 step = (num < 0x20000) ? 0x2000 : ((num>>4) & ~0x1fff);
418 /* don't allow too large steps */
419 if (step > 0x800000)
420 step = 0x800000;
421 /* cis_readable wants to map 2x map_size */
422 if (step < 2 * s->map_size)
423 step = 2 * s->map_size;
424 for (i = j = base; i < base+num; i = j + step) {
425 if (!fail) {
426 for (j = i; j < base+num; j += step) {
3f32b3c0 427 if (!do_validate_mem(s, j, step, validate))
9fea84f4
DB
428 break;
429 }
430 fail = ((i == base) && (j == base+num));
431 }
3f32b3c0
DB
432 if ((fail) && (fallback)) {
433 for (j = i; j < base+num; j += step)
434 if (!do_validate_mem(s, j, step, fallback))
9fea84f4
DB
435 break;
436 }
437 if (i != j) {
438 if (!bad)
439 printk(" excluding");
440 printk(" %#05lx-%#05lx", i, j-1);
441 sub_interval(&s_data->mem_db, i, j-i);
442 bad += j-i;
443 }
444 }
445 printk(bad ? "\n" : " clean.\n");
446 return num - bad;
1da177e4
LT
447}
448
3f32b3c0 449
1da177e4
LT
450#ifdef CONFIG_PCMCIA_PROBE
451
3f32b3c0
DB
452/**
453 * inv_probe() - top-to-bottom search for one usuable high memory area
454 * @s: PCMCIA socket to validate
455 * @m: resource_map to check
456 */
1da177e4
LT
457static u_long inv_probe(struct resource_map *m, struct pcmcia_socket *s)
458{
de75914e
DB
459 struct socket_data *s_data = s->resource_data;
460 u_long ok;
461 if (m == &s_data->mem_db)
462 return 0;
463 ok = inv_probe(m->next, s);
464 if (ok) {
465 if (m->base >= 0x100000)
466 sub_interval(&s_data->mem_db, m->base, m->num);
467 return ok;
468 }
469 if (m->base < 0x100000)
470 return 0;
3f32b3c0 471 return do_mem_probe(s, m->base, m->num, readable, checksum);
1da177e4
LT
472}
473
3f32b3c0
DB
474/**
475 * validate_mem() - memory probe function
476 * @s: PCMCIA socket to validate
477 * @probe_mask: MEM_PROBE_LOW | MEM_PROBE_HIGH
478 *
479 * The memory probe. If the memory list includes a 64K-aligned block
480 * below 1MB, we probe in 64K chunks, and as soon as we accumulate at
481 * least mem_limit free space, we quit. Returns 0 on usuable ports.
482 */
de75914e 483static int validate_mem(struct pcmcia_socket *s, unsigned int probe_mask)
1da177e4 484{
de75914e
DB
485 struct resource_map *m, mm;
486 static unsigned char order[] = { 0xd0, 0xe0, 0xc0, 0xf0 };
487 unsigned long b, i, ok = 0;
488 struct socket_data *s_data = s->resource_data;
1da177e4 489
de75914e
DB
490 /* We do up to four passes through the list */
491 if (probe_mask & MEM_PROBE_HIGH) {
492 if (inv_probe(s_data->mem_db.next, s) > 0)
493 return 0;
dbe4ea5f
DB
494 dev_printk(KERN_NOTICE, &s->dev,
495 "cs: warning: no high memory space available!\n");
de75914e 496 return -ENODEV;
1da177e4 497 }
de75914e
DB
498
499 for (m = s_data->mem_db.next; m != &s_data->mem_db; m = mm.next) {
500 mm = *m;
501 /* Only probe < 1 MB */
502 if (mm.base >= 0x100000)
503 continue;
504 if ((mm.base | mm.num) & 0xffff) {
3f32b3c0
DB
505 ok += do_mem_probe(s, mm.base, mm.num, readable,
506 checksum);
de75914e
DB
507 continue;
508 }
509 /* Special probe for 64K-aligned block */
510 for (i = 0; i < 4; i++) {
511 b = order[i] << 12;
512 if ((b >= mm.base) && (b+0x10000 <= mm.base+mm.num)) {
513 if (ok >= mem_limit)
514 sub_interval(&s_data->mem_db, b, 0x10000);
515 else
3f32b3c0
DB
516 ok += do_mem_probe(s, b, 0x10000,
517 readable, checksum);
de75914e
DB
518 }
519 }
1da177e4 520 }
de75914e
DB
521
522 if (ok > 0)
523 return 0;
524
525 return -ENODEV;
1da177e4
LT
526}
527
528#else /* CONFIG_PCMCIA_PROBE */
529
3f32b3c0
DB
530/**
531 * validate_mem() - memory probe function
532 * @s: PCMCIA socket to validate
533 * @probe_mask: ignored
534 *
535 * Returns 0 on usuable ports.
536 */
2cff9447 537static int validate_mem(struct pcmcia_socket *s, unsigned int probe_mask)
1da177e4
LT
538{
539 struct resource_map *m, mm;
540 struct socket_data *s_data = s->resource_data;
2cff9447 541 unsigned long ok = 0;
1da177e4
LT
542
543 for (m = s_data->mem_db.next; m != &s_data->mem_db; m = mm.next) {
544 mm = *m;
3f32b3c0 545 ok += do_mem_probe(s, mm.base, mm.num, readable, checksum);
1da177e4 546 }
2cff9447
AM
547 if (ok > 0)
548 return 0;
549 return -ENODEV;
1da177e4
LT
550}
551
552#endif /* CONFIG_PCMCIA_PROBE */
553
554
3f32b3c0
DB
555/**
556 * pcmcia_nonstatic_validate_mem() - try to validate iomem for PCMCIA use
557 * @s: PCMCIA socket to validate
558 *
559 * This is tricky... when we set up CIS memory, we try to validate
560 * the memory window space allocations.
561 *
7fe908dd 562 * Locking note: Must be called with skt_mutex held!
1da177e4 563 */
de75914e 564static int pcmcia_nonstatic_validate_mem(struct pcmcia_socket *s)
1da177e4
LT
565{
566 struct socket_data *s_data = s->resource_data;
de75914e
DB
567 unsigned int probe_mask = MEM_PROBE_LOW;
568 int ret = 0;
569
570 if (!probe_mem)
571 return 0;
1da177e4 572
7fe908dd 573 mutex_lock(&rsrc_mutex);
1da177e4 574
de75914e
DB
575 if (s->features & SS_CAP_PAGE_REGS)
576 probe_mask = MEM_PROBE_HIGH;
1da177e4 577
de75914e 578 if (probe_mask & ~s_data->rsrc_mem_probe) {
3f32b3c0 579 if (s->state & SOCKET_PRESENT) {
de75914e 580 ret = validate_mem(s, probe_mask);
3f32b3c0
DB
581 if (!ret)
582 s_data->rsrc_mem_probe |= probe_mask;
583 }
de75914e 584 }
1da177e4 585
7fe908dd 586 mutex_unlock(&rsrc_mutex);
1da177e4 587
de75914e 588 return ret;
1da177e4
LT
589}
590
591struct pcmcia_align_data {
592 unsigned long mask;
593 unsigned long offset;
594 struct resource_map *map;
595};
596
597static void
598pcmcia_common_align(void *align_data, struct resource *res,
2427ddd8 599 resource_size_t size, resource_size_t align)
1da177e4
LT
600{
601 struct pcmcia_align_data *data = align_data;
2427ddd8 602 resource_size_t start;
1da177e4
LT
603 /*
604 * Ensure that we have the correct start address
605 */
606 start = (res->start & ~data->mask) + data->offset;
607 if (start < res->start)
608 start += data->mask + 1;
609 res->start = start;
610}
611
612static void
2427ddd8
GKH
613pcmcia_align(void *align_data, struct resource *res, resource_size_t size,
614 resource_size_t align)
1da177e4
LT
615{
616 struct pcmcia_align_data *data = align_data;
617 struct resource_map *m;
618
619 pcmcia_common_align(data, res, size, align);
620
621 for (m = data->map->next; m != data->map; m = m->next) {
622 unsigned long start = m->base;
623 unsigned long end = m->base + m->num - 1;
624
625 /*
626 * If the lower resources are not available, try aligning
627 * to this entry of the resource database to see if it'll
628 * fit here.
629 */
630 if (res->start < start) {
631 res->start = start;
632 pcmcia_common_align(data, res, size, align);
633 }
634
635 /*
636 * If we're above the area which was passed in, there's
637 * no point proceeding.
638 */
639 if (res->start >= res->end)
640 break;
641
642 if ((res->start + size - 1) <= end)
643 break;
644 }
645
646 /*
647 * If we failed to find something suitable, ensure we fail.
648 */
649 if (m == data->map)
650 res->start = res->end;
651}
652
653/*
654 * Adjust an existing IO region allocation, but making sure that we don't
655 * encroach outside the resources which the user supplied.
656 */
657static int nonstatic_adjust_io_region(struct resource *res, unsigned long r_start,
658 unsigned long r_end, struct pcmcia_socket *s)
659{
660 struct resource_map *m;
661 struct socket_data *s_data = s->resource_data;
662 int ret = -ENOMEM;
663
7fe908dd 664 mutex_lock(&rsrc_mutex);
1da177e4
LT
665 for (m = s_data->io_db.next; m != &s_data->io_db; m = m->next) {
666 unsigned long start = m->base;
667 unsigned long end = m->base + m->num - 1;
668
669 if (start > r_start || r_end > end)
670 continue;
671
672 ret = adjust_resource(res, r_start, r_end - r_start + 1);
673 break;
674 }
7fe908dd 675 mutex_unlock(&rsrc_mutex);
1da177e4
LT
676
677 return ret;
678}
679
680/*======================================================================
681
682 These find ranges of I/O ports or memory addresses that are not
683 currently allocated by other devices.
684
685 The 'align' field should reflect the number of bits of address
686 that need to be preserved from the initial value of *base. It
687 should be a power of two, greater than or equal to 'num'. A value
688 of 0 means that all bits of *base are significant. *base should
689 also be strictly less than 'align'.
690
691======================================================================*/
692
e94e15f7 693static struct resource *nonstatic_find_io_region(unsigned long base, int num,
1da177e4
LT
694 unsigned long align, struct pcmcia_socket *s)
695{
25096986 696 struct resource *res = make_resource(0, num, IORESOURCE_IO, dev_name(&s->dev));
1da177e4
LT
697 struct socket_data *s_data = s->resource_data;
698 struct pcmcia_align_data data;
699 unsigned long min = base;
700 int ret;
701
702 if (align == 0)
703 align = 0x10000;
704
705 data.mask = align - 1;
706 data.offset = base & data.mask;
707 data.map = &s_data->io_db;
708
7fe908dd 709 mutex_lock(&rsrc_mutex);
1da177e4
LT
710#ifdef CONFIG_PCI
711 if (s->cb_dev) {
712 ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1,
713 min, 0, pcmcia_align, &data);
714 } else
715#endif
716 ret = allocate_resource(&ioport_resource, res, num, min, ~0UL,
717 1, pcmcia_align, &data);
7fe908dd 718 mutex_unlock(&rsrc_mutex);
1da177e4
LT
719
720 if (ret != 0) {
721 kfree(res);
722 res = NULL;
723 }
724 return res;
725}
726
9fea84f4 727static struct resource *nonstatic_find_mem_region(u_long base, u_long num,
e94e15f7 728 u_long align, int low, struct pcmcia_socket *s)
1da177e4 729{
25096986 730 struct resource *res = make_resource(0, num, IORESOURCE_MEM, dev_name(&s->dev));
1da177e4
LT
731 struct socket_data *s_data = s->resource_data;
732 struct pcmcia_align_data data;
733 unsigned long min, max;
734 int ret, i;
735
736 low = low || !(s->features & SS_CAP_PAGE_REGS);
737
738 data.mask = align - 1;
739 data.offset = base & data.mask;
740 data.map = &s_data->mem_db;
741
742 for (i = 0; i < 2; i++) {
743 if (low) {
744 max = 0x100000UL;
745 min = base < max ? base : 0;
746 } else {
747 max = ~0UL;
748 min = 0x100000UL + base;
749 }
750
7fe908dd 751 mutex_lock(&rsrc_mutex);
1da177e4
LT
752#ifdef CONFIG_PCI
753 if (s->cb_dev) {
754 ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num,
755 1, min, 0,
756 pcmcia_align, &data);
757 } else
758#endif
759 ret = allocate_resource(&iomem_resource, res, num, min,
760 max, 1, pcmcia_align, &data);
7fe908dd 761 mutex_unlock(&rsrc_mutex);
1da177e4
LT
762 if (ret == 0 || low)
763 break;
764 low = 1;
765 }
766
767 if (ret != 0) {
768 kfree(res);
769 res = NULL;
770 }
771 return res;
772}
773
774
22916638 775static int adjust_memory(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
1da177e4 776{
1da177e4 777 struct socket_data *data = s->resource_data;
22916638
DB
778 unsigned long size = end - start + 1;
779 int ret = 0;
1da177e4 780
1146bc74 781 if (end < start)
22916638 782 return -EINVAL;
1da177e4 783
7fe908dd 784 mutex_lock(&rsrc_mutex);
22916638 785 switch (action) {
1da177e4 786 case ADD_MANAGED_RESOURCE:
22916638 787 ret = add_interval(&data->mem_db, start, size);
3f32b3c0
DB
788 if (!ret)
789 do_mem_probe(s, start, size, NULL, NULL);
1da177e4
LT
790 break;
791 case REMOVE_MANAGED_RESOURCE:
22916638 792 ret = sub_interval(&data->mem_db, start, size);
1da177e4
LT
793 break;
794 default:
22916638 795 ret = -EINVAL;
1da177e4 796 }
7fe908dd 797 mutex_unlock(&rsrc_mutex);
1da177e4
LT
798
799 return ret;
800}
801
802
22916638 803static int adjust_io(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
1da177e4
LT
804{
805 struct socket_data *data = s->resource_data;
22916638
DB
806 unsigned long size = end - start + 1;
807 int ret = 0;
1da177e4 808
1146bc74 809 if (end < start)
22916638
DB
810 return -EINVAL;
811
812 if (end > IO_SPACE_LIMIT)
813 return -EINVAL;
1da177e4 814
7fe908dd 815 mutex_lock(&rsrc_mutex);
22916638 816 switch (action) {
1da177e4 817 case ADD_MANAGED_RESOURCE:
22916638
DB
818 if (add_interval(&data->io_db, start, size) != 0) {
819 ret = -EBUSY;
1da177e4
LT
820 break;
821 }
822#ifdef CONFIG_PCMCIA_PROBE
823 if (probe_io)
22916638 824 do_io_probe(s, start, size);
1da177e4
LT
825#endif
826 break;
827 case REMOVE_MANAGED_RESOURCE:
22916638 828 sub_interval(&data->io_db, start, size);
1da177e4
LT
829 break;
830 default:
22916638 831 ret = -EINVAL;
1da177e4
LT
832 break;
833 }
7fe908dd 834 mutex_unlock(&rsrc_mutex);
1da177e4
LT
835
836 return ret;
837}
838
839
3c29976a
DB
840#ifdef CONFIG_PCI
841static int nonstatic_autoadd_resources(struct pcmcia_socket *s)
842{
843 struct resource *res;
844 int i, done = 0;
845
846 if (!s->cb_dev || !s->cb_dev->bus)
847 return -ENODEV;
848
0d078f6f 849#if defined(CONFIG_X86)
b6d00f0d
DB
850 /* If this is the root bus, the risk of hitting
851 * some strange system devices which aren't protected
852 * by either ACPI resource tables or properly requested
853 * resources is too big. Therefore, don't do auto-adding
854 * of resources at the moment.
855 */
856 if (s->cb_dev->bus->number == 0)
857 return -EINVAL;
858#endif
859
9fea84f4 860 for (i = 0; i < PCI_BUS_NUM_RESOURCES; i++) {
3c29976a
DB
861 res = s->cb_dev->bus->resource[i];
862 if (!res)
863 continue;
864
865 if (res->flags & IORESOURCE_IO) {
866 if (res == &ioport_resource)
867 continue;
dbe4ea5f
DB
868 dev_printk(KERN_INFO, &s->cb_dev->dev,
869 "pcmcia: parent PCI bridge I/O "
870 "window: 0x%llx - 0x%llx\n",
871 (unsigned long long)res->start,
872 (unsigned long long)res->end);
3c29976a
DB
873 if (!adjust_io(s, ADD_MANAGED_RESOURCE, res->start, res->end))
874 done |= IORESOURCE_IO;
875
876 }
877
878 if (res->flags & IORESOURCE_MEM) {
879 if (res == &iomem_resource)
880 continue;
dbe4ea5f
DB
881 dev_printk(KERN_INFO, &s->cb_dev->dev,
882 "pcmcia: parent PCI bridge Memory "
883 "window: 0x%llx - 0x%llx\n",
884 (unsigned long long)res->start,
885 (unsigned long long)res->end);
3c29976a
DB
886 if (!adjust_memory(s, ADD_MANAGED_RESOURCE, res->start, res->end))
887 done |= IORESOURCE_MEM;
888 }
889 }
890
891 /* if we got at least one of IO, and one of MEM, we can be glad and
892 * activate the PCMCIA subsystem */
54bb5675 893 if (done == (IORESOURCE_MEM | IORESOURCE_IO))
3c29976a
DB
894 s->resource_setup_done = 1;
895
896 return 0;
897}
898
899#else
900
901static inline int nonstatic_autoadd_resources(struct pcmcia_socket *s)
902{
903 return -ENODEV;
904}
905
906#endif
907
908
1da177e4
LT
909static int nonstatic_init(struct pcmcia_socket *s)
910{
911 struct socket_data *data;
912
8084b372 913 data = kzalloc(sizeof(struct socket_data), GFP_KERNEL);
1da177e4
LT
914 if (!data)
915 return -ENOMEM;
1da177e4
LT
916
917 data->mem_db.next = &data->mem_db;
918 data->io_db.next = &data->io_db;
919
920 s->resource_data = (void *) data;
921
3c29976a
DB
922 nonstatic_autoadd_resources(s);
923
1da177e4
LT
924 return 0;
925}
926
927static void nonstatic_release_resource_db(struct pcmcia_socket *s)
928{
929 struct socket_data *data = s->resource_data;
930 struct resource_map *p, *q;
931
7fe908dd 932 mutex_lock(&rsrc_mutex);
1da177e4
LT
933 for (p = data->mem_db.next; p != &data->mem_db; p = q) {
934 q = p->next;
935 kfree(p);
936 }
937 for (p = data->io_db.next; p != &data->io_db; p = q) {
938 q = p->next;
939 kfree(p);
940 }
7fe908dd 941 mutex_unlock(&rsrc_mutex);
1da177e4
LT
942}
943
944
945struct pccard_resource_ops pccard_nonstatic_ops = {
946 .validate_mem = pcmcia_nonstatic_validate_mem,
947 .adjust_io_region = nonstatic_adjust_io_region,
948 .find_io = nonstatic_find_io_region,
949 .find_mem = nonstatic_find_mem_region,
c5023801
DB
950 .add_io = adjust_io,
951 .add_mem = adjust_memory,
1da177e4
LT
952 .init = nonstatic_init,
953 .exit = nonstatic_release_resource_db,
954};
955EXPORT_SYMBOL(pccard_nonstatic_ops);
956
957
958/* sysfs interface to the resource database */
959
87373318
GKH
960static ssize_t show_io_db(struct device *dev,
961 struct device_attribute *attr, char *buf)
1da177e4 962{
87373318 963 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4
LT
964 struct socket_data *data;
965 struct resource_map *p;
966 ssize_t ret = 0;
967
7fe908dd 968 mutex_lock(&rsrc_mutex);
1da177e4
LT
969 data = s->resource_data;
970
971 for (p = data->io_db.next; p != &data->io_db; p = p->next) {
972 if (ret > (PAGE_SIZE - 10))
973 continue;
9fea84f4
DB
974 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
975 "0x%08lx - 0x%08lx\n",
976 ((unsigned long) p->base),
977 ((unsigned long) p->base + p->num - 1));
1da177e4
LT
978 }
979
7fe908dd 980 mutex_unlock(&rsrc_mutex);
9fea84f4 981 return ret;
1da177e4
LT
982}
983
87373318
GKH
984static ssize_t store_io_db(struct device *dev,
985 struct device_attribute *attr,
986 const char *buf, size_t count)
1da177e4 987{
87373318 988 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4 989 unsigned long start_addr, end_addr;
22916638 990 unsigned int add = ADD_MANAGED_RESOURCE;
1da177e4
LT
991 ssize_t ret = 0;
992
9fea84f4 993 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
1da177e4 994 if (ret != 2) {
9fea84f4 995 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
22916638 996 add = REMOVE_MANAGED_RESOURCE;
1da177e4 997 if (ret != 2) {
9fea84f4
DB
998 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
999 &end_addr);
22916638 1000 add = ADD_MANAGED_RESOURCE;
1da177e4
LT
1001 if (ret != 2)
1002 return -EINVAL;
1003 }
1004 }
1146bc74 1005 if (end_addr < start_addr)
1da177e4
LT
1006 return -EINVAL;
1007
22916638 1008 ret = adjust_io(s, add, start_addr, end_addr);
3c29976a
DB
1009 if (!ret)
1010 s->resource_setup_new = 1;
1da177e4
LT
1011
1012 return ret ? ret : count;
1013}
87373318 1014static DEVICE_ATTR(available_resources_io, 0600, show_io_db, store_io_db);
1da177e4 1015
87373318
GKH
1016static ssize_t show_mem_db(struct device *dev,
1017 struct device_attribute *attr, char *buf)
1da177e4 1018{
87373318 1019 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4
LT
1020 struct socket_data *data;
1021 struct resource_map *p;
1022 ssize_t ret = 0;
1023
7fe908dd 1024 mutex_lock(&rsrc_mutex);
1da177e4
LT
1025 data = s->resource_data;
1026
1027 for (p = data->mem_db.next; p != &data->mem_db; p = p->next) {
1028 if (ret > (PAGE_SIZE - 10))
1029 continue;
9fea84f4
DB
1030 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
1031 "0x%08lx - 0x%08lx\n",
1032 ((unsigned long) p->base),
1033 ((unsigned long) p->base + p->num - 1));
1da177e4
LT
1034 }
1035
7fe908dd 1036 mutex_unlock(&rsrc_mutex);
9fea84f4 1037 return ret;
1da177e4
LT
1038}
1039
87373318
GKH
1040static ssize_t store_mem_db(struct device *dev,
1041 struct device_attribute *attr,
1042 const char *buf, size_t count)
1da177e4 1043{
87373318 1044 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4 1045 unsigned long start_addr, end_addr;
22916638 1046 unsigned int add = ADD_MANAGED_RESOURCE;
1da177e4
LT
1047 ssize_t ret = 0;
1048
9fea84f4 1049 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
1da177e4 1050 if (ret != 2) {
9fea84f4 1051 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
22916638 1052 add = REMOVE_MANAGED_RESOURCE;
1da177e4 1053 if (ret != 2) {
9fea84f4
DB
1054 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
1055 &end_addr);
22916638 1056 add = ADD_MANAGED_RESOURCE;
1da177e4
LT
1057 if (ret != 2)
1058 return -EINVAL;
1059 }
1060 }
1146bc74 1061 if (end_addr < start_addr)
1da177e4
LT
1062 return -EINVAL;
1063
22916638 1064 ret = adjust_memory(s, add, start_addr, end_addr);
3c29976a
DB
1065 if (!ret)
1066 s->resource_setup_new = 1;
1da177e4
LT
1067
1068 return ret ? ret : count;
1069}
87373318 1070static DEVICE_ATTR(available_resources_mem, 0600, show_mem_db, store_mem_db);
1da177e4 1071
7d578961
DB
1072static struct attribute *pccard_rsrc_attributes[] = {
1073 &dev_attr_available_resources_io.attr,
1074 &dev_attr_available_resources_mem.attr,
1da177e4
LT
1075 NULL,
1076};
1077
7d578961
DB
1078static const struct attribute_group rsrc_attributes = {
1079 .attrs = pccard_rsrc_attributes,
1080};
1081
87373318 1082static int __devinit pccard_sysfs_add_rsrc(struct device *dev,
d8539d81 1083 struct class_interface *class_intf)
1da177e4 1084{
87373318 1085 struct pcmcia_socket *s = dev_get_drvdata(dev);
7d578961 1086
1da177e4
LT
1087 if (s->resource_ops != &pccard_nonstatic_ops)
1088 return 0;
7d578961 1089 return sysfs_create_group(&dev->kobj, &rsrc_attributes);
1da177e4
LT
1090}
1091
87373318 1092static void __devexit pccard_sysfs_remove_rsrc(struct device *dev,
d8539d81 1093 struct class_interface *class_intf)
1da177e4 1094{
87373318 1095 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4
LT
1096
1097 if (s->resource_ops != &pccard_nonstatic_ops)
1098 return;
7d578961 1099 sysfs_remove_group(&dev->kobj, &rsrc_attributes);
1da177e4
LT
1100}
1101
ed49f5d0 1102static struct class_interface pccard_rsrc_interface __refdata = {
1da177e4 1103 .class = &pcmcia_socket_class,
87373318
GKH
1104 .add_dev = &pccard_sysfs_add_rsrc,
1105 .remove_dev = __devexit_p(&pccard_sysfs_remove_rsrc),
1da177e4
LT
1106};
1107
1108static int __init nonstatic_sysfs_init(void)
1109{
1110 return class_interface_register(&pccard_rsrc_interface);
1111}
1112
1113static void __exit nonstatic_sysfs_exit(void)
1114{
1115 class_interface_unregister(&pccard_rsrc_interface);
1116}
1117
1118module_init(nonstatic_sysfs_init);
1119module_exit(nonstatic_sysfs_exit);