Linux Audio

Check our new training course

Loading...
v6.2
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 *  Copyright (C) 2009-2010, Lars-Peter Clausen <lars@metafoo.de>
   4 *  Copyright (C) 2013, Imagination Technologies
   5 *
   6 *  JZ4740 SD/MMC controller driver
   7 */
   8
   9#include <linux/bitops.h>
  10#include <linux/clk.h>
  11#include <linux/delay.h>
  12#include <linux/dmaengine.h>
  13#include <linux/dma-mapping.h>
  14#include <linux/err.h>
  15#include <linux/interrupt.h>
  16#include <linux/io.h>
  17#include <linux/irq.h>
  18#include <linux/mmc/host.h>
  19#include <linux/mmc/slot-gpio.h>
  20#include <linux/module.h>
  21#include <linux/of_device.h>
  22#include <linux/pinctrl/consumer.h>
  23#include <linux/platform_device.h>
 
 
  24#include <linux/scatterlist.h>
  25
  26#include <asm/cacheflush.h>
  27
  28#define JZ_REG_MMC_STRPCL	0x00
  29#define JZ_REG_MMC_STATUS	0x04
  30#define JZ_REG_MMC_CLKRT	0x08
  31#define JZ_REG_MMC_CMDAT	0x0C
  32#define JZ_REG_MMC_RESTO	0x10
  33#define JZ_REG_MMC_RDTO		0x14
  34#define JZ_REG_MMC_BLKLEN	0x18
  35#define JZ_REG_MMC_NOB		0x1C
  36#define JZ_REG_MMC_SNOB		0x20
  37#define JZ_REG_MMC_IMASK	0x24
  38#define JZ_REG_MMC_IREG		0x28
  39#define JZ_REG_MMC_CMD		0x2C
  40#define JZ_REG_MMC_ARG		0x30
  41#define JZ_REG_MMC_RESP_FIFO	0x34
  42#define JZ_REG_MMC_RXFIFO	0x38
  43#define JZ_REG_MMC_TXFIFO	0x3C
  44#define JZ_REG_MMC_LPM		0x40
  45#define JZ_REG_MMC_DMAC		0x44
  46
  47#define JZ_MMC_STRPCL_EXIT_MULTIPLE BIT(7)
  48#define JZ_MMC_STRPCL_EXIT_TRANSFER BIT(6)
  49#define JZ_MMC_STRPCL_START_READWAIT BIT(5)
  50#define JZ_MMC_STRPCL_STOP_READWAIT BIT(4)
  51#define JZ_MMC_STRPCL_RESET BIT(3)
  52#define JZ_MMC_STRPCL_START_OP BIT(2)
  53#define JZ_MMC_STRPCL_CLOCK_CONTROL (BIT(1) | BIT(0))
  54#define JZ_MMC_STRPCL_CLOCK_STOP BIT(0)
  55#define JZ_MMC_STRPCL_CLOCK_START BIT(1)
  56
  57
  58#define JZ_MMC_STATUS_IS_RESETTING BIT(15)
  59#define JZ_MMC_STATUS_SDIO_INT_ACTIVE BIT(14)
  60#define JZ_MMC_STATUS_PRG_DONE BIT(13)
  61#define JZ_MMC_STATUS_DATA_TRAN_DONE BIT(12)
  62#define JZ_MMC_STATUS_END_CMD_RES BIT(11)
  63#define JZ_MMC_STATUS_DATA_FIFO_AFULL BIT(10)
  64#define JZ_MMC_STATUS_IS_READWAIT BIT(9)
  65#define JZ_MMC_STATUS_CLK_EN BIT(8)
  66#define JZ_MMC_STATUS_DATA_FIFO_FULL BIT(7)
  67#define JZ_MMC_STATUS_DATA_FIFO_EMPTY BIT(6)
  68#define JZ_MMC_STATUS_CRC_RES_ERR BIT(5)
  69#define JZ_MMC_STATUS_CRC_READ_ERROR BIT(4)
  70#define JZ_MMC_STATUS_TIMEOUT_WRITE BIT(3)
  71#define JZ_MMC_STATUS_CRC_WRITE_ERROR BIT(2)
  72#define JZ_MMC_STATUS_TIMEOUT_RES BIT(1)
  73#define JZ_MMC_STATUS_TIMEOUT_READ BIT(0)
  74
  75#define JZ_MMC_STATUS_READ_ERROR_MASK (BIT(4) | BIT(0))
  76#define JZ_MMC_STATUS_WRITE_ERROR_MASK (BIT(3) | BIT(2))
  77
  78
  79#define JZ_MMC_CMDAT_IO_ABORT BIT(11)
  80#define JZ_MMC_CMDAT_BUS_WIDTH_4BIT BIT(10)
  81#define JZ_MMC_CMDAT_BUS_WIDTH_8BIT (BIT(10) | BIT(9))
  82#define	JZ_MMC_CMDAT_BUS_WIDTH_MASK (BIT(10) | BIT(9))
  83#define JZ_MMC_CMDAT_DMA_EN BIT(8)
  84#define JZ_MMC_CMDAT_INIT BIT(7)
  85#define JZ_MMC_CMDAT_BUSY BIT(6)
  86#define JZ_MMC_CMDAT_STREAM BIT(5)
  87#define JZ_MMC_CMDAT_WRITE BIT(4)
  88#define JZ_MMC_CMDAT_DATA_EN BIT(3)
  89#define JZ_MMC_CMDAT_RESPONSE_FORMAT (BIT(2) | BIT(1) | BIT(0))
  90#define JZ_MMC_CMDAT_RSP_R1 1
  91#define JZ_MMC_CMDAT_RSP_R2 2
  92#define JZ_MMC_CMDAT_RSP_R3 3
  93
  94#define JZ_MMC_IRQ_SDIO BIT(7)
  95#define JZ_MMC_IRQ_TXFIFO_WR_REQ BIT(6)
  96#define JZ_MMC_IRQ_RXFIFO_RD_REQ BIT(5)
  97#define JZ_MMC_IRQ_END_CMD_RES BIT(2)
  98#define JZ_MMC_IRQ_PRG_DONE BIT(1)
  99#define JZ_MMC_IRQ_DATA_TRAN_DONE BIT(0)
 100
 101#define JZ_MMC_DMAC_DMA_SEL BIT(1)
 102#define JZ_MMC_DMAC_DMA_EN BIT(0)
 103
 104#define	JZ_MMC_LPM_DRV_RISING BIT(31)
 105#define	JZ_MMC_LPM_DRV_RISING_QTR_PHASE_DLY BIT(31)
 106#define	JZ_MMC_LPM_DRV_RISING_1NS_DLY BIT(30)
 107#define	JZ_MMC_LPM_SMP_RISING_QTR_OR_HALF_PHASE_DLY BIT(29)
 108#define	JZ_MMC_LPM_LOW_POWER_MODE_EN BIT(0)
 109
 110#define JZ_MMC_CLK_RATE 24000000
 111#define JZ_MMC_REQ_TIMEOUT_MS 5000
 112
 113enum jz4740_mmc_version {
 114	JZ_MMC_JZ4740,
 115	JZ_MMC_JZ4725B,
 116	JZ_MMC_JZ4760,
 117	JZ_MMC_JZ4780,
 118	JZ_MMC_X1000,
 119};
 120
 121enum jz4740_mmc_state {
 122	JZ4740_MMC_STATE_READ_RESPONSE,
 123	JZ4740_MMC_STATE_TRANSFER_DATA,
 124	JZ4740_MMC_STATE_SEND_STOP,
 125	JZ4740_MMC_STATE_DONE,
 126};
 127
 128/*
 129 * The MMC core allows to prepare a mmc_request while another mmc_request
 130 * is in-flight. This is used via the pre_req/post_req hooks.
 131 * This driver uses the pre_req/post_req hooks to map/unmap the mmc_request.
 132 * Following what other drivers do (sdhci, dw_mmc) we use the following cookie
 133 * flags to keep track of the mmc_request mapping state.
 134 *
 135 * COOKIE_UNMAPPED: the request is not mapped.
 136 * COOKIE_PREMAPPED: the request was mapped in pre_req,
 137 * and should be unmapped in post_req.
 138 * COOKIE_MAPPED: the request was mapped in the irq handler,
 139 * and should be unmapped before mmc_request_done is called..
 140 */
 141enum jz4780_cookie {
 142	COOKIE_UNMAPPED = 0,
 143	COOKIE_PREMAPPED,
 144	COOKIE_MAPPED,
 145};
 146
 147struct jz4740_mmc_host {
 148	struct mmc_host *mmc;
 149	struct platform_device *pdev;
 150	struct clk *clk;
 151
 152	enum jz4740_mmc_version version;
 153
 154	int irq;
 155
 156	void __iomem *base;
 157	struct resource *mem_res;
 158	struct mmc_request *req;
 159	struct mmc_command *cmd;
 160
 
 
 161	unsigned long waiting;
 162
 163	uint32_t cmdat;
 164
 165	uint32_t irq_mask;
 166
 167	spinlock_t lock;
 168
 169	struct timer_list timeout_timer;
 170	struct sg_mapping_iter miter;
 171	enum jz4740_mmc_state state;
 172
 173	/* DMA support */
 174	struct dma_chan *dma_rx;
 175	struct dma_chan *dma_tx;
 176	bool use_dma;
 177
 178/* The DMA trigger level is 8 words, that is to say, the DMA read
 179 * trigger is when data words in MSC_RXFIFO is >= 8 and the DMA write
 180 * trigger is when data words in MSC_TXFIFO is < 8.
 181 */
 182#define JZ4740_MMC_FIFO_HALF_SIZE 8
 183};
 184
 185static void jz4740_mmc_write_irq_mask(struct jz4740_mmc_host *host,
 186				      uint32_t val)
 187{
 188	if (host->version >= JZ_MMC_JZ4725B)
 189		return writel(val, host->base + JZ_REG_MMC_IMASK);
 190	else
 191		return writew(val, host->base + JZ_REG_MMC_IMASK);
 192}
 193
 194static void jz4740_mmc_write_irq_reg(struct jz4740_mmc_host *host,
 195				     uint32_t val)
 196{
 197	if (host->version >= JZ_MMC_JZ4780)
 198		writel(val, host->base + JZ_REG_MMC_IREG);
 199	else
 200		writew(val, host->base + JZ_REG_MMC_IREG);
 201}
 202
 203static uint32_t jz4740_mmc_read_irq_reg(struct jz4740_mmc_host *host)
 204{
 205	if (host->version >= JZ_MMC_JZ4780)
 206		return readl(host->base + JZ_REG_MMC_IREG);
 207	else
 208		return readw(host->base + JZ_REG_MMC_IREG);
 209}
 210
 211/*----------------------------------------------------------------------------*/
 212/* DMA infrastructure */
 213
 214static void jz4740_mmc_release_dma_channels(struct jz4740_mmc_host *host)
 215{
 216	if (!host->use_dma)
 217		return;
 218
 219	dma_release_channel(host->dma_tx);
 220	if (host->dma_rx)
 221		dma_release_channel(host->dma_rx);
 222}
 223
 224static int jz4740_mmc_acquire_dma_channels(struct jz4740_mmc_host *host)
 225{
 226	struct device *dev = mmc_dev(host->mmc);
 227
 228	host->dma_tx = dma_request_chan(dev, "tx-rx");
 229	if (!IS_ERR(host->dma_tx))
 230		return 0;
 231
 232	if (PTR_ERR(host->dma_tx) != -ENODEV) {
 233		dev_err(dev, "Failed to get dma tx-rx channel\n");
 234		return PTR_ERR(host->dma_tx);
 235	}
 236
 237	host->dma_tx = dma_request_chan(mmc_dev(host->mmc), "tx");
 238	if (IS_ERR(host->dma_tx)) {
 239		dev_err(mmc_dev(host->mmc), "Failed to get dma_tx channel\n");
 240		return PTR_ERR(host->dma_tx);
 241	}
 242
 243	host->dma_rx = dma_request_chan(mmc_dev(host->mmc), "rx");
 244	if (IS_ERR(host->dma_rx)) {
 245		dev_err(mmc_dev(host->mmc), "Failed to get dma_rx channel\n");
 246		dma_release_channel(host->dma_tx);
 247		return PTR_ERR(host->dma_rx);
 248	}
 249
 250	/*
 251	 * Limit the maximum segment size in any SG entry according to
 252	 * the parameters of the DMA engine device.
 253	 */
 254	if (host->dma_tx) {
 255		struct device *dev = host->dma_tx->device->dev;
 256		unsigned int max_seg_size = dma_get_max_seg_size(dev);
 257
 258		if (max_seg_size < host->mmc->max_seg_size)
 259			host->mmc->max_seg_size = max_seg_size;
 260	}
 261
 262	if (host->dma_rx) {
 263		struct device *dev = host->dma_rx->device->dev;
 264		unsigned int max_seg_size = dma_get_max_seg_size(dev);
 265
 266		if (max_seg_size < host->mmc->max_seg_size)
 267			host->mmc->max_seg_size = max_seg_size;
 268	}
 269
 270	return 0;
 271}
 272
 273static inline struct dma_chan *jz4740_mmc_get_dma_chan(struct jz4740_mmc_host *host,
 274						       struct mmc_data *data)
 275{
 276	if ((data->flags & MMC_DATA_READ) && host->dma_rx)
 277		return host->dma_rx;
 278	else
 279		return host->dma_tx;
 280}
 281
 282static void jz4740_mmc_dma_unmap(struct jz4740_mmc_host *host,
 283				 struct mmc_data *data)
 284{
 285	struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 286	enum dma_data_direction dir = mmc_get_dma_dir(data);
 287
 288	dma_unmap_sg(chan->device->dev, data->sg, data->sg_len, dir);
 289	data->host_cookie = COOKIE_UNMAPPED;
 290}
 291
 292/* Prepares DMA data for current or next transfer.
 293 * A request can be in-flight when this is called.
 294 */
 295static int jz4740_mmc_prepare_dma_data(struct jz4740_mmc_host *host,
 296				       struct mmc_data *data,
 297				       int cookie)
 298{
 299	struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 300	enum dma_data_direction dir = mmc_get_dma_dir(data);
 301	unsigned int sg_count;
 302
 303	if (data->host_cookie == COOKIE_PREMAPPED)
 304		return data->sg_count;
 305
 306	sg_count = dma_map_sg(chan->device->dev,
 307			data->sg,
 308			data->sg_len,
 309			dir);
 310
 311	if (!sg_count) {
 312		dev_err(mmc_dev(host->mmc),
 313			"Failed to map scatterlist for DMA operation\n");
 314		return -EINVAL;
 315	}
 316
 317	data->sg_count = sg_count;
 318	data->host_cookie = cookie;
 319
 320	return data->sg_count;
 321}
 322
 323static int jz4740_mmc_start_dma_transfer(struct jz4740_mmc_host *host,
 324					 struct mmc_data *data)
 325{
 326	struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 327	struct dma_async_tx_descriptor *desc;
 328	struct dma_slave_config conf = {
 329		.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES,
 330		.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES,
 331		.src_maxburst = JZ4740_MMC_FIFO_HALF_SIZE,
 332		.dst_maxburst = JZ4740_MMC_FIFO_HALF_SIZE,
 333	};
 334	int sg_count;
 335
 336	if (data->flags & MMC_DATA_WRITE) {
 337		conf.direction = DMA_MEM_TO_DEV;
 338		conf.dst_addr = host->mem_res->start + JZ_REG_MMC_TXFIFO;
 339	} else {
 340		conf.direction = DMA_DEV_TO_MEM;
 341		conf.src_addr = host->mem_res->start + JZ_REG_MMC_RXFIFO;
 342	}
 343
 344	sg_count = jz4740_mmc_prepare_dma_data(host, data, COOKIE_MAPPED);
 345	if (sg_count < 0)
 346		return sg_count;
 347
 348	dmaengine_slave_config(chan, &conf);
 349	desc = dmaengine_prep_slave_sg(chan, data->sg, sg_count,
 350			conf.direction,
 351			DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
 352	if (!desc) {
 353		dev_err(mmc_dev(host->mmc),
 354			"Failed to allocate DMA %s descriptor",
 355			 conf.direction == DMA_MEM_TO_DEV ? "TX" : "RX");
 356		goto dma_unmap;
 357	}
 358
 359	dmaengine_submit(desc);
 360	dma_async_issue_pending(chan);
 361
 362	return 0;
 363
 364dma_unmap:
 365	if (data->host_cookie == COOKIE_MAPPED)
 366		jz4740_mmc_dma_unmap(host, data);
 367	return -ENOMEM;
 368}
 369
 370static void jz4740_mmc_pre_request(struct mmc_host *mmc,
 371				   struct mmc_request *mrq)
 372{
 373	struct jz4740_mmc_host *host = mmc_priv(mmc);
 374	struct mmc_data *data = mrq->data;
 375
 376	if (!host->use_dma)
 377		return;
 378
 379	data->host_cookie = COOKIE_UNMAPPED;
 380	if (jz4740_mmc_prepare_dma_data(host, data, COOKIE_PREMAPPED) < 0)
 381		data->host_cookie = COOKIE_UNMAPPED;
 382}
 383
 384static void jz4740_mmc_post_request(struct mmc_host *mmc,
 385				    struct mmc_request *mrq,
 386				    int err)
 387{
 388	struct jz4740_mmc_host *host = mmc_priv(mmc);
 389	struct mmc_data *data = mrq->data;
 390
 391	if (data && data->host_cookie != COOKIE_UNMAPPED)
 392		jz4740_mmc_dma_unmap(host, data);
 393
 394	if (err) {
 395		struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 396
 397		dmaengine_terminate_all(chan);
 398	}
 399}
 400
 401/*----------------------------------------------------------------------------*/
 402
 403static void jz4740_mmc_set_irq_enabled(struct jz4740_mmc_host *host,
 404	unsigned int irq, bool enabled)
 405{
 406	unsigned long flags;
 407
 408	spin_lock_irqsave(&host->lock, flags);
 409	if (enabled)
 410		host->irq_mask &= ~irq;
 411	else
 412		host->irq_mask |= irq;
 413
 414	jz4740_mmc_write_irq_mask(host, host->irq_mask);
 415	spin_unlock_irqrestore(&host->lock, flags);
 416}
 417
 418static void jz4740_mmc_clock_enable(struct jz4740_mmc_host *host,
 419	bool start_transfer)
 420{
 421	uint16_t val = JZ_MMC_STRPCL_CLOCK_START;
 422
 423	if (start_transfer)
 424		val |= JZ_MMC_STRPCL_START_OP;
 425
 426	writew(val, host->base + JZ_REG_MMC_STRPCL);
 427}
 428
 429static void jz4740_mmc_clock_disable(struct jz4740_mmc_host *host)
 430{
 431	uint32_t status;
 432	unsigned int timeout = 1000;
 433
 434	writew(JZ_MMC_STRPCL_CLOCK_STOP, host->base + JZ_REG_MMC_STRPCL);
 435	do {
 436		status = readl(host->base + JZ_REG_MMC_STATUS);
 437	} while (status & JZ_MMC_STATUS_CLK_EN && --timeout);
 438}
 439
 440static void jz4740_mmc_reset(struct jz4740_mmc_host *host)
 441{
 442	uint32_t status;
 443	unsigned int timeout = 1000;
 444
 445	writew(JZ_MMC_STRPCL_RESET, host->base + JZ_REG_MMC_STRPCL);
 446	udelay(10);
 447	do {
 448		status = readl(host->base + JZ_REG_MMC_STATUS);
 449	} while (status & JZ_MMC_STATUS_IS_RESETTING && --timeout);
 450}
 451
 452static void jz4740_mmc_request_done(struct jz4740_mmc_host *host)
 453{
 454	struct mmc_request *req;
 455	struct mmc_data *data;
 456
 457	req = host->req;
 458	data = req->data;
 459	host->req = NULL;
 460
 461	if (data && data->host_cookie == COOKIE_MAPPED)
 462		jz4740_mmc_dma_unmap(host, data);
 463	mmc_request_done(host->mmc, req);
 464}
 465
 466static unsigned int jz4740_mmc_poll_irq(struct jz4740_mmc_host *host,
 467	unsigned int irq)
 468{
 469	unsigned int timeout = 0x800;
 470	uint32_t status;
 471
 472	do {
 473		status = jz4740_mmc_read_irq_reg(host);
 474	} while (!(status & irq) && --timeout);
 475
 476	if (timeout == 0) {
 477		set_bit(0, &host->waiting);
 478		mod_timer(&host->timeout_timer,
 479			  jiffies + msecs_to_jiffies(JZ_MMC_REQ_TIMEOUT_MS));
 480		jz4740_mmc_set_irq_enabled(host, irq, true);
 481		return true;
 482	}
 483
 484	return false;
 485}
 486
 487static void jz4740_mmc_transfer_check_state(struct jz4740_mmc_host *host,
 488	struct mmc_data *data)
 489{
 490	int status;
 491
 492	status = readl(host->base + JZ_REG_MMC_STATUS);
 493	if (status & JZ_MMC_STATUS_WRITE_ERROR_MASK) {
 494		if (status & (JZ_MMC_STATUS_TIMEOUT_WRITE)) {
 495			host->req->cmd->error = -ETIMEDOUT;
 496			data->error = -ETIMEDOUT;
 497		} else {
 498			host->req->cmd->error = -EIO;
 499			data->error = -EIO;
 500		}
 501	} else if (status & JZ_MMC_STATUS_READ_ERROR_MASK) {
 502		if (status & (JZ_MMC_STATUS_TIMEOUT_READ)) {
 503			host->req->cmd->error = -ETIMEDOUT;
 504			data->error = -ETIMEDOUT;
 505		} else {
 506			host->req->cmd->error = -EIO;
 507			data->error = -EIO;
 508		}
 509	}
 510}
 511
 512static bool jz4740_mmc_write_data(struct jz4740_mmc_host *host,
 513	struct mmc_data *data)
 514{
 515	struct sg_mapping_iter *miter = &host->miter;
 516	void __iomem *fifo_addr = host->base + JZ_REG_MMC_TXFIFO;
 517	uint32_t *buf;
 518	bool timeout;
 519	size_t i, j;
 520
 521	while (sg_miter_next(miter)) {
 522		buf = miter->addr;
 523		i = miter->length / 4;
 524		j = i / 8;
 525		i = i & 0x7;
 526		while (j) {
 527			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_TXFIFO_WR_REQ);
 528			if (unlikely(timeout))
 529				goto poll_timeout;
 530
 531			writel(buf[0], fifo_addr);
 532			writel(buf[1], fifo_addr);
 533			writel(buf[2], fifo_addr);
 534			writel(buf[3], fifo_addr);
 535			writel(buf[4], fifo_addr);
 536			writel(buf[5], fifo_addr);
 537			writel(buf[6], fifo_addr);
 538			writel(buf[7], fifo_addr);
 539			buf += 8;
 540			--j;
 541		}
 542		if (unlikely(i)) {
 543			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_TXFIFO_WR_REQ);
 544			if (unlikely(timeout))
 545				goto poll_timeout;
 546
 547			while (i) {
 548				writel(*buf, fifo_addr);
 549				++buf;
 550				--i;
 551			}
 552		}
 553		data->bytes_xfered += miter->length;
 554	}
 555	sg_miter_stop(miter);
 556
 557	return false;
 558
 559poll_timeout:
 560	miter->consumed = (void *)buf - miter->addr;
 561	data->bytes_xfered += miter->consumed;
 562	sg_miter_stop(miter);
 563
 564	return true;
 565}
 566
 567static bool jz4740_mmc_read_data(struct jz4740_mmc_host *host,
 568				struct mmc_data *data)
 569{
 570	struct sg_mapping_iter *miter = &host->miter;
 571	void __iomem *fifo_addr = host->base + JZ_REG_MMC_RXFIFO;
 572	uint32_t *buf;
 573	uint32_t d;
 574	uint32_t status;
 575	size_t i, j;
 576	unsigned int timeout;
 577
 578	while (sg_miter_next(miter)) {
 579		buf = miter->addr;
 580		i = miter->length;
 581		j = i / 32;
 582		i = i & 0x1f;
 583		while (j) {
 584			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_RXFIFO_RD_REQ);
 585			if (unlikely(timeout))
 586				goto poll_timeout;
 587
 588			buf[0] = readl(fifo_addr);
 589			buf[1] = readl(fifo_addr);
 590			buf[2] = readl(fifo_addr);
 591			buf[3] = readl(fifo_addr);
 592			buf[4] = readl(fifo_addr);
 593			buf[5] = readl(fifo_addr);
 594			buf[6] = readl(fifo_addr);
 595			buf[7] = readl(fifo_addr);
 596
 597			buf += 8;
 598			--j;
 599		}
 600
 601		if (unlikely(i)) {
 602			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_RXFIFO_RD_REQ);
 603			if (unlikely(timeout))
 604				goto poll_timeout;
 605
 606			while (i >= 4) {
 607				*buf++ = readl(fifo_addr);
 608				i -= 4;
 609			}
 610			if (unlikely(i > 0)) {
 611				d = readl(fifo_addr);
 612				memcpy(buf, &d, i);
 613			}
 614		}
 615		data->bytes_xfered += miter->length;
 616	}
 617	sg_miter_stop(miter);
 618
 619	/* For whatever reason there is sometime one word more in the fifo then
 620	 * requested */
 621	timeout = 1000;
 622	status = readl(host->base + JZ_REG_MMC_STATUS);
 623	while (!(status & JZ_MMC_STATUS_DATA_FIFO_EMPTY) && --timeout) {
 624		d = readl(fifo_addr);
 625		status = readl(host->base + JZ_REG_MMC_STATUS);
 626	}
 627
 628	return false;
 629
 630poll_timeout:
 631	miter->consumed = (void *)buf - miter->addr;
 632	data->bytes_xfered += miter->consumed;
 633	sg_miter_stop(miter);
 634
 635	return true;
 636}
 637
 638static void jz4740_mmc_timeout(struct timer_list *t)
 639{
 640	struct jz4740_mmc_host *host = from_timer(host, t, timeout_timer);
 641
 642	if (!test_and_clear_bit(0, &host->waiting))
 643		return;
 644
 645	jz4740_mmc_set_irq_enabled(host, JZ_MMC_IRQ_END_CMD_RES, false);
 646
 647	host->req->cmd->error = -ETIMEDOUT;
 648	jz4740_mmc_request_done(host);
 649}
 650
 651static void jz4740_mmc_read_response(struct jz4740_mmc_host *host,
 652	struct mmc_command *cmd)
 653{
 654	int i;
 655	uint16_t tmp;
 656	void __iomem *fifo_addr = host->base + JZ_REG_MMC_RESP_FIFO;
 657
 658	if (cmd->flags & MMC_RSP_136) {
 659		tmp = readw(fifo_addr);
 660		for (i = 0; i < 4; ++i) {
 661			cmd->resp[i] = tmp << 24;
 662			tmp = readw(fifo_addr);
 663			cmd->resp[i] |= tmp << 8;
 664			tmp = readw(fifo_addr);
 665			cmd->resp[i] |= tmp >> 8;
 666		}
 667	} else {
 668		cmd->resp[0] = readw(fifo_addr) << 24;
 669		cmd->resp[0] |= readw(fifo_addr) << 8;
 670		cmd->resp[0] |= readw(fifo_addr) & 0xff;
 671	}
 672}
 673
 674static void jz4740_mmc_send_command(struct jz4740_mmc_host *host,
 675	struct mmc_command *cmd)
 676{
 677	uint32_t cmdat = host->cmdat;
 678
 679	host->cmdat &= ~JZ_MMC_CMDAT_INIT;
 680	jz4740_mmc_clock_disable(host);
 681
 682	host->cmd = cmd;
 683
 684	if (cmd->flags & MMC_RSP_BUSY)
 685		cmdat |= JZ_MMC_CMDAT_BUSY;
 686
 687	switch (mmc_resp_type(cmd)) {
 688	case MMC_RSP_R1B:
 689	case MMC_RSP_R1:
 690		cmdat |= JZ_MMC_CMDAT_RSP_R1;
 691		break;
 692	case MMC_RSP_R2:
 693		cmdat |= JZ_MMC_CMDAT_RSP_R2;
 694		break;
 695	case MMC_RSP_R3:
 696		cmdat |= JZ_MMC_CMDAT_RSP_R3;
 697		break;
 698	default:
 699		break;
 700	}
 701
 702	if (cmd->data) {
 703		cmdat |= JZ_MMC_CMDAT_DATA_EN;
 704		if (cmd->data->flags & MMC_DATA_WRITE)
 705			cmdat |= JZ_MMC_CMDAT_WRITE;
 706		if (host->use_dma) {
 707			/*
 708			 * The JZ4780's MMC controller has integrated DMA ability
 709			 * in addition to being able to use the external DMA
 710			 * controller. It moves DMA control bits to a separate
 711			 * register. The DMA_SEL bit chooses the external
 712			 * controller over the integrated one. Earlier SoCs
 713			 * can only use the external controller, and have a
 714			 * single DMA enable bit in CMDAT.
 715			 */
 716			if (host->version >= JZ_MMC_JZ4780) {
 717				writel(JZ_MMC_DMAC_DMA_EN | JZ_MMC_DMAC_DMA_SEL,
 718				       host->base + JZ_REG_MMC_DMAC);
 719			} else {
 720				cmdat |= JZ_MMC_CMDAT_DMA_EN;
 721			}
 722		} else if (host->version >= JZ_MMC_JZ4780) {
 723			writel(0, host->base + JZ_REG_MMC_DMAC);
 724		}
 725
 726		writew(cmd->data->blksz, host->base + JZ_REG_MMC_BLKLEN);
 727		writew(cmd->data->blocks, host->base + JZ_REG_MMC_NOB);
 728	}
 729
 730	writeb(cmd->opcode, host->base + JZ_REG_MMC_CMD);
 731	writel(cmd->arg, host->base + JZ_REG_MMC_ARG);
 732	writel(cmdat, host->base + JZ_REG_MMC_CMDAT);
 733
 734	jz4740_mmc_clock_enable(host, 1);
 735}
 736
 737static void jz_mmc_prepare_data_transfer(struct jz4740_mmc_host *host)
 738{
 739	struct mmc_command *cmd = host->req->cmd;
 740	struct mmc_data *data = cmd->data;
 741	int direction;
 742
 743	if (data->flags & MMC_DATA_READ)
 744		direction = SG_MITER_TO_SG;
 745	else
 746		direction = SG_MITER_FROM_SG;
 747
 748	sg_miter_start(&host->miter, data->sg, data->sg_len, direction);
 749}
 750
 751
 752static irqreturn_t jz_mmc_irq_worker(int irq, void *devid)
 753{
 754	struct jz4740_mmc_host *host = (struct jz4740_mmc_host *)devid;
 755	struct mmc_command *cmd = host->req->cmd;
 756	struct mmc_request *req = host->req;
 757	struct mmc_data *data = cmd->data;
 758	bool timeout = false;
 759
 760	if (cmd->error)
 761		host->state = JZ4740_MMC_STATE_DONE;
 762
 763	switch (host->state) {
 764	case JZ4740_MMC_STATE_READ_RESPONSE:
 765		if (cmd->flags & MMC_RSP_PRESENT)
 766			jz4740_mmc_read_response(host, cmd);
 767
 768		if (!data)
 769			break;
 770
 771		jz_mmc_prepare_data_transfer(host);
 772		fallthrough;
 773
 774	case JZ4740_MMC_STATE_TRANSFER_DATA:
 775		if (host->use_dma) {
 776			/* Use DMA if enabled.
 777			 * Data transfer direction is defined later by
 778			 * relying on data flags in
 779			 * jz4740_mmc_prepare_dma_data() and
 780			 * jz4740_mmc_start_dma_transfer().
 781			 */
 782			timeout = jz4740_mmc_start_dma_transfer(host, data);
 783			data->bytes_xfered = data->blocks * data->blksz;
 784		} else if (data->flags & MMC_DATA_READ)
 785			/* Use PIO if DMA is not enabled.
 786			 * Data transfer direction was defined before
 787			 * by relying on data flags in
 788			 * jz_mmc_prepare_data_transfer().
 789			 */
 790			timeout = jz4740_mmc_read_data(host, data);
 791		else
 792			timeout = jz4740_mmc_write_data(host, data);
 793
 794		if (unlikely(timeout)) {
 795			host->state = JZ4740_MMC_STATE_TRANSFER_DATA;
 796			break;
 797		}
 798
 799		jz4740_mmc_transfer_check_state(host, data);
 800
 801		timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_DATA_TRAN_DONE);
 802		if (unlikely(timeout)) {
 803			host->state = JZ4740_MMC_STATE_SEND_STOP;
 804			break;
 805		}
 806		jz4740_mmc_write_irq_reg(host, JZ_MMC_IRQ_DATA_TRAN_DONE);
 807		fallthrough;
 808
 809	case JZ4740_MMC_STATE_SEND_STOP:
 810		if (!req->stop)
 811			break;
 812
 813		jz4740_mmc_send_command(host, req->stop);
 814
 815		if (mmc_resp_type(req->stop) & MMC_RSP_BUSY) {
 816			timeout = jz4740_mmc_poll_irq(host,
 817						      JZ_MMC_IRQ_PRG_DONE);
 818			if (timeout) {
 819				host->state = JZ4740_MMC_STATE_DONE;
 820				break;
 821			}
 822		}
 823		fallthrough;
 824
 825	case JZ4740_MMC_STATE_DONE:
 826		break;
 827	}
 828
 829	if (!timeout)
 830		jz4740_mmc_request_done(host);
 831
 832	return IRQ_HANDLED;
 833}
 834
 835static irqreturn_t jz_mmc_irq(int irq, void *devid)
 836{
 837	struct jz4740_mmc_host *host = devid;
 838	struct mmc_command *cmd = host->cmd;
 839	uint32_t irq_reg, status, tmp;
 840
 841	status = readl(host->base + JZ_REG_MMC_STATUS);
 842	irq_reg = jz4740_mmc_read_irq_reg(host);
 843
 844	tmp = irq_reg;
 845	irq_reg &= ~host->irq_mask;
 846
 847	tmp &= ~(JZ_MMC_IRQ_TXFIFO_WR_REQ | JZ_MMC_IRQ_RXFIFO_RD_REQ |
 848		JZ_MMC_IRQ_PRG_DONE | JZ_MMC_IRQ_DATA_TRAN_DONE);
 849
 850	if (tmp != irq_reg)
 851		jz4740_mmc_write_irq_reg(host, tmp & ~irq_reg);
 852
 853	if (irq_reg & JZ_MMC_IRQ_SDIO) {
 854		jz4740_mmc_write_irq_reg(host, JZ_MMC_IRQ_SDIO);
 855		mmc_signal_sdio_irq(host->mmc);
 856		irq_reg &= ~JZ_MMC_IRQ_SDIO;
 857	}
 858
 859	if (host->req && cmd && irq_reg) {
 860		if (test_and_clear_bit(0, &host->waiting)) {
 861			del_timer(&host->timeout_timer);
 862
 863			if (status & JZ_MMC_STATUS_TIMEOUT_RES) {
 864				cmd->error = -ETIMEDOUT;
 865			} else if (status & JZ_MMC_STATUS_CRC_RES_ERR) {
 866				cmd->error = -EIO;
 867			} else if (status & (JZ_MMC_STATUS_CRC_READ_ERROR |
 868				    JZ_MMC_STATUS_CRC_WRITE_ERROR)) {
 869				if (cmd->data)
 870					cmd->data->error = -EIO;
 871				cmd->error = -EIO;
 872			}
 873
 874			jz4740_mmc_set_irq_enabled(host, irq_reg, false);
 875			jz4740_mmc_write_irq_reg(host, irq_reg);
 876
 877			return IRQ_WAKE_THREAD;
 878		}
 879	}
 880
 881	return IRQ_HANDLED;
 882}
 883
 884static int jz4740_mmc_set_clock_rate(struct jz4740_mmc_host *host, int rate)
 885{
 886	int div = 0;
 887	int real_rate;
 888
 889	jz4740_mmc_clock_disable(host);
 890	clk_set_rate(host->clk, host->mmc->f_max);
 891
 892	real_rate = clk_get_rate(host->clk);
 893
 894	while (real_rate > rate && div < 7) {
 895		++div;
 896		real_rate >>= 1;
 897	}
 898
 899	writew(div, host->base + JZ_REG_MMC_CLKRT);
 900
 901	if (real_rate > 25000000) {
 902		if (host->version >= JZ_MMC_JZ4780) {
 903			writel(JZ_MMC_LPM_DRV_RISING_QTR_PHASE_DLY |
 904				   JZ_MMC_LPM_SMP_RISING_QTR_OR_HALF_PHASE_DLY |
 905				   JZ_MMC_LPM_LOW_POWER_MODE_EN,
 906				   host->base + JZ_REG_MMC_LPM);
 907		} else if (host->version >= JZ_MMC_JZ4760) {
 908			writel(JZ_MMC_LPM_DRV_RISING |
 909				   JZ_MMC_LPM_LOW_POWER_MODE_EN,
 910				   host->base + JZ_REG_MMC_LPM);
 911		} else if (host->version >= JZ_MMC_JZ4725B)
 912			writel(JZ_MMC_LPM_LOW_POWER_MODE_EN,
 913				   host->base + JZ_REG_MMC_LPM);
 914	}
 915
 916	return real_rate;
 917}
 918
 919static void jz4740_mmc_request(struct mmc_host *mmc, struct mmc_request *req)
 920{
 921	struct jz4740_mmc_host *host = mmc_priv(mmc);
 922
 923	host->req = req;
 924
 925	jz4740_mmc_write_irq_reg(host, ~0);
 926	jz4740_mmc_set_irq_enabled(host, JZ_MMC_IRQ_END_CMD_RES, true);
 927
 928	host->state = JZ4740_MMC_STATE_READ_RESPONSE;
 929	set_bit(0, &host->waiting);
 930	mod_timer(&host->timeout_timer,
 931		  jiffies + msecs_to_jiffies(JZ_MMC_REQ_TIMEOUT_MS));
 932	jz4740_mmc_send_command(host, req->cmd);
 933}
 934
 935static void jz4740_mmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
 936{
 937	struct jz4740_mmc_host *host = mmc_priv(mmc);
 
 
 938	if (ios->clock)
 939		jz4740_mmc_set_clock_rate(host, ios->clock);
 940
 941	switch (ios->power_mode) {
 942	case MMC_POWER_UP:
 943		jz4740_mmc_reset(host);
 944		if (!IS_ERR(mmc->supply.vmmc))
 945			mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, ios->vdd);
 946		host->cmdat |= JZ_MMC_CMDAT_INIT;
 947		clk_prepare_enable(host->clk);
 948		break;
 949	case MMC_POWER_ON:
 
 
 
 
 
 
 
 950		break;
 951	default:
 952		if (!IS_ERR(mmc->supply.vmmc))
 953			mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
 
 
 
 
 954		clk_disable_unprepare(host->clk);
 955		break;
 
 
 956	}
 957
 958	switch (ios->bus_width) {
 959	case MMC_BUS_WIDTH_1:
 960		host->cmdat &= ~JZ_MMC_CMDAT_BUS_WIDTH_MASK;
 961		break;
 962	case MMC_BUS_WIDTH_4:
 963		host->cmdat &= ~JZ_MMC_CMDAT_BUS_WIDTH_MASK;
 964		host->cmdat |= JZ_MMC_CMDAT_BUS_WIDTH_4BIT;
 965		break;
 966	case MMC_BUS_WIDTH_8:
 967		host->cmdat &= ~JZ_MMC_CMDAT_BUS_WIDTH_MASK;
 968		host->cmdat |= JZ_MMC_CMDAT_BUS_WIDTH_8BIT;
 969		break;
 970	default:
 971		break;
 972	}
 973}
 974
 975static void jz4740_mmc_enable_sdio_irq(struct mmc_host *mmc, int enable)
 976{
 977	struct jz4740_mmc_host *host = mmc_priv(mmc);
 978	jz4740_mmc_set_irq_enabled(host, JZ_MMC_IRQ_SDIO, enable);
 979}
 980
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 981static const struct mmc_host_ops jz4740_mmc_ops = {
 982	.request	= jz4740_mmc_request,
 983	.pre_req	= jz4740_mmc_pre_request,
 984	.post_req	= jz4740_mmc_post_request,
 985	.set_ios	= jz4740_mmc_set_ios,
 986	.get_ro		= mmc_gpio_get_ro,
 987	.get_cd		= mmc_gpio_get_cd,
 988	.enable_sdio_irq = jz4740_mmc_enable_sdio_irq,
 
 989};
 990
 991static const struct of_device_id jz4740_mmc_of_match[] = {
 992	{ .compatible = "ingenic,jz4740-mmc", .data = (void *) JZ_MMC_JZ4740 },
 993	{ .compatible = "ingenic,jz4725b-mmc", .data = (void *)JZ_MMC_JZ4725B },
 994	{ .compatible = "ingenic,jz4760-mmc", .data = (void *) JZ_MMC_JZ4760 },
 995	{ .compatible = "ingenic,jz4775-mmc", .data = (void *) JZ_MMC_JZ4780 },
 996	{ .compatible = "ingenic,jz4780-mmc", .data = (void *) JZ_MMC_JZ4780 },
 997	{ .compatible = "ingenic,x1000-mmc", .data = (void *) JZ_MMC_X1000 },
 998	{},
 999};
1000MODULE_DEVICE_TABLE(of, jz4740_mmc_of_match);
1001
1002static int jz4740_mmc_probe(struct platform_device* pdev)
1003{
1004	int ret;
1005	struct mmc_host *mmc;
1006	struct jz4740_mmc_host *host;
1007	const struct of_device_id *match;
1008
1009	mmc = mmc_alloc_host(sizeof(struct jz4740_mmc_host), &pdev->dev);
1010	if (!mmc) {
1011		dev_err(&pdev->dev, "Failed to alloc mmc host structure\n");
1012		return -ENOMEM;
1013	}
1014
1015	host = mmc_priv(mmc);
1016
1017	match = of_match_device(jz4740_mmc_of_match, &pdev->dev);
1018	if (match) {
1019		host->version = (enum jz4740_mmc_version)match->data;
1020	} else {
1021		/* JZ4740 should be the only one using legacy probe */
1022		host->version = JZ_MMC_JZ4740;
1023	}
1024
1025	ret = mmc_of_parse(mmc);
1026	if (ret) {
1027		dev_err_probe(&pdev->dev, ret, "could not parse device properties\n");
1028		goto err_free_host;
1029	}
1030
1031	mmc_regulator_get_supply(mmc);
1032
1033	host->irq = platform_get_irq(pdev, 0);
1034	if (host->irq < 0) {
1035		ret = host->irq;
1036		goto err_free_host;
1037	}
1038
1039	host->clk = devm_clk_get(&pdev->dev, "mmc");
1040	if (IS_ERR(host->clk)) {
1041		ret = PTR_ERR(host->clk);
1042		dev_err(&pdev->dev, "Failed to get mmc clock\n");
1043		goto err_free_host;
1044	}
1045
1046	host->mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1047	host->base = devm_ioremap_resource(&pdev->dev, host->mem_res);
1048	if (IS_ERR(host->base)) {
1049		ret = PTR_ERR(host->base);
1050		goto err_free_host;
1051	}
1052
1053	mmc->ops = &jz4740_mmc_ops;
1054	if (!mmc->f_max)
1055		mmc->f_max = JZ_MMC_CLK_RATE;
1056
1057	/*
1058	 * There seems to be a problem with this driver on the JZ4760 and
1059	 * JZ4760B SoCs. There, when using the maximum rate supported (50 MHz),
1060	 * the communication fails with many SD cards.
1061	 * Until this bug is sorted out, limit the maximum rate to 24 MHz.
1062	 */
1063	if (host->version == JZ_MMC_JZ4760 && mmc->f_max > JZ_MMC_CLK_RATE)
1064		mmc->f_max = JZ_MMC_CLK_RATE;
1065
1066	mmc->f_min = mmc->f_max / 128;
1067	mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
1068
1069	/*
1070	 * We use a fixed timeout of 5s, hence inform the core about it. A
1071	 * future improvement should instead respect the cmd->busy_timeout.
1072	 */
1073	mmc->max_busy_timeout = JZ_MMC_REQ_TIMEOUT_MS;
1074
1075	mmc->max_blk_size = (1 << 10) - 1;
1076	mmc->max_blk_count = (1 << 15) - 1;
1077	mmc->max_req_size = mmc->max_blk_size * mmc->max_blk_count;
1078
1079	mmc->max_segs = 128;
1080	mmc->max_seg_size = mmc->max_req_size;
1081
1082	host->mmc = mmc;
1083	host->pdev = pdev;
1084	spin_lock_init(&host->lock);
1085	host->irq_mask = ~0;
1086
1087	jz4740_mmc_reset(host);
1088
1089	ret = request_threaded_irq(host->irq, jz_mmc_irq, jz_mmc_irq_worker, 0,
1090			dev_name(&pdev->dev), host);
1091	if (ret) {
1092		dev_err(&pdev->dev, "Failed to request irq: %d\n", ret);
1093		goto err_free_host;
1094	}
1095
1096	jz4740_mmc_clock_disable(host);
1097	timer_setup(&host->timeout_timer, jz4740_mmc_timeout, 0);
1098
1099	ret = jz4740_mmc_acquire_dma_channels(host);
1100	if (ret == -EPROBE_DEFER)
1101		goto err_free_irq;
1102	host->use_dma = !ret;
1103
1104	platform_set_drvdata(pdev, host);
1105	ret = mmc_add_host(mmc);
1106
1107	if (ret) {
1108		dev_err(&pdev->dev, "Failed to add mmc host: %d\n", ret);
1109		goto err_release_dma;
1110	}
1111	dev_info(&pdev->dev, "Ingenic SD/MMC card driver registered\n");
1112
1113	dev_info(&pdev->dev, "Using %s, %d-bit mode\n",
1114		 host->use_dma ? "DMA" : "PIO",
1115		 (mmc->caps & MMC_CAP_8_BIT_DATA) ? 8 :
1116		 ((mmc->caps & MMC_CAP_4_BIT_DATA) ? 4 : 1));
1117
1118	return 0;
1119
1120err_release_dma:
1121	if (host->use_dma)
1122		jz4740_mmc_release_dma_channels(host);
1123err_free_irq:
1124	free_irq(host->irq, host);
1125err_free_host:
1126	mmc_free_host(mmc);
1127
1128	return ret;
1129}
1130
1131static int jz4740_mmc_remove(struct platform_device *pdev)
1132{
1133	struct jz4740_mmc_host *host = platform_get_drvdata(pdev);
1134
1135	del_timer_sync(&host->timeout_timer);
1136	jz4740_mmc_set_irq_enabled(host, 0xff, false);
1137	jz4740_mmc_reset(host);
1138
1139	mmc_remove_host(host->mmc);
1140
1141	free_irq(host->irq, host);
1142
1143	if (host->use_dma)
1144		jz4740_mmc_release_dma_channels(host);
1145
1146	mmc_free_host(host->mmc);
1147
1148	return 0;
1149}
1150
1151static int jz4740_mmc_suspend(struct device *dev)
1152{
1153	return pinctrl_pm_select_sleep_state(dev);
1154}
1155
1156static int jz4740_mmc_resume(struct device *dev)
1157{
1158	return pinctrl_select_default_state(dev);
1159}
1160
1161static DEFINE_SIMPLE_DEV_PM_OPS(jz4740_mmc_pm_ops, jz4740_mmc_suspend,
1162				jz4740_mmc_resume);
1163
1164static struct platform_driver jz4740_mmc_driver = {
1165	.probe = jz4740_mmc_probe,
1166	.remove = jz4740_mmc_remove,
1167	.driver = {
1168		.name = "jz4740-mmc",
1169		.probe_type = PROBE_PREFER_ASYNCHRONOUS,
1170		.of_match_table = of_match_ptr(jz4740_mmc_of_match),
1171		.pm = pm_sleep_ptr(&jz4740_mmc_pm_ops),
1172	},
1173};
1174
1175module_platform_driver(jz4740_mmc_driver);
1176
1177MODULE_DESCRIPTION("JZ4740 SD/MMC controller driver");
1178MODULE_LICENSE("GPL");
1179MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
v6.9.4
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 *  Copyright (C) 2009-2010, Lars-Peter Clausen <lars@metafoo.de>
   4 *  Copyright (C) 2013, Imagination Technologies
   5 *
   6 *  JZ4740 SD/MMC controller driver
   7 */
   8
   9#include <linux/bitops.h>
  10#include <linux/clk.h>
  11#include <linux/delay.h>
  12#include <linux/dmaengine.h>
  13#include <linux/dma-mapping.h>
  14#include <linux/err.h>
  15#include <linux/interrupt.h>
  16#include <linux/io.h>
  17#include <linux/irq.h>
  18#include <linux/mmc/host.h>
  19#include <linux/mmc/slot-gpio.h>
  20#include <linux/module.h>
  21#include <linux/of.h>
  22#include <linux/pinctrl/consumer.h>
  23#include <linux/platform_device.h>
  24#include <linux/property.h>
  25#include <linux/regulator/consumer.h>
  26#include <linux/scatterlist.h>
  27
  28#include <asm/cacheflush.h>
  29
  30#define JZ_REG_MMC_STRPCL	0x00
  31#define JZ_REG_MMC_STATUS	0x04
  32#define JZ_REG_MMC_CLKRT	0x08
  33#define JZ_REG_MMC_CMDAT	0x0C
  34#define JZ_REG_MMC_RESTO	0x10
  35#define JZ_REG_MMC_RDTO		0x14
  36#define JZ_REG_MMC_BLKLEN	0x18
  37#define JZ_REG_MMC_NOB		0x1C
  38#define JZ_REG_MMC_SNOB		0x20
  39#define JZ_REG_MMC_IMASK	0x24
  40#define JZ_REG_MMC_IREG		0x28
  41#define JZ_REG_MMC_CMD		0x2C
  42#define JZ_REG_MMC_ARG		0x30
  43#define JZ_REG_MMC_RESP_FIFO	0x34
  44#define JZ_REG_MMC_RXFIFO	0x38
  45#define JZ_REG_MMC_TXFIFO	0x3C
  46#define JZ_REG_MMC_LPM		0x40
  47#define JZ_REG_MMC_DMAC		0x44
  48
  49#define JZ_MMC_STRPCL_EXIT_MULTIPLE BIT(7)
  50#define JZ_MMC_STRPCL_EXIT_TRANSFER BIT(6)
  51#define JZ_MMC_STRPCL_START_READWAIT BIT(5)
  52#define JZ_MMC_STRPCL_STOP_READWAIT BIT(4)
  53#define JZ_MMC_STRPCL_RESET BIT(3)
  54#define JZ_MMC_STRPCL_START_OP BIT(2)
  55#define JZ_MMC_STRPCL_CLOCK_CONTROL (BIT(1) | BIT(0))
  56#define JZ_MMC_STRPCL_CLOCK_STOP BIT(0)
  57#define JZ_MMC_STRPCL_CLOCK_START BIT(1)
  58
  59
  60#define JZ_MMC_STATUS_IS_RESETTING BIT(15)
  61#define JZ_MMC_STATUS_SDIO_INT_ACTIVE BIT(14)
  62#define JZ_MMC_STATUS_PRG_DONE BIT(13)
  63#define JZ_MMC_STATUS_DATA_TRAN_DONE BIT(12)
  64#define JZ_MMC_STATUS_END_CMD_RES BIT(11)
  65#define JZ_MMC_STATUS_DATA_FIFO_AFULL BIT(10)
  66#define JZ_MMC_STATUS_IS_READWAIT BIT(9)
  67#define JZ_MMC_STATUS_CLK_EN BIT(8)
  68#define JZ_MMC_STATUS_DATA_FIFO_FULL BIT(7)
  69#define JZ_MMC_STATUS_DATA_FIFO_EMPTY BIT(6)
  70#define JZ_MMC_STATUS_CRC_RES_ERR BIT(5)
  71#define JZ_MMC_STATUS_CRC_READ_ERROR BIT(4)
  72#define JZ_MMC_STATUS_TIMEOUT_WRITE BIT(3)
  73#define JZ_MMC_STATUS_CRC_WRITE_ERROR BIT(2)
  74#define JZ_MMC_STATUS_TIMEOUT_RES BIT(1)
  75#define JZ_MMC_STATUS_TIMEOUT_READ BIT(0)
  76
  77#define JZ_MMC_STATUS_READ_ERROR_MASK (BIT(4) | BIT(0))
  78#define JZ_MMC_STATUS_WRITE_ERROR_MASK (BIT(3) | BIT(2))
  79
  80
  81#define JZ_MMC_CMDAT_IO_ABORT BIT(11)
  82#define JZ_MMC_CMDAT_BUS_WIDTH_4BIT BIT(10)
  83#define JZ_MMC_CMDAT_BUS_WIDTH_8BIT (BIT(10) | BIT(9))
  84#define	JZ_MMC_CMDAT_BUS_WIDTH_MASK (BIT(10) | BIT(9))
  85#define JZ_MMC_CMDAT_DMA_EN BIT(8)
  86#define JZ_MMC_CMDAT_INIT BIT(7)
  87#define JZ_MMC_CMDAT_BUSY BIT(6)
  88#define JZ_MMC_CMDAT_STREAM BIT(5)
  89#define JZ_MMC_CMDAT_WRITE BIT(4)
  90#define JZ_MMC_CMDAT_DATA_EN BIT(3)
  91#define JZ_MMC_CMDAT_RESPONSE_FORMAT (BIT(2) | BIT(1) | BIT(0))
  92#define JZ_MMC_CMDAT_RSP_R1 1
  93#define JZ_MMC_CMDAT_RSP_R2 2
  94#define JZ_MMC_CMDAT_RSP_R3 3
  95
  96#define JZ_MMC_IRQ_SDIO BIT(7)
  97#define JZ_MMC_IRQ_TXFIFO_WR_REQ BIT(6)
  98#define JZ_MMC_IRQ_RXFIFO_RD_REQ BIT(5)
  99#define JZ_MMC_IRQ_END_CMD_RES BIT(2)
 100#define JZ_MMC_IRQ_PRG_DONE BIT(1)
 101#define JZ_MMC_IRQ_DATA_TRAN_DONE BIT(0)
 102
 103#define JZ_MMC_DMAC_DMA_SEL BIT(1)
 104#define JZ_MMC_DMAC_DMA_EN BIT(0)
 105
 106#define	JZ_MMC_LPM_DRV_RISING BIT(31)
 107#define	JZ_MMC_LPM_DRV_RISING_QTR_PHASE_DLY BIT(31)
 108#define	JZ_MMC_LPM_DRV_RISING_1NS_DLY BIT(30)
 109#define	JZ_MMC_LPM_SMP_RISING_QTR_OR_HALF_PHASE_DLY BIT(29)
 110#define	JZ_MMC_LPM_LOW_POWER_MODE_EN BIT(0)
 111
 112#define JZ_MMC_CLK_RATE 24000000
 113#define JZ_MMC_REQ_TIMEOUT_MS 5000
 114
 115enum jz4740_mmc_version {
 116	JZ_MMC_JZ4740,
 117	JZ_MMC_JZ4725B,
 118	JZ_MMC_JZ4760,
 119	JZ_MMC_JZ4780,
 120	JZ_MMC_X1000,
 121};
 122
 123enum jz4740_mmc_state {
 124	JZ4740_MMC_STATE_READ_RESPONSE,
 125	JZ4740_MMC_STATE_TRANSFER_DATA,
 126	JZ4740_MMC_STATE_SEND_STOP,
 127	JZ4740_MMC_STATE_DONE,
 128};
 129
 130/*
 131 * The MMC core allows to prepare a mmc_request while another mmc_request
 132 * is in-flight. This is used via the pre_req/post_req hooks.
 133 * This driver uses the pre_req/post_req hooks to map/unmap the mmc_request.
 134 * Following what other drivers do (sdhci, dw_mmc) we use the following cookie
 135 * flags to keep track of the mmc_request mapping state.
 136 *
 137 * COOKIE_UNMAPPED: the request is not mapped.
 138 * COOKIE_PREMAPPED: the request was mapped in pre_req,
 139 * and should be unmapped in post_req.
 140 * COOKIE_MAPPED: the request was mapped in the irq handler,
 141 * and should be unmapped before mmc_request_done is called..
 142 */
 143enum jz4780_cookie {
 144	COOKIE_UNMAPPED = 0,
 145	COOKIE_PREMAPPED,
 146	COOKIE_MAPPED,
 147};
 148
 149struct jz4740_mmc_host {
 150	struct mmc_host *mmc;
 151	struct platform_device *pdev;
 152	struct clk *clk;
 153
 154	enum jz4740_mmc_version version;
 155
 156	int irq;
 157
 158	void __iomem *base;
 159	struct resource *mem_res;
 160	struct mmc_request *req;
 161	struct mmc_command *cmd;
 162
 163	bool vqmmc_enabled;
 164
 165	unsigned long waiting;
 166
 167	uint32_t cmdat;
 168
 169	uint32_t irq_mask;
 170
 171	spinlock_t lock;
 172
 173	struct timer_list timeout_timer;
 174	struct sg_mapping_iter miter;
 175	enum jz4740_mmc_state state;
 176
 177	/* DMA support */
 178	struct dma_chan *dma_rx;
 179	struct dma_chan *dma_tx;
 180	bool use_dma;
 181
 182/* The DMA trigger level is 8 words, that is to say, the DMA read
 183 * trigger is when data words in MSC_RXFIFO is >= 8 and the DMA write
 184 * trigger is when data words in MSC_TXFIFO is < 8.
 185 */
 186#define JZ4740_MMC_FIFO_HALF_SIZE 8
 187};
 188
 189static void jz4740_mmc_write_irq_mask(struct jz4740_mmc_host *host,
 190				      uint32_t val)
 191{
 192	if (host->version >= JZ_MMC_JZ4725B)
 193		return writel(val, host->base + JZ_REG_MMC_IMASK);
 194	else
 195		return writew(val, host->base + JZ_REG_MMC_IMASK);
 196}
 197
 198static void jz4740_mmc_write_irq_reg(struct jz4740_mmc_host *host,
 199				     uint32_t val)
 200{
 201	if (host->version >= JZ_MMC_JZ4780)
 202		writel(val, host->base + JZ_REG_MMC_IREG);
 203	else
 204		writew(val, host->base + JZ_REG_MMC_IREG);
 205}
 206
 207static uint32_t jz4740_mmc_read_irq_reg(struct jz4740_mmc_host *host)
 208{
 209	if (host->version >= JZ_MMC_JZ4780)
 210		return readl(host->base + JZ_REG_MMC_IREG);
 211	else
 212		return readw(host->base + JZ_REG_MMC_IREG);
 213}
 214
 215/*----------------------------------------------------------------------------*/
 216/* DMA infrastructure */
 217
 218static void jz4740_mmc_release_dma_channels(struct jz4740_mmc_host *host)
 219{
 220	if (!host->use_dma)
 221		return;
 222
 223	dma_release_channel(host->dma_tx);
 224	if (host->dma_rx)
 225		dma_release_channel(host->dma_rx);
 226}
 227
 228static int jz4740_mmc_acquire_dma_channels(struct jz4740_mmc_host *host)
 229{
 230	struct device *dev = mmc_dev(host->mmc);
 231
 232	host->dma_tx = dma_request_chan(dev, "tx-rx");
 233	if (!IS_ERR(host->dma_tx))
 234		return 0;
 235
 236	if (PTR_ERR(host->dma_tx) != -ENODEV) {
 237		dev_err(dev, "Failed to get dma tx-rx channel\n");
 238		return PTR_ERR(host->dma_tx);
 239	}
 240
 241	host->dma_tx = dma_request_chan(mmc_dev(host->mmc), "tx");
 242	if (IS_ERR(host->dma_tx)) {
 243		dev_err(mmc_dev(host->mmc), "Failed to get dma_tx channel\n");
 244		return PTR_ERR(host->dma_tx);
 245	}
 246
 247	host->dma_rx = dma_request_chan(mmc_dev(host->mmc), "rx");
 248	if (IS_ERR(host->dma_rx)) {
 249		dev_err(mmc_dev(host->mmc), "Failed to get dma_rx channel\n");
 250		dma_release_channel(host->dma_tx);
 251		return PTR_ERR(host->dma_rx);
 252	}
 253
 254	/*
 255	 * Limit the maximum segment size in any SG entry according to
 256	 * the parameters of the DMA engine device.
 257	 */
 258	if (host->dma_tx) {
 259		struct device *dev = host->dma_tx->device->dev;
 260		unsigned int max_seg_size = dma_get_max_seg_size(dev);
 261
 262		if (max_seg_size < host->mmc->max_seg_size)
 263			host->mmc->max_seg_size = max_seg_size;
 264	}
 265
 266	if (host->dma_rx) {
 267		struct device *dev = host->dma_rx->device->dev;
 268		unsigned int max_seg_size = dma_get_max_seg_size(dev);
 269
 270		if (max_seg_size < host->mmc->max_seg_size)
 271			host->mmc->max_seg_size = max_seg_size;
 272	}
 273
 274	return 0;
 275}
 276
 277static inline struct dma_chan *jz4740_mmc_get_dma_chan(struct jz4740_mmc_host *host,
 278						       struct mmc_data *data)
 279{
 280	if ((data->flags & MMC_DATA_READ) && host->dma_rx)
 281		return host->dma_rx;
 282	else
 283		return host->dma_tx;
 284}
 285
 286static void jz4740_mmc_dma_unmap(struct jz4740_mmc_host *host,
 287				 struct mmc_data *data)
 288{
 289	struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 290	enum dma_data_direction dir = mmc_get_dma_dir(data);
 291
 292	dma_unmap_sg(chan->device->dev, data->sg, data->sg_len, dir);
 293	data->host_cookie = COOKIE_UNMAPPED;
 294}
 295
 296/* Prepares DMA data for current or next transfer.
 297 * A request can be in-flight when this is called.
 298 */
 299static int jz4740_mmc_prepare_dma_data(struct jz4740_mmc_host *host,
 300				       struct mmc_data *data,
 301				       int cookie)
 302{
 303	struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 304	enum dma_data_direction dir = mmc_get_dma_dir(data);
 305	unsigned int sg_count;
 306
 307	if (data->host_cookie == COOKIE_PREMAPPED)
 308		return data->sg_count;
 309
 310	sg_count = dma_map_sg(chan->device->dev,
 311			data->sg,
 312			data->sg_len,
 313			dir);
 314
 315	if (!sg_count) {
 316		dev_err(mmc_dev(host->mmc),
 317			"Failed to map scatterlist for DMA operation\n");
 318		return -EINVAL;
 319	}
 320
 321	data->sg_count = sg_count;
 322	data->host_cookie = cookie;
 323
 324	return data->sg_count;
 325}
 326
 327static int jz4740_mmc_start_dma_transfer(struct jz4740_mmc_host *host,
 328					 struct mmc_data *data)
 329{
 330	struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 331	struct dma_async_tx_descriptor *desc;
 332	struct dma_slave_config conf = {
 333		.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES,
 334		.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES,
 335		.src_maxburst = JZ4740_MMC_FIFO_HALF_SIZE,
 336		.dst_maxburst = JZ4740_MMC_FIFO_HALF_SIZE,
 337	};
 338	int sg_count;
 339
 340	if (data->flags & MMC_DATA_WRITE) {
 341		conf.direction = DMA_MEM_TO_DEV;
 342		conf.dst_addr = host->mem_res->start + JZ_REG_MMC_TXFIFO;
 343	} else {
 344		conf.direction = DMA_DEV_TO_MEM;
 345		conf.src_addr = host->mem_res->start + JZ_REG_MMC_RXFIFO;
 346	}
 347
 348	sg_count = jz4740_mmc_prepare_dma_data(host, data, COOKIE_MAPPED);
 349	if (sg_count < 0)
 350		return sg_count;
 351
 352	dmaengine_slave_config(chan, &conf);
 353	desc = dmaengine_prep_slave_sg(chan, data->sg, sg_count,
 354			conf.direction,
 355			DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
 356	if (!desc) {
 357		dev_err(mmc_dev(host->mmc),
 358			"Failed to allocate DMA %s descriptor",
 359			 conf.direction == DMA_MEM_TO_DEV ? "TX" : "RX");
 360		goto dma_unmap;
 361	}
 362
 363	dmaengine_submit(desc);
 364	dma_async_issue_pending(chan);
 365
 366	return 0;
 367
 368dma_unmap:
 369	if (data->host_cookie == COOKIE_MAPPED)
 370		jz4740_mmc_dma_unmap(host, data);
 371	return -ENOMEM;
 372}
 373
 374static void jz4740_mmc_pre_request(struct mmc_host *mmc,
 375				   struct mmc_request *mrq)
 376{
 377	struct jz4740_mmc_host *host = mmc_priv(mmc);
 378	struct mmc_data *data = mrq->data;
 379
 380	if (!host->use_dma)
 381		return;
 382
 383	data->host_cookie = COOKIE_UNMAPPED;
 384	if (jz4740_mmc_prepare_dma_data(host, data, COOKIE_PREMAPPED) < 0)
 385		data->host_cookie = COOKIE_UNMAPPED;
 386}
 387
 388static void jz4740_mmc_post_request(struct mmc_host *mmc,
 389				    struct mmc_request *mrq,
 390				    int err)
 391{
 392	struct jz4740_mmc_host *host = mmc_priv(mmc);
 393	struct mmc_data *data = mrq->data;
 394
 395	if (data && data->host_cookie != COOKIE_UNMAPPED)
 396		jz4740_mmc_dma_unmap(host, data);
 397
 398	if (err) {
 399		struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 400
 401		dmaengine_terminate_all(chan);
 402	}
 403}
 404
 405/*----------------------------------------------------------------------------*/
 406
 407static void jz4740_mmc_set_irq_enabled(struct jz4740_mmc_host *host,
 408	unsigned int irq, bool enabled)
 409{
 410	unsigned long flags;
 411
 412	spin_lock_irqsave(&host->lock, flags);
 413	if (enabled)
 414		host->irq_mask &= ~irq;
 415	else
 416		host->irq_mask |= irq;
 417
 418	jz4740_mmc_write_irq_mask(host, host->irq_mask);
 419	spin_unlock_irqrestore(&host->lock, flags);
 420}
 421
 422static void jz4740_mmc_clock_enable(struct jz4740_mmc_host *host,
 423	bool start_transfer)
 424{
 425	uint16_t val = JZ_MMC_STRPCL_CLOCK_START;
 426
 427	if (start_transfer)
 428		val |= JZ_MMC_STRPCL_START_OP;
 429
 430	writew(val, host->base + JZ_REG_MMC_STRPCL);
 431}
 432
 433static void jz4740_mmc_clock_disable(struct jz4740_mmc_host *host)
 434{
 435	uint32_t status;
 436	unsigned int timeout = 1000;
 437
 438	writew(JZ_MMC_STRPCL_CLOCK_STOP, host->base + JZ_REG_MMC_STRPCL);
 439	do {
 440		status = readl(host->base + JZ_REG_MMC_STATUS);
 441	} while (status & JZ_MMC_STATUS_CLK_EN && --timeout);
 442}
 443
 444static void jz4740_mmc_reset(struct jz4740_mmc_host *host)
 445{
 446	uint32_t status;
 447	unsigned int timeout = 1000;
 448
 449	writew(JZ_MMC_STRPCL_RESET, host->base + JZ_REG_MMC_STRPCL);
 450	udelay(10);
 451	do {
 452		status = readl(host->base + JZ_REG_MMC_STATUS);
 453	} while (status & JZ_MMC_STATUS_IS_RESETTING && --timeout);
 454}
 455
 456static void jz4740_mmc_request_done(struct jz4740_mmc_host *host)
 457{
 458	struct mmc_request *req;
 459	struct mmc_data *data;
 460
 461	req = host->req;
 462	data = req->data;
 463	host->req = NULL;
 464
 465	if (data && data->host_cookie == COOKIE_MAPPED)
 466		jz4740_mmc_dma_unmap(host, data);
 467	mmc_request_done(host->mmc, req);
 468}
 469
 470static unsigned int jz4740_mmc_poll_irq(struct jz4740_mmc_host *host,
 471	unsigned int irq)
 472{
 473	unsigned int timeout = 0x800;
 474	uint32_t status;
 475
 476	do {
 477		status = jz4740_mmc_read_irq_reg(host);
 478	} while (!(status & irq) && --timeout);
 479
 480	if (timeout == 0) {
 481		set_bit(0, &host->waiting);
 482		mod_timer(&host->timeout_timer,
 483			  jiffies + msecs_to_jiffies(JZ_MMC_REQ_TIMEOUT_MS));
 484		jz4740_mmc_set_irq_enabled(host, irq, true);
 485		return true;
 486	}
 487
 488	return false;
 489}
 490
 491static void jz4740_mmc_transfer_check_state(struct jz4740_mmc_host *host,
 492	struct mmc_data *data)
 493{
 494	int status;
 495
 496	status = readl(host->base + JZ_REG_MMC_STATUS);
 497	if (status & JZ_MMC_STATUS_WRITE_ERROR_MASK) {
 498		if (status & (JZ_MMC_STATUS_TIMEOUT_WRITE)) {
 499			host->req->cmd->error = -ETIMEDOUT;
 500			data->error = -ETIMEDOUT;
 501		} else {
 502			host->req->cmd->error = -EIO;
 503			data->error = -EIO;
 504		}
 505	} else if (status & JZ_MMC_STATUS_READ_ERROR_MASK) {
 506		if (status & (JZ_MMC_STATUS_TIMEOUT_READ)) {
 507			host->req->cmd->error = -ETIMEDOUT;
 508			data->error = -ETIMEDOUT;
 509		} else {
 510			host->req->cmd->error = -EIO;
 511			data->error = -EIO;
 512		}
 513	}
 514}
 515
 516static bool jz4740_mmc_write_data(struct jz4740_mmc_host *host,
 517	struct mmc_data *data)
 518{
 519	struct sg_mapping_iter *miter = &host->miter;
 520	void __iomem *fifo_addr = host->base + JZ_REG_MMC_TXFIFO;
 521	uint32_t *buf;
 522	bool timeout;
 523	size_t i, j;
 524
 525	while (sg_miter_next(miter)) {
 526		buf = miter->addr;
 527		i = miter->length / 4;
 528		j = i / 8;
 529		i = i & 0x7;
 530		while (j) {
 531			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_TXFIFO_WR_REQ);
 532			if (unlikely(timeout))
 533				goto poll_timeout;
 534
 535			writel(buf[0], fifo_addr);
 536			writel(buf[1], fifo_addr);
 537			writel(buf[2], fifo_addr);
 538			writel(buf[3], fifo_addr);
 539			writel(buf[4], fifo_addr);
 540			writel(buf[5], fifo_addr);
 541			writel(buf[6], fifo_addr);
 542			writel(buf[7], fifo_addr);
 543			buf += 8;
 544			--j;
 545		}
 546		if (unlikely(i)) {
 547			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_TXFIFO_WR_REQ);
 548			if (unlikely(timeout))
 549				goto poll_timeout;
 550
 551			while (i) {
 552				writel(*buf, fifo_addr);
 553				++buf;
 554				--i;
 555			}
 556		}
 557		data->bytes_xfered += miter->length;
 558	}
 559	sg_miter_stop(miter);
 560
 561	return false;
 562
 563poll_timeout:
 564	miter->consumed = (void *)buf - miter->addr;
 565	data->bytes_xfered += miter->consumed;
 566	sg_miter_stop(miter);
 567
 568	return true;
 569}
 570
 571static bool jz4740_mmc_read_data(struct jz4740_mmc_host *host,
 572				struct mmc_data *data)
 573{
 574	struct sg_mapping_iter *miter = &host->miter;
 575	void __iomem *fifo_addr = host->base + JZ_REG_MMC_RXFIFO;
 576	uint32_t *buf;
 577	uint32_t d;
 578	uint32_t status;
 579	size_t i, j;
 580	unsigned int timeout;
 581
 582	while (sg_miter_next(miter)) {
 583		buf = miter->addr;
 584		i = miter->length;
 585		j = i / 32;
 586		i = i & 0x1f;
 587		while (j) {
 588			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_RXFIFO_RD_REQ);
 589			if (unlikely(timeout))
 590				goto poll_timeout;
 591
 592			buf[0] = readl(fifo_addr);
 593			buf[1] = readl(fifo_addr);
 594			buf[2] = readl(fifo_addr);
 595			buf[3] = readl(fifo_addr);
 596			buf[4] = readl(fifo_addr);
 597			buf[5] = readl(fifo_addr);
 598			buf[6] = readl(fifo_addr);
 599			buf[7] = readl(fifo_addr);
 600
 601			buf += 8;
 602			--j;
 603		}
 604
 605		if (unlikely(i)) {
 606			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_RXFIFO_RD_REQ);
 607			if (unlikely(timeout))
 608				goto poll_timeout;
 609
 610			while (i >= 4) {
 611				*buf++ = readl(fifo_addr);
 612				i -= 4;
 613			}
 614			if (unlikely(i > 0)) {
 615				d = readl(fifo_addr);
 616				memcpy(buf, &d, i);
 617			}
 618		}
 619		data->bytes_xfered += miter->length;
 620	}
 621	sg_miter_stop(miter);
 622
 623	/* For whatever reason there is sometime one word more in the fifo then
 624	 * requested */
 625	timeout = 1000;
 626	status = readl(host->base + JZ_REG_MMC_STATUS);
 627	while (!(status & JZ_MMC_STATUS_DATA_FIFO_EMPTY) && --timeout) {
 628		d = readl(fifo_addr);
 629		status = readl(host->base + JZ_REG_MMC_STATUS);
 630	}
 631
 632	return false;
 633
 634poll_timeout:
 635	miter->consumed = (void *)buf - miter->addr;
 636	data->bytes_xfered += miter->consumed;
 637	sg_miter_stop(miter);
 638
 639	return true;
 640}
 641
 642static void jz4740_mmc_timeout(struct timer_list *t)
 643{
 644	struct jz4740_mmc_host *host = from_timer(host, t, timeout_timer);
 645
 646	if (!test_and_clear_bit(0, &host->waiting))
 647		return;
 648
 649	jz4740_mmc_set_irq_enabled(host, JZ_MMC_IRQ_END_CMD_RES, false);
 650
 651	host->req->cmd->error = -ETIMEDOUT;
 652	jz4740_mmc_request_done(host);
 653}
 654
 655static void jz4740_mmc_read_response(struct jz4740_mmc_host *host,
 656	struct mmc_command *cmd)
 657{
 658	int i;
 659	uint16_t tmp;
 660	void __iomem *fifo_addr = host->base + JZ_REG_MMC_RESP_FIFO;
 661
 662	if (cmd->flags & MMC_RSP_136) {
 663		tmp = readw(fifo_addr);
 664		for (i = 0; i < 4; ++i) {
 665			cmd->resp[i] = tmp << 24;
 666			tmp = readw(fifo_addr);
 667			cmd->resp[i] |= tmp << 8;
 668			tmp = readw(fifo_addr);
 669			cmd->resp[i] |= tmp >> 8;
 670		}
 671	} else {
 672		cmd->resp[0] = readw(fifo_addr) << 24;
 673		cmd->resp[0] |= readw(fifo_addr) << 8;
 674		cmd->resp[0] |= readw(fifo_addr) & 0xff;
 675	}
 676}
 677
 678static void jz4740_mmc_send_command(struct jz4740_mmc_host *host,
 679	struct mmc_command *cmd)
 680{
 681	uint32_t cmdat = host->cmdat;
 682
 683	host->cmdat &= ~JZ_MMC_CMDAT_INIT;
 684	jz4740_mmc_clock_disable(host);
 685
 686	host->cmd = cmd;
 687
 688	if (cmd->flags & MMC_RSP_BUSY)
 689		cmdat |= JZ_MMC_CMDAT_BUSY;
 690
 691	switch (mmc_resp_type(cmd)) {
 692	case MMC_RSP_R1B:
 693	case MMC_RSP_R1:
 694		cmdat |= JZ_MMC_CMDAT_RSP_R1;
 695		break;
 696	case MMC_RSP_R2:
 697		cmdat |= JZ_MMC_CMDAT_RSP_R2;
 698		break;
 699	case MMC_RSP_R3:
 700		cmdat |= JZ_MMC_CMDAT_RSP_R3;
 701		break;
 702	default:
 703		break;
 704	}
 705
 706	if (cmd->data) {
 707		cmdat |= JZ_MMC_CMDAT_DATA_EN;
 708		if (cmd->data->flags & MMC_DATA_WRITE)
 709			cmdat |= JZ_MMC_CMDAT_WRITE;
 710		if (host->use_dma) {
 711			/*
 712			 * The JZ4780's MMC controller has integrated DMA ability
 713			 * in addition to being able to use the external DMA
 714			 * controller. It moves DMA control bits to a separate
 715			 * register. The DMA_SEL bit chooses the external
 716			 * controller over the integrated one. Earlier SoCs
 717			 * can only use the external controller, and have a
 718			 * single DMA enable bit in CMDAT.
 719			 */
 720			if (host->version >= JZ_MMC_JZ4780) {
 721				writel(JZ_MMC_DMAC_DMA_EN | JZ_MMC_DMAC_DMA_SEL,
 722				       host->base + JZ_REG_MMC_DMAC);
 723			} else {
 724				cmdat |= JZ_MMC_CMDAT_DMA_EN;
 725			}
 726		} else if (host->version >= JZ_MMC_JZ4780) {
 727			writel(0, host->base + JZ_REG_MMC_DMAC);
 728		}
 729
 730		writew(cmd->data->blksz, host->base + JZ_REG_MMC_BLKLEN);
 731		writew(cmd->data->blocks, host->base + JZ_REG_MMC_NOB);
 732	}
 733
 734	writeb(cmd->opcode, host->base + JZ_REG_MMC_CMD);
 735	writel(cmd->arg, host->base + JZ_REG_MMC_ARG);
 736	writel(cmdat, host->base + JZ_REG_MMC_CMDAT);
 737
 738	jz4740_mmc_clock_enable(host, 1);
 739}
 740
 741static void jz_mmc_prepare_data_transfer(struct jz4740_mmc_host *host)
 742{
 743	struct mmc_command *cmd = host->req->cmd;
 744	struct mmc_data *data = cmd->data;
 745	int direction;
 746
 747	if (data->flags & MMC_DATA_READ)
 748		direction = SG_MITER_TO_SG;
 749	else
 750		direction = SG_MITER_FROM_SG;
 751
 752	sg_miter_start(&host->miter, data->sg, data->sg_len, direction);
 753}
 754
 755
 756static irqreturn_t jz_mmc_irq_worker(int irq, void *devid)
 757{
 758	struct jz4740_mmc_host *host = (struct jz4740_mmc_host *)devid;
 759	struct mmc_command *cmd = host->req->cmd;
 760	struct mmc_request *req = host->req;
 761	struct mmc_data *data = cmd->data;
 762	bool timeout = false;
 763
 764	if (cmd->error)
 765		host->state = JZ4740_MMC_STATE_DONE;
 766
 767	switch (host->state) {
 768	case JZ4740_MMC_STATE_READ_RESPONSE:
 769		if (cmd->flags & MMC_RSP_PRESENT)
 770			jz4740_mmc_read_response(host, cmd);
 771
 772		if (!data)
 773			break;
 774
 775		jz_mmc_prepare_data_transfer(host);
 776		fallthrough;
 777
 778	case JZ4740_MMC_STATE_TRANSFER_DATA:
 779		if (host->use_dma) {
 780			/* Use DMA if enabled.
 781			 * Data transfer direction is defined later by
 782			 * relying on data flags in
 783			 * jz4740_mmc_prepare_dma_data() and
 784			 * jz4740_mmc_start_dma_transfer().
 785			 */
 786			timeout = jz4740_mmc_start_dma_transfer(host, data);
 787			data->bytes_xfered = data->blocks * data->blksz;
 788		} else if (data->flags & MMC_DATA_READ)
 789			/* Use PIO if DMA is not enabled.
 790			 * Data transfer direction was defined before
 791			 * by relying on data flags in
 792			 * jz_mmc_prepare_data_transfer().
 793			 */
 794			timeout = jz4740_mmc_read_data(host, data);
 795		else
 796			timeout = jz4740_mmc_write_data(host, data);
 797
 798		if (unlikely(timeout)) {
 799			host->state = JZ4740_MMC_STATE_TRANSFER_DATA;
 800			break;
 801		}
 802
 803		jz4740_mmc_transfer_check_state(host, data);
 804
 805		timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_DATA_TRAN_DONE);
 806		if (unlikely(timeout)) {
 807			host->state = JZ4740_MMC_STATE_SEND_STOP;
 808			break;
 809		}
 810		jz4740_mmc_write_irq_reg(host, JZ_MMC_IRQ_DATA_TRAN_DONE);
 811		fallthrough;
 812
 813	case JZ4740_MMC_STATE_SEND_STOP:
 814		if (!req->stop)
 815			break;
 816
 817		jz4740_mmc_send_command(host, req->stop);
 818
 819		if (mmc_resp_type(req->stop) & MMC_RSP_BUSY) {
 820			timeout = jz4740_mmc_poll_irq(host,
 821						      JZ_MMC_IRQ_PRG_DONE);
 822			if (timeout) {
 823				host->state = JZ4740_MMC_STATE_DONE;
 824				break;
 825			}
 826		}
 827		fallthrough;
 828
 829	case JZ4740_MMC_STATE_DONE:
 830		break;
 831	}
 832
 833	if (!timeout)
 834		jz4740_mmc_request_done(host);
 835
 836	return IRQ_HANDLED;
 837}
 838
 839static irqreturn_t jz_mmc_irq(int irq, void *devid)
 840{
 841	struct jz4740_mmc_host *host = devid;
 842	struct mmc_command *cmd = host->cmd;
 843	uint32_t irq_reg, status, tmp;
 844
 845	status = readl(host->base + JZ_REG_MMC_STATUS);
 846	irq_reg = jz4740_mmc_read_irq_reg(host);
 847
 848	tmp = irq_reg;
 849	irq_reg &= ~host->irq_mask;
 850
 851	tmp &= ~(JZ_MMC_IRQ_TXFIFO_WR_REQ | JZ_MMC_IRQ_RXFIFO_RD_REQ |
 852		JZ_MMC_IRQ_PRG_DONE | JZ_MMC_IRQ_DATA_TRAN_DONE);
 853
 854	if (tmp != irq_reg)
 855		jz4740_mmc_write_irq_reg(host, tmp & ~irq_reg);
 856
 857	if (irq_reg & JZ_MMC_IRQ_SDIO) {
 858		jz4740_mmc_write_irq_reg(host, JZ_MMC_IRQ_SDIO);
 859		mmc_signal_sdio_irq(host->mmc);
 860		irq_reg &= ~JZ_MMC_IRQ_SDIO;
 861	}
 862
 863	if (host->req && cmd && irq_reg) {
 864		if (test_and_clear_bit(0, &host->waiting)) {
 865			del_timer(&host->timeout_timer);
 866
 867			if (status & JZ_MMC_STATUS_TIMEOUT_RES) {
 868				cmd->error = -ETIMEDOUT;
 869			} else if (status & JZ_MMC_STATUS_CRC_RES_ERR) {
 870				cmd->error = -EIO;
 871			} else if (status & (JZ_MMC_STATUS_CRC_READ_ERROR |
 872				    JZ_MMC_STATUS_CRC_WRITE_ERROR)) {
 873				if (cmd->data)
 874					cmd->data->error = -EIO;
 875				cmd->error = -EIO;
 876			}
 877
 878			jz4740_mmc_set_irq_enabled(host, irq_reg, false);
 879			jz4740_mmc_write_irq_reg(host, irq_reg);
 880
 881			return IRQ_WAKE_THREAD;
 882		}
 883	}
 884
 885	return IRQ_HANDLED;
 886}
 887
 888static int jz4740_mmc_set_clock_rate(struct jz4740_mmc_host *host, int rate)
 889{
 890	int div = 0;
 891	int real_rate;
 892
 893	jz4740_mmc_clock_disable(host);
 894	clk_set_rate(host->clk, host->mmc->f_max);
 895
 896	real_rate = clk_get_rate(host->clk);
 897
 898	while (real_rate > rate && div < 7) {
 899		++div;
 900		real_rate >>= 1;
 901	}
 902
 903	writew(div, host->base + JZ_REG_MMC_CLKRT);
 904
 905	if (real_rate > 25000000) {
 906		if (host->version >= JZ_MMC_JZ4780) {
 907			writel(JZ_MMC_LPM_DRV_RISING_QTR_PHASE_DLY |
 908				   JZ_MMC_LPM_SMP_RISING_QTR_OR_HALF_PHASE_DLY |
 909				   JZ_MMC_LPM_LOW_POWER_MODE_EN,
 910				   host->base + JZ_REG_MMC_LPM);
 911		} else if (host->version >= JZ_MMC_JZ4760) {
 912			writel(JZ_MMC_LPM_DRV_RISING |
 913				   JZ_MMC_LPM_LOW_POWER_MODE_EN,
 914				   host->base + JZ_REG_MMC_LPM);
 915		} else if (host->version >= JZ_MMC_JZ4725B)
 916			writel(JZ_MMC_LPM_LOW_POWER_MODE_EN,
 917				   host->base + JZ_REG_MMC_LPM);
 918	}
 919
 920	return real_rate;
 921}
 922
 923static void jz4740_mmc_request(struct mmc_host *mmc, struct mmc_request *req)
 924{
 925	struct jz4740_mmc_host *host = mmc_priv(mmc);
 926
 927	host->req = req;
 928
 929	jz4740_mmc_write_irq_reg(host, ~0);
 930	jz4740_mmc_set_irq_enabled(host, JZ_MMC_IRQ_END_CMD_RES, true);
 931
 932	host->state = JZ4740_MMC_STATE_READ_RESPONSE;
 933	set_bit(0, &host->waiting);
 934	mod_timer(&host->timeout_timer,
 935		  jiffies + msecs_to_jiffies(JZ_MMC_REQ_TIMEOUT_MS));
 936	jz4740_mmc_send_command(host, req->cmd);
 937}
 938
 939static void jz4740_mmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
 940{
 941	struct jz4740_mmc_host *host = mmc_priv(mmc);
 942	int ret;
 943
 944	if (ios->clock)
 945		jz4740_mmc_set_clock_rate(host, ios->clock);
 946
 947	switch (ios->power_mode) {
 948	case MMC_POWER_UP:
 949		jz4740_mmc_reset(host);
 950		if (!IS_ERR(mmc->supply.vmmc))
 951			mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, ios->vdd);
 952		host->cmdat |= JZ_MMC_CMDAT_INIT;
 953		clk_prepare_enable(host->clk);
 954		break;
 955	case MMC_POWER_ON:
 956		if (!IS_ERR(mmc->supply.vqmmc) && !host->vqmmc_enabled) {
 957			ret = regulator_enable(mmc->supply.vqmmc);
 958			if (ret)
 959				dev_err(&host->pdev->dev, "Failed to set vqmmc power!\n");
 960			else
 961				host->vqmmc_enabled = true;
 962		}
 963		break;
 964	case MMC_POWER_OFF:
 965		if (!IS_ERR(mmc->supply.vmmc))
 966			mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
 967		if (!IS_ERR(mmc->supply.vqmmc) && host->vqmmc_enabled) {
 968			regulator_disable(mmc->supply.vqmmc);
 969			host->vqmmc_enabled = false;
 970		}
 971		clk_disable_unprepare(host->clk);
 972		break;
 973	default:
 974		break;
 975	}
 976
 977	switch (ios->bus_width) {
 978	case MMC_BUS_WIDTH_1:
 979		host->cmdat &= ~JZ_MMC_CMDAT_BUS_WIDTH_MASK;
 980		break;
 981	case MMC_BUS_WIDTH_4:
 982		host->cmdat &= ~JZ_MMC_CMDAT_BUS_WIDTH_MASK;
 983		host->cmdat |= JZ_MMC_CMDAT_BUS_WIDTH_4BIT;
 984		break;
 985	case MMC_BUS_WIDTH_8:
 986		host->cmdat &= ~JZ_MMC_CMDAT_BUS_WIDTH_MASK;
 987		host->cmdat |= JZ_MMC_CMDAT_BUS_WIDTH_8BIT;
 988		break;
 989	default:
 990		break;
 991	}
 992}
 993
 994static void jz4740_mmc_enable_sdio_irq(struct mmc_host *mmc, int enable)
 995{
 996	struct jz4740_mmc_host *host = mmc_priv(mmc);
 997	jz4740_mmc_set_irq_enabled(host, JZ_MMC_IRQ_SDIO, enable);
 998}
 999
1000static int jz4740_voltage_switch(struct mmc_host *mmc, struct mmc_ios *ios)
1001{
1002	int ret;
1003
1004	/* vqmmc regulator is available */
1005	if (!IS_ERR(mmc->supply.vqmmc)) {
1006		ret = mmc_regulator_set_vqmmc(mmc, ios);
1007		return ret < 0 ? ret : 0;
1008	}
1009
1010	/* no vqmmc regulator, assume fixed regulator at 3/3.3V */
1011	if (ios->signal_voltage == MMC_SIGNAL_VOLTAGE_330)
1012		return 0;
1013
1014	return -EINVAL;
1015}
1016
1017static const struct mmc_host_ops jz4740_mmc_ops = {
1018	.request	= jz4740_mmc_request,
1019	.pre_req	= jz4740_mmc_pre_request,
1020	.post_req	= jz4740_mmc_post_request,
1021	.set_ios	= jz4740_mmc_set_ios,
1022	.get_ro		= mmc_gpio_get_ro,
1023	.get_cd		= mmc_gpio_get_cd,
1024	.enable_sdio_irq = jz4740_mmc_enable_sdio_irq,
1025	.start_signal_voltage_switch = jz4740_voltage_switch,
1026};
1027
1028static const struct of_device_id jz4740_mmc_of_match[] = {
1029	{ .compatible = "ingenic,jz4740-mmc", .data = (void *) JZ_MMC_JZ4740 },
1030	{ .compatible = "ingenic,jz4725b-mmc", .data = (void *)JZ_MMC_JZ4725B },
1031	{ .compatible = "ingenic,jz4760-mmc", .data = (void *) JZ_MMC_JZ4760 },
1032	{ .compatible = "ingenic,jz4775-mmc", .data = (void *) JZ_MMC_JZ4780 },
1033	{ .compatible = "ingenic,jz4780-mmc", .data = (void *) JZ_MMC_JZ4780 },
1034	{ .compatible = "ingenic,x1000-mmc", .data = (void *) JZ_MMC_X1000 },
1035	{},
1036};
1037MODULE_DEVICE_TABLE(of, jz4740_mmc_of_match);
1038
1039static int jz4740_mmc_probe(struct platform_device* pdev)
1040{
1041	int ret;
1042	struct mmc_host *mmc;
1043	struct jz4740_mmc_host *host;
 
1044
1045	mmc = mmc_alloc_host(sizeof(struct jz4740_mmc_host), &pdev->dev);
1046	if (!mmc) {
1047		dev_err(&pdev->dev, "Failed to alloc mmc host structure\n");
1048		return -ENOMEM;
1049	}
1050
1051	host = mmc_priv(mmc);
1052
1053	/* Default if no match is JZ4740 */
1054	host->version = (enum jz4740_mmc_version)device_get_match_data(&pdev->dev);
 
 
 
 
 
1055
1056	ret = mmc_of_parse(mmc);
1057	if (ret) {
1058		dev_err_probe(&pdev->dev, ret, "could not parse device properties\n");
1059		goto err_free_host;
1060	}
1061
1062	mmc_regulator_get_supply(mmc);
1063
1064	host->irq = platform_get_irq(pdev, 0);
1065	if (host->irq < 0) {
1066		ret = host->irq;
1067		goto err_free_host;
1068	}
1069
1070	host->clk = devm_clk_get(&pdev->dev, "mmc");
1071	if (IS_ERR(host->clk)) {
1072		ret = PTR_ERR(host->clk);
1073		dev_err(&pdev->dev, "Failed to get mmc clock\n");
1074		goto err_free_host;
1075	}
1076
1077	host->base = devm_platform_get_and_ioremap_resource(pdev, 0, &host->mem_res);
 
1078	if (IS_ERR(host->base)) {
1079		ret = PTR_ERR(host->base);
1080		goto err_free_host;
1081	}
1082
1083	mmc->ops = &jz4740_mmc_ops;
1084	if (!mmc->f_max)
1085		mmc->f_max = JZ_MMC_CLK_RATE;
1086
1087	/*
1088	 * There seems to be a problem with this driver on the JZ4760 and
1089	 * JZ4760B SoCs. There, when using the maximum rate supported (50 MHz),
1090	 * the communication fails with many SD cards.
1091	 * Until this bug is sorted out, limit the maximum rate to 24 MHz.
1092	 */
1093	if (host->version == JZ_MMC_JZ4760 && mmc->f_max > JZ_MMC_CLK_RATE)
1094		mmc->f_max = JZ_MMC_CLK_RATE;
1095
1096	mmc->f_min = mmc->f_max / 128;
1097	mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
1098
1099	/*
1100	 * We use a fixed timeout of 5s, hence inform the core about it. A
1101	 * future improvement should instead respect the cmd->busy_timeout.
1102	 */
1103	mmc->max_busy_timeout = JZ_MMC_REQ_TIMEOUT_MS;
1104
1105	mmc->max_blk_size = (1 << 10) - 1;
1106	mmc->max_blk_count = (1 << 15) - 1;
1107	mmc->max_req_size = mmc->max_blk_size * mmc->max_blk_count;
1108
1109	mmc->max_segs = 128;
1110	mmc->max_seg_size = mmc->max_req_size;
1111
1112	host->mmc = mmc;
1113	host->pdev = pdev;
1114	spin_lock_init(&host->lock);
1115	host->irq_mask = ~0;
1116
1117	jz4740_mmc_reset(host);
1118
1119	ret = request_threaded_irq(host->irq, jz_mmc_irq, jz_mmc_irq_worker, 0,
1120			dev_name(&pdev->dev), host);
1121	if (ret) {
1122		dev_err(&pdev->dev, "Failed to request irq: %d\n", ret);
1123		goto err_free_host;
1124	}
1125
1126	jz4740_mmc_clock_disable(host);
1127	timer_setup(&host->timeout_timer, jz4740_mmc_timeout, 0);
1128
1129	ret = jz4740_mmc_acquire_dma_channels(host);
1130	if (ret == -EPROBE_DEFER)
1131		goto err_free_irq;
1132	host->use_dma = !ret;
1133
1134	platform_set_drvdata(pdev, host);
1135	ret = mmc_add_host(mmc);
1136
1137	if (ret) {
1138		dev_err(&pdev->dev, "Failed to add mmc host: %d\n", ret);
1139		goto err_release_dma;
1140	}
1141	dev_info(&pdev->dev, "Ingenic SD/MMC card driver registered\n");
1142
1143	dev_info(&pdev->dev, "Using %s, %d-bit mode\n",
1144		 host->use_dma ? "DMA" : "PIO",
1145		 (mmc->caps & MMC_CAP_8_BIT_DATA) ? 8 :
1146		 ((mmc->caps & MMC_CAP_4_BIT_DATA) ? 4 : 1));
1147
1148	return 0;
1149
1150err_release_dma:
1151	if (host->use_dma)
1152		jz4740_mmc_release_dma_channels(host);
1153err_free_irq:
1154	free_irq(host->irq, host);
1155err_free_host:
1156	mmc_free_host(mmc);
1157
1158	return ret;
1159}
1160
1161static void jz4740_mmc_remove(struct platform_device *pdev)
1162{
1163	struct jz4740_mmc_host *host = platform_get_drvdata(pdev);
1164
1165	del_timer_sync(&host->timeout_timer);
1166	jz4740_mmc_set_irq_enabled(host, 0xff, false);
1167	jz4740_mmc_reset(host);
1168
1169	mmc_remove_host(host->mmc);
1170
1171	free_irq(host->irq, host);
1172
1173	if (host->use_dma)
1174		jz4740_mmc_release_dma_channels(host);
1175
1176	mmc_free_host(host->mmc);
 
 
1177}
1178
1179static int jz4740_mmc_suspend(struct device *dev)
1180{
1181	return pinctrl_pm_select_sleep_state(dev);
1182}
1183
1184static int jz4740_mmc_resume(struct device *dev)
1185{
1186	return pinctrl_select_default_state(dev);
1187}
1188
1189static DEFINE_SIMPLE_DEV_PM_OPS(jz4740_mmc_pm_ops, jz4740_mmc_suspend,
1190				jz4740_mmc_resume);
1191
1192static struct platform_driver jz4740_mmc_driver = {
1193	.probe = jz4740_mmc_probe,
1194	.remove_new = jz4740_mmc_remove,
1195	.driver = {
1196		.name = "jz4740-mmc",
1197		.probe_type = PROBE_PREFER_ASYNCHRONOUS,
1198		.of_match_table = jz4740_mmc_of_match,
1199		.pm = pm_sleep_ptr(&jz4740_mmc_pm_ops),
1200	},
1201};
1202
1203module_platform_driver(jz4740_mmc_driver);
1204
1205MODULE_DESCRIPTION("JZ4740 SD/MMC controller driver");
1206MODULE_LICENSE("GPL");
1207MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");