2 * linux/drivers/mmc/sdhci.c - Secure Digital Host Controller Interface driver
4 * Copyright (C) 2005-2006 Pierre Ossman, All Rights Reserved.
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
11 #include <linux/delay.h>
12 #include <linux/highmem.h>
13 #include <linux/pci.h>
14 #include <linux/dma-mapping.h>
16 #include <linux/mmc/host.h>
17 #include <linux/mmc/protocol.h>
19 #include <asm/scatterlist.h>
23 #define DRIVER_NAME "sdhci"
24 #define DRIVER_VERSION "0.11"
26 #define BUGMAIL "<sdhci-devel@list.drzeus.cx>"
28 #define DBG(f, x...) \
29 pr_debug(DRIVER_NAME " [%s()]: " f, __func__,## x)
31 static const struct pci_device_id pci_ids
[] __devinitdata
= {
32 /* handle any SD host controller */
33 {PCI_DEVICE_CLASS((PCI_CLASS_SYSTEM_SDHCI
<< 8), 0xFFFF00)},
34 { /* end: all zeroes */ },
37 MODULE_DEVICE_TABLE(pci
, pci_ids
);
39 static void sdhci_prepare_data(struct sdhci_host
*, struct mmc_data
*);
40 static void sdhci_finish_data(struct sdhci_host
*);
42 static void sdhci_send_command(struct sdhci_host
*, struct mmc_command
*);
43 static void sdhci_finish_command(struct sdhci_host
*);
45 static void sdhci_dumpregs(struct sdhci_host
*host
)
47 printk(KERN_DEBUG DRIVER_NAME
": ============== REGISTER DUMP ==============\n");
49 printk(KERN_DEBUG DRIVER_NAME
": Sys addr: 0x%08x | Version: 0x%08x\n",
50 readl(host
->ioaddr
+ SDHCI_DMA_ADDRESS
),
51 readw(host
->ioaddr
+ SDHCI_HOST_VERSION
));
52 printk(KERN_DEBUG DRIVER_NAME
": Blk size: 0x%08x | Blk cnt: 0x%08x\n",
53 readw(host
->ioaddr
+ SDHCI_BLOCK_SIZE
),
54 readw(host
->ioaddr
+ SDHCI_BLOCK_COUNT
));
55 printk(KERN_DEBUG DRIVER_NAME
": Argument: 0x%08x | Trn mode: 0x%08x\n",
56 readl(host
->ioaddr
+ SDHCI_ARGUMENT
),
57 readw(host
->ioaddr
+ SDHCI_TRANSFER_MODE
));
58 printk(KERN_DEBUG DRIVER_NAME
": Present: 0x%08x | Host ctl: 0x%08x\n",
59 readl(host
->ioaddr
+ SDHCI_PRESENT_STATE
),
60 readb(host
->ioaddr
+ SDHCI_HOST_CONTROL
));
61 printk(KERN_DEBUG DRIVER_NAME
": Power: 0x%08x | Blk gap: 0x%08x\n",
62 readb(host
->ioaddr
+ SDHCI_POWER_CONTROL
),
63 readb(host
->ioaddr
+ SDHCI_BLOCK_GAP_CONTROL
));
64 printk(KERN_DEBUG DRIVER_NAME
": Wake-up: 0x%08x | Clock: 0x%08x\n",
65 readb(host
->ioaddr
+ SDHCI_WALK_UP_CONTROL
),
66 readw(host
->ioaddr
+ SDHCI_CLOCK_CONTROL
));
67 printk(KERN_DEBUG DRIVER_NAME
": Timeout: 0x%08x | Int stat: 0x%08x\n",
68 readb(host
->ioaddr
+ SDHCI_TIMEOUT_CONTROL
),
69 readl(host
->ioaddr
+ SDHCI_INT_STATUS
));
70 printk(KERN_DEBUG DRIVER_NAME
": Int enab: 0x%08x | Sig enab: 0x%08x\n",
71 readl(host
->ioaddr
+ SDHCI_INT_ENABLE
),
72 readl(host
->ioaddr
+ SDHCI_SIGNAL_ENABLE
));
73 printk(KERN_DEBUG DRIVER_NAME
": AC12 err: 0x%08x | Slot int: 0x%08x\n",
74 readw(host
->ioaddr
+ SDHCI_ACMD12_ERR
),
75 readw(host
->ioaddr
+ SDHCI_SLOT_INT_STATUS
));
76 printk(KERN_DEBUG DRIVER_NAME
": Caps: 0x%08x | Max curr: 0x%08x\n",
77 readl(host
->ioaddr
+ SDHCI_CAPABILITIES
),
78 readl(host
->ioaddr
+ SDHCI_MAX_CURRENT
));
80 printk(KERN_DEBUG DRIVER_NAME
": ===========================================\n");
83 /*****************************************************************************\
85 * Low level functions *
87 \*****************************************************************************/
89 static void sdhci_reset(struct sdhci_host
*host
, u8 mask
)
91 unsigned long timeout
;
93 writeb(mask
, host
->ioaddr
+ SDHCI_SOFTWARE_RESET
);
95 if (mask
& SDHCI_RESET_ALL
)
101 /* hw clears the bit when it's done */
102 while (readb(host
->ioaddr
+ SDHCI_SOFTWARE_RESET
) & mask
) {
104 printk(KERN_ERR
"%s: Reset 0x%x never completed. "
105 "Please report this to " BUGMAIL
".\n",
106 mmc_hostname(host
->mmc
), (int)mask
);
107 sdhci_dumpregs(host
);
115 static void sdhci_init(struct sdhci_host
*host
)
119 sdhci_reset(host
, SDHCI_RESET_ALL
);
121 intmask
= SDHCI_INT_BUS_POWER
| SDHCI_INT_DATA_END_BIT
|
122 SDHCI_INT_DATA_CRC
| SDHCI_INT_DATA_TIMEOUT
| SDHCI_INT_INDEX
|
123 SDHCI_INT_END_BIT
| SDHCI_INT_CRC
| SDHCI_INT_TIMEOUT
|
124 SDHCI_INT_CARD_REMOVE
| SDHCI_INT_CARD_INSERT
|
125 SDHCI_INT_DATA_AVAIL
| SDHCI_INT_SPACE_AVAIL
|
126 SDHCI_INT_DMA_END
| SDHCI_INT_DATA_END
| SDHCI_INT_RESPONSE
;
128 writel(intmask
, host
->ioaddr
+ SDHCI_INT_ENABLE
);
129 writel(intmask
, host
->ioaddr
+ SDHCI_SIGNAL_ENABLE
);
132 static void sdhci_activate_led(struct sdhci_host
*host
)
136 ctrl
= readb(host
->ioaddr
+ SDHCI_HOST_CONTROL
);
137 ctrl
|= SDHCI_CTRL_LED
;
138 writeb(ctrl
, host
->ioaddr
+ SDHCI_HOST_CONTROL
);
141 static void sdhci_deactivate_led(struct sdhci_host
*host
)
145 ctrl
= readb(host
->ioaddr
+ SDHCI_HOST_CONTROL
);
146 ctrl
&= ~SDHCI_CTRL_LED
;
147 writeb(ctrl
, host
->ioaddr
+ SDHCI_HOST_CONTROL
);
150 /*****************************************************************************\
154 \*****************************************************************************/
156 static inline char* sdhci_kmap_sg(struct sdhci_host
* host
)
158 host
->mapped_sg
= kmap_atomic(host
->cur_sg
->page
, KM_BIO_SRC_IRQ
);
159 return host
->mapped_sg
+ host
->cur_sg
->offset
;
162 static inline void sdhci_kunmap_sg(struct sdhci_host
* host
)
164 kunmap_atomic(host
->mapped_sg
, KM_BIO_SRC_IRQ
);
167 static inline int sdhci_next_sg(struct sdhci_host
* host
)
170 * Skip to next SG entry.
178 if (host
->num_sg
> 0) {
180 host
->remain
= host
->cur_sg
->length
;
186 static void sdhci_read_block_pio(struct sdhci_host
*host
)
188 int blksize
, chunk_remain
;
193 DBG("PIO reading\n");
195 blksize
= host
->data
->blksz
;
199 buffer
= sdhci_kmap_sg(host
) + host
->offset
;
202 if (chunk_remain
== 0) {
203 data
= readl(host
->ioaddr
+ SDHCI_BUFFER
);
204 chunk_remain
= min(blksize
, 4);
207 size
= min(host
->size
, host
->remain
);
208 size
= min(size
, chunk_remain
);
210 chunk_remain
-= size
;
212 host
->offset
+= size
;
213 host
->remain
-= size
;
216 *buffer
= data
& 0xFF;
222 if (host
->remain
== 0) {
223 sdhci_kunmap_sg(host
);
224 if (sdhci_next_sg(host
) == 0) {
225 BUG_ON(blksize
!= 0);
228 buffer
= sdhci_kmap_sg(host
);
232 sdhci_kunmap_sg(host
);
235 static void sdhci_write_block_pio(struct sdhci_host
*host
)
237 int blksize
, chunk_remain
;
242 DBG("PIO writing\n");
244 blksize
= host
->data
->blksz
;
249 buffer
= sdhci_kmap_sg(host
) + host
->offset
;
252 size
= min(host
->size
, host
->remain
);
253 size
= min(size
, chunk_remain
);
255 chunk_remain
-= size
;
257 host
->offset
+= size
;
258 host
->remain
-= size
;
262 data
|= (u32
)*buffer
<< 24;
267 if (chunk_remain
== 0) {
268 writel(data
, host
->ioaddr
+ SDHCI_BUFFER
);
269 chunk_remain
= min(blksize
, 4);
272 if (host
->remain
== 0) {
273 sdhci_kunmap_sg(host
);
274 if (sdhci_next_sg(host
) == 0) {
275 BUG_ON(blksize
!= 0);
278 buffer
= sdhci_kmap_sg(host
);
282 sdhci_kunmap_sg(host
);
285 static void sdhci_transfer_pio(struct sdhci_host
*host
)
294 if (host
->data
->flags
& MMC_DATA_READ
)
295 mask
= SDHCI_DATA_AVAILABLE
;
297 mask
= SDHCI_SPACE_AVAILABLE
;
299 while (readl(host
->ioaddr
+ SDHCI_PRESENT_STATE
) & mask
) {
300 if (host
->data
->flags
& MMC_DATA_READ
)
301 sdhci_read_block_pio(host
);
303 sdhci_write_block_pio(host
);
308 BUG_ON(host
->num_sg
== 0);
311 DBG("PIO transfer complete.\n");
314 static void sdhci_prepare_data(struct sdhci_host
*host
, struct mmc_data
*data
)
317 unsigned target_timeout
, current_timeout
;
324 DBG("blksz %04x blks %04x flags %08x\n",
325 data
->blksz
, data
->blocks
, data
->flags
);
326 DBG("tsac %d ms nsac %d clk\n",
327 data
->timeout_ns
/ 1000000, data
->timeout_clks
);
330 BUG_ON(data
->blksz
* data
->blocks
> 524288);
331 BUG_ON(data
->blksz
> host
->max_block
);
332 BUG_ON(data
->blocks
> 65535);
335 target_timeout
= data
->timeout_ns
/ 1000 +
336 data
->timeout_clks
/ host
->clock
;
339 * Figure out needed cycles.
340 * We do this in steps in order to fit inside a 32 bit int.
341 * The first step is the minimum timeout, which will have a
342 * minimum resolution of 6 bits:
343 * (1) 2^13*1000 > 2^22,
344 * (2) host->timeout_clk < 2^16
349 current_timeout
= (1 << 13) * 1000 / host
->timeout_clk
;
350 while (current_timeout
< target_timeout
) {
352 current_timeout
<<= 1;
358 printk(KERN_WARNING
"%s: Too large timeout requested!\n",
359 mmc_hostname(host
->mmc
));
363 writeb(count
, host
->ioaddr
+ SDHCI_TIMEOUT_CONTROL
);
365 if (host
->flags
& SDHCI_USE_DMA
) {
368 count
= pci_map_sg(host
->chip
->pdev
, data
->sg
, data
->sg_len
,
369 (data
->flags
& MMC_DATA_READ
)?PCI_DMA_FROMDEVICE
:PCI_DMA_TODEVICE
);
372 writel(sg_dma_address(data
->sg
), host
->ioaddr
+ SDHCI_DMA_ADDRESS
);
374 host
->size
= data
->blksz
* data
->blocks
;
376 host
->cur_sg
= data
->sg
;
377 host
->num_sg
= data
->sg_len
;
380 host
->remain
= host
->cur_sg
->length
;
383 /* We do not handle DMA boundaries, so set it to max (512 KiB) */
384 writew(SDHCI_MAKE_BLKSZ(7, data
->blksz
),
385 host
->ioaddr
+ SDHCI_BLOCK_SIZE
);
386 writew(data
->blocks
, host
->ioaddr
+ SDHCI_BLOCK_COUNT
);
389 static void sdhci_set_transfer_mode(struct sdhci_host
*host
,
390 struct mmc_data
*data
)
399 mode
= SDHCI_TRNS_BLK_CNT_EN
;
400 if (data
->blocks
> 1)
401 mode
|= SDHCI_TRNS_MULTI
;
402 if (data
->flags
& MMC_DATA_READ
)
403 mode
|= SDHCI_TRNS_READ
;
404 if (host
->flags
& SDHCI_USE_DMA
)
405 mode
|= SDHCI_TRNS_DMA
;
407 writew(mode
, host
->ioaddr
+ SDHCI_TRANSFER_MODE
);
410 static void sdhci_finish_data(struct sdhci_host
*host
)
412 struct mmc_data
*data
;
420 if (host
->flags
& SDHCI_USE_DMA
) {
421 pci_unmap_sg(host
->chip
->pdev
, data
->sg
, data
->sg_len
,
422 (data
->flags
& MMC_DATA_READ
)?PCI_DMA_FROMDEVICE
:PCI_DMA_TODEVICE
);
426 * Controller doesn't count down when in single block mode.
428 if ((data
->blocks
== 1) && (data
->error
== MMC_ERR_NONE
))
431 blocks
= readw(host
->ioaddr
+ SDHCI_BLOCK_COUNT
);
432 data
->bytes_xfered
= data
->blksz
* (data
->blocks
- blocks
);
434 if ((data
->error
== MMC_ERR_NONE
) && blocks
) {
435 printk(KERN_ERR
"%s: Controller signalled completion even "
436 "though there were blocks left. Please report this "
437 "to " BUGMAIL
".\n", mmc_hostname(host
->mmc
));
438 data
->error
= MMC_ERR_FAILED
;
441 if (host
->size
!= 0) {
442 printk(KERN_ERR
"%s: %d bytes were left untransferred. "
443 "Please report this to " BUGMAIL
".\n",
444 mmc_hostname(host
->mmc
), host
->size
);
445 data
->error
= MMC_ERR_FAILED
;
448 DBG("Ending data transfer (%d bytes)\n", data
->bytes_xfered
);
452 * The controller needs a reset of internal state machines
453 * upon error conditions.
455 if (data
->error
!= MMC_ERR_NONE
) {
456 sdhci_reset(host
, SDHCI_RESET_CMD
);
457 sdhci_reset(host
, SDHCI_RESET_DATA
);
460 sdhci_send_command(host
, data
->stop
);
462 tasklet_schedule(&host
->finish_tasklet
);
465 static void sdhci_send_command(struct sdhci_host
*host
, struct mmc_command
*cmd
)
468 unsigned long timeout
;
472 DBG("Sending cmd (%x)\n", cmd
->opcode
);
476 while (readl(host
->ioaddr
+ SDHCI_PRESENT_STATE
) &
477 (SDHCI_CMD_INHIBIT
| SDHCI_DATA_INHIBIT
)) {
479 printk(KERN_ERR
"%s: Controller never released "
480 "inhibit bits. Please report this to "
481 BUGMAIL
".\n", mmc_hostname(host
->mmc
));
482 sdhci_dumpregs(host
);
483 cmd
->error
= MMC_ERR_FAILED
;
484 tasklet_schedule(&host
->finish_tasklet
);
491 mod_timer(&host
->timer
, jiffies
+ 10 * HZ
);
495 sdhci_prepare_data(host
, cmd
->data
);
497 writel(cmd
->arg
, host
->ioaddr
+ SDHCI_ARGUMENT
);
499 sdhci_set_transfer_mode(host
, cmd
->data
);
501 if ((cmd
->flags
& MMC_RSP_136
) && (cmd
->flags
& MMC_RSP_BUSY
)) {
502 printk(KERN_ERR
"%s: Unsupported response type! "
503 "Please report this to " BUGMAIL
".\n",
504 mmc_hostname(host
->mmc
));
505 cmd
->error
= MMC_ERR_INVALID
;
506 tasklet_schedule(&host
->finish_tasklet
);
510 if (!(cmd
->flags
& MMC_RSP_PRESENT
))
511 flags
= SDHCI_CMD_RESP_NONE
;
512 else if (cmd
->flags
& MMC_RSP_136
)
513 flags
= SDHCI_CMD_RESP_LONG
;
514 else if (cmd
->flags
& MMC_RSP_BUSY
)
515 flags
= SDHCI_CMD_RESP_SHORT_BUSY
;
517 flags
= SDHCI_CMD_RESP_SHORT
;
519 if (cmd
->flags
& MMC_RSP_CRC
)
520 flags
|= SDHCI_CMD_CRC
;
521 if (cmd
->flags
& MMC_RSP_OPCODE
)
522 flags
|= SDHCI_CMD_INDEX
;
524 flags
|= SDHCI_CMD_DATA
;
526 writel(SDHCI_MAKE_CMD(cmd
->opcode
, flags
),
527 host
->ioaddr
+ SDHCI_COMMAND
);
530 static void sdhci_finish_command(struct sdhci_host
*host
)
534 BUG_ON(host
->cmd
== NULL
);
536 if (host
->cmd
->flags
& MMC_RSP_PRESENT
) {
537 if (host
->cmd
->flags
& MMC_RSP_136
) {
538 /* CRC is stripped so we need to do some shifting. */
539 for (i
= 0;i
< 4;i
++) {
540 host
->cmd
->resp
[i
] = readl(host
->ioaddr
+
541 SDHCI_RESPONSE
+ (3-i
)*4) << 8;
543 host
->cmd
->resp
[i
] |=
545 SDHCI_RESPONSE
+ (3-i
)*4-1);
548 host
->cmd
->resp
[0] = readl(host
->ioaddr
+ SDHCI_RESPONSE
);
552 host
->cmd
->error
= MMC_ERR_NONE
;
554 DBG("Ending cmd (%x)\n", host
->cmd
->opcode
);
557 host
->data
= host
->cmd
->data
;
559 tasklet_schedule(&host
->finish_tasklet
);
564 static void sdhci_set_clock(struct sdhci_host
*host
, unsigned int clock
)
568 unsigned long timeout
;
570 if (clock
== host
->clock
)
573 writew(0, host
->ioaddr
+ SDHCI_CLOCK_CONTROL
);
578 for (div
= 1;div
< 256;div
*= 2) {
579 if ((host
->max_clk
/ div
) <= clock
)
584 clk
= div
<< SDHCI_DIVIDER_SHIFT
;
585 clk
|= SDHCI_CLOCK_INT_EN
;
586 writew(clk
, host
->ioaddr
+ SDHCI_CLOCK_CONTROL
);
590 while (!((clk
= readw(host
->ioaddr
+ SDHCI_CLOCK_CONTROL
))
591 & SDHCI_CLOCK_INT_STABLE
)) {
593 printk(KERN_ERR
"%s: Internal clock never stabilised. "
594 "Please report this to " BUGMAIL
".\n",
595 mmc_hostname(host
->mmc
));
596 sdhci_dumpregs(host
);
603 clk
|= SDHCI_CLOCK_CARD_EN
;
604 writew(clk
, host
->ioaddr
+ SDHCI_CLOCK_CONTROL
);
610 static void sdhci_set_power(struct sdhci_host
*host
, unsigned short power
)
614 if (host
->power
== power
)
617 writeb(0, host
->ioaddr
+ SDHCI_POWER_CONTROL
);
619 if (power
== (unsigned short)-1)
622 pwr
= SDHCI_POWER_ON
;
628 pwr
|= SDHCI_POWER_180
;
633 pwr
|= SDHCI_POWER_300
;
638 pwr
|= SDHCI_POWER_330
;
644 writeb(pwr
, host
->ioaddr
+ SDHCI_POWER_CONTROL
);
650 /*****************************************************************************\
654 \*****************************************************************************/
656 static void sdhci_request(struct mmc_host
*mmc
, struct mmc_request
*mrq
)
658 struct sdhci_host
*host
;
661 host
= mmc_priv(mmc
);
663 spin_lock_irqsave(&host
->lock
, flags
);
665 WARN_ON(host
->mrq
!= NULL
);
667 sdhci_activate_led(host
);
671 if (!(readl(host
->ioaddr
+ SDHCI_PRESENT_STATE
) & SDHCI_CARD_PRESENT
)) {
672 host
->mrq
->cmd
->error
= MMC_ERR_TIMEOUT
;
673 tasklet_schedule(&host
->finish_tasklet
);
675 sdhci_send_command(host
, mrq
->cmd
);
677 spin_unlock_irqrestore(&host
->lock
, flags
);
680 static void sdhci_set_ios(struct mmc_host
*mmc
, struct mmc_ios
*ios
)
682 struct sdhci_host
*host
;
686 host
= mmc_priv(mmc
);
688 spin_lock_irqsave(&host
->lock
, flags
);
691 * Reset the chip on each power off.
692 * Should clear out any weird states.
694 if (ios
->power_mode
== MMC_POWER_OFF
) {
695 writel(0, host
->ioaddr
+ SDHCI_SIGNAL_ENABLE
);
699 sdhci_set_clock(host
, ios
->clock
);
701 if (ios
->power_mode
== MMC_POWER_OFF
)
702 sdhci_set_power(host
, -1);
704 sdhci_set_power(host
, ios
->vdd
);
706 ctrl
= readb(host
->ioaddr
+ SDHCI_HOST_CONTROL
);
707 if (ios
->bus_width
== MMC_BUS_WIDTH_4
)
708 ctrl
|= SDHCI_CTRL_4BITBUS
;
710 ctrl
&= ~SDHCI_CTRL_4BITBUS
;
711 writeb(ctrl
, host
->ioaddr
+ SDHCI_HOST_CONTROL
);
713 spin_unlock_irqrestore(&host
->lock
, flags
);
716 static int sdhci_get_ro(struct mmc_host
*mmc
)
718 struct sdhci_host
*host
;
722 host
= mmc_priv(mmc
);
724 spin_lock_irqsave(&host
->lock
, flags
);
726 present
= readl(host
->ioaddr
+ SDHCI_PRESENT_STATE
);
728 spin_unlock_irqrestore(&host
->lock
, flags
);
730 return !(present
& SDHCI_WRITE_PROTECT
);
733 static struct mmc_host_ops sdhci_ops
= {
734 .request
= sdhci_request
,
735 .set_ios
= sdhci_set_ios
,
736 .get_ro
= sdhci_get_ro
,
739 /*****************************************************************************\
743 \*****************************************************************************/
745 static void sdhci_tasklet_card(unsigned long param
)
747 struct sdhci_host
*host
;
750 host
= (struct sdhci_host
*)param
;
752 spin_lock_irqsave(&host
->lock
, flags
);
754 if (!(readl(host
->ioaddr
+ SDHCI_PRESENT_STATE
) & SDHCI_CARD_PRESENT
)) {
756 printk(KERN_ERR
"%s: Card removed during transfer!\n",
757 mmc_hostname(host
->mmc
));
758 printk(KERN_ERR
"%s: Resetting controller.\n",
759 mmc_hostname(host
->mmc
));
761 sdhci_reset(host
, SDHCI_RESET_CMD
);
762 sdhci_reset(host
, SDHCI_RESET_DATA
);
764 host
->mrq
->cmd
->error
= MMC_ERR_FAILED
;
765 tasklet_schedule(&host
->finish_tasklet
);
769 spin_unlock_irqrestore(&host
->lock
, flags
);
771 mmc_detect_change(host
->mmc
, msecs_to_jiffies(500));
774 static void sdhci_tasklet_finish(unsigned long param
)
776 struct sdhci_host
*host
;
778 struct mmc_request
*mrq
;
780 host
= (struct sdhci_host
*)param
;
782 spin_lock_irqsave(&host
->lock
, flags
);
784 del_timer(&host
->timer
);
788 DBG("Ending request, cmd (%x)\n", mrq
->cmd
->opcode
);
791 * The controller needs a reset of internal state machines
792 * upon error conditions.
794 if ((mrq
->cmd
->error
!= MMC_ERR_NONE
) ||
795 (mrq
->data
&& ((mrq
->data
->error
!= MMC_ERR_NONE
) ||
796 (mrq
->data
->stop
&& (mrq
->data
->stop
->error
!= MMC_ERR_NONE
))))) {
797 sdhci_reset(host
, SDHCI_RESET_CMD
);
798 sdhci_reset(host
, SDHCI_RESET_DATA
);
805 sdhci_deactivate_led(host
);
807 spin_unlock_irqrestore(&host
->lock
, flags
);
809 mmc_request_done(host
->mmc
, mrq
);
812 static void sdhci_timeout_timer(unsigned long data
)
814 struct sdhci_host
*host
;
817 host
= (struct sdhci_host
*)data
;
819 spin_lock_irqsave(&host
->lock
, flags
);
822 printk(KERN_ERR
"%s: Timeout waiting for hardware interrupt. "
823 "Please report this to " BUGMAIL
".\n",
824 mmc_hostname(host
->mmc
));
825 sdhci_dumpregs(host
);
828 host
->data
->error
= MMC_ERR_TIMEOUT
;
829 sdhci_finish_data(host
);
832 host
->cmd
->error
= MMC_ERR_TIMEOUT
;
834 host
->mrq
->cmd
->error
= MMC_ERR_TIMEOUT
;
836 tasklet_schedule(&host
->finish_tasklet
);
840 spin_unlock_irqrestore(&host
->lock
, flags
);
843 /*****************************************************************************\
845 * Interrupt handling *
847 \*****************************************************************************/
849 static void sdhci_cmd_irq(struct sdhci_host
*host
, u32 intmask
)
851 BUG_ON(intmask
== 0);
854 printk(KERN_ERR
"%s: Got command interrupt even though no "
855 "command operation was in progress.\n",
856 mmc_hostname(host
->mmc
));
857 printk(KERN_ERR
"%s: Please report this to " BUGMAIL
".\n",
858 mmc_hostname(host
->mmc
));
859 sdhci_dumpregs(host
);
863 if (intmask
& SDHCI_INT_RESPONSE
)
864 sdhci_finish_command(host
);
866 if (intmask
& SDHCI_INT_TIMEOUT
)
867 host
->cmd
->error
= MMC_ERR_TIMEOUT
;
868 else if (intmask
& SDHCI_INT_CRC
)
869 host
->cmd
->error
= MMC_ERR_BADCRC
;
870 else if (intmask
& (SDHCI_INT_END_BIT
| SDHCI_INT_INDEX
))
871 host
->cmd
->error
= MMC_ERR_FAILED
;
873 host
->cmd
->error
= MMC_ERR_INVALID
;
875 tasklet_schedule(&host
->finish_tasklet
);
879 static void sdhci_data_irq(struct sdhci_host
*host
, u32 intmask
)
881 BUG_ON(intmask
== 0);
885 * A data end interrupt is sent together with the response
886 * for the stop command.
888 if (intmask
& SDHCI_INT_DATA_END
)
891 printk(KERN_ERR
"%s: Got data interrupt even though no "
892 "data operation was in progress.\n",
893 mmc_hostname(host
->mmc
));
894 printk(KERN_ERR
"%s: Please report this to " BUGMAIL
".\n",
895 mmc_hostname(host
->mmc
));
896 sdhci_dumpregs(host
);
901 if (intmask
& SDHCI_INT_DATA_TIMEOUT
)
902 host
->data
->error
= MMC_ERR_TIMEOUT
;
903 else if (intmask
& SDHCI_INT_DATA_CRC
)
904 host
->data
->error
= MMC_ERR_BADCRC
;
905 else if (intmask
& SDHCI_INT_DATA_END_BIT
)
906 host
->data
->error
= MMC_ERR_FAILED
;
908 if (host
->data
->error
!= MMC_ERR_NONE
)
909 sdhci_finish_data(host
);
911 if (intmask
& (SDHCI_INT_DATA_AVAIL
| SDHCI_INT_SPACE_AVAIL
))
912 sdhci_transfer_pio(host
);
914 if (intmask
& SDHCI_INT_DATA_END
)
915 sdhci_finish_data(host
);
919 static irqreturn_t
sdhci_irq(int irq
, void *dev_id
, struct pt_regs
*regs
)
922 struct sdhci_host
* host
= dev_id
;
925 spin_lock(&host
->lock
);
927 intmask
= readl(host
->ioaddr
+ SDHCI_INT_STATUS
);
934 DBG("*** %s got interrupt: 0x%08x\n", host
->slot_descr
, intmask
);
936 if (intmask
& (SDHCI_INT_CARD_INSERT
| SDHCI_INT_CARD_REMOVE
)) {
937 writel(intmask
& (SDHCI_INT_CARD_INSERT
| SDHCI_INT_CARD_REMOVE
),
938 host
->ioaddr
+ SDHCI_INT_STATUS
);
939 tasklet_schedule(&host
->card_tasklet
);
942 intmask
&= ~(SDHCI_INT_CARD_INSERT
| SDHCI_INT_CARD_REMOVE
);
944 if (intmask
& SDHCI_INT_CMD_MASK
) {
945 writel(intmask
& SDHCI_INT_CMD_MASK
,
946 host
->ioaddr
+ SDHCI_INT_STATUS
);
947 sdhci_cmd_irq(host
, intmask
& SDHCI_INT_CMD_MASK
);
950 if (intmask
& SDHCI_INT_DATA_MASK
) {
951 writel(intmask
& SDHCI_INT_DATA_MASK
,
952 host
->ioaddr
+ SDHCI_INT_STATUS
);
953 sdhci_data_irq(host
, intmask
& SDHCI_INT_DATA_MASK
);
956 intmask
&= ~(SDHCI_INT_CMD_MASK
| SDHCI_INT_DATA_MASK
);
958 if (intmask
& SDHCI_INT_BUS_POWER
) {
959 printk(KERN_ERR
"%s: Card is consuming too much power!\n",
960 mmc_hostname(host
->mmc
));
961 writel(SDHCI_INT_BUS_POWER
, host
->ioaddr
+ SDHCI_INT_STATUS
);
964 intmask
&= SDHCI_INT_BUS_POWER
;
967 printk(KERN_ERR
"%s: Unexpected interrupt 0x%08x. Please "
968 "report this to " BUGMAIL
".\n",
969 mmc_hostname(host
->mmc
), intmask
);
970 sdhci_dumpregs(host
);
972 writel(intmask
, host
->ioaddr
+ SDHCI_INT_STATUS
);
975 result
= IRQ_HANDLED
;
978 spin_unlock(&host
->lock
);
983 /*****************************************************************************\
987 \*****************************************************************************/
991 static int sdhci_suspend (struct pci_dev
*pdev
, pm_message_t state
)
993 struct sdhci_chip
*chip
;
996 chip
= pci_get_drvdata(pdev
);
1000 DBG("Suspending...\n");
1002 for (i
= 0;i
< chip
->num_slots
;i
++) {
1003 if (!chip
->hosts
[i
])
1005 ret
= mmc_suspend_host(chip
->hosts
[i
]->mmc
, state
);
1007 for (i
--;i
>= 0;i
--)
1008 mmc_resume_host(chip
->hosts
[i
]->mmc
);
1013 pci_save_state(pdev
);
1014 pci_enable_wake(pdev
, pci_choose_state(pdev
, state
), 0);
1015 pci_disable_device(pdev
);
1016 pci_set_power_state(pdev
, pci_choose_state(pdev
, state
));
1021 static int sdhci_resume (struct pci_dev
*pdev
)
1023 struct sdhci_chip
*chip
;
1026 chip
= pci_get_drvdata(pdev
);
1030 DBG("Resuming...\n");
1032 pci_set_power_state(pdev
, PCI_D0
);
1033 pci_restore_state(pdev
);
1034 pci_enable_device(pdev
);
1036 for (i
= 0;i
< chip
->num_slots
;i
++) {
1037 if (!chip
->hosts
[i
])
1039 if (chip
->hosts
[i
]->flags
& SDHCI_USE_DMA
)
1040 pci_set_master(pdev
);
1041 sdhci_init(chip
->hosts
[i
]);
1042 ret
= mmc_resume_host(chip
->hosts
[i
]->mmc
);
1050 #else /* CONFIG_PM */
1052 #define sdhci_suspend NULL
1053 #define sdhci_resume NULL
1055 #endif /* CONFIG_PM */
1057 /*****************************************************************************\
1059 * Device probing/removal *
1061 \*****************************************************************************/
1063 static int __devinit
sdhci_probe_slot(struct pci_dev
*pdev
, int slot
)
1066 struct sdhci_chip
*chip
;
1067 struct mmc_host
*mmc
;
1068 struct sdhci_host
*host
;
1073 chip
= pci_get_drvdata(pdev
);
1076 ret
= pci_read_config_byte(pdev
, PCI_SLOT_INFO
, &first_bar
);
1080 first_bar
&= PCI_SLOT_INFO_FIRST_BAR_MASK
;
1082 if (first_bar
> 5) {
1083 printk(KERN_ERR DRIVER_NAME
": Invalid first BAR. Aborting.\n");
1087 if (!(pci_resource_flags(pdev
, first_bar
+ slot
) & IORESOURCE_MEM
)) {
1088 printk(KERN_ERR DRIVER_NAME
": BAR is not iomem. Aborting.\n");
1092 if (pci_resource_len(pdev
, first_bar
+ slot
) != 0x100) {
1093 printk(KERN_ERR DRIVER_NAME
": Invalid iomem size. Aborting.\n");
1097 mmc
= mmc_alloc_host(sizeof(struct sdhci_host
), &pdev
->dev
);
1101 host
= mmc_priv(mmc
);
1104 host
->bar
= first_bar
+ slot
;
1106 host
->addr
= pci_resource_start(pdev
, host
->bar
);
1107 host
->irq
= pdev
->irq
;
1109 DBG("slot %d at 0x%08lx, irq %d\n", slot
, host
->addr
, host
->irq
);
1111 snprintf(host
->slot_descr
, 20, "sdhci:slot%d", slot
);
1113 ret
= pci_request_region(pdev
, host
->bar
, host
->slot_descr
);
1117 host
->ioaddr
= ioremap_nocache(host
->addr
,
1118 pci_resource_len(pdev
, host
->bar
));
1119 if (!host
->ioaddr
) {
1124 caps
= readl(host
->ioaddr
+ SDHCI_CAPABILITIES
);
1126 if ((caps
& SDHCI_CAN_DO_DMA
) && ((pdev
->class & 0x0000FF) == 0x01))
1127 host
->flags
|= SDHCI_USE_DMA
;
1129 if (host
->flags
& SDHCI_USE_DMA
) {
1130 if (pci_set_dma_mask(pdev
, DMA_32BIT_MASK
)) {
1131 printk(KERN_WARNING
"%s: No suitable DMA available. "
1132 "Falling back to PIO.\n", host
->slot_descr
);
1133 host
->flags
&= ~SDHCI_USE_DMA
;
1137 if (host
->flags
& SDHCI_USE_DMA
)
1138 pci_set_master(pdev
);
1139 else /* XXX: Hack to get MMC layer to avoid highmem */
1143 (caps
& SDHCI_CLOCK_BASE_MASK
) >> SDHCI_CLOCK_BASE_SHIFT
;
1144 if (host
->max_clk
== 0) {
1145 printk(KERN_ERR
"%s: Hardware doesn't specify base clock "
1146 "frequency.\n", host
->slot_descr
);
1150 host
->max_clk
*= 1000000;
1153 (caps
& SDHCI_TIMEOUT_CLK_MASK
) >> SDHCI_TIMEOUT_CLK_SHIFT
;
1154 if (host
->timeout_clk
== 0) {
1155 printk(KERN_ERR
"%s: Hardware doesn't specify timeout clock "
1156 "frequency.\n", host
->slot_descr
);
1160 if (caps
& SDHCI_TIMEOUT_CLK_UNIT
)
1161 host
->timeout_clk
*= 1000;
1163 host
->max_block
= (caps
& SDHCI_MAX_BLOCK_MASK
) >> SDHCI_MAX_BLOCK_SHIFT
;
1164 if (host
->max_block
>= 3) {
1165 printk(KERN_ERR
"%s: Invalid maximum block size.\n",
1170 host
->max_block
= 512 << host
->max_block
;
1173 * Set host parameters.
1175 mmc
->ops
= &sdhci_ops
;
1176 mmc
->f_min
= host
->max_clk
/ 256;
1177 mmc
->f_max
= host
->max_clk
;
1178 mmc
->caps
= MMC_CAP_4_BIT_DATA
;
1181 if (caps
& SDHCI_CAN_VDD_330
)
1182 mmc
->ocr_avail
|= MMC_VDD_32_33
|MMC_VDD_33_34
;
1183 else if (caps
& SDHCI_CAN_VDD_300
)
1184 mmc
->ocr_avail
|= MMC_VDD_29_30
|MMC_VDD_30_31
;
1185 else if (caps
& SDHCI_CAN_VDD_180
)
1186 mmc
->ocr_avail
|= MMC_VDD_17_18
|MMC_VDD_18_19
;
1188 if (mmc
->ocr_avail
== 0) {
1189 printk(KERN_ERR
"%s: Hardware doesn't report any "
1190 "support voltages.\n", host
->slot_descr
);
1195 spin_lock_init(&host
->lock
);
1198 * Maximum number of segments. Hardware cannot do scatter lists.
1200 if (host
->flags
& SDHCI_USE_DMA
)
1201 mmc
->max_hw_segs
= 1;
1203 mmc
->max_hw_segs
= 16;
1204 mmc
->max_phys_segs
= 16;
1207 * Maximum number of sectors in one transfer. Limited by DMA boundary
1208 * size (512KiB), which means (512 KiB/512=) 1024 entries.
1210 mmc
->max_sectors
= 1024;
1213 * Maximum segment size. Could be one segment with the maximum number
1216 mmc
->max_seg_size
= mmc
->max_sectors
* 512;
1221 tasklet_init(&host
->card_tasklet
,
1222 sdhci_tasklet_card
, (unsigned long)host
);
1223 tasklet_init(&host
->finish_tasklet
,
1224 sdhci_tasklet_finish
, (unsigned long)host
);
1226 setup_timer(&host
->timer
, sdhci_timeout_timer
, (long)host
);
1228 ret
= request_irq(host
->irq
, sdhci_irq
, SA_SHIRQ
,
1229 host
->slot_descr
, host
);
1235 #ifdef CONFIG_MMC_DEBUG
1236 sdhci_dumpregs(host
);
1240 chip
->hosts
[slot
] = host
;
1244 printk(KERN_INFO
"%s: SDHCI at 0x%08lx irq %d %s\n", mmc_hostname(mmc
),
1245 host
->addr
, host
->irq
,
1246 (host
->flags
& SDHCI_USE_DMA
)?"DMA":"PIO");
1251 tasklet_kill(&host
->card_tasklet
);
1252 tasklet_kill(&host
->finish_tasklet
);
1254 iounmap(host
->ioaddr
);
1256 pci_release_region(pdev
, host
->bar
);
1263 static void sdhci_remove_slot(struct pci_dev
*pdev
, int slot
)
1265 struct sdhci_chip
*chip
;
1266 struct mmc_host
*mmc
;
1267 struct sdhci_host
*host
;
1269 chip
= pci_get_drvdata(pdev
);
1270 host
= chip
->hosts
[slot
];
1273 chip
->hosts
[slot
] = NULL
;
1275 mmc_remove_host(mmc
);
1277 sdhci_reset(host
, SDHCI_RESET_ALL
);
1279 free_irq(host
->irq
, host
);
1281 del_timer_sync(&host
->timer
);
1283 tasklet_kill(&host
->card_tasklet
);
1284 tasklet_kill(&host
->finish_tasklet
);
1286 iounmap(host
->ioaddr
);
1288 pci_release_region(pdev
, host
->bar
);
1293 static int __devinit
sdhci_probe(struct pci_dev
*pdev
,
1294 const struct pci_device_id
*ent
)
1298 struct sdhci_chip
*chip
;
1300 BUG_ON(pdev
== NULL
);
1301 BUG_ON(ent
== NULL
);
1303 pci_read_config_byte(pdev
, PCI_CLASS_REVISION
, &rev
);
1305 printk(KERN_INFO DRIVER_NAME
1306 ": SDHCI controller found at %s [%04x:%04x] (rev %x)\n",
1307 pci_name(pdev
), (int)pdev
->vendor
, (int)pdev
->device
,
1310 ret
= pci_read_config_byte(pdev
, PCI_SLOT_INFO
, &slots
);
1314 slots
= PCI_SLOT_INFO_SLOTS(slots
) + 1;
1315 DBG("found %d slot(s)\n", slots
);
1319 ret
= pci_enable_device(pdev
);
1323 chip
= kzalloc(sizeof(struct sdhci_chip
) +
1324 sizeof(struct sdhci_host
*) * slots
, GFP_KERNEL
);
1332 chip
->num_slots
= slots
;
1333 pci_set_drvdata(pdev
, chip
);
1335 for (i
= 0;i
< slots
;i
++) {
1336 ret
= sdhci_probe_slot(pdev
, i
);
1338 for (i
--;i
>= 0;i
--)
1339 sdhci_remove_slot(pdev
, i
);
1347 pci_set_drvdata(pdev
, NULL
);
1351 pci_disable_device(pdev
);
1355 static void __devexit
sdhci_remove(struct pci_dev
*pdev
)
1358 struct sdhci_chip
*chip
;
1360 chip
= pci_get_drvdata(pdev
);
1363 for (i
= 0;i
< chip
->num_slots
;i
++)
1364 sdhci_remove_slot(pdev
, i
);
1366 pci_set_drvdata(pdev
, NULL
);
1371 pci_disable_device(pdev
);
1374 static struct pci_driver sdhci_driver
= {
1375 .name
= DRIVER_NAME
,
1376 .id_table
= pci_ids
,
1377 .probe
= sdhci_probe
,
1378 .remove
= __devexit_p(sdhci_remove
),
1379 .suspend
= sdhci_suspend
,
1380 .resume
= sdhci_resume
,
1383 /*****************************************************************************\
1385 * Driver init/exit *
1387 \*****************************************************************************/
1389 static int __init
sdhci_drv_init(void)
1391 printk(KERN_INFO DRIVER_NAME
1392 ": Secure Digital Host Controller Interface driver, "
1393 DRIVER_VERSION
"\n");
1394 printk(KERN_INFO DRIVER_NAME
": Copyright(c) Pierre Ossman\n");
1396 return pci_register_driver(&sdhci_driver
);
1399 static void __exit
sdhci_drv_exit(void)
1403 pci_unregister_driver(&sdhci_driver
);
1406 module_init(sdhci_drv_init
);
1407 module_exit(sdhci_drv_exit
);
1409 MODULE_AUTHOR("Pierre Ossman <drzeus@drzeus.cx>");
1410 MODULE_DESCRIPTION("Secure Digital Host Controller Interface driver");
1411 MODULE_VERSION(DRIVER_VERSION
);
1412 MODULE_LICENSE("GPL");