USB: gadgetfs behaves better on userspace init bug
[linux-2.6] / drivers / mmc / wbsd.c
1 /*
2  *  linux/drivers/mmc/wbsd.c - Winbond W83L51xD SD/MMC driver
3  *
4  *  Copyright (C) 2004-2006 Pierre Ossman, All Rights Reserved.
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or (at
9  * your option) any later version.
10  *
11  *
12  * Warning!
13  *
14  * Changes to the FIFO system should be done with extreme care since
15  * the hardware is full of bugs related to the FIFO. Known issues are:
16  *
17  * - FIFO size field in FSR is always zero.
18  *
19  * - FIFO interrupts tend not to work as they should. Interrupts are
20  *   triggered only for full/empty events, not for threshold values.
21  *
22  * - On APIC systems the FIFO empty interrupt is sometimes lost.
23  */
24
25 #include <linux/module.h>
26 #include <linux/moduleparam.h>
27 #include <linux/init.h>
28 #include <linux/ioport.h>
29 #include <linux/platform_device.h>
30 #include <linux/interrupt.h>
31 #include <linux/dma-mapping.h>
32 #include <linux/delay.h>
33 #include <linux/pnp.h>
34 #include <linux/highmem.h>
35 #include <linux/mmc/host.h>
36 #include <linux/mmc/protocol.h>
37
38 #include <asm/io.h>
39 #include <asm/dma.h>
40 #include <asm/scatterlist.h>
41
42 #include "wbsd.h"
43
44 #define DRIVER_NAME "wbsd"
45 #define DRIVER_VERSION "1.6"
46
47 #define DBG(x...) \
48         pr_debug(DRIVER_NAME ": " x)
49 #define DBGF(f, x...) \
50         pr_debug(DRIVER_NAME " [%s()]: " f, __func__ , ##x)
51
52 /*
53  * Device resources
54  */
55
56 #ifdef CONFIG_PNP
57
58 static const struct pnp_device_id pnp_dev_table[] = {
59         { "WEC0517", 0 },
60         { "WEC0518", 0 },
61         { "", 0 },
62 };
63
64 MODULE_DEVICE_TABLE(pnp, pnp_dev_table);
65
66 #endif /* CONFIG_PNP */
67
68 static const int config_ports[] = { 0x2E, 0x4E };
69 static const int unlock_codes[] = { 0x83, 0x87 };
70
71 static const int valid_ids[] = {
72         0x7112,
73         };
74
75 #ifdef CONFIG_PNP
76 static unsigned int nopnp = 0;
77 #else
78 static const unsigned int nopnp = 1;
79 #endif
80 static unsigned int io = 0x248;
81 static unsigned int irq = 6;
82 static int dma = 2;
83
84 /*
85  * Basic functions
86  */
87
88 static inline void wbsd_unlock_config(struct wbsd_host *host)
89 {
90         BUG_ON(host->config == 0);
91
92         outb(host->unlock_code, host->config);
93         outb(host->unlock_code, host->config);
94 }
95
96 static inline void wbsd_lock_config(struct wbsd_host *host)
97 {
98         BUG_ON(host->config == 0);
99
100         outb(LOCK_CODE, host->config);
101 }
102
103 static inline void wbsd_write_config(struct wbsd_host *host, u8 reg, u8 value)
104 {
105         BUG_ON(host->config == 0);
106
107         outb(reg, host->config);
108         outb(value, host->config + 1);
109 }
110
111 static inline u8 wbsd_read_config(struct wbsd_host *host, u8 reg)
112 {
113         BUG_ON(host->config == 0);
114
115         outb(reg, host->config);
116         return inb(host->config + 1);
117 }
118
119 static inline void wbsd_write_index(struct wbsd_host *host, u8 index, u8 value)
120 {
121         outb(index, host->base + WBSD_IDXR);
122         outb(value, host->base + WBSD_DATAR);
123 }
124
125 static inline u8 wbsd_read_index(struct wbsd_host *host, u8 index)
126 {
127         outb(index, host->base + WBSD_IDXR);
128         return inb(host->base + WBSD_DATAR);
129 }
130
131 /*
132  * Common routines
133  */
134
135 static void wbsd_init_device(struct wbsd_host *host)
136 {
137         u8 setup, ier;
138
139         /*
140          * Reset chip (SD/MMC part) and fifo.
141          */
142         setup = wbsd_read_index(host, WBSD_IDX_SETUP);
143         setup |= WBSD_FIFO_RESET | WBSD_SOFT_RESET;
144         wbsd_write_index(host, WBSD_IDX_SETUP, setup);
145
146         /*
147          * Set DAT3 to input
148          */
149         setup &= ~WBSD_DAT3_H;
150         wbsd_write_index(host, WBSD_IDX_SETUP, setup);
151         host->flags &= ~WBSD_FIGNORE_DETECT;
152
153         /*
154          * Read back default clock.
155          */
156         host->clk = wbsd_read_index(host, WBSD_IDX_CLK);
157
158         /*
159          * Power down port.
160          */
161         outb(WBSD_POWER_N, host->base + WBSD_CSR);
162
163         /*
164          * Set maximum timeout.
165          */
166         wbsd_write_index(host, WBSD_IDX_TAAC, 0x7F);
167
168         /*
169          * Test for card presence
170          */
171         if (inb(host->base + WBSD_CSR) & WBSD_CARDPRESENT)
172                 host->flags |= WBSD_FCARD_PRESENT;
173         else
174                 host->flags &= ~WBSD_FCARD_PRESENT;
175
176         /*
177          * Enable interesting interrupts.
178          */
179         ier = 0;
180         ier |= WBSD_EINT_CARD;
181         ier |= WBSD_EINT_FIFO_THRE;
182         ier |= WBSD_EINT_CCRC;
183         ier |= WBSD_EINT_TIMEOUT;
184         ier |= WBSD_EINT_CRC;
185         ier |= WBSD_EINT_TC;
186
187         outb(ier, host->base + WBSD_EIR);
188
189         /*
190          * Clear interrupts.
191          */
192         inb(host->base + WBSD_ISR);
193 }
194
195 static void wbsd_reset(struct wbsd_host *host)
196 {
197         u8 setup;
198
199         printk(KERN_ERR "%s: Resetting chip\n", mmc_hostname(host->mmc));
200
201         /*
202          * Soft reset of chip (SD/MMC part).
203          */
204         setup = wbsd_read_index(host, WBSD_IDX_SETUP);
205         setup |= WBSD_SOFT_RESET;
206         wbsd_write_index(host, WBSD_IDX_SETUP, setup);
207 }
208
209 static void wbsd_request_end(struct wbsd_host *host, struct mmc_request *mrq)
210 {
211         unsigned long dmaflags;
212
213         DBGF("Ending request, cmd (%x)\n", mrq->cmd->opcode);
214
215         if (host->dma >= 0) {
216                 /*
217                  * Release ISA DMA controller.
218                  */
219                 dmaflags = claim_dma_lock();
220                 disable_dma(host->dma);
221                 clear_dma_ff(host->dma);
222                 release_dma_lock(dmaflags);
223
224                 /*
225                  * Disable DMA on host.
226                  */
227                 wbsd_write_index(host, WBSD_IDX_DMA, 0);
228         }
229
230         host->mrq = NULL;
231
232         /*
233          * MMC layer might call back into the driver so first unlock.
234          */
235         spin_unlock(&host->lock);
236         mmc_request_done(host->mmc, mrq);
237         spin_lock(&host->lock);
238 }
239
240 /*
241  * Scatter/gather functions
242  */
243
244 static inline void wbsd_init_sg(struct wbsd_host *host, struct mmc_data *data)
245 {
246         /*
247          * Get info. about SG list from data structure.
248          */
249         host->cur_sg = data->sg;
250         host->num_sg = data->sg_len;
251
252         host->offset = 0;
253         host->remain = host->cur_sg->length;
254 }
255
256 static inline int wbsd_next_sg(struct wbsd_host *host)
257 {
258         /*
259          * Skip to next SG entry.
260          */
261         host->cur_sg++;
262         host->num_sg--;
263
264         /*
265          * Any entries left?
266          */
267         if (host->num_sg > 0) {
268                 host->offset = 0;
269                 host->remain = host->cur_sg->length;
270         }
271
272         return host->num_sg;
273 }
274
275 static inline char *wbsd_sg_to_buffer(struct wbsd_host *host)
276 {
277         return page_address(host->cur_sg->page) + host->cur_sg->offset;
278 }
279
280 static inline void wbsd_sg_to_dma(struct wbsd_host *host, struct mmc_data *data)
281 {
282         unsigned int len, i, size;
283         struct scatterlist *sg;
284         char *dmabuf = host->dma_buffer;
285         char *sgbuf;
286
287         size = host->size;
288
289         sg = data->sg;
290         len = data->sg_len;
291
292         /*
293          * Just loop through all entries. Size might not
294          * be the entire list though so make sure that
295          * we do not transfer too much.
296          */
297         for (i = 0; i < len; i++) {
298                 sgbuf = page_address(sg[i].page) + sg[i].offset;
299                 if (size < sg[i].length)
300                         memcpy(dmabuf, sgbuf, size);
301                 else
302                         memcpy(dmabuf, sgbuf, sg[i].length);
303                 dmabuf += sg[i].length;
304
305                 if (size < sg[i].length)
306                         size = 0;
307                 else
308                         size -= sg[i].length;
309
310                 if (size == 0)
311                         break;
312         }
313
314         /*
315          * Check that we didn't get a request to transfer
316          * more data than can fit into the SG list.
317          */
318
319         BUG_ON(size != 0);
320
321         host->size -= size;
322 }
323
324 static inline void wbsd_dma_to_sg(struct wbsd_host *host, struct mmc_data *data)
325 {
326         unsigned int len, i, size;
327         struct scatterlist *sg;
328         char *dmabuf = host->dma_buffer;
329         char *sgbuf;
330
331         size = host->size;
332
333         sg = data->sg;
334         len = data->sg_len;
335
336         /*
337          * Just loop through all entries. Size might not
338          * be the entire list though so make sure that
339          * we do not transfer too much.
340          */
341         for (i = 0; i < len; i++) {
342                 sgbuf = page_address(sg[i].page) + sg[i].offset;
343                 if (size < sg[i].length)
344                         memcpy(sgbuf, dmabuf, size);
345                 else
346                         memcpy(sgbuf, dmabuf, sg[i].length);
347                 kunmap_atomic(sgbuf, KM_BIO_SRC_IRQ);
348                 dmabuf += sg[i].length;
349
350                 if (size < sg[i].length)
351                         size = 0;
352                 else
353                         size -= sg[i].length;
354
355                 if (size == 0)
356                         break;
357         }
358
359         /*
360          * Check that we didn't get a request to transfer
361          * more data than can fit into the SG list.
362          */
363
364         BUG_ON(size != 0);
365
366         host->size -= size;
367 }
368
369 /*
370  * Command handling
371  */
372
373 static inline void wbsd_get_short_reply(struct wbsd_host *host,
374                                         struct mmc_command *cmd)
375 {
376         /*
377          * Correct response type?
378          */
379         if (wbsd_read_index(host, WBSD_IDX_RSPLEN) != WBSD_RSP_SHORT) {
380                 cmd->error = MMC_ERR_INVALID;
381                 return;
382         }
383
384         cmd->resp[0]  = wbsd_read_index(host, WBSD_IDX_RESP12) << 24;
385         cmd->resp[0] |= wbsd_read_index(host, WBSD_IDX_RESP13) << 16;
386         cmd->resp[0] |= wbsd_read_index(host, WBSD_IDX_RESP14) << 8;
387         cmd->resp[0] |= wbsd_read_index(host, WBSD_IDX_RESP15) << 0;
388         cmd->resp[1]  = wbsd_read_index(host, WBSD_IDX_RESP16) << 24;
389 }
390
391 static inline void wbsd_get_long_reply(struct wbsd_host *host,
392         struct mmc_command *cmd)
393 {
394         int i;
395
396         /*
397          * Correct response type?
398          */
399         if (wbsd_read_index(host, WBSD_IDX_RSPLEN) != WBSD_RSP_LONG) {
400                 cmd->error = MMC_ERR_INVALID;
401                 return;
402         }
403
404         for (i = 0; i < 4; i++) {
405                 cmd->resp[i] =
406                         wbsd_read_index(host, WBSD_IDX_RESP1 + i * 4) << 24;
407                 cmd->resp[i] |=
408                         wbsd_read_index(host, WBSD_IDX_RESP2 + i * 4) << 16;
409                 cmd->resp[i] |=
410                         wbsd_read_index(host, WBSD_IDX_RESP3 + i * 4) << 8;
411                 cmd->resp[i] |=
412                         wbsd_read_index(host, WBSD_IDX_RESP4 + i * 4) << 0;
413         }
414 }
415
416 static void wbsd_send_command(struct wbsd_host *host, struct mmc_command *cmd)
417 {
418         int i;
419         u8 status, isr;
420
421         DBGF("Sending cmd (%x)\n", cmd->opcode);
422
423         /*
424          * Clear accumulated ISR. The interrupt routine
425          * will fill this one with events that occur during
426          * transfer.
427          */
428         host->isr = 0;
429
430         /*
431          * Send the command (CRC calculated by host).
432          */
433         outb(cmd->opcode, host->base + WBSD_CMDR);
434         for (i = 3; i >= 0; i--)
435                 outb((cmd->arg >> (i * 8)) & 0xff, host->base + WBSD_CMDR);
436
437         cmd->error = MMC_ERR_NONE;
438
439         /*
440          * Wait for the request to complete.
441          */
442         do {
443                 status = wbsd_read_index(host, WBSD_IDX_STATUS);
444         } while (status & WBSD_CARDTRAFFIC);
445
446         /*
447          * Do we expect a reply?
448          */
449         if (cmd->flags & MMC_RSP_PRESENT) {
450                 /*
451                  * Read back status.
452                  */
453                 isr = host->isr;
454
455                 /* Card removed? */
456                 if (isr & WBSD_INT_CARD)
457                         cmd->error = MMC_ERR_TIMEOUT;
458                 /* Timeout? */
459                 else if (isr & WBSD_INT_TIMEOUT)
460                         cmd->error = MMC_ERR_TIMEOUT;
461                 /* CRC? */
462                 else if ((cmd->flags & MMC_RSP_CRC) && (isr & WBSD_INT_CRC))
463                         cmd->error = MMC_ERR_BADCRC;
464                 /* All ok */
465                 else {
466                         if (cmd->flags & MMC_RSP_136)
467                                 wbsd_get_long_reply(host, cmd);
468                         else
469                                 wbsd_get_short_reply(host, cmd);
470                 }
471         }
472
473         DBGF("Sent cmd (%x), res %d\n", cmd->opcode, cmd->error);
474 }
475
476 /*
477  * Data functions
478  */
479
480 static void wbsd_empty_fifo(struct wbsd_host *host)
481 {
482         struct mmc_data *data = host->mrq->cmd->data;
483         char *buffer;
484         int i, fsr, fifo;
485
486         /*
487          * Handle excessive data.
488          */
489         if (data->bytes_xfered == host->size)
490                 return;
491
492         buffer = wbsd_sg_to_buffer(host) + host->offset;
493
494         /*
495          * Drain the fifo. This has a tendency to loop longer
496          * than the FIFO length (usually one block).
497          */
498         while (!((fsr = inb(host->base + WBSD_FSR)) & WBSD_FIFO_EMPTY)) {
499                 /*
500                  * The size field in the FSR is broken so we have to
501                  * do some guessing.
502                  */
503                 if (fsr & WBSD_FIFO_FULL)
504                         fifo = 16;
505                 else if (fsr & WBSD_FIFO_FUTHRE)
506                         fifo = 8;
507                 else
508                         fifo = 1;
509
510                 for (i = 0; i < fifo; i++) {
511                         *buffer = inb(host->base + WBSD_DFR);
512                         buffer++;
513                         host->offset++;
514                         host->remain--;
515
516                         data->bytes_xfered++;
517
518                         /*
519                          * Transfer done?
520                          */
521                         if (data->bytes_xfered == host->size)
522                                 return;
523
524                         /*
525                          * End of scatter list entry?
526                          */
527                         if (host->remain == 0) {
528                                 /*
529                                  * Get next entry. Check if last.
530                                  */
531                                 if (!wbsd_next_sg(host)) {
532                                         /*
533                                          * We should never reach this point.
534                                          * It means that we're trying to
535                                          * transfer more blocks than can fit
536                                          * into the scatter list.
537                                          */
538                                         BUG_ON(1);
539
540                                         host->size = data->bytes_xfered;
541
542                                         return;
543                                 }
544
545                                 buffer = wbsd_sg_to_buffer(host);
546                         }
547                 }
548         }
549
550         /*
551          * This is a very dirty hack to solve a
552          * hardware problem. The chip doesn't trigger
553          * FIFO threshold interrupts properly.
554          */
555         if ((host->size - data->bytes_xfered) < 16)
556                 tasklet_schedule(&host->fifo_tasklet);
557 }
558
559 static void wbsd_fill_fifo(struct wbsd_host *host)
560 {
561         struct mmc_data *data = host->mrq->cmd->data;
562         char *buffer;
563         int i, fsr, fifo;
564
565         /*
566          * Check that we aren't being called after the
567          * entire buffer has been transfered.
568          */
569         if (data->bytes_xfered == host->size)
570                 return;
571
572         buffer = wbsd_sg_to_buffer(host) + host->offset;
573
574         /*
575          * Fill the fifo. This has a tendency to loop longer
576          * than the FIFO length (usually one block).
577          */
578         while (!((fsr = inb(host->base + WBSD_FSR)) & WBSD_FIFO_FULL)) {
579                 /*
580                  * The size field in the FSR is broken so we have to
581                  * do some guessing.
582                  */
583                 if (fsr & WBSD_FIFO_EMPTY)
584                         fifo = 0;
585                 else if (fsr & WBSD_FIFO_EMTHRE)
586                         fifo = 8;
587                 else
588                         fifo = 15;
589
590                 for (i = 16; i > fifo; i--) {
591                         outb(*buffer, host->base + WBSD_DFR);
592                         buffer++;
593                         host->offset++;
594                         host->remain--;
595
596                         data->bytes_xfered++;
597
598                         /*
599                          * Transfer done?
600                          */
601                         if (data->bytes_xfered == host->size)
602                                 return;
603
604                         /*
605                          * End of scatter list entry?
606                          */
607                         if (host->remain == 0) {
608                                 /*
609                                  * Get next entry. Check if last.
610                                  */
611                                 if (!wbsd_next_sg(host)) {
612                                         /*
613                                          * We should never reach this point.
614                                          * It means that we're trying to
615                                          * transfer more blocks than can fit
616                                          * into the scatter list.
617                                          */
618                                         BUG_ON(1);
619
620                                         host->size = data->bytes_xfered;
621
622                                         return;
623                                 }
624
625                                 buffer = wbsd_sg_to_buffer(host);
626                         }
627                 }
628         }
629
630         /*
631          * The controller stops sending interrupts for
632          * 'FIFO empty' under certain conditions. So we
633          * need to be a bit more pro-active.
634          */
635         tasklet_schedule(&host->fifo_tasklet);
636 }
637
638 static void wbsd_prepare_data(struct wbsd_host *host, struct mmc_data *data)
639 {
640         u16 blksize;
641         u8 setup;
642         unsigned long dmaflags;
643
644         DBGF("blksz %04x blks %04x flags %08x\n",
645                 data->blksz, data->blocks, data->flags);
646         DBGF("tsac %d ms nsac %d clk\n",
647                 data->timeout_ns / 1000000, data->timeout_clks);
648
649         /*
650          * Calculate size.
651          */
652         host->size = data->blocks * data->blksz;
653
654         /*
655          * Check timeout values for overflow.
656          * (Yes, some cards cause this value to overflow).
657          */
658         if (data->timeout_ns > 127000000)
659                 wbsd_write_index(host, WBSD_IDX_TAAC, 127);
660         else {
661                 wbsd_write_index(host, WBSD_IDX_TAAC,
662                         data->timeout_ns / 1000000);
663         }
664
665         if (data->timeout_clks > 255)
666                 wbsd_write_index(host, WBSD_IDX_NSAC, 255);
667         else
668                 wbsd_write_index(host, WBSD_IDX_NSAC, data->timeout_clks);
669
670         /*
671          * Inform the chip of how large blocks will be
672          * sent. It needs this to determine when to
673          * calculate CRC.
674          *
675          * Space for CRC must be included in the size.
676          * Two bytes are needed for each data line.
677          */
678         if (host->bus_width == MMC_BUS_WIDTH_1) {
679                 blksize = data->blksz + 2;
680
681                 wbsd_write_index(host, WBSD_IDX_PBSMSB, (blksize >> 4) & 0xF0);
682                 wbsd_write_index(host, WBSD_IDX_PBSLSB, blksize & 0xFF);
683         } else if (host->bus_width == MMC_BUS_WIDTH_4) {
684                 blksize = data->blksz + 2 * 4;
685
686                 wbsd_write_index(host, WBSD_IDX_PBSMSB,
687                         ((blksize >> 4) & 0xF0) | WBSD_DATA_WIDTH);
688                 wbsd_write_index(host, WBSD_IDX_PBSLSB, blksize & 0xFF);
689         } else {
690                 data->error = MMC_ERR_INVALID;
691                 return;
692         }
693
694         /*
695          * Clear the FIFO. This is needed even for DMA
696          * transfers since the chip still uses the FIFO
697          * internally.
698          */
699         setup = wbsd_read_index(host, WBSD_IDX_SETUP);
700         setup |= WBSD_FIFO_RESET;
701         wbsd_write_index(host, WBSD_IDX_SETUP, setup);
702
703         /*
704          * DMA transfer?
705          */
706         if (host->dma >= 0) {
707                 /*
708                  * The buffer for DMA is only 64 kB.
709                  */
710                 BUG_ON(host->size > 0x10000);
711                 if (host->size > 0x10000) {
712                         data->error = MMC_ERR_INVALID;
713                         return;
714                 }
715
716                 /*
717                  * Transfer data from the SG list to
718                  * the DMA buffer.
719                  */
720                 if (data->flags & MMC_DATA_WRITE)
721                         wbsd_sg_to_dma(host, data);
722
723                 /*
724                  * Initialise the ISA DMA controller.
725                  */
726                 dmaflags = claim_dma_lock();
727                 disable_dma(host->dma);
728                 clear_dma_ff(host->dma);
729                 if (data->flags & MMC_DATA_READ)
730                         set_dma_mode(host->dma, DMA_MODE_READ & ~0x40);
731                 else
732                         set_dma_mode(host->dma, DMA_MODE_WRITE & ~0x40);
733                 set_dma_addr(host->dma, host->dma_addr);
734                 set_dma_count(host->dma, host->size);
735
736                 enable_dma(host->dma);
737                 release_dma_lock(dmaflags);
738
739                 /*
740                  * Enable DMA on the host.
741                  */
742                 wbsd_write_index(host, WBSD_IDX_DMA, WBSD_DMA_ENABLE);
743         } else {
744                 /*
745                  * This flag is used to keep printk
746                  * output to a minimum.
747                  */
748                 host->firsterr = 1;
749
750                 /*
751                  * Initialise the SG list.
752                  */
753                 wbsd_init_sg(host, data);
754
755                 /*
756                  * Turn off DMA.
757                  */
758                 wbsd_write_index(host, WBSD_IDX_DMA, 0);
759
760                 /*
761                  * Set up FIFO threshold levels (and fill
762                  * buffer if doing a write).
763                  */
764                 if (data->flags & MMC_DATA_READ) {
765                         wbsd_write_index(host, WBSD_IDX_FIFOEN,
766                                 WBSD_FIFOEN_FULL | 8);
767                 } else {
768                         wbsd_write_index(host, WBSD_IDX_FIFOEN,
769                                 WBSD_FIFOEN_EMPTY | 8);
770                         wbsd_fill_fifo(host);
771                 }
772         }
773
774         data->error = MMC_ERR_NONE;
775 }
776
777 static void wbsd_finish_data(struct wbsd_host *host, struct mmc_data *data)
778 {
779         unsigned long dmaflags;
780         int count;
781         u8 status;
782
783         WARN_ON(host->mrq == NULL);
784
785         /*
786          * Send a stop command if needed.
787          */
788         if (data->stop)
789                 wbsd_send_command(host, data->stop);
790
791         /*
792          * Wait for the controller to leave data
793          * transfer state.
794          */
795         do {
796                 status = wbsd_read_index(host, WBSD_IDX_STATUS);
797         } while (status & (WBSD_BLOCK_READ | WBSD_BLOCK_WRITE));
798
799         /*
800          * DMA transfer?
801          */
802         if (host->dma >= 0) {
803                 /*
804                  * Disable DMA on the host.
805                  */
806                 wbsd_write_index(host, WBSD_IDX_DMA, 0);
807
808                 /*
809                  * Turn of ISA DMA controller.
810                  */
811                 dmaflags = claim_dma_lock();
812                 disable_dma(host->dma);
813                 clear_dma_ff(host->dma);
814                 count = get_dma_residue(host->dma);
815                 release_dma_lock(dmaflags);
816
817                 /*
818                  * Any leftover data?
819                  */
820                 if (count) {
821                         printk(KERN_ERR "%s: Incomplete DMA transfer. "
822                                 "%d bytes left.\n",
823                                 mmc_hostname(host->mmc), count);
824
825                         data->error = MMC_ERR_FAILED;
826                 } else {
827                         /*
828                          * Transfer data from DMA buffer to
829                          * SG list.
830                          */
831                         if (data->flags & MMC_DATA_READ)
832                                 wbsd_dma_to_sg(host, data);
833
834                         data->bytes_xfered = host->size;
835                 }
836         }
837
838         DBGF("Ending data transfer (%d bytes)\n", data->bytes_xfered);
839
840         wbsd_request_end(host, host->mrq);
841 }
842
843 /*****************************************************************************\
844  *                                                                           *
845  * MMC layer callbacks                                                       *
846  *                                                                           *
847 \*****************************************************************************/
848
849 static void wbsd_request(struct mmc_host *mmc, struct mmc_request *mrq)
850 {
851         struct wbsd_host *host = mmc_priv(mmc);
852         struct mmc_command *cmd;
853
854         /*
855          * Disable tasklets to avoid a deadlock.
856          */
857         spin_lock_bh(&host->lock);
858
859         BUG_ON(host->mrq != NULL);
860
861         cmd = mrq->cmd;
862
863         host->mrq = mrq;
864
865         /*
866          * If there is no card in the slot then
867          * timeout immediatly.
868          */
869         if (!(host->flags & WBSD_FCARD_PRESENT)) {
870                 cmd->error = MMC_ERR_TIMEOUT;
871                 goto done;
872         }
873
874         /*
875          * Does the request include data?
876          */
877         if (cmd->data) {
878                 wbsd_prepare_data(host, cmd->data);
879
880                 if (cmd->data->error != MMC_ERR_NONE)
881                         goto done;
882         }
883
884         wbsd_send_command(host, cmd);
885
886         /*
887          * If this is a data transfer the request
888          * will be finished after the data has
889          * transfered.
890          */
891         if (cmd->data && (cmd->error == MMC_ERR_NONE)) {
892                 /*
893                  * The hardware is so delightfully stupid that it has a list
894                  * of "data" commands. If a command isn't on this list, it'll
895                  * just go back to the idle state and won't send any data
896                  * interrupts.
897                  */
898                 switch (cmd->opcode) {
899                 case 11:
900                 case 17:
901                 case 18:
902                 case 20:
903                 case 24:
904                 case 25:
905                 case 26:
906                 case 27:
907                 case 30:
908                 case 42:
909                 case 56:
910                         break;
911
912                 /* ACMDs. We don't keep track of state, so we just treat them
913                  * like any other command. */
914                 case 51:
915                         break;
916
917                 default:
918 #ifdef CONFIG_MMC_DEBUG
919                         printk(KERN_WARNING "%s: Data command %d is not "
920                                 "supported by this controller.\n",
921                                 mmc_hostname(host->mmc), cmd->opcode);
922 #endif
923                         cmd->data->error = MMC_ERR_INVALID;
924
925                         if (cmd->data->stop)
926                                 wbsd_send_command(host, cmd->data->stop);
927
928                         goto done;
929                 };
930
931                 /*
932                  * Dirty fix for hardware bug.
933                  */
934                 if (host->dma == -1)
935                         tasklet_schedule(&host->fifo_tasklet);
936
937                 spin_unlock_bh(&host->lock);
938
939                 return;
940         }
941
942 done:
943         wbsd_request_end(host, mrq);
944
945         spin_unlock_bh(&host->lock);
946 }
947
948 static void wbsd_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
949 {
950         struct wbsd_host *host = mmc_priv(mmc);
951         u8 clk, setup, pwr;
952
953         spin_lock_bh(&host->lock);
954
955         /*
956          * Reset the chip on each power off.
957          * Should clear out any weird states.
958          */
959         if (ios->power_mode == MMC_POWER_OFF)
960                 wbsd_init_device(host);
961
962         if (ios->clock >= 24000000)
963                 clk = WBSD_CLK_24M;
964         else if (ios->clock >= 16000000)
965                 clk = WBSD_CLK_16M;
966         else if (ios->clock >= 12000000)
967                 clk = WBSD_CLK_12M;
968         else
969                 clk = WBSD_CLK_375K;
970
971         /*
972          * Only write to the clock register when
973          * there is an actual change.
974          */
975         if (clk != host->clk) {
976                 wbsd_write_index(host, WBSD_IDX_CLK, clk);
977                 host->clk = clk;
978         }
979
980         /*
981          * Power up card.
982          */
983         if (ios->power_mode != MMC_POWER_OFF) {
984                 pwr = inb(host->base + WBSD_CSR);
985                 pwr &= ~WBSD_POWER_N;
986                 outb(pwr, host->base + WBSD_CSR);
987         }
988
989         /*
990          * MMC cards need to have pin 1 high during init.
991          * It wreaks havoc with the card detection though so
992          * that needs to be disabled.
993          */
994         setup = wbsd_read_index(host, WBSD_IDX_SETUP);
995         if (ios->chip_select == MMC_CS_HIGH) {
996                 BUG_ON(ios->bus_width != MMC_BUS_WIDTH_1);
997                 setup |= WBSD_DAT3_H;
998                 host->flags |= WBSD_FIGNORE_DETECT;
999         } else {
1000                 if (setup & WBSD_DAT3_H) {
1001                         setup &= ~WBSD_DAT3_H;
1002
1003                         /*
1004                          * We cannot resume card detection immediatly
1005                          * because of capacitance and delays in the chip.
1006                          */
1007                         mod_timer(&host->ignore_timer, jiffies + HZ / 100);
1008                 }
1009         }
1010         wbsd_write_index(host, WBSD_IDX_SETUP, setup);
1011
1012         /*
1013          * Store bus width for later. Will be used when
1014          * setting up the data transfer.
1015          */
1016         host->bus_width = ios->bus_width;
1017
1018         spin_unlock_bh(&host->lock);
1019 }
1020
1021 static int wbsd_get_ro(struct mmc_host *mmc)
1022 {
1023         struct wbsd_host *host = mmc_priv(mmc);
1024         u8 csr;
1025
1026         spin_lock_bh(&host->lock);
1027
1028         csr = inb(host->base + WBSD_CSR);
1029         csr |= WBSD_MSLED;
1030         outb(csr, host->base + WBSD_CSR);
1031
1032         mdelay(1);
1033
1034         csr = inb(host->base + WBSD_CSR);
1035         csr &= ~WBSD_MSLED;
1036         outb(csr, host->base + WBSD_CSR);
1037
1038         spin_unlock_bh(&host->lock);
1039
1040         return csr & WBSD_WRPT;
1041 }
1042
1043 static const struct mmc_host_ops wbsd_ops = {
1044         .request        = wbsd_request,
1045         .set_ios        = wbsd_set_ios,
1046         .get_ro         = wbsd_get_ro,
1047 };
1048
1049 /*****************************************************************************\
1050  *                                                                           *
1051  * Interrupt handling                                                        *
1052  *                                                                           *
1053 \*****************************************************************************/
1054
1055 /*
1056  * Helper function to reset detection ignore
1057  */
1058
1059 static void wbsd_reset_ignore(unsigned long data)
1060 {
1061         struct wbsd_host *host = (struct wbsd_host *)data;
1062
1063         BUG_ON(host == NULL);
1064
1065         DBG("Resetting card detection ignore\n");
1066
1067         spin_lock_bh(&host->lock);
1068
1069         host->flags &= ~WBSD_FIGNORE_DETECT;
1070
1071         /*
1072          * Card status might have changed during the
1073          * blackout.
1074          */
1075         tasklet_schedule(&host->card_tasklet);
1076
1077         spin_unlock_bh(&host->lock);
1078 }
1079
1080 /*
1081  * Tasklets
1082  */
1083
1084 static inline struct mmc_data *wbsd_get_data(struct wbsd_host *host)
1085 {
1086         WARN_ON(!host->mrq);
1087         if (!host->mrq)
1088                 return NULL;
1089
1090         WARN_ON(!host->mrq->cmd);
1091         if (!host->mrq->cmd)
1092                 return NULL;
1093
1094         WARN_ON(!host->mrq->cmd->data);
1095         if (!host->mrq->cmd->data)
1096                 return NULL;
1097
1098         return host->mrq->cmd->data;
1099 }
1100
1101 static void wbsd_tasklet_card(unsigned long param)
1102 {
1103         struct wbsd_host *host = (struct wbsd_host *)param;
1104         u8 csr;
1105         int delay = -1;
1106
1107         spin_lock(&host->lock);
1108
1109         if (host->flags & WBSD_FIGNORE_DETECT) {
1110                 spin_unlock(&host->lock);
1111                 return;
1112         }
1113
1114         csr = inb(host->base + WBSD_CSR);
1115         WARN_ON(csr == 0xff);
1116
1117         if (csr & WBSD_CARDPRESENT) {
1118                 if (!(host->flags & WBSD_FCARD_PRESENT)) {
1119                         DBG("Card inserted\n");
1120                         host->flags |= WBSD_FCARD_PRESENT;
1121
1122                         delay = 500;
1123                 }
1124         } else if (host->flags & WBSD_FCARD_PRESENT) {
1125                 DBG("Card removed\n");
1126                 host->flags &= ~WBSD_FCARD_PRESENT;
1127
1128                 if (host->mrq) {
1129                         printk(KERN_ERR "%s: Card removed during transfer!\n",
1130                                 mmc_hostname(host->mmc));
1131                         wbsd_reset(host);
1132
1133                         host->mrq->cmd->error = MMC_ERR_FAILED;
1134                         tasklet_schedule(&host->finish_tasklet);
1135                 }
1136
1137                 delay = 0;
1138         }
1139
1140         /*
1141          * Unlock first since we might get a call back.
1142          */
1143
1144         spin_unlock(&host->lock);
1145
1146         if (delay != -1)
1147                 mmc_detect_change(host->mmc, msecs_to_jiffies(delay));
1148 }
1149
1150 static void wbsd_tasklet_fifo(unsigned long param)
1151 {
1152         struct wbsd_host *host = (struct wbsd_host *)param;
1153         struct mmc_data *data;
1154
1155         spin_lock(&host->lock);
1156
1157         if (!host->mrq)
1158                 goto end;
1159
1160         data = wbsd_get_data(host);
1161         if (!data)
1162                 goto end;
1163
1164         if (data->flags & MMC_DATA_WRITE)
1165                 wbsd_fill_fifo(host);
1166         else
1167                 wbsd_empty_fifo(host);
1168
1169         /*
1170          * Done?
1171          */
1172         if (host->size == data->bytes_xfered) {
1173                 wbsd_write_index(host, WBSD_IDX_FIFOEN, 0);
1174                 tasklet_schedule(&host->finish_tasklet);
1175         }
1176
1177 end:
1178         spin_unlock(&host->lock);
1179 }
1180
1181 static void wbsd_tasklet_crc(unsigned long param)
1182 {
1183         struct wbsd_host *host = (struct wbsd_host *)param;
1184         struct mmc_data *data;
1185
1186         spin_lock(&host->lock);
1187
1188         if (!host->mrq)
1189                 goto end;
1190
1191         data = wbsd_get_data(host);
1192         if (!data)
1193                 goto end;
1194
1195         DBGF("CRC error\n");
1196
1197         data->error = MMC_ERR_BADCRC;
1198
1199         tasklet_schedule(&host->finish_tasklet);
1200
1201 end:
1202         spin_unlock(&host->lock);
1203 }
1204
1205 static void wbsd_tasklet_timeout(unsigned long param)
1206 {
1207         struct wbsd_host *host = (struct wbsd_host *)param;
1208         struct mmc_data *data;
1209
1210         spin_lock(&host->lock);
1211
1212         if (!host->mrq)
1213                 goto end;
1214
1215         data = wbsd_get_data(host);
1216         if (!data)
1217                 goto end;
1218
1219         DBGF("Timeout\n");
1220
1221         data->error = MMC_ERR_TIMEOUT;
1222
1223         tasklet_schedule(&host->finish_tasklet);
1224
1225 end:
1226         spin_unlock(&host->lock);
1227 }
1228
1229 static void wbsd_tasklet_finish(unsigned long param)
1230 {
1231         struct wbsd_host *host = (struct wbsd_host *)param;
1232         struct mmc_data *data;
1233
1234         spin_lock(&host->lock);
1235
1236         WARN_ON(!host->mrq);
1237         if (!host->mrq)
1238                 goto end;
1239
1240         data = wbsd_get_data(host);
1241         if (!data)
1242                 goto end;
1243
1244         wbsd_finish_data(host, data);
1245
1246 end:
1247         spin_unlock(&host->lock);
1248 }
1249
1250 static void wbsd_tasklet_block(unsigned long param)
1251 {
1252         struct wbsd_host *host = (struct wbsd_host *)param;
1253         struct mmc_data *data;
1254
1255         spin_lock(&host->lock);
1256
1257         if ((wbsd_read_index(host, WBSD_IDX_CRCSTATUS) & WBSD_CRC_MASK) !=
1258                 WBSD_CRC_OK) {
1259                 data = wbsd_get_data(host);
1260                 if (!data)
1261                         goto end;
1262
1263                 DBGF("CRC error\n");
1264
1265                 data->error = MMC_ERR_BADCRC;
1266
1267                 tasklet_schedule(&host->finish_tasklet);
1268         }
1269
1270 end:
1271         spin_unlock(&host->lock);
1272 }
1273
1274 /*
1275  * Interrupt handling
1276  */
1277
1278 static irqreturn_t wbsd_irq(int irq, void *dev_id)
1279 {
1280         struct wbsd_host *host = dev_id;
1281         int isr;
1282
1283         isr = inb(host->base + WBSD_ISR);
1284
1285         /*
1286          * Was it actually our hardware that caused the interrupt?
1287          */
1288         if (isr == 0xff || isr == 0x00)
1289                 return IRQ_NONE;
1290
1291         host->isr |= isr;
1292
1293         /*
1294          * Schedule tasklets as needed.
1295          */
1296         if (isr & WBSD_INT_CARD)
1297                 tasklet_schedule(&host->card_tasklet);
1298         if (isr & WBSD_INT_FIFO_THRE)
1299                 tasklet_schedule(&host->fifo_tasklet);
1300         if (isr & WBSD_INT_CRC)
1301                 tasklet_hi_schedule(&host->crc_tasklet);
1302         if (isr & WBSD_INT_TIMEOUT)
1303                 tasklet_hi_schedule(&host->timeout_tasklet);
1304         if (isr & WBSD_INT_BUSYEND)
1305                 tasklet_hi_schedule(&host->block_tasklet);
1306         if (isr & WBSD_INT_TC)
1307                 tasklet_schedule(&host->finish_tasklet);
1308
1309         return IRQ_HANDLED;
1310 }
1311
1312 /*****************************************************************************\
1313  *                                                                           *
1314  * Device initialisation and shutdown                                        *
1315  *                                                                           *
1316 \*****************************************************************************/
1317
1318 /*
1319  * Allocate/free MMC structure.
1320  */
1321
1322 static int __devinit wbsd_alloc_mmc(struct device *dev)
1323 {
1324         struct mmc_host *mmc;
1325         struct wbsd_host *host;
1326
1327         /*
1328          * Allocate MMC structure.
1329          */
1330         mmc = mmc_alloc_host(sizeof(struct wbsd_host), dev);
1331         if (!mmc)
1332                 return -ENOMEM;
1333
1334         host = mmc_priv(mmc);
1335         host->mmc = mmc;
1336
1337         host->dma = -1;
1338
1339         /*
1340          * Set host parameters.
1341          */
1342         mmc->ops = &wbsd_ops;
1343         mmc->f_min = 375000;
1344         mmc->f_max = 24000000;
1345         mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
1346         mmc->caps = MMC_CAP_4_BIT_DATA | MMC_CAP_MULTIWRITE | MMC_CAP_BYTEBLOCK;
1347
1348         spin_lock_init(&host->lock);
1349
1350         /*
1351          * Set up timers
1352          */
1353         init_timer(&host->ignore_timer);
1354         host->ignore_timer.data = (unsigned long)host;
1355         host->ignore_timer.function = wbsd_reset_ignore;
1356
1357         /*
1358          * Maximum number of segments. Worst case is one sector per segment
1359          * so this will be 64kB/512.
1360          */
1361         mmc->max_hw_segs = 128;
1362         mmc->max_phys_segs = 128;
1363
1364         /*
1365          * Maximum request size. Also limited by 64KiB buffer.
1366          */
1367         mmc->max_req_size = 65536;
1368
1369         /*
1370          * Maximum segment size. Could be one segment with the maximum number
1371          * of bytes.
1372          */
1373         mmc->max_seg_size = mmc->max_req_size;
1374
1375         /*
1376          * Maximum block size. We have 12 bits (= 4095) but have to subtract
1377          * space for CRC. So the maximum is 4095 - 4*2 = 4087.
1378          */
1379         mmc->max_blk_size = 4087;
1380
1381         /*
1382          * Maximum block count. There is no real limit so the maximum
1383          * request size will be the only restriction.
1384          */
1385         mmc->max_blk_count = mmc->max_req_size;
1386
1387         dev_set_drvdata(dev, mmc);
1388
1389         return 0;
1390 }
1391
1392 static void __devexit wbsd_free_mmc(struct device *dev)
1393 {
1394         struct mmc_host *mmc;
1395         struct wbsd_host *host;
1396
1397         mmc = dev_get_drvdata(dev);
1398         if (!mmc)
1399                 return;
1400
1401         host = mmc_priv(mmc);
1402         BUG_ON(host == NULL);
1403
1404         del_timer_sync(&host->ignore_timer);
1405
1406         mmc_free_host(mmc);
1407
1408         dev_set_drvdata(dev, NULL);
1409 }
1410
1411 /*
1412  * Scan for known chip id:s
1413  */
1414
1415 static int __devinit wbsd_scan(struct wbsd_host *host)
1416 {
1417         int i, j, k;
1418         int id;
1419
1420         /*
1421          * Iterate through all ports, all codes to
1422          * find hardware that is in our known list.
1423          */
1424         for (i = 0; i < ARRAY_SIZE(config_ports); i++) {
1425                 if (!request_region(config_ports[i], 2, DRIVER_NAME))
1426                         continue;
1427
1428                 for (j = 0; j < ARRAY_SIZE(unlock_codes); j++) {
1429                         id = 0xFFFF;
1430
1431                         host->config = config_ports[i];
1432                         host->unlock_code = unlock_codes[j];
1433
1434                         wbsd_unlock_config(host);
1435
1436                         outb(WBSD_CONF_ID_HI, config_ports[i]);
1437                         id = inb(config_ports[i] + 1) << 8;
1438
1439                         outb(WBSD_CONF_ID_LO, config_ports[i]);
1440                         id |= inb(config_ports[i] + 1);
1441
1442                         wbsd_lock_config(host);
1443
1444                         for (k = 0; k < ARRAY_SIZE(valid_ids); k++) {
1445                                 if (id == valid_ids[k]) {
1446                                         host->chip_id = id;
1447
1448                                         return 0;
1449                                 }
1450                         }
1451
1452                         if (id != 0xFFFF) {
1453                                 DBG("Unknown hardware (id %x) found at %x\n",
1454                                         id, config_ports[i]);
1455                         }
1456                 }
1457
1458                 release_region(config_ports[i], 2);
1459         }
1460
1461         host->config = 0;
1462         host->unlock_code = 0;
1463
1464         return -ENODEV;
1465 }
1466
1467 /*
1468  * Allocate/free io port ranges
1469  */
1470
1471 static int __devinit wbsd_request_region(struct wbsd_host *host, int base)
1472 {
1473         if (base & 0x7)
1474                 return -EINVAL;
1475
1476         if (!request_region(base, 8, DRIVER_NAME))
1477                 return -EIO;
1478
1479         host->base = base;
1480
1481         return 0;
1482 }
1483
1484 static void __devexit wbsd_release_regions(struct wbsd_host *host)
1485 {
1486         if (host->base)
1487                 release_region(host->base, 8);
1488
1489         host->base = 0;
1490
1491         if (host->config)
1492                 release_region(host->config, 2);
1493
1494         host->config = 0;
1495 }
1496
1497 /*
1498  * Allocate/free DMA port and buffer
1499  */
1500
1501 static void __devinit wbsd_request_dma(struct wbsd_host *host, int dma)
1502 {
1503         if (dma < 0)
1504                 return;
1505
1506         if (request_dma(dma, DRIVER_NAME))
1507                 goto err;
1508
1509         /*
1510          * We need to allocate a special buffer in
1511          * order for ISA to be able to DMA to it.
1512          */
1513         host->dma_buffer = kmalloc(WBSD_DMA_SIZE,
1514                 GFP_NOIO | GFP_DMA | __GFP_REPEAT | __GFP_NOWARN);
1515         if (!host->dma_buffer)
1516                 goto free;
1517
1518         /*
1519          * Translate the address to a physical address.
1520          */
1521         host->dma_addr = dma_map_single(mmc_dev(host->mmc), host->dma_buffer,
1522                 WBSD_DMA_SIZE, DMA_BIDIRECTIONAL);
1523
1524         /*
1525          * ISA DMA must be aligned on a 64k basis.
1526          */
1527         if ((host->dma_addr & 0xffff) != 0)
1528                 goto kfree;
1529         /*
1530          * ISA cannot access memory above 16 MB.
1531          */
1532         else if (host->dma_addr >= 0x1000000)
1533                 goto kfree;
1534
1535         host->dma = dma;
1536
1537         return;
1538
1539 kfree:
1540         /*
1541          * If we've gotten here then there is some kind of alignment bug
1542          */
1543         BUG_ON(1);
1544
1545         dma_unmap_single(mmc_dev(host->mmc), host->dma_addr,
1546                 WBSD_DMA_SIZE, DMA_BIDIRECTIONAL);
1547         host->dma_addr = (dma_addr_t)NULL;
1548
1549         kfree(host->dma_buffer);
1550         host->dma_buffer = NULL;
1551
1552 free:
1553         free_dma(dma);
1554
1555 err:
1556         printk(KERN_WARNING DRIVER_NAME ": Unable to allocate DMA %d. "
1557                 "Falling back on FIFO.\n", dma);
1558 }
1559
1560 static void __devexit wbsd_release_dma(struct wbsd_host *host)
1561 {
1562         if (host->dma_addr) {
1563                 dma_unmap_single(mmc_dev(host->mmc), host->dma_addr,
1564                         WBSD_DMA_SIZE, DMA_BIDIRECTIONAL);
1565         }
1566         kfree(host->dma_buffer);
1567         if (host->dma >= 0)
1568                 free_dma(host->dma);
1569
1570         host->dma = -1;
1571         host->dma_buffer = NULL;
1572         host->dma_addr = (dma_addr_t)NULL;
1573 }
1574
1575 /*
1576  * Allocate/free IRQ.
1577  */
1578
1579 static int __devinit wbsd_request_irq(struct wbsd_host *host, int irq)
1580 {
1581         int ret;
1582
1583         /*
1584          * Allocate interrupt.
1585          */
1586
1587         ret = request_irq(irq, wbsd_irq, IRQF_SHARED, DRIVER_NAME, host);
1588         if (ret)
1589                 return ret;
1590
1591         host->irq = irq;
1592
1593         /*
1594          * Set up tasklets.
1595          */
1596         tasklet_init(&host->card_tasklet, wbsd_tasklet_card,
1597                         (unsigned long)host);
1598         tasklet_init(&host->fifo_tasklet, wbsd_tasklet_fifo,
1599                         (unsigned long)host);
1600         tasklet_init(&host->crc_tasklet, wbsd_tasklet_crc,
1601                         (unsigned long)host);
1602         tasklet_init(&host->timeout_tasklet, wbsd_tasklet_timeout,
1603                         (unsigned long)host);
1604         tasklet_init(&host->finish_tasklet, wbsd_tasklet_finish,
1605                         (unsigned long)host);
1606         tasklet_init(&host->block_tasklet, wbsd_tasklet_block,
1607                         (unsigned long)host);
1608
1609         return 0;
1610 }
1611
1612 static void __devexit wbsd_release_irq(struct wbsd_host *host)
1613 {
1614         if (!host->irq)
1615                 return;
1616
1617         free_irq(host->irq, host);
1618
1619         host->irq = 0;
1620
1621         tasklet_kill(&host->card_tasklet);
1622         tasklet_kill(&host->fifo_tasklet);
1623         tasklet_kill(&host->crc_tasklet);
1624         tasklet_kill(&host->timeout_tasklet);
1625         tasklet_kill(&host->finish_tasklet);
1626         tasklet_kill(&host->block_tasklet);
1627 }
1628
1629 /*
1630  * Allocate all resources for the host.
1631  */
1632
1633 static int __devinit wbsd_request_resources(struct wbsd_host *host,
1634         int base, int irq, int dma)
1635 {
1636         int ret;
1637
1638         /*
1639          * Allocate I/O ports.
1640          */
1641         ret = wbsd_request_region(host, base);
1642         if (ret)
1643                 return ret;
1644
1645         /*
1646          * Allocate interrupt.
1647          */
1648         ret = wbsd_request_irq(host, irq);
1649         if (ret)
1650                 return ret;
1651
1652         /*
1653          * Allocate DMA.
1654          */
1655         wbsd_request_dma(host, dma);
1656
1657         return 0;
1658 }
1659
1660 /*
1661  * Release all resources for the host.
1662  */
1663
1664 static void __devexit wbsd_release_resources(struct wbsd_host *host)
1665 {
1666         wbsd_release_dma(host);
1667         wbsd_release_irq(host);
1668         wbsd_release_regions(host);
1669 }
1670
1671 /*
1672  * Configure the resources the chip should use.
1673  */
1674
1675 static void wbsd_chip_config(struct wbsd_host *host)
1676 {
1677         wbsd_unlock_config(host);
1678
1679         /*
1680          * Reset the chip.
1681          */
1682         wbsd_write_config(host, WBSD_CONF_SWRST, 1);
1683         wbsd_write_config(host, WBSD_CONF_SWRST, 0);
1684
1685         /*
1686          * Select SD/MMC function.
1687          */
1688         wbsd_write_config(host, WBSD_CONF_DEVICE, DEVICE_SD);
1689
1690         /*
1691          * Set up card detection.
1692          */
1693         wbsd_write_config(host, WBSD_CONF_PINS, WBSD_PINS_DETECT_GP11);
1694
1695         /*
1696          * Configure chip
1697          */
1698         wbsd_write_config(host, WBSD_CONF_PORT_HI, host->base >> 8);
1699         wbsd_write_config(host, WBSD_CONF_PORT_LO, host->base & 0xff);
1700
1701         wbsd_write_config(host, WBSD_CONF_IRQ, host->irq);
1702
1703         if (host->dma >= 0)
1704                 wbsd_write_config(host, WBSD_CONF_DRQ, host->dma);
1705
1706         /*
1707          * Enable and power up chip.
1708          */
1709         wbsd_write_config(host, WBSD_CONF_ENABLE, 1);
1710         wbsd_write_config(host, WBSD_CONF_POWER, 0x20);
1711
1712         wbsd_lock_config(host);
1713 }
1714
1715 /*
1716  * Check that configured resources are correct.
1717  */
1718
1719 static int wbsd_chip_validate(struct wbsd_host *host)
1720 {
1721         int base, irq, dma;
1722
1723         wbsd_unlock_config(host);
1724
1725         /*
1726          * Select SD/MMC function.
1727          */
1728         wbsd_write_config(host, WBSD_CONF_DEVICE, DEVICE_SD);
1729
1730         /*
1731          * Read configuration.
1732          */
1733         base = wbsd_read_config(host, WBSD_CONF_PORT_HI) << 8;
1734         base |= wbsd_read_config(host, WBSD_CONF_PORT_LO);
1735
1736         irq = wbsd_read_config(host, WBSD_CONF_IRQ);
1737
1738         dma = wbsd_read_config(host, WBSD_CONF_DRQ);
1739
1740         wbsd_lock_config(host);
1741
1742         /*
1743          * Validate against given configuration.
1744          */
1745         if (base != host->base)
1746                 return 0;
1747         if (irq != host->irq)
1748                 return 0;
1749         if ((dma != host->dma) && (host->dma != -1))
1750                 return 0;
1751
1752         return 1;
1753 }
1754
1755 /*
1756  * Powers down the SD function
1757  */
1758
1759 static void wbsd_chip_poweroff(struct wbsd_host *host)
1760 {
1761         wbsd_unlock_config(host);
1762
1763         wbsd_write_config(host, WBSD_CONF_DEVICE, DEVICE_SD);
1764         wbsd_write_config(host, WBSD_CONF_ENABLE, 0);
1765
1766         wbsd_lock_config(host);
1767 }
1768
1769 /*****************************************************************************\
1770  *                                                                           *
1771  * Devices setup and shutdown                                                *
1772  *                                                                           *
1773 \*****************************************************************************/
1774
1775 static int __devinit wbsd_init(struct device *dev, int base, int irq, int dma,
1776         int pnp)
1777 {
1778         struct wbsd_host *host = NULL;
1779         struct mmc_host *mmc = NULL;
1780         int ret;
1781
1782         ret = wbsd_alloc_mmc(dev);
1783         if (ret)
1784                 return ret;
1785
1786         mmc = dev_get_drvdata(dev);
1787         host = mmc_priv(mmc);
1788
1789         /*
1790          * Scan for hardware.
1791          */
1792         ret = wbsd_scan(host);
1793         if (ret) {
1794                 if (pnp && (ret == -ENODEV)) {
1795                         printk(KERN_WARNING DRIVER_NAME
1796                                 ": Unable to confirm device presence. You may "
1797                                 "experience lock-ups.\n");
1798                 } else {
1799                         wbsd_free_mmc(dev);
1800                         return ret;
1801                 }
1802         }
1803
1804         /*
1805          * Request resources.
1806          */
1807         ret = wbsd_request_resources(host, base, irq, dma);
1808         if (ret) {
1809                 wbsd_release_resources(host);
1810                 wbsd_free_mmc(dev);
1811                 return ret;
1812         }
1813
1814         /*
1815          * See if chip needs to be configured.
1816          */
1817         if (pnp) {
1818                 if ((host->config != 0) && !wbsd_chip_validate(host)) {
1819                         printk(KERN_WARNING DRIVER_NAME
1820                                 ": PnP active but chip not configured! "
1821                                 "You probably have a buggy BIOS. "
1822                                 "Configuring chip manually.\n");
1823                         wbsd_chip_config(host);
1824                 }
1825         } else
1826                 wbsd_chip_config(host);
1827
1828         /*
1829          * Power Management stuff. No idea how this works.
1830          * Not tested.
1831          */
1832 #ifdef CONFIG_PM
1833         if (host->config) {
1834                 wbsd_unlock_config(host);
1835                 wbsd_write_config(host, WBSD_CONF_PME, 0xA0);
1836                 wbsd_lock_config(host);
1837         }
1838 #endif
1839         /*
1840          * Allow device to initialise itself properly.
1841          */
1842         mdelay(5);
1843
1844         /*
1845          * Reset the chip into a known state.
1846          */
1847         wbsd_init_device(host);
1848
1849         mmc_add_host(mmc);
1850
1851         printk(KERN_INFO "%s: W83L51xD", mmc_hostname(mmc));
1852         if (host->chip_id != 0)
1853                 printk(" id %x", (int)host->chip_id);
1854         printk(" at 0x%x irq %d", (int)host->base, (int)host->irq);
1855         if (host->dma >= 0)
1856                 printk(" dma %d", (int)host->dma);
1857         else
1858                 printk(" FIFO");
1859         if (pnp)
1860                 printk(" PnP");
1861         printk("\n");
1862
1863         return 0;
1864 }
1865
1866 static void __devexit wbsd_shutdown(struct device *dev, int pnp)
1867 {
1868         struct mmc_host *mmc = dev_get_drvdata(dev);
1869         struct wbsd_host *host;
1870
1871         if (!mmc)
1872                 return;
1873
1874         host = mmc_priv(mmc);
1875
1876         mmc_remove_host(mmc);
1877
1878         /*
1879          * Power down the SD/MMC function.
1880          */
1881         if (!pnp)
1882                 wbsd_chip_poweroff(host);
1883
1884         wbsd_release_resources(host);
1885
1886         wbsd_free_mmc(dev);
1887 }
1888
1889 /*
1890  * Non-PnP
1891  */
1892
1893 static int __devinit wbsd_probe(struct platform_device *dev)
1894 {
1895         /* Use the module parameters for resources */
1896         return wbsd_init(&dev->dev, io, irq, dma, 0);
1897 }
1898
1899 static int __devexit wbsd_remove(struct platform_device *dev)
1900 {
1901         wbsd_shutdown(&dev->dev, 0);
1902
1903         return 0;
1904 }
1905
1906 /*
1907  * PnP
1908  */
1909
1910 #ifdef CONFIG_PNP
1911
1912 static int __devinit
1913 wbsd_pnp_probe(struct pnp_dev *pnpdev, const struct pnp_device_id *dev_id)
1914 {
1915         int io, irq, dma;
1916
1917         /*
1918          * Get resources from PnP layer.
1919          */
1920         io = pnp_port_start(pnpdev, 0);
1921         irq = pnp_irq(pnpdev, 0);
1922         if (pnp_dma_valid(pnpdev, 0))
1923                 dma = pnp_dma(pnpdev, 0);
1924         else
1925                 dma = -1;
1926
1927         DBGF("PnP resources: port %3x irq %d dma %d\n", io, irq, dma);
1928
1929         return wbsd_init(&pnpdev->dev, io, irq, dma, 1);
1930 }
1931
1932 static void __devexit wbsd_pnp_remove(struct pnp_dev *dev)
1933 {
1934         wbsd_shutdown(&dev->dev, 1);
1935 }
1936
1937 #endif /* CONFIG_PNP */
1938
1939 /*
1940  * Power management
1941  */
1942
1943 #ifdef CONFIG_PM
1944
1945 static int wbsd_suspend(struct wbsd_host *host, pm_message_t state)
1946 {
1947         BUG_ON(host == NULL);
1948
1949         return mmc_suspend_host(host->mmc, state);
1950 }
1951
1952 static int wbsd_resume(struct wbsd_host *host)
1953 {
1954         BUG_ON(host == NULL);
1955
1956         wbsd_init_device(host);
1957
1958         return mmc_resume_host(host->mmc);
1959 }
1960
1961 static int wbsd_platform_suspend(struct platform_device *dev,
1962                                  pm_message_t state)
1963 {
1964         struct mmc_host *mmc = platform_get_drvdata(dev);
1965         struct wbsd_host *host;
1966         int ret;
1967
1968         if (mmc == NULL)
1969                 return 0;
1970
1971         DBGF("Suspending...\n");
1972
1973         host = mmc_priv(mmc);
1974
1975         ret = wbsd_suspend(host, state);
1976         if (ret)
1977                 return ret;
1978
1979         wbsd_chip_poweroff(host);
1980
1981         return 0;
1982 }
1983
1984 static int wbsd_platform_resume(struct platform_device *dev)
1985 {
1986         struct mmc_host *mmc = platform_get_drvdata(dev);
1987         struct wbsd_host *host;
1988
1989         if (mmc == NULL)
1990                 return 0;
1991
1992         DBGF("Resuming...\n");
1993
1994         host = mmc_priv(mmc);
1995
1996         wbsd_chip_config(host);
1997
1998         /*
1999          * Allow device to initialise itself properly.
2000          */
2001         mdelay(5);
2002
2003         return wbsd_resume(host);
2004 }
2005
2006 #ifdef CONFIG_PNP
2007
2008 static int wbsd_pnp_suspend(struct pnp_dev *pnp_dev, pm_message_t state)
2009 {
2010         struct mmc_host *mmc = dev_get_drvdata(&pnp_dev->dev);
2011         struct wbsd_host *host;
2012
2013         if (mmc == NULL)
2014                 return 0;
2015
2016         DBGF("Suspending...\n");
2017
2018         host = mmc_priv(mmc);
2019
2020         return wbsd_suspend(host, state);
2021 }
2022
2023 static int wbsd_pnp_resume(struct pnp_dev *pnp_dev)
2024 {
2025         struct mmc_host *mmc = dev_get_drvdata(&pnp_dev->dev);
2026         struct wbsd_host *host;
2027
2028         if (mmc == NULL)
2029                 return 0;
2030
2031         DBGF("Resuming...\n");
2032
2033         host = mmc_priv(mmc);
2034
2035         /*
2036          * See if chip needs to be configured.
2037          */
2038         if (host->config != 0) {
2039                 if (!wbsd_chip_validate(host)) {
2040                         printk(KERN_WARNING DRIVER_NAME
2041                                 ": PnP active but chip not configured! "
2042                                 "You probably have a buggy BIOS. "
2043                                 "Configuring chip manually.\n");
2044                         wbsd_chip_config(host);
2045                 }
2046         }
2047
2048         /*
2049          * Allow device to initialise itself properly.
2050          */
2051         mdelay(5);
2052
2053         return wbsd_resume(host);
2054 }
2055
2056 #endif /* CONFIG_PNP */
2057
2058 #else /* CONFIG_PM */
2059
2060 #define wbsd_platform_suspend NULL
2061 #define wbsd_platform_resume NULL
2062
2063 #define wbsd_pnp_suspend NULL
2064 #define wbsd_pnp_resume NULL
2065
2066 #endif /* CONFIG_PM */
2067
2068 static struct platform_device *wbsd_device;
2069
2070 static struct platform_driver wbsd_driver = {
2071         .probe          = wbsd_probe,
2072         .remove         = __devexit_p(wbsd_remove),
2073
2074         .suspend        = wbsd_platform_suspend,
2075         .resume         = wbsd_platform_resume,
2076         .driver         = {
2077                 .name   = DRIVER_NAME,
2078         },
2079 };
2080
2081 #ifdef CONFIG_PNP
2082
2083 static struct pnp_driver wbsd_pnp_driver = {
2084         .name           = DRIVER_NAME,
2085         .id_table       = pnp_dev_table,
2086         .probe          = wbsd_pnp_probe,
2087         .remove         = __devexit_p(wbsd_pnp_remove),
2088
2089         .suspend        = wbsd_pnp_suspend,
2090         .resume         = wbsd_pnp_resume,
2091 };
2092
2093 #endif /* CONFIG_PNP */
2094
2095 /*
2096  * Module loading/unloading
2097  */
2098
2099 static int __init wbsd_drv_init(void)
2100 {
2101         int result;
2102
2103         printk(KERN_INFO DRIVER_NAME
2104                 ": Winbond W83L51xD SD/MMC card interface driver, "
2105                 DRIVER_VERSION "\n");
2106         printk(KERN_INFO DRIVER_NAME ": Copyright(c) Pierre Ossman\n");
2107
2108 #ifdef CONFIG_PNP
2109
2110         if (!nopnp) {
2111                 result = pnp_register_driver(&wbsd_pnp_driver);
2112                 if (result < 0)
2113                         return result;
2114         }
2115 #endif /* CONFIG_PNP */
2116
2117         if (nopnp) {
2118                 result = platform_driver_register(&wbsd_driver);
2119                 if (result < 0)
2120                         return result;
2121
2122                 wbsd_device = platform_device_alloc(DRIVER_NAME, -1);
2123                 if (!wbsd_device) {
2124                         platform_driver_unregister(&wbsd_driver);
2125                         return -ENOMEM;
2126                 }
2127
2128                 result = platform_device_add(wbsd_device);
2129                 if (result) {
2130                         platform_device_put(wbsd_device);
2131                         platform_driver_unregister(&wbsd_driver);
2132                         return result;
2133                 }
2134         }
2135
2136         return 0;
2137 }
2138
2139 static void __exit wbsd_drv_exit(void)
2140 {
2141 #ifdef CONFIG_PNP
2142
2143         if (!nopnp)
2144                 pnp_unregister_driver(&wbsd_pnp_driver);
2145
2146 #endif /* CONFIG_PNP */
2147
2148         if (nopnp) {
2149                 platform_device_unregister(wbsd_device);
2150
2151                 platform_driver_unregister(&wbsd_driver);
2152         }
2153
2154         DBG("unloaded\n");
2155 }
2156
2157 module_init(wbsd_drv_init);
2158 module_exit(wbsd_drv_exit);
2159 #ifdef CONFIG_PNP
2160 module_param(nopnp, uint, 0444);
2161 #endif
2162 module_param(io, uint, 0444);
2163 module_param(irq, uint, 0444);
2164 module_param(dma, int, 0444);
2165
2166 MODULE_LICENSE("GPL");
2167 MODULE_AUTHOR("Pierre Ossman <drzeus@drzeus.cx>");
2168 MODULE_DESCRIPTION("Winbond W83L51xD SD/MMC card interface driver");
2169 MODULE_VERSION(DRIVER_VERSION);
2170
2171 #ifdef CONFIG_PNP
2172 MODULE_PARM_DESC(nopnp, "Scan for device instead of relying on PNP. (default 0)");
2173 #endif
2174 MODULE_PARM_DESC(io, "I/O base to allocate. Must be 8 byte aligned. (default 0x248)");
2175 MODULE_PARM_DESC(irq, "IRQ to allocate. (default 6)");
2176 MODULE_PARM_DESC(dma, "DMA channel to allocate. -1 for no DMA. (default 2)");