tiny-printf: Support assert()
[oweals/u-boot.git] / drivers / mmc / sdhci.c
index 5332e61cae6bae2c454182e7d4c75d94ded6beb3..de8d8ea70c447a4bdff18f7e0273d6db761f1c19 100644 (file)
@@ -9,11 +9,16 @@
  */
 
 #include <common.h>
+#include <errno.h>
 #include <malloc.h>
 #include <mmc.h>
 #include <sdhci.h>
 
+#if defined(CONFIG_FIXED_SDHCI_ALIGNED_BUFFER)
+void *aligned_buffer = (void *)CONFIG_FIXED_SDHCI_ALIGNED_BUFFER;
+#else
 void *aligned_buffer;
+#endif
 
 static void sdhci_reset(struct sdhci_host *host, u8 mask)
 {
@@ -123,18 +128,27 @@ static int sdhci_transfer_data(struct sdhci_host *host, struct mmc_data *data,
 #define CONFIG_SDHCI_CMD_MAX_TIMEOUT           3200
 #endif
 #define CONFIG_SDHCI_CMD_DEFAULT_TIMEOUT       100
+#define SDHCI_READ_STATUS_TIMEOUT              1000
+
+#ifdef CONFIG_DM_MMC_OPS
+static int sdhci_send_command(struct udevice *dev, struct mmc_cmd *cmd,
+                             struct mmc_data *data)
+{
+       struct mmc *mmc = mmc_get_mmc_dev(dev);
 
+#else
 static int sdhci_send_command(struct mmc *mmc, struct mmc_cmd *cmd,
-                      struct mmc_data *data)
+                             struct mmc_data *data)
 {
+#endif
        struct sdhci_host *host = mmc->priv;
        unsigned int stat = 0;
        int ret = 0;
        int trans_bytes = 0, is_aligned = 1;
        u32 mask, flags, mode;
        unsigned int time = 0, start_addr = 0;
-       unsigned int retry = 10000;
-       int mmc_dev = mmc->block_dev.dev;
+       int mmc_dev = mmc_get_blk_desc(mmc)->devnum;
+       unsigned start = get_timer(0);
 
        /* Timeout unit - ms */
        static unsigned int cmd_timeout = CONFIG_SDHCI_CMD_DEFAULT_TIMEOUT;
@@ -205,6 +219,17 @@ static int sdhci_send_command(struct mmc *mmc, struct mmc_cmd *cmd,
                                memcpy(aligned_buffer, data->src, trans_bytes);
                }
 
+#if defined(CONFIG_FIXED_SDHCI_ALIGNED_BUFFER)
+               /*
+                * Always use this bounce-buffer when
+                * CONFIG_FIXED_SDHCI_ALIGNED_BUFFER is defined
+                */
+               is_aligned = 0;
+               start_addr = (unsigned long)aligned_buffer;
+               if (data->flags != MMC_DATA_READ)
+                       memcpy(aligned_buffer, data->src, trans_bytes);
+#endif
+
                sdhci_writel(host, start_addr, SDHCI_DMA_ADDRESS);
                mode |= SDHCI_TRNS_DMA;
 #endif
@@ -213,6 +238,8 @@ static int sdhci_send_command(struct mmc *mmc, struct mmc_cmd *cmd,
                                SDHCI_BLOCK_SIZE);
                sdhci_writew(host, data->blocks, SDHCI_BLOCK_COUNT);
                sdhci_writew(host, mode, SDHCI_TRANSFER_MODE);
+       } else if (cmd->resp_type & MMC_RSP_BUSY) {
+               sdhci_writeb(host, 0xe, SDHCI_TIMEOUT_CONTROL);
        }
 
        sdhci_writel(host, cmd->cmdarg, SDHCI_ARGUMENT);
@@ -220,15 +247,15 @@ static int sdhci_send_command(struct mmc *mmc, struct mmc_cmd *cmd,
        flush_cache(start_addr, trans_bytes);
 #endif
        sdhci_writew(host, SDHCI_MAKE_CMD(cmd->cmdidx, flags), SDHCI_COMMAND);
+       start = get_timer(0);
        do {
                stat = sdhci_readl(host, SDHCI_INT_STATUS);
                if (stat & SDHCI_INT_ERROR)
                        break;
-               if (--retry == 0)
-                       break;
-       } while ((stat & mask) != mask);
+       } while (((stat & mask) != mask) &&
+                (get_timer(start) < SDHCI_READ_STATUS_TIMEOUT));
 
-       if (retry == 0) {
+       if (get_timer(start) >= SDHCI_READ_STATUS_TIMEOUT) {
                if (host->quirks & SDHCI_QUIRK_BROKEN_R1B)
                        return 0;
                else {
@@ -269,9 +296,25 @@ static int sdhci_send_command(struct mmc *mmc, struct mmc_cmd *cmd,
 static int sdhci_set_clock(struct mmc *mmc, unsigned int clock)
 {
        struct sdhci_host *host = mmc->priv;
-       unsigned int div, clk, timeout;
+       unsigned int div, clk, timeout, reg;
 
-       sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL);
+       /* Wait max 20 ms */
+       timeout = 200;
+       while (sdhci_readl(host, SDHCI_PRESENT_STATE) &
+                          (SDHCI_CMD_INHIBIT | SDHCI_DATA_INHIBIT)) {
+               if (timeout == 0) {
+                       printf("%s: Timeout to wait cmd & data inhibit\n",
+                              __func__);
+                       return -1;
+               }
+
+               timeout--;
+               udelay(100);
+       }
+
+       reg = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
+       reg &= ~SDHCI_CLOCK_CARD_EN;
+       sdhci_writew(host, reg, SDHCI_CLOCK_CONTROL);
 
        if (clock == 0)
                return 0;
@@ -355,8 +398,14 @@ static void sdhci_set_power(struct sdhci_host *host, unsigned short power)
        sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
 }
 
+#ifdef CONFIG_DM_MMC_OPS
+static int sdhci_set_ios(struct udevice *dev)
+{
+       struct mmc *mmc = mmc_get_mmc_dev(dev);
+#else
 static void sdhci_set_ios(struct mmc *mmc)
 {
+#endif
        u32 ctrl;
        struct sdhci_host *host = mmc->priv;
 
@@ -392,6 +441,9 @@ static void sdhci_set_ios(struct mmc *mmc)
                ctrl &= ~SDHCI_CTRL_HISPD;
 
        sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
+#ifdef CONFIG_DM_MMC_OPS
+       return 0;
+#endif
 }
 
 static int sdhci_init(struct mmc *mmc)
@@ -410,6 +462,12 @@ static int sdhci_init(struct mmc *mmc)
        sdhci_set_power(host, fls(mmc->cfg->voltages) - 1);
 
        if (host->quirks & SDHCI_QUIRK_NO_CD) {
+#if defined(CONFIG_PIC32_SDHCI)
+               /* PIC32 SDHCI CD errata:
+                * - set CD_TEST and clear CD_TEST_INS bit
+                */
+               sdhci_writeb(host, SDHCI_CTRL_CD_TEST, SDHCI_HOST_CONTROL);
+#else
                unsigned int status;
 
                sdhci_writeb(host, SDHCI_CTRL_CD_TEST_INS | SDHCI_CTRL_CD_TEST,
@@ -420,6 +478,7 @@ static int sdhci_init(struct mmc *mmc)
                    (!(status & SDHCI_CARD_STATE_STABLE)) ||
                    (!(status & SDHCI_CARD_DETECT_PIN_LEVEL)))
                        status = sdhci_readl(host, SDHCI_PRESENT_STATE);
+#endif
        }
 
        /* Enable only interrupts served by the SD controller */
@@ -431,20 +490,91 @@ static int sdhci_init(struct mmc *mmc)
        return 0;
 }
 
+#ifdef CONFIG_DM_MMC_OPS
+int sdhci_probe(struct udevice *dev)
+{
+       struct mmc *mmc = mmc_get_mmc_dev(dev);
+
+       return sdhci_init(mmc);
+}
 
+const struct dm_mmc_ops sdhci_ops = {
+       .send_cmd       = sdhci_send_command,
+       .set_ios        = sdhci_set_ios,
+};
+#else
 static const struct mmc_ops sdhci_ops = {
        .send_cmd       = sdhci_send_command,
        .set_ios        = sdhci_set_ios,
        .init           = sdhci_init,
 };
+#endif
 
+int sdhci_setup_cfg(struct mmc_config *cfg, const char *name, int buswidth,
+                   uint caps, u32 max_clk, u32 min_clk, uint version,
+                   uint quirks, uint host_caps)
+{
+       cfg->name = name;
+#ifndef CONFIG_DM_MMC_OPS
+       cfg->ops = &sdhci_ops;
+#endif
+       if (max_clk)
+               cfg->f_max = max_clk;
+       else {
+               if (version >= SDHCI_SPEC_300)
+                       cfg->f_max = (caps & SDHCI_CLOCK_V3_BASE_MASK) >>
+                               SDHCI_CLOCK_BASE_SHIFT;
+               else
+                       cfg->f_max = (caps & SDHCI_CLOCK_BASE_MASK) >>
+                               SDHCI_CLOCK_BASE_SHIFT;
+               cfg->f_max *= 1000000;
+       }
+       if (cfg->f_max == 0)
+               return -EINVAL;
+       if (min_clk)
+               cfg->f_min = min_clk;
+       else {
+               if (version >= SDHCI_SPEC_300)
+                       cfg->f_min = cfg->f_max / SDHCI_MAX_DIV_SPEC_300;
+               else
+                       cfg->f_min = cfg->f_max / SDHCI_MAX_DIV_SPEC_200;
+       }
+       cfg->voltages = 0;
+       if (caps & SDHCI_CAN_VDD_330)
+               cfg->voltages |= MMC_VDD_32_33 | MMC_VDD_33_34;
+       if (caps & SDHCI_CAN_VDD_300)
+               cfg->voltages |= MMC_VDD_29_30 | MMC_VDD_30_31;
+       if (caps & SDHCI_CAN_VDD_180)
+               cfg->voltages |= MMC_VDD_165_195;
+
+       cfg->host_caps = MMC_MODE_HS | MMC_MODE_HS_52MHz | MMC_MODE_4BIT;
+       if (version >= SDHCI_SPEC_300) {
+               if (caps & SDHCI_CAN_DO_8BIT)
+                       cfg->host_caps |= MMC_MODE_8BIT;
+       }
+
+       if (quirks & SDHCI_QUIRK_NO_HISPD_BIT)
+               cfg->host_caps &= ~(MMC_MODE_HS | MMC_MODE_HS_52MHz);
+
+       if (host_caps)
+               cfg->host_caps |= host_caps;
+
+
+       cfg->b_max = CONFIG_SYS_MMC_MAX_BLK_COUNT;
+
+       return 0;
+}
+
+#ifdef CONFIG_BLK
+int sdhci_bind(struct udevice *dev, struct mmc *mmc, struct mmc_config *cfg)
+{
+       return mmc_bind(dev, mmc, cfg);
+}
+#else
 int add_sdhci(struct sdhci_host *host, u32 max_clk, u32 min_clk)
 {
        unsigned int caps;
 
-       host->cfg.name = host->name;
-       host->cfg.ops = &sdhci_ops;
-
        caps = sdhci_readl(host, SDHCI_CAPABILITIES);
 #ifdef CONFIG_MMC_SDMA
        if (!(caps & SDHCI_CAN_DO_SDMA)) {
@@ -454,54 +584,17 @@ int add_sdhci(struct sdhci_host *host, u32 max_clk, u32 min_clk)
        }
 #endif
 
-       if (max_clk)
-               host->cfg.f_max = max_clk;
-       else {
-               if (SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300)
-                       host->cfg.f_max = (caps & SDHCI_CLOCK_V3_BASE_MASK)
-                               >> SDHCI_CLOCK_BASE_SHIFT;
-               else
-                       host->cfg.f_max = (caps & SDHCI_CLOCK_BASE_MASK)
-                               >> SDHCI_CLOCK_BASE_SHIFT;
-               host->cfg.f_max *= 1000000;
-       }
-       if (host->cfg.f_max == 0) {
+       if (sdhci_setup_cfg(&host->cfg, host->name, host->bus_width, caps,
+                           max_clk, min_clk, SDHCI_GET_VERSION(host),
+                           host->quirks, host->host_caps)) {
                printf("%s: Hardware doesn't specify base clock frequency\n",
                       __func__);
-               return -1;
+               return -EINVAL;
        }
-       if (min_clk)
-               host->cfg.f_min = min_clk;
-       else {
-               if (SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300)
-                       host->cfg.f_min = host->cfg.f_max /
-                               SDHCI_MAX_DIV_SPEC_300;
-               else
-                       host->cfg.f_min = host->cfg.f_max /
-                               SDHCI_MAX_DIV_SPEC_200;
-       }
-
-       host->cfg.voltages = 0;
-       if (caps & SDHCI_CAN_VDD_330)
-               host->cfg.voltages |= MMC_VDD_32_33 | MMC_VDD_33_34;
-       if (caps & SDHCI_CAN_VDD_300)
-               host->cfg.voltages |= MMC_VDD_29_30 | MMC_VDD_30_31;
-       if (caps & SDHCI_CAN_VDD_180)
-               host->cfg.voltages |= MMC_VDD_165_195;
 
        if (host->quirks & SDHCI_QUIRK_BROKEN_VOLTAGE)
                host->cfg.voltages |= host->voltages;
 
-       host->cfg.host_caps = MMC_MODE_HS | MMC_MODE_HS_52MHz | MMC_MODE_4BIT;
-       if (SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300) {
-               if (caps & SDHCI_CAN_DO_8BIT)
-                       host->cfg.host_caps |= MMC_MODE_8BIT;
-       }
-       if (host->host_caps)
-               host->cfg.host_caps |= host->host_caps;
-
-       host->cfg.b_max = CONFIG_SYS_MMC_MAX_BLK_COUNT;
-
        sdhci_reset(host, SDHCI_RESET_ALL);
 
        host->mmc = mmc_create(&host->cfg, host);
@@ -512,3 +605,4 @@ int add_sdhci(struct sdhci_host *host, u32 max_clk, u32 min_clk)
 
        return 0;
 }
+#endif