Skip to content

R
raspberrypi-kernel

openeuler / raspberrypi-kernel

通知 13
Star 1
Fork 0
R
raspberrypi-kernel
提交 8542e589 编写于 作者: L Linus Torvalds
浏览文件
操作

Merge branch 'devel' of master.kernel.org:/home/rmk/linux-2.6-mmc 

* 'devel' of master.kernel.org:/home/rmk/linux-2.6-mmc:
  [ARM] 3565/1: AT91RM9200 MMC update
  [MMC] Convert all hosts except mmci to use data->blksz
上级 6f3cafce b44fb7a0
隐藏空白更改
内联 并排
Showing with 74 addition and 83 deletion
drivers/mmc/at91_mci.c
浏览文件 @ 8542e589
...@@ -81,13 +81,6 @@ ...@@ -81,13 +81,6 @@
#undef SUPPORT_4WIRE #undef SUPPORT_4WIRE
#ifdef CONFIG_MMC_DEBUG
#define DBG(fmt...) \
printk(fmt)
#else
#define DBG(fmt...) do { } while (0)
#endif
static struct clk *mci_clk; static struct clk *mci_clk;
#define FL_SENT_COMMAND (1 << 0) #define FL_SENT_COMMAND (1 << 0)
...@@ -202,50 +195,50 @@ static void at91mci_pre_dma_read(struct at91mci_host *host) ...@@ -202,50 +195,50 @@ static void at91mci_pre_dma_read(struct at91mci_host *host)
struct mmc_command *cmd; struct mmc_command *cmd;
struct mmc_data *data; struct mmc_data *data;
DBG("pre dma read\n"); pr_debug("pre dma read\n");
cmd = host->cmd; cmd = host->cmd;
if (!cmd) { if (!cmd) {
DBG("no command\n"); pr_debug("no command\n");
return; return;
} }
data = cmd->data; data = cmd->data;
if (!data) { if (!data) {
DBG("no data\n"); pr_debug("no data\n");
return; return;
} }
for (i = 0; i < 2; i++) { for (i = 0; i < 2; i++) {
/* nothing left to transfer */ /* nothing left to transfer */
if (host->transfer_index >= data->sg_len) { if (host->transfer_index >= data->sg_len) {
DBG("Nothing left to transfer (index = %d)\n", host->transfer_index); pr_debug("Nothing left to transfer (index = %d)\n", host->transfer_index);
break; break;
} }
/* Check to see if this needs filling */ /* Check to see if this needs filling */
if (i == 0) { if (i == 0) {
if (at91_mci_read(AT91_PDC_RCR) != 0) { if (at91_mci_read(AT91_PDC_RCR) != 0) {
DBG("Transfer active in current\n"); pr_debug("Transfer active in current\n");
continue; continue;
} }
} }
else { else {
if (at91_mci_read(AT91_PDC_RNCR) != 0) { if (at91_mci_read(AT91_PDC_RNCR) != 0) {
DBG("Transfer active in next\n"); pr_debug("Transfer active in next\n");
continue; continue;
} }
} }
/* Setup the next transfer */ /* Setup the next transfer */
DBG("Using transfer index %d\n", host->transfer_index); pr_debug("Using transfer index %d\n", host->transfer_index);
sg = &data->sg[host->transfer_index++]; sg = &data->sg[host->transfer_index++];
DBG("sg = %p\n", sg); pr_debug("sg = %p\n", sg);
sg->dma_address = dma_map_page(NULL, sg->page, sg->offset, sg->length, DMA_FROM_DEVICE); sg->dma_address = dma_map_page(NULL, sg->page, sg->offset, sg->length, DMA_FROM_DEVICE);
DBG("dma address = %08X, length = %d\n", sg->dma_address, sg->length); pr_debug("dma address = %08X, length = %d\n", sg->dma_address, sg->length);
if (i == 0) { if (i == 0) {
at91_mci_write(AT91_PDC_RPR, sg->dma_address); at91_mci_write(AT91_PDC_RPR, sg->dma_address);
...@@ -257,7 +250,7 @@ static void at91mci_pre_dma_read(struct at91mci_host *host) ...@@ -257,7 +250,7 @@ static void at91mci_pre_dma_read(struct at91mci_host *host)
} }
} }
DBG("pre dma read done\n"); pr_debug("pre dma read done\n");
} }
/* /*
...@@ -268,17 +261,17 @@ static void at91mci_post_dma_read(struct at91mci_host *host) ...@@ -268,17 +261,17 @@ static void at91mci_post_dma_read(struct at91mci_host *host)
struct mmc_command *cmd; struct mmc_command *cmd;
struct mmc_data *data; struct mmc_data *data;
DBG("post dma read\n"); pr_debug("post dma read\n");
cmd = host->cmd; cmd = host->cmd;
if (!cmd) { if (!cmd) {
DBG("no command\n"); pr_debug("no command\n");
return; return;
} }
data = cmd->data; data = cmd->data;
if (!data) { if (!data) {
DBG("no data\n"); pr_debug("no data\n");
return; return;
} }
...@@ -289,17 +282,17 @@ static void at91mci_post_dma_read(struct at91mci_host *host) ...@@ -289,17 +282,17 @@ static void at91mci_post_dma_read(struct at91mci_host *host)
struct scatterlist *sg; struct scatterlist *sg;
DBG("finishing index %d\n", host->in_use_index); pr_debug("finishing index %d\n", host->in_use_index);
sg = &data->sg[host->in_use_index++]; sg = &data->sg[host->in_use_index++];
DBG("Unmapping page %08X\n", sg->dma_address); pr_debug("Unmapping page %08X\n", sg->dma_address);
dma_unmap_page(NULL, sg->dma_address, sg->length, DMA_FROM_DEVICE); dma_unmap_page(NULL, sg->dma_address, sg->length, DMA_FROM_DEVICE);
/* Swap the contents of the buffer */ /* Swap the contents of the buffer */
buffer = kmap_atomic(sg->page, KM_BIO_SRC_IRQ) + sg->offset; buffer = kmap_atomic(sg->page, KM_BIO_SRC_IRQ) + sg->offset;
DBG("buffer = %p, length = %d\n", buffer, sg->length); pr_debug("buffer = %p, length = %d\n", buffer, sg->length);
data->bytes_xfered += sg->length; data->bytes_xfered += sg->length;
...@@ -320,7 +313,7 @@ static void at91mci_post_dma_read(struct at91mci_host *host) ...@@ -320,7 +313,7 @@ static void at91mci_post_dma_read(struct at91mci_host *host)
at91_mci_write(AT91_PDC_PTCR, AT91_PDC_RXTDIS | AT91_PDC_TXTDIS); at91_mci_write(AT91_PDC_PTCR, AT91_PDC_RXTDIS | AT91_PDC_TXTDIS);
} }
DBG("post dma read done\n"); pr_debug("post dma read done\n");
} }
/* /*
...@@ -331,7 +324,7 @@ static void at91_mci_handle_transmitted(struct at91mci_host *host) ...@@ -331,7 +324,7 @@ static void at91_mci_handle_transmitted(struct at91mci_host *host)
struct mmc_command *cmd; struct mmc_command *cmd;
struct mmc_data *data; struct mmc_data *data;
DBG("Handling the transmit\n"); pr_debug("Handling the transmit\n");
/* Disable the transfer */ /* Disable the transfer */
at91_mci_write(AT91_PDC_PTCR, AT91_PDC_RXTDIS | AT91_PDC_TXTDIS); at91_mci_write(AT91_PDC_PTCR, AT91_PDC_RXTDIS | AT91_PDC_TXTDIS);
...@@ -387,12 +380,12 @@ static unsigned int at91_mci_send_command(struct at91mci_host *host, struct mmc_ ...@@ -387,12 +380,12 @@ static unsigned int at91_mci_send_command(struct at91mci_host *host, struct mmc_
/* Not sure if this is needed */ /* Not sure if this is needed */
#if 0 #if 0
if ((at91_mci_read(AT91_MCI_SR) & AT91_MCI_RTOE) && (cmd->opcode == 1)) { if ((at91_mci_read(AT91_MCI_SR) & AT91_MCI_RTOE) && (cmd->opcode == 1)) {
DBG("Clearing timeout\n"); pr_debug("Clearing timeout\n");
at91_mci_write(AT91_MCI_ARGR, 0); at91_mci_write(AT91_MCI_ARGR, 0);
at91_mci_write(AT91_MCI_CMDR, AT91_MCI_OPDCMD); at91_mci_write(AT91_MCI_CMDR, AT91_MCI_OPDCMD);
while (!(at91_mci_read(AT91_MCI_SR) & AT91_MCI_CMDRDY)) { while (!(at91_mci_read(AT91_MCI_SR) & AT91_MCI_CMDRDY)) {
/* spin */ /* spin */
DBG("Clearing: SR = %08X\n", at91_mci_read(AT91_MCI_SR)); pr_debug("Clearing: SR = %08X\n", at91_mci_read(AT91_MCI_SR));
} }
} }
#endif #endif
...@@ -411,7 +404,7 @@ static unsigned int at91_mci_send_command(struct at91mci_host *host, struct mmc_ ...@@ -411,7 +404,7 @@ static unsigned int at91_mci_send_command(struct at91mci_host *host, struct mmc_
} }
if (data) { if (data) {
block_length = 1 << data->blksz_bits; block_length = data->blksz;
blocks = data->blocks; blocks = data->blocks;
/* always set data start - also set direction flag for read */ /* always set data start - also set direction flag for read */
...@@ -439,7 +432,7 @@ static unsigned int at91_mci_send_command(struct at91mci_host *host, struct mmc_ ...@@ -439,7 +432,7 @@ static unsigned int at91_mci_send_command(struct at91mci_host *host, struct mmc_
/* /*
* Set the arguments and send the command * Set the arguments and send the command
*/ */
DBG("Sending command %d as %08X, arg = %08X, blocks = %d, length = %d (MR = %08lX)\n", pr_debug("Sending command %d as %08X, arg = %08X, blocks = %d, length = %d (MR = %08lX)\n",
cmd->opcode, cmdr, cmd->arg, blocks, block_length, at91_mci_read(AT91_MCI_MR)); cmd->opcode, cmdr, cmd->arg, blocks, block_length, at91_mci_read(AT91_MCI_MR));
if (!data) { if (!data) {
...@@ -491,7 +484,7 @@ static unsigned int at91_mci_send_command(struct at91mci_host *host, struct mmc_ ...@@ -491,7 +484,7 @@ static unsigned int at91_mci_send_command(struct at91mci_host *host, struct mmc_
at91mci_sg_to_dma(host, data); at91mci_sg_to_dma(host, data);
DBG("Transmitting %d bytes\n", host->total_length); pr_debug("Transmitting %d bytes\n", host->total_length);
at91_mci_write(AT91_PDC_TPR, host->physical_address); at91_mci_write(AT91_PDC_TPR, host->physical_address);
at91_mci_write(AT91_PDC_TCR, host->total_length / 4); at91_mci_write(AT91_PDC_TCR, host->total_length / 4);
...@@ -525,7 +518,7 @@ static void at91mci_process_command(struct at91mci_host *host, struct mmc_comman ...@@ -525,7 +518,7 @@ static void at91mci_process_command(struct at91mci_host *host, struct mmc_comman
ier = at91_mci_send_command(host, cmd); ier = at91_mci_send_command(host, cmd);
DBG("setting ier to %08X\n", ier); pr_debug("setting ier to %08X\n", ier);
/* Stop on errors or the required value */ /* Stop on errors or the required value */
at91_mci_write(AT91_MCI_IER, 0xffff0000 | ier); at91_mci_write(AT91_MCI_IER, 0xffff0000 | ier);
...@@ -570,7 +563,7 @@ static void at91mci_completed_command(struct at91mci_host *host) ...@@ -570,7 +563,7 @@ static void at91mci_completed_command(struct at91mci_host *host)
status = at91_mci_read(AT91_MCI_SR); status = at91_mci_read(AT91_MCI_SR);
DBG("Status = %08X [%08X %08X %08X %08X]\n", pr_debug("Status = %08X [%08X %08X %08X %08X]\n",
status, cmd->resp[0], cmd->resp[1], cmd->resp[2], cmd->resp[3]); status, cmd->resp[0], cmd->resp[1], cmd->resp[2], cmd->resp[3]);
if (status & (AT91_MCI_RINDE | AT91_MCI_RDIRE | AT91_MCI_RCRCE | if (status & (AT91_MCI_RINDE | AT91_MCI_RDIRE | AT91_MCI_RCRCE |
...@@ -590,7 +583,7 @@ static void at91mci_completed_command(struct at91mci_host *host) ...@@ -590,7 +583,7 @@ static void at91mci_completed_command(struct at91mci_host *host)
else else
cmd->error = MMC_ERR_FAILED; cmd->error = MMC_ERR_FAILED;
DBG("Error detected and set to %d (cmd = %d, retries = %d)\n", pr_debug("Error detected and set to %d (cmd = %d, retries = %d)\n",
cmd->error, cmd->opcode, cmd->retries); cmd->error, cmd->opcode, cmd->retries);
} }
} }
...@@ -621,10 +614,7 @@ static void at91_mci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) ...@@ -621,10 +614,7 @@ static void at91_mci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
struct at91mci_host *host = mmc_priv(mmc); struct at91mci_host *host = mmc_priv(mmc);
unsigned long at91_master_clock = clk_get_rate(mci_clk); unsigned long at91_master_clock = clk_get_rate(mci_clk);
if (host) host->bus_mode = ios->bus_mode;
host->bus_mode = ios->bus_mode;
else
printk("MMC: No host for bus_mode\n");
if (ios->clock == 0) { if (ios->clock == 0) {
/* Disable the MCI controller */ /* Disable the MCI controller */
...@@ -640,15 +630,15 @@ static void at91_mci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) ...@@ -640,15 +630,15 @@ static void at91_mci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
else else
clkdiv = (at91_master_clock / ios->clock) / 2; clkdiv = (at91_master_clock / ios->clock) / 2;
DBG("clkdiv = %d. mcck = %ld\n", clkdiv, pr_debug("clkdiv = %d. mcck = %ld\n", clkdiv,
at91_master_clock / (2 * (clkdiv + 1))); at91_master_clock / (2 * (clkdiv + 1)));
} }
if (ios->bus_width == MMC_BUS_WIDTH_4 && host->board->wire4) { if (ios->bus_width == MMC_BUS_WIDTH_4 && host->board->wire4) {
DBG("MMC: Setting controller bus width to 4\n"); pr_debug("MMC: Setting controller bus width to 4\n");
at91_mci_write(AT91_MCI_SDCR, at91_mci_read(AT91_MCI_SDCR) | AT91_MCI_SDCBUS); at91_mci_write(AT91_MCI_SDCR, at91_mci_read(AT91_MCI_SDCR) | AT91_MCI_SDCBUS);
} }
else { else {
DBG("MMC: Setting controller bus width to 1\n"); pr_debug("MMC: Setting controller bus width to 1\n");
at91_mci_write(AT91_MCI_SDCR, at91_mci_read(AT91_MCI_SDCR) & ~AT91_MCI_SDCBUS); at91_mci_write(AT91_MCI_SDCR, at91_mci_read(AT91_MCI_SDCR) & ~AT91_MCI_SDCBUS);
} }
...@@ -656,7 +646,7 @@ static void at91_mci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) ...@@ -656,7 +646,7 @@ static void at91_mci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
at91_mci_write(AT91_MCI_MR, (at91_mci_read(AT91_MCI_MR) & ~AT91_MCI_CLKDIV) | clkdiv); at91_mci_write(AT91_MCI_MR, (at91_mci_read(AT91_MCI_MR) & ~AT91_MCI_CLKDIV) | clkdiv);
/* maybe switch power to the card */ /* maybe switch power to the card */
if (host && host->board->vcc_pin) { if (host->board->vcc_pin) {
switch (ios->power_mode) { switch (ios->power_mode) {
case MMC_POWER_OFF: case MMC_POWER_OFF:
at91_set_gpio_output(host->board->vcc_pin, 0); at91_set_gpio_output(host->board->vcc_pin, 0);
...@@ -679,11 +669,8 @@ static irqreturn_t at91_mci_irq(int irq, void *devid, struct pt_regs *regs) ...@@ -679,11 +669,8 @@ static irqreturn_t at91_mci_irq(int irq, void *devid, struct pt_regs *regs)
unsigned int int_status; unsigned int int_status;
if (host == NULL)
return IRQ_HANDLED;
int_status = at91_mci_read(AT91_MCI_SR); int_status = at91_mci_read(AT91_MCI_SR);
DBG("MCI irq: status = %08X, %08lX, %08lX\n", int_status, at91_mci_read(AT91_MCI_IMR), pr_debug("MCI irq: status = %08X, %08lX, %08lX\n", int_status, at91_mci_read(AT91_MCI_IMR),
int_status & at91_mci_read(AT91_MCI_IMR)); int_status & at91_mci_read(AT91_MCI_IMR));
if ((int_status & at91_mci_read(AT91_MCI_IMR)) & 0xffff0000) if ((int_status & at91_mci_read(AT91_MCI_IMR)) & 0xffff0000)
...@@ -692,75 +679,75 @@ static irqreturn_t at91_mci_irq(int irq, void *devid, struct pt_regs *regs) ...@@ -692,75 +679,75 @@ static irqreturn_t at91_mci_irq(int irq, void *devid, struct pt_regs *regs)
int_status &= at91_mci_read(AT91_MCI_IMR); int_status &= at91_mci_read(AT91_MCI_IMR);
if (int_status & AT91_MCI_UNRE) if (int_status & AT91_MCI_UNRE)
DBG("MMC: Underrun error\n"); pr_debug("MMC: Underrun error\n");
if (int_status & AT91_MCI_OVRE) if (int_status & AT91_MCI_OVRE)
DBG("MMC: Overrun error\n"); pr_debug("MMC: Overrun error\n");
if (int_status & AT91_MCI_DTOE) if (int_status & AT91_MCI_DTOE)
DBG("MMC: Data timeout\n"); pr_debug("MMC: Data timeout\n");
if (int_status & AT91_MCI_DCRCE) if (int_status & AT91_MCI_DCRCE)
DBG("MMC: CRC error in data\n"); pr_debug("MMC: CRC error in data\n");
if (int_status & AT91_MCI_RTOE) if (int_status & AT91_MCI_RTOE)
DBG("MMC: Response timeout\n"); pr_debug("MMC: Response timeout\n");
if (int_status & AT91_MCI_RENDE) if (int_status & AT91_MCI_RENDE)
DBG("MMC: Response end bit error\n"); pr_debug("MMC: Response end bit error\n");
if (int_status & AT91_MCI_RCRCE) if (int_status & AT91_MCI_RCRCE)
DBG("MMC: Response CRC error\n"); pr_debug("MMC: Response CRC error\n");
if (int_status & AT91_MCI_RDIRE) if (int_status & AT91_MCI_RDIRE)
DBG("MMC: Response direction error\n"); pr_debug("MMC: Response direction error\n");
if (int_status & AT91_MCI_RINDE) if (int_status & AT91_MCI_RINDE)
DBG("MMC: Response index error\n"); pr_debug("MMC: Response index error\n");
/* Only continue processing if no errors */ /* Only continue processing if no errors */
if (!completed) { if (!completed) {
if (int_status & AT91_MCI_TXBUFE) { if (int_status & AT91_MCI_TXBUFE) {
DBG("TX buffer empty\n"); pr_debug("TX buffer empty\n");
at91_mci_handle_transmitted(host); at91_mci_handle_transmitted(host);
} }
if (int_status & AT91_MCI_RXBUFF) { if (int_status & AT91_MCI_RXBUFF) {
DBG("RX buffer full\n"); pr_debug("RX buffer full\n");
at91_mci_write(AT91_MCI_IER, AT91_MCI_CMDRDY); at91_mci_write(AT91_MCI_IER, AT91_MCI_CMDRDY);
} }
if (int_status & AT91_MCI_ENDTX) { if (int_status & AT91_MCI_ENDTX) {
DBG("Transmit has ended\n"); pr_debug("Transmit has ended\n");
} }
if (int_status & AT91_MCI_ENDRX) { if (int_status & AT91_MCI_ENDRX) {
DBG("Receive has ended\n"); pr_debug("Receive has ended\n");
at91mci_post_dma_read(host); at91mci_post_dma_read(host);
} }
if (int_status & AT91_MCI_NOTBUSY) { if (int_status & AT91_MCI_NOTBUSY) {
DBG("Card is ready\n"); pr_debug("Card is ready\n");
at91_mci_write(AT91_MCI_IER, AT91_MCI_CMDRDY); at91_mci_write(AT91_MCI_IER, AT91_MCI_CMDRDY);
} }
if (int_status & AT91_MCI_DTIP) { if (int_status & AT91_MCI_DTIP) {
DBG("Data transfer in progress\n"); pr_debug("Data transfer in progress\n");
} }
if (int_status & AT91_MCI_BLKE) { if (int_status & AT91_MCI_BLKE) {
DBG("Block transfer has ended\n"); pr_debug("Block transfer has ended\n");
} }
if (int_status & AT91_MCI_TXRDY) { if (int_status & AT91_MCI_TXRDY) {
DBG("Ready to transmit\n"); pr_debug("Ready to transmit\n");
} }
if (int_status & AT91_MCI_RXRDY) { if (int_status & AT91_MCI_RXRDY) {
DBG("Ready to receive\n"); pr_debug("Ready to receive\n");
} }
if (int_status & AT91_MCI_CMDRDY) { if (int_status & AT91_MCI_CMDRDY) {
DBG("Command ready\n"); pr_debug("Command ready\n");
completed = 1; completed = 1;
} }
} }
at91_mci_write(AT91_MCI_IDR, int_status); at91_mci_write(AT91_MCI_IDR, int_status);
if (completed) { if (completed) {
DBG("Completed command\n"); pr_debug("Completed command\n");
at91_mci_write(AT91_MCI_IDR, 0xffffffff); at91_mci_write(AT91_MCI_IDR, 0xffffffff);
at91mci_completed_command(host); at91mci_completed_command(host);
} }
...@@ -779,10 +766,10 @@ static irqreturn_t at91_mmc_det_irq(int irq, void *_host, struct pt_regs *regs) ...@@ -779,10 +766,10 @@ static irqreturn_t at91_mmc_det_irq(int irq, void *_host, struct pt_regs *regs)
*/ */
if (present != host->present) { if (present != host->present) {
host->present = present; host->present = present;
DBG("%s: card %s\n", mmc_hostname(host->mmc), pr_debug("%s: card %s\n", mmc_hostname(host->mmc),
present ? "insert" : "remove"); present ? "insert" : "remove");
if (!present) { if (!present) {
DBG("****** Resetting SD-card bus width ******\n"); pr_debug("****** Resetting SD-card bus width ******\n");
at91_mci_write(AT91_MCI_SDCR, 0); at91_mci_write(AT91_MCI_SDCR, 0);
} }
mmc_detect_change(host->mmc, msecs_to_jiffies(100)); mmc_detect_change(host->mmc, msecs_to_jiffies(100));
...@@ -822,13 +809,13 @@ static int at91_mci_probe(struct platform_device *pdev) ...@@ -822,13 +809,13 @@ static int at91_mci_probe(struct platform_device *pdev)
struct at91mci_host *host; struct at91mci_host *host;
int ret; int ret;
DBG("Probe MCI devices\n"); pr_debug("Probe MCI devices\n");
at91_mci_disable(); at91_mci_disable();
at91_mci_enable(); at91_mci_enable();
mmc = mmc_alloc_host(sizeof(struct at91mci_host), &pdev->dev); mmc = mmc_alloc_host(sizeof(struct at91mci_host), &pdev->dev);
if (!mmc) { if (!mmc) {
DBG("Failed to allocate mmc host\n"); pr_debug("Failed to allocate mmc host\n");
return -ENOMEM; return -ENOMEM;
} }
...@@ -854,8 +841,9 @@ static int at91_mci_probe(struct platform_device *pdev) ...@@ -854,8 +841,9 @@ static int at91_mci_probe(struct platform_device *pdev)
* Get Clock * Get Clock
*/ */
mci_clk = clk_get(&pdev->dev, "mci_clk"); mci_clk = clk_get(&pdev->dev, "mci_clk");
if (!mci_clk) { if (IS_ERR(mci_clk)) {
printk(KERN_ERR "AT91 MMC: no clock defined.\n"); printk(KERN_ERR "AT91 MMC: no clock defined.\n");
mmc_free_host(mmc);
return -ENODEV; return -ENODEV;
} }
clk_enable(mci_clk); /* Enable the peripheral clock */ clk_enable(mci_clk); /* Enable the peripheral clock */
...@@ -865,7 +853,10 @@ static int at91_mci_probe(struct platform_device *pdev) ...@@ -865,7 +853,10 @@ static int at91_mci_probe(struct platform_device *pdev)
*/ */
ret = request_irq(AT91_ID_MCI, at91_mci_irq, SA_SHIRQ, DRIVER_NAME, host); ret = request_irq(AT91_ID_MCI, at91_mci_irq, SA_SHIRQ, DRIVER_NAME, host);
if (ret) { if (ret) {
DBG("Failed to request MCI interrupt\n"); printk(KERN_ERR "Failed to request MCI interrupt\n");
clk_disable(mci_clk);
clk_put(mci_clk);
mmc_free_host(mmc);
return ret; return ret;
} }
...@@ -886,12 +877,12 @@ static int at91_mci_probe(struct platform_device *pdev) ...@@ -886,12 +877,12 @@ static int at91_mci_probe(struct platform_device *pdev)
*/ */
if (host->board->det_pin) { if (host->board->det_pin) {
ret = request_irq(host->board->det_pin, at91_mmc_det_irq, ret = request_irq(host->board->det_pin, at91_mmc_det_irq,
SA_SAMPLE_RANDOM, DRIVER_NAME, host); 0, DRIVER_NAME, host);
if (ret) if (ret)
DBG("couldn't allocate MMC detect irq\n"); printk(KERN_ERR "couldn't allocate MMC detect irq\n");
} }
DBG(KERN_INFO "Added MCI driver\n"); pr_debug(KERN_INFO "Added MCI driver\n");
return 0; return 0;
} }
...@@ -924,7 +915,7 @@ static int at91_mci_remove(struct platform_device *pdev) ...@@ -924,7 +915,7 @@ static int at91_mci_remove(struct platform_device *pdev)
platform_set_drvdata(pdev, NULL); platform_set_drvdata(pdev, NULL);
DBG("Removed\n"); pr_debug("MCI Removed\n");
return 0; return 0;
} }
......
drivers/mmc/imxmmc.c
浏览文件 @ 8542e589
...@@ -228,7 +228,7 @@ static int imxmci_busy_wait_for_status(struct imxmci_host *host, ...@@ -228,7 +228,7 @@ static int imxmci_busy_wait_for_status(struct imxmci_host *host,
static void imxmci_setup_data(struct imxmci_host *host, struct mmc_data *data) static void imxmci_setup_data(struct imxmci_host *host, struct mmc_data *data)
{ {
unsigned int nob = data->blocks; unsigned int nob = data->blocks;
unsigned int blksz = 1 << data->blksz_bits; unsigned int blksz = data->blksz;
unsigned int datasz = nob * blksz; unsigned int datasz = nob * blksz;
int i; int i;
......
drivers/mmc/omap.c
浏览文件 @ 8542e589
...@@ -584,10 +584,10 @@ mmc_omap_prepare_dma(struct mmc_omap_host *host, struct mmc_data *data) ...@@ -584,10 +584,10 @@ mmc_omap_prepare_dma(struct mmc_omap_host *host, struct mmc_data *data)
int sync_dev = 0; int sync_dev = 0;
data_addr = io_v2p((u32) host->base) + OMAP_MMC_REG_DATA; data_addr = io_v2p((u32) host->base) + OMAP_MMC_REG_DATA;
frame = 1 << data->blksz_bits; frame = data->blksz;
count = sg_dma_len(sg); count = sg_dma_len(sg);
if ((data->blocks == 1) && (count > (1 << data->blksz_bits))) if ((data->blocks == 1) && (count > data->blksz))
count = frame; count = frame;
host->dma_len = count; host->dma_len = count;
...@@ -776,7 +776,7 @@ mmc_omap_prepare_data(struct mmc_omap_host *host, struct mmc_request *req) ...@@ -776,7 +776,7 @@ mmc_omap_prepare_data(struct mmc_omap_host *host, struct mmc_request *req)
} }
block_size = 1 << data->blksz_bits; block_size = data->blksz;
OMAP_MMC_WRITE(host->base, NBLK, data->blocks - 1); OMAP_MMC_WRITE(host->base, NBLK, data->blocks - 1);
OMAP_MMC_WRITE(host->base, BLEN, block_size - 1); OMAP_MMC_WRITE(host->base, BLEN, block_size - 1);
......
drivers/mmc/sdhci.c
浏览文件 @ 8542e589
...@@ -268,7 +268,7 @@ static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_data *data) ...@@ -268,7 +268,7 @@ static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_data *data)
} }
DBG("blksz %04x blks %04x flags %08x\n", DBG("blksz %04x blks %04x flags %08x\n",
1 << data->blksz_bits, data->blocks, data->flags); data->blksz, data->blocks, data->flags);
DBG("tsac %d ms nsac %d clk\n", DBG("tsac %d ms nsac %d clk\n",
data->timeout_ns / 1000000, data->timeout_clks); data->timeout_ns / 1000000, data->timeout_clks);
...@@ -282,7 +282,7 @@ static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_data *data) ...@@ -282,7 +282,7 @@ static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_data *data)
writew(mode, host->ioaddr + SDHCI_TRANSFER_MODE); writew(mode, host->ioaddr + SDHCI_TRANSFER_MODE);
writew(1 << data->blksz_bits, host->ioaddr + SDHCI_BLOCK_SIZE); writew(data->blksz, host->ioaddr + SDHCI_BLOCK_SIZE);
writew(data->blocks, host->ioaddr + SDHCI_BLOCK_COUNT); writew(data->blocks, host->ioaddr + SDHCI_BLOCK_COUNT);
if (host->flags & SDHCI_USE_DMA) { if (host->flags & SDHCI_USE_DMA) {
...@@ -294,7 +294,7 @@ static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_data *data) ...@@ -294,7 +294,7 @@ static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_data *data)
writel(sg_dma_address(data->sg), host->ioaddr + SDHCI_DMA_ADDRESS); writel(sg_dma_address(data->sg), host->ioaddr + SDHCI_DMA_ADDRESS);
} else { } else {
host->size = (1 << data->blksz_bits) * data->blocks; host->size = data->blksz * data->blocks;
host->cur_sg = data->sg; host->cur_sg = data->sg;
host->num_sg = data->sg_len; host->num_sg = data->sg_len;
...@@ -335,7 +335,7 @@ static void sdhci_finish_data(struct sdhci_host *host) ...@@ -335,7 +335,7 @@ static void sdhci_finish_data(struct sdhci_host *host)
blocks = 0; blocks = 0;
else else
blocks = readw(host->ioaddr + SDHCI_BLOCK_COUNT); blocks = readw(host->ioaddr + SDHCI_BLOCK_COUNT);
data->bytes_xfered = (1 << data->blksz_bits) * (data->blocks - blocks); data->bytes_xfered = data->blksz * (data->blocks - blocks);
if ((data->error == MMC_ERR_NONE) && blocks) { if ((data->error == MMC_ERR_NONE) && blocks) {
printk(KERN_ERR "%s: Controller signalled completion even " printk(KERN_ERR "%s: Controller signalled completion even "
......
Markdown is supported
0% 或 .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑！
想要评论请 注册 或