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