1 files changed, 168 insertions, 42 deletions

diff --git a/drivers/mmc/core/sdio.c b/drivers/mmc/core/sdio.c
index b9dee28ee7d0..bd2755e8d9a3 100644
--- a/drivers/mmc/core/sdio.c
+++ b/drivers/mmc/core/sdio.c
@@ -18,6 +18,7 @@
 
 #include "core.h"
 #include "bus.h"
+#include "sd.h"
 #include "sdio_bus.h"
 #include "mmc_ops.h"
 #include "sd_ops.h"
@@ -62,13 +63,19 @@ static int sdio_init_func(struct mmc_card *card, unsigned int fn)
 
         func->num = fn;
 
-        ret = sdio_read_fbr(func);
-        if (ret)
-                goto fail;
+        if (!(card->quirks & MMC_QUIRK_NONSTD_SDIO)) {
+                ret = sdio_read_fbr(func);
+                if (ret)
+                        goto fail;
 
-        ret = sdio_read_func_cis(func);
-        if (ret)
-                goto fail;
+                ret = sdio_read_func_cis(func);
+                if (ret)
+                        goto fail;
+        } else {
+                func->vendor = func->card->cis.vendor;
+                func->device = func->card->cis.device;
+                func->max_blksize = func->card->cis.blksize;
+        }
 
         card->sdio_func[fn - 1] = func;
 
@@ -159,9 +166,7 @@ static int sdio_enable_wide(struct mmc_card *card)
         if (ret)
                 return ret;
 
-        mmc_set_bus_width(card->host, MMC_BUS_WIDTH_4);
-
-        return 0;
+        return 1;
 }
 
 /*
@@ -221,10 +226,34 @@ static int sdio_disable_wide(struct mmc_card *card)
         return 0;
 }
 
+
+static int sdio_enable_4bit_bus(struct mmc_card *card)
+{
+        int err;
+
+        if (card->type == MMC_TYPE_SDIO)
+                return sdio_enable_wide(card);
+
+        if ((card->host->caps & MMC_CAP_4_BIT_DATA) &&
+                (card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
+                err = mmc_app_set_bus_width(card, MMC_BUS_WIDTH_4);
+                if (err)
+                        return err;
+        } else
+                return 0;
+
+        err = sdio_enable_wide(card);
+        if (err <= 0)
+                mmc_app_set_bus_width(card, MMC_BUS_WIDTH_1);
+
+        return err;
+}
+
+
 /*
  * Test if the card supports high-speed mode and, if so, switch to it.
  */
-static int sdio_enable_hs(struct mmc_card *card)
+static int mmc_sdio_switch_hs(struct mmc_card *card, int enable)
 {
         int ret;
         u8 speed;
@@ -239,16 +268,56 @@ static int sdio_enable_hs(struct mmc_card *card)
         if (ret)
                 return ret;
 
-        speed |= SDIO_SPEED_EHS;
+        if (enable)
+                speed |= SDIO_SPEED_EHS;
+        else
+                speed &= ~SDIO_SPEED_EHS;
 
         ret = mmc_io_rw_direct(card, 1, 0, SDIO_CCCR_SPEED, speed, NULL);
         if (ret)
                 return ret;
 
-        mmc_card_set_highspeed(card);
-        mmc_set_timing(card->host, MMC_TIMING_SD_HS);
+        return 1;
+}
 
-        return 0;
+/*
+ * Enable SDIO/combo card's high-speed mode. Return 0/1 if [not]supported.
+ */
+static int sdio_enable_hs(struct mmc_card *card)
+{
+        int ret;
+
+        ret = mmc_sdio_switch_hs(card, true);
+        if (ret <= 0 || card->type == MMC_TYPE_SDIO)
+                return ret;
+
+        ret = mmc_sd_switch_hs(card);
+        if (ret <= 0)
+                mmc_sdio_switch_hs(card, false);
+
+        return ret;
+}
+
+static unsigned mmc_sdio_get_max_clock(struct mmc_card *card)
+{
+        unsigned max_dtr;
+
+        if (mmc_card_highspeed(card)) {
+                /*
+                 * The SDIO specification doesn't mention how
+                 * the CIS transfer speed register relates to
+                 * high-speed, but it seems that 50 MHz is
+                 * mandatory.
+                 */
+                max_dtr = 50000000;
+        } else {
+                max_dtr = card->cis.max_dtr;
+        }
+
+        if (card->type == MMC_TYPE_SD_COMBO)
+                max_dtr = min(max_dtr, mmc_sd_get_max_clock(card));
+
+        return max_dtr;
 }
 
 /*
@@ -293,7 +362,24 @@ static int mmc_sdio_init_card(struct mmc_host *host, u32 ocr,
                 goto err;
         }
 
-        card->type = MMC_TYPE_SDIO;
+        err = mmc_sd_get_cid(host, host->ocr & ocr, card->raw_cid);
+
+        if (!err) {
+                card->type = MMC_TYPE_SD_COMBO;
+
+                if (oldcard && (oldcard->type != MMC_TYPE_SD_COMBO ||
+                    memcmp(card->raw_cid, oldcard->raw_cid, sizeof(card->raw_cid)) != 0)) {
+                        mmc_remove_card(card);
+                        return -ENOENT;
+                }
+        } else {
+                card->type = MMC_TYPE_SDIO;
+
+                if (oldcard && oldcard->type != MMC_TYPE_SDIO) {
+                        mmc_remove_card(card);
+                        return -ENOENT;
+                }
+        }
 
         /*
          * Call the optional HC's init_card function to handle quirks.
@@ -313,6 +399,17 @@ static int mmc_sdio_init_card(struct mmc_host *host, u32 ocr,
         }
 
         /*
+         * Read CSD, before selecting the card
+         */
+        if (!oldcard && card->type == MMC_TYPE_SD_COMBO) {
+                err = mmc_sd_get_csd(host, card);
+                if (err)
+                        return err;
+
+                mmc_decode_cid(card);
+        }
+
+        /*
          * Select card, as all following commands rely on that.
          */
         if (!powered_resume && !mmc_host_is_spi(host)) {
@@ -321,6 +418,23 @@ static int mmc_sdio_init_card(struct mmc_host *host, u32 ocr,
                         goto remove;
         }
 
+        if (card->quirks & MMC_QUIRK_NONSTD_SDIO) {
+                /*
+                 * This is non-standard SDIO device, meaning it doesn't
+                 * have any CIA (Common I/O area) registers present.
+                 * It's host's responsibility to fill cccr and cis
+                 * structures in init_card().
+                 */
+                mmc_set_clock(host, card->cis.max_dtr);
+
+                if (card->cccr.high_speed) {
+                        mmc_card_set_highspeed(card);
+                        mmc_set_timing(card->host, MMC_TIMING_SD_HS);
+                }
+
+                goto finish;
+        }
+
         /*
          * Read the common registers.
          */
@@ -339,43 +453,57 @@ static int mmc_sdio_init_card(struct mmc_host *host, u32 ocr,
                 int same = (card->cis.vendor == oldcard->cis.vendor &&
                             card->cis.device == oldcard->cis.device);
                 mmc_remove_card(card);
-                if (!same) {
-                        err = -ENOENT;
-                        goto err;
-                }
+                if (!same)
+                        return -ENOENT;
+
                 card = oldcard;
                 return 0;
         }
 
+        if (card->type == MMC_TYPE_SD_COMBO) {
+                err = mmc_sd_setup_card(host, card, oldcard != NULL);
+                /* handle as SDIO-only card if memory init failed */
+                if (err) {
+                        mmc_go_idle(host);
+                        if (mmc_host_is_spi(host))
+                                /* should not fail, as it worked previously */
+                                mmc_spi_set_crc(host, use_spi_crc);
+                        card->type = MMC_TYPE_SDIO;
+                } else
+                        card->dev.type = &sd_type;
+        }
+
+        /*
+         * If needed, disconnect card detection pull-up resistor.
+         */
+        err = sdio_disable_cd(card);
+        if (err)
+                goto remove;
+
         /*
          * Switch to high-speed (if supported).
          */
         err = sdio_enable_hs(card);
-        if (err)
+        if (err > 0)
+                mmc_sd_go_highspeed(card);
+        else if (err)
                 goto remove;
 
         /*
          * Change to the card's maximum speed.
          */
-        if (mmc_card_highspeed(card)) {
-                /*
-                 * The SDIO specification doesn't mention how
-                 * the CIS transfer speed register relates to
-                 * high-speed, but it seems that 50 MHz is
-                 * mandatory.
-                 */
-                mmc_set_clock(host, 50000000);
-        } else {
-                mmc_set_clock(host, card->cis.max_dtr);
-        }
+        mmc_set_clock(host, mmc_sdio_get_max_clock(card));
 
         /*
          * Switch to wider bus (if supported).
          */
-        err = sdio_enable_wide(card);
-        if (err)
+        err = sdio_enable_4bit_bus(card);
+        if (err > 0)
+                mmc_set_bus_width(card->host, MMC_BUS_WIDTH_4);
+        else if (err)
                 goto remove;
 
+finish:
         if (!oldcard)
                 host->card = card;
         return 0;
@@ -487,9 +615,14 @@ static int mmc_sdio_resume(struct mmc_host *host)
         mmc_claim_host(host);
         err = mmc_sdio_init_card(host, host->ocr, host->card,
                                  (host->pm_flags & MMC_PM_KEEP_POWER));
-        if (!err)
+        if (!err) {
                 /* We may have switched to 1-bit mode during suspend. */
-                err = sdio_enable_wide(host->card);
+                err = sdio_enable_4bit_bus(host->card);
+                if (err > 0) {
+                        mmc_set_bus_width(host, MMC_BUS_WIDTH_4);
+                        err = 0;
+                }
+        }
         if (!err && host->sdio_irqs)
                 mmc_signal_sdio_irq(host);
         mmc_release_host(host);
@@ -574,13 +707,6 @@ int mmc_attach_sdio(struct mmc_host *host, u32 ocr)
         card->sdio_funcs = 0;
 
         /*
-         * If needed, disconnect card detection pull-up resistor.
-         */
-        err = sdio_disable_cd(card);
-        if (err)
-                goto remove;
-
-        /*
          * Initialize (but don't add) all present functions.
          */
         for (i = 0; i < funcs; i++, card->sdio_funcs++) {