blob: 559069a80a3bb37b277e6ae589e433a9fde2271a [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 Brodowski147a2742010-04-04 18:10:35 +0200599static resource_size_t pcmcia_common_align(struct pcmcia_align_data *align_data,
600 resource_size_t start)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700601{
Dominik Brodowski147a2742010-04-04 18:10:35 +0200602 resource_size_t ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603 /*
604 * Ensure that we have the correct start address
605 */
Dominik Brodowski147a2742010-04-04 18:10:35 +0200606 ret = (start & ~align_data->mask) + align_data->offset;
607 if (ret < start)
608 ret += align_data->mask + 1;
609 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700610}
611
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100612static resource_size_t
Dominik Brodowski3b7a17f2010-01-01 17:40:50 +0100613pcmcia_align(void *align_data, const struct resource *res,
614 resource_size_t size, resource_size_t align)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700615{
616 struct pcmcia_align_data *data = align_data;
617 struct resource_map *m;
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100618 resource_size_t start;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700619
Dominik Brodowski147a2742010-04-04 18:10:35 +0200620 start = pcmcia_common_align(data, res->start);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621
622 for (m = data->map->next; m != data->map; m = m->next) {
Dominik Brodowski147a2742010-04-04 18:10:35 +0200623 unsigned long map_start = m->base;
624 unsigned long map_end = m->base + m->num - 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625
626 /*
627 * If the lower resources are not available, try aligning
628 * to this entry of the resource database to see if it'll
629 * fit here.
630 */
Dominik Brodowski147a2742010-04-04 18:10:35 +0200631 if (start < map_start)
632 start = pcmcia_common_align(data, map_start);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700633
634 /*
635 * If we're above the area which was passed in, there's
636 * no point proceeding.
637 */
Dominik Brodowski147a2742010-04-04 18:10:35 +0200638 if (start >= res->end)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700639 break;
640
Dominik Brodowski147a2742010-04-04 18:10:35 +0200641 if ((start + size - 1) <= map_end)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700642 break;
643 }
644
645 /*
646 * If we failed to find something suitable, ensure we fail.
647 */
648 if (m == data->map)
Dominik Brodowskib26b2d42010-01-01 17:40:49 +0100649 start = res->end;
650
651 return start;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700652}
653
654/*
655 * Adjust an existing IO region allocation, but making sure that we don't
656 * encroach outside the resources which the user supplied.
657 */
658static int nonstatic_adjust_io_region(struct resource *res, unsigned long r_start,
659 unsigned long r_end, struct pcmcia_socket *s)
660{
661 struct resource_map *m;
662 struct socket_data *s_data = s->resource_data;
663 int ret = -ENOMEM;
664
Linus Torvalds1da177e2005-04-16 15:20:36 -0700665 for (m = s_data->io_db.next; m != &s_data->io_db; m = m->next) {
666 unsigned long start = m->base;
667 unsigned long end = m->base + m->num - 1;
668
669 if (start > r_start || r_end > end)
670 continue;
671
672 ret = adjust_resource(res, r_start, r_end - r_start + 1);
673 break;
674 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700675
676 return ret;
677}
678
679/*======================================================================
680
681 These find ranges of I/O ports or memory addresses that are not
682 currently allocated by other devices.
683
684 The 'align' field should reflect the number of bits of address
685 that need to be preserved from the initial value of *base. It
686 should be a power of two, greater than or equal to 'num'. A value
687 of 0 means that all bits of *base are significant. *base should
688 also be strictly less than 'align'.
689
690======================================================================*/
691
Dominik Brodowskie94e15f2005-06-27 16:28:15 -0700692static struct resource *nonstatic_find_io_region(unsigned long base, int num,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693 unsigned long align, struct pcmcia_socket *s)
694{
Kay Sievers25096982008-11-01 11:46:06 +0100695 struct resource *res = make_resource(0, num, IORESOURCE_IO, dev_name(&s->dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696 struct socket_data *s_data = s->resource_data;
697 struct pcmcia_align_data data;
698 unsigned long min = base;
699 int ret;
700
701 if (align == 0)
702 align = 0x10000;
703
704 data.mask = align - 1;
705 data.offset = base & data.mask;
706 data.map = &s_data->io_db;
707
Linus Torvalds1da177e2005-04-16 15:20:36 -0700708#ifdef CONFIG_PCI
709 if (s->cb_dev) {
710 ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1,
711 min, 0, pcmcia_align, &data);
712 } else
713#endif
714 ret = allocate_resource(&ioport_resource, res, num, min, ~0UL,
715 1, pcmcia_align, &data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700716
717 if (ret != 0) {
718 kfree(res);
719 res = NULL;
720 }
721 return res;
722}
723
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100724static struct resource *nonstatic_find_mem_region(u_long base, u_long num,
Dominik Brodowskie94e15f2005-06-27 16:28:15 -0700725 u_long align, int low, struct pcmcia_socket *s)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700726{
Kay Sievers25096982008-11-01 11:46:06 +0100727 struct resource *res = make_resource(0, num, IORESOURCE_MEM, dev_name(&s->dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700728 struct socket_data *s_data = s->resource_data;
729 struct pcmcia_align_data data;
730 unsigned long min, max;
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100731 int ret, i, j;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700732
733 low = low || !(s->features & SS_CAP_PAGE_REGS);
734
735 data.mask = align - 1;
736 data.offset = base & data.mask;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700737
738 for (i = 0; i < 2; i++) {
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100739 data.map = &s_data->mem_db_valid;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700740 if (low) {
741 max = 0x100000UL;
742 min = base < max ? base : 0;
743 } else {
744 max = ~0UL;
745 min = 0x100000UL + base;
746 }
747
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100748 for (j = 0; j < 2; j++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700749#ifdef CONFIG_PCI
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100750 if (s->cb_dev) {
751 ret = pci_bus_alloc_resource(s->cb_dev->bus,
752 res, num, 1, min, 0,
753 pcmcia_align, &data);
754 } else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700755#endif
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100756 {
757 ret = allocate_resource(&iomem_resource,
758 res, num, min, max, 1,
759 pcmcia_align, &data);
760 }
761 if (ret == 0)
762 break;
763 data.map = &s_data->mem_db;
764 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700765 if (ret == 0 || low)
766 break;
767 low = 1;
768 }
769
770 if (ret != 0) {
771 kfree(res);
772 res = NULL;
773 }
774 return res;
775}
776
777
Dominik Brodowski22916632005-06-27 16:28:46 -0700778static int adjust_memory(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700779{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700780 struct socket_data *data = s->resource_data;
Dominik Brodowski22916632005-06-27 16:28:46 -0700781 unsigned long size = end - start + 1;
782 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783
Dominik Brodowski1146bc72005-09-28 19:28:37 +0200784 if (end < start)
Dominik Brodowski22916632005-06-27 16:28:46 -0700785 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700786
Dominik Brodowski22916632005-06-27 16:28:46 -0700787 switch (action) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700788 case ADD_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700789 ret = add_interval(&data->mem_db, start, size);
Dominik Brodowski3f32b3c2010-01-02 22:22:50 +0100790 if (!ret)
791 do_mem_probe(s, start, size, NULL, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700792 break;
793 case REMOVE_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700794 ret = sub_interval(&data->mem_db, start, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700795 break;
796 default:
Dominik Brodowski22916632005-06-27 16:28:46 -0700797 ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700798 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700799
800 return ret;
801}
802
803
Dominik Brodowski22916632005-06-27 16:28:46 -0700804static int adjust_io(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700805{
806 struct socket_data *data = s->resource_data;
Dominik Brodowski22916632005-06-27 16:28:46 -0700807 unsigned long size = end - start + 1;
808 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809
Dominik Brodowski9713ab22010-03-23 16:05:00 +0100810#if defined(CONFIG_X86)
811 /* on x86, avoid anything < 0x100 for it is often used for
812 * legacy platform devices */
813 if (start < 0x100)
814 start = 0x100;
815#endif
816
Dominik Brodowski1146bc72005-09-28 19:28:37 +0200817 if (end < start)
Dominik Brodowski22916632005-06-27 16:28:46 -0700818 return -EINVAL;
819
820 if (end > IO_SPACE_LIMIT)
821 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700822
Dominik Brodowski22916632005-06-27 16:28:46 -0700823 switch (action) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824 case ADD_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700825 if (add_interval(&data->io_db, start, size) != 0) {
826 ret = -EBUSY;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700827 break;
828 }
829#ifdef CONFIG_PCMCIA_PROBE
830 if (probe_io)
Dominik Brodowski22916632005-06-27 16:28:46 -0700831 do_io_probe(s, start, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832#endif
833 break;
834 case REMOVE_MANAGED_RESOURCE:
Dominik Brodowski22916632005-06-27 16:28:46 -0700835 sub_interval(&data->io_db, start, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700836 break;
837 default:
Dominik Brodowski22916632005-06-27 16:28:46 -0700838 ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839 break;
840 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700841
842 return ret;
843}
844
845
Dominik Brodowski3c299762005-06-27 16:28:46 -0700846#ifdef CONFIG_PCI
847static int nonstatic_autoadd_resources(struct pcmcia_socket *s)
848{
849 struct resource *res;
850 int i, done = 0;
851
852 if (!s->cb_dev || !s->cb_dev->bus)
853 return -ENODEV;
854
Brian Gerst0d078f62005-10-30 14:59:20 -0800855#if defined(CONFIG_X86)
Dominik Brodowskib6d00f02005-06-27 16:29:02 -0700856 /* If this is the root bus, the risk of hitting
857 * some strange system devices which aren't protected
858 * by either ACPI resource tables or properly requested
859 * resources is too big. Therefore, don't do auto-adding
860 * of resources at the moment.
861 */
862 if (s->cb_dev->bus->number == 0)
863 return -EINVAL;
864#endif
865
Bjorn Helgaas89a74ec2010-02-23 10:24:31 -0700866 pci_bus_for_each_resource(s->cb_dev->bus, res, i) {
Dominik Brodowski3c299762005-06-27 16:28:46 -0700867 if (!res)
868 continue;
869
870 if (res->flags & IORESOURCE_IO) {
871 if (res == &ioport_resource)
872 continue;
Dominik Brodowskidbe4ea52008-08-02 21:36:19 +0200873 dev_printk(KERN_INFO, &s->cb_dev->dev,
Bjorn Helgaase1944c62010-03-16 15:53:08 -0600874 "pcmcia: parent PCI bridge window: %pR\n",
875 res);
Dominik Brodowski3c299762005-06-27 16:28:46 -0700876 if (!adjust_io(s, ADD_MANAGED_RESOURCE, res->start, res->end))
877 done |= IORESOURCE_IO;
878
879 }
880
881 if (res->flags & IORESOURCE_MEM) {
882 if (res == &iomem_resource)
883 continue;
Dominik Brodowskidbe4ea52008-08-02 21:36:19 +0200884 dev_printk(KERN_INFO, &s->cb_dev->dev,
Bjorn Helgaase1944c62010-03-16 15:53:08 -0600885 "pcmcia: parent PCI bridge window: %pR\n",
886 res);
Dominik Brodowski3c299762005-06-27 16:28:46 -0700887 if (!adjust_memory(s, ADD_MANAGED_RESOURCE, res->start, res->end))
888 done |= IORESOURCE_MEM;
889 }
890 }
891
892 /* if we got at least one of IO, and one of MEM, we can be glad and
893 * activate the PCMCIA subsystem */
Dominik Brodowski54bb5672005-09-28 19:29:59 +0200894 if (done == (IORESOURCE_MEM | IORESOURCE_IO))
Dominik Brodowski3c299762005-06-27 16:28:46 -0700895 s->resource_setup_done = 1;
896
897 return 0;
898}
899
900#else
901
902static inline int nonstatic_autoadd_resources(struct pcmcia_socket *s)
903{
904 return -ENODEV;
905}
906
907#endif
908
909
Linus Torvalds1da177e2005-04-16 15:20:36 -0700910static int nonstatic_init(struct pcmcia_socket *s)
911{
912 struct socket_data *data;
913
Dominik Brodowski8084b372005-12-11 21:18:26 +0100914 data = kzalloc(sizeof(struct socket_data), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700915 if (!data)
916 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700917
918 data->mem_db.next = &data->mem_db;
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100919 data->mem_db_valid.next = &data->mem_db_valid;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700920 data->io_db.next = &data->io_db;
921
922 s->resource_data = (void *) data;
923
Dominik Brodowski3c299762005-06-27 16:28:46 -0700924 nonstatic_autoadd_resources(s);
925
Linus Torvalds1da177e2005-04-16 15:20:36 -0700926 return 0;
927}
928
929static void nonstatic_release_resource_db(struct pcmcia_socket *s)
930{
931 struct socket_data *data = s->resource_data;
932 struct resource_map *p, *q;
933
Dominik Brodowski7b4884c2010-02-17 16:25:53 +0100934 for (p = data->mem_db_valid.next; p != &data->mem_db_valid; p = q) {
935 q = p->next;
936 kfree(p);
937 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700938 for (p = data->mem_db.next; p != &data->mem_db; p = q) {
939 q = p->next;
940 kfree(p);
941 }
942 for (p = data->io_db.next; p != &data->io_db; p = q) {
943 q = p->next;
944 kfree(p);
945 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700946}
947
948
949struct pccard_resource_ops pccard_nonstatic_ops = {
950 .validate_mem = pcmcia_nonstatic_validate_mem,
951 .adjust_io_region = nonstatic_adjust_io_region,
952 .find_io = nonstatic_find_io_region,
953 .find_mem = nonstatic_find_mem_region,
Dominik Brodowskic5023802008-06-19 19:02:52 +0200954 .add_io = adjust_io,
955 .add_mem = adjust_memory,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700956 .init = nonstatic_init,
957 .exit = nonstatic_release_resource_db,
958};
959EXPORT_SYMBOL(pccard_nonstatic_ops);
960
961
962/* sysfs interface to the resource database */
963
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200964static ssize_t show_io_db(struct device *dev,
965 struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700966{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200967 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700968 struct socket_data *data;
969 struct resource_map *p;
970 ssize_t ret = 0;
971
Dominik Brodowskicfe5d802010-01-17 19:31:45 +0100972 mutex_lock(&s->ops_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700973 data = s->resource_data;
974
975 for (p = data->io_db.next; p != &data->io_db; p = p->next) {
976 if (ret > (PAGE_SIZE - 10))
977 continue;
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100978 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
979 "0x%08lx - 0x%08lx\n",
980 ((unsigned long) p->base),
981 ((unsigned long) p->base + p->num - 1));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700982 }
983
Dominik Brodowskicfe5d802010-01-17 19:31:45 +0100984 mutex_unlock(&s->ops_mutex);
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100985 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700986}
987
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200988static ssize_t store_io_db(struct device *dev,
989 struct device_attribute *attr,
990 const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700991{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200992 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700993 unsigned long start_addr, end_addr;
Dominik Brodowski22916632005-06-27 16:28:46 -0700994 unsigned int add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700995 ssize_t ret = 0;
996
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100997 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +0100999 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -07001000 add = REMOVE_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001001 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001002 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
1003 &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -07001004 add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001005 if (ret != 2)
1006 return -EINVAL;
1007 }
1008 }
Dominik Brodowski1146bc72005-09-28 19:28:37 +02001009 if (end_addr < start_addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001010 return -EINVAL;
1011
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001012 mutex_lock(&s->ops_mutex);
Dominik Brodowski22916632005-06-27 16:28:46 -07001013 ret = adjust_io(s, add, start_addr, end_addr);
Dominik Brodowski3c299762005-06-27 16:28:46 -07001014 if (!ret)
1015 s->resource_setup_new = 1;
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001016 mutex_unlock(&s->ops_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001017
1018 return ret ? ret : count;
1019}
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001020static DEVICE_ATTR(available_resources_io, 0600, show_io_db, store_io_db);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001021
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001022static ssize_t show_mem_db(struct device *dev,
1023 struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001024{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001025 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001026 struct socket_data *data;
1027 struct resource_map *p;
1028 ssize_t ret = 0;
1029
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001030 mutex_lock(&s->ops_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001031 data = s->resource_data;
1032
Dominik Brodowski7b4884c2010-02-17 16:25:53 +01001033 for (p = data->mem_db_valid.next; p != &data->mem_db_valid;
1034 p = p->next) {
1035 if (ret > (PAGE_SIZE - 10))
1036 continue;
1037 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
1038 "0x%08lx - 0x%08lx\n",
1039 ((unsigned long) p->base),
1040 ((unsigned long) p->base + p->num - 1));
1041 }
1042
Linus Torvalds1da177e2005-04-16 15:20:36 -07001043 for (p = data->mem_db.next; p != &data->mem_db; p = p->next) {
1044 if (ret > (PAGE_SIZE - 10))
1045 continue;
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001046 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
1047 "0x%08lx - 0x%08lx\n",
1048 ((unsigned long) p->base),
1049 ((unsigned long) p->base + p->num - 1));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001050 }
1051
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001052 mutex_unlock(&s->ops_mutex);
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001053 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001054}
1055
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001056static ssize_t store_mem_db(struct device *dev,
1057 struct device_attribute *attr,
1058 const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001059{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001060 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001061 unsigned long start_addr, end_addr;
Dominik Brodowski22916632005-06-27 16:28:46 -07001062 unsigned int add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001063 ssize_t ret = 0;
1064
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001065 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001066 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001067 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -07001068 add = REMOVE_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001069 if (ret != 2) {
Dominik Brodowski9fea84f2009-12-07 22:11:45 +01001070 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
1071 &end_addr);
Dominik Brodowski22916632005-06-27 16:28:46 -07001072 add = ADD_MANAGED_RESOURCE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001073 if (ret != 2)
1074 return -EINVAL;
1075 }
1076 }
Dominik Brodowski1146bc72005-09-28 19:28:37 +02001077 if (end_addr < start_addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001078 return -EINVAL;
1079
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001080 mutex_lock(&s->ops_mutex);
Dominik Brodowski22916632005-06-27 16:28:46 -07001081 ret = adjust_memory(s, add, start_addr, end_addr);
Dominik Brodowski3c299762005-06-27 16:28:46 -07001082 if (!ret)
1083 s->resource_setup_new = 1;
Dominik Brodowskicfe5d802010-01-17 19:31:45 +01001084 mutex_unlock(&s->ops_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001085
1086 return ret ? ret : count;
1087}
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001088static DEVICE_ATTR(available_resources_mem, 0600, show_mem_db, store_mem_db);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001089
David Brownell7d578962008-06-12 12:13:55 -07001090static struct attribute *pccard_rsrc_attributes[] = {
1091 &dev_attr_available_resources_io.attr,
1092 &dev_attr_available_resources_mem.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001093 NULL,
1094};
1095
David Brownell7d578962008-06-12 12:13:55 -07001096static const struct attribute_group rsrc_attributes = {
1097 .attrs = pccard_rsrc_attributes,
1098};
1099
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001100static int __devinit pccard_sysfs_add_rsrc(struct device *dev,
Dmitry Torokhovd8539d82005-09-15 02:01:36 -05001101 struct class_interface *class_intf)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001102{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001103 struct pcmcia_socket *s = dev_get_drvdata(dev);
David Brownell7d578962008-06-12 12:13:55 -07001104
Linus Torvalds1da177e2005-04-16 15:20:36 -07001105 if (s->resource_ops != &pccard_nonstatic_ops)
1106 return 0;
David Brownell7d578962008-06-12 12:13:55 -07001107 return sysfs_create_group(&dev->kobj, &rsrc_attributes);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001108}
1109
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001110static void __devexit pccard_sysfs_remove_rsrc(struct device *dev,
Dmitry Torokhovd8539d82005-09-15 02:01:36 -05001111 struct class_interface *class_intf)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001112{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001113 struct pcmcia_socket *s = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001114
1115 if (s->resource_ops != &pccard_nonstatic_ops)
1116 return;
David Brownell7d578962008-06-12 12:13:55 -07001117 sysfs_remove_group(&dev->kobj, &rsrc_attributes);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001118}
1119
Sam Ravnborged49f5d2008-05-01 04:34:50 -07001120static struct class_interface pccard_rsrc_interface __refdata = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001121 .class = &pcmcia_socket_class,
Greg Kroah-Hartman87373312006-09-12 17:00:10 +02001122 .add_dev = &pccard_sysfs_add_rsrc,
1123 .remove_dev = __devexit_p(&pccard_sysfs_remove_rsrc),
Linus Torvalds1da177e2005-04-16 15:20:36 -07001124};
1125
1126static int __init nonstatic_sysfs_init(void)
1127{
1128 return class_interface_register(&pccard_rsrc_interface);
1129}
1130
1131static void __exit nonstatic_sysfs_exit(void)
1132{
1133 class_interface_unregister(&pccard_rsrc_interface);
1134}
1135
1136module_init(nonstatic_sysfs_init);
1137module_exit(nonstatic_sysfs_exit);