blob: b886385f12e229616e25291d08a5c42398068f12 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#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>
Dominik Brodowski9fea84f2009-12-07 22:11:45 +010027#include <linux/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070028
29#include <asm/irq.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070030
31#include <pcmcia/cs_types.h>
32#include <pcmcia/ss.h>
33#include <pcmcia/cs.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034#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
Dominik Brodowski7fe908d2006-01-10 21:20:36 +010062static DEFINE_MUTEX(rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070063#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 *
Kay Sievers25096982008-11-01 11:46:06 +010074make_resource(resource_size_t b, resource_size_t n, int flags, const char *name)
Linus Torvalds1da177e2005-04-16 15:20:36 -070075{
Dominik Brodowski8084b372005-12-11 21:18:26 +010076 struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -070077
78 if (res) {
Linus Torvalds1da177e2005-04-16 15:20:36 -070079 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 *
Greg Kroah-Hartman2427ddd2006-06-12 17:07:52 -070088claim_region(struct pcmcia_socket *s, resource_size_t base,
89 resource_size_t size, int type, char *name)
Linus Torvalds1da177e2005-04-16 15:20:36 -070090{
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{
Dominik Brodowski11683862008-08-03 10:22:47 +0200125 struct resource_map *p, *q;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700126
Dominik Brodowski11683862008-08-03 10:22:47 +0200127 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;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700141}
142
143/*====================================================================*/
144
145static int sub_interval(struct resource_map *map, u_long base, u_long num)
146{
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100147 struct resource_map *p, *q;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100149 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 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183 }
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100184 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185}
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
Olof Johansson906da802008-02-04 22:27:35 -0800195static void do_io_probe(struct pcmcia_socket *s, unsigned int base,
196 unsigned int num)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197{
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100198 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;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100204 dev_printk(KERN_INFO, &s->dev, "cs: IO port probe %#x-%#x:",
205 base, base+num-1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100207 /* 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;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214 }
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100215 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;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 }
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100229 kfree(b);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100231 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");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264}
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 */
Dominik Brodowskic5081d52008-06-19 20:12:34 +0200275static int readable(struct pcmcia_socket *s, struct resource *res,
276 unsigned int *count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700277{
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) {
Dominik Brodowski84897fc2009-10-18 23:51:09 +0200283 ret = pccard_validate_cis(s, count);
Dominik Brodowski904e3772010-01-02 12:28:04 +0100284 /* invalidate mapping */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285 iounmap(s->cis_virt);
286 s->cis_virt = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287 }
288 s->cis_mem.res = NULL;
Dominik Brodowski0e09c862008-07-28 16:37:10 +0200289 if ((ret != 0) || (*count == 0))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700290 return 0;
291 return 1;
292}
293
294/* Validation function for simple memory cards */
295static int checksum(struct pcmcia_socket *s, struct resource *res)
296{
297 pccard_mem_map map;
298 int i, a = 0, b = -1, d;
299 void __iomem *virt;
300
301 virt = ioremap(res->start, s->map_size);
302 if (virt) {
303 map.map = 0;
304 map.flags = MAP_ACTIVE;
305 map.speed = 0;
306 map.res = res;
307 map.card_start = 0;
308 s->ops->set_mem_map(s, &map);
309
310 /* Don't bother checking every word... */
311 for (i = 0; i < s->map_size; i += 44) {
312 d = readl(virt+i);
313 a += d;
314 b &= d;
315 }
316
317 map.flags = 0;
318 s->ops->set_mem_map(s, &map);
319
320 iounmap(virt);
321 }
322
323 return (b == -1) ? -1 : (a>>1);
324}
325
326static int
327cis_readable(struct pcmcia_socket *s, unsigned long base, unsigned long size)
328{
329 struct resource *res1, *res2;
Dominik Brodowskic5081d52008-06-19 20:12:34 +0200330 unsigned int info1, info2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331 int ret = 0;
332
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100333 res1 = claim_region(s, base, size/2, IORESOURCE_MEM, "PCMCIA memprobe");
334 res2 = claim_region(s, base + size/2, size/2, IORESOURCE_MEM,
335 "PCMCIA memprobe");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700336
337 if (res1 && res2) {
338 ret = readable(s, res1, &info1);
339 ret += readable(s, res2, &info2);
340 }
341
342 free_region(res2);
343 free_region(res1);
344
Dominik Brodowskic5081d52008-06-19 20:12:34 +0200345 return (ret == 2) && (info1 == info2);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700346}
347
348static int
349checksum_match(struct pcmcia_socket *s, unsigned long base, unsigned long size)
350{
351 struct resource *res1, *res2;
352 int a = -1, b = -1;
353
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100354 res1 = claim_region(s, base, size/2, IORESOURCE_MEM, "PCMCIA memprobe");
355 res2 = claim_region(s, base + size/2, size/2, IORESOURCE_MEM,
356 "PCMCIA memprobe");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357
358 if (res1 && res2) {
359 a = checksum(s, res1);
360 b = checksum(s, res2);
361 }
362
363 free_region(res2);
364 free_region(res1);
365
366 return (a == b) && (a >= 0);
367}
368
369/*======================================================================
370
371 The memory probe. If the memory list includes a 64K-aligned block
372 below 1MB, we probe in 64K chunks, and as soon as we accumulate at
373 least mem_limit free space, we quit.
374
375======================================================================*/
376
377static int do_mem_probe(u_long base, u_long num, struct pcmcia_socket *s)
378{
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100379 struct socket_data *s_data = s->resource_data;
380 u_long i, j, bad, fail, step;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100382 dev_printk(KERN_INFO, &s->dev, "cs: memory probe 0x%06lx-0x%06lx:",
383 base, base+num-1);
384 bad = fail = 0;
385 step = (num < 0x20000) ? 0x2000 : ((num>>4) & ~0x1fff);
386 /* don't allow too large steps */
387 if (step > 0x800000)
388 step = 0x800000;
389 /* cis_readable wants to map 2x map_size */
390 if (step < 2 * s->map_size)
391 step = 2 * s->map_size;
392 for (i = j = base; i < base+num; i = j + step) {
393 if (!fail) {
394 for (j = i; j < base+num; j += step) {
395 if (cis_readable(s, j, step))
396 break;
397 }
398 fail = ((i == base) && (j == base+num));
399 }
400 if (fail) {
401 for (j = i; j < base+num; j += 2*step)
402 if (checksum_match(s, j, step) &&
403 checksum_match(s, j + step, step))
404 break;
405 }
406 if (i != j) {
407 if (!bad)
408 printk(" excluding");
409 printk(" %#05lx-%#05lx", i, j-1);
410 sub_interval(&s_data->mem_db, i, j-i);
411 bad += j-i;
412 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413 }
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100414 printk(bad ? "\n" : " clean.\n");
415 return num - bad;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416}
417
418#ifdef CONFIG_PCMCIA_PROBE
419
420static u_long inv_probe(struct resource_map *m, struct pcmcia_socket *s)
421{
Dominik Brodowskide759142005-09-28 19:41:56 +0200422 struct socket_data *s_data = s->resource_data;
423 u_long ok;
424 if (m == &s_data->mem_db)
425 return 0;
426 ok = inv_probe(m->next, s);
427 if (ok) {
428 if (m->base >= 0x100000)
429 sub_interval(&s_data->mem_db, m->base, m->num);
430 return ok;
431 }
432 if (m->base < 0x100000)
433 return 0;
434 return do_mem_probe(m->base, m->num, s);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700435}
436
Dominik Brodowskide759142005-09-28 19:41:56 +0200437static int validate_mem(struct pcmcia_socket *s, unsigned int probe_mask)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700438{
Dominik Brodowskide759142005-09-28 19:41:56 +0200439 struct resource_map *m, mm;
440 static unsigned char order[] = { 0xd0, 0xe0, 0xc0, 0xf0 };
441 unsigned long b, i, ok = 0;
442 struct socket_data *s_data = s->resource_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700443
Dominik Brodowskide759142005-09-28 19:41:56 +0200444 /* We do up to four passes through the list */
445 if (probe_mask & MEM_PROBE_HIGH) {
446 if (inv_probe(s_data->mem_db.next, s) > 0)
447 return 0;
Dominik Brodowskidbe4ea52008-08-02 21:36:19 +0200448 dev_printk(KERN_NOTICE, &s->dev,
449 "cs: warning: no high memory space available!\n");
Dominik Brodowskide759142005-09-28 19:41:56 +0200450 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451 }
Dominik Brodowskide759142005-09-28 19:41:56 +0200452
453 for (m = s_data->mem_db.next; m != &s_data->mem_db; m = mm.next) {
454 mm = *m;
455 /* Only probe < 1 MB */
456 if (mm.base >= 0x100000)
457 continue;
458 if ((mm.base | mm.num) & 0xffff) {
459 ok += do_mem_probe(mm.base, mm.num, s);
460 continue;
461 }
462 /* Special probe for 64K-aligned block */
463 for (i = 0; i < 4; i++) {
464 b = order[i] << 12;
465 if ((b >= mm.base) && (b+0x10000 <= mm.base+mm.num)) {
466 if (ok >= mem_limit)
467 sub_interval(&s_data->mem_db, b, 0x10000);
468 else
469 ok += do_mem_probe(b, 0x10000, s);
470 }
471 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700472 }
Dominik Brodowskide759142005-09-28 19:41:56 +0200473
474 if (ok > 0)
475 return 0;
476
477 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478}
479
480#else /* CONFIG_PCMCIA_PROBE */
481
Andrew Morton2cff9442005-11-16 21:29:26 -0800482static int validate_mem(struct pcmcia_socket *s, unsigned int probe_mask)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700483{
484 struct resource_map *m, mm;
485 struct socket_data *s_data = s->resource_data;
Andrew Morton2cff9442005-11-16 21:29:26 -0800486 unsigned long ok = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700487
488 for (m = s_data->mem_db.next; m != &s_data->mem_db; m = mm.next) {
489 mm = *m;
Andrew Morton2cff9442005-11-16 21:29:26 -0800490 ok += do_mem_probe(mm.base, mm.num, s);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700491 }
Andrew Morton2cff9442005-11-16 21:29:26 -0800492 if (ok > 0)
493 return 0;
494 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700495}
496
497#endif /* CONFIG_PCMCIA_PROBE */
498
499
500/*
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100501 * Locking note: Must be called with skt_mutex held!
Linus Torvalds1da177e2005-04-16 15:20:36 -0700502 */
Dominik Brodowskide759142005-09-28 19:41:56 +0200503static int pcmcia_nonstatic_validate_mem(struct pcmcia_socket *s)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504{
505 struct socket_data *s_data = s->resource_data;
Dominik Brodowskide759142005-09-28 19:41:56 +0200506 unsigned int probe_mask = MEM_PROBE_LOW;
507 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508
Dominik Brodowskide759142005-09-28 19:41:56 +0200509 if (!probe_mem)
510 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100512 mutex_lock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700513
Dominik Brodowskide759142005-09-28 19:41:56 +0200514 if (s->features & SS_CAP_PAGE_REGS)
515 probe_mask = MEM_PROBE_HIGH;
516
517 if (probe_mask & ~s_data->rsrc_mem_probe) {
518 if (s->state & SOCKET_PRESENT)
519 ret = validate_mem(s, probe_mask);
520 if (!ret)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521 s_data->rsrc_mem_probe |= probe_mask;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700522 }
Dominik Brodowskide759142005-09-28 19:41:56 +0200523
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100524 mutex_unlock(&rsrc_mutex);
Dominik Brodowskide759142005-09-28 19:41:56 +0200525
526 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527}
528
529struct pcmcia_align_data {
530 unsigned long mask;
531 unsigned long offset;
532 struct resource_map *map;
533};
534
535static void
536pcmcia_common_align(void *align_data, struct resource *res,
Greg Kroah-Hartman2427ddd2006-06-12 17:07:52 -0700537 resource_size_t size, resource_size_t align)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538{
539 struct pcmcia_align_data *data = align_data;
Greg Kroah-Hartman2427ddd2006-06-12 17:07:52 -0700540 resource_size_t start;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700541 /*
542 * Ensure that we have the correct start address
543 */
544 start = (res->start & ~data->mask) + data->offset;
545 if (start < res->start)
546 start += data->mask + 1;
547 res->start = start;
548}
549
550static void
Greg Kroah-Hartman2427ddd2006-06-12 17:07:52 -0700551pcmcia_align(void *align_data, struct resource *res, resource_size_t size,
552 resource_size_t align)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700553{
554 struct pcmcia_align_data *data = align_data;
555 struct resource_map *m;
556
557 pcmcia_common_align(data, res, size, align);
558
559 for (m = data->map->next; m != data->map; m = m->next) {
560 unsigned long start = m->base;
561 unsigned long end = m->base + m->num - 1;
562
563 /*
564 * If the lower resources are not available, try aligning
565 * to this entry of the resource database to see if it'll
566 * fit here.
567 */
568 if (res->start < start) {
569 res->start = start;
570 pcmcia_common_align(data, res, size, align);
571 }
572
573 /*
574 * If we're above the area which was passed in, there's
575 * no point proceeding.
576 */
577 if (res->start >= res->end)
578 break;
579
580 if ((res->start + size - 1) <= end)
581 break;
582 }
583
584 /*
585 * If we failed to find something suitable, ensure we fail.
586 */
587 if (m == data->map)
588 res->start = res->end;
589}
590
591/*
592 * Adjust an existing IO region allocation, but making sure that we don't
593 * encroach outside the resources which the user supplied.
594 */
595static int nonstatic_adjust_io_region(struct resource *res, unsigned long r_start,
596 unsigned long r_end, struct pcmcia_socket *s)
597{
598 struct resource_map *m;
599 struct socket_data *s_data = s->resource_data;
600 int ret = -ENOMEM;
601
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100602 mutex_lock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603 for (m = s_data->io_db.next; m != &s_data->io_db; m = m->next) {
604 unsigned long start = m->base;
605 unsigned long end = m->base + m->num - 1;
606
607 if (start > r_start || r_end > end)
608 continue;
609
610 ret = adjust_resource(res, r_start, r_end - r_start + 1);
611 break;
612 }
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100613 mutex_unlock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614
615 return ret;
616}
617
618/*======================================================================
619
620 These find ranges of I/O ports or memory addresses that are not
621 currently allocated by other devices.
622
623 The 'align' field should reflect the number of bits of address
624 that need to be preserved from the initial value of *base. It
625 should be a power of two, greater than or equal to 'num'. A value
626 of 0 means that all bits of *base are significant. *base should
627 also be strictly less than 'align'.
628
629======================================================================*/
630
Dominik Brodowskie94e15f2005-06-27 16:28:15 -0700631static struct resource *nonstatic_find_io_region(unsigned long base, int num,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632 unsigned long align, struct pcmcia_socket *s)
633{
Kay Sievers25096982008-11-01 11:46:06 +0100634 struct resource *res = make_resource(0, num, IORESOURCE_IO, dev_name(&s->dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700635 struct socket_data *s_data = s->resource_data;
636 struct pcmcia_align_data data;
637 unsigned long min = base;
638 int ret;
639
640 if (align == 0)
641 align = 0x10000;
642
643 data.mask = align - 1;
644 data.offset = base & data.mask;
645 data.map = &s_data->io_db;
646
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100647 mutex_lock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648#ifdef CONFIG_PCI
649 if (s->cb_dev) {
650 ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1,
651 min, 0, pcmcia_align, &data);
652 } else
653#endif
654 ret = allocate_resource(&ioport_resource, res, num, min, ~0UL,
655 1, pcmcia_align, &data);
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100656 mutex_unlock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700657
658 if (ret != 0) {
659 kfree(res);
660 res = NULL;
661 }
662 return res;
663}
664
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100665static struct resource *nonstatic_find_mem_region(u_long base, u_long num,
Dominik Brodowskie94e15f2005-06-27 16:28:15 -0700666 u_long align, int low, struct pcmcia_socket *s)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700667{
Kay Sievers25096982008-11-01 11:46:06 +0100668 struct resource *res = make_resource(0, num, IORESOURCE_MEM, dev_name(&s->dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700669 struct socket_data *s_data = s->resource_data;
670 struct pcmcia_align_data data;
671 unsigned long min, max;
672 int ret, i;
673
674 low = low || !(s->features & SS_CAP_PAGE_REGS);
675
676 data.mask = align - 1;
677 data.offset = base & data.mask;
678 data.map = &s_data->mem_db;
679
680 for (i = 0; i < 2; i++) {
681 if (low) {
682 max = 0x100000UL;
683 min = base < max ? base : 0;
684 } else {
685 max = ~0UL;
686 min = 0x100000UL + base;
687 }
688
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100689 mutex_lock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700690#ifdef CONFIG_PCI
691 if (s->cb_dev) {
692 ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num,
693 1, min, 0,
694 pcmcia_align, &data);
695 } else
696#endif
697 ret = allocate_resource(&iomem_resource, res, num, min,
698 max, 1, pcmcia_align, &data);
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100699 mutex_unlock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700 if (ret == 0 || low)
701 break;
702 low = 1;
703 }
704
705 if (ret != 0) {
706 kfree(res);
707 res = NULL;
708 }
709 return res;
710}
711
712
Dominik Brodowski22916632005-06-27 16:28:46 -0700713static int adjust_memory(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700714{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715 struct socket_data *data = s->resource_data;
Dominik Brodowski22916632005-06-27 16:28:46 -0700716 unsigned long size = end - start + 1;
717 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700718
Dominik Brodowski1146bc72005-09-28 19:28:37 +0200719 if (end < start)
Dominik Brodowski22916632005-06-27 16:28:46 -0700720 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700721
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100722 mutex_lock(&rsrc_mutex);
Dominik Brodowski22916632005-06-27 16:28:46 -0700723 switch (action) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700724 case ADD_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700725 ret = add_interval(&data->mem_db, start, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700726 break;
727 case REMOVE_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700728 ret = sub_interval(&data->mem_db, start, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700729 break;
730 default:
Dominik Brodowski22916632005-06-27 16:28:46 -0700731 ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700732 }
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100733 mutex_unlock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700734
735 return ret;
736}
737
738
Dominik Brodowski22916632005-06-27 16:28:46 -0700739static int adjust_io(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700740{
741 struct socket_data *data = s->resource_data;
Dominik Brodowski22916632005-06-27 16:28:46 -0700742 unsigned long size = end - start + 1;
743 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700744
Dominik Brodowski1146bc72005-09-28 19:28:37 +0200745 if (end < start)
Dominik Brodowski22916632005-06-27 16:28:46 -0700746 return -EINVAL;
747
748 if (end > IO_SPACE_LIMIT)
749 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700750
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100751 mutex_lock(&rsrc_mutex);
Dominik Brodowski22916632005-06-27 16:28:46 -0700752 switch (action) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700753 case ADD_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700754 if (add_interval(&data->io_db, start, size) != 0) {
755 ret = -EBUSY;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700756 break;
757 }
758#ifdef CONFIG_PCMCIA_PROBE
759 if (probe_io)
Dominik Brodowski22916632005-06-27 16:28:46 -0700760 do_io_probe(s, start, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761#endif
762 break;
763 case REMOVE_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700764 sub_interval(&data->io_db, start, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700765 break;
766 default:
Dominik Brodowski22916632005-06-27 16:28:46 -0700767 ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700768 break;
769 }
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100770 mutex_unlock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700771
772 return ret;
773}
774
775
Dominik Brodowski3c299762005-06-27 16:28:46 -0700776#ifdef CONFIG_PCI
777static int nonstatic_autoadd_resources(struct pcmcia_socket *s)
778{
779 struct resource *res;
780 int i, done = 0;
781
782 if (!s->cb_dev || !s->cb_dev->bus)
783 return -ENODEV;
784
Brian Gerst0d078f62005-10-30 14:59:20 -0800785#if defined(CONFIG_X86)
Dominik Brodowskib6d00f02005-06-27 16:29:02 -0700786 /* If this is the root bus, the risk of hitting
787 * some strange system devices which aren't protected
788 * by either ACPI resource tables or properly requested
789 * resources is too big. Therefore, don't do auto-adding
790 * of resources at the moment.
791 */
792 if (s->cb_dev->bus->number == 0)
793 return -EINVAL;
794#endif
795
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100796 for (i = 0; i < PCI_BUS_NUM_RESOURCES; i++) {
Dominik Brodowski3c299762005-06-27 16:28:46 -0700797 res = s->cb_dev->bus->resource[i];
798 if (!res)
799 continue;
800
801 if (res->flags & IORESOURCE_IO) {
802 if (res == &ioport_resource)
803 continue;
Dominik Brodowskidbe4ea52008-08-02 21:36:19 +0200804 dev_printk(KERN_INFO, &s->cb_dev->dev,
805 "pcmcia: parent PCI bridge I/O "
806 "window: 0x%llx - 0x%llx\n",
807 (unsigned long long)res->start,
808 (unsigned long long)res->end);
Dominik Brodowski3c299762005-06-27 16:28:46 -0700809 if (!adjust_io(s, ADD_MANAGED_RESOURCE, res->start, res->end))
810 done |= IORESOURCE_IO;
811
812 }
813
814 if (res->flags & IORESOURCE_MEM) {
815 if (res == &iomem_resource)
816 continue;
Dominik Brodowskidbe4ea52008-08-02 21:36:19 +0200817 dev_printk(KERN_INFO, &s->cb_dev->dev,
818 "pcmcia: parent PCI bridge Memory "
819 "window: 0x%llx - 0x%llx\n",
820 (unsigned long long)res->start,
821 (unsigned long long)res->end);
Dominik Brodowski3c299762005-06-27 16:28:46 -0700822 if (!adjust_memory(s, ADD_MANAGED_RESOURCE, res->start, res->end))
823 done |= IORESOURCE_MEM;
824 }
825 }
826
827 /* if we got at least one of IO, and one of MEM, we can be glad and
828 * activate the PCMCIA subsystem */
Dominik Brodowski54bb5672005-09-28 19:29:59 +0200829 if (done == (IORESOURCE_MEM | IORESOURCE_IO))
Dominik Brodowski3c299762005-06-27 16:28:46 -0700830 s->resource_setup_done = 1;
831
832 return 0;
833}
834
835#else
836
837static inline int nonstatic_autoadd_resources(struct pcmcia_socket *s)
838{
839 return -ENODEV;
840}
841
842#endif
843
844
Linus Torvalds1da177e2005-04-16 15:20:36 -0700845static int nonstatic_init(struct pcmcia_socket *s)
846{
847 struct socket_data *data;
848
Dominik Brodowski8084b372005-12-11 21:18:26 +0100849 data = kzalloc(sizeof(struct socket_data), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700850 if (!data)
851 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700852
853 data->mem_db.next = &data->mem_db;
854 data->io_db.next = &data->io_db;
855
856 s->resource_data = (void *) data;
857
Dominik Brodowski3c299762005-06-27 16:28:46 -0700858 nonstatic_autoadd_resources(s);
859
Linus Torvalds1da177e2005-04-16 15:20:36 -0700860 return 0;
861}
862
863static void nonstatic_release_resource_db(struct pcmcia_socket *s)
864{
865 struct socket_data *data = s->resource_data;
866 struct resource_map *p, *q;
867
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100868 mutex_lock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700869 for (p = data->mem_db.next; p != &data->mem_db; p = q) {
870 q = p->next;
871 kfree(p);
872 }
873 for (p = data->io_db.next; p != &data->io_db; p = q) {
874 q = p->next;
875 kfree(p);
876 }
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100877 mutex_unlock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700878}
879
880
881struct pccard_resource_ops pccard_nonstatic_ops = {
882 .validate_mem = pcmcia_nonstatic_validate_mem,
883 .adjust_io_region = nonstatic_adjust_io_region,
884 .find_io = nonstatic_find_io_region,
885 .find_mem = nonstatic_find_mem_region,
Dominik Brodowskic5023802008-06-19 19:02:52 +0200886 .add_io = adjust_io,
887 .add_mem = adjust_memory,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700888 .init = nonstatic_init,
889 .exit = nonstatic_release_resource_db,
890};
891EXPORT_SYMBOL(pccard_nonstatic_ops);
892
893
894/* sysfs interface to the resource database */
895
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200896static ssize_t show_io_db(struct device *dev,
897 struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700898{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200899 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700900 struct socket_data *data;
901 struct resource_map *p;
902 ssize_t ret = 0;
903
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100904 mutex_lock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700905 data = s->resource_data;
906
907 for (p = data->io_db.next; p != &data->io_db; p = p->next) {
908 if (ret > (PAGE_SIZE - 10))
909 continue;
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100910 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
911 "0x%08lx - 0x%08lx\n",
912 ((unsigned long) p->base),
913 ((unsigned long) p->base + p->num - 1));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700914 }
915
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100916 mutex_unlock(&rsrc_mutex);
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100917 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700918}
919
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200920static ssize_t store_io_db(struct device *dev,
921 struct device_attribute *attr,
922 const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700923{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200924 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700925 unsigned long start_addr, end_addr;
Dominik Brodowski22916632005-06-27 16:28:46 -0700926 unsigned int add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700927 ssize_t ret = 0;
928
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100929 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700930 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100931 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -0700932 add = REMOVE_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700933 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100934 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
935 &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -0700936 add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937 if (ret != 2)
938 return -EINVAL;
939 }
940 }
Dominik Brodowski1146bc72005-09-28 19:28:37 +0200941 if (end_addr < start_addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700942 return -EINVAL;
943
Dominik Brodowski22916632005-06-27 16:28:46 -0700944 ret = adjust_io(s, add, start_addr, end_addr);
Dominik Brodowski3c299762005-06-27 16:28:46 -0700945 if (!ret)
946 s->resource_setup_new = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700947
948 return ret ? ret : count;
949}
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200950static DEVICE_ATTR(available_resources_io, 0600, show_io_db, store_io_db);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700951
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200952static ssize_t show_mem_db(struct device *dev,
953 struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700954{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200955 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700956 struct socket_data *data;
957 struct resource_map *p;
958 ssize_t ret = 0;
959
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100960 mutex_lock(&rsrc_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700961 data = s->resource_data;
962
963 for (p = data->mem_db.next; p != &data->mem_db; p = p->next) {
964 if (ret > (PAGE_SIZE - 10))
965 continue;
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100966 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
967 "0x%08lx - 0x%08lx\n",
968 ((unsigned long) p->base),
969 ((unsigned long) p->base + p->num - 1));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700970 }
971
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100972 mutex_unlock(&rsrc_mutex);
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100973 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700974}
975
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200976static ssize_t store_mem_db(struct device *dev,
977 struct device_attribute *attr,
978 const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700979{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200980 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700981 unsigned long start_addr, end_addr;
Dominik Brodowski22916632005-06-27 16:28:46 -0700982 unsigned int add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700983 ssize_t ret = 0;
984
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100985 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700986 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100987 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -0700988 add = REMOVE_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700989 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100990 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
991 &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -0700992 add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700993 if (ret != 2)
994 return -EINVAL;
995 }
996 }
Dominik Brodowski1146bc72005-09-28 19:28:37 +0200997 if (end_addr < start_addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998 return -EINVAL;
999
Dominik Brodowski22916632005-06-27 16:28:46 -07001000 ret = adjust_memory(s, add, start_addr, end_addr);
Dominik Brodowski3c299762005-06-27 16:28:46 -07001001 if (!ret)
1002 s->resource_setup_new = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001003
1004 return ret ? ret : count;
1005}
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001006static DEVICE_ATTR(available_resources_mem, 0600, show_mem_db, store_mem_db);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001007
David Brownell7d578962008-06-12 12:13:55 -07001008static struct attribute *pccard_rsrc_attributes[] = {
1009 &dev_attr_available_resources_io.attr,
1010 &dev_attr_available_resources_mem.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001011 NULL,
1012};
1013
David Brownell7d578962008-06-12 12:13:55 -07001014static const struct attribute_group rsrc_attributes = {
1015 .attrs = pccard_rsrc_attributes,
1016};
1017
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001018static int __devinit pccard_sysfs_add_rsrc(struct device *dev,
Dmitry Torokhovd8539d82005-09-15 02:01:36 -05001019 struct class_interface *class_intf)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001020{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001021 struct pcmcia_socket *s = dev_get_drvdata(dev);
David Brownell7d578962008-06-12 12:13:55 -07001022
Linus Torvalds1da177e2005-04-16 15:20:36 -07001023 if (s->resource_ops != &pccard_nonstatic_ops)
1024 return 0;
David Brownell7d578962008-06-12 12:13:55 -07001025 return sysfs_create_group(&dev->kobj, &rsrc_attributes);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001026}
1027
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001028static void __devexit pccard_sysfs_remove_rsrc(struct device *dev,
Dmitry Torokhovd8539d82005-09-15 02:01:36 -05001029 struct class_interface *class_intf)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001030{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001031 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001032
1033 if (s->resource_ops != &pccard_nonstatic_ops)
1034 return;
David Brownell7d578962008-06-12 12:13:55 -07001035 sysfs_remove_group(&dev->kobj, &rsrc_attributes);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001036}
1037
Sam Ravnborged49f5d2008-05-01 04:34:50 -07001038static struct class_interface pccard_rsrc_interface __refdata = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039 .class = &pcmcia_socket_class,
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001040 .add_dev = &pccard_sysfs_add_rsrc,
1041 .remove_dev = __devexit_p(&pccard_sysfs_remove_rsrc),
Linus Torvalds1da177e2005-04-16 15:20:36 -07001042};
1043
1044static int __init nonstatic_sysfs_init(void)
1045{
1046 return class_interface_register(&pccard_rsrc_interface);
1047}
1048
1049static void __exit nonstatic_sysfs_exit(void)
1050{
1051 class_interface_unregister(&pccard_rsrc_interface);
1052}
1053
1054module_init(nonstatic_sysfs_init);
1055module_exit(nonstatic_sysfs_exit);