xref: /rk3399_rockchip-uboot/drivers/mmc/tegra_mmc.c (revision 29f3e3f24832fccdd7ce5fa961bc4d4005b07381)
13f82d89dSTom Warren /*
23f82d89dSTom Warren  * (C) Copyright 2009 SAMSUNG Electronics
33f82d89dSTom Warren  * Minkyu Kang <mk7.kang@samsung.com>
43f82d89dSTom Warren  * Jaehoon Chung <jh80.chung@samsung.com>
53f82d89dSTom Warren  * Portions Copyright 2011-2012 NVIDIA Corporation
63f82d89dSTom Warren  *
73f82d89dSTom Warren  * This program is free software; you can redistribute it and/or modify
83f82d89dSTom Warren  * it under the terms of the GNU General Public License as published by
93f82d89dSTom Warren  * the Free Software Foundation; either version 2 of the License, or
103f82d89dSTom Warren  * (at your option) any later version.
113f82d89dSTom Warren  *
123f82d89dSTom Warren  * This program is distributed in the hope that it will be useful,
133f82d89dSTom Warren  * but WITHOUT ANY WARRANTY; without even the implied warranty of
143f82d89dSTom Warren  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
153f82d89dSTom Warren  * GNU General Public License for more details.
163f82d89dSTom Warren  *
173f82d89dSTom Warren  * You should have received a copy of the GNU General Public License
183f82d89dSTom Warren  * along with this program; if not, write to the Free Software
193f82d89dSTom Warren  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
203f82d89dSTom Warren  */
213f82d89dSTom Warren 
223f82d89dSTom Warren #include <common.h>
233f82d89dSTom Warren #include <mmc.h>
243f82d89dSTom Warren #include <asm/gpio.h>
253f82d89dSTom Warren #include <asm/io.h>
263f82d89dSTom Warren #include <asm/arch/clk_rst.h>
273f82d89dSTom Warren #include <asm/arch/clock.h>
28*29f3e3f2STom Warren #include <asm/arch/tegra_mmc.h>
293f82d89dSTom Warren 
303f82d89dSTom Warren /* support 4 mmc hosts */
313f82d89dSTom Warren struct mmc mmc_dev[4];
323f82d89dSTom Warren struct mmc_host mmc_host[4];
333f82d89dSTom Warren 
343f82d89dSTom Warren 
353f82d89dSTom Warren /**
363f82d89dSTom Warren  * Get the host address and peripheral ID for a device. Devices are numbered
373f82d89dSTom Warren  * from 0 to 3.
383f82d89dSTom Warren  *
393f82d89dSTom Warren  * @param host		Structure to fill in (base, reg, mmc_id)
403f82d89dSTom Warren  * @param dev_index	Device index (0-3)
413f82d89dSTom Warren  */
42*29f3e3f2STom Warren static void tegra_get_setup(struct mmc_host *host, int dev_index)
433f82d89dSTom Warren {
44*29f3e3f2STom Warren 	debug("tegra_get_setup: dev_index = %d\n", dev_index);
453f82d89dSTom Warren 
463f82d89dSTom Warren 	switch (dev_index) {
473f82d89dSTom Warren 	case 1:
48*29f3e3f2STom Warren 		host->base = TEGRA_SDMMC3_BASE;
493f82d89dSTom Warren 		host->mmc_id = PERIPH_ID_SDMMC3;
503f82d89dSTom Warren 		break;
513f82d89dSTom Warren 	case 2:
52*29f3e3f2STom Warren 		host->base = TEGRA_SDMMC2_BASE;
533f82d89dSTom Warren 		host->mmc_id = PERIPH_ID_SDMMC2;
543f82d89dSTom Warren 		break;
553f82d89dSTom Warren 	case 3:
56*29f3e3f2STom Warren 		host->base = TEGRA_SDMMC1_BASE;
573f82d89dSTom Warren 		host->mmc_id = PERIPH_ID_SDMMC1;
583f82d89dSTom Warren 		break;
593f82d89dSTom Warren 	case 0:
603f82d89dSTom Warren 	default:
61*29f3e3f2STom Warren 		host->base = TEGRA_SDMMC4_BASE;
623f82d89dSTom Warren 		host->mmc_id = PERIPH_ID_SDMMC4;
633f82d89dSTom Warren 		break;
643f82d89dSTom Warren 	}
653f82d89dSTom Warren 
66*29f3e3f2STom Warren 	host->reg = (struct tegra_mmc *)host->base;
673f82d89dSTom Warren }
683f82d89dSTom Warren 
693f82d89dSTom Warren static void mmc_prepare_data(struct mmc_host *host, struct mmc_data *data)
703f82d89dSTom Warren {
713f82d89dSTom Warren 	unsigned char ctrl;
723f82d89dSTom Warren 
733f82d89dSTom Warren 	debug("data->dest: %08X, data->blocks: %u, data->blocksize: %u\n",
743f82d89dSTom Warren 	(u32)data->dest, data->blocks, data->blocksize);
753f82d89dSTom Warren 
763f82d89dSTom Warren 	writel((u32)data->dest, &host->reg->sysad);
773f82d89dSTom Warren 	/*
783f82d89dSTom Warren 	 * DMASEL[4:3]
793f82d89dSTom Warren 	 * 00 = Selects SDMA
803f82d89dSTom Warren 	 * 01 = Reserved
813f82d89dSTom Warren 	 * 10 = Selects 32-bit Address ADMA2
823f82d89dSTom Warren 	 * 11 = Selects 64-bit Address ADMA2
833f82d89dSTom Warren 	 */
843f82d89dSTom Warren 	ctrl = readb(&host->reg->hostctl);
853f82d89dSTom Warren 	ctrl &= ~TEGRA_MMC_HOSTCTL_DMASEL_MASK;
863f82d89dSTom Warren 	ctrl |= TEGRA_MMC_HOSTCTL_DMASEL_SDMA;
873f82d89dSTom Warren 	writeb(ctrl, &host->reg->hostctl);
883f82d89dSTom Warren 
893f82d89dSTom Warren 	/* We do not handle DMA boundaries, so set it to max (512 KiB) */
903f82d89dSTom Warren 	writew((7 << 12) | (data->blocksize & 0xFFF), &host->reg->blksize);
913f82d89dSTom Warren 	writew(data->blocks, &host->reg->blkcnt);
923f82d89dSTom Warren }
933f82d89dSTom Warren 
943f82d89dSTom Warren static void mmc_set_transfer_mode(struct mmc_host *host, struct mmc_data *data)
953f82d89dSTom Warren {
963f82d89dSTom Warren 	unsigned short mode;
973f82d89dSTom Warren 	debug(" mmc_set_transfer_mode called\n");
983f82d89dSTom Warren 	/*
993f82d89dSTom Warren 	 * TRNMOD
1003f82d89dSTom Warren 	 * MUL1SIN0[5]	: Multi/Single Block Select
1013f82d89dSTom Warren 	 * RD1WT0[4]	: Data Transfer Direction Select
1023f82d89dSTom Warren 	 *	1 = read
1033f82d89dSTom Warren 	 *	0 = write
1043f82d89dSTom Warren 	 * ENACMD12[2]	: Auto CMD12 Enable
1053f82d89dSTom Warren 	 * ENBLKCNT[1]	: Block Count Enable
1063f82d89dSTom Warren 	 * ENDMA[0]	: DMA Enable
1073f82d89dSTom Warren 	 */
1083f82d89dSTom Warren 	mode = (TEGRA_MMC_TRNMOD_DMA_ENABLE |
1093f82d89dSTom Warren 		TEGRA_MMC_TRNMOD_BLOCK_COUNT_ENABLE);
1103f82d89dSTom Warren 
1113f82d89dSTom Warren 	if (data->blocks > 1)
1123f82d89dSTom Warren 		mode |= TEGRA_MMC_TRNMOD_MULTI_BLOCK_SELECT;
1133f82d89dSTom Warren 
1143f82d89dSTom Warren 	if (data->flags & MMC_DATA_READ)
1153f82d89dSTom Warren 		mode |= TEGRA_MMC_TRNMOD_DATA_XFER_DIR_SEL_READ;
1163f82d89dSTom Warren 
1173f82d89dSTom Warren 	if (data->flags & MMC_DATA_WRITE) {
1183f82d89dSTom Warren 		if ((uintptr_t)data->src & (ARCH_DMA_MINALIGN - 1))
1193f82d89dSTom Warren 			printf("Warning: unaligned write to %p may fail\n",
1203f82d89dSTom Warren 			       data->src);
1213f82d89dSTom Warren 		flush_dcache_range((ulong)data->src, (ulong)data->src +
1223f82d89dSTom Warren 			data->blocks * data->blocksize);
1233f82d89dSTom Warren 	}
1243f82d89dSTom Warren 
1253f82d89dSTom Warren 	writew(mode, &host->reg->trnmod);
1263f82d89dSTom Warren }
1273f82d89dSTom Warren 
1283f82d89dSTom Warren static int mmc_wait_inhibit(struct mmc_host *host,
1293f82d89dSTom Warren 			    struct mmc_cmd *cmd,
1303f82d89dSTom Warren 			    struct mmc_data *data,
1313f82d89dSTom Warren 			    unsigned int timeout)
1323f82d89dSTom Warren {
1333f82d89dSTom Warren 	/*
1343f82d89dSTom Warren 	 * PRNSTS
1353f82d89dSTom Warren 	 * CMDINHDAT[1] : Command Inhibit (DAT)
1363f82d89dSTom Warren 	 * CMDINHCMD[0] : Command Inhibit (CMD)
1373f82d89dSTom Warren 	 */
1383f82d89dSTom Warren 	unsigned int mask = TEGRA_MMC_PRNSTS_CMD_INHIBIT_CMD;
1393f82d89dSTom Warren 
1403f82d89dSTom Warren 	/*
1413f82d89dSTom Warren 	 * We shouldn't wait for data inhibit for stop commands, even
1423f82d89dSTom Warren 	 * though they might use busy signaling
1433f82d89dSTom Warren 	 */
1443f82d89dSTom Warren 	if ((data == NULL) && (cmd->resp_type & MMC_RSP_BUSY))
1453f82d89dSTom Warren 		mask |= TEGRA_MMC_PRNSTS_CMD_INHIBIT_DAT;
1463f82d89dSTom Warren 
1473f82d89dSTom Warren 	while (readl(&host->reg->prnsts) & mask) {
1483f82d89dSTom Warren 		if (timeout == 0) {
1493f82d89dSTom Warren 			printf("%s: timeout error\n", __func__);
1503f82d89dSTom Warren 			return -1;
1513f82d89dSTom Warren 		}
1523f82d89dSTom Warren 		timeout--;
1533f82d89dSTom Warren 		udelay(1000);
1543f82d89dSTom Warren 	}
1553f82d89dSTom Warren 
1563f82d89dSTom Warren 	return 0;
1573f82d89dSTom Warren }
1583f82d89dSTom Warren 
1593f82d89dSTom Warren static int mmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd,
1603f82d89dSTom Warren 			struct mmc_data *data)
1613f82d89dSTom Warren {
1623f82d89dSTom Warren 	struct mmc_host *host = (struct mmc_host *)mmc->priv;
1633f82d89dSTom Warren 	int flags, i;
1643f82d89dSTom Warren 	int result;
1653f82d89dSTom Warren 	unsigned int mask = 0;
1663f82d89dSTom Warren 	unsigned int retry = 0x100000;
1673f82d89dSTom Warren 	debug(" mmc_send_cmd called\n");
1683f82d89dSTom Warren 
1693f82d89dSTom Warren 	result = mmc_wait_inhibit(host, cmd, data, 10 /* ms */);
1703f82d89dSTom Warren 
1713f82d89dSTom Warren 	if (result < 0)
1723f82d89dSTom Warren 		return result;
1733f82d89dSTom Warren 
1743f82d89dSTom Warren 	if (data)
1753f82d89dSTom Warren 		mmc_prepare_data(host, data);
1763f82d89dSTom Warren 
1773f82d89dSTom Warren 	debug("cmd->arg: %08x\n", cmd->cmdarg);
1783f82d89dSTom Warren 	writel(cmd->cmdarg, &host->reg->argument);
1793f82d89dSTom Warren 
1803f82d89dSTom Warren 	if (data)
1813f82d89dSTom Warren 		mmc_set_transfer_mode(host, data);
1823f82d89dSTom Warren 
1833f82d89dSTom Warren 	if ((cmd->resp_type & MMC_RSP_136) && (cmd->resp_type & MMC_RSP_BUSY))
1843f82d89dSTom Warren 		return -1;
1853f82d89dSTom Warren 
1863f82d89dSTom Warren 	/*
1873f82d89dSTom Warren 	 * CMDREG
1883f82d89dSTom Warren 	 * CMDIDX[13:8]	: Command index
1893f82d89dSTom Warren 	 * DATAPRNT[5]	: Data Present Select
1903f82d89dSTom Warren 	 * ENCMDIDX[4]	: Command Index Check Enable
1913f82d89dSTom Warren 	 * ENCMDCRC[3]	: Command CRC Check Enable
1923f82d89dSTom Warren 	 * RSPTYP[1:0]
1933f82d89dSTom Warren 	 *	00 = No Response
1943f82d89dSTom Warren 	 *	01 = Length 136
1953f82d89dSTom Warren 	 *	10 = Length 48
1963f82d89dSTom Warren 	 *	11 = Length 48 Check busy after response
1973f82d89dSTom Warren 	 */
1983f82d89dSTom Warren 	if (!(cmd->resp_type & MMC_RSP_PRESENT))
1993f82d89dSTom Warren 		flags = TEGRA_MMC_CMDREG_RESP_TYPE_SELECT_NO_RESPONSE;
2003f82d89dSTom Warren 	else if (cmd->resp_type & MMC_RSP_136)
2013f82d89dSTom Warren 		flags = TEGRA_MMC_CMDREG_RESP_TYPE_SELECT_LENGTH_136;
2023f82d89dSTom Warren 	else if (cmd->resp_type & MMC_RSP_BUSY)
2033f82d89dSTom Warren 		flags = TEGRA_MMC_CMDREG_RESP_TYPE_SELECT_LENGTH_48_BUSY;
2043f82d89dSTom Warren 	else
2053f82d89dSTom Warren 		flags = TEGRA_MMC_CMDREG_RESP_TYPE_SELECT_LENGTH_48;
2063f82d89dSTom Warren 
2073f82d89dSTom Warren 	if (cmd->resp_type & MMC_RSP_CRC)
2083f82d89dSTom Warren 		flags |= TEGRA_MMC_TRNMOD_CMD_CRC_CHECK;
2093f82d89dSTom Warren 	if (cmd->resp_type & MMC_RSP_OPCODE)
2103f82d89dSTom Warren 		flags |= TEGRA_MMC_TRNMOD_CMD_INDEX_CHECK;
2113f82d89dSTom Warren 	if (data)
2123f82d89dSTom Warren 		flags |= TEGRA_MMC_TRNMOD_DATA_PRESENT_SELECT_DATA_TRANSFER;
2133f82d89dSTom Warren 
2143f82d89dSTom Warren 	debug("cmd: %d\n", cmd->cmdidx);
2153f82d89dSTom Warren 
2163f82d89dSTom Warren 	writew((cmd->cmdidx << 8) | flags, &host->reg->cmdreg);
2173f82d89dSTom Warren 
2183f82d89dSTom Warren 	for (i = 0; i < retry; i++) {
2193f82d89dSTom Warren 		mask = readl(&host->reg->norintsts);
2203f82d89dSTom Warren 		/* Command Complete */
2213f82d89dSTom Warren 		if (mask & TEGRA_MMC_NORINTSTS_CMD_COMPLETE) {
2223f82d89dSTom Warren 			if (!data)
2233f82d89dSTom Warren 				writel(mask, &host->reg->norintsts);
2243f82d89dSTom Warren 			break;
2253f82d89dSTom Warren 		}
2263f82d89dSTom Warren 	}
2273f82d89dSTom Warren 
2283f82d89dSTom Warren 	if (i == retry) {
2293f82d89dSTom Warren 		printf("%s: waiting for status update\n", __func__);
2303f82d89dSTom Warren 		writel(mask, &host->reg->norintsts);
2313f82d89dSTom Warren 		return TIMEOUT;
2323f82d89dSTom Warren 	}
2333f82d89dSTom Warren 
2343f82d89dSTom Warren 	if (mask & TEGRA_MMC_NORINTSTS_CMD_TIMEOUT) {
2353f82d89dSTom Warren 		/* Timeout Error */
2363f82d89dSTom Warren 		debug("timeout: %08x cmd %d\n", mask, cmd->cmdidx);
2373f82d89dSTom Warren 		writel(mask, &host->reg->norintsts);
2383f82d89dSTom Warren 		return TIMEOUT;
2393f82d89dSTom Warren 	} else if (mask & TEGRA_MMC_NORINTSTS_ERR_INTERRUPT) {
2403f82d89dSTom Warren 		/* Error Interrupt */
2413f82d89dSTom Warren 		debug("error: %08x cmd %d\n", mask, cmd->cmdidx);
2423f82d89dSTom Warren 		writel(mask, &host->reg->norintsts);
2433f82d89dSTom Warren 		return -1;
2443f82d89dSTom Warren 	}
2453f82d89dSTom Warren 
2463f82d89dSTom Warren 	if (cmd->resp_type & MMC_RSP_PRESENT) {
2473f82d89dSTom Warren 		if (cmd->resp_type & MMC_RSP_136) {
2483f82d89dSTom Warren 			/* CRC is stripped so we need to do some shifting. */
2493f82d89dSTom Warren 			for (i = 0; i < 4; i++) {
2503f82d89dSTom Warren 				unsigned int offset =
2513f82d89dSTom Warren 					(unsigned int)(&host->reg->rspreg3 - i);
2523f82d89dSTom Warren 				cmd->response[i] = readl(offset) << 8;
2533f82d89dSTom Warren 
2543f82d89dSTom Warren 				if (i != 3) {
2553f82d89dSTom Warren 					cmd->response[i] |=
2563f82d89dSTom Warren 						readb(offset - 1);
2573f82d89dSTom Warren 				}
2583f82d89dSTom Warren 				debug("cmd->resp[%d]: %08x\n",
2593f82d89dSTom Warren 						i, cmd->response[i]);
2603f82d89dSTom Warren 			}
2613f82d89dSTom Warren 		} else if (cmd->resp_type & MMC_RSP_BUSY) {
2623f82d89dSTom Warren 			for (i = 0; i < retry; i++) {
2633f82d89dSTom Warren 				/* PRNTDATA[23:20] : DAT[3:0] Line Signal */
2643f82d89dSTom Warren 				if (readl(&host->reg->prnsts)
2653f82d89dSTom Warren 					& (1 << 20))	/* DAT[0] */
2663f82d89dSTom Warren 					break;
2673f82d89dSTom Warren 			}
2683f82d89dSTom Warren 
2693f82d89dSTom Warren 			if (i == retry) {
2703f82d89dSTom Warren 				printf("%s: card is still busy\n", __func__);
2713f82d89dSTom Warren 				writel(mask, &host->reg->norintsts);
2723f82d89dSTom Warren 				return TIMEOUT;
2733f82d89dSTom Warren 			}
2743f82d89dSTom Warren 
2753f82d89dSTom Warren 			cmd->response[0] = readl(&host->reg->rspreg0);
2763f82d89dSTom Warren 			debug("cmd->resp[0]: %08x\n", cmd->response[0]);
2773f82d89dSTom Warren 		} else {
2783f82d89dSTom Warren 			cmd->response[0] = readl(&host->reg->rspreg0);
2793f82d89dSTom Warren 			debug("cmd->resp[0]: %08x\n", cmd->response[0]);
2803f82d89dSTom Warren 		}
2813f82d89dSTom Warren 	}
2823f82d89dSTom Warren 
2833f82d89dSTom Warren 	if (data) {
2843f82d89dSTom Warren 		unsigned long	start = get_timer(0);
2853f82d89dSTom Warren 
2863f82d89dSTom Warren 		while (1) {
2873f82d89dSTom Warren 			mask = readl(&host->reg->norintsts);
2883f82d89dSTom Warren 
2893f82d89dSTom Warren 			if (mask & TEGRA_MMC_NORINTSTS_ERR_INTERRUPT) {
2903f82d89dSTom Warren 				/* Error Interrupt */
2913f82d89dSTom Warren 				writel(mask, &host->reg->norintsts);
2923f82d89dSTom Warren 				printf("%s: error during transfer: 0x%08x\n",
2933f82d89dSTom Warren 						__func__, mask);
2943f82d89dSTom Warren 				return -1;
2953f82d89dSTom Warren 			} else if (mask & TEGRA_MMC_NORINTSTS_DMA_INTERRUPT) {
2963f82d89dSTom Warren 				/*
2973f82d89dSTom Warren 				 * DMA Interrupt, restart the transfer where
2983f82d89dSTom Warren 				 * it was interrupted.
2993f82d89dSTom Warren 				 */
3003f82d89dSTom Warren 				unsigned int address = readl(&host->reg->sysad);
3013f82d89dSTom Warren 
3023f82d89dSTom Warren 				debug("DMA end\n");
3033f82d89dSTom Warren 				writel(TEGRA_MMC_NORINTSTS_DMA_INTERRUPT,
3043f82d89dSTom Warren 				       &host->reg->norintsts);
3053f82d89dSTom Warren 				writel(address, &host->reg->sysad);
3063f82d89dSTom Warren 			} else if (mask & TEGRA_MMC_NORINTSTS_XFER_COMPLETE) {
3073f82d89dSTom Warren 				/* Transfer Complete */
3083f82d89dSTom Warren 				debug("r/w is done\n");
3093f82d89dSTom Warren 				break;
3103f82d89dSTom Warren 			} else if (get_timer(start) > 2000UL) {
3113f82d89dSTom Warren 				writel(mask, &host->reg->norintsts);
3123f82d89dSTom Warren 				printf("%s: MMC Timeout\n"
3133f82d89dSTom Warren 				       "    Interrupt status        0x%08x\n"
3143f82d89dSTom Warren 				       "    Interrupt status enable 0x%08x\n"
3153f82d89dSTom Warren 				       "    Interrupt signal enable 0x%08x\n"
3163f82d89dSTom Warren 				       "    Present status          0x%08x\n",
3173f82d89dSTom Warren 				       __func__, mask,
3183f82d89dSTom Warren 				       readl(&host->reg->norintstsen),
3193f82d89dSTom Warren 				       readl(&host->reg->norintsigen),
3203f82d89dSTom Warren 				       readl(&host->reg->prnsts));
3213f82d89dSTom Warren 				return -1;
3223f82d89dSTom Warren 			}
3233f82d89dSTom Warren 		}
3243f82d89dSTom Warren 		writel(mask, &host->reg->norintsts);
3253f82d89dSTom Warren 		if (data->flags & MMC_DATA_READ) {
3263f82d89dSTom Warren 			if ((uintptr_t)data->dest & (ARCH_DMA_MINALIGN - 1))
3273f82d89dSTom Warren 				printf("Warning: unaligned read from %p "
3283f82d89dSTom Warren 					"may fail\n", data->dest);
3293f82d89dSTom Warren 			invalidate_dcache_range((ulong)data->dest,
3303f82d89dSTom Warren 				(ulong)data->dest +
3313f82d89dSTom Warren 					data->blocks * data->blocksize);
3323f82d89dSTom Warren 		}
3333f82d89dSTom Warren 	}
3343f82d89dSTom Warren 
3353f82d89dSTom Warren 	udelay(1000);
3363f82d89dSTom Warren 	return 0;
3373f82d89dSTom Warren }
3383f82d89dSTom Warren 
3393f82d89dSTom Warren static void mmc_change_clock(struct mmc_host *host, uint clock)
3403f82d89dSTom Warren {
3413f82d89dSTom Warren 	int div;
3423f82d89dSTom Warren 	unsigned short clk;
3433f82d89dSTom Warren 	unsigned long timeout;
3443f82d89dSTom Warren 
3453f82d89dSTom Warren 	debug(" mmc_change_clock called\n");
3463f82d89dSTom Warren 
3473f82d89dSTom Warren 	/*
348*29f3e3f2STom Warren 	 * Change Tegra SDMMCx clock divisor here. Source is 216MHz,
3493f82d89dSTom Warren 	 * PLLP_OUT0
3503f82d89dSTom Warren 	 */
3513f82d89dSTom Warren 	if (clock == 0)
3523f82d89dSTom Warren 		goto out;
3533f82d89dSTom Warren 	clock_adjust_periph_pll_div(host->mmc_id, CLOCK_ID_PERIPH, clock,
3543f82d89dSTom Warren 				    &div);
3553f82d89dSTom Warren 	debug("div = %d\n", div);
3563f82d89dSTom Warren 
3573f82d89dSTom Warren 	writew(0, &host->reg->clkcon);
3583f82d89dSTom Warren 
3593f82d89dSTom Warren 	/*
3603f82d89dSTom Warren 	 * CLKCON
3613f82d89dSTom Warren 	 * SELFREQ[15:8]	: base clock divided by value
3623f82d89dSTom Warren 	 * ENSDCLK[2]		: SD Clock Enable
3633f82d89dSTom Warren 	 * STBLINTCLK[1]	: Internal Clock Stable
3643f82d89dSTom Warren 	 * ENINTCLK[0]		: Internal Clock Enable
3653f82d89dSTom Warren 	 */
3663f82d89dSTom Warren 	div >>= 1;
3673f82d89dSTom Warren 	clk = ((div << TEGRA_MMC_CLKCON_SDCLK_FREQ_SEL_SHIFT) |
3683f82d89dSTom Warren 	       TEGRA_MMC_CLKCON_INTERNAL_CLOCK_ENABLE);
3693f82d89dSTom Warren 	writew(clk, &host->reg->clkcon);
3703f82d89dSTom Warren 
3713f82d89dSTom Warren 	/* Wait max 10 ms */
3723f82d89dSTom Warren 	timeout = 10;
3733f82d89dSTom Warren 	while (!(readw(&host->reg->clkcon) &
3743f82d89dSTom Warren 		 TEGRA_MMC_CLKCON_INTERNAL_CLOCK_STABLE)) {
3753f82d89dSTom Warren 		if (timeout == 0) {
3763f82d89dSTom Warren 			printf("%s: timeout error\n", __func__);
3773f82d89dSTom Warren 			return;
3783f82d89dSTom Warren 		}
3793f82d89dSTom Warren 		timeout--;
3803f82d89dSTom Warren 		udelay(1000);
3813f82d89dSTom Warren 	}
3823f82d89dSTom Warren 
3833f82d89dSTom Warren 	clk |= TEGRA_MMC_CLKCON_SD_CLOCK_ENABLE;
3843f82d89dSTom Warren 	writew(clk, &host->reg->clkcon);
3853f82d89dSTom Warren 
3863f82d89dSTom Warren 	debug("mmc_change_clock: clkcon = %08X\n", clk);
3873f82d89dSTom Warren 
3883f82d89dSTom Warren out:
3893f82d89dSTom Warren 	host->clock = clock;
3903f82d89dSTom Warren }
3913f82d89dSTom Warren 
3923f82d89dSTom Warren static void mmc_set_ios(struct mmc *mmc)
3933f82d89dSTom Warren {
3943f82d89dSTom Warren 	struct mmc_host *host = mmc->priv;
3953f82d89dSTom Warren 	unsigned char ctrl;
3963f82d89dSTom Warren 	debug(" mmc_set_ios called\n");
3973f82d89dSTom Warren 
3983f82d89dSTom Warren 	debug("bus_width: %x, clock: %d\n", mmc->bus_width, mmc->clock);
3993f82d89dSTom Warren 
4003f82d89dSTom Warren 	/* Change clock first */
4013f82d89dSTom Warren 	mmc_change_clock(host, mmc->clock);
4023f82d89dSTom Warren 
4033f82d89dSTom Warren 	ctrl = readb(&host->reg->hostctl);
4043f82d89dSTom Warren 
4053f82d89dSTom Warren 	/*
4063f82d89dSTom Warren 	 * WIDE8[5]
4073f82d89dSTom Warren 	 * 0 = Depend on WIDE4
4083f82d89dSTom Warren 	 * 1 = 8-bit mode
4093f82d89dSTom Warren 	 * WIDE4[1]
4103f82d89dSTom Warren 	 * 1 = 4-bit mode
4113f82d89dSTom Warren 	 * 0 = 1-bit mode
4123f82d89dSTom Warren 	 */
4133f82d89dSTom Warren 	if (mmc->bus_width == 8)
4143f82d89dSTom Warren 		ctrl |= (1 << 5);
4153f82d89dSTom Warren 	else if (mmc->bus_width == 4)
4163f82d89dSTom Warren 		ctrl |= (1 << 1);
4173f82d89dSTom Warren 	else
4183f82d89dSTom Warren 		ctrl &= ~(1 << 1);
4193f82d89dSTom Warren 
4203f82d89dSTom Warren 	writeb(ctrl, &host->reg->hostctl);
4213f82d89dSTom Warren 	debug("mmc_set_ios: hostctl = %08X\n", ctrl);
4223f82d89dSTom Warren }
4233f82d89dSTom Warren 
4243f82d89dSTom Warren static void mmc_reset(struct mmc_host *host)
4253f82d89dSTom Warren {
4263f82d89dSTom Warren 	unsigned int timeout;
4273f82d89dSTom Warren 	debug(" mmc_reset called\n");
4283f82d89dSTom Warren 
4293f82d89dSTom Warren 	/*
4303f82d89dSTom Warren 	 * RSTALL[0] : Software reset for all
4313f82d89dSTom Warren 	 * 1 = reset
4323f82d89dSTom Warren 	 * 0 = work
4333f82d89dSTom Warren 	 */
4343f82d89dSTom Warren 	writeb(TEGRA_MMC_SWRST_SW_RESET_FOR_ALL, &host->reg->swrst);
4353f82d89dSTom Warren 
4363f82d89dSTom Warren 	host->clock = 0;
4373f82d89dSTom Warren 
4383f82d89dSTom Warren 	/* Wait max 100 ms */
4393f82d89dSTom Warren 	timeout = 100;
4403f82d89dSTom Warren 
4413f82d89dSTom Warren 	/* hw clears the bit when it's done */
4423f82d89dSTom Warren 	while (readb(&host->reg->swrst) & TEGRA_MMC_SWRST_SW_RESET_FOR_ALL) {
4433f82d89dSTom Warren 		if (timeout == 0) {
4443f82d89dSTom Warren 			printf("%s: timeout error\n", __func__);
4453f82d89dSTom Warren 			return;
4463f82d89dSTom Warren 		}
4473f82d89dSTom Warren 		timeout--;
4483f82d89dSTom Warren 		udelay(1000);
4493f82d89dSTom Warren 	}
4503f82d89dSTom Warren }
4513f82d89dSTom Warren 
4523f82d89dSTom Warren static int mmc_core_init(struct mmc *mmc)
4533f82d89dSTom Warren {
4543f82d89dSTom Warren 	struct mmc_host *host = (struct mmc_host *)mmc->priv;
4553f82d89dSTom Warren 	unsigned int mask;
4563f82d89dSTom Warren 	debug(" mmc_core_init called\n");
4573f82d89dSTom Warren 
4583f82d89dSTom Warren 	mmc_reset(host);
4593f82d89dSTom Warren 
4603f82d89dSTom Warren 	host->version = readw(&host->reg->hcver);
4613f82d89dSTom Warren 	debug("host version = %x\n", host->version);
4623f82d89dSTom Warren 
4633f82d89dSTom Warren 	/* mask all */
4643f82d89dSTom Warren 	writel(0xffffffff, &host->reg->norintstsen);
4653f82d89dSTom Warren 	writel(0xffffffff, &host->reg->norintsigen);
4663f82d89dSTom Warren 
4673f82d89dSTom Warren 	writeb(0xe, &host->reg->timeoutcon);	/* TMCLK * 2^27 */
4683f82d89dSTom Warren 	/*
4693f82d89dSTom Warren 	 * NORMAL Interrupt Status Enable Register init
4703f82d89dSTom Warren 	 * [5] ENSTABUFRDRDY : Buffer Read Ready Status Enable
4713f82d89dSTom Warren 	 * [4] ENSTABUFWTRDY : Buffer write Ready Status Enable
4723f82d89dSTom Warren 	 * [3] ENSTADMAINT   : DMA boundary interrupt
4733f82d89dSTom Warren 	 * [1] ENSTASTANSCMPLT : Transfre Complete Status Enable
4743f82d89dSTom Warren 	 * [0] ENSTACMDCMPLT : Command Complete Status Enable
4753f82d89dSTom Warren 	*/
4763f82d89dSTom Warren 	mask = readl(&host->reg->norintstsen);
4773f82d89dSTom Warren 	mask &= ~(0xffff);
4783f82d89dSTom Warren 	mask |= (TEGRA_MMC_NORINTSTSEN_CMD_COMPLETE |
4793f82d89dSTom Warren 		 TEGRA_MMC_NORINTSTSEN_XFER_COMPLETE |
4803f82d89dSTom Warren 		 TEGRA_MMC_NORINTSTSEN_DMA_INTERRUPT |
4813f82d89dSTom Warren 		 TEGRA_MMC_NORINTSTSEN_BUFFER_WRITE_READY |
4823f82d89dSTom Warren 		 TEGRA_MMC_NORINTSTSEN_BUFFER_READ_READY);
4833f82d89dSTom Warren 	writel(mask, &host->reg->norintstsen);
4843f82d89dSTom Warren 
4853f82d89dSTom Warren 	/*
4863f82d89dSTom Warren 	 * NORMAL Interrupt Signal Enable Register init
4873f82d89dSTom Warren 	 * [1] ENSTACMDCMPLT : Transfer Complete Signal Enable
4883f82d89dSTom Warren 	 */
4893f82d89dSTom Warren 	mask = readl(&host->reg->norintsigen);
4903f82d89dSTom Warren 	mask &= ~(0xffff);
4913f82d89dSTom Warren 	mask |= TEGRA_MMC_NORINTSIGEN_XFER_COMPLETE;
4923f82d89dSTom Warren 	writel(mask, &host->reg->norintsigen);
4933f82d89dSTom Warren 
4943f82d89dSTom Warren 	return 0;
4953f82d89dSTom Warren }
4963f82d89dSTom Warren 
497*29f3e3f2STom Warren int tegra_mmc_getcd(struct mmc *mmc)
4983f82d89dSTom Warren {
4993f82d89dSTom Warren 	struct mmc_host *host = (struct mmc_host *)mmc->priv;
5003f82d89dSTom Warren 
501*29f3e3f2STom Warren 	debug("tegra_mmc_getcd called\n");
5023f82d89dSTom Warren 
5033f82d89dSTom Warren 	if (host->cd_gpio >= 0)
5043f82d89dSTom Warren 		return !gpio_get_value(host->cd_gpio);
5053f82d89dSTom Warren 
5063f82d89dSTom Warren 	return 1;
5073f82d89dSTom Warren }
5083f82d89dSTom Warren 
509*29f3e3f2STom Warren int tegra_mmc_init(int dev_index, int bus_width, int pwr_gpio, int cd_gpio)
5103f82d89dSTom Warren {
5113f82d89dSTom Warren 	struct mmc_host *host;
5123f82d89dSTom Warren 	char gpusage[12]; /* "SD/MMCn PWR" or "SD/MMCn CD" */
5133f82d89dSTom Warren 	struct mmc *mmc;
5143f82d89dSTom Warren 
515*29f3e3f2STom Warren 	debug(" tegra_mmc_init: index %d, bus width %d "
5163f82d89dSTom Warren 		"pwr_gpio %d cd_gpio %d\n",
5173f82d89dSTom Warren 		dev_index, bus_width, pwr_gpio, cd_gpio);
5183f82d89dSTom Warren 
5193f82d89dSTom Warren 	host = &mmc_host[dev_index];
5203f82d89dSTom Warren 
5213f82d89dSTom Warren 	host->clock = 0;
5223f82d89dSTom Warren 	host->pwr_gpio = pwr_gpio;
5233f82d89dSTom Warren 	host->cd_gpio = cd_gpio;
524*29f3e3f2STom Warren 	tegra_get_setup(host, dev_index);
5253f82d89dSTom Warren 
5263f82d89dSTom Warren 	clock_start_periph_pll(host->mmc_id, CLOCK_ID_PERIPH, 20000000);
5273f82d89dSTom Warren 
5283f82d89dSTom Warren 	if (host->pwr_gpio >= 0) {
5293f82d89dSTom Warren 		sprintf(gpusage, "SD/MMC%d PWR", dev_index);
5303f82d89dSTom Warren 		gpio_request(host->pwr_gpio, gpusage);
5313f82d89dSTom Warren 		gpio_direction_output(host->pwr_gpio, 1);
5323f82d89dSTom Warren 	}
5333f82d89dSTom Warren 
5343f82d89dSTom Warren 	if (host->cd_gpio >= 0) {
5353f82d89dSTom Warren 		sprintf(gpusage, "SD/MMC%d CD", dev_index);
5363f82d89dSTom Warren 		gpio_request(host->cd_gpio, gpusage);
5373f82d89dSTom Warren 		gpio_direction_input(host->cd_gpio);
5383f82d89dSTom Warren 	}
5393f82d89dSTom Warren 
5403f82d89dSTom Warren 	mmc = &mmc_dev[dev_index];
5413f82d89dSTom Warren 
542*29f3e3f2STom Warren 	sprintf(mmc->name, "Tegra SD/MMC");
5433f82d89dSTom Warren 	mmc->priv = host;
5443f82d89dSTom Warren 	mmc->send_cmd = mmc_send_cmd;
5453f82d89dSTom Warren 	mmc->set_ios = mmc_set_ios;
5463f82d89dSTom Warren 	mmc->init = mmc_core_init;
547*29f3e3f2STom Warren 	mmc->getcd = tegra_mmc_getcd;
5483f82d89dSTom Warren 
5493f82d89dSTom Warren 	mmc->voltages = MMC_VDD_32_33 | MMC_VDD_33_34 | MMC_VDD_165_195;
5503f82d89dSTom Warren 	if (bus_width == 8)
5513f82d89dSTom Warren 		mmc->host_caps = MMC_MODE_8BIT;
5523f82d89dSTom Warren 	else
5533f82d89dSTom Warren 		mmc->host_caps = MMC_MODE_4BIT;
5543f82d89dSTom Warren 	mmc->host_caps |= MMC_MODE_HS_52MHz | MMC_MODE_HS | MMC_MODE_HC;
5553f82d89dSTom Warren 
5563f82d89dSTom Warren 	/*
5573f82d89dSTom Warren 	 * min freq is for card identification, and is the highest
5583f82d89dSTom Warren 	 *  low-speed SDIO card frequency (actually 400KHz)
5593f82d89dSTom Warren 	 * max freq is highest HS eMMC clock as per the SD/MMC spec
5603f82d89dSTom Warren 	 *  (actually 52MHz)
5613f82d89dSTom Warren 	 * Both of these are the closest equivalents w/216MHz source
562*29f3e3f2STom Warren 	 *  clock and Tegra SDMMC divisors.
5633f82d89dSTom Warren 	 */
5643f82d89dSTom Warren 	mmc->f_min = 375000;
5653f82d89dSTom Warren 	mmc->f_max = 48000000;
5663f82d89dSTom Warren 
5673f82d89dSTom Warren 	mmc_register(mmc);
5683f82d89dSTom Warren 
5693f82d89dSTom Warren 	return 0;
5703f82d89dSTom Warren }
571