]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/pcmcia/rsrc_nonstatic.c
pcmcia: clarify alloc_io_space, move it to resource handlers
[mirror_ubuntu-bionic-kernel.git] / drivers / pcmcia / rsrc_nonstatic.c
CommitLineData
1da177e4
LT
1/*
2 * rsrc_nonstatic.c -- Resource management routines for !SS_CAP_STATIC_MAP sockets
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
7 *
8 * The initial developer of the original code is David A. Hinds
9 * <dahinds@users.sourceforge.net>. Portions created by David A. Hinds
10 * are Copyright (C) 1999 David A. Hinds. All Rights Reserved.
11 *
12 * (C) 1999 David A. Hinds
13 */
14
1da177e4
LT
15#include <linux/module.h>
16#include <linux/moduleparam.h>
17#include <linux/init.h>
18#include <linux/interrupt.h>
19#include <linux/kernel.h>
20#include <linux/errno.h>
21#include <linux/types.h>
22#include <linux/slab.h>
23#include <linux/ioport.h>
24#include <linux/timer.h>
25#include <linux/pci.h>
26#include <linux/device.h>
9fea84f4 27#include <linux/io.h>
1da177e4
LT
28
29#include <asm/irq.h>
1da177e4
LT
30
31#include <pcmcia/cs_types.h>
32#include <pcmcia/ss.h>
33#include <pcmcia/cs.h>
1da177e4
LT
34#include <pcmcia/cistpl.h>
35#include "cs_internal.h"
36
49b1153a 37/* moved to rsrc_mgr.c
1da177e4
LT
38MODULE_AUTHOR("David A. Hinds, Dominik Brodowski");
39MODULE_LICENSE("GPL");
49b1153a 40*/
1da177e4
LT
41
42/* Parameters that can be set with 'insmod' */
43
44#define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0444)
45
46INT_MODULE_PARM(probe_mem, 1); /* memory probe? */
47#ifdef CONFIG_PCMCIA_PROBE
48INT_MODULE_PARM(probe_io, 1); /* IO port probe? */
49INT_MODULE_PARM(mem_limit, 0x10000);
50#endif
51
52/* for io_db and mem_db */
53struct resource_map {
54 u_long base, num;
55 struct resource_map *next;
56};
57
58struct socket_data {
59 struct resource_map mem_db;
7b4884ca 60 struct resource_map mem_db_valid;
1da177e4 61 struct resource_map io_db;
1da177e4
LT
62};
63
1da177e4
LT
64#define MEM_PROBE_LOW (1 << 0)
65#define MEM_PROBE_HIGH (1 << 1)
66
67
68/*======================================================================
69
70 Linux resource management extensions
71
72======================================================================*/
73
1da177e4 74static struct resource *
2427ddd8
GKH
75claim_region(struct pcmcia_socket *s, resource_size_t base,
76 resource_size_t size, int type, char *name)
1da177e4
LT
77{
78 struct resource *res, *parent;
79
80 parent = type & IORESOURCE_MEM ? &iomem_resource : &ioport_resource;
49b1153a 81 res = pcmcia_make_resource(base, size, type | IORESOURCE_BUSY, name);
1da177e4
LT
82
83 if (res) {
84#ifdef CONFIG_PCI
85 if (s && s->cb_dev)
86 parent = pci_find_parent_resource(s->cb_dev, res);
87#endif
88 if (!parent || request_resource(parent, res)) {
89 kfree(res);
90 res = NULL;
91 }
92 }
93 return res;
94}
95
96static void free_region(struct resource *res)
97{
98 if (res) {
99 release_resource(res);
100 kfree(res);
101 }
102}
103
104/*======================================================================
105
106 These manage the internal databases of available resources.
107
108======================================================================*/
109
110static int add_interval(struct resource_map *map, u_long base, u_long num)
111{
1168386a 112 struct resource_map *p, *q;
1da177e4 113
1168386a 114 for (p = map; ; p = p->next) {
f309cb3e
DB
115 if ((p != map) && (p->base+p->num >= base)) {
116 p->num = max(num + base - p->base, p->num);
117 return 0;
118 }
1168386a
DB
119 if ((p->next == map) || (p->next->base > base+num-1))
120 break;
121 }
122 q = kmalloc(sizeof(struct resource_map), GFP_KERNEL);
123 if (!q) {
124 printk(KERN_WARNING "out of memory to update resources\n");
125 return -ENOMEM;
126 }
127 q->base = base; q->num = num;
128 q->next = p->next; p->next = q;
129 return 0;
1da177e4
LT
130}
131
132/*====================================================================*/
133
134static int sub_interval(struct resource_map *map, u_long base, u_long num)
135{
9fea84f4
DB
136 struct resource_map *p, *q;
137
138 for (p = map; ; p = q) {
139 q = p->next;
140 if (q == map)
141 break;
142 if ((q->base+q->num > base) && (base+num > q->base)) {
143 if (q->base >= base) {
144 if (q->base+q->num <= base+num) {
145 /* Delete whole block */
146 p->next = q->next;
147 kfree(q);
148 /* don't advance the pointer yet */
149 q = p;
150 } else {
151 /* Cut off bit from the front */
152 q->num = q->base + q->num - base - num;
153 q->base = base + num;
154 }
155 } else if (q->base+q->num <= base+num) {
156 /* Cut off bit from the end */
157 q->num = base - q->base;
158 } else {
159 /* Split the block into two pieces */
160 p = kmalloc(sizeof(struct resource_map),
161 GFP_KERNEL);
162 if (!p) {
163 printk(KERN_WARNING "out of memory to update resources\n");
164 return -ENOMEM;
165 }
166 p->base = base+num;
167 p->num = q->base+q->num - p->base;
168 q->num = base - q->base;
169 p->next = q->next ; q->next = p;
170 }
1168386a 171 }
9fea84f4
DB
172 }
173 return 0;
1da177e4
LT
174}
175
176/*======================================================================
177
178 These routines examine a region of IO or memory addresses to
179 determine what ranges might be genuinely available.
180
181======================================================================*/
182
183#ifdef CONFIG_PCMCIA_PROBE
906da809
OJ
184static void do_io_probe(struct pcmcia_socket *s, unsigned int base,
185 unsigned int num)
1da177e4 186{
9fea84f4
DB
187 struct resource *res;
188 struct socket_data *s_data = s->resource_data;
189 unsigned int i, j, bad;
190 int any;
191 u_char *b, hole, most;
192
193 dev_printk(KERN_INFO, &s->dev, "cs: IO port probe %#x-%#x:",
194 base, base+num-1);
195
196 /* First, what does a floating port look like? */
197 b = kzalloc(256, GFP_KERNEL);
198 if (!b) {
199 printk("\n");
200 dev_printk(KERN_ERR, &s->dev,
201 "do_io_probe: unable to kmalloc 256 bytes");
202 return;
203 }
204 for (i = base, most = 0; i < base+num; i += 8) {
509b0865 205 res = claim_region(s, i, 8, IORESOURCE_IO, "PCMCIA ioprobe");
9fea84f4
DB
206 if (!res)
207 continue;
208 hole = inb(i);
209 for (j = 1; j < 8; j++)
210 if (inb(i+j) != hole)
211 break;
212 free_region(res);
213 if ((j == 8) && (++b[hole] > b[most]))
214 most = hole;
215 if (b[most] == 127)
216 break;
217 }
218 kfree(b);
219
220 bad = any = 0;
221 for (i = base; i < base+num; i += 8) {
509b0865
DB
222 res = claim_region(s, i, 8, IORESOURCE_IO, "PCMCIA ioprobe");
223 if (!res) {
224 if (!any)
225 printk(" excluding");
226 if (!bad)
227 bad = any = i;
9fea84f4 228 continue;
509b0865 229 }
9fea84f4
DB
230 for (j = 0; j < 8; j++)
231 if (inb(i+j) != most)
232 break;
233 free_region(res);
234 if (j < 8) {
235 if (!any)
236 printk(" excluding");
237 if (!bad)
238 bad = any = i;
239 } else {
240 if (bad) {
241 sub_interval(&s_data->io_db, bad, i-bad);
242 printk(" %#x-%#x", bad, i-1);
243 bad = 0;
244 }
245 }
246 }
247 if (bad) {
248 if ((num > 16) && (bad == base) && (i == base+num)) {
509b0865 249 sub_interval(&s_data->io_db, bad, i-bad);
9fea84f4
DB
250 printk(" nothing: probe failed.\n");
251 return;
252 } else {
253 sub_interval(&s_data->io_db, bad, i-bad);
254 printk(" %#x-%#x", bad, i-1);
255 }
256 }
257
258 printk(any ? "\n" : " clean.\n");
1da177e4
LT
259}
260#endif
261
3f32b3c0 262/*======================================================================*/
1da177e4 263
3f32b3c0
DB
264/**
265 * readable() - iomem validation function for cards with a valid CIS
266 */
c5081d5f
DB
267static int readable(struct pcmcia_socket *s, struct resource *res,
268 unsigned int *count)
1da177e4 269{
3f32b3c0 270 int ret = -EINVAL;
1da177e4 271
7ab24855
DB
272 if (s->fake_cis) {
273 dev_dbg(&s->dev, "fake CIS is being used: can't validate mem\n");
274 return 0;
275 }
1da177e4
LT
276
277 s->cis_mem.res = res;
278 s->cis_virt = ioremap(res->start, s->map_size);
279 if (s->cis_virt) {
6b8e087b 280 mutex_unlock(&s->ops_mutex);
6e7b51a7
DB
281 /* as we're only called from pcmcia.c, we're safe */
282 if (s->callback->validate)
283 ret = s->callback->validate(s, count);
904e3777 284 /* invalidate mapping */
6b8e087b 285 mutex_lock(&s->ops_mutex);
1da177e4
LT
286 iounmap(s->cis_virt);
287 s->cis_virt = NULL;
1da177e4
LT
288 }
289 s->cis_mem.res = NULL;
3f32b3c0
DB
290 if ((ret) || (*count == 0))
291 return -EINVAL;
292 return 0;
1da177e4
LT
293}
294
3f32b3c0
DB
295/**
296 * checksum() - iomem validation function for simple memory cards
297 */
298static int checksum(struct pcmcia_socket *s, struct resource *res,
299 unsigned int *value)
1da177e4
LT
300{
301 pccard_mem_map map;
302 int i, a = 0, b = -1, d;
303 void __iomem *virt;
304
305 virt = ioremap(res->start, s->map_size);
306 if (virt) {
307 map.map = 0;
308 map.flags = MAP_ACTIVE;
309 map.speed = 0;
310 map.res = res;
311 map.card_start = 0;
312 s->ops->set_mem_map(s, &map);
313
314 /* Don't bother checking every word... */
315 for (i = 0; i < s->map_size; i += 44) {
316 d = readl(virt+i);
317 a += d;
318 b &= d;
319 }
320
321 map.flags = 0;
322 s->ops->set_mem_map(s, &map);
323
324 iounmap(virt);
325 }
326
3f32b3c0
DB
327 if (b == -1)
328 return -EINVAL;
1da177e4 329
3f32b3c0 330 *value = a;
1da177e4 331
3f32b3c0 332 return 0;
1da177e4
LT
333}
334
3f32b3c0
DB
335/**
336 * do_validate_mem() - low level validate a memory region for PCMCIA use
337 * @s: PCMCIA socket to validate
338 * @base: start address of resource to check
339 * @size: size of resource to check
340 * @validate: validation function to use
341 *
342 * do_validate_mem() splits up the memory region which is to be checked
343 * into two parts. Both are passed to the @validate() function. If
344 * @validate() returns non-zero, or the value parameter to @validate()
345 * is zero, or the value parameter is different between both calls,
346 * the check fails, and -EINVAL is returned. Else, 0 is returned.
347 */
348static int do_validate_mem(struct pcmcia_socket *s,
349 unsigned long base, unsigned long size,
350 int validate (struct pcmcia_socket *s,
351 struct resource *res,
352 unsigned int *value))
1da177e4 353{
7b4884ca 354 struct socket_data *s_data = s->resource_data;
1da177e4 355 struct resource *res1, *res2;
3f32b3c0
DB
356 unsigned int info1 = 1, info2 = 1;
357 int ret = -EINVAL;
1da177e4 358
9fea84f4
DB
359 res1 = claim_region(s, base, size/2, IORESOURCE_MEM, "PCMCIA memprobe");
360 res2 = claim_region(s, base + size/2, size/2, IORESOURCE_MEM,
361 "PCMCIA memprobe");
1da177e4
LT
362
363 if (res1 && res2) {
3f32b3c0
DB
364 ret = 0;
365 if (validate) {
366 ret = validate(s, res1, &info1);
367 ret += validate(s, res2, &info2);
368 }
1da177e4
LT
369 }
370
371 free_region(res2);
372 free_region(res1);
373
3f32b3c0
DB
374 dev_dbg(&s->dev, "cs: memory probe 0x%06lx-0x%06lx: %p %p %u %u %u",
375 base, base+size-1, res1, res2, ret, info1, info2);
1da177e4 376
3f32b3c0
DB
377 if ((ret) || (info1 != info2) || (info1 == 0))
378 return -EINVAL;
1da177e4 379
7b4884ca
DB
380 if (validate && !s->fake_cis) {
381 /* move it to the validated data set */
382 add_interval(&s_data->mem_db_valid, base, size);
383 sub_interval(&s_data->mem_db, base, size);
1da177e4
LT
384 }
385
3f32b3c0 386 return 0;
1da177e4
LT
387}
388
1da177e4 389
3f32b3c0
DB
390/**
391 * do_mem_probe() - validate a memory region for PCMCIA use
392 * @s: PCMCIA socket to validate
393 * @base: start address of resource to check
394 * @num: size of resource to check
395 * @validate: validation function to use
396 * @fallback: validation function to use if validate fails
397 *
398 * do_mem_probe() checks a memory region for use by the PCMCIA subsystem.
399 * To do so, the area is split up into sensible parts, and then passed
400 * into the @validate() function. Only if @validate() and @fallback() fail,
401 * the area is marked as unavaibale for use by the PCMCIA subsystem. The
402 * function returns the size of the usable memory area.
403 */
404static int do_mem_probe(struct pcmcia_socket *s, u_long base, u_long num,
405 int validate (struct pcmcia_socket *s,
406 struct resource *res,
407 unsigned int *value),
408 int fallback (struct pcmcia_socket *s,
409 struct resource *res,
410 unsigned int *value))
1da177e4 411{
9fea84f4
DB
412 struct socket_data *s_data = s->resource_data;
413 u_long i, j, bad, fail, step;
414
415 dev_printk(KERN_INFO, &s->dev, "cs: memory probe 0x%06lx-0x%06lx:",
416 base, base+num-1);
417 bad = fail = 0;
418 step = (num < 0x20000) ? 0x2000 : ((num>>4) & ~0x1fff);
419 /* don't allow too large steps */
420 if (step > 0x800000)
421 step = 0x800000;
422 /* cis_readable wants to map 2x map_size */
423 if (step < 2 * s->map_size)
424 step = 2 * s->map_size;
425 for (i = j = base; i < base+num; i = j + step) {
426 if (!fail) {
427 for (j = i; j < base+num; j += step) {
3f32b3c0 428 if (!do_validate_mem(s, j, step, validate))
9fea84f4
DB
429 break;
430 }
431 fail = ((i == base) && (j == base+num));
432 }
3f32b3c0
DB
433 if ((fail) && (fallback)) {
434 for (j = i; j < base+num; j += step)
435 if (!do_validate_mem(s, j, step, fallback))
9fea84f4
DB
436 break;
437 }
438 if (i != j) {
439 if (!bad)
440 printk(" excluding");
441 printk(" %#05lx-%#05lx", i, j-1);
442 sub_interval(&s_data->mem_db, i, j-i);
443 bad += j-i;
444 }
445 }
446 printk(bad ? "\n" : " clean.\n");
447 return num - bad;
1da177e4
LT
448}
449
3f32b3c0 450
1da177e4
LT
451#ifdef CONFIG_PCMCIA_PROBE
452
3f32b3c0
DB
453/**
454 * inv_probe() - top-to-bottom search for one usuable high memory area
455 * @s: PCMCIA socket to validate
456 * @m: resource_map to check
457 */
1da177e4
LT
458static u_long inv_probe(struct resource_map *m, struct pcmcia_socket *s)
459{
de75914e
DB
460 struct socket_data *s_data = s->resource_data;
461 u_long ok;
462 if (m == &s_data->mem_db)
463 return 0;
464 ok = inv_probe(m->next, s);
465 if (ok) {
466 if (m->base >= 0x100000)
467 sub_interval(&s_data->mem_db, m->base, m->num);
468 return ok;
469 }
470 if (m->base < 0x100000)
471 return 0;
3f32b3c0 472 return do_mem_probe(s, m->base, m->num, readable, checksum);
1da177e4
LT
473}
474
3f32b3c0
DB
475/**
476 * validate_mem() - memory probe function
477 * @s: PCMCIA socket to validate
478 * @probe_mask: MEM_PROBE_LOW | MEM_PROBE_HIGH
479 *
480 * The memory probe. If the memory list includes a 64K-aligned block
481 * below 1MB, we probe in 64K chunks, and as soon as we accumulate at
482 * least mem_limit free space, we quit. Returns 0 on usuable ports.
483 */
de75914e 484static int validate_mem(struct pcmcia_socket *s, unsigned int probe_mask)
1da177e4 485{
de75914e
DB
486 struct resource_map *m, mm;
487 static unsigned char order[] = { 0xd0, 0xe0, 0xc0, 0xf0 };
488 unsigned long b, i, ok = 0;
489 struct socket_data *s_data = s->resource_data;
1da177e4 490
de75914e
DB
491 /* We do up to four passes through the list */
492 if (probe_mask & MEM_PROBE_HIGH) {
493 if (inv_probe(s_data->mem_db.next, s) > 0)
494 return 0;
7b4884ca
DB
495 if (s_data->mem_db_valid.next != &s_data->mem_db_valid)
496 return 0;
dbe4ea5f
DB
497 dev_printk(KERN_NOTICE, &s->dev,
498 "cs: warning: no high memory space available!\n");
de75914e 499 return -ENODEV;
1da177e4 500 }
de75914e
DB
501
502 for (m = s_data->mem_db.next; m != &s_data->mem_db; m = mm.next) {
503 mm = *m;
504 /* Only probe < 1 MB */
505 if (mm.base >= 0x100000)
506 continue;
507 if ((mm.base | mm.num) & 0xffff) {
3f32b3c0
DB
508 ok += do_mem_probe(s, mm.base, mm.num, readable,
509 checksum);
de75914e
DB
510 continue;
511 }
512 /* Special probe for 64K-aligned block */
513 for (i = 0; i < 4; i++) {
514 b = order[i] << 12;
515 if ((b >= mm.base) && (b+0x10000 <= mm.base+mm.num)) {
516 if (ok >= mem_limit)
517 sub_interval(&s_data->mem_db, b, 0x10000);
518 else
3f32b3c0
DB
519 ok += do_mem_probe(s, b, 0x10000,
520 readable, checksum);
de75914e
DB
521 }
522 }
1da177e4 523 }
de75914e
DB
524
525 if (ok > 0)
526 return 0;
527
528 return -ENODEV;
1da177e4
LT
529}
530
531#else /* CONFIG_PCMCIA_PROBE */
532
3f32b3c0
DB
533/**
534 * validate_mem() - memory probe function
535 * @s: PCMCIA socket to validate
536 * @probe_mask: ignored
537 *
538 * Returns 0 on usuable ports.
539 */
2cff9447 540static int validate_mem(struct pcmcia_socket *s, unsigned int probe_mask)
1da177e4
LT
541{
542 struct resource_map *m, mm;
543 struct socket_data *s_data = s->resource_data;
2cff9447 544 unsigned long ok = 0;
1da177e4
LT
545
546 for (m = s_data->mem_db.next; m != &s_data->mem_db; m = mm.next) {
547 mm = *m;
3f32b3c0 548 ok += do_mem_probe(s, mm.base, mm.num, readable, checksum);
1da177e4 549 }
2cff9447
AM
550 if (ok > 0)
551 return 0;
552 return -ENODEV;
1da177e4
LT
553}
554
555#endif /* CONFIG_PCMCIA_PROBE */
556
557
3f32b3c0
DB
558/**
559 * pcmcia_nonstatic_validate_mem() - try to validate iomem for PCMCIA use
560 * @s: PCMCIA socket to validate
561 *
562 * This is tricky... when we set up CIS memory, we try to validate
563 * the memory window space allocations.
564 *
7fe908dd 565 * Locking note: Must be called with skt_mutex held!
1da177e4 566 */
de75914e 567static int pcmcia_nonstatic_validate_mem(struct pcmcia_socket *s)
1da177e4
LT
568{
569 struct socket_data *s_data = s->resource_data;
de75914e 570 unsigned int probe_mask = MEM_PROBE_LOW;
7b4884ca 571 int ret;
de75914e 572
7b4884ca 573 if (!probe_mem || !(s->state & SOCKET_PRESENT))
de75914e 574 return 0;
1da177e4 575
de75914e
DB
576 if (s->features & SS_CAP_PAGE_REGS)
577 probe_mask = MEM_PROBE_HIGH;
1da177e4 578
7b4884ca 579 ret = validate_mem(s, probe_mask);
1da177e4 580
7b4884ca
DB
581 if (s_data->mem_db_valid.next != &s_data->mem_db_valid)
582 return 0;
1da177e4 583
de75914e 584 return ret;
1da177e4
LT
585}
586
587struct pcmcia_align_data {
588 unsigned long mask;
589 unsigned long offset;
590 struct resource_map *map;
591};
592
147a2746
DB
593static resource_size_t pcmcia_common_align(struct pcmcia_align_data *align_data,
594 resource_size_t start)
1da177e4 595{
147a2746 596 resource_size_t ret;
1da177e4
LT
597 /*
598 * Ensure that we have the correct start address
599 */
147a2746
DB
600 ret = (start & ~align_data->mask) + align_data->offset;
601 if (ret < start)
602 ret += align_data->mask + 1;
603 return ret;
1da177e4
LT
604}
605
b26b2d49 606static resource_size_t
3b7a17fc
DB
607pcmcia_align(void *align_data, const struct resource *res,
608 resource_size_t size, resource_size_t align)
1da177e4
LT
609{
610 struct pcmcia_align_data *data = align_data;
611 struct resource_map *m;
b26b2d49 612 resource_size_t start;
1da177e4 613
147a2746 614 start = pcmcia_common_align(data, res->start);
1da177e4
LT
615
616 for (m = data->map->next; m != data->map; m = m->next) {
147a2746
DB
617 unsigned long map_start = m->base;
618 unsigned long map_end = m->base + m->num - 1;
1da177e4
LT
619
620 /*
621 * If the lower resources are not available, try aligning
622 * to this entry of the resource database to see if it'll
623 * fit here.
624 */
147a2746
DB
625 if (start < map_start)
626 start = pcmcia_common_align(data, map_start);
1da177e4
LT
627
628 /*
629 * If we're above the area which was passed in, there's
630 * no point proceeding.
631 */
147a2746 632 if (start >= res->end)
1da177e4
LT
633 break;
634
147a2746 635 if ((start + size - 1) <= map_end)
1da177e4
LT
636 break;
637 }
638
639 /*
640 * If we failed to find something suitable, ensure we fail.
641 */
642 if (m == data->map)
b26b2d49
DB
643 start = res->end;
644
645 return start;
1da177e4
LT
646}
647
648/*
649 * Adjust an existing IO region allocation, but making sure that we don't
650 * encroach outside the resources which the user supplied.
651 */
b19a7275
DB
652static int __nonstatic_adjust_io_region(struct pcmcia_socket *s,
653 unsigned long r_start,
654 unsigned long r_end)
1da177e4
LT
655{
656 struct resource_map *m;
657 struct socket_data *s_data = s->resource_data;
658 int ret = -ENOMEM;
659
1da177e4
LT
660 for (m = s_data->io_db.next; m != &s_data->io_db; m = m->next) {
661 unsigned long start = m->base;
662 unsigned long end = m->base + m->num - 1;
663
664 if (start > r_start || r_end > end)
665 continue;
666
b19a7275 667 ret = 0;
1da177e4 668 }
1da177e4
LT
669
670 return ret;
671}
672
673/*======================================================================
674
675 These find ranges of I/O ports or memory addresses that are not
676 currently allocated by other devices.
677
678 The 'align' field should reflect the number of bits of address
679 that need to be preserved from the initial value of *base. It
680 should be a power of two, greater than or equal to 'num'. A value
681 of 0 means that all bits of *base are significant. *base should
682 also be strictly less than 'align'.
683
684======================================================================*/
685
b19a7275
DB
686static struct resource *__nonstatic_find_io_region(struct pcmcia_socket *s,
687 unsigned long base, int num,
688 unsigned long align)
1da177e4 689{
49b1153a
DB
690 struct resource *res = pcmcia_make_resource(0, num, IORESOURCE_IO,
691 dev_name(&s->dev));
1da177e4
LT
692 struct socket_data *s_data = s->resource_data;
693 struct pcmcia_align_data data;
694 unsigned long min = base;
695 int ret;
696
1da177e4
LT
697 data.mask = align - 1;
698 data.offset = base & data.mask;
699 data.map = &s_data->io_db;
700
1da177e4
LT
701#ifdef CONFIG_PCI
702 if (s->cb_dev) {
703 ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1,
704 min, 0, pcmcia_align, &data);
705 } else
706#endif
707 ret = allocate_resource(&ioport_resource, res, num, min, ~0UL,
708 1, pcmcia_align, &data);
1da177e4
LT
709
710 if (ret != 0) {
711 kfree(res);
712 res = NULL;
713 }
714 return res;
715}
716
b19a7275
DB
717static int nonstatic_find_io(struct pcmcia_socket *s, unsigned int attr,
718 unsigned int *base, unsigned int num,
719 unsigned int align)
720{
721 int i, ret = 0;
722
723 /* Check for an already-allocated window that must conflict with
724 * what was asked for. It is a hack because it does not catch all
725 * potential conflicts, just the most obvious ones.
726 */
727 for (i = 0; i < MAX_IO_WIN; i++) {
728 if (!s->io[i].res)
729 continue;
730
731 if (!*base)
732 continue;
733
734 if ((s->io[i].res->start & (align-1)) == *base)
735 return -EBUSY;
736 }
737
738 for (i = 0; i < MAX_IO_WIN; i++) {
739 struct resource *res = s->io[i].res;
740 unsigned int try;
741
742 if (res && (res->flags & IORESOURCE_BITS) !=
743 (attr & IORESOURCE_BITS))
744 continue;
745
746 if (!res) {
747 if (align == 0)
748 align = 0x10000;
749
750 res = s->io[i].res = __nonstatic_find_io_region(s,
751 *base, num,
752 align);
753 if (!res)
754 return -EINVAL;
755
756 *base = res->start;
757 s->io[i].res->flags =
758 ((res->flags & ~IORESOURCE_BITS) |
759 (attr & IORESOURCE_BITS));
760 s->io[i].InUse = num;
761 return 0;
762 }
763
764 /* Try to extend top of window */
765 try = res->end + 1;
766 if ((*base == 0) || (*base == try)) {
767 ret = __nonstatic_adjust_io_region(s, res->start,
768 res->end + num);
769 if (!ret) {
770 ret = adjust_resource(s->io[i].res, res->start,
771 res->end - res->start + num + 1);
772 if (ret)
773 continue;
774 *base = try;
775 s->io[i].InUse += num;
776 return 0;
777 }
778 }
779
780 /* Try to extend bottom of window */
781 try = res->start - num;
782 if ((*base == 0) || (*base == try)) {
783 ret = __nonstatic_adjust_io_region(s,
784 res->start - num,
785 res->end);
786 if (!ret) {
787 ret = adjust_resource(s->io[i].res,
788 res->start - num,
789 res->end - res->start + num + 1);
790 if (ret)
791 continue;
792 *base = try;
793 s->io[i].InUse += num;
794 return 0;
795 }
796 }
797 }
798
799 return -EINVAL;
800}
801
802
9fea84f4 803static struct resource *nonstatic_find_mem_region(u_long base, u_long num,
e94e15f7 804 u_long align, int low, struct pcmcia_socket *s)
1da177e4 805{
49b1153a
DB
806 struct resource *res = pcmcia_make_resource(0, num, IORESOURCE_MEM,
807 dev_name(&s->dev));
1da177e4
LT
808 struct socket_data *s_data = s->resource_data;
809 struct pcmcia_align_data data;
810 unsigned long min, max;
7b4884ca 811 int ret, i, j;
1da177e4
LT
812
813 low = low || !(s->features & SS_CAP_PAGE_REGS);
814
815 data.mask = align - 1;
816 data.offset = base & data.mask;
1da177e4
LT
817
818 for (i = 0; i < 2; i++) {
7b4884ca 819 data.map = &s_data->mem_db_valid;
1da177e4
LT
820 if (low) {
821 max = 0x100000UL;
822 min = base < max ? base : 0;
823 } else {
824 max = ~0UL;
825 min = 0x100000UL + base;
826 }
827
7b4884ca 828 for (j = 0; j < 2; j++) {
1da177e4 829#ifdef CONFIG_PCI
7b4884ca
DB
830 if (s->cb_dev) {
831 ret = pci_bus_alloc_resource(s->cb_dev->bus,
832 res, num, 1, min, 0,
833 pcmcia_align, &data);
834 } else
1da177e4 835#endif
7b4884ca
DB
836 {
837 ret = allocate_resource(&iomem_resource,
838 res, num, min, max, 1,
839 pcmcia_align, &data);
840 }
841 if (ret == 0)
842 break;
843 data.map = &s_data->mem_db;
844 }
1da177e4
LT
845 if (ret == 0 || low)
846 break;
847 low = 1;
848 }
849
850 if (ret != 0) {
851 kfree(res);
852 res = NULL;
853 }
854 return res;
855}
856
857
22916638 858static int adjust_memory(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
1da177e4 859{
1da177e4 860 struct socket_data *data = s->resource_data;
22916638
DB
861 unsigned long size = end - start + 1;
862 int ret = 0;
1da177e4 863
1146bc74 864 if (end < start)
22916638 865 return -EINVAL;
1da177e4 866
22916638 867 switch (action) {
1da177e4 868 case ADD_MANAGED_RESOURCE:
22916638 869 ret = add_interval(&data->mem_db, start, size);
3f32b3c0
DB
870 if (!ret)
871 do_mem_probe(s, start, size, NULL, NULL);
1da177e4
LT
872 break;
873 case REMOVE_MANAGED_RESOURCE:
22916638 874 ret = sub_interval(&data->mem_db, start, size);
1da177e4
LT
875 break;
876 default:
22916638 877 ret = -EINVAL;
1da177e4 878 }
1da177e4
LT
879
880 return ret;
881}
882
883
22916638 884static int adjust_io(struct pcmcia_socket *s, unsigned int action, unsigned long start, unsigned long end)
1da177e4
LT
885{
886 struct socket_data *data = s->resource_data;
41b97ab5 887 unsigned long size;
22916638 888 int ret = 0;
1da177e4 889
9713ab28
DB
890#if defined(CONFIG_X86)
891 /* on x86, avoid anything < 0x100 for it is often used for
892 * legacy platform devices */
893 if (start < 0x100)
894 start = 0x100;
895#endif
896
41b97ab5
DB
897 size = end - start + 1;
898
1146bc74 899 if (end < start)
22916638
DB
900 return -EINVAL;
901
902 if (end > IO_SPACE_LIMIT)
903 return -EINVAL;
1da177e4 904
22916638 905 switch (action) {
1da177e4 906 case ADD_MANAGED_RESOURCE:
22916638
DB
907 if (add_interval(&data->io_db, start, size) != 0) {
908 ret = -EBUSY;
1da177e4
LT
909 break;
910 }
911#ifdef CONFIG_PCMCIA_PROBE
912 if (probe_io)
22916638 913 do_io_probe(s, start, size);
1da177e4
LT
914#endif
915 break;
916 case REMOVE_MANAGED_RESOURCE:
22916638 917 sub_interval(&data->io_db, start, size);
1da177e4
LT
918 break;
919 default:
22916638 920 ret = -EINVAL;
1da177e4
LT
921 break;
922 }
1da177e4
LT
923
924 return ret;
925}
926
927
3c29976a
DB
928#ifdef CONFIG_PCI
929static int nonstatic_autoadd_resources(struct pcmcia_socket *s)
930{
931 struct resource *res;
932 int i, done = 0;
933
934 if (!s->cb_dev || !s->cb_dev->bus)
935 return -ENODEV;
936
0d078f6f 937#if defined(CONFIG_X86)
b6d00f0d
DB
938 /* If this is the root bus, the risk of hitting
939 * some strange system devices which aren't protected
940 * by either ACPI resource tables or properly requested
941 * resources is too big. Therefore, don't do auto-adding
942 * of resources at the moment.
943 */
944 if (s->cb_dev->bus->number == 0)
945 return -EINVAL;
946#endif
947
89a74ecc 948 pci_bus_for_each_resource(s->cb_dev->bus, res, i) {
3c29976a
DB
949 if (!res)
950 continue;
951
952 if (res->flags & IORESOURCE_IO) {
953 if (res == &ioport_resource)
954 continue;
dbe4ea5f 955 dev_printk(KERN_INFO, &s->cb_dev->dev,
e1944c6b
BH
956 "pcmcia: parent PCI bridge window: %pR\n",
957 res);
3c29976a
DB
958 if (!adjust_io(s, ADD_MANAGED_RESOURCE, res->start, res->end))
959 done |= IORESOURCE_IO;
960
961 }
962
963 if (res->flags & IORESOURCE_MEM) {
964 if (res == &iomem_resource)
965 continue;
dbe4ea5f 966 dev_printk(KERN_INFO, &s->cb_dev->dev,
e1944c6b
BH
967 "pcmcia: parent PCI bridge window: %pR\n",
968 res);
3c29976a
DB
969 if (!adjust_memory(s, ADD_MANAGED_RESOURCE, res->start, res->end))
970 done |= IORESOURCE_MEM;
971 }
972 }
973
974 /* if we got at least one of IO, and one of MEM, we can be glad and
975 * activate the PCMCIA subsystem */
54bb5675 976 if (done == (IORESOURCE_MEM | IORESOURCE_IO))
3c29976a
DB
977 s->resource_setup_done = 1;
978
979 return 0;
980}
981
982#else
983
984static inline int nonstatic_autoadd_resources(struct pcmcia_socket *s)
985{
986 return -ENODEV;
987}
988
989#endif
990
991
1da177e4
LT
992static int nonstatic_init(struct pcmcia_socket *s)
993{
994 struct socket_data *data;
995
8084b372 996 data = kzalloc(sizeof(struct socket_data), GFP_KERNEL);
1da177e4
LT
997 if (!data)
998 return -ENOMEM;
1da177e4
LT
999
1000 data->mem_db.next = &data->mem_db;
7b4884ca 1001 data->mem_db_valid.next = &data->mem_db_valid;
1da177e4
LT
1002 data->io_db.next = &data->io_db;
1003
1004 s->resource_data = (void *) data;
1005
3c29976a
DB
1006 nonstatic_autoadd_resources(s);
1007
1da177e4
LT
1008 return 0;
1009}
1010
1011static void nonstatic_release_resource_db(struct pcmcia_socket *s)
1012{
1013 struct socket_data *data = s->resource_data;
1014 struct resource_map *p, *q;
1015
7b4884ca
DB
1016 for (p = data->mem_db_valid.next; p != &data->mem_db_valid; p = q) {
1017 q = p->next;
1018 kfree(p);
1019 }
1da177e4
LT
1020 for (p = data->mem_db.next; p != &data->mem_db; p = q) {
1021 q = p->next;
1022 kfree(p);
1023 }
1024 for (p = data->io_db.next; p != &data->io_db; p = q) {
1025 q = p->next;
1026 kfree(p);
1027 }
1da177e4
LT
1028}
1029
1030
1031struct pccard_resource_ops pccard_nonstatic_ops = {
1032 .validate_mem = pcmcia_nonstatic_validate_mem,
b19a7275 1033 .find_io = nonstatic_find_io,
1da177e4 1034 .find_mem = nonstatic_find_mem_region,
c5023801
DB
1035 .add_io = adjust_io,
1036 .add_mem = adjust_memory,
1da177e4
LT
1037 .init = nonstatic_init,
1038 .exit = nonstatic_release_resource_db,
1039};
1040EXPORT_SYMBOL(pccard_nonstatic_ops);
1041
1042
1043/* sysfs interface to the resource database */
1044
87373318
GKH
1045static ssize_t show_io_db(struct device *dev,
1046 struct device_attribute *attr, char *buf)
1da177e4 1047{
87373318 1048 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4
LT
1049 struct socket_data *data;
1050 struct resource_map *p;
1051 ssize_t ret = 0;
1052
cfe5d809 1053 mutex_lock(&s->ops_mutex);
1da177e4
LT
1054 data = s->resource_data;
1055
1056 for (p = data->io_db.next; p != &data->io_db; p = p->next) {
1057 if (ret > (PAGE_SIZE - 10))
1058 continue;
9fea84f4
DB
1059 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
1060 "0x%08lx - 0x%08lx\n",
1061 ((unsigned long) p->base),
1062 ((unsigned long) p->base + p->num - 1));
1da177e4
LT
1063 }
1064
cfe5d809 1065 mutex_unlock(&s->ops_mutex);
9fea84f4 1066 return ret;
1da177e4
LT
1067}
1068
87373318
GKH
1069static ssize_t store_io_db(struct device *dev,
1070 struct device_attribute *attr,
1071 const char *buf, size_t count)
1da177e4 1072{
87373318 1073 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4 1074 unsigned long start_addr, end_addr;
22916638 1075 unsigned int add = ADD_MANAGED_RESOURCE;
1da177e4
LT
1076 ssize_t ret = 0;
1077
9fea84f4 1078 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
1da177e4 1079 if (ret != 2) {
9fea84f4 1080 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
22916638 1081 add = REMOVE_MANAGED_RESOURCE;
1da177e4 1082 if (ret != 2) {
9fea84f4
DB
1083 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
1084 &end_addr);
22916638 1085 add = ADD_MANAGED_RESOURCE;
1da177e4
LT
1086 if (ret != 2)
1087 return -EINVAL;
1088 }
1089 }
1146bc74 1090 if (end_addr < start_addr)
1da177e4
LT
1091 return -EINVAL;
1092
cfe5d809 1093 mutex_lock(&s->ops_mutex);
22916638 1094 ret = adjust_io(s, add, start_addr, end_addr);
3c29976a
DB
1095 if (!ret)
1096 s->resource_setup_new = 1;
cfe5d809 1097 mutex_unlock(&s->ops_mutex);
1da177e4
LT
1098
1099 return ret ? ret : count;
1100}
87373318 1101static DEVICE_ATTR(available_resources_io, 0600, show_io_db, store_io_db);
1da177e4 1102
87373318
GKH
1103static ssize_t show_mem_db(struct device *dev,
1104 struct device_attribute *attr, char *buf)
1da177e4 1105{
87373318 1106 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4
LT
1107 struct socket_data *data;
1108 struct resource_map *p;
1109 ssize_t ret = 0;
1110
cfe5d809 1111 mutex_lock(&s->ops_mutex);
1da177e4
LT
1112 data = s->resource_data;
1113
7b4884ca
DB
1114 for (p = data->mem_db_valid.next; p != &data->mem_db_valid;
1115 p = p->next) {
1116 if (ret > (PAGE_SIZE - 10))
1117 continue;
1118 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
1119 "0x%08lx - 0x%08lx\n",
1120 ((unsigned long) p->base),
1121 ((unsigned long) p->base + p->num - 1));
1122 }
1123
1da177e4
LT
1124 for (p = data->mem_db.next; p != &data->mem_db; p = p->next) {
1125 if (ret > (PAGE_SIZE - 10))
1126 continue;
9fea84f4
DB
1127 ret += snprintf(&buf[ret], (PAGE_SIZE - ret - 1),
1128 "0x%08lx - 0x%08lx\n",
1129 ((unsigned long) p->base),
1130 ((unsigned long) p->base + p->num - 1));
1da177e4
LT
1131 }
1132
cfe5d809 1133 mutex_unlock(&s->ops_mutex);
9fea84f4 1134 return ret;
1da177e4
LT
1135}
1136
87373318
GKH
1137static ssize_t store_mem_db(struct device *dev,
1138 struct device_attribute *attr,
1139 const char *buf, size_t count)
1da177e4 1140{
87373318 1141 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4 1142 unsigned long start_addr, end_addr;
22916638 1143 unsigned int add = ADD_MANAGED_RESOURCE;
1da177e4
LT
1144 ssize_t ret = 0;
1145
9fea84f4 1146 ret = sscanf(buf, "+ 0x%lx - 0x%lx", &start_addr, &end_addr);
1da177e4 1147 if (ret != 2) {
9fea84f4 1148 ret = sscanf(buf, "- 0x%lx - 0x%lx", &start_addr, &end_addr);
22916638 1149 add = REMOVE_MANAGED_RESOURCE;
1da177e4 1150 if (ret != 2) {
9fea84f4
DB
1151 ret = sscanf(buf, "0x%lx - 0x%lx", &start_addr,
1152 &end_addr);
22916638 1153 add = ADD_MANAGED_RESOURCE;
1da177e4
LT
1154 if (ret != 2)
1155 return -EINVAL;
1156 }
1157 }
1146bc74 1158 if (end_addr < start_addr)
1da177e4
LT
1159 return -EINVAL;
1160
cfe5d809 1161 mutex_lock(&s->ops_mutex);
22916638 1162 ret = adjust_memory(s, add, start_addr, end_addr);
3c29976a
DB
1163 if (!ret)
1164 s->resource_setup_new = 1;
cfe5d809 1165 mutex_unlock(&s->ops_mutex);
1da177e4
LT
1166
1167 return ret ? ret : count;
1168}
87373318 1169static DEVICE_ATTR(available_resources_mem, 0600, show_mem_db, store_mem_db);
1da177e4 1170
7d578961
DB
1171static struct attribute *pccard_rsrc_attributes[] = {
1172 &dev_attr_available_resources_io.attr,
1173 &dev_attr_available_resources_mem.attr,
1da177e4
LT
1174 NULL,
1175};
1176
7d578961
DB
1177static const struct attribute_group rsrc_attributes = {
1178 .attrs = pccard_rsrc_attributes,
1179};
1180
87373318 1181static int __devinit pccard_sysfs_add_rsrc(struct device *dev,
d8539d81 1182 struct class_interface *class_intf)
1da177e4 1183{
87373318 1184 struct pcmcia_socket *s = dev_get_drvdata(dev);
7d578961 1185
1da177e4
LT
1186 if (s->resource_ops != &pccard_nonstatic_ops)
1187 return 0;
7d578961 1188 return sysfs_create_group(&dev->kobj, &rsrc_attributes);
1da177e4
LT
1189}
1190
87373318 1191static void __devexit pccard_sysfs_remove_rsrc(struct device *dev,
d8539d81 1192 struct class_interface *class_intf)
1da177e4 1193{
87373318 1194 struct pcmcia_socket *s = dev_get_drvdata(dev);
1da177e4
LT
1195
1196 if (s->resource_ops != &pccard_nonstatic_ops)
1197 return;
7d578961 1198 sysfs_remove_group(&dev->kobj, &rsrc_attributes);
1da177e4
LT
1199}
1200
ed49f5d0 1201static struct class_interface pccard_rsrc_interface __refdata = {
1da177e4 1202 .class = &pcmcia_socket_class,
87373318
GKH
1203 .add_dev = &pccard_sysfs_add_rsrc,
1204 .remove_dev = __devexit_p(&pccard_sysfs_remove_rsrc),
1da177e4
LT
1205};
1206
1207static int __init nonstatic_sysfs_init(void)
1208{
1209 return class_interface_register(&pccard_rsrc_interface);
1210}
1211
1212static void __exit nonstatic_sysfs_exit(void)
1213{
1214 class_interface_unregister(&pccard_rsrc_interface);
1215}
1216
1217module_init(nonstatic_sysfs_init);
1218module_exit(nonstatic_sysfs_exit);