sdhci.c 97.2 KB
Newer Older
1
/*
P
Pierre Ossman 已提交
2
 *  linux/drivers/mmc/host/sdhci.c - Secure Digital Host Controller Interface driver
3
 *
4
 *  Copyright (C) 2005-2008 Pierre Ossman, All Rights Reserved.
5 6
 *
 * This program is free software; you can redistribute it and/or modify
7 8 9
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or (at
 * your option) any later version.
10 11 12 13
 *
 * Thanks to the following companies for their support:
 *
 *     - JMicron (hardware and technical support)
14 15 16
 */

#include <linux/delay.h>
A
Adrian Hunter 已提交
17
#include <linux/ktime.h>
18
#include <linux/highmem.h>
19
#include <linux/io.h>
20
#include <linux/module.h>
21
#include <linux/dma-mapping.h>
22
#include <linux/slab.h>
23
#include <linux/scatterlist.h>
M
Marek Szyprowski 已提交
24
#include <linux/regulator/consumer.h>
25
#include <linux/pm_runtime.h>
26
#include <linux/of.h>
27

28 29
#include <linux/leds.h>

30
#include <linux/mmc/mmc.h>
31
#include <linux/mmc/host.h>
32
#include <linux/mmc/card.h>
33
#include <linux/mmc/sdio.h>
34
#include <linux/mmc/slot-gpio.h>
35 36 37 38 39 40

#include "sdhci.h"

#define DRIVER_NAME "sdhci"

#define DBG(f, x...) \
41
	pr_debug(DRIVER_NAME " [%s()]: " f, __func__,## x)
42

43 44
#define MAX_TUNING_LOOP 40

45
static unsigned int debug_quirks = 0;
46
static unsigned int debug_quirks2;
47

48 49
static void sdhci_finish_data(struct sdhci_host *);

50
static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable);
51 52 53

static void sdhci_dumpregs(struct sdhci_host *host)
{
54 55
	pr_err(DRIVER_NAME ": =========== REGISTER DUMP (%s)===========\n",
	       mmc_hostname(host->mmc));
56

57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91
	pr_err(DRIVER_NAME ": Sys addr: 0x%08x | Version:  0x%08x\n",
	       sdhci_readl(host, SDHCI_DMA_ADDRESS),
	       sdhci_readw(host, SDHCI_HOST_VERSION));
	pr_err(DRIVER_NAME ": Blk size: 0x%08x | Blk cnt:  0x%08x\n",
	       sdhci_readw(host, SDHCI_BLOCK_SIZE),
	       sdhci_readw(host, SDHCI_BLOCK_COUNT));
	pr_err(DRIVER_NAME ": Argument: 0x%08x | Trn mode: 0x%08x\n",
	       sdhci_readl(host, SDHCI_ARGUMENT),
	       sdhci_readw(host, SDHCI_TRANSFER_MODE));
	pr_err(DRIVER_NAME ": Present:  0x%08x | Host ctl: 0x%08x\n",
	       sdhci_readl(host, SDHCI_PRESENT_STATE),
	       sdhci_readb(host, SDHCI_HOST_CONTROL));
	pr_err(DRIVER_NAME ": Power:    0x%08x | Blk gap:  0x%08x\n",
	       sdhci_readb(host, SDHCI_POWER_CONTROL),
	       sdhci_readb(host, SDHCI_BLOCK_GAP_CONTROL));
	pr_err(DRIVER_NAME ": Wake-up:  0x%08x | Clock:    0x%08x\n",
	       sdhci_readb(host, SDHCI_WAKE_UP_CONTROL),
	       sdhci_readw(host, SDHCI_CLOCK_CONTROL));
	pr_err(DRIVER_NAME ": Timeout:  0x%08x | Int stat: 0x%08x\n",
	       sdhci_readb(host, SDHCI_TIMEOUT_CONTROL),
	       sdhci_readl(host, SDHCI_INT_STATUS));
	pr_err(DRIVER_NAME ": Int enab: 0x%08x | Sig enab: 0x%08x\n",
	       sdhci_readl(host, SDHCI_INT_ENABLE),
	       sdhci_readl(host, SDHCI_SIGNAL_ENABLE));
	pr_err(DRIVER_NAME ": AC12 err: 0x%08x | Slot int: 0x%08x\n",
	       sdhci_readw(host, SDHCI_ACMD12_ERR),
	       sdhci_readw(host, SDHCI_SLOT_INT_STATUS));
	pr_err(DRIVER_NAME ": Caps:     0x%08x | Caps_1:   0x%08x\n",
	       sdhci_readl(host, SDHCI_CAPABILITIES),
	       sdhci_readl(host, SDHCI_CAPABILITIES_1));
	pr_err(DRIVER_NAME ": Cmd:      0x%08x | Max curr: 0x%08x\n",
	       sdhci_readw(host, SDHCI_COMMAND),
	       sdhci_readl(host, SDHCI_MAX_CURRENT));
	pr_err(DRIVER_NAME ": Host ctl2: 0x%08x\n",
	       sdhci_readw(host, SDHCI_HOST_CONTROL2));
92

93 94
	if (host->flags & SDHCI_USE_ADMA) {
		if (host->flags & SDHCI_USE_64_BIT_DMA)
95 96 97 98
			pr_err(DRIVER_NAME ": ADMA Err: 0x%08x | ADMA Ptr: 0x%08x%08x\n",
			       readl(host->ioaddr + SDHCI_ADMA_ERROR),
			       readl(host->ioaddr + SDHCI_ADMA_ADDRESS_HI),
			       readl(host->ioaddr + SDHCI_ADMA_ADDRESS));
99
		else
100 101 102
			pr_err(DRIVER_NAME ": ADMA Err: 0x%08x | ADMA Ptr: 0x%08x\n",
			       readl(host->ioaddr + SDHCI_ADMA_ERROR),
			       readl(host->ioaddr + SDHCI_ADMA_ADDRESS));
103
	}
104

105
	pr_err(DRIVER_NAME ": ===========================================\n");
106 107 108 109 110 111 112 113
}

/*****************************************************************************\
 *                                                                           *
 * Low level functions                                                       *
 *                                                                           *
\*****************************************************************************/

114 115 116 117 118
static inline bool sdhci_data_line_cmd(struct mmc_command *cmd)
{
	return cmd->data || cmd->flags & MMC_RSP_BUSY;
}

119 120
static void sdhci_set_card_detection(struct sdhci_host *host, bool enable)
{
121
	u32 present;
122

123
	if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) ||
124
	    !mmc_card_is_removable(host->mmc))
125 126
		return;

127 128 129
	if (enable) {
		present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
				      SDHCI_CARD_PRESENT;
130

131 132 133 134 135
		host->ier |= present ? SDHCI_INT_CARD_REMOVE :
				       SDHCI_INT_CARD_INSERT;
	} else {
		host->ier &= ~(SDHCI_INT_CARD_REMOVE | SDHCI_INT_CARD_INSERT);
	}
136 137 138

	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
139 140 141 142 143 144 145 146 147 148 149 150
}

static void sdhci_enable_card_detection(struct sdhci_host *host)
{
	sdhci_set_card_detection(host, true);
}

static void sdhci_disable_card_detection(struct sdhci_host *host)
{
	sdhci_set_card_detection(host, false);
}

151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166
static void sdhci_runtime_pm_bus_on(struct sdhci_host *host)
{
	if (host->bus_on)
		return;
	host->bus_on = true;
	pm_runtime_get_noresume(host->mmc->parent);
}

static void sdhci_runtime_pm_bus_off(struct sdhci_host *host)
{
	if (!host->bus_on)
		return;
	host->bus_on = false;
	pm_runtime_put_noidle(host->mmc->parent);
}

167
void sdhci_reset(struct sdhci_host *host, u8 mask)
168
{
A
Adrian Hunter 已提交
169
	ktime_t timeout;
170

171
	sdhci_writeb(host, mask, SDHCI_SOFTWARE_RESET);
172

173
	if (mask & SDHCI_RESET_ALL) {
174
		host->clock = 0;
175 176 177 178
		/* Reset-all turns off SD Bus Power */
		if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
			sdhci_runtime_pm_bus_off(host);
	}
179

180
	/* Wait max 100 ms */
A
Adrian Hunter 已提交
181
	timeout = ktime_add_ms(ktime_get(), 100);
182 183

	/* hw clears the bit when it's done */
184
	while (sdhci_readb(host, SDHCI_SOFTWARE_RESET) & mask) {
A
Adrian Hunter 已提交
185
		if (ktime_after(ktime_get(), timeout)) {
186
			pr_err("%s: Reset 0x%x never completed.\n",
187 188 189 190
				mmc_hostname(host->mmc), (int)mask);
			sdhci_dumpregs(host);
			return;
		}
A
Adrian Hunter 已提交
191
		udelay(10);
192
	}
193 194 195 196 197 198
}
EXPORT_SYMBOL_GPL(sdhci_reset);

static void sdhci_do_reset(struct sdhci_host *host, u8 mask)
{
	if (host->quirks & SDHCI_QUIRK_NO_CARD_NO_RESET) {
199 200 201
		struct mmc_host *mmc = host->mmc;

		if (!mmc->ops->get_cd(mmc))
202 203
			return;
	}
204

205
	host->ops->reset(host, mask);
206

207 208 209 210 211 212 213 214
	if (mask & SDHCI_RESET_ALL) {
		if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
			if (host->ops->enable_dma)
				host->ops->enable_dma(host);
		}

		/* Resetting the controller clears many */
		host->preset_enabled = false;
215
	}
216 217
}

218
static void sdhci_init(struct sdhci_host *host, int soft)
219
{
220 221
	struct mmc_host *mmc = host->mmc;

222
	if (soft)
223
		sdhci_do_reset(host, SDHCI_RESET_CMD|SDHCI_RESET_DATA);
224
	else
225
		sdhci_do_reset(host, SDHCI_RESET_ALL);
226

227 228 229 230 231 232
	host->ier = SDHCI_INT_BUS_POWER | SDHCI_INT_DATA_END_BIT |
		    SDHCI_INT_DATA_CRC | SDHCI_INT_DATA_TIMEOUT |
		    SDHCI_INT_INDEX | SDHCI_INT_END_BIT | SDHCI_INT_CRC |
		    SDHCI_INT_TIMEOUT | SDHCI_INT_DATA_END |
		    SDHCI_INT_RESPONSE;

233 234 235 236
	if (host->tuning_mode == SDHCI_TUNING_MODE_2 ||
	    host->tuning_mode == SDHCI_TUNING_MODE_3)
		host->ier |= SDHCI_INT_RETUNE;

237 238
	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
239 240 241 242

	if (soft) {
		/* force clock reconfiguration */
		host->clock = 0;
243
		mmc->ops->set_ios(mmc, &mmc->ios);
244
	}
245
}
246

247 248
static void sdhci_reinit(struct sdhci_host *host)
{
249
	sdhci_init(host, 0);
250
	sdhci_enable_card_detection(host);
251 252
}

253
static void __sdhci_led_activate(struct sdhci_host *host)
254 255 256
{
	u8 ctrl;

257
	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
258
	ctrl |= SDHCI_CTRL_LED;
259
	sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
260 261
}

262
static void __sdhci_led_deactivate(struct sdhci_host *host)
263 264 265
{
	u8 ctrl;

266
	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
267
	ctrl &= ~SDHCI_CTRL_LED;
268
	sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
269 270
}

271
#if IS_REACHABLE(CONFIG_LEDS_CLASS)
272
static void sdhci_led_control(struct led_classdev *led,
273
			      enum led_brightness brightness)
274 275 276 277 278 279
{
	struct sdhci_host *host = container_of(led, struct sdhci_host, led);
	unsigned long flags;

	spin_lock_irqsave(&host->lock, flags);

280 281 282
	if (host->runtime_suspended)
		goto out;

283
	if (brightness == LED_OFF)
284
		__sdhci_led_deactivate(host);
285
	else
286
		__sdhci_led_activate(host);
287
out:
288 289
	spin_unlock_irqrestore(&host->lock, flags);
}
290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339

static int sdhci_led_register(struct sdhci_host *host)
{
	struct mmc_host *mmc = host->mmc;

	snprintf(host->led_name, sizeof(host->led_name),
		 "%s::", mmc_hostname(mmc));

	host->led.name = host->led_name;
	host->led.brightness = LED_OFF;
	host->led.default_trigger = mmc_hostname(mmc);
	host->led.brightness_set = sdhci_led_control;

	return led_classdev_register(mmc_dev(mmc), &host->led);
}

static void sdhci_led_unregister(struct sdhci_host *host)
{
	led_classdev_unregister(&host->led);
}

static inline void sdhci_led_activate(struct sdhci_host *host)
{
}

static inline void sdhci_led_deactivate(struct sdhci_host *host)
{
}

#else

static inline int sdhci_led_register(struct sdhci_host *host)
{
	return 0;
}

static inline void sdhci_led_unregister(struct sdhci_host *host)
{
}

static inline void sdhci_led_activate(struct sdhci_host *host)
{
	__sdhci_led_activate(host);
}

static inline void sdhci_led_deactivate(struct sdhci_host *host)
{
	__sdhci_led_deactivate(host);
}

340 341
#endif

342 343 344 345 346 347
/*****************************************************************************\
 *                                                                           *
 * Core functions                                                            *
 *                                                                           *
\*****************************************************************************/

P
Pierre Ossman 已提交
348
static void sdhci_read_block_pio(struct sdhci_host *host)
349
{
350 351
	unsigned long flags;
	size_t blksize, len, chunk;
352
	u32 uninitialized_var(scratch);
353
	u8 *buf;
354

P
Pierre Ossman 已提交
355
	DBG("PIO reading\n");
356

P
Pierre Ossman 已提交
357
	blksize = host->data->blksz;
358
	chunk = 0;
359

360
	local_irq_save(flags);
361

P
Pierre Ossman 已提交
362
	while (blksize) {
F
Fabio Estevam 已提交
363
		BUG_ON(!sg_miter_next(&host->sg_miter));
364

365
		len = min(host->sg_miter.length, blksize);
366

367 368
		blksize -= len;
		host->sg_miter.consumed = len;
369

370
		buf = host->sg_miter.addr;
371

372 373
		while (len) {
			if (chunk == 0) {
374
				scratch = sdhci_readl(host, SDHCI_BUFFER);
375
				chunk = 4;
P
Pierre Ossman 已提交
376
			}
377 378 379 380 381 382 383

			*buf = scratch & 0xFF;

			buf++;
			scratch >>= 8;
			chunk--;
			len--;
384
		}
P
Pierre Ossman 已提交
385
	}
386 387 388 389

	sg_miter_stop(&host->sg_miter);

	local_irq_restore(flags);
P
Pierre Ossman 已提交
390
}
391

P
Pierre Ossman 已提交
392 393
static void sdhci_write_block_pio(struct sdhci_host *host)
{
394 395 396 397
	unsigned long flags;
	size_t blksize, len, chunk;
	u32 scratch;
	u8 *buf;
398

P
Pierre Ossman 已提交
399 400 401
	DBG("PIO writing\n");

	blksize = host->data->blksz;
402 403
	chunk = 0;
	scratch = 0;
404

405
	local_irq_save(flags);
406

P
Pierre Ossman 已提交
407
	while (blksize) {
F
Fabio Estevam 已提交
408
		BUG_ON(!sg_miter_next(&host->sg_miter));
P
Pierre Ossman 已提交
409

410 411 412 413 414 415
		len = min(host->sg_miter.length, blksize);

		blksize -= len;
		host->sg_miter.consumed = len;

		buf = host->sg_miter.addr;
416

417 418 419 420 421 422 423 424
		while (len) {
			scratch |= (u32)*buf << (chunk * 8);

			buf++;
			chunk++;
			len--;

			if ((chunk == 4) || ((len == 0) && (blksize == 0))) {
425
				sdhci_writel(host, scratch, SDHCI_BUFFER);
426 427
				chunk = 0;
				scratch = 0;
428 429 430
			}
		}
	}
431 432 433 434

	sg_miter_stop(&host->sg_miter);

	local_irq_restore(flags);
P
Pierre Ossman 已提交
435 436 437 438 439 440
}

static void sdhci_transfer_pio(struct sdhci_host *host)
{
	u32 mask;

441
	if (host->blocks == 0)
P
Pierre Ossman 已提交
442 443 444 445 446 447 448
		return;

	if (host->data->flags & MMC_DATA_READ)
		mask = SDHCI_DATA_AVAILABLE;
	else
		mask = SDHCI_SPACE_AVAILABLE;

449 450 451 452 453 454 455 456 457
	/*
	 * Some controllers (JMicron JMB38x) mess up the buffer bits
	 * for transfers < 4 bytes. As long as it is just one block,
	 * we can ignore the bits.
	 */
	if ((host->quirks & SDHCI_QUIRK_BROKEN_SMALL_PIO) &&
		(host->data->blocks == 1))
		mask = ~0;

458
	while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
459 460 461
		if (host->quirks & SDHCI_QUIRK_PIO_NEEDS_DELAY)
			udelay(100);

P
Pierre Ossman 已提交
462 463 464 465
		if (host->data->flags & MMC_DATA_READ)
			sdhci_read_block_pio(host);
		else
			sdhci_write_block_pio(host);
466

467 468
		host->blocks--;
		if (host->blocks == 0)
P
Pierre Ossman 已提交
469 470
			break;
	}
471

P
Pierre Ossman 已提交
472
	DBG("PIO transfer complete.\n");
473 474
}

475
static int sdhci_pre_dma_transfer(struct sdhci_host *host,
476
				  struct mmc_data *data, int cookie)
477 478 479
{
	int sg_count;

480 481 482 483 484
	/*
	 * If the data buffers are already mapped, return the previous
	 * dma_map_sg() result.
	 */
	if (data->host_cookie == COOKIE_PRE_MAPPED)
485 486 487 488 489 490 491 492 493 494
		return data->sg_count;

	sg_count = dma_map_sg(mmc_dev(host->mmc), data->sg, data->sg_len,
				data->flags & MMC_DATA_WRITE ?
				DMA_TO_DEVICE : DMA_FROM_DEVICE);

	if (sg_count == 0)
		return -ENOSPC;

	data->sg_count = sg_count;
495
	data->host_cookie = cookie;
496 497 498 499

	return sg_count;
}

500 501 502
static char *sdhci_kmap_atomic(struct scatterlist *sg, unsigned long *flags)
{
	local_irq_save(*flags);
503
	return kmap_atomic(sg_page(sg)) + sg->offset;
504 505 506 507
}

static void sdhci_kunmap_atomic(void *buffer, unsigned long *flags)
{
508
	kunmap_atomic(buffer);
509 510 511
	local_irq_restore(*flags);
}

512 513
static void sdhci_adma_write_desc(struct sdhci_host *host, void *desc,
				  dma_addr_t addr, int len, unsigned cmd)
B
Ben Dooks 已提交
514
{
515
	struct sdhci_adma2_64_desc *dma_desc = desc;
B
Ben Dooks 已提交
516

517
	/* 32-bit and 64-bit descriptors have these members in same position */
518 519
	dma_desc->cmd = cpu_to_le16(cmd);
	dma_desc->len = cpu_to_le16(len);
520 521 522 523
	dma_desc->addr_lo = cpu_to_le32((u32)addr);

	if (host->flags & SDHCI_USE_64_BIT_DMA)
		dma_desc->addr_hi = cpu_to_le32((u64)addr >> 32);
B
Ben Dooks 已提交
524 525
}

526 527
static void sdhci_adma_mark_end(void *desc)
{
528
	struct sdhci_adma2_64_desc *dma_desc = desc;
529

530
	/* 32-bit and 64-bit descriptors have 'cmd' in same position */
531
	dma_desc->cmd |= cpu_to_le16(ADMA2_END);
532 533
}

534 535
static void sdhci_adma_table_pre(struct sdhci_host *host,
	struct mmc_data *data, int sg_count)
536 537 538
{
	struct scatterlist *sg;
	unsigned long flags;
539 540 541 542
	dma_addr_t addr, align_addr;
	void *desc, *align;
	char *buffer;
	int len, offset, i;
543 544 545 546 547 548

	/*
	 * The spec does not specify endianness of descriptor table.
	 * We currently guess that it is LE.
	 */

549
	host->sg_count = sg_count;
550

551
	desc = host->adma_table;
552 553 554 555 556 557 558 559 560
	align = host->align_buffer;

	align_addr = host->align_addr;

	for_each_sg(data->sg, sg, host->sg_count, i) {
		addr = sg_dma_address(sg);
		len = sg_dma_len(sg);

		/*
561 562 563
		 * The SDHCI specification states that ADMA addresses must
		 * be 32-bit aligned. If they aren't, then we use a bounce
		 * buffer for the (up to three) bytes that screw up the
564 565
		 * alignment.
		 */
566 567
		offset = (SDHCI_ADMA2_ALIGN - (addr & SDHCI_ADMA2_MASK)) &
			 SDHCI_ADMA2_MASK;
568 569 570 571 572 573 574
		if (offset) {
			if (data->flags & MMC_DATA_WRITE) {
				buffer = sdhci_kmap_atomic(sg, &flags);
				memcpy(align, buffer, offset);
				sdhci_kunmap_atomic(buffer, &flags);
			}

B
Ben Dooks 已提交
575
			/* tran, valid */
576
			sdhci_adma_write_desc(host, desc, align_addr, offset,
A
Adrian Hunter 已提交
577
					      ADMA2_TRAN_VALID);
578 579 580

			BUG_ON(offset > 65536);

581 582
			align += SDHCI_ADMA2_ALIGN;
			align_addr += SDHCI_ADMA2_ALIGN;
583

584
			desc += host->desc_sz;
585 586 587 588 589 590 591

			addr += offset;
			len -= offset;
		}

		BUG_ON(len > 65536);

592 593 594 595 596 597
		if (len) {
			/* tran, valid */
			sdhci_adma_write_desc(host, desc, addr, len,
					      ADMA2_TRAN_VALID);
			desc += host->desc_sz;
		}
598 599 600 601 602

		/*
		 * If this triggers then we have a calculation bug
		 * somewhere. :/
		 */
603
		WARN_ON((desc - host->adma_table) >= host->adma_table_sz);
604 605
	}

606
	if (host->quirks & SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC) {
607
		/* Mark the last descriptor as the terminating descriptor */
608
		if (desc != host->adma_table) {
609
			desc -= host->desc_sz;
610
			sdhci_adma_mark_end(desc);
611 612
		}
	} else {
613
		/* Add a terminating entry - nop, end, valid */
614
		sdhci_adma_write_desc(host, desc, 0, 0, ADMA2_NOP_END_VALID);
615
	}
616 617 618 619 620 621 622
}

static void sdhci_adma_table_post(struct sdhci_host *host,
	struct mmc_data *data)
{
	struct scatterlist *sg;
	int i, size;
623
	void *align;
624 625 626
	char *buffer;
	unsigned long flags;

627 628
	if (data->flags & MMC_DATA_READ) {
		bool has_unaligned = false;
629

630 631 632 633 634 635
		/* Do a quick scan of the SG list for any unaligned mappings */
		for_each_sg(data->sg, sg, host->sg_count, i)
			if (sg_dma_address(sg) & SDHCI_ADMA2_MASK) {
				has_unaligned = true;
				break;
			}
636

637 638
		if (has_unaligned) {
			dma_sync_sg_for_cpu(mmc_dev(host->mmc), data->sg,
639
					    data->sg_len, DMA_FROM_DEVICE);
640

641
			align = host->align_buffer;
642

643 644 645 646 647 648 649 650
			for_each_sg(data->sg, sg, host->sg_count, i) {
				if (sg_dma_address(sg) & SDHCI_ADMA2_MASK) {
					size = SDHCI_ADMA2_ALIGN -
					       (sg_dma_address(sg) & SDHCI_ADMA2_MASK);

					buffer = sdhci_kmap_atomic(sg, &flags);
					memcpy(buffer, align, size);
					sdhci_kunmap_atomic(buffer, &flags);
651

652 653
					align += SDHCI_ADMA2_ALIGN;
				}
654 655 656 657 658
			}
		}
	}
}

659
static u8 sdhci_calc_timeout(struct sdhci_host *host, struct mmc_command *cmd)
660
{
661
	u8 count;
662
	struct mmc_data *data = cmd->data;
663
	unsigned target_timeout, current_timeout;
664

665 666 667 668 669 670
	/*
	 * If the host controller provides us with an incorrect timeout
	 * value, just skip the check and use 0xE.  The hardware may take
	 * longer to time out, but that's much better than having a too-short
	 * timeout value.
	 */
671
	if (host->quirks & SDHCI_QUIRK_BROKEN_TIMEOUT_VAL)
672
		return 0xE;
673

674
	/* Unspecified timeout, assume max */
675
	if (!data && !cmd->busy_timeout)
676
		return 0xE;
677

678 679
	/* timeout in us */
	if (!data)
680
		target_timeout = cmd->busy_timeout * 1000;
681
	else {
682
		target_timeout = DIV_ROUND_UP(data->timeout_ns, 1000);
683 684 685 686 687 688 689 690
		if (host->clock && data->timeout_clks) {
			unsigned long long val;

			/*
			 * data->timeout_clks is in units of clock cycles.
			 * host->clock is in Hz.  target_timeout is in us.
			 * Hence, us = 1000000 * cycles / Hz.  Round up.
			 */
691
			val = 1000000ULL * data->timeout_clks;
692 693 694 695
			if (do_div(val, host->clock))
				target_timeout++;
			target_timeout += val;
		}
696
	}
697

698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717
	/*
	 * Figure out needed cycles.
	 * We do this in steps in order to fit inside a 32 bit int.
	 * The first step is the minimum timeout, which will have a
	 * minimum resolution of 6 bits:
	 * (1) 2^13*1000 > 2^22,
	 * (2) host->timeout_clk < 2^16
	 *     =>
	 *     (1) / (2) > 2^6
	 */
	count = 0;
	current_timeout = (1 << 13) * 1000 / host->timeout_clk;
	while (current_timeout < target_timeout) {
		count++;
		current_timeout <<= 1;
		if (count >= 0xF)
			break;
	}

	if (count >= 0xF) {
718 719
		DBG("%s: Too large timeout 0x%x requested for CMD%d!\n",
		    mmc_hostname(host->mmc), count, cmd->opcode);
720 721 722
		count = 0xE;
	}

723 724 725
	return count;
}

726 727 728 729 730 731
static void sdhci_set_transfer_irqs(struct sdhci_host *host)
{
	u32 pio_irqs = SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL;
	u32 dma_irqs = SDHCI_INT_DMA_END | SDHCI_INT_ADMA_ERROR;

	if (host->flags & SDHCI_REQ_USE_DMA)
732
		host->ier = (host->ier & ~pio_irqs) | dma_irqs;
733
	else
734 735 736 737
		host->ier = (host->ier & ~dma_irqs) | pio_irqs;

	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
738 739
}

740
static void sdhci_set_timeout(struct sdhci_host *host, struct mmc_command *cmd)
741 742
{
	u8 count;
743 744 745 746 747 748 749 750 751 752 753

	if (host->ops->set_timeout) {
		host->ops->set_timeout(host, cmd);
	} else {
		count = sdhci_calc_timeout(host, cmd);
		sdhci_writeb(host, count, SDHCI_TIMEOUT_CONTROL);
	}
}

static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_command *cmd)
{
754
	u8 ctrl;
755
	struct mmc_data *data = cmd->data;
756

757
	if (sdhci_data_line_cmd(cmd))
758
		sdhci_set_timeout(host, cmd);
759 760

	if (!data)
761 762
		return;

763 764
	WARN_ON(host->data);

765 766 767 768 769 770 771
	/* Sanity checks */
	BUG_ON(data->blksz * data->blocks > 524288);
	BUG_ON(data->blksz > host->mmc->max_blk_size);
	BUG_ON(data->blocks > 65535);

	host->data = data;
	host->data_early = 0;
772
	host->data->bytes_xfered = 0;
773

774
	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
775
		struct scatterlist *sg;
776
		unsigned int length_mask, offset_mask;
777
		int i;
778

779 780 781 782 783 784 785 786 787
		host->flags |= SDHCI_REQ_USE_DMA;

		/*
		 * FIXME: This doesn't account for merging when mapping the
		 * scatterlist.
		 *
		 * The assumption here being that alignment and lengths are
		 * the same after DMA mapping to device address space.
		 */
788
		length_mask = 0;
789
		offset_mask = 0;
790
		if (host->flags & SDHCI_USE_ADMA) {
791
			if (host->quirks & SDHCI_QUIRK_32BIT_ADMA_SIZE) {
792
				length_mask = 3;
793 794 795 796 797 798 799
				/*
				 * As we use up to 3 byte chunks to work
				 * around alignment problems, we need to
				 * check the offset as well.
				 */
				offset_mask = 3;
			}
800 801
		} else {
			if (host->quirks & SDHCI_QUIRK_32BIT_DMA_SIZE)
802
				length_mask = 3;
803 804
			if (host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR)
				offset_mask = 3;
805 806
		}

807
		if (unlikely(length_mask | offset_mask)) {
808
			for_each_sg(data->sg, sg, data->sg_len, i) {
809
				if (sg->length & length_mask) {
810
					DBG("Reverting to PIO because of transfer size (%d)\n",
811
					    sg->length);
812 813 814
					host->flags &= ~SDHCI_REQ_USE_DMA;
					break;
				}
815
				if (sg->offset & offset_mask) {
816
					DBG("Reverting to PIO because of bad alignment\n");
817 818 819 820 821 822 823
					host->flags &= ~SDHCI_REQ_USE_DMA;
					break;
				}
			}
		}
	}

824
	if (host->flags & SDHCI_REQ_USE_DMA) {
825
		int sg_cnt = sdhci_pre_dma_transfer(host, data, COOKIE_MAPPED);
826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841

		if (sg_cnt <= 0) {
			/*
			 * This only happens when someone fed
			 * us an invalid request.
			 */
			WARN_ON(1);
			host->flags &= ~SDHCI_REQ_USE_DMA;
		} else if (host->flags & SDHCI_USE_ADMA) {
			sdhci_adma_table_pre(host, data, sg_cnt);

			sdhci_writel(host, host->adma_addr, SDHCI_ADMA_ADDRESS);
			if (host->flags & SDHCI_USE_64_BIT_DMA)
				sdhci_writel(host,
					     (u64)host->adma_addr >> 32,
					     SDHCI_ADMA_ADDRESS_HI);
842
		} else {
843 844 845
			WARN_ON(sg_cnt != 1);
			sdhci_writel(host, sg_dma_address(data->sg),
				SDHCI_DMA_ADDRESS);
846 847 848
		}
	}

849 850 851 852 853 854
	/*
	 * Always adjust the DMA selection as some controllers
	 * (e.g. JMicron) can't do PIO properly when the selection
	 * is ADMA.
	 */
	if (host->version >= SDHCI_SPEC_200) {
855
		ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
856 857
		ctrl &= ~SDHCI_CTRL_DMA_MASK;
		if ((host->flags & SDHCI_REQ_USE_DMA) &&
858 859 860 861 862 863
			(host->flags & SDHCI_USE_ADMA)) {
			if (host->flags & SDHCI_USE_64_BIT_DMA)
				ctrl |= SDHCI_CTRL_ADMA64;
			else
				ctrl |= SDHCI_CTRL_ADMA32;
		} else {
864
			ctrl |= SDHCI_CTRL_SDMA;
865
		}
866
		sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
867 868
	}

869
	if (!(host->flags & SDHCI_REQ_USE_DMA)) {
870 871 872 873 874 875 876 877
		int flags;

		flags = SG_MITER_ATOMIC;
		if (host->data->flags & MMC_DATA_READ)
			flags |= SG_MITER_TO_SG;
		else
			flags |= SG_MITER_FROM_SG;
		sg_miter_start(&host->sg_miter, data->sg, data->sg_len, flags);
878
		host->blocks = data->blocks;
879
	}
880

881 882
	sdhci_set_transfer_irqs(host);

883 884 885
	/* Set the DMA boundary value and block size */
	sdhci_writew(host, SDHCI_MAKE_BLKSZ(SDHCI_DEFAULT_BOUNDARY_ARG,
		data->blksz), SDHCI_BLOCK_SIZE);
886
	sdhci_writew(host, data->blocks, SDHCI_BLOCK_COUNT);
887 888
}

889 890 891
static inline bool sdhci_auto_cmd12(struct sdhci_host *host,
				    struct mmc_request *mrq)
{
892 893
	return !mrq->sbc && (host->flags & SDHCI_AUTO_CMD12) &&
	       !mrq->cap_cmd_during_tfr;
894 895
}

896
static void sdhci_set_transfer_mode(struct sdhci_host *host,
897
	struct mmc_command *cmd)
898
{
899
	u16 mode = 0;
900
	struct mmc_data *data = cmd->data;
901

902
	if (data == NULL) {
903 904 905 906
		if (host->quirks2 &
			SDHCI_QUIRK2_CLEAR_TRANSFERMODE_REG_BEFORE_CMD) {
			sdhci_writew(host, 0x0, SDHCI_TRANSFER_MODE);
		} else {
907
		/* clear Auto CMD settings for no data CMDs */
908 909
			mode = sdhci_readw(host, SDHCI_TRANSFER_MODE);
			sdhci_writew(host, mode & ~(SDHCI_TRNS_AUTO_CMD12 |
910
				SDHCI_TRNS_AUTO_CMD23), SDHCI_TRANSFER_MODE);
911
		}
912
		return;
913
	}
914

915 916
	WARN_ON(!host->data);

917 918 919
	if (!(host->quirks2 & SDHCI_QUIRK2_SUPPORT_SINGLE))
		mode = SDHCI_TRNS_BLK_CNT_EN;

920
	if (mmc_op_multi(cmd->opcode) || data->blocks > 1) {
921
		mode = SDHCI_TRNS_BLK_CNT_EN | SDHCI_TRNS_MULTI;
922 923 924 925
		/*
		 * If we are sending CMD23, CMD12 never gets sent
		 * on successful completion (so no Auto-CMD12).
		 */
926
		if (sdhci_auto_cmd12(host, cmd->mrq) &&
927
		    (cmd->opcode != SD_IO_RW_EXTENDED))
928
			mode |= SDHCI_TRNS_AUTO_CMD12;
929
		else if (cmd->mrq->sbc && (host->flags & SDHCI_AUTO_CMD23)) {
930
			mode |= SDHCI_TRNS_AUTO_CMD23;
931
			sdhci_writel(host, cmd->mrq->sbc->arg, SDHCI_ARGUMENT2);
932
		}
933
	}
934

935 936
	if (data->flags & MMC_DATA_READ)
		mode |= SDHCI_TRNS_READ;
937
	if (host->flags & SDHCI_REQ_USE_DMA)
938 939
		mode |= SDHCI_TRNS_DMA;

940
	sdhci_writew(host, mode, SDHCI_TRANSFER_MODE);
941 942
}

943 944 945 946 947 948 949 950 951 952
static bool sdhci_needs_reset(struct sdhci_host *host, struct mmc_request *mrq)
{
	return (!(host->flags & SDHCI_DEVICE_DEAD) &&
		((mrq->cmd && mrq->cmd->error) ||
		 (mrq->sbc && mrq->sbc->error) ||
		 (mrq->data && ((mrq->data->error && !mrq->data->stop) ||
				(mrq->data->stop && mrq->data->stop->error))) ||
		 (host->quirks & SDHCI_QUIRK_RESET_AFTER_REQUEST)));
}

953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975
static void __sdhci_finish_mrq(struct sdhci_host *host, struct mmc_request *mrq)
{
	int i;

	for (i = 0; i < SDHCI_MAX_MRQS; i++) {
		if (host->mrqs_done[i] == mrq) {
			WARN_ON(1);
			return;
		}
	}

	for (i = 0; i < SDHCI_MAX_MRQS; i++) {
		if (!host->mrqs_done[i]) {
			host->mrqs_done[i] = mrq;
			break;
		}
	}

	WARN_ON(i >= SDHCI_MAX_MRQS);

	tasklet_schedule(&host->finish_tasklet);
}

976 977
static void sdhci_finish_mrq(struct sdhci_host *host, struct mmc_request *mrq)
{
978 979 980 981 982 983 984 985 986
	if (host->cmd && host->cmd->mrq == mrq)
		host->cmd = NULL;

	if (host->data_cmd && host->data_cmd->mrq == mrq)
		host->data_cmd = NULL;

	if (host->data && host->data->mrq == mrq)
		host->data = NULL;

987 988 989
	if (sdhci_needs_reset(host, mrq))
		host->pending_reset = true;

990
	__sdhci_finish_mrq(host, mrq);
991 992
}

993 994
static void sdhci_finish_data(struct sdhci_host *host)
{
995 996
	struct mmc_command *data_cmd = host->data_cmd;
	struct mmc_data *data = host->data;
997 998

	host->data = NULL;
999
	host->data_cmd = NULL;
1000

1001 1002 1003
	if ((host->flags & (SDHCI_REQ_USE_DMA | SDHCI_USE_ADMA)) ==
	    (SDHCI_REQ_USE_DMA | SDHCI_USE_ADMA))
		sdhci_adma_table_post(host, data);
1004 1005

	/*
1006 1007 1008 1009 1010
	 * The specification states that the block count register must
	 * be updated, but it does not specify at what point in the
	 * data flow. That makes the register entirely useless to read
	 * back so we have to assume that nothing made it to the card
	 * in the event of an error.
1011
	 */
1012 1013
	if (data->error)
		data->bytes_xfered = 0;
1014
	else
1015
		data->bytes_xfered = data->blksz * data->blocks;
1016

1017 1018 1019 1020 1021 1022 1023
	/*
	 * Need to send CMD12 if -
	 * a) open-ended multiblock transfer (no CMD23)
	 * b) error in multiblock transfer
	 */
	if (data->stop &&
	    (data->error ||
1024
	     !data->mrq->sbc)) {
1025

1026 1027 1028 1029
		/*
		 * The controller needs a reset of internal state machines
		 * upon error conditions.
		 */
P
Pierre Ossman 已提交
1030
		if (data->error) {
1031 1032
			if (!host->cmd || host->cmd == data_cmd)
				sdhci_do_reset(host, SDHCI_RESET_CMD);
1033
			sdhci_do_reset(host, SDHCI_RESET_DATA);
1034 1035
		}

1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047
		/*
		 * 'cap_cmd_during_tfr' request must not use the command line
		 * after mmc_command_done() has been called. It is upper layer's
		 * responsibility to send the stop command if required.
		 */
		if (data->mrq->cap_cmd_during_tfr) {
			sdhci_finish_mrq(host, data->mrq);
		} else {
			/* Avoid triggering warning in sdhci_send_command() */
			host->cmd = NULL;
			sdhci_send_command(host, data->stop);
		}
1048 1049 1050
	} else {
		sdhci_finish_mrq(host, data->mrq);
	}
1051 1052
}

1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069
static void sdhci_mod_timer(struct sdhci_host *host, struct mmc_request *mrq,
			    unsigned long timeout)
{
	if (sdhci_data_line_cmd(mrq->cmd))
		mod_timer(&host->data_timer, timeout);
	else
		mod_timer(&host->timer, timeout);
}

static void sdhci_del_timer(struct sdhci_host *host, struct mmc_request *mrq)
{
	if (sdhci_data_line_cmd(mrq->cmd))
		del_timer(&host->data_timer);
	else
		del_timer(&host->timer);
}

1070
void sdhci_send_command(struct sdhci_host *host, struct mmc_command *cmd)
1071 1072
{
	int flags;
1073
	u32 mask;
1074
	unsigned long timeout;
1075 1076 1077

	WARN_ON(host->cmd);

1078 1079 1080
	/* Initially, a command has no error */
	cmd->error = 0;

1081 1082 1083 1084
	if ((host->quirks2 & SDHCI_QUIRK2_STOP_WITH_TC) &&
	    cmd->opcode == MMC_STOP_TRANSMISSION)
		cmd->flags |= MMC_RSP_BUSY;

1085
	/* Wait max 10 ms */
1086
	timeout = 10;
1087 1088

	mask = SDHCI_CMD_INHIBIT;
1089
	if (sdhci_data_line_cmd(cmd))
1090 1091 1092 1093
		mask |= SDHCI_DATA_INHIBIT;

	/* We shouldn't wait for data inihibit for stop commands, even
	   though they might use busy signaling */
1094
	if (cmd->mrq->data && (cmd == cmd->mrq->data->stop))
1095 1096
		mask &= ~SDHCI_DATA_INHIBIT;

1097
	while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
1098
		if (timeout == 0) {
1099 1100
			pr_err("%s: Controller never released inhibit bit(s).\n",
			       mmc_hostname(host->mmc));
1101
			sdhci_dumpregs(host);
P
Pierre Ossman 已提交
1102
			cmd->error = -EIO;
1103
			sdhci_finish_mrq(host, cmd->mrq);
1104 1105
			return;
		}
1106 1107 1108
		timeout--;
		mdelay(1);
	}
1109

1110
	timeout = jiffies;
1111 1112
	if (!cmd->data && cmd->busy_timeout > 9000)
		timeout += DIV_ROUND_UP(cmd->busy_timeout, 1000) * HZ + HZ;
1113 1114
	else
		timeout += 10 * HZ;
1115
	sdhci_mod_timer(host, cmd->mrq, timeout);
1116 1117

	host->cmd = cmd;
1118
	if (sdhci_data_line_cmd(cmd)) {
1119 1120 1121
		WARN_ON(host->data_cmd);
		host->data_cmd = cmd;
	}
1122

1123
	sdhci_prepare_data(host, cmd);
1124

1125
	sdhci_writel(host, cmd->arg, SDHCI_ARGUMENT);
1126

1127
	sdhci_set_transfer_mode(host, cmd);
1128

1129
	if ((cmd->flags & MMC_RSP_136) && (cmd->flags & MMC_RSP_BUSY)) {
1130
		pr_err("%s: Unsupported response type!\n",
1131
			mmc_hostname(host->mmc));
P
Pierre Ossman 已提交
1132
		cmd->error = -EINVAL;
1133
		sdhci_finish_mrq(host, cmd->mrq);
1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149
		return;
	}

	if (!(cmd->flags & MMC_RSP_PRESENT))
		flags = SDHCI_CMD_RESP_NONE;
	else if (cmd->flags & MMC_RSP_136)
		flags = SDHCI_CMD_RESP_LONG;
	else if (cmd->flags & MMC_RSP_BUSY)
		flags = SDHCI_CMD_RESP_SHORT_BUSY;
	else
		flags = SDHCI_CMD_RESP_SHORT;

	if (cmd->flags & MMC_RSP_CRC)
		flags |= SDHCI_CMD_CRC;
	if (cmd->flags & MMC_RSP_OPCODE)
		flags |= SDHCI_CMD_INDEX;
1150 1151

	/* CMD19 is special in that the Data Present Select should be set */
1152 1153
	if (cmd->data || cmd->opcode == MMC_SEND_TUNING_BLOCK ||
	    cmd->opcode == MMC_SEND_TUNING_BLOCK_HS200)
1154 1155
		flags |= SDHCI_CMD_DATA;

1156
	sdhci_writew(host, SDHCI_MAKE_CMD(cmd->opcode, flags), SDHCI_COMMAND);
1157
}
1158
EXPORT_SYMBOL_GPL(sdhci_send_command);
1159 1160 1161

static void sdhci_finish_command(struct sdhci_host *host)
{
1162
	struct mmc_command *cmd = host->cmd;
1163 1164
	int i;

1165 1166 1167 1168
	host->cmd = NULL;

	if (cmd->flags & MMC_RSP_PRESENT) {
		if (cmd->flags & MMC_RSP_136) {
1169 1170
			/* CRC is stripped so we need to do some shifting. */
			for (i = 0;i < 4;i++) {
1171
				cmd->resp[i] = sdhci_readl(host,
1172 1173
					SDHCI_RESPONSE + (3-i)*4) << 8;
				if (i != 3)
1174
					cmd->resp[i] |=
1175
						sdhci_readb(host,
1176 1177 1178
						SDHCI_RESPONSE + (3-i)*4-1);
			}
		} else {
1179
			cmd->resp[0] = sdhci_readl(host, SDHCI_RESPONSE);
1180 1181 1182
		}
	}

1183 1184 1185
	if (cmd->mrq->cap_cmd_during_tfr && cmd == cmd->mrq->cmd)
		mmc_command_done(host->mmc, cmd->mrq);

1186 1187 1188 1189 1190 1191 1192 1193 1194 1195
	/*
	 * The host can send and interrupt when the busy state has
	 * ended, allowing us to wait without wasting CPU cycles.
	 * The busy signal uses DAT0 so this is similar to waiting
	 * for data to complete.
	 *
	 * Note: The 1.0 specification is a bit ambiguous about this
	 *       feature so there might be some problems with older
	 *       controllers.
	 */
1196 1197
	if (cmd->flags & MMC_RSP_BUSY) {
		if (cmd->data) {
1198 1199
			DBG("Cannot wait for busy signal when also doing a data transfer");
		} else if (!(host->quirks & SDHCI_QUIRK_NO_BUSY_IRQ) &&
1200 1201
			   cmd == host->data_cmd) {
			/* Command complete before busy is ended */
1202 1203 1204 1205
			return;
		}
	}

1206
	/* Finished CMD23, now send actual command. */
1207 1208
	if (cmd == cmd->mrq->sbc) {
		sdhci_send_command(host, cmd->mrq->cmd);
1209
	} else {
1210

1211 1212 1213
		/* Processed actual command. */
		if (host->data && host->data_early)
			sdhci_finish_data(host);
1214

1215
		if (!cmd->data)
1216
			sdhci_finish_mrq(host, cmd->mrq);
1217
	}
1218 1219
}

1220 1221
static u16 sdhci_get_preset_value(struct sdhci_host *host)
{
1222
	u16 preset = 0;
1223

1224 1225
	switch (host->timing) {
	case MMC_TIMING_UHS_SDR12:
1226 1227
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR12);
		break;
1228
	case MMC_TIMING_UHS_SDR25:
1229 1230
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR25);
		break;
1231
	case MMC_TIMING_UHS_SDR50:
1232 1233
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR50);
		break;
1234 1235
	case MMC_TIMING_UHS_SDR104:
	case MMC_TIMING_MMC_HS200:
1236 1237
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR104);
		break;
1238
	case MMC_TIMING_UHS_DDR50:
1239
	case MMC_TIMING_MMC_DDR52:
1240 1241
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_DDR50);
		break;
1242 1243 1244
	case MMC_TIMING_MMC_HS400:
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_HS400);
		break;
1245 1246 1247 1248 1249 1250 1251 1252 1253
	default:
		pr_warn("%s: Invalid UHS-I mode selected\n",
			mmc_hostname(host->mmc));
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR12);
		break;
	}
	return preset;
}

1254 1255
u16 sdhci_calc_clk(struct sdhci_host *host, unsigned int clock,
		   unsigned int *actual_clock)
1256
{
1257
	int div = 0; /* Initialized for compiler warning */
1258
	int real_div = div, clk_mul = 1;
1259
	u16 clk = 0;
1260
	bool switch_base_clk = false;
1261

1262
	if (host->version >= SDHCI_SPEC_300) {
1263
		if (host->preset_enabled) {
1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280
			u16 pre_val;

			clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
			pre_val = sdhci_get_preset_value(host);
			div = (pre_val & SDHCI_PRESET_SDCLK_FREQ_MASK)
				>> SDHCI_PRESET_SDCLK_FREQ_SHIFT;
			if (host->clk_mul &&
				(pre_val & SDHCI_PRESET_CLKGEN_SEL_MASK)) {
				clk = SDHCI_PROG_CLOCK_MODE;
				real_div = div + 1;
				clk_mul = host->clk_mul;
			} else {
				real_div = max_t(int, 1, div << 1);
			}
			goto clock_set;
		}

1281 1282 1283 1284 1285
		/*
		 * Check if the Host Controller supports Programmable Clock
		 * Mode.
		 */
		if (host->clk_mul) {
1286 1287 1288 1289 1290
			for (div = 1; div <= 1024; div++) {
				if ((host->max_clk * host->clk_mul / div)
					<= clock)
					break;
			}
1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309
			if ((host->max_clk * host->clk_mul / div) <= clock) {
				/*
				 * Set Programmable Clock Mode in the Clock
				 * Control register.
				 */
				clk = SDHCI_PROG_CLOCK_MODE;
				real_div = div;
				clk_mul = host->clk_mul;
				div--;
			} else {
				/*
				 * Divisor can be too small to reach clock
				 * speed requirement. Then use the base clock.
				 */
				switch_base_clk = true;
			}
		}

		if (!host->clk_mul || switch_base_clk) {
1310 1311 1312 1313 1314 1315 1316 1317 1318
			/* Version 3.00 divisors must be a multiple of 2. */
			if (host->max_clk <= clock)
				div = 1;
			else {
				for (div = 2; div < SDHCI_MAX_DIV_SPEC_300;
				     div += 2) {
					if ((host->max_clk / div) <= clock)
						break;
				}
1319
			}
1320
			real_div = div;
1321
			div >>= 1;
1322 1323 1324
			if ((host->quirks2 & SDHCI_QUIRK2_CLOCK_DIV_ZERO_BROKEN)
				&& !div && host->max_clk <= 25000000)
				div = 1;
1325 1326 1327
		}
	} else {
		/* Version 2.00 divisors must be a power of 2. */
1328
		for (div = 1; div < SDHCI_MAX_DIV_SPEC_200; div *= 2) {
1329 1330 1331
			if ((host->max_clk / div) <= clock)
				break;
		}
1332
		real_div = div;
1333
		div >>= 1;
1334 1335
	}

1336
clock_set:
1337
	if (real_div)
1338
		*actual_clock = (host->max_clk * clk_mul) / real_div;
1339
	clk |= (div & SDHCI_DIV_MASK) << SDHCI_DIVIDER_SHIFT;
1340 1341
	clk |= ((div & SDHCI_DIV_HI_MASK) >> SDHCI_DIV_MASK_LEN)
		<< SDHCI_DIVIDER_HI_SHIFT;
1342 1343 1344 1345 1346

	return clk;
}
EXPORT_SYMBOL_GPL(sdhci_calc_clk);

1347
void sdhci_enable_clk(struct sdhci_host *host, u16 clk)
1348
{
A
Adrian Hunter 已提交
1349
	ktime_t timeout;
1350

1351
	clk |= SDHCI_CLOCK_INT_EN;
1352
	sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
1353

1354
	/* Wait max 20 ms */
A
Adrian Hunter 已提交
1355
	timeout = ktime_add_ms(ktime_get(), 20);
1356
	while (!((clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL))
1357
		& SDHCI_CLOCK_INT_STABLE)) {
A
Adrian Hunter 已提交
1358
		if (ktime_after(ktime_get(), timeout)) {
1359 1360
			pr_err("%s: Internal clock never stabilised.\n",
			       mmc_hostname(host->mmc));
1361 1362 1363
			sdhci_dumpregs(host);
			return;
		}
A
Adrian Hunter 已提交
1364
		udelay(10);
1365
	}
1366 1367

	clk |= SDHCI_CLOCK_CARD_EN;
1368
	sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
1369
}
1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385
EXPORT_SYMBOL_GPL(sdhci_enable_clk);

void sdhci_set_clock(struct sdhci_host *host, unsigned int clock)
{
	u16 clk;

	host->mmc->actual_clock = 0;

	sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL);

	if (clock == 0)
		return;

	clk = sdhci_calc_clk(host, clock, &host->mmc->actual_clock);
	sdhci_enable_clk(host, clk);
}
1386
EXPORT_SYMBOL_GPL(sdhci_set_clock);
1387

1388 1389
static void sdhci_set_power_reg(struct sdhci_host *host, unsigned char mode,
				unsigned short vdd)
1390
{
1391
	struct mmc_host *mmc = host->mmc;
1392 1393 1394 1395 1396 1397 1398 1399 1400

	mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, vdd);

	if (mode != MMC_POWER_OFF)
		sdhci_writeb(host, SDHCI_POWER_ON, SDHCI_POWER_CONTROL);
	else
		sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
}

1401 1402
void sdhci_set_power_noreg(struct sdhci_host *host, unsigned char mode,
			   unsigned short vdd)
1403
{
1404
	u8 pwr = 0;
1405

1406 1407
	if (mode != MMC_POWER_OFF) {
		switch (1 << vdd) {
1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419
		case MMC_VDD_165_195:
			pwr = SDHCI_POWER_180;
			break;
		case MMC_VDD_29_30:
		case MMC_VDD_30_31:
			pwr = SDHCI_POWER_300;
			break;
		case MMC_VDD_32_33:
		case MMC_VDD_33_34:
			pwr = SDHCI_POWER_330;
			break;
		default:
1420 1421 1422
			WARN(1, "%s: Invalid vdd %#x\n",
			     mmc_hostname(host->mmc), vdd);
			break;
1423 1424 1425 1426
		}
	}

	if (host->pwr == pwr)
1427
		return;
1428

1429 1430 1431
	host->pwr = pwr;

	if (pwr == 0) {
1432
		sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
1433 1434
		if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
			sdhci_runtime_pm_bus_off(host);
1435 1436 1437 1438 1439 1440 1441
	} else {
		/*
		 * Spec says that we should clear the power reg before setting
		 * a new value. Some controllers don't seem to like this though.
		 */
		if (!(host->quirks & SDHCI_QUIRK_SINGLE_POWER_WRITE))
			sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
1442

1443 1444 1445 1446 1447 1448 1449
		/*
		 * At least the Marvell CaFe chip gets confused if we set the
		 * voltage and set turn on power at the same time, so set the
		 * voltage first.
		 */
		if (host->quirks & SDHCI_QUIRK_NO_SIMULT_VDD_AND_POWER)
			sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
1450

1451
		pwr |= SDHCI_POWER_ON;
1452

1453
		sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
1454

1455 1456
		if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
			sdhci_runtime_pm_bus_on(host);
1457

1458 1459 1460 1461 1462 1463 1464
		/*
		 * Some controllers need an extra 10ms delay of 10ms before
		 * they can apply clock after applying power
		 */
		if (host->quirks & SDHCI_QUIRK_DELAY_AFTER_POWER)
			mdelay(10);
	}
1465
}
1466
EXPORT_SYMBOL_GPL(sdhci_set_power_noreg);
1467

1468 1469
void sdhci_set_power(struct sdhci_host *host, unsigned char mode,
		     unsigned short vdd)
1470
{
1471 1472
	if (IS_ERR(host->mmc->supply.vmmc))
		sdhci_set_power_noreg(host, mode, vdd);
1473
	else
1474
		sdhci_set_power_reg(host, mode, vdd);
1475
}
1476
EXPORT_SYMBOL_GPL(sdhci_set_power);
1477

1478 1479 1480 1481 1482 1483 1484 1485 1486
/*****************************************************************************\
 *                                                                           *
 * MMC callbacks                                                             *
 *                                                                           *
\*****************************************************************************/

static void sdhci_request(struct mmc_host *mmc, struct mmc_request *mrq)
{
	struct sdhci_host *host;
1487
	int present;
1488 1489 1490 1491
	unsigned long flags;

	host = mmc_priv(mmc);

1492
	/* Firstly check card presence */
1493
	present = mmc->ops->get_cd(mmc);
1494

1495 1496
	spin_lock_irqsave(&host->lock, flags);

1497
	sdhci_led_activate(host);
1498 1499 1500 1501 1502

	/*
	 * Ensure we don't send the STOP for non-SET_BLOCK_COUNTED
	 * requests if Auto-CMD12 is enabled.
	 */
1503
	if (sdhci_auto_cmd12(host, mrq)) {
1504 1505 1506 1507 1508
		if (mrq->stop) {
			mrq->data->stop = NULL;
			mrq->stop = NULL;
		}
	}
1509

1510
	if (!present || host->flags & SDHCI_DEVICE_DEAD) {
1511
		mrq->cmd->error = -ENOMEDIUM;
1512
		sdhci_finish_mrq(host, mrq);
1513
	} else {
1514
		if (mrq->sbc && !(host->flags & SDHCI_AUTO_CMD23))
1515 1516 1517
			sdhci_send_command(host, mrq->sbc);
		else
			sdhci_send_command(host, mrq->cmd);
1518
	}
1519

1520
	mmiowb();
1521 1522 1523
	spin_unlock_irqrestore(&host->lock, flags);
}

1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544
void sdhci_set_bus_width(struct sdhci_host *host, int width)
{
	u8 ctrl;

	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
	if (width == MMC_BUS_WIDTH_8) {
		ctrl &= ~SDHCI_CTRL_4BITBUS;
		if (host->version >= SDHCI_SPEC_300)
			ctrl |= SDHCI_CTRL_8BITBUS;
	} else {
		if (host->version >= SDHCI_SPEC_300)
			ctrl &= ~SDHCI_CTRL_8BITBUS;
		if (width == MMC_BUS_WIDTH_4)
			ctrl |= SDHCI_CTRL_4BITBUS;
		else
			ctrl &= ~SDHCI_CTRL_4BITBUS;
	}
	sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
}
EXPORT_SYMBOL_GPL(sdhci_set_bus_width);

1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563
void sdhci_set_uhs_signaling(struct sdhci_host *host, unsigned timing)
{
	u16 ctrl_2;

	ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2);
	/* Select Bus Speed Mode for host */
	ctrl_2 &= ~SDHCI_CTRL_UHS_MASK;
	if ((timing == MMC_TIMING_MMC_HS200) ||
	    (timing == MMC_TIMING_UHS_SDR104))
		ctrl_2 |= SDHCI_CTRL_UHS_SDR104;
	else if (timing == MMC_TIMING_UHS_SDR12)
		ctrl_2 |= SDHCI_CTRL_UHS_SDR12;
	else if (timing == MMC_TIMING_UHS_SDR25)
		ctrl_2 |= SDHCI_CTRL_UHS_SDR25;
	else if (timing == MMC_TIMING_UHS_SDR50)
		ctrl_2 |= SDHCI_CTRL_UHS_SDR50;
	else if ((timing == MMC_TIMING_UHS_DDR50) ||
		 (timing == MMC_TIMING_MMC_DDR52))
		ctrl_2 |= SDHCI_CTRL_UHS_DDR50;
1564 1565
	else if (timing == MMC_TIMING_MMC_HS400)
		ctrl_2 |= SDHCI_CTRL_HS400; /* Non-standard */
1566 1567 1568 1569
	sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2);
}
EXPORT_SYMBOL_GPL(sdhci_set_uhs_signaling);

1570
static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
1571
{
1572
	struct sdhci_host *host = mmc_priv(mmc);
1573 1574
	u8 ctrl;

1575 1576 1577
	if (ios->power_mode == MMC_POWER_UNDEFINED)
		return;

A
Adrian Hunter 已提交
1578
	if (host->flags & SDHCI_DEVICE_DEAD) {
1579 1580
		if (!IS_ERR(mmc->supply.vmmc) &&
		    ios->power_mode == MMC_POWER_OFF)
1581
			mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
A
Adrian Hunter 已提交
1582 1583
		return;
	}
P
Pierre Ossman 已提交
1584

1585 1586 1587 1588 1589
	/*
	 * Reset the chip on each power off.
	 * Should clear out any weird states.
	 */
	if (ios->power_mode == MMC_POWER_OFF) {
1590
		sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
1591
		sdhci_reinit(host);
1592 1593
	}

1594
	if (host->version >= SDHCI_SPEC_300 &&
1595 1596
		(ios->power_mode == MMC_POWER_UP) &&
		!(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN))
1597 1598
		sdhci_enable_preset_value(host, false);

1599
	if (!ios->clock || ios->clock != host->clock) {
1600
		host->ops->set_clock(host, ios->clock);
1601
		host->clock = ios->clock;
1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613

		if (host->quirks & SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK &&
		    host->clock) {
			host->timeout_clk = host->mmc->actual_clock ?
						host->mmc->actual_clock / 1000 :
						host->clock / 1000;
			host->mmc->max_busy_timeout =
				host->ops->get_max_timeout_count ?
				host->ops->get_max_timeout_count(host) :
				1 << 27;
			host->mmc->max_busy_timeout /= host->timeout_clk;
		}
1614
	}
1615

1616 1617 1618 1619
	if (host->ops->set_power)
		host->ops->set_power(host, ios->power_mode, ios->vdd);
	else
		sdhci_set_power(host, ios->power_mode, ios->vdd);
1620

1621 1622 1623
	if (host->ops->platform_send_init_74_clocks)
		host->ops->platform_send_init_74_clocks(host, ios->power_mode);

1624
	host->ops->set_bus_width(host, ios->bus_width);
1625

1626
	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
1627

1628
	if ((ios->timing == MMC_TIMING_SD_HS ||
1629 1630 1631 1632 1633 1634 1635 1636
	     ios->timing == MMC_TIMING_MMC_HS ||
	     ios->timing == MMC_TIMING_MMC_HS400 ||
	     ios->timing == MMC_TIMING_MMC_HS200 ||
	     ios->timing == MMC_TIMING_MMC_DDR52 ||
	     ios->timing == MMC_TIMING_UHS_SDR50 ||
	     ios->timing == MMC_TIMING_UHS_SDR104 ||
	     ios->timing == MMC_TIMING_UHS_DDR50 ||
	     ios->timing == MMC_TIMING_UHS_SDR25)
1637
	    && !(host->quirks & SDHCI_QUIRK_NO_HISPD_BIT))
1638 1639 1640 1641
		ctrl |= SDHCI_CTRL_HISPD;
	else
		ctrl &= ~SDHCI_CTRL_HISPD;

1642
	if (host->version >= SDHCI_SPEC_300) {
1643 1644
		u16 clk, ctrl_2;

1645
		if (!host->preset_enabled) {
1646
			sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1647 1648 1649 1650
			/*
			 * We only need to set Driver Strength if the
			 * preset value enable is not set.
			 */
1651
			ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1652 1653 1654
			ctrl_2 &= ~SDHCI_CTRL_DRV_TYPE_MASK;
			if (ios->drv_type == MMC_SET_DRIVER_TYPE_A)
				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_A;
1655 1656
			else if (ios->drv_type == MMC_SET_DRIVER_TYPE_B)
				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_B;
1657 1658
			else if (ios->drv_type == MMC_SET_DRIVER_TYPE_C)
				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_C;
1659 1660 1661
			else if (ios->drv_type == MMC_SET_DRIVER_TYPE_D)
				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_D;
			else {
1662 1663
				pr_warn("%s: invalid driver type, default to driver type B\n",
					mmc_hostname(mmc));
1664 1665
				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_B;
			}
1666 1667

			sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2);
1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683
		} else {
			/*
			 * According to SDHC Spec v3.00, if the Preset Value
			 * Enable in the Host Control 2 register is set, we
			 * need to reset SD Clock Enable before changing High
			 * Speed Enable to avoid generating clock gliches.
			 */

			/* Reset SD Clock Enable */
			clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
			clk &= ~SDHCI_CLOCK_CARD_EN;
			sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);

			sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);

			/* Re-enable SD Clock */
1684
			host->ops->set_clock(host, host->clock);
1685
		}
1686 1687 1688 1689 1690 1691

		/* Reset SD Clock Enable */
		clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
		clk &= ~SDHCI_CLOCK_CARD_EN;
		sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);

1692
		host->ops->set_uhs_signaling(host, ios->timing);
1693
		host->timing = ios->timing;
1694

1695 1696 1697 1698 1699
		if (!(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN) &&
				((ios->timing == MMC_TIMING_UHS_SDR12) ||
				 (ios->timing == MMC_TIMING_UHS_SDR25) ||
				 (ios->timing == MMC_TIMING_UHS_SDR50) ||
				 (ios->timing == MMC_TIMING_UHS_SDR104) ||
1700 1701
				 (ios->timing == MMC_TIMING_UHS_DDR50) ||
				 (ios->timing == MMC_TIMING_MMC_DDR52))) {
1702 1703 1704 1705 1706 1707 1708 1709
			u16 preset;

			sdhci_enable_preset_value(host, true);
			preset = sdhci_get_preset_value(host);
			ios->drv_type = (preset & SDHCI_PRESET_DRV_MASK)
				>> SDHCI_PRESET_DRV_SHIFT;
		}

1710
		/* Re-enable SD Clock */
1711
		host->ops->set_clock(host, host->clock);
1712 1713
	} else
		sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1714

1715 1716 1717 1718 1719
	/*
	 * Some (ENE) controllers go apeshit on some ios operation,
	 * signalling timeout and CRC errors even on CMD0. Resetting
	 * it on each ios seems to solve the problem.
	 */
1720
	if (host->quirks & SDHCI_QUIRK_RESET_CMD_DATA_ON_IOS)
1721
		sdhci_do_reset(host, SDHCI_RESET_CMD | SDHCI_RESET_DATA);
1722

1723
	mmiowb();
1724 1725
}

1726
static int sdhci_get_cd(struct mmc_host *mmc)
1727 1728
{
	struct sdhci_host *host = mmc_priv(mmc);
1729
	int gpio_cd = mmc_gpio_get_cd(mmc);
1730 1731 1732 1733

	if (host->flags & SDHCI_DEVICE_DEAD)
		return 0;

1734
	/* If nonremovable, assume that the card is always present. */
1735
	if (!mmc_card_is_removable(host->mmc))
1736 1737
		return 1;

1738 1739 1740 1741
	/*
	 * Try slot gpio detect, if defined it take precedence
	 * over build in controller functionality
	 */
1742
	if (gpio_cd >= 0)
1743 1744
		return !!gpio_cd;

1745 1746 1747 1748
	/* If polling, assume that the card is always present. */
	if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
		return 1;

1749 1750 1751 1752
	/* Host native card detect */
	return !!(sdhci_readl(host, SDHCI_PRESENT_STATE) & SDHCI_CARD_PRESENT);
}

1753
static int sdhci_check_ro(struct sdhci_host *host)
1754 1755
{
	unsigned long flags;
1756
	int is_readonly;
1757 1758 1759

	spin_lock_irqsave(&host->lock, flags);

P
Pierre Ossman 已提交
1760
	if (host->flags & SDHCI_DEVICE_DEAD)
1761 1762 1763
		is_readonly = 0;
	else if (host->ops->get_ro)
		is_readonly = host->ops->get_ro(host);
P
Pierre Ossman 已提交
1764
	else
1765 1766
		is_readonly = !(sdhci_readl(host, SDHCI_PRESENT_STATE)
				& SDHCI_WRITE_PROTECT);
1767 1768 1769

	spin_unlock_irqrestore(&host->lock, flags);

1770 1771 1772
	/* This quirk needs to be replaced by a callback-function later */
	return host->quirks & SDHCI_QUIRK_INVERTED_WRITE_PROTECT ?
		!is_readonly : is_readonly;
1773 1774
}

1775 1776
#define SAMPLE_COUNT	5

1777
static int sdhci_get_ro(struct mmc_host *mmc)
1778
{
1779
	struct sdhci_host *host = mmc_priv(mmc);
1780 1781 1782
	int i, ro_count;

	if (!(host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT))
1783
		return sdhci_check_ro(host);
1784 1785 1786

	ro_count = 0;
	for (i = 0; i < SAMPLE_COUNT; i++) {
1787
		if (sdhci_check_ro(host)) {
1788 1789 1790 1791 1792 1793 1794 1795
			if (++ro_count > SAMPLE_COUNT / 2)
				return 1;
		}
		msleep(30);
	}
	return 0;
}

1796 1797 1798 1799 1800 1801 1802 1803
static void sdhci_hw_reset(struct mmc_host *mmc)
{
	struct sdhci_host *host = mmc_priv(mmc);

	if (host->ops && host->ops->hw_reset)
		host->ops->hw_reset(host);
}

1804 1805
static void sdhci_enable_sdio_irq_nolock(struct sdhci_host *host, int enable)
{
1806
	if (!(host->flags & SDHCI_DEVICE_DEAD)) {
1807
		if (enable)
1808
			host->ier |= SDHCI_INT_CARD_INT;
1809
		else
1810 1811 1812 1813
			host->ier &= ~SDHCI_INT_CARD_INT;

		sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
		sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
1814 1815
		mmiowb();
	}
1816 1817 1818 1819 1820 1821
}

static void sdhci_enable_sdio_irq(struct mmc_host *mmc, int enable)
{
	struct sdhci_host *host = mmc_priv(mmc);
	unsigned long flags;
P
Pierre Ossman 已提交
1822

1823 1824 1825
	if (enable)
		pm_runtime_get_noresume(host->mmc->parent);

1826
	spin_lock_irqsave(&host->lock, flags);
1827 1828 1829 1830 1831
	if (enable)
		host->flags |= SDHCI_SDIO_IRQ_ENABLED;
	else
		host->flags &= ~SDHCI_SDIO_IRQ_ENABLED;

1832
	sdhci_enable_sdio_irq_nolock(host, enable);
P
Pierre Ossman 已提交
1833
	spin_unlock_irqrestore(&host->lock, flags);
1834 1835 1836

	if (!enable)
		pm_runtime_put_noidle(host->mmc->parent);
P
Pierre Ossman 已提交
1837 1838
}

1839 1840
static int sdhci_start_signal_voltage_switch(struct mmc_host *mmc,
					     struct mmc_ios *ios)
1841
{
1842
	struct sdhci_host *host = mmc_priv(mmc);
1843
	u16 ctrl;
1844
	int ret;
1845

1846 1847 1848 1849 1850 1851
	/*
	 * Signal Voltage Switching is only applicable for Host Controllers
	 * v3.00 and above.
	 */
	if (host->version < SDHCI_SPEC_300)
		return 0;
1852

1853 1854
	ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);

1855
	switch (ios->signal_voltage) {
1856
	case MMC_SIGNAL_VOLTAGE_330:
1857 1858
		if (!(host->flags & SDHCI_SIGNALING_330))
			return -EINVAL;
1859 1860 1861
		/* Set 1.8V Signal Enable in the Host Control2 register to 0 */
		ctrl &= ~SDHCI_CTRL_VDD_180;
		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1862

1863
		if (!IS_ERR(mmc->supply.vqmmc)) {
1864
			ret = mmc_regulator_set_vqmmc(mmc, ios);
1865
			if (ret) {
J
Joe Perches 已提交
1866 1867
				pr_warn("%s: Switching to 3.3V signalling voltage failed\n",
					mmc_hostname(mmc));
1868 1869 1870 1871 1872
				return -EIO;
			}
		}
		/* Wait for 5ms */
		usleep_range(5000, 5500);
1873

1874 1875 1876 1877
		/* 3.3V regulator output should be stable within 5 ms */
		ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
		if (!(ctrl & SDHCI_CTRL_VDD_180))
			return 0;
1878

J
Joe Perches 已提交
1879 1880
		pr_warn("%s: 3.3V regulator output did not became stable\n",
			mmc_hostname(mmc));
1881 1882 1883

		return -EAGAIN;
	case MMC_SIGNAL_VOLTAGE_180:
1884 1885
		if (!(host->flags & SDHCI_SIGNALING_180))
			return -EINVAL;
1886
		if (!IS_ERR(mmc->supply.vqmmc)) {
1887
			ret = mmc_regulator_set_vqmmc(mmc, ios);
1888
			if (ret) {
J
Joe Perches 已提交
1889 1890
				pr_warn("%s: Switching to 1.8V signalling voltage failed\n",
					mmc_hostname(mmc));
1891 1892 1893
				return -EIO;
			}
		}
1894 1895 1896 1897 1898

		/*
		 * Enable 1.8V Signal Enable in the Host Control2
		 * register
		 */
1899 1900
		ctrl |= SDHCI_CTRL_VDD_180;
		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1901

1902 1903 1904 1905
		/* Some controller need to do more when switching */
		if (host->ops->voltage_switch)
			host->ops->voltage_switch(host);

1906 1907 1908 1909
		/* 1.8V regulator output should be stable within 5 ms */
		ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
		if (ctrl & SDHCI_CTRL_VDD_180)
			return 0;
1910

J
Joe Perches 已提交
1911 1912
		pr_warn("%s: 1.8V regulator output did not became stable\n",
			mmc_hostname(mmc));
1913

1914 1915
		return -EAGAIN;
	case MMC_SIGNAL_VOLTAGE_120:
1916 1917
		if (!(host->flags & SDHCI_SIGNALING_120))
			return -EINVAL;
1918
		if (!IS_ERR(mmc->supply.vqmmc)) {
1919
			ret = mmc_regulator_set_vqmmc(mmc, ios);
1920
			if (ret) {
J
Joe Perches 已提交
1921 1922
				pr_warn("%s: Switching to 1.2V signalling voltage failed\n",
					mmc_hostname(mmc));
1923
				return -EIO;
1924 1925
			}
		}
1926
		return 0;
1927
	default:
1928 1929
		/* No signal voltage switch required */
		return 0;
1930
	}
1931 1932
}

1933 1934 1935 1936 1937
static int sdhci_card_busy(struct mmc_host *mmc)
{
	struct sdhci_host *host = mmc_priv(mmc);
	u32 present_state;

1938
	/* Check whether DAT[0] is 0 */
1939 1940
	present_state = sdhci_readl(host, SDHCI_PRESENT_STATE);

1941
	return !(present_state & SDHCI_DATA_0_LVL_MASK);
1942 1943
}

1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955
static int sdhci_prepare_hs400_tuning(struct mmc_host *mmc, struct mmc_ios *ios)
{
	struct sdhci_host *host = mmc_priv(mmc);
	unsigned long flags;

	spin_lock_irqsave(&host->lock, flags);
	host->flags |= SDHCI_HS400_TUNING;
	spin_unlock_irqrestore(&host->lock, flags);

	return 0;
}

1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021
static void sdhci_start_tuning(struct sdhci_host *host)
{
	u16 ctrl;

	ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
	ctrl |= SDHCI_CTRL_EXEC_TUNING;
	if (host->quirks2 & SDHCI_QUIRK2_TUNING_WORK_AROUND)
		ctrl |= SDHCI_CTRL_TUNED_CLK;
	sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);

	/*
	 * As per the Host Controller spec v3.00, tuning command
	 * generates Buffer Read Ready interrupt, so enable that.
	 *
	 * Note: The spec clearly says that when tuning sequence
	 * is being performed, the controller does not generate
	 * interrupts other than Buffer Read Ready interrupt. But
	 * to make sure we don't hit a controller bug, we _only_
	 * enable Buffer Read Ready interrupt here.
	 */
	sdhci_writel(host, SDHCI_INT_DATA_AVAIL, SDHCI_INT_ENABLE);
	sdhci_writel(host, SDHCI_INT_DATA_AVAIL, SDHCI_SIGNAL_ENABLE);
}

static void sdhci_end_tuning(struct sdhci_host *host)
{
	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
}

static void sdhci_reset_tuning(struct sdhci_host *host)
{
	u16 ctrl;

	ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
	ctrl &= ~SDHCI_CTRL_TUNED_CLK;
	ctrl &= ~SDHCI_CTRL_EXEC_TUNING;
	sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
}

static void sdhci_abort_tuning(struct sdhci_host *host, u32 opcode,
			       unsigned long flags)
{
	sdhci_reset_tuning(host);

	sdhci_do_reset(host, SDHCI_RESET_CMD);
	sdhci_do_reset(host, SDHCI_RESET_DATA);

	sdhci_end_tuning(host);

	spin_unlock_irqrestore(&host->lock, flags);
	mmc_abort_tuning(host->mmc, opcode);
	spin_lock_irqsave(&host->lock, flags);
}

/*
 * We use sdhci_send_tuning() because mmc_send_tuning() is not a good fit. SDHCI
 * tuning command does not have a data payload (or rather the hardware does it
 * automatically) so mmc_send_tuning() will return -EIO. Also the tuning command
 * interrupt setup is different to other commands and there is no timeout
 * interrupt so special handling is needed.
 */
static void sdhci_send_tuning(struct sdhci_host *host, u32 opcode,
			      unsigned long flags)
{
	struct mmc_host *mmc = host->mmc;
2022 2023
	struct mmc_command cmd = {};
	struct mmc_request mrq = {};
2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034

	cmd.opcode = opcode;
	cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
	cmd.mrq = &mrq;

	mrq.cmd = &cmd;
	/*
	 * In response to CMD19, the card sends 64 bytes of tuning
	 * block to the Host Controller. So we set the block size
	 * to 64 here.
	 */
2035 2036 2037 2038 2039
	if (cmd.opcode == MMC_SEND_TUNING_BLOCK_HS200 &&
	    mmc->ios.bus_width == MMC_BUS_WIDTH_8)
		sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 128), SDHCI_BLOCK_SIZE);
	else
		sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 64), SDHCI_BLOCK_SIZE);
2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065

	/*
	 * The tuning block is sent by the card to the host controller.
	 * So we set the TRNS_READ bit in the Transfer Mode register.
	 * This also takes care of setting DMA Enable and Multi Block
	 * Select in the same register to 0.
	 */
	sdhci_writew(host, SDHCI_TRNS_READ, SDHCI_TRANSFER_MODE);

	sdhci_send_command(host, &cmd);

	host->cmd = NULL;

	sdhci_del_timer(host, &mrq);

	host->tuning_done = 0;

	spin_unlock_irqrestore(&host->lock, flags);

	/* Wait for Buffer Read Ready interrupt */
	wait_event_timeout(host->buf_ready_int, (host->tuning_done == 1),
			   msecs_to_jiffies(50));

	spin_lock_irqsave(&host->lock, flags);
}

A
Adrian Hunter 已提交
2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103
static void __sdhci_execute_tuning(struct sdhci_host *host, u32 opcode,
				   unsigned long flags)
{
	int i;

	/*
	 * Issue opcode repeatedly till Execute Tuning is set to 0 or the number
	 * of loops reaches 40 times.
	 */
	for (i = 0; i < MAX_TUNING_LOOP; i++) {
		u16 ctrl;

		sdhci_send_tuning(host, opcode, flags);

		if (!host->tuning_done) {
			pr_info("%s: Tuning timeout, falling back to fixed sampling clock\n",
				mmc_hostname(host->mmc));
			sdhci_abort_tuning(host, opcode, flags);
			return;
		}

		ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
		if (!(ctrl & SDHCI_CTRL_EXEC_TUNING)) {
			if (ctrl & SDHCI_CTRL_TUNED_CLK)
				return; /* Success! */
			break;
		}

		/* eMMC spec does not require a delay between tuning cycles */
		if (opcode == MMC_SEND_TUNING_BLOCK)
			mdelay(1);
	}

	pr_info("%s: Tuning failed, falling back to fixed sampling clock\n",
		mmc_hostname(host->mmc));
	sdhci_reset_tuning(host);
}

2104
int sdhci_execute_tuning(struct mmc_host *mmc, u32 opcode)
2105
{
2106
	struct sdhci_host *host = mmc_priv(mmc);
2107
	int err = 0;
2108
	unsigned long flags;
2109
	unsigned int tuning_count = 0;
2110
	bool hs400_tuning;
2111

2112
	spin_lock_irqsave(&host->lock, flags);
2113

2114 2115
	hs400_tuning = host->flags & SDHCI_HS400_TUNING;

2116 2117 2118
	if (host->tuning_mode == SDHCI_TUNING_MODE_1)
		tuning_count = host->tuning_count;

2119
	/*
W
Weijun Yang 已提交
2120 2121 2122
	 * The Host Controller needs tuning in case of SDR104 and DDR50
	 * mode, and for SDR50 mode when Use Tuning for SDR50 is set in
	 * the Capabilities register.
2123 2124
	 * If the Host Controller supports the HS200 mode then the
	 * tuning function has to be executed.
2125
	 */
2126
	switch (host->timing) {
2127
	/* HS400 tuning is done in HS200 mode */
2128
	case MMC_TIMING_MMC_HS400:
2129 2130 2131
		err = -EINVAL;
		goto out_unlock;

2132
	case MMC_TIMING_MMC_HS200:
2133 2134 2135 2136 2137 2138 2139 2140
		/*
		 * Periodic re-tuning for HS400 is not expected to be needed, so
		 * disable it here.
		 */
		if (hs400_tuning)
			tuning_count = 0;
		break;

2141
	case MMC_TIMING_UHS_SDR104:
W
Weijun Yang 已提交
2142
	case MMC_TIMING_UHS_DDR50:
2143 2144 2145
		break;

	case MMC_TIMING_UHS_SDR50:
2146
		if (host->flags & SDHCI_SDR50_NEEDS_TUNING)
2147 2148 2149 2150
			break;
		/* FALLTHROUGH */

	default:
2151
		goto out_unlock;
2152 2153
	}

2154
	if (host->ops->platform_execute_tuning) {
2155
		spin_unlock_irqrestore(&host->lock, flags);
2156 2157 2158
		err = host->ops->platform_execute_tuning(host, opcode);
		spin_lock_irqsave(&host->lock, flags);
		goto out_unlock;
2159 2160
	}

A
Adrian Hunter 已提交
2161
	host->mmc->retune_period = tuning_count;
2162

A
Adrian Hunter 已提交
2163
	sdhci_start_tuning(host);
2164

A
Adrian Hunter 已提交
2165
	__sdhci_execute_tuning(host, opcode, flags);
2166

2167
	sdhci_end_tuning(host);
2168
out_unlock:
2169
	host->flags &= ~SDHCI_HS400_TUNING;
2170
	spin_unlock_irqrestore(&host->lock, flags);
A
Adrian Hunter 已提交
2171

2172 2173
	return err;
}
2174
EXPORT_SYMBOL_GPL(sdhci_execute_tuning);
2175

2176
static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable)
2177 2178 2179 2180 2181 2182 2183 2184 2185
{
	/* Host Controller v3.00 defines preset value registers */
	if (host->version < SDHCI_SPEC_300)
		return;

	/*
	 * We only enable or disable Preset Value if they are not already
	 * enabled or disabled respectively. Otherwise, we bail out.
	 */
2186 2187 2188 2189 2190 2191 2192 2193
	if (host->preset_enabled != enable) {
		u16 ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);

		if (enable)
			ctrl |= SDHCI_CTRL_PRESET_VAL_ENABLE;
		else
			ctrl &= ~SDHCI_CTRL_PRESET_VAL_ENABLE;

2194
		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
2195 2196 2197 2198 2199 2200 2201

		if (enable)
			host->flags |= SDHCI_PV_ENABLED;
		else
			host->flags &= ~SDHCI_PV_ENABLED;

		host->preset_enabled = enable;
2202
	}
2203 2204
}

2205 2206 2207 2208 2209 2210
static void sdhci_post_req(struct mmc_host *mmc, struct mmc_request *mrq,
				int err)
{
	struct sdhci_host *host = mmc_priv(mmc);
	struct mmc_data *data = mrq->data;

2211
	if (data->host_cookie != COOKIE_UNMAPPED)
2212 2213 2214 2215 2216
		dma_unmap_sg(mmc_dev(host->mmc), data->sg, data->sg_len,
			     data->flags & MMC_DATA_WRITE ?
			       DMA_TO_DEVICE : DMA_FROM_DEVICE);

	data->host_cookie = COOKIE_UNMAPPED;
2217 2218
}

2219
static void sdhci_pre_req(struct mmc_host *mmc, struct mmc_request *mrq)
2220 2221 2222
{
	struct sdhci_host *host = mmc_priv(mmc);

2223
	mrq->data->host_cookie = COOKIE_UNMAPPED;
2224 2225

	if (host->flags & SDHCI_REQ_USE_DMA)
2226
		sdhci_pre_dma_transfer(host, mrq->data, COOKIE_PRE_MAPPED);
2227 2228
}

2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246
static inline bool sdhci_has_requests(struct sdhci_host *host)
{
	return host->cmd || host->data_cmd;
}

static void sdhci_error_out_mrqs(struct sdhci_host *host, int err)
{
	if (host->data_cmd) {
		host->data_cmd->error = err;
		sdhci_finish_mrq(host, host->data_cmd->mrq);
	}

	if (host->cmd) {
		host->cmd->error = err;
		sdhci_finish_mrq(host, host->cmd->mrq);
	}
}

2247
static void sdhci_card_event(struct mmc_host *mmc)
2248
{
2249
	struct sdhci_host *host = mmc_priv(mmc);
2250
	unsigned long flags;
2251
	int present;
2252

2253 2254 2255 2256
	/* First check if client has provided their own card event */
	if (host->ops->card_event)
		host->ops->card_event(host);

2257
	present = mmc->ops->get_cd(mmc);
2258

2259 2260
	spin_lock_irqsave(&host->lock, flags);

2261 2262
	/* Check sdhci_has_requests() first in case we are runtime suspended */
	if (sdhci_has_requests(host) && !present) {
2263
		pr_err("%s: Card removed during transfer!\n",
2264
			mmc_hostname(host->mmc));
2265
		pr_err("%s: Resetting controller.\n",
2266
			mmc_hostname(host->mmc));
2267

2268 2269
		sdhci_do_reset(host, SDHCI_RESET_CMD);
		sdhci_do_reset(host, SDHCI_RESET_DATA);
2270

2271
		sdhci_error_out_mrqs(host, -ENOMEDIUM);
2272 2273 2274
	}

	spin_unlock_irqrestore(&host->lock, flags);
2275 2276 2277 2278
}

static const struct mmc_host_ops sdhci_ops = {
	.request	= sdhci_request,
2279 2280
	.post_req	= sdhci_post_req,
	.pre_req	= sdhci_pre_req,
2281
	.set_ios	= sdhci_set_ios,
2282
	.get_cd		= sdhci_get_cd,
2283 2284 2285 2286
	.get_ro		= sdhci_get_ro,
	.hw_reset	= sdhci_hw_reset,
	.enable_sdio_irq = sdhci_enable_sdio_irq,
	.start_signal_voltage_switch	= sdhci_start_signal_voltage_switch,
2287
	.prepare_hs400_tuning		= sdhci_prepare_hs400_tuning,
2288 2289
	.execute_tuning			= sdhci_execute_tuning,
	.card_event			= sdhci_card_event,
2290
	.card_busy	= sdhci_card_busy,
2291 2292 2293 2294 2295 2296 2297 2298
};

/*****************************************************************************\
 *                                                                           *
 * Tasklets                                                                  *
 *                                                                           *
\*****************************************************************************/

2299
static bool sdhci_request_done(struct sdhci_host *host)
2300 2301 2302
{
	unsigned long flags;
	struct mmc_request *mrq;
2303
	int i;
2304

2305 2306
	spin_lock_irqsave(&host->lock, flags);

2307 2308
	for (i = 0; i < SDHCI_MAX_MRQS; i++) {
		mrq = host->mrqs_done[i];
2309
		if (mrq)
2310
			break;
2311
	}
2312

2313 2314 2315 2316
	if (!mrq) {
		spin_unlock_irqrestore(&host->lock, flags);
		return true;
	}
2317

2318 2319
	sdhci_del_timer(host, mrq);

2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335
	/*
	 * Always unmap the data buffers if they were mapped by
	 * sdhci_prepare_data() whenever we finish with a request.
	 * This avoids leaking DMA mappings on error.
	 */
	if (host->flags & SDHCI_REQ_USE_DMA) {
		struct mmc_data *data = mrq->data;

		if (data && data->host_cookie == COOKIE_MAPPED) {
			dma_unmap_sg(mmc_dev(host->mmc), data->sg, data->sg_len,
				     (data->flags & MMC_DATA_READ) ?
				     DMA_FROM_DEVICE : DMA_TO_DEVICE);
			data->host_cookie = COOKIE_UNMAPPED;
		}
	}

2336 2337 2338 2339
	/*
	 * The controller needs a reset of internal state machines
	 * upon error conditions.
	 */
2340
	if (sdhci_needs_reset(host, mrq)) {
2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351
		/*
		 * Do not finish until command and data lines are available for
		 * reset. Note there can only be one other mrq, so it cannot
		 * also be in mrqs_done, otherwise host->cmd and host->data_cmd
		 * would both be null.
		 */
		if (host->cmd || host->data_cmd) {
			spin_unlock_irqrestore(&host->lock, flags);
			return true;
		}

2352
		/* Some controllers need this kick or reset won't work here */
2353
		if (host->quirks & SDHCI_QUIRK_CLOCK_BEFORE_RESET)
2354
			/* This is to force an update */
2355
			host->ops->set_clock(host, host->clock);
2356 2357 2358

		/* Spec says we should do both at the same time, but Ricoh
		   controllers do not like that. */
2359 2360
		sdhci_do_reset(host, SDHCI_RESET_CMD);
		sdhci_do_reset(host, SDHCI_RESET_DATA);
2361 2362

		host->pending_reset = false;
2363 2364
	}

2365 2366
	if (!sdhci_has_requests(host))
		sdhci_led_deactivate(host);
2367

2368 2369
	host->mrqs_done[i] = NULL;

2370
	mmiowb();
2371 2372 2373
	spin_unlock_irqrestore(&host->lock, flags);

	mmc_request_done(host->mmc, mrq);
2374 2375 2376 2377 2378 2379 2380 2381 2382 2383

	return false;
}

static void sdhci_tasklet_finish(unsigned long param)
{
	struct sdhci_host *host = (struct sdhci_host *)param;

	while (!sdhci_request_done(host))
		;
2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394
}

static void sdhci_timeout_timer(unsigned long data)
{
	struct sdhci_host *host;
	unsigned long flags;

	host = (struct sdhci_host*)data;

	spin_lock_irqsave(&host->lock, flags);

2395 2396 2397 2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418
	if (host->cmd && !sdhci_data_line_cmd(host->cmd)) {
		pr_err("%s: Timeout waiting for hardware cmd interrupt.\n",
		       mmc_hostname(host->mmc));
		sdhci_dumpregs(host);

		host->cmd->error = -ETIMEDOUT;
		sdhci_finish_mrq(host, host->cmd->mrq);
	}

	mmiowb();
	spin_unlock_irqrestore(&host->lock, flags);
}

static void sdhci_timeout_data_timer(unsigned long data)
{
	struct sdhci_host *host;
	unsigned long flags;

	host = (struct sdhci_host *)data;

	spin_lock_irqsave(&host->lock, flags);

	if (host->data || host->data_cmd ||
	    (host->cmd && sdhci_data_line_cmd(host->cmd))) {
2419 2420
		pr_err("%s: Timeout waiting for hardware interrupt.\n",
		       mmc_hostname(host->mmc));
2421 2422 2423
		sdhci_dumpregs(host);

		if (host->data) {
P
Pierre Ossman 已提交
2424
			host->data->error = -ETIMEDOUT;
2425
			sdhci_finish_data(host);
2426 2427 2428
		} else if (host->data_cmd) {
			host->data_cmd->error = -ETIMEDOUT;
			sdhci_finish_mrq(host, host->data_cmd->mrq);
2429
		} else {
2430 2431
			host->cmd->error = -ETIMEDOUT;
			sdhci_finish_mrq(host, host->cmd->mrq);
2432 2433 2434
		}
	}

2435
	mmiowb();
2436 2437 2438 2439 2440 2441 2442 2443 2444
	spin_unlock_irqrestore(&host->lock, flags);
}

/*****************************************************************************\
 *                                                                           *
 * Interrupt handling                                                        *
 *                                                                           *
\*****************************************************************************/

2445
static void sdhci_cmd_irq(struct sdhci_host *host, u32 intmask)
2446 2447
{
	if (!host->cmd) {
2448 2449 2450 2451 2452 2453 2454
		/*
		 * SDHCI recovers from errors by resetting the cmd and data
		 * circuits.  Until that is done, there very well might be more
		 * interrupts, so ignore them in that case.
		 */
		if (host->pending_reset)
			return;
2455 2456
		pr_err("%s: Got command interrupt 0x%08x even though no command operation was in progress.\n",
		       mmc_hostname(host->mmc), (unsigned)intmask);
2457 2458 2459 2460
		sdhci_dumpregs(host);
		return;
	}

2461 2462 2463 2464 2465 2466
	if (intmask & (SDHCI_INT_TIMEOUT | SDHCI_INT_CRC |
		       SDHCI_INT_END_BIT | SDHCI_INT_INDEX)) {
		if (intmask & SDHCI_INT_TIMEOUT)
			host->cmd->error = -ETIMEDOUT;
		else
			host->cmd->error = -EILSEQ;
2467

2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484
		/*
		 * If this command initiates a data phase and a response
		 * CRC error is signalled, the card can start transferring
		 * data - the card may have received the command without
		 * error.  We must not terminate the mmc_request early.
		 *
		 * If the card did not receive the command or returned an
		 * error which prevented it sending data, the data phase
		 * will time out.
		 */
		if (host->cmd->data &&
		    (intmask & (SDHCI_INT_CRC | SDHCI_INT_TIMEOUT)) ==
		     SDHCI_INT_CRC) {
			host->cmd = NULL;
			return;
		}

2485
		sdhci_finish_mrq(host, host->cmd->mrq);
2486 2487 2488 2489
		return;
	}

	if (intmask & SDHCI_INT_RESPONSE)
2490
		sdhci_finish_command(host);
2491 2492
}

2493
#ifdef CONFIG_MMC_DEBUG
2494
static void sdhci_adma_show_error(struct sdhci_host *host)
2495 2496
{
	const char *name = mmc_hostname(host->mmc);
2497
	void *desc = host->adma_table;
2498 2499 2500 2501

	sdhci_dumpregs(host);

	while (true) {
2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513 2514
		struct sdhci_adma2_64_desc *dma_desc = desc;

		if (host->flags & SDHCI_USE_64_BIT_DMA)
			DBG("%s: %p: DMA 0x%08x%08x, LEN 0x%04x, Attr=0x%02x\n",
			    name, desc, le32_to_cpu(dma_desc->addr_hi),
			    le32_to_cpu(dma_desc->addr_lo),
			    le16_to_cpu(dma_desc->len),
			    le16_to_cpu(dma_desc->cmd));
		else
			DBG("%s: %p: DMA 0x%08x, LEN 0x%04x, Attr=0x%02x\n",
			    name, desc, le32_to_cpu(dma_desc->addr_lo),
			    le16_to_cpu(dma_desc->len),
			    le16_to_cpu(dma_desc->cmd));
2515

2516
		desc += host->desc_sz;
2517

2518
		if (dma_desc->cmd & cpu_to_le16(ADMA2_END))
2519 2520 2521 2522
			break;
	}
}
#else
2523
static void sdhci_adma_show_error(struct sdhci_host *host) { }
2524 2525
#endif

2526 2527
static void sdhci_data_irq(struct sdhci_host *host, u32 intmask)
{
2528
	u32 command;
2529

2530 2531
	/* CMD19 generates _only_ Buffer Read Ready interrupt */
	if (intmask & SDHCI_INT_DATA_AVAIL) {
2532 2533 2534
		command = SDHCI_GET_CMD(sdhci_readw(host, SDHCI_COMMAND));
		if (command == MMC_SEND_TUNING_BLOCK ||
		    command == MMC_SEND_TUNING_BLOCK_HS200) {
2535 2536 2537 2538 2539 2540
			host->tuning_done = 1;
			wake_up(&host->buf_ready_int);
			return;
		}
	}

2541
	if (!host->data) {
2542 2543
		struct mmc_command *data_cmd = host->data_cmd;

2544
		/*
2545 2546 2547
		 * The "data complete" interrupt is also used to
		 * indicate that a busy state has ended. See comment
		 * above in sdhci_cmd_irq().
2548
		 */
2549
		if (data_cmd && (data_cmd->flags & MMC_RSP_BUSY)) {
2550
			if (intmask & SDHCI_INT_DATA_TIMEOUT) {
2551
				host->data_cmd = NULL;
2552
				data_cmd->error = -ETIMEDOUT;
2553
				sdhci_finish_mrq(host, data_cmd->mrq);
2554 2555
				return;
			}
2556
			if (intmask & SDHCI_INT_DATA_END) {
2557
				host->data_cmd = NULL;
2558 2559 2560 2561 2562
				/*
				 * Some cards handle busy-end interrupt
				 * before the command completed, so make
				 * sure we do things in the proper order.
				 */
2563 2564 2565
				if (host->cmd == data_cmd)
					return;

2566
				sdhci_finish_mrq(host, data_cmd->mrq);
2567 2568 2569
				return;
			}
		}
2570

2571 2572 2573 2574 2575 2576 2577 2578
		/*
		 * SDHCI recovers from errors by resetting the cmd and data
		 * circuits. Until that is done, there very well might be more
		 * interrupts, so ignore them in that case.
		 */
		if (host->pending_reset)
			return;

2579 2580
		pr_err("%s: Got data interrupt 0x%08x even though no data operation was in progress.\n",
		       mmc_hostname(host->mmc), (unsigned)intmask);
2581 2582 2583 2584 2585 2586
		sdhci_dumpregs(host);

		return;
	}

	if (intmask & SDHCI_INT_DATA_TIMEOUT)
P
Pierre Ossman 已提交
2587
		host->data->error = -ETIMEDOUT;
2588 2589 2590 2591 2592
	else if (intmask & SDHCI_INT_DATA_END_BIT)
		host->data->error = -EILSEQ;
	else if ((intmask & SDHCI_INT_DATA_CRC) &&
		SDHCI_GET_CMD(sdhci_readw(host, SDHCI_COMMAND))
			!= MMC_BUS_TEST_R)
P
Pierre Ossman 已提交
2593
		host->data->error = -EILSEQ;
2594
	else if (intmask & SDHCI_INT_ADMA_ERROR) {
2595
		pr_err("%s: ADMA error\n", mmc_hostname(host->mmc));
2596
		sdhci_adma_show_error(host);
2597
		host->data->error = -EIO;
2598 2599
		if (host->ops->adma_workaround)
			host->ops->adma_workaround(host, intmask);
2600
	}
2601

P
Pierre Ossman 已提交
2602
	if (host->data->error)
2603 2604
		sdhci_finish_data(host);
	else {
P
Pierre Ossman 已提交
2605
		if (intmask & (SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL))
2606 2607
			sdhci_transfer_pio(host);

2608 2609 2610 2611
		/*
		 * We currently don't do anything fancy with DMA
		 * boundaries, but as we can't disable the feature
		 * we need to at least restart the transfer.
2612 2613 2614 2615
		 *
		 * According to the spec sdhci_readl(host, SDHCI_DMA_ADDRESS)
		 * should return a valid address to continue from, but as
		 * some controllers are faulty, don't trust them.
2616
		 */
2617 2618 2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633
		if (intmask & SDHCI_INT_DMA_END) {
			u32 dmastart, dmanow;
			dmastart = sg_dma_address(host->data->sg);
			dmanow = dmastart + host->data->bytes_xfered;
			/*
			 * Force update to the next DMA block boundary.
			 */
			dmanow = (dmanow &
				~(SDHCI_DEFAULT_BOUNDARY_SIZE - 1)) +
				SDHCI_DEFAULT_BOUNDARY_SIZE;
			host->data->bytes_xfered = dmanow - dmastart;
			DBG("%s: DMA base 0x%08x, transferred 0x%06x bytes,"
				" next 0x%08x\n",
				mmc_hostname(host->mmc), dmastart,
				host->data->bytes_xfered, dmanow);
			sdhci_writel(host, dmanow, SDHCI_DMA_ADDRESS);
		}
2634

2635
		if (intmask & SDHCI_INT_DATA_END) {
2636
			if (host->cmd == host->data_cmd) {
2637 2638 2639 2640 2641 2642 2643 2644 2645 2646
				/*
				 * Data managed to finish before the
				 * command completed. Make sure we do
				 * things in the proper order.
				 */
				host->data_early = 1;
			} else {
				sdhci_finish_data(host);
			}
		}
2647 2648 2649
	}
}

2650
static irqreturn_t sdhci_irq(int irq, void *dev_id)
2651
{
2652
	irqreturn_t result = IRQ_NONE;
2653
	struct sdhci_host *host = dev_id;
2654
	u32 intmask, mask, unexpected = 0;
2655
	int max_loops = 16;
2656 2657 2658

	spin_lock(&host->lock);

2659
	if (host->runtime_suspended && !sdhci_sdio_irq_enabled(host)) {
2660
		spin_unlock(&host->lock);
2661
		return IRQ_NONE;
2662 2663
	}

2664
	intmask = sdhci_readl(host, SDHCI_INT_STATUS);
2665
	if (!intmask || intmask == 0xffffffff) {
2666 2667 2668 2669
		result = IRQ_NONE;
		goto out;
	}

2670 2671 2672 2673 2674
	do {
		/* Clear selected interrupts. */
		mask = intmask & (SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK |
				  SDHCI_INT_BUS_POWER);
		sdhci_writel(host, mask, SDHCI_INT_STATUS);
2675

2676 2677
		DBG("*** %s got interrupt: 0x%08x\n",
			mmc_hostname(host->mmc), intmask);
2678

2679 2680 2681
		if (intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
			u32 present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
				      SDHCI_CARD_PRESENT;
2682

2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693
			/*
			 * There is a observation on i.mx esdhc.  INSERT
			 * bit will be immediately set again when it gets
			 * cleared, if a card is inserted.  We have to mask
			 * the irq to prevent interrupt storm which will
			 * freeze the system.  And the REMOVE gets the
			 * same situation.
			 *
			 * More testing are needed here to ensure it works
			 * for other platforms though.
			 */
2694 2695 2696 2697 2698 2699
			host->ier &= ~(SDHCI_INT_CARD_INSERT |
				       SDHCI_INT_CARD_REMOVE);
			host->ier |= present ? SDHCI_INT_CARD_REMOVE :
					       SDHCI_INT_CARD_INSERT;
			sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
			sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
2700 2701 2702

			sdhci_writel(host, intmask & (SDHCI_INT_CARD_INSERT |
				     SDHCI_INT_CARD_REMOVE), SDHCI_INT_STATUS);
2703 2704 2705 2706

			host->thread_isr |= intmask & (SDHCI_INT_CARD_INSERT |
						       SDHCI_INT_CARD_REMOVE);
			result = IRQ_WAKE_THREAD;
2707
		}
2708

2709
		if (intmask & SDHCI_INT_CMD_MASK)
2710
			sdhci_cmd_irq(host, intmask & SDHCI_INT_CMD_MASK);
2711

2712 2713
		if (intmask & SDHCI_INT_DATA_MASK)
			sdhci_data_irq(host, intmask & SDHCI_INT_DATA_MASK);
2714

2715 2716 2717
		if (intmask & SDHCI_INT_BUS_POWER)
			pr_err("%s: Card is consuming too much power!\n",
				mmc_hostname(host->mmc));
2718

2719 2720 2721
		if (intmask & SDHCI_INT_RETUNE)
			mmc_retune_needed(host->mmc);

2722 2723
		if ((intmask & SDHCI_INT_CARD_INT) &&
		    (host->ier & SDHCI_INT_CARD_INT)) {
2724 2725 2726 2727
			sdhci_enable_sdio_irq_nolock(host, false);
			host->thread_isr |= SDHCI_INT_CARD_INT;
			result = IRQ_WAKE_THREAD;
		}
P
Pierre Ossman 已提交
2728

2729 2730 2731
		intmask &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE |
			     SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK |
			     SDHCI_INT_ERROR | SDHCI_INT_BUS_POWER |
2732
			     SDHCI_INT_RETUNE | SDHCI_INT_CARD_INT);
P
Pierre Ossman 已提交
2733

2734 2735 2736 2737
		if (intmask) {
			unexpected |= intmask;
			sdhci_writel(host, intmask, SDHCI_INT_STATUS);
		}
2738

2739 2740
		if (result == IRQ_NONE)
			result = IRQ_HANDLED;
2741

2742 2743
		intmask = sdhci_readl(host, SDHCI_INT_STATUS);
	} while (intmask && --max_loops);
2744 2745 2746
out:
	spin_unlock(&host->lock);

2747 2748 2749 2750 2751
	if (unexpected) {
		pr_err("%s: Unexpected interrupt 0x%08x.\n",
			   mmc_hostname(host->mmc), unexpected);
		sdhci_dumpregs(host);
	}
P
Pierre Ossman 已提交
2752

2753 2754 2755
	return result;
}

2756 2757 2758 2759 2760 2761 2762 2763 2764 2765 2766
static irqreturn_t sdhci_thread_irq(int irq, void *dev_id)
{
	struct sdhci_host *host = dev_id;
	unsigned long flags;
	u32 isr;

	spin_lock_irqsave(&host->lock, flags);
	isr = host->thread_isr;
	host->thread_isr = 0;
	spin_unlock_irqrestore(&host->lock, flags);

2767
	if (isr & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
2768 2769 2770 2771
		struct mmc_host *mmc = host->mmc;

		mmc->ops->card_event(mmc);
		mmc_detect_change(mmc, msecs_to_jiffies(200));
2772 2773
	}

2774 2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785
	if (isr & SDHCI_INT_CARD_INT) {
		sdio_run_irqs(host->mmc);

		spin_lock_irqsave(&host->lock, flags);
		if (host->flags & SDHCI_SDIO_IRQ_ENABLED)
			sdhci_enable_sdio_irq_nolock(host, true);
		spin_unlock_irqrestore(&host->lock, flags);
	}

	return isr ? IRQ_HANDLED : IRQ_NONE;
}

2786 2787 2788 2789 2790 2791 2792
/*****************************************************************************\
 *                                                                           *
 * Suspend/resume                                                            *
 *                                                                           *
\*****************************************************************************/

#ifdef CONFIG_PM
2793 2794 2795 2796 2797 2798 2799 2800
/*
 * To enable wakeup events, the corresponding events have to be enabled in
 * the Interrupt Status Enable register too. See 'Table 1-6: Wakeup Signal
 * Table' in the SD Host Controller Standard Specification.
 * It is useless to restore SDHCI_INT_ENABLE state in
 * sdhci_disable_irq_wakeups() since it will be set by
 * sdhci_enable_card_detection() or sdhci_init().
 */
K
Kevin Liu 已提交
2801 2802 2803 2804 2805
void sdhci_enable_irq_wakeups(struct sdhci_host *host)
{
	u8 val;
	u8 mask = SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE
			| SDHCI_WAKE_ON_INT;
2806 2807
	u32 irq_val = SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE |
		      SDHCI_INT_CARD_INT;
K
Kevin Liu 已提交
2808 2809 2810 2811

	val = sdhci_readb(host, SDHCI_WAKE_UP_CONTROL);
	val |= mask ;
	/* Avoid fake wake up */
2812
	if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) {
K
Kevin Liu 已提交
2813
		val &= ~(SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE);
2814 2815
		irq_val &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE);
	}
K
Kevin Liu 已提交
2816
	sdhci_writeb(host, val, SDHCI_WAKE_UP_CONTROL);
2817
	sdhci_writel(host, irq_val, SDHCI_INT_ENABLE);
K
Kevin Liu 已提交
2818 2819 2820
}
EXPORT_SYMBOL_GPL(sdhci_enable_irq_wakeups);

2821
static void sdhci_disable_irq_wakeups(struct sdhci_host *host)
K
Kevin Liu 已提交
2822 2823 2824 2825 2826 2827 2828 2829 2830
{
	u8 val;
	u8 mask = SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE
			| SDHCI_WAKE_ON_INT;

	val = sdhci_readb(host, SDHCI_WAKE_UP_CONTROL);
	val &= ~mask;
	sdhci_writeb(host, val, SDHCI_WAKE_UP_CONTROL);
}
2831

2832
int sdhci_suspend_host(struct sdhci_host *host)
2833
{
2834 2835
	sdhci_disable_card_detection(host);

2836
	mmc_retune_timer_stop(host->mmc);
2837

K
Kevin Liu 已提交
2838
	if (!device_may_wakeup(mmc_dev(host->mmc))) {
2839 2840 2841
		host->ier = 0;
		sdhci_writel(host, 0, SDHCI_INT_ENABLE);
		sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
K
Kevin Liu 已提交
2842 2843 2844 2845 2846
		free_irq(host->irq, host);
	} else {
		sdhci_enable_irq_wakeups(host);
		enable_irq_wake(host->irq);
	}
2847
	return 0;
2848 2849
}

2850
EXPORT_SYMBOL_GPL(sdhci_suspend_host);
2851

2852 2853
int sdhci_resume_host(struct sdhci_host *host)
{
2854
	struct mmc_host *mmc = host->mmc;
2855
	int ret = 0;
2856

2857
	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
2858 2859 2860
		if (host->ops->enable_dma)
			host->ops->enable_dma(host);
	}
2861

2862 2863 2864 2865 2866 2867
	if ((host->mmc->pm_flags & MMC_PM_KEEP_POWER) &&
	    (host->quirks2 & SDHCI_QUIRK2_HOST_OFF_CARD_ON)) {
		/* Card keeps power but host controller does not */
		sdhci_init(host, 0);
		host->pwr = 0;
		host->clock = 0;
2868
		mmc->ops->set_ios(mmc, &mmc->ios);
2869 2870 2871 2872
	} else {
		sdhci_init(host, (host->mmc->pm_flags & MMC_PM_KEEP_POWER));
		mmiowb();
	}
2873

2874 2875 2876 2877 2878 2879 2880 2881 2882 2883 2884
	if (!device_may_wakeup(mmc_dev(host->mmc))) {
		ret = request_threaded_irq(host->irq, sdhci_irq,
					   sdhci_thread_irq, IRQF_SHARED,
					   mmc_hostname(host->mmc), host);
		if (ret)
			return ret;
	} else {
		sdhci_disable_irq_wakeups(host);
		disable_irq_wake(host->irq);
	}

2885 2886
	sdhci_enable_card_detection(host);

2887
	return ret;
2888 2889
}

2890
EXPORT_SYMBOL_GPL(sdhci_resume_host);
2891 2892 2893 2894 2895

int sdhci_runtime_suspend_host(struct sdhci_host *host)
{
	unsigned long flags;

2896
	mmc_retune_timer_stop(host->mmc);
2897 2898

	spin_lock_irqsave(&host->lock, flags);
2899 2900 2901
	host->ier &= SDHCI_INT_CARD_INT;
	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
2902 2903
	spin_unlock_irqrestore(&host->lock, flags);

2904
	synchronize_hardirq(host->irq);
2905 2906 2907 2908 2909

	spin_lock_irqsave(&host->lock, flags);
	host->runtime_suspended = true;
	spin_unlock_irqrestore(&host->lock, flags);

2910
	return 0;
2911 2912 2913 2914 2915
}
EXPORT_SYMBOL_GPL(sdhci_runtime_suspend_host);

int sdhci_runtime_resume_host(struct sdhci_host *host)
{
2916
	struct mmc_host *mmc = host->mmc;
2917
	unsigned long flags;
2918
	int host_flags = host->flags;
2919 2920 2921 2922 2923 2924 2925 2926

	if (host_flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
		if (host->ops->enable_dma)
			host->ops->enable_dma(host);
	}

	sdhci_init(host, 0);

2927 2928 2929 2930 2931 2932
	if (mmc->ios.power_mode != MMC_POWER_UNDEFINED) {
		/* Force clock and power re-program */
		host->pwr = 0;
		host->clock = 0;
		mmc->ops->start_signal_voltage_switch(mmc, &mmc->ios);
		mmc->ops->set_ios(mmc, &mmc->ios);
2933

2934 2935 2936 2937 2938 2939
		if ((host_flags & SDHCI_PV_ENABLED) &&
		    !(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN)) {
			spin_lock_irqsave(&host->lock, flags);
			sdhci_enable_preset_value(host, true);
			spin_unlock_irqrestore(&host->lock, flags);
		}
2940

2941 2942 2943 2944
		if ((mmc->caps2 & MMC_CAP2_HS400_ES) &&
		    mmc->ops->hs400_enhanced_strobe)
			mmc->ops->hs400_enhanced_strobe(mmc, &mmc->ios);
	}
2945

2946 2947 2948 2949 2950
	spin_lock_irqsave(&host->lock, flags);

	host->runtime_suspended = false;

	/* Enable SDIO IRQ */
2951
	if (host->flags & SDHCI_SDIO_IRQ_ENABLED)
2952 2953 2954 2955 2956 2957 2958
		sdhci_enable_sdio_irq_nolock(host, true);

	/* Enable Card Detection */
	sdhci_enable_card_detection(host);

	spin_unlock_irqrestore(&host->lock, flags);

2959
	return 0;
2960 2961 2962
}
EXPORT_SYMBOL_GPL(sdhci_runtime_resume_host);

2963
#endif /* CONFIG_PM */
2964

2965 2966
/*****************************************************************************\
 *                                                                           *
2967
 * Device allocation/registration                                            *
2968 2969 2970
 *                                                                           *
\*****************************************************************************/

2971 2972
struct sdhci_host *sdhci_alloc_host(struct device *dev,
	size_t priv_size)
2973 2974 2975 2976
{
	struct mmc_host *mmc;
	struct sdhci_host *host;

2977
	WARN_ON(dev == NULL);
2978

2979
	mmc = mmc_alloc_host(sizeof(struct sdhci_host) + priv_size, dev);
2980
	if (!mmc)
2981
		return ERR_PTR(-ENOMEM);
2982 2983 2984

	host = mmc_priv(mmc);
	host->mmc = mmc;
2985 2986
	host->mmc_host_ops = sdhci_ops;
	mmc->ops = &host->mmc_host_ops;
2987

2988 2989
	host->flags = SDHCI_SIGNALING_330;

2990 2991
	return host;
}
2992

2993
EXPORT_SYMBOL_GPL(sdhci_alloc_host);
2994

2995 2996 2997 2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024
static int sdhci_set_dma_mask(struct sdhci_host *host)
{
	struct mmc_host *mmc = host->mmc;
	struct device *dev = mmc_dev(mmc);
	int ret = -EINVAL;

	if (host->quirks2 & SDHCI_QUIRK2_BROKEN_64_BIT_DMA)
		host->flags &= ~SDHCI_USE_64_BIT_DMA;

	/* Try 64-bit mask if hardware is capable  of it */
	if (host->flags & SDHCI_USE_64_BIT_DMA) {
		ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(64));
		if (ret) {
			pr_warn("%s: Failed to set 64-bit DMA mask.\n",
				mmc_hostname(mmc));
			host->flags &= ~SDHCI_USE_64_BIT_DMA;
		}
	}

	/* 32-bit mask as default & fallback */
	if (ret) {
		ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(32));
		if (ret)
			pr_warn("%s: Failed to set 32-bit DMA mask.\n",
				mmc_hostname(mmc));
	}

	return ret;
}

3025 3026 3027
void __sdhci_read_caps(struct sdhci_host *host, u16 *ver, u32 *caps, u32 *caps1)
{
	u16 v;
3028 3029
	u64 dt_caps_mask = 0;
	u64 dt_caps = 0;
3030 3031 3032 3033 3034 3035 3036 3037 3038 3039 3040 3041 3042 3043

	if (host->read_caps)
		return;

	host->read_caps = true;

	if (debug_quirks)
		host->quirks = debug_quirks;

	if (debug_quirks2)
		host->quirks2 = debug_quirks2;

	sdhci_do_reset(host, SDHCI_RESET_ALL);

3044 3045 3046 3047 3048
	of_property_read_u64(mmc_dev(host->mmc)->of_node,
			     "sdhci-caps-mask", &dt_caps_mask);
	of_property_read_u64(mmc_dev(host->mmc)->of_node,
			     "sdhci-caps", &dt_caps);

3049 3050 3051 3052 3053 3054
	v = ver ? *ver : sdhci_readw(host, SDHCI_HOST_VERSION);
	host->version = (v & SDHCI_SPEC_VER_MASK) >> SDHCI_SPEC_VER_SHIFT;

	if (host->quirks & SDHCI_QUIRK_MISSING_CAPS)
		return;

3055 3056 3057 3058 3059 3060 3061
	if (caps) {
		host->caps = *caps;
	} else {
		host->caps = sdhci_readl(host, SDHCI_CAPABILITIES);
		host->caps &= ~lower_32_bits(dt_caps_mask);
		host->caps |= lower_32_bits(dt_caps);
	}
3062 3063 3064 3065

	if (host->version < SDHCI_SPEC_300)
		return;

3066 3067 3068 3069 3070 3071 3072
	if (caps1) {
		host->caps1 = *caps1;
	} else {
		host->caps1 = sdhci_readl(host, SDHCI_CAPABILITIES_1);
		host->caps1 &= ~upper_32_bits(dt_caps_mask);
		host->caps1 |= upper_32_bits(dt_caps);
	}
3073 3074 3075
}
EXPORT_SYMBOL_GPL(__sdhci_read_caps);

3076
int sdhci_setup_host(struct sdhci_host *host)
3077 3078
{
	struct mmc_host *mmc;
3079 3080
	u32 max_current_caps;
	unsigned int ocr_avail;
3081
	unsigned int override_timeout_clk;
3082
	u32 max_clk;
3083
	int ret;
3084

3085 3086 3087
	WARN_ON(host == NULL);
	if (host == NULL)
		return -EINVAL;
3088

3089
	mmc = host->mmc;
3090

3091 3092 3093 3094 3095 3096 3097 3098 3099 3100
	/*
	 * If there are external regulators, get them. Note this must be done
	 * early before resetting the host and reading the capabilities so that
	 * the host can take the appropriate action if regulators are not
	 * available.
	 */
	ret = mmc_regulator_get_supply(mmc);
	if (ret == -EPROBE_DEFER)
		return ret;

3101
	sdhci_read_caps(host);
3102

3103 3104
	override_timeout_clk = host->timeout_clk;

3105
	if (host->version > SDHCI_SPEC_300) {
3106 3107
		pr_err("%s: Unknown controller version (%d). You may experience problems.\n",
		       mmc_hostname(mmc), host->version);
3108 3109
	}

3110
	if (host->quirks & SDHCI_QUIRK_FORCE_DMA)
3111
		host->flags |= SDHCI_USE_SDMA;
3112
	else if (!(host->caps & SDHCI_CAN_DO_SDMA))
3113
		DBG("Controller doesn't have SDMA capability\n");
3114
	else
3115
		host->flags |= SDHCI_USE_SDMA;
3116

3117
	if ((host->quirks & SDHCI_QUIRK_BROKEN_DMA) &&
3118
		(host->flags & SDHCI_USE_SDMA)) {
R
Rolf Eike Beer 已提交
3119
		DBG("Disabling DMA as it is marked broken\n");
3120
		host->flags &= ~SDHCI_USE_SDMA;
3121 3122
	}

3123
	if ((host->version >= SDHCI_SPEC_200) &&
3124
		(host->caps & SDHCI_CAN_DO_ADMA2))
3125
		host->flags |= SDHCI_USE_ADMA;
3126 3127 3128 3129 3130 3131 3132

	if ((host->quirks & SDHCI_QUIRK_BROKEN_ADMA) &&
		(host->flags & SDHCI_USE_ADMA)) {
		DBG("Disabling ADMA as it is marked broken\n");
		host->flags &= ~SDHCI_USE_ADMA;
	}

3133 3134 3135 3136 3137 3138 3139
	/*
	 * It is assumed that a 64-bit capable device has set a 64-bit DMA mask
	 * and *must* do 64-bit DMA.  A driver has the opportunity to change
	 * that during the first call to ->enable_dma().  Similarly
	 * SDHCI_QUIRK2_BROKEN_64_BIT_DMA must be left to the drivers to
	 * implement.
	 */
3140
	if (host->caps & SDHCI_CAN_64BIT)
3141 3142
		host->flags |= SDHCI_USE_64_BIT_DMA;

3143
	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
3144 3145 3146 3147 3148 3149 3150 3151 3152 3153 3154
		ret = sdhci_set_dma_mask(host);

		if (!ret && host->ops->enable_dma)
			ret = host->ops->enable_dma(host);

		if (ret) {
			pr_warn("%s: No suitable DMA available - falling back to PIO\n",
				mmc_hostname(mmc));
			host->flags &= ~(SDHCI_USE_SDMA | SDHCI_USE_ADMA);

			ret = 0;
3155 3156 3157
		}
	}

3158 3159 3160 3161
	/* SDMA does not support 64-bit DMA */
	if (host->flags & SDHCI_USE_64_BIT_DMA)
		host->flags &= ~SDHCI_USE_SDMA;

3162
	if (host->flags & SDHCI_USE_ADMA) {
3163 3164 3165
		dma_addr_t dma;
		void *buf;

3166
		/*
3167 3168 3169 3170
		 * The DMA descriptor table size is calculated as the maximum
		 * number of segments times 2, to allow for an alignment
		 * descriptor for each segment, plus 1 for a nop end descriptor,
		 * all multipled by the descriptor size.
3171
		 */
3172 3173 3174 3175 3176 3177 3178 3179 3180
		if (host->flags & SDHCI_USE_64_BIT_DMA) {
			host->adma_table_sz = (SDHCI_MAX_SEGS * 2 + 1) *
					      SDHCI_ADMA2_64_DESC_SZ;
			host->desc_sz = SDHCI_ADMA2_64_DESC_SZ;
		} else {
			host->adma_table_sz = (SDHCI_MAX_SEGS * 2 + 1) *
					      SDHCI_ADMA2_32_DESC_SZ;
			host->desc_sz = SDHCI_ADMA2_32_DESC_SZ;
		}
3181

3182
		host->align_buffer_sz = SDHCI_MAX_SEGS * SDHCI_ADMA2_ALIGN;
3183 3184 3185
		buf = dma_alloc_coherent(mmc_dev(mmc), host->align_buffer_sz +
					 host->adma_table_sz, &dma, GFP_KERNEL);
		if (!buf) {
J
Joe Perches 已提交
3186
			pr_warn("%s: Unable to allocate ADMA buffers - falling back to standard DMA\n",
3187 3188
				mmc_hostname(mmc));
			host->flags &= ~SDHCI_USE_ADMA;
3189 3190
		} else if ((dma + host->align_buffer_sz) &
			   (SDHCI_ADMA2_DESC_ALIGN - 1)) {
J
Joe Perches 已提交
3191 3192
			pr_warn("%s: unable to allocate aligned ADMA descriptor\n",
				mmc_hostname(mmc));
3193
			host->flags &= ~SDHCI_USE_ADMA;
3194 3195 3196 3197 3198
			dma_free_coherent(mmc_dev(mmc), host->align_buffer_sz +
					  host->adma_table_sz, buf, dma);
		} else {
			host->align_buffer = buf;
			host->align_addr = dma;
3199

3200 3201 3202
			host->adma_table = buf + host->align_buffer_sz;
			host->adma_addr = dma + host->align_buffer_sz;
		}
3203 3204
	}

3205 3206 3207 3208 3209
	/*
	 * If we use DMA, then it's up to the caller to set the DMA
	 * mask, but PIO does not need the hw shim so we set a new
	 * mask here in that case.
	 */
3210
	if (!(host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA))) {
3211
		host->dma_mask = DMA_BIT_MASK(64);
3212
		mmc_dev(mmc)->dma_mask = &host->dma_mask;
3213
	}
3214

3215
	if (host->version >= SDHCI_SPEC_300)
3216
		host->max_clk = (host->caps & SDHCI_CLOCK_V3_BASE_MASK)
3217 3218
			>> SDHCI_CLOCK_BASE_SHIFT;
	else
3219
		host->max_clk = (host->caps & SDHCI_CLOCK_BASE_MASK)
3220 3221
			>> SDHCI_CLOCK_BASE_SHIFT;

3222
	host->max_clk *= 1000000;
3223 3224
	if (host->max_clk == 0 || host->quirks &
			SDHCI_QUIRK_CAP_CLOCK_BASE_BROKEN) {
3225
		if (!host->ops->get_max_clock) {
3226 3227
			pr_err("%s: Hardware doesn't specify base clock frequency.\n",
			       mmc_hostname(mmc));
3228 3229
			ret = -ENODEV;
			goto undma;
3230 3231
		}
		host->max_clk = host->ops->get_max_clock(host);
3232
	}
3233

3234 3235 3236 3237
	/*
	 * In case of Host Controller v3.00, find out whether clock
	 * multiplier is supported.
	 */
3238
	host->clk_mul = (host->caps1 & SDHCI_CLOCK_MUL_MASK) >>
3239 3240 3241 3242 3243 3244 3245 3246 3247 3248 3249
			SDHCI_CLOCK_MUL_SHIFT;

	/*
	 * In case the value in Clock Multiplier is 0, then programmable
	 * clock mode is not supported, otherwise the actual clock
	 * multiplier is one more than the value of Clock Multiplier
	 * in the Capabilities Register.
	 */
	if (host->clk_mul)
		host->clk_mul += 1;

3250 3251 3252
	/*
	 * Set host parameters.
	 */
3253 3254
	max_clk = host->max_clk;

3255
	if (host->ops->get_min_clock)
3256
		mmc->f_min = host->ops->get_min_clock(host);
3257 3258 3259
	else if (host->version >= SDHCI_SPEC_300) {
		if (host->clk_mul) {
			mmc->f_min = (host->max_clk * host->clk_mul) / 1024;
3260
			max_clk = host->max_clk * host->clk_mul;
3261 3262 3263
		} else
			mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_300;
	} else
3264
		mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_200;
3265

3266
	if (!mmc->f_max || mmc->f_max > max_clk)
3267 3268
		mmc->f_max = max_clk;

3269
	if (!(host->quirks & SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK)) {
3270
		host->timeout_clk = (host->caps & SDHCI_TIMEOUT_CLK_MASK) >>
3271 3272 3273 3274 3275 3276 3277 3278
					SDHCI_TIMEOUT_CLK_SHIFT;
		if (host->timeout_clk == 0) {
			if (host->ops->get_timeout_clock) {
				host->timeout_clk =
					host->ops->get_timeout_clock(host);
			} else {
				pr_err("%s: Hardware doesn't specify timeout clock frequency.\n",
					mmc_hostname(mmc));
3279 3280
				ret = -ENODEV;
				goto undma;
3281
			}
3282 3283
		}

3284
		if (host->caps & SDHCI_TIMEOUT_CLK_UNIT)
3285
			host->timeout_clk *= 1000;
3286

3287 3288 3289
		if (override_timeout_clk)
			host->timeout_clk = override_timeout_clk;

3290
		mmc->max_busy_timeout = host->ops->get_max_timeout_count ?
3291
			host->ops->get_max_timeout_count(host) : 1 << 27;
3292 3293
		mmc->max_busy_timeout /= host->timeout_clk;
	}
3294

3295
	mmc->caps |= MMC_CAP_SDIO_IRQ | MMC_CAP_ERASE | MMC_CAP_CMD23;
3296
	mmc->caps2 |= MMC_CAP2_SDIO_IRQ_NOTHREAD;
3297 3298 3299

	if (host->quirks & SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12)
		host->flags |= SDHCI_AUTO_CMD12;
3300

3301
	/* Auto-CMD23 stuff only works in ADMA or PIO. */
A
Andrei Warkentin 已提交
3302
	if ((host->version >= SDHCI_SPEC_300) &&
3303
	    ((host->flags & SDHCI_USE_ADMA) ||
3304 3305
	     !(host->flags & SDHCI_USE_SDMA)) &&
	     !(host->quirks2 & SDHCI_QUIRK2_ACMD23_BROKEN)) {
3306 3307 3308 3309 3310 3311
		host->flags |= SDHCI_AUTO_CMD23;
		DBG("%s: Auto-CMD23 available\n", mmc_hostname(mmc));
	} else {
		DBG("%s: Auto-CMD23 unavailable\n", mmc_hostname(mmc));
	}

3312 3313 3314 3315 3316 3317 3318
	/*
	 * A controller may support 8-bit width, but the board itself
	 * might not have the pins brought out.  Boards that support
	 * 8-bit width must set "mmc->caps |= MMC_CAP_8_BIT_DATA;" in
	 * their platform code before calling sdhci_add_host(), and we
	 * won't assume 8-bit width for hosts without that CAP.
	 */
3319
	if (!(host->quirks & SDHCI_QUIRK_FORCE_1_BIT_DATA))
3320
		mmc->caps |= MMC_CAP_4_BIT_DATA;
3321

3322 3323 3324
	if (host->quirks2 & SDHCI_QUIRK2_HOST_NO_CMD23)
		mmc->caps &= ~MMC_CAP_CMD23;

3325
	if (host->caps & SDHCI_CAN_DO_HISPD)
3326
		mmc->caps |= MMC_CAP_SD_HIGHSPEED | MMC_CAP_MMC_HIGHSPEED;
3327

3328
	if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) &&
3329
	    mmc_card_is_removable(mmc) &&
3330
	    mmc_gpio_get_cd(host->mmc) < 0)
3331 3332
		mmc->caps |= MMC_CAP_NEEDS_POLL;

3333
	/* If vqmmc regulator and no 1.8V signalling, then there's no UHS */
3334 3335 3336 3337
	if (!IS_ERR(mmc->supply.vqmmc)) {
		ret = regulator_enable(mmc->supply.vqmmc);
		if (!regulator_is_supported_voltage(mmc->supply.vqmmc, 1700000,
						    1950000))
3338 3339 3340
			host->caps1 &= ~(SDHCI_SUPPORT_SDR104 |
					 SDHCI_SUPPORT_SDR50 |
					 SDHCI_SUPPORT_DDR50);
3341 3342 3343
		if (ret) {
			pr_warn("%s: Failed to enable vqmmc regulator: %d\n",
				mmc_hostname(mmc), ret);
3344
			mmc->supply.vqmmc = ERR_PTR(-EINVAL);
3345
		}
3346
	}
3347

3348 3349 3350 3351
	if (host->quirks2 & SDHCI_QUIRK2_NO_1_8_V) {
		host->caps1 &= ~(SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
				 SDHCI_SUPPORT_DDR50);
	}
3352

3353
	/* Any UHS-I mode in caps implies SDR12 and SDR25 support. */
3354 3355
	if (host->caps1 & (SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
			   SDHCI_SUPPORT_DDR50))
3356 3357 3358
		mmc->caps |= MMC_CAP_UHS_SDR12 | MMC_CAP_UHS_SDR25;

	/* SDR104 supports also implies SDR50 support */
3359
	if (host->caps1 & SDHCI_SUPPORT_SDR104) {
3360
		mmc->caps |= MMC_CAP_UHS_SDR104 | MMC_CAP_UHS_SDR50;
3361 3362 3363
		/* SD3.0: SDR104 is supported so (for eMMC) the caps2
		 * field can be promoted to support HS200.
		 */
3364
		if (!(host->quirks2 & SDHCI_QUIRK2_BROKEN_HS200))
3365
			mmc->caps2 |= MMC_CAP2_HS200;
3366
	} else if (host->caps1 & SDHCI_SUPPORT_SDR50) {
3367
		mmc->caps |= MMC_CAP_UHS_SDR50;
3368
	}
3369

3370
	if (host->quirks2 & SDHCI_QUIRK2_CAPS_BIT63_FOR_HS400 &&
3371
	    (host->caps1 & SDHCI_SUPPORT_HS400))
3372 3373
		mmc->caps2 |= MMC_CAP2_HS400;

3374 3375 3376 3377 3378 3379
	if ((mmc->caps2 & MMC_CAP2_HSX00_1_2V) &&
	    (IS_ERR(mmc->supply.vqmmc) ||
	     !regulator_is_supported_voltage(mmc->supply.vqmmc, 1100000,
					     1300000)))
		mmc->caps2 &= ~MMC_CAP2_HSX00_1_2V;

3380 3381
	if ((host->caps1 & SDHCI_SUPPORT_DDR50) &&
	    !(host->quirks2 & SDHCI_QUIRK2_BROKEN_DDR50))
3382 3383
		mmc->caps |= MMC_CAP_UHS_DDR50;

3384
	/* Does the host need tuning for SDR50? */
3385
	if (host->caps1 & SDHCI_USE_SDR50_TUNING)
3386 3387
		host->flags |= SDHCI_SDR50_NEEDS_TUNING;

3388
	/* Driver Type(s) (A, C, D) supported by the host */
3389
	if (host->caps1 & SDHCI_DRIVER_TYPE_A)
3390
		mmc->caps |= MMC_CAP_DRIVER_TYPE_A;
3391
	if (host->caps1 & SDHCI_DRIVER_TYPE_C)
3392
		mmc->caps |= MMC_CAP_DRIVER_TYPE_C;
3393
	if (host->caps1 & SDHCI_DRIVER_TYPE_D)
3394 3395
		mmc->caps |= MMC_CAP_DRIVER_TYPE_D;

3396
	/* Initial value for re-tuning timer count */
3397 3398
	host->tuning_count = (host->caps1 & SDHCI_RETUNING_TIMER_COUNT_MASK) >>
			     SDHCI_RETUNING_TIMER_COUNT_SHIFT;
3399 3400 3401 3402 3403 3404 3405 3406 3407

	/*
	 * In case Re-tuning Timer is not disabled, the actual value of
	 * re-tuning timer will be 2 ^ (n - 1).
	 */
	if (host->tuning_count)
		host->tuning_count = 1 << (host->tuning_count - 1);

	/* Re-tuning mode supported by the Host Controller */
3408
	host->tuning_mode = (host->caps1 & SDHCI_RETUNING_MODE_MASK) >>
3409 3410
			     SDHCI_RETUNING_MODE_SHIFT;

3411
	ocr_avail = 0;
3412

3413 3414 3415 3416 3417 3418 3419 3420
	/*
	 * According to SD Host Controller spec v3.00, if the Host System
	 * can afford more than 150mA, Host Driver should set XPC to 1. Also
	 * the value is meaningful only if Voltage Support in the Capabilities
	 * register is set. The actual current value is 4 times the register
	 * value.
	 */
	max_current_caps = sdhci_readl(host, SDHCI_MAX_CURRENT);
3421
	if (!max_current_caps && !IS_ERR(mmc->supply.vmmc)) {
3422
		int curr = regulator_get_current_limit(mmc->supply.vmmc);
3423 3424 3425 3426 3427 3428 3429 3430 3431 3432 3433 3434 3435
		if (curr > 0) {

			/* convert to SDHCI_MAX_CURRENT format */
			curr = curr/1000;  /* convert to mA */
			curr = curr/SDHCI_MAX_CURRENT_MULTIPLIER;

			curr = min_t(u32, curr, SDHCI_MAX_CURRENT_LIMIT);
			max_current_caps =
				(curr << SDHCI_MAX_CURRENT_330_SHIFT) |
				(curr << SDHCI_MAX_CURRENT_300_SHIFT) |
				(curr << SDHCI_MAX_CURRENT_180_SHIFT);
		}
	}
3436

3437
	if (host->caps & SDHCI_CAN_VDD_330) {
3438
		ocr_avail |= MMC_VDD_32_33 | MMC_VDD_33_34;
3439

A
Aaron Lu 已提交
3440
		mmc->max_current_330 = ((max_current_caps &
3441 3442 3443 3444
				   SDHCI_MAX_CURRENT_330_MASK) >>
				   SDHCI_MAX_CURRENT_330_SHIFT) *
				   SDHCI_MAX_CURRENT_MULTIPLIER;
	}
3445
	if (host->caps & SDHCI_CAN_VDD_300) {
3446
		ocr_avail |= MMC_VDD_29_30 | MMC_VDD_30_31;
3447

A
Aaron Lu 已提交
3448
		mmc->max_current_300 = ((max_current_caps &
3449 3450 3451 3452
				   SDHCI_MAX_CURRENT_300_MASK) >>
				   SDHCI_MAX_CURRENT_300_SHIFT) *
				   SDHCI_MAX_CURRENT_MULTIPLIER;
	}
3453
	if (host->caps & SDHCI_CAN_VDD_180) {
3454 3455
		ocr_avail |= MMC_VDD_165_195;

A
Aaron Lu 已提交
3456
		mmc->max_current_180 = ((max_current_caps &
3457 3458 3459 3460 3461
				   SDHCI_MAX_CURRENT_180_MASK) >>
				   SDHCI_MAX_CURRENT_180_SHIFT) *
				   SDHCI_MAX_CURRENT_MULTIPLIER;
	}

3462 3463 3464 3465 3466
	/* If OCR set by host, use it instead. */
	if (host->ocr_mask)
		ocr_avail = host->ocr_mask;

	/* If OCR set by external regulators, give it highest prio. */
3467
	if (mmc->ocr_avail)
3468
		ocr_avail = mmc->ocr_avail;
3469

3470 3471 3472 3473 3474 3475 3476 3477 3478 3479 3480 3481
	mmc->ocr_avail = ocr_avail;
	mmc->ocr_avail_sdio = ocr_avail;
	if (host->ocr_avail_sdio)
		mmc->ocr_avail_sdio &= host->ocr_avail_sdio;
	mmc->ocr_avail_sd = ocr_avail;
	if (host->ocr_avail_sd)
		mmc->ocr_avail_sd &= host->ocr_avail_sd;
	else /* normal SD controllers don't support 1.8V */
		mmc->ocr_avail_sd &= ~MMC_VDD_165_195;
	mmc->ocr_avail_mmc = ocr_avail;
	if (host->ocr_avail_mmc)
		mmc->ocr_avail_mmc &= host->ocr_avail_mmc;
3482 3483

	if (mmc->ocr_avail == 0) {
3484 3485
		pr_err("%s: Hardware doesn't report any support voltages.\n",
		       mmc_hostname(mmc));
3486 3487
		ret = -ENODEV;
		goto unreg;
3488 3489
	}

3490 3491 3492 3493 3494 3495 3496 3497 3498
	if ((mmc->caps & (MMC_CAP_UHS_SDR12 | MMC_CAP_UHS_SDR25 |
			  MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR104 |
			  MMC_CAP_UHS_DDR50 | MMC_CAP_1_8V_DDR)) ||
	    (mmc->caps2 & (MMC_CAP2_HS200_1_8V_SDR | MMC_CAP2_HS400_1_8V)))
		host->flags |= SDHCI_SIGNALING_180;

	if (mmc->caps2 & MMC_CAP2_HSX00_1_2V)
		host->flags |= SDHCI_SIGNALING_120;

3499 3500 3501
	spin_lock_init(&host->lock);

	/*
3502 3503
	 * Maximum number of segments. Depends on if the hardware
	 * can do scatter/gather or not.
3504
	 */
3505
	if (host->flags & SDHCI_USE_ADMA)
3506
		mmc->max_segs = SDHCI_MAX_SEGS;
3507
	else if (host->flags & SDHCI_USE_SDMA)
3508
		mmc->max_segs = 1;
3509
	else /* PIO */
3510
		mmc->max_segs = SDHCI_MAX_SEGS;
3511 3512

	/*
3513 3514 3515
	 * Maximum number of sectors in one transfer. Limited by SDMA boundary
	 * size (512KiB). Note some tuning modes impose a 4MiB limit, but this
	 * is less anyway.
3516
	 */
3517
	mmc->max_req_size = 524288;
3518 3519 3520

	/*
	 * Maximum segment size. Could be one segment with the maximum number
3521 3522
	 * of bytes. When doing hardware scatter/gather, each entry cannot
	 * be larger than 64 KiB though.
3523
	 */
3524 3525 3526 3527 3528 3529
	if (host->flags & SDHCI_USE_ADMA) {
		if (host->quirks & SDHCI_QUIRK_BROKEN_ADMA_ZEROLEN_DESC)
			mmc->max_seg_size = 65535;
		else
			mmc->max_seg_size = 65536;
	} else {
3530
		mmc->max_seg_size = mmc->max_req_size;
3531
	}
3532

3533 3534 3535 3536
	/*
	 * Maximum block size. This varies from controller to controller and
	 * is specified in the capabilities register.
	 */
3537 3538 3539
	if (host->quirks & SDHCI_QUIRK_FORCE_BLK_SZ_2048) {
		mmc->max_blk_size = 2;
	} else {
3540
		mmc->max_blk_size = (host->caps & SDHCI_MAX_BLOCK_MASK) >>
3541 3542
				SDHCI_MAX_BLOCK_SHIFT;
		if (mmc->max_blk_size >= 3) {
J
Joe Perches 已提交
3543 3544
			pr_warn("%s: Invalid maximum block size, assuming 512 bytes\n",
				mmc_hostname(mmc));
3545 3546 3547 3548 3549
			mmc->max_blk_size = 0;
		}
	}

	mmc->max_blk_size = 512 << mmc->max_blk_size;
3550

3551 3552 3553
	/*
	 * Maximum block count.
	 */
3554
	mmc->max_blk_count = (host->quirks & SDHCI_QUIRK_NO_MULTIBLOCK) ? 1 : 65535;
3555

3556 3557 3558 3559 3560 3561 3562 3563 3564 3565 3566 3567 3568 3569 3570 3571 3572 3573 3574 3575 3576 3577
	return 0;

unreg:
	if (!IS_ERR(mmc->supply.vqmmc))
		regulator_disable(mmc->supply.vqmmc);
undma:
	if (host->align_buffer)
		dma_free_coherent(mmc_dev(mmc), host->align_buffer_sz +
				  host->adma_table_sz, host->align_buffer,
				  host->align_addr);
	host->adma_table = NULL;
	host->align_buffer = NULL;

	return ret;
}
EXPORT_SYMBOL_GPL(sdhci_setup_host);

int __sdhci_add_host(struct sdhci_host *host)
{
	struct mmc_host *mmc = host->mmc;
	int ret;

3578 3579 3580 3581 3582 3583
	/*
	 * Init tasklets.
	 */
	tasklet_init(&host->finish_tasklet,
		sdhci_tasklet_finish, (unsigned long)host);

3584
	setup_timer(&host->timer, sdhci_timeout_timer, (unsigned long)host);
3585 3586
	setup_timer(&host->data_timer, sdhci_timeout_data_timer,
		    (unsigned long)host);
3587

3588
	init_waitqueue_head(&host->buf_ready_int);
3589

3590 3591
	sdhci_init(host, 0);

3592 3593
	ret = request_threaded_irq(host->irq, sdhci_irq, sdhci_thread_irq,
				   IRQF_SHARED,	mmc_hostname(mmc), host);
3594 3595 3596
	if (ret) {
		pr_err("%s: Failed to request IRQ %d: %d\n",
		       mmc_hostname(mmc), host->irq, ret);
3597
		goto untasklet;
3598
	}
3599 3600 3601 3602 3603

#ifdef CONFIG_MMC_DEBUG
	sdhci_dumpregs(host);
#endif

3604
	ret = sdhci_led_register(host);
3605 3606 3607
	if (ret) {
		pr_err("%s: Failed to register LED device: %d\n",
		       mmc_hostname(mmc), ret);
3608
		goto unirq;
3609
	}
3610

3611 3612
	mmiowb();

3613 3614 3615
	ret = mmc_add_host(mmc);
	if (ret)
		goto unled;
3616

3617
	pr_info("%s: SDHCI controller on %s [%s] using %s\n",
3618
		mmc_hostname(mmc), host->hw_name, dev_name(mmc_dev(mmc)),
3619 3620
		(host->flags & SDHCI_USE_ADMA) ?
		(host->flags & SDHCI_USE_64_BIT_DMA) ? "ADMA 64-bit" : "ADMA" :
3621
		(host->flags & SDHCI_USE_SDMA) ? "DMA" : "PIO");
3622

3623 3624
	sdhci_enable_card_detection(host);

3625 3626
	return 0;

3627
unled:
3628
	sdhci_led_unregister(host);
3629
unirq:
3630
	sdhci_do_reset(host, SDHCI_RESET_ALL);
3631 3632
	sdhci_writel(host, 0, SDHCI_INT_ENABLE);
	sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
3633
	free_irq(host->irq, host);
3634
untasklet:
3635
	tasklet_kill(&host->finish_tasklet);
3636

3637 3638
	if (!IS_ERR(mmc->supply.vqmmc))
		regulator_disable(mmc->supply.vqmmc);
3639

3640 3641 3642 3643 3644 3645
	if (host->align_buffer)
		dma_free_coherent(mmc_dev(mmc), host->align_buffer_sz +
				  host->adma_table_sz, host->align_buffer,
				  host->align_addr);
	host->adma_table = NULL;
	host->align_buffer = NULL;
3646 3647 3648

	return ret;
}
3649 3650 3651 3652 3653 3654 3655 3656 3657
EXPORT_SYMBOL_GPL(__sdhci_add_host);

int sdhci_add_host(struct sdhci_host *host)
{
	int ret;

	ret = sdhci_setup_host(host);
	if (ret)
		return ret;
3658

3659 3660
	return __sdhci_add_host(host);
}
3661
EXPORT_SYMBOL_GPL(sdhci_add_host);
3662

P
Pierre Ossman 已提交
3663
void sdhci_remove_host(struct sdhci_host *host, int dead)
3664
{
3665
	struct mmc_host *mmc = host->mmc;
P
Pierre Ossman 已提交
3666 3667 3668 3669 3670 3671 3672
	unsigned long flags;

	if (dead) {
		spin_lock_irqsave(&host->lock, flags);

		host->flags |= SDHCI_DEVICE_DEAD;

3673
		if (sdhci_has_requests(host)) {
3674
			pr_err("%s: Controller removed during "
3675
				" transfer!\n", mmc_hostname(mmc));
3676
			sdhci_error_out_mrqs(host, -ENOMEDIUM);
P
Pierre Ossman 已提交
3677 3678 3679 3680 3681
		}

		spin_unlock_irqrestore(&host->lock, flags);
	}

3682 3683
	sdhci_disable_card_detection(host);

3684
	mmc_remove_host(mmc);
3685

3686
	sdhci_led_unregister(host);
3687

P
Pierre Ossman 已提交
3688
	if (!dead)
3689
		sdhci_do_reset(host, SDHCI_RESET_ALL);
3690

3691 3692
	sdhci_writel(host, 0, SDHCI_INT_ENABLE);
	sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
3693 3694 3695
	free_irq(host->irq, host);

	del_timer_sync(&host->timer);
3696
	del_timer_sync(&host->data_timer);
3697 3698

	tasklet_kill(&host->finish_tasklet);
3699

3700 3701
	if (!IS_ERR(mmc->supply.vqmmc))
		regulator_disable(mmc->supply.vqmmc);
3702

3703
	if (host->align_buffer)
3704 3705 3706
		dma_free_coherent(mmc_dev(mmc), host->align_buffer_sz +
				  host->adma_table_sz, host->align_buffer,
				  host->align_addr);
3707

3708
	host->adma_table = NULL;
3709
	host->align_buffer = NULL;
3710 3711
}

3712
EXPORT_SYMBOL_GPL(sdhci_remove_host);
3713

3714
void sdhci_free_host(struct sdhci_host *host)
3715
{
3716
	mmc_free_host(host->mmc);
3717 3718
}

3719
EXPORT_SYMBOL_GPL(sdhci_free_host);
3720 3721 3722 3723 3724 3725 3726 3727 3728

/*****************************************************************************\
 *                                                                           *
 * Driver init/exit                                                          *
 *                                                                           *
\*****************************************************************************/

static int __init sdhci_drv_init(void)
{
3729
	pr_info(DRIVER_NAME
3730
		": Secure Digital Host Controller Interface driver\n");
3731
	pr_info(DRIVER_NAME ": Copyright(c) Pierre Ossman\n");
3732

3733
	return 0;
3734 3735 3736 3737 3738 3739 3740 3741 3742
}

static void __exit sdhci_drv_exit(void)
{
}

module_init(sdhci_drv_init);
module_exit(sdhci_drv_exit);

3743
module_param(debug_quirks, uint, 0444);
3744
module_param(debug_quirks2, uint, 0444);
3745

3746
MODULE_AUTHOR("Pierre Ossman <pierre@ossman.eu>");
3747
MODULE_DESCRIPTION("Secure Digital Host Controller Interface core driver");
3748
MODULE_LICENSE("GPL");
3749

3750
MODULE_PARM_DESC(debug_quirks, "Force certain quirks.");
3751
MODULE_PARM_DESC(debug_quirks2, "Force certain other quirks.");