Linux Audio

Check our new training course

Yocto / OpenEmbedded training

Mar 24-27, 2025, special US time zones
Register
Loading...
v6.8
   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>");
v5.14.15
   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	dma_release_channel(host->dma_rx);
 
 221}
 222
 223static int jz4740_mmc_acquire_dma_channels(struct jz4740_mmc_host *host)
 224{
 
 
 
 
 
 
 
 
 
 
 
 225	host->dma_tx = dma_request_chan(mmc_dev(host->mmc), "tx");
 226	if (IS_ERR(host->dma_tx)) {
 227		dev_err(mmc_dev(host->mmc), "Failed to get dma_tx channel\n");
 228		return PTR_ERR(host->dma_tx);
 229	}
 230
 231	host->dma_rx = dma_request_chan(mmc_dev(host->mmc), "rx");
 232	if (IS_ERR(host->dma_rx)) {
 233		dev_err(mmc_dev(host->mmc), "Failed to get dma_rx channel\n");
 234		dma_release_channel(host->dma_tx);
 235		return PTR_ERR(host->dma_rx);
 236	}
 237
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 238	return 0;
 239}
 240
 241static inline struct dma_chan *jz4740_mmc_get_dma_chan(struct jz4740_mmc_host *host,
 242						       struct mmc_data *data)
 243{
 244	return (data->flags & MMC_DATA_READ) ? host->dma_rx : host->dma_tx;
 
 
 
 245}
 246
 247static void jz4740_mmc_dma_unmap(struct jz4740_mmc_host *host,
 248				 struct mmc_data *data)
 249{
 250	struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 251	enum dma_data_direction dir = mmc_get_dma_dir(data);
 252
 253	dma_unmap_sg(chan->device->dev, data->sg, data->sg_len, dir);
 254	data->host_cookie = COOKIE_UNMAPPED;
 255}
 256
 257/* Prepares DMA data for current or next transfer.
 258 * A request can be in-flight when this is called.
 259 */
 260static int jz4740_mmc_prepare_dma_data(struct jz4740_mmc_host *host,
 261				       struct mmc_data *data,
 262				       int cookie)
 263{
 264	struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 265	enum dma_data_direction dir = mmc_get_dma_dir(data);
 266	int sg_count;
 267
 268	if (data->host_cookie == COOKIE_PREMAPPED)
 269		return data->sg_count;
 270
 271	sg_count = dma_map_sg(chan->device->dev,
 272			data->sg,
 273			data->sg_len,
 274			dir);
 275
 276	if (sg_count <= 0) {
 277		dev_err(mmc_dev(host->mmc),
 278			"Failed to map scatterlist for DMA operation\n");
 279		return -EINVAL;
 280	}
 281
 282	data->sg_count = sg_count;
 283	data->host_cookie = cookie;
 284
 285	return data->sg_count;
 286}
 287
 288static int jz4740_mmc_start_dma_transfer(struct jz4740_mmc_host *host,
 289					 struct mmc_data *data)
 290{
 291	struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 292	struct dma_async_tx_descriptor *desc;
 293	struct dma_slave_config conf = {
 294		.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES,
 295		.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES,
 296		.src_maxburst = JZ4740_MMC_FIFO_HALF_SIZE,
 297		.dst_maxburst = JZ4740_MMC_FIFO_HALF_SIZE,
 298	};
 299	int sg_count;
 300
 301	if (data->flags & MMC_DATA_WRITE) {
 302		conf.direction = DMA_MEM_TO_DEV;
 303		conf.dst_addr = host->mem_res->start + JZ_REG_MMC_TXFIFO;
 304	} else {
 305		conf.direction = DMA_DEV_TO_MEM;
 306		conf.src_addr = host->mem_res->start + JZ_REG_MMC_RXFIFO;
 307	}
 308
 309	sg_count = jz4740_mmc_prepare_dma_data(host, data, COOKIE_MAPPED);
 310	if (sg_count < 0)
 311		return sg_count;
 312
 313	dmaengine_slave_config(chan, &conf);
 314	desc = dmaengine_prep_slave_sg(chan, data->sg, sg_count,
 315			conf.direction,
 316			DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
 317	if (!desc) {
 318		dev_err(mmc_dev(host->mmc),
 319			"Failed to allocate DMA %s descriptor",
 320			 conf.direction == DMA_MEM_TO_DEV ? "TX" : "RX");
 321		goto dma_unmap;
 322	}
 323
 324	dmaengine_submit(desc);
 325	dma_async_issue_pending(chan);
 326
 327	return 0;
 328
 329dma_unmap:
 330	if (data->host_cookie == COOKIE_MAPPED)
 331		jz4740_mmc_dma_unmap(host, data);
 332	return -ENOMEM;
 333}
 334
 335static void jz4740_mmc_pre_request(struct mmc_host *mmc,
 336				   struct mmc_request *mrq)
 337{
 338	struct jz4740_mmc_host *host = mmc_priv(mmc);
 339	struct mmc_data *data = mrq->data;
 340
 341	if (!host->use_dma)
 342		return;
 343
 344	data->host_cookie = COOKIE_UNMAPPED;
 345	if (jz4740_mmc_prepare_dma_data(host, data, COOKIE_PREMAPPED) < 0)
 346		data->host_cookie = COOKIE_UNMAPPED;
 347}
 348
 349static void jz4740_mmc_post_request(struct mmc_host *mmc,
 350				    struct mmc_request *mrq,
 351				    int err)
 352{
 353	struct jz4740_mmc_host *host = mmc_priv(mmc);
 354	struct mmc_data *data = mrq->data;
 355
 356	if (data && data->host_cookie != COOKIE_UNMAPPED)
 357		jz4740_mmc_dma_unmap(host, data);
 358
 359	if (err) {
 360		struct dma_chan *chan = jz4740_mmc_get_dma_chan(host, data);
 361
 362		dmaengine_terminate_all(chan);
 363	}
 364}
 365
 366/*----------------------------------------------------------------------------*/
 367
 368static void jz4740_mmc_set_irq_enabled(struct jz4740_mmc_host *host,
 369	unsigned int irq, bool enabled)
 370{
 371	unsigned long flags;
 372
 373	spin_lock_irqsave(&host->lock, flags);
 374	if (enabled)
 375		host->irq_mask &= ~irq;
 376	else
 377		host->irq_mask |= irq;
 378
 379	jz4740_mmc_write_irq_mask(host, host->irq_mask);
 380	spin_unlock_irqrestore(&host->lock, flags);
 381}
 382
 383static void jz4740_mmc_clock_enable(struct jz4740_mmc_host *host,
 384	bool start_transfer)
 385{
 386	uint16_t val = JZ_MMC_STRPCL_CLOCK_START;
 387
 388	if (start_transfer)
 389		val |= JZ_MMC_STRPCL_START_OP;
 390
 391	writew(val, host->base + JZ_REG_MMC_STRPCL);
 392}
 393
 394static void jz4740_mmc_clock_disable(struct jz4740_mmc_host *host)
 395{
 396	uint32_t status;
 397	unsigned int timeout = 1000;
 398
 399	writew(JZ_MMC_STRPCL_CLOCK_STOP, host->base + JZ_REG_MMC_STRPCL);
 400	do {
 401		status = readl(host->base + JZ_REG_MMC_STATUS);
 402	} while (status & JZ_MMC_STATUS_CLK_EN && --timeout);
 403}
 404
 405static void jz4740_mmc_reset(struct jz4740_mmc_host *host)
 406{
 407	uint32_t status;
 408	unsigned int timeout = 1000;
 409
 410	writew(JZ_MMC_STRPCL_RESET, host->base + JZ_REG_MMC_STRPCL);
 411	udelay(10);
 412	do {
 413		status = readl(host->base + JZ_REG_MMC_STATUS);
 414	} while (status & JZ_MMC_STATUS_IS_RESETTING && --timeout);
 415}
 416
 417static void jz4740_mmc_request_done(struct jz4740_mmc_host *host)
 418{
 419	struct mmc_request *req;
 420	struct mmc_data *data;
 421
 422	req = host->req;
 423	data = req->data;
 424	host->req = NULL;
 425
 426	if (data && data->host_cookie == COOKIE_MAPPED)
 427		jz4740_mmc_dma_unmap(host, data);
 428	mmc_request_done(host->mmc, req);
 429}
 430
 431static unsigned int jz4740_mmc_poll_irq(struct jz4740_mmc_host *host,
 432	unsigned int irq)
 433{
 434	unsigned int timeout = 0x800;
 435	uint32_t status;
 436
 437	do {
 438		status = jz4740_mmc_read_irq_reg(host);
 439	} while (!(status & irq) && --timeout);
 440
 441	if (timeout == 0) {
 442		set_bit(0, &host->waiting);
 443		mod_timer(&host->timeout_timer,
 444			  jiffies + msecs_to_jiffies(JZ_MMC_REQ_TIMEOUT_MS));
 445		jz4740_mmc_set_irq_enabled(host, irq, true);
 446		return true;
 447	}
 448
 449	return false;
 450}
 451
 452static void jz4740_mmc_transfer_check_state(struct jz4740_mmc_host *host,
 453	struct mmc_data *data)
 454{
 455	int status;
 456
 457	status = readl(host->base + JZ_REG_MMC_STATUS);
 458	if (status & JZ_MMC_STATUS_WRITE_ERROR_MASK) {
 459		if (status & (JZ_MMC_STATUS_TIMEOUT_WRITE)) {
 460			host->req->cmd->error = -ETIMEDOUT;
 461			data->error = -ETIMEDOUT;
 462		} else {
 463			host->req->cmd->error = -EIO;
 464			data->error = -EIO;
 465		}
 466	} else if (status & JZ_MMC_STATUS_READ_ERROR_MASK) {
 467		if (status & (JZ_MMC_STATUS_TIMEOUT_READ)) {
 468			host->req->cmd->error = -ETIMEDOUT;
 469			data->error = -ETIMEDOUT;
 470		} else {
 471			host->req->cmd->error = -EIO;
 472			data->error = -EIO;
 473		}
 474	}
 475}
 476
 477static bool jz4740_mmc_write_data(struct jz4740_mmc_host *host,
 478	struct mmc_data *data)
 479{
 480	struct sg_mapping_iter *miter = &host->miter;
 481	void __iomem *fifo_addr = host->base + JZ_REG_MMC_TXFIFO;
 482	uint32_t *buf;
 483	bool timeout;
 484	size_t i, j;
 485
 486	while (sg_miter_next(miter)) {
 487		buf = miter->addr;
 488		i = miter->length / 4;
 489		j = i / 8;
 490		i = i & 0x7;
 491		while (j) {
 492			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_TXFIFO_WR_REQ);
 493			if (unlikely(timeout))
 494				goto poll_timeout;
 495
 496			writel(buf[0], fifo_addr);
 497			writel(buf[1], fifo_addr);
 498			writel(buf[2], fifo_addr);
 499			writel(buf[3], fifo_addr);
 500			writel(buf[4], fifo_addr);
 501			writel(buf[5], fifo_addr);
 502			writel(buf[6], fifo_addr);
 503			writel(buf[7], fifo_addr);
 504			buf += 8;
 505			--j;
 506		}
 507		if (unlikely(i)) {
 508			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_TXFIFO_WR_REQ);
 509			if (unlikely(timeout))
 510				goto poll_timeout;
 511
 512			while (i) {
 513				writel(*buf, fifo_addr);
 514				++buf;
 515				--i;
 516			}
 517		}
 518		data->bytes_xfered += miter->length;
 519	}
 520	sg_miter_stop(miter);
 521
 522	return false;
 523
 524poll_timeout:
 525	miter->consumed = (void *)buf - miter->addr;
 526	data->bytes_xfered += miter->consumed;
 527	sg_miter_stop(miter);
 528
 529	return true;
 530}
 531
 532static bool jz4740_mmc_read_data(struct jz4740_mmc_host *host,
 533				struct mmc_data *data)
 534{
 535	struct sg_mapping_iter *miter = &host->miter;
 536	void __iomem *fifo_addr = host->base + JZ_REG_MMC_RXFIFO;
 537	uint32_t *buf;
 538	uint32_t d;
 539	uint32_t status;
 540	size_t i, j;
 541	unsigned int timeout;
 542
 543	while (sg_miter_next(miter)) {
 544		buf = miter->addr;
 545		i = miter->length;
 546		j = i / 32;
 547		i = i & 0x1f;
 548		while (j) {
 549			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_RXFIFO_RD_REQ);
 550			if (unlikely(timeout))
 551				goto poll_timeout;
 552
 553			buf[0] = readl(fifo_addr);
 554			buf[1] = readl(fifo_addr);
 555			buf[2] = readl(fifo_addr);
 556			buf[3] = readl(fifo_addr);
 557			buf[4] = readl(fifo_addr);
 558			buf[5] = readl(fifo_addr);
 559			buf[6] = readl(fifo_addr);
 560			buf[7] = readl(fifo_addr);
 561
 562			buf += 8;
 563			--j;
 564		}
 565
 566		if (unlikely(i)) {
 567			timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_RXFIFO_RD_REQ);
 568			if (unlikely(timeout))
 569				goto poll_timeout;
 570
 571			while (i >= 4) {
 572				*buf++ = readl(fifo_addr);
 573				i -= 4;
 574			}
 575			if (unlikely(i > 0)) {
 576				d = readl(fifo_addr);
 577				memcpy(buf, &d, i);
 578			}
 579		}
 580		data->bytes_xfered += miter->length;
 581
 582		/* This can go away once MIPS implements
 583		 * flush_kernel_dcache_page */
 584		flush_dcache_page(miter->page);
 585	}
 586	sg_miter_stop(miter);
 587
 588	/* For whatever reason there is sometime one word more in the fifo then
 589	 * requested */
 590	timeout = 1000;
 591	status = readl(host->base + JZ_REG_MMC_STATUS);
 592	while (!(status & JZ_MMC_STATUS_DATA_FIFO_EMPTY) && --timeout) {
 593		d = readl(fifo_addr);
 594		status = readl(host->base + JZ_REG_MMC_STATUS);
 595	}
 596
 597	return false;
 598
 599poll_timeout:
 600	miter->consumed = (void *)buf - miter->addr;
 601	data->bytes_xfered += miter->consumed;
 602	sg_miter_stop(miter);
 603
 604	return true;
 605}
 606
 607static void jz4740_mmc_timeout(struct timer_list *t)
 608{
 609	struct jz4740_mmc_host *host = from_timer(host, t, timeout_timer);
 610
 611	if (!test_and_clear_bit(0, &host->waiting))
 612		return;
 613
 614	jz4740_mmc_set_irq_enabled(host, JZ_MMC_IRQ_END_CMD_RES, false);
 615
 616	host->req->cmd->error = -ETIMEDOUT;
 617	jz4740_mmc_request_done(host);
 618}
 619
 620static void jz4740_mmc_read_response(struct jz4740_mmc_host *host,
 621	struct mmc_command *cmd)
 622{
 623	int i;
 624	uint16_t tmp;
 625	void __iomem *fifo_addr = host->base + JZ_REG_MMC_RESP_FIFO;
 626
 627	if (cmd->flags & MMC_RSP_136) {
 628		tmp = readw(fifo_addr);
 629		for (i = 0; i < 4; ++i) {
 630			cmd->resp[i] = tmp << 24;
 631			tmp = readw(fifo_addr);
 632			cmd->resp[i] |= tmp << 8;
 633			tmp = readw(fifo_addr);
 634			cmd->resp[i] |= tmp >> 8;
 635		}
 636	} else {
 637		cmd->resp[0] = readw(fifo_addr) << 24;
 638		cmd->resp[0] |= readw(fifo_addr) << 8;
 639		cmd->resp[0] |= readw(fifo_addr) & 0xff;
 640	}
 641}
 642
 643static void jz4740_mmc_send_command(struct jz4740_mmc_host *host,
 644	struct mmc_command *cmd)
 645{
 646	uint32_t cmdat = host->cmdat;
 647
 648	host->cmdat &= ~JZ_MMC_CMDAT_INIT;
 649	jz4740_mmc_clock_disable(host);
 650
 651	host->cmd = cmd;
 652
 653	if (cmd->flags & MMC_RSP_BUSY)
 654		cmdat |= JZ_MMC_CMDAT_BUSY;
 655
 656	switch (mmc_resp_type(cmd)) {
 657	case MMC_RSP_R1B:
 658	case MMC_RSP_R1:
 659		cmdat |= JZ_MMC_CMDAT_RSP_R1;
 660		break;
 661	case MMC_RSP_R2:
 662		cmdat |= JZ_MMC_CMDAT_RSP_R2;
 663		break;
 664	case MMC_RSP_R3:
 665		cmdat |= JZ_MMC_CMDAT_RSP_R3;
 666		break;
 667	default:
 668		break;
 669	}
 670
 671	if (cmd->data) {
 672		cmdat |= JZ_MMC_CMDAT_DATA_EN;
 673		if (cmd->data->flags & MMC_DATA_WRITE)
 674			cmdat |= JZ_MMC_CMDAT_WRITE;
 675		if (host->use_dma) {
 676			/*
 677			 * The JZ4780's MMC controller has integrated DMA ability
 678			 * in addition to being able to use the external DMA
 679			 * controller. It moves DMA control bits to a separate
 680			 * register. The DMA_SEL bit chooses the external
 681			 * controller over the integrated one. Earlier SoCs
 682			 * can only use the external controller, and have a
 683			 * single DMA enable bit in CMDAT.
 684			 */
 685			if (host->version >= JZ_MMC_JZ4780) {
 686				writel(JZ_MMC_DMAC_DMA_EN | JZ_MMC_DMAC_DMA_SEL,
 687				       host->base + JZ_REG_MMC_DMAC);
 688			} else {
 689				cmdat |= JZ_MMC_CMDAT_DMA_EN;
 690			}
 691		} else if (host->version >= JZ_MMC_JZ4780) {
 692			writel(0, host->base + JZ_REG_MMC_DMAC);
 693		}
 694
 695		writew(cmd->data->blksz, host->base + JZ_REG_MMC_BLKLEN);
 696		writew(cmd->data->blocks, host->base + JZ_REG_MMC_NOB);
 697	}
 698
 699	writeb(cmd->opcode, host->base + JZ_REG_MMC_CMD);
 700	writel(cmd->arg, host->base + JZ_REG_MMC_ARG);
 701	writel(cmdat, host->base + JZ_REG_MMC_CMDAT);
 702
 703	jz4740_mmc_clock_enable(host, 1);
 704}
 705
 706static void jz_mmc_prepare_data_transfer(struct jz4740_mmc_host *host)
 707{
 708	struct mmc_command *cmd = host->req->cmd;
 709	struct mmc_data *data = cmd->data;
 710	int direction;
 711
 712	if (data->flags & MMC_DATA_READ)
 713		direction = SG_MITER_TO_SG;
 714	else
 715		direction = SG_MITER_FROM_SG;
 716
 717	sg_miter_start(&host->miter, data->sg, data->sg_len, direction);
 718}
 719
 720
 721static irqreturn_t jz_mmc_irq_worker(int irq, void *devid)
 722{
 723	struct jz4740_mmc_host *host = (struct jz4740_mmc_host *)devid;
 724	struct mmc_command *cmd = host->req->cmd;
 725	struct mmc_request *req = host->req;
 726	struct mmc_data *data = cmd->data;
 727	bool timeout = false;
 728
 729	if (cmd->error)
 730		host->state = JZ4740_MMC_STATE_DONE;
 731
 732	switch (host->state) {
 733	case JZ4740_MMC_STATE_READ_RESPONSE:
 734		if (cmd->flags & MMC_RSP_PRESENT)
 735			jz4740_mmc_read_response(host, cmd);
 736
 737		if (!data)
 738			break;
 739
 740		jz_mmc_prepare_data_transfer(host);
 741		fallthrough;
 742
 743	case JZ4740_MMC_STATE_TRANSFER_DATA:
 744		if (host->use_dma) {
 745			/* Use DMA if enabled.
 746			 * Data transfer direction is defined later by
 747			 * relying on data flags in
 748			 * jz4740_mmc_prepare_dma_data() and
 749			 * jz4740_mmc_start_dma_transfer().
 750			 */
 751			timeout = jz4740_mmc_start_dma_transfer(host, data);
 752			data->bytes_xfered = data->blocks * data->blksz;
 753		} else if (data->flags & MMC_DATA_READ)
 754			/* Use PIO if DMA is not enabled.
 755			 * Data transfer direction was defined before
 756			 * by relying on data flags in
 757			 * jz_mmc_prepare_data_transfer().
 758			 */
 759			timeout = jz4740_mmc_read_data(host, data);
 760		else
 761			timeout = jz4740_mmc_write_data(host, data);
 762
 763		if (unlikely(timeout)) {
 764			host->state = JZ4740_MMC_STATE_TRANSFER_DATA;
 765			break;
 766		}
 767
 768		jz4740_mmc_transfer_check_state(host, data);
 769
 770		timeout = jz4740_mmc_poll_irq(host, JZ_MMC_IRQ_DATA_TRAN_DONE);
 771		if (unlikely(timeout)) {
 772			host->state = JZ4740_MMC_STATE_SEND_STOP;
 773			break;
 774		}
 775		jz4740_mmc_write_irq_reg(host, JZ_MMC_IRQ_DATA_TRAN_DONE);
 776		fallthrough;
 777
 778	case JZ4740_MMC_STATE_SEND_STOP:
 779		if (!req->stop)
 780			break;
 781
 782		jz4740_mmc_send_command(host, req->stop);
 783
 784		if (mmc_resp_type(req->stop) & MMC_RSP_BUSY) {
 785			timeout = jz4740_mmc_poll_irq(host,
 786						      JZ_MMC_IRQ_PRG_DONE);
 787			if (timeout) {
 788				host->state = JZ4740_MMC_STATE_DONE;
 789				break;
 790			}
 791		}
 792		fallthrough;
 793
 794	case JZ4740_MMC_STATE_DONE:
 795		break;
 796	}
 797
 798	if (!timeout)
 799		jz4740_mmc_request_done(host);
 800
 801	return IRQ_HANDLED;
 802}
 803
 804static irqreturn_t jz_mmc_irq(int irq, void *devid)
 805{
 806	struct jz4740_mmc_host *host = devid;
 807	struct mmc_command *cmd = host->cmd;
 808	uint32_t irq_reg, status, tmp;
 809
 810	status = readl(host->base + JZ_REG_MMC_STATUS);
 811	irq_reg = jz4740_mmc_read_irq_reg(host);
 812
 813	tmp = irq_reg;
 814	irq_reg &= ~host->irq_mask;
 815
 816	tmp &= ~(JZ_MMC_IRQ_TXFIFO_WR_REQ | JZ_MMC_IRQ_RXFIFO_RD_REQ |
 817		JZ_MMC_IRQ_PRG_DONE | JZ_MMC_IRQ_DATA_TRAN_DONE);
 818
 819	if (tmp != irq_reg)
 820		jz4740_mmc_write_irq_reg(host, tmp & ~irq_reg);
 821
 822	if (irq_reg & JZ_MMC_IRQ_SDIO) {
 823		jz4740_mmc_write_irq_reg(host, JZ_MMC_IRQ_SDIO);
 824		mmc_signal_sdio_irq(host->mmc);
 825		irq_reg &= ~JZ_MMC_IRQ_SDIO;
 826	}
 827
 828	if (host->req && cmd && irq_reg) {
 829		if (test_and_clear_bit(0, &host->waiting)) {
 830			del_timer(&host->timeout_timer);
 831
 832			if (status & JZ_MMC_STATUS_TIMEOUT_RES) {
 833				cmd->error = -ETIMEDOUT;
 834			} else if (status & JZ_MMC_STATUS_CRC_RES_ERR) {
 835				cmd->error = -EIO;
 836			} else if (status & (JZ_MMC_STATUS_CRC_READ_ERROR |
 837				    JZ_MMC_STATUS_CRC_WRITE_ERROR)) {
 838				if (cmd->data)
 839					cmd->data->error = -EIO;
 840				cmd->error = -EIO;
 841			}
 842
 843			jz4740_mmc_set_irq_enabled(host, irq_reg, false);
 844			jz4740_mmc_write_irq_reg(host, irq_reg);
 845
 846			return IRQ_WAKE_THREAD;
 847		}
 848	}
 849
 850	return IRQ_HANDLED;
 851}
 852
 853static int jz4740_mmc_set_clock_rate(struct jz4740_mmc_host *host, int rate)
 854{
 855	int div = 0;
 856	int real_rate;
 857
 858	jz4740_mmc_clock_disable(host);
 859	clk_set_rate(host->clk, host->mmc->f_max);
 860
 861	real_rate = clk_get_rate(host->clk);
 862
 863	while (real_rate > rate && div < 7) {
 864		++div;
 865		real_rate >>= 1;
 866	}
 867
 868	writew(div, host->base + JZ_REG_MMC_CLKRT);
 869
 870	if (real_rate > 25000000) {
 871		if (host->version >= JZ_MMC_JZ4780) {
 872			writel(JZ_MMC_LPM_DRV_RISING_QTR_PHASE_DLY |
 873				   JZ_MMC_LPM_SMP_RISING_QTR_OR_HALF_PHASE_DLY |
 874				   JZ_MMC_LPM_LOW_POWER_MODE_EN,
 875				   host->base + JZ_REG_MMC_LPM);
 876		} else if (host->version >= JZ_MMC_JZ4760) {
 877			writel(JZ_MMC_LPM_DRV_RISING |
 878				   JZ_MMC_LPM_LOW_POWER_MODE_EN,
 879				   host->base + JZ_REG_MMC_LPM);
 880		} else if (host->version >= JZ_MMC_JZ4725B)
 881			writel(JZ_MMC_LPM_LOW_POWER_MODE_EN,
 882				   host->base + JZ_REG_MMC_LPM);
 883	}
 884
 885	return real_rate;
 886}
 887
 888static void jz4740_mmc_request(struct mmc_host *mmc, struct mmc_request *req)
 889{
 890	struct jz4740_mmc_host *host = mmc_priv(mmc);
 891
 892	host->req = req;
 893
 894	jz4740_mmc_write_irq_reg(host, ~0);
 895	jz4740_mmc_set_irq_enabled(host, JZ_MMC_IRQ_END_CMD_RES, true);
 896
 897	host->state = JZ4740_MMC_STATE_READ_RESPONSE;
 898	set_bit(0, &host->waiting);
 899	mod_timer(&host->timeout_timer,
 900		  jiffies + msecs_to_jiffies(JZ_MMC_REQ_TIMEOUT_MS));
 901	jz4740_mmc_send_command(host, req->cmd);
 902}
 903
 904static void jz4740_mmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
 905{
 906	struct jz4740_mmc_host *host = mmc_priv(mmc);
 
 
 907	if (ios->clock)
 908		jz4740_mmc_set_clock_rate(host, ios->clock);
 909
 910	switch (ios->power_mode) {
 911	case MMC_POWER_UP:
 912		jz4740_mmc_reset(host);
 913		if (!IS_ERR(mmc->supply.vmmc))
 914			mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, ios->vdd);
 915		host->cmdat |= JZ_MMC_CMDAT_INIT;
 916		clk_prepare_enable(host->clk);
 917		break;
 918	case MMC_POWER_ON:
 
 
 
 
 
 
 
 919		break;
 920	default:
 921		if (!IS_ERR(mmc->supply.vmmc))
 922			mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
 
 
 
 
 923		clk_disable_unprepare(host->clk);
 924		break;
 
 
 925	}
 926
 927	switch (ios->bus_width) {
 928	case MMC_BUS_WIDTH_1:
 929		host->cmdat &= ~JZ_MMC_CMDAT_BUS_WIDTH_MASK;
 930		break;
 931	case MMC_BUS_WIDTH_4:
 932		host->cmdat &= ~JZ_MMC_CMDAT_BUS_WIDTH_MASK;
 933		host->cmdat |= JZ_MMC_CMDAT_BUS_WIDTH_4BIT;
 934		break;
 935	case MMC_BUS_WIDTH_8:
 936		host->cmdat &= ~JZ_MMC_CMDAT_BUS_WIDTH_MASK;
 937		host->cmdat |= JZ_MMC_CMDAT_BUS_WIDTH_8BIT;
 938		break;
 939	default:
 940		break;
 941	}
 942}
 943
 944static void jz4740_mmc_enable_sdio_irq(struct mmc_host *mmc, int enable)
 945{
 946	struct jz4740_mmc_host *host = mmc_priv(mmc);
 947	jz4740_mmc_set_irq_enabled(host, JZ_MMC_IRQ_SDIO, enable);
 948}
 949
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 950static const struct mmc_host_ops jz4740_mmc_ops = {
 951	.request	= jz4740_mmc_request,
 952	.pre_req	= jz4740_mmc_pre_request,
 953	.post_req	= jz4740_mmc_post_request,
 954	.set_ios	= jz4740_mmc_set_ios,
 955	.get_ro		= mmc_gpio_get_ro,
 956	.get_cd		= mmc_gpio_get_cd,
 957	.enable_sdio_irq = jz4740_mmc_enable_sdio_irq,
 
 958};
 959
 960static const struct of_device_id jz4740_mmc_of_match[] = {
 961	{ .compatible = "ingenic,jz4740-mmc", .data = (void *) JZ_MMC_JZ4740 },
 962	{ .compatible = "ingenic,jz4725b-mmc", .data = (void *)JZ_MMC_JZ4725B },
 963	{ .compatible = "ingenic,jz4760-mmc", .data = (void *) JZ_MMC_JZ4760 },
 964	{ .compatible = "ingenic,jz4775-mmc", .data = (void *) JZ_MMC_JZ4780 },
 965	{ .compatible = "ingenic,jz4780-mmc", .data = (void *) JZ_MMC_JZ4780 },
 966	{ .compatible = "ingenic,x1000-mmc", .data = (void *) JZ_MMC_X1000 },
 967	{},
 968};
 969MODULE_DEVICE_TABLE(of, jz4740_mmc_of_match);
 970
 971static int jz4740_mmc_probe(struct platform_device* pdev)
 972{
 973	int ret;
 974	struct mmc_host *mmc;
 975	struct jz4740_mmc_host *host;
 976	const struct of_device_id *match;
 977
 978	mmc = mmc_alloc_host(sizeof(struct jz4740_mmc_host), &pdev->dev);
 979	if (!mmc) {
 980		dev_err(&pdev->dev, "Failed to alloc mmc host structure\n");
 981		return -ENOMEM;
 982	}
 983
 984	host = mmc_priv(mmc);
 985
 986	match = of_match_device(jz4740_mmc_of_match, &pdev->dev);
 987	if (match) {
 988		host->version = (enum jz4740_mmc_version)match->data;
 989	} else {
 990		/* JZ4740 should be the only one using legacy probe */
 991		host->version = JZ_MMC_JZ4740;
 992	}
 993
 994	ret = mmc_of_parse(mmc);
 995	if (ret) {
 996		dev_err_probe(&pdev->dev, ret, "could not parse device properties\n");
 997		goto err_free_host;
 998	}
 999
1000	mmc_regulator_get_supply(mmc);
1001
1002	host->irq = platform_get_irq(pdev, 0);
1003	if (host->irq < 0) {
1004		ret = host->irq;
1005		goto err_free_host;
1006	}
1007
1008	host->clk = devm_clk_get(&pdev->dev, "mmc");
1009	if (IS_ERR(host->clk)) {
1010		ret = PTR_ERR(host->clk);
1011		dev_err(&pdev->dev, "Failed to get mmc clock\n");
1012		goto err_free_host;
1013	}
1014
1015	host->mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1016	host->base = devm_ioremap_resource(&pdev->dev, host->mem_res);
1017	if (IS_ERR(host->base)) {
1018		ret = PTR_ERR(host->base);
1019		goto err_free_host;
1020	}
1021
1022	mmc->ops = &jz4740_mmc_ops;
1023	if (!mmc->f_max)
1024		mmc->f_max = JZ_MMC_CLK_RATE;
 
 
 
 
 
 
 
 
 
 
1025	mmc->f_min = mmc->f_max / 128;
1026	mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
1027
1028	/*
1029	 * We use a fixed timeout of 5s, hence inform the core about it. A
1030	 * future improvement should instead respect the cmd->busy_timeout.
1031	 */
1032	mmc->max_busy_timeout = JZ_MMC_REQ_TIMEOUT_MS;
1033
1034	mmc->max_blk_size = (1 << 10) - 1;
1035	mmc->max_blk_count = (1 << 15) - 1;
1036	mmc->max_req_size = mmc->max_blk_size * mmc->max_blk_count;
1037
1038	mmc->max_segs = 128;
1039	mmc->max_seg_size = mmc->max_req_size;
1040
1041	host->mmc = mmc;
1042	host->pdev = pdev;
1043	spin_lock_init(&host->lock);
1044	host->irq_mask = ~0;
1045
1046	jz4740_mmc_reset(host);
1047
1048	ret = request_threaded_irq(host->irq, jz_mmc_irq, jz_mmc_irq_worker, 0,
1049			dev_name(&pdev->dev), host);
1050	if (ret) {
1051		dev_err(&pdev->dev, "Failed to request irq: %d\n", ret);
1052		goto err_free_host;
1053	}
1054
1055	jz4740_mmc_clock_disable(host);
1056	timer_setup(&host->timeout_timer, jz4740_mmc_timeout, 0);
1057
1058	ret = jz4740_mmc_acquire_dma_channels(host);
1059	if (ret == -EPROBE_DEFER)
1060		goto err_free_irq;
1061	host->use_dma = !ret;
1062
1063	platform_set_drvdata(pdev, host);
1064	ret = mmc_add_host(mmc);
1065
1066	if (ret) {
1067		dev_err(&pdev->dev, "Failed to add mmc host: %d\n", ret);
1068		goto err_release_dma;
1069	}
1070	dev_info(&pdev->dev, "Ingenic SD/MMC card driver registered\n");
1071
1072	dev_info(&pdev->dev, "Using %s, %d-bit mode\n",
1073		 host->use_dma ? "DMA" : "PIO",
1074		 (mmc->caps & MMC_CAP_8_BIT_DATA) ? 8 :
1075		 ((mmc->caps & MMC_CAP_4_BIT_DATA) ? 4 : 1));
1076
1077	return 0;
1078
1079err_release_dma:
1080	if (host->use_dma)
1081		jz4740_mmc_release_dma_channels(host);
1082err_free_irq:
1083	free_irq(host->irq, host);
1084err_free_host:
1085	mmc_free_host(mmc);
1086
1087	return ret;
1088}
1089
1090static int jz4740_mmc_remove(struct platform_device *pdev)
1091{
1092	struct jz4740_mmc_host *host = platform_get_drvdata(pdev);
1093
1094	del_timer_sync(&host->timeout_timer);
1095	jz4740_mmc_set_irq_enabled(host, 0xff, false);
1096	jz4740_mmc_reset(host);
1097
1098	mmc_remove_host(host->mmc);
1099
1100	free_irq(host->irq, host);
1101
1102	if (host->use_dma)
1103		jz4740_mmc_release_dma_channels(host);
1104
1105	mmc_free_host(host->mmc);
1106
1107	return 0;
1108}
1109
1110static int __maybe_unused jz4740_mmc_suspend(struct device *dev)
1111{
1112	return pinctrl_pm_select_sleep_state(dev);
1113}
1114
1115static int __maybe_unused jz4740_mmc_resume(struct device *dev)
1116{
1117	return pinctrl_select_default_state(dev);
1118}
1119
1120static SIMPLE_DEV_PM_OPS(jz4740_mmc_pm_ops, jz4740_mmc_suspend,
1121	jz4740_mmc_resume);
1122
1123static struct platform_driver jz4740_mmc_driver = {
1124	.probe = jz4740_mmc_probe,
1125	.remove = jz4740_mmc_remove,
1126	.driver = {
1127		.name = "jz4740-mmc",
1128		.probe_type = PROBE_PREFER_ASYNCHRONOUS,
1129		.of_match_table = of_match_ptr(jz4740_mmc_of_match),
1130		.pm = pm_ptr(&jz4740_mmc_pm_ops),
1131	},
1132};
1133
1134module_platform_driver(jz4740_mmc_driver);
1135
1136MODULE_DESCRIPTION("JZ4740 SD/MMC controller driver");
1137MODULE_LICENSE("GPL");
1138MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");