2 * rsrc_mgr.c -- Resource management routines and/or wrappers
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.
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.
12 * (C) 1999 David A. Hinds
15 #include <linux/config.h>
16 #include <linux/module.h>
17 #include <linux/kernel.h>
19 #include <pcmcia/cs_types.h>
20 #include <pcmcia/ss.h>
21 #include <pcmcia/cs.h>
22 #include "cs_internal.h"
25 #ifdef CONFIG_PCMCIA_PROBE
27 static int adjust_irq(struct pcmcia_socket
*s
, adjust_t
*adj
)
32 irq
= adj
->resource
.irq
.IRQ
;
33 if ((irq
< 0) || (irq
> 15))
36 if (adj
->Action
!= REMOVE_MANAGED_RESOURCE
)
41 if (!(s
->irq_mask
& mask
))
51 static inline int adjust_irq(struct pcmcia_socket
*s
, adjust_t
*adj
) {
58 int pcmcia_adjust_resource_info(adjust_t
*adj
)
60 struct pcmcia_socket
*s
;
61 int ret
= CS_UNSUPPORTED_FUNCTION
;
64 down_read(&pcmcia_socket_list_rwsem
);
65 list_for_each_entry(s
, &pcmcia_socket_list
, socket_list
) {
67 if (adj
->Resource
== RES_IRQ
)
68 ret
= adjust_irq(s
, adj
);
70 else if (s
->resource_ops
->adjust_resource
) {
72 /* you can't use the old interface if the new
73 * one was used before */
74 spin_lock_irqsave(&s
->lock
, flags
);
75 if ((s
->resource_setup_new
) &&
76 !(s
->resource_setup_old
)) {
77 spin_unlock_irqrestore(&s
->lock
, flags
);
79 } else if (!(s
->resource_setup_old
))
80 s
->resource_setup_old
= 1;
81 spin_unlock_irqrestore(&s
->lock
, flags
);
83 ret
= s
->resource_ops
->adjust_resource(s
, adj
);
85 /* as there's no way we know this is the
86 * last call to adjust_resource_info, we
87 * always need to assume this is the latest
89 spin_lock_irqsave(&s
->lock
, flags
);
90 s
->resource_setup_done
= 1;
91 spin_unlock_irqrestore(&s
->lock
, flags
);
95 up_read(&pcmcia_socket_list_rwsem
);
99 EXPORT_SYMBOL(pcmcia_adjust_resource_info
);
101 int pcmcia_validate_mem(struct pcmcia_socket
*s
)
103 if (s
->resource_ops
->validate_mem
)
104 return s
->resource_ops
->validate_mem(s
);
105 /* if there is no callback, we can assume that everything is OK */
108 EXPORT_SYMBOL(pcmcia_validate_mem
);
110 int pcmcia_adjust_io_region(struct resource
*res
, unsigned long r_start
,
111 unsigned long r_end
, struct pcmcia_socket
*s
)
113 if (s
->resource_ops
->adjust_io_region
)
114 return s
->resource_ops
->adjust_io_region(res
, r_start
, r_end
, s
);
117 EXPORT_SYMBOL(pcmcia_adjust_io_region
);
119 struct resource
*pcmcia_find_io_region(unsigned long base
, int num
,
120 unsigned long align
, struct pcmcia_socket
*s
)
122 if (s
->resource_ops
->find_io
)
123 return s
->resource_ops
->find_io(base
, num
, align
, s
);
126 EXPORT_SYMBOL(pcmcia_find_io_region
);
128 struct resource
*pcmcia_find_mem_region(u_long base
, u_long num
, u_long align
,
129 int low
, struct pcmcia_socket
*s
)
131 if (s
->resource_ops
->find_mem
)
132 return s
->resource_ops
->find_mem(base
, num
, align
, low
, s
);
135 EXPORT_SYMBOL(pcmcia_find_mem_region
);
137 void release_resource_db(struct pcmcia_socket
*s
)
139 if (s
->resource_ops
->exit
)
140 s
->resource_ops
->exit(s
);
144 static int static_init(struct pcmcia_socket
*s
)
148 /* the good thing about SS_CAP_STATIC_MAP sockets is
149 * that they don't need a resource database */
151 spin_lock_irqsave(&s
->lock
, flags
);
152 s
->resource_setup_done
= 1;
153 spin_unlock_irqrestore(&s
->lock
, flags
);
159 struct pccard_resource_ops pccard_static_ops
= {
160 .validate_mem
= NULL
,
161 .adjust_io_region
= NULL
,
164 .adjust_resource
= NULL
,
168 EXPORT_SYMBOL(pccard_static_ops
);
171 #ifdef CONFIG_PCCARD_IODYN
173 static struct resource
*
174 make_resource(unsigned long b
, unsigned long n
, int flags
, char *name
)
176 struct resource
*res
= kzalloc(sizeof(*res
), GFP_KERNEL
);
181 res
->end
= b
+ n
- 1;
187 struct pcmcia_align_data
{
189 unsigned long offset
;
192 static void pcmcia_align(void *align_data
, struct resource
*res
,
193 unsigned long size
, unsigned long align
)
195 struct pcmcia_align_data
*data
= align_data
;
198 start
= (res
->start
& ~data
->mask
) + data
->offset
;
199 if (start
< res
->start
)
200 start
+= data
->mask
+ 1;
204 if (res
->flags
& IORESOURCE_IO
) {
206 start
= (start
+ 0x3ff) & ~0x3ff;
213 if (res
->flags
& IORESOURCE_IO
) {
214 if ((res
->start
+ size
- 1) >= 1024)
215 res
->start
= res
->end
;
221 static int iodyn_adjust_io_region(struct resource
*res
, unsigned long r_start
,
222 unsigned long r_end
, struct pcmcia_socket
*s
)
224 return adjust_resource(res
, r_start
, r_end
- r_start
+ 1);
228 static struct resource
*iodyn_find_io_region(unsigned long base
, int num
,
229 unsigned long align
, struct pcmcia_socket
*s
)
231 struct resource
*res
= make_resource(0, num
, IORESOURCE_IO
,
233 struct pcmcia_align_data data
;
234 unsigned long min
= base
;
240 data
.mask
= align
- 1;
241 data
.offset
= base
& data
.mask
;
245 ret
= pci_bus_alloc_resource(s
->cb_dev
->bus
, res
, num
, 1,
246 min
, 0, pcmcia_align
, &data
);
249 ret
= allocate_resource(&ioport_resource
, res
, num
, min
, ~0UL,
250 1, pcmcia_align
, &data
);
259 struct pccard_resource_ops pccard_iodyn_ops
= {
260 .validate_mem
= NULL
,
261 .adjust_io_region
= iodyn_adjust_io_region
,
262 .find_io
= iodyn_find_io_region
,
264 .adjust_resource
= NULL
,
268 EXPORT_SYMBOL(pccard_iodyn_ops
);
270 #endif /* CONFIG_PCCARD_IODYN */