[people/ms/u-boot.git] / drivers / mmc / dw_mmc.c

/*
 * (C) Copyright 2012 SAMSUNG Electronics
 * Jaehoon Chung <jh80.chung@samsung.com>
 * Rajeshawari Shinde <rajeshwari.s@samsung.com>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <bouncebuf.h>
#include <common.h>
#include <malloc.h>
#include <mmc.h>
#include <dwmmc.h>
#include <asm-generic/errno.h>

#define PAGE_SIZE 4096

static int dwmci_wait_reset(struct dwmci_host *host, u32 value)
{
	unsigned long timeout = 1000;
	u32 ctrl;

	dwmci_writel(host, DWMCI_CTRL, value);

	while (timeout--) {
		ctrl = dwmci_readl(host, DWMCI_CTRL);
		if (!(ctrl & DWMCI_RESET_ALL))
			return 1;
	}
	return 0;
}

static void dwmci_set_idma_desc(struct dwmci_idmac *idmac,
		u32 desc0, u32 desc1, u32 desc2)
{
	struct dwmci_idmac *desc = idmac;

	desc->flags = desc0;
	desc->cnt = desc1;
	desc->addr = desc2;
	desc->next_addr = (unsigned int)desc + sizeof(struct dwmci_idmac);
}

static void dwmci_prepare_data(struct dwmci_host *host,
			       struct mmc_data *data,
			       struct dwmci_idmac *cur_idmac,
			       void *bounce_buffer)
{
	unsigned long ctrl;
	unsigned int i = 0, flags, cnt, blk_cnt;
	ulong data_start, data_end;


	blk_cnt = data->blocks;

	dwmci_wait_reset(host, DWMCI_CTRL_FIFO_RESET);

	data_start = (ulong)cur_idmac;
	dwmci_writel(host, DWMCI_DBADDR, (unsigned int)cur_idmac);

	do {
		flags = DWMCI_IDMAC_OWN | DWMCI_IDMAC_CH ;
		flags |= (i == 0) ? DWMCI_IDMAC_FS : 0;
		if (blk_cnt <= 8) {
			flags |= DWMCI_IDMAC_LD;
			cnt = data->blocksize * blk_cnt;
		} else
			cnt = data->blocksize * 8;

		dwmci_set_idma_desc(cur_idmac, flags, cnt,
				    (u32)bounce_buffer + (i * PAGE_SIZE));

		if (blk_cnt <= 8)
			break;
		blk_cnt -= 8;
		cur_idmac++;
		i++;
	} while(1);

	data_end = (ulong)cur_idmac;
	flush_dcache_range(data_start, data_end + ARCH_DMA_MINALIGN);

	ctrl = dwmci_readl(host, DWMCI_CTRL);
	ctrl |= DWMCI_IDMAC_EN | DWMCI_DMA_EN;
	dwmci_writel(host, DWMCI_CTRL, ctrl);

	ctrl = dwmci_readl(host, DWMCI_BMOD);
	ctrl |= DWMCI_BMOD_IDMAC_FB | DWMCI_BMOD_IDMAC_EN;
	dwmci_writel(host, DWMCI_BMOD, ctrl);

	dwmci_writel(host, DWMCI_BLKSIZ, data->blocksize);
	dwmci_writel(host, DWMCI_BYTCNT, data->blocksize * data->blocks);
}

static int dwmci_set_transfer_mode(struct dwmci_host *host,
		struct mmc_data *data)
{
	unsigned long mode;

	mode = DWMCI_CMD_DATA_EXP;
	if (data->flags & MMC_DATA_WRITE)
		mode |= DWMCI_CMD_RW;

	return mode;
}

static int dwmci_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd,
		struct mmc_data *data)
{
	struct dwmci_host *host = mmc->priv;
	ALLOC_CACHE_ALIGN_BUFFER(struct dwmci_idmac, cur_idmac,
				 data ? DIV_ROUND_UP(data->blocks, 8) : 0);
	int flags = 0, i;
	unsigned int timeout = 100000;
	u32 retry = 10000;
	u32 mask, ctrl;
	ulong start = get_timer(0);
	struct bounce_buffer bbstate;

	while (dwmci_readl(host, DWMCI_STATUS) & DWMCI_BUSY) {
		if (get_timer(start) > timeout) {
			printf("%s: Timeout on data busy\n", __func__);
			return TIMEOUT;
		}
	}

	dwmci_writel(host, DWMCI_RINTSTS, DWMCI_INTMSK_ALL);

	if (data) {
		if (data->flags == MMC_DATA_READ) {
			bounce_buffer_start(&bbstate, (void*)data->dest,
					    data->blocksize *
					    data->blocks, GEN_BB_WRITE);
		} else {
			bounce_buffer_start(&bbstate, (void*)data->src,
					    data->blocksize *
					    data->blocks, GEN_BB_READ);
		}
		dwmci_prepare_data(host, data, cur_idmac,
				   bbstate.bounce_buffer);
	}

	dwmci_writel(host, DWMCI_CMDARG, cmd->cmdarg);

	if (data)
		flags = dwmci_set_transfer_mode(host, data);

	if ((cmd->resp_type & MMC_RSP_136) && (cmd->resp_type & MMC_RSP_BUSY))
		return -1;

	if (cmd->cmdidx == MMC_CMD_STOP_TRANSMISSION)
		flags |= DWMCI_CMD_ABORT_STOP;
	else
		flags |= DWMCI_CMD_PRV_DAT_WAIT;

	if (cmd->resp_type & MMC_RSP_PRESENT) {
		flags |= DWMCI_CMD_RESP_EXP;
		if (cmd->resp_type & MMC_RSP_136)
			flags |= DWMCI_CMD_RESP_LENGTH;
	}

	if (cmd->resp_type & MMC_RSP_CRC)
		flags |= DWMCI_CMD_CHECK_CRC;

	flags |= (cmd->cmdidx | DWMCI_CMD_START | DWMCI_CMD_USE_HOLD_REG);

	debug("Sending CMD%d\n",cmd->cmdidx);

	dwmci_writel(host, DWMCI_CMD, flags);

	for (i = 0; i < retry; i++) {
		mask = dwmci_readl(host, DWMCI_RINTSTS);
		if (mask & DWMCI_INTMSK_CDONE) {
			if (!data)
				dwmci_writel(host, DWMCI_RINTSTS, mask);
			break;
		}
	}

	if (i == retry) {
		printf("%s: Timeout.\n", __func__);
		return TIMEOUT;
	}

	if (mask & DWMCI_INTMSK_RTO) {
		/*
		 * Timeout here is not necessarily fatal. (e)MMC cards
		 * will splat here when they receive CMD55 as they do
		 * not support this command and that is exactly the way
		 * to tell them apart from SD cards. Thus, this output
		 * below shall be debug(). eMMC cards also do not favor
		 * CMD8, please keep that in mind.
		 */
		debug("%s: Response Timeout.\n", __func__);
		return TIMEOUT;
	} else if (mask & DWMCI_INTMSK_RE) {
		printf("%s: Response Error.\n", __func__);
		return -1;
	}


	if (cmd->resp_type & MMC_RSP_PRESENT) {
		if (cmd->resp_type & MMC_RSP_136) {
			cmd->response[0] = dwmci_readl(host, DWMCI_RESP3);
			cmd->response[1] = dwmci_readl(host, DWMCI_RESP2);
			cmd->response[2] = dwmci_readl(host, DWMCI_RESP1);
			cmd->response[3] = dwmci_readl(host, DWMCI_RESP0);
		} else {
			cmd->response[0] = dwmci_readl(host, DWMCI_RESP0);
		}
	}

	if (data) {
		do {
			mask = dwmci_readl(host, DWMCI_RINTSTS);
			if (mask & (DWMCI_DATA_ERR | DWMCI_DATA_TOUT)) {
				printf("%s: DATA ERROR!\n", __func__);
				return -1;
			}
		} while (!(mask & DWMCI_INTMSK_DTO));

		dwmci_writel(host, DWMCI_RINTSTS, mask);

		ctrl = dwmci_readl(host, DWMCI_CTRL);
		ctrl &= ~(DWMCI_DMA_EN);
		dwmci_writel(host, DWMCI_CTRL, ctrl);

		bounce_buffer_stop(&bbstate);
	}

	udelay(100);

	return 0;
}

static int dwmci_setup_bus(struct dwmci_host *host, u32 freq)
{
	u32 div, status;
	int timeout = 10000;
	unsigned long sclk;

	if ((freq == host->clock) || (freq == 0))
		return 0;
	/*
	 * If host->get_mmc_clk isn't defined,
	 * then assume that host->bus_hz is source clock value.
	 * host->bus_hz should be set by user.
	 */
	if (host->get_mmc_clk)
		sclk = host->get_mmc_clk(host);
	else if (host->bus_hz)
		sclk = host->bus_hz;
	else {
		printf("%s: Didn't get source clock value.\n", __func__);
		return -EINVAL;
	}

	if (sclk == freq)
		div = 0;	/* bypass mode */
	else
		div = DIV_ROUND_UP(sclk, 2 * freq);

	dwmci_writel(host, DWMCI_CLKENA, 0);
	dwmci_writel(host, DWMCI_CLKSRC, 0);

	dwmci_writel(host, DWMCI_CLKDIV, div);
	dwmci_writel(host, DWMCI_CMD, DWMCI_CMD_PRV_DAT_WAIT |
			DWMCI_CMD_UPD_CLK | DWMCI_CMD_START);

	do {
		status = dwmci_readl(host, DWMCI_CMD);
		if (timeout-- < 0) {
			printf("%s: Timeout!\n", __func__);
			return -ETIMEDOUT;
		}
	} while (status & DWMCI_CMD_START);

	dwmci_writel(host, DWMCI_CLKENA, DWMCI_CLKEN_ENABLE |
			DWMCI_CLKEN_LOW_PWR);

	dwmci_writel(host, DWMCI_CMD, DWMCI_CMD_PRV_DAT_WAIT |
			DWMCI_CMD_UPD_CLK | DWMCI_CMD_START);

	timeout = 10000;
	do {
		status = dwmci_readl(host, DWMCI_CMD);
		if (timeout-- < 0) {
			printf("%s: Timeout!\n", __func__);
			return -ETIMEDOUT;
		}
	} while (status & DWMCI_CMD_START);

	host->clock = freq;

	return 0;
}

static void dwmci_set_ios(struct mmc *mmc)
{
	struct dwmci_host *host = (struct dwmci_host *)mmc->priv;
	u32 ctype, regs;

	debug("Buswidth = %d, clock: %d\n", mmc->bus_width, mmc->clock);

	dwmci_setup_bus(host, mmc->clock);
	switch (mmc->bus_width) {
	case 8:
		ctype = DWMCI_CTYPE_8BIT;
		break;
	case 4:
		ctype = DWMCI_CTYPE_4BIT;
		break;
	default:
		ctype = DWMCI_CTYPE_1BIT;
		break;
	}

	dwmci_writel(host, DWMCI_CTYPE, ctype);

	regs = dwmci_readl(host, DWMCI_UHS_REG);
	if (mmc->card_caps & MMC_MODE_DDR_52MHz)
		regs |= DWMCI_DDR_MODE;
	else
		regs &= DWMCI_DDR_MODE;

	dwmci_writel(host, DWMCI_UHS_REG, regs);

	if (host->clksel)
		host->clksel(host);
}

static int dwmci_init(struct mmc *mmc)
{
	struct dwmci_host *host = mmc->priv;

	if (host->board_init)
		host->board_init(host);

	dwmci_writel(host, DWMCI_PWREN, 1);

	if (!dwmci_wait_reset(host, DWMCI_RESET_ALL)) {
		printf("%s[%d] Fail-reset!!\n", __func__, __LINE__);
		return -1;
	}

	/* Enumerate at 400KHz */
	dwmci_setup_bus(host, mmc->cfg->f_min);

	dwmci_writel(host, DWMCI_RINTSTS, 0xFFFFFFFF);
	dwmci_writel(host, DWMCI_INTMASK, 0);

	dwmci_writel(host, DWMCI_TMOUT, 0xFFFFFFFF);

	dwmci_writel(host, DWMCI_IDINTEN, 0);
	dwmci_writel(host, DWMCI_BMOD, 1);

	if (host->fifoth_val) {
		dwmci_writel(host, DWMCI_FIFOTH, host->fifoth_val);
	}

	dwmci_writel(host, DWMCI_CLKENA, 0);
	dwmci_writel(host, DWMCI_CLKSRC, 0);

	return 0;
}

static const struct mmc_ops dwmci_ops = {
	.send_cmd	= dwmci_send_cmd,
	.set_ios	= dwmci_set_ios,
	.init		= dwmci_init,
};

int add_dwmci(struct dwmci_host *host, u32 max_clk, u32 min_clk)
{
	host->cfg.name = host->name;
	host->cfg.ops = &dwmci_ops;
	host->cfg.f_min = min_clk;
	host->cfg.f_max = max_clk;

	host->cfg.voltages = MMC_VDD_32_33 | MMC_VDD_33_34 | MMC_VDD_165_195;

	host->cfg.host_caps = host->caps;

	if (host->buswidth == 8) {
		host->cfg.host_caps |= MMC_MODE_8BIT;
		host->cfg.host_caps &= ~MMC_MODE_4BIT;
	} else {
		host->cfg.host_caps |= MMC_MODE_4BIT;
		host->cfg.host_caps &= ~MMC_MODE_8BIT;
	}
	host->cfg.host_caps |= MMC_MODE_HS | MMC_MODE_HS_52MHz | MMC_MODE_HC;

	host->cfg.b_max = CONFIG_SYS_MMC_MAX_BLK_COUNT;

	host->mmc = mmc_create(&host->cfg, host);
	if (host->mmc == NULL)
		return -1;

	return 0;
}
Commit	Line	Data
757bff49 JC	1	/*
	2	* (C) Copyright 2012 SAMSUNG Electronics
	3	* Jaehoon Chung <jh80.chung@samsung.com>
	4	* Rajeshawari Shinde <rajeshwari.s@samsung.com>
	5	*
1a459660	6	* SPDX-License-Identifier: GPL-2.0+
757bff49 JC	7	*/
757bff49 JC	8
2a7a210e	9	#include <bouncebuf.h>
757bff49 JC	10	#include <common.h>
	11	#include <malloc.h>
	12	#include <mmc.h>
	13	#include <dwmmc.h>
757bff49 JC	14	#include <asm-generic/errno.h>
	15
	16	#define PAGE_SIZE 4096
	17
	18	static int dwmci_wait_reset(struct dwmci_host *host, u32 value)
	19	{
	20	unsigned long timeout = 1000;
	21	u32 ctrl;
	22
	23	dwmci_writel(host, DWMCI_CTRL, value);
	24
	25	while (timeout--) {
	26	ctrl = dwmci_readl(host, DWMCI_CTRL);
	27	if (!(ctrl & DWMCI_RESET_ALL))
	28	return 1;
	29	}
	30	return 0;
	31	}
	32
	33	static void dwmci_set_idma_desc(struct dwmci_idmac *idmac,
	34	u32 desc0, u32 desc1, u32 desc2)
	35	{
	36	struct dwmci_idmac *desc = idmac;
	37
	38	desc->flags = desc0;
	39	desc->cnt = desc1;
	40	desc->addr = desc2;
	41	desc->next_addr = (unsigned int)desc + sizeof(struct dwmci_idmac);
	42	}
	43
	44	static void dwmci_prepare_data(struct dwmci_host *host,
2a7a210e AB	45	struct mmc_data *data,
	46	struct dwmci_idmac *cur_idmac,
	47	void *bounce_buffer)
757bff49 JC	48	{
	49	unsigned long ctrl;
	50	unsigned int i = 0, flags, cnt, blk_cnt;
2a7a210e	51	ulong data_start, data_end;
757bff49 JC	52
	53
	54	blk_cnt = data->blocks;
	55
	56	dwmci_wait_reset(host, DWMCI_CTRL_FIFO_RESET);
	57
	58	data_start = (ulong)cur_idmac;
	59	dwmci_writel(host, DWMCI_DBADDR, (unsigned int)cur_idmac);
	60
757bff49 JC	61	do {
	62	flags = DWMCI_IDMAC_OWN \| DWMCI_IDMAC_CH ;
	63	flags \|= (i == 0) ? DWMCI_IDMAC_FS : 0;
	64	if (blk_cnt <= 8) {
	65	flags \|= DWMCI_IDMAC_LD;
	66	cnt = data->blocksize * blk_cnt;
	67	} else
	68	cnt = data->blocksize * 8;
	69
	70	dwmci_set_idma_desc(cur_idmac, flags, cnt,
2a7a210e	71	(u32)bounce_buffer + (i * PAGE_SIZE));
757bff49	72
21bd5761	73	if (blk_cnt <= 8)
757bff49 JC	74	break;
	75	blk_cnt -= 8;
	76	cur_idmac++;
	77	i++;
	78	} while(1);
	79
	80	data_end = (ulong)cur_idmac;
	81	flush_dcache_range(data_start, data_end + ARCH_DMA_MINALIGN);
	82
	83	ctrl = dwmci_readl(host, DWMCI_CTRL);
	84	ctrl \|= DWMCI_IDMAC_EN \| DWMCI_DMA_EN;
	85	dwmci_writel(host, DWMCI_CTRL, ctrl);
	86
	87	ctrl = dwmci_readl(host, DWMCI_BMOD);
	88	ctrl \|= DWMCI_BMOD_IDMAC_FB \| DWMCI_BMOD_IDMAC_EN;
	89	dwmci_writel(host, DWMCI_BMOD, ctrl);
	90
	91	dwmci_writel(host, DWMCI_BLKSIZ, data->blocksize);
	92	dwmci_writel(host, DWMCI_BYTCNT, data->blocksize * data->blocks);
	93	}
	94
	95	static int dwmci_set_transfer_mode(struct dwmci_host *host,
	96	struct mmc_data *data)
	97	{
	98	unsigned long mode;
	99
	100	mode = DWMCI_CMD_DATA_EXP;
	101	if (data->flags & MMC_DATA_WRITE)
	102	mode \|= DWMCI_CMD_RW;
	103
	104	return mode;
	105	}
	106
	107	static int dwmci_send_cmd(struct mmc mmc, struct mmc_cmd cmd,
	108	struct mmc_data *data)
	109	{
93bfd616	110	struct dwmci_host *host = mmc->priv;
2136d226	111	ALLOC_CACHE_ALIGN_BUFFER(struct dwmci_idmac, cur_idmac,
21bd5761	112	data ? DIV_ROUND_UP(data->blocks, 8) : 0);
757bff49 JC	113	int flags = 0, i;
	114	unsigned int timeout = 100000;
	115	u32 retry = 10000;
	116	u32 mask, ctrl;
9c50e35f	117	ulong start = get_timer(0);
2a7a210e	118	struct bounce_buffer bbstate;
757bff49 JC	119
757bff49 JC	120	while (dwmci_readl(host, DWMCI_STATUS) & DWMCI_BUSY) {
9c50e35f	121	if (get_timer(start) > timeout) {
f33c9305	122	printf("%s: Timeout on data busy\n", __func__);
757bff49 JC	123	return TIMEOUT;
757bff49 JC	124	}
757bff49 JC	125	}
	126
	127	dwmci_writel(host, DWMCI_RINTSTS, DWMCI_INTMSK_ALL);
	128
2a7a210e AB	129	if (data) {
	130	if (data->flags == MMC_DATA_READ) {
	131	bounce_buffer_start(&bbstate, (void*)data->dest,
	132	data->blocksize *
	133	data->blocks, GEN_BB_WRITE);
	134	} else {
	135	bounce_buffer_start(&bbstate, (void*)data->src,
	136	data->blocksize *
	137	data->blocks, GEN_BB_READ);
	138	}
	139	dwmci_prepare_data(host, data, cur_idmac,
	140	bbstate.bounce_buffer);
	141	}
757bff49	142
757bff49 JC	143	dwmci_writel(host, DWMCI_CMDARG, cmd->cmdarg);
	144
	145	if (data)
	146	flags = dwmci_set_transfer_mode(host, data);
	147
	148	if ((cmd->resp_type & MMC_RSP_136) && (cmd->resp_type & MMC_RSP_BUSY))
	149	return -1;
	150
	151	if (cmd->cmdidx == MMC_CMD_STOP_TRANSMISSION)
	152	flags \|= DWMCI_CMD_ABORT_STOP;
	153	else
	154	flags \|= DWMCI_CMD_PRV_DAT_WAIT;
	155
	156	if (cmd->resp_type & MMC_RSP_PRESENT) {
	157	flags \|= DWMCI_CMD_RESP_EXP;
	158	if (cmd->resp_type & MMC_RSP_136)
	159	flags \|= DWMCI_CMD_RESP_LENGTH;
	160	}
	161
	162	if (cmd->resp_type & MMC_RSP_CRC)
	163	flags \|= DWMCI_CMD_CHECK_CRC;
	164
	165	flags \|= (cmd->cmdidx \| DWMCI_CMD_START \| DWMCI_CMD_USE_HOLD_REG);
	166
	167	debug("Sending CMD%d\n",cmd->cmdidx);
	168
	169	dwmci_writel(host, DWMCI_CMD, flags);
	170
	171	for (i = 0; i < retry; i++) {
	172	mask = dwmci_readl(host, DWMCI_RINTSTS);
	173	if (mask & DWMCI_INTMSK_CDONE) {
	174	if (!data)
	175	dwmci_writel(host, DWMCI_RINTSTS, mask);
	176	break;
	177	}
	178	}
	179
f33c9305 PM	180	if (i == retry) {
f33c9305 PM	181	printf("%s: Timeout.\n", __func__);
757bff49	182	return TIMEOUT;
f33c9305	183	}
757bff49 JC	184
757bff49 JC	185	if (mask & DWMCI_INTMSK_RTO) {
f33c9305 PM	186	/*
	187	* Timeout here is not necessarily fatal. (e)MMC cards
	188	* will splat here when they receive CMD55 as they do
	189	* not support this command and that is exactly the way
	190	* to tell them apart from SD cards. Thus, this output
	191	* below shall be debug(). eMMC cards also do not favor
	192	* CMD8, please keep that in mind.
	193	*/
	194	debug("%s: Response Timeout.\n", __func__);
757bff49 JC	195	return TIMEOUT;
757bff49 JC	196	} else if (mask & DWMCI_INTMSK_RE) {
f33c9305	197	printf("%s: Response Error.\n", __func__);
757bff49 JC	198	return -1;
	199	}
	200
	201
	202	if (cmd->resp_type & MMC_RSP_PRESENT) {
	203	if (cmd->resp_type & MMC_RSP_136) {
	204	cmd->response[0] = dwmci_readl(host, DWMCI_RESP3);
	205	cmd->response[1] = dwmci_readl(host, DWMCI_RESP2);
	206	cmd->response[2] = dwmci_readl(host, DWMCI_RESP1);
	207	cmd->response[3] = dwmci_readl(host, DWMCI_RESP0);
	208	} else {
	209	cmd->response[0] = dwmci_readl(host, DWMCI_RESP0);
	210	}
	211	}
	212
	213	if (data) {
	214	do {
	215	mask = dwmci_readl(host, DWMCI_RINTSTS);
	216	if (mask & (DWMCI_DATA_ERR \| DWMCI_DATA_TOUT)) {
f33c9305	217	printf("%s: DATA ERROR!\n", __func__);
757bff49 JC	218	return -1;
	219	}
	220	} while (!(mask & DWMCI_INTMSK_DTO));
	221
	222	dwmci_writel(host, DWMCI_RINTSTS, mask);
	223
	224	ctrl = dwmci_readl(host, DWMCI_CTRL);
	225	ctrl &= ~(DWMCI_DMA_EN);
	226	dwmci_writel(host, DWMCI_CTRL, ctrl);
2a7a210e AB	227
2a7a210e AB	228	bounce_buffer_stop(&bbstate);
757bff49 JC	229	}
	230
	231	udelay(100);
	232
	233	return 0;
	234	}
	235
	236	static int dwmci_setup_bus(struct dwmci_host *host, u32 freq)
	237	{
	238	u32 div, status;
	239	int timeout = 10000;
	240	unsigned long sclk;
	241
9c50e35f	242	if ((freq == host->clock) \|\| (freq == 0))
757bff49	243	return 0;
757bff49	244	/*
f33c9305	245	* If host->get_mmc_clk isn't defined,
757bff49	246	* then assume that host->bus_hz is source clock value.
f33c9305	247	* host->bus_hz should be set by user.
757bff49	248	*/
b44fe83a	249	if (host->get_mmc_clk)
d3e016cc	250	sclk = host->get_mmc_clk(host);
757bff49 JC	251	else if (host->bus_hz)
	252	sclk = host->bus_hz;
	253	else {
f33c9305	254	printf("%s: Didn't get source clock value.\n", __func__);
757bff49 JC	255	return -EINVAL;
	256	}
	257
6ace153d CLS	258	if (sclk == freq)
	259	div = 0; /* bypass mode */
	260	else
	261	div = DIV_ROUND_UP(sclk, 2 * freq);
757bff49 JC	262
	263	dwmci_writel(host, DWMCI_CLKENA, 0);
	264	dwmci_writel(host, DWMCI_CLKSRC, 0);
	265
	266	dwmci_writel(host, DWMCI_CLKDIV, div);
	267	dwmci_writel(host, DWMCI_CMD, DWMCI_CMD_PRV_DAT_WAIT \|
	268	DWMCI_CMD_UPD_CLK \| DWMCI_CMD_START);
	269
	270	do {
	271	status = dwmci_readl(host, DWMCI_CMD);
	272	if (timeout-- < 0) {
f33c9305	273	printf("%s: Timeout!\n", __func__);
757bff49 JC	274	return -ETIMEDOUT;
	275	}
	276	} while (status & DWMCI_CMD_START);
	277
	278	dwmci_writel(host, DWMCI_CLKENA, DWMCI_CLKEN_ENABLE \|
	279	DWMCI_CLKEN_LOW_PWR);
	280
	281	dwmci_writel(host, DWMCI_CMD, DWMCI_CMD_PRV_DAT_WAIT \|
	282	DWMCI_CMD_UPD_CLK \| DWMCI_CMD_START);
	283
	284	timeout = 10000;
	285	do {
	286	status = dwmci_readl(host, DWMCI_CMD);
	287	if (timeout-- < 0) {
f33c9305	288	printf("%s: Timeout!\n", __func__);
757bff49 JC	289	return -ETIMEDOUT;
	290	}
	291	} while (status & DWMCI_CMD_START);
	292
	293	host->clock = freq;
	294
	295	return 0;
	296	}
	297
	298	static void dwmci_set_ios(struct mmc *mmc)
	299	{
045bdcd0 JC	300	struct dwmci_host host = (struct dwmci_host )mmc->priv;
045bdcd0 JC	301	u32 ctype, regs;
757bff49	302
f33c9305	303	debug("Buswidth = %d, clock: %d\n", mmc->bus_width, mmc->clock);
757bff49 JC	304
	305	dwmci_setup_bus(host, mmc->clock);
	306	switch (mmc->bus_width) {
	307	case 8:
	308	ctype = DWMCI_CTYPE_8BIT;
	309	break;
	310	case 4:
	311	ctype = DWMCI_CTYPE_4BIT;
	312	break;
	313	default:
	314	ctype = DWMCI_CTYPE_1BIT;
	315	break;
	316	}
	317
	318	dwmci_writel(host, DWMCI_CTYPE, ctype);
	319
045bdcd0 JC	320	regs = dwmci_readl(host, DWMCI_UHS_REG);
	321	if (mmc->card_caps & MMC_MODE_DDR_52MHz)
	322	regs \|= DWMCI_DDR_MODE;
	323	else
	324	regs &= DWMCI_DDR_MODE;
	325
	326	dwmci_writel(host, DWMCI_UHS_REG, regs);
	327
757bff49 JC	328	if (host->clksel)
	329	host->clksel(host);
	330	}
	331
	332	static int dwmci_init(struct mmc *mmc)
	333	{
93bfd616	334	struct dwmci_host *host = mmc->priv;
757bff49	335
18ab6755 JC	336	if (host->board_init)
18ab6755 JC	337	host->board_init(host);
6f0b7caa	338
757bff49 JC	339	dwmci_writel(host, DWMCI_PWREN, 1);
	340
	341	if (!dwmci_wait_reset(host, DWMCI_RESET_ALL)) {
f33c9305	342	printf("%s[%d] Fail-reset!!\n", __func__, __LINE__);
757bff49 JC	343	return -1;
	344	}
	345
9c50e35f	346	/* Enumerate at 400KHz */
93bfd616	347	dwmci_setup_bus(host, mmc->cfg->f_min);
9c50e35f	348
757bff49 JC	349	dwmci_writel(host, DWMCI_RINTSTS, 0xFFFFFFFF);
	350	dwmci_writel(host, DWMCI_INTMASK, 0);
	351
	352	dwmci_writel(host, DWMCI_TMOUT, 0xFFFFFFFF);
	353
	354	dwmci_writel(host, DWMCI_IDINTEN, 0);
	355	dwmci_writel(host, DWMCI_BMOD, 1);
	356
9108b315 AB	357	if (host->fifoth_val) {
9108b315 AB	358	dwmci_writel(host, DWMCI_FIFOTH, host->fifoth_val);
9c50e35f	359	}
757bff49 JC	360
	361	dwmci_writel(host, DWMCI_CLKENA, 0);
	362	dwmci_writel(host, DWMCI_CLKSRC, 0);
	363
	364	return 0;
	365	}
	366
ab769f22 PA	367	static const struct mmc_ops dwmci_ops = {
	368	.send_cmd = dwmci_send_cmd,
	369	.set_ios = dwmci_set_ios,
	370	.init = dwmci_init,
	371	};
	372
757bff49 JC	373	int add_dwmci(struct dwmci_host *host, u32 max_clk, u32 min_clk)
757bff49 JC	374	{
93bfd616 PA	375	host->cfg.name = host->name;
	376	host->cfg.ops = &dwmci_ops;
	377	host->cfg.f_min = min_clk;
	378	host->cfg.f_max = max_clk;
757bff49	379
93bfd616	380	host->cfg.voltages = MMC_VDD_32_33 \| MMC_VDD_33_34 \| MMC_VDD_165_195;
757bff49	381
93bfd616	382	host->cfg.host_caps = host->caps;
757bff49 JC	383
757bff49 JC	384	if (host->buswidth == 8) {
93bfd616 PA	385	host->cfg.host_caps \|= MMC_MODE_8BIT;
93bfd616 PA	386	host->cfg.host_caps &= ~MMC_MODE_4BIT;
757bff49	387	} else {
93bfd616 PA	388	host->cfg.host_caps \|= MMC_MODE_4BIT;
93bfd616 PA	389	host->cfg.host_caps &= ~MMC_MODE_8BIT;
757bff49	390	}
93bfd616 PA	391	host->cfg.host_caps \|= MMC_MODE_HS \| MMC_MODE_HS_52MHz \| MMC_MODE_HC;
	392
	393	host->cfg.b_max = CONFIG_SYS_MMC_MAX_BLK_COUNT;
757bff49	394
93bfd616 PA	395	host->mmc = mmc_create(&host->cfg, host);
	396	if (host->mmc == NULL)
	397	return -1;
757bff49	398
93bfd616	399	return 0;
757bff49	400	}