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>");
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>");