blob: b42e129b7673d94be0656b8fa7ab701c5bd36c54 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*======================================================================
2
3 Common support code for the PCMCIA control functionality of
4 integrated SOCs like the SA-11x0 and PXA2xx microprocessors.
5
6 The contents of this file are subject to the Mozilla Public
7 License Version 1.1 (the "License"); you may not use this file
8 except in compliance with the License. You may obtain a copy of
9 the License at http://www.mozilla.org/MPL/
10
11 Software distributed under the License is distributed on an "AS
12 IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
13 implied. See the License for the specific language governing
14 rights and limitations under the License.
15
16 The initial developer of the original code is John G. Dorsey
17 <john+@cs.cmu.edu>. Portions created by John G. Dorsey are
18 Copyright (C) 1999 John G. Dorsey. All Rights Reserved.
19
20 Alternatively, the contents of this file may be used under the
21 terms of the GNU Public License version 2 (the "GPL"), in which
22 case the provisions of the GPL are applicable instead of the
23 above. If you wish to allow the use of your version of this file
24 only under the terms of the GPL and not to allow others to use
25 your version of this file under the MPL, indicate your decision
26 by deleting the provisions above and replace them with the notice
27 and other provisions required by the GPL. If you do not delete
28 the provisions above, a recipient may use your version of this
29 file under either the MPL or the GPL.
30
31======================================================================*/
32
33
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +010034#include <linux/cpufreq.h>
35#include <linux/init.h>
36#include <linux/interrupt.h>
37#include <linux/io.h>
38#include <linux/irq.h>
39#include <linux/kernel.h>
40#include <linux/mm.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070041#include <linux/module.h>
42#include <linux/moduleparam.h>
Andrew Morton23d077e2008-05-01 04:34:54 -070043#include <linux/mutex.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070044#include <linux/spinlock.h>
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +010045#include <linux/timer.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070046
Russell Kinga09e64f2008-08-05 16:14:15 +010047#include <mach/hardware.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070048#include <asm/system.h>
49
50#include "soc_common.h"
51
Dominik Brodowski7d16b652008-08-02 21:02:01 +020052#ifdef CONFIG_PCMCIA_DEBUG
Linus Torvalds1da177e2005-04-16 15:20:36 -070053
54static int pc_debug;
55module_param(pc_debug, int, 0644);
56
57void soc_pcmcia_debug(struct soc_pcmcia_socket *skt, const char *func,
58 int lvl, const char *fmt, ...)
59{
60 va_list args;
61 if (pc_debug > lvl) {
62 printk(KERN_DEBUG "skt%u: %s: ", skt->nr, func);
63 va_start(args, fmt);
Pavel Machek4846d012005-10-14 15:59:02 -070064 vprintk(fmt, args);
Linus Torvalds1da177e2005-04-16 15:20:36 -070065 va_end(args);
66 }
67}
68
69#endif
70
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +010071#define to_soc_pcmcia_socket(x) \
72 container_of(x, struct soc_pcmcia_socket, socket)
Linus Torvalds1da177e2005-04-16 15:20:36 -070073
74static unsigned short
75calc_speed(unsigned short *spds, int num, unsigned short dflt)
76{
77 unsigned short speed = 0;
78 int i;
79
80 for (i = 0; i < num; i++)
81 if (speed < spds[i])
82 speed = spds[i];
83 if (speed == 0)
84 speed = dflt;
85
86 return speed;
87}
88
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +010089void soc_common_pcmcia_get_timing(struct soc_pcmcia_socket *skt,
90 struct soc_pcmcia_timing *timing)
Linus Torvalds1da177e2005-04-16 15:20:36 -070091{
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +010092 timing->io =
93 calc_speed(skt->spd_io, MAX_IO_WIN, SOC_PCMCIA_IO_ACCESS);
94 timing->mem =
95 calc_speed(skt->spd_mem, MAX_WIN, SOC_PCMCIA_3V_MEM_ACCESS);
96 timing->attr =
97 calc_speed(skt->spd_attr, MAX_WIN, SOC_PCMCIA_3V_MEM_ACCESS);
Linus Torvalds1da177e2005-04-16 15:20:36 -070098}
99EXPORT_SYMBOL(soc_common_pcmcia_get_timing);
100
101static unsigned int soc_common_pcmcia_skt_state(struct soc_pcmcia_socket *skt)
102{
103 struct pcmcia_state state;
104 unsigned int stat;
105
106 memset(&state, 0, sizeof(struct pcmcia_state));
107
108 skt->ops->socket_state(skt, &state);
109
110 stat = state.detect ? SS_DETECT : 0;
111 stat |= state.ready ? SS_READY : 0;
112 stat |= state.wrprot ? SS_WRPROT : 0;
113 stat |= state.vs_3v ? SS_3VCARD : 0;
114 stat |= state.vs_Xv ? SS_XVCARD : 0;
115
116 /* The power status of individual sockets is not available
117 * explicitly from the hardware, so we just remember the state
118 * and regurgitate it upon request:
119 */
120 stat |= skt->cs_state.Vcc ? SS_POWERON : 0;
121
122 if (skt->cs_state.flags & SS_IOCARD)
123 stat |= state.bvd1 ? SS_STSCHG : 0;
124 else {
125 if (state.bvd1 == 0)
126 stat |= SS_BATDEAD;
127 else if (state.bvd2 == 0)
128 stat |= SS_BATWARN;
129 }
130 return stat;
131}
132
133/*
134 * soc_common_pcmcia_config_skt
135 * ^^^^^^^^^^^^^^^^^^^^^^^^^^^^
136 *
137 * Convert PCMCIA socket state to our socket configure structure.
138 */
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100139static int soc_common_pcmcia_config_skt(
140 struct soc_pcmcia_socket *skt, socket_state_t *state)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700141{
142 int ret;
143
144 ret = skt->ops->configure_socket(skt, state);
145 if (ret == 0) {
146 /*
147 * This really needs a better solution. The IRQ
148 * may or may not be claimed by the driver.
149 */
150 if (skt->irq_state != 1 && state->io_irq) {
151 skt->irq_state = 1;
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100152 set_irq_type(skt->socket.pci_irq,
153 IRQ_TYPE_EDGE_FALLING);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700154 } else if (skt->irq_state == 1 && state->io_irq == 0) {
155 skt->irq_state = 0;
Russell King - ARM Linux66024db2009-03-29 22:45:26 +0100156 set_irq_type(skt->socket.pci_irq, IRQ_TYPE_NONE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157 }
158
159 skt->cs_state = *state;
160 }
161
162 if (ret < 0)
163 printk(KERN_ERR "soc_common_pcmcia: unable to configure "
164 "socket %d\n", skt->nr);
165
166 return ret;
167}
168
169/* soc_common_pcmcia_sock_init()
170 * ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
171 *
172 * (Re-)Initialise the socket, turning on status interrupts
173 * and PCMCIA bus. This must wait for power to stabilise
174 * so that the card status signals report correctly.
175 *
176 * Returns: 0
177 */
178static int soc_common_pcmcia_sock_init(struct pcmcia_socket *sock)
179{
180 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
181
182 debug(skt, 2, "initializing socket\n");
183
184 skt->ops->socket_init(skt);
185 return 0;
186}
187
188
189/*
190 * soc_common_pcmcia_suspend()
191 * ^^^^^^^^^^^^^^^^^^^^^^^^^^^
192 *
193 * Remove power on the socket, disable IRQs from the card.
194 * Turn off status interrupts, and disable the PCMCIA bus.
195 *
196 * Returns: 0
197 */
198static int soc_common_pcmcia_suspend(struct pcmcia_socket *sock)
199{
200 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
201
202 debug(skt, 2, "suspending socket\n");
203
204 skt->ops->socket_suspend(skt);
205
206 return 0;
207}
208
209static DEFINE_SPINLOCK(status_lock);
210
211static void soc_common_check_status(struct soc_pcmcia_socket *skt)
212{
213 unsigned int events;
214
215 debug(skt, 4, "entering PCMCIA monitoring thread\n");
216
217 do {
218 unsigned int status;
219 unsigned long flags;
220
221 status = soc_common_pcmcia_skt_state(skt);
222
223 spin_lock_irqsave(&status_lock, flags);
224 events = (status ^ skt->status) & skt->cs_state.csc_mask;
225 skt->status = status;
226 spin_unlock_irqrestore(&status_lock, flags);
227
228 debug(skt, 4, "events: %s%s%s%s%s%s\n",
229 events == 0 ? "<NONE>" : "",
230 events & SS_DETECT ? "DETECT " : "",
231 events & SS_READY ? "READY " : "",
232 events & SS_BATDEAD ? "BATDEAD " : "",
233 events & SS_BATWARN ? "BATWARN " : "",
234 events & SS_STSCHG ? "STSCHG " : "");
235
236 if (events)
237 pcmcia_parse_events(&skt->socket, events);
238 } while (events);
239}
240
241/* Let's poll for events in addition to IRQs since IRQ only is unreliable... */
242static void soc_common_pcmcia_poll_event(unsigned long dummy)
243{
244 struct soc_pcmcia_socket *skt = (struct soc_pcmcia_socket *)dummy;
245 debug(skt, 4, "polling for events\n");
246
247 mod_timer(&skt->poll_timer, jiffies + SOC_PCMCIA_POLL_PERIOD);
248
249 soc_common_check_status(skt);
250}
251
252
253/*
254 * Service routine for socket driver interrupts (requested by the
255 * low-level PCMCIA init() operation via soc_common_pcmcia_thread()).
256 * The actual interrupt-servicing work is performed by
257 * soc_common_pcmcia_thread(), largely because the Card Services event-
258 * handling code performs scheduling operations which cannot be
259 * executed from within an interrupt context.
260 */
David Howells7d12e782006-10-05 14:55:46 +0100261static irqreturn_t soc_common_pcmcia_interrupt(int irq, void *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262{
263 struct soc_pcmcia_socket *skt = dev;
264
265 debug(skt, 3, "servicing IRQ %d\n", irq);
266
267 soc_common_check_status(skt);
268
269 return IRQ_HANDLED;
270}
271
272
273/*
274 * Implements the get_status() operation for the in-kernel PCMCIA
275 * service (formerly SS_GetStatus in Card Services). Essentially just
276 * fills in bits in `status' according to internal driver state or
277 * the value of the voltage detect chipselect register.
278 *
279 * As a debugging note, during card startup, the PCMCIA core issues
280 * three set_socket() commands in a row the first with RESET deasserted,
281 * the second with RESET asserted, and the last with RESET deasserted
282 * again. Following the third set_socket(), a get_status() command will
283 * be issued. The kernel is looking for the SS_READY flag (see
284 * setup_socket(), reset_socket(), and unreset_socket() in cs.c).
285 *
286 * Returns: 0
287 */
288static int
289soc_common_pcmcia_get_status(struct pcmcia_socket *sock, unsigned int *status)
290{
291 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
292
293 skt->status = soc_common_pcmcia_skt_state(skt);
294 *status = skt->status;
295
296 return 0;
297}
298
299
300/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301 * Implements the set_socket() operation for the in-kernel PCMCIA
302 * service (formerly SS_SetSocket in Card Services). We more or
303 * less punt all of this work and let the kernel handle the details
304 * of power configuration, reset, &c. We also record the value of
305 * `state' in order to regurgitate it to the PCMCIA core later.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306 */
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100307static int soc_common_pcmcia_set_socket(
308 struct pcmcia_socket *sock, socket_state_t *state)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309{
310 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
311
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100312 debug(skt, 2, "mask: %s%s%s%s%s%s flags: %s%s%s%s%s%s Vcc %d Vpp %d irq %d\n",
313 (state->csc_mask == 0) ? "<NONE> " : "",
314 (state->csc_mask & SS_DETECT) ? "DETECT " : "",
315 (state->csc_mask & SS_READY) ? "READY " : "",
316 (state->csc_mask & SS_BATDEAD) ? "BATDEAD " : "",
317 (state->csc_mask & SS_BATWARN) ? "BATWARN " : "",
318 (state->csc_mask & SS_STSCHG) ? "STSCHG " : "",
319 (state->flags == 0) ? "<NONE> " : "",
320 (state->flags & SS_PWR_AUTO) ? "PWR_AUTO " : "",
321 (state->flags & SS_IOCARD) ? "IOCARD " : "",
322 (state->flags & SS_RESET) ? "RESET " : "",
323 (state->flags & SS_SPKR_ENA) ? "SPKR_ENA " : "",
324 (state->flags & SS_OUTPUT_ENA) ? "OUTPUT_ENA " : "",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700325 state->Vcc, state->Vpp, state->io_irq);
326
327 return soc_common_pcmcia_config_skt(skt, state);
328}
329
330
331/*
332 * Implements the set_io_map() operation for the in-kernel PCMCIA
333 * service (formerly SS_SetIOMap in Card Services). We configure
334 * the map speed as requested, but override the address ranges
335 * supplied by Card Services.
336 *
337 * Returns: 0 on success, -1 on error
338 */
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100339static int soc_common_pcmcia_set_io_map(
340 struct pcmcia_socket *sock, struct pccard_io_map *map)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700341{
342 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
343 unsigned short speed = map->speed;
344
Wolfram Sang5f784332009-10-19 11:42:13 +0200345 debug(skt, 2, "map %u speed %u start 0x%08llx stop 0x%08llx\n",
346 map->map, map->speed, (unsigned long long)map->start,
347 (unsigned long long)map->stop);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348 debug(skt, 2, "flags: %s%s%s%s%s%s%s%s\n",
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100349 (map->flags == 0) ? "<NONE>" : "",
350 (map->flags & MAP_ACTIVE) ? "ACTIVE " : "",
351 (map->flags & MAP_16BIT) ? "16BIT " : "",
352 (map->flags & MAP_AUTOSZ) ? "AUTOSZ " : "",
353 (map->flags & MAP_0WS) ? "0WS " : "",
354 (map->flags & MAP_WRPROT) ? "WRPROT " : "",
355 (map->flags & MAP_USE_WAIT) ? "USE_WAIT " : "",
356 (map->flags & MAP_PREFETCH) ? "PREFETCH " : "");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357
358 if (map->map >= MAX_IO_WIN) {
Harvey Harrison2e11cb42008-05-01 04:34:54 -0700359 printk(KERN_ERR "%s(): map (%d) out of range\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360 map->map);
361 return -1;
362 }
363
364 if (map->flags & MAP_ACTIVE) {
365 if (speed == 0)
366 speed = SOC_PCMCIA_IO_ACCESS;
367 } else {
368 speed = 0;
369 }
370
371 skt->spd_io[map->map] = speed;
372 skt->ops->set_timing(skt);
373
374 if (map->stop == 1)
375 map->stop = PAGE_SIZE-1;
376
377 map->stop -= map->start;
378 map->stop += skt->socket.io_offset;
379 map->start = skt->socket.io_offset;
380
381 return 0;
382}
383
384
385/*
386 * Implements the set_mem_map() operation for the in-kernel PCMCIA
387 * service (formerly SS_SetMemMap in Card Services). We configure
388 * the map speed as requested, but override the address ranges
389 * supplied by Card Services.
390 *
Pavel Machek4846d012005-10-14 15:59:02 -0700391 * Returns: 0 on success, -ERRNO on error
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392 */
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100393static int soc_common_pcmcia_set_mem_map(
394 struct pcmcia_socket *sock, struct pccard_mem_map *map)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395{
396 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
397 struct resource *res;
398 unsigned short speed = map->speed;
399
400 debug(skt, 2, "map %u speed %u card_start %08x\n",
401 map->map, map->speed, map->card_start);
402 debug(skt, 2, "flags: %s%s%s%s%s%s%s%s\n",
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100403 (map->flags == 0) ? "<NONE>" : "",
404 (map->flags & MAP_ACTIVE) ? "ACTIVE " : "",
405 (map->flags & MAP_16BIT) ? "16BIT " : "",
406 (map->flags & MAP_AUTOSZ) ? "AUTOSZ " : "",
407 (map->flags & MAP_0WS) ? "0WS " : "",
408 (map->flags & MAP_WRPROT) ? "WRPROT " : "",
409 (map->flags & MAP_ATTRIB) ? "ATTRIB " : "",
410 (map->flags & MAP_USE_WAIT) ? "USE_WAIT " : "");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411
412 if (map->map >= MAX_WIN)
413 return -EINVAL;
414
415 if (map->flags & MAP_ACTIVE) {
416 if (speed == 0)
417 speed = 300;
418 } else {
419 speed = 0;
420 }
421
422 if (map->flags & MAP_ATTRIB) {
423 res = &skt->res_attr;
424 skt->spd_attr[map->map] = speed;
425 skt->spd_mem[map->map] = 0;
426 } else {
427 res = &skt->res_mem;
428 skt->spd_attr[map->map] = 0;
429 skt->spd_mem[map->map] = speed;
430 }
431
432 skt->ops->set_timing(skt);
433
434 map->static_start = res->start + map->card_start;
435
436 return 0;
437}
438
439struct bittbl {
440 unsigned int mask;
441 const char *name;
442};
443
444static struct bittbl status_bits[] = {
445 { SS_WRPROT, "SS_WRPROT" },
446 { SS_BATDEAD, "SS_BATDEAD" },
447 { SS_BATWARN, "SS_BATWARN" },
448 { SS_READY, "SS_READY" },
449 { SS_DETECT, "SS_DETECT" },
450 { SS_POWERON, "SS_POWERON" },
451 { SS_STSCHG, "SS_STSCHG" },
452 { SS_3VCARD, "SS_3VCARD" },
453 { SS_XVCARD, "SS_XVCARD" },
454};
455
456static struct bittbl conf_bits[] = {
457 { SS_PWR_AUTO, "SS_PWR_AUTO" },
458 { SS_IOCARD, "SS_IOCARD" },
459 { SS_RESET, "SS_RESET" },
460 { SS_DMA_MODE, "SS_DMA_MODE" },
461 { SS_SPKR_ENA, "SS_SPKR_ENA" },
462 { SS_OUTPUT_ENA, "SS_OUTPUT_ENA" },
463};
464
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100465static void dump_bits(char **p, const char *prefix,
466 unsigned int val, struct bittbl *bits, int sz)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700467{
468 char *b = *p;
469 int i;
470
471 b += sprintf(b, "%-9s:", prefix);
472 for (i = 0; i < sz; i++)
473 if (val & bits[i].mask)
474 b += sprintf(b, " %s", bits[i].name);
475 *b++ = '\n';
476 *p = b;
477}
478
479/*
480 * Implements the /sys/class/pcmcia_socket/??/status file.
481 *
482 * Returns: the number of characters added to the buffer
483 */
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100484static ssize_t show_status(
485 struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700486{
487 struct soc_pcmcia_socket *skt =
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200488 container_of(dev, struct soc_pcmcia_socket, socket.dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700489 char *p = buf;
490
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100491 p += sprintf(p, "slot : %d\n", skt->nr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700492
493 dump_bits(&p, "status", skt->status,
494 status_bits, ARRAY_SIZE(status_bits));
495 dump_bits(&p, "csc_mask", skt->cs_state.csc_mask,
496 status_bits, ARRAY_SIZE(status_bits));
497 dump_bits(&p, "cs_flags", skt->cs_state.flags,
498 conf_bits, ARRAY_SIZE(conf_bits));
499
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100500 p += sprintf(p, "Vcc : %d\n", skt->cs_state.Vcc);
501 p += sprintf(p, "Vpp : %d\n", skt->cs_state.Vpp);
502 p += sprintf(p, "IRQ : %d (%d)\n", skt->cs_state.io_irq,
Russell King - ARM Linux66024db2009-03-29 22:45:26 +0100503 skt->socket.pci_irq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504 if (skt->ops->show_timing)
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100505 p += skt->ops->show_timing(skt, p);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700506
507 return p-buf;
508}
Alexey Dobriyane4a3c3f2007-02-13 22:39:27 -0800509static DEVICE_ATTR(status, S_IRUGO, show_status, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700510
511
512static struct pccard_operations soc_common_pcmcia_operations = {
513 .init = soc_common_pcmcia_sock_init,
514 .suspend = soc_common_pcmcia_suspend,
515 .get_status = soc_common_pcmcia_get_status,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516 .set_socket = soc_common_pcmcia_set_socket,
517 .set_io_map = soc_common_pcmcia_set_io_map,
518 .set_mem_map = soc_common_pcmcia_set_mem_map,
519};
520
521
522int soc_pcmcia_request_irqs(struct soc_pcmcia_socket *skt,
523 struct pcmcia_irqs *irqs, int nr)
524{
525 int i, res = 0;
526
527 for (i = 0; i < nr; i++) {
528 if (irqs[i].sock != skt->nr)
529 continue;
530 res = request_irq(irqs[i].irq, soc_common_pcmcia_interrupt,
Thomas Gleixnerdace1452006-07-01 19:29:38 -0700531 IRQF_DISABLED, irqs[i].str, skt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 if (res)
533 break;
Dmitry Baryshkov6cab4862008-07-27 04:23:31 +0100534 set_irq_type(irqs[i].irq, IRQ_TYPE_NONE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535 }
536
537 if (res) {
538 printk(KERN_ERR "PCMCIA: request for IRQ%d failed (%d)\n",
539 irqs[i].irq, res);
540
541 while (i--)
542 if (irqs[i].sock == skt->nr)
543 free_irq(irqs[i].irq, skt);
544 }
545 return res;
546}
547EXPORT_SYMBOL(soc_pcmcia_request_irqs);
548
549void soc_pcmcia_free_irqs(struct soc_pcmcia_socket *skt,
550 struct pcmcia_irqs *irqs, int nr)
551{
552 int i;
553
554 for (i = 0; i < nr; i++)
555 if (irqs[i].sock == skt->nr)
556 free_irq(irqs[i].irq, skt);
557}
558EXPORT_SYMBOL(soc_pcmcia_free_irqs);
559
560void soc_pcmcia_disable_irqs(struct soc_pcmcia_socket *skt,
561 struct pcmcia_irqs *irqs, int nr)
562{
563 int i;
564
565 for (i = 0; i < nr; i++)
566 if (irqs[i].sock == skt->nr)
Dmitry Baryshkov6cab4862008-07-27 04:23:31 +0100567 set_irq_type(irqs[i].irq, IRQ_TYPE_NONE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700568}
569EXPORT_SYMBOL(soc_pcmcia_disable_irqs);
570
571void soc_pcmcia_enable_irqs(struct soc_pcmcia_socket *skt,
572 struct pcmcia_irqs *irqs, int nr)
573{
574 int i;
575
576 for (i = 0; i < nr; i++)
577 if (irqs[i].sock == skt->nr) {
Dmitry Baryshkov6cab4862008-07-27 04:23:31 +0100578 set_irq_type(irqs[i].irq, IRQ_TYPE_EDGE_RISING);
579 set_irq_type(irqs[i].irq, IRQ_TYPE_EDGE_BOTH);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700580 }
581}
582EXPORT_SYMBOL(soc_pcmcia_enable_irqs);
583
584
Russell King - ARM Linux097e2962009-03-26 21:45:05 +0000585static LIST_HEAD(soc_pcmcia_sockets);
Andrew Morton23d077e2008-05-01 04:34:54 -0700586static DEFINE_MUTEX(soc_pcmcia_sockets_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700587
Linus Torvalds1da177e2005-04-16 15:20:36 -0700588#ifdef CONFIG_CPU_FREQ
589static int
590soc_pcmcia_notifier(struct notifier_block *nb, unsigned long val, void *data)
591{
592 struct soc_pcmcia_socket *skt;
593 struct cpufreq_freqs *freqs = data;
594 int ret = 0;
595
Andrew Morton23d077e2008-05-01 04:34:54 -0700596 mutex_lock(&soc_pcmcia_sockets_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700597 list_for_each_entry(skt, &soc_pcmcia_sockets, node)
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100598 if (skt->ops->frequency_change)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700599 ret += skt->ops->frequency_change(skt, val, freqs);
Andrew Morton23d077e2008-05-01 04:34:54 -0700600 mutex_unlock(&soc_pcmcia_sockets_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700601
602 return ret;
603}
604
605static struct notifier_block soc_pcmcia_notifier_block = {
606 .notifier_call = soc_pcmcia_notifier
607};
608
609static int soc_pcmcia_cpufreq_register(void)
610{
611 int ret;
612
613 ret = cpufreq_register_notifier(&soc_pcmcia_notifier_block,
614 CPUFREQ_TRANSITION_NOTIFIER);
615 if (ret < 0)
616 printk(KERN_ERR "Unable to register CPU frequency change "
617 "notifier for PCMCIA (%d)\n", ret);
618 return ret;
619}
Russell King - ARM Linux0f767de2009-03-26 21:14:19 +0000620fs_initcall(soc_pcmcia_cpufreq_register);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621
622static void soc_pcmcia_cpufreq_unregister(void)
623{
Marcelo Roberto Jimenez17b38eb2010-10-18 22:39:05 +0100624 cpufreq_unregister_notifier(&soc_pcmcia_notifier_block,
625 CPUFREQ_TRANSITION_NOTIFIER);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626}
Russell King - ARM Linux0f767de2009-03-26 21:14:19 +0000627module_exit(soc_pcmcia_cpufreq_unregister);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629#endif
630
Russell King - ARM Linux097e2962009-03-26 21:45:05 +0000631void soc_pcmcia_remove_one(struct soc_pcmcia_socket *skt)
632{
633 mutex_lock(&soc_pcmcia_sockets_lock);
634 del_timer_sync(&skt->poll_timer);
635
636 pcmcia_unregister_socket(&skt->socket);
637
Russell King - ARM Linux097e2962009-03-26 21:45:05 +0000638 skt->ops->hw_shutdown(skt);
639
640 soc_common_pcmcia_config_skt(skt, &dead_socket);
641
642 list_del(&skt->node);
643 mutex_unlock(&soc_pcmcia_sockets_lock);
644
645 iounmap(skt->virt_io);
646 skt->virt_io = NULL;
647 release_resource(&skt->res_attr);
648 release_resource(&skt->res_mem);
649 release_resource(&skt->res_io);
650 release_resource(&skt->res_skt);
651}
652EXPORT_SYMBOL(soc_pcmcia_remove_one);
653
654int soc_pcmcia_add_one(struct soc_pcmcia_socket *skt)
655{
656 int ret;
657
658 init_timer(&skt->poll_timer);
659 skt->poll_timer.function = soc_common_pcmcia_poll_event;
660 skt->poll_timer.data = (unsigned long)skt;
661 skt->poll_timer.expires = jiffies + SOC_PCMCIA_POLL_PERIOD;
662
663 ret = request_resource(&iomem_resource, &skt->res_skt);
664 if (ret)
665 goto out_err_1;
666
667 ret = request_resource(&skt->res_skt, &skt->res_io);
668 if (ret)
669 goto out_err_2;
670
671 ret = request_resource(&skt->res_skt, &skt->res_mem);
672 if (ret)
673 goto out_err_3;
674
675 ret = request_resource(&skt->res_skt, &skt->res_attr);
676 if (ret)
677 goto out_err_4;
678
679 skt->virt_io = ioremap(skt->res_io.start, 0x10000);
680 if (skt->virt_io == NULL) {
681 ret = -ENOMEM;
682 goto out_err_5;
683 }
684
685 mutex_lock(&soc_pcmcia_sockets_lock);
686
687 list_add(&skt->node, &soc_pcmcia_sockets);
688
689 /*
690 * We initialize default socket timing here, because
691 * we are not guaranteed to see a SetIOMap operation at
692 * runtime.
693 */
694 skt->ops->set_timing(skt);
695
696 ret = skt->ops->hw_init(skt);
697 if (ret)
698 goto out_err_6;
699
700 skt->socket.ops = &soc_common_pcmcia_operations;
701 skt->socket.features = SS_CAP_STATIC_MAP|SS_CAP_PCCARD;
702 skt->socket.resource_ops = &pccard_static_ops;
703 skt->socket.irq_mask = 0;
704 skt->socket.map_size = PAGE_SIZE;
Russell King - ARM Linux097e2962009-03-26 21:45:05 +0000705 skt->socket.io_offset = (unsigned long)skt->virt_io;
706
707 skt->status = soc_common_pcmcia_skt_state(skt);
708
709 ret = pcmcia_register_socket(&skt->socket);
710 if (ret)
711 goto out_err_7;
712
713 add_timer(&skt->poll_timer);
714
715 mutex_unlock(&soc_pcmcia_sockets_lock);
716
717 ret = device_create_file(&skt->socket.dev, &dev_attr_status);
718 if (ret)
719 goto out_err_8;
720
721 return ret;
722
723 out_err_8:
724 mutex_lock(&soc_pcmcia_sockets_lock);
725 del_timer_sync(&skt->poll_timer);
726 pcmcia_unregister_socket(&skt->socket);
727
728 out_err_7:
Russell King - ARM Linux097e2962009-03-26 21:45:05 +0000729 skt->ops->hw_shutdown(skt);
730 out_err_6:
731 list_del(&skt->node);
732 mutex_unlock(&soc_pcmcia_sockets_lock);
733 iounmap(skt->virt_io);
734 out_err_5:
735 release_resource(&skt->res_attr);
736 out_err_4:
737 release_resource(&skt->res_mem);
738 out_err_3:
739 release_resource(&skt->res_io);
740 out_err_2:
741 release_resource(&skt->res_skt);
742 out_err_1:
743
744 return ret;
745}
746EXPORT_SYMBOL(soc_pcmcia_add_one);
747
Russell King - ARM Linux0f767de2009-03-26 21:14:19 +0000748MODULE_AUTHOR("John Dorsey <john+@cs.cmu.edu>");
749MODULE_DESCRIPTION("Linux PCMCIA Card Services: Common SoC support");
750MODULE_LICENSE("Dual MPL/GPL");