1 files changed, 33 insertions, 20 deletions

diff --git a/drivers/mmc/host/sdhci.c b/drivers/mmc/host/sdhci.c
index f2bc87ac24f7..20a7d89e01ba 100644
--- a/drivers/mmc/host/sdhci.c
+++ b/drivers/mmc/host/sdhci.c
@@ -385,6 +385,9 @@ static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_data *data)
         BUG_ON(data->blksz > host->mmc->max_blk_size);
         BUG_ON(data->blocks > 65535);
 
+        host->data = data;
+        host->data_early = 0;
+
         /* timeout in us */
         target_timeout = data->timeout_ns / 1000 +
                 data->timeout_clks / host->clock;
@@ -443,11 +446,11 @@ static void sdhci_set_transfer_mode(struct sdhci_host *host,
 {
         u16 mode;
 
-        WARN_ON(host->data);
-
         if (data == NULL)
                 return;
 
+        WARN_ON(!host->data);
+
         mode = SDHCI_TRNS_BLK_CNT_EN;
         if (data->blocks > 1)
                 mode |= SDHCI_TRNS_MULTI;
@@ -477,8 +480,8 @@ static void sdhci_finish_data(struct sdhci_host *host)
         /*
          * Controller doesn't count down when in single block mode.
          */
-        if ((data->blocks == 1) && (data->error == MMC_ERR_NONE))
-                blocks = 0;
+        if (data->blocks == 1)
+                blocks = (data->error == MMC_ERR_NONE) ? 0 : 1;
         else
                 blocks = readw(host->ioaddr + SDHCI_BLOCK_COUNT);
         data->bytes_xfered = data->blksz * (data->blocks - blocks);
@@ -600,9 +603,10 @@ static void sdhci_finish_command(struct sdhci_host *host)
 
         host->cmd->error = MMC_ERR_NONE;
 
-        if (host->cmd->data)
-                host->data = host->cmd->data;
-        else
+        if (host->data && host->data_early)
+                sdhci_finish_data(host);
+
+        if (!host->cmd->data)
                 tasklet_schedule(&host->finish_tasklet);
 
         host->cmd = NULL;
@@ -929,9 +933,9 @@ static void sdhci_cmd_irq(struct sdhci_host *host, u32 intmask)
         BUG_ON(intmask == 0);
 
         if (!host->cmd) {
-                printk(KERN_ERR "%s: Got command interrupt even though no "
-                        "command operation was in progress.\n",
-                        mmc_hostname(host->mmc));
+                printk(KERN_ERR "%s: Got command interrupt 0x%08x even "
+                        "though no command operation was in progress.\n",
+                        mmc_hostname(host->mmc), (unsigned)intmask);
                 sdhci_dumpregs(host);
                 return;
         }
@@ -961,9 +965,9 @@ static void sdhci_data_irq(struct sdhci_host *host, u32 intmask)
                 if (intmask & SDHCI_INT_DATA_END)
                         return;
 
-                printk(KERN_ERR "%s: Got data interrupt even though no "
-                        "data operation was in progress.\n",
-                        mmc_hostname(host->mmc));
+                printk(KERN_ERR "%s: Got data interrupt 0x%08x even "
+                        "though no data operation was in progress.\n",
+                        mmc_hostname(host->mmc), (unsigned)intmask);
                 sdhci_dumpregs(host);
 
                 return;
@@ -991,8 +995,18 @@ static void sdhci_data_irq(struct sdhci_host *host, u32 intmask)
                         writel(readl(host->ioaddr + SDHCI_DMA_ADDRESS),
                                 host->ioaddr + SDHCI_DMA_ADDRESS);
 
-                if (intmask & SDHCI_INT_DATA_END)
-                        sdhci_finish_data(host);
+                if (intmask & SDHCI_INT_DATA_END) {
+                        if (host->cmd) {
+                                /*
+                                 * Data managed to finish before the
+                                 * command completed. Make sure we do
+                                 * things in the proper order.
+                                 */
+                                host->data_early = 1;
+                        } else {
+                                sdhci_finish_data(host);
+                        }
+                }
         }
 }
 
@@ -1347,12 +1361,11 @@ static int __devinit sdhci_probe_slot(struct pci_dev *pdev, int slot)
          */
         mmc->max_blk_size = (caps & SDHCI_MAX_BLOCK_MASK) >> SDHCI_MAX_BLOCK_SHIFT;
         if (mmc->max_blk_size >= 3) {
-                printk(KERN_ERR "%s: Invalid maximum block size.\n",
+                printk(KERN_WARNING "%s: Invalid maximum block size, assuming 512\n",
                         host->slot_descr);
-                ret = -ENODEV;
-                goto unmap;
-        }
-        mmc->max_blk_size = 512 << mmc->max_blk_size;
+                mmc->max_blk_size = 512;
+        } else
+                mmc->max_blk_size = 512 << mmc->max_blk_size;
 
         /*
          * Maximum block count.