|
@@ -0,0 +1,433 @@
|
|
|
+/*
|
|
|
+ * Copyright 2011, Marvell Semiconductor Inc.
|
|
|
+ * Lei Wen <leiwen@marvell.com>
|
|
|
+ *
|
|
|
+ * See file CREDITS for list of people who contributed to this
|
|
|
+ * project.
|
|
|
+ *
|
|
|
+ * This program is free software; you can redistribute it and/or
|
|
|
+ * modify it under the terms of the GNU General Public License as
|
|
|
+ * published by the Free Software Foundation; either version 2 of
|
|
|
+ * the License, or (at your option) any later version.
|
|
|
+ *
|
|
|
+ * This program is distributed in the hope that it will be useful,
|
|
|
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
+ * GNU General Public License for more details.
|
|
|
+ *
|
|
|
+ * You should have received a copy of the GNU General Public License
|
|
|
+ * along with this program; if not, write to the Free Software
|
|
|
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|
|
+ * MA 02111-1307 USA
|
|
|
+ *
|
|
|
+ * Back ported to the 8xx platform (from the 8260 platform) by
|
|
|
+ * Murray.Jensen@cmst.csiro.au, 27-Jan-01.
|
|
|
+ */
|
|
|
+
|
|
|
+#include <common.h>
|
|
|
+#include <malloc.h>
|
|
|
+#include <mmc.h>
|
|
|
+#include <sdhci.h>
|
|
|
+
|
|
|
+void *aligned_buffer;
|
|
|
+
|
|
|
+static void sdhci_reset(struct sdhci_host *host, u8 mask)
|
|
|
+{
|
|
|
+ unsigned long timeout;
|
|
|
+
|
|
|
+ /* Wait max 100 ms */
|
|
|
+ timeout = 100;
|
|
|
+ sdhci_writeb(host, mask, SDHCI_SOFTWARE_RESET);
|
|
|
+ while (sdhci_readb(host, SDHCI_SOFTWARE_RESET) & mask) {
|
|
|
+ if (timeout == 0) {
|
|
|
+ printf("Reset 0x%x never completed.\n", (int)mask);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ timeout--;
|
|
|
+ udelay(1000);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void sdhci_cmd_done(struct sdhci_host *host, struct mmc_cmd *cmd)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ if (cmd->resp_type & MMC_RSP_136) {
|
|
|
+ /* CRC is stripped so we need to do some shifting. */
|
|
|
+ for (i = 0; i < 4; i++) {
|
|
|
+ cmd->response[i] = sdhci_readl(host,
|
|
|
+ SDHCI_RESPONSE + (3-i)*4) << 8;
|
|
|
+ if (i != 3)
|
|
|
+ cmd->response[i] |= sdhci_readb(host,
|
|
|
+ SDHCI_RESPONSE + (3-i)*4-1);
|
|
|
+ }
|
|
|
+ } else {
|
|
|
+ cmd->response[0] = sdhci_readl(host, SDHCI_RESPONSE);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void sdhci_transfer_pio(struct sdhci_host *host, struct mmc_data *data)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ char *offs;
|
|
|
+ for (i = 0; i < data->blocksize; i += 4) {
|
|
|
+ offs = data->dest + i;
|
|
|
+ if (data->flags == MMC_DATA_READ)
|
|
|
+ *(u32 *)offs = sdhci_readl(host, SDHCI_BUFFER);
|
|
|
+ else
|
|
|
+ sdhci_writel(host, *(u32 *)offs, SDHCI_BUFFER);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static int sdhci_transfer_data(struct sdhci_host *host, struct mmc_data *data,
|
|
|
+ unsigned int start_addr)
|
|
|
+{
|
|
|
+ unsigned int stat, rdy, mask, block = 0;
|
|
|
+
|
|
|
+ rdy = SDHCI_INT_SPACE_AVAIL | SDHCI_INT_DATA_AVAIL;
|
|
|
+ mask = SDHCI_DATA_AVAILABLE | SDHCI_SPACE_AVAILABLE;
|
|
|
+ do {
|
|
|
+ stat = sdhci_readl(host, SDHCI_INT_STATUS);
|
|
|
+ if (stat & SDHCI_INT_ERROR) {
|
|
|
+ printf("Error detected in status(0x%X)!\n", stat);
|
|
|
+ return -1;
|
|
|
+ }
|
|
|
+ if (stat & rdy) {
|
|
|
+ if (!(sdhci_readl(host, SDHCI_PRESENT_STATE) & mask))
|
|
|
+ continue;
|
|
|
+ sdhci_writel(host, rdy, SDHCI_INT_STATUS);
|
|
|
+ sdhci_transfer_pio(host, data);
|
|
|
+ data->dest += data->blocksize;
|
|
|
+ if (++block >= data->blocks)
|
|
|
+ break;
|
|
|
+ }
|
|
|
+#ifdef CONFIG_MMC_SDMA
|
|
|
+ if (stat & SDHCI_INT_DMA_END) {
|
|
|
+ sdhci_writel(host, SDHCI_INT_DMA_END, SDHCI_INT_STATUS);
|
|
|
+ start_addr &= SDHCI_DEFAULT_BOUNDARY_SIZE - 1;
|
|
|
+ start_addr += SDHCI_DEFAULT_BOUNDARY_SIZE;
|
|
|
+ sdhci_writel(host, start_addr, SDHCI_DMA_ADDRESS);
|
|
|
+ }
|
|
|
+#endif
|
|
|
+ } while (!(stat & SDHCI_INT_DATA_END));
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+int sdhci_send_command(struct mmc *mmc, struct mmc_cmd *cmd,
|
|
|
+ struct mmc_data *data)
|
|
|
+{
|
|
|
+ struct sdhci_host *host = (struct sdhci_host *)mmc->priv;
|
|
|
+ unsigned int stat = 0;
|
|
|
+ int ret = 0;
|
|
|
+ int trans_bytes = 0, is_aligned = 1;
|
|
|
+ u32 mask, flags, mode;
|
|
|
+ unsigned int timeout, start_addr = 0;
|
|
|
+
|
|
|
+ /* Wait max 10 ms */
|
|
|
+ timeout = 10;
|
|
|
+
|
|
|
+ sdhci_writel(host, SDHCI_INT_ALL_MASK, SDHCI_INT_STATUS);
|
|
|
+ mask = SDHCI_CMD_INHIBIT | SDHCI_DATA_INHIBIT;
|
|
|
+
|
|
|
+ /* We shouldn't wait for data inihibit for stop commands, even
|
|
|
+ though they might use busy signaling */
|
|
|
+ if (cmd->cmdidx == MMC_CMD_STOP_TRANSMISSION)
|
|
|
+ mask &= ~SDHCI_DATA_INHIBIT;
|
|
|
+
|
|
|
+ while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
|
|
|
+ if (timeout == 0) {
|
|
|
+ printf("Controller never released inhibit bit(s).\n");
|
|
|
+ return COMM_ERR;
|
|
|
+ }
|
|
|
+ timeout--;
|
|
|
+ udelay(1000);
|
|
|
+ }
|
|
|
+
|
|
|
+ mask = SDHCI_INT_RESPONSE;
|
|
|
+ if (!(cmd->resp_type & MMC_RSP_PRESENT))
|
|
|
+ flags = SDHCI_CMD_RESP_NONE;
|
|
|
+ else if (cmd->resp_type & MMC_RSP_136)
|
|
|
+ flags = SDHCI_CMD_RESP_LONG;
|
|
|
+ else if (cmd->resp_type & MMC_RSP_BUSY) {
|
|
|
+ flags = SDHCI_CMD_RESP_SHORT_BUSY;
|
|
|
+ mask |= SDHCI_INT_DATA_END;
|
|
|
+ } else
|
|
|
+ flags = SDHCI_CMD_RESP_SHORT;
|
|
|
+
|
|
|
+ if (cmd->resp_type & MMC_RSP_CRC)
|
|
|
+ flags |= SDHCI_CMD_CRC;
|
|
|
+ if (cmd->resp_type & MMC_RSP_OPCODE)
|
|
|
+ flags |= SDHCI_CMD_INDEX;
|
|
|
+ if (data)
|
|
|
+ flags |= SDHCI_CMD_DATA;
|
|
|
+
|
|
|
+ /*Set Transfer mode regarding to data flag*/
|
|
|
+ if (data != 0) {
|
|
|
+ sdhci_writeb(host, 0xe, SDHCI_TIMEOUT_CONTROL);
|
|
|
+ mode = SDHCI_TRNS_BLK_CNT_EN;
|
|
|
+ trans_bytes = data->blocks * data->blocksize;
|
|
|
+ if (data->blocks > 1)
|
|
|
+ mode |= SDHCI_TRNS_MULTI;
|
|
|
+
|
|
|
+ if (data->flags == MMC_DATA_READ)
|
|
|
+ mode |= SDHCI_TRNS_READ;
|
|
|
+
|
|
|
+#ifdef CONFIG_MMC_SDMA
|
|
|
+ if (data->flags == MMC_DATA_READ)
|
|
|
+ start_addr = (unsigned int)data->dest;
|
|
|
+ else
|
|
|
+ start_addr = (unsigned int)data->src;
|
|
|
+ if ((host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR) &&
|
|
|
+ (start_addr & 0x7) != 0x0) {
|
|
|
+ is_aligned = 0;
|
|
|
+ start_addr = (unsigned int)aligned_buffer;
|
|
|
+ if (data->flags != MMC_DATA_READ)
|
|
|
+ memcpy(aligned_buffer, data->src, trans_bytes);
|
|
|
+ }
|
|
|
+
|
|
|
+ sdhci_writel(host, start_addr, SDHCI_DMA_ADDRESS);
|
|
|
+ mode |= SDHCI_TRNS_DMA;
|
|
|
+#endif
|
|
|
+ sdhci_writew(host, SDHCI_MAKE_BLKSZ(SDHCI_DEFAULT_BOUNDARY_ARG,
|
|
|
+ data->blocksize),
|
|
|
+ SDHCI_BLOCK_SIZE);
|
|
|
+ sdhci_writew(host, data->blocks, SDHCI_BLOCK_COUNT);
|
|
|
+ sdhci_writew(host, mode, SDHCI_TRANSFER_MODE);
|
|
|
+ }
|
|
|
+
|
|
|
+ sdhci_writel(host, cmd->cmdarg, SDHCI_ARGUMENT);
|
|
|
+#ifdef CONFIG_MMC_SDMA
|
|
|
+ flush_cache(0, ~0);
|
|
|
+#endif
|
|
|
+ sdhci_writew(host, SDHCI_MAKE_CMD(cmd->cmdidx, flags), SDHCI_COMMAND);
|
|
|
+ do {
|
|
|
+ stat = sdhci_readl(host, SDHCI_INT_STATUS);
|
|
|
+ if (stat & SDHCI_INT_ERROR)
|
|
|
+ break;
|
|
|
+ } while ((stat & mask) != mask);
|
|
|
+
|
|
|
+ if ((stat & (SDHCI_INT_ERROR | mask)) == mask) {
|
|
|
+ sdhci_cmd_done(host, cmd);
|
|
|
+ sdhci_writel(host, mask, SDHCI_INT_STATUS);
|
|
|
+ } else
|
|
|
+ ret = -1;
|
|
|
+
|
|
|
+ if (!ret && data)
|
|
|
+ ret = sdhci_transfer_data(host, data, start_addr);
|
|
|
+
|
|
|
+ stat = sdhci_readl(host, SDHCI_INT_STATUS);
|
|
|
+ sdhci_writel(host, SDHCI_INT_ALL_MASK, SDHCI_INT_STATUS);
|
|
|
+ if (!ret) {
|
|
|
+ if ((host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR) &&
|
|
|
+ !is_aligned && (data->flags == MMC_DATA_READ))
|
|
|
+ memcpy(data->dest, aligned_buffer, trans_bytes);
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ sdhci_reset(host, SDHCI_RESET_CMD);
|
|
|
+ sdhci_reset(host, SDHCI_RESET_DATA);
|
|
|
+ if (stat & SDHCI_INT_TIMEOUT)
|
|
|
+ return TIMEOUT;
|
|
|
+ else
|
|
|
+ return COMM_ERR;
|
|
|
+}
|
|
|
+
|
|
|
+static int sdhci_set_clock(struct mmc *mmc, unsigned int clock)
|
|
|
+{
|
|
|
+ struct sdhci_host *host = (struct sdhci_host *)mmc->priv;
|
|
|
+ unsigned int div, clk, timeout;
|
|
|
+
|
|
|
+ sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL);
|
|
|
+
|
|
|
+ if (clock == 0)
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ if (host->version >= SDHCI_SPEC_300) {
|
|
|
+ /* Version 3.00 divisors must be a multiple of 2. */
|
|
|
+ if (mmc->f_max <= clock)
|
|
|
+ div = 1;
|
|
|
+ else {
|
|
|
+ for (div = 2; div < SDHCI_MAX_DIV_SPEC_300; div += 2) {
|
|
|
+ if ((mmc->f_max / div) <= clock)
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ } else {
|
|
|
+ /* Version 2.00 divisors must be a power of 2. */
|
|
|
+ for (div = 1; div < SDHCI_MAX_DIV_SPEC_200; div *= 2) {
|
|
|
+ if ((mmc->f_max / div) <= clock)
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ div >>= 1;
|
|
|
+
|
|
|
+ clk = (div & SDHCI_DIV_MASK) << SDHCI_DIVIDER_SHIFT;
|
|
|
+ clk |= ((div & SDHCI_DIV_HI_MASK) >> SDHCI_DIV_MASK_LEN)
|
|
|
+ << SDHCI_DIVIDER_HI_SHIFT;
|
|
|
+ clk |= SDHCI_CLOCK_INT_EN;
|
|
|
+ sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
|
|
|
+
|
|
|
+ /* Wait max 20 ms */
|
|
|
+ timeout = 20;
|
|
|
+ while (!((clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL))
|
|
|
+ & SDHCI_CLOCK_INT_STABLE)) {
|
|
|
+ if (timeout == 0) {
|
|
|
+ printf("Internal clock never stabilised.\n");
|
|
|
+ return -1;
|
|
|
+ }
|
|
|
+ timeout--;
|
|
|
+ udelay(1000);
|
|
|
+ }
|
|
|
+
|
|
|
+ clk |= SDHCI_CLOCK_CARD_EN;
|
|
|
+ sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static void sdhci_set_power(struct sdhci_host *host, unsigned short power)
|
|
|
+{
|
|
|
+ u8 pwr = 0;
|
|
|
+
|
|
|
+ if (power != (unsigned short)-1) {
|
|
|
+ switch (1 << power) {
|
|
|
+ case MMC_VDD_165_195:
|
|
|
+ pwr = SDHCI_POWER_180;
|
|
|
+ break;
|
|
|
+ case MMC_VDD_29_30:
|
|
|
+ case MMC_VDD_30_31:
|
|
|
+ pwr = SDHCI_POWER_300;
|
|
|
+ break;
|
|
|
+ case MMC_VDD_32_33:
|
|
|
+ case MMC_VDD_33_34:
|
|
|
+ pwr = SDHCI_POWER_330;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (pwr == 0) {
|
|
|
+ sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ pwr |= SDHCI_POWER_ON;
|
|
|
+
|
|
|
+ sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
|
|
|
+}
|
|
|
+
|
|
|
+void sdhci_set_ios(struct mmc *mmc)
|
|
|
+{
|
|
|
+ u32 ctrl;
|
|
|
+ struct sdhci_host *host = (struct sdhci_host *)mmc->priv;
|
|
|
+
|
|
|
+ if (mmc->clock != host->clock)
|
|
|
+ sdhci_set_clock(mmc, mmc->clock);
|
|
|
+
|
|
|
+ /* Set bus width */
|
|
|
+ ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
|
|
|
+ if (mmc->bus_width == 8) {
|
|
|
+ ctrl &= ~SDHCI_CTRL_4BITBUS;
|
|
|
+ if (host->version >= SDHCI_SPEC_300)
|
|
|
+ ctrl |= SDHCI_CTRL_8BITBUS;
|
|
|
+ } else {
|
|
|
+ if (host->version >= SDHCI_SPEC_300)
|
|
|
+ ctrl &= ~SDHCI_CTRL_8BITBUS;
|
|
|
+ if (mmc->bus_width == 4)
|
|
|
+ ctrl |= SDHCI_CTRL_4BITBUS;
|
|
|
+ else
|
|
|
+ ctrl &= ~SDHCI_CTRL_4BITBUS;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (mmc->clock > 26000000)
|
|
|
+ ctrl |= SDHCI_CTRL_HISPD;
|
|
|
+ else
|
|
|
+ ctrl &= ~SDHCI_CTRL_HISPD;
|
|
|
+
|
|
|
+ sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
|
|
|
+}
|
|
|
+
|
|
|
+int sdhci_init(struct mmc *mmc)
|
|
|
+{
|
|
|
+ struct sdhci_host *host = (struct sdhci_host *)mmc->priv;
|
|
|
+
|
|
|
+ if ((host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR) && !aligned_buffer) {
|
|
|
+ aligned_buffer = memalign(8, 512*1024);
|
|
|
+ if (!aligned_buffer) {
|
|
|
+ printf("Aligned buffer alloc failed!!!");
|
|
|
+ return -1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Eable all state */
|
|
|
+ sdhci_writel(host, SDHCI_INT_ALL_MASK, SDHCI_INT_ENABLE);
|
|
|
+ sdhci_writel(host, SDHCI_INT_ALL_MASK, SDHCI_SIGNAL_ENABLE);
|
|
|
+
|
|
|
+ sdhci_set_power(host, fls(mmc->voltages) - 1);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+int add_sdhci(struct sdhci_host *host, u32 max_clk, u32 min_clk)
|
|
|
+{
|
|
|
+ struct mmc *mmc;
|
|
|
+ unsigned int caps;
|
|
|
+
|
|
|
+ mmc = malloc(sizeof(struct mmc));
|
|
|
+ if (!mmc) {
|
|
|
+ printf("mmc malloc fail!\n");
|
|
|
+ return -1;
|
|
|
+ }
|
|
|
+
|
|
|
+ mmc->priv = host;
|
|
|
+
|
|
|
+ sprintf(mmc->name, "%s", host->name);
|
|
|
+ mmc->send_cmd = sdhci_send_command;
|
|
|
+ mmc->set_ios = sdhci_set_ios;
|
|
|
+ mmc->init = sdhci_init;
|
|
|
+
|
|
|
+ caps = sdhci_readl(host, SDHCI_CAPABILITIES);
|
|
|
+#ifdef CONFIG_MMC_SDMA
|
|
|
+ if (!(caps & SDHCI_CAN_DO_SDMA)) {
|
|
|
+ printf("Your controller don't support sdma!!\n");
|
|
|
+ return -1;
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
+ if (max_clk)
|
|
|
+ mmc->f_max = max_clk;
|
|
|
+ else {
|
|
|
+ if (host->version >= SDHCI_SPEC_300)
|
|
|
+ mmc->f_max = (caps & SDHCI_CLOCK_V3_BASE_MASK)
|
|
|
+ >> SDHCI_CLOCK_BASE_SHIFT;
|
|
|
+ else
|
|
|
+ mmc->f_max = (caps & SDHCI_CLOCK_BASE_MASK)
|
|
|
+ >> SDHCI_CLOCK_BASE_SHIFT;
|
|
|
+ mmc->f_max *= 1000000;
|
|
|
+ }
|
|
|
+ if (mmc->f_max == 0) {
|
|
|
+ printf("Hardware doesn't specify base clock frequency\n");
|
|
|
+ return -1;
|
|
|
+ }
|
|
|
+ if (min_clk)
|
|
|
+ mmc->f_min = min_clk;
|
|
|
+ else {
|
|
|
+ if (host->version >= SDHCI_SPEC_300)
|
|
|
+ mmc->f_min = mmc->f_max / SDHCI_MAX_DIV_SPEC_300;
|
|
|
+ else
|
|
|
+ mmc->f_min = mmc->f_max / SDHCI_MAX_DIV_SPEC_200;
|
|
|
+ }
|
|
|
+
|
|
|
+ mmc->voltages = 0;
|
|
|
+ if (caps & SDHCI_CAN_VDD_330)
|
|
|
+ mmc->voltages |= MMC_VDD_32_33 | MMC_VDD_33_34;
|
|
|
+ if (caps & SDHCI_CAN_VDD_300)
|
|
|
+ mmc->voltages |= MMC_VDD_29_30 | MMC_VDD_30_31;
|
|
|
+ if (caps & SDHCI_CAN_VDD_180)
|
|
|
+ mmc->voltages |= MMC_VDD_165_195;
|
|
|
+ mmc->host_caps = MMC_MODE_HS | MMC_MODE_HS_52MHz | MMC_MODE_4BIT;
|
|
|
+ if (caps & SDHCI_CAN_DO_8BIT)
|
|
|
+ mmc->host_caps |= MMC_MODE_8BIT;
|
|
|
+
|
|
|
+ sdhci_reset(host, SDHCI_RESET_ALL);
|
|
|
+ mmc_register(mmc);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|