sdhci.c 91.0 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 17
 */

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

26 27
#include <linux/leds.h>

28
#include <linux/mmc/mmc.h>
29
#include <linux/mmc/host.h>
30
#include <linux/mmc/card.h>
31
#include <linux/mmc/slot-gpio.h>
32 33 34 35 36 37

#include "sdhci.h"

#define DRIVER_NAME "sdhci"

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

40 41 42 43 44
#if defined(CONFIG_LEDS_CLASS) || (defined(CONFIG_LEDS_CLASS_MODULE) && \
	defined(CONFIG_MMC_SDHCI_MODULE))
#define SDHCI_USE_LEDS_CLASS
#endif

45 46
#define MAX_TUNING_LOOP 40

47
static unsigned int debug_quirks = 0;
48
static unsigned int debug_quirks2;
49

50 51 52
static void sdhci_finish_data(struct sdhci_host *);

static void sdhci_finish_command(struct sdhci_host *);
53
static int sdhci_execute_tuning(struct mmc_host *mmc, u32 opcode);
54
static void sdhci_tuning_timer(unsigned long data);
55
static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable);
56

57
#ifdef CONFIG_PM
58 59
static int sdhci_runtime_pm_get(struct sdhci_host *host);
static int sdhci_runtime_pm_put(struct sdhci_host *host);
60 61
static void sdhci_runtime_pm_bus_on(struct sdhci_host *host);
static void sdhci_runtime_pm_bus_off(struct sdhci_host *host);
62 63 64 65 66 67 68 69 70
#else
static inline int sdhci_runtime_pm_get(struct sdhci_host *host)
{
	return 0;
}
static inline int sdhci_runtime_pm_put(struct sdhci_host *host)
{
	return 0;
}
71 72 73 74 75 76
static void sdhci_runtime_pm_bus_on(struct sdhci_host *host)
{
}
static void sdhci_runtime_pm_bus_off(struct sdhci_host *host)
{
}
77 78
#endif

79 80
static void sdhci_dumpregs(struct sdhci_host *host)
{
81
	pr_debug(DRIVER_NAME ": =========== REGISTER DUMP (%s)===========\n",
82
		mmc_hostname(host->mmc));
83

84
	pr_debug(DRIVER_NAME ": Sys addr: 0x%08x | Version:  0x%08x\n",
85 86
		sdhci_readl(host, SDHCI_DMA_ADDRESS),
		sdhci_readw(host, SDHCI_HOST_VERSION));
87
	pr_debug(DRIVER_NAME ": Blk size: 0x%08x | Blk cnt:  0x%08x\n",
88 89
		sdhci_readw(host, SDHCI_BLOCK_SIZE),
		sdhci_readw(host, SDHCI_BLOCK_COUNT));
90
	pr_debug(DRIVER_NAME ": Argument: 0x%08x | Trn mode: 0x%08x\n",
91 92
		sdhci_readl(host, SDHCI_ARGUMENT),
		sdhci_readw(host, SDHCI_TRANSFER_MODE));
93
	pr_debug(DRIVER_NAME ": Present:  0x%08x | Host ctl: 0x%08x\n",
94 95
		sdhci_readl(host, SDHCI_PRESENT_STATE),
		sdhci_readb(host, SDHCI_HOST_CONTROL));
96
	pr_debug(DRIVER_NAME ": Power:    0x%08x | Blk gap:  0x%08x\n",
97 98
		sdhci_readb(host, SDHCI_POWER_CONTROL),
		sdhci_readb(host, SDHCI_BLOCK_GAP_CONTROL));
99
	pr_debug(DRIVER_NAME ": Wake-up:  0x%08x | Clock:    0x%08x\n",
100 101
		sdhci_readb(host, SDHCI_WAKE_UP_CONTROL),
		sdhci_readw(host, SDHCI_CLOCK_CONTROL));
102
	pr_debug(DRIVER_NAME ": Timeout:  0x%08x | Int stat: 0x%08x\n",
103 104
		sdhci_readb(host, SDHCI_TIMEOUT_CONTROL),
		sdhci_readl(host, SDHCI_INT_STATUS));
105
	pr_debug(DRIVER_NAME ": Int enab: 0x%08x | Sig enab: 0x%08x\n",
106 107
		sdhci_readl(host, SDHCI_INT_ENABLE),
		sdhci_readl(host, SDHCI_SIGNAL_ENABLE));
108
	pr_debug(DRIVER_NAME ": AC12 err: 0x%08x | Slot int: 0x%08x\n",
109 110
		sdhci_readw(host, SDHCI_ACMD12_ERR),
		sdhci_readw(host, SDHCI_SLOT_INT_STATUS));
111
	pr_debug(DRIVER_NAME ": Caps:     0x%08x | Caps_1:   0x%08x\n",
112
		sdhci_readl(host, SDHCI_CAPABILITIES),
113
		sdhci_readl(host, SDHCI_CAPABILITIES_1));
114
	pr_debug(DRIVER_NAME ": Cmd:      0x%08x | Max curr: 0x%08x\n",
115
		sdhci_readw(host, SDHCI_COMMAND),
116
		sdhci_readl(host, SDHCI_MAX_CURRENT));
117
	pr_debug(DRIVER_NAME ": Host ctl2: 0x%08x\n",
118
		sdhci_readw(host, SDHCI_HOST_CONTROL2));
119

120 121 122 123 124 125 126 127 128 129 130
	if (host->flags & SDHCI_USE_ADMA) {
		if (host->flags & SDHCI_USE_64_BIT_DMA)
			pr_debug(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));
		else
			pr_debug(DRIVER_NAME ": ADMA Err: 0x%08x | ADMA Ptr: 0x%08x\n",
				 readl(host->ioaddr + SDHCI_ADMA_ERROR),
				 readl(host->ioaddr + SDHCI_ADMA_ADDRESS));
	}
131

132
	pr_debug(DRIVER_NAME ": ===========================================\n");
133 134 135 136 137 138 139 140
}

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

141 142
static void sdhci_set_card_detection(struct sdhci_host *host, bool enable)
{
143
	u32 present;
144

145
	if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) ||
146
	    (host->mmc->caps & MMC_CAP_NONREMOVABLE))
147 148
		return;

149 150 151
	if (enable) {
		present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
				      SDHCI_CARD_PRESENT;
152

153 154 155 156 157
		host->ier |= present ? SDHCI_INT_CARD_REMOVE :
				       SDHCI_INT_CARD_INSERT;
	} else {
		host->ier &= ~(SDHCI_INT_CARD_REMOVE | SDHCI_INT_CARD_INSERT);
	}
158 159 160

	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
161 162 163 164 165 166 167 168 169 170 171 172
}

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

173
void sdhci_reset(struct sdhci_host *host, u8 mask)
174
{
175
	unsigned long timeout;
176

177
	sdhci_writeb(host, mask, SDHCI_SOFTWARE_RESET);
178

179
	if (mask & SDHCI_RESET_ALL) {
180
		host->clock = 0;
181 182 183 184
		/* Reset-all turns off SD Bus Power */
		if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
			sdhci_runtime_pm_bus_off(host);
	}
185

186 187 188 189
	/* Wait max 100 ms */
	timeout = 100;

	/* hw clears the bit when it's done */
190
	while (sdhci_readb(host, SDHCI_SOFTWARE_RESET) & mask) {
191
		if (timeout == 0) {
192
			pr_err("%s: Reset 0x%x never completed.\n",
193 194 195 196 197 198
				mmc_hostname(host->mmc), (int)mask);
			sdhci_dumpregs(host);
			return;
		}
		timeout--;
		mdelay(1);
199
	}
200 201 202 203 204 205 206 207 208 209
}
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) {
		if (!(sdhci_readl(host, SDHCI_PRESENT_STATE) &
			SDHCI_CARD_PRESENT))
			return;
	}
210

211
	host->ops->reset(host, mask);
212

213 214 215 216 217 218 219 220
	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;
221
	}
222 223
}

224 225 226
static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios);

static void sdhci_init(struct sdhci_host *host, int soft)
227
{
228
	if (soft)
229
		sdhci_do_reset(host, SDHCI_RESET_CMD|SDHCI_RESET_DATA);
230
	else
231
		sdhci_do_reset(host, SDHCI_RESET_ALL);
232

233 234 235 236 237 238 239 240
	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;

	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
241 242 243 244 245 246

	if (soft) {
		/* force clock reconfiguration */
		host->clock = 0;
		sdhci_set_ios(host->mmc, &host->mmc->ios);
	}
247
}
248

249 250
static void sdhci_reinit(struct sdhci_host *host)
{
251
	sdhci_init(host, 0);
252 253 254 255 256
	/*
	 * Retuning stuffs are affected by different cards inserted and only
	 * applicable to UHS-I cards. So reset these fields to their initial
	 * value when card is removed.
	 */
257 258 259
	if (host->flags & SDHCI_USING_RETUNING_TIMER) {
		host->flags &= ~SDHCI_USING_RETUNING_TIMER;

260 261 262
		del_timer_sync(&host->tuning_timer);
		host->flags &= ~SDHCI_NEEDS_RETUNING;
	}
263
	sdhci_enable_card_detection(host);
264 265 266 267 268 269
}

static void sdhci_activate_led(struct sdhci_host *host)
{
	u8 ctrl;

270
	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
271
	ctrl |= SDHCI_CTRL_LED;
272
	sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
273 274 275 276 277 278
}

static void sdhci_deactivate_led(struct sdhci_host *host)
{
	u8 ctrl;

279
	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
280
	ctrl &= ~SDHCI_CTRL_LED;
281
	sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
282 283
}

284
#ifdef SDHCI_USE_LEDS_CLASS
285 286 287 288 289 290 291 292
static void sdhci_led_control(struct led_classdev *led,
	enum led_brightness brightness)
{
	struct sdhci_host *host = container_of(led, struct sdhci_host, led);
	unsigned long flags;

	spin_lock_irqsave(&host->lock, flags);

293 294 295
	if (host->runtime_suspended)
		goto out;

296 297 298 299
	if (brightness == LED_OFF)
		sdhci_deactivate_led(host);
	else
		sdhci_activate_led(host);
300
out:
301 302 303 304
	spin_unlock_irqrestore(&host->lock, flags);
}
#endif

305 306 307 308 309 310
/*****************************************************************************\
 *                                                                           *
 * Core functions                                                            *
 *                                                                           *
\*****************************************************************************/

P
Pierre Ossman 已提交
311
static void sdhci_read_block_pio(struct sdhci_host *host)
312
{
313 314
	unsigned long flags;
	size_t blksize, len, chunk;
315
	u32 uninitialized_var(scratch);
316
	u8 *buf;
317

P
Pierre Ossman 已提交
318
	DBG("PIO reading\n");
319

P
Pierre Ossman 已提交
320
	blksize = host->data->blksz;
321
	chunk = 0;
322

323
	local_irq_save(flags);
324

P
Pierre Ossman 已提交
325
	while (blksize) {
326 327
		if (!sg_miter_next(&host->sg_miter))
			BUG();
328

329
		len = min(host->sg_miter.length, blksize);
330

331 332
		blksize -= len;
		host->sg_miter.consumed = len;
333

334
		buf = host->sg_miter.addr;
335

336 337
		while (len) {
			if (chunk == 0) {
338
				scratch = sdhci_readl(host, SDHCI_BUFFER);
339
				chunk = 4;
P
Pierre Ossman 已提交
340
			}
341 342 343 344 345 346 347

			*buf = scratch & 0xFF;

			buf++;
			scratch >>= 8;
			chunk--;
			len--;
348
		}
P
Pierre Ossman 已提交
349
	}
350 351 352 353

	sg_miter_stop(&host->sg_miter);

	local_irq_restore(flags);
P
Pierre Ossman 已提交
354
}
355

P
Pierre Ossman 已提交
356 357
static void sdhci_write_block_pio(struct sdhci_host *host)
{
358 359 360 361
	unsigned long flags;
	size_t blksize, len, chunk;
	u32 scratch;
	u8 *buf;
362

P
Pierre Ossman 已提交
363 364 365
	DBG("PIO writing\n");

	blksize = host->data->blksz;
366 367
	chunk = 0;
	scratch = 0;
368

369
	local_irq_save(flags);
370

P
Pierre Ossman 已提交
371
	while (blksize) {
372 373
		if (!sg_miter_next(&host->sg_miter))
			BUG();
P
Pierre Ossman 已提交
374

375 376 377 378 379 380
		len = min(host->sg_miter.length, blksize);

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

		buf = host->sg_miter.addr;
381

382 383 384 385 386 387 388 389
		while (len) {
			scratch |= (u32)*buf << (chunk * 8);

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

			if ((chunk == 4) || ((len == 0) && (blksize == 0))) {
390
				sdhci_writel(host, scratch, SDHCI_BUFFER);
391 392
				chunk = 0;
				scratch = 0;
393 394 395
			}
		}
	}
396 397 398 399

	sg_miter_stop(&host->sg_miter);

	local_irq_restore(flags);
P
Pierre Ossman 已提交
400 401 402 403 404 405 406 407
}

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

	BUG_ON(!host->data);

408
	if (host->blocks == 0)
P
Pierre Ossman 已提交
409 410 411 412 413 414 415
		return;

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

416 417 418 419 420 421 422 423 424
	/*
	 * 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;

425
	while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
426 427 428
		if (host->quirks & SDHCI_QUIRK_PIO_NEEDS_DELAY)
			udelay(100);

P
Pierre Ossman 已提交
429 430 431 432
		if (host->data->flags & MMC_DATA_READ)
			sdhci_read_block_pio(host);
		else
			sdhci_write_block_pio(host);
433

434 435
		host->blocks--;
		if (host->blocks == 0)
P
Pierre Ossman 已提交
436 437
			break;
	}
438

P
Pierre Ossman 已提交
439
	DBG("PIO transfer complete.\n");
440 441
}

442 443 444
static char *sdhci_kmap_atomic(struct scatterlist *sg, unsigned long *flags)
{
	local_irq_save(*flags);
445
	return kmap_atomic(sg_page(sg)) + sg->offset;
446 447 448 449
}

static void sdhci_kunmap_atomic(void *buffer, unsigned long *flags)
{
450
	kunmap_atomic(buffer);
451 452 453
	local_irq_restore(*flags);
}

454 455
static void sdhci_adma_write_desc(struct sdhci_host *host, void *desc,
				  dma_addr_t addr, int len, unsigned cmd)
B
Ben Dooks 已提交
456
{
457
	struct sdhci_adma2_64_desc *dma_desc = desc;
B
Ben Dooks 已提交
458

459
	/* 32-bit and 64-bit descriptors have these members in same position */
460 461
	dma_desc->cmd = cpu_to_le16(cmd);
	dma_desc->len = cpu_to_le16(len);
462 463 464 465
	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 已提交
466 467
}

468 469
static void sdhci_adma_mark_end(void *desc)
{
470
	struct sdhci_adma2_64_desc *dma_desc = desc;
471

472
	/* 32-bit and 64-bit descriptors have 'cmd' in same position */
473
	dma_desc->cmd |= cpu_to_le16(ADMA2_END);
474 475
}

476
static int sdhci_adma_table_pre(struct sdhci_host *host,
477 478 479 480
	struct mmc_data *data)
{
	int direction;

481 482
	void *desc;
	void *align;
483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502
	dma_addr_t addr;
	dma_addr_t align_addr;
	int len, offset;

	struct scatterlist *sg;
	int i;
	char *buffer;
	unsigned long flags;

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

	if (data->flags & MMC_DATA_READ)
		direction = DMA_FROM_DEVICE;
	else
		direction = DMA_TO_DEVICE;

	host->align_addr = dma_map_single(mmc_dev(host->mmc),
503
		host->align_buffer, host->align_buffer_sz, direction);
504
	if (dma_mapping_error(mmc_dev(host->mmc), host->align_addr))
505
		goto fail;
506
	BUG_ON(host->align_addr & host->align_mask);
507 508 509

	host->sg_count = dma_map_sg(mmc_dev(host->mmc),
		data->sg, data->sg_len, direction);
510 511
	if (host->sg_count == 0)
		goto unmap_align;
512

513
	desc = host->adma_table;
514 515 516 517 518 519 520 521 522 523 524 525 526 527 528
	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);

		/*
		 * 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
		 * alignment.
		 */
529 530
		offset = (host->align_sz - (addr & host->align_mask)) &
			 host->align_mask;
531 532 533
		if (offset) {
			if (data->flags & MMC_DATA_WRITE) {
				buffer = sdhci_kmap_atomic(sg, &flags);
534 535
				WARN_ON(((long)buffer & (PAGE_SIZE - 1)) >
					(PAGE_SIZE - offset));
536 537 538 539
				memcpy(align, buffer, offset);
				sdhci_kunmap_atomic(buffer, &flags);
			}

B
Ben Dooks 已提交
540
			/* tran, valid */
541
			sdhci_adma_write_desc(host, desc, align_addr, offset,
A
Adrian Hunter 已提交
542
					      ADMA2_TRAN_VALID);
543 544 545

			BUG_ON(offset > 65536);

546 547
			align += host->align_sz;
			align_addr += host->align_sz;
548

549
			desc += host->desc_sz;
550 551 552 553 554 555 556

			addr += offset;
			len -= offset;
		}

		BUG_ON(len > 65536);

B
Ben Dooks 已提交
557
		/* tran, valid */
558
		sdhci_adma_write_desc(host, desc, addr, len, ADMA2_TRAN_VALID);
559
		desc += host->desc_sz;
560 561 562 563 564

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

568 569 570 571
	if (host->quirks & SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC) {
		/*
		* Mark the last descriptor as the terminating descriptor
		*/
572
		if (desc != host->adma_table) {
573
			desc -= host->desc_sz;
574
			sdhci_adma_mark_end(desc);
575 576 577 578 579
		}
	} else {
		/*
		* Add a terminating entry.
		*/
580

581
		/* nop, end, valid */
582
		sdhci_adma_write_desc(host, desc, 0, 0, ADMA2_NOP_END_VALID);
583
	}
584 585 586 587 588 589

	/*
	 * Resync align buffer as we might have changed it.
	 */
	if (data->flags & MMC_DATA_WRITE) {
		dma_sync_single_for_device(mmc_dev(host->mmc),
590
			host->align_addr, host->align_buffer_sz, direction);
591 592
	}

593 594 595 596
	return 0;

unmap_align:
	dma_unmap_single(mmc_dev(host->mmc), host->align_addr,
597
		host->align_buffer_sz, direction);
598 599
fail:
	return -EINVAL;
600 601 602 603 604 605 606 607 608
}

static void sdhci_adma_table_post(struct sdhci_host *host,
	struct mmc_data *data)
{
	int direction;

	struct scatterlist *sg;
	int i, size;
609
	void *align;
610 611
	char *buffer;
	unsigned long flags;
612
	bool has_unaligned;
613 614 615 616 617 618 619

	if (data->flags & MMC_DATA_READ)
		direction = DMA_FROM_DEVICE;
	else
		direction = DMA_TO_DEVICE;

	dma_unmap_single(mmc_dev(host->mmc), host->align_addr,
620
		host->align_buffer_sz, direction);
621

622 623 624
	/* Do a quick scan of the SG list for any unaligned mappings */
	has_unaligned = false;
	for_each_sg(data->sg, sg, host->sg_count, i)
625
		if (sg_dma_address(sg) & host->align_mask) {
626 627 628 629 630
			has_unaligned = true;
			break;
		}

	if (has_unaligned && data->flags & MMC_DATA_READ) {
631 632 633 634 635 636
		dma_sync_sg_for_cpu(mmc_dev(host->mmc), data->sg,
			data->sg_len, direction);

		align = host->align_buffer;

		for_each_sg(data->sg, sg, host->sg_count, i) {
637 638 639
			if (sg_dma_address(sg) & host->align_mask) {
				size = host->align_sz -
				       (sg_dma_address(sg) & host->align_mask);
640 641

				buffer = sdhci_kmap_atomic(sg, &flags);
642 643
				WARN_ON(((long)buffer & (PAGE_SIZE - 1)) >
					(PAGE_SIZE - size));
644 645 646
				memcpy(buffer, align, size);
				sdhci_kunmap_atomic(buffer, &flags);

647
				align += host->align_sz;
648 649 650 651 652 653 654 655
			}
		}
	}

	dma_unmap_sg(mmc_dev(host->mmc), data->sg,
		data->sg_len, direction);
}

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

662 663 664 665 666 667
	/*
	 * 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.
	 */
668
	if (host->quirks & SDHCI_QUIRK_BROKEN_TIMEOUT_VAL)
669
		return 0xE;
670

671
	/* Unspecified timeout, assume max */
672
	if (!data && !cmd->busy_timeout)
673
		return 0xE;
674

675 676
	/* timeout in us */
	if (!data)
677
		target_timeout = cmd->busy_timeout * 1000;
678 679 680 681 682
	else {
		target_timeout = data->timeout_ns / 1000;
		if (host->clock)
			target_timeout += data->timeout_clks / host->clock;
	}
683

684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703
	/*
	 * 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) {
704 705
		DBG("%s: Too large timeout 0x%x requested for CMD%d!\n",
		    mmc_hostname(host->mmc), count, cmd->opcode);
706 707 708
		count = 0xE;
	}

709 710 711
	return count;
}

712 713 714 715 716 717
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)
718
		host->ier = (host->ier & ~pio_irqs) | dma_irqs;
719
	else
720 721 722 723
		host->ier = (host->ier & ~dma_irqs) | pio_irqs;

	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
724 725
}

726
static void sdhci_set_timeout(struct sdhci_host *host, struct mmc_command *cmd)
727 728
{
	u8 count;
729 730 731 732 733 734 735 736 737 738 739

	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)
{
740
	u8 ctrl;
741
	struct mmc_data *data = cmd->data;
742
	int ret;
743 744 745

	WARN_ON(host->data);

746 747
	if (data || (cmd->flags & MMC_RSP_BUSY))
		sdhci_set_timeout(host, cmd);
748 749

	if (!data)
750 751 752 753 754 755 756 757 758
		return;

	/* 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;
759
	host->data->bytes_xfered = 0;
760

761
	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA))
762 763
		host->flags |= SDHCI_REQ_USE_DMA;

764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791
	/*
	 * FIXME: This doesn't account for merging when mapping the
	 * scatterlist.
	 */
	if (host->flags & SDHCI_REQ_USE_DMA) {
		int broken, i;
		struct scatterlist *sg;

		broken = 0;
		if (host->flags & SDHCI_USE_ADMA) {
			if (host->quirks & SDHCI_QUIRK_32BIT_ADMA_SIZE)
				broken = 1;
		} else {
			if (host->quirks & SDHCI_QUIRK_32BIT_DMA_SIZE)
				broken = 1;
		}

		if (unlikely(broken)) {
			for_each_sg(data->sg, sg, data->sg_len, i) {
				if (sg->length & 0x3) {
					DBG("Reverting to PIO because of "
						"transfer size (%d)\n",
						sg->length);
					host->flags &= ~SDHCI_REQ_USE_DMA;
					break;
				}
			}
		}
792 793 794 795 796 797
	}

	/*
	 * The assumption here being that alignment is the same after
	 * translation to device address space.
	 */
798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827
	if (host->flags & SDHCI_REQ_USE_DMA) {
		int broken, i;
		struct scatterlist *sg;

		broken = 0;
		if (host->flags & SDHCI_USE_ADMA) {
			/*
			 * As we use 3 byte chunks to work around
			 * alignment problems, we need to check this
			 * quirk.
			 */
			if (host->quirks & SDHCI_QUIRK_32BIT_ADMA_SIZE)
				broken = 1;
		} else {
			if (host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR)
				broken = 1;
		}

		if (unlikely(broken)) {
			for_each_sg(data->sg, sg, data->sg_len, i) {
				if (sg->offset & 0x3) {
					DBG("Reverting to PIO because of "
						"bad alignment\n");
					host->flags &= ~SDHCI_REQ_USE_DMA;
					break;
				}
			}
		}
	}

828 829 830 831 832 833 834 835 836
	if (host->flags & SDHCI_REQ_USE_DMA) {
		if (host->flags & SDHCI_USE_ADMA) {
			ret = sdhci_adma_table_pre(host, data);
			if (ret) {
				/*
				 * This only happens when someone fed
				 * us an invalid request.
				 */
				WARN_ON(1);
837
				host->flags &= ~SDHCI_REQ_USE_DMA;
838
			} else {
839 840
				sdhci_writel(host, host->adma_addr,
					SDHCI_ADMA_ADDRESS);
841 842 843 844
				if (host->flags & SDHCI_USE_64_BIT_DMA)
					sdhci_writel(host,
						     (u64)host->adma_addr >> 32,
						     SDHCI_ADMA_ADDRESS_HI);
845 846
			}
		} else {
847
			int sg_cnt;
848

849
			sg_cnt = dma_map_sg(mmc_dev(host->mmc),
850 851 852 853
					data->sg, data->sg_len,
					(data->flags & MMC_DATA_READ) ?
						DMA_FROM_DEVICE :
						DMA_TO_DEVICE);
854
			if (sg_cnt == 0) {
855 856 857 858 859
				/*
				 * This only happens when someone fed
				 * us an invalid request.
				 */
				WARN_ON(1);
860
				host->flags &= ~SDHCI_REQ_USE_DMA;
861
			} else {
862
				WARN_ON(sg_cnt != 1);
863 864
				sdhci_writel(host, sg_dma_address(data->sg),
					SDHCI_DMA_ADDRESS);
865 866 867 868
			}
		}
	}

869 870 871 872 873 874
	/*
	 * 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) {
875
		ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
876 877
		ctrl &= ~SDHCI_CTRL_DMA_MASK;
		if ((host->flags & SDHCI_REQ_USE_DMA) &&
878 879 880 881 882 883
			(host->flags & SDHCI_USE_ADMA)) {
			if (host->flags & SDHCI_USE_64_BIT_DMA)
				ctrl |= SDHCI_CTRL_ADMA64;
			else
				ctrl |= SDHCI_CTRL_ADMA32;
		} else {
884
			ctrl |= SDHCI_CTRL_SDMA;
885
		}
886
		sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
887 888
	}

889
	if (!(host->flags & SDHCI_REQ_USE_DMA)) {
890 891 892 893 894 895 896 897
		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);
898
		host->blocks = data->blocks;
899
	}
900

901 902
	sdhci_set_transfer_irqs(host);

903 904 905
	/* Set the DMA boundary value and block size */
	sdhci_writew(host, SDHCI_MAKE_BLKSZ(SDHCI_DEFAULT_BOUNDARY_ARG,
		data->blksz), SDHCI_BLOCK_SIZE);
906
	sdhci_writew(host, data->blocks, SDHCI_BLOCK_COUNT);
907 908 909
}

static void sdhci_set_transfer_mode(struct sdhci_host *host,
910
	struct mmc_command *cmd)
911 912
{
	u16 mode;
913
	struct mmc_data *data = cmd->data;
914

915
	if (data == NULL) {
916 917 918 919
		if (host->quirks2 &
			SDHCI_QUIRK2_CLEAR_TRANSFERMODE_REG_BEFORE_CMD) {
			sdhci_writew(host, 0x0, SDHCI_TRANSFER_MODE);
		} else {
920
		/* clear Auto CMD settings for no data CMDs */
921 922
			mode = sdhci_readw(host, SDHCI_TRANSFER_MODE);
			sdhci_writew(host, mode & ~(SDHCI_TRNS_AUTO_CMD12 |
923
				SDHCI_TRNS_AUTO_CMD23), SDHCI_TRANSFER_MODE);
924
		}
925
		return;
926
	}
927

928 929
	WARN_ON(!host->data);

930
	mode = SDHCI_TRNS_BLK_CNT_EN;
931 932 933 934 935 936 937 938
	if (mmc_op_multi(cmd->opcode) || data->blocks > 1) {
		mode |= SDHCI_TRNS_MULTI;
		/*
		 * If we are sending CMD23, CMD12 never gets sent
		 * on successful completion (so no Auto-CMD12).
		 */
		if (!host->mrq->sbc && (host->flags & SDHCI_AUTO_CMD12))
			mode |= SDHCI_TRNS_AUTO_CMD12;
939 940 941 942
		else if (host->mrq->sbc && (host->flags & SDHCI_AUTO_CMD23)) {
			mode |= SDHCI_TRNS_AUTO_CMD23;
			sdhci_writel(host, host->mrq->sbc->arg, SDHCI_ARGUMENT2);
		}
943
	}
944

945 946
	if (data->flags & MMC_DATA_READ)
		mode |= SDHCI_TRNS_READ;
947
	if (host->flags & SDHCI_REQ_USE_DMA)
948 949
		mode |= SDHCI_TRNS_DMA;

950
	sdhci_writew(host, mode, SDHCI_TRANSFER_MODE);
951 952 953 954 955 956 957 958 959 960 961
}

static void sdhci_finish_data(struct sdhci_host *host)
{
	struct mmc_data *data;

	BUG_ON(!host->data);

	data = host->data;
	host->data = NULL;

962
	if (host->flags & SDHCI_REQ_USE_DMA) {
963 964 965 966 967 968 969
		if (host->flags & SDHCI_USE_ADMA)
			sdhci_adma_table_post(host, data);
		else {
			dma_unmap_sg(mmc_dev(host->mmc), data->sg,
				data->sg_len, (data->flags & MMC_DATA_READ) ?
					DMA_FROM_DEVICE : DMA_TO_DEVICE);
		}
970 971 972
	}

	/*
973 974 975 976 977
	 * 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.
978
	 */
979 980
	if (data->error)
		data->bytes_xfered = 0;
981
	else
982
		data->bytes_xfered = data->blksz * data->blocks;
983

984 985 986 987 988 989 990 991 992
	/*
	 * Need to send CMD12 if -
	 * a) open-ended multiblock transfer (no CMD23)
	 * b) error in multiblock transfer
	 */
	if (data->stop &&
	    (data->error ||
	     !host->mrq->sbc)) {

993 994 995 996
		/*
		 * The controller needs a reset of internal state machines
		 * upon error conditions.
		 */
P
Pierre Ossman 已提交
997
		if (data->error) {
998 999
			sdhci_do_reset(host, SDHCI_RESET_CMD);
			sdhci_do_reset(host, SDHCI_RESET_DATA);
1000 1001 1002 1003 1004 1005 1006
		}

		sdhci_send_command(host, data->stop);
	} else
		tasklet_schedule(&host->finish_tasklet);
}

1007
void sdhci_send_command(struct sdhci_host *host, struct mmc_command *cmd)
1008 1009
{
	int flags;
1010
	u32 mask;
1011
	unsigned long timeout;
1012 1013 1014 1015

	WARN_ON(host->cmd);

	/* Wait max 10 ms */
1016
	timeout = 10;
1017 1018 1019 1020 1021 1022 1023 1024 1025 1026

	mask = SDHCI_CMD_INHIBIT;
	if ((cmd->data != NULL) || (cmd->flags & MMC_RSP_BUSY))
		mask |= SDHCI_DATA_INHIBIT;

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

1027
	while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
1028
		if (timeout == 0) {
1029
			pr_err("%s: Controller never released "
P
Pierre Ossman 已提交
1030
				"inhibit bit(s).\n", mmc_hostname(host->mmc));
1031
			sdhci_dumpregs(host);
P
Pierre Ossman 已提交
1032
			cmd->error = -EIO;
1033 1034 1035
			tasklet_schedule(&host->finish_tasklet);
			return;
		}
1036 1037 1038
		timeout--;
		mdelay(1);
	}
1039

1040
	timeout = jiffies;
1041 1042
	if (!cmd->data && cmd->busy_timeout > 9000)
		timeout += DIV_ROUND_UP(cmd->busy_timeout, 1000) * HZ + HZ;
1043 1044 1045
	else
		timeout += 10 * HZ;
	mod_timer(&host->timer, timeout);
1046 1047

	host->cmd = cmd;
1048
	host->busy_handle = 0;
1049

1050
	sdhci_prepare_data(host, cmd);
1051

1052
	sdhci_writel(host, cmd->arg, SDHCI_ARGUMENT);
1053

1054
	sdhci_set_transfer_mode(host, cmd);
1055

1056
	if ((cmd->flags & MMC_RSP_136) && (cmd->flags & MMC_RSP_BUSY)) {
1057
		pr_err("%s: Unsupported response type!\n",
1058
			mmc_hostname(host->mmc));
P
Pierre Ossman 已提交
1059
		cmd->error = -EINVAL;
1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076
		tasklet_schedule(&host->finish_tasklet);
		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;
1077 1078

	/* CMD19 is special in that the Data Present Select should be set */
1079 1080
	if (cmd->data || cmd->opcode == MMC_SEND_TUNING_BLOCK ||
	    cmd->opcode == MMC_SEND_TUNING_BLOCK_HS200)
1081 1082
		flags |= SDHCI_CMD_DATA;

1083
	sdhci_writew(host, SDHCI_MAKE_CMD(cmd->opcode, flags), SDHCI_COMMAND);
1084
}
1085
EXPORT_SYMBOL_GPL(sdhci_send_command);
1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096

static void sdhci_finish_command(struct sdhci_host *host)
{
	int i;

	BUG_ON(host->cmd == NULL);

	if (host->cmd->flags & MMC_RSP_PRESENT) {
		if (host->cmd->flags & MMC_RSP_136) {
			/* CRC is stripped so we need to do some shifting. */
			for (i = 0;i < 4;i++) {
1097
				host->cmd->resp[i] = sdhci_readl(host,
1098 1099 1100
					SDHCI_RESPONSE + (3-i)*4) << 8;
				if (i != 3)
					host->cmd->resp[i] |=
1101
						sdhci_readb(host,
1102 1103 1104
						SDHCI_RESPONSE + (3-i)*4-1);
			}
		} else {
1105
			host->cmd->resp[0] = sdhci_readl(host, SDHCI_RESPONSE);
1106 1107 1108
		}
	}

P
Pierre Ossman 已提交
1109
	host->cmd->error = 0;
1110

1111 1112 1113 1114 1115
	/* Finished CMD23, now send actual command. */
	if (host->cmd == host->mrq->sbc) {
		host->cmd = NULL;
		sdhci_send_command(host, host->mrq->cmd);
	} else {
1116

1117 1118 1119
		/* Processed actual command. */
		if (host->data && host->data_early)
			sdhci_finish_data(host);
1120

1121 1122 1123 1124 1125
		if (!host->cmd->data)
			tasklet_schedule(&host->finish_tasklet);

		host->cmd = NULL;
	}
1126 1127
}

1128 1129
static u16 sdhci_get_preset_value(struct sdhci_host *host)
{
1130
	u16 preset = 0;
1131

1132 1133
	switch (host->timing) {
	case MMC_TIMING_UHS_SDR12:
1134 1135
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR12);
		break;
1136
	case MMC_TIMING_UHS_SDR25:
1137 1138
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR25);
		break;
1139
	case MMC_TIMING_UHS_SDR50:
1140 1141
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR50);
		break;
1142 1143
	case MMC_TIMING_UHS_SDR104:
	case MMC_TIMING_MMC_HS200:
1144 1145
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR104);
		break;
1146
	case MMC_TIMING_UHS_DDR50:
1147 1148
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_DDR50);
		break;
1149 1150 1151
	case MMC_TIMING_MMC_HS400:
		preset = sdhci_readw(host, SDHCI_PRESET_FOR_HS400);
		break;
1152 1153 1154 1155 1156 1157 1158 1159 1160
	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;
}

1161
void sdhci_set_clock(struct sdhci_host *host, unsigned int clock)
1162
{
1163
	int div = 0; /* Initialized for compiler warning */
1164
	int real_div = div, clk_mul = 1;
1165
	u16 clk = 0;
1166
	unsigned long timeout;
1167

1168 1169
	host->mmc->actual_clock = 0;

1170
	sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL);
1171 1172

	if (clock == 0)
1173
		return;
1174

1175
	if (host->version >= SDHCI_SPEC_300) {
1176
		if (host->preset_enabled) {
1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193
			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;
		}

1194 1195 1196 1197 1198
		/*
		 * Check if the Host Controller supports Programmable Clock
		 * Mode.
		 */
		if (host->clk_mul) {
1199 1200 1201 1202 1203
			for (div = 1; div <= 1024; div++) {
				if ((host->max_clk * host->clk_mul / div)
					<= clock)
					break;
			}
1204
			/*
1205 1206
			 * Set Programmable Clock Mode in the Clock
			 * Control register.
1207
			 */
1208 1209 1210 1211
			clk = SDHCI_PROG_CLOCK_MODE;
			real_div = div;
			clk_mul = host->clk_mul;
			div--;
1212 1213 1214 1215 1216 1217 1218 1219 1220 1221
		} else {
			/* 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;
				}
1222
			}
1223
			real_div = div;
1224
			div >>= 1;
1225 1226 1227
		}
	} else {
		/* Version 2.00 divisors must be a power of 2. */
1228
		for (div = 1; div < SDHCI_MAX_DIV_SPEC_200; div *= 2) {
1229 1230 1231
			if ((host->max_clk / div) <= clock)
				break;
		}
1232
		real_div = div;
1233
		div >>= 1;
1234 1235
	}

1236
clock_set:
1237
	if (real_div)
1238
		host->mmc->actual_clock = (host->max_clk * clk_mul) / real_div;
1239
	clk |= (div & SDHCI_DIV_MASK) << SDHCI_DIVIDER_SHIFT;
1240 1241
	clk |= ((div & SDHCI_DIV_HI_MASK) >> SDHCI_DIV_MASK_LEN)
		<< SDHCI_DIVIDER_HI_SHIFT;
1242
	clk |= SDHCI_CLOCK_INT_EN;
1243
	sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
1244

1245 1246
	/* Wait max 20 ms */
	timeout = 20;
1247
	while (!((clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL))
1248 1249
		& SDHCI_CLOCK_INT_STABLE)) {
		if (timeout == 0) {
1250
			pr_err("%s: Internal clock never "
P
Pierre Ossman 已提交
1251
				"stabilised.\n", mmc_hostname(host->mmc));
1252 1253 1254
			sdhci_dumpregs(host);
			return;
		}
1255 1256 1257
		timeout--;
		mdelay(1);
	}
1258 1259

	clk |= SDHCI_CLOCK_CARD_EN;
1260
	sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
1261
}
1262
EXPORT_SYMBOL_GPL(sdhci_set_clock);
1263

1264 1265
static void sdhci_set_power(struct sdhci_host *host, unsigned char mode,
			    unsigned short vdd)
1266
{
1267
	struct mmc_host *mmc = host->mmc;
1268
	u8 pwr = 0;
1269

1270 1271
	if (!IS_ERR(mmc->supply.vmmc)) {
		spin_unlock_irq(&host->lock);
1272
		mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, vdd);
1273 1274 1275 1276
		spin_lock_irq(&host->lock);
		return;
	}

1277 1278
	if (mode != MMC_POWER_OFF) {
		switch (1 << vdd) {
1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295
		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:
			BUG();
		}
	}

	if (host->pwr == pwr)
1296
		return;
1297

1298 1299 1300
	host->pwr = pwr;

	if (pwr == 0) {
1301
		sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
1302 1303
		if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
			sdhci_runtime_pm_bus_off(host);
1304
		vdd = 0;
1305 1306 1307 1308 1309 1310 1311
	} 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);
1312

1313 1314 1315 1316 1317 1318 1319
		/*
		 * 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);
1320

1321
		pwr |= SDHCI_POWER_ON;
1322

1323
		sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
1324

1325 1326
		if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
			sdhci_runtime_pm_bus_on(host);
1327

1328 1329 1330 1331 1332 1333 1334
		/*
		 * 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);
	}
1335 1336
}

1337 1338 1339 1340 1341 1342 1343 1344 1345
/*****************************************************************************\
 *                                                                           *
 * MMC callbacks                                                             *
 *                                                                           *
\*****************************************************************************/

static void sdhci_request(struct mmc_host *mmc, struct mmc_request *mrq)
{
	struct sdhci_host *host;
1346
	int present;
1347
	unsigned long flags;
1348
	u32 tuning_opcode;
1349 1350 1351

	host = mmc_priv(mmc);

1352 1353
	sdhci_runtime_pm_get(host);

1354 1355
	present = mmc_gpio_get_cd(host->mmc);

1356 1357 1358 1359
	spin_lock_irqsave(&host->lock, flags);

	WARN_ON(host->mrq != NULL);

1360
#ifndef SDHCI_USE_LEDS_CLASS
1361
	sdhci_activate_led(host);
1362
#endif
1363 1364 1365 1366 1367 1368

	/*
	 * Ensure we don't send the STOP for non-SET_BLOCK_COUNTED
	 * requests if Auto-CMD12 is enabled.
	 */
	if (!mrq->sbc && (host->flags & SDHCI_AUTO_CMD12)) {
1369 1370 1371 1372 1373
		if (mrq->stop) {
			mrq->data->stop = NULL;
			mrq->stop = NULL;
		}
	}
1374 1375 1376

	host->mrq = mrq;

1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390
	/*
	 * Firstly check card presence from cd-gpio.  The return could
	 * be one of the following possibilities:
	 *     negative: cd-gpio is not available
	 *     zero: cd-gpio is used, and card is removed
	 *     one: cd-gpio is used, and card is present
	 */
	if (present < 0) {
		/* If polling, assume that the card is always present. */
		if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
			present = 1;
		else
			present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
					SDHCI_CARD_PRESENT;
1391 1392
	}

1393
	if (!present || host->flags & SDHCI_DEVICE_DEAD) {
P
Pierre Ossman 已提交
1394
		host->mrq->cmd->error = -ENOMEDIUM;
1395
		tasklet_schedule(&host->finish_tasklet);
1396 1397 1398 1399 1400 1401
	} else {
		u32 present_state;

		present_state = sdhci_readl(host, SDHCI_PRESENT_STATE);
		/*
		 * Check if the re-tuning timer has already expired and there
1402 1403
		 * is no on-going data transfer and DAT0 is not busy. If so,
		 * we need to execute tuning procedure before sending command.
1404 1405
		 */
		if ((host->flags & SDHCI_NEEDS_RETUNING) &&
1406 1407
		    !(present_state & (SDHCI_DOING_WRITE | SDHCI_DOING_READ)) &&
		    (present_state & SDHCI_DATA_0_LVL_MASK)) {
1408 1409 1410 1411 1412 1413
			if (mmc->card) {
				/* eMMC uses cmd21 but sd and sdio use cmd19 */
				tuning_opcode =
					mmc->card->type == MMC_TYPE_MMC ?
					MMC_SEND_TUNING_BLOCK_HS200 :
					MMC_SEND_TUNING_BLOCK;
1414 1415 1416 1417 1418 1419 1420

				/* Here we need to set the host->mrq to NULL,
				 * in case the pending finish_tasklet
				 * finishes it incorrectly.
				 */
				host->mrq = NULL;

1421 1422 1423 1424 1425 1426 1427
				spin_unlock_irqrestore(&host->lock, flags);
				sdhci_execute_tuning(mmc, tuning_opcode);
				spin_lock_irqsave(&host->lock, flags);

				/* Restore original mmc_request structure */
				host->mrq = mrq;
			}
1428 1429
		}

1430
		if (mrq->sbc && !(host->flags & SDHCI_AUTO_CMD23))
1431 1432 1433
			sdhci_send_command(host, mrq->sbc);
		else
			sdhci_send_command(host, mrq->cmd);
1434
	}
1435

1436
	mmiowb();
1437 1438 1439
	spin_unlock_irqrestore(&host->lock, flags);
}

1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460
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);

1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479
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;
1480 1481
	else if (timing == MMC_TIMING_MMC_HS400)
		ctrl_2 |= SDHCI_CTRL_HS400; /* Non-standard */
1482 1483 1484 1485
	sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2);
}
EXPORT_SYMBOL_GPL(sdhci_set_uhs_signaling);

1486
static void sdhci_do_set_ios(struct sdhci_host *host, struct mmc_ios *ios)
1487 1488 1489
{
	unsigned long flags;
	u8 ctrl;
1490
	struct mmc_host *mmc = host->mmc;
1491 1492 1493

	spin_lock_irqsave(&host->lock, flags);

A
Adrian Hunter 已提交
1494 1495
	if (host->flags & SDHCI_DEVICE_DEAD) {
		spin_unlock_irqrestore(&host->lock, flags);
1496 1497
		if (!IS_ERR(mmc->supply.vmmc) &&
		    ios->power_mode == MMC_POWER_OFF)
1498
			mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
A
Adrian Hunter 已提交
1499 1500
		return;
	}
P
Pierre Ossman 已提交
1501

1502 1503 1504 1505 1506
	/*
	 * Reset the chip on each power off.
	 * Should clear out any weird states.
	 */
	if (ios->power_mode == MMC_POWER_OFF) {
1507
		sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
1508
		sdhci_reinit(host);
1509 1510
	}

1511
	if (host->version >= SDHCI_SPEC_300 &&
1512 1513
		(ios->power_mode == MMC_POWER_UP) &&
		!(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN))
1514 1515
		sdhci_enable_preset_value(host, false);

1516
	if (!ios->clock || ios->clock != host->clock) {
1517
		host->ops->set_clock(host, ios->clock);
1518
		host->clock = ios->clock;
1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530

		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;
		}
1531
	}
1532

1533
	sdhci_set_power(host, ios->power_mode, ios->vdd);
1534

1535 1536 1537
	if (host->ops->platform_send_init_74_clocks)
		host->ops->platform_send_init_74_clocks(host, ios->power_mode);

1538
	host->ops->set_bus_width(host, ios->bus_width);
1539

1540
	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
1541

1542 1543 1544
	if ((ios->timing == MMC_TIMING_SD_HS ||
	     ios->timing == MMC_TIMING_MMC_HS)
	    && !(host->quirks & SDHCI_QUIRK_NO_HISPD_BIT))
1545 1546 1547 1548
		ctrl |= SDHCI_CTRL_HISPD;
	else
		ctrl &= ~SDHCI_CTRL_HISPD;

1549
	if (host->version >= SDHCI_SPEC_300) {
1550 1551 1552
		u16 clk, ctrl_2;

		/* In case of UHS-I modes, set High Speed Enable */
1553 1554
		if ((ios->timing == MMC_TIMING_MMC_HS400) ||
		    (ios->timing == MMC_TIMING_MMC_HS200) ||
1555
		    (ios->timing == MMC_TIMING_MMC_DDR52) ||
1556
		    (ios->timing == MMC_TIMING_UHS_SDR50) ||
1557 1558
		    (ios->timing == MMC_TIMING_UHS_SDR104) ||
		    (ios->timing == MMC_TIMING_UHS_DDR50) ||
1559
		    (ios->timing == MMC_TIMING_UHS_SDR25))
1560
			ctrl |= SDHCI_CTRL_HISPD;
1561

1562
		if (!host->preset_enabled) {
1563
			sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1564 1565 1566 1567
			/*
			 * We only need to set Driver Strength if the
			 * preset value enable is not set.
			 */
1568
			ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1569 1570 1571 1572 1573 1574 1575
			ctrl_2 &= ~SDHCI_CTRL_DRV_TYPE_MASK;
			if (ios->drv_type == MMC_SET_DRIVER_TYPE_A)
				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_A;
			else if (ios->drv_type == MMC_SET_DRIVER_TYPE_C)
				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_C;

			sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2);
1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591
		} 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 */
1592
			host->ops->set_clock(host, host->clock);
1593
		}
1594 1595 1596 1597 1598 1599

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

1600
		host->ops->set_uhs_signaling(host, ios->timing);
1601
		host->timing = ios->timing;
1602

1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616
		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) ||
				 (ios->timing == MMC_TIMING_UHS_DDR50))) {
			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;
		}

1617
		/* Re-enable SD Clock */
1618
		host->ops->set_clock(host, host->clock);
1619 1620
	} else
		sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1621

1622 1623 1624 1625 1626
	/*
	 * 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.
	 */
1627
	if(host->quirks & SDHCI_QUIRK_RESET_CMD_DATA_ON_IOS)
1628
		sdhci_do_reset(host, SDHCI_RESET_CMD | SDHCI_RESET_DATA);
1629

1630
	mmiowb();
1631 1632 1633
	spin_unlock_irqrestore(&host->lock, flags);
}

1634 1635 1636 1637 1638 1639 1640 1641 1642
static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
{
	struct sdhci_host *host = mmc_priv(mmc);

	sdhci_runtime_pm_get(host);
	sdhci_do_set_ios(host, ios);
	sdhci_runtime_pm_put(host);
}

1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673
static int sdhci_do_get_cd(struct sdhci_host *host)
{
	int gpio_cd = mmc_gpio_get_cd(host->mmc);

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

	/* If polling/nonremovable, assume that the card is always present. */
	if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) ||
	    (host->mmc->caps & MMC_CAP_NONREMOVABLE))
		return 1;

	/* Try slot gpio detect */
	if (!IS_ERR_VALUE(gpio_cd))
		return !!gpio_cd;

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

static int sdhci_get_cd(struct mmc_host *mmc)
{
	struct sdhci_host *host = mmc_priv(mmc);
	int ret;

	sdhci_runtime_pm_get(host);
	ret = sdhci_do_get_cd(host);
	sdhci_runtime_pm_put(host);
	return ret;
}

1674
static int sdhci_check_ro(struct sdhci_host *host)
1675 1676
{
	unsigned long flags;
1677
	int is_readonly;
1678 1679 1680

	spin_lock_irqsave(&host->lock, flags);

P
Pierre Ossman 已提交
1681
	if (host->flags & SDHCI_DEVICE_DEAD)
1682 1683 1684
		is_readonly = 0;
	else if (host->ops->get_ro)
		is_readonly = host->ops->get_ro(host);
P
Pierre Ossman 已提交
1685
	else
1686 1687
		is_readonly = !(sdhci_readl(host, SDHCI_PRESENT_STATE)
				& SDHCI_WRITE_PROTECT);
1688 1689 1690

	spin_unlock_irqrestore(&host->lock, flags);

1691 1692 1693
	/* This quirk needs to be replaced by a callback-function later */
	return host->quirks & SDHCI_QUIRK_INVERTED_WRITE_PROTECT ?
		!is_readonly : is_readonly;
1694 1695
}

1696 1697
#define SAMPLE_COUNT	5

1698
static int sdhci_do_get_ro(struct sdhci_host *host)
1699 1700 1701 1702
{
	int i, ro_count;

	if (!(host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT))
1703
		return sdhci_check_ro(host);
1704 1705 1706

	ro_count = 0;
	for (i = 0; i < SAMPLE_COUNT; i++) {
1707
		if (sdhci_check_ro(host)) {
1708 1709 1710 1711 1712 1713 1714 1715
			if (++ro_count > SAMPLE_COUNT / 2)
				return 1;
		}
		msleep(30);
	}
	return 0;
}

1716 1717 1718 1719 1720 1721 1722 1723
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);
}

1724
static int sdhci_get_ro(struct mmc_host *mmc)
P
Pierre Ossman 已提交
1725
{
1726 1727
	struct sdhci_host *host = mmc_priv(mmc);
	int ret;
P
Pierre Ossman 已提交
1728

1729 1730 1731 1732 1733
	sdhci_runtime_pm_get(host);
	ret = sdhci_do_get_ro(host);
	sdhci_runtime_pm_put(host);
	return ret;
}
P
Pierre Ossman 已提交
1734

1735 1736
static void sdhci_enable_sdio_irq_nolock(struct sdhci_host *host, int enable)
{
1737
	if (!(host->flags & SDHCI_DEVICE_DEAD)) {
1738
		if (enable)
1739
			host->ier |= SDHCI_INT_CARD_INT;
1740
		else
1741 1742 1743 1744
			host->ier &= ~SDHCI_INT_CARD_INT;

		sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
		sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
1745 1746
		mmiowb();
	}
1747 1748 1749 1750 1751 1752
}

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 已提交
1753

1754 1755
	sdhci_runtime_pm_get(host);

1756
	spin_lock_irqsave(&host->lock, flags);
1757 1758 1759 1760 1761
	if (enable)
		host->flags |= SDHCI_SDIO_IRQ_ENABLED;
	else
		host->flags &= ~SDHCI_SDIO_IRQ_ENABLED;

1762
	sdhci_enable_sdio_irq_nolock(host, enable);
P
Pierre Ossman 已提交
1763
	spin_unlock_irqrestore(&host->lock, flags);
1764 1765

	sdhci_runtime_pm_put(host);
P
Pierre Ossman 已提交
1766 1767
}

1768
static int sdhci_do_start_signal_voltage_switch(struct sdhci_host *host,
1769
						struct mmc_ios *ios)
1770
{
1771
	struct mmc_host *mmc = host->mmc;
1772
	u16 ctrl;
1773
	int ret;
1774

1775 1776 1777 1778 1779 1780
	/*
	 * Signal Voltage Switching is only applicable for Host Controllers
	 * v3.00 and above.
	 */
	if (host->version < SDHCI_SPEC_300)
		return 0;
1781

1782 1783
	ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);

1784
	switch (ios->signal_voltage) {
1785 1786 1787 1788
	case MMC_SIGNAL_VOLTAGE_330:
		/* Set 1.8V Signal Enable in the Host Control2 register to 0 */
		ctrl &= ~SDHCI_CTRL_VDD_180;
		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1789

1790 1791 1792
		if (!IS_ERR(mmc->supply.vqmmc)) {
			ret = regulator_set_voltage(mmc->supply.vqmmc, 2700000,
						    3600000);
1793
			if (ret) {
J
Joe Perches 已提交
1794 1795
				pr_warn("%s: Switching to 3.3V signalling voltage failed\n",
					mmc_hostname(mmc));
1796 1797 1798 1799 1800
				return -EIO;
			}
		}
		/* Wait for 5ms */
		usleep_range(5000, 5500);
1801

1802 1803 1804 1805
		/* 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;
1806

J
Joe Perches 已提交
1807 1808
		pr_warn("%s: 3.3V regulator output did not became stable\n",
			mmc_hostname(mmc));
1809 1810 1811

		return -EAGAIN;
	case MMC_SIGNAL_VOLTAGE_180:
1812 1813
		if (!IS_ERR(mmc->supply.vqmmc)) {
			ret = regulator_set_voltage(mmc->supply.vqmmc,
1814 1815
					1700000, 1950000);
			if (ret) {
J
Joe Perches 已提交
1816 1817
				pr_warn("%s: Switching to 1.8V signalling voltage failed\n",
					mmc_hostname(mmc));
1818 1819 1820
				return -EIO;
			}
		}
1821 1822 1823 1824 1825

		/*
		 * Enable 1.8V Signal Enable in the Host Control2
		 * register
		 */
1826 1827
		ctrl |= SDHCI_CTRL_VDD_180;
		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1828

1829 1830 1831 1832
		/* 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;
1833

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

1837 1838
		return -EAGAIN;
	case MMC_SIGNAL_VOLTAGE_120:
1839 1840 1841
		if (!IS_ERR(mmc->supply.vqmmc)) {
			ret = regulator_set_voltage(mmc->supply.vqmmc, 1100000,
						    1300000);
1842
			if (ret) {
J
Joe Perches 已提交
1843 1844
				pr_warn("%s: Switching to 1.2V signalling voltage failed\n",
					mmc_hostname(mmc));
1845
				return -EIO;
1846 1847
			}
		}
1848
		return 0;
1849
	default:
1850 1851
		/* No signal voltage switch required */
		return 0;
1852
	}
1853 1854
}

1855
static int sdhci_start_signal_voltage_switch(struct mmc_host *mmc,
1856
	struct mmc_ios *ios)
1857 1858 1859 1860 1861 1862 1863
{
	struct sdhci_host *host = mmc_priv(mmc);
	int err;

	if (host->version < SDHCI_SPEC_300)
		return 0;
	sdhci_runtime_pm_get(host);
1864
	err = sdhci_do_start_signal_voltage_switch(host, ios);
1865 1866 1867 1868
	sdhci_runtime_pm_put(host);
	return err;
}

1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881
static int sdhci_card_busy(struct mmc_host *mmc)
{
	struct sdhci_host *host = mmc_priv(mmc);
	u32 present_state;

	sdhci_runtime_pm_get(host);
	/* Check whether DAT[3:0] is 0000 */
	present_state = sdhci_readl(host, SDHCI_PRESENT_STATE);
	sdhci_runtime_pm_put(host);

	return !(present_state & SDHCI_DATA_LVL_MASK);
}

1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893
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;
}

1894
static int sdhci_execute_tuning(struct mmc_host *mmc, u32 opcode)
1895
{
1896
	struct sdhci_host *host = mmc_priv(mmc);
1897 1898 1899
	u16 ctrl;
	int tuning_loop_counter = MAX_TUNING_LOOP;
	int err = 0;
1900
	unsigned long flags;
1901
	unsigned int tuning_count = 0;
1902
	bool hs400_tuning;
1903

1904
	sdhci_runtime_pm_get(host);
1905
	spin_lock_irqsave(&host->lock, flags);
1906

1907 1908 1909
	hs400_tuning = host->flags & SDHCI_HS400_TUNING;
	host->flags &= ~SDHCI_HS400_TUNING;

1910 1911 1912
	if (host->tuning_mode == SDHCI_TUNING_MODE_1)
		tuning_count = host->tuning_count;

1913
	/*
1914 1915
	 * The Host Controller needs tuning only in case of SDR104 mode
	 * and for SDR50 mode when Use Tuning for SDR50 is set in the
1916
	 * Capabilities register.
1917 1918
	 * If the Host Controller supports the HS200 mode then the
	 * tuning function has to be executed.
1919
	 */
1920
	switch (host->timing) {
1921
	/* HS400 tuning is done in HS200 mode */
1922
	case MMC_TIMING_MMC_HS400:
1923 1924 1925
		err = -EINVAL;
		goto out_unlock;

1926
	case MMC_TIMING_MMC_HS200:
1927 1928 1929 1930 1931 1932 1933 1934
		/*
		 * Periodic re-tuning for HS400 is not expected to be needed, so
		 * disable it here.
		 */
		if (hs400_tuning)
			tuning_count = 0;
		break;

1935 1936 1937 1938 1939 1940 1941 1942 1943 1944
	case MMC_TIMING_UHS_SDR104:
		break;

	case MMC_TIMING_UHS_SDR50:
		if (host->flags & SDHCI_SDR50_NEEDS_TUNING ||
		    host->flags & SDHCI_SDR104_NEEDS_TUNING)
			break;
		/* FALLTHROUGH */

	default:
1945
		goto out_unlock;
1946 1947
	}

1948
	if (host->ops->platform_execute_tuning) {
1949
		spin_unlock_irqrestore(&host->lock, flags);
1950 1951 1952 1953 1954
		err = host->ops->platform_execute_tuning(host, opcode);
		sdhci_runtime_pm_put(host);
		return err;
	}

1955 1956
	ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
	ctrl |= SDHCI_CTRL_EXEC_TUNING;
1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968
	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.
	 */
1969 1970
	sdhci_writel(host, SDHCI_INT_DATA_AVAIL, SDHCI_INT_ENABLE);
	sdhci_writel(host, SDHCI_INT_DATA_AVAIL, SDHCI_SIGNAL_ENABLE);
1971 1972 1973 1974 1975 1976 1977

	/*
	 * Issue CMD19 repeatedly till Execute Tuning is set to 0 or the number
	 * of loops reaches 40 times or a timeout of 150ms occurs.
	 */
	do {
		struct mmc_command cmd = {0};
1978
		struct mmc_request mrq = {NULL};
1979

1980
		cmd.opcode = opcode;
1981 1982 1983 1984 1985 1986
		cmd.arg = 0;
		cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
		cmd.retries = 0;
		cmd.data = NULL;
		cmd.error = 0;

1987 1988 1989
		if (tuning_loop_counter-- == 0)
			break;

1990 1991 1992 1993 1994 1995 1996 1997
		mrq.cmd = &cmd;
		host->mrq = &mrq;

		/*
		 * 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.
		 */
1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008
		if (cmd.opcode == MMC_SEND_TUNING_BLOCK_HS200) {
			if (mmc->ios.bus_width == MMC_BUS_WIDTH_8)
				sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 128),
					     SDHCI_BLOCK_SIZE);
			else if (mmc->ios.bus_width == MMC_BUS_WIDTH_4)
				sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 64),
					     SDHCI_BLOCK_SIZE);
		} else {
			sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 64),
				     SDHCI_BLOCK_SIZE);
		}
2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022

		/*
		 * 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;
		host->mrq = NULL;

2023
		spin_unlock_irqrestore(&host->lock, flags);
2024 2025 2026 2027
		/* Wait for Buffer Read Ready interrupt */
		wait_event_interruptible_timeout(host->buf_ready_int,
					(host->tuning_done == 1),
					msecs_to_jiffies(50));
2028
		spin_lock_irqsave(&host->lock, flags);
2029 2030

		if (!host->tuning_done) {
2031
			pr_info(DRIVER_NAME ": Timeout waiting for "
2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046
				"Buffer Read Ready interrupt during tuning "
				"procedure, falling back to fixed sampling "
				"clock\n");
			ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
			ctrl &= ~SDHCI_CTRL_TUNED_CLK;
			ctrl &= ~SDHCI_CTRL_EXEC_TUNING;
			sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);

			err = -EIO;
			goto out;
		}

		host->tuning_done = 0;

		ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
2047 2048 2049 2050

		/* eMMC spec does not require a delay between tuning cycles */
		if (opcode == MMC_SEND_TUNING_BLOCK)
			mdelay(1);
2051 2052 2053 2054 2055 2056
	} while (ctrl & SDHCI_CTRL_EXEC_TUNING);

	/*
	 * The Host Driver has exhausted the maximum number of loops allowed,
	 * so use fixed sampling frequency.
	 */
2057
	if (tuning_loop_counter < 0) {
2058 2059
		ctrl &= ~SDHCI_CTRL_TUNED_CLK;
		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
2060 2061 2062 2063 2064
	}
	if (!(ctrl & SDHCI_CTRL_TUNED_CLK)) {
		pr_info(DRIVER_NAME ": Tuning procedure"
			" failed, falling back to fixed sampling"
			" clock\n");
2065
		err = -EIO;
2066 2067 2068
	}

out:
2069 2070 2071
	host->flags &= ~SDHCI_NEEDS_RETUNING;

	if (tuning_count) {
2072
		host->flags |= SDHCI_USING_RETUNING_TIMER;
2073
		mod_timer(&host->tuning_timer, jiffies + tuning_count * HZ);
2074 2075 2076 2077 2078 2079 2080
	}

	/*
	 * In case tuning fails, host controllers which support re-tuning can
	 * try tuning again at a later time, when the re-tuning timer expires.
	 * So for these controllers, we return 0. Since there might be other
	 * controllers who do not have this capability, we return error for
2081 2082
	 * them. SDHCI_USING_RETUNING_TIMER means the host is currently using
	 * a retuning timer to do the retuning for the card.
2083
	 */
2084
	if (err && (host->flags & SDHCI_USING_RETUNING_TIMER))
2085 2086
		err = 0;

2087 2088
	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
2089
out_unlock:
2090
	spin_unlock_irqrestore(&host->lock, flags);
2091
	sdhci_runtime_pm_put(host);
2092 2093 2094 2095

	return err;
}

2096 2097

static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable)
2098 2099 2100 2101 2102 2103 2104 2105 2106
{
	/* 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.
	 */
2107 2108 2109 2110 2111 2112 2113 2114
	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;

2115
		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
2116 2117 2118 2119 2120 2121 2122

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

		host->preset_enabled = enable;
2123
	}
2124 2125
}

2126
static void sdhci_card_event(struct mmc_host *mmc)
2127
{
2128
	struct sdhci_host *host = mmc_priv(mmc);
2129
	unsigned long flags;
2130
	int present;
2131

2132 2133 2134 2135
	/* First check if client has provided their own card event */
	if (host->ops->card_event)
		host->ops->card_event(host);

2136 2137
	present = sdhci_do_get_cd(host);

2138 2139
	spin_lock_irqsave(&host->lock, flags);

2140
	/* Check host->mrq first in case we are runtime suspended */
2141
	if (host->mrq && !present) {
2142
		pr_err("%s: Card removed during transfer!\n",
2143
			mmc_hostname(host->mmc));
2144
		pr_err("%s: Resetting controller.\n",
2145
			mmc_hostname(host->mmc));
2146

2147 2148
		sdhci_do_reset(host, SDHCI_RESET_CMD);
		sdhci_do_reset(host, SDHCI_RESET_DATA);
2149

2150 2151
		host->mrq->cmd->error = -ENOMEDIUM;
		tasklet_schedule(&host->finish_tasklet);
2152 2153 2154
	}

	spin_unlock_irqrestore(&host->lock, flags);
2155 2156 2157 2158 2159
}

static const struct mmc_host_ops sdhci_ops = {
	.request	= sdhci_request,
	.set_ios	= sdhci_set_ios,
2160
	.get_cd		= sdhci_get_cd,
2161 2162 2163 2164
	.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,
2165
	.prepare_hs400_tuning		= sdhci_prepare_hs400_tuning,
2166 2167
	.execute_tuning			= sdhci_execute_tuning,
	.card_event			= sdhci_card_event,
2168
	.card_busy	= sdhci_card_busy,
2169 2170 2171 2172 2173 2174 2175 2176
};

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

2177 2178 2179 2180 2181 2182 2183 2184
static void sdhci_tasklet_finish(unsigned long param)
{
	struct sdhci_host *host;
	unsigned long flags;
	struct mmc_request *mrq;

	host = (struct sdhci_host*)param;

2185 2186
	spin_lock_irqsave(&host->lock, flags);

2187 2188 2189 2190
        /*
         * If this tasklet gets rescheduled while running, it will
         * be run again afterwards but without any active request.
         */
2191 2192
	if (!host->mrq) {
		spin_unlock_irqrestore(&host->lock, flags);
2193
		return;
2194
	}
2195 2196 2197 2198 2199 2200 2201 2202 2203

	del_timer(&host->timer);

	mrq = host->mrq;

	/*
	 * The controller needs a reset of internal state machines
	 * upon error conditions.
	 */
P
Pierre Ossman 已提交
2204
	if (!(host->flags & SDHCI_DEVICE_DEAD) &&
2205
	    ((mrq->cmd && mrq->cmd->error) ||
2206 2207 2208 2209
	     (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))) {
2210 2211

		/* Some controllers need this kick or reset won't work here */
2212
		if (host->quirks & SDHCI_QUIRK_CLOCK_BEFORE_RESET)
2213
			/* This is to force an update */
2214
			host->ops->set_clock(host, host->clock);
2215 2216 2217

		/* Spec says we should do both at the same time, but Ricoh
		   controllers do not like that. */
2218 2219
		sdhci_do_reset(host, SDHCI_RESET_CMD);
		sdhci_do_reset(host, SDHCI_RESET_DATA);
2220 2221 2222 2223 2224 2225
	}

	host->mrq = NULL;
	host->cmd = NULL;
	host->data = NULL;

2226
#ifndef SDHCI_USE_LEDS_CLASS
2227
	sdhci_deactivate_led(host);
2228
#endif
2229

2230
	mmiowb();
2231 2232 2233
	spin_unlock_irqrestore(&host->lock, flags);

	mmc_request_done(host->mmc, mrq);
2234
	sdhci_runtime_pm_put(host);
2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246
}

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

	if (host->mrq) {
2247
		pr_err("%s: Timeout waiting for hardware "
P
Pierre Ossman 已提交
2248
			"interrupt.\n", mmc_hostname(host->mmc));
2249 2250 2251
		sdhci_dumpregs(host);

		if (host->data) {
P
Pierre Ossman 已提交
2252
			host->data->error = -ETIMEDOUT;
2253 2254 2255
			sdhci_finish_data(host);
		} else {
			if (host->cmd)
P
Pierre Ossman 已提交
2256
				host->cmd->error = -ETIMEDOUT;
2257
			else
P
Pierre Ossman 已提交
2258
				host->mrq->cmd->error = -ETIMEDOUT;
2259 2260 2261 2262 2263

			tasklet_schedule(&host->finish_tasklet);
		}
	}

2264
	mmiowb();
2265 2266 2267
	spin_unlock_irqrestore(&host->lock, flags);
}

2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281
static void sdhci_tuning_timer(unsigned long data)
{
	struct sdhci_host *host;
	unsigned long flags;

	host = (struct sdhci_host *)data;

	spin_lock_irqsave(&host->lock, flags);

	host->flags |= SDHCI_NEEDS_RETUNING;

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

2282 2283 2284 2285 2286 2287
/*****************************************************************************\
 *                                                                           *
 * Interrupt handling                                                        *
 *                                                                           *
\*****************************************************************************/

2288
static void sdhci_cmd_irq(struct sdhci_host *host, u32 intmask, u32 *mask)
2289 2290 2291 2292
{
	BUG_ON(intmask == 0);

	if (!host->cmd) {
2293
		pr_err("%s: Got command interrupt 0x%08x even "
2294 2295
			"though no command operation was in progress.\n",
			mmc_hostname(host->mmc), (unsigned)intmask);
2296 2297 2298 2299
		sdhci_dumpregs(host);
		return;
	}

2300
	if (intmask & SDHCI_INT_TIMEOUT)
P
Pierre Ossman 已提交
2301 2302 2303 2304
		host->cmd->error = -ETIMEDOUT;
	else if (intmask & (SDHCI_INT_CRC | SDHCI_INT_END_BIT |
			SDHCI_INT_INDEX))
		host->cmd->error = -EILSEQ;
2305

2306
	if (host->cmd->error) {
2307
		tasklet_schedule(&host->finish_tasklet);
2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325
		return;
	}

	/*
	 * The host can send and interrupt when the busy state has
	 * ended, allowing us to wait without wasting CPU cycles.
	 * Unfortunately this is overloaded on the "data complete"
	 * interrupt, so we need to take some care when handling
	 * it.
	 *
	 * Note: The 1.0 specification is a bit ambiguous about this
	 *       feature so there might be some problems with older
	 *       controllers.
	 */
	if (host->cmd->flags & MMC_RSP_BUSY) {
		if (host->cmd->data)
			DBG("Cannot wait for busy signal when also "
				"doing a data transfer");
2326 2327 2328 2329
		else if (!(host->quirks & SDHCI_QUIRK_NO_BUSY_IRQ)
				&& !host->busy_handle) {
			/* Mark that command complete before busy is ended */
			host->busy_handle = 1;
2330
			return;
2331
		}
2332 2333 2334

		/* The controller does not support the end-of-busy IRQ,
		 * fall through and take the SDHCI_INT_RESPONSE */
2335 2336 2337
	} else if ((host->quirks2 & SDHCI_QUIRK2_STOP_WITH_TC) &&
		   host->cmd->opcode == MMC_STOP_TRANSMISSION && !host->data) {
		*mask &= ~SDHCI_INT_DATA_END;
2338 2339 2340
	}

	if (intmask & SDHCI_INT_RESPONSE)
2341
		sdhci_finish_command(host);
2342 2343
}

2344
#ifdef CONFIG_MMC_DEBUG
2345
static void sdhci_adma_show_error(struct sdhci_host *host)
2346 2347
{
	const char *name = mmc_hostname(host->mmc);
2348
	void *desc = host->adma_table;
2349 2350 2351 2352

	sdhci_dumpregs(host);

	while (true) {
2353 2354 2355 2356 2357 2358 2359 2360 2361 2362 2363 2364 2365
		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));
2366

2367
		desc += host->desc_sz;
2368

2369
		if (dma_desc->cmd & cpu_to_le16(ADMA2_END))
2370 2371 2372 2373
			break;
	}
}
#else
2374
static void sdhci_adma_show_error(struct sdhci_host *host) { }
2375 2376
#endif

2377 2378
static void sdhci_data_irq(struct sdhci_host *host, u32 intmask)
{
2379
	u32 command;
2380 2381
	BUG_ON(intmask == 0);

2382 2383
	/* CMD19 generates _only_ Buffer Read Ready interrupt */
	if (intmask & SDHCI_INT_DATA_AVAIL) {
2384 2385 2386
		command = SDHCI_GET_CMD(sdhci_readw(host, SDHCI_COMMAND));
		if (command == MMC_SEND_TUNING_BLOCK ||
		    command == MMC_SEND_TUNING_BLOCK_HS200) {
2387 2388 2389 2390 2391 2392
			host->tuning_done = 1;
			wake_up(&host->buf_ready_int);
			return;
		}
	}

2393 2394
	if (!host->data) {
		/*
2395 2396 2397
		 * The "data complete" interrupt is also used to
		 * indicate that a busy state has ended. See comment
		 * above in sdhci_cmd_irq().
2398
		 */
2399
		if (host->cmd && (host->cmd->flags & MMC_RSP_BUSY)) {
2400 2401 2402 2403 2404
			if (intmask & SDHCI_INT_DATA_TIMEOUT) {
				host->cmd->error = -ETIMEDOUT;
				tasklet_schedule(&host->finish_tasklet);
				return;
			}
2405
			if (intmask & SDHCI_INT_DATA_END) {
2406 2407 2408 2409 2410 2411 2412 2413 2414
				/*
				 * Some cards handle busy-end interrupt
				 * before the command completed, so make
				 * sure we do things in the proper order.
				 */
				if (host->busy_handle)
					sdhci_finish_command(host);
				else
					host->busy_handle = 1;
2415 2416 2417
				return;
			}
		}
2418

2419
		pr_err("%s: Got data interrupt 0x%08x even "
2420 2421
			"though no data operation was in progress.\n",
			mmc_hostname(host->mmc), (unsigned)intmask);
2422 2423 2424 2425 2426 2427
		sdhci_dumpregs(host);

		return;
	}

	if (intmask & SDHCI_INT_DATA_TIMEOUT)
P
Pierre Ossman 已提交
2428
		host->data->error = -ETIMEDOUT;
2429 2430 2431 2432 2433
	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 已提交
2434
		host->data->error = -EILSEQ;
2435
	else if (intmask & SDHCI_INT_ADMA_ERROR) {
2436
		pr_err("%s: ADMA error\n", mmc_hostname(host->mmc));
2437
		sdhci_adma_show_error(host);
2438
		host->data->error = -EIO;
2439 2440
		if (host->ops->adma_workaround)
			host->ops->adma_workaround(host, intmask);
2441
	}
2442

P
Pierre Ossman 已提交
2443
	if (host->data->error)
2444 2445
		sdhci_finish_data(host);
	else {
P
Pierre Ossman 已提交
2446
		if (intmask & (SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL))
2447 2448
			sdhci_transfer_pio(host);

2449 2450 2451 2452
		/*
		 * 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.
2453 2454 2455 2456
		 *
		 * 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.
2457
		 */
2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474
		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);
		}
2475

2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487
		if (intmask & SDHCI_INT_DATA_END) {
			if (host->cmd) {
				/*
				 * 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);
			}
		}
2488 2489 2490
	}
}

2491
static irqreturn_t sdhci_irq(int irq, void *dev_id)
2492
{
2493
	irqreturn_t result = IRQ_NONE;
2494
	struct sdhci_host *host = dev_id;
2495
	u32 intmask, mask, unexpected = 0;
2496
	int max_loops = 16;
2497 2498 2499

	spin_lock(&host->lock);

2500
	if (host->runtime_suspended && !sdhci_sdio_irq_enabled(host)) {
2501
		spin_unlock(&host->lock);
2502
		return IRQ_NONE;
2503 2504
	}

2505
	intmask = sdhci_readl(host, SDHCI_INT_STATUS);
2506
	if (!intmask || intmask == 0xffffffff) {
2507 2508 2509 2510
		result = IRQ_NONE;
		goto out;
	}

2511 2512 2513 2514 2515
	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);
2516

2517 2518
		DBG("*** %s got interrupt: 0x%08x\n",
			mmc_hostname(host->mmc), intmask);
2519

2520 2521 2522
		if (intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
			u32 present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
				      SDHCI_CARD_PRESENT;
2523

2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534
			/*
			 * 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.
			 */
2535 2536 2537 2538 2539 2540
			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);
2541 2542 2543

			sdhci_writel(host, intmask & (SDHCI_INT_CARD_INSERT |
				     SDHCI_INT_CARD_REMOVE), SDHCI_INT_STATUS);
2544 2545 2546 2547

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

2550
		if (intmask & SDHCI_INT_CMD_MASK)
2551 2552
			sdhci_cmd_irq(host, intmask & SDHCI_INT_CMD_MASK,
				      &intmask);
2553

2554 2555
		if (intmask & SDHCI_INT_DATA_MASK)
			sdhci_data_irq(host, intmask & SDHCI_INT_DATA_MASK);
2556

2557 2558 2559
		if (intmask & SDHCI_INT_BUS_POWER)
			pr_err("%s: Card is consuming too much power!\n",
				mmc_hostname(host->mmc));
2560

2561 2562 2563 2564 2565
		if (intmask & SDHCI_INT_CARD_INT) {
			sdhci_enable_sdio_irq_nolock(host, false);
			host->thread_isr |= SDHCI_INT_CARD_INT;
			result = IRQ_WAKE_THREAD;
		}
P
Pierre Ossman 已提交
2566

2567 2568 2569 2570
		intmask &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE |
			     SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK |
			     SDHCI_INT_ERROR | SDHCI_INT_BUS_POWER |
			     SDHCI_INT_CARD_INT);
P
Pierre Ossman 已提交
2571

2572 2573 2574 2575
		if (intmask) {
			unexpected |= intmask;
			sdhci_writel(host, intmask, SDHCI_INT_STATUS);
		}
2576

2577 2578
		if (result == IRQ_NONE)
			result = IRQ_HANDLED;
2579

2580 2581
		intmask = sdhci_readl(host, SDHCI_INT_STATUS);
	} while (intmask && --max_loops);
2582 2583 2584
out:
	spin_unlock(&host->lock);

2585 2586 2587 2588 2589
	if (unexpected) {
		pr_err("%s: Unexpected interrupt 0x%08x.\n",
			   mmc_hostname(host->mmc), unexpected);
		sdhci_dumpregs(host);
	}
P
Pierre Ossman 已提交
2590

2591 2592 2593
	return result;
}

2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604
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);

2605 2606 2607 2608 2609
	if (isr & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
		sdhci_card_event(host->mmc);
		mmc_detect_change(host->mmc, msecs_to_jiffies(200));
	}

2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621
	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;
}

2622 2623 2624 2625 2626 2627 2628
/*****************************************************************************\
 *                                                                           *
 * Suspend/resume                                                            *
 *                                                                           *
\*****************************************************************************/

#ifdef CONFIG_PM
K
Kevin Liu 已提交
2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643
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;

	val = sdhci_readb(host, SDHCI_WAKE_UP_CONTROL);
	val |= mask ;
	/* Avoid fake wake up */
	if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
		val &= ~(SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE);
	sdhci_writeb(host, val, SDHCI_WAKE_UP_CONTROL);
}
EXPORT_SYMBOL_GPL(sdhci_enable_irq_wakeups);

2644
static void sdhci_disable_irq_wakeups(struct sdhci_host *host)
K
Kevin Liu 已提交
2645 2646 2647 2648 2649 2650 2651 2652 2653
{
	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);
}
2654

2655
int sdhci_suspend_host(struct sdhci_host *host)
2656
{
2657 2658
	sdhci_disable_card_detection(host);

2659
	/* Disable tuning since we are suspending */
2660
	if (host->flags & SDHCI_USING_RETUNING_TIMER) {
2661
		del_timer_sync(&host->tuning_timer);
2662 2663 2664
		host->flags &= ~SDHCI_NEEDS_RETUNING;
	}

K
Kevin Liu 已提交
2665
	if (!device_may_wakeup(mmc_dev(host->mmc))) {
2666 2667 2668
		host->ier = 0;
		sdhci_writel(host, 0, SDHCI_INT_ENABLE);
		sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
K
Kevin Liu 已提交
2669 2670 2671 2672 2673
		free_irq(host->irq, host);
	} else {
		sdhci_enable_irq_wakeups(host);
		enable_irq_wake(host->irq);
	}
2674
	return 0;
2675 2676
}

2677
EXPORT_SYMBOL_GPL(sdhci_suspend_host);
2678

2679 2680
int sdhci_resume_host(struct sdhci_host *host)
{
2681
	int ret = 0;
2682

2683
	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
2684 2685 2686
		if (host->ops->enable_dma)
			host->ops->enable_dma(host);
	}
2687

K
Kevin Liu 已提交
2688
	if (!device_may_wakeup(mmc_dev(host->mmc))) {
2689 2690 2691
		ret = request_threaded_irq(host->irq, sdhci_irq,
					   sdhci_thread_irq, IRQF_SHARED,
					   mmc_hostname(host->mmc), host);
K
Kevin Liu 已提交
2692 2693 2694 2695 2696 2697
		if (ret)
			return ret;
	} else {
		sdhci_disable_irq_wakeups(host);
		disable_irq_wake(host->irq);
	}
2698

2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709
	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;
		sdhci_do_set_ios(host, &host->mmc->ios);
	} else {
		sdhci_init(host, (host->mmc->pm_flags & MMC_PM_KEEP_POWER));
		mmiowb();
	}
2710

2711 2712
	sdhci_enable_card_detection(host);

2713
	/* Set the re-tuning expiration flag */
2714
	if (host->flags & SDHCI_USING_RETUNING_TIMER)
2715 2716
		host->flags |= SDHCI_NEEDS_RETUNING;

2717
	return ret;
2718 2719
}

2720
EXPORT_SYMBOL_GPL(sdhci_resume_host);
2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732

static int sdhci_runtime_pm_get(struct sdhci_host *host)
{
	return pm_runtime_get_sync(host->mmc->parent);
}

static int sdhci_runtime_pm_put(struct sdhci_host *host)
{
	pm_runtime_mark_last_busy(host->mmc->parent);
	return pm_runtime_put_autosuspend(host->mmc->parent);
}

2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747 2748
static void sdhci_runtime_pm_bus_on(struct sdhci_host *host)
{
	if (host->runtime_suspended || 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->runtime_suspended || !host->bus_on)
		return;
	host->bus_on = false;
	pm_runtime_put_noidle(host->mmc->parent);
}

2749 2750 2751 2752 2753
int sdhci_runtime_suspend_host(struct sdhci_host *host)
{
	unsigned long flags;

	/* Disable tuning since we are suspending */
2754
	if (host->flags & SDHCI_USING_RETUNING_TIMER) {
2755 2756 2757 2758 2759
		del_timer_sync(&host->tuning_timer);
		host->flags &= ~SDHCI_NEEDS_RETUNING;
	}

	spin_lock_irqsave(&host->lock, flags);
2760 2761 2762
	host->ier &= SDHCI_INT_CARD_INT;
	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
2763 2764
	spin_unlock_irqrestore(&host->lock, flags);

2765
	synchronize_hardirq(host->irq);
2766 2767 2768 2769 2770

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

2771
	return 0;
2772 2773 2774 2775 2776 2777
}
EXPORT_SYMBOL_GPL(sdhci_runtime_suspend_host);

int sdhci_runtime_resume_host(struct sdhci_host *host)
{
	unsigned long flags;
2778
	int host_flags = host->flags;
2779 2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790 2791 2792

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

	sdhci_init(host, 0);

	/* Force clock and power re-program */
	host->pwr = 0;
	host->clock = 0;
	sdhci_do_set_ios(host, &host->mmc->ios);

	sdhci_do_start_signal_voltage_switch(host, &host->mmc->ios);
2793 2794 2795 2796 2797 2798
	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);
	}
2799 2800

	/* Set the re-tuning expiration flag */
2801
	if (host->flags & SDHCI_USING_RETUNING_TIMER)
2802 2803 2804 2805 2806 2807 2808
		host->flags |= SDHCI_NEEDS_RETUNING;

	spin_lock_irqsave(&host->lock, flags);

	host->runtime_suspended = false;

	/* Enable SDIO IRQ */
2809
	if (host->flags & SDHCI_SDIO_IRQ_ENABLED)
2810 2811 2812 2813 2814 2815 2816
		sdhci_enable_sdio_irq_nolock(host, true);

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

	spin_unlock_irqrestore(&host->lock, flags);

2817
	return 0;
2818 2819 2820
}
EXPORT_SYMBOL_GPL(sdhci_runtime_resume_host);

2821
#endif /* CONFIG_PM */
2822

2823 2824
/*****************************************************************************\
 *                                                                           *
2825
 * Device allocation/registration                                            *
2826 2827 2828
 *                                                                           *
\*****************************************************************************/

2829 2830
struct sdhci_host *sdhci_alloc_host(struct device *dev,
	size_t priv_size)
2831 2832 2833 2834
{
	struct mmc_host *mmc;
	struct sdhci_host *host;

2835
	WARN_ON(dev == NULL);
2836

2837
	mmc = mmc_alloc_host(sizeof(struct sdhci_host) + priv_size, dev);
2838
	if (!mmc)
2839
		return ERR_PTR(-ENOMEM);
2840 2841 2842 2843

	host = mmc_priv(mmc);
	host->mmc = mmc;

2844 2845
	return host;
}
2846

2847
EXPORT_SYMBOL_GPL(sdhci_alloc_host);
2848

2849 2850 2851
int sdhci_add_host(struct sdhci_host *host)
{
	struct mmc_host *mmc;
2852
	u32 caps[2] = {0, 0};
2853 2854
	u32 max_current_caps;
	unsigned int ocr_avail;
2855
	unsigned int override_timeout_clk;
2856
	int ret;
2857

2858 2859 2860
	WARN_ON(host == NULL);
	if (host == NULL)
		return -EINVAL;
2861

2862
	mmc = host->mmc;
2863

2864 2865
	if (debug_quirks)
		host->quirks = debug_quirks;
2866 2867
	if (debug_quirks2)
		host->quirks2 = debug_quirks2;
2868

2869 2870
	override_timeout_clk = host->timeout_clk;

2871
	sdhci_do_reset(host, SDHCI_RESET_ALL);
2872

2873
	host->version = sdhci_readw(host, SDHCI_HOST_VERSION);
2874 2875
	host->version = (host->version & SDHCI_SPEC_VER_MASK)
				>> SDHCI_SPEC_VER_SHIFT;
2876
	if (host->version > SDHCI_SPEC_300) {
2877
		pr_err("%s: Unknown controller version (%d). "
2878
			"You may experience problems.\n", mmc_hostname(mmc),
2879
			host->version);
2880 2881
	}

2882
	caps[0] = (host->quirks & SDHCI_QUIRK_MISSING_CAPS) ? host->caps :
2883
		sdhci_readl(host, SDHCI_CAPABILITIES);
2884

2885 2886 2887 2888
	if (host->version >= SDHCI_SPEC_300)
		caps[1] = (host->quirks & SDHCI_QUIRK_MISSING_CAPS) ?
			host->caps1 :
			sdhci_readl(host, SDHCI_CAPABILITIES_1);
2889

2890
	if (host->quirks & SDHCI_QUIRK_FORCE_DMA)
2891
		host->flags |= SDHCI_USE_SDMA;
2892
	else if (!(caps[0] & SDHCI_CAN_DO_SDMA))
2893
		DBG("Controller doesn't have SDMA capability\n");
2894
	else
2895
		host->flags |= SDHCI_USE_SDMA;
2896

2897
	if ((host->quirks & SDHCI_QUIRK_BROKEN_DMA) &&
2898
		(host->flags & SDHCI_USE_SDMA)) {
R
Rolf Eike Beer 已提交
2899
		DBG("Disabling DMA as it is marked broken\n");
2900
		host->flags &= ~SDHCI_USE_SDMA;
2901 2902
	}

2903 2904
	if ((host->version >= SDHCI_SPEC_200) &&
		(caps[0] & SDHCI_CAN_DO_ADMA2))
2905
		host->flags |= SDHCI_USE_ADMA;
2906 2907 2908 2909 2910 2911 2912

	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;
	}

2913 2914 2915 2916 2917 2918 2919 2920 2921 2922
	/*
	 * 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.
	 */
	if (sdhci_readl(host, SDHCI_CAPABILITIES) & SDHCI_CAN_64BIT)
		host->flags |= SDHCI_USE_64_BIT_DMA;

2923
	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
2924 2925
		if (host->ops->enable_dma) {
			if (host->ops->enable_dma(host)) {
J
Joe Perches 已提交
2926
				pr_warn("%s: No suitable DMA available - falling back to PIO\n",
2927
					mmc_hostname(mmc));
2928 2929
				host->flags &=
					~(SDHCI_USE_SDMA | SDHCI_USE_ADMA);
2930
			}
2931 2932 2933
		}
	}

2934 2935 2936 2937
	/* SDMA does not support 64-bit DMA */
	if (host->flags & SDHCI_USE_64_BIT_DMA)
		host->flags &= ~SDHCI_USE_SDMA;

2938 2939
	if (host->flags & SDHCI_USE_ADMA) {
		/*
2940 2941 2942 2943
		 * 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.
2944
		 */
2945 2946 2947 2948 2949 2950 2951 2952 2953 2954 2955 2956 2957 2958 2959 2960 2961
		if (host->flags & SDHCI_USE_64_BIT_DMA) {
			host->adma_table_sz = (SDHCI_MAX_SEGS * 2 + 1) *
					      SDHCI_ADMA2_64_DESC_SZ;
			host->align_buffer_sz = SDHCI_MAX_SEGS *
						SDHCI_ADMA2_64_ALIGN;
			host->desc_sz = SDHCI_ADMA2_64_DESC_SZ;
			host->align_sz = SDHCI_ADMA2_64_ALIGN;
			host->align_mask = SDHCI_ADMA2_64_ALIGN - 1;
		} else {
			host->adma_table_sz = (SDHCI_MAX_SEGS * 2 + 1) *
					      SDHCI_ADMA2_32_DESC_SZ;
			host->align_buffer_sz = SDHCI_MAX_SEGS *
						SDHCI_ADMA2_32_ALIGN;
			host->desc_sz = SDHCI_ADMA2_32_DESC_SZ;
			host->align_sz = SDHCI_ADMA2_32_ALIGN;
			host->align_mask = SDHCI_ADMA2_32_ALIGN - 1;
		}
2962
		host->adma_table = dma_alloc_coherent(mmc_dev(mmc),
2963
						      host->adma_table_sz,
2964 2965
						      &host->adma_addr,
						      GFP_KERNEL);
2966
		host->align_buffer = kmalloc(host->align_buffer_sz, GFP_KERNEL);
2967
		if (!host->adma_table || !host->align_buffer) {
2968
			dma_free_coherent(mmc_dev(mmc), host->adma_table_sz,
2969
					  host->adma_table, host->adma_addr);
2970
			kfree(host->align_buffer);
J
Joe Perches 已提交
2971
			pr_warn("%s: Unable to allocate ADMA buffers - falling back to standard DMA\n",
2972 2973
				mmc_hostname(mmc));
			host->flags &= ~SDHCI_USE_ADMA;
2974
			host->adma_table = NULL;
2975
			host->align_buffer = NULL;
2976
		} else if (host->adma_addr & host->align_mask) {
J
Joe Perches 已提交
2977 2978
			pr_warn("%s: unable to allocate aligned ADMA descriptor\n",
				mmc_hostname(mmc));
2979
			host->flags &= ~SDHCI_USE_ADMA;
2980
			dma_free_coherent(mmc_dev(mmc), host->adma_table_sz,
2981
					  host->adma_table, host->adma_addr);
2982
			kfree(host->align_buffer);
2983
			host->adma_table = NULL;
2984
			host->align_buffer = NULL;
2985 2986 2987
		}
	}

2988 2989 2990 2991 2992
	/*
	 * 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.
	 */
2993
	if (!(host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA))) {
2994
		host->dma_mask = DMA_BIT_MASK(64);
2995
		mmc_dev(mmc)->dma_mask = &host->dma_mask;
2996
	}
2997

2998
	if (host->version >= SDHCI_SPEC_300)
2999
		host->max_clk = (caps[0] & SDHCI_CLOCK_V3_BASE_MASK)
3000 3001
			>> SDHCI_CLOCK_BASE_SHIFT;
	else
3002
		host->max_clk = (caps[0] & SDHCI_CLOCK_BASE_MASK)
3003 3004
			>> SDHCI_CLOCK_BASE_SHIFT;

3005
	host->max_clk *= 1000000;
3006 3007
	if (host->max_clk == 0 || host->quirks &
			SDHCI_QUIRK_CAP_CLOCK_BASE_BROKEN) {
3008
		if (!host->ops->get_max_clock) {
3009
			pr_err("%s: Hardware doesn't specify base clock "
3010 3011 3012 3013
			       "frequency.\n", mmc_hostname(mmc));
			return -ENODEV;
		}
		host->max_clk = host->ops->get_max_clock(host);
3014
	}
3015

3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026 3027 3028 3029 3030 3031
	/*
	 * In case of Host Controller v3.00, find out whether clock
	 * multiplier is supported.
	 */
	host->clk_mul = (caps[1] & SDHCI_CLOCK_MUL_MASK) >>
			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;

3032 3033 3034 3035
	/*
	 * Set host parameters.
	 */
	mmc->ops = &sdhci_ops;
3036
	mmc->f_max = host->max_clk;
3037
	if (host->ops->get_min_clock)
3038
		mmc->f_min = host->ops->get_min_clock(host);
3039 3040 3041 3042 3043 3044 3045
	else if (host->version >= SDHCI_SPEC_300) {
		if (host->clk_mul) {
			mmc->f_min = (host->max_clk * host->clk_mul) / 1024;
			mmc->f_max = host->max_clk * host->clk_mul;
		} else
			mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_300;
	} else
3046
		mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_200;
3047

3048 3049 3050 3051 3052 3053 3054 3055 3056 3057 3058 3059
	if (!(host->quirks & SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK)) {
		host->timeout_clk = (caps[0] & SDHCI_TIMEOUT_CLK_MASK) >>
					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));
				return -ENODEV;
			}
3060 3061
		}

3062 3063
		if (caps[0] & SDHCI_TIMEOUT_CLK_UNIT)
			host->timeout_clk *= 1000;
3064

3065
		mmc->max_busy_timeout = host->ops->get_max_timeout_count ?
3066
			host->ops->get_max_timeout_count(host) : 1 << 27;
3067 3068
		mmc->max_busy_timeout /= host->timeout_clk;
	}
3069

3070 3071 3072
	if (override_timeout_clk)
		host->timeout_clk = override_timeout_clk;

3073
	mmc->caps |= MMC_CAP_SDIO_IRQ | MMC_CAP_ERASE | MMC_CAP_CMD23;
3074
	mmc->caps2 |= MMC_CAP2_SDIO_IRQ_NOTHREAD;
3075 3076 3077

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

3079
	/* Auto-CMD23 stuff only works in ADMA or PIO. */
A
Andrei Warkentin 已提交
3080
	if ((host->version >= SDHCI_SPEC_300) &&
3081
	    ((host->flags & SDHCI_USE_ADMA) ||
A
Andrei Warkentin 已提交
3082
	     !(host->flags & SDHCI_USE_SDMA))) {
3083 3084 3085 3086 3087 3088
		host->flags |= SDHCI_AUTO_CMD23;
		DBG("%s: Auto-CMD23 available\n", mmc_hostname(mmc));
	} else {
		DBG("%s: Auto-CMD23 unavailable\n", mmc_hostname(mmc));
	}

3089 3090 3091 3092 3093 3094 3095
	/*
	 * 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.
	 */
3096
	if (!(host->quirks & SDHCI_QUIRK_FORCE_1_BIT_DATA))
3097
		mmc->caps |= MMC_CAP_4_BIT_DATA;
3098

3099 3100 3101
	if (host->quirks2 & SDHCI_QUIRK2_HOST_NO_CMD23)
		mmc->caps &= ~MMC_CAP_CMD23;

3102
	if (caps[0] & SDHCI_CAN_DO_HISPD)
3103
		mmc->caps |= MMC_CAP_SD_HIGHSPEED | MMC_CAP_MMC_HIGHSPEED;
3104

3105
	if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) &&
3106
	    !(mmc->caps & MMC_CAP_NONREMOVABLE))
3107 3108
		mmc->caps |= MMC_CAP_NEEDS_POLL;

3109 3110 3111 3112
	/* If there are external regulators, get them */
	if (mmc_regulator_get_supply(mmc) == -EPROBE_DEFER)
		return -EPROBE_DEFER;

3113
	/* If vqmmc regulator and no 1.8V signalling, then there's no UHS */
3114 3115 3116 3117
	if (!IS_ERR(mmc->supply.vqmmc)) {
		ret = regulator_enable(mmc->supply.vqmmc);
		if (!regulator_is_supported_voltage(mmc->supply.vqmmc, 1700000,
						    1950000))
3118 3119 3120
			caps[1] &= ~(SDHCI_SUPPORT_SDR104 |
					SDHCI_SUPPORT_SDR50 |
					SDHCI_SUPPORT_DDR50);
3121 3122 3123
		if (ret) {
			pr_warn("%s: Failed to enable vqmmc regulator: %d\n",
				mmc_hostname(mmc), ret);
3124
			mmc->supply.vqmmc = ERR_PTR(-EINVAL);
3125
		}
3126
	}
3127

3128 3129 3130 3131
	if (host->quirks2 & SDHCI_QUIRK2_NO_1_8_V)
		caps[1] &= ~(SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
		       SDHCI_SUPPORT_DDR50);

3132 3133 3134
	/* Any UHS-I mode in caps implies SDR12 and SDR25 support. */
	if (caps[1] & (SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
		       SDHCI_SUPPORT_DDR50))
3135 3136 3137
		mmc->caps |= MMC_CAP_UHS_SDR12 | MMC_CAP_UHS_SDR25;

	/* SDR104 supports also implies SDR50 support */
3138
	if (caps[1] & SDHCI_SUPPORT_SDR104) {
3139
		mmc->caps |= MMC_CAP_UHS_SDR104 | MMC_CAP_UHS_SDR50;
3140 3141 3142
		/* SD3.0: SDR104 is supported so (for eMMC) the caps2
		 * field can be promoted to support HS200.
		 */
3143
		if (!(host->quirks2 & SDHCI_QUIRK2_BROKEN_HS200))
3144
			mmc->caps2 |= MMC_CAP2_HS200;
3145
	} else if (caps[1] & SDHCI_SUPPORT_SDR50)
3146 3147
		mmc->caps |= MMC_CAP_UHS_SDR50;

3148 3149 3150 3151
	if (host->quirks2 & SDHCI_QUIRK2_CAPS_BIT63_FOR_HS400 &&
	    (caps[1] & SDHCI_SUPPORT_HS400))
		mmc->caps2 |= MMC_CAP2_HS400;

3152 3153 3154 3155 3156 3157
	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;

3158 3159
	if ((caps[1] & SDHCI_SUPPORT_DDR50) &&
		!(host->quirks2 & SDHCI_QUIRK2_BROKEN_DDR50))
3160 3161
		mmc->caps |= MMC_CAP_UHS_DDR50;

3162
	/* Does the host need tuning for SDR50? */
3163 3164 3165
	if (caps[1] & SDHCI_USE_SDR50_TUNING)
		host->flags |= SDHCI_SDR50_NEEDS_TUNING;

3166
	/* Does the host need tuning for SDR104 / HS200? */
3167
	if (mmc->caps2 & MMC_CAP2_HS200)
3168
		host->flags |= SDHCI_SDR104_NEEDS_TUNING;
3169

3170 3171 3172 3173 3174 3175 3176 3177
	/* Driver Type(s) (A, C, D) supported by the host */
	if (caps[1] & SDHCI_DRIVER_TYPE_A)
		mmc->caps |= MMC_CAP_DRIVER_TYPE_A;
	if (caps[1] & SDHCI_DRIVER_TYPE_C)
		mmc->caps |= MMC_CAP_DRIVER_TYPE_C;
	if (caps[1] & SDHCI_DRIVER_TYPE_D)
		mmc->caps |= MMC_CAP_DRIVER_TYPE_D;

3178 3179 3180 3181 3182 3183 3184 3185 3186 3187 3188 3189 3190 3191 3192
	/* Initial value for re-tuning timer count */
	host->tuning_count = (caps[1] & SDHCI_RETUNING_TIMER_COUNT_MASK) >>
			      SDHCI_RETUNING_TIMER_COUNT_SHIFT;

	/*
	 * 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 */
	host->tuning_mode = (caps[1] & SDHCI_RETUNING_MODE_MASK) >>
			     SDHCI_RETUNING_MODE_SHIFT;

3193
	ocr_avail = 0;
3194

3195 3196 3197 3198 3199 3200 3201 3202
	/*
	 * 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);
3203
	if (!max_current_caps && !IS_ERR(mmc->supply.vmmc)) {
3204
		int curr = regulator_get_current_limit(mmc->supply.vmmc);
3205 3206 3207 3208 3209 3210 3211 3212 3213 3214 3215 3216 3217
		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);
		}
	}
3218 3219

	if (caps[0] & SDHCI_CAN_VDD_330) {
3220
		ocr_avail |= MMC_VDD_32_33 | MMC_VDD_33_34;
3221

A
Aaron Lu 已提交
3222
		mmc->max_current_330 = ((max_current_caps &
3223 3224 3225 3226 3227
				   SDHCI_MAX_CURRENT_330_MASK) >>
				   SDHCI_MAX_CURRENT_330_SHIFT) *
				   SDHCI_MAX_CURRENT_MULTIPLIER;
	}
	if (caps[0] & SDHCI_CAN_VDD_300) {
3228
		ocr_avail |= MMC_VDD_29_30 | MMC_VDD_30_31;
3229

A
Aaron Lu 已提交
3230
		mmc->max_current_300 = ((max_current_caps &
3231 3232 3233 3234 3235
				   SDHCI_MAX_CURRENT_300_MASK) >>
				   SDHCI_MAX_CURRENT_300_SHIFT) *
				   SDHCI_MAX_CURRENT_MULTIPLIER;
	}
	if (caps[0] & SDHCI_CAN_VDD_180) {
3236 3237
		ocr_avail |= MMC_VDD_165_195;

A
Aaron Lu 已提交
3238
		mmc->max_current_180 = ((max_current_caps &
3239 3240 3241 3242 3243
				   SDHCI_MAX_CURRENT_180_MASK) >>
				   SDHCI_MAX_CURRENT_180_SHIFT) *
				   SDHCI_MAX_CURRENT_MULTIPLIER;
	}

3244
	/* If OCR set by external regulators, use it instead */
3245
	if (mmc->ocr_avail)
3246
		ocr_avail = mmc->ocr_avail;
3247

3248
	if (host->ocr_mask)
3249
		ocr_avail &= host->ocr_mask;
3250

3251 3252 3253 3254 3255 3256 3257 3258 3259 3260 3261 3262
	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;
3263 3264

	if (mmc->ocr_avail == 0) {
3265
		pr_err("%s: Hardware doesn't report any "
3266
			"support voltages.\n", mmc_hostname(mmc));
3267
		return -ENODEV;
3268 3269
	}

3270 3271 3272
	spin_lock_init(&host->lock);

	/*
3273 3274
	 * Maximum number of segments. Depends on if the hardware
	 * can do scatter/gather or not.
3275
	 */
3276
	if (host->flags & SDHCI_USE_ADMA)
3277
		mmc->max_segs = SDHCI_MAX_SEGS;
3278
	else if (host->flags & SDHCI_USE_SDMA)
3279
		mmc->max_segs = 1;
3280
	else /* PIO */
3281
		mmc->max_segs = SDHCI_MAX_SEGS;
3282 3283

	/*
3284 3285 3286
	 * 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.
3287
	 */
3288
	mmc->max_req_size = 524288;
3289 3290 3291

	/*
	 * Maximum segment size. Could be one segment with the maximum number
3292 3293
	 * of bytes. When doing hardware scatter/gather, each entry cannot
	 * be larger than 64 KiB though.
3294
	 */
3295 3296 3297 3298 3299 3300
	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 {
3301
		mmc->max_seg_size = mmc->max_req_size;
3302
	}
3303

3304 3305 3306 3307
	/*
	 * Maximum block size. This varies from controller to controller and
	 * is specified in the capabilities register.
	 */
3308 3309 3310
	if (host->quirks & SDHCI_QUIRK_FORCE_BLK_SZ_2048) {
		mmc->max_blk_size = 2;
	} else {
3311
		mmc->max_blk_size = (caps[0] & SDHCI_MAX_BLOCK_MASK) >>
3312 3313
				SDHCI_MAX_BLOCK_SHIFT;
		if (mmc->max_blk_size >= 3) {
J
Joe Perches 已提交
3314 3315
			pr_warn("%s: Invalid maximum block size, assuming 512 bytes\n",
				mmc_hostname(mmc));
3316 3317 3318 3319 3320
			mmc->max_blk_size = 0;
		}
	}

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

3322 3323 3324
	/*
	 * Maximum block count.
	 */
3325
	mmc->max_blk_count = (host->quirks & SDHCI_QUIRK_NO_MULTIBLOCK) ? 1 : 65535;
3326

3327 3328 3329 3330 3331 3332
	/*
	 * Init tasklets.
	 */
	tasklet_init(&host->finish_tasklet,
		sdhci_tasklet_finish, (unsigned long)host);

3333
	setup_timer(&host->timer, sdhci_timeout_timer, (unsigned long)host);
3334

3335
	if (host->version >= SDHCI_SPEC_300) {
3336 3337
		init_waitqueue_head(&host->buf_ready_int);

3338 3339 3340 3341 3342 3343
		/* Initialize re-tuning timer */
		init_timer(&host->tuning_timer);
		host->tuning_timer.data = (unsigned long)host;
		host->tuning_timer.function = sdhci_tuning_timer;
	}

3344 3345
	sdhci_init(host, 0);

3346 3347
	ret = request_threaded_irq(host->irq, sdhci_irq, sdhci_thread_irq,
				   IRQF_SHARED,	mmc_hostname(mmc), host);
3348 3349 3350
	if (ret) {
		pr_err("%s: Failed to request IRQ %d: %d\n",
		       mmc_hostname(mmc), host->irq, ret);
3351
		goto untasklet;
3352
	}
3353 3354 3355 3356 3357

#ifdef CONFIG_MMC_DEBUG
	sdhci_dumpregs(host);
#endif

3358
#ifdef SDHCI_USE_LEDS_CLASS
H
Helmut Schaa 已提交
3359 3360 3361
	snprintf(host->led_name, sizeof(host->led_name),
		"%s::", mmc_hostname(mmc));
	host->led.name = host->led_name;
3362 3363 3364 3365
	host->led.brightness = LED_OFF;
	host->led.default_trigger = mmc_hostname(mmc);
	host->led.brightness_set = sdhci_led_control;

3366
	ret = led_classdev_register(mmc_dev(mmc), &host->led);
3367 3368 3369
	if (ret) {
		pr_err("%s: Failed to register LED device: %d\n",
		       mmc_hostname(mmc), ret);
3370
		goto reset;
3371
	}
3372 3373
#endif

3374 3375
	mmiowb();

3376 3377
	mmc_add_host(mmc);

3378
	pr_info("%s: SDHCI controller on %s [%s] using %s\n",
3379
		mmc_hostname(mmc), host->hw_name, dev_name(mmc_dev(mmc)),
3380 3381
		(host->flags & SDHCI_USE_ADMA) ?
		(host->flags & SDHCI_USE_64_BIT_DMA) ? "ADMA 64-bit" : "ADMA" :
3382
		(host->flags & SDHCI_USE_SDMA) ? "DMA" : "PIO");
3383

3384 3385
	sdhci_enable_card_detection(host);

3386 3387
	return 0;

3388
#ifdef SDHCI_USE_LEDS_CLASS
3389
reset:
3390
	sdhci_do_reset(host, SDHCI_RESET_ALL);
3391 3392
	sdhci_writel(host, 0, SDHCI_INT_ENABLE);
	sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
3393 3394
	free_irq(host->irq, host);
#endif
3395
untasklet:
3396 3397 3398 3399 3400
	tasklet_kill(&host->finish_tasklet);

	return ret;
}

3401
EXPORT_SYMBOL_GPL(sdhci_add_host);
3402

P
Pierre Ossman 已提交
3403
void sdhci_remove_host(struct sdhci_host *host, int dead)
3404
{
3405
	struct mmc_host *mmc = host->mmc;
P
Pierre Ossman 已提交
3406 3407 3408 3409 3410 3411 3412 3413
	unsigned long flags;

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

		host->flags |= SDHCI_DEVICE_DEAD;

		if (host->mrq) {
3414
			pr_err("%s: Controller removed during "
3415
				" transfer!\n", mmc_hostname(mmc));
P
Pierre Ossman 已提交
3416 3417 3418 3419 3420 3421 3422 3423

			host->mrq->cmd->error = -ENOMEDIUM;
			tasklet_schedule(&host->finish_tasklet);
		}

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

3424 3425
	sdhci_disable_card_detection(host);

3426
	mmc_remove_host(mmc);
3427

3428
#ifdef SDHCI_USE_LEDS_CLASS
3429 3430 3431
	led_classdev_unregister(&host->led);
#endif

P
Pierre Ossman 已提交
3432
	if (!dead)
3433
		sdhci_do_reset(host, SDHCI_RESET_ALL);
3434

3435 3436
	sdhci_writel(host, 0, SDHCI_INT_ENABLE);
	sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
3437 3438 3439 3440 3441
	free_irq(host->irq, host);

	del_timer_sync(&host->timer);

	tasklet_kill(&host->finish_tasklet);
3442

3443 3444
	if (!IS_ERR(mmc->supply.vqmmc))
		regulator_disable(mmc->supply.vqmmc);
3445

3446
	if (host->adma_table)
3447
		dma_free_coherent(mmc_dev(mmc), host->adma_table_sz,
3448
				  host->adma_table, host->adma_addr);
3449 3450
	kfree(host->align_buffer);

3451
	host->adma_table = NULL;
3452
	host->align_buffer = NULL;
3453 3454
}

3455
EXPORT_SYMBOL_GPL(sdhci_remove_host);
3456

3457
void sdhci_free_host(struct sdhci_host *host)
3458
{
3459
	mmc_free_host(host->mmc);
3460 3461
}

3462
EXPORT_SYMBOL_GPL(sdhci_free_host);
3463 3464 3465 3466 3467 3468 3469 3470 3471

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

static int __init sdhci_drv_init(void)
{
3472
	pr_info(DRIVER_NAME
3473
		": Secure Digital Host Controller Interface driver\n");
3474
	pr_info(DRIVER_NAME ": Copyright(c) Pierre Ossman\n");
3475

3476
	return 0;
3477 3478 3479 3480 3481 3482 3483 3484 3485
}

static void __exit sdhci_drv_exit(void)
{
}

module_init(sdhci_drv_init);
module_exit(sdhci_drv_exit);

3486
module_param(debug_quirks, uint, 0444);
3487
module_param(debug_quirks2, uint, 0444);
3488

3489
MODULE_AUTHOR("Pierre Ossman <pierre@ossman.eu>");
3490
MODULE_DESCRIPTION("Secure Digital Host Controller Interface core driver");
3491
MODULE_LICENSE("GPL");
3492

3493
MODULE_PARM_DESC(debug_quirks, "Force certain quirks.");
3494
MODULE_PARM_DESC(debug_quirks2, "Force certain other quirks.");