diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/pcmcia/au1000_generic.c |
Linux-2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/pcmcia/au1000_generic.c')
-rw-r--r-- | drivers/pcmcia/au1000_generic.c | 579 |
1 files changed, 579 insertions, 0 deletions
diff --git a/drivers/pcmcia/au1000_generic.c b/drivers/pcmcia/au1000_generic.c new file mode 100644 index 00000000000..9fa7f15d89e --- /dev/null +++ b/drivers/pcmcia/au1000_generic.c | |||
@@ -0,0 +1,579 @@ | |||
1 | /* | ||
2 | * | ||
3 | * Alchemy Semi Au1000 pcmcia driver | ||
4 | * | ||
5 | * Copyright 2001-2003 MontaVista Software Inc. | ||
6 | * Author: MontaVista Software, Inc. | ||
7 | * ppopov@embeddedalley.com or source@mvista.com | ||
8 | * | ||
9 | * Copyright 2004 Pete Popov, Embedded Alley Solutions, Inc. | ||
10 | * Updated the driver to 2.6. Followed the sa11xx API and largely | ||
11 | * copied many of the hardware independent functions. | ||
12 | * | ||
13 | * ######################################################################## | ||
14 | * | ||
15 | * This program is free software; you can distribute it and/or modify it | ||
16 | * under the terms of the GNU General Public License (Version 2) as | ||
17 | * published by the Free Software Foundation. | ||
18 | * | ||
19 | * This program is distributed in the hope it will be useful, but WITHOUT | ||
20 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | ||
21 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License | ||
22 | * for more details. | ||
23 | * | ||
24 | * You should have received a copy of the GNU General Public License along | ||
25 | * with this program; if not, write to the Free Software Foundation, Inc., | ||
26 | * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. | ||
27 | * | ||
28 | * ######################################################################## | ||
29 | * | ||
30 | * | ||
31 | */ | ||
32 | |||
33 | #include <linux/module.h> | ||
34 | #include <linux/moduleparam.h> | ||
35 | #include <linux/init.h> | ||
36 | #include <linux/config.h> | ||
37 | #include <linux/cpufreq.h> | ||
38 | #include <linux/ioport.h> | ||
39 | #include <linux/kernel.h> | ||
40 | #include <linux/timer.h> | ||
41 | #include <linux/mm.h> | ||
42 | #include <linux/notifier.h> | ||
43 | #include <linux/interrupt.h> | ||
44 | #include <linux/spinlock.h> | ||
45 | #include <linux/device.h> | ||
46 | |||
47 | #include <asm/io.h> | ||
48 | #include <asm/irq.h> | ||
49 | #include <asm/system.h> | ||
50 | |||
51 | #include <asm/mach-au1x00/au1000.h> | ||
52 | #include "au1000_generic.h" | ||
53 | |||
54 | MODULE_LICENSE("GPL"); | ||
55 | MODULE_AUTHOR("Pete Popov <ppopov@embeddedalley.com>"); | ||
56 | MODULE_DESCRIPTION("Linux PCMCIA Card Services: Au1x00 Socket Controller"); | ||
57 | |||
58 | #if 0 | ||
59 | #define debug(x,args...) printk(KERN_DEBUG "%s: " x, __func__ , ##args) | ||
60 | #else | ||
61 | #define debug(x,args...) | ||
62 | #endif | ||
63 | |||
64 | #define MAP_SIZE 0x100000 | ||
65 | extern struct au1000_pcmcia_socket au1000_pcmcia_socket[]; | ||
66 | #define PCMCIA_SOCKET(x) (au1000_pcmcia_socket + (x)) | ||
67 | #define to_au1000_socket(x) container_of(x, struct au1000_pcmcia_socket, socket) | ||
68 | |||
69 | /* Some boards like to support CF cards as IDE root devices, so they | ||
70 | * grab pcmcia sockets directly. | ||
71 | */ | ||
72 | u32 *pcmcia_base_vaddrs[2]; | ||
73 | extern const unsigned long mips_io_port_base; | ||
74 | |||
75 | DECLARE_MUTEX(pcmcia_sockets_lock); | ||
76 | |||
77 | static int (*au1x00_pcmcia_hw_init[])(struct device *dev) = { | ||
78 | au1x_board_init, | ||
79 | }; | ||
80 | |||
81 | static int | ||
82 | au1x00_pcmcia_skt_state(struct au1000_pcmcia_socket *skt) | ||
83 | { | ||
84 | struct pcmcia_state state; | ||
85 | unsigned int stat; | ||
86 | |||
87 | memset(&state, 0, sizeof(struct pcmcia_state)); | ||
88 | |||
89 | skt->ops->socket_state(skt, &state); | ||
90 | |||
91 | stat = state.detect ? SS_DETECT : 0; | ||
92 | stat |= state.ready ? SS_READY : 0; | ||
93 | stat |= state.wrprot ? SS_WRPROT : 0; | ||
94 | stat |= state.vs_3v ? SS_3VCARD : 0; | ||
95 | stat |= state.vs_Xv ? SS_XVCARD : 0; | ||
96 | stat |= skt->cs_state.Vcc ? SS_POWERON : 0; | ||
97 | |||
98 | if (skt->cs_state.flags & SS_IOCARD) | ||
99 | stat |= state.bvd1 ? SS_STSCHG : 0; | ||
100 | else { | ||
101 | if (state.bvd1 == 0) | ||
102 | stat |= SS_BATDEAD; | ||
103 | else if (state.bvd2 == 0) | ||
104 | stat |= SS_BATWARN; | ||
105 | } | ||
106 | return stat; | ||
107 | } | ||
108 | |||
109 | /* | ||
110 | * au100_pcmcia_config_skt | ||
111 | * | ||
112 | * Convert PCMCIA socket state to our socket configure structure. | ||
113 | */ | ||
114 | static int | ||
115 | au1x00_pcmcia_config_skt(struct au1000_pcmcia_socket *skt, socket_state_t *state) | ||
116 | { | ||
117 | int ret; | ||
118 | |||
119 | ret = skt->ops->configure_socket(skt, state); | ||
120 | if (ret == 0) { | ||
121 | skt->cs_state = *state; | ||
122 | } | ||
123 | |||
124 | if (ret < 0) | ||
125 | debug("unable to configure socket %d\n", skt->nr); | ||
126 | |||
127 | return ret; | ||
128 | } | ||
129 | |||
130 | /* au1x00_pcmcia_sock_init() | ||
131 | * | ||
132 | * (Re-)Initialise the socket, turning on status interrupts | ||
133 | * and PCMCIA bus. This must wait for power to stabilise | ||
134 | * so that the card status signals report correctly. | ||
135 | * | ||
136 | * Returns: 0 | ||
137 | */ | ||
138 | static int au1x00_pcmcia_sock_init(struct pcmcia_socket *sock) | ||
139 | { | ||
140 | struct au1000_pcmcia_socket *skt = to_au1000_socket(sock); | ||
141 | |||
142 | debug("initializing socket %u\n", skt->nr); | ||
143 | |||
144 | skt->ops->socket_init(skt); | ||
145 | return 0; | ||
146 | } | ||
147 | |||
148 | /* | ||
149 | * au1x00_pcmcia_suspend() | ||
150 | * | ||
151 | * Remove power on the socket, disable IRQs from the card. | ||
152 | * Turn off status interrupts, and disable the PCMCIA bus. | ||
153 | * | ||
154 | * Returns: 0 | ||
155 | */ | ||
156 | static int au1x00_pcmcia_suspend(struct pcmcia_socket *sock) | ||
157 | { | ||
158 | struct au1000_pcmcia_socket *skt = to_au1000_socket(sock); | ||
159 | |||
160 | debug("suspending socket %u\n", skt->nr); | ||
161 | |||
162 | skt->ops->socket_suspend(skt); | ||
163 | |||
164 | return 0; | ||
165 | } | ||
166 | |||
167 | static DEFINE_SPINLOCK(status_lock); | ||
168 | |||
169 | /* | ||
170 | * au1x00_check_status() | ||
171 | */ | ||
172 | static void au1x00_check_status(struct au1000_pcmcia_socket *skt) | ||
173 | { | ||
174 | unsigned int events; | ||
175 | |||
176 | debug("entering PCMCIA monitoring thread\n"); | ||
177 | |||
178 | do { | ||
179 | unsigned int status; | ||
180 | unsigned long flags; | ||
181 | |||
182 | status = au1x00_pcmcia_skt_state(skt); | ||
183 | |||
184 | spin_lock_irqsave(&status_lock, flags); | ||
185 | events = (status ^ skt->status) & skt->cs_state.csc_mask; | ||
186 | skt->status = status; | ||
187 | spin_unlock_irqrestore(&status_lock, flags); | ||
188 | |||
189 | debug("events: %s%s%s%s%s%s\n", | ||
190 | events == 0 ? "<NONE>" : "", | ||
191 | events & SS_DETECT ? "DETECT " : "", | ||
192 | events & SS_READY ? "READY " : "", | ||
193 | events & SS_BATDEAD ? "BATDEAD " : "", | ||
194 | events & SS_BATWARN ? "BATWARN " : "", | ||
195 | events & SS_STSCHG ? "STSCHG " : ""); | ||
196 | |||
197 | if (events) | ||
198 | pcmcia_parse_events(&skt->socket, events); | ||
199 | } while (events); | ||
200 | } | ||
201 | |||
202 | /* | ||
203 | * au1x00_pcmcia_poll_event() | ||
204 | * Let's poll for events in addition to IRQs since IRQ only is unreliable... | ||
205 | */ | ||
206 | static void au1x00_pcmcia_poll_event(unsigned long dummy) | ||
207 | { | ||
208 | struct au1000_pcmcia_socket *skt = (struct au1000_pcmcia_socket *)dummy; | ||
209 | debug("polling for events\n"); | ||
210 | |||
211 | mod_timer(&skt->poll_timer, jiffies + AU1000_PCMCIA_POLL_PERIOD); | ||
212 | |||
213 | au1x00_check_status(skt); | ||
214 | } | ||
215 | |||
216 | /* au1x00_pcmcia_get_status() | ||
217 | * | ||
218 | * From the sa11xx_core.c: | ||
219 | * Implements the get_status() operation for the in-kernel PCMCIA | ||
220 | * service (formerly SS_GetStatus in Card Services). Essentially just | ||
221 | * fills in bits in `status' according to internal driver state or | ||
222 | * the value of the voltage detect chipselect register. | ||
223 | * | ||
224 | * As a debugging note, during card startup, the PCMCIA core issues | ||
225 | * three set_socket() commands in a row the first with RESET deasserted, | ||
226 | * the second with RESET asserted, and the last with RESET deasserted | ||
227 | * again. Following the third set_socket(), a get_status() command will | ||
228 | * be issued. The kernel is looking for the SS_READY flag (see | ||
229 | * setup_socket(), reset_socket(), and unreset_socket() in cs.c). | ||
230 | * | ||
231 | * Returns: 0 | ||
232 | */ | ||
233 | static int | ||
234 | au1x00_pcmcia_get_status(struct pcmcia_socket *sock, unsigned int *status) | ||
235 | { | ||
236 | struct au1000_pcmcia_socket *skt = to_au1000_socket(sock); | ||
237 | |||
238 | skt->status = au1x00_pcmcia_skt_state(skt); | ||
239 | *status = skt->status; | ||
240 | |||
241 | return 0; | ||
242 | } | ||
243 | |||
244 | /* au1x00_pcmcia_get_socket() | ||
245 | * Implements the get_socket() operation for the in-kernel PCMCIA | ||
246 | * service (formerly SS_GetSocket in Card Services). Not a very | ||
247 | * exciting routine. | ||
248 | * | ||
249 | * Returns: 0 | ||
250 | */ | ||
251 | static int | ||
252 | au1x00_pcmcia_get_socket(struct pcmcia_socket *sock, socket_state_t *state) | ||
253 | { | ||
254 | struct au1000_pcmcia_socket *skt = to_au1000_socket(sock); | ||
255 | |||
256 | debug("for sock %u\n", skt->nr); | ||
257 | *state = skt->cs_state; | ||
258 | return 0; | ||
259 | } | ||
260 | |||
261 | /* au1x00_pcmcia_set_socket() | ||
262 | * Implements the set_socket() operation for the in-kernel PCMCIA | ||
263 | * service (formerly SS_SetSocket in Card Services). We more or | ||
264 | * less punt all of this work and let the kernel handle the details | ||
265 | * of power configuration, reset, &c. We also record the value of | ||
266 | * `state' in order to regurgitate it to the PCMCIA core later. | ||
267 | * | ||
268 | * Returns: 0 | ||
269 | */ | ||
270 | static int | ||
271 | au1x00_pcmcia_set_socket(struct pcmcia_socket *sock, socket_state_t *state) | ||
272 | { | ||
273 | struct au1000_pcmcia_socket *skt = to_au1000_socket(sock); | ||
274 | |||
275 | debug("for sock %u\n", skt->nr); | ||
276 | |||
277 | debug("\tmask: %s%s%s%s%s%s\n\tflags: %s%s%s%s%s%s\n", | ||
278 | (state->csc_mask==0)?"<NONE>":"", | ||
279 | (state->csc_mask&SS_DETECT)?"DETECT ":"", | ||
280 | (state->csc_mask&SS_READY)?"READY ":"", | ||
281 | (state->csc_mask&SS_BATDEAD)?"BATDEAD ":"", | ||
282 | (state->csc_mask&SS_BATWARN)?"BATWARN ":"", | ||
283 | (state->csc_mask&SS_STSCHG)?"STSCHG ":"", | ||
284 | (state->flags==0)?"<NONE>":"", | ||
285 | (state->flags&SS_PWR_AUTO)?"PWR_AUTO ":"", | ||
286 | (state->flags&SS_IOCARD)?"IOCARD ":"", | ||
287 | (state->flags&SS_RESET)?"RESET ":"", | ||
288 | (state->flags&SS_SPKR_ENA)?"SPKR_ENA ":"", | ||
289 | (state->flags&SS_OUTPUT_ENA)?"OUTPUT_ENA ":""); | ||
290 | debug("\tVcc %d Vpp %d irq %d\n", | ||
291 | state->Vcc, state->Vpp, state->io_irq); | ||
292 | |||
293 | return au1x00_pcmcia_config_skt(skt, state); | ||
294 | } | ||
295 | |||
296 | int | ||
297 | au1x00_pcmcia_set_io_map(struct pcmcia_socket *sock, struct pccard_io_map *map) | ||
298 | { | ||
299 | struct au1000_pcmcia_socket *skt = to_au1000_socket(sock); | ||
300 | unsigned int speed; | ||
301 | |||
302 | if(map->map>=MAX_IO_WIN){ | ||
303 | debug("map (%d) out of range\n", map->map); | ||
304 | return -1; | ||
305 | } | ||
306 | |||
307 | if(map->flags&MAP_ACTIVE){ | ||
308 | speed=(map->speed>0)?map->speed:AU1000_PCMCIA_IO_SPEED; | ||
309 | skt->spd_io[map->map] = speed; | ||
310 | } | ||
311 | |||
312 | map->start=(ioaddr_t)(u32)skt->virt_io; | ||
313 | map->stop=map->start+MAP_SIZE; | ||
314 | return 0; | ||
315 | |||
316 | } /* au1x00_pcmcia_set_io_map() */ | ||
317 | |||
318 | |||
319 | static int | ||
320 | au1x00_pcmcia_set_mem_map(struct pcmcia_socket *sock, struct pccard_mem_map *map) | ||
321 | { | ||
322 | struct au1000_pcmcia_socket *skt = to_au1000_socket(sock); | ||
323 | unsigned short speed = map->speed; | ||
324 | |||
325 | if(map->map>=MAX_WIN){ | ||
326 | debug("map (%d) out of range\n", map->map); | ||
327 | return -1; | ||
328 | } | ||
329 | |||
330 | if (map->flags & MAP_ATTRIB) { | ||
331 | skt->spd_attr[map->map] = speed; | ||
332 | skt->spd_mem[map->map] = 0; | ||
333 | } else { | ||
334 | skt->spd_attr[map->map] = 0; | ||
335 | skt->spd_mem[map->map] = speed; | ||
336 | } | ||
337 | |||
338 | if (map->flags & MAP_ATTRIB) { | ||
339 | map->static_start = skt->phys_attr + map->card_start; | ||
340 | } | ||
341 | else { | ||
342 | map->static_start = skt->phys_mem + map->card_start; | ||
343 | } | ||
344 | |||
345 | debug("set_mem_map %d start %08lx card_start %08x\n", | ||
346 | map->map, map->static_start, map->card_start); | ||
347 | return 0; | ||
348 | |||
349 | } /* au1x00_pcmcia_set_mem_map() */ | ||
350 | |||
351 | static struct pccard_operations au1x00_pcmcia_operations = { | ||
352 | .init = au1x00_pcmcia_sock_init, | ||
353 | .suspend = au1x00_pcmcia_suspend, | ||
354 | .get_status = au1x00_pcmcia_get_status, | ||
355 | .get_socket = au1x00_pcmcia_get_socket, | ||
356 | .set_socket = au1x00_pcmcia_set_socket, | ||
357 | .set_io_map = au1x00_pcmcia_set_io_map, | ||
358 | .set_mem_map = au1x00_pcmcia_set_mem_map, | ||
359 | }; | ||
360 | |||
361 | static const char *skt_names[] = { | ||
362 | "PCMCIA socket 0", | ||
363 | "PCMCIA socket 1", | ||
364 | }; | ||
365 | |||
366 | struct skt_dev_info { | ||
367 | int nskt; | ||
368 | }; | ||
369 | |||
370 | int au1x00_pcmcia_socket_probe(struct device *dev, struct pcmcia_low_level *ops, int first, int nr) | ||
371 | { | ||
372 | struct skt_dev_info *sinfo; | ||
373 | int ret, i; | ||
374 | |||
375 | sinfo = kmalloc(sizeof(struct skt_dev_info), GFP_KERNEL); | ||
376 | if (!sinfo) { | ||
377 | ret = -ENOMEM; | ||
378 | goto out; | ||
379 | } | ||
380 | |||
381 | memset(sinfo, 0, sizeof(struct skt_dev_info)); | ||
382 | sinfo->nskt = nr; | ||
383 | |||
384 | /* | ||
385 | * Initialise the per-socket structure. | ||
386 | */ | ||
387 | for (i = 0; i < nr; i++) { | ||
388 | struct au1000_pcmcia_socket *skt = PCMCIA_SOCKET(i); | ||
389 | memset(skt, 0, sizeof(*skt)); | ||
390 | |||
391 | skt->socket.ops = &au1x00_pcmcia_operations; | ||
392 | skt->socket.owner = ops->owner; | ||
393 | skt->socket.dev.dev = dev; | ||
394 | |||
395 | init_timer(&skt->poll_timer); | ||
396 | skt->poll_timer.function = au1x00_pcmcia_poll_event; | ||
397 | skt->poll_timer.data = (unsigned long)skt; | ||
398 | skt->poll_timer.expires = jiffies + AU1000_PCMCIA_POLL_PERIOD; | ||
399 | |||
400 | skt->nr = first + i; | ||
401 | skt->irq = 255; | ||
402 | skt->dev = dev; | ||
403 | skt->ops = ops; | ||
404 | |||
405 | skt->res_skt.name = skt_names[skt->nr]; | ||
406 | skt->res_io.name = "io"; | ||
407 | skt->res_io.flags = IORESOURCE_MEM | IORESOURCE_BUSY; | ||
408 | skt->res_mem.name = "memory"; | ||
409 | skt->res_mem.flags = IORESOURCE_MEM; | ||
410 | skt->res_attr.name = "attribute"; | ||
411 | skt->res_attr.flags = IORESOURCE_MEM; | ||
412 | |||
413 | /* | ||
414 | * PCMCIA client drivers use the inb/outb macros to access the | ||
415 | * IO registers. Since mips_io_port_base is added to the | ||
416 | * access address of the mips implementation of inb/outb, | ||
417 | * we need to subtract it here because we want to access the | ||
418 | * I/O or MEM address directly, without going through this | ||
419 | * "mips_io_port_base" mechanism. | ||
420 | */ | ||
421 | if (i == 0) { | ||
422 | skt->virt_io = (void *) | ||
423 | (ioremap((phys_t)AU1X_SOCK0_IO, 0x1000) - | ||
424 | (u32)mips_io_port_base); | ||
425 | skt->phys_attr = AU1X_SOCK0_PSEUDO_PHYS_ATTR; | ||
426 | skt->phys_mem = AU1X_SOCK0_PSEUDO_PHYS_MEM; | ||
427 | } | ||
428 | #ifndef CONFIG_MIPS_XXS1500 | ||
429 | else { | ||
430 | skt->virt_io = (void *) | ||
431 | (ioremap((phys_t)AU1X_SOCK1_IO, 0x1000) - | ||
432 | (u32)mips_io_port_base); | ||
433 | skt->phys_attr = AU1X_SOCK1_PSEUDO_PHYS_ATTR; | ||
434 | skt->phys_mem = AU1X_SOCK1_PSEUDO_PHYS_MEM; | ||
435 | } | ||
436 | #endif | ||
437 | pcmcia_base_vaddrs[i] = (u32 *)skt->virt_io; | ||
438 | ret = ops->hw_init(skt); | ||
439 | |||
440 | skt->socket.features = SS_CAP_STATIC_MAP|SS_CAP_PCCARD; | ||
441 | skt->socket.irq_mask = 0; | ||
442 | skt->socket.map_size = MAP_SIZE; | ||
443 | skt->socket.pci_irq = skt->irq; | ||
444 | skt->socket.io_offset = (unsigned long)skt->virt_io; | ||
445 | |||
446 | skt->status = au1x00_pcmcia_skt_state(skt); | ||
447 | |||
448 | ret = pcmcia_register_socket(&skt->socket); | ||
449 | if (ret) | ||
450 | goto out_err; | ||
451 | |||
452 | WARN_ON(skt->socket.sock != i); | ||
453 | |||
454 | add_timer(&skt->poll_timer); | ||
455 | } | ||
456 | |||
457 | dev_set_drvdata(dev, sinfo); | ||
458 | return 0; | ||
459 | |||
460 | do { | ||
461 | struct au1000_pcmcia_socket *skt = PCMCIA_SOCKET(i); | ||
462 | |||
463 | del_timer_sync(&skt->poll_timer); | ||
464 | pcmcia_unregister_socket(&skt->socket); | ||
465 | out_err: | ||
466 | flush_scheduled_work(); | ||
467 | ops->hw_shutdown(skt); | ||
468 | |||
469 | i--; | ||
470 | } while (i > 0); | ||
471 | kfree(sinfo); | ||
472 | out: | ||
473 | return ret; | ||
474 | } | ||
475 | |||
476 | int au1x00_drv_pcmcia_remove(struct device *dev) | ||
477 | { | ||
478 | struct skt_dev_info *sinfo = dev_get_drvdata(dev); | ||
479 | int i; | ||
480 | |||
481 | down(&pcmcia_sockets_lock); | ||
482 | dev_set_drvdata(dev, NULL); | ||
483 | |||
484 | for (i = 0; i < sinfo->nskt; i++) { | ||
485 | struct au1000_pcmcia_socket *skt = PCMCIA_SOCKET(i); | ||
486 | |||
487 | del_timer_sync(&skt->poll_timer); | ||
488 | pcmcia_unregister_socket(&skt->socket); | ||
489 | flush_scheduled_work(); | ||
490 | skt->ops->hw_shutdown(skt); | ||
491 | au1x00_pcmcia_config_skt(skt, &dead_socket); | ||
492 | iounmap(skt->virt_io); | ||
493 | skt->virt_io = NULL; | ||
494 | } | ||
495 | |||
496 | kfree(sinfo); | ||
497 | up(&pcmcia_sockets_lock); | ||
498 | return 0; | ||
499 | } | ||
500 | |||
501 | |||
502 | /* | ||
503 | * PCMCIA "Driver" API | ||
504 | */ | ||
505 | |||
506 | static int au1x00_drv_pcmcia_probe(struct device *dev) | ||
507 | { | ||
508 | int i, ret = -ENODEV; | ||
509 | |||
510 | down(&pcmcia_sockets_lock); | ||
511 | for (i=0; i < ARRAY_SIZE(au1x00_pcmcia_hw_init); i++) { | ||
512 | ret = au1x00_pcmcia_hw_init[i](dev); | ||
513 | if (ret == 0) | ||
514 | break; | ||
515 | } | ||
516 | up(&pcmcia_sockets_lock); | ||
517 | return ret; | ||
518 | } | ||
519 | |||
520 | |||
521 | static int au1x00_drv_pcmcia_suspend(struct device *dev, u32 state, u32 level) | ||
522 | { | ||
523 | int ret = 0; | ||
524 | if (level == SUSPEND_SAVE_STATE) | ||
525 | ret = pcmcia_socket_dev_suspend(dev, state); | ||
526 | return ret; | ||
527 | } | ||
528 | |||
529 | static int au1x00_drv_pcmcia_resume(struct device *dev, u32 level) | ||
530 | { | ||
531 | int ret = 0; | ||
532 | if (level == RESUME_RESTORE_STATE) | ||
533 | ret = pcmcia_socket_dev_resume(dev); | ||
534 | return ret; | ||
535 | } | ||
536 | |||
537 | |||
538 | static struct device_driver au1x00_pcmcia_driver = { | ||
539 | .probe = au1x00_drv_pcmcia_probe, | ||
540 | .remove = au1x00_drv_pcmcia_remove, | ||
541 | .name = "au1x00-pcmcia", | ||
542 | .bus = &platform_bus_type, | ||
543 | .suspend = au1x00_drv_pcmcia_suspend, | ||
544 | .resume = au1x00_drv_pcmcia_resume | ||
545 | }; | ||
546 | |||
547 | static struct platform_device au1x00_device = { | ||
548 | .name = "au1x00-pcmcia", | ||
549 | .id = 0, | ||
550 | }; | ||
551 | |||
552 | /* au1x00_pcmcia_init() | ||
553 | * | ||
554 | * This routine performs low-level PCMCIA initialization and then | ||
555 | * registers this socket driver with Card Services. | ||
556 | * | ||
557 | * Returns: 0 on success, -ve error code on failure | ||
558 | */ | ||
559 | static int __init au1x00_pcmcia_init(void) | ||
560 | { | ||
561 | int error = 0; | ||
562 | if ((error = driver_register(&au1x00_pcmcia_driver))) | ||
563 | return error; | ||
564 | platform_device_register(&au1x00_device); | ||
565 | return error; | ||
566 | } | ||
567 | |||
568 | /* au1x00_pcmcia_exit() | ||
569 | * Invokes the low-level kernel service to free IRQs associated with this | ||
570 | * socket controller and reset GPIO edge detection. | ||
571 | */ | ||
572 | static void __exit au1x00_pcmcia_exit(void) | ||
573 | { | ||
574 | driver_unregister(&au1x00_pcmcia_driver); | ||
575 | platform_device_unregister(&au1x00_device); | ||
576 | } | ||
577 | |||
578 | module_init(au1x00_pcmcia_init); | ||
579 | module_exit(au1x00_pcmcia_exit); | ||