dw_mmc.c 75.8 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29
/*
 * Synopsys DesignWare Multimedia Card Interface driver
 *  (Based on NXP driver for lpc 31xx)
 *
 * Copyright (C) 2009 NXP Semiconductors
 * Copyright (C) 2009, 2010 Imagination Technologies Ltd.
 *
 * 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.
 */

#include <linux/blkdev.h>
#include <linux/clk.h>
#include <linux/debugfs.h>
#include <linux/device.h>
#include <linux/dma-mapping.h>
#include <linux/err.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/ioport.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/seq_file.h>
#include <linux/slab.h>
#include <linux/stat.h>
#include <linux/delay.h>
#include <linux/irq.h>
30
#include <linux/mmc/card.h>
31 32
#include <linux/mmc/host.h>
#include <linux/mmc/mmc.h>
33
#include <linux/mmc/sd.h>
34
#include <linux/mmc/sdio.h>
35 36
#include <linux/mmc/dw_mmc.h>
#include <linux/bitops.h>
37
#include <linux/regulator/consumer.h>
38
#include <linux/of.h>
39
#include <linux/of_gpio.h>
40
#include <linux/mmc/slot-gpio.h>
41 42 43 44

#include "dw_mmc.h"

/* Common flag combinations */
45
#define DW_MCI_DATA_ERROR_FLAGS	(SDMMC_INT_DRTO | SDMMC_INT_DCRC | \
46 47 48 49 50 51 52 53 54 55
				 SDMMC_INT_HTO | SDMMC_INT_SBE  | \
				 SDMMC_INT_EBE)
#define DW_MCI_CMD_ERROR_FLAGS	(SDMMC_INT_RTO | SDMMC_INT_RCRC | \
				 SDMMC_INT_RESP_ERR)
#define DW_MCI_ERROR_FLAGS	(DW_MCI_DATA_ERROR_FLAGS | \
				 DW_MCI_CMD_ERROR_FLAGS  | SDMMC_INT_HLE)
#define DW_MCI_SEND_STATUS	1
#define DW_MCI_RECV_STATUS	2
#define DW_MCI_DMA_THRESHOLD	16

56 57 58
#define DW_MCI_FREQ_MAX	200000000	/* unit: HZ */
#define DW_MCI_FREQ_MIN	400000		/* unit: HZ */

59
#ifdef CONFIG_MMC_DW_IDMAC
60 61 62 63 64
#define IDMAC_INT_CLR		(SDMMC_IDMAC_INT_AI | SDMMC_IDMAC_INT_NI | \
				 SDMMC_IDMAC_INT_CES | SDMMC_IDMAC_INT_DU | \
				 SDMMC_IDMAC_INT_FBE | SDMMC_IDMAC_INT_RI | \
				 SDMMC_IDMAC_INT_TI)

65 66 67 68 69 70 71
struct idmac_desc_64addr {
	u32		des0;	/* Control Descriptor */

	u32		des1;	/* Reserved */

	u32		des2;	/*Buffer sizes */
#define IDMAC_64ADDR_SET_BUFFER1_SIZE(d, s) \
72 73
	((d)->des2 = ((d)->des2 & cpu_to_le32(0x03ffe000)) | \
	 ((cpu_to_le32(s)) & cpu_to_le32(0x1fff)))
74 75 76 77 78 79 80 81 82 83

	u32		des3;	/* Reserved */

	u32		des4;	/* Lower 32-bits of Buffer Address Pointer 1*/
	u32		des5;	/* Upper 32-bits of Buffer Address Pointer 1*/

	u32		des6;	/* Lower 32-bits of Next Descriptor Address */
	u32		des7;	/* Upper 32-bits of Next Descriptor Address */
};

84
struct idmac_desc {
85
	__le32		des0;	/* Control Descriptor */
86 87 88 89 90 91 92 93
#define IDMAC_DES0_DIC	BIT(1)
#define IDMAC_DES0_LD	BIT(2)
#define IDMAC_DES0_FD	BIT(3)
#define IDMAC_DES0_CH	BIT(4)
#define IDMAC_DES0_ER	BIT(5)
#define IDMAC_DES0_CES	BIT(30)
#define IDMAC_DES0_OWN	BIT(31)

94
	__le32		des1;	/* Buffer sizes */
95
#define IDMAC_SET_BUFFER1_SIZE(d, s) \
96
	((d)->des1 = ((d)->des1 & 0x03ffe000) | ((s) & 0x1fff))
97

98
	__le32		des2;	/* buffer 1 physical address */
99

100
	__le32		des3;	/* buffer 2 physical address */
101 102 103
};
#endif /* CONFIG_MMC_DW_IDMAC */

104
static bool dw_mci_reset(struct dw_mci *host);
105
static bool dw_mci_ctrl_reset(struct dw_mci *host, u32 reset);
106
static int dw_mci_card_busy(struct mmc_host *mmc);
107

108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228
#if defined(CONFIG_DEBUG_FS)
static int dw_mci_req_show(struct seq_file *s, void *v)
{
	struct dw_mci_slot *slot = s->private;
	struct mmc_request *mrq;
	struct mmc_command *cmd;
	struct mmc_command *stop;
	struct mmc_data	*data;

	/* Make sure we get a consistent snapshot */
	spin_lock_bh(&slot->host->lock);
	mrq = slot->mrq;

	if (mrq) {
		cmd = mrq->cmd;
		data = mrq->data;
		stop = mrq->stop;

		if (cmd)
			seq_printf(s,
				   "CMD%u(0x%x) flg %x rsp %x %x %x %x err %d\n",
				   cmd->opcode, cmd->arg, cmd->flags,
				   cmd->resp[0], cmd->resp[1], cmd->resp[2],
				   cmd->resp[2], cmd->error);
		if (data)
			seq_printf(s, "DATA %u / %u * %u flg %x err %d\n",
				   data->bytes_xfered, data->blocks,
				   data->blksz, data->flags, data->error);
		if (stop)
			seq_printf(s,
				   "CMD%u(0x%x) flg %x rsp %x %x %x %x err %d\n",
				   stop->opcode, stop->arg, stop->flags,
				   stop->resp[0], stop->resp[1], stop->resp[2],
				   stop->resp[2], stop->error);
	}

	spin_unlock_bh(&slot->host->lock);

	return 0;
}

static int dw_mci_req_open(struct inode *inode, struct file *file)
{
	return single_open(file, dw_mci_req_show, inode->i_private);
}

static const struct file_operations dw_mci_req_fops = {
	.owner		= THIS_MODULE,
	.open		= dw_mci_req_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
};

static int dw_mci_regs_show(struct seq_file *s, void *v)
{
	seq_printf(s, "STATUS:\t0x%08x\n", SDMMC_STATUS);
	seq_printf(s, "RINTSTS:\t0x%08x\n", SDMMC_RINTSTS);
	seq_printf(s, "CMD:\t0x%08x\n", SDMMC_CMD);
	seq_printf(s, "CTRL:\t0x%08x\n", SDMMC_CTRL);
	seq_printf(s, "INTMASK:\t0x%08x\n", SDMMC_INTMASK);
	seq_printf(s, "CLKENA:\t0x%08x\n", SDMMC_CLKENA);

	return 0;
}

static int dw_mci_regs_open(struct inode *inode, struct file *file)
{
	return single_open(file, dw_mci_regs_show, inode->i_private);
}

static const struct file_operations dw_mci_regs_fops = {
	.owner		= THIS_MODULE,
	.open		= dw_mci_regs_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
};

static void dw_mci_init_debugfs(struct dw_mci_slot *slot)
{
	struct mmc_host	*mmc = slot->mmc;
	struct dw_mci *host = slot->host;
	struct dentry *root;
	struct dentry *node;

	root = mmc->debugfs_root;
	if (!root)
		return;

	node = debugfs_create_file("regs", S_IRUSR, root, host,
				   &dw_mci_regs_fops);
	if (!node)
		goto err;

	node = debugfs_create_file("req", S_IRUSR, root, slot,
				   &dw_mci_req_fops);
	if (!node)
		goto err;

	node = debugfs_create_u32("state", S_IRUSR, root, (u32 *)&host->state);
	if (!node)
		goto err;

	node = debugfs_create_x32("pending_events", S_IRUSR, root,
				  (u32 *)&host->pending_events);
	if (!node)
		goto err;

	node = debugfs_create_x32("completed_events", S_IRUSR, root,
				  (u32 *)&host->completed_events);
	if (!node)
		goto err;

	return;

err:
	dev_err(&mmc->class_dev, "failed to initialize debugfs for slot\n");
}
#endif /* defined(CONFIG_DEBUG_FS) */

229 230
static void mci_send_cmd(struct dw_mci_slot *slot, u32 cmd, u32 arg);

231 232 233
static u32 dw_mci_prepare_command(struct mmc_host *mmc, struct mmc_command *cmd)
{
	struct mmc_data	*data;
234
	struct dw_mci_slot *slot = mmc_priv(mmc);
235
	struct dw_mci *host = slot->host;
236
	const struct dw_mci_drv_data *drv_data = slot->host->drv_data;
237 238 239 240 241
	u32 cmdr;
	cmd->error = -EINPROGRESS;

	cmdr = cmd->opcode;

242 243 244 245 246
	if (cmd->opcode == MMC_STOP_TRANSMISSION ||
	    cmd->opcode == MMC_GO_IDLE_STATE ||
	    cmd->opcode == MMC_GO_INACTIVE_STATE ||
	    (cmd->opcode == SD_IO_RW_DIRECT &&
	     ((cmd->arg >> 9) & 0x1FFFF) == SDIO_CCCR_ABORT))
247
		cmdr |= SDMMC_CMD_STOP;
248 249
	else if (cmd->opcode != MMC_SEND_STATUS && cmd->data)
		cmdr |= SDMMC_CMD_PRV_DAT_WAIT;
250

251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278
	if (cmd->opcode == SD_SWITCH_VOLTAGE) {
		u32 clk_en_a;

		/* Special bit makes CMD11 not die */
		cmdr |= SDMMC_CMD_VOLT_SWITCH;

		/* Change state to continue to handle CMD11 weirdness */
		WARN_ON(slot->host->state != STATE_SENDING_CMD);
		slot->host->state = STATE_SENDING_CMD11;

		/*
		 * We need to disable low power mode (automatic clock stop)
		 * while doing voltage switch so we don't confuse the card,
		 * since stopping the clock is a specific part of the UHS
		 * voltage change dance.
		 *
		 * Note that low power mode (SDMMC_CLKEN_LOW_PWR) will be
		 * unconditionally turned back on in dw_mci_setup_bus() if it's
		 * ever called with a non-zero clock.  That shouldn't happen
		 * until the voltage change is all done.
		 */
		clk_en_a = mci_readl(host, CLKENA);
		clk_en_a &= ~(SDMMC_CLKEN_LOW_PWR << slot->id);
		mci_writel(host, CLKENA, clk_en_a);
		mci_send_cmd(slot, SDMMC_CMD_UPD_CLK |
			     SDMMC_CMD_PRV_DAT_WAIT, 0);
	}

279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297
	if (cmd->flags & MMC_RSP_PRESENT) {
		/* We expect a response, so set this bit */
		cmdr |= SDMMC_CMD_RESP_EXP;
		if (cmd->flags & MMC_RSP_136)
			cmdr |= SDMMC_CMD_RESP_LONG;
	}

	if (cmd->flags & MMC_RSP_CRC)
		cmdr |= SDMMC_CMD_RESP_CRC;

	data = cmd->data;
	if (data) {
		cmdr |= SDMMC_CMD_DAT_EXP;
		if (data->flags & MMC_DATA_STREAM)
			cmdr |= SDMMC_CMD_STRM_MODE;
		if (data->flags & MMC_DATA_WRITE)
			cmdr |= SDMMC_CMD_DAT_WR;
	}

298 299
	if (drv_data && drv_data->prepare_command)
		drv_data->prepare_command(slot->host, &cmdr);
300

301 302 303
	return cmdr;
}

304 305 306 307 308 309 310 311 312 313 314 315 316 317 318
static u32 dw_mci_prep_stop_abort(struct dw_mci *host, struct mmc_command *cmd)
{
	struct mmc_command *stop;
	u32 cmdr;

	if (!cmd->data)
		return 0;

	stop = &host->stop_abort;
	cmdr = cmd->opcode;
	memset(stop, 0, sizeof(struct mmc_command));

	if (cmdr == MMC_READ_SINGLE_BLOCK ||
	    cmdr == MMC_READ_MULTIPLE_BLOCK ||
	    cmdr == MMC_WRITE_BLOCK ||
319 320 321
	    cmdr == MMC_WRITE_MULTIPLE_BLOCK ||
	    cmdr == MMC_SEND_TUNING_BLOCK ||
	    cmdr == MMC_SEND_TUNING_BLOCK_HS200) {
322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339
		stop->opcode = MMC_STOP_TRANSMISSION;
		stop->arg = 0;
		stop->flags = MMC_RSP_R1B | MMC_CMD_AC;
	} else if (cmdr == SD_IO_RW_EXTENDED) {
		stop->opcode = SD_IO_RW_DIRECT;
		stop->arg |= (1 << 31) | (0 << 28) | (SDIO_CCCR_ABORT << 9) |
			     ((cmd->arg >> 28) & 0x7);
		stop->flags = MMC_RSP_SPI_R5 | MMC_RSP_R5 | MMC_CMD_AC;
	} else {
		return 0;
	}

	cmdr = stop->opcode | SDMMC_CMD_STOP |
		SDMMC_CMD_RESP_CRC | SDMMC_CMD_RESP_EXP;

	return cmdr;
}

340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364
static void dw_mci_wait_while_busy(struct dw_mci *host, u32 cmd_flags)
{
	unsigned long timeout = jiffies + msecs_to_jiffies(500);

	/*
	 * Databook says that before issuing a new data transfer command
	 * we need to check to see if the card is busy.  Data transfer commands
	 * all have SDMMC_CMD_PRV_DAT_WAIT set, so we'll key off that.
	 *
	 * ...also allow sending for SDMMC_CMD_VOLT_SWITCH where busy is
	 * expected.
	 */
	if ((cmd_flags & SDMMC_CMD_PRV_DAT_WAIT) &&
	    !(cmd_flags & SDMMC_CMD_VOLT_SWITCH)) {
		while (mci_readl(host, STATUS) & SDMMC_STATUS_BUSY) {
			if (time_after(jiffies, timeout)) {
				/* Command will fail; we'll pass error then */
				dev_err(host->dev, "Busy; trying anyway\n");
				break;
			}
			udelay(10);
		}
	}
}

365 366 367 368
static void dw_mci_start_command(struct dw_mci *host,
				 struct mmc_command *cmd, u32 cmd_flags)
{
	host->cmd = cmd;
369
	dev_vdbg(host->dev,
370 371 372 373 374
		 "start command: ARGR=0x%08x CMDR=0x%08x\n",
		 cmd->arg, cmd_flags);

	mci_writel(host, CMDARG, cmd->arg);
	wmb();
375
	dw_mci_wait_while_busy(host, cmd_flags);
376 377 378 379

	mci_writel(host, CMD, cmd_flags | SDMMC_CMD_START);
}

380
static inline void send_stop_abort(struct dw_mci *host, struct mmc_data *data)
381
{
382 383
	struct mmc_command *stop = data->stop ? data->stop : &host->stop_abort;
	dw_mci_start_command(host, stop, host->stop_cmdr);
384 385 386 387 388
}

/* DMA interface functions */
static void dw_mci_stop_dma(struct dw_mci *host)
{
389
	if (host->using_dma) {
390 391 392
		host->dma_ops->stop(host);
		host->dma_ops->cleanup(host);
	}
393 394 395

	/* Data transfer was stopped by the interrupt handler */
	set_bit(EVENT_XFER_COMPLETE, &host->pending_events);
396 397
}

398 399 400 401 402 403 404 405
static int dw_mci_get_dma_dir(struct mmc_data *data)
{
	if (data->flags & MMC_DATA_WRITE)
		return DMA_TO_DEVICE;
	else
		return DMA_FROM_DEVICE;
}

406
#ifdef CONFIG_MMC_DW_IDMAC
407 408 409 410 411
static void dw_mci_dma_cleanup(struct dw_mci *host)
{
	struct mmc_data *data = host->data;

	if (data)
412
		if (!data->host_cookie)
413
			dma_unmap_sg(host->dev,
414 415 416
				     data->sg,
				     data->sg_len,
				     dw_mci_get_dma_dir(data));
417 418
}

419 420 421 422 423 424 425 426
static void dw_mci_idmac_reset(struct dw_mci *host)
{
	u32 bmod = mci_readl(host, BMOD);
	/* Software reset of DMA */
	bmod |= SDMMC_IDMAC_SWRESET;
	mci_writel(host, BMOD, bmod);
}

427 428 429 430 431 432 433 434 435 436 437 438
static void dw_mci_idmac_stop_dma(struct dw_mci *host)
{
	u32 temp;

	/* Disable and reset the IDMAC interface */
	temp = mci_readl(host, CTRL);
	temp &= ~SDMMC_CTRL_USE_IDMAC;
	temp |= SDMMC_CTRL_DMA_RESET;
	mci_writel(host, CTRL, temp);

	/* Stop the IDMAC running */
	temp = mci_readl(host, BMOD);
439
	temp &= ~(SDMMC_IDMAC_ENABLE | SDMMC_IDMAC_FB);
440
	temp |= SDMMC_IDMAC_SWRESET;
441 442 443 444 445 446 447
	mci_writel(host, BMOD, temp);
}

static void dw_mci_idmac_complete_dma(struct dw_mci *host)
{
	struct mmc_data *data = host->data;

448
	dev_vdbg(host->dev, "DMA complete\n");
449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465

	host->dma_ops->cleanup(host);

	/*
	 * If the card was removed, data will be NULL. No point in trying to
	 * send the stop command or waiting for NBUSY in this case.
	 */
	if (data) {
		set_bit(EVENT_XFER_COMPLETE, &host->pending_events);
		tasklet_schedule(&host->tasklet);
	}
}

static void dw_mci_translate_sglist(struct dw_mci *host, struct mmc_data *data,
				    unsigned int sg_len)
{
	int i;
466 467 468 469 470 471
	if (host->dma_64bit_address == 1) {
		struct idmac_desc_64addr *desc = host->sg_cpu;

		for (i = 0; i < sg_len; i++, desc++) {
			unsigned int length = sg_dma_len(&data->sg[i]);
			u64 mem_addr = sg_dma_address(&data->sg[i]);
472

473 474 475 476 477 478 479 480 481 482 483 484 485
			/*
			 * Set the OWN bit and disable interrupts for this
			 * descriptor
			 */
			desc->des0 = IDMAC_DES0_OWN | IDMAC_DES0_DIC |
						IDMAC_DES0_CH;
			/* Buffer length */
			IDMAC_64ADDR_SET_BUFFER1_SIZE(desc, length);

			/* Physical address to DMA to/from */
			desc->des4 = mem_addr & 0xffffffff;
			desc->des5 = mem_addr >> 32;
		}
486

487 488 489
		/* Set first descriptor */
		desc = host->sg_cpu;
		desc->des0 |= IDMAC_DES0_FD;
490

491 492 493 494 495
		/* Set last descriptor */
		desc = host->sg_cpu + (i - 1) *
				sizeof(struct idmac_desc_64addr);
		desc->des0 &= ~(IDMAC_DES0_CH | IDMAC_DES0_DIC);
		desc->des0 |= IDMAC_DES0_LD;
496

497 498 499 500 501 502 503 504 505 506 507
	} else {
		struct idmac_desc *desc = host->sg_cpu;

		for (i = 0; i < sg_len; i++, desc++) {
			unsigned int length = sg_dma_len(&data->sg[i]);
			u32 mem_addr = sg_dma_address(&data->sg[i]);

			/*
			 * Set the OWN bit and disable interrupts for this
			 * descriptor
			 */
508 509
			desc->des0 = cpu_to_le32(IDMAC_DES0_OWN |
					IDMAC_DES0_DIC | IDMAC_DES0_CH);
510 511
			/* Buffer length */
			IDMAC_SET_BUFFER1_SIZE(desc, length);
512

513
			/* Physical address to DMA to/from */
514
			desc->des2 = cpu_to_le32(mem_addr);
515 516 517 518
		}

		/* Set first descriptor */
		desc = host->sg_cpu;
519
		desc->des0 |= cpu_to_le32(IDMAC_DES0_FD);
520

521 522
		/* Set last descriptor */
		desc = host->sg_cpu + (i - 1) * sizeof(struct idmac_desc);
523 524
		desc->des0 &= cpu_to_le32(~(IDMAC_DES0_CH | IDMAC_DES0_DIC));
		desc->des0 |= cpu_to_le32(IDMAC_DES0_LD);
525
	}
526 527 528 529 530 531 532 533 534 535

	wmb();
}

static void dw_mci_idmac_start_dma(struct dw_mci *host, unsigned int sg_len)
{
	u32 temp;

	dw_mci_translate_sglist(host, host->data, sg_len);

536 537 538 539
	/* Make sure to reset DMA in case we did PIO before this */
	dw_mci_ctrl_reset(host, SDMMC_CTRL_DMA_RESET);
	dw_mci_idmac_reset(host);

540 541 542 543 544 545 546 547 548
	/* Select IDMAC interface */
	temp = mci_readl(host, CTRL);
	temp |= SDMMC_CTRL_USE_IDMAC;
	mci_writel(host, CTRL, temp);

	wmb();

	/* Enable the IDMAC */
	temp = mci_readl(host, BMOD);
549
	temp |= SDMMC_IDMAC_ENABLE | SDMMC_IDMAC_FB;
550 551 552 553 554 555 556 557
	mci_writel(host, BMOD, temp);

	/* Start it running */
	mci_writel(host, PLDMND, 1);
}

static int dw_mci_idmac_init(struct dw_mci *host)
{
558
	int i;
559

560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579
	if (host->dma_64bit_address == 1) {
		struct idmac_desc_64addr *p;
		/* Number of descriptors in the ring buffer */
		host->ring_size = PAGE_SIZE / sizeof(struct idmac_desc_64addr);

		/* Forward link the descriptor list */
		for (i = 0, p = host->sg_cpu; i < host->ring_size - 1;
								i++, p++) {
			p->des6 = (host->sg_dma +
					(sizeof(struct idmac_desc_64addr) *
							(i + 1))) & 0xffffffff;

			p->des7 = (u64)(host->sg_dma +
					(sizeof(struct idmac_desc_64addr) *
							(i + 1))) >> 32;
			/* Initialize reserved and buffer size fields to "0" */
			p->des1 = 0;
			p->des2 = 0;
			p->des3 = 0;
		}
580

581 582 583 584
		/* Set the last descriptor as the end-of-ring descriptor */
		p->des6 = host->sg_dma & 0xffffffff;
		p->des7 = (u64)host->sg_dma >> 32;
		p->des0 = IDMAC_DES0_ER;
585

586 587 588 589 590 591 592
	} else {
		struct idmac_desc *p;
		/* Number of descriptors in the ring buffer */
		host->ring_size = PAGE_SIZE / sizeof(struct idmac_desc);

		/* Forward link the descriptor list */
		for (i = 0, p = host->sg_cpu; i < host->ring_size - 1; i++, p++)
593 594
			p->des3 = cpu_to_le32(host->sg_dma +
					(sizeof(struct idmac_desc) * (i + 1)));
595 596

		/* Set the last descriptor as the end-of-ring descriptor */
597 598
		p->des3 = cpu_to_le32(host->sg_dma);
		p->des0 = cpu_to_le32(IDMAC_DES0_ER);
599
	}
600

601
	dw_mci_idmac_reset(host);
602

603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621
	if (host->dma_64bit_address == 1) {
		/* Mask out interrupts - get Tx & Rx complete only */
		mci_writel(host, IDSTS64, IDMAC_INT_CLR);
		mci_writel(host, IDINTEN64, SDMMC_IDMAC_INT_NI |
				SDMMC_IDMAC_INT_RI | SDMMC_IDMAC_INT_TI);

		/* Set the descriptor base address */
		mci_writel(host, DBADDRL, host->sg_dma & 0xffffffff);
		mci_writel(host, DBADDRU, (u64)host->sg_dma >> 32);

	} else {
		/* Mask out interrupts - get Tx & Rx complete only */
		mci_writel(host, IDSTS, IDMAC_INT_CLR);
		mci_writel(host, IDINTEN, SDMMC_IDMAC_INT_NI |
				SDMMC_IDMAC_INT_RI | SDMMC_IDMAC_INT_TI);

		/* Set the descriptor base address */
		mci_writel(host, DBADDR, host->sg_dma);
	}
622 623 624 625

	return 0;
}

626
static const struct dw_mci_dma_ops dw_mci_idmac_ops = {
627 628 629 630 631 632 633 634
	.init = dw_mci_idmac_init,
	.start = dw_mci_idmac_start_dma,
	.stop = dw_mci_idmac_stop_dma,
	.complete = dw_mci_idmac_complete_dma,
	.cleanup = dw_mci_dma_cleanup,
};
#endif /* CONFIG_MMC_DW_IDMAC */

635 636 637
static int dw_mci_pre_dma_transfer(struct dw_mci *host,
				   struct mmc_data *data,
				   bool next)
638 639
{
	struct scatterlist *sg;
640
	unsigned int i, sg_len;
641

642 643
	if (!next && data->host_cookie)
		return data->host_cookie;
644 645 646 647 648 649 650 651

	/*
	 * We don't do DMA on "complex" transfers, i.e. with
	 * non-word-aligned buffers or lengths. Also, we don't bother
	 * with all the DMA setup overhead for short transfers.
	 */
	if (data->blocks * data->blksz < DW_MCI_DMA_THRESHOLD)
		return -EINVAL;
652

653 654 655 656 657 658 659 660
	if (data->blksz & 3)
		return -EINVAL;

	for_each_sg(data->sg, sg, data->sg_len, i) {
		if (sg->offset & 3 || sg->length & 3)
			return -EINVAL;
	}

661
	sg_len = dma_map_sg(host->dev,
662 663 664 665 666
			    data->sg,
			    data->sg_len,
			    dw_mci_get_dma_dir(data));
	if (sg_len == 0)
		return -EINVAL;
667

668 669
	if (next)
		data->host_cookie = sg_len;
670

671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703
	return sg_len;
}

static void dw_mci_pre_req(struct mmc_host *mmc,
			   struct mmc_request *mrq,
			   bool is_first_req)
{
	struct dw_mci_slot *slot = mmc_priv(mmc);
	struct mmc_data *data = mrq->data;

	if (!slot->host->use_dma || !data)
		return;

	if (data->host_cookie) {
		data->host_cookie = 0;
		return;
	}

	if (dw_mci_pre_dma_transfer(slot->host, mrq->data, 1) < 0)
		data->host_cookie = 0;
}

static void dw_mci_post_req(struct mmc_host *mmc,
			    struct mmc_request *mrq,
			    int err)
{
	struct dw_mci_slot *slot = mmc_priv(mmc);
	struct mmc_data *data = mrq->data;

	if (!slot->host->use_dma || !data)
		return;

	if (data->host_cookie)
704
		dma_unmap_sg(slot->host->dev,
705 706 707 708 709 710
			     data->sg,
			     data->sg_len,
			     dw_mci_get_dma_dir(data));
	data->host_cookie = 0;
}

711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751
static void dw_mci_adjust_fifoth(struct dw_mci *host, struct mmc_data *data)
{
#ifdef CONFIG_MMC_DW_IDMAC
	unsigned int blksz = data->blksz;
	const u32 mszs[] = {1, 4, 8, 16, 32, 64, 128, 256};
	u32 fifo_width = 1 << host->data_shift;
	u32 blksz_depth = blksz / fifo_width, fifoth_val;
	u32 msize = 0, rx_wmark = 1, tx_wmark, tx_wmark_invers;
	int idx = (sizeof(mszs) / sizeof(mszs[0])) - 1;

	tx_wmark = (host->fifo_depth) / 2;
	tx_wmark_invers = host->fifo_depth - tx_wmark;

	/*
	 * MSIZE is '1',
	 * if blksz is not a multiple of the FIFO width
	 */
	if (blksz % fifo_width) {
		msize = 0;
		rx_wmark = 1;
		goto done;
	}

	do {
		if (!((blksz_depth % mszs[idx]) ||
		     (tx_wmark_invers % mszs[idx]))) {
			msize = idx;
			rx_wmark = mszs[idx] - 1;
			break;
		}
	} while (--idx > 0);
	/*
	 * If idx is '0', it won't be tried
	 * Thus, initial values are uesed
	 */
done:
	fifoth_val = SDMMC_SET_FIFOTH(msize, rx_wmark, tx_wmark);
	mci_writel(host, FIFOTH, fifoth_val);
#endif
}

752 753 754 755 756 757 758 759
static void dw_mci_ctrl_rd_thld(struct dw_mci *host, struct mmc_data *data)
{
	unsigned int blksz = data->blksz;
	u32 blksz_depth, fifo_depth;
	u16 thld_size;

	WARN_ON(!(data->flags & MMC_DATA_READ));

760 761 762 763 764 765 766
	/*
	 * CDTHRCTL doesn't exist prior to 240A (in fact that register offset is
	 * in the FIFO region, so we really shouldn't access it).
	 */
	if (host->verid < DW_MMC_240A)
		return;

767
	if (host->timing != MMC_TIMING_MMC_HS200 &&
768
	    host->timing != MMC_TIMING_MMC_HS400 &&
769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790
	    host->timing != MMC_TIMING_UHS_SDR104)
		goto disable;

	blksz_depth = blksz / (1 << host->data_shift);
	fifo_depth = host->fifo_depth;

	if (blksz_depth > fifo_depth)
		goto disable;

	/*
	 * If (blksz_depth) >= (fifo_depth >> 1), should be 'thld_size <= blksz'
	 * If (blksz_depth) <  (fifo_depth >> 1), should be thld_size = blksz
	 * Currently just choose blksz.
	 */
	thld_size = blksz;
	mci_writel(host, CDTHRCTL, SDMMC_SET_RD_THLD(thld_size, 1));
	return;

disable:
	mci_writel(host, CDTHRCTL, SDMMC_SET_RD_THLD(0, 0));
}

791 792
static int dw_mci_submit_data_dma(struct dw_mci *host, struct mmc_data *data)
{
793
	unsigned long irqflags;
794 795 796 797 798 799 800 801 802 803
	int sg_len;
	u32 temp;

	host->using_dma = 0;

	/* If we don't have a channel, we can't do DMA */
	if (!host->use_dma)
		return -ENODEV;

	sg_len = dw_mci_pre_dma_transfer(host, data, 0);
804 805
	if (sg_len < 0) {
		host->dma_ops->stop(host);
806
		return sg_len;
807
	}
808 809

	host->using_dma = 1;
810

811
	dev_vdbg(host->dev,
812 813 814 815
		 "sd sg_cpu: %#lx sg_dma: %#lx sg_len: %d\n",
		 (unsigned long)host->sg_cpu, (unsigned long)host->sg_dma,
		 sg_len);

816 817 818 819 820 821 822 823
	/*
	 * Decide the MSIZE and RX/TX Watermark.
	 * If current block size is same with previous size,
	 * no need to update fifoth.
	 */
	if (host->prev_blksz != data->blksz)
		dw_mci_adjust_fifoth(host, data);

824 825 826 827 828 829
	/* Enable the DMA interface */
	temp = mci_readl(host, CTRL);
	temp |= SDMMC_CTRL_DMA_ENABLE;
	mci_writel(host, CTRL, temp);

	/* Disable RX/TX IRQs, let DMA handle it */
830
	spin_lock_irqsave(&host->irq_lock, irqflags);
831 832 833
	temp = mci_readl(host, INTMASK);
	temp  &= ~(SDMMC_INT_RXDR | SDMMC_INT_TXDR);
	mci_writel(host, INTMASK, temp);
834
	spin_unlock_irqrestore(&host->irq_lock, irqflags);
835 836 837 838 839 840 841 842

	host->dma_ops->start(host, sg_len);

	return 0;
}

static void dw_mci_submit_data(struct dw_mci *host, struct mmc_data *data)
{
843
	unsigned long irqflags;
844 845 846 847 848 849 850 851
	u32 temp;

	data->error = -EINPROGRESS;

	WARN_ON(host->data);
	host->sg = NULL;
	host->data = data;

852
	if (data->flags & MMC_DATA_READ) {
853
		host->dir_status = DW_MCI_RECV_STATUS;
854 855
		dw_mci_ctrl_rd_thld(host, data);
	} else {
856
		host->dir_status = DW_MCI_SEND_STATUS;
857
	}
858

859
	if (dw_mci_submit_data_dma(host, data)) {
860 861 862 863 864 865 866
		int flags = SG_MITER_ATOMIC;
		if (host->data->flags & MMC_DATA_READ)
			flags |= SG_MITER_TO_SG;
		else
			flags |= SG_MITER_FROM_SG;

		sg_miter_start(&host->sg_miter, data->sg, data->sg_len, flags);
867
		host->sg = data->sg;
868 869
		host->part_buf_start = 0;
		host->part_buf_count = 0;
870

871
		mci_writel(host, RINTSTS, SDMMC_INT_TXDR | SDMMC_INT_RXDR);
872 873

		spin_lock_irqsave(&host->irq_lock, irqflags);
874 875 876
		temp = mci_readl(host, INTMASK);
		temp |= SDMMC_INT_TXDR | SDMMC_INT_RXDR;
		mci_writel(host, INTMASK, temp);
877
		spin_unlock_irqrestore(&host->irq_lock, irqflags);
878 879 880 881

		temp = mci_readl(host, CTRL);
		temp &= ~SDMMC_CTRL_DMA_ENABLE;
		mci_writel(host, CTRL, temp);
882 883 884 885 886 887 888 889 890 891 892 893 894 895 896

		/*
		 * Use the initial fifoth_val for PIO mode.
		 * If next issued data may be transfered by DMA mode,
		 * prev_blksz should be invalidated.
		 */
		mci_writel(host, FIFOTH, host->fifoth_val);
		host->prev_blksz = 0;
	} else {
		/*
		 * Keep the current block size.
		 * It will be used to decide whether to update
		 * fifoth register next time.
		 */
		host->prev_blksz = data->blksz;
897 898 899 900 901 902 903 904 905 906 907
	}
}

static void mci_send_cmd(struct dw_mci_slot *slot, u32 cmd, u32 arg)
{
	struct dw_mci *host = slot->host;
	unsigned long timeout = jiffies + msecs_to_jiffies(500);
	unsigned int cmd_status = 0;

	mci_writel(host, CMDARG, arg);
	wmb();
908
	dw_mci_wait_while_busy(host, cmd);
909 910 911 912 913 914 915 916 917 918 919 920
	mci_writel(host, CMD, SDMMC_CMD_START | cmd);

	while (time_before(jiffies, timeout)) {
		cmd_status = mci_readl(host, CMD);
		if (!(cmd_status & SDMMC_CMD_START))
			return;
	}
	dev_err(&slot->mmc->class_dev,
		"Timeout sending command (cmd %#x arg %#x status %#x)\n",
		cmd, arg, cmd_status);
}

921
static void dw_mci_setup_bus(struct dw_mci_slot *slot, bool force_clkinit)
922 923
{
	struct dw_mci *host = slot->host;
924
	unsigned int clock = slot->clock;
925
	u32 div;
926
	u32 clk_en_a;
927 928 929 930 931
	u32 sdmmc_cmd_bits = SDMMC_CMD_UPD_CLK | SDMMC_CMD_PRV_DAT_WAIT;

	/* We must continue to set bit 28 in CMD until the change is complete */
	if (host->state == STATE_WAITING_CMD11_DONE)
		sdmmc_cmd_bits |= SDMMC_CMD_VOLT_SWITCH;
932

933 934
	if (!clock) {
		mci_writel(host, CLKENA, 0);
935
		mci_send_cmd(slot, sdmmc_cmd_bits, 0);
936 937 938
	} else if (clock != host->current_speed || force_clkinit) {
		div = host->bus_hz / clock;
		if (host->bus_hz % clock && host->bus_hz > clock)
939 940 941 942
			/*
			 * move the + 1 after the divide to prevent
			 * over-clocking the card.
			 */
943 944
			div += 1;

945
		div = (host->bus_hz != clock) ? DIV_ROUND_UP(div, 2) : 0;
946

947 948 949 950 951 952
		if ((clock << div) != slot->__clk_old || force_clkinit)
			dev_info(&slot->mmc->class_dev,
				 "Bus speed (slot %d) = %dHz (slot req %dHz, actual %dHZ div = %d)\n",
				 slot->id, host->bus_hz, clock,
				 div ? ((host->bus_hz / div) >> 1) :
				 host->bus_hz, div);
953 954 955 956 957 958

		/* disable clock */
		mci_writel(host, CLKENA, 0);
		mci_writel(host, CLKSRC, 0);

		/* inform CIU */
959
		mci_send_cmd(slot, sdmmc_cmd_bits, 0);
960 961 962 963 964

		/* set clock to desired speed */
		mci_writel(host, CLKDIV, div);

		/* inform CIU */
965
		mci_send_cmd(slot, sdmmc_cmd_bits, 0);
966

967 968
		/* enable clock; only low power if no SDIO */
		clk_en_a = SDMMC_CLKEN_ENABLE << slot->id;
969
		if (!test_bit(DW_MMC_CARD_NO_LOW_PWR, &slot->flags))
970 971
			clk_en_a |= SDMMC_CLKEN_LOW_PWR << slot->id;
		mci_writel(host, CLKENA, clk_en_a);
972 973

		/* inform CIU */
974
		mci_send_cmd(slot, sdmmc_cmd_bits, 0);
975

976 977
		/* keep the clock with reflecting clock dividor */
		slot->__clk_old = clock << div;
978 979
	}

980 981
	host->current_speed = clock;

982
	/* Set the current slot bus width */
983
	mci_writel(host, CTYPE, (slot->ctype << slot->id));
984 985
}

986 987 988
static void __dw_mci_start_request(struct dw_mci *host,
				   struct dw_mci_slot *slot,
				   struct mmc_command *cmd)
989 990 991 992 993 994 995 996 997 998 999 1000
{
	struct mmc_request *mrq;
	struct mmc_data	*data;
	u32 cmdflags;

	mrq = slot->mrq;

	host->cur_slot = slot;
	host->mrq = mrq;

	host->pending_events = 0;
	host->completed_events = 0;
1001
	host->cmd_status = 0;
1002
	host->data_status = 0;
1003
	host->dir_status = 0;
1004

1005
	data = cmd->data;
1006
	if (data) {
1007
		mci_writel(host, TMOUT, 0xFFFFFFFF);
1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024
		mci_writel(host, BYTCNT, data->blksz*data->blocks);
		mci_writel(host, BLKSIZ, data->blksz);
	}

	cmdflags = dw_mci_prepare_command(slot->mmc, cmd);

	/* this is the first command, send the initialization clock */
	if (test_and_clear_bit(DW_MMC_CARD_NEED_INIT, &slot->flags))
		cmdflags |= SDMMC_CMD_INIT;

	if (data) {
		dw_mci_submit_data(host, data);
		wmb();
	}

	dw_mci_start_command(host, cmd, cmdflags);

1025
	if (cmd->opcode == SD_SWITCH_VOLTAGE) {
1026 1027
		unsigned long irqflags;

1028
		/*
1029 1030 1031 1032
		 * Databook says to fail after 2ms w/ no response, but evidence
		 * shows that sometimes the cmd11 interrupt takes over 130ms.
		 * We'll set to 500ms, plus an extra jiffy just in case jiffies
		 * is just about to roll over.
1033 1034 1035 1036
		 *
		 * We do this whole thing under spinlock and only if the
		 * command hasn't already completed (indicating the the irq
		 * already ran so we don't want the timeout).
1037
		 */
1038 1039 1040 1041 1042
		spin_lock_irqsave(&host->irq_lock, irqflags);
		if (!test_bit(EVENT_CMD_COMPLETE, &host->pending_events))
			mod_timer(&host->cmd11_timer,
				jiffies + msecs_to_jiffies(500) + 1);
		spin_unlock_irqrestore(&host->irq_lock, irqflags);
1043 1044
	}

1045 1046
	if (mrq->stop)
		host->stop_cmdr = dw_mci_prepare_command(slot->mmc, mrq->stop);
1047 1048
	else
		host->stop_cmdr = dw_mci_prep_stop_abort(host, cmd);
1049 1050
}

1051 1052 1053 1054 1055 1056 1057 1058 1059 1060
static void dw_mci_start_request(struct dw_mci *host,
				 struct dw_mci_slot *slot)
{
	struct mmc_request *mrq = slot->mrq;
	struct mmc_command *cmd;

	cmd = mrq->sbc ? mrq->sbc : mrq->cmd;
	__dw_mci_start_request(host, slot, cmd);
}

1061
/* must be called with host->lock held */
1062 1063 1064 1065 1066 1067 1068 1069
static void dw_mci_queue_request(struct dw_mci *host, struct dw_mci_slot *slot,
				 struct mmc_request *mrq)
{
	dev_vdbg(&slot->mmc->class_dev, "queue request: state=%d\n",
		 host->state);

	slot->mrq = mrq;

1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080
	if (host->state == STATE_WAITING_CMD11_DONE) {
		dev_warn(&slot->mmc->class_dev,
			 "Voltage change didn't complete\n");
		/*
		 * this case isn't expected to happen, so we can
		 * either crash here or just try to continue on
		 * in the closest possible state
		 */
		host->state = STATE_IDLE;
	}

1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095
	if (host->state == STATE_IDLE) {
		host->state = STATE_SENDING_CMD;
		dw_mci_start_request(host, slot);
	} else {
		list_add_tail(&slot->queue_node, &host->queue);
	}
}

static void dw_mci_request(struct mmc_host *mmc, struct mmc_request *mrq)
{
	struct dw_mci_slot *slot = mmc_priv(mmc);
	struct dw_mci *host = slot->host;

	WARN_ON(slot->mrq);

1096 1097 1098 1099 1100 1101 1102
	/*
	 * The check for card presence and queueing of the request must be
	 * atomic, otherwise the card could be removed in between and the
	 * request wouldn't fail until another card was inserted.
	 */
	spin_lock_bh(&host->lock);

1103
	if (!test_bit(DW_MMC_CARD_PRESENT, &slot->flags)) {
1104
		spin_unlock_bh(&host->lock);
1105 1106 1107 1108 1109 1110
		mrq->cmd->error = -ENOMEDIUM;
		mmc_request_done(mmc, mrq);
		return;
	}

	dw_mci_queue_request(host, slot, mrq);
1111 1112

	spin_unlock_bh(&host->lock);
1113 1114 1115 1116 1117
}

static void dw_mci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
{
	struct dw_mci_slot *slot = mmc_priv(mmc);
1118
	const struct dw_mci_drv_data *drv_data = slot->host->drv_data;
J
Jaehoon Chung 已提交
1119
	u32 regs;
1120
	int ret;
1121 1122 1123 1124 1125

	switch (ios->bus_width) {
	case MMC_BUS_WIDTH_4:
		slot->ctype = SDMMC_CTYPE_4BIT;
		break;
1126 1127 1128
	case MMC_BUS_WIDTH_8:
		slot->ctype = SDMMC_CTYPE_8BIT;
		break;
1129 1130 1131
	default:
		/* set default 1 bit mode */
		slot->ctype = SDMMC_CTYPE_1BIT;
1132 1133
	}

1134 1135
	regs = mci_readl(slot->host, UHS_REG);

J
Jaehoon Chung 已提交
1136
	/* DDR mode set */
1137 1138
	if (ios->timing == MMC_TIMING_MMC_DDR52 ||
	    ios->timing == MMC_TIMING_MMC_HS400)
1139
		regs |= ((0x1 << slot->id) << 16);
1140
	else
1141
		regs &= ~((0x1 << slot->id) << 16);
1142 1143

	mci_writel(slot->host, UHS_REG, regs);
1144
	slot->host->timing = ios->timing;
J
Jaehoon Chung 已提交
1145

1146 1147 1148 1149 1150
	/*
	 * Use mirror of ios->clock to prevent race with mmc
	 * core ios update when finding the minimum.
	 */
	slot->clock = ios->clock;
1151

1152 1153
	if (drv_data && drv_data->set_ios)
		drv_data->set_ios(slot->host, ios);
1154

1155 1156
	switch (ios->power_mode) {
	case MMC_POWER_UP:
1157 1158 1159 1160 1161 1162 1163 1164 1165 1166
		if (!IS_ERR(mmc->supply.vmmc)) {
			ret = mmc_regulator_set_ocr(mmc, mmc->supply.vmmc,
					ios->vdd);
			if (ret) {
				dev_err(slot->host->dev,
					"failed to enable vmmc regulator\n");
				/*return, if failed turn on vmmc*/
				return;
			}
		}
1167 1168 1169 1170 1171 1172
		set_bit(DW_MMC_CARD_NEED_INIT, &slot->flags);
		regs = mci_readl(slot->host, PWREN);
		regs |= (1 << slot->id);
		mci_writel(slot->host, PWREN, regs);
		break;
	case MMC_POWER_ON:
1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183
		if (!slot->host->vqmmc_enabled) {
			if (!IS_ERR(mmc->supply.vqmmc)) {
				ret = regulator_enable(mmc->supply.vqmmc);
				if (ret < 0)
					dev_err(slot->host->dev,
						"failed to enable vqmmc\n");
				else
					slot->host->vqmmc_enabled = true;

			} else {
				/* Keep track so we don't reset again */
1184
				slot->host->vqmmc_enabled = true;
1185 1186 1187 1188 1189
			}

			/* Reset our state machine after powering on */
			dw_mci_ctrl_reset(slot->host,
					  SDMMC_CTRL_ALL_RESET_FLAGS);
1190
		}
1191 1192 1193 1194

		/* Adjust clock / bus width after power is up */
		dw_mci_setup_bus(slot, false);

1195 1196
		break;
	case MMC_POWER_OFF:
1197 1198 1199
		/* Turn clock off before power goes down */
		dw_mci_setup_bus(slot, false);

1200 1201 1202
		if (!IS_ERR(mmc->supply.vmmc))
			mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);

1203
		if (!IS_ERR(mmc->supply.vqmmc) && slot->host->vqmmc_enabled)
1204
			regulator_disable(mmc->supply.vqmmc);
1205
		slot->host->vqmmc_enabled = false;
1206

1207 1208 1209
		regs = mci_readl(slot->host, PWREN);
		regs &= ~(1 << slot->id);
		mci_writel(slot->host, PWREN, regs);
1210 1211 1212 1213
		break;
	default:
		break;
	}
1214 1215 1216

	if (slot->host->state == STATE_WAITING_CMD11_DONE && ios->clock != 0)
		slot->host->state = STATE_IDLE;
1217 1218
}

1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260
static int dw_mci_card_busy(struct mmc_host *mmc)
{
	struct dw_mci_slot *slot = mmc_priv(mmc);
	u32 status;

	/*
	 * Check the busy bit which is low when DAT[3:0]
	 * (the data lines) are 0000
	 */
	status = mci_readl(slot->host, STATUS);

	return !!(status & SDMMC_STATUS_BUSY);
}

static int dw_mci_switch_voltage(struct mmc_host *mmc, struct mmc_ios *ios)
{
	struct dw_mci_slot *slot = mmc_priv(mmc);
	struct dw_mci *host = slot->host;
	u32 uhs;
	u32 v18 = SDMMC_UHS_18V << slot->id;
	int min_uv, max_uv;
	int ret;

	/*
	 * Program the voltage.  Note that some instances of dw_mmc may use
	 * the UHS_REG for this.  For other instances (like exynos) the UHS_REG
	 * does no harm but you need to set the regulator directly.  Try both.
	 */
	uhs = mci_readl(host, UHS_REG);
	if (ios->signal_voltage == MMC_SIGNAL_VOLTAGE_330) {
		min_uv = 2700000;
		max_uv = 3600000;
		uhs &= ~v18;
	} else {
		min_uv = 1700000;
		max_uv = 1950000;
		uhs |= v18;
	}
	if (!IS_ERR(mmc->supply.vqmmc)) {
		ret = regulator_set_voltage(mmc->supply.vqmmc, min_uv, max_uv);

		if (ret) {
1261
			dev_dbg(&mmc->class_dev,
1262 1263 1264 1265 1266 1267 1268 1269 1270 1271
					 "Regulator set error %d: %d - %d\n",
					 ret, min_uv, max_uv);
			return ret;
		}
	}
	mci_writel(host, UHS_REG, uhs);

	return 0;
}

1272 1273 1274 1275
static int dw_mci_get_ro(struct mmc_host *mmc)
{
	int read_only;
	struct dw_mci_slot *slot = mmc_priv(mmc);
1276
	int gpio_ro = mmc_gpio_get_ro(mmc);
1277 1278

	/* Use platform get_ro function, else try on board write protect */
1279 1280
	if ((slot->quirks & DW_MCI_SLOT_QUIRK_NO_WRITE_PROTECT) ||
			(slot->host->quirks & DW_MCI_QUIRK_NO_WRITE_PROTECT))
1281
		read_only = 0;
1282 1283
	else if (!IS_ERR_VALUE(gpio_ro))
		read_only = gpio_ro;
1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298
	else
		read_only =
			mci_readl(slot->host, WRTPRT) & (1 << slot->id) ? 1 : 0;

	dev_dbg(&mmc->class_dev, "card is %s\n",
		read_only ? "read-only" : "read-write");

	return read_only;
}

static int dw_mci_get_cd(struct mmc_host *mmc)
{
	int present;
	struct dw_mci_slot *slot = mmc_priv(mmc);
	struct dw_mci_board *brd = slot->host->pdata;
Z
Zhangfei Gao 已提交
1299 1300
	struct dw_mci *host = slot->host;
	int gpio_cd = mmc_gpio_get_cd(mmc);
1301 1302

	/* Use platform get_cd function, else try onboard card detect */
1303 1304
	if (brd->quirks & DW_MCI_QUIRK_BROKEN_CARD_DETECTION)
		present = 1;
1305
	else if (!IS_ERR_VALUE(gpio_cd))
Z
Zhangfei Gao 已提交
1306
		present = gpio_cd;
1307 1308 1309 1310
	else
		present = (mci_readl(slot->host, CDETECT) & (1 << slot->id))
			== 0 ? 1 : 0;

Z
Zhangfei Gao 已提交
1311
	spin_lock_bh(&host->lock);
1312 1313
	if (present) {
		set_bit(DW_MMC_CARD_PRESENT, &slot->flags);
1314
		dev_dbg(&mmc->class_dev, "card is present\n");
1315 1316
	} else {
		clear_bit(DW_MMC_CARD_PRESENT, &slot->flags);
1317
		dev_dbg(&mmc->class_dev, "card is not present\n");
1318
	}
Z
Zhangfei Gao 已提交
1319
	spin_unlock_bh(&host->lock);
1320 1321 1322 1323

	return present;
}

1324
static void dw_mci_init_card(struct mmc_host *mmc, struct mmc_card *card)
1325
{
1326
	struct dw_mci_slot *slot = mmc_priv(mmc);
1327 1328
	struct dw_mci *host = slot->host;

1329 1330 1331 1332 1333 1334 1335 1336 1337
	/*
	 * Low power mode will stop the card clock when idle.  According to the
	 * description of the CLKENA register we should disable low power mode
	 * for SDIO cards if we need SDIO interrupts to work.
	 */
	if (mmc->caps & MMC_CAP_SDIO_IRQ) {
		const u32 clken_low_pwr = SDMMC_CLKEN_LOW_PWR << slot->id;
		u32 clk_en_a_old;
		u32 clk_en_a;
1338

1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354
		clk_en_a_old = mci_readl(host, CLKENA);

		if (card->type == MMC_TYPE_SDIO ||
		    card->type == MMC_TYPE_SD_COMBO) {
			set_bit(DW_MMC_CARD_NO_LOW_PWR, &slot->flags);
			clk_en_a = clk_en_a_old & ~clken_low_pwr;
		} else {
			clear_bit(DW_MMC_CARD_NO_LOW_PWR, &slot->flags);
			clk_en_a = clk_en_a_old | clken_low_pwr;
		}

		if (clk_en_a != clk_en_a_old) {
			mci_writel(host, CLKENA, clk_en_a);
			mci_send_cmd(slot, SDMMC_CMD_UPD_CLK |
				     SDMMC_CMD_PRV_DAT_WAIT, 0);
		}
1355 1356 1357
	}
}

1358 1359 1360 1361
static void dw_mci_enable_sdio_irq(struct mmc_host *mmc, int enb)
{
	struct dw_mci_slot *slot = mmc_priv(mmc);
	struct dw_mci *host = slot->host;
1362
	unsigned long irqflags;
1363 1364
	u32 int_mask;

1365 1366
	spin_lock_irqsave(&host->irq_lock, irqflags);

1367 1368
	/* Enable/disable Slot Specific SDIO interrupt */
	int_mask = mci_readl(host, INTMASK);
1369 1370 1371 1372 1373
	if (enb)
		int_mask |= SDMMC_INT_SDIO(slot->sdio_id);
	else
		int_mask &= ~SDMMC_INT_SDIO(slot->sdio_id);
	mci_writel(host, INTMASK, int_mask);
1374 1375

	spin_unlock_irqrestore(&host->irq_lock, irqflags);
1376 1377
}

1378 1379 1380 1381 1382 1383 1384 1385
static int dw_mci_execute_tuning(struct mmc_host *mmc, u32 opcode)
{
	struct dw_mci_slot *slot = mmc_priv(mmc);
	struct dw_mci *host = slot->host;
	const struct dw_mci_drv_data *drv_data = host->drv_data;
	int err = -ENOSYS;

	if (drv_data && drv_data->execute_tuning)
1386
		err = drv_data->execute_tuning(slot);
1387 1388 1389
	return err;
}

1390
static int dw_mci_prepare_hs400_tuning(struct mmc_host *mmc, struct mmc_ios *ios)
1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401
{
	struct dw_mci_slot *slot = mmc_priv(mmc);
	struct dw_mci *host = slot->host;
	const struct dw_mci_drv_data *drv_data = host->drv_data;

	if (drv_data && drv_data->prepare_hs400_tuning)
		return drv_data->prepare_hs400_tuning(host, ios);

	return 0;
}

1402
static const struct mmc_host_ops dw_mci_ops = {
1403
	.request		= dw_mci_request,
1404 1405
	.pre_req		= dw_mci_pre_req,
	.post_req		= dw_mci_post_req,
1406 1407 1408 1409
	.set_ios		= dw_mci_set_ios,
	.get_ro			= dw_mci_get_ro,
	.get_cd			= dw_mci_get_cd,
	.enable_sdio_irq	= dw_mci_enable_sdio_irq,
1410
	.execute_tuning		= dw_mci_execute_tuning,
1411 1412
	.card_busy		= dw_mci_card_busy,
	.start_signal_voltage_switch = dw_mci_switch_voltage,
1413
	.init_card		= dw_mci_init_card,
1414
	.prepare_hs400_tuning	= dw_mci_prepare_hs400_tuning,
1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431
};

static void dw_mci_request_end(struct dw_mci *host, struct mmc_request *mrq)
	__releases(&host->lock)
	__acquires(&host->lock)
{
	struct dw_mci_slot *slot;
	struct mmc_host	*prev_mmc = host->cur_slot->mmc;

	WARN_ON(host->cmd || host->data);

	host->cur_slot->mrq = NULL;
	host->mrq = NULL;
	if (!list_empty(&host->queue)) {
		slot = list_entry(host->queue.next,
				  struct dw_mci_slot, queue_node);
		list_del(&slot->queue_node);
1432
		dev_vdbg(host->dev, "list not empty: %s is next\n",
1433 1434 1435 1436
			 mmc_hostname(slot->mmc));
		host->state = STATE_SENDING_CMD;
		dw_mci_start_request(host, slot);
	} else {
1437
		dev_vdbg(host->dev, "list empty\n");
1438 1439 1440 1441 1442

		if (host->state == STATE_SENDING_CMD11)
			host->state = STATE_WAITING_CMD11_DONE;
		else
			host->state = STATE_IDLE;
1443 1444 1445 1446 1447 1448 1449
	}

	spin_unlock(&host->lock);
	mmc_request_done(prev_mmc, mrq);
	spin_lock(&host->lock);
}

1450
static int dw_mci_command_complete(struct dw_mci *host, struct mmc_command *cmd)
1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484
{
	u32 status = host->cmd_status;

	host->cmd_status = 0;

	/* Read the response from the card (up to 16 bytes) */
	if (cmd->flags & MMC_RSP_PRESENT) {
		if (cmd->flags & MMC_RSP_136) {
			cmd->resp[3] = mci_readl(host, RESP0);
			cmd->resp[2] = mci_readl(host, RESP1);
			cmd->resp[1] = mci_readl(host, RESP2);
			cmd->resp[0] = mci_readl(host, RESP3);
		} else {
			cmd->resp[0] = mci_readl(host, RESP0);
			cmd->resp[1] = 0;
			cmd->resp[2] = 0;
			cmd->resp[3] = 0;
		}
	}

	if (status & SDMMC_INT_RTO)
		cmd->error = -ETIMEDOUT;
	else if ((cmd->flags & MMC_RSP_CRC) && (status & SDMMC_INT_RCRC))
		cmd->error = -EILSEQ;
	else if (status & SDMMC_INT_RESP_ERR)
		cmd->error = -EIO;
	else
		cmd->error = 0;

	if (cmd->error) {
		/* newer ip versions need a delay between retries */
		if (host->quirks & DW_MCI_QUIRK_RETRY_DELAY)
			mdelay(20);
	}
1485 1486 1487 1488 1489 1490

	return cmd->error;
}

static int dw_mci_data_complete(struct dw_mci *host, struct mmc_data *data)
{
1491
	u32 status = host->data_status;
1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516

	if (status & DW_MCI_DATA_ERROR_FLAGS) {
		if (status & SDMMC_INT_DRTO) {
			data->error = -ETIMEDOUT;
		} else if (status & SDMMC_INT_DCRC) {
			data->error = -EILSEQ;
		} else if (status & SDMMC_INT_EBE) {
			if (host->dir_status ==
				DW_MCI_SEND_STATUS) {
				/*
				 * No data CRC status was returned.
				 * The number of bytes transferred
				 * will be exaggerated in PIO mode.
				 */
				data->bytes_xfered = 0;
				data->error = -ETIMEDOUT;
			} else if (host->dir_status ==
					DW_MCI_RECV_STATUS) {
				data->error = -EIO;
			}
		} else {
			/* SDMMC_INT_SBE is included */
			data->error = -EIO;
		}

1517
		dev_dbg(host->dev, "data error, status 0x%08x\n", status);
1518 1519 1520

		/*
		 * After an error, there may be data lingering
1521
		 * in the FIFO
1522
		 */
1523
		dw_mci_reset(host);
1524 1525 1526 1527 1528 1529
	} else {
		data->bytes_xfered = data->blocks * data->blksz;
		data->error = 0;
	}

	return data->error;
1530 1531 1532 1533 1534 1535 1536
}

static void dw_mci_tasklet_func(unsigned long priv)
{
	struct dw_mci *host = (struct dw_mci *)priv;
	struct mmc_data	*data;
	struct mmc_command *cmd;
1537
	struct mmc_request *mrq;
1538 1539
	enum dw_mci_state state;
	enum dw_mci_state prev_state;
1540
	unsigned int err;
1541 1542 1543 1544 1545

	spin_lock(&host->lock);

	state = host->state;
	data = host->data;
1546
	mrq = host->mrq;
1547 1548 1549 1550 1551 1552

	do {
		prev_state = state;

		switch (state) {
		case STATE_IDLE:
1553
		case STATE_WAITING_CMD11_DONE:
1554 1555
			break;

1556
		case STATE_SENDING_CMD11:
1557 1558 1559 1560 1561 1562 1563 1564
		case STATE_SENDING_CMD:
			if (!test_and_clear_bit(EVENT_CMD_COMPLETE,
						&host->pending_events))
				break;

			cmd = host->cmd;
			host->cmd = NULL;
			set_bit(EVENT_CMD_COMPLETE, &host->completed_events);
1565 1566
			err = dw_mci_command_complete(host, cmd);
			if (cmd == mrq->sbc && !err) {
1567 1568
				prev_state = state = STATE_SENDING_CMD;
				__dw_mci_start_request(host, host->cur_slot,
1569
						       mrq->cmd);
1570 1571 1572
				goto unlock;
			}

1573
			if (cmd->data && err) {
1574
				dw_mci_stop_dma(host);
1575 1576 1577
				send_stop_abort(host, data);
				state = STATE_SENDING_STOP;
				break;
1578 1579
			}

1580 1581
			if (!cmd->data || err) {
				dw_mci_request_end(host, mrq);
1582 1583 1584 1585 1586 1587 1588
				goto unlock;
			}

			prev_state = state = STATE_SENDING_DATA;
			/* fall through */

		case STATE_SENDING_DATA:
1589 1590 1591 1592 1593 1594 1595 1596
			/*
			 * We could get a data error and never a transfer
			 * complete so we'd better check for it here.
			 *
			 * Note that we don't really care if we also got a
			 * transfer complete; stopping the DMA and sending an
			 * abort won't hurt.
			 */
1597 1598 1599
			if (test_and_clear_bit(EVENT_DATA_ERROR,
					       &host->pending_events)) {
				dw_mci_stop_dma(host);
1600 1601 1602 1603
				if (data->stop ||
				    !(host->data_status & (SDMMC_INT_DRTO |
							   SDMMC_INT_EBE)))
					send_stop_abort(host, data);
1604 1605 1606 1607 1608 1609 1610 1611 1612
				state = STATE_DATA_ERROR;
				break;
			}

			if (!test_and_clear_bit(EVENT_XFER_COMPLETE,
						&host->pending_events))
				break;

			set_bit(EVENT_XFER_COMPLETE, &host->completed_events);
1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629

			/*
			 * Handle an EVENT_DATA_ERROR that might have shown up
			 * before the transfer completed.  This might not have
			 * been caught by the check above because the interrupt
			 * could have gone off between the previous check and
			 * the check for transfer complete.
			 *
			 * Technically this ought not be needed assuming we
			 * get a DATA_COMPLETE eventually (we'll notice the
			 * error and end the request), but it shouldn't hurt.
			 *
			 * This has the advantage of sending the stop command.
			 */
			if (test_and_clear_bit(EVENT_DATA_ERROR,
					       &host->pending_events)) {
				dw_mci_stop_dma(host);
1630 1631 1632 1633
				if (data->stop ||
				    !(host->data_status & (SDMMC_INT_DRTO |
							   SDMMC_INT_EBE)))
					send_stop_abort(host, data);
1634 1635 1636
				state = STATE_DATA_ERROR;
				break;
			}
1637
			prev_state = state = STATE_DATA_BUSY;
1638

1639 1640 1641 1642 1643 1644 1645 1646 1647
			/* fall through */

		case STATE_DATA_BUSY:
			if (!test_and_clear_bit(EVENT_DATA_COMPLETE,
						&host->pending_events))
				break;

			host->data = NULL;
			set_bit(EVENT_DATA_COMPLETE, &host->completed_events);
1648 1649 1650 1651
			err = dw_mci_data_complete(host, data);

			if (!err) {
				if (!data->stop || mrq->sbc) {
1652
					if (mrq->sbc && data->stop)
1653 1654 1655
						data->stop->error = 0;
					dw_mci_request_end(host, mrq);
					goto unlock;
1656 1657
				}

1658 1659 1660
				/* stop command for open-ended transfer*/
				if (data->stop)
					send_stop_abort(host, data);
1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676
			} else {
				/*
				 * If we don't have a command complete now we'll
				 * never get one since we just reset everything;
				 * better end the request.
				 *
				 * If we do have a command complete we'll fall
				 * through to the SENDING_STOP command and
				 * everything will be peachy keen.
				 */
				if (!test_bit(EVENT_CMD_COMPLETE,
					      &host->pending_events)) {
					host->cmd = NULL;
					dw_mci_request_end(host, mrq);
					goto unlock;
				}
1677 1678
			}

1679 1680 1681 1682
			/*
			 * If err has non-zero,
			 * stop-abort command has been already issued.
			 */
1683
			prev_state = state = STATE_SENDING_STOP;
1684

1685 1686 1687 1688 1689 1690 1691
			/* fall through */

		case STATE_SENDING_STOP:
			if (!test_and_clear_bit(EVENT_CMD_COMPLETE,
						&host->pending_events))
				break;

1692
			/* CMD error in data command */
1693
			if (mrq->cmd->error && mrq->data)
1694
				dw_mci_reset(host);
1695

1696
			host->cmd = NULL;
1697
			host->data = NULL;
1698

1699 1700
			if (mrq->stop)
				dw_mci_command_complete(host, mrq->stop);
1701 1702 1703
			else
				host->cmd_status = 0;

1704
			dw_mci_request_end(host, mrq);
1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722
			goto unlock;

		case STATE_DATA_ERROR:
			if (!test_and_clear_bit(EVENT_XFER_COMPLETE,
						&host->pending_events))
				break;

			state = STATE_DATA_BUSY;
			break;
		}
	} while (state != prev_state);

	host->state = state;
unlock:
	spin_unlock(&host->lock);

}

1723 1724
/* push final bytes to part_buf, only use during push */
static void dw_mci_set_part_bytes(struct dw_mci *host, void *buf, int cnt)
1725
{
1726 1727 1728
	memcpy((void *)&host->part_buf, buf, cnt);
	host->part_buf_count = cnt;
}
1729

1730 1731 1732 1733 1734 1735 1736 1737
/* append bytes to part_buf, only use during push */
static int dw_mci_push_part_bytes(struct dw_mci *host, void *buf, int cnt)
{
	cnt = min(cnt, (1 << host->data_shift) - host->part_buf_count);
	memcpy((void *)&host->part_buf + host->part_buf_count, buf, cnt);
	host->part_buf_count += cnt;
	return cnt;
}
1738

1739 1740 1741 1742 1743 1744 1745 1746 1747
/* pull first bytes from part_buf, only use during pull */
static int dw_mci_pull_part_bytes(struct dw_mci *host, void *buf, int cnt)
{
	cnt = min(cnt, (int)host->part_buf_count);
	if (cnt) {
		memcpy(buf, (void *)&host->part_buf + host->part_buf_start,
		       cnt);
		host->part_buf_count -= cnt;
		host->part_buf_start += cnt;
1748
	}
1749
	return cnt;
1750 1751
}

1752 1753
/* pull final bytes from the part_buf, assuming it's just been filled */
static void dw_mci_pull_final_bytes(struct dw_mci *host, void *buf, int cnt)
1754
{
1755 1756 1757 1758
	memcpy(buf, &host->part_buf, cnt);
	host->part_buf_start = cnt;
	host->part_buf_count = (1 << host->data_shift) - cnt;
}
1759

1760 1761
static void dw_mci_push_data16(struct dw_mci *host, void *buf, int cnt)
{
1762 1763 1764
	struct mmc_data *data = host->data;
	int init_cnt = cnt;

1765 1766 1767 1768 1769
	/* try and push anything in the part_buf */
	if (unlikely(host->part_buf_count)) {
		int len = dw_mci_push_part_bytes(host, buf, cnt);
		buf += len;
		cnt -= len;
1770
		if (host->part_buf_count == 2) {
1771
			mci_fifo_writew(host->fifo_reg, host->part_buf16);
1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787
			host->part_buf_count = 0;
		}
	}
#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS
	if (unlikely((unsigned long)buf & 0x1)) {
		while (cnt >= 2) {
			u16 aligned_buf[64];
			int len = min(cnt & -2, (int)sizeof(aligned_buf));
			int items = len >> 1;
			int i;
			/* memcpy from input buffer into aligned buffer */
			memcpy(aligned_buf, buf, len);
			buf += len;
			cnt -= len;
			/* push data from aligned buffer into fifo */
			for (i = 0; i < items; ++i)
1788
				mci_fifo_writew(host->fifo_reg, aligned_buf[i]);
1789 1790 1791 1792 1793 1794
		}
	} else
#endif
	{
		u16 *pdata = buf;
		for (; cnt >= 2; cnt -= 2)
1795
			mci_fifo_writew(host->fifo_reg, *pdata++);
1796 1797 1798 1799 1800
		buf = pdata;
	}
	/* put anything remaining in the part_buf */
	if (cnt) {
		dw_mci_set_part_bytes(host, buf, cnt);
1801 1802 1803
		 /* Push data if we have reached the expected data length */
		if ((data->bytes_xfered + init_cnt) ==
		    (data->blksz * data->blocks))
1804
			mci_fifo_writew(host->fifo_reg, host->part_buf16);
1805 1806
	}
}
1807

1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818
static void dw_mci_pull_data16(struct dw_mci *host, void *buf, int cnt)
{
#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS
	if (unlikely((unsigned long)buf & 0x1)) {
		while (cnt >= 2) {
			/* pull data from fifo into aligned buffer */
			u16 aligned_buf[64];
			int len = min(cnt & -2, (int)sizeof(aligned_buf));
			int items = len >> 1;
			int i;
			for (i = 0; i < items; ++i)
1819
				aligned_buf[i] = mci_fifo_readw(host->fifo_reg);
1820 1821 1822 1823 1824 1825 1826 1827 1828 1829
			/* memcpy from aligned buffer into output buffer */
			memcpy(buf, aligned_buf, len);
			buf += len;
			cnt -= len;
		}
	} else
#endif
	{
		u16 *pdata = buf;
		for (; cnt >= 2; cnt -= 2)
1830
			*pdata++ = mci_fifo_readw(host->fifo_reg);
1831 1832 1833
		buf = pdata;
	}
	if (cnt) {
1834
		host->part_buf16 = mci_fifo_readw(host->fifo_reg);
1835
		dw_mci_pull_final_bytes(host, buf, cnt);
1836 1837 1838 1839 1840
	}
}

static void dw_mci_push_data32(struct dw_mci *host, void *buf, int cnt)
{
1841 1842 1843
	struct mmc_data *data = host->data;
	int init_cnt = cnt;

1844 1845 1846 1847 1848
	/* try and push anything in the part_buf */
	if (unlikely(host->part_buf_count)) {
		int len = dw_mci_push_part_bytes(host, buf, cnt);
		buf += len;
		cnt -= len;
1849
		if (host->part_buf_count == 4) {
1850
			mci_fifo_writel(host->fifo_reg,	host->part_buf32);
1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866
			host->part_buf_count = 0;
		}
	}
#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS
	if (unlikely((unsigned long)buf & 0x3)) {
		while (cnt >= 4) {
			u32 aligned_buf[32];
			int len = min(cnt & -4, (int)sizeof(aligned_buf));
			int items = len >> 2;
			int i;
			/* memcpy from input buffer into aligned buffer */
			memcpy(aligned_buf, buf, len);
			buf += len;
			cnt -= len;
			/* push data from aligned buffer into fifo */
			for (i = 0; i < items; ++i)
1867
				mci_fifo_writel(host->fifo_reg,	aligned_buf[i]);
1868 1869 1870 1871 1872 1873
		}
	} else
#endif
	{
		u32 *pdata = buf;
		for (; cnt >= 4; cnt -= 4)
1874
			mci_fifo_writel(host->fifo_reg, *pdata++);
1875 1876 1877 1878 1879
		buf = pdata;
	}
	/* put anything remaining in the part_buf */
	if (cnt) {
		dw_mci_set_part_bytes(host, buf, cnt);
1880 1881 1882
		 /* Push data if we have reached the expected data length */
		if ((data->bytes_xfered + init_cnt) ==
		    (data->blksz * data->blocks))
1883
			mci_fifo_writel(host->fifo_reg, host->part_buf32);
1884 1885 1886 1887 1888
	}
}

static void dw_mci_pull_data32(struct dw_mci *host, void *buf, int cnt)
{
1889 1890 1891 1892 1893 1894 1895 1896 1897
#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS
	if (unlikely((unsigned long)buf & 0x3)) {
		while (cnt >= 4) {
			/* pull data from fifo into aligned buffer */
			u32 aligned_buf[32];
			int len = min(cnt & -4, (int)sizeof(aligned_buf));
			int items = len >> 2;
			int i;
			for (i = 0; i < items; ++i)
1898
				aligned_buf[i] = mci_fifo_readl(host->fifo_reg);
1899 1900 1901 1902 1903 1904 1905 1906 1907 1908
			/* memcpy from aligned buffer into output buffer */
			memcpy(buf, aligned_buf, len);
			buf += len;
			cnt -= len;
		}
	} else
#endif
	{
		u32 *pdata = buf;
		for (; cnt >= 4; cnt -= 4)
1909
			*pdata++ = mci_fifo_readl(host->fifo_reg);
1910 1911 1912
		buf = pdata;
	}
	if (cnt) {
1913
		host->part_buf32 = mci_fifo_readl(host->fifo_reg);
1914
		dw_mci_pull_final_bytes(host, buf, cnt);
1915 1916 1917 1918 1919
	}
}

static void dw_mci_push_data64(struct dw_mci *host, void *buf, int cnt)
{
1920 1921 1922
	struct mmc_data *data = host->data;
	int init_cnt = cnt;

1923 1924 1925 1926 1927
	/* try and push anything in the part_buf */
	if (unlikely(host->part_buf_count)) {
		int len = dw_mci_push_part_bytes(host, buf, cnt);
		buf += len;
		cnt -= len;
1928

1929
		if (host->part_buf_count == 8) {
1930
			mci_fifo_writeq(host->fifo_reg,	host->part_buf);
1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946
			host->part_buf_count = 0;
		}
	}
#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS
	if (unlikely((unsigned long)buf & 0x7)) {
		while (cnt >= 8) {
			u64 aligned_buf[16];
			int len = min(cnt & -8, (int)sizeof(aligned_buf));
			int items = len >> 3;
			int i;
			/* memcpy from input buffer into aligned buffer */
			memcpy(aligned_buf, buf, len);
			buf += len;
			cnt -= len;
			/* push data from aligned buffer into fifo */
			for (i = 0; i < items; ++i)
1947
				mci_fifo_writeq(host->fifo_reg,	aligned_buf[i]);
1948 1949 1950 1951 1952 1953
		}
	} else
#endif
	{
		u64 *pdata = buf;
		for (; cnt >= 8; cnt -= 8)
1954
			mci_fifo_writeq(host->fifo_reg, *pdata++);
1955 1956 1957 1958 1959
		buf = pdata;
	}
	/* put anything remaining in the part_buf */
	if (cnt) {
		dw_mci_set_part_bytes(host, buf, cnt);
1960 1961 1962
		/* Push data if we have reached the expected data length */
		if ((data->bytes_xfered + init_cnt) ==
		    (data->blksz * data->blocks))
1963
			mci_fifo_writeq(host->fifo_reg, host->part_buf);
1964 1965 1966 1967 1968
	}
}

static void dw_mci_pull_data64(struct dw_mci *host, void *buf, int cnt)
{
1969 1970 1971 1972 1973 1974 1975 1976 1977
#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS
	if (unlikely((unsigned long)buf & 0x7)) {
		while (cnt >= 8) {
			/* pull data from fifo into aligned buffer */
			u64 aligned_buf[16];
			int len = min(cnt & -8, (int)sizeof(aligned_buf));
			int items = len >> 3;
			int i;
			for (i = 0; i < items; ++i)
1978 1979
				aligned_buf[i] = mci_fifo_readq(host->fifo_reg);

1980 1981 1982 1983 1984 1985 1986 1987 1988 1989
			/* memcpy from aligned buffer into output buffer */
			memcpy(buf, aligned_buf, len);
			buf += len;
			cnt -= len;
		}
	} else
#endif
	{
		u64 *pdata = buf;
		for (; cnt >= 8; cnt -= 8)
1990
			*pdata++ = mci_fifo_readq(host->fifo_reg);
1991 1992 1993
		buf = pdata;
	}
	if (cnt) {
1994
		host->part_buf = mci_fifo_readq(host->fifo_reg);
1995 1996 1997
		dw_mci_pull_final_bytes(host, buf, cnt);
	}
}
1998

1999 2000 2001
static void dw_mci_pull_data(struct dw_mci *host, void *buf, int cnt)
{
	int len;
2002

2003 2004 2005 2006 2007 2008 2009 2010 2011
	/* get remaining partial bytes */
	len = dw_mci_pull_part_bytes(host, buf, cnt);
	if (unlikely(len == cnt))
		return;
	buf += len;
	cnt -= len;

	/* get the rest of the data */
	host->pull_data(host, buf, cnt);
2012 2013
}

2014
static void dw_mci_read_data_pio(struct dw_mci *host, bool dto)
2015
{
2016 2017 2018
	struct sg_mapping_iter *sg_miter = &host->sg_miter;
	void *buf;
	unsigned int offset;
2019 2020 2021
	struct mmc_data	*data = host->data;
	int shift = host->data_shift;
	u32 status;
2022
	unsigned int len;
2023
	unsigned int remain, fcnt;
2024 2025

	do {
2026 2027 2028
		if (!sg_miter_next(sg_miter))
			goto done;

2029
		host->sg = sg_miter->piter.sg;
2030 2031 2032 2033 2034 2035 2036 2037 2038 2039
		buf = sg_miter->addr;
		remain = sg_miter->length;
		offset = 0;

		do {
			fcnt = (SDMMC_GET_FCNT(mci_readl(host, STATUS))
					<< shift) + host->part_buf_count;
			len = min(remain, fcnt);
			if (!len)
				break;
2040
			dw_mci_pull_data(host, (void *)(buf + offset), len);
2041
			data->bytes_xfered += len;
2042
			offset += len;
2043 2044
			remain -= len;
		} while (remain);
2045

2046
		sg_miter->consumed = offset;
2047 2048
		status = mci_readl(host, MINTSTS);
		mci_writel(host, RINTSTS, SDMMC_INT_RXDR);
2049 2050 2051
	/* if the RXDR is ready read again */
	} while ((status & SDMMC_INT_RXDR) ||
		 (dto && SDMMC_GET_FCNT(mci_readl(host, STATUS))));
2052 2053 2054 2055 2056 2057 2058

	if (!remain) {
		if (!sg_miter_next(sg_miter))
			goto done;
		sg_miter->consumed = 0;
	}
	sg_miter_stop(sg_miter);
2059 2060 2061
	return;

done:
2062 2063
	sg_miter_stop(sg_miter);
	host->sg = NULL;
2064 2065 2066 2067 2068 2069
	smp_wmb();
	set_bit(EVENT_XFER_COMPLETE, &host->pending_events);
}

static void dw_mci_write_data_pio(struct dw_mci *host)
{
2070 2071 2072
	struct sg_mapping_iter *sg_miter = &host->sg_miter;
	void *buf;
	unsigned int offset;
2073 2074 2075
	struct mmc_data	*data = host->data;
	int shift = host->data_shift;
	u32 status;
2076
	unsigned int len;
2077 2078
	unsigned int fifo_depth = host->fifo_depth;
	unsigned int remain, fcnt;
2079 2080

	do {
2081 2082 2083
		if (!sg_miter_next(sg_miter))
			goto done;

2084
		host->sg = sg_miter->piter.sg;
2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095
		buf = sg_miter->addr;
		remain = sg_miter->length;
		offset = 0;

		do {
			fcnt = ((fifo_depth -
				 SDMMC_GET_FCNT(mci_readl(host, STATUS)))
					<< shift) - host->part_buf_count;
			len = min(remain, fcnt);
			if (!len)
				break;
2096
			host->push_data(host, (void *)(buf + offset), len);
2097
			data->bytes_xfered += len;
2098
			offset += len;
2099 2100
			remain -= len;
		} while (remain);
2101

2102
		sg_miter->consumed = offset;
2103 2104 2105
		status = mci_readl(host, MINTSTS);
		mci_writel(host, RINTSTS, SDMMC_INT_TXDR);
	} while (status & SDMMC_INT_TXDR); /* if TXDR write again */
2106 2107 2108 2109 2110 2111 2112

	if (!remain) {
		if (!sg_miter_next(sg_miter))
			goto done;
		sg_miter->consumed = 0;
	}
	sg_miter_stop(sg_miter);
2113 2114 2115
	return;

done:
2116 2117
	sg_miter_stop(sg_miter);
	host->sg = NULL;
2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132
	smp_wmb();
	set_bit(EVENT_XFER_COMPLETE, &host->pending_events);
}

static void dw_mci_cmd_interrupt(struct dw_mci *host, u32 status)
{
	if (!host->cmd_status)
		host->cmd_status = status;

	smp_wmb();

	set_bit(EVENT_CMD_COMPLETE, &host->pending_events);
	tasklet_schedule(&host->tasklet);
}

2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149
static void dw_mci_handle_cd(struct dw_mci *host)
{
	int i;

	for (i = 0; i < host->num_slots; i++) {
		struct dw_mci_slot *slot = host->slot[i];

		if (!slot)
			continue;

		if (slot->mmc->ops->card_event)
			slot->mmc->ops->card_event(slot->mmc);
		mmc_detect_change(slot->mmc,
			msecs_to_jiffies(host->pdata->detect_delay_ms));
	}
}

2150 2151 2152
static irqreturn_t dw_mci_interrupt(int irq, void *dev_id)
{
	struct dw_mci *host = dev_id;
2153
	u32 pending;
2154
	int i;
2155

2156 2157
	pending = mci_readl(host, MINTSTS); /* read-only mask reg */

2158 2159 2160 2161 2162 2163 2164 2165 2166
	/*
	 * DTO fix - version 2.10a and below, and only if internal DMA
	 * is configured.
	 */
	if (host->quirks & DW_MCI_QUIRK_IDMAC_DTO) {
		if (!pending &&
		    ((mci_readl(host, STATUS) >> 17) & 0x1fff))
			pending |= SDMMC_INT_DATA_OVER;
	}
2167

2168
	if (pending) {
2169 2170 2171
		/* Check volt switch first, since it can look like an error */
		if ((host->state == STATE_SENDING_CMD11) &&
		    (pending & SDMMC_INT_VOLT_SWITCH)) {
2172
			unsigned long irqflags;
2173

2174 2175
			mci_writel(host, RINTSTS, SDMMC_INT_VOLT_SWITCH);
			pending &= ~SDMMC_INT_VOLT_SWITCH;
2176 2177 2178 2179 2180 2181

			/*
			 * Hold the lock; we know cmd11_timer can't be kicked
			 * off after the lock is released, so safe to delete.
			 */
			spin_lock_irqsave(&host->irq_lock, irqflags);
2182
			dw_mci_cmd_interrupt(host, pending);
2183 2184 2185
			spin_unlock_irqrestore(&host->irq_lock, irqflags);

			del_timer(&host->cmd11_timer);
2186 2187
		}

2188 2189
		if (pending & DW_MCI_CMD_ERROR_FLAGS) {
			mci_writel(host, RINTSTS, DW_MCI_CMD_ERROR_FLAGS);
2190
			host->cmd_status = pending;
2191 2192 2193 2194 2195 2196 2197
			smp_wmb();
			set_bit(EVENT_CMD_COMPLETE, &host->pending_events);
		}

		if (pending & DW_MCI_DATA_ERROR_FLAGS) {
			/* if there is an error report DATA_ERROR */
			mci_writel(host, RINTSTS, DW_MCI_DATA_ERROR_FLAGS);
2198
			host->data_status = pending;
2199 2200
			smp_wmb();
			set_bit(EVENT_DATA_ERROR, &host->pending_events);
2201
			tasklet_schedule(&host->tasklet);
2202 2203 2204 2205 2206
		}

		if (pending & SDMMC_INT_DATA_OVER) {
			mci_writel(host, RINTSTS, SDMMC_INT_DATA_OVER);
			if (!host->data_status)
2207
				host->data_status = pending;
2208 2209 2210
			smp_wmb();
			if (host->dir_status == DW_MCI_RECV_STATUS) {
				if (host->sg != NULL)
2211
					dw_mci_read_data_pio(host, true);
2212 2213 2214 2215 2216 2217 2218
			}
			set_bit(EVENT_DATA_COMPLETE, &host->pending_events);
			tasklet_schedule(&host->tasklet);
		}

		if (pending & SDMMC_INT_RXDR) {
			mci_writel(host, RINTSTS, SDMMC_INT_RXDR);
2219
			if (host->dir_status == DW_MCI_RECV_STATUS && host->sg)
2220
				dw_mci_read_data_pio(host, false);
2221 2222 2223 2224
		}

		if (pending & SDMMC_INT_TXDR) {
			mci_writel(host, RINTSTS, SDMMC_INT_TXDR);
2225
			if (host->dir_status == DW_MCI_SEND_STATUS && host->sg)
2226 2227 2228 2229 2230
				dw_mci_write_data_pio(host);
		}

		if (pending & SDMMC_INT_CMD_DONE) {
			mci_writel(host, RINTSTS, SDMMC_INT_CMD_DONE);
2231
			dw_mci_cmd_interrupt(host, pending);
2232 2233 2234 2235
		}

		if (pending & SDMMC_INT_CD) {
			mci_writel(host, RINTSTS, SDMMC_INT_CD);
2236
			dw_mci_handle_cd(host);
2237 2238
		}

2239 2240 2241
		/* Handle SDIO Interrupts */
		for (i = 0; i < host->num_slots; i++) {
			struct dw_mci_slot *slot = host->slot[i];
2242 2243 2244 2245

			if (!slot)
				continue;

2246 2247 2248
			if (pending & SDMMC_INT_SDIO(slot->sdio_id)) {
				mci_writel(host, RINTSTS,
					   SDMMC_INT_SDIO(slot->sdio_id));
2249 2250 2251 2252
				mmc_signal_sdio_irq(slot->mmc);
			}
		}

2253
	}
2254 2255 2256

#ifdef CONFIG_MMC_DW_IDMAC
	/* Handle DMA interrupts */
2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272
	if (host->dma_64bit_address == 1) {
		pending = mci_readl(host, IDSTS64);
		if (pending & (SDMMC_IDMAC_INT_TI | SDMMC_IDMAC_INT_RI)) {
			mci_writel(host, IDSTS64, SDMMC_IDMAC_INT_TI |
							SDMMC_IDMAC_INT_RI);
			mci_writel(host, IDSTS64, SDMMC_IDMAC_INT_NI);
			host->dma_ops->complete(host);
		}
	} else {
		pending = mci_readl(host, IDSTS);
		if (pending & (SDMMC_IDMAC_INT_TI | SDMMC_IDMAC_INT_RI)) {
			mci_writel(host, IDSTS, SDMMC_IDMAC_INT_TI |
							SDMMC_IDMAC_INT_RI);
			mci_writel(host, IDSTS, SDMMC_IDMAC_INT_NI);
			host->dma_ops->complete(host);
		}
2273 2274 2275 2276 2277 2278
	}
#endif

	return IRQ_HANDLED;
}

2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299
#ifdef CONFIG_OF
/* given a slot id, find out the device node representing that slot */
static struct device_node *dw_mci_of_find_slot_node(struct device *dev, u8 slot)
{
	struct device_node *np;
	const __be32 *addr;
	int len;

	if (!dev || !dev->of_node)
		return NULL;

	for_each_child_of_node(dev->of_node, np) {
		addr = of_get_property(np, "reg", &len);
		if (!addr || (len < sizeof(int)))
			continue;
		if (be32_to_cpup(addr) == slot)
			return np;
	}
	return NULL;
}

2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317
static struct dw_mci_of_slot_quirks {
	char *quirk;
	int id;
} of_slot_quirks[] = {
	{
		.quirk	= "disable-wp",
		.id	= DW_MCI_SLOT_QUIRK_NO_WRITE_PROTECT,
	},
};

static int dw_mci_of_get_slot_quirks(struct device *dev, u8 slot)
{
	struct device_node *np = dw_mci_of_find_slot_node(dev, slot);
	int quirks = 0;
	int idx;

	/* get quirks */
	for (idx = 0; idx < ARRAY_SIZE(of_slot_quirks); idx++)
2318 2319 2320
		if (of_get_property(np, of_slot_quirks[idx].quirk, NULL)) {
			dev_warn(dev, "Slot quirk %s is deprecated\n",
					of_slot_quirks[idx].quirk);
2321
			quirks |= of_slot_quirks[idx].id;
2322
		}
2323 2324 2325

	return quirks;
}
2326
#else /* CONFIG_OF */
2327 2328 2329 2330
static int dw_mci_of_get_slot_quirks(struct device *dev, u8 slot)
{
	return 0;
}
2331 2332
#endif /* CONFIG_OF */

2333
static int dw_mci_init_slot(struct dw_mci *host, unsigned int id)
2334 2335 2336
{
	struct mmc_host *mmc;
	struct dw_mci_slot *slot;
2337
	const struct dw_mci_drv_data *drv_data = host->drv_data;
2338
	int ctrl_id, ret;
2339
	u32 freq[2];
2340

2341
	mmc = mmc_alloc_host(sizeof(struct dw_mci_slot), host->dev);
2342 2343 2344 2345 2346
	if (!mmc)
		return -ENOMEM;

	slot = mmc_priv(mmc);
	slot->id = id;
2347
	slot->sdio_id = host->sdio_id0 + id;
2348 2349
	slot->mmc = mmc;
	slot->host = host;
2350
	host->slot[id] = slot;
2351

2352 2353
	slot->quirks = dw_mci_of_get_slot_quirks(host->dev, slot->id);

2354
	mmc->ops = &dw_mci_ops;
2355 2356 2357 2358 2359 2360 2361 2362
	if (of_property_read_u32_array(host->dev->of_node,
				       "clock-freq-min-max", freq, 2)) {
		mmc->f_min = DW_MCI_FREQ_MIN;
		mmc->f_max = DW_MCI_FREQ_MAX;
	} else {
		mmc->f_min = freq[0];
		mmc->f_max = freq[1];
	}
2363

2364 2365 2366
	/*if there are external regulators, get them*/
	ret = mmc_regulator_get_supply(mmc);
	if (ret == -EPROBE_DEFER)
2367
		goto err_host_allocated;
2368 2369 2370

	if (!mmc->ocr_avail)
		mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
2371

2372 2373 2374
	if (host->pdata->caps)
		mmc->caps = host->pdata->caps;

2375 2376 2377
	if (host->pdata->pm_caps)
		mmc->pm_caps = host->pdata->pm_caps;

2378 2379 2380 2381 2382 2383 2384
	if (host->dev->of_node) {
		ctrl_id = of_alias_get_id(host->dev->of_node, "mshc");
		if (ctrl_id < 0)
			ctrl_id = 0;
	} else {
		ctrl_id = to_platform_device(host->dev)->id;
	}
2385 2386
	if (drv_data && drv_data->caps)
		mmc->caps |= drv_data->caps[ctrl_id];
2387

2388 2389 2390
	if (host->pdata->caps2)
		mmc->caps2 = host->pdata->caps2;

2391 2392 2393
	ret = mmc_of_parse(mmc);
	if (ret)
		goto err_host_allocated;
2394 2395 2396 2397 2398 2399 2400 2401 2402

	if (host->pdata->blk_settings) {
		mmc->max_segs = host->pdata->blk_settings->max_segs;
		mmc->max_blk_size = host->pdata->blk_settings->max_blk_size;
		mmc->max_blk_count = host->pdata->blk_settings->max_blk_count;
		mmc->max_req_size = host->pdata->blk_settings->max_req_size;
		mmc->max_seg_size = host->pdata->blk_settings->max_seg_size;
	} else {
		/* Useful defaults if platform data is unset. */
2403 2404 2405 2406
#ifdef CONFIG_MMC_DW_IDMAC
		mmc->max_segs = host->ring_size;
		mmc->max_blk_size = 65536;
		mmc->max_seg_size = 0x1000;
2407 2408
		mmc->max_req_size = mmc->max_seg_size * host->ring_size;
		mmc->max_blk_count = mmc->max_req_size / 512;
2409
#else
2410 2411 2412 2413 2414 2415
		mmc->max_segs = 64;
		mmc->max_blk_size = 65536; /* BLKSIZ is 16 bits */
		mmc->max_blk_count = 512;
		mmc->max_req_size = mmc->max_blk_size * mmc->max_blk_count;
		mmc->max_seg_size = mmc->max_req_size;
#endif /* CONFIG_MMC_DW_IDMAC */
2416
	}
2417

2418 2419 2420 2421 2422
	if (dw_mci_get_cd(mmc))
		set_bit(DW_MMC_CARD_PRESENT, &slot->flags);
	else
		clear_bit(DW_MMC_CARD_PRESENT, &slot->flags);

2423 2424
	ret = mmc_add_host(mmc);
	if (ret)
2425
		goto err_host_allocated;
2426 2427 2428 2429 2430 2431

#if defined(CONFIG_DEBUG_FS)
	dw_mci_init_debugfs(slot);
#endif

	return 0;
2432

2433
err_host_allocated:
2434
	mmc_free_host(mmc);
2435
	return ret;
2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447
}

static void dw_mci_cleanup_slot(struct dw_mci_slot *slot, unsigned int id)
{
	/* Debugfs stuff is cleaned up by mmc core */
	mmc_remove_host(slot->mmc);
	slot->host->slot[id] = NULL;
	mmc_free_host(slot->mmc);
}

static void dw_mci_init_dma(struct dw_mci *host)
{
2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463
	int addr_config;
	/* Check ADDR_CONFIG bit in HCON to find IDMAC address bus width */
	addr_config = (mci_readl(host, HCON) >> 27) & 0x01;

	if (addr_config == 1) {
		/* host supports IDMAC in 64-bit address mode */
		host->dma_64bit_address = 1;
		dev_info(host->dev, "IDMAC supports 64-bit address mode.\n");
		if (!dma_set_mask(host->dev, DMA_BIT_MASK(64)))
			dma_set_coherent_mask(host->dev, DMA_BIT_MASK(64));
	} else {
		/* host supports IDMAC in 32-bit address mode */
		host->dma_64bit_address = 0;
		dev_info(host->dev, "IDMAC supports 32-bit address mode.\n");
	}

2464
	/* Alloc memory for sg translation */
2465
	host->sg_cpu = dmam_alloc_coherent(host->dev, PAGE_SIZE,
2466 2467
					  &host->sg_dma, GFP_KERNEL);
	if (!host->sg_cpu) {
2468
		dev_err(host->dev, "%s: could not alloc DMA memory\n",
2469 2470 2471 2472 2473 2474 2475
			__func__);
		goto no_dma;
	}

	/* Determine which DMA interface to use */
#ifdef CONFIG_MMC_DW_IDMAC
	host->dma_ops = &dw_mci_idmac_ops;
2476
	dev_info(host->dev, "Using internal DMA controller.\n");
2477 2478 2479 2480 2481
#endif

	if (!host->dma_ops)
		goto no_dma;

2482 2483
	if (host->dma_ops->init && host->dma_ops->start &&
	    host->dma_ops->stop && host->dma_ops->cleanup) {
2484
		if (host->dma_ops->init(host)) {
2485
			dev_err(host->dev, "%s: Unable to initialize "
2486 2487 2488 2489
				"DMA Controller.\n", __func__);
			goto no_dma;
		}
	} else {
2490
		dev_err(host->dev, "DMA initialization not found.\n");
2491 2492 2493 2494 2495 2496 2497
		goto no_dma;
	}

	host->use_dma = 1;
	return;

no_dma:
2498
	dev_info(host->dev, "Using PIO mode.\n");
2499 2500 2501 2502
	host->use_dma = 0;
	return;
}

2503
static bool dw_mci_ctrl_reset(struct dw_mci *host, u32 reset)
2504 2505
{
	unsigned long timeout = jiffies + msecs_to_jiffies(500);
2506
	u32 ctrl;
2507

2508 2509 2510
	ctrl = mci_readl(host, CTRL);
	ctrl |= reset;
	mci_writel(host, CTRL, ctrl);
2511 2512 2513 2514

	/* wait till resets clear */
	do {
		ctrl = mci_readl(host, CTRL);
2515
		if (!(ctrl & reset))
2516 2517 2518
			return true;
	} while (time_before(jiffies, timeout));

2519 2520 2521
	dev_err(host->dev,
		"Timeout resetting block (ctrl reset %#x)\n",
		ctrl & reset);
2522 2523 2524 2525

	return false;
}

2526
static bool dw_mci_reset(struct dw_mci *host)
2527
{
2528 2529 2530
	u32 flags = SDMMC_CTRL_RESET | SDMMC_CTRL_FIFO_RESET;
	bool ret = false;

2531 2532 2533 2534 2535 2536 2537 2538 2539
	/*
	 * Reseting generates a block interrupt, hence setting
	 * the scatter-gather pointer to NULL.
	 */
	if (host->sg) {
		sg_miter_stop(&host->sg_miter);
		host->sg = NULL;
	}

2540 2541
	if (host->use_dma)
		flags |= SDMMC_CTRL_DMA_RESET;
2542

2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576 2577 2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593
	if (dw_mci_ctrl_reset(host, flags)) {
		/*
		 * In all cases we clear the RAWINTS register to clear any
		 * interrupts.
		 */
		mci_writel(host, RINTSTS, 0xFFFFFFFF);

		/* if using dma we wait for dma_req to clear */
		if (host->use_dma) {
			unsigned long timeout = jiffies + msecs_to_jiffies(500);
			u32 status;
			do {
				status = mci_readl(host, STATUS);
				if (!(status & SDMMC_STATUS_DMA_REQ))
					break;
				cpu_relax();
			} while (time_before(jiffies, timeout));

			if (status & SDMMC_STATUS_DMA_REQ) {
				dev_err(host->dev,
					"%s: Timeout waiting for dma_req to "
					"clear during reset\n", __func__);
				goto ciu_out;
			}

			/* when using DMA next we reset the fifo again */
			if (!dw_mci_ctrl_reset(host, SDMMC_CTRL_FIFO_RESET))
				goto ciu_out;
		}
	} else {
		/* if the controller reset bit did clear, then set clock regs */
		if (!(mci_readl(host, CTRL) & SDMMC_CTRL_RESET)) {
			dev_err(host->dev, "%s: fifo/dma reset bits didn't "
				"clear but ciu was reset, doing clock update\n",
				__func__);
			goto ciu_out;
		}
	}

#if IS_ENABLED(CONFIG_MMC_DW_IDMAC)
	/* It is also recommended that we reset and reprogram idmac */
	dw_mci_idmac_reset(host);
#endif

	ret = true;

ciu_out:
	/* After a CTRL reset we need to have CIU set clock registers  */
	mci_send_cmd(host->cur_slot, SDMMC_CMD_UPD_CLK, 0);

	return ret;
2594 2595
}

2596 2597 2598 2599
static void dw_mci_cmd11_timer(unsigned long arg)
{
	struct dw_mci *host = (struct dw_mci *)arg;

2600 2601 2602 2603
	if (host->state != STATE_SENDING_CMD11) {
		dev_warn(host->dev, "Unexpected CMD11 timeout\n");
		return;
	}
2604 2605 2606 2607 2608 2609

	host->cmd_status = SDMMC_INT_RTO;
	set_bit(EVENT_CMD_COMPLETE, &host->pending_events);
	tasklet_schedule(&host->tasklet);
}

2610 2611 2612 2613 2614 2615 2616 2617
#ifdef CONFIG_OF
static struct dw_mci_of_quirks {
	char *quirk;
	int id;
} of_quirks[] = {
	{
		.quirk	= "broken-cd",
		.id	= DW_MCI_QUIRK_BROKEN_CARD_DETECTION,
2618 2619 2620
	}, {
		.quirk	= "disable-wp",
		.id	= DW_MCI_QUIRK_NO_WRITE_PROTECT,
2621 2622 2623 2624 2625 2626 2627 2628
	},
};

static struct dw_mci_board *dw_mci_parse_dt(struct dw_mci *host)
{
	struct dw_mci_board *pdata;
	struct device *dev = host->dev;
	struct device_node *np = dev->of_node;
2629
	const struct dw_mci_drv_data *drv_data = host->drv_data;
2630
	int idx, ret;
2631
	u32 clock_frequency;
2632 2633

	pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
2634
	if (!pdata)
2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655
		return ERR_PTR(-ENOMEM);

	/* find out number of slots supported */
	if (of_property_read_u32(dev->of_node, "num-slots",
				&pdata->num_slots)) {
		dev_info(dev, "num-slots property not found, "
				"assuming 1 slot is available\n");
		pdata->num_slots = 1;
	}

	/* get quirks */
	for (idx = 0; idx < ARRAY_SIZE(of_quirks); idx++)
		if (of_get_property(np, of_quirks[idx].quirk, NULL))
			pdata->quirks |= of_quirks[idx].id;

	if (of_property_read_u32(np, "fifo-depth", &pdata->fifo_depth))
		dev_info(dev, "fifo-depth property not found, using "
				"value of FIFOTH register as default\n");

	of_property_read_u32(np, "card-detect-delay", &pdata->detect_delay_ms);

2656 2657 2658
	if (!of_property_read_u32(np, "clock-frequency", &clock_frequency))
		pdata->bus_hz = clock_frequency;

2659 2660
	if (drv_data && drv_data->parse_dt) {
		ret = drv_data->parse_dt(host);
2661 2662 2663 2664
		if (ret)
			return ERR_PTR(ret);
	}

2665 2666 2667
	if (of_find_property(np, "supports-highspeed", NULL))
		pdata->caps |= MMC_CAP_SD_HIGHSPEED | MMC_CAP_MMC_HIGHSPEED;

2668 2669 2670 2671 2672 2673 2674 2675 2676 2677
	return pdata;
}

#else /* CONFIG_OF */
static struct dw_mci_board *dw_mci_parse_dt(struct dw_mci *host)
{
	return ERR_PTR(-EINVAL);
}
#endif /* CONFIG_OF */

2678 2679 2680 2681 2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693 2694 2695 2696 2697 2698 2699 2700 2701 2702 2703 2704 2705
static void dw_mci_enable_cd(struct dw_mci *host)
{
	struct dw_mci_board *brd = host->pdata;
	unsigned long irqflags;
	u32 temp;
	int i;

	/* No need for CD if broken card detection */
	if (brd->quirks & DW_MCI_QUIRK_BROKEN_CARD_DETECTION)
		return;

	/* No need for CD if all slots have a non-error GPIO */
	for (i = 0; i < host->num_slots; i++) {
		struct dw_mci_slot *slot = host->slot[i];

		if (IS_ERR_VALUE(mmc_gpio_get_cd(slot->mmc)))
			break;
	}
	if (i == host->num_slots)
		return;

	spin_lock_irqsave(&host->irq_lock, irqflags);
	temp = mci_readl(host, INTMASK);
	temp  |= SDMMC_INT_CD;
	mci_writel(host, INTMASK, temp);
	spin_unlock_irqrestore(&host->irq_lock, irqflags);
}

2706
int dw_mci_probe(struct dw_mci *host)
2707
{
2708
	const struct dw_mci_drv_data *drv_data = host->drv_data;
2709
	int width, i, ret = 0;
2710
	u32 fifo_size;
2711
	int init_slots = 0;
2712

2713 2714 2715 2716 2717 2718
	if (!host->pdata) {
		host->pdata = dw_mci_parse_dt(host);
		if (IS_ERR(host->pdata)) {
			dev_err(host->dev, "platform data not available\n");
			return -EINVAL;
		}
2719 2720
	}

2721
	if (host->pdata->num_slots > 1) {
2722
		dev_err(host->dev,
2723
			"Platform data must supply num_slots.\n");
2724
		return -ENODEV;
2725 2726
	}

2727
	host->biu_clk = devm_clk_get(host->dev, "biu");
2728 2729 2730 2731 2732 2733 2734 2735 2736 2737
	if (IS_ERR(host->biu_clk)) {
		dev_dbg(host->dev, "biu clock not available\n");
	} else {
		ret = clk_prepare_enable(host->biu_clk);
		if (ret) {
			dev_err(host->dev, "failed to enable biu clock\n");
			return ret;
		}
	}

2738
	host->ciu_clk = devm_clk_get(host->dev, "ciu");
2739 2740
	if (IS_ERR(host->ciu_clk)) {
		dev_dbg(host->dev, "ciu clock not available\n");
2741
		host->bus_hz = host->pdata->bus_hz;
2742 2743 2744 2745 2746 2747 2748
	} else {
		ret = clk_prepare_enable(host->ciu_clk);
		if (ret) {
			dev_err(host->dev, "failed to enable ciu clock\n");
			goto err_clk_biu;
		}

2749 2750 2751 2752
		if (host->pdata->bus_hz) {
			ret = clk_set_rate(host->ciu_clk, host->pdata->bus_hz);
			if (ret)
				dev_warn(host->dev,
2753
					 "Unable to set bus rate to %uHz\n",
2754 2755
					 host->pdata->bus_hz);
		}
2756
		host->bus_hz = clk_get_rate(host->ciu_clk);
2757
	}
2758

2759 2760 2761 2762 2763 2764 2765
	if (!host->bus_hz) {
		dev_err(host->dev,
			"Platform data must supply bus speed\n");
		ret = -ENODEV;
		goto err_clk_ciu;
	}

2766 2767 2768 2769 2770 2771 2772 2773 2774
	if (drv_data && drv_data->init) {
		ret = drv_data->init(host);
		if (ret) {
			dev_err(host->dev,
				"implementation specific init failed\n");
			goto err_clk_ciu;
		}
	}

2775 2776
	if (drv_data && drv_data->setup_clock) {
		ret = drv_data->setup_clock(host);
2777 2778 2779 2780 2781 2782 2783
		if (ret) {
			dev_err(host->dev,
				"implementation specific clock setup failed\n");
			goto err_clk_ciu;
		}
	}

2784 2785 2786
	setup_timer(&host->cmd11_timer,
		    dw_mci_cmd11_timer, (unsigned long)host);

2787
	host->quirks = host->pdata->quirks;
2788 2789

	spin_lock_init(&host->lock);
2790
	spin_lock_init(&host->irq_lock);
2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809 2810 2811 2812 2813 2814 2815 2816 2817 2818 2819
	INIT_LIST_HEAD(&host->queue);

	/*
	 * Get the host data width - this assumes that HCON has been set with
	 * the correct values.
	 */
	i = (mci_readl(host, HCON) >> 7) & 0x7;
	if (!i) {
		host->push_data = dw_mci_push_data16;
		host->pull_data = dw_mci_pull_data16;
		width = 16;
		host->data_shift = 1;
	} else if (i == 2) {
		host->push_data = dw_mci_push_data64;
		host->pull_data = dw_mci_pull_data64;
		width = 64;
		host->data_shift = 3;
	} else {
		/* Check for a reserved value, and warn if it is */
		WARN((i != 1),
		     "HCON reports a reserved host data width!\n"
		     "Defaulting to 32-bit access.\n");
		host->push_data = dw_mci_push_data32;
		host->pull_data = dw_mci_pull_data32;
		width = 32;
		host->data_shift = 2;
	}

	/* Reset all blocks */
2820
	if (!dw_mci_ctrl_reset(host, SDMMC_CTRL_ALL_RESET_FLAGS))
2821 2822 2823 2824
		return -ENODEV;

	host->dma_ops = host->pdata->dma_ops;
	dw_mci_init_dma(host);
2825 2826 2827 2828 2829 2830 2831 2832 2833 2834 2835 2836

	/* Clear the interrupts for the host controller */
	mci_writel(host, RINTSTS, 0xFFFFFFFF);
	mci_writel(host, INTMASK, 0); /* disable all mmc interrupt first */

	/* Put in max timeout */
	mci_writel(host, TMOUT, 0xFFFFFFFF);

	/*
	 * FIFO threshold settings  RxMark  = fifo_size / 2 - 1,
	 *                          Tx Mark = fifo_size / 2 DMA Size = 8
	 */
2837 2838 2839 2840 2841 2842 2843 2844
	if (!host->pdata->fifo_depth) {
		/*
		 * Power-on value of RX_WMark is FIFO_DEPTH-1, but this may
		 * have been overwritten by the bootloader, just like we're
		 * about to do, so if you know the value for your hardware, you
		 * should put it in the platform data.
		 */
		fifo_size = mci_readl(host, FIFOTH);
2845
		fifo_size = 1 + ((fifo_size >> 16) & 0xfff);
2846 2847 2848 2849
	} else {
		fifo_size = host->pdata->fifo_depth;
	}
	host->fifo_depth = fifo_size;
2850 2851
	host->fifoth_val =
		SDMMC_SET_FIFOTH(0x2, fifo_size / 2 - 1, fifo_size / 2);
2852
	mci_writel(host, FIFOTH, host->fifoth_val);
2853 2854 2855 2856 2857

	/* disable clock to CIU */
	mci_writel(host, CLKENA, 0);
	mci_writel(host, CLKSRC, 0);

2858 2859 2860 2861 2862 2863 2864 2865
	/*
	 * In 2.40a spec, Data offset is changed.
	 * Need to check the version-id and set data-offset for DATA register.
	 */
	host->verid = SDMMC_GET_VERID(mci_readl(host, VERID));
	dev_info(host->dev, "Version ID is %04x\n", host->verid);

	if (host->verid < DW_MMC_240A)
2866
		host->fifo_reg = host->regs + DATA_OFFSET;
2867
	else
2868
		host->fifo_reg = host->regs + DATA_240A_OFFSET;
2869

2870
	tasklet_init(&host->tasklet, dw_mci_tasklet_func, (unsigned long)host);
2871 2872
	ret = devm_request_irq(host->dev, host->irq, dw_mci_interrupt,
			       host->irq_flags, "dw-mci", host);
2873
	if (ret)
2874
		goto err_dmaunmap;
2875 2876 2877 2878 2879 2880

	if (host->pdata->num_slots)
		host->num_slots = host->pdata->num_slots;
	else
		host->num_slots = ((mci_readl(host, HCON) >> 1) & 0x1F) + 1;

2881
	/*
2882
	 * Enable interrupts for command done, data over, data empty,
2883 2884 2885 2886 2887
	 * receive ready and error such as transmit, receive timeout, crc error
	 */
	mci_writel(host, RINTSTS, 0xFFFFFFFF);
	mci_writel(host, INTMASK, SDMMC_INT_CMD_DONE | SDMMC_INT_DATA_OVER |
		   SDMMC_INT_TXDR | SDMMC_INT_RXDR |
2888
		   DW_MCI_ERROR_FLAGS);
2889 2890 2891 2892 2893 2894 2895
	mci_writel(host, CTRL, SDMMC_CTRL_INT_ENABLE); /* Enable mci interrupt */

	dev_info(host->dev, "DW MMC controller at irq %d, "
		 "%d bit host data width, "
		 "%u deep fifo\n",
		 host->irq, width, fifo_size);

2896 2897 2898
	/* We need at least one slot to succeed */
	for (i = 0; i < host->num_slots; i++) {
		ret = dw_mci_init_slot(host, i);
2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909
		if (ret)
			dev_dbg(host->dev, "slot %d init failed\n", i);
		else
			init_slots++;
	}

	if (init_slots) {
		dev_info(host->dev, "%d slots initialized\n", init_slots);
	} else {
		dev_dbg(host->dev, "attempted to initialize %d slots, "
					"but failed on all\n", host->num_slots);
2910
		goto err_dmaunmap;
2911 2912
	}

2913 2914 2915
	/* Now that slots are all setup, we can enable card detect */
	dw_mci_enable_cd(host);

2916
	if (host->quirks & DW_MCI_QUIRK_IDMAC_DTO)
2917
		dev_info(host->dev, "Internal DMAC interrupt fix enabled.\n");
2918 2919 2920 2921 2922 2923

	return 0;

err_dmaunmap:
	if (host->use_dma && host->dma_ops->exit)
		host->dma_ops->exit(host);
2924 2925

err_clk_ciu:
2926
	if (!IS_ERR(host->ciu_clk))
2927
		clk_disable_unprepare(host->ciu_clk);
2928

2929
err_clk_biu:
2930
	if (!IS_ERR(host->biu_clk))
2931
		clk_disable_unprepare(host->biu_clk);
2932

2933 2934
	return ret;
}
2935
EXPORT_SYMBOL(dw_mci_probe);
2936

2937
void dw_mci_remove(struct dw_mci *host)
2938 2939 2940 2941 2942 2943 2944
{
	int i;

	mci_writel(host, RINTSTS, 0xFFFFFFFF);
	mci_writel(host, INTMASK, 0); /* disable all mmc interrupt first */

	for (i = 0; i < host->num_slots; i++) {
2945
		dev_dbg(host->dev, "remove slot %d\n", i);
2946 2947 2948 2949 2950 2951 2952 2953 2954 2955 2956
		if (host->slot[i])
			dw_mci_cleanup_slot(host->slot[i], i);
	}

	/* disable clock to CIU */
	mci_writel(host, CLKENA, 0);
	mci_writel(host, CLKSRC, 0);

	if (host->use_dma && host->dma_ops->exit)
		host->dma_ops->exit(host);

2957 2958
	if (!IS_ERR(host->ciu_clk))
		clk_disable_unprepare(host->ciu_clk);
2959

2960 2961
	if (!IS_ERR(host->biu_clk))
		clk_disable_unprepare(host->biu_clk);
2962
}
2963 2964 2965
EXPORT_SYMBOL(dw_mci_remove);


2966

2967
#ifdef CONFIG_PM_SLEEP
2968 2969 2970
/*
 * TODO: we should probably disable the clock to the card in the suspend path.
 */
2971
int dw_mci_suspend(struct dw_mci *host)
2972 2973 2974
{
	return 0;
}
2975
EXPORT_SYMBOL(dw_mci_suspend);
2976

2977
int dw_mci_resume(struct dw_mci *host)
2978 2979 2980
{
	int i, ret;

2981
	if (!dw_mci_ctrl_reset(host, SDMMC_CTRL_ALL_RESET_FLAGS)) {
2982 2983 2984 2985
		ret = -ENODEV;
		return ret;
	}

2986
	if (host->use_dma && host->dma_ops->init)
2987 2988
		host->dma_ops->init(host);

2989 2990 2991 2992
	/*
	 * Restore the initial value at FIFOTH register
	 * And Invalidate the prev_blksz with zero
	 */
2993
	mci_writel(host, FIFOTH, host->fifoth_val);
2994
	host->prev_blksz = 0;
2995

2996 2997 2998
	/* Put in max timeout */
	mci_writel(host, TMOUT, 0xFFFFFFFF);

2999 3000 3001
	mci_writel(host, RINTSTS, 0xFFFFFFFF);
	mci_writel(host, INTMASK, SDMMC_INT_CMD_DONE | SDMMC_INT_DATA_OVER |
		   SDMMC_INT_TXDR | SDMMC_INT_RXDR |
3002
		   DW_MCI_ERROR_FLAGS);
3003 3004
	mci_writel(host, CTRL, SDMMC_CTRL_INT_ENABLE);

3005 3006 3007 3008
	for (i = 0; i < host->num_slots; i++) {
		struct dw_mci_slot *slot = host->slot[i];
		if (!slot)
			continue;
3009 3010 3011 3012
		if (slot->mmc->pm_flags & MMC_PM_KEEP_POWER) {
			dw_mci_set_ios(slot->mmc, &slot->mmc->ios);
			dw_mci_setup_bus(slot, true);
		}
3013
	}
3014 3015 3016 3017

	/* Now that slots are all setup, we can enable card detect */
	dw_mci_enable_cd(host);

3018 3019
	return 0;
}
3020
EXPORT_SYMBOL(dw_mci_resume);
3021 3022
#endif /* CONFIG_PM_SLEEP */

3023 3024
static int __init dw_mci_init(void)
{
3025
	pr_info("Synopsys Designware Multimedia Card Interface Driver\n");
3026
	return 0;
3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037 3038 3039
}

static void __exit dw_mci_exit(void)
{
}

module_init(dw_mci_init);
module_exit(dw_mci_exit);

MODULE_DESCRIPTION("DW Multimedia Card Interface driver");
MODULE_AUTHOR("NXP Semiconductor VietNam");
MODULE_AUTHOR("Imagination Technologies Ltd");
MODULE_LICENSE("GPL v2");