blob: dcc602134d90ddca6e06314cce9c204a9b6bf7d7 [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;
Dominik Brodowski7b4884c2010-02-17 16:25:53 +010058 struct resource_map mem_db_valid;
Linus Torvalds1da177e2005-04-16 15:20:36 -070059 struct resource_map io_db;
Linus Torvalds1da177e2005-04-16 15:20:36 -070060};
61
Linus Torvalds1da177e2005-04-16 15:20:36 -070062#define MEM_PROBE_LOW (1 << 0)
63#define MEM_PROBE_HIGH (1 << 1)
64
65
66/*======================================================================
67
68 Linux resource management extensions
69
70======================================================================*/
71
72static struct resource *
Kay Sievers25096982008-11-01 11:46:06 +010073make_resource(resource_size_t b, resource_size_t n, int flags, const char *name)
Linus Torvalds1da177e2005-04-16 15:20:36 -070074{
Dominik Brodowski8084b372005-12-11 21:18:26 +010075 struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -070076
77 if (res) {
Linus Torvalds1da177e2005-04-16 15:20:36 -070078 res->name = name;
79 res->start = b;
80 res->end = b + n - 1;
81 res->flags = flags;
82 }
83 return res;
84}
85
86static struct resource *
Greg Kroah-Hartman2427ddd2006-06-12 17:07:52 -070087claim_region(struct pcmcia_socket *s, resource_size_t base,
88 resource_size_t size, int type, char *name)
Linus Torvalds1da177e2005-04-16 15:20:36 -070089{
90 struct resource *res, *parent;
91
92 parent = type & IORESOURCE_MEM ? &iomem_resource : &ioport_resource;
93 res = make_resource(base, size, type | IORESOURCE_BUSY, name);
94
95 if (res) {
96#ifdef CONFIG_PCI
97 if (s && s->cb_dev)
98 parent = pci_find_parent_resource(s->cb_dev, res);
99#endif
100 if (!parent || request_resource(parent, res)) {
101 kfree(res);
102 res = NULL;
103 }
104 }
105 return res;
106}
107
108static void free_region(struct resource *res)
109{
110 if (res) {
111 release_resource(res);
112 kfree(res);
113 }
114}
115
116/*======================================================================
117
118 These manage the internal databases of available resources.
119
120======================================================================*/
121
122static int add_interval(struct resource_map *map, u_long base, u_long num)
123{
Dominik Brodowski11683862008-08-03 10:22:47 +0200124 struct resource_map *p, *q;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125
Dominik Brodowski11683862008-08-03 10:22:47 +0200126 for (p = map; ; p = p->next) {
Dominik Brodowskif309cb32010-02-17 14:35:33 +0100127 if ((p != map) && (p->base+p->num >= base)) {
128 p->num = max(num + base - p->base, p->num);
129 return 0;
130 }
Dominik Brodowski11683862008-08-03 10:22:47 +0200131 if ((p->next == map) || (p->next->base > base+num-1))
132 break;
133 }
134 q = kmalloc(sizeof(struct resource_map), GFP_KERNEL);
135 if (!q) {
136 printk(KERN_WARNING "out of memory to update resources\n");
137 return -ENOMEM;
138 }
139 q->base = base; q->num = num;
140 q->next = p->next; p->next = q;
141 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142}
143
144/*====================================================================*/
145
146static int sub_interval(struct resource_map *map, u_long base, u_long num)
147{
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100148 struct resource_map *p, *q;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100150 for (p = map; ; p = q) {
151 q = p->next;
152 if (q == map)
153 break;
154 if ((q->base+q->num > base) && (base+num > q->base)) {
155 if (q->base >= base) {
156 if (q->base+q->num <= base+num) {
157 /* Delete whole block */
158 p->next = q->next;
159 kfree(q);
160 /* don't advance the pointer yet */
161 q = p;
162 } else {
163 /* Cut off bit from the front */
164 q->num = q->base + q->num - base - num;
165 q->base = base + num;
166 }
167 } else if (q->base+q->num <= base+num) {
168 /* Cut off bit from the end */
169 q->num = base - q->base;
170 } else {
171 /* Split the block into two pieces */
172 p = kmalloc(sizeof(struct resource_map),
173 GFP_KERNEL);
174 if (!p) {
175 printk(KERN_WARNING "out of memory to update resources\n");
176 return -ENOMEM;
177 }
178 p->base = base+num;
179 p->num = q->base+q->num - p->base;
180 q->num = base - q->base;
181 p->next = q->next ; q->next = p;
182 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700184 }
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100185 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186}
187
188/*======================================================================
189
190 These routines examine a region of IO or memory addresses to
191 determine what ranges might be genuinely available.
192
193======================================================================*/
194
195#ifdef CONFIG_PCMCIA_PROBE
Olof Johansson906da802008-02-04 22:27:35 -0800196static void do_io_probe(struct pcmcia_socket *s, unsigned int base,
197 unsigned int num)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198{
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100199 struct resource *res;
200 struct socket_data *s_data = s->resource_data;
201 unsigned int i, j, bad;
202 int any;
203 u_char *b, hole, most;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100205 dev_printk(KERN_INFO, &s->dev, "cs: IO port probe %#x-%#x:",
206 base, base+num-1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700207
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100208 /* First, what does a floating port look like? */
209 b = kzalloc(256, GFP_KERNEL);
210 if (!b) {
211 printk("\n");
212 dev_printk(KERN_ERR, &s->dev,
213 "do_io_probe: unable to kmalloc 256 bytes");
214 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215 }
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100216 for (i = base, most = 0; i < base+num; i += 8) {
217 res = claim_region(NULL, i, 8, IORESOURCE_IO, "PCMCIA ioprobe");
218 if (!res)
219 continue;
220 hole = inb(i);
221 for (j = 1; j < 8; j++)
222 if (inb(i+j) != hole)
223 break;
224 free_region(res);
225 if ((j == 8) && (++b[hole] > b[most]))
226 most = hole;
227 if (b[most] == 127)
228 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229 }
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100230 kfree(b);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100232 bad = any = 0;
233 for (i = base; i < base+num; i += 8) {
234 res = claim_region(NULL, i, 8, IORESOURCE_IO, "PCMCIA ioprobe");
235 if (!res)
236 continue;
237 for (j = 0; j < 8; j++)
238 if (inb(i+j) != most)
239 break;
240 free_region(res);
241 if (j < 8) {
242 if (!any)
243 printk(" excluding");
244 if (!bad)
245 bad = any = i;
246 } else {
247 if (bad) {
248 sub_interval(&s_data->io_db, bad, i-bad);
249 printk(" %#x-%#x", bad, i-1);
250 bad = 0;
251 }
252 }
253 }
254 if (bad) {
255 if ((num > 16) && (bad == base) && (i == base+num)) {
256 printk(" nothing: probe failed.\n");
257 return;
258 } else {
259 sub_interval(&s_data->io_db, bad, i-bad);
260 printk(" %#x-%#x", bad, i-1);
261 }
262 }
263
264 printk(any ? "\n" : " clean.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265}
266#endif
267
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100268/*======================================================================*/
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100270/**
271 * readable() - iomem validation function for cards with a valid CIS
272 */
Dominik Brodowskic5081d52008-06-19 20:12:34 +0200273static int readable(struct pcmcia_socket *s, struct resource *res,
274 unsigned int *count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700275{
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100276 int ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700277
Dominik Brodowski7ab248552010-02-17 18:00:07 +0100278 if (s->fake_cis) {
279 dev_dbg(&s->dev, "fake CIS is being used: can't validate mem\n");
280 return 0;
281 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282
283 s->cis_mem.res = res;
284 s->cis_virt = ioremap(res->start, s->map_size);
285 if (s->cis_virt) {
Dominik Brodowski6b8e0872010-01-12 21:42:51 +0100286 mutex_unlock(&s->ops_mutex);
Dominik Brodowski6e7b51a2010-01-06 13:57:43 +0100287 /* as we're only called from pcmcia.c, we're safe */
288 if (s->callback->validate)
289 ret = s->callback->validate(s, count);
Dominik Brodowski904e3772010-01-02 12:28:04 +0100290 /* invalidate mapping */
Dominik Brodowski6b8e0872010-01-12 21:42:51 +0100291 mutex_lock(&s->ops_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292 iounmap(s->cis_virt);
293 s->cis_virt = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700294 }
295 s->cis_mem.res = NULL;
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100296 if ((ret) || (*count == 0))
297 return -EINVAL;
298 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700299}
300
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100301/**
302 * checksum() - iomem validation function for simple memory cards
303 */
304static int checksum(struct pcmcia_socket *s, struct resource *res,
305 unsigned int *value)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306{
307 pccard_mem_map map;
308 int i, a = 0, b = -1, d;
309 void __iomem *virt;
310
311 virt = ioremap(res->start, s->map_size);
312 if (virt) {
313 map.map = 0;
314 map.flags = MAP_ACTIVE;
315 map.speed = 0;
316 map.res = res;
317 map.card_start = 0;
318 s->ops->set_mem_map(s, &map);
319
320 /* Don't bother checking every word... */
321 for (i = 0; i < s->map_size; i += 44) {
322 d = readl(virt+i);
323 a += d;
324 b &= d;
325 }
326
327 map.flags = 0;
328 s->ops->set_mem_map(s, &map);
329
330 iounmap(virt);
331 }
332
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100333 if (b == -1)
334 return -EINVAL;
335
336 *value = a;
337
338 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700339}
340
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100341/**
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))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700359{
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100360 struct socket_data *s_data = s->resource_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700361 struct resource *res1, *res2;
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100362 unsigned int info1 = 1, info2 = 1;
363 int ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700364
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100365 res1 = claim_region(s, base, size/2, IORESOURCE_MEM, "PCMCIA memprobe");
366 res2 = claim_region(s, base + size/2, size/2, IORESOURCE_MEM,
367 "PCMCIA memprobe");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700368
369 if (res1 && res2) {
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100370 ret = 0;
371 if (validate) {
372 ret = validate(s, res1, &info1);
373 ret += validate(s, res2, &info2);
374 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700375 }
376
377 free_region(res2);
378 free_region(res1);
379
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100380 dev_dbg(&s->dev, "cs: memory probe 0x%06lx-0x%06lx: %p %p %u %u %u",
381 base, base+size-1, res1, res2, ret, info1, info2);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700382
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100383 if ((ret) || (info1 != info2) || (info1 == 0))
384 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100386 if (validate && !s->fake_cis) {
387 /* move it to the validated data set */
388 add_interval(&s_data->mem_db_valid, base, size);
389 sub_interval(&s_data->mem_db, base, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390 }
391
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100392 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700393}
394
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100396/**
397 * do_mem_probe() - validate a memory region for PCMCIA use
398 * @s: PCMCIA socket to validate
399 * @base: start address of resource to check
400 * @num: size of resource to check
401 * @validate: validation function to use
402 * @fallback: validation function to use if validate fails
403 *
404 * do_mem_probe() checks a memory region for use by the PCMCIA subsystem.
405 * To do so, the area is split up into sensible parts, and then passed
406 * into the @validate() function. Only if @validate() and @fallback() fail,
407 * the area is marked as unavaibale for use by the PCMCIA subsystem. The
408 * function returns the size of the usable memory area.
409 */
410static int do_mem_probe(struct pcmcia_socket *s, u_long base, u_long num,
411 int validate (struct pcmcia_socket *s,
412 struct resource *res,
413 unsigned int *value),
414 int fallback (struct pcmcia_socket *s,
415 struct resource *res,
416 unsigned int *value))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417{
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100418 struct socket_data *s_data = s->resource_data;
419 u_long i, j, bad, fail, step;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700420
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100421 dev_printk(KERN_INFO, &s->dev, "cs: memory probe 0x%06lx-0x%06lx:",
422 base, base+num-1);
423 bad = fail = 0;
424 step = (num < 0x20000) ? 0x2000 : ((num>>4) & ~0x1fff);
425 /* don't allow too large steps */
426 if (step > 0x800000)
427 step = 0x800000;
428 /* cis_readable wants to map 2x map_size */
429 if (step < 2 * s->map_size)
430 step = 2 * s->map_size;
431 for (i = j = base; i < base+num; i = j + step) {
432 if (!fail) {
433 for (j = i; j < base+num; j += step) {
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100434 if (!do_validate_mem(s, j, step, validate))
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100435 break;
436 }
437 fail = ((i == base) && (j == base+num));
438 }
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100439 if ((fail) && (fallback)) {
440 for (j = i; j < base+num; j += step)
441 if (!do_validate_mem(s, j, step, fallback))
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100442 break;
443 }
444 if (i != j) {
445 if (!bad)
446 printk(" excluding");
447 printk(" %#05lx-%#05lx", i, j-1);
448 sub_interval(&s_data->mem_db, i, j-i);
449 bad += j-i;
450 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451 }
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100452 printk(bad ? "\n" : " clean.\n");
453 return num - bad;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700454}
455
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100456
Linus Torvalds1da177e2005-04-16 15:20:36 -0700457#ifdef CONFIG_PCMCIA_PROBE
458
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100459/**
460 * inv_probe() - top-to-bottom search for one usuable high memory area
461 * @s: PCMCIA socket to validate
462 * @m: resource_map to check
463 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700464static u_long inv_probe(struct resource_map *m, struct pcmcia_socket *s)
465{
Dominik Brodowskide759142005-09-28 19:41:56 +0200466 struct socket_data *s_data = s->resource_data;
467 u_long ok;
468 if (m == &s_data->mem_db)
469 return 0;
470 ok = inv_probe(m->next, s);
471 if (ok) {
472 if (m->base >= 0x100000)
473 sub_interval(&s_data->mem_db, m->base, m->num);
474 return ok;
475 }
476 if (m->base < 0x100000)
477 return 0;
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100478 return do_mem_probe(s, m->base, m->num, readable, checksum);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700479}
480
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100481/**
482 * validate_mem() - memory probe function
483 * @s: PCMCIA socket to validate
484 * @probe_mask: MEM_PROBE_LOW | MEM_PROBE_HIGH
485 *
486 * The memory probe. If the memory list includes a 64K-aligned block
487 * below 1MB, we probe in 64K chunks, and as soon as we accumulate at
488 * least mem_limit free space, we quit. Returns 0 on usuable ports.
489 */
Dominik Brodowskide759142005-09-28 19:41:56 +0200490static int validate_mem(struct pcmcia_socket *s, unsigned int probe_mask)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700491{
Dominik Brodowskide759142005-09-28 19:41:56 +0200492 struct resource_map *m, mm;
493 static unsigned char order[] = { 0xd0, 0xe0, 0xc0, 0xf0 };
494 unsigned long b, i, ok = 0;
495 struct socket_data *s_data = s->resource_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496
Dominik Brodowskide759142005-09-28 19:41:56 +0200497 /* We do up to four passes through the list */
498 if (probe_mask & MEM_PROBE_HIGH) {
499 if (inv_probe(s_data->mem_db.next, s) > 0)
500 return 0;
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100501 if (s_data->mem_db_valid.next != &s_data->mem_db_valid)
502 return 0;
Dominik Brodowskidbe4ea52008-08-02 21:36:19 +0200503 dev_printk(KERN_NOTICE, &s->dev,
504 "cs: warning: no high memory space available!\n");
Dominik Brodowskide759142005-09-28 19:41:56 +0200505 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700506 }
Dominik Brodowskide759142005-09-28 19:41:56 +0200507
508 for (m = s_data->mem_db.next; m != &s_data->mem_db; m = mm.next) {
509 mm = *m;
510 /* Only probe < 1 MB */
511 if (mm.base >= 0x100000)
512 continue;
513 if ((mm.base | mm.num) & 0xffff) {
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100514 ok += do_mem_probe(s, mm.base, mm.num, readable,
515 checksum);
Dominik Brodowskide759142005-09-28 19:41:56 +0200516 continue;
517 }
518 /* Special probe for 64K-aligned block */
519 for (i = 0; i < 4; i++) {
520 b = order[i] << 12;
521 if ((b >= mm.base) && (b+0x10000 <= mm.base+mm.num)) {
522 if (ok >= mem_limit)
523 sub_interval(&s_data->mem_db, b, 0x10000);
524 else
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100525 ok += do_mem_probe(s, b, 0x10000,
526 readable, checksum);
Dominik Brodowskide759142005-09-28 19:41:56 +0200527 }
528 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529 }
Dominik Brodowskide759142005-09-28 19:41:56 +0200530
531 if (ok > 0)
532 return 0;
533
534 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535}
536
537#else /* CONFIG_PCMCIA_PROBE */
538
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100539/**
540 * validate_mem() - memory probe function
541 * @s: PCMCIA socket to validate
542 * @probe_mask: ignored
543 *
544 * Returns 0 on usuable ports.
545 */
Andrew Morton2cff9442005-11-16 21:29:26 -0800546static int validate_mem(struct pcmcia_socket *s, unsigned int probe_mask)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700547{
548 struct resource_map *m, mm;
549 struct socket_data *s_data = s->resource_data;
Andrew Morton2cff9442005-11-16 21:29:26 -0800550 unsigned long ok = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700551
552 for (m = s_data->mem_db.next; m != &s_data->mem_db; m = mm.next) {
553 mm = *m;
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100554 ok += do_mem_probe(s, mm.base, mm.num, readable, checksum);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700555 }
Andrew Morton2cff9442005-11-16 21:29:26 -0800556 if (ok > 0)
557 return 0;
558 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700559}
560
561#endif /* CONFIG_PCMCIA_PROBE */
562
563
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100564/**
565 * pcmcia_nonstatic_validate_mem() - try to validate iomem for PCMCIA use
566 * @s: PCMCIA socket to validate
567 *
568 * This is tricky... when we set up CIS memory, we try to validate
569 * the memory window space allocations.
570 *
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100571 * Locking note: Must be called with skt_mutex held!
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572 */
Dominik Brodowskide759142005-09-28 19:41:56 +0200573static int pcmcia_nonstatic_validate_mem(struct pcmcia_socket *s)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700574{
575 struct socket_data *s_data = s->resource_data;
Dominik Brodowskide759142005-09-28 19:41:56 +0200576 unsigned int probe_mask = MEM_PROBE_LOW;
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100577 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700578
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100579 if (!probe_mem || !(s->state & SOCKET_PRESENT))
Dominik Brodowskide759142005-09-28 19:41:56 +0200580 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581
Dominik Brodowskide759142005-09-28 19:41:56 +0200582 if (s->features & SS_CAP_PAGE_REGS)
583 probe_mask = MEM_PROBE_HIGH;
584
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100585 ret = validate_mem(s, probe_mask);
Dominik Brodowskide759142005-09-28 19:41:56 +0200586
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100587 if (s_data->mem_db_valid.next != &s_data->mem_db_valid)
588 return 0;
Dominik Brodowskide759142005-09-28 19:41:56 +0200589
590 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700591}
592
593struct pcmcia_align_data {
594 unsigned long mask;
595 unsigned long offset;
596 struct resource_map *map;
597};
598
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100599static resource_size_t
Dominik Brodowski3b7a17f2010-01-01 17:40:50 +0100600pcmcia_common_align(void *align_data, const struct resource *res,
Greg Kroah-Hartman2427ddd2006-06-12 17:07:52 -0700601 resource_size_t size, resource_size_t align)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700602{
603 struct pcmcia_align_data *data = align_data;
Greg Kroah-Hartman2427ddd2006-06-12 17:07:52 -0700604 resource_size_t start;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700605 /*
606 * Ensure that we have the correct start address
607 */
608 start = (res->start & ~data->mask) + data->offset;
609 if (start < res->start)
610 start += data->mask + 1;
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100611 return start;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700612}
613
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100614static resource_size_t
Dominik Brodowski3b7a17f2010-01-01 17:40:50 +0100615pcmcia_align(void *align_data, const struct resource *res,
616 resource_size_t size, resource_size_t align)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700617{
618 struct pcmcia_align_data *data = align_data;
619 struct resource_map *m;
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100620 resource_size_t start;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100622 start = pcmcia_common_align(data, res, size, align);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700623
624 for (m = data->map->next; m != data->map; m = m->next) {
625 unsigned long start = m->base;
626 unsigned long end = m->base + m->num - 1;
627
628 /*
629 * If the lower resources are not available, try aligning
630 * to this entry of the resource database to see if it'll
631 * fit here.
632 */
633 if (res->start < start) {
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100634 start = pcmcia_common_align(data, res, size, align);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700635 }
636
637 /*
638 * If we're above the area which was passed in, there's
639 * no point proceeding.
640 */
641 if (res->start >= res->end)
642 break;
643
644 if ((res->start + size - 1) <= end)
645 break;
646 }
647
648 /*
649 * If we failed to find something suitable, ensure we fail.
650 */
651 if (m == data->map)
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100652 start = res->end;
653
654 return start;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655}
656
657/*
658 * Adjust an existing IO region allocation, but making sure that we don't
659 * encroach outside the resources which the user supplied.
660 */
661static int nonstatic_adjust_io_region(struct resource *res, unsigned long r_start,
662 unsigned long r_end, struct pcmcia_socket *s)
663{
664 struct resource_map *m;
665 struct socket_data *s_data = s->resource_data;
666 int ret = -ENOMEM;
667
Linus Torvalds1da177e2005-04-16 15:20:36 -0700668 for (m = s_data->io_db.next; m != &s_data->io_db; m = m->next) {
669 unsigned long start = m->base;
670 unsigned long end = m->base + m->num - 1;
671
672 if (start > r_start || r_end > end)
673 continue;
674
675 ret = adjust_resource(res, r_start, r_end - r_start + 1);
676 break;
677 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700678
679 return ret;
680}
681
682/*======================================================================
683
684 These find ranges of I/O ports or memory addresses that are not
685 currently allocated by other devices.
686
687 The 'align' field should reflect the number of bits of address
688 that need to be preserved from the initial value of *base. It
689 should be a power of two, greater than or equal to 'num'. A value
690 of 0 means that all bits of *base are significant. *base should
691 also be strictly less than 'align'.
692
693======================================================================*/
694
Dominik Brodowskie94e15f2005-06-27 16:28:15 -0700695static struct resource *nonstatic_find_io_region(unsigned long base, int num,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696 unsigned long align, struct pcmcia_socket *s)
697{
Kay Sievers25096982008-11-01 11:46:06 +0100698 struct resource *res = make_resource(0, num, IORESOURCE_IO, dev_name(&s->dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700699 struct socket_data *s_data = s->resource_data;
700 struct pcmcia_align_data data;
701 unsigned long min = base;
702 int ret;
703
704 if (align == 0)
705 align = 0x10000;
706
707 data.mask = align - 1;
708 data.offset = base & data.mask;
709 data.map = &s_data->io_db;
710
Linus Torvalds1da177e2005-04-16 15:20:36 -0700711#ifdef CONFIG_PCI
712 if (s->cb_dev) {
713 ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1,
714 min, 0, pcmcia_align, &data);
715 } else
716#endif
717 ret = allocate_resource(&ioport_resource, res, num, min, ~0UL,
718 1, pcmcia_align, &data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719
720 if (ret != 0) {
721 kfree(res);
722 res = NULL;
723 }
724 return res;
725}
726
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100727static struct resource *nonstatic_find_mem_region(u_long base, u_long num,
Dominik Brodowskie94e15f2005-06-27 16:28:15 -0700728 u_long align, int low, struct pcmcia_socket *s)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700729{
Kay Sievers25096982008-11-01 11:46:06 +0100730 struct resource *res = make_resource(0, num, IORESOURCE_MEM, dev_name(&s->dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700731 struct socket_data *s_data = s->resource_data;
732 struct pcmcia_align_data data;
733 unsigned long min, max;
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100734 int ret, i, j;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700735
736 low = low || !(s->features & SS_CAP_PAGE_REGS);
737
738 data.mask = align - 1;
739 data.offset = base & data.mask;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700740
741 for (i = 0; i < 2; i++) {
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100742 data.map = &s_data->mem_db_valid;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700743 if (low) {
744 max = 0x100000UL;
745 min = base < max ? base : 0;
746 } else {
747 max = ~0UL;
748 min = 0x100000UL + base;
749 }
750
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100751 for (j = 0; j < 2; j++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700752#ifdef CONFIG_PCI
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100753 if (s->cb_dev) {
754 ret = pci_bus_alloc_resource(s->cb_dev->bus,
755 res, num, 1, min, 0,
756 pcmcia_align, &data);
757 } else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700758#endif
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100759 {
760 ret = allocate_resource(&iomem_resource,
761 res, num, min, max, 1,
762 pcmcia_align, &data);
763 }
764 if (ret == 0)
765 break;
766 data.map = &s_data->mem_db;
767 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700768 if (ret == 0 || low)
769 break;
770 low = 1;
771 }
772
773 if (ret != 0) {
774 kfree(res);
775 res = NULL;
776 }
777 return res;
778}
779
780
Dominik Brodowski22916632005-06-27 16:28:46 -0700781static int adjust_memory(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700782{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783 struct socket_data *data = s->resource_data;
Dominik Brodowski22916632005-06-27 16:28:46 -0700784 unsigned long size = end - start + 1;
785 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700786
Dominik Brodowski1146bc72005-09-28 19:28:37 +0200787 if (end < start)
Dominik Brodowski22916632005-06-27 16:28:46 -0700788 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700789
Dominik Brodowski22916632005-06-27 16:28:46 -0700790 switch (action) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700791 case ADD_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700792 ret = add_interval(&data->mem_db, start, size);
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100793 if (!ret)
794 do_mem_probe(s, start, size, NULL, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700795 break;
796 case REMOVE_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700797 ret = sub_interval(&data->mem_db, start, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700798 break;
799 default:
Dominik Brodowski22916632005-06-27 16:28:46 -0700800 ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700801 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700802
803 return ret;
804}
805
806
Dominik Brodowski22916632005-06-27 16:28:46 -0700807static int adjust_io(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700808{
809 struct socket_data *data = s->resource_data;
Dominik Brodowski22916632005-06-27 16:28:46 -0700810 unsigned long size = end - start + 1;
811 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700812
Dominik Brodowski9713ab22010-03-23 16:05:00 +0100813#if defined(CONFIG_X86)
814 /* on x86, avoid anything < 0x100 for it is often used for
815 * legacy platform devices */
816 if (start < 0x100)
817 start = 0x100;
818#endif
819
Dominik Brodowski1146bc72005-09-28 19:28:37 +0200820 if (end < start)
Dominik Brodowski22916632005-06-27 16:28:46 -0700821 return -EINVAL;
822
823 if (end > IO_SPACE_LIMIT)
824 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700825
Dominik Brodowski22916632005-06-27 16:28:46 -0700826 switch (action) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700827 case ADD_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700828 if (add_interval(&data->io_db, start, size) != 0) {
829 ret = -EBUSY;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700830 break;
831 }
832#ifdef CONFIG_PCMCIA_PROBE
833 if (probe_io)
Dominik Brodowski22916632005-06-27 16:28:46 -0700834 do_io_probe(s, start, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700835#endif
836 break;
837 case REMOVE_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700838 sub_interval(&data->io_db, start, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839 break;
840 default:
Dominik Brodowski22916632005-06-27 16:28:46 -0700841 ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700842 break;
843 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844
845 return ret;
846}
847
848
Dominik Brodowski3c299762005-06-27 16:28:46 -0700849#ifdef CONFIG_PCI
850static int nonstatic_autoadd_resources(struct pcmcia_socket *s)
851{
852 struct resource *res;
853 int i, done = 0;
854
855 if (!s->cb_dev || !s->cb_dev->bus)
856 return -ENODEV;
857
Brian Gerst0d078f62005-10-30 14:59:20 -0800858#if defined(CONFIG_X86)
Dominik Brodowskib6d00f02005-06-27 16:29:02 -0700859 /* If this is the root bus, the risk of hitting
860 * some strange system devices which aren't protected
861 * by either ACPI resource tables or properly requested
862 * resources is too big. Therefore, don't do auto-adding
863 * of resources at the moment.
864 */
865 if (s->cb_dev->bus->number == 0)
866 return -EINVAL;
867#endif
868
Bjorn Helgaas89a74ec2010-02-23 10:24:31 -0700869 pci_bus_for_each_resource(s->cb_dev->bus, res, i) {
Dominik Brodowski3c299762005-06-27 16:28:46 -0700870 if (!res)
871 continue;
872
873 if (res->flags & IORESOURCE_IO) {
874 if (res == &ioport_resource)
875 continue;
Dominik Brodowskidbe4ea52008-08-02 21:36:19 +0200876 dev_printk(KERN_INFO, &s->cb_dev->dev,
877 "pcmcia: parent PCI bridge I/O "
878 "window: 0x%llx - 0x%llx\n",
879 (unsigned long long)res->start,
880 (unsigned long long)res->end);
Dominik Brodowski3c299762005-06-27 16:28:46 -0700881 if (!adjust_io(s, ADD_MANAGED_RESOURCE, res->start, res->end))
882 done |= IORESOURCE_IO;
883
884 }
885
886 if (res->flags & IORESOURCE_MEM) {
887 if (res == &iomem_resource)
888 continue;
Dominik Brodowskidbe4ea52008-08-02 21:36:19 +0200889 dev_printk(KERN_INFO, &s->cb_dev->dev,
890 "pcmcia: parent PCI bridge Memory "
891 "window: 0x%llx - 0x%llx\n",
892 (unsigned long long)res->start,
893 (unsigned long long)res->end);
Dominik Brodowski3c299762005-06-27 16:28:46 -0700894 if (!adjust_memory(s, ADD_MANAGED_RESOURCE, res->start, res->end))
895 done |= IORESOURCE_MEM;
896 }
897 }
898
899 /* if we got at least one of IO, and one of MEM, we can be glad and
900 * activate the PCMCIA subsystem */
Dominik Brodowski54bb5672005-09-28 19:29:59 +0200901 if (done == (IORESOURCE_MEM | IORESOURCE_IO))
Dominik Brodowski3c299762005-06-27 16:28:46 -0700902 s->resource_setup_done = 1;
903
904 return 0;
905}
906
907#else
908
909static inline int nonstatic_autoadd_resources(struct pcmcia_socket *s)
910{
911 return -ENODEV;
912}
913
914#endif
915
916
Linus Torvalds1da177e2005-04-16 15:20:36 -0700917static int nonstatic_init(struct pcmcia_socket *s)
918{
919 struct socket_data *data;
920
Dominik Brodowski8084b372005-12-11 21:18:26 +0100921 data = kzalloc(sizeof(struct socket_data), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700922 if (!data)
923 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700924
925 data->mem_db.next = &data->mem_db;
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100926 data->mem_db_valid.next = &data->mem_db_valid;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700927 data->io_db.next = &data->io_db;
928
929 s->resource_data = (void *) data;
930
Dominik Brodowski3c299762005-06-27 16:28:46 -0700931 nonstatic_autoadd_resources(s);
932
Linus Torvalds1da177e2005-04-16 15:20:36 -0700933 return 0;
934}
935
936static void nonstatic_release_resource_db(struct pcmcia_socket *s)
937{
938 struct socket_data *data = s->resource_data;
939 struct resource_map *p, *q;
940
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100941 for (p = data->mem_db_valid.next; p != &data->mem_db_valid; p = q) {
942 q = p->next;
943 kfree(p);
944 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700945 for (p = data->mem_db.next; p != &data->mem_db; p = q) {
946 q = p->next;
947 kfree(p);
948 }
949 for (p = data->io_db.next; p != &data->io_db; p = q) {
950 q = p->next;
951 kfree(p);
952 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700953}
954
955
956struct pccard_resource_ops pccard_nonstatic_ops = {
957 .validate_mem = pcmcia_nonstatic_validate_mem,
958 .adjust_io_region = nonstatic_adjust_io_region,
959 .find_io = nonstatic_find_io_region,
960 .find_mem = nonstatic_find_mem_region,
Dominik Brodowskic5023802008-06-19 19:02:52 +0200961 .add_io = adjust_io,
962 .add_mem = adjust_memory,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700963 .init = nonstatic_init,
964 .exit = nonstatic_release_resource_db,
965};
966EXPORT_SYMBOL(pccard_nonstatic_ops);
967
968
969/* sysfs interface to the resource database */
970
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200971static ssize_t show_io_db(struct device *dev,
972 struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700973{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200974 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700975 struct socket_data *data;
976 struct resource_map *p;
977 ssize_t ret = 0;
978
Dominik Brodowskicfe5d802010-01-17 19:31:45 +0100979 mutex_lock(&s->ops_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700980 data = s->resource_data;
981
982 for (p = data->io_db.next; p != &data->io_db; p = p->next) {
983 if (ret > (PAGE_SIZE - 10))
984 continue;
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100985 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
986 "0x%08lx - 0x%08lx\n",
987 ((unsigned long) p->base),
988 ((unsigned long) p->base + p->num - 1));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700989 }
990
Dominik Brodowskicfe5d802010-01-17 19:31:45 +0100991 mutex_unlock(&s->ops_mutex);
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100992 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700993}
994
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200995static ssize_t store_io_db(struct device *dev,
996 struct device_attribute *attr,
997 const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200999 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001000 unsigned long start_addr, end_addr;
Dominik Brodowski22916632005-06-27 16:28:46 -07001001 unsigned int add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001002 ssize_t ret = 0;
1003
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001004 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001005 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001006 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -07001007 add = REMOVE_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001008 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001009 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
1010 &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -07001011 add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001012 if (ret != 2)
1013 return -EINVAL;
1014 }
1015 }
Dominik Brodowski1146bc72005-09-28 19:28:37 +02001016 if (end_addr < start_addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001017 return -EINVAL;
1018
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001019 mutex_lock(&s->ops_mutex);
Dominik Brodowski22916632005-06-27 16:28:46 -07001020 ret = adjust_io(s, add, start_addr, end_addr);
Dominik Brodowski3c299762005-06-27 16:28:46 -07001021 if (!ret)
1022 s->resource_setup_new = 1;
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001023 mutex_unlock(&s->ops_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001024
1025 return ret ? ret : count;
1026}
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001027static DEVICE_ATTR(available_resources_io, 0600, show_io_db, store_io_db);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001028
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001029static ssize_t show_mem_db(struct device *dev,
1030 struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001031{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001032 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001033 struct socket_data *data;
1034 struct resource_map *p;
1035 ssize_t ret = 0;
1036
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001037 mutex_lock(&s->ops_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001038 data = s->resource_data;
1039
Dominik Brodowski7b4884c2010-02-17 16:25:53 +01001040 for (p = data->mem_db_valid.next; p != &data->mem_db_valid;
1041 p = p->next) {
1042 if (ret > (PAGE_SIZE - 10))
1043 continue;
1044 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
1045 "0x%08lx - 0x%08lx\n",
1046 ((unsigned long) p->base),
1047 ((unsigned long) p->base + p->num - 1));
1048 }
1049
Linus Torvalds1da177e2005-04-16 15:20:36 -07001050 for (p = data->mem_db.next; p != &data->mem_db; p = p->next) {
1051 if (ret > (PAGE_SIZE - 10))
1052 continue;
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001053 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
1054 "0x%08lx - 0x%08lx\n",
1055 ((unsigned long) p->base),
1056 ((unsigned long) p->base + p->num - 1));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001057 }
1058
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001059 mutex_unlock(&s->ops_mutex);
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001060 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001061}
1062
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001063static ssize_t store_mem_db(struct device *dev,
1064 struct device_attribute *attr,
1065 const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001066{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001067 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001068 unsigned long start_addr, end_addr;
Dominik Brodowski22916632005-06-27 16:28:46 -07001069 unsigned int add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001070 ssize_t ret = 0;
1071
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001072 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001073 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001074 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -07001075 add = REMOVE_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001076 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001077 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
1078 &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -07001079 add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001080 if (ret != 2)
1081 return -EINVAL;
1082 }
1083 }
Dominik Brodowski1146bc72005-09-28 19:28:37 +02001084 if (end_addr < start_addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001085 return -EINVAL;
1086
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001087 mutex_lock(&s->ops_mutex);
Dominik Brodowski22916632005-06-27 16:28:46 -07001088 ret = adjust_memory(s, add, start_addr, end_addr);
Dominik Brodowski3c299762005-06-27 16:28:46 -07001089 if (!ret)
1090 s->resource_setup_new = 1;
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001091 mutex_unlock(&s->ops_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001092
1093 return ret ? ret : count;
1094}
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001095static DEVICE_ATTR(available_resources_mem, 0600, show_mem_db, store_mem_db);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001096
David Brownell7d578962008-06-12 12:13:55 -07001097static struct attribute *pccard_rsrc_attributes[] = {
1098 &dev_attr_available_resources_io.attr,
1099 &dev_attr_available_resources_mem.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001100 NULL,
1101};
1102
David Brownell7d578962008-06-12 12:13:55 -07001103static const struct attribute_group rsrc_attributes = {
1104 .attrs = pccard_rsrc_attributes,
1105};
1106
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001107static int __devinit pccard_sysfs_add_rsrc(struct device *dev,
Dmitry Torokhovd8539d82005-09-15 02:01:36 -05001108 struct class_interface *class_intf)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001109{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001110 struct pcmcia_socket *s = dev_get_drvdata(dev);
David Brownell7d578962008-06-12 12:13:55 -07001111
Linus Torvalds1da177e2005-04-16 15:20:36 -07001112 if (s->resource_ops != &pccard_nonstatic_ops)
1113 return 0;
David Brownell7d578962008-06-12 12:13:55 -07001114 return sysfs_create_group(&dev->kobj, &rsrc_attributes);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001115}
1116
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001117static void __devexit pccard_sysfs_remove_rsrc(struct device *dev,
Dmitry Torokhovd8539d82005-09-15 02:01:36 -05001118 struct class_interface *class_intf)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001119{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001120 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001121
1122 if (s->resource_ops != &pccard_nonstatic_ops)
1123 return;
David Brownell7d578962008-06-12 12:13:55 -07001124 sysfs_remove_group(&dev->kobj, &rsrc_attributes);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001125}
1126
Sam Ravnborged49f5d2008-05-01 04:34:50 -07001127static struct class_interface pccard_rsrc_interface __refdata = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001128 .class = &pcmcia_socket_class,
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001129 .add_dev = &pccard_sysfs_add_rsrc,
1130 .remove_dev = __devexit_p(&pccard_sysfs_remove_rsrc),
Linus Torvalds1da177e2005-04-16 15:20:36 -07001131};
1132
1133static int __init nonstatic_sysfs_init(void)
1134{
1135 return class_interface_register(&pccard_rsrc_interface);
1136}
1137
1138static void __exit nonstatic_sysfs_exit(void)
1139{
1140 class_interface_unregister(&pccard_rsrc_interface);
1141}
1142
1143module_init(nonstatic_sysfs_init);
1144module_exit(nonstatic_sysfs_exit);