blob: f9424801b9c8b0979776424583e77c9400284eb6 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * cs.c -- Kernel Card Services - core services
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
15#include <linux/module.h>
16#include <linux/moduleparam.h>
17#include <linux/init.h>
18#include <linux/kernel.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070019#include <linux/string.h>
20#include <linux/major.h>
21#include <linux/errno.h>
22#include <linux/slab.h>
23#include <linux/mm.h>
24#include <linux/interrupt.h>
25#include <linux/timer.h>
26#include <linux/ioport.h>
27#include <linux/delay.h>
28#include <linux/pm.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070029#include <linux/device.h>
Serge E. Hallyn1da9ab72006-06-14 08:01:26 -050030#include <linux/kthread.h>
Nigel Cunningham7dfb7102006-12-06 20:34:23 -080031#include <linux/freezer.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070032#include <asm/system.h>
33#include <asm/irq.h>
34
Linus Torvalds1da177e2005-04-16 15:20:36 -070035#include <pcmcia/cs_types.h>
36#include <pcmcia/ss.h>
37#include <pcmcia/cs.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070038#include <pcmcia/cistpl.h>
39#include <pcmcia/cisreg.h>
40#include <pcmcia/ds.h>
41#include "cs_internal.h"
42
Linus Torvalds1da177e2005-04-16 15:20:36 -070043
44/* Module parameters */
45
46MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>");
Dominik Brodowski33519dd2005-06-27 16:28:53 -070047MODULE_DESCRIPTION("Linux Kernel Card Services");
Linus Torvalds1da177e2005-04-16 15:20:36 -070048MODULE_LICENSE("GPL");
49
50#define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0444)
51
52INT_MODULE_PARM(setup_delay, 10); /* centiseconds */
53INT_MODULE_PARM(resume_delay, 20); /* centiseconds */
54INT_MODULE_PARM(shutdown_delay, 3); /* centiseconds */
55INT_MODULE_PARM(vcc_settle, 40); /* centiseconds */
56INT_MODULE_PARM(reset_time, 10); /* usecs */
57INT_MODULE_PARM(unreset_delay, 10); /* centiseconds */
58INT_MODULE_PARM(unreset_check, 10); /* centiseconds */
59INT_MODULE_PARM(unreset_limit, 30); /* unreset_check's */
60
61/* Access speed for attribute memory windows */
62INT_MODULE_PARM(cis_speed, 300); /* ns */
63
Dominik Brodowski7d16b652008-08-02 21:02:01 +020064#ifdef CONFIG_PCMCIA_DEBUG
Linus Torvalds1da177e2005-04-16 15:20:36 -070065static int pc_debug;
66
67module_param(pc_debug, int, 0644);
68
69int cs_debug_level(int level)
70{
71 return pc_debug > level;
72}
73#endif
74
Linus Torvalds1da177e2005-04-16 15:20:36 -070075
76socket_state_t dead_socket = {
77 .csc_mask = SS_DETECT,
78};
Dominik Brodowski33519dd2005-06-27 16:28:53 -070079EXPORT_SYMBOL(dead_socket);
Linus Torvalds1da177e2005-04-16 15:20:36 -070080
81
82/* List of all sockets, protected by a rwsem */
83LIST_HEAD(pcmcia_socket_list);
Linus Torvalds1da177e2005-04-16 15:20:36 -070084EXPORT_SYMBOL(pcmcia_socket_list);
Dominik Brodowski33519dd2005-06-27 16:28:53 -070085
86DECLARE_RWSEM(pcmcia_socket_list_rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -070087EXPORT_SYMBOL(pcmcia_socket_list_rwsem);
88
89
Randy Dunlap78187862007-12-10 15:49:22 -080090/*
Dominik Brodowski33519dd2005-06-27 16:28:53 -070091 * Low-level PCMCIA socket drivers need to register with the PCCard
92 * core using pcmcia_register_socket.
93 *
94 * socket drivers are expected to use the following callbacks in their
Linus Torvalds1da177e2005-04-16 15:20:36 -070095 * .drv struct:
96 * - pcmcia_socket_dev_suspend
97 * - pcmcia_socket_dev_resume
98 * These functions check for the appropriate struct pcmcia_soket arrays,
99 * and pass them to the low-level functions pcmcia_{suspend,resume}_socket
100 */
101static int socket_resume(struct pcmcia_socket *skt);
102static int socket_suspend(struct pcmcia_socket *skt);
103
104int pcmcia_socket_dev_suspend(struct device *dev, pm_message_t state)
105{
106 struct pcmcia_socket *socket;
107
108 down_read(&pcmcia_socket_list_rwsem);
109 list_for_each_entry(socket, &pcmcia_socket_list, socket_list) {
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200110 if (socket->dev.parent != dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111 continue;
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100112 mutex_lock(&socket->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113 socket_suspend(socket);
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100114 mutex_unlock(&socket->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700115 }
116 up_read(&pcmcia_socket_list_rwsem);
117
118 return 0;
119}
120EXPORT_SYMBOL(pcmcia_socket_dev_suspend);
121
122int pcmcia_socket_dev_resume(struct device *dev)
123{
124 struct pcmcia_socket *socket;
125
126 down_read(&pcmcia_socket_list_rwsem);
127 list_for_each_entry(socket, &pcmcia_socket_list, socket_list) {
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200128 if (socket->dev.parent != dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129 continue;
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100130 mutex_lock(&socket->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131 socket_resume(socket);
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100132 mutex_unlock(&socket->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133 }
134 up_read(&pcmcia_socket_list_rwsem);
135
136 return 0;
137}
138EXPORT_SYMBOL(pcmcia_socket_dev_resume);
139
140
141struct pcmcia_socket * pcmcia_get_socket(struct pcmcia_socket *skt)
142{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200143 struct device *dev = get_device(&skt->dev);
144 if (!dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700145 return NULL;
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200146 skt = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700147 if (!try_module_get(skt->owner)) {
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200148 put_device(&skt->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149 return NULL;
150 }
151 return (skt);
152}
153EXPORT_SYMBOL(pcmcia_get_socket);
154
155
156void pcmcia_put_socket(struct pcmcia_socket *skt)
157{
158 module_put(skt->owner);
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200159 put_device(&skt->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160}
161EXPORT_SYMBOL(pcmcia_put_socket);
162
163
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200164static void pcmcia_release_socket(struct device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165{
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200166 struct pcmcia_socket *socket = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167
168 complete(&socket->socket_released);
169}
170
171static int pccardd(void *__skt);
172
173/**
174 * pcmcia_register_socket - add a new pcmcia socket device
Randy Dunlap78187862007-12-10 15:49:22 -0800175 * @socket: the &socket to register
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176 */
177int pcmcia_register_socket(struct pcmcia_socket *socket)
178{
Serge E. Hallyn1da9ab72006-06-14 08:01:26 -0500179 struct task_struct *tsk;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700180 int ret;
181
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200182 if (!socket || !socket->ops || !socket->dev.parent || !socket->resource_ops)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183 return -EINVAL;
184
185 cs_dbg(socket, 0, "pcmcia_register_socket(0x%p)\n", socket->ops);
186
187 spin_lock_init(&socket->lock);
188
189 if (socket->resource_ops->init) {
190 ret = socket->resource_ops->init(socket);
191 if (ret)
192 return (ret);
193 }
194
195 /* try to obtain a socket number [yes, it gets ugly if we
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700196 * register more than 2^sizeof(unsigned int) pcmcia
197 * sockets... but the socket number is deprecated
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 * anyways, so I don't care] */
199 down_write(&pcmcia_socket_list_rwsem);
200 if (list_empty(&pcmcia_socket_list))
201 socket->sock = 0;
202 else {
203 unsigned int found, i = 1;
204 struct pcmcia_socket *tmp;
205 do {
206 found = 1;
207 list_for_each_entry(tmp, &pcmcia_socket_list, socket_list) {
208 if (tmp->sock == i)
209 found = 0;
210 }
211 i++;
212 } while (!found);
213 socket->sock = i - 1;
214 }
215 list_add_tail(&socket->socket_list, &pcmcia_socket_list);
216 up_write(&pcmcia_socket_list_rwsem);
217
Russell King5bc6b682005-07-07 17:59:07 -0700218#ifndef CONFIG_CARDBUS
219 /*
220 * If we do not support Cardbus, ensure that
221 * the Cardbus socket capability is disabled.
222 */
223 socket->features &= ~SS_CAP_CARDBUS;
224#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700225
226 /* set proper values in socket->dev */
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200227 dev_set_drvdata(&socket->dev, socket);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 socket->dev.class = &pcmcia_socket_class;
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200229 snprintf(socket->dev.bus_id, BUS_ID_SIZE, "pcmcia_socket%u", socket->sock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230
231 /* base address = 0, map = 0 */
232 socket->cis_mem.flags = 0;
233 socket->cis_mem.speed = cis_speed;
234
235 INIT_LIST_HEAD(&socket->cis_cache);
236
237 init_completion(&socket->socket_released);
238 init_completion(&socket->thread_done);
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100239 mutex_init(&socket->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240 spin_lock_init(&socket->thread_lock);
241
Serge E. Hallyn1da9ab72006-06-14 08:01:26 -0500242 tsk = kthread_run(pccardd, socket, "pccardd");
243 if (IS_ERR(tsk)) {
244 ret = PTR_ERR(tsk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245 goto err;
Serge E. Hallyn1da9ab72006-06-14 08:01:26 -0500246 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700247
248 wait_for_completion(&socket->thread_done);
Serge E. Hallyn1da9ab72006-06-14 08:01:26 -0500249 if (!socket->thread) {
Dominik Brodowski2e55bf62008-08-02 18:08:38 +0200250 dev_printk(KERN_WARNING, &socket->dev,
251 "PCMCIA: warning: socket thread did not start\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252 return -EIO;
253 }
Serge E. Hallyn1da9ab72006-06-14 08:01:26 -0500254
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255 pcmcia_parse_events(socket, SS_DETECT);
256
257 return 0;
258
259 err:
260 down_write(&pcmcia_socket_list_rwsem);
261 list_del(&socket->socket_list);
262 up_write(&pcmcia_socket_list_rwsem);
263 return ret;
264} /* pcmcia_register_socket */
265EXPORT_SYMBOL(pcmcia_register_socket);
266
267
268/**
269 * pcmcia_unregister_socket - remove a pcmcia socket device
Randy Dunlap78187862007-12-10 15:49:22 -0800270 * @socket: the &socket to unregister
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 */
272void pcmcia_unregister_socket(struct pcmcia_socket *socket)
273{
274 if (!socket)
275 return;
276
277 cs_dbg(socket, 0, "pcmcia_unregister_socket(0x%p)\n", socket->ops);
278
Christoph Hellwig0b402092007-04-22 13:55:36 +0100279 if (socket->thread)
Serge E. Hallyn1da9ab72006-06-14 08:01:26 -0500280 kthread_stop(socket->thread);
Christoph Hellwig0b402092007-04-22 13:55:36 +0100281
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282 release_cis_mem(socket);
283
284 /* remove from our own list */
285 down_write(&pcmcia_socket_list_rwsem);
286 list_del(&socket->socket_list);
287 up_write(&pcmcia_socket_list_rwsem);
288
289 /* wait for sysfs to drop all references */
290 release_resource_db(socket);
291 wait_for_completion(&socket->socket_released);
292} /* pcmcia_unregister_socket */
293EXPORT_SYMBOL(pcmcia_unregister_socket);
294
295
296struct pcmcia_socket * pcmcia_get_socket_by_nr(unsigned int nr)
297{
298 struct pcmcia_socket *s;
299
300 down_read(&pcmcia_socket_list_rwsem);
301 list_for_each_entry(s, &pcmcia_socket_list, socket_list)
302 if (s->sock == nr) {
303 up_read(&pcmcia_socket_list_rwsem);
304 return s;
305 }
306 up_read(&pcmcia_socket_list_rwsem);
307
308 return NULL;
309
310}
311EXPORT_SYMBOL(pcmcia_get_socket_by_nr);
312
Randy Dunlap78187862007-12-10 15:49:22 -0800313/*
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700314 * The central event handler. Send_event() sends an event to the
315 * 16-bit subsystem, which then calls the relevant device drivers.
316 * Parse_events() interprets the event bits from
317 * a card status change report. Do_shutdown() handles the high
318 * priority stuff associated with a card removal.
319 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320
321/* NOTE: send_event needs to be called with skt->sem held. */
322
323static int send_event(struct pcmcia_socket *s, event_t event, int priority)
324{
325 int ret;
326
327 if (s->state & SOCKET_CARDBUS)
328 return 0;
329
330 cs_dbg(s, 1, "send_event(event %d, pri %d, callback 0x%p)\n",
331 event, priority, s->callback);
332
333 if (!s->callback)
334 return 0;
335 if (!try_module_get(s->callback->owner))
336 return 0;
337
338 ret = s->callback->event(s, event, priority);
339
340 module_put(s->callback->owner);
341
342 return ret;
343}
344
345static void socket_remove_drivers(struct pcmcia_socket *skt)
346{
347 cs_dbg(skt, 4, "remove_drivers\n");
348
349 send_event(skt, CS_EVENT_CARD_REMOVAL, CS_EVENT_PRI_HIGH);
350}
351
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352static int socket_reset(struct pcmcia_socket *skt)
353{
354 int status, i;
355
356 cs_dbg(skt, 4, "reset\n");
357
358 skt->socket.flags |= SS_OUTPUT_ENA | SS_RESET;
359 skt->ops->set_socket(skt, &skt->socket);
360 udelay((long)reset_time);
361
362 skt->socket.flags &= ~SS_RESET;
363 skt->ops->set_socket(skt, &skt->socket);
364
365 msleep(unreset_delay * 10);
366 for (i = 0; i < unreset_limit; i++) {
367 skt->ops->get_status(skt, &status);
368
369 if (!(status & SS_DETECT))
Dominik Brodowski3939c1ef2008-08-03 11:10:56 +0200370 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371
372 if (status & SS_READY)
Dominik Brodowski4c89e882008-08-03 10:07:45 +0200373 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374
375 msleep(unreset_check * 10);
376 }
377
378 cs_err(skt, "time out after reset.\n");
Dominik Brodowski85671422008-08-03 11:15:45 +0200379 return -ETIMEDOUT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380}
381
Randy Dunlap78187862007-12-10 15:49:22 -0800382/*
Daniel Ritz6e493882005-12-30 15:12:35 +0100383 * socket_setup() and socket_shutdown() are called by the main event handler
384 * when card insertion and removal events are received.
385 * socket_setup() turns on socket power and resets the socket, in two stages.
386 * socket_shutdown() unconfigures a socket and turns off socket power.
387 */
388static void socket_shutdown(struct pcmcia_socket *s)
389{
390 int status;
391
392 cs_dbg(s, 4, "shutdown\n");
393
394 socket_remove_drivers(s);
395 s->state &= SOCKET_INUSE | SOCKET_PRESENT;
396 msleep(shutdown_delay * 10);
397 s->state &= SOCKET_INUSE;
398
399 /* Blank out the socket state */
400 s->socket = dead_socket;
401 s->ops->init(s);
402 s->ops->set_socket(s, &s->socket);
403 s->irq.AssignedIRQ = s->irq.Config = 0;
404 s->lock_count = 0;
405 destroy_cis_cache(s);
406#ifdef CONFIG_CARDBUS
407 cb_free(s);
408#endif
409 s->functions = 0;
Daniel Ritz6e493882005-12-30 15:12:35 +0100410
Daniel Ritzafb2c162007-07-31 00:38:08 -0700411 /* give socket some time to power down */
412 msleep(100);
413
Daniel Ritz6e493882005-12-30 15:12:35 +0100414 s->ops->get_status(s, &status);
415 if (status & SS_POWERON) {
Dominik Brodowski2e55bf62008-08-02 18:08:38 +0200416 dev_printk(KERN_ERR, &s->dev,
417 "*** DANGER *** unable to remove socket power\n");
Daniel Ritz6e493882005-12-30 15:12:35 +0100418 }
419
420 cs_socket_put(s);
421}
422
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423static int socket_setup(struct pcmcia_socket *skt, int initial_delay)
424{
425 int status, i;
426
427 cs_dbg(skt, 4, "setup\n");
428
429 skt->ops->get_status(skt, &status);
430 if (!(status & SS_DETECT))
Dominik Brodowski3939c1ef2008-08-03 11:10:56 +0200431 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432
433 msleep(initial_delay * 10);
434
435 for (i = 0; i < 100; i++) {
436 skt->ops->get_status(skt, &status);
437 if (!(status & SS_DETECT))
Dominik Brodowski3939c1ef2008-08-03 11:10:56 +0200438 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700439
440 if (!(status & SS_PENDING))
441 break;
442
443 msleep(100);
444 }
445
446 if (status & SS_PENDING) {
447 cs_err(skt, "voltage interrogation timed out.\n");
Dominik Brodowski85671422008-08-03 11:15:45 +0200448 return -ETIMEDOUT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449 }
450
451 if (status & SS_CARDBUS) {
Russell King5bc6b682005-07-07 17:59:07 -0700452 if (!(skt->features & SS_CAP_CARDBUS)) {
453 cs_err(skt, "cardbus cards are not supported.\n");
454 return CS_BAD_TYPE;
455 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700456 skt->state |= SOCKET_CARDBUS;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700457 }
458
459 /*
460 * Decode the card voltage requirements, and apply power to the card.
461 */
462 if (status & SS_3VCARD)
463 skt->socket.Vcc = skt->socket.Vpp = 33;
464 else if (!(status & SS_XVCARD))
465 skt->socket.Vcc = skt->socket.Vpp = 50;
466 else {
467 cs_err(skt, "unsupported voltage key.\n");
468 return CS_BAD_TYPE;
469 }
Daniel Ritzfa912bc2005-06-23 00:10:12 -0700470
471 if (skt->power_hook)
472 skt->power_hook(skt, HOOK_POWER_PRE);
473
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474 skt->socket.flags = 0;
475 skt->ops->set_socket(skt, &skt->socket);
476
477 /*
478 * Wait "vcc_settle" for the supply to stabilise.
479 */
480 msleep(vcc_settle * 10);
481
482 skt->ops->get_status(skt, &status);
483 if (!(status & SS_POWERON)) {
484 cs_err(skt, "unable to apply power.\n");
485 return CS_BAD_TYPE;
486 }
487
Daniel Ritzfa912bc2005-06-23 00:10:12 -0700488 status = socket_reset(skt);
489
490 if (skt->power_hook)
491 skt->power_hook(skt, HOOK_POWER_POST);
492
493 return status;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700494}
495
496/*
497 * Handle card insertion. Setup the socket, reset the card,
498 * and then tell the rest of PCMCIA that a card is present.
499 */
500static int socket_insert(struct pcmcia_socket *skt)
501{
502 int ret;
503
504 cs_dbg(skt, 4, "insert\n");
505
506 if (!cs_socket_get(skt))
Dominik Brodowski3939c1ef2008-08-03 11:10:56 +0200507 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508
509 ret = socket_setup(skt, setup_delay);
Dominik Brodowski4c89e882008-08-03 10:07:45 +0200510 if (ret == 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511 skt->state |= SOCKET_PRESENT;
Dominik Brodowski807277c2005-11-12 23:34:06 +0100512
Dominik Brodowski2e55bf62008-08-02 18:08:38 +0200513 dev_printk(KERN_NOTICE, &skt->dev,
514 "pccard: %s card inserted into slot %d\n",
515 (skt->state & SOCKET_CARDBUS) ? "CardBus" : "PCMCIA",
516 skt->sock);
Dominik Brodowski807277c2005-11-12 23:34:06 +0100517
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518#ifdef CONFIG_CARDBUS
519 if (skt->state & SOCKET_CARDBUS) {
520 cb_alloc(skt);
521 skt->state |= SOCKET_CARDBUS_CONFIG;
522 }
523#endif
524 cs_dbg(skt, 4, "insert done\n");
525
526 send_event(skt, CS_EVENT_CARD_INSERTION, CS_EVENT_PRI_LOW);
527 } else {
528 socket_shutdown(skt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529 }
530
531 return ret;
532}
533
534static int socket_suspend(struct pcmcia_socket *skt)
535{
536 if (skt->state & SOCKET_SUSPEND)
537 return CS_IN_USE;
538
539 send_event(skt, CS_EVENT_PM_SUSPEND, CS_EVENT_PRI_LOW);
540 skt->socket = dead_socket;
541 skt->ops->set_socket(skt, &skt->socket);
542 if (skt->ops->suspend)
543 skt->ops->suspend(skt);
544 skt->state |= SOCKET_SUSPEND;
545
Dominik Brodowski4c89e882008-08-03 10:07:45 +0200546 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700547}
548
549/*
550 * Resume a socket. If a card is present, verify its CIS against
551 * our cached copy. If they are different, the card has been
552 * replaced, and we need to tell the drivers.
553 */
554static int socket_resume(struct pcmcia_socket *skt)
555{
556 int ret;
557
558 if (!(skt->state & SOCKET_SUSPEND))
559 return CS_IN_USE;
560
561 skt->socket = dead_socket;
562 skt->ops->init(skt);
563 skt->ops->set_socket(skt, &skt->socket);
564
565 if (!(skt->state & SOCKET_PRESENT)) {
566 skt->state &= ~SOCKET_SUSPEND;
567 return socket_insert(skt);
568 }
569
570 ret = socket_setup(skt, resume_delay);
Dominik Brodowski4c89e882008-08-03 10:07:45 +0200571 if (ret == 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572 /*
573 * FIXME: need a better check here for cardbus cards.
574 */
575 if (verify_cis_cache(skt) != 0) {
576 cs_dbg(skt, 4, "cis mismatch - different card\n");
577 socket_remove_drivers(skt);
578 destroy_cis_cache(skt);
579 /*
580 * Workaround: give DS time to schedule removal.
581 * Remove me once the 100ms delay is eliminated
582 * in ds.c
583 */
584 msleep(200);
585 send_event(skt, CS_EVENT_CARD_INSERTION, CS_EVENT_PRI_LOW);
586 } else {
587 cs_dbg(skt, 4, "cis matches cache\n");
588 send_event(skt, CS_EVENT_PM_RESUME, CS_EVENT_PRI_LOW);
589 }
590 } else {
591 socket_shutdown(skt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700592 }
593
594 skt->state &= ~SOCKET_SUSPEND;
595
Dominik Brodowski4c89e882008-08-03 10:07:45 +0200596 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700597}
598
599static void socket_remove(struct pcmcia_socket *skt)
600{
Dominik Brodowski2e55bf62008-08-02 18:08:38 +0200601 dev_printk(KERN_NOTICE, &skt->dev,
602 "pccard: card ejected from slot %d\n", skt->sock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603 socket_shutdown(skt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604}
605
606/*
607 * Process a socket card detect status change.
608 *
609 * If we don't have a card already present, delay the detect event for
610 * about 20ms (to be on the safe side) before reading the socket status.
611 *
612 * Some i82365-based systems send multiple SS_DETECT events during card
613 * insertion, and the "card present" status bit seems to bounce. This
614 * will probably be true with GPIO-based card detection systems after
615 * the product has aged.
616 */
617static void socket_detect_change(struct pcmcia_socket *skt)
618{
619 if (!(skt->state & SOCKET_SUSPEND)) {
620 int status;
621
622 if (!(skt->state & SOCKET_PRESENT))
623 msleep(20);
624
625 skt->ops->get_status(skt, &status);
626 if ((skt->state & SOCKET_PRESENT) &&
627 !(status & SS_DETECT))
628 socket_remove(skt);
629 if (!(skt->state & SOCKET_PRESENT) &&
630 (status & SS_DETECT))
631 socket_insert(skt);
632 }
633}
634
635static int pccardd(void *__skt)
636{
637 struct pcmcia_socket *skt = __skt;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700638 int ret;
639
Linus Torvalds1da177e2005-04-16 15:20:36 -0700640 skt->thread = current;
641 skt->socket = dead_socket;
642 skt->ops->init(skt);
643 skt->ops->set_socket(skt, &skt->socket);
644
645 /* register with the device core */
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200646 ret = device_register(&skt->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700647 if (ret) {
Dominik Brodowski2e55bf62008-08-02 18:08:38 +0200648 dev_printk(KERN_WARNING, &skt->dev,
649 "PCMCIA: unable to register socket\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700650 skt->thread = NULL;
Serge E. Hallyn1da9ab72006-06-14 08:01:26 -0500651 complete(&skt->thread_done);
652 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700653 }
David Brownell4356d732008-04-28 01:03:20 -0700654 ret = pccard_sysfs_add_socket(&skt->dev);
655 if (ret)
656 dev_warn(&skt->dev, "err %d adding socket attributes\n", ret);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700657
Daniel Ritzbf4de6f2005-09-09 13:03:23 -0700658 complete(&skt->thread_done);
659
Rafael J. Wysocki83144182007-07-17 04:03:35 -0700660 set_freezable();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700661 for (;;) {
662 unsigned long flags;
663 unsigned int events;
664
665 set_current_state(TASK_INTERRUPTIBLE);
666
667 spin_lock_irqsave(&skt->thread_lock, flags);
668 events = skt->thread_events;
669 skt->thread_events = 0;
670 spin_unlock_irqrestore(&skt->thread_lock, flags);
671
672 if (events) {
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100673 mutex_lock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700674 if (events & SS_DETECT)
675 socket_detect_change(skt);
676 if (events & SS_BATDEAD)
677 send_event(skt, CS_EVENT_BATTERY_DEAD, CS_EVENT_PRI_LOW);
678 if (events & SS_BATWARN)
679 send_event(skt, CS_EVENT_BATTERY_LOW, CS_EVENT_PRI_LOW);
680 if (events & SS_READY)
681 send_event(skt, CS_EVENT_READY_CHANGE, CS_EVENT_PRI_LOW);
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100682 mutex_unlock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700683 continue;
684 }
685
Serge E. Hallyn1da9ab72006-06-14 08:01:26 -0500686 if (kthread_should_stop())
Linus Torvalds1da177e2005-04-16 15:20:36 -0700687 break;
Daniel Ritzbf4de6f2005-09-09 13:03:23 -0700688
689 schedule();
690 try_to_freeze();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700691 }
Steven Rostedt220ec022005-10-10 11:13:17 -0400692 /* make sure we are running before we exit */
693 set_current_state(TASK_RUNNING);
694
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695 /* remove from the device core */
David Brownell4356d732008-04-28 01:03:20 -0700696 pccard_sysfs_remove_socket(&skt->dev);
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200697 device_unregister(&skt->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700698
Serge E. Hallyn1da9ab72006-06-14 08:01:26 -0500699 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700}
701
702/*
703 * Yenta (at least) probes interrupts before registering the socket and
704 * starting the handler thread.
705 */
706void pcmcia_parse_events(struct pcmcia_socket *s, u_int events)
707{
Arjan van de Ven4b7a89a2006-06-30 10:31:13 +0200708 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700709 cs_dbg(s, 4, "parse_events: events %08x\n", events);
710 if (s->thread) {
Arjan van de Ven4b7a89a2006-06-30 10:31:13 +0200711 spin_lock_irqsave(&s->thread_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700712 s->thread_events |= events;
Arjan van de Ven4b7a89a2006-06-30 10:31:13 +0200713 spin_unlock_irqrestore(&s->thread_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700714
Christoph Hellwig0b402092007-04-22 13:55:36 +0100715 wake_up_process(s->thread);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700716 }
717} /* pcmcia_parse_events */
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700718EXPORT_SYMBOL(pcmcia_parse_events);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719
Linus Torvalds1da177e2005-04-16 15:20:36 -0700720
721/* register pcmcia_callback */
722int pccard_register_pcmcia(struct pcmcia_socket *s, struct pcmcia_callback *c)
723{
724 int ret = 0;
725
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100726 /* s->skt_mutex also protects s->callback */
727 mutex_lock(&s->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700728
729 if (c) {
730 /* registration */
731 if (s->callback) {
732 ret = -EBUSY;
733 goto err;
734 }
735
736 s->callback = c;
737
738 if ((s->state & (SOCKET_PRESENT|SOCKET_CARDBUS)) == SOCKET_PRESENT)
739 send_event(s, CS_EVENT_CARD_INSERTION, CS_EVENT_PRI_LOW);
740 } else
741 s->callback = NULL;
742 err:
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100743 mutex_unlock(&s->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700744
745 return ret;
746}
747EXPORT_SYMBOL(pccard_register_pcmcia);
748
Linus Torvalds1da177e2005-04-16 15:20:36 -0700749
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700750/* I'm not sure which "reset" function this is supposed to use,
751 * but for now, it uses the low-level interface's reset, not the
752 * CIS register.
753 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700754
755int pccard_reset_card(struct pcmcia_socket *skt)
756{
757 int ret;
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700758
Linus Torvalds1da177e2005-04-16 15:20:36 -0700759 cs_dbg(skt, 1, "resetting socket\n");
760
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100761 mutex_lock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700762 do {
763 if (!(skt->state & SOCKET_PRESENT)) {
Dominik Brodowski3939c1ef2008-08-03 11:10:56 +0200764 ret = -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700765 break;
766 }
767 if (skt->state & SOCKET_SUSPEND) {
768 ret = CS_IN_USE;
769 break;
770 }
771 if (skt->state & SOCKET_CARDBUS) {
Dominik Brodowskide6405e2008-08-03 10:47:59 +0200772 ret = -EPERM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700773 break;
774 }
775
776 ret = send_event(skt, CS_EVENT_RESET_REQUEST, CS_EVENT_PRI_LOW);
777 if (ret == 0) {
778 send_event(skt, CS_EVENT_RESET_PHYSICAL, CS_EVENT_PRI_LOW);
Dominik Brodowski8e9e7932006-01-06 00:02:03 +0100779 if (skt->callback)
780 skt->callback->suspend(skt);
Dominik Brodowski4c89e882008-08-03 10:07:45 +0200781 if (socket_reset(skt) == 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700782 send_event(skt, CS_EVENT_CARD_RESET, CS_EVENT_PRI_LOW);
Dominik Brodowski8e9e7932006-01-06 00:02:03 +0100783 if (skt->callback)
784 skt->callback->resume(skt);
785 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700786 }
787
Dominik Brodowski4c89e882008-08-03 10:07:45 +0200788 ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700789 } while (0);
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100790 mutex_unlock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700791
792 return ret;
793} /* reset_card */
794EXPORT_SYMBOL(pccard_reset_card);
795
Linus Torvalds1da177e2005-04-16 15:20:36 -0700796
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700797/* These shut down or wake up a socket. They are sort of user
798 * initiated versions of the APM suspend and resume actions.
799 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700800int pcmcia_suspend_card(struct pcmcia_socket *skt)
801{
802 int ret;
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700803
Linus Torvalds1da177e2005-04-16 15:20:36 -0700804 cs_dbg(skt, 1, "suspending socket\n");
805
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100806 mutex_lock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700807 do {
808 if (!(skt->state & SOCKET_PRESENT)) {
Dominik Brodowski3939c1ef2008-08-03 11:10:56 +0200809 ret = -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700810 break;
811 }
812 if (skt->state & SOCKET_CARDBUS) {
Dominik Brodowskide6405e2008-08-03 10:47:59 +0200813 ret = -EPERM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700814 break;
815 }
Dominik Brodowski8e9e7932006-01-06 00:02:03 +0100816 if (skt->callback) {
817 ret = skt->callback->suspend(skt);
818 if (ret)
819 break;
820 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700821 ret = socket_suspend(skt);
822 } while (0);
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100823 mutex_unlock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824
825 return ret;
826} /* suspend_card */
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700827EXPORT_SYMBOL(pcmcia_suspend_card);
828
Linus Torvalds1da177e2005-04-16 15:20:36 -0700829
830int pcmcia_resume_card(struct pcmcia_socket *skt)
831{
832 int ret;
833
834 cs_dbg(skt, 1, "waking up socket\n");
835
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100836 mutex_lock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837 do {
838 if (!(skt->state & SOCKET_PRESENT)) {
Dominik Brodowski3939c1ef2008-08-03 11:10:56 +0200839 ret = -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700840 break;
841 }
842 if (skt->state & SOCKET_CARDBUS) {
Dominik Brodowskide6405e2008-08-03 10:47:59 +0200843 ret = -EPERM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844 break;
845 }
846 ret = socket_resume(skt);
Dominik Brodowski8e9e7932006-01-06 00:02:03 +0100847 if (!ret && skt->callback)
848 skt->callback->resume(skt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700849 } while (0);
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100850 mutex_unlock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700851
852 return ret;
853} /* resume_card */
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700854EXPORT_SYMBOL(pcmcia_resume_card);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700855
Linus Torvalds1da177e2005-04-16 15:20:36 -0700856
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700857/* These handle user requests to eject or insert a card. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700858int pcmcia_eject_card(struct pcmcia_socket *skt)
859{
860 int ret;
861
862 cs_dbg(skt, 1, "user eject request\n");
863
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100864 mutex_lock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700865 do {
866 if (!(skt->state & SOCKET_PRESENT)) {
867 ret = -ENODEV;
868 break;
869 }
870
871 ret = send_event(skt, CS_EVENT_EJECTION_REQUEST, CS_EVENT_PRI_LOW);
872 if (ret != 0) {
873 ret = -EINVAL;
874 break;
875 }
876
877 socket_remove(skt);
878 ret = 0;
879 } while (0);
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100880 mutex_unlock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700881
882 return ret;
883} /* eject_card */
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700884EXPORT_SYMBOL(pcmcia_eject_card);
885
Linus Torvalds1da177e2005-04-16 15:20:36 -0700886
887int pcmcia_insert_card(struct pcmcia_socket *skt)
888{
889 int ret;
890
891 cs_dbg(skt, 1, "user insert request\n");
892
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100893 mutex_lock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700894 do {
895 if (skt->state & SOCKET_PRESENT) {
896 ret = -EBUSY;
897 break;
898 }
Dominik Brodowski3939c1ef2008-08-03 11:10:56 +0200899 if (socket_insert(skt) == -ENODEV) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700900 ret = -ENODEV;
901 break;
902 }
903 ret = 0;
904 } while (0);
Dominik Brodowski7fe908d2006-01-10 21:20:36 +0100905 mutex_unlock(&skt->skt_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700906
907 return ret;
908} /* insert_card */
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700909EXPORT_SYMBOL(pcmcia_insert_card);
910
Linus Torvalds1da177e2005-04-16 15:20:36 -0700911
Kay Sievers7eff2e72007-08-14 15:15:12 +0200912static int pcmcia_socket_uevent(struct device *dev,
913 struct kobj_uevent_env *env)
Dominik Brodowski3ee13932005-06-27 16:28:05 -0700914{
915 struct pcmcia_socket *s = container_of(dev, struct pcmcia_socket, dev);
Dominik Brodowski3ee13932005-06-27 16:28:05 -0700916
Kay Sievers7eff2e72007-08-14 15:15:12 +0200917 if (add_uevent_var(env, "SOCKET_NO=%u", s->sock))
Dominik Brodowski3ee13932005-06-27 16:28:05 -0700918 return -ENOMEM;
919
Dominik Brodowski3ee13932005-06-27 16:28:05 -0700920 return 0;
921}
922
Linus Torvalds1da177e2005-04-16 15:20:36 -0700923
Dominik Brodowski378a33a2005-06-27 16:28:54 -0700924static struct completion pcmcia_unload;
925
926static void pcmcia_release_socket_class(struct class *data)
927{
928 complete(&pcmcia_unload);
929}
930
931
Linus Torvalds1da177e2005-04-16 15:20:36 -0700932struct class pcmcia_socket_class = {
933 .name = "pcmcia_socket",
Greg Kroah-Hartman87373312006-09-12 17:00:10 +0200934 .dev_uevent = pcmcia_socket_uevent,
935 .dev_release = pcmcia_release_socket,
Dominik Brodowski378a33a2005-06-27 16:28:54 -0700936 .class_release = pcmcia_release_socket_class,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937};
938EXPORT_SYMBOL(pcmcia_socket_class);
939
940
941static int __init init_pcmcia_cs(void)
942{
Dominik Brodowski378a33a2005-06-27 16:28:54 -0700943 init_completion(&pcmcia_unload);
David Brownell4356d732008-04-28 01:03:20 -0700944 return class_register(&pcmcia_socket_class);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700945}
946
947static void __exit exit_pcmcia_cs(void)
948{
Dominik Brodowski33519dd2005-06-27 16:28:53 -0700949 class_unregister(&pcmcia_socket_class);
Dominik Brodowski378a33a2005-06-27 16:28:54 -0700950 wait_for_completion(&pcmcia_unload);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700951}
952
953subsys_initcall(init_pcmcia_cs);
954module_exit(exit_pcmcia_cs);
955