pcmcia: use state machine for extended requery
[GitHub/LineageOS/android_kernel_samsung_universal7580.git] / drivers / pcmcia / cs.c
CommitLineData
1da177e4
LT
1/*
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>
1da177e4
LT
19#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>
1da177e4 29#include <linux/device.h>
1da9ab73 30#include <linux/kthread.h>
7dfb7103 31#include <linux/freezer.h>
1da177e4
LT
32#include <asm/system.h>
33#include <asm/irq.h>
34
1da177e4
LT
35#include <pcmcia/cs_types.h>
36#include <pcmcia/ss.h>
37#include <pcmcia/cs.h>
1da177e4
LT
38#include <pcmcia/cistpl.h>
39#include <pcmcia/cisreg.h>
40#include <pcmcia/ds.h>
41#include "cs_internal.h"
42
1da177e4
LT
43
44/* Module parameters */
45
46MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>");
33519ddd 47MODULE_DESCRIPTION("Linux Kernel Card Services");
1da177e4
LT
48MODULE_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
1da177e4
LT
64
65socket_state_t dead_socket = {
66 .csc_mask = SS_DETECT,
67};
33519ddd 68EXPORT_SYMBOL(dead_socket);
1da177e4
LT
69
70
71/* List of all sockets, protected by a rwsem */
72LIST_HEAD(pcmcia_socket_list);
1da177e4 73EXPORT_SYMBOL(pcmcia_socket_list);
1da177e4 74
33519ddd
DB
75DECLARE_RWSEM(pcmcia_socket_list_rwsem);
76EXPORT_SYMBOL(pcmcia_socket_list_rwsem);
1da177e4 77
1da177e4 78
78187865 79/*
33519ddd
DB
80 * Low-level PCMCIA socket drivers need to register with the PCCard
81 * core using pcmcia_register_socket.
82 *
83 * socket drivers are expected to use the following callbacks in their
1da177e4
LT
84 * .drv struct:
85 * - pcmcia_socket_dev_suspend
86 * - pcmcia_socket_dev_resume
87 * These functions check for the appropriate struct pcmcia_soket arrays,
88 * and pass them to the low-level functions pcmcia_{suspend,resume}_socket
89 */
9905d1b4
RW
90static int socket_early_resume(struct pcmcia_socket *skt);
91static int socket_late_resume(struct pcmcia_socket *skt);
1da177e4
LT
92static int socket_resume(struct pcmcia_socket *skt);
93static int socket_suspend(struct pcmcia_socket *skt);
94
9905d1b4
RW
95static void pcmcia_socket_dev_run(struct device *dev,
96 int (*cb)(struct pcmcia_socket *))
1da177e4
LT
97{
98 struct pcmcia_socket *socket;
99
100 down_read(&pcmcia_socket_list_rwsem);
101 list_for_each_entry(socket, &pcmcia_socket_list, socket_list) {
87373318 102 if (socket->dev.parent != dev)
1da177e4 103 continue;
7fe908dd 104 mutex_lock(&socket->skt_mutex);
9905d1b4 105 cb(socket);
7fe908dd 106 mutex_unlock(&socket->skt_mutex);
1da177e4
LT
107 }
108 up_read(&pcmcia_socket_list_rwsem);
9905d1b4 109}
1da177e4 110
9905d1b4
RW
111int pcmcia_socket_dev_suspend(struct device *dev)
112{
113 pcmcia_socket_dev_run(dev, socket_suspend);
1da177e4
LT
114 return 0;
115}
116EXPORT_SYMBOL(pcmcia_socket_dev_suspend);
117
9905d1b4 118void pcmcia_socket_dev_early_resume(struct device *dev)
1da177e4 119{
9905d1b4
RW
120 pcmcia_socket_dev_run(dev, socket_early_resume);
121}
122EXPORT_SYMBOL(pcmcia_socket_dev_early_resume);
1da177e4 123
9905d1b4
RW
124void pcmcia_socket_dev_late_resume(struct device *dev)
125{
126 pcmcia_socket_dev_run(dev, socket_late_resume);
127}
128EXPORT_SYMBOL(pcmcia_socket_dev_late_resume);
1da177e4 129
9905d1b4
RW
130int pcmcia_socket_dev_resume(struct device *dev)
131{
132 pcmcia_socket_dev_run(dev, socket_resume);
1da177e4
LT
133 return 0;
134}
135EXPORT_SYMBOL(pcmcia_socket_dev_resume);
136
137
9fea84f4 138struct pcmcia_socket *pcmcia_get_socket(struct pcmcia_socket *skt)
1da177e4 139{
87373318
GKH
140 struct device *dev = get_device(&skt->dev);
141 if (!dev)
1da177e4 142 return NULL;
593f010b 143 return dev_get_drvdata(dev);
1da177e4
LT
144}
145EXPORT_SYMBOL(pcmcia_get_socket);
146
147
148void pcmcia_put_socket(struct pcmcia_socket *skt)
149{
87373318 150 put_device(&skt->dev);
1da177e4
LT
151}
152EXPORT_SYMBOL(pcmcia_put_socket);
153
154
87373318 155static void pcmcia_release_socket(struct device *dev)
1da177e4 156{
87373318 157 struct pcmcia_socket *socket = dev_get_drvdata(dev);
1da177e4
LT
158
159 complete(&socket->socket_released);
160}
161
162static int pccardd(void *__skt);
163
164/**
165 * pcmcia_register_socket - add a new pcmcia socket device
78187865 166 * @socket: the &socket to register
1da177e4
LT
167 */
168int pcmcia_register_socket(struct pcmcia_socket *socket)
169{
1da9ab73 170 struct task_struct *tsk;
1da177e4
LT
171 int ret;
172
87373318 173 if (!socket || !socket->ops || !socket->dev.parent || !socket->resource_ops)
1da177e4
LT
174 return -EINVAL;
175
d50dbec3 176 dev_dbg(&socket->dev, "pcmcia_register_socket(0x%p)\n", socket->ops);
1da177e4 177
1da177e4 178 /* try to obtain a socket number [yes, it gets ugly if we
33519ddd
DB
179 * register more than 2^sizeof(unsigned int) pcmcia
180 * sockets... but the socket number is deprecated
1da177e4
LT
181 * anyways, so I don't care] */
182 down_write(&pcmcia_socket_list_rwsem);
183 if (list_empty(&pcmcia_socket_list))
184 socket->sock = 0;
185 else {
186 unsigned int found, i = 1;
187 struct pcmcia_socket *tmp;
188 do {
189 found = 1;
190 list_for_each_entry(tmp, &pcmcia_socket_list, socket_list) {
191 if (tmp->sock == i)
192 found = 0;
193 }
194 i++;
195 } while (!found);
196 socket->sock = i - 1;
197 }
198 list_add_tail(&socket->socket_list, &pcmcia_socket_list);
199 up_write(&pcmcia_socket_list_rwsem);
200
5bc6b68a
RK
201#ifndef CONFIG_CARDBUS
202 /*
203 * If we do not support Cardbus, ensure that
204 * the Cardbus socket capability is disabled.
205 */
206 socket->features &= ~SS_CAP_CARDBUS;
207#endif
1da177e4
LT
208
209 /* set proper values in socket->dev */
87373318 210 dev_set_drvdata(&socket->dev, socket);
1da177e4 211 socket->dev.class = &pcmcia_socket_class;
25096986 212 dev_set_name(&socket->dev, "pcmcia_socket%u", socket->sock);
1da177e4
LT
213
214 /* base address = 0, map = 0 */
215 socket->cis_mem.flags = 0;
216 socket->cis_mem.speed = cis_speed;
217
218 INIT_LIST_HEAD(&socket->cis_cache);
219
220 init_completion(&socket->socket_released);
221 init_completion(&socket->thread_done);
7fe908dd 222 mutex_init(&socket->skt_mutex);
6b8e087b 223 mutex_init(&socket->ops_mutex);
1da177e4
LT
224 spin_lock_init(&socket->thread_lock);
225
b1769450 226 if (socket->resource_ops->init) {
cfe5d809 227 mutex_lock(&socket->ops_mutex);
b1769450 228 ret = socket->resource_ops->init(socket);
cfe5d809 229 mutex_unlock(&socket->ops_mutex);
b1769450
DB
230 if (ret)
231 goto err;
232 }
233
1da9ab73
SH
234 tsk = kthread_run(pccardd, socket, "pccardd");
235 if (IS_ERR(tsk)) {
236 ret = PTR_ERR(tsk);
1da177e4 237 goto err;
1da9ab73 238 }
1da177e4
LT
239
240 wait_for_completion(&socket->thread_done);
1da9ab73 241 if (!socket->thread) {
2e55bf6b
DB
242 dev_printk(KERN_WARNING, &socket->dev,
243 "PCMCIA: warning: socket thread did not start\n");
1da177e4
LT
244 return -EIO;
245 }
1da9ab73 246
1da177e4
LT
247 pcmcia_parse_events(socket, SS_DETECT);
248
638bba55
DB
249 /*
250 * Let's try to get the PCMCIA module for 16-bit PCMCIA support.
251 * If it fails, it doesn't matter -- we still have 32-bit CardBus
252 * support to offer, so this is not a failure mode.
253 */
254 request_module_nowait("pcmcia");
255
1da177e4
LT
256 return 0;
257
258 err:
259 down_write(&pcmcia_socket_list_rwsem);
260 list_del(&socket->socket_list);
261 up_write(&pcmcia_socket_list_rwsem);
262 return ret;
263} /* pcmcia_register_socket */
264EXPORT_SYMBOL(pcmcia_register_socket);
265
266
267/**
268 * pcmcia_unregister_socket - remove a pcmcia socket device
78187865 269 * @socket: the &socket to unregister
1da177e4
LT
270 */
271void pcmcia_unregister_socket(struct pcmcia_socket *socket)
272{
273 if (!socket)
274 return;
275
d50dbec3 276 dev_dbg(&socket->dev, "pcmcia_unregister_socket(0x%p)\n", socket->ops);
1da177e4 277
0b402094 278 if (socket->thread)
1da9ab73 279 kthread_stop(socket->thread);
0b402094 280
1da177e4
LT
281 /* remove from our own list */
282 down_write(&pcmcia_socket_list_rwsem);
283 list_del(&socket->socket_list);
284 up_write(&pcmcia_socket_list_rwsem);
285
286 /* wait for sysfs to drop all references */
cfe5d809
DB
287 if (socket->resource_ops->exit) {
288 mutex_lock(&socket->ops_mutex);
385ee871 289 socket->resource_ops->exit(socket);
cfe5d809
DB
290 mutex_unlock(&socket->ops_mutex);
291 }
1da177e4
LT
292 wait_for_completion(&socket->socket_released);
293} /* pcmcia_unregister_socket */
294EXPORT_SYMBOL(pcmcia_unregister_socket);
295
296
9fea84f4 297struct pcmcia_socket *pcmcia_get_socket_by_nr(unsigned int nr)
1da177e4
LT
298{
299 struct pcmcia_socket *s;
300
301 down_read(&pcmcia_socket_list_rwsem);
302 list_for_each_entry(s, &pcmcia_socket_list, socket_list)
303 if (s->sock == nr) {
304 up_read(&pcmcia_socket_list_rwsem);
305 return s;
306 }
307 up_read(&pcmcia_socket_list_rwsem);
308
309 return NULL;
310
311}
312EXPORT_SYMBOL(pcmcia_get_socket_by_nr);
313
78187865 314/*
33519ddd
DB
315 * The central event handler. Send_event() sends an event to the
316 * 16-bit subsystem, which then calls the relevant device drivers.
317 * Parse_events() interprets the event bits from
318 * a card status change report. Do_shutdown() handles the high
319 * priority stuff associated with a card removal.
320 */
1da177e4
LT
321
322/* NOTE: send_event needs to be called with skt->sem held. */
323
324static int send_event(struct pcmcia_socket *s, event_t event, int priority)
325{
326 int ret;
327
88b060d6 328 if ((s->state & SOCKET_CARDBUS) && (event != CS_EVENT_CARD_REMOVAL))
1da177e4
LT
329 return 0;
330
d50dbec3 331 dev_dbg(&s->dev, "send_event(event %d, pri %d, callback 0x%p)\n",
1da177e4
LT
332 event, priority, s->callback);
333
334 if (!s->callback)
335 return 0;
336 if (!try_module_get(s->callback->owner))
337 return 0;
338
339 ret = s->callback->event(s, event, priority);
340
341 module_put(s->callback->owner);
342
343 return ret;
344}
345
1da177e4
LT
346static int socket_reset(struct pcmcia_socket *skt)
347{
348 int status, i;
349
d50dbec3 350 dev_dbg(&skt->dev, "reset\n");
1da177e4
LT
351
352 skt->socket.flags |= SS_OUTPUT_ENA | SS_RESET;
353 skt->ops->set_socket(skt, &skt->socket);
354 udelay((long)reset_time);
355
356 skt->socket.flags &= ~SS_RESET;
357 skt->ops->set_socket(skt, &skt->socket);
358
359 msleep(unreset_delay * 10);
360 for (i = 0; i < unreset_limit; i++) {
361 skt->ops->get_status(skt, &status);
362
363 if (!(status & SS_DETECT))
3939c1ef 364 return -ENODEV;
1da177e4
LT
365
366 if (status & SS_READY)
4c89e88b 367 return 0;
1da177e4
LT
368
369 msleep(unreset_check * 10);
370 }
371
d50dbec3 372 dev_printk(KERN_ERR, &skt->dev, "time out after reset.\n");
8567142e 373 return -ETIMEDOUT;
1da177e4
LT
374}
375
78187865 376/*
6e493882
DR
377 * socket_setup() and socket_shutdown() are called by the main event handler
378 * when card insertion and removal events are received.
379 * socket_setup() turns on socket power and resets the socket, in two stages.
380 * socket_shutdown() unconfigures a socket and turns off socket power.
381 */
382static void socket_shutdown(struct pcmcia_socket *s)
383{
384 int status;
385
d50dbec3 386 dev_dbg(&s->dev, "shutdown\n");
6e493882 387
88b060d6 388 send_event(s, CS_EVENT_CARD_REMOVAL, CS_EVENT_PRI_HIGH);
9e86749c
DB
389
390 mutex_lock(&s->ops_mutex);
6e493882
DR
391 s->state &= SOCKET_INUSE | SOCKET_PRESENT;
392 msleep(shutdown_delay * 10);
393 s->state &= SOCKET_INUSE;
394
395 /* Blank out the socket state */
396 s->socket = dead_socket;
397 s->ops->init(s);
398 s->ops->set_socket(s, &s->socket);
399 s->irq.AssignedIRQ = s->irq.Config = 0;
400 s->lock_count = 0;
904e3777
DB
401 kfree(s->fake_cis);
402 s->fake_cis = NULL;
6e493882
DR
403#ifdef CONFIG_CARDBUS
404 cb_free(s);
405#endif
406 s->functions = 0;
6e493882 407
afb2c165
DR
408 /* give socket some time to power down */
409 msleep(100);
410
6e493882
DR
411 s->ops->get_status(s, &status);
412 if (status & SS_POWERON) {
2e55bf6b
DB
413 dev_printk(KERN_ERR, &s->dev,
414 "*** DANGER *** unable to remove socket power\n");
6e493882
DR
415 }
416
3970dd8c 417 s->state &= ~SOCKET_INUSE;
9e86749c 418 mutex_unlock(&s->ops_mutex);
6e493882
DR
419}
420
1da177e4
LT
421static int socket_setup(struct pcmcia_socket *skt, int initial_delay)
422{
423 int status, i;
424
d50dbec3 425 dev_dbg(&skt->dev, "setup\n");
1da177e4
LT
426
427 skt->ops->get_status(skt, &status);
428 if (!(status & SS_DETECT))
3939c1ef 429 return -ENODEV;
1da177e4
LT
430
431 msleep(initial_delay * 10);
432
433 for (i = 0; i < 100; i++) {
434 skt->ops->get_status(skt, &status);
435 if (!(status & SS_DETECT))
3939c1ef 436 return -ENODEV;
1da177e4
LT
437
438 if (!(status & SS_PENDING))
439 break;
440
441 msleep(100);
442 }
443
444 if (status & SS_PENDING) {
d50dbec3
DB
445 dev_printk(KERN_ERR, &skt->dev,
446 "voltage interrogation timed out.\n");
8567142e 447 return -ETIMEDOUT;
1da177e4
LT
448 }
449
450 if (status & SS_CARDBUS) {
5bc6b68a 451 if (!(skt->features & SS_CAP_CARDBUS)) {
d50dbec3
DB
452 dev_printk(KERN_ERR, &skt->dev,
453 "cardbus cards are not supported.\n");
610e2374 454 return -EINVAL;
5bc6b68a 455 }
1da177e4 456 skt->state |= SOCKET_CARDBUS;
88b060d6
DB
457 } else
458 skt->state &= ~SOCKET_CARDBUS;
1da177e4
LT
459
460 /*
461 * Decode the card voltage requirements, and apply power to the card.
462 */
463 if (status & SS_3VCARD)
464 skt->socket.Vcc = skt->socket.Vpp = 33;
465 else if (!(status & SS_XVCARD))
466 skt->socket.Vcc = skt->socket.Vpp = 50;
467 else {
d50dbec3 468 dev_printk(KERN_ERR, &skt->dev, "unsupported voltage key.\n");
610e2374 469 return -EIO;
1da177e4 470 }
fa912bcb
DR
471
472 if (skt->power_hook)
473 skt->power_hook(skt, HOOK_POWER_PRE);
474
1da177e4
LT
475 skt->socket.flags = 0;
476 skt->ops->set_socket(skt, &skt->socket);
477
478 /*
479 * Wait "vcc_settle" for the supply to stabilise.
480 */
481 msleep(vcc_settle * 10);
482
483 skt->ops->get_status(skt, &status);
484 if (!(status & SS_POWERON)) {
d50dbec3 485 dev_printk(KERN_ERR, &skt->dev, "unable to apply power.\n");
610e2374 486 return -EIO;
1da177e4
LT
487 }
488
fa912bcb
DR
489 status = socket_reset(skt);
490
491 if (skt->power_hook)
492 skt->power_hook(skt, HOOK_POWER_POST);
493
494 return status;
1da177e4
LT
495}
496
497/*
498 * Handle card insertion. Setup the socket, reset the card,
499 * and then tell the rest of PCMCIA that a card is present.
500 */
501static int socket_insert(struct pcmcia_socket *skt)
502{
503 int ret;
504
d50dbec3 505 dev_dbg(&skt->dev, "insert\n");
1da177e4 506
9e86749c 507 mutex_lock(&skt->ops_mutex);
f971dbd5
DB
508 if (skt->state & SOCKET_INUSE) {
509 mutex_unlock(&skt->ops_mutex);
510 return -EINVAL;
511 }
3970dd8c 512 skt->state |= SOCKET_INUSE;
1da177e4
LT
513
514 ret = socket_setup(skt, setup_delay);
4c89e88b 515 if (ret == 0) {
1da177e4 516 skt->state |= SOCKET_PRESENT;
807277cb 517
2e55bf6b
DB
518 dev_printk(KERN_NOTICE, &skt->dev,
519 "pccard: %s card inserted into slot %d\n",
520 (skt->state & SOCKET_CARDBUS) ? "CardBus" : "PCMCIA",
521 skt->sock);
807277cb 522
1da177e4
LT
523#ifdef CONFIG_CARDBUS
524 if (skt->state & SOCKET_CARDBUS) {
525 cb_alloc(skt);
526 skt->state |= SOCKET_CARDBUS_CONFIG;
527 }
528#endif
d50dbec3 529 dev_dbg(&skt->dev, "insert done\n");
9e86749c 530 mutex_unlock(&skt->ops_mutex);
1da177e4
LT
531
532 send_event(skt, CS_EVENT_CARD_INSERTION, CS_EVENT_PRI_LOW);
533 } else {
9e86749c 534 mutex_unlock(&skt->ops_mutex);
1da177e4 535 socket_shutdown(skt);
1da177e4
LT
536 }
537
538 return ret;
539}
540
541static int socket_suspend(struct pcmcia_socket *skt)
542{
543 if (skt->state & SOCKET_SUSPEND)
f958095e 544 return -EBUSY;
1da177e4 545
9e86749c 546 mutex_lock(&skt->ops_mutex);
88b060d6
DB
547 skt->suspended_state = skt->state;
548
1da177e4
LT
549 send_event(skt, CS_EVENT_PM_SUSPEND, CS_EVENT_PRI_LOW);
550 skt->socket = dead_socket;
551 skt->ops->set_socket(skt, &skt->socket);
552 if (skt->ops->suspend)
553 skt->ops->suspend(skt);
554 skt->state |= SOCKET_SUSPEND;
9e86749c 555 mutex_unlock(&skt->ops_mutex);
4c89e88b 556 return 0;
1da177e4
LT
557}
558
9905d1b4 559static int socket_early_resume(struct pcmcia_socket *skt)
1da177e4 560{
9e86749c 561 mutex_lock(&skt->ops_mutex);
1da177e4
LT
562 skt->socket = dead_socket;
563 skt->ops->init(skt);
564 skt->ops->set_socket(skt, &skt->socket);
9905d1b4
RW
565 if (skt->state & SOCKET_PRESENT)
566 skt->resume_status = socket_setup(skt, resume_delay);
9e86749c 567 mutex_unlock(&skt->ops_mutex);
9905d1b4
RW
568 return 0;
569}
1da177e4 570
9905d1b4
RW
571static int socket_late_resume(struct pcmcia_socket *skt)
572{
9e86749c 573 mutex_lock(&skt->ops_mutex);
88b060d6 574 skt->state &= ~SOCKET_SUSPEND;
9e86749c 575 mutex_unlock(&skt->ops_mutex);
88b060d6
DB
576
577 if (!(skt->state & SOCKET_PRESENT))
1da177e4 578 return socket_insert(skt);
88b060d6
DB
579
580 if (skt->resume_status) {
581 socket_shutdown(skt);
582 return 0;
1da177e4
LT
583 }
584
88b060d6
DB
585 if (skt->suspended_state != skt->state) {
586 dev_dbg(&skt->dev,
587 "suspend state 0x%x != resume state 0x%x\n",
588 skt->suspended_state, skt->state);
589
1da177e4 590 socket_shutdown(skt);
88b060d6 591 return socket_insert(skt);
1da177e4
LT
592 }
593
88b060d6
DB
594#ifdef CONFIG_CARDBUS
595 if (skt->state & SOCKET_CARDBUS) {
596 /* We can't be sure the CardBus card is the same
597 * as the one previously inserted. Therefore, remove
598 * and re-add... */
599 cb_free(skt);
600 cb_alloc(skt);
601 return 0;
602 }
603#endif
1da177e4 604
88b060d6 605 send_event(skt, CS_EVENT_PM_RESUME, CS_EVENT_PRI_LOW);
4c89e88b 606 return 0;
1da177e4
LT
607}
608
9905d1b4
RW
609/*
610 * Resume a socket. If a card is present, verify its CIS against
611 * our cached copy. If they are different, the card has been
612 * replaced, and we need to tell the drivers.
613 */
614static int socket_resume(struct pcmcia_socket *skt)
615{
616 if (!(skt->state & SOCKET_SUSPEND))
617 return -EBUSY;
618
619 socket_early_resume(skt);
620 return socket_late_resume(skt);
621}
622
1da177e4
LT
623static void socket_remove(struct pcmcia_socket *skt)
624{
2e55bf6b
DB
625 dev_printk(KERN_NOTICE, &skt->dev,
626 "pccard: card ejected from slot %d\n", skt->sock);
1da177e4 627 socket_shutdown(skt);
1da177e4
LT
628}
629
630/*
631 * Process a socket card detect status change.
632 *
633 * If we don't have a card already present, delay the detect event for
634 * about 20ms (to be on the safe side) before reading the socket status.
635 *
636 * Some i82365-based systems send multiple SS_DETECT events during card
637 * insertion, and the "card present" status bit seems to bounce. This
638 * will probably be true with GPIO-based card detection systems after
639 * the product has aged.
640 */
641static void socket_detect_change(struct pcmcia_socket *skt)
642{
643 if (!(skt->state & SOCKET_SUSPEND)) {
644 int status;
645
646 if (!(skt->state & SOCKET_PRESENT))
647 msleep(20);
648
649 skt->ops->get_status(skt, &status);
650 if ((skt->state & SOCKET_PRESENT) &&
651 !(status & SS_DETECT))
652 socket_remove(skt);
653 if (!(skt->state & SOCKET_PRESENT) &&
654 (status & SS_DETECT))
655 socket_insert(skt);
656 }
657}
658
659static int pccardd(void *__skt)
660{
661 struct pcmcia_socket *skt = __skt;
1da177e4
LT
662 int ret;
663
1da177e4
LT
664 skt->thread = current;
665 skt->socket = dead_socket;
666 skt->ops->init(skt);
667 skt->ops->set_socket(skt, &skt->socket);
668
669 /* register with the device core */
87373318 670 ret = device_register(&skt->dev);
1da177e4 671 if (ret) {
2e55bf6b
DB
672 dev_printk(KERN_WARNING, &skt->dev,
673 "PCMCIA: unable to register socket\n");
1da177e4 674 skt->thread = NULL;
1da9ab73
SH
675 complete(&skt->thread_done);
676 return 0;
1da177e4 677 }
4356d73d
DB
678 ret = pccard_sysfs_add_socket(&skt->dev);
679 if (ret)
680 dev_warn(&skt->dev, "err %d adding socket attributes\n", ret);
1da177e4 681
bf4de6f2
DR
682 complete(&skt->thread_done);
683
83144186 684 set_freezable();
1da177e4
LT
685 for (;;) {
686 unsigned long flags;
687 unsigned int events;
f971dbd5 688 unsigned int sysfs_events;
1da177e4
LT
689
690 set_current_state(TASK_INTERRUPTIBLE);
691
692 spin_lock_irqsave(&skt->thread_lock, flags);
693 events = skt->thread_events;
694 skt->thread_events = 0;
f971dbd5
DB
695 sysfs_events = skt->sysfs_events;
696 skt->sysfs_events = 0;
1da177e4
LT
697 spin_unlock_irqrestore(&skt->thread_lock, flags);
698
f971dbd5 699 mutex_lock(&skt->skt_mutex);
1da177e4 700 if (events) {
1da177e4
LT
701 if (events & SS_DETECT)
702 socket_detect_change(skt);
703 if (events & SS_BATDEAD)
704 send_event(skt, CS_EVENT_BATTERY_DEAD, CS_EVENT_PRI_LOW);
705 if (events & SS_BATWARN)
706 send_event(skt, CS_EVENT_BATTERY_LOW, CS_EVENT_PRI_LOW);
707 if (events & SS_READY)
708 send_event(skt, CS_EVENT_READY_CHANGE, CS_EVENT_PRI_LOW);
1da177e4
LT
709 }
710
f971dbd5
DB
711 if (sysfs_events) {
712 if (sysfs_events & PCMCIA_UEVENT_EJECT)
713 socket_remove(skt);
714 if (sysfs_events & PCMCIA_UEVENT_INSERT)
715 socket_insert(skt);
716 if ((sysfs_events & PCMCIA_UEVENT_RESUME) &&
717 !(skt->state & SOCKET_CARDBUS)) {
718 ret = socket_resume(skt);
719 if (!ret && skt->callback)
720 skt->callback->resume(skt);
721 }
722 if ((sysfs_events & PCMCIA_UEVENT_SUSPEND) &&
723 !(skt->state & SOCKET_CARDBUS)) {
724 if (skt->callback)
725 ret = skt->callback->suspend(skt);
726 else
727 ret = 0;
728 if (!ret)
729 socket_suspend(skt);
730 }
af461fc1
DB
731 if ((sysfs_events & PCMCIA_UEVENT_REQUERY) &&
732 !(skt->state & SOCKET_CARDBUS)) {
733 if (!ret && skt->callback)
734 skt->callback->requery(skt);
735 }
f971dbd5
DB
736 }
737 mutex_unlock(&skt->skt_mutex);
738
739 if (events || sysfs_events)
740 continue;
741
1da9ab73 742 if (kthread_should_stop())
1da177e4 743 break;
bf4de6f2
DR
744
745 schedule();
746 try_to_freeze();
1da177e4 747 }
220ec029
SR
748 /* make sure we are running before we exit */
749 set_current_state(TASK_RUNNING);
750
3970dd8c
DB
751 /* shut down socket, if a device is still present */
752 if (skt->state & SOCKET_PRESENT) {
753 mutex_lock(&skt->skt_mutex);
754 socket_remove(skt);
755 mutex_unlock(&skt->skt_mutex);
756 }
757
1da177e4 758 /* remove from the device core */
4356d73d 759 pccard_sysfs_remove_socket(&skt->dev);
87373318 760 device_unregister(&skt->dev);
1da177e4 761
1da9ab73 762 return 0;
1da177e4
LT
763}
764
765/*
766 * Yenta (at least) probes interrupts before registering the socket and
767 * starting the handler thread.
768 */
769void pcmcia_parse_events(struct pcmcia_socket *s, u_int events)
770{
4b7a89a3 771 unsigned long flags;
d50dbec3 772 dev_dbg(&s->dev, "parse_events: events %08x\n", events);
1da177e4 773 if (s->thread) {
4b7a89a3 774 spin_lock_irqsave(&s->thread_lock, flags);
1da177e4 775 s->thread_events |= events;
4b7a89a3 776 spin_unlock_irqrestore(&s->thread_lock, flags);
1da177e4 777
0b402094 778 wake_up_process(s->thread);
1da177e4
LT
779 }
780} /* pcmcia_parse_events */
33519ddd 781EXPORT_SYMBOL(pcmcia_parse_events);
1da177e4 782
f971dbd5
DB
783/**
784 * pcmcia_parse_uevents() - tell pccardd to issue manual commands
785 * @s: the PCMCIA socket we wan't to command
786 * @events: events to pass to pccardd
787 *
788 * userspace-issued insert, eject, suspend and resume commands must be
789 * handled by pccardd to avoid any sysfs-related deadlocks. Valid events
790 * are PCMCIA_UEVENT_EJECT (for eject), PCMCIA_UEVENT__INSERT (for insert),
af461fc1
DB
791 * PCMCIA_UEVENT_RESUME (for resume), PCMCIA_UEVENT_SUSPEND (for suspend)
792 * and PCMCIA_UEVENT_REQUERY (for re-querying the PCMCIA card).
f971dbd5
DB
793 */
794void pcmcia_parse_uevents(struct pcmcia_socket *s, u_int events)
795{
796 unsigned long flags;
797 dev_dbg(&s->dev, "parse_uevents: events %08x\n", events);
798 if (s->thread) {
799 spin_lock_irqsave(&s->thread_lock, flags);
800 s->sysfs_events |= events;
801 spin_unlock_irqrestore(&s->thread_lock, flags);
802
803 wake_up_process(s->thread);
804 }
805}
806EXPORT_SYMBOL(pcmcia_parse_uevents);
807
1da177e4
LT
808
809/* register pcmcia_callback */
810int pccard_register_pcmcia(struct pcmcia_socket *s, struct pcmcia_callback *c)
811{
9fea84f4 812 int ret = 0;
1da177e4 813
7fe908dd
DB
814 /* s->skt_mutex also protects s->callback */
815 mutex_lock(&s->skt_mutex);
1da177e4
LT
816
817 if (c) {
818 /* registration */
819 if (s->callback) {
820 ret = -EBUSY;
821 goto err;
822 }
823
824 s->callback = c;
825
826 if ((s->state & (SOCKET_PRESENT|SOCKET_CARDBUS)) == SOCKET_PRESENT)
827 send_event(s, CS_EVENT_CARD_INSERTION, CS_EVENT_PRI_LOW);
828 } else
829 s->callback = NULL;
830 err:
7fe908dd 831 mutex_unlock(&s->skt_mutex);
1da177e4
LT
832
833 return ret;
834}
835EXPORT_SYMBOL(pccard_register_pcmcia);
836
1da177e4 837
33519ddd
DB
838/* I'm not sure which "reset" function this is supposed to use,
839 * but for now, it uses the low-level interface's reset, not the
840 * CIS register.
841 */
1da177e4 842
994917f8 843int pcmcia_reset_card(struct pcmcia_socket *skt)
1da177e4
LT
844{
845 int ret;
33519ddd 846
d50dbec3 847 dev_dbg(&skt->dev, "resetting socket\n");
1da177e4 848
7fe908dd 849 mutex_lock(&skt->skt_mutex);
1da177e4
LT
850 do {
851 if (!(skt->state & SOCKET_PRESENT)) {
6d9a299f 852 dev_dbg(&skt->dev, "can't reset, not present\n");
3939c1ef 853 ret = -ENODEV;
1da177e4
LT
854 break;
855 }
856 if (skt->state & SOCKET_SUSPEND) {
6d9a299f 857 dev_dbg(&skt->dev, "can't reset, suspended\n");
f958095e 858 ret = -EBUSY;
1da177e4
LT
859 break;
860 }
861 if (skt->state & SOCKET_CARDBUS) {
6d9a299f 862 dev_dbg(&skt->dev, "can't reset, is cardbus\n");
de6405e9 863 ret = -EPERM;
1da177e4
LT
864 break;
865 }
866
867 ret = send_event(skt, CS_EVENT_RESET_REQUEST, CS_EVENT_PRI_LOW);
868 if (ret == 0) {
869 send_event(skt, CS_EVENT_RESET_PHYSICAL, CS_EVENT_PRI_LOW);
8e9e793d
DB
870 if (skt->callback)
871 skt->callback->suspend(skt);
9e86749c
DB
872 mutex_lock(&skt->ops_mutex);
873 ret = socket_reset(skt);
874 mutex_unlock(&skt->ops_mutex);
875 if (ret == 0) {
1da177e4 876 send_event(skt, CS_EVENT_CARD_RESET, CS_EVENT_PRI_LOW);
8e9e793d
DB
877 if (skt->callback)
878 skt->callback->resume(skt);
879 }
1da177e4
LT
880 }
881
4c89e88b 882 ret = 0;
1da177e4 883 } while (0);
7fe908dd 884 mutex_unlock(&skt->skt_mutex);
1da177e4
LT
885
886 return ret;
887} /* reset_card */
994917f8 888EXPORT_SYMBOL(pcmcia_reset_card);
1da177e4 889
1da177e4 890
7eff2e7a
KS
891static int pcmcia_socket_uevent(struct device *dev,
892 struct kobj_uevent_env *env)
3ee13937
DB
893{
894 struct pcmcia_socket *s = container_of(dev, struct pcmcia_socket, dev);
3ee13937 895
7eff2e7a 896 if (add_uevent_var(env, "SOCKET_NO=%u", s->sock))
3ee13937
DB
897 return -ENOMEM;
898
3ee13937
DB
899 return 0;
900}
901
1da177e4 902
378a33a6
DB
903static struct completion pcmcia_unload;
904
905static void pcmcia_release_socket_class(struct class *data)
906{
907 complete(&pcmcia_unload);
908}
909
910
1da177e4
LT
911struct class pcmcia_socket_class = {
912 .name = "pcmcia_socket",
87373318
GKH
913 .dev_uevent = pcmcia_socket_uevent,
914 .dev_release = pcmcia_release_socket,
378a33a6 915 .class_release = pcmcia_release_socket_class,
1da177e4
LT
916};
917EXPORT_SYMBOL(pcmcia_socket_class);
918
919
920static int __init init_pcmcia_cs(void)
921{
378a33a6 922 init_completion(&pcmcia_unload);
4356d73d 923 return class_register(&pcmcia_socket_class);
1da177e4
LT
924}
925
926static void __exit exit_pcmcia_cs(void)
927{
33519ddd 928 class_unregister(&pcmcia_socket_class);
378a33a6 929 wait_for_completion(&pcmcia_unload);
1da177e4
LT
930}
931
932subsys_initcall(init_pcmcia_cs);
933module_exit(exit_pcmcia_cs);
934