Linux Audio

Check our new training course

Loading...
v4.6
   1/*
   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 * it under the terms of the GNU General Public License as published by
   8 * the Free Software Foundation; either version 2 of the License, or (at
   9 * your option) any later version.
  10 *
  11 * Thanks to the following companies for their support:
  12 *
  13 *     - JMicron (hardware and technical support)
  14 */
  15
  16#include <linux/delay.h>
  17#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>
  23#include <linux/regulator/consumer.h>
  24#include <linux/pm_runtime.h>
  25
  26#include <linux/leds.h>
  27
  28#include <linux/mmc/mmc.h>
  29#include <linux/mmc/host.h>
  30#include <linux/mmc/card.h>
  31#include <linux/mmc/sdio.h>
  32#include <linux/mmc/slot-gpio.h>
  33
  34#include "sdhci.h"
  35
  36#define DRIVER_NAME "sdhci"
  37
  38#define DBG(f, x...) \
  39	pr_debug(DRIVER_NAME " [%s()]: " f, __func__,## x)
  40
  41#if defined(CONFIG_LEDS_CLASS) || (defined(CONFIG_LEDS_CLASS_MODULE) && \
  42	defined(CONFIG_MMC_SDHCI_MODULE))
  43#define SDHCI_USE_LEDS_CLASS
  44#endif
  45
  46#define MAX_TUNING_LOOP 40
  47
  48static unsigned int debug_quirks = 0;
  49static unsigned int debug_quirks2;
  50
  51static void sdhci_finish_data(struct sdhci_host *);
  52
  53static void sdhci_finish_command(struct sdhci_host *);
  54static int sdhci_execute_tuning(struct mmc_host *mmc, u32 opcode);
 
  55static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable);
  56static int sdhci_do_get_cd(struct sdhci_host *host);
  57
  58#ifdef CONFIG_PM
  59static int sdhci_runtime_pm_get(struct sdhci_host *host);
  60static int sdhci_runtime_pm_put(struct sdhci_host *host);
  61static void sdhci_runtime_pm_bus_on(struct sdhci_host *host);
  62static void sdhci_runtime_pm_bus_off(struct sdhci_host *host);
  63#else
  64static inline int sdhci_runtime_pm_get(struct sdhci_host *host)
  65{
  66	return 0;
  67}
  68static inline int sdhci_runtime_pm_put(struct sdhci_host *host)
  69{
  70	return 0;
  71}
  72static void sdhci_runtime_pm_bus_on(struct sdhci_host *host)
  73{
  74}
  75static void sdhci_runtime_pm_bus_off(struct sdhci_host *host)
  76{
  77}
  78#endif
  79
  80static void sdhci_dumpregs(struct sdhci_host *host)
  81{
  82	pr_debug(DRIVER_NAME ": =========== REGISTER DUMP (%s)===========\n",
  83		mmc_hostname(host->mmc));
  84
  85	pr_debug(DRIVER_NAME ": Sys addr: 0x%08x | Version:  0x%08x\n",
  86		sdhci_readl(host, SDHCI_DMA_ADDRESS),
  87		sdhci_readw(host, SDHCI_HOST_VERSION));
  88	pr_debug(DRIVER_NAME ": Blk size: 0x%08x | Blk cnt:  0x%08x\n",
  89		sdhci_readw(host, SDHCI_BLOCK_SIZE),
  90		sdhci_readw(host, SDHCI_BLOCK_COUNT));
  91	pr_debug(DRIVER_NAME ": Argument: 0x%08x | Trn mode: 0x%08x\n",
  92		sdhci_readl(host, SDHCI_ARGUMENT),
  93		sdhci_readw(host, SDHCI_TRANSFER_MODE));
  94	pr_debug(DRIVER_NAME ": Present:  0x%08x | Host ctl: 0x%08x\n",
  95		sdhci_readl(host, SDHCI_PRESENT_STATE),
  96		sdhci_readb(host, SDHCI_HOST_CONTROL));
  97	pr_debug(DRIVER_NAME ": Power:    0x%08x | Blk gap:  0x%08x\n",
  98		sdhci_readb(host, SDHCI_POWER_CONTROL),
  99		sdhci_readb(host, SDHCI_BLOCK_GAP_CONTROL));
 100	pr_debug(DRIVER_NAME ": Wake-up:  0x%08x | Clock:    0x%08x\n",
 101		sdhci_readb(host, SDHCI_WAKE_UP_CONTROL),
 102		sdhci_readw(host, SDHCI_CLOCK_CONTROL));
 103	pr_debug(DRIVER_NAME ": Timeout:  0x%08x | Int stat: 0x%08x\n",
 104		sdhci_readb(host, SDHCI_TIMEOUT_CONTROL),
 105		sdhci_readl(host, SDHCI_INT_STATUS));
 106	pr_debug(DRIVER_NAME ": Int enab: 0x%08x | Sig enab: 0x%08x\n",
 107		sdhci_readl(host, SDHCI_INT_ENABLE),
 108		sdhci_readl(host, SDHCI_SIGNAL_ENABLE));
 109	pr_debug(DRIVER_NAME ": AC12 err: 0x%08x | Slot int: 0x%08x\n",
 110		sdhci_readw(host, SDHCI_ACMD12_ERR),
 111		sdhci_readw(host, SDHCI_SLOT_INT_STATUS));
 112	pr_debug(DRIVER_NAME ": Caps:     0x%08x | Caps_1:   0x%08x\n",
 113		sdhci_readl(host, SDHCI_CAPABILITIES),
 114		sdhci_readl(host, SDHCI_CAPABILITIES_1));
 115	pr_debug(DRIVER_NAME ": Cmd:      0x%08x | Max curr: 0x%08x\n",
 116		sdhci_readw(host, SDHCI_COMMAND),
 117		sdhci_readl(host, SDHCI_MAX_CURRENT));
 118	pr_debug(DRIVER_NAME ": Host ctl2: 0x%08x\n",
 119		sdhci_readw(host, SDHCI_HOST_CONTROL2));
 120
 121	if (host->flags & SDHCI_USE_ADMA) {
 122		if (host->flags & SDHCI_USE_64_BIT_DMA)
 123			pr_debug(DRIVER_NAME ": ADMA Err: 0x%08x | ADMA Ptr: 0x%08x%08x\n",
 124				 readl(host->ioaddr + SDHCI_ADMA_ERROR),
 125				 readl(host->ioaddr + SDHCI_ADMA_ADDRESS_HI),
 126				 readl(host->ioaddr + SDHCI_ADMA_ADDRESS));
 127		else
 128			pr_debug(DRIVER_NAME ": ADMA Err: 0x%08x | ADMA Ptr: 0x%08x\n",
 129				 readl(host->ioaddr + SDHCI_ADMA_ERROR),
 130				 readl(host->ioaddr + SDHCI_ADMA_ADDRESS));
 131	}
 132
 133	pr_debug(DRIVER_NAME ": ===========================================\n");
 134}
 135
 136/*****************************************************************************\
 137 *                                                                           *
 138 * Low level functions                                                       *
 139 *                                                                           *
 140\*****************************************************************************/
 141
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 142static void sdhci_set_card_detection(struct sdhci_host *host, bool enable)
 143{
 144	u32 present;
 145
 146	if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) ||
 147	    (host->mmc->caps & MMC_CAP_NONREMOVABLE))
 148		return;
 149
 150	if (enable) {
 151		present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
 152				      SDHCI_CARD_PRESENT;
 153
 154		host->ier |= present ? SDHCI_INT_CARD_REMOVE :
 155				       SDHCI_INT_CARD_INSERT;
 156	} else {
 157		host->ier &= ~(SDHCI_INT_CARD_REMOVE | SDHCI_INT_CARD_INSERT);
 158	}
 159
 160	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
 161	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
 162}
 163
 164static void sdhci_enable_card_detection(struct sdhci_host *host)
 165{
 166	sdhci_set_card_detection(host, true);
 167}
 168
 169static void sdhci_disable_card_detection(struct sdhci_host *host)
 170{
 171	sdhci_set_card_detection(host, false);
 172}
 173
 174void sdhci_reset(struct sdhci_host *host, u8 mask)
 175{
 176	unsigned long timeout;
 
 
 
 
 
 
 
 
 
 
 
 
 
 177
 178	sdhci_writeb(host, mask, SDHCI_SOFTWARE_RESET);
 179
 180	if (mask & SDHCI_RESET_ALL) {
 181		host->clock = 0;
 182		/* Reset-all turns off SD Bus Power */
 183		if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
 184			sdhci_runtime_pm_bus_off(host);
 185	}
 186
 187	/* Wait max 100 ms */
 188	timeout = 100;
 189
 190	/* hw clears the bit when it's done */
 191	while (sdhci_readb(host, SDHCI_SOFTWARE_RESET) & mask) {
 192		if (timeout == 0) {
 193			pr_err("%s: Reset 0x%x never completed.\n",
 194				mmc_hostname(host->mmc), (int)mask);
 195			sdhci_dumpregs(host);
 196			return;
 197		}
 198		timeout--;
 199		mdelay(1);
 200	}
 201}
 202EXPORT_SYMBOL_GPL(sdhci_reset);
 203
 204static void sdhci_do_reset(struct sdhci_host *host, u8 mask)
 205{
 206	if (host->quirks & SDHCI_QUIRK_NO_CARD_NO_RESET) {
 207		if (!sdhci_do_get_cd(host))
 208			return;
 209	}
 210
 211	host->ops->reset(host, mask);
 
 212
 213	if (mask & SDHCI_RESET_ALL) {
 214		if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
 215			if (host->ops->enable_dma)
 216				host->ops->enable_dma(host);
 217		}
 218
 219		/* Resetting the controller clears many */
 220		host->preset_enabled = false;
 
 221	}
 222}
 223
 224static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios);
 225
 226static 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	host->ier = SDHCI_INT_BUS_POWER | SDHCI_INT_DATA_END_BIT |
 234		    SDHCI_INT_DATA_CRC | SDHCI_INT_DATA_TIMEOUT |
 235		    SDHCI_INT_INDEX | SDHCI_INT_END_BIT | SDHCI_INT_CRC |
 236		    SDHCI_INT_TIMEOUT | SDHCI_INT_DATA_END |
 237		    SDHCI_INT_RESPONSE;
 238
 239	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
 240	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
 
 
 
 241
 242	if (soft) {
 243		/* force clock reconfiguration */
 244		host->clock = 0;
 245		sdhci_set_ios(host->mmc, &host->mmc->ios);
 246	}
 247}
 248
 249static void sdhci_reinit(struct sdhci_host *host)
 250{
 251	sdhci_init(host, 0);
 
 
 
 
 
 
 
 
 
 
 
 
 
 252	sdhci_enable_card_detection(host);
 253}
 254
 255static void sdhci_activate_led(struct sdhci_host *host)
 256{
 257	u8 ctrl;
 258
 259	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
 260	ctrl |= SDHCI_CTRL_LED;
 261	sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
 262}
 263
 264static void sdhci_deactivate_led(struct sdhci_host *host)
 265{
 266	u8 ctrl;
 267
 268	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
 269	ctrl &= ~SDHCI_CTRL_LED;
 270	sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
 271}
 272
 273#ifdef SDHCI_USE_LEDS_CLASS
 274static void sdhci_led_control(struct led_classdev *led,
 275	enum led_brightness brightness)
 276{
 277	struct sdhci_host *host = container_of(led, struct sdhci_host, led);
 278	unsigned long flags;
 279
 280	spin_lock_irqsave(&host->lock, flags);
 281
 282	if (host->runtime_suspended)
 283		goto out;
 284
 285	if (brightness == LED_OFF)
 286		sdhci_deactivate_led(host);
 287	else
 288		sdhci_activate_led(host);
 289out:
 290	spin_unlock_irqrestore(&host->lock, flags);
 291}
 292#endif
 293
 294/*****************************************************************************\
 295 *                                                                           *
 296 * Core functions                                                            *
 297 *                                                                           *
 298\*****************************************************************************/
 299
 300static void sdhci_read_block_pio(struct sdhci_host *host)
 301{
 302	unsigned long flags;
 303	size_t blksize, len, chunk;
 304	u32 uninitialized_var(scratch);
 305	u8 *buf;
 306
 307	DBG("PIO reading\n");
 308
 309	blksize = host->data->blksz;
 310	chunk = 0;
 311
 312	local_irq_save(flags);
 313
 314	while (blksize) {
 315		BUG_ON(!sg_miter_next(&host->sg_miter));
 
 316
 317		len = min(host->sg_miter.length, blksize);
 318
 319		blksize -= len;
 320		host->sg_miter.consumed = len;
 321
 322		buf = host->sg_miter.addr;
 323
 324		while (len) {
 325			if (chunk == 0) {
 326				scratch = sdhci_readl(host, SDHCI_BUFFER);
 327				chunk = 4;
 328			}
 329
 330			*buf = scratch & 0xFF;
 331
 332			buf++;
 333			scratch >>= 8;
 334			chunk--;
 335			len--;
 336		}
 337	}
 338
 339	sg_miter_stop(&host->sg_miter);
 340
 341	local_irq_restore(flags);
 342}
 343
 344static void sdhci_write_block_pio(struct sdhci_host *host)
 345{
 346	unsigned long flags;
 347	size_t blksize, len, chunk;
 348	u32 scratch;
 349	u8 *buf;
 350
 351	DBG("PIO writing\n");
 352
 353	blksize = host->data->blksz;
 354	chunk = 0;
 355	scratch = 0;
 356
 357	local_irq_save(flags);
 358
 359	while (blksize) {
 360		BUG_ON(!sg_miter_next(&host->sg_miter));
 
 361
 362		len = min(host->sg_miter.length, blksize);
 363
 364		blksize -= len;
 365		host->sg_miter.consumed = len;
 366
 367		buf = host->sg_miter.addr;
 368
 369		while (len) {
 370			scratch |= (u32)*buf << (chunk * 8);
 371
 372			buf++;
 373			chunk++;
 374			len--;
 375
 376			if ((chunk == 4) || ((len == 0) && (blksize == 0))) {
 377				sdhci_writel(host, scratch, SDHCI_BUFFER);
 378				chunk = 0;
 379				scratch = 0;
 380			}
 381		}
 382	}
 383
 384	sg_miter_stop(&host->sg_miter);
 385
 386	local_irq_restore(flags);
 387}
 388
 389static void sdhci_transfer_pio(struct sdhci_host *host)
 390{
 391	u32 mask;
 392
 393	BUG_ON(!host->data);
 394
 395	if (host->blocks == 0)
 396		return;
 397
 398	if (host->data->flags & MMC_DATA_READ)
 399		mask = SDHCI_DATA_AVAILABLE;
 400	else
 401		mask = SDHCI_SPACE_AVAILABLE;
 402
 403	/*
 404	 * Some controllers (JMicron JMB38x) mess up the buffer bits
 405	 * for transfers < 4 bytes. As long as it is just one block,
 406	 * we can ignore the bits.
 407	 */
 408	if ((host->quirks & SDHCI_QUIRK_BROKEN_SMALL_PIO) &&
 409		(host->data->blocks == 1))
 410		mask = ~0;
 411
 412	while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
 413		if (host->quirks & SDHCI_QUIRK_PIO_NEEDS_DELAY)
 414			udelay(100);
 415
 416		if (host->data->flags & MMC_DATA_READ)
 417			sdhci_read_block_pio(host);
 418		else
 419			sdhci_write_block_pio(host);
 420
 421		host->blocks--;
 422		if (host->blocks == 0)
 423			break;
 424	}
 425
 426	DBG("PIO transfer complete.\n");
 427}
 428
 429static int sdhci_pre_dma_transfer(struct sdhci_host *host,
 430				  struct mmc_data *data, int cookie)
 431{
 432	int sg_count;
 433
 434	/*
 435	 * If the data buffers are already mapped, return the previous
 436	 * dma_map_sg() result.
 437	 */
 438	if (data->host_cookie == COOKIE_PRE_MAPPED)
 439		return data->sg_count;
 440
 441	sg_count = dma_map_sg(mmc_dev(host->mmc), data->sg, data->sg_len,
 442				data->flags & MMC_DATA_WRITE ?
 443				DMA_TO_DEVICE : DMA_FROM_DEVICE);
 444
 445	if (sg_count == 0)
 446		return -ENOSPC;
 447
 448	data->sg_count = sg_count;
 449	data->host_cookie = cookie;
 450
 451	return sg_count;
 452}
 453
 454static char *sdhci_kmap_atomic(struct scatterlist *sg, unsigned long *flags)
 455{
 456	local_irq_save(*flags);
 457	return kmap_atomic(sg_page(sg)) + sg->offset;
 458}
 459
 460static void sdhci_kunmap_atomic(void *buffer, unsigned long *flags)
 461{
 462	kunmap_atomic(buffer);
 463	local_irq_restore(*flags);
 464}
 465
 466static void sdhci_adma_write_desc(struct sdhci_host *host, void *desc,
 467				  dma_addr_t addr, int len, unsigned cmd)
 468{
 469	struct sdhci_adma2_64_desc *dma_desc = desc;
 
 470
 471	/* 32-bit and 64-bit descriptors have these members in same position */
 472	dma_desc->cmd = cpu_to_le16(cmd);
 473	dma_desc->len = cpu_to_le16(len);
 474	dma_desc->addr_lo = cpu_to_le32((u32)addr);
 475
 476	if (host->flags & SDHCI_USE_64_BIT_DMA)
 477		dma_desc->addr_hi = cpu_to_le32((u64)addr >> 32);
 
 
 478}
 479
 480static void sdhci_adma_mark_end(void *desc)
 
 481{
 482	struct sdhci_adma2_64_desc *dma_desc = desc;
 483
 484	/* 32-bit and 64-bit descriptors have 'cmd' in same position */
 485	dma_desc->cmd |= cpu_to_le16(ADMA2_END);
 486}
 
 
 487
 488static void sdhci_adma_table_pre(struct sdhci_host *host,
 489	struct mmc_data *data, int sg_count)
 490{
 491	struct scatterlist *sg;
 492	unsigned long flags;
 493	dma_addr_t addr, align_addr;
 494	void *desc, *align;
 495	char *buffer;
 496	int len, offset, i;
 497
 498	/*
 499	 * The spec does not specify endianness of descriptor table.
 500	 * We currently guess that it is LE.
 501	 */
 502
 503	host->sg_count = sg_count;
 
 
 
 504
 505	desc = host->adma_table;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 506	align = host->align_buffer;
 507
 508	align_addr = host->align_addr;
 509
 510	for_each_sg(data->sg, sg, host->sg_count, i) {
 511		addr = sg_dma_address(sg);
 512		len = sg_dma_len(sg);
 513
 514		/*
 515		 * The SDHCI specification states that ADMA addresses must
 516		 * be 32-bit aligned. If they aren't, then we use a bounce
 517		 * buffer for the (up to three) bytes that screw up the
 
 518		 * alignment.
 519		 */
 520		offset = (SDHCI_ADMA2_ALIGN - (addr & SDHCI_ADMA2_MASK)) &
 521			 SDHCI_ADMA2_MASK;
 522		if (offset) {
 523			if (data->flags & MMC_DATA_WRITE) {
 524				buffer = sdhci_kmap_atomic(sg, &flags);
 
 525				memcpy(align, buffer, offset);
 526				sdhci_kunmap_atomic(buffer, &flags);
 527			}
 528
 529			/* tran, valid */
 530			sdhci_adma_write_desc(host, desc, align_addr, offset,
 531					      ADMA2_TRAN_VALID);
 532
 533			BUG_ON(offset > 65536);
 534
 535			align += SDHCI_ADMA2_ALIGN;
 536			align_addr += SDHCI_ADMA2_ALIGN;
 537
 538			desc += host->desc_sz;
 539
 540			addr += offset;
 541			len -= offset;
 542		}
 543
 544		BUG_ON(len > 65536);
 545
 546		if (len) {
 547			/* tran, valid */
 548			sdhci_adma_write_desc(host, desc, addr, len,
 549					      ADMA2_TRAN_VALID);
 550			desc += host->desc_sz;
 551		}
 552
 553		/*
 554		 * If this triggers then we have a calculation bug
 555		 * somewhere. :/
 556		 */
 557		WARN_ON((desc - host->adma_table) >= host->adma_table_sz);
 558	}
 559
 560	if (host->quirks & SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC) {
 561		/* Mark the last descriptor as the terminating descriptor */
 562		if (desc != host->adma_table) {
 563			desc -= host->desc_sz;
 564			sdhci_adma_mark_end(desc);
 
 
 565		}
 566	} else {
 567		/* Add a terminating entry - nop, end, valid */
 568		sdhci_adma_write_desc(host, desc, 0, 0, ADMA2_NOP_END_VALID);
 
 
 
 
 569	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 570}
 571
 572static void sdhci_adma_table_post(struct sdhci_host *host,
 573	struct mmc_data *data)
 574{
 
 
 575	struct scatterlist *sg;
 576	int i, size;
 577	void *align;
 578	char *buffer;
 579	unsigned long flags;
 580
 
 
 
 
 
 
 
 
 
 
 
 581	if (data->flags & MMC_DATA_READ) {
 582		bool has_unaligned = false;
 
 583
 584		/* Do a quick scan of the SG list for any unaligned mappings */
 585		for_each_sg(data->sg, sg, host->sg_count, i)
 586			if (sg_dma_address(sg) & SDHCI_ADMA2_MASK) {
 587				has_unaligned = true;
 588				break;
 589			}
 590
 591		if (has_unaligned) {
 592			dma_sync_sg_for_cpu(mmc_dev(host->mmc), data->sg,
 593					    data->sg_len, DMA_FROM_DEVICE);
 594
 595			align = host->align_buffer;
 596
 597			for_each_sg(data->sg, sg, host->sg_count, i) {
 598				if (sg_dma_address(sg) & SDHCI_ADMA2_MASK) {
 599					size = SDHCI_ADMA2_ALIGN -
 600					       (sg_dma_address(sg) & SDHCI_ADMA2_MASK);
 601
 602					buffer = sdhci_kmap_atomic(sg, &flags);
 603					memcpy(buffer, align, size);
 604					sdhci_kunmap_atomic(buffer, &flags);
 605
 606					align += SDHCI_ADMA2_ALIGN;
 607				}
 
 
 
 
 608			}
 609		}
 610	}
 
 
 
 611}
 612
 613static u8 sdhci_calc_timeout(struct sdhci_host *host, struct mmc_command *cmd)
 614{
 615	u8 count;
 616	struct mmc_data *data = cmd->data;
 617	unsigned target_timeout, current_timeout;
 618
 619	/*
 620	 * If the host controller provides us with an incorrect timeout
 621	 * value, just skip the check and use 0xE.  The hardware may take
 622	 * longer to time out, but that's much better than having a too-short
 623	 * timeout value.
 624	 */
 625	if (host->quirks & SDHCI_QUIRK_BROKEN_TIMEOUT_VAL)
 626		return 0xE;
 627
 628	/* Unspecified timeout, assume max */
 629	if (!data && !cmd->busy_timeout)
 630		return 0xE;
 631
 632	/* timeout in us */
 633	if (!data)
 634		target_timeout = cmd->busy_timeout * 1000;
 635	else {
 636		target_timeout = DIV_ROUND_UP(data->timeout_ns, 1000);
 637		if (host->clock && data->timeout_clks) {
 638			unsigned long long val;
 639
 640			/*
 641			 * data->timeout_clks is in units of clock cycles.
 642			 * host->clock is in Hz.  target_timeout is in us.
 643			 * Hence, us = 1000000 * cycles / Hz.  Round up.
 644			 */
 645			val = 1000000 * data->timeout_clks;
 646			if (do_div(val, host->clock))
 647				target_timeout++;
 648			target_timeout += val;
 649		}
 650	}
 651
 652	/*
 653	 * Figure out needed cycles.
 654	 * We do this in steps in order to fit inside a 32 bit int.
 655	 * The first step is the minimum timeout, which will have a
 656	 * minimum resolution of 6 bits:
 657	 * (1) 2^13*1000 > 2^22,
 658	 * (2) host->timeout_clk < 2^16
 659	 *     =>
 660	 *     (1) / (2) > 2^6
 661	 */
 662	count = 0;
 663	current_timeout = (1 << 13) * 1000 / host->timeout_clk;
 664	while (current_timeout < target_timeout) {
 665		count++;
 666		current_timeout <<= 1;
 667		if (count >= 0xF)
 668			break;
 669	}
 670
 671	if (count >= 0xF) {
 672		DBG("%s: Too large timeout 0x%x requested for CMD%d!\n",
 673		    mmc_hostname(host->mmc), count, cmd->opcode);
 674		count = 0xE;
 675	}
 676
 677	return count;
 678}
 679
 680static void sdhci_set_transfer_irqs(struct sdhci_host *host)
 681{
 682	u32 pio_irqs = SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL;
 683	u32 dma_irqs = SDHCI_INT_DMA_END | SDHCI_INT_ADMA_ERROR;
 684
 685	if (host->flags & SDHCI_REQ_USE_DMA)
 686		host->ier = (host->ier & ~pio_irqs) | dma_irqs;
 687	else
 688		host->ier = (host->ier & ~dma_irqs) | pio_irqs;
 689
 690	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
 691	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
 692}
 693
 694static void sdhci_set_timeout(struct sdhci_host *host, struct mmc_command *cmd)
 695{
 696	u8 count;
 697
 698	if (host->ops->set_timeout) {
 699		host->ops->set_timeout(host, cmd);
 700	} else {
 701		count = sdhci_calc_timeout(host, cmd);
 702		sdhci_writeb(host, count, SDHCI_TIMEOUT_CONTROL);
 703	}
 704}
 705
 706static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_command *cmd)
 707{
 
 708	u8 ctrl;
 709	struct mmc_data *data = cmd->data;
 
 710
 711	WARN_ON(host->data);
 712
 713	if (data || (cmd->flags & MMC_RSP_BUSY))
 714		sdhci_set_timeout(host, cmd);
 
 
 715
 716	if (!data)
 717		return;
 718
 719	/* Sanity checks */
 720	BUG_ON(data->blksz * data->blocks > 524288);
 721	BUG_ON(data->blksz > host->mmc->max_blk_size);
 722	BUG_ON(data->blocks > 65535);
 723
 724	host->data = data;
 725	host->data_early = 0;
 726	host->data->bytes_xfered = 0;
 727
 728	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
 729		struct scatterlist *sg;
 730		unsigned int length_mask, offset_mask;
 731		int i;
 732
 733		host->flags |= SDHCI_REQ_USE_DMA;
 734
 735		/*
 736		 * FIXME: This doesn't account for merging when mapping the
 737		 * scatterlist.
 738		 *
 739		 * The assumption here being that alignment and lengths are
 740		 * the same after DMA mapping to device address space.
 741		 */
 742		length_mask = 0;
 743		offset_mask = 0;
 744		if (host->flags & SDHCI_USE_ADMA) {
 745			if (host->quirks & SDHCI_QUIRK_32BIT_ADMA_SIZE) {
 746				length_mask = 3;
 747				/*
 748				 * As we use up to 3 byte chunks to work
 749				 * around alignment problems, we need to
 750				 * check the offset as well.
 751				 */
 752				offset_mask = 3;
 753			}
 754		} else {
 755			if (host->quirks & SDHCI_QUIRK_32BIT_DMA_SIZE)
 756				length_mask = 3;
 757			if (host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR)
 758				offset_mask = 3;
 759		}
 760
 761		if (unlikely(length_mask | offset_mask)) {
 762			for_each_sg(data->sg, sg, data->sg_len, i) {
 763				if (sg->length & length_mask) {
 764					DBG("Reverting to PIO because of transfer size (%d)\n",
 765					    sg->length);
 766					host->flags &= ~SDHCI_REQ_USE_DMA;
 767					break;
 768				}
 769				if (sg->offset & offset_mask) {
 770					DBG("Reverting to PIO because of bad alignment\n");
 771					host->flags &= ~SDHCI_REQ_USE_DMA;
 772					break;
 773				}
 774			}
 775		}
 776	}
 777
 
 
 
 
 778	if (host->flags & SDHCI_REQ_USE_DMA) {
 779		int sg_cnt = sdhci_pre_dma_transfer(host, data, COOKIE_MAPPED);
 
 780
 781		if (sg_cnt <= 0) {
 
 782			/*
 783			 * This only happens when someone fed
 784			 * us an invalid request.
 
 785			 */
 786			WARN_ON(1);
 787			host->flags &= ~SDHCI_REQ_USE_DMA;
 788		} else if (host->flags & SDHCI_USE_ADMA) {
 789			sdhci_adma_table_pre(host, data, sg_cnt);
 790
 791			sdhci_writel(host, host->adma_addr, SDHCI_ADMA_ADDRESS);
 792			if (host->flags & SDHCI_USE_64_BIT_DMA)
 793				sdhci_writel(host,
 794					     (u64)host->adma_addr >> 32,
 795					     SDHCI_ADMA_ADDRESS_HI);
 796		} else {
 797			WARN_ON(sg_cnt != 1);
 798			sdhci_writel(host, sg_dma_address(data->sg),
 799				SDHCI_DMA_ADDRESS);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 800		}
 801	}
 802
 803	/*
 804	 * Always adjust the DMA selection as some controllers
 805	 * (e.g. JMicron) can't do PIO properly when the selection
 806	 * is ADMA.
 807	 */
 808	if (host->version >= SDHCI_SPEC_200) {
 809		ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
 810		ctrl &= ~SDHCI_CTRL_DMA_MASK;
 811		if ((host->flags & SDHCI_REQ_USE_DMA) &&
 812			(host->flags & SDHCI_USE_ADMA)) {
 813			if (host->flags & SDHCI_USE_64_BIT_DMA)
 814				ctrl |= SDHCI_CTRL_ADMA64;
 815			else
 816				ctrl |= SDHCI_CTRL_ADMA32;
 817		} else {
 818			ctrl |= SDHCI_CTRL_SDMA;
 819		}
 820		sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
 821	}
 822
 823	if (!(host->flags & SDHCI_REQ_USE_DMA)) {
 824		int flags;
 825
 826		flags = SG_MITER_ATOMIC;
 827		if (host->data->flags & MMC_DATA_READ)
 828			flags |= SG_MITER_TO_SG;
 829		else
 830			flags |= SG_MITER_FROM_SG;
 831		sg_miter_start(&host->sg_miter, data->sg, data->sg_len, flags);
 832		host->blocks = data->blocks;
 833	}
 834
 835	sdhci_set_transfer_irqs(host);
 836
 837	/* Set the DMA boundary value and block size */
 838	sdhci_writew(host, SDHCI_MAKE_BLKSZ(SDHCI_DEFAULT_BOUNDARY_ARG,
 839		data->blksz), SDHCI_BLOCK_SIZE);
 840	sdhci_writew(host, data->blocks, SDHCI_BLOCK_COUNT);
 841}
 842
 843static void sdhci_set_transfer_mode(struct sdhci_host *host,
 844	struct mmc_command *cmd)
 845{
 846	u16 mode = 0;
 847	struct mmc_data *data = cmd->data;
 848
 849	if (data == NULL) {
 850		if (host->quirks2 &
 851			SDHCI_QUIRK2_CLEAR_TRANSFERMODE_REG_BEFORE_CMD) {
 852			sdhci_writew(host, 0x0, SDHCI_TRANSFER_MODE);
 853		} else {
 854		/* clear Auto CMD settings for no data CMDs */
 855			mode = sdhci_readw(host, SDHCI_TRANSFER_MODE);
 856			sdhci_writew(host, mode & ~(SDHCI_TRNS_AUTO_CMD12 |
 857				SDHCI_TRNS_AUTO_CMD23), SDHCI_TRANSFER_MODE);
 858		}
 859		return;
 860	}
 861
 862	WARN_ON(!host->data);
 863
 864	if (!(host->quirks2 & SDHCI_QUIRK2_SUPPORT_SINGLE))
 865		mode = SDHCI_TRNS_BLK_CNT_EN;
 866
 867	if (mmc_op_multi(cmd->opcode) || data->blocks > 1) {
 868		mode = SDHCI_TRNS_BLK_CNT_EN | SDHCI_TRNS_MULTI;
 869		/*
 870		 * If we are sending CMD23, CMD12 never gets sent
 871		 * on successful completion (so no Auto-CMD12).
 872		 */
 873		if (!host->mrq->sbc && (host->flags & SDHCI_AUTO_CMD12) &&
 874		    (cmd->opcode != SD_IO_RW_EXTENDED))
 875			mode |= SDHCI_TRNS_AUTO_CMD12;
 876		else if (host->mrq->sbc && (host->flags & SDHCI_AUTO_CMD23)) {
 877			mode |= SDHCI_TRNS_AUTO_CMD23;
 878			sdhci_writel(host, host->mrq->sbc->arg, SDHCI_ARGUMENT2);
 879		}
 880	}
 881
 882	if (data->flags & MMC_DATA_READ)
 883		mode |= SDHCI_TRNS_READ;
 884	if (host->flags & SDHCI_REQ_USE_DMA)
 885		mode |= SDHCI_TRNS_DMA;
 886
 887	sdhci_writew(host, mode, SDHCI_TRANSFER_MODE);
 888}
 889
 890static void sdhci_finish_data(struct sdhci_host *host)
 891{
 892	struct mmc_data *data;
 893
 894	BUG_ON(!host->data);
 895
 896	data = host->data;
 897	host->data = NULL;
 898
 899	if ((host->flags & (SDHCI_REQ_USE_DMA | SDHCI_USE_ADMA)) ==
 900	    (SDHCI_REQ_USE_DMA | SDHCI_USE_ADMA))
 901		sdhci_adma_table_post(host, data);
 
 
 
 
 
 
 902
 903	/*
 904	 * The specification states that the block count register must
 905	 * be updated, but it does not specify at what point in the
 906	 * data flow. That makes the register entirely useless to read
 907	 * back so we have to assume that nothing made it to the card
 908	 * in the event of an error.
 909	 */
 910	if (data->error)
 911		data->bytes_xfered = 0;
 912	else
 913		data->bytes_xfered = data->blksz * data->blocks;
 914
 915	/*
 916	 * Need to send CMD12 if -
 917	 * a) open-ended multiblock transfer (no CMD23)
 918	 * b) error in multiblock transfer
 919	 */
 920	if (data->stop &&
 921	    (data->error ||
 922	     !host->mrq->sbc)) {
 923
 924		/*
 925		 * The controller needs a reset of internal state machines
 926		 * upon error conditions.
 927		 */
 928		if (data->error) {
 929			sdhci_do_reset(host, SDHCI_RESET_CMD);
 930			sdhci_do_reset(host, SDHCI_RESET_DATA);
 931		}
 932
 933		sdhci_send_command(host, data->stop);
 934	} else
 935		tasklet_schedule(&host->finish_tasklet);
 936}
 937
 938void sdhci_send_command(struct sdhci_host *host, struct mmc_command *cmd)
 939{
 940	int flags;
 941	u32 mask;
 942	unsigned long timeout;
 943
 944	WARN_ON(host->cmd);
 945
 946	/* Initially, a command has no error */
 947	cmd->error = 0;
 948
 949	/* Wait max 10 ms */
 950	timeout = 10;
 951
 952	mask = SDHCI_CMD_INHIBIT;
 953	if ((cmd->data != NULL) || (cmd->flags & MMC_RSP_BUSY))
 954		mask |= SDHCI_DATA_INHIBIT;
 955
 956	/* We shouldn't wait for data inihibit for stop commands, even
 957	   though they might use busy signaling */
 958	if (host->mrq->data && (cmd == host->mrq->data->stop))
 959		mask &= ~SDHCI_DATA_INHIBIT;
 960
 961	while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
 962		if (timeout == 0) {
 963			pr_err("%s: Controller never released inhibit bit(s).\n",
 964			       mmc_hostname(host->mmc));
 965			sdhci_dumpregs(host);
 966			cmd->error = -EIO;
 967			tasklet_schedule(&host->finish_tasklet);
 968			return;
 969		}
 970		timeout--;
 971		mdelay(1);
 972	}
 973
 974	timeout = jiffies;
 975	if (!cmd->data && cmd->busy_timeout > 9000)
 976		timeout += DIV_ROUND_UP(cmd->busy_timeout, 1000) * HZ + HZ;
 977	else
 978		timeout += 10 * HZ;
 979	mod_timer(&host->timer, timeout);
 980
 981	host->cmd = cmd;
 982	host->busy_handle = 0;
 983
 984	sdhci_prepare_data(host, cmd);
 985
 986	sdhci_writel(host, cmd->arg, SDHCI_ARGUMENT);
 987
 988	sdhci_set_transfer_mode(host, cmd);
 989
 990	if ((cmd->flags & MMC_RSP_136) && (cmd->flags & MMC_RSP_BUSY)) {
 991		pr_err("%s: Unsupported response type!\n",
 992			mmc_hostname(host->mmc));
 993		cmd->error = -EINVAL;
 994		tasklet_schedule(&host->finish_tasklet);
 995		return;
 996	}
 997
 998	if (!(cmd->flags & MMC_RSP_PRESENT))
 999		flags = SDHCI_CMD_RESP_NONE;
1000	else if (cmd->flags & MMC_RSP_136)
1001		flags = SDHCI_CMD_RESP_LONG;
1002	else if (cmd->flags & MMC_RSP_BUSY)
1003		flags = SDHCI_CMD_RESP_SHORT_BUSY;
1004	else
1005		flags = SDHCI_CMD_RESP_SHORT;
1006
1007	if (cmd->flags & MMC_RSP_CRC)
1008		flags |= SDHCI_CMD_CRC;
1009	if (cmd->flags & MMC_RSP_OPCODE)
1010		flags |= SDHCI_CMD_INDEX;
1011
1012	/* CMD19 is special in that the Data Present Select should be set */
1013	if (cmd->data || cmd->opcode == MMC_SEND_TUNING_BLOCK ||
1014	    cmd->opcode == MMC_SEND_TUNING_BLOCK_HS200)
1015		flags |= SDHCI_CMD_DATA;
1016
1017	sdhci_writew(host, SDHCI_MAKE_CMD(cmd->opcode, flags), SDHCI_COMMAND);
1018}
1019EXPORT_SYMBOL_GPL(sdhci_send_command);
1020
1021static void sdhci_finish_command(struct sdhci_host *host)
1022{
1023	int i;
1024
1025	BUG_ON(host->cmd == NULL);
1026
1027	if (host->cmd->flags & MMC_RSP_PRESENT) {
1028		if (host->cmd->flags & MMC_RSP_136) {
1029			/* CRC is stripped so we need to do some shifting. */
1030			for (i = 0;i < 4;i++) {
1031				host->cmd->resp[i] = sdhci_readl(host,
1032					SDHCI_RESPONSE + (3-i)*4) << 8;
1033				if (i != 3)
1034					host->cmd->resp[i] |=
1035						sdhci_readb(host,
1036						SDHCI_RESPONSE + (3-i)*4-1);
1037			}
1038		} else {
1039			host->cmd->resp[0] = sdhci_readl(host, SDHCI_RESPONSE);
1040		}
1041	}
1042
 
 
1043	/* Finished CMD23, now send actual command. */
1044	if (host->cmd == host->mrq->sbc) {
1045		host->cmd = NULL;
1046		sdhci_send_command(host, host->mrq->cmd);
1047	} else {
1048
1049		/* Processed actual command. */
1050		if (host->data && host->data_early)
1051			sdhci_finish_data(host);
1052
1053		if (!host->cmd->data)
1054			tasklet_schedule(&host->finish_tasklet);
1055
1056		host->cmd = NULL;
1057	}
1058}
1059
1060static u16 sdhci_get_preset_value(struct sdhci_host *host)
1061{
1062	u16 preset = 0;
 
 
1063
1064	switch (host->timing) {
1065	case MMC_TIMING_UHS_SDR12:
1066		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR12);
1067		break;
1068	case MMC_TIMING_UHS_SDR25:
1069		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR25);
1070		break;
1071	case MMC_TIMING_UHS_SDR50:
1072		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR50);
1073		break;
1074	case MMC_TIMING_UHS_SDR104:
1075	case MMC_TIMING_MMC_HS200:
1076		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR104);
1077		break;
1078	case MMC_TIMING_UHS_DDR50:
1079	case MMC_TIMING_MMC_DDR52:
1080		preset = sdhci_readw(host, SDHCI_PRESET_FOR_DDR50);
1081		break;
1082	case MMC_TIMING_MMC_HS400:
1083		preset = sdhci_readw(host, SDHCI_PRESET_FOR_HS400);
1084		break;
1085	default:
1086		pr_warn("%s: Invalid UHS-I mode selected\n",
1087			mmc_hostname(host->mmc));
1088		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR12);
1089		break;
1090	}
1091	return preset;
1092}
1093
1094void sdhci_set_clock(struct sdhci_host *host, unsigned int clock)
1095{
1096	int div = 0; /* Initialized for compiler warning */
1097	int real_div = div, clk_mul = 1;
1098	u16 clk = 0;
1099	unsigned long timeout;
1100	bool switch_base_clk = false;
 
 
1101
1102	host->mmc->actual_clock = 0;
1103
 
 
 
 
 
 
1104	sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL);
1105	if (host->quirks2 & SDHCI_QUIRK2_NEED_DELAY_AFTER_INT_CLK_RST)
1106		mdelay(1);
1107
1108	if (clock == 0)
1109		return;
1110
1111	if (host->version >= SDHCI_SPEC_300) {
1112		if (host->preset_enabled) {
 
1113			u16 pre_val;
1114
1115			clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
1116			pre_val = sdhci_get_preset_value(host);
1117			div = (pre_val & SDHCI_PRESET_SDCLK_FREQ_MASK)
1118				>> SDHCI_PRESET_SDCLK_FREQ_SHIFT;
1119			if (host->clk_mul &&
1120				(pre_val & SDHCI_PRESET_CLKGEN_SEL_MASK)) {
1121				clk = SDHCI_PROG_CLOCK_MODE;
1122				real_div = div + 1;
1123				clk_mul = host->clk_mul;
1124			} else {
1125				real_div = max_t(int, 1, div << 1);
1126			}
1127			goto clock_set;
1128		}
1129
1130		/*
1131		 * Check if the Host Controller supports Programmable Clock
1132		 * Mode.
1133		 */
1134		if (host->clk_mul) {
1135			for (div = 1; div <= 1024; div++) {
1136				if ((host->max_clk * host->clk_mul / div)
1137					<= clock)
1138					break;
1139			}
1140			if ((host->max_clk * host->clk_mul / div) <= clock) {
1141				/*
1142				 * Set Programmable Clock Mode in the Clock
1143				 * Control register.
1144				 */
1145				clk = SDHCI_PROG_CLOCK_MODE;
1146				real_div = div;
1147				clk_mul = host->clk_mul;
1148				div--;
1149			} else {
1150				/*
1151				 * Divisor can be too small to reach clock
1152				 * speed requirement. Then use the base clock.
1153				 */
1154				switch_base_clk = true;
1155			}
1156		}
1157
1158		if (!host->clk_mul || switch_base_clk) {
1159			/* Version 3.00 divisors must be a multiple of 2. */
1160			if (host->max_clk <= clock)
1161				div = 1;
1162			else {
1163				for (div = 2; div < SDHCI_MAX_DIV_SPEC_300;
1164				     div += 2) {
1165					if ((host->max_clk / div) <= clock)
1166						break;
1167				}
1168			}
1169			real_div = div;
1170			div >>= 1;
1171			if ((host->quirks2 & SDHCI_QUIRK2_CLOCK_DIV_ZERO_BROKEN)
1172				&& !div && host->max_clk <= 25000000)
1173				div = 1;
1174		}
1175	} else {
1176		/* Version 2.00 divisors must be a power of 2. */
1177		for (div = 1; div < SDHCI_MAX_DIV_SPEC_200; div *= 2) {
1178			if ((host->max_clk / div) <= clock)
1179				break;
1180		}
1181		real_div = div;
1182		div >>= 1;
1183	}
1184
1185clock_set:
1186	if (real_div)
1187		host->mmc->actual_clock = (host->max_clk * clk_mul) / real_div;
 
1188	clk |= (div & SDHCI_DIV_MASK) << SDHCI_DIVIDER_SHIFT;
1189	clk |= ((div & SDHCI_DIV_HI_MASK) >> SDHCI_DIV_MASK_LEN)
1190		<< SDHCI_DIVIDER_HI_SHIFT;
1191	clk |= SDHCI_CLOCK_INT_EN;
1192	sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
1193
1194	/* Wait max 20 ms */
1195	timeout = 20;
1196	while (!((clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL))
1197		& SDHCI_CLOCK_INT_STABLE)) {
1198		if (timeout == 0) {
1199			pr_err("%s: Internal clock never stabilised.\n",
1200			       mmc_hostname(host->mmc));
1201			sdhci_dumpregs(host);
1202			return;
1203		}
1204		timeout--;
1205		mdelay(1);
1206	}
1207
1208	clk |= SDHCI_CLOCK_CARD_EN;
1209	sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
 
 
 
1210}
1211EXPORT_SYMBOL_GPL(sdhci_set_clock);
1212
1213static void sdhci_set_power_reg(struct sdhci_host *host, unsigned char mode,
1214				unsigned short vdd)
1215{
1216	struct mmc_host *mmc = host->mmc;
1217
1218	spin_unlock_irq(&host->lock);
1219	mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, vdd);
1220	spin_lock_irq(&host->lock);
1221
1222	if (mode != MMC_POWER_OFF)
1223		sdhci_writeb(host, SDHCI_POWER_ON, SDHCI_POWER_CONTROL);
1224	else
1225		sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
1226}
1227
1228void sdhci_set_power(struct sdhci_host *host, unsigned char mode,
1229		     unsigned short vdd)
1230{
1231	u8 pwr = 0;
1232
1233	if (mode != MMC_POWER_OFF) {
1234		switch (1 << vdd) {
1235		case MMC_VDD_165_195:
1236			pwr = SDHCI_POWER_180;
1237			break;
1238		case MMC_VDD_29_30:
1239		case MMC_VDD_30_31:
1240			pwr = SDHCI_POWER_300;
1241			break;
1242		case MMC_VDD_32_33:
1243		case MMC_VDD_33_34:
1244			pwr = SDHCI_POWER_330;
1245			break;
1246		default:
1247			WARN(1, "%s: Invalid vdd %#x\n",
1248			     mmc_hostname(host->mmc), vdd);
1249			break;
1250		}
1251	}
1252
1253	if (host->pwr == pwr)
1254		return;
1255
1256	host->pwr = pwr;
1257
1258	if (pwr == 0) {
1259		sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
1260		if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
1261			sdhci_runtime_pm_bus_off(host);
1262	} else {
1263		/*
1264		 * Spec says that we should clear the power reg before setting
1265		 * a new value. Some controllers don't seem to like this though.
1266		 */
1267		if (!(host->quirks & SDHCI_QUIRK_SINGLE_POWER_WRITE))
1268			sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
1269
1270		/*
1271		 * At least the Marvell CaFe chip gets confused if we set the
1272		 * voltage and set turn on power at the same time, so set the
1273		 * voltage first.
1274		 */
1275		if (host->quirks & SDHCI_QUIRK_NO_SIMULT_VDD_AND_POWER)
1276			sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
1277
1278		pwr |= SDHCI_POWER_ON;
 
 
 
 
 
1279
 
 
 
 
 
1280		sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
1281
1282		if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
1283			sdhci_runtime_pm_bus_on(host);
1284
1285		/*
1286		 * Some controllers need an extra 10ms delay of 10ms before
1287		 * they can apply clock after applying power
1288		 */
1289		if (host->quirks & SDHCI_QUIRK_DELAY_AFTER_POWER)
1290			mdelay(10);
1291	}
1292}
1293EXPORT_SYMBOL_GPL(sdhci_set_power);
1294
1295static void __sdhci_set_power(struct sdhci_host *host, unsigned char mode,
1296			      unsigned short vdd)
1297{
1298	struct mmc_host *mmc = host->mmc;
1299
1300	if (host->ops->set_power)
1301		host->ops->set_power(host, mode, vdd);
1302	else if (!IS_ERR(mmc->supply.vmmc))
1303		sdhci_set_power_reg(host, mode, vdd);
1304	else
1305		sdhci_set_power(host, mode, vdd);
 
 
1306}
1307
1308/*****************************************************************************\
1309 *                                                                           *
1310 * MMC callbacks                                                             *
1311 *                                                                           *
1312\*****************************************************************************/
1313
1314static void sdhci_request(struct mmc_host *mmc, struct mmc_request *mrq)
1315{
1316	struct sdhci_host *host;
1317	int present;
1318	unsigned long flags;
 
1319
1320	host = mmc_priv(mmc);
1321
1322	sdhci_runtime_pm_get(host);
1323
1324	/* Firstly check card presence */
1325	present = mmc->ops->get_cd(mmc);
1326
1327	spin_lock_irqsave(&host->lock, flags);
1328
1329	WARN_ON(host->mrq != NULL);
1330
1331#ifndef SDHCI_USE_LEDS_CLASS
1332	sdhci_activate_led(host);
1333#endif
1334
1335	/*
1336	 * Ensure we don't send the STOP for non-SET_BLOCK_COUNTED
1337	 * requests if Auto-CMD12 is enabled.
1338	 */
1339	if (!mrq->sbc && (host->flags & SDHCI_AUTO_CMD12)) {
1340		if (mrq->stop) {
1341			mrq->data->stop = NULL;
1342			mrq->stop = NULL;
1343		}
1344	}
1345
1346	host->mrq = mrq;
1347
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1348	if (!present || host->flags & SDHCI_DEVICE_DEAD) {
1349		host->mrq->cmd->error = -ENOMEDIUM;
1350		tasklet_schedule(&host->finish_tasklet);
1351	} else {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1352		if (mrq->sbc && !(host->flags & SDHCI_AUTO_CMD23))
1353			sdhci_send_command(host, mrq->sbc);
1354		else
1355			sdhci_send_command(host, mrq->cmd);
1356	}
1357
1358	mmiowb();
1359	spin_unlock_irqrestore(&host->lock, flags);
1360}
1361
1362void sdhci_set_bus_width(struct sdhci_host *host, int width)
1363{
1364	u8 ctrl;
1365
1366	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
1367	if (width == MMC_BUS_WIDTH_8) {
1368		ctrl &= ~SDHCI_CTRL_4BITBUS;
1369		if (host->version >= SDHCI_SPEC_300)
1370			ctrl |= SDHCI_CTRL_8BITBUS;
1371	} else {
1372		if (host->version >= SDHCI_SPEC_300)
1373			ctrl &= ~SDHCI_CTRL_8BITBUS;
1374		if (width == MMC_BUS_WIDTH_4)
1375			ctrl |= SDHCI_CTRL_4BITBUS;
1376		else
1377			ctrl &= ~SDHCI_CTRL_4BITBUS;
1378	}
1379	sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1380}
1381EXPORT_SYMBOL_GPL(sdhci_set_bus_width);
1382
1383void sdhci_set_uhs_signaling(struct sdhci_host *host, unsigned timing)
1384{
1385	u16 ctrl_2;
1386
1387	ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1388	/* Select Bus Speed Mode for host */
1389	ctrl_2 &= ~SDHCI_CTRL_UHS_MASK;
1390	if ((timing == MMC_TIMING_MMC_HS200) ||
1391	    (timing == MMC_TIMING_UHS_SDR104))
1392		ctrl_2 |= SDHCI_CTRL_UHS_SDR104;
1393	else if (timing == MMC_TIMING_UHS_SDR12)
1394		ctrl_2 |= SDHCI_CTRL_UHS_SDR12;
1395	else if (timing == MMC_TIMING_UHS_SDR25)
1396		ctrl_2 |= SDHCI_CTRL_UHS_SDR25;
1397	else if (timing == MMC_TIMING_UHS_SDR50)
1398		ctrl_2 |= SDHCI_CTRL_UHS_SDR50;
1399	else if ((timing == MMC_TIMING_UHS_DDR50) ||
1400		 (timing == MMC_TIMING_MMC_DDR52))
1401		ctrl_2 |= SDHCI_CTRL_UHS_DDR50;
1402	else if (timing == MMC_TIMING_MMC_HS400)
1403		ctrl_2 |= SDHCI_CTRL_HS400; /* Non-standard */
1404	sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2);
1405}
1406EXPORT_SYMBOL_GPL(sdhci_set_uhs_signaling);
1407
1408static void sdhci_do_set_ios(struct sdhci_host *host, struct mmc_ios *ios)
1409{
1410	unsigned long flags;
 
1411	u8 ctrl;
1412	struct mmc_host *mmc = host->mmc;
1413
1414	spin_lock_irqsave(&host->lock, flags);
1415
1416	if (host->flags & SDHCI_DEVICE_DEAD) {
1417		spin_unlock_irqrestore(&host->lock, flags);
1418		if (!IS_ERR(mmc->supply.vmmc) &&
1419		    ios->power_mode == MMC_POWER_OFF)
1420			mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
1421		return;
1422	}
1423
1424	/*
1425	 * Reset the chip on each power off.
1426	 * Should clear out any weird states.
1427	 */
1428	if (ios->power_mode == MMC_POWER_OFF) {
1429		sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
1430		sdhci_reinit(host);
1431	}
1432
1433	if (host->version >= SDHCI_SPEC_300 &&
1434		(ios->power_mode == MMC_POWER_UP) &&
1435		!(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN))
1436		sdhci_enable_preset_value(host, false);
1437
1438	if (!ios->clock || ios->clock != host->clock) {
1439		host->ops->set_clock(host, ios->clock);
1440		host->clock = ios->clock;
1441
1442		if (host->quirks & SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK &&
1443		    host->clock) {
1444			host->timeout_clk = host->mmc->actual_clock ?
1445						host->mmc->actual_clock / 1000 :
1446						host->clock / 1000;
1447			host->mmc->max_busy_timeout =
1448				host->ops->get_max_timeout_count ?
1449				host->ops->get_max_timeout_count(host) :
1450				1 << 27;
1451			host->mmc->max_busy_timeout /= host->timeout_clk;
1452		}
1453	}
1454
1455	__sdhci_set_power(host, ios->power_mode, ios->vdd);
 
 
 
 
 
 
 
 
 
1456
1457	if (host->ops->platform_send_init_74_clocks)
1458		host->ops->platform_send_init_74_clocks(host, ios->power_mode);
1459
1460	host->ops->set_bus_width(host, ios->bus_width);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1461
1462	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
1463
1464	if ((ios->timing == MMC_TIMING_SD_HS ||
1465	     ios->timing == MMC_TIMING_MMC_HS)
1466	    && !(host->quirks & SDHCI_QUIRK_NO_HISPD_BIT))
1467		ctrl |= SDHCI_CTRL_HISPD;
1468	else
1469		ctrl &= ~SDHCI_CTRL_HISPD;
1470
1471	if (host->version >= SDHCI_SPEC_300) {
1472		u16 clk, ctrl_2;
1473
1474		/* In case of UHS-I modes, set High Speed Enable */
1475		if ((ios->timing == MMC_TIMING_MMC_HS400) ||
1476		    (ios->timing == MMC_TIMING_MMC_HS200) ||
1477		    (ios->timing == MMC_TIMING_MMC_DDR52) ||
1478		    (ios->timing == MMC_TIMING_UHS_SDR50) ||
1479		    (ios->timing == MMC_TIMING_UHS_SDR104) ||
1480		    (ios->timing == MMC_TIMING_UHS_DDR50) ||
1481		    (ios->timing == MMC_TIMING_UHS_SDR25))
1482			ctrl |= SDHCI_CTRL_HISPD;
1483
1484		if (!host->preset_enabled) {
 
1485			sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1486			/*
1487			 * We only need to set Driver Strength if the
1488			 * preset value enable is not set.
1489			 */
1490			ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1491			ctrl_2 &= ~SDHCI_CTRL_DRV_TYPE_MASK;
1492			if (ios->drv_type == MMC_SET_DRIVER_TYPE_A)
1493				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_A;
1494			else if (ios->drv_type == MMC_SET_DRIVER_TYPE_B)
1495				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_B;
1496			else if (ios->drv_type == MMC_SET_DRIVER_TYPE_C)
1497				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_C;
1498			else if (ios->drv_type == MMC_SET_DRIVER_TYPE_D)
1499				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_D;
1500			else {
1501				pr_warn("%s: invalid driver type, default to driver type B\n",
1502					mmc_hostname(mmc));
1503				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_B;
1504			}
1505
1506			sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2);
1507		} else {
1508			/*
1509			 * According to SDHC Spec v3.00, if the Preset Value
1510			 * Enable in the Host Control 2 register is set, we
1511			 * need to reset SD Clock Enable before changing High
1512			 * Speed Enable to avoid generating clock gliches.
1513			 */
1514
1515			/* Reset SD Clock Enable */
1516			clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
1517			clk &= ~SDHCI_CLOCK_CARD_EN;
1518			sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
1519
1520			sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1521
1522			/* Re-enable SD Clock */
1523			host->ops->set_clock(host, host->clock);
1524		}
1525
 
1526		/* Reset SD Clock Enable */
1527		clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
1528		clk &= ~SDHCI_CLOCK_CARD_EN;
1529		sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
1530
1531		host->ops->set_uhs_signaling(host, ios->timing);
1532		host->timing = ios->timing;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1533
1534		if (!(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN) &&
1535				((ios->timing == MMC_TIMING_UHS_SDR12) ||
1536				 (ios->timing == MMC_TIMING_UHS_SDR25) ||
1537				 (ios->timing == MMC_TIMING_UHS_SDR50) ||
1538				 (ios->timing == MMC_TIMING_UHS_SDR104) ||
1539				 (ios->timing == MMC_TIMING_UHS_DDR50) ||
1540				 (ios->timing == MMC_TIMING_MMC_DDR52))) {
1541			u16 preset;
1542
1543			sdhci_enable_preset_value(host, true);
1544			preset = sdhci_get_preset_value(host);
1545			ios->drv_type = (preset & SDHCI_PRESET_DRV_MASK)
1546				>> SDHCI_PRESET_DRV_SHIFT;
1547		}
1548
1549		/* Re-enable SD Clock */
1550		host->ops->set_clock(host, host->clock);
1551	} else
1552		sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1553
1554	/*
1555	 * Some (ENE) controllers go apeshit on some ios operation,
1556	 * signalling timeout and CRC errors even on CMD0. Resetting
1557	 * it on each ios seems to solve the problem.
1558	 */
1559	if (host->quirks & SDHCI_QUIRK_RESET_CMD_DATA_ON_IOS)
1560		sdhci_do_reset(host, SDHCI_RESET_CMD | SDHCI_RESET_DATA);
1561
1562	mmiowb();
1563	spin_unlock_irqrestore(&host->lock, flags);
1564}
1565
1566static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
1567{
1568	struct sdhci_host *host = mmc_priv(mmc);
1569
1570	sdhci_runtime_pm_get(host);
1571	sdhci_do_set_ios(host, ios);
1572	sdhci_runtime_pm_put(host);
1573}
1574
1575static int sdhci_do_get_cd(struct sdhci_host *host)
1576{
1577	int gpio_cd = mmc_gpio_get_cd(host->mmc);
1578
1579	if (host->flags & SDHCI_DEVICE_DEAD)
1580		return 0;
1581
1582	/* If nonremovable, assume that the card is always present. */
1583	if (host->mmc->caps & MMC_CAP_NONREMOVABLE)
 
1584		return 1;
1585
1586	/*
1587	 * Try slot gpio detect, if defined it take precedence
1588	 * over build in controller functionality
1589	 */
1590	if (!IS_ERR_VALUE(gpio_cd))
1591		return !!gpio_cd;
1592
1593	/* If polling, assume that the card is always present. */
1594	if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
1595		return 1;
1596
1597	/* Host native card detect */
1598	return !!(sdhci_readl(host, SDHCI_PRESENT_STATE) & SDHCI_CARD_PRESENT);
1599}
1600
1601static int sdhci_get_cd(struct mmc_host *mmc)
1602{
1603	struct sdhci_host *host = mmc_priv(mmc);
1604	int ret;
1605
1606	sdhci_runtime_pm_get(host);
1607	ret = sdhci_do_get_cd(host);
1608	sdhci_runtime_pm_put(host);
1609	return ret;
1610}
1611
1612static int sdhci_check_ro(struct sdhci_host *host)
1613{
1614	unsigned long flags;
1615	int is_readonly;
1616
1617	spin_lock_irqsave(&host->lock, flags);
1618
1619	if (host->flags & SDHCI_DEVICE_DEAD)
1620		is_readonly = 0;
1621	else if (host->ops->get_ro)
1622		is_readonly = host->ops->get_ro(host);
1623	else
1624		is_readonly = !(sdhci_readl(host, SDHCI_PRESENT_STATE)
1625				& SDHCI_WRITE_PROTECT);
1626
1627	spin_unlock_irqrestore(&host->lock, flags);
1628
1629	/* This quirk needs to be replaced by a callback-function later */
1630	return host->quirks & SDHCI_QUIRK_INVERTED_WRITE_PROTECT ?
1631		!is_readonly : is_readonly;
1632}
1633
1634#define SAMPLE_COUNT	5
1635
1636static int sdhci_do_get_ro(struct sdhci_host *host)
1637{
1638	int i, ro_count;
1639
1640	if (!(host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT))
1641		return sdhci_check_ro(host);
1642
1643	ro_count = 0;
1644	for (i = 0; i < SAMPLE_COUNT; i++) {
1645		if (sdhci_check_ro(host)) {
1646			if (++ro_count > SAMPLE_COUNT / 2)
1647				return 1;
1648		}
1649		msleep(30);
1650	}
1651	return 0;
1652}
1653
1654static void sdhci_hw_reset(struct mmc_host *mmc)
1655{
1656	struct sdhci_host *host = mmc_priv(mmc);
1657
1658	if (host->ops && host->ops->hw_reset)
1659		host->ops->hw_reset(host);
1660}
1661
1662static int sdhci_get_ro(struct mmc_host *mmc)
1663{
1664	struct sdhci_host *host = mmc_priv(mmc);
1665	int ret;
1666
1667	sdhci_runtime_pm_get(host);
1668	ret = sdhci_do_get_ro(host);
1669	sdhci_runtime_pm_put(host);
1670	return ret;
1671}
1672
1673static void sdhci_enable_sdio_irq_nolock(struct sdhci_host *host, int enable)
1674{
1675	if (!(host->flags & SDHCI_DEVICE_DEAD)) {
1676		if (enable)
1677			host->ier |= SDHCI_INT_CARD_INT;
1678		else
1679			host->ier &= ~SDHCI_INT_CARD_INT;
1680
1681		sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
1682		sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
1683		mmiowb();
1684	}
 
 
 
 
 
 
 
 
 
 
 
1685}
1686
1687static void sdhci_enable_sdio_irq(struct mmc_host *mmc, int enable)
1688{
1689	struct sdhci_host *host = mmc_priv(mmc);
1690	unsigned long flags;
1691
1692	sdhci_runtime_pm_get(host);
1693
1694	spin_lock_irqsave(&host->lock, flags);
1695	if (enable)
1696		host->flags |= SDHCI_SDIO_IRQ_ENABLED;
1697	else
1698		host->flags &= ~SDHCI_SDIO_IRQ_ENABLED;
1699
1700	sdhci_enable_sdio_irq_nolock(host, enable);
1701	spin_unlock_irqrestore(&host->lock, flags);
1702
1703	sdhci_runtime_pm_put(host);
1704}
1705
1706static int sdhci_do_start_signal_voltage_switch(struct sdhci_host *host,
1707						struct mmc_ios *ios)
1708{
1709	struct mmc_host *mmc = host->mmc;
1710	u16 ctrl;
1711	int ret;
1712
1713	/*
1714	 * Signal Voltage Switching is only applicable for Host Controllers
1715	 * v3.00 and above.
1716	 */
1717	if (host->version < SDHCI_SPEC_300)
1718		return 0;
1719
1720	ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1721
1722	switch (ios->signal_voltage) {
1723	case MMC_SIGNAL_VOLTAGE_330:
1724		/* Set 1.8V Signal Enable in the Host Control2 register to 0 */
1725		ctrl &= ~SDHCI_CTRL_VDD_180;
1726		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1727
1728		if (!IS_ERR(mmc->supply.vqmmc)) {
1729			ret = regulator_set_voltage(mmc->supply.vqmmc, 2700000,
1730						    3600000);
1731			if (ret) {
1732				pr_warn("%s: Switching to 3.3V signalling voltage failed\n",
1733					mmc_hostname(mmc));
1734				return -EIO;
1735			}
1736		}
1737		/* Wait for 5ms */
1738		usleep_range(5000, 5500);
1739
1740		/* 3.3V regulator output should be stable within 5 ms */
1741		ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1742		if (!(ctrl & SDHCI_CTRL_VDD_180))
1743			return 0;
1744
1745		pr_warn("%s: 3.3V regulator output did not became stable\n",
1746			mmc_hostname(mmc));
1747
1748		return -EAGAIN;
1749	case MMC_SIGNAL_VOLTAGE_180:
1750		if (!IS_ERR(mmc->supply.vqmmc)) {
1751			ret = regulator_set_voltage(mmc->supply.vqmmc,
1752					1700000, 1950000);
1753			if (ret) {
1754				pr_warn("%s: Switching to 1.8V signalling voltage failed\n",
1755					mmc_hostname(mmc));
1756				return -EIO;
1757			}
1758		}
1759
1760		/*
1761		 * Enable 1.8V Signal Enable in the Host Control2
1762		 * register
1763		 */
1764		ctrl |= SDHCI_CTRL_VDD_180;
1765		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1766
1767		/* Some controller need to do more when switching */
1768		if (host->ops->voltage_switch)
1769			host->ops->voltage_switch(host);
1770
1771		/* 1.8V regulator output should be stable within 5 ms */
1772		ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1773		if (ctrl & SDHCI_CTRL_VDD_180)
1774			return 0;
1775
1776		pr_warn("%s: 1.8V regulator output did not became stable\n",
1777			mmc_hostname(mmc));
1778
1779		return -EAGAIN;
1780	case MMC_SIGNAL_VOLTAGE_120:
1781		if (!IS_ERR(mmc->supply.vqmmc)) {
1782			ret = regulator_set_voltage(mmc->supply.vqmmc, 1100000,
1783						    1300000);
1784			if (ret) {
1785				pr_warn("%s: Switching to 1.2V signalling voltage failed\n",
1786					mmc_hostname(mmc));
1787				return -EIO;
1788			}
1789		}
1790		return 0;
1791	default:
1792		/* No signal voltage switch required */
1793		return 0;
1794	}
1795}
1796
1797static int sdhci_start_signal_voltage_switch(struct mmc_host *mmc,
1798	struct mmc_ios *ios)
1799{
1800	struct sdhci_host *host = mmc_priv(mmc);
1801	int err;
1802
1803	if (host->version < SDHCI_SPEC_300)
1804		return 0;
1805	sdhci_runtime_pm_get(host);
1806	err = sdhci_do_start_signal_voltage_switch(host, ios);
1807	sdhci_runtime_pm_put(host);
1808	return err;
1809}
1810
1811static int sdhci_card_busy(struct mmc_host *mmc)
1812{
1813	struct sdhci_host *host = mmc_priv(mmc);
1814	u32 present_state;
1815
1816	sdhci_runtime_pm_get(host);
1817	/* Check whether DAT[3:0] is 0000 */
1818	present_state = sdhci_readl(host, SDHCI_PRESENT_STATE);
1819	sdhci_runtime_pm_put(host);
1820
1821	return !(present_state & SDHCI_DATA_LVL_MASK);
1822}
1823
1824static int sdhci_prepare_hs400_tuning(struct mmc_host *mmc, struct mmc_ios *ios)
1825{
1826	struct sdhci_host *host = mmc_priv(mmc);
1827	unsigned long flags;
1828
1829	spin_lock_irqsave(&host->lock, flags);
1830	host->flags |= SDHCI_HS400_TUNING;
1831	spin_unlock_irqrestore(&host->lock, flags);
1832
1833	return 0;
1834}
1835
1836static int sdhci_execute_tuning(struct mmc_host *mmc, u32 opcode)
1837{
1838	struct sdhci_host *host = mmc_priv(mmc);
1839	u16 ctrl;
 
1840	int tuning_loop_counter = MAX_TUNING_LOOP;
 
1841	int err = 0;
 
1842	unsigned long flags;
1843	unsigned int tuning_count = 0;
1844	bool hs400_tuning;
1845
1846	sdhci_runtime_pm_get(host);
1847	spin_lock_irqsave(&host->lock, flags);
1848
1849	hs400_tuning = host->flags & SDHCI_HS400_TUNING;
1850	host->flags &= ~SDHCI_HS400_TUNING;
1851
1852	if (host->tuning_mode == SDHCI_TUNING_MODE_1)
1853		tuning_count = host->tuning_count;
1854
1855	/*
1856	 * The Host Controller needs tuning in case of SDR104 and DDR50
1857	 * mode, and for SDR50 mode when Use Tuning for SDR50 is set in
1858	 * the Capabilities register.
1859	 * If the Host Controller supports the HS200 mode then the
1860	 * tuning function has to be executed.
1861	 */
1862	switch (host->timing) {
1863	/* HS400 tuning is done in HS200 mode */
1864	case MMC_TIMING_MMC_HS400:
1865		err = -EINVAL;
1866		goto out_unlock;
1867
1868	case MMC_TIMING_MMC_HS200:
1869		/*
1870		 * Periodic re-tuning for HS400 is not expected to be needed, so
1871		 * disable it here.
1872		 */
1873		if (hs400_tuning)
1874			tuning_count = 0;
1875		break;
1876
1877	case MMC_TIMING_UHS_SDR104:
1878	case MMC_TIMING_UHS_DDR50:
1879		break;
1880
1881	case MMC_TIMING_UHS_SDR50:
1882		if (host->flags & SDHCI_SDR50_NEEDS_TUNING ||
1883		    host->flags & SDHCI_SDR104_NEEDS_TUNING)
1884			break;
1885		/* FALLTHROUGH */
1886
1887	default:
1888		goto out_unlock;
1889	}
1890
1891	if (host->ops->platform_execute_tuning) {
1892		spin_unlock_irqrestore(&host->lock, flags);
1893		err = host->ops->platform_execute_tuning(host, opcode);
1894		sdhci_runtime_pm_put(host);
1895		return err;
1896	}
1897
1898	ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1899	ctrl |= SDHCI_CTRL_EXEC_TUNING;
1900	if (host->quirks2 & SDHCI_QUIRK2_TUNING_WORK_AROUND)
1901		ctrl |= SDHCI_CTRL_TUNED_CLK;
1902	sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1903
1904	/*
1905	 * As per the Host Controller spec v3.00, tuning command
1906	 * generates Buffer Read Ready interrupt, so enable that.
1907	 *
1908	 * Note: The spec clearly says that when tuning sequence
1909	 * is being performed, the controller does not generate
1910	 * interrupts other than Buffer Read Ready interrupt. But
1911	 * to make sure we don't hit a controller bug, we _only_
1912	 * enable Buffer Read Ready interrupt here.
1913	 */
1914	sdhci_writel(host, SDHCI_INT_DATA_AVAIL, SDHCI_INT_ENABLE);
1915	sdhci_writel(host, SDHCI_INT_DATA_AVAIL, SDHCI_SIGNAL_ENABLE);
1916
1917	/*
1918	 * Issue CMD19 repeatedly till Execute Tuning is set to 0 or the number
1919	 * of loops reaches 40 times or a timeout of 150ms occurs.
1920	 */
 
1921	do {
1922		struct mmc_command cmd = {0};
1923		struct mmc_request mrq = {NULL};
1924
 
 
 
1925		cmd.opcode = opcode;
1926		cmd.arg = 0;
1927		cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
1928		cmd.retries = 0;
1929		cmd.data = NULL;
1930		cmd.error = 0;
1931
1932		if (tuning_loop_counter-- == 0)
1933			break;
1934
1935		mrq.cmd = &cmd;
1936		host->mrq = &mrq;
1937
1938		/*
1939		 * In response to CMD19, the card sends 64 bytes of tuning
1940		 * block to the Host Controller. So we set the block size
1941		 * to 64 here.
1942		 */
1943		if (cmd.opcode == MMC_SEND_TUNING_BLOCK_HS200) {
1944			if (mmc->ios.bus_width == MMC_BUS_WIDTH_8)
1945				sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 128),
1946					     SDHCI_BLOCK_SIZE);
1947			else if (mmc->ios.bus_width == MMC_BUS_WIDTH_4)
1948				sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 64),
1949					     SDHCI_BLOCK_SIZE);
1950		} else {
1951			sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 64),
1952				     SDHCI_BLOCK_SIZE);
1953		}
1954
1955		/*
1956		 * The tuning block is sent by the card to the host controller.
1957		 * So we set the TRNS_READ bit in the Transfer Mode register.
1958		 * This also takes care of setting DMA Enable and Multi Block
1959		 * Select in the same register to 0.
1960		 */
1961		sdhci_writew(host, SDHCI_TRNS_READ, SDHCI_TRANSFER_MODE);
1962
1963		sdhci_send_command(host, &cmd);
1964
1965		host->cmd = NULL;
1966		host->mrq = NULL;
1967
1968		spin_unlock_irqrestore(&host->lock, flags);
1969		/* Wait for Buffer Read Ready interrupt */
1970		wait_event_interruptible_timeout(host->buf_ready_int,
1971					(host->tuning_done == 1),
1972					msecs_to_jiffies(50));
1973		spin_lock_irqsave(&host->lock, flags);
1974
1975		if (!host->tuning_done) {
1976			pr_info(DRIVER_NAME ": Timeout waiting for Buffer Read Ready interrupt during tuning procedure, falling back to fixed sampling clock\n");
 
 
 
1977			ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1978			ctrl &= ~SDHCI_CTRL_TUNED_CLK;
1979			ctrl &= ~SDHCI_CTRL_EXEC_TUNING;
1980			sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1981
1982			err = -EIO;
1983			goto out;
1984		}
1985
1986		host->tuning_done = 0;
1987
1988		ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1989
1990		/* eMMC spec does not require a delay between tuning cycles */
1991		if (opcode == MMC_SEND_TUNING_BLOCK)
1992			mdelay(1);
1993	} while (ctrl & SDHCI_CTRL_EXEC_TUNING);
1994
1995	/*
1996	 * The Host Driver has exhausted the maximum number of loops allowed,
1997	 * so use fixed sampling frequency.
1998	 */
1999	if (tuning_loop_counter < 0) {
2000		ctrl &= ~SDHCI_CTRL_TUNED_CLK;
2001		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
2002	}
2003	if (!(ctrl & SDHCI_CTRL_TUNED_CLK)) {
2004		pr_info(DRIVER_NAME ": Tuning procedure failed, falling back to fixed sampling clock\n");
2005		err = -EIO;
 
 
 
 
 
 
 
2006	}
2007
2008out:
2009	if (tuning_count) {
2010		/*
2011		 * In case tuning fails, host controllers which support
2012		 * re-tuning can try tuning again at a later time, when the
2013		 * re-tuning timer expires.  So for these controllers, we
2014		 * return 0. Since there might be other controllers who do not
2015		 * have this capability, we return error for them.
2016		 */
2017		err = 0;
 
 
 
 
 
 
 
 
 
2018	}
2019
2020	host->mmc->retune_period = err ? 0 : tuning_count;
 
 
 
 
 
 
 
 
 
2021
2022	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
2023	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
2024out_unlock:
2025	spin_unlock_irqrestore(&host->lock, flags);
2026	sdhci_runtime_pm_put(host);
2027
2028	return err;
2029}
2030
2031static int sdhci_select_drive_strength(struct mmc_card *card,
2032				       unsigned int max_dtr, int host_drv,
2033				       int card_drv, int *drv_type)
2034{
2035	struct sdhci_host *host = mmc_priv(card->host);
2036
2037	if (!host->ops->select_drive_strength)
2038		return 0;
2039
2040	return host->ops->select_drive_strength(host, card, max_dtr, host_drv,
2041						card_drv, drv_type);
2042}
2043
2044static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable)
2045{
 
 
2046	/* Host Controller v3.00 defines preset value registers */
2047	if (host->version < SDHCI_SPEC_300)
2048		return;
2049
 
 
2050	/*
2051	 * We only enable or disable Preset Value if they are not already
2052	 * enabled or disabled respectively. Otherwise, we bail out.
2053	 */
2054	if (host->preset_enabled != enable) {
2055		u16 ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
2056
2057		if (enable)
2058			ctrl |= SDHCI_CTRL_PRESET_VAL_ENABLE;
2059		else
2060			ctrl &= ~SDHCI_CTRL_PRESET_VAL_ENABLE;
2061
2062		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
2063
2064		if (enable)
2065			host->flags |= SDHCI_PV_ENABLED;
2066		else
2067			host->flags &= ~SDHCI_PV_ENABLED;
2068
2069		host->preset_enabled = enable;
2070	}
2071}
2072
2073static void sdhci_post_req(struct mmc_host *mmc, struct mmc_request *mrq,
2074				int err)
2075{
2076	struct sdhci_host *host = mmc_priv(mmc);
2077	struct mmc_data *data = mrq->data;
2078
2079	if (data->host_cookie != COOKIE_UNMAPPED)
2080		dma_unmap_sg(mmc_dev(host->mmc), data->sg, data->sg_len,
2081			     data->flags & MMC_DATA_WRITE ?
2082			       DMA_TO_DEVICE : DMA_FROM_DEVICE);
2083
2084	data->host_cookie = COOKIE_UNMAPPED;
2085}
2086
2087static void sdhci_pre_req(struct mmc_host *mmc, struct mmc_request *mrq,
2088			       bool is_first_req)
2089{
2090	struct sdhci_host *host = mmc_priv(mmc);
2091
2092	mrq->data->host_cookie = COOKIE_UNMAPPED;
2093
2094	if (host->flags & SDHCI_REQ_USE_DMA)
2095		sdhci_pre_dma_transfer(host, mrq->data, COOKIE_PRE_MAPPED);
2096}
2097
2098static void sdhci_card_event(struct mmc_host *mmc)
2099{
2100	struct sdhci_host *host = mmc_priv(mmc);
2101	unsigned long flags;
2102	int present;
2103
2104	/* First check if client has provided their own card event */
2105	if (host->ops->card_event)
2106		host->ops->card_event(host);
2107
2108	present = sdhci_do_get_cd(host);
2109
2110	spin_lock_irqsave(&host->lock, flags);
2111
2112	/* Check host->mrq first in case we are runtime suspended */
2113	if (host->mrq && !present) {
2114		pr_err("%s: Card removed during transfer!\n",
2115			mmc_hostname(host->mmc));
2116		pr_err("%s: Resetting controller.\n",
2117			mmc_hostname(host->mmc));
2118
2119		sdhci_do_reset(host, SDHCI_RESET_CMD);
2120		sdhci_do_reset(host, SDHCI_RESET_DATA);
2121
2122		host->mrq->cmd->error = -ENOMEDIUM;
2123		tasklet_schedule(&host->finish_tasklet);
2124	}
2125
2126	spin_unlock_irqrestore(&host->lock, flags);
2127}
2128
2129static const struct mmc_host_ops sdhci_ops = {
2130	.request	= sdhci_request,
2131	.post_req	= sdhci_post_req,
2132	.pre_req	= sdhci_pre_req,
2133	.set_ios	= sdhci_set_ios,
2134	.get_cd		= sdhci_get_cd,
2135	.get_ro		= sdhci_get_ro,
2136	.hw_reset	= sdhci_hw_reset,
2137	.enable_sdio_irq = sdhci_enable_sdio_irq,
2138	.start_signal_voltage_switch	= sdhci_start_signal_voltage_switch,
2139	.prepare_hs400_tuning		= sdhci_prepare_hs400_tuning,
2140	.execute_tuning			= sdhci_execute_tuning,
2141	.select_drive_strength		= sdhci_select_drive_strength,
2142	.card_event			= sdhci_card_event,
2143	.card_busy	= sdhci_card_busy,
2144};
2145
2146/*****************************************************************************\
2147 *                                                                           *
2148 * Tasklets                                                                  *
2149 *                                                                           *
2150\*****************************************************************************/
2151
 
 
 
 
 
 
 
 
 
2152static void sdhci_tasklet_finish(unsigned long param)
2153{
2154	struct sdhci_host *host;
2155	unsigned long flags;
2156	struct mmc_request *mrq;
2157
2158	host = (struct sdhci_host*)param;
2159
2160	spin_lock_irqsave(&host->lock, flags);
2161
2162        /*
2163         * If this tasklet gets rescheduled while running, it will
2164         * be run again afterwards but without any active request.
2165         */
2166	if (!host->mrq) {
2167		spin_unlock_irqrestore(&host->lock, flags);
2168		return;
2169	}
2170
2171	del_timer(&host->timer);
2172
2173	mrq = host->mrq;
2174
2175	/*
2176	 * Always unmap the data buffers if they were mapped by
2177	 * sdhci_prepare_data() whenever we finish with a request.
2178	 * This avoids leaking DMA mappings on error.
2179	 */
2180	if (host->flags & SDHCI_REQ_USE_DMA) {
2181		struct mmc_data *data = mrq->data;
2182
2183		if (data && data->host_cookie == COOKIE_MAPPED) {
2184			dma_unmap_sg(mmc_dev(host->mmc), data->sg, data->sg_len,
2185				     (data->flags & MMC_DATA_READ) ?
2186				     DMA_FROM_DEVICE : DMA_TO_DEVICE);
2187			data->host_cookie = COOKIE_UNMAPPED;
2188		}
2189	}
2190
2191	/*
2192	 * The controller needs a reset of internal state machines
2193	 * upon error conditions.
2194	 */
2195	if (!(host->flags & SDHCI_DEVICE_DEAD) &&
2196	    ((mrq->cmd && mrq->cmd->error) ||
2197	     (mrq->sbc && mrq->sbc->error) ||
2198	     (mrq->data && ((mrq->data->error && !mrq->data->stop) ||
2199			    (mrq->data->stop && mrq->data->stop->error))) ||
2200	     (host->quirks & SDHCI_QUIRK_RESET_AFTER_REQUEST))) {
2201
2202		/* Some controllers need this kick or reset won't work here */
2203		if (host->quirks & SDHCI_QUIRK_CLOCK_BEFORE_RESET)
2204			/* This is to force an update */
2205			host->ops->set_clock(host, host->clock);
2206
2207		/* Spec says we should do both at the same time, but Ricoh
2208		   controllers do not like that. */
2209		sdhci_do_reset(host, SDHCI_RESET_CMD);
2210		sdhci_do_reset(host, SDHCI_RESET_DATA);
2211	}
2212
2213	host->mrq = NULL;
2214	host->cmd = NULL;
2215	host->data = NULL;
2216
2217#ifndef SDHCI_USE_LEDS_CLASS
2218	sdhci_deactivate_led(host);
2219#endif
2220
2221	mmiowb();
2222	spin_unlock_irqrestore(&host->lock, flags);
2223
2224	mmc_request_done(host->mmc, mrq);
2225	sdhci_runtime_pm_put(host);
2226}
2227
2228static void sdhci_timeout_timer(unsigned long data)
2229{
2230	struct sdhci_host *host;
2231	unsigned long flags;
2232
2233	host = (struct sdhci_host*)data;
2234
2235	spin_lock_irqsave(&host->lock, flags);
2236
2237	if (host->mrq) {
2238		pr_err("%s: Timeout waiting for hardware interrupt.\n",
2239		       mmc_hostname(host->mmc));
2240		sdhci_dumpregs(host);
2241
2242		if (host->data) {
2243			host->data->error = -ETIMEDOUT;
2244			sdhci_finish_data(host);
2245		} else {
2246			if (host->cmd)
2247				host->cmd->error = -ETIMEDOUT;
2248			else
2249				host->mrq->cmd->error = -ETIMEDOUT;
2250
2251			tasklet_schedule(&host->finish_tasklet);
2252		}
2253	}
2254
2255	mmiowb();
2256	spin_unlock_irqrestore(&host->lock, flags);
2257}
2258
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2259/*****************************************************************************\
2260 *                                                                           *
2261 * Interrupt handling                                                        *
2262 *                                                                           *
2263\*****************************************************************************/
2264
2265static void sdhci_cmd_irq(struct sdhci_host *host, u32 intmask, u32 *mask)
2266{
2267	BUG_ON(intmask == 0);
2268
2269	if (!host->cmd) {
2270		pr_err("%s: Got command interrupt 0x%08x even though no command operation was in progress.\n",
2271		       mmc_hostname(host->mmc), (unsigned)intmask);
 
2272		sdhci_dumpregs(host);
2273		return;
2274	}
2275
2276	if (intmask & (SDHCI_INT_TIMEOUT | SDHCI_INT_CRC |
2277		       SDHCI_INT_END_BIT | SDHCI_INT_INDEX)) {
2278		if (intmask & SDHCI_INT_TIMEOUT)
2279			host->cmd->error = -ETIMEDOUT;
2280		else
2281			host->cmd->error = -EILSEQ;
2282
2283		/*
2284		 * If this command initiates a data phase and a response
2285		 * CRC error is signalled, the card can start transferring
2286		 * data - the card may have received the command without
2287		 * error.  We must not terminate the mmc_request early.
2288		 *
2289		 * If the card did not receive the command or returned an
2290		 * error which prevented it sending data, the data phase
2291		 * will time out.
2292		 */
2293		if (host->cmd->data &&
2294		    (intmask & (SDHCI_INT_CRC | SDHCI_INT_TIMEOUT)) ==
2295		     SDHCI_INT_CRC) {
2296			host->cmd = NULL;
2297			return;
2298		}
2299
 
2300		tasklet_schedule(&host->finish_tasklet);
2301		return;
2302	}
2303
2304	/*
2305	 * The host can send and interrupt when the busy state has
2306	 * ended, allowing us to wait without wasting CPU cycles.
2307	 * Unfortunately this is overloaded on the "data complete"
2308	 * interrupt, so we need to take some care when handling
2309	 * it.
2310	 *
2311	 * Note: The 1.0 specification is a bit ambiguous about this
2312	 *       feature so there might be some problems with older
2313	 *       controllers.
2314	 */
2315	if (host->cmd->flags & MMC_RSP_BUSY) {
2316		if (host->cmd->data)
2317			DBG("Cannot wait for busy signal when also doing a data transfer");
2318		else if (!(host->quirks & SDHCI_QUIRK_NO_BUSY_IRQ)
2319				&& !host->busy_handle) {
2320			/* Mark that command complete before busy is ended */
2321			host->busy_handle = 1;
2322			return;
2323		}
2324
2325		/* The controller does not support the end-of-busy IRQ,
2326		 * fall through and take the SDHCI_INT_RESPONSE */
2327	} else if ((host->quirks2 & SDHCI_QUIRK2_STOP_WITH_TC) &&
2328		   host->cmd->opcode == MMC_STOP_TRANSMISSION && !host->data) {
2329		*mask &= ~SDHCI_INT_DATA_END;
2330	}
2331
2332	if (intmask & SDHCI_INT_RESPONSE)
2333		sdhci_finish_command(host);
2334}
2335
2336#ifdef CONFIG_MMC_DEBUG
2337static void sdhci_adma_show_error(struct sdhci_host *host)
2338{
2339	const char *name = mmc_hostname(host->mmc);
2340	void *desc = host->adma_table;
 
 
 
2341
2342	sdhci_dumpregs(host);
2343
2344	while (true) {
2345		struct sdhci_adma2_64_desc *dma_desc = desc;
 
 
2346
2347		if (host->flags & SDHCI_USE_64_BIT_DMA)
2348			DBG("%s: %p: DMA 0x%08x%08x, LEN 0x%04x, Attr=0x%02x\n",
2349			    name, desc, le32_to_cpu(dma_desc->addr_hi),
2350			    le32_to_cpu(dma_desc->addr_lo),
2351			    le16_to_cpu(dma_desc->len),
2352			    le16_to_cpu(dma_desc->cmd));
2353		else
2354			DBG("%s: %p: DMA 0x%08x, LEN 0x%04x, Attr=0x%02x\n",
2355			    name, desc, le32_to_cpu(dma_desc->addr_lo),
2356			    le16_to_cpu(dma_desc->len),
2357			    le16_to_cpu(dma_desc->cmd));
2358
2359		desc += host->desc_sz;
2360
2361		if (dma_desc->cmd & cpu_to_le16(ADMA2_END))
2362			break;
2363	}
2364}
2365#else
2366static void sdhci_adma_show_error(struct sdhci_host *host) { }
2367#endif
2368
2369static void sdhci_data_irq(struct sdhci_host *host, u32 intmask)
2370{
2371	u32 command;
2372	BUG_ON(intmask == 0);
2373
2374	/* CMD19 generates _only_ Buffer Read Ready interrupt */
2375	if (intmask & SDHCI_INT_DATA_AVAIL) {
2376		command = SDHCI_GET_CMD(sdhci_readw(host, SDHCI_COMMAND));
2377		if (command == MMC_SEND_TUNING_BLOCK ||
2378		    command == MMC_SEND_TUNING_BLOCK_HS200) {
2379			host->tuning_done = 1;
2380			wake_up(&host->buf_ready_int);
2381			return;
2382		}
2383	}
2384
2385	if (!host->data) {
2386		/*
2387		 * The "data complete" interrupt is also used to
2388		 * indicate that a busy state has ended. See comment
2389		 * above in sdhci_cmd_irq().
2390		 */
2391		if (host->cmd && (host->cmd->flags & MMC_RSP_BUSY)) {
2392			if (intmask & SDHCI_INT_DATA_TIMEOUT) {
2393				host->cmd->error = -ETIMEDOUT;
2394				tasklet_schedule(&host->finish_tasklet);
2395				return;
2396			}
2397			if (intmask & SDHCI_INT_DATA_END) {
2398				/*
2399				 * Some cards handle busy-end interrupt
2400				 * before the command completed, so make
2401				 * sure we do things in the proper order.
2402				 */
2403				if (host->busy_handle)
2404					sdhci_finish_command(host);
2405				else
2406					host->busy_handle = 1;
2407				return;
2408			}
2409		}
2410
2411		pr_err("%s: Got data interrupt 0x%08x even though no data operation was in progress.\n",
2412		       mmc_hostname(host->mmc), (unsigned)intmask);
 
2413		sdhci_dumpregs(host);
2414
2415		return;
2416	}
2417
2418	if (intmask & SDHCI_INT_DATA_TIMEOUT)
2419		host->data->error = -ETIMEDOUT;
2420	else if (intmask & SDHCI_INT_DATA_END_BIT)
2421		host->data->error = -EILSEQ;
2422	else if ((intmask & SDHCI_INT_DATA_CRC) &&
2423		SDHCI_GET_CMD(sdhci_readw(host, SDHCI_COMMAND))
2424			!= MMC_BUS_TEST_R)
2425		host->data->error = -EILSEQ;
2426	else if (intmask & SDHCI_INT_ADMA_ERROR) {
2427		pr_err("%s: ADMA error\n", mmc_hostname(host->mmc));
2428		sdhci_adma_show_error(host);
2429		host->data->error = -EIO;
2430		if (host->ops->adma_workaround)
2431			host->ops->adma_workaround(host, intmask);
2432	}
2433
2434	if (host->data->error)
2435		sdhci_finish_data(host);
2436	else {
2437		if (intmask & (SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL))
2438			sdhci_transfer_pio(host);
2439
2440		/*
2441		 * We currently don't do anything fancy with DMA
2442		 * boundaries, but as we can't disable the feature
2443		 * we need to at least restart the transfer.
2444		 *
2445		 * According to the spec sdhci_readl(host, SDHCI_DMA_ADDRESS)
2446		 * should return a valid address to continue from, but as
2447		 * some controllers are faulty, don't trust them.
2448		 */
2449		if (intmask & SDHCI_INT_DMA_END) {
2450			u32 dmastart, dmanow;
2451			dmastart = sg_dma_address(host->data->sg);
2452			dmanow = dmastart + host->data->bytes_xfered;
2453			/*
2454			 * Force update to the next DMA block boundary.
2455			 */
2456			dmanow = (dmanow &
2457				~(SDHCI_DEFAULT_BOUNDARY_SIZE - 1)) +
2458				SDHCI_DEFAULT_BOUNDARY_SIZE;
2459			host->data->bytes_xfered = dmanow - dmastart;
2460			DBG("%s: DMA base 0x%08x, transferred 0x%06x bytes,"
2461				" next 0x%08x\n",
2462				mmc_hostname(host->mmc), dmastart,
2463				host->data->bytes_xfered, dmanow);
2464			sdhci_writel(host, dmanow, SDHCI_DMA_ADDRESS);
2465		}
2466
2467		if (intmask & SDHCI_INT_DATA_END) {
2468			if (host->cmd) {
2469				/*
2470				 * Data managed to finish before the
2471				 * command completed. Make sure we do
2472				 * things in the proper order.
2473				 */
2474				host->data_early = 1;
2475			} else {
2476				sdhci_finish_data(host);
2477			}
2478		}
2479	}
2480}
2481
2482static irqreturn_t sdhci_irq(int irq, void *dev_id)
2483{
2484	irqreturn_t result = IRQ_NONE;
2485	struct sdhci_host *host = dev_id;
2486	u32 intmask, mask, unexpected = 0;
2487	int max_loops = 16;
2488
2489	spin_lock(&host->lock);
2490
2491	if (host->runtime_suspended && !sdhci_sdio_irq_enabled(host)) {
2492		spin_unlock(&host->lock);
2493		return IRQ_NONE;
2494	}
2495
2496	intmask = sdhci_readl(host, SDHCI_INT_STATUS);
 
2497	if (!intmask || intmask == 0xffffffff) {
2498		result = IRQ_NONE;
2499		goto out;
2500	}
2501
2502	do {
2503		/* Clear selected interrupts. */
2504		mask = intmask & (SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK |
2505				  SDHCI_INT_BUS_POWER);
2506		sdhci_writel(host, mask, SDHCI_INT_STATUS);
2507
2508		DBG("*** %s got interrupt: 0x%08x\n",
2509			mmc_hostname(host->mmc), intmask);
2510
2511		if (intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
2512			u32 present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
2513				      SDHCI_CARD_PRESENT;
2514
2515			/*
2516			 * There is a observation on i.mx esdhc.  INSERT
2517			 * bit will be immediately set again when it gets
2518			 * cleared, if a card is inserted.  We have to mask
2519			 * the irq to prevent interrupt storm which will
2520			 * freeze the system.  And the REMOVE gets the
2521			 * same situation.
2522			 *
2523			 * More testing are needed here to ensure it works
2524			 * for other platforms though.
2525			 */
2526			host->ier &= ~(SDHCI_INT_CARD_INSERT |
2527				       SDHCI_INT_CARD_REMOVE);
2528			host->ier |= present ? SDHCI_INT_CARD_REMOVE :
2529					       SDHCI_INT_CARD_INSERT;
2530			sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
2531			sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
2532
2533			sdhci_writel(host, intmask & (SDHCI_INT_CARD_INSERT |
2534				     SDHCI_INT_CARD_REMOVE), SDHCI_INT_STATUS);
2535
2536			host->thread_isr |= intmask & (SDHCI_INT_CARD_INSERT |
2537						       SDHCI_INT_CARD_REMOVE);
2538			result = IRQ_WAKE_THREAD;
2539		}
2540
2541		if (intmask & SDHCI_INT_CMD_MASK)
2542			sdhci_cmd_irq(host, intmask & SDHCI_INT_CMD_MASK,
2543				      &intmask);
2544
2545		if (intmask & SDHCI_INT_DATA_MASK)
2546			sdhci_data_irq(host, intmask & SDHCI_INT_DATA_MASK);
 
 
 
2547
2548		if (intmask & SDHCI_INT_BUS_POWER)
2549			pr_err("%s: Card is consuming too much power!\n",
2550				mmc_hostname(host->mmc));
 
 
2551
2552		if (intmask & SDHCI_INT_CARD_INT) {
2553			sdhci_enable_sdio_irq_nolock(host, false);
2554			host->thread_isr |= SDHCI_INT_CARD_INT;
2555			result = IRQ_WAKE_THREAD;
2556		}
2557
2558		intmask &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE |
2559			     SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK |
2560			     SDHCI_INT_ERROR | SDHCI_INT_BUS_POWER |
2561			     SDHCI_INT_CARD_INT);
2562
2563		if (intmask) {
2564			unexpected |= intmask;
2565			sdhci_writel(host, intmask, SDHCI_INT_STATUS);
2566		}
 
 
 
 
 
 
 
 
2567
2568		if (result == IRQ_NONE)
2569			result = IRQ_HANDLED;
 
 
 
 
2570
2571		intmask = sdhci_readl(host, SDHCI_INT_STATUS);
2572	} while (intmask && --max_loops);
 
 
 
 
 
 
 
 
 
 
 
2573out:
2574	spin_unlock(&host->lock);
2575
2576	if (unexpected) {
2577		pr_err("%s: Unexpected interrupt 0x%08x.\n",
2578			   mmc_hostname(host->mmc), unexpected);
2579		sdhci_dumpregs(host);
2580	}
 
 
 
 
 
2581
2582	return result;
2583}
2584
2585static irqreturn_t sdhci_thread_irq(int irq, void *dev_id)
2586{
2587	struct sdhci_host *host = dev_id;
2588	unsigned long flags;
2589	u32 isr;
2590
2591	spin_lock_irqsave(&host->lock, flags);
2592	isr = host->thread_isr;
2593	host->thread_isr = 0;
2594	spin_unlock_irqrestore(&host->lock, flags);
2595
2596	if (isr & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
2597		sdhci_card_event(host->mmc);
2598		mmc_detect_change(host->mmc, msecs_to_jiffies(200));
2599	}
2600
2601	if (isr & SDHCI_INT_CARD_INT) {
2602		sdio_run_irqs(host->mmc);
2603
2604		spin_lock_irqsave(&host->lock, flags);
2605		if (host->flags & SDHCI_SDIO_IRQ_ENABLED)
2606			sdhci_enable_sdio_irq_nolock(host, true);
2607		spin_unlock_irqrestore(&host->lock, flags);
2608	}
2609
2610	return isr ? IRQ_HANDLED : IRQ_NONE;
2611}
2612
2613/*****************************************************************************\
2614 *                                                                           *
2615 * Suspend/resume                                                            *
2616 *                                                                           *
2617\*****************************************************************************/
2618
2619#ifdef CONFIG_PM
2620void sdhci_enable_irq_wakeups(struct sdhci_host *host)
2621{
2622	u8 val;
2623	u8 mask = SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE
2624			| SDHCI_WAKE_ON_INT;
2625
2626	val = sdhci_readb(host, SDHCI_WAKE_UP_CONTROL);
2627	val |= mask ;
2628	/* Avoid fake wake up */
2629	if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
2630		val &= ~(SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE);
2631	sdhci_writeb(host, val, SDHCI_WAKE_UP_CONTROL);
2632}
2633EXPORT_SYMBOL_GPL(sdhci_enable_irq_wakeups);
2634
2635static void sdhci_disable_irq_wakeups(struct sdhci_host *host)
2636{
2637	u8 val;
2638	u8 mask = SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE
2639			| SDHCI_WAKE_ON_INT;
2640
2641	val = sdhci_readb(host, SDHCI_WAKE_UP_CONTROL);
2642	val &= ~mask;
2643	sdhci_writeb(host, val, SDHCI_WAKE_UP_CONTROL);
2644}
 
2645
2646int sdhci_suspend_host(struct sdhci_host *host)
2647{
 
 
 
2648	sdhci_disable_card_detection(host);
2649
2650	mmc_retune_timer_stop(host->mmc);
2651	mmc_retune_needed(host->mmc);
 
 
 
2652
2653	if (!device_may_wakeup(mmc_dev(host->mmc))) {
2654		host->ier = 0;
2655		sdhci_writel(host, 0, SDHCI_INT_ENABLE);
2656		sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
2657		free_irq(host->irq, host);
2658	} else {
2659		sdhci_enable_irq_wakeups(host);
2660		enable_irq_wake(host->irq);
2661	}
2662	return 0;
2663}
2664
2665EXPORT_SYMBOL_GPL(sdhci_suspend_host);
2666
2667int sdhci_resume_host(struct sdhci_host *host)
2668{
2669	int ret = 0;
2670
2671	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
2672		if (host->ops->enable_dma)
2673			host->ops->enable_dma(host);
2674	}
2675
 
 
 
 
 
 
 
 
 
 
2676	if ((host->mmc->pm_flags & MMC_PM_KEEP_POWER) &&
2677	    (host->quirks2 & SDHCI_QUIRK2_HOST_OFF_CARD_ON)) {
2678		/* Card keeps power but host controller does not */
2679		sdhci_init(host, 0);
2680		host->pwr = 0;
2681		host->clock = 0;
2682		sdhci_do_set_ios(host, &host->mmc->ios);
2683	} else {
2684		sdhci_init(host, (host->mmc->pm_flags & MMC_PM_KEEP_POWER));
2685		mmiowb();
2686	}
2687
2688	if (!device_may_wakeup(mmc_dev(host->mmc))) {
2689		ret = request_threaded_irq(host->irq, sdhci_irq,
2690					   sdhci_thread_irq, IRQF_SHARED,
2691					   mmc_hostname(host->mmc), host);
2692		if (ret)
2693			return ret;
2694	} else {
2695		sdhci_disable_irq_wakeups(host);
2696		disable_irq_wake(host->irq);
2697	}
2698
2699	sdhci_enable_card_detection(host);
2700
 
 
 
 
 
 
 
2701	return ret;
2702}
2703
2704EXPORT_SYMBOL_GPL(sdhci_resume_host);
 
 
 
2705
2706static int sdhci_runtime_pm_get(struct sdhci_host *host)
2707{
2708	return pm_runtime_get_sync(host->mmc->parent);
2709}
2710
2711static int sdhci_runtime_pm_put(struct sdhci_host *host)
2712{
2713	pm_runtime_mark_last_busy(host->mmc->parent);
2714	return pm_runtime_put_autosuspend(host->mmc->parent);
2715}
2716
2717static void sdhci_runtime_pm_bus_on(struct sdhci_host *host)
2718{
2719	if (host->bus_on)
2720		return;
2721	host->bus_on = true;
2722	pm_runtime_get_noresume(host->mmc->parent);
2723}
2724
2725static void sdhci_runtime_pm_bus_off(struct sdhci_host *host)
2726{
2727	if (!host->bus_on)
2728		return;
2729	host->bus_on = false;
2730	pm_runtime_put_noidle(host->mmc->parent);
2731}
2732
2733int sdhci_runtime_suspend_host(struct sdhci_host *host)
2734{
2735	unsigned long flags;
 
2736
2737	mmc_retune_timer_stop(host->mmc);
2738	mmc_retune_needed(host->mmc);
 
 
 
2739
2740	spin_lock_irqsave(&host->lock, flags);
2741	host->ier &= SDHCI_INT_CARD_INT;
2742	sdhci_writel(host, host->ier, SDHCI_INT_ENABLE);
2743	sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE);
2744	spin_unlock_irqrestore(&host->lock, flags);
2745
2746	synchronize_hardirq(host->irq);
2747
2748	spin_lock_irqsave(&host->lock, flags);
2749	host->runtime_suspended = true;
2750	spin_unlock_irqrestore(&host->lock, flags);
2751
2752	return 0;
2753}
2754EXPORT_SYMBOL_GPL(sdhci_runtime_suspend_host);
2755
2756int sdhci_runtime_resume_host(struct sdhci_host *host)
2757{
2758	unsigned long flags;
2759	int host_flags = host->flags;
2760
2761	if (host_flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
2762		if (host->ops->enable_dma)
2763			host->ops->enable_dma(host);
2764	}
2765
2766	sdhci_init(host, 0);
2767
2768	/* Force clock and power re-program */
2769	host->pwr = 0;
2770	host->clock = 0;
2771	sdhci_do_start_signal_voltage_switch(host, &host->mmc->ios);
2772	sdhci_do_set_ios(host, &host->mmc->ios);
2773
 
2774	if ((host_flags & SDHCI_PV_ENABLED) &&
2775		!(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN)) {
2776		spin_lock_irqsave(&host->lock, flags);
2777		sdhci_enable_preset_value(host, true);
2778		spin_unlock_irqrestore(&host->lock, flags);
2779	}
2780
 
 
 
 
2781	spin_lock_irqsave(&host->lock, flags);
2782
2783	host->runtime_suspended = false;
2784
2785	/* Enable SDIO IRQ */
2786	if (host->flags & SDHCI_SDIO_IRQ_ENABLED)
2787		sdhci_enable_sdio_irq_nolock(host, true);
2788
2789	/* Enable Card Detection */
2790	sdhci_enable_card_detection(host);
2791
2792	spin_unlock_irqrestore(&host->lock, flags);
2793
2794	return 0;
2795}
2796EXPORT_SYMBOL_GPL(sdhci_runtime_resume_host);
2797
2798#endif /* CONFIG_PM */
2799
2800/*****************************************************************************\
2801 *                                                                           *
2802 * Device allocation/registration                                            *
2803 *                                                                           *
2804\*****************************************************************************/
2805
2806struct sdhci_host *sdhci_alloc_host(struct device *dev,
2807	size_t priv_size)
2808{
2809	struct mmc_host *mmc;
2810	struct sdhci_host *host;
2811
2812	WARN_ON(dev == NULL);
2813
2814	mmc = mmc_alloc_host(sizeof(struct sdhci_host) + priv_size, dev);
2815	if (!mmc)
2816		return ERR_PTR(-ENOMEM);
2817
2818	host = mmc_priv(mmc);
2819	host->mmc = mmc;
2820	host->mmc_host_ops = sdhci_ops;
2821	mmc->ops = &host->mmc_host_ops;
2822
2823	return host;
2824}
2825
2826EXPORT_SYMBOL_GPL(sdhci_alloc_host);
2827
2828static int sdhci_set_dma_mask(struct sdhci_host *host)
2829{
2830	struct mmc_host *mmc = host->mmc;
2831	struct device *dev = mmc_dev(mmc);
2832	int ret = -EINVAL;
2833
2834	if (host->quirks2 & SDHCI_QUIRK2_BROKEN_64_BIT_DMA)
2835		host->flags &= ~SDHCI_USE_64_BIT_DMA;
2836
2837	/* Try 64-bit mask if hardware is capable  of it */
2838	if (host->flags & SDHCI_USE_64_BIT_DMA) {
2839		ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(64));
2840		if (ret) {
2841			pr_warn("%s: Failed to set 64-bit DMA mask.\n",
2842				mmc_hostname(mmc));
2843			host->flags &= ~SDHCI_USE_64_BIT_DMA;
2844		}
2845	}
2846
2847	/* 32-bit mask as default & fallback */
2848	if (ret) {
2849		ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(32));
2850		if (ret)
2851			pr_warn("%s: Failed to set 32-bit DMA mask.\n",
2852				mmc_hostname(mmc));
2853	}
2854
2855	return ret;
2856}
2857
2858int sdhci_add_host(struct sdhci_host *host)
2859{
2860	struct mmc_host *mmc;
2861	u32 caps[2] = {0, 0};
2862	u32 max_current_caps;
2863	unsigned int ocr_avail;
2864	unsigned int override_timeout_clk;
2865	u32 max_clk;
2866	int ret;
2867
2868	WARN_ON(host == NULL);
2869	if (host == NULL)
2870		return -EINVAL;
2871
2872	mmc = host->mmc;
2873
2874	if (debug_quirks)
2875		host->quirks = debug_quirks;
2876	if (debug_quirks2)
2877		host->quirks2 = debug_quirks2;
2878
2879	override_timeout_clk = host->timeout_clk;
2880
2881	sdhci_do_reset(host, SDHCI_RESET_ALL);
2882
2883	host->version = sdhci_readw(host, SDHCI_HOST_VERSION);
2884	host->version = (host->version & SDHCI_SPEC_VER_MASK)
2885				>> SDHCI_SPEC_VER_SHIFT;
2886	if (host->version > SDHCI_SPEC_300) {
2887		pr_err("%s: Unknown controller version (%d). You may experience problems.\n",
2888		       mmc_hostname(mmc), host->version);
 
2889	}
2890
2891	caps[0] = (host->quirks & SDHCI_QUIRK_MISSING_CAPS) ? host->caps :
2892		sdhci_readl(host, SDHCI_CAPABILITIES);
2893
2894	if (host->version >= SDHCI_SPEC_300)
2895		caps[1] = (host->quirks & SDHCI_QUIRK_MISSING_CAPS) ?
2896			host->caps1 :
2897			sdhci_readl(host, SDHCI_CAPABILITIES_1);
2898
2899	if (host->quirks & SDHCI_QUIRK_FORCE_DMA)
2900		host->flags |= SDHCI_USE_SDMA;
2901	else if (!(caps[0] & SDHCI_CAN_DO_SDMA))
2902		DBG("Controller doesn't have SDMA capability\n");
2903	else
2904		host->flags |= SDHCI_USE_SDMA;
2905
2906	if ((host->quirks & SDHCI_QUIRK_BROKEN_DMA) &&
2907		(host->flags & SDHCI_USE_SDMA)) {
2908		DBG("Disabling DMA as it is marked broken\n");
2909		host->flags &= ~SDHCI_USE_SDMA;
2910	}
2911
2912	if ((host->version >= SDHCI_SPEC_200) &&
2913		(caps[0] & SDHCI_CAN_DO_ADMA2))
2914		host->flags |= SDHCI_USE_ADMA;
2915
2916	if ((host->quirks & SDHCI_QUIRK_BROKEN_ADMA) &&
2917		(host->flags & SDHCI_USE_ADMA)) {
2918		DBG("Disabling ADMA as it is marked broken\n");
2919		host->flags &= ~SDHCI_USE_ADMA;
2920	}
2921
2922	/*
2923	 * It is assumed that a 64-bit capable device has set a 64-bit DMA mask
2924	 * and *must* do 64-bit DMA.  A driver has the opportunity to change
2925	 * that during the first call to ->enable_dma().  Similarly
2926	 * SDHCI_QUIRK2_BROKEN_64_BIT_DMA must be left to the drivers to
2927	 * implement.
2928	 */
2929	if (caps[0] & SDHCI_CAN_64BIT)
2930		host->flags |= SDHCI_USE_64_BIT_DMA;
2931
2932	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
2933		ret = sdhci_set_dma_mask(host);
2934
2935		if (!ret && host->ops->enable_dma)
2936			ret = host->ops->enable_dma(host);
2937
2938		if (ret) {
2939			pr_warn("%s: No suitable DMA available - falling back to PIO\n",
2940				mmc_hostname(mmc));
2941			host->flags &= ~(SDHCI_USE_SDMA | SDHCI_USE_ADMA);
2942
2943			ret = 0;
2944		}
2945	}
2946
2947	/* SDMA does not support 64-bit DMA */
2948	if (host->flags & SDHCI_USE_64_BIT_DMA)
2949		host->flags &= ~SDHCI_USE_SDMA;
2950
2951	if (host->flags & SDHCI_USE_ADMA) {
2952		dma_addr_t dma;
2953		void *buf;
2954
2955		/*
2956		 * The DMA descriptor table size is calculated as the maximum
2957		 * number of segments times 2, to allow for an alignment
2958		 * descriptor for each segment, plus 1 for a nop end descriptor,
2959		 * all multipled by the descriptor size.
2960		 */
2961		if (host->flags & SDHCI_USE_64_BIT_DMA) {
2962			host->adma_table_sz = (SDHCI_MAX_SEGS * 2 + 1) *
2963					      SDHCI_ADMA2_64_DESC_SZ;
2964			host->desc_sz = SDHCI_ADMA2_64_DESC_SZ;
2965		} else {
2966			host->adma_table_sz = (SDHCI_MAX_SEGS * 2 + 1) *
2967					      SDHCI_ADMA2_32_DESC_SZ;
2968			host->desc_sz = SDHCI_ADMA2_32_DESC_SZ;
2969		}
2970
2971		host->align_buffer_sz = SDHCI_MAX_SEGS * SDHCI_ADMA2_ALIGN;
2972		buf = dma_alloc_coherent(mmc_dev(mmc), host->align_buffer_sz +
2973					 host->adma_table_sz, &dma, GFP_KERNEL);
2974		if (!buf) {
2975			pr_warn("%s: Unable to allocate ADMA buffers - falling back to standard DMA\n",
2976				mmc_hostname(mmc));
2977			host->flags &= ~SDHCI_USE_ADMA;
2978		} else if ((dma + host->align_buffer_sz) &
2979			   (SDHCI_ADMA2_DESC_ALIGN - 1)) {
2980			pr_warn("%s: unable to allocate aligned ADMA descriptor\n",
2981				mmc_hostname(mmc));
2982			host->flags &= ~SDHCI_USE_ADMA;
2983			dma_free_coherent(mmc_dev(mmc), host->align_buffer_sz +
2984					  host->adma_table_sz, buf, dma);
2985		} else {
2986			host->align_buffer = buf;
2987			host->align_addr = dma;
2988
2989			host->adma_table = buf + host->align_buffer_sz;
2990			host->adma_addr = dma + host->align_buffer_sz;
2991		}
2992	}
2993
2994	/*
2995	 * If we use DMA, then it's up to the caller to set the DMA
2996	 * mask, but PIO does not need the hw shim so we set a new
2997	 * mask here in that case.
2998	 */
2999	if (!(host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA))) {
3000		host->dma_mask = DMA_BIT_MASK(64);
3001		mmc_dev(mmc)->dma_mask = &host->dma_mask;
3002	}
3003
3004	if (host->version >= SDHCI_SPEC_300)
3005		host->max_clk = (caps[0] & SDHCI_CLOCK_V3_BASE_MASK)
3006			>> SDHCI_CLOCK_BASE_SHIFT;
3007	else
3008		host->max_clk = (caps[0] & SDHCI_CLOCK_BASE_MASK)
3009			>> SDHCI_CLOCK_BASE_SHIFT;
3010
3011	host->max_clk *= 1000000;
3012	if (host->max_clk == 0 || host->quirks &
3013			SDHCI_QUIRK_CAP_CLOCK_BASE_BROKEN) {
3014		if (!host->ops->get_max_clock) {
3015			pr_err("%s: Hardware doesn't specify base clock frequency.\n",
3016			       mmc_hostname(mmc));
3017			return -ENODEV;
3018		}
3019		host->max_clk = host->ops->get_max_clock(host);
3020	}
3021
3022	/*
3023	 * In case of Host Controller v3.00, find out whether clock
3024	 * multiplier is supported.
3025	 */
3026	host->clk_mul = (caps[1] & SDHCI_CLOCK_MUL_MASK) >>
3027			SDHCI_CLOCK_MUL_SHIFT;
3028
3029	/*
3030	 * In case the value in Clock Multiplier is 0, then programmable
3031	 * clock mode is not supported, otherwise the actual clock
3032	 * multiplier is one more than the value of Clock Multiplier
3033	 * in the Capabilities Register.
3034	 */
3035	if (host->clk_mul)
3036		host->clk_mul += 1;
3037
3038	/*
3039	 * Set host parameters.
3040	 */
3041	max_clk = host->max_clk;
3042
3043	if (host->ops->get_min_clock)
3044		mmc->f_min = host->ops->get_min_clock(host);
3045	else if (host->version >= SDHCI_SPEC_300) {
3046		if (host->clk_mul) {
3047			mmc->f_min = (host->max_clk * host->clk_mul) / 1024;
3048			max_clk = host->max_clk * host->clk_mul;
3049		} else
3050			mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_300;
3051	} else
3052		mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_200;
3053
3054	if (!mmc->f_max || (mmc->f_max && (mmc->f_max > max_clk)))
3055		mmc->f_max = max_clk;
3056
3057	if (!(host->quirks & SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK)) {
3058		host->timeout_clk = (caps[0] & SDHCI_TIMEOUT_CLK_MASK) >>
3059					SDHCI_TIMEOUT_CLK_SHIFT;
3060		if (host->timeout_clk == 0) {
3061			if (host->ops->get_timeout_clock) {
3062				host->timeout_clk =
3063					host->ops->get_timeout_clock(host);
3064			} else {
3065				pr_err("%s: Hardware doesn't specify timeout clock frequency.\n",
3066					mmc_hostname(mmc));
3067				return -ENODEV;
3068			}
3069		}
 
 
 
3070
3071		if (caps[0] & SDHCI_TIMEOUT_CLK_UNIT)
3072			host->timeout_clk *= 1000;
3073
3074		if (override_timeout_clk)
3075			host->timeout_clk = override_timeout_clk;
3076
3077		mmc->max_busy_timeout = host->ops->get_max_timeout_count ?
3078			host->ops->get_max_timeout_count(host) : 1 << 27;
3079		mmc->max_busy_timeout /= host->timeout_clk;
3080	}
3081
3082	mmc->caps |= MMC_CAP_SDIO_IRQ | MMC_CAP_ERASE | MMC_CAP_CMD23;
3083	mmc->caps2 |= MMC_CAP2_SDIO_IRQ_NOTHREAD;
3084
3085	if (host->quirks & SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12)
3086		host->flags |= SDHCI_AUTO_CMD12;
3087
3088	/* Auto-CMD23 stuff only works in ADMA or PIO. */
3089	if ((host->version >= SDHCI_SPEC_300) &&
3090	    ((host->flags & SDHCI_USE_ADMA) ||
3091	     !(host->flags & SDHCI_USE_SDMA)) &&
3092	     !(host->quirks2 & SDHCI_QUIRK2_ACMD23_BROKEN)) {
3093		host->flags |= SDHCI_AUTO_CMD23;
3094		DBG("%s: Auto-CMD23 available\n", mmc_hostname(mmc));
3095	} else {
3096		DBG("%s: Auto-CMD23 unavailable\n", mmc_hostname(mmc));
3097	}
3098
3099	/*
3100	 * A controller may support 8-bit width, but the board itself
3101	 * might not have the pins brought out.  Boards that support
3102	 * 8-bit width must set "mmc->caps |= MMC_CAP_8_BIT_DATA;" in
3103	 * their platform code before calling sdhci_add_host(), and we
3104	 * won't assume 8-bit width for hosts without that CAP.
3105	 */
3106	if (!(host->quirks & SDHCI_QUIRK_FORCE_1_BIT_DATA))
3107		mmc->caps |= MMC_CAP_4_BIT_DATA;
3108
3109	if (host->quirks2 & SDHCI_QUIRK2_HOST_NO_CMD23)
3110		mmc->caps &= ~MMC_CAP_CMD23;
3111
3112	if (caps[0] & SDHCI_CAN_DO_HISPD)
3113		mmc->caps |= MMC_CAP_SD_HIGHSPEED | MMC_CAP_MMC_HIGHSPEED;
3114
3115	if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) &&
3116	    !(mmc->caps & MMC_CAP_NONREMOVABLE) &&
3117	    IS_ERR_VALUE(mmc_gpio_get_cd(host->mmc)))
3118		mmc->caps |= MMC_CAP_NEEDS_POLL;
3119
3120	/* If there are external regulators, get them */
3121	if (mmc_regulator_get_supply(mmc) == -EPROBE_DEFER)
3122		return -EPROBE_DEFER;
3123
3124	/* If vqmmc regulator and no 1.8V signalling, then there's no UHS */
3125	if (!IS_ERR(mmc->supply.vqmmc)) {
3126		ret = regulator_enable(mmc->supply.vqmmc);
3127		if (!regulator_is_supported_voltage(mmc->supply.vqmmc, 1700000,
3128						    1950000))
 
 
 
 
 
 
 
3129			caps[1] &= ~(SDHCI_SUPPORT_SDR104 |
3130					SDHCI_SUPPORT_SDR50 |
3131					SDHCI_SUPPORT_DDR50);
3132		if (ret) {
3133			pr_warn("%s: Failed to enable vqmmc regulator: %d\n",
3134				mmc_hostname(mmc), ret);
3135			mmc->supply.vqmmc = ERR_PTR(-EINVAL);
3136		}
3137	}
3138
3139	if (host->quirks2 & SDHCI_QUIRK2_NO_1_8_V)
3140		caps[1] &= ~(SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
3141		       SDHCI_SUPPORT_DDR50);
3142
3143	/* Any UHS-I mode in caps implies SDR12 and SDR25 support. */
3144	if (caps[1] & (SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
3145		       SDHCI_SUPPORT_DDR50))
3146		mmc->caps |= MMC_CAP_UHS_SDR12 | MMC_CAP_UHS_SDR25;
3147
3148	/* SDR104 supports also implies SDR50 support */
3149	if (caps[1] & SDHCI_SUPPORT_SDR104) {
3150		mmc->caps |= MMC_CAP_UHS_SDR104 | MMC_CAP_UHS_SDR50;
3151		/* SD3.0: SDR104 is supported so (for eMMC) the caps2
3152		 * field can be promoted to support HS200.
3153		 */
3154		if (!(host->quirks2 & SDHCI_QUIRK2_BROKEN_HS200))
3155			mmc->caps2 |= MMC_CAP2_HS200;
3156	} else if (caps[1] & SDHCI_SUPPORT_SDR50)
3157		mmc->caps |= MMC_CAP_UHS_SDR50;
3158
3159	if (host->quirks2 & SDHCI_QUIRK2_CAPS_BIT63_FOR_HS400 &&
3160	    (caps[1] & SDHCI_SUPPORT_HS400))
3161		mmc->caps2 |= MMC_CAP2_HS400;
3162
3163	if ((mmc->caps2 & MMC_CAP2_HSX00_1_2V) &&
3164	    (IS_ERR(mmc->supply.vqmmc) ||
3165	     !regulator_is_supported_voltage(mmc->supply.vqmmc, 1100000,
3166					     1300000)))
3167		mmc->caps2 &= ~MMC_CAP2_HSX00_1_2V;
3168
3169	if ((caps[1] & SDHCI_SUPPORT_DDR50) &&
3170		!(host->quirks2 & SDHCI_QUIRK2_BROKEN_DDR50))
3171		mmc->caps |= MMC_CAP_UHS_DDR50;
3172
3173	/* Does the host need tuning for SDR50? */
3174	if (caps[1] & SDHCI_USE_SDR50_TUNING)
3175		host->flags |= SDHCI_SDR50_NEEDS_TUNING;
3176
3177	/* Does the host need tuning for SDR104 / HS200? */
3178	if (mmc->caps2 & MMC_CAP2_HS200)
3179		host->flags |= SDHCI_SDR104_NEEDS_TUNING;
3180
3181	/* Driver Type(s) (A, C, D) supported by the host */
3182	if (caps[1] & SDHCI_DRIVER_TYPE_A)
3183		mmc->caps |= MMC_CAP_DRIVER_TYPE_A;
3184	if (caps[1] & SDHCI_DRIVER_TYPE_C)
3185		mmc->caps |= MMC_CAP_DRIVER_TYPE_C;
3186	if (caps[1] & SDHCI_DRIVER_TYPE_D)
3187		mmc->caps |= MMC_CAP_DRIVER_TYPE_D;
3188
3189	/* Initial value for re-tuning timer count */
3190	host->tuning_count = (caps[1] & SDHCI_RETUNING_TIMER_COUNT_MASK) >>
3191			      SDHCI_RETUNING_TIMER_COUNT_SHIFT;
3192
3193	/*
3194	 * In case Re-tuning Timer is not disabled, the actual value of
3195	 * re-tuning timer will be 2 ^ (n - 1).
3196	 */
3197	if (host->tuning_count)
3198		host->tuning_count = 1 << (host->tuning_count - 1);
3199
3200	/* Re-tuning mode supported by the Host Controller */
3201	host->tuning_mode = (caps[1] & SDHCI_RETUNING_MODE_MASK) >>
3202			     SDHCI_RETUNING_MODE_SHIFT;
3203
3204	ocr_avail = 0;
3205
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
3206	/*
3207	 * According to SD Host Controller spec v3.00, if the Host System
3208	 * can afford more than 150mA, Host Driver should set XPC to 1. Also
3209	 * the value is meaningful only if Voltage Support in the Capabilities
3210	 * register is set. The actual current value is 4 times the register
3211	 * value.
3212	 */
3213	max_current_caps = sdhci_readl(host, SDHCI_MAX_CURRENT);
3214	if (!max_current_caps && !IS_ERR(mmc->supply.vmmc)) {
3215		int curr = regulator_get_current_limit(mmc->supply.vmmc);
3216		if (curr > 0) {
3217
3218			/* convert to SDHCI_MAX_CURRENT format */
3219			curr = curr/1000;  /* convert to mA */
3220			curr = curr/SDHCI_MAX_CURRENT_MULTIPLIER;
3221
3222			curr = min_t(u32, curr, SDHCI_MAX_CURRENT_LIMIT);
3223			max_current_caps =
3224				(curr << SDHCI_MAX_CURRENT_330_SHIFT) |
3225				(curr << SDHCI_MAX_CURRENT_300_SHIFT) |
3226				(curr << SDHCI_MAX_CURRENT_180_SHIFT);
3227		}
3228	}
3229
3230	if (caps[0] & SDHCI_CAN_VDD_330) {
3231		ocr_avail |= MMC_VDD_32_33 | MMC_VDD_33_34;
3232
3233		mmc->max_current_330 = ((max_current_caps &
3234				   SDHCI_MAX_CURRENT_330_MASK) >>
3235				   SDHCI_MAX_CURRENT_330_SHIFT) *
3236				   SDHCI_MAX_CURRENT_MULTIPLIER;
3237	}
3238	if (caps[0] & SDHCI_CAN_VDD_300) {
3239		ocr_avail |= MMC_VDD_29_30 | MMC_VDD_30_31;
3240
3241		mmc->max_current_300 = ((max_current_caps &
3242				   SDHCI_MAX_CURRENT_300_MASK) >>
3243				   SDHCI_MAX_CURRENT_300_SHIFT) *
3244				   SDHCI_MAX_CURRENT_MULTIPLIER;
3245	}
3246	if (caps[0] & SDHCI_CAN_VDD_180) {
3247		ocr_avail |= MMC_VDD_165_195;
3248
3249		mmc->max_current_180 = ((max_current_caps &
3250				   SDHCI_MAX_CURRENT_180_MASK) >>
3251				   SDHCI_MAX_CURRENT_180_SHIFT) *
3252				   SDHCI_MAX_CURRENT_MULTIPLIER;
3253	}
3254
3255	/* If OCR set by host, use it instead. */
3256	if (host->ocr_mask)
3257		ocr_avail = host->ocr_mask;
3258
3259	/* If OCR set by external regulators, give it highest prio. */
3260	if (mmc->ocr_avail)
3261		ocr_avail = mmc->ocr_avail;
3262
3263	mmc->ocr_avail = ocr_avail;
3264	mmc->ocr_avail_sdio = ocr_avail;
3265	if (host->ocr_avail_sdio)
3266		mmc->ocr_avail_sdio &= host->ocr_avail_sdio;
3267	mmc->ocr_avail_sd = ocr_avail;
3268	if (host->ocr_avail_sd)
3269		mmc->ocr_avail_sd &= host->ocr_avail_sd;
3270	else /* normal SD controllers don't support 1.8V */
3271		mmc->ocr_avail_sd &= ~MMC_VDD_165_195;
3272	mmc->ocr_avail_mmc = ocr_avail;
3273	if (host->ocr_avail_mmc)
3274		mmc->ocr_avail_mmc &= host->ocr_avail_mmc;
3275
3276	if (mmc->ocr_avail == 0) {
3277		pr_err("%s: Hardware doesn't report any support voltages.\n",
3278		       mmc_hostname(mmc));
3279		return -ENODEV;
3280	}
3281
3282	spin_lock_init(&host->lock);
3283
3284	/*
3285	 * Maximum number of segments. Depends on if the hardware
3286	 * can do scatter/gather or not.
3287	 */
3288	if (host->flags & SDHCI_USE_ADMA)
3289		mmc->max_segs = SDHCI_MAX_SEGS;
3290	else if (host->flags & SDHCI_USE_SDMA)
3291		mmc->max_segs = 1;
3292	else /* PIO */
3293		mmc->max_segs = SDHCI_MAX_SEGS;
3294
3295	/*
3296	 * Maximum number of sectors in one transfer. Limited by SDMA boundary
3297	 * size (512KiB). Note some tuning modes impose a 4MiB limit, but this
3298	 * is less anyway.
3299	 */
3300	mmc->max_req_size = 524288;
3301
3302	/*
3303	 * Maximum segment size. Could be one segment with the maximum number
3304	 * of bytes. When doing hardware scatter/gather, each entry cannot
3305	 * be larger than 64 KiB though.
3306	 */
3307	if (host->flags & SDHCI_USE_ADMA) {
3308		if (host->quirks & SDHCI_QUIRK_BROKEN_ADMA_ZEROLEN_DESC)
3309			mmc->max_seg_size = 65535;
3310		else
3311			mmc->max_seg_size = 65536;
3312	} else {
3313		mmc->max_seg_size = mmc->max_req_size;
3314	}
3315
3316	/*
3317	 * Maximum block size. This varies from controller to controller and
3318	 * is specified in the capabilities register.
3319	 */
3320	if (host->quirks & SDHCI_QUIRK_FORCE_BLK_SZ_2048) {
3321		mmc->max_blk_size = 2;
3322	} else {
3323		mmc->max_blk_size = (caps[0] & SDHCI_MAX_BLOCK_MASK) >>
3324				SDHCI_MAX_BLOCK_SHIFT;
3325		if (mmc->max_blk_size >= 3) {
3326			pr_warn("%s: Invalid maximum block size, assuming 512 bytes\n",
3327				mmc_hostname(mmc));
3328			mmc->max_blk_size = 0;
3329		}
3330	}
3331
3332	mmc->max_blk_size = 512 << mmc->max_blk_size;
3333
3334	/*
3335	 * Maximum block count.
3336	 */
3337	mmc->max_blk_count = (host->quirks & SDHCI_QUIRK_NO_MULTIBLOCK) ? 1 : 65535;
3338
3339	/*
3340	 * Init tasklets.
3341	 */
 
 
3342	tasklet_init(&host->finish_tasklet,
3343		sdhci_tasklet_finish, (unsigned long)host);
3344
3345	setup_timer(&host->timer, sdhci_timeout_timer, (unsigned long)host);
3346
3347	init_waitqueue_head(&host->buf_ready_int);
 
 
 
 
 
 
 
3348
3349	sdhci_init(host, 0);
3350
3351	ret = request_threaded_irq(host->irq, sdhci_irq, sdhci_thread_irq,
3352				   IRQF_SHARED,	mmc_hostname(mmc), host);
3353	if (ret) {
3354		pr_err("%s: Failed to request IRQ %d: %d\n",
3355		       mmc_hostname(mmc), host->irq, ret);
3356		goto untasklet;
3357	}
3358
3359#ifdef CONFIG_MMC_DEBUG
3360	sdhci_dumpregs(host);
3361#endif
3362
3363#ifdef SDHCI_USE_LEDS_CLASS
3364	snprintf(host->led_name, sizeof(host->led_name),
3365		"%s::", mmc_hostname(mmc));
3366	host->led.name = host->led_name;
3367	host->led.brightness = LED_OFF;
3368	host->led.default_trigger = mmc_hostname(mmc);
3369	host->led.brightness_set = sdhci_led_control;
3370
3371	ret = led_classdev_register(mmc_dev(mmc), &host->led);
3372	if (ret) {
3373		pr_err("%s: Failed to register LED device: %d\n",
3374		       mmc_hostname(mmc), ret);
3375		goto reset;
3376	}
3377#endif
3378
3379	mmiowb();
3380
3381	mmc_add_host(mmc);
3382
3383	pr_info("%s: SDHCI controller on %s [%s] using %s\n",
3384		mmc_hostname(mmc), host->hw_name, dev_name(mmc_dev(mmc)),
3385		(host->flags & SDHCI_USE_ADMA) ?
3386		(host->flags & SDHCI_USE_64_BIT_DMA) ? "ADMA 64-bit" : "ADMA" :
3387		(host->flags & SDHCI_USE_SDMA) ? "DMA" : "PIO");
3388
3389	sdhci_enable_card_detection(host);
3390
3391	return 0;
3392
3393#ifdef SDHCI_USE_LEDS_CLASS
3394reset:
3395	sdhci_do_reset(host, SDHCI_RESET_ALL);
3396	sdhci_writel(host, 0, SDHCI_INT_ENABLE);
3397	sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
3398	free_irq(host->irq, host);
3399#endif
3400untasklet:
 
3401	tasklet_kill(&host->finish_tasklet);
3402
3403	return ret;
3404}
3405
3406EXPORT_SYMBOL_GPL(sdhci_add_host);
3407
3408void sdhci_remove_host(struct sdhci_host *host, int dead)
3409{
3410	struct mmc_host *mmc = host->mmc;
3411	unsigned long flags;
3412
3413	if (dead) {
3414		spin_lock_irqsave(&host->lock, flags);
3415
3416		host->flags |= SDHCI_DEVICE_DEAD;
3417
3418		if (host->mrq) {
3419			pr_err("%s: Controller removed during "
3420				" transfer!\n", mmc_hostname(mmc));
3421
3422			host->mrq->cmd->error = -ENOMEDIUM;
3423			tasklet_schedule(&host->finish_tasklet);
3424		}
3425
3426		spin_unlock_irqrestore(&host->lock, flags);
3427	}
3428
3429	sdhci_disable_card_detection(host);
3430
3431	mmc_remove_host(mmc);
3432
3433#ifdef SDHCI_USE_LEDS_CLASS
3434	led_classdev_unregister(&host->led);
3435#endif
3436
3437	if (!dead)
3438		sdhci_do_reset(host, SDHCI_RESET_ALL);
3439
3440	sdhci_writel(host, 0, SDHCI_INT_ENABLE);
3441	sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
3442	free_irq(host->irq, host);
3443
3444	del_timer_sync(&host->timer);
3445
 
3446	tasklet_kill(&host->finish_tasklet);
3447
3448	if (!IS_ERR(mmc->supply.vqmmc))
3449		regulator_disable(mmc->supply.vqmmc);
 
 
 
 
 
 
 
3450
3451	if (host->align_buffer)
3452		dma_free_coherent(mmc_dev(mmc), host->align_buffer_sz +
3453				  host->adma_table_sz, host->align_buffer,
3454				  host->align_addr);
3455
3456	host->adma_table = NULL;
3457	host->align_buffer = NULL;
3458}
3459
3460EXPORT_SYMBOL_GPL(sdhci_remove_host);
3461
3462void sdhci_free_host(struct sdhci_host *host)
3463{
3464	mmc_free_host(host->mmc);
3465}
3466
3467EXPORT_SYMBOL_GPL(sdhci_free_host);
3468
3469/*****************************************************************************\
3470 *                                                                           *
3471 * Driver init/exit                                                          *
3472 *                                                                           *
3473\*****************************************************************************/
3474
3475static int __init sdhci_drv_init(void)
3476{
3477	pr_info(DRIVER_NAME
3478		": Secure Digital Host Controller Interface driver\n");
3479	pr_info(DRIVER_NAME ": Copyright(c) Pierre Ossman\n");
3480
3481	return 0;
3482}
3483
3484static void __exit sdhci_drv_exit(void)
3485{
3486}
3487
3488module_init(sdhci_drv_init);
3489module_exit(sdhci_drv_exit);
3490
3491module_param(debug_quirks, uint, 0444);
3492module_param(debug_quirks2, uint, 0444);
3493
3494MODULE_AUTHOR("Pierre Ossman <pierre@ossman.eu>");
3495MODULE_DESCRIPTION("Secure Digital Host Controller Interface core driver");
3496MODULE_LICENSE("GPL");
3497
3498MODULE_PARM_DESC(debug_quirks, "Force certain quirks.");
3499MODULE_PARM_DESC(debug_quirks2, "Force certain other quirks.");
v3.15
   1/*
   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 * it under the terms of the GNU General Public License as published by
   8 * the Free Software Foundation; either version 2 of the License, or (at
   9 * your option) any later version.
  10 *
  11 * Thanks to the following companies for their support:
  12 *
  13 *     - JMicron (hardware and technical support)
  14 */
  15
  16#include <linux/delay.h>
  17#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>
  23#include <linux/regulator/consumer.h>
  24#include <linux/pm_runtime.h>
  25
  26#include <linux/leds.h>
  27
  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#include "sdhci.h"
  34
  35#define DRIVER_NAME "sdhci"
  36
  37#define DBG(f, x...) \
  38	pr_debug(DRIVER_NAME " [%s()]: " f, __func__,## x)
  39
  40#if defined(CONFIG_LEDS_CLASS) || (defined(CONFIG_LEDS_CLASS_MODULE) && \
  41	defined(CONFIG_MMC_SDHCI_MODULE))
  42#define SDHCI_USE_LEDS_CLASS
  43#endif
  44
  45#define MAX_TUNING_LOOP 40
  46
  47static unsigned int debug_quirks = 0;
  48static unsigned int debug_quirks2;
  49
  50static void sdhci_finish_data(struct sdhci_host *);
  51
  52static void sdhci_finish_command(struct sdhci_host *);
  53static int sdhci_execute_tuning(struct mmc_host *mmc, u32 opcode);
  54static void sdhci_tuning_timer(unsigned long data);
  55static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable);
 
  56
  57#ifdef CONFIG_PM_RUNTIME
  58static int sdhci_runtime_pm_get(struct sdhci_host *host);
  59static int sdhci_runtime_pm_put(struct sdhci_host *host);
  60static void sdhci_runtime_pm_bus_on(struct sdhci_host *host);
  61static void sdhci_runtime_pm_bus_off(struct sdhci_host *host);
  62#else
  63static inline int sdhci_runtime_pm_get(struct sdhci_host *host)
  64{
  65	return 0;
  66}
  67static inline int sdhci_runtime_pm_put(struct sdhci_host *host)
  68{
  69	return 0;
  70}
  71static void sdhci_runtime_pm_bus_on(struct sdhci_host *host)
  72{
  73}
  74static void sdhci_runtime_pm_bus_off(struct sdhci_host *host)
  75{
  76}
  77#endif
  78
  79static void sdhci_dumpregs(struct sdhci_host *host)
  80{
  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		sdhci_readl(host, SDHCI_DMA_ADDRESS),
  86		sdhci_readw(host, SDHCI_HOST_VERSION));
  87	pr_debug(DRIVER_NAME ": Blk size: 0x%08x | Blk cnt:  0x%08x\n",
  88		sdhci_readw(host, SDHCI_BLOCK_SIZE),
  89		sdhci_readw(host, SDHCI_BLOCK_COUNT));
  90	pr_debug(DRIVER_NAME ": Argument: 0x%08x | Trn mode: 0x%08x\n",
  91		sdhci_readl(host, SDHCI_ARGUMENT),
  92		sdhci_readw(host, SDHCI_TRANSFER_MODE));
  93	pr_debug(DRIVER_NAME ": Present:  0x%08x | Host ctl: 0x%08x\n",
  94		sdhci_readl(host, SDHCI_PRESENT_STATE),
  95		sdhci_readb(host, SDHCI_HOST_CONTROL));
  96	pr_debug(DRIVER_NAME ": Power:    0x%08x | Blk gap:  0x%08x\n",
  97		sdhci_readb(host, SDHCI_POWER_CONTROL),
  98		sdhci_readb(host, SDHCI_BLOCK_GAP_CONTROL));
  99	pr_debug(DRIVER_NAME ": Wake-up:  0x%08x | Clock:    0x%08x\n",
 100		sdhci_readb(host, SDHCI_WAKE_UP_CONTROL),
 101		sdhci_readw(host, SDHCI_CLOCK_CONTROL));
 102	pr_debug(DRIVER_NAME ": Timeout:  0x%08x | Int stat: 0x%08x\n",
 103		sdhci_readb(host, SDHCI_TIMEOUT_CONTROL),
 104		sdhci_readl(host, SDHCI_INT_STATUS));
 105	pr_debug(DRIVER_NAME ": Int enab: 0x%08x | Sig enab: 0x%08x\n",
 106		sdhci_readl(host, SDHCI_INT_ENABLE),
 107		sdhci_readl(host, SDHCI_SIGNAL_ENABLE));
 108	pr_debug(DRIVER_NAME ": AC12 err: 0x%08x | Slot int: 0x%08x\n",
 109		sdhci_readw(host, SDHCI_ACMD12_ERR),
 110		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	if (host->flags & SDHCI_USE_ADMA)
 121		pr_debug(DRIVER_NAME ": ADMA Err: 0x%08x | ADMA Ptr: 0x%08x\n",
 122		       readl(host->ioaddr + SDHCI_ADMA_ERROR),
 123		       readl(host->ioaddr + SDHCI_ADMA_ADDRESS));
 
 
 
 
 
 
 
 124
 125	pr_debug(DRIVER_NAME ": ===========================================\n");
 126}
 127
 128/*****************************************************************************\
 129 *                                                                           *
 130 * Low level functions                                                       *
 131 *                                                                           *
 132\*****************************************************************************/
 133
 134static void sdhci_clear_set_irqs(struct sdhci_host *host, u32 clear, u32 set)
 135{
 136	u32 ier;
 137
 138	ier = sdhci_readl(host, SDHCI_INT_ENABLE);
 139	ier &= ~clear;
 140	ier |= set;
 141	sdhci_writel(host, ier, SDHCI_INT_ENABLE);
 142	sdhci_writel(host, ier, SDHCI_SIGNAL_ENABLE);
 143}
 144
 145static void sdhci_unmask_irqs(struct sdhci_host *host, u32 irqs)
 146{
 147	sdhci_clear_set_irqs(host, 0, irqs);
 148}
 149
 150static void sdhci_mask_irqs(struct sdhci_host *host, u32 irqs)
 151{
 152	sdhci_clear_set_irqs(host, irqs, 0);
 153}
 154
 155static void sdhci_set_card_detection(struct sdhci_host *host, bool enable)
 156{
 157	u32 present, irqs;
 158
 159	if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) ||
 160	    (host->mmc->caps & MMC_CAP_NONREMOVABLE))
 161		return;
 162
 163	present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
 164			      SDHCI_CARD_PRESENT;
 165	irqs = present ? SDHCI_INT_CARD_REMOVE : SDHCI_INT_CARD_INSERT;
 166
 167	if (enable)
 168		sdhci_unmask_irqs(host, irqs);
 169	else
 170		sdhci_mask_irqs(host, irqs);
 
 
 
 
 171}
 172
 173static void sdhci_enable_card_detection(struct sdhci_host *host)
 174{
 175	sdhci_set_card_detection(host, true);
 176}
 177
 178static void sdhci_disable_card_detection(struct sdhci_host *host)
 179{
 180	sdhci_set_card_detection(host, false);
 181}
 182
 183static void sdhci_reset(struct sdhci_host *host, u8 mask)
 184{
 185	unsigned long timeout;
 186	u32 uninitialized_var(ier);
 187
 188	if (host->quirks & SDHCI_QUIRK_NO_CARD_NO_RESET) {
 189		if (!(sdhci_readl(host, SDHCI_PRESENT_STATE) &
 190			SDHCI_CARD_PRESENT))
 191			return;
 192	}
 193
 194	if (host->quirks & SDHCI_QUIRK_RESTORE_IRQS_AFTER_RESET)
 195		ier = sdhci_readl(host, SDHCI_INT_ENABLE);
 196
 197	if (host->ops->platform_reset_enter)
 198		host->ops->platform_reset_enter(host, mask);
 199
 200	sdhci_writeb(host, mask, SDHCI_SOFTWARE_RESET);
 201
 202	if (mask & SDHCI_RESET_ALL) {
 203		host->clock = 0;
 204		/* Reset-all turns off SD Bus Power */
 205		if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
 206			sdhci_runtime_pm_bus_off(host);
 207	}
 208
 209	/* Wait max 100 ms */
 210	timeout = 100;
 211
 212	/* hw clears the bit when it's done */
 213	while (sdhci_readb(host, SDHCI_SOFTWARE_RESET) & mask) {
 214		if (timeout == 0) {
 215			pr_err("%s: Reset 0x%x never completed.\n",
 216				mmc_hostname(host->mmc), (int)mask);
 217			sdhci_dumpregs(host);
 218			return;
 219		}
 220		timeout--;
 221		mdelay(1);
 222	}
 
 
 
 
 
 
 
 
 
 223
 224	if (host->ops->platform_reset_exit)
 225		host->ops->platform_reset_exit(host, mask);
 226
 227	if (host->quirks & SDHCI_QUIRK_RESTORE_IRQS_AFTER_RESET)
 228		sdhci_clear_set_irqs(host, SDHCI_INT_ALL_MASK, ier);
 
 
 
 229
 230	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
 231		if ((host->ops->enable_dma) && (mask & SDHCI_RESET_ALL))
 232			host->ops->enable_dma(host);
 233	}
 234}
 235
 236static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios);
 237
 238static void sdhci_init(struct sdhci_host *host, int soft)
 239{
 240	if (soft)
 241		sdhci_reset(host, SDHCI_RESET_CMD|SDHCI_RESET_DATA);
 242	else
 243		sdhci_reset(host, SDHCI_RESET_ALL);
 
 
 
 
 
 
 244
 245	sdhci_clear_set_irqs(host, SDHCI_INT_ALL_MASK,
 246		SDHCI_INT_BUS_POWER | SDHCI_INT_DATA_END_BIT |
 247		SDHCI_INT_DATA_CRC | SDHCI_INT_DATA_TIMEOUT | SDHCI_INT_INDEX |
 248		SDHCI_INT_END_BIT | SDHCI_INT_CRC | SDHCI_INT_TIMEOUT |
 249		SDHCI_INT_DATA_END | SDHCI_INT_RESPONSE);
 250
 251	if (soft) {
 252		/* force clock reconfiguration */
 253		host->clock = 0;
 254		sdhci_set_ios(host->mmc, &host->mmc->ios);
 255	}
 256}
 257
 258static void sdhci_reinit(struct sdhci_host *host)
 259{
 260	sdhci_init(host, 0);
 261	/*
 262	 * Retuning stuffs are affected by different cards inserted and only
 263	 * applicable to UHS-I cards. So reset these fields to their initial
 264	 * value when card is removed.
 265	 */
 266	if (host->flags & SDHCI_USING_RETUNING_TIMER) {
 267		host->flags &= ~SDHCI_USING_RETUNING_TIMER;
 268
 269		del_timer_sync(&host->tuning_timer);
 270		host->flags &= ~SDHCI_NEEDS_RETUNING;
 271		host->mmc->max_blk_count =
 272			(host->quirks & SDHCI_QUIRK_NO_MULTIBLOCK) ? 1 : 65535;
 273	}
 274	sdhci_enable_card_detection(host);
 275}
 276
 277static void sdhci_activate_led(struct sdhci_host *host)
 278{
 279	u8 ctrl;
 280
 281	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
 282	ctrl |= SDHCI_CTRL_LED;
 283	sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
 284}
 285
 286static void sdhci_deactivate_led(struct sdhci_host *host)
 287{
 288	u8 ctrl;
 289
 290	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
 291	ctrl &= ~SDHCI_CTRL_LED;
 292	sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
 293}
 294
 295#ifdef SDHCI_USE_LEDS_CLASS
 296static void sdhci_led_control(struct led_classdev *led,
 297	enum led_brightness brightness)
 298{
 299	struct sdhci_host *host = container_of(led, struct sdhci_host, led);
 300	unsigned long flags;
 301
 302	spin_lock_irqsave(&host->lock, flags);
 303
 304	if (host->runtime_suspended)
 305		goto out;
 306
 307	if (brightness == LED_OFF)
 308		sdhci_deactivate_led(host);
 309	else
 310		sdhci_activate_led(host);
 311out:
 312	spin_unlock_irqrestore(&host->lock, flags);
 313}
 314#endif
 315
 316/*****************************************************************************\
 317 *                                                                           *
 318 * Core functions                                                            *
 319 *                                                                           *
 320\*****************************************************************************/
 321
 322static void sdhci_read_block_pio(struct sdhci_host *host)
 323{
 324	unsigned long flags;
 325	size_t blksize, len, chunk;
 326	u32 uninitialized_var(scratch);
 327	u8 *buf;
 328
 329	DBG("PIO reading\n");
 330
 331	blksize = host->data->blksz;
 332	chunk = 0;
 333
 334	local_irq_save(flags);
 335
 336	while (blksize) {
 337		if (!sg_miter_next(&host->sg_miter))
 338			BUG();
 339
 340		len = min(host->sg_miter.length, blksize);
 341
 342		blksize -= len;
 343		host->sg_miter.consumed = len;
 344
 345		buf = host->sg_miter.addr;
 346
 347		while (len) {
 348			if (chunk == 0) {
 349				scratch = sdhci_readl(host, SDHCI_BUFFER);
 350				chunk = 4;
 351			}
 352
 353			*buf = scratch & 0xFF;
 354
 355			buf++;
 356			scratch >>= 8;
 357			chunk--;
 358			len--;
 359		}
 360	}
 361
 362	sg_miter_stop(&host->sg_miter);
 363
 364	local_irq_restore(flags);
 365}
 366
 367static void sdhci_write_block_pio(struct sdhci_host *host)
 368{
 369	unsigned long flags;
 370	size_t blksize, len, chunk;
 371	u32 scratch;
 372	u8 *buf;
 373
 374	DBG("PIO writing\n");
 375
 376	blksize = host->data->blksz;
 377	chunk = 0;
 378	scratch = 0;
 379
 380	local_irq_save(flags);
 381
 382	while (blksize) {
 383		if (!sg_miter_next(&host->sg_miter))
 384			BUG();
 385
 386		len = min(host->sg_miter.length, blksize);
 387
 388		blksize -= len;
 389		host->sg_miter.consumed = len;
 390
 391		buf = host->sg_miter.addr;
 392
 393		while (len) {
 394			scratch |= (u32)*buf << (chunk * 8);
 395
 396			buf++;
 397			chunk++;
 398			len--;
 399
 400			if ((chunk == 4) || ((len == 0) && (blksize == 0))) {
 401				sdhci_writel(host, scratch, SDHCI_BUFFER);
 402				chunk = 0;
 403				scratch = 0;
 404			}
 405		}
 406	}
 407
 408	sg_miter_stop(&host->sg_miter);
 409
 410	local_irq_restore(flags);
 411}
 412
 413static void sdhci_transfer_pio(struct sdhci_host *host)
 414{
 415	u32 mask;
 416
 417	BUG_ON(!host->data);
 418
 419	if (host->blocks == 0)
 420		return;
 421
 422	if (host->data->flags & MMC_DATA_READ)
 423		mask = SDHCI_DATA_AVAILABLE;
 424	else
 425		mask = SDHCI_SPACE_AVAILABLE;
 426
 427	/*
 428	 * Some controllers (JMicron JMB38x) mess up the buffer bits
 429	 * for transfers < 4 bytes. As long as it is just one block,
 430	 * we can ignore the bits.
 431	 */
 432	if ((host->quirks & SDHCI_QUIRK_BROKEN_SMALL_PIO) &&
 433		(host->data->blocks == 1))
 434		mask = ~0;
 435
 436	while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
 437		if (host->quirks & SDHCI_QUIRK_PIO_NEEDS_DELAY)
 438			udelay(100);
 439
 440		if (host->data->flags & MMC_DATA_READ)
 441			sdhci_read_block_pio(host);
 442		else
 443			sdhci_write_block_pio(host);
 444
 445		host->blocks--;
 446		if (host->blocks == 0)
 447			break;
 448	}
 449
 450	DBG("PIO transfer complete.\n");
 451}
 452
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 453static char *sdhci_kmap_atomic(struct scatterlist *sg, unsigned long *flags)
 454{
 455	local_irq_save(*flags);
 456	return kmap_atomic(sg_page(sg)) + sg->offset;
 457}
 458
 459static void sdhci_kunmap_atomic(void *buffer, unsigned long *flags)
 460{
 461	kunmap_atomic(buffer);
 462	local_irq_restore(*flags);
 463}
 464
 465static void sdhci_set_adma_desc(u8 *desc, u32 addr, int len, unsigned cmd)
 
 466{
 467	__le32 *dataddr = (__le32 __force *)(desc + 4);
 468	__le16 *cmdlen = (__le16 __force *)desc;
 469
 470	/* SDHCI specification says ADMA descriptors should be 4 byte
 471	 * aligned, so using 16 or 32bit operations should be safe. */
 
 
 472
 473	cmdlen[0] = cpu_to_le16(cmd);
 474	cmdlen[1] = cpu_to_le16(len);
 475
 476	dataddr[0] = cpu_to_le32(addr);
 477}
 478
 479static int sdhci_adma_table_pre(struct sdhci_host *host,
 480	struct mmc_data *data)
 481{
 482	int direction;
 483
 484	u8 *desc;
 485	u8 *align;
 486	dma_addr_t addr;
 487	dma_addr_t align_addr;
 488	int len, offset;
 489
 
 
 
 490	struct scatterlist *sg;
 491	int i;
 
 
 492	char *buffer;
 493	unsigned long flags;
 494
 495	/*
 496	 * The spec does not specify endianness of descriptor table.
 497	 * We currently guess that it is LE.
 498	 */
 499
 500	if (data->flags & MMC_DATA_READ)
 501		direction = DMA_FROM_DEVICE;
 502	else
 503		direction = DMA_TO_DEVICE;
 504
 505	/*
 506	 * The ADMA descriptor table is mapped further down as we
 507	 * need to fill it with data first.
 508	 */
 509
 510	host->align_addr = dma_map_single(mmc_dev(host->mmc),
 511		host->align_buffer, 128 * 4, direction);
 512	if (dma_mapping_error(mmc_dev(host->mmc), host->align_addr))
 513		goto fail;
 514	BUG_ON(host->align_addr & 0x3);
 515
 516	host->sg_count = dma_map_sg(mmc_dev(host->mmc),
 517		data->sg, data->sg_len, direction);
 518	if (host->sg_count == 0)
 519		goto unmap_align;
 520
 521	desc = host->adma_desc;
 522	align = host->align_buffer;
 523
 524	align_addr = host->align_addr;
 525
 526	for_each_sg(data->sg, sg, host->sg_count, i) {
 527		addr = sg_dma_address(sg);
 528		len = sg_dma_len(sg);
 529
 530		/*
 531		 * The SDHCI specification states that ADMA
 532		 * addresses must be 32-bit aligned. If they
 533		 * aren't, then we use a bounce buffer for
 534		 * the (up to three) bytes that screw up the
 535		 * alignment.
 536		 */
 537		offset = (4 - (addr & 0x3)) & 0x3;
 
 538		if (offset) {
 539			if (data->flags & MMC_DATA_WRITE) {
 540				buffer = sdhci_kmap_atomic(sg, &flags);
 541				WARN_ON(((long)buffer & PAGE_MASK) > (PAGE_SIZE - 3));
 542				memcpy(align, buffer, offset);
 543				sdhci_kunmap_atomic(buffer, &flags);
 544			}
 545
 546			/* tran, valid */
 547			sdhci_set_adma_desc(desc, align_addr, offset, 0x21);
 
 548
 549			BUG_ON(offset > 65536);
 550
 551			align += 4;
 552			align_addr += 4;
 553
 554			desc += 8;
 555
 556			addr += offset;
 557			len -= offset;
 558		}
 559
 560		BUG_ON(len > 65536);
 561
 562		/* tran, valid */
 563		sdhci_set_adma_desc(desc, addr, len, 0x21);
 564		desc += 8;
 
 
 
 565
 566		/*
 567		 * If this triggers then we have a calculation bug
 568		 * somewhere. :/
 569		 */
 570		WARN_ON((desc - host->adma_desc) > (128 * 2 + 1) * 4);
 571	}
 572
 573	if (host->quirks & SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC) {
 574		/*
 575		* Mark the last descriptor as the terminating descriptor
 576		*/
 577		if (desc != host->adma_desc) {
 578			desc -= 8;
 579			desc[0] |= 0x2; /* end */
 580		}
 581	} else {
 582		/*
 583		* Add a terminating entry.
 584		*/
 585
 586		/* nop, end, valid */
 587		sdhci_set_adma_desc(desc, 0, 0, 0x3);
 588	}
 589
 590	/*
 591	 * Resync align buffer as we might have changed it.
 592	 */
 593	if (data->flags & MMC_DATA_WRITE) {
 594		dma_sync_single_for_device(mmc_dev(host->mmc),
 595			host->align_addr, 128 * 4, direction);
 596	}
 597
 598	host->adma_addr = dma_map_single(mmc_dev(host->mmc),
 599		host->adma_desc, (128 * 2 + 1) * 4, DMA_TO_DEVICE);
 600	if (dma_mapping_error(mmc_dev(host->mmc), host->adma_addr))
 601		goto unmap_entries;
 602	BUG_ON(host->adma_addr & 0x3);
 603
 604	return 0;
 605
 606unmap_entries:
 607	dma_unmap_sg(mmc_dev(host->mmc), data->sg,
 608		data->sg_len, direction);
 609unmap_align:
 610	dma_unmap_single(mmc_dev(host->mmc), host->align_addr,
 611		128 * 4, direction);
 612fail:
 613	return -EINVAL;
 614}
 615
 616static void sdhci_adma_table_post(struct sdhci_host *host,
 617	struct mmc_data *data)
 618{
 619	int direction;
 620
 621	struct scatterlist *sg;
 622	int i, size;
 623	u8 *align;
 624	char *buffer;
 625	unsigned long flags;
 626
 627	if (data->flags & MMC_DATA_READ)
 628		direction = DMA_FROM_DEVICE;
 629	else
 630		direction = DMA_TO_DEVICE;
 631
 632	dma_unmap_single(mmc_dev(host->mmc), host->adma_addr,
 633		(128 * 2 + 1) * 4, DMA_TO_DEVICE);
 634
 635	dma_unmap_single(mmc_dev(host->mmc), host->align_addr,
 636		128 * 4, direction);
 637
 638	if (data->flags & MMC_DATA_READ) {
 639		dma_sync_sg_for_cpu(mmc_dev(host->mmc), data->sg,
 640			data->sg_len, direction);
 641
 642		align = host->align_buffer;
 
 
 
 
 
 643
 644		for_each_sg(data->sg, sg, host->sg_count, i) {
 645			if (sg_dma_address(sg) & 0x3) {
 646				size = 4 - (sg_dma_address(sg) & 0x3);
 
 
 
 
 
 
 
 
 
 
 
 647
 648				buffer = sdhci_kmap_atomic(sg, &flags);
 649				WARN_ON(((long)buffer & PAGE_MASK) > (PAGE_SIZE - 3));
 650				memcpy(buffer, align, size);
 651				sdhci_kunmap_atomic(buffer, &flags);
 652
 653				align += 4;
 654			}
 655		}
 656	}
 657
 658	dma_unmap_sg(mmc_dev(host->mmc), data->sg,
 659		data->sg_len, direction);
 660}
 661
 662static u8 sdhci_calc_timeout(struct sdhci_host *host, struct mmc_command *cmd)
 663{
 664	u8 count;
 665	struct mmc_data *data = cmd->data;
 666	unsigned target_timeout, current_timeout;
 667
 668	/*
 669	 * If the host controller provides us with an incorrect timeout
 670	 * value, just skip the check and use 0xE.  The hardware may take
 671	 * longer to time out, but that's much better than having a too-short
 672	 * timeout value.
 673	 */
 674	if (host->quirks & SDHCI_QUIRK_BROKEN_TIMEOUT_VAL)
 675		return 0xE;
 676
 677	/* Unspecified timeout, assume max */
 678	if (!data && !cmd->busy_timeout)
 679		return 0xE;
 680
 681	/* timeout in us */
 682	if (!data)
 683		target_timeout = cmd->busy_timeout * 1000;
 684	else {
 685		target_timeout = data->timeout_ns / 1000;
 686		if (host->clock)
 687			target_timeout += data->timeout_clks / host->clock;
 
 
 
 
 
 
 
 
 
 
 
 688	}
 689
 690	/*
 691	 * Figure out needed cycles.
 692	 * We do this in steps in order to fit inside a 32 bit int.
 693	 * The first step is the minimum timeout, which will have a
 694	 * minimum resolution of 6 bits:
 695	 * (1) 2^13*1000 > 2^22,
 696	 * (2) host->timeout_clk < 2^16
 697	 *     =>
 698	 *     (1) / (2) > 2^6
 699	 */
 700	count = 0;
 701	current_timeout = (1 << 13) * 1000 / host->timeout_clk;
 702	while (current_timeout < target_timeout) {
 703		count++;
 704		current_timeout <<= 1;
 705		if (count >= 0xF)
 706			break;
 707	}
 708
 709	if (count >= 0xF) {
 710		DBG("%s: Too large timeout 0x%x requested for CMD%d!\n",
 711		    mmc_hostname(host->mmc), count, cmd->opcode);
 712		count = 0xE;
 713	}
 714
 715	return count;
 716}
 717
 718static void sdhci_set_transfer_irqs(struct sdhci_host *host)
 719{
 720	u32 pio_irqs = SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL;
 721	u32 dma_irqs = SDHCI_INT_DMA_END | SDHCI_INT_ADMA_ERROR;
 722
 723	if (host->flags & SDHCI_REQ_USE_DMA)
 724		sdhci_clear_set_irqs(host, pio_irqs, dma_irqs);
 725	else
 726		sdhci_clear_set_irqs(host, dma_irqs, pio_irqs);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 727}
 728
 729static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_command *cmd)
 730{
 731	u8 count;
 732	u8 ctrl;
 733	struct mmc_data *data = cmd->data;
 734	int ret;
 735
 736	WARN_ON(host->data);
 737
 738	if (data || (cmd->flags & MMC_RSP_BUSY)) {
 739		count = sdhci_calc_timeout(host, cmd);
 740		sdhci_writeb(host, count, SDHCI_TIMEOUT_CONTROL);
 741	}
 742
 743	if (!data)
 744		return;
 745
 746	/* Sanity checks */
 747	BUG_ON(data->blksz * data->blocks > 524288);
 748	BUG_ON(data->blksz > host->mmc->max_blk_size);
 749	BUG_ON(data->blocks > 65535);
 750
 751	host->data = data;
 752	host->data_early = 0;
 753	host->data->bytes_xfered = 0;
 754
 755	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA))
 
 
 
 
 756		host->flags |= SDHCI_REQ_USE_DMA;
 757
 758	/*
 759	 * FIXME: This doesn't account for merging when mapping the
 760	 * scatterlist.
 761	 */
 762	if (host->flags & SDHCI_REQ_USE_DMA) {
 763		int broken, i;
 764		struct scatterlist *sg;
 765
 766		broken = 0;
 767		if (host->flags & SDHCI_USE_ADMA) {
 768			if (host->quirks & SDHCI_QUIRK_32BIT_ADMA_SIZE)
 769				broken = 1;
 
 
 
 
 
 
 
 770		} else {
 771			if (host->quirks & SDHCI_QUIRK_32BIT_DMA_SIZE)
 772				broken = 1;
 
 
 773		}
 774
 775		if (unlikely(broken)) {
 776			for_each_sg(data->sg, sg, data->sg_len, i) {
 777				if (sg->length & 0x3) {
 778					DBG("Reverting to PIO because of "
 779						"transfer size (%d)\n",
 780						sg->length);
 
 
 
 
 781					host->flags &= ~SDHCI_REQ_USE_DMA;
 782					break;
 783				}
 784			}
 785		}
 786	}
 787
 788	/*
 789	 * The assumption here being that alignment is the same after
 790	 * translation to device address space.
 791	 */
 792	if (host->flags & SDHCI_REQ_USE_DMA) {
 793		int broken, i;
 794		struct scatterlist *sg;
 795
 796		broken = 0;
 797		if (host->flags & SDHCI_USE_ADMA) {
 798			/*
 799			 * As we use 3 byte chunks to work around
 800			 * alignment problems, we need to check this
 801			 * quirk.
 802			 */
 803			if (host->quirks & SDHCI_QUIRK_32BIT_ADMA_SIZE)
 804				broken = 1;
 
 
 
 
 
 
 
 
 805		} else {
 806			if (host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR)
 807				broken = 1;
 808		}
 809
 810		if (unlikely(broken)) {
 811			for_each_sg(data->sg, sg, data->sg_len, i) {
 812				if (sg->offset & 0x3) {
 813					DBG("Reverting to PIO because of "
 814						"bad alignment\n");
 815					host->flags &= ~SDHCI_REQ_USE_DMA;
 816					break;
 817				}
 818			}
 819		}
 820	}
 821
 822	if (host->flags & SDHCI_REQ_USE_DMA) {
 823		if (host->flags & SDHCI_USE_ADMA) {
 824			ret = sdhci_adma_table_pre(host, data);
 825			if (ret) {
 826				/*
 827				 * This only happens when someone fed
 828				 * us an invalid request.
 829				 */
 830				WARN_ON(1);
 831				host->flags &= ~SDHCI_REQ_USE_DMA;
 832			} else {
 833				sdhci_writel(host, host->adma_addr,
 834					SDHCI_ADMA_ADDRESS);
 835			}
 836		} else {
 837			int sg_cnt;
 838
 839			sg_cnt = dma_map_sg(mmc_dev(host->mmc),
 840					data->sg, data->sg_len,
 841					(data->flags & MMC_DATA_READ) ?
 842						DMA_FROM_DEVICE :
 843						DMA_TO_DEVICE);
 844			if (sg_cnt == 0) {
 845				/*
 846				 * This only happens when someone fed
 847				 * us an invalid request.
 848				 */
 849				WARN_ON(1);
 850				host->flags &= ~SDHCI_REQ_USE_DMA;
 851			} else {
 852				WARN_ON(sg_cnt != 1);
 853				sdhci_writel(host, sg_dma_address(data->sg),
 854					SDHCI_DMA_ADDRESS);
 855			}
 856		}
 857	}
 858
 859	/*
 860	 * Always adjust the DMA selection as some controllers
 861	 * (e.g. JMicron) can't do PIO properly when the selection
 862	 * is ADMA.
 863	 */
 864	if (host->version >= SDHCI_SPEC_200) {
 865		ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
 866		ctrl &= ~SDHCI_CTRL_DMA_MASK;
 867		if ((host->flags & SDHCI_REQ_USE_DMA) &&
 868			(host->flags & SDHCI_USE_ADMA))
 869			ctrl |= SDHCI_CTRL_ADMA32;
 870		else
 
 
 
 871			ctrl |= SDHCI_CTRL_SDMA;
 
 872		sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
 873	}
 874
 875	if (!(host->flags & SDHCI_REQ_USE_DMA)) {
 876		int flags;
 877
 878		flags = SG_MITER_ATOMIC;
 879		if (host->data->flags & MMC_DATA_READ)
 880			flags |= SG_MITER_TO_SG;
 881		else
 882			flags |= SG_MITER_FROM_SG;
 883		sg_miter_start(&host->sg_miter, data->sg, data->sg_len, flags);
 884		host->blocks = data->blocks;
 885	}
 886
 887	sdhci_set_transfer_irqs(host);
 888
 889	/* Set the DMA boundary value and block size */
 890	sdhci_writew(host, SDHCI_MAKE_BLKSZ(SDHCI_DEFAULT_BOUNDARY_ARG,
 891		data->blksz), SDHCI_BLOCK_SIZE);
 892	sdhci_writew(host, data->blocks, SDHCI_BLOCK_COUNT);
 893}
 894
 895static void sdhci_set_transfer_mode(struct sdhci_host *host,
 896	struct mmc_command *cmd)
 897{
 898	u16 mode;
 899	struct mmc_data *data = cmd->data;
 900
 901	if (data == NULL) {
 
 
 
 
 902		/* clear Auto CMD settings for no data CMDs */
 903		mode = sdhci_readw(host, SDHCI_TRANSFER_MODE);
 904		sdhci_writew(host, mode & ~(SDHCI_TRNS_AUTO_CMD12 |
 905				SDHCI_TRNS_AUTO_CMD23), SDHCI_TRANSFER_MODE);
 
 906		return;
 907	}
 908
 909	WARN_ON(!host->data);
 910
 911	mode = SDHCI_TRNS_BLK_CNT_EN;
 
 
 912	if (mmc_op_multi(cmd->opcode) || data->blocks > 1) {
 913		mode |= SDHCI_TRNS_MULTI;
 914		/*
 915		 * If we are sending CMD23, CMD12 never gets sent
 916		 * on successful completion (so no Auto-CMD12).
 917		 */
 918		if (!host->mrq->sbc && (host->flags & SDHCI_AUTO_CMD12))
 
 919			mode |= SDHCI_TRNS_AUTO_CMD12;
 920		else if (host->mrq->sbc && (host->flags & SDHCI_AUTO_CMD23)) {
 921			mode |= SDHCI_TRNS_AUTO_CMD23;
 922			sdhci_writel(host, host->mrq->sbc->arg, SDHCI_ARGUMENT2);
 923		}
 924	}
 925
 926	if (data->flags & MMC_DATA_READ)
 927		mode |= SDHCI_TRNS_READ;
 928	if (host->flags & SDHCI_REQ_USE_DMA)
 929		mode |= SDHCI_TRNS_DMA;
 930
 931	sdhci_writew(host, mode, SDHCI_TRANSFER_MODE);
 932}
 933
 934static void sdhci_finish_data(struct sdhci_host *host)
 935{
 936	struct mmc_data *data;
 937
 938	BUG_ON(!host->data);
 939
 940	data = host->data;
 941	host->data = NULL;
 942
 943	if (host->flags & SDHCI_REQ_USE_DMA) {
 944		if (host->flags & SDHCI_USE_ADMA)
 945			sdhci_adma_table_post(host, data);
 946		else {
 947			dma_unmap_sg(mmc_dev(host->mmc), data->sg,
 948				data->sg_len, (data->flags & MMC_DATA_READ) ?
 949					DMA_FROM_DEVICE : DMA_TO_DEVICE);
 950		}
 951	}
 952
 953	/*
 954	 * The specification states that the block count register must
 955	 * be updated, but it does not specify at what point in the
 956	 * data flow. That makes the register entirely useless to read
 957	 * back so we have to assume that nothing made it to the card
 958	 * in the event of an error.
 959	 */
 960	if (data->error)
 961		data->bytes_xfered = 0;
 962	else
 963		data->bytes_xfered = data->blksz * data->blocks;
 964
 965	/*
 966	 * Need to send CMD12 if -
 967	 * a) open-ended multiblock transfer (no CMD23)
 968	 * b) error in multiblock transfer
 969	 */
 970	if (data->stop &&
 971	    (data->error ||
 972	     !host->mrq->sbc)) {
 973
 974		/*
 975		 * The controller needs a reset of internal state machines
 976		 * upon error conditions.
 977		 */
 978		if (data->error) {
 979			sdhci_reset(host, SDHCI_RESET_CMD);
 980			sdhci_reset(host, SDHCI_RESET_DATA);
 981		}
 982
 983		sdhci_send_command(host, data->stop);
 984	} else
 985		tasklet_schedule(&host->finish_tasklet);
 986}
 987
 988void sdhci_send_command(struct sdhci_host *host, struct mmc_command *cmd)
 989{
 990	int flags;
 991	u32 mask;
 992	unsigned long timeout;
 993
 994	WARN_ON(host->cmd);
 995
 
 
 
 996	/* Wait max 10 ms */
 997	timeout = 10;
 998
 999	mask = SDHCI_CMD_INHIBIT;
1000	if ((cmd->data != NULL) || (cmd->flags & MMC_RSP_BUSY))
1001		mask |= SDHCI_DATA_INHIBIT;
1002
1003	/* We shouldn't wait for data inihibit for stop commands, even
1004	   though they might use busy signaling */
1005	if (host->mrq->data && (cmd == host->mrq->data->stop))
1006		mask &= ~SDHCI_DATA_INHIBIT;
1007
1008	while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
1009		if (timeout == 0) {
1010			pr_err("%s: Controller never released "
1011				"inhibit bit(s).\n", mmc_hostname(host->mmc));
1012			sdhci_dumpregs(host);
1013			cmd->error = -EIO;
1014			tasklet_schedule(&host->finish_tasklet);
1015			return;
1016		}
1017		timeout--;
1018		mdelay(1);
1019	}
1020
1021	timeout = jiffies;
1022	if (!cmd->data && cmd->busy_timeout > 9000)
1023		timeout += DIV_ROUND_UP(cmd->busy_timeout, 1000) * HZ + HZ;
1024	else
1025		timeout += 10 * HZ;
1026	mod_timer(&host->timer, timeout);
1027
1028	host->cmd = cmd;
 
1029
1030	sdhci_prepare_data(host, cmd);
1031
1032	sdhci_writel(host, cmd->arg, SDHCI_ARGUMENT);
1033
1034	sdhci_set_transfer_mode(host, cmd);
1035
1036	if ((cmd->flags & MMC_RSP_136) && (cmd->flags & MMC_RSP_BUSY)) {
1037		pr_err("%s: Unsupported response type!\n",
1038			mmc_hostname(host->mmc));
1039		cmd->error = -EINVAL;
1040		tasklet_schedule(&host->finish_tasklet);
1041		return;
1042	}
1043
1044	if (!(cmd->flags & MMC_RSP_PRESENT))
1045		flags = SDHCI_CMD_RESP_NONE;
1046	else if (cmd->flags & MMC_RSP_136)
1047		flags = SDHCI_CMD_RESP_LONG;
1048	else if (cmd->flags & MMC_RSP_BUSY)
1049		flags = SDHCI_CMD_RESP_SHORT_BUSY;
1050	else
1051		flags = SDHCI_CMD_RESP_SHORT;
1052
1053	if (cmd->flags & MMC_RSP_CRC)
1054		flags |= SDHCI_CMD_CRC;
1055	if (cmd->flags & MMC_RSP_OPCODE)
1056		flags |= SDHCI_CMD_INDEX;
1057
1058	/* CMD19 is special in that the Data Present Select should be set */
1059	if (cmd->data || cmd->opcode == MMC_SEND_TUNING_BLOCK ||
1060	    cmd->opcode == MMC_SEND_TUNING_BLOCK_HS200)
1061		flags |= SDHCI_CMD_DATA;
1062
1063	sdhci_writew(host, SDHCI_MAKE_CMD(cmd->opcode, flags), SDHCI_COMMAND);
1064}
1065EXPORT_SYMBOL_GPL(sdhci_send_command);
1066
1067static void sdhci_finish_command(struct sdhci_host *host)
1068{
1069	int i;
1070
1071	BUG_ON(host->cmd == NULL);
1072
1073	if (host->cmd->flags & MMC_RSP_PRESENT) {
1074		if (host->cmd->flags & MMC_RSP_136) {
1075			/* CRC is stripped so we need to do some shifting. */
1076			for (i = 0;i < 4;i++) {
1077				host->cmd->resp[i] = sdhci_readl(host,
1078					SDHCI_RESPONSE + (3-i)*4) << 8;
1079				if (i != 3)
1080					host->cmd->resp[i] |=
1081						sdhci_readb(host,
1082						SDHCI_RESPONSE + (3-i)*4-1);
1083			}
1084		} else {
1085			host->cmd->resp[0] = sdhci_readl(host, SDHCI_RESPONSE);
1086		}
1087	}
1088
1089	host->cmd->error = 0;
1090
1091	/* Finished CMD23, now send actual command. */
1092	if (host->cmd == host->mrq->sbc) {
1093		host->cmd = NULL;
1094		sdhci_send_command(host, host->mrq->cmd);
1095	} else {
1096
1097		/* Processed actual command. */
1098		if (host->data && host->data_early)
1099			sdhci_finish_data(host);
1100
1101		if (!host->cmd->data)
1102			tasklet_schedule(&host->finish_tasklet);
1103
1104		host->cmd = NULL;
1105	}
1106}
1107
1108static u16 sdhci_get_preset_value(struct sdhci_host *host)
1109{
1110	u16 ctrl, preset = 0;
1111
1112	ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1113
1114	switch (ctrl & SDHCI_CTRL_UHS_MASK) {
1115	case SDHCI_CTRL_UHS_SDR12:
1116		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR12);
1117		break;
1118	case SDHCI_CTRL_UHS_SDR25:
1119		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR25);
1120		break;
1121	case SDHCI_CTRL_UHS_SDR50:
1122		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR50);
1123		break;
1124	case SDHCI_CTRL_UHS_SDR104:
 
1125		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR104);
1126		break;
1127	case SDHCI_CTRL_UHS_DDR50:
 
1128		preset = sdhci_readw(host, SDHCI_PRESET_FOR_DDR50);
1129		break;
 
 
 
1130	default:
1131		pr_warn("%s: Invalid UHS-I mode selected\n",
1132			mmc_hostname(host->mmc));
1133		preset = sdhci_readw(host, SDHCI_PRESET_FOR_SDR12);
1134		break;
1135	}
1136	return preset;
1137}
1138
1139static void sdhci_set_clock(struct sdhci_host *host, unsigned int clock)
1140{
1141	int div = 0; /* Initialized for compiler warning */
1142	int real_div = div, clk_mul = 1;
1143	u16 clk = 0;
1144	unsigned long timeout;
1145
1146	if (clock && clock == host->clock)
1147		return;
1148
1149	host->mmc->actual_clock = 0;
1150
1151	if (host->ops->set_clock) {
1152		host->ops->set_clock(host, clock);
1153		if (host->quirks & SDHCI_QUIRK_NONSTANDARD_CLOCK)
1154			return;
1155	}
1156
1157	sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL);
 
 
1158
1159	if (clock == 0)
1160		goto out;
1161
1162	if (host->version >= SDHCI_SPEC_300) {
1163		if (sdhci_readw(host, SDHCI_HOST_CONTROL2) &
1164			SDHCI_CTRL_PRESET_VAL_ENABLE) {
1165			u16 pre_val;
1166
1167			clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
1168			pre_val = sdhci_get_preset_value(host);
1169			div = (pre_val & SDHCI_PRESET_SDCLK_FREQ_MASK)
1170				>> SDHCI_PRESET_SDCLK_FREQ_SHIFT;
1171			if (host->clk_mul &&
1172				(pre_val & SDHCI_PRESET_CLKGEN_SEL_MASK)) {
1173				clk = SDHCI_PROG_CLOCK_MODE;
1174				real_div = div + 1;
1175				clk_mul = host->clk_mul;
1176			} else {
1177				real_div = max_t(int, 1, div << 1);
1178			}
1179			goto clock_set;
1180		}
1181
1182		/*
1183		 * Check if the Host Controller supports Programmable Clock
1184		 * Mode.
1185		 */
1186		if (host->clk_mul) {
1187			for (div = 1; div <= 1024; div++) {
1188				if ((host->max_clk * host->clk_mul / div)
1189					<= clock)
1190					break;
1191			}
1192			/*
1193			 * Set Programmable Clock Mode in the Clock
1194			 * Control register.
1195			 */
1196			clk = SDHCI_PROG_CLOCK_MODE;
1197			real_div = div;
1198			clk_mul = host->clk_mul;
1199			div--;
1200		} else {
 
 
 
 
 
 
 
 
 
 
1201			/* Version 3.00 divisors must be a multiple of 2. */
1202			if (host->max_clk <= clock)
1203				div = 1;
1204			else {
1205				for (div = 2; div < SDHCI_MAX_DIV_SPEC_300;
1206				     div += 2) {
1207					if ((host->max_clk / div) <= clock)
1208						break;
1209				}
1210			}
1211			real_div = div;
1212			div >>= 1;
 
 
 
1213		}
1214	} else {
1215		/* Version 2.00 divisors must be a power of 2. */
1216		for (div = 1; div < SDHCI_MAX_DIV_SPEC_200; div *= 2) {
1217			if ((host->max_clk / div) <= clock)
1218				break;
1219		}
1220		real_div = div;
1221		div >>= 1;
1222	}
1223
1224clock_set:
1225	if (real_div)
1226		host->mmc->actual_clock = (host->max_clk * clk_mul) / real_div;
1227
1228	clk |= (div & SDHCI_DIV_MASK) << SDHCI_DIVIDER_SHIFT;
1229	clk |= ((div & SDHCI_DIV_HI_MASK) >> SDHCI_DIV_MASK_LEN)
1230		<< SDHCI_DIVIDER_HI_SHIFT;
1231	clk |= SDHCI_CLOCK_INT_EN;
1232	sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
1233
1234	/* Wait max 20 ms */
1235	timeout = 20;
1236	while (!((clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL))
1237		& SDHCI_CLOCK_INT_STABLE)) {
1238		if (timeout == 0) {
1239			pr_err("%s: Internal clock never "
1240				"stabilised.\n", mmc_hostname(host->mmc));
1241			sdhci_dumpregs(host);
1242			return;
1243		}
1244		timeout--;
1245		mdelay(1);
1246	}
1247
1248	clk |= SDHCI_CLOCK_CARD_EN;
1249	sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
1250
1251out:
1252	host->clock = clock;
1253}
 
1254
1255static inline void sdhci_update_clock(struct sdhci_host *host)
 
1256{
1257	unsigned int clock;
1258
1259	clock = host->clock;
1260	host->clock = 0;
1261	sdhci_set_clock(host, clock);
 
 
 
 
 
1262}
1263
1264static int sdhci_set_power(struct sdhci_host *host, unsigned short power)
 
1265{
1266	u8 pwr = 0;
1267
1268	if (power != (unsigned short)-1) {
1269		switch (1 << power) {
1270		case MMC_VDD_165_195:
1271			pwr = SDHCI_POWER_180;
1272			break;
1273		case MMC_VDD_29_30:
1274		case MMC_VDD_30_31:
1275			pwr = SDHCI_POWER_300;
1276			break;
1277		case MMC_VDD_32_33:
1278		case MMC_VDD_33_34:
1279			pwr = SDHCI_POWER_330;
1280			break;
1281		default:
1282			BUG();
 
 
1283		}
1284	}
1285
1286	if (host->pwr == pwr)
1287		return -1;
1288
1289	host->pwr = pwr;
1290
1291	if (pwr == 0) {
1292		sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
1293		if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
1294			sdhci_runtime_pm_bus_off(host);
1295		return 0;
1296	}
 
 
 
 
 
 
 
 
 
 
 
 
 
1297
1298	/*
1299	 * Spec says that we should clear the power reg before setting
1300	 * a new value. Some controllers don't seem to like this though.
1301	 */
1302	if (!(host->quirks & SDHCI_QUIRK_SINGLE_POWER_WRITE))
1303		sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
1304
1305	/*
1306	 * At least the Marvell CaFe chip gets confused if we set the voltage
1307	 * and set turn on power at the same time, so set the voltage first.
1308	 */
1309	if (host->quirks & SDHCI_QUIRK_NO_SIMULT_VDD_AND_POWER)
1310		sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
1311
1312	pwr |= SDHCI_POWER_ON;
 
1313
1314	sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
 
 
 
 
 
 
 
 
1315
1316	if (host->quirks2 & SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON)
1317		sdhci_runtime_pm_bus_on(host);
 
 
1318
1319	/*
1320	 * Some controllers need an extra 10ms delay of 10ms before they
1321	 * can apply clock after applying power
1322	 */
1323	if (host->quirks & SDHCI_QUIRK_DELAY_AFTER_POWER)
1324		mdelay(10);
1325
1326	return power;
1327}
1328
1329/*****************************************************************************\
1330 *                                                                           *
1331 * MMC callbacks                                                             *
1332 *                                                                           *
1333\*****************************************************************************/
1334
1335static void sdhci_request(struct mmc_host *mmc, struct mmc_request *mrq)
1336{
1337	struct sdhci_host *host;
1338	int present;
1339	unsigned long flags;
1340	u32 tuning_opcode;
1341
1342	host = mmc_priv(mmc);
1343
1344	sdhci_runtime_pm_get(host);
1345
 
 
 
1346	spin_lock_irqsave(&host->lock, flags);
1347
1348	WARN_ON(host->mrq != NULL);
1349
1350#ifndef SDHCI_USE_LEDS_CLASS
1351	sdhci_activate_led(host);
1352#endif
1353
1354	/*
1355	 * Ensure we don't send the STOP for non-SET_BLOCK_COUNTED
1356	 * requests if Auto-CMD12 is enabled.
1357	 */
1358	if (!mrq->sbc && (host->flags & SDHCI_AUTO_CMD12)) {
1359		if (mrq->stop) {
1360			mrq->data->stop = NULL;
1361			mrq->stop = NULL;
1362		}
1363	}
1364
1365	host->mrq = mrq;
1366
1367	/*
1368	 * Firstly check card presence from cd-gpio.  The return could
1369	 * be one of the following possibilities:
1370	 *     negative: cd-gpio is not available
1371	 *     zero: cd-gpio is used, and card is removed
1372	 *     one: cd-gpio is used, and card is present
1373	 */
1374	present = mmc_gpio_get_cd(host->mmc);
1375	if (present < 0) {
1376		/* If polling, assume that the card is always present. */
1377		if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
1378			present = 1;
1379		else
1380			present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
1381					SDHCI_CARD_PRESENT;
1382	}
1383
1384	if (!present || host->flags & SDHCI_DEVICE_DEAD) {
1385		host->mrq->cmd->error = -ENOMEDIUM;
1386		tasklet_schedule(&host->finish_tasklet);
1387	} else {
1388		u32 present_state;
1389
1390		present_state = sdhci_readl(host, SDHCI_PRESENT_STATE);
1391		/*
1392		 * Check if the re-tuning timer has already expired and there
1393		 * is no on-going data transfer. If so, we need to execute
1394		 * tuning procedure before sending command.
1395		 */
1396		if ((host->flags & SDHCI_NEEDS_RETUNING) &&
1397		    !(present_state & (SDHCI_DOING_WRITE | SDHCI_DOING_READ))) {
1398			if (mmc->card) {
1399				/* eMMC uses cmd21 but sd and sdio use cmd19 */
1400				tuning_opcode =
1401					mmc->card->type == MMC_TYPE_MMC ?
1402					MMC_SEND_TUNING_BLOCK_HS200 :
1403					MMC_SEND_TUNING_BLOCK;
1404
1405				/* Here we need to set the host->mrq to NULL,
1406				 * in case the pending finish_tasklet
1407				 * finishes it incorrectly.
1408				 */
1409				host->mrq = NULL;
1410
1411				spin_unlock_irqrestore(&host->lock, flags);
1412				sdhci_execute_tuning(mmc, tuning_opcode);
1413				spin_lock_irqsave(&host->lock, flags);
1414
1415				/* Restore original mmc_request structure */
1416				host->mrq = mrq;
1417			}
1418		}
1419
1420		if (mrq->sbc && !(host->flags & SDHCI_AUTO_CMD23))
1421			sdhci_send_command(host, mrq->sbc);
1422		else
1423			sdhci_send_command(host, mrq->cmd);
1424	}
1425
1426	mmiowb();
1427	spin_unlock_irqrestore(&host->lock, flags);
1428}
1429
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1430static void sdhci_do_set_ios(struct sdhci_host *host, struct mmc_ios *ios)
1431{
1432	unsigned long flags;
1433	int vdd_bit = -1;
1434	u8 ctrl;
 
1435
1436	spin_lock_irqsave(&host->lock, flags);
1437
1438	if (host->flags & SDHCI_DEVICE_DEAD) {
1439		spin_unlock_irqrestore(&host->lock, flags);
1440		if (host->vmmc && ios->power_mode == MMC_POWER_OFF)
1441			mmc_regulator_set_ocr(host->mmc, host->vmmc, 0);
 
1442		return;
1443	}
1444
1445	/*
1446	 * Reset the chip on each power off.
1447	 * Should clear out any weird states.
1448	 */
1449	if (ios->power_mode == MMC_POWER_OFF) {
1450		sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
1451		sdhci_reinit(host);
1452	}
1453
1454	if (host->version >= SDHCI_SPEC_300 &&
1455		(ios->power_mode == MMC_POWER_UP) &&
1456		!(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN))
1457		sdhci_enable_preset_value(host, false);
1458
1459	sdhci_set_clock(host, ios->clock);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1460
1461	if (ios->power_mode == MMC_POWER_OFF)
1462		vdd_bit = sdhci_set_power(host, -1);
1463	else
1464		vdd_bit = sdhci_set_power(host, ios->vdd);
1465
1466	if (host->vmmc && vdd_bit != -1) {
1467		spin_unlock_irqrestore(&host->lock, flags);
1468		mmc_regulator_set_ocr(host->mmc, host->vmmc, vdd_bit);
1469		spin_lock_irqsave(&host->lock, flags);
1470	}
1471
1472	if (host->ops->platform_send_init_74_clocks)
1473		host->ops->platform_send_init_74_clocks(host, ios->power_mode);
1474
1475	/*
1476	 * If your platform has 8-bit width support but is not a v3 controller,
1477	 * or if it requires special setup code, you should implement that in
1478	 * platform_bus_width().
1479	 */
1480	if (host->ops->platform_bus_width) {
1481		host->ops->platform_bus_width(host, ios->bus_width);
1482	} else {
1483		ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
1484		if (ios->bus_width == MMC_BUS_WIDTH_8) {
1485			ctrl &= ~SDHCI_CTRL_4BITBUS;
1486			if (host->version >= SDHCI_SPEC_300)
1487				ctrl |= SDHCI_CTRL_8BITBUS;
1488		} else {
1489			if (host->version >= SDHCI_SPEC_300)
1490				ctrl &= ~SDHCI_CTRL_8BITBUS;
1491			if (ios->bus_width == MMC_BUS_WIDTH_4)
1492				ctrl |= SDHCI_CTRL_4BITBUS;
1493			else
1494				ctrl &= ~SDHCI_CTRL_4BITBUS;
1495		}
1496		sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1497	}
1498
1499	ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
1500
1501	if ((ios->timing == MMC_TIMING_SD_HS ||
1502	     ios->timing == MMC_TIMING_MMC_HS)
1503	    && !(host->quirks & SDHCI_QUIRK_NO_HISPD_BIT))
1504		ctrl |= SDHCI_CTRL_HISPD;
1505	else
1506		ctrl &= ~SDHCI_CTRL_HISPD;
1507
1508	if (host->version >= SDHCI_SPEC_300) {
1509		u16 clk, ctrl_2;
1510
1511		/* In case of UHS-I modes, set High Speed Enable */
1512		if ((ios->timing == MMC_TIMING_MMC_HS200) ||
 
 
1513		    (ios->timing == MMC_TIMING_UHS_SDR50) ||
1514		    (ios->timing == MMC_TIMING_UHS_SDR104) ||
1515		    (ios->timing == MMC_TIMING_UHS_DDR50) ||
1516		    (ios->timing == MMC_TIMING_UHS_SDR25))
1517			ctrl |= SDHCI_CTRL_HISPD;
1518
1519		ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1520		if (!(ctrl_2 & SDHCI_CTRL_PRESET_VAL_ENABLE)) {
1521			sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1522			/*
1523			 * We only need to set Driver Strength if the
1524			 * preset value enable is not set.
1525			 */
 
1526			ctrl_2 &= ~SDHCI_CTRL_DRV_TYPE_MASK;
1527			if (ios->drv_type == MMC_SET_DRIVER_TYPE_A)
1528				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_A;
 
 
1529			else if (ios->drv_type == MMC_SET_DRIVER_TYPE_C)
1530				ctrl_2 |= SDHCI_CTRL_DRV_TYPE_C;
 
 
 
 
 
 
 
1531
1532			sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2);
1533		} else {
1534			/*
1535			 * According to SDHC Spec v3.00, if the Preset Value
1536			 * Enable in the Host Control 2 register is set, we
1537			 * need to reset SD Clock Enable before changing High
1538			 * Speed Enable to avoid generating clock gliches.
1539			 */
1540
1541			/* Reset SD Clock Enable */
1542			clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
1543			clk &= ~SDHCI_CLOCK_CARD_EN;
1544			sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
1545
1546			sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1547
1548			/* Re-enable SD Clock */
1549			sdhci_update_clock(host);
1550		}
1551
1552
1553		/* Reset SD Clock Enable */
1554		clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL);
1555		clk &= ~SDHCI_CLOCK_CARD_EN;
1556		sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
1557
1558		if (host->ops->set_uhs_signaling)
1559			host->ops->set_uhs_signaling(host, ios->timing);
1560		else {
1561			ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1562			/* Select Bus Speed Mode for host */
1563			ctrl_2 &= ~SDHCI_CTRL_UHS_MASK;
1564			if ((ios->timing == MMC_TIMING_MMC_HS200) ||
1565			    (ios->timing == MMC_TIMING_UHS_SDR104))
1566				ctrl_2 |= SDHCI_CTRL_UHS_SDR104;
1567			else if (ios->timing == MMC_TIMING_UHS_SDR12)
1568				ctrl_2 |= SDHCI_CTRL_UHS_SDR12;
1569			else if (ios->timing == MMC_TIMING_UHS_SDR25)
1570				ctrl_2 |= SDHCI_CTRL_UHS_SDR25;
1571			else if (ios->timing == MMC_TIMING_UHS_SDR50)
1572				ctrl_2 |= SDHCI_CTRL_UHS_SDR50;
1573			else if (ios->timing == MMC_TIMING_UHS_DDR50)
1574				ctrl_2 |= SDHCI_CTRL_UHS_DDR50;
1575			sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2);
1576		}
1577
1578		if (!(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN) &&
1579				((ios->timing == MMC_TIMING_UHS_SDR12) ||
1580				 (ios->timing == MMC_TIMING_UHS_SDR25) ||
1581				 (ios->timing == MMC_TIMING_UHS_SDR50) ||
1582				 (ios->timing == MMC_TIMING_UHS_SDR104) ||
1583				 (ios->timing == MMC_TIMING_UHS_DDR50))) {
 
1584			u16 preset;
1585
1586			sdhci_enable_preset_value(host, true);
1587			preset = sdhci_get_preset_value(host);
1588			ios->drv_type = (preset & SDHCI_PRESET_DRV_MASK)
1589				>> SDHCI_PRESET_DRV_SHIFT;
1590		}
1591
1592		/* Re-enable SD Clock */
1593		sdhci_update_clock(host);
1594	} else
1595		sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1596
1597	/*
1598	 * Some (ENE) controllers go apeshit on some ios operation,
1599	 * signalling timeout and CRC errors even on CMD0. Resetting
1600	 * it on each ios seems to solve the problem.
1601	 */
1602	if(host->quirks & SDHCI_QUIRK_RESET_CMD_DATA_ON_IOS)
1603		sdhci_reset(host, SDHCI_RESET_CMD | SDHCI_RESET_DATA);
1604
1605	mmiowb();
1606	spin_unlock_irqrestore(&host->lock, flags);
1607}
1608
1609static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
1610{
1611	struct sdhci_host *host = mmc_priv(mmc);
1612
1613	sdhci_runtime_pm_get(host);
1614	sdhci_do_set_ios(host, ios);
1615	sdhci_runtime_pm_put(host);
1616}
1617
1618static int sdhci_do_get_cd(struct sdhci_host *host)
1619{
1620	int gpio_cd = mmc_gpio_get_cd(host->mmc);
1621
1622	if (host->flags & SDHCI_DEVICE_DEAD)
1623		return 0;
1624
1625	/* If polling/nonremovable, assume that the card is always present. */
1626	if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) ||
1627	    (host->mmc->caps & MMC_CAP_NONREMOVABLE))
1628		return 1;
1629
1630	/* Try slot gpio detect */
 
 
 
1631	if (!IS_ERR_VALUE(gpio_cd))
1632		return !!gpio_cd;
1633
 
 
 
 
1634	/* Host native card detect */
1635	return !!(sdhci_readl(host, SDHCI_PRESENT_STATE) & SDHCI_CARD_PRESENT);
1636}
1637
1638static int sdhci_get_cd(struct mmc_host *mmc)
1639{
1640	struct sdhci_host *host = mmc_priv(mmc);
1641	int ret;
1642
1643	sdhci_runtime_pm_get(host);
1644	ret = sdhci_do_get_cd(host);
1645	sdhci_runtime_pm_put(host);
1646	return ret;
1647}
1648
1649static int sdhci_check_ro(struct sdhci_host *host)
1650{
1651	unsigned long flags;
1652	int is_readonly;
1653
1654	spin_lock_irqsave(&host->lock, flags);
1655
1656	if (host->flags & SDHCI_DEVICE_DEAD)
1657		is_readonly = 0;
1658	else if (host->ops->get_ro)
1659		is_readonly = host->ops->get_ro(host);
1660	else
1661		is_readonly = !(sdhci_readl(host, SDHCI_PRESENT_STATE)
1662				& SDHCI_WRITE_PROTECT);
1663
1664	spin_unlock_irqrestore(&host->lock, flags);
1665
1666	/* This quirk needs to be replaced by a callback-function later */
1667	return host->quirks & SDHCI_QUIRK_INVERTED_WRITE_PROTECT ?
1668		!is_readonly : is_readonly;
1669}
1670
1671#define SAMPLE_COUNT	5
1672
1673static int sdhci_do_get_ro(struct sdhci_host *host)
1674{
1675	int i, ro_count;
1676
1677	if (!(host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT))
1678		return sdhci_check_ro(host);
1679
1680	ro_count = 0;
1681	for (i = 0; i < SAMPLE_COUNT; i++) {
1682		if (sdhci_check_ro(host)) {
1683			if (++ro_count > SAMPLE_COUNT / 2)
1684				return 1;
1685		}
1686		msleep(30);
1687	}
1688	return 0;
1689}
1690
1691static void sdhci_hw_reset(struct mmc_host *mmc)
1692{
1693	struct sdhci_host *host = mmc_priv(mmc);
1694
1695	if (host->ops && host->ops->hw_reset)
1696		host->ops->hw_reset(host);
1697}
1698
1699static int sdhci_get_ro(struct mmc_host *mmc)
1700{
1701	struct sdhci_host *host = mmc_priv(mmc);
1702	int ret;
1703
1704	sdhci_runtime_pm_get(host);
1705	ret = sdhci_do_get_ro(host);
1706	sdhci_runtime_pm_put(host);
1707	return ret;
1708}
1709
1710static void sdhci_enable_sdio_irq_nolock(struct sdhci_host *host, int enable)
1711{
1712	if (host->flags & SDHCI_DEVICE_DEAD)
1713		goto out;
 
 
 
1714
1715	if (enable)
1716		host->flags |= SDHCI_SDIO_IRQ_ENABLED;
1717	else
1718		host->flags &= ~SDHCI_SDIO_IRQ_ENABLED;
1719
1720	/* SDIO IRQ will be enabled as appropriate in runtime resume */
1721	if (host->runtime_suspended)
1722		goto out;
1723
1724	if (enable)
1725		sdhci_unmask_irqs(host, SDHCI_INT_CARD_INT);
1726	else
1727		sdhci_mask_irqs(host, SDHCI_INT_CARD_INT);
1728out:
1729	mmiowb();
1730}
1731
1732static void sdhci_enable_sdio_irq(struct mmc_host *mmc, int enable)
1733{
1734	struct sdhci_host *host = mmc_priv(mmc);
1735	unsigned long flags;
1736
 
 
1737	spin_lock_irqsave(&host->lock, flags);
 
 
 
 
 
1738	sdhci_enable_sdio_irq_nolock(host, enable);
1739	spin_unlock_irqrestore(&host->lock, flags);
 
 
1740}
1741
1742static int sdhci_do_start_signal_voltage_switch(struct sdhci_host *host,
1743						struct mmc_ios *ios)
1744{
 
1745	u16 ctrl;
1746	int ret;
1747
1748	/*
1749	 * Signal Voltage Switching is only applicable for Host Controllers
1750	 * v3.00 and above.
1751	 */
1752	if (host->version < SDHCI_SPEC_300)
1753		return 0;
1754
1755	ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1756
1757	switch (ios->signal_voltage) {
1758	case MMC_SIGNAL_VOLTAGE_330:
1759		/* Set 1.8V Signal Enable in the Host Control2 register to 0 */
1760		ctrl &= ~SDHCI_CTRL_VDD_180;
1761		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1762
1763		if (host->vqmmc) {
1764			ret = regulator_set_voltage(host->vqmmc, 2700000, 3600000);
 
1765			if (ret) {
1766				pr_warning("%s: Switching to 3.3V signalling voltage "
1767						" failed\n", mmc_hostname(host->mmc));
1768				return -EIO;
1769			}
1770		}
1771		/* Wait for 5ms */
1772		usleep_range(5000, 5500);
1773
1774		/* 3.3V regulator output should be stable within 5 ms */
1775		ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1776		if (!(ctrl & SDHCI_CTRL_VDD_180))
1777			return 0;
1778
1779		pr_warning("%s: 3.3V regulator output did not became stable\n",
1780				mmc_hostname(host->mmc));
1781
1782		return -EAGAIN;
1783	case MMC_SIGNAL_VOLTAGE_180:
1784		if (host->vqmmc) {
1785			ret = regulator_set_voltage(host->vqmmc,
1786					1700000, 1950000);
1787			if (ret) {
1788				pr_warning("%s: Switching to 1.8V signalling voltage "
1789						" failed\n", mmc_hostname(host->mmc));
1790				return -EIO;
1791			}
1792		}
1793
1794		/*
1795		 * Enable 1.8V Signal Enable in the Host Control2
1796		 * register
1797		 */
1798		ctrl |= SDHCI_CTRL_VDD_180;
1799		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1800
1801		/* Wait for 5ms */
1802		usleep_range(5000, 5500);
 
1803
1804		/* 1.8V regulator output should be stable within 5 ms */
1805		ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1806		if (ctrl & SDHCI_CTRL_VDD_180)
1807			return 0;
1808
1809		pr_warning("%s: 1.8V regulator output did not became stable\n",
1810				mmc_hostname(host->mmc));
1811
1812		return -EAGAIN;
1813	case MMC_SIGNAL_VOLTAGE_120:
1814		if (host->vqmmc) {
1815			ret = regulator_set_voltage(host->vqmmc, 1100000, 1300000);
 
1816			if (ret) {
1817				pr_warning("%s: Switching to 1.2V signalling voltage "
1818						" failed\n", mmc_hostname(host->mmc));
1819				return -EIO;
1820			}
1821		}
1822		return 0;
1823	default:
1824		/* No signal voltage switch required */
1825		return 0;
1826	}
1827}
1828
1829static int sdhci_start_signal_voltage_switch(struct mmc_host *mmc,
1830	struct mmc_ios *ios)
1831{
1832	struct sdhci_host *host = mmc_priv(mmc);
1833	int err;
1834
1835	if (host->version < SDHCI_SPEC_300)
1836		return 0;
1837	sdhci_runtime_pm_get(host);
1838	err = sdhci_do_start_signal_voltage_switch(host, ios);
1839	sdhci_runtime_pm_put(host);
1840	return err;
1841}
1842
1843static int sdhci_card_busy(struct mmc_host *mmc)
1844{
1845	struct sdhci_host *host = mmc_priv(mmc);
1846	u32 present_state;
1847
1848	sdhci_runtime_pm_get(host);
1849	/* Check whether DAT[3:0] is 0000 */
1850	present_state = sdhci_readl(host, SDHCI_PRESENT_STATE);
1851	sdhci_runtime_pm_put(host);
1852
1853	return !(present_state & SDHCI_DATA_LVL_MASK);
1854}
1855
 
 
 
 
 
 
 
 
 
 
 
 
1856static int sdhci_execute_tuning(struct mmc_host *mmc, u32 opcode)
1857{
1858	struct sdhci_host *host;
1859	u16 ctrl;
1860	u32 ier;
1861	int tuning_loop_counter = MAX_TUNING_LOOP;
1862	unsigned long timeout;
1863	int err = 0;
1864	bool requires_tuning_nonuhs = false;
1865	unsigned long flags;
1866
1867	host = mmc_priv(mmc);
1868
1869	sdhci_runtime_pm_get(host);
1870	spin_lock_irqsave(&host->lock, flags);
1871
1872	ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
 
 
 
 
1873
1874	/*
1875	 * The Host Controller needs tuning only in case of SDR104 mode
1876	 * and for SDR50 mode when Use Tuning for SDR50 is set in the
1877	 * Capabilities register.
1878	 * If the Host Controller supports the HS200 mode then the
1879	 * tuning function has to be executed.
1880	 */
1881	if (((ctrl & SDHCI_CTRL_UHS_MASK) == SDHCI_CTRL_UHS_SDR50) &&
1882	    (host->flags & SDHCI_SDR50_NEEDS_TUNING ||
1883	     host->flags & SDHCI_SDR104_NEEDS_TUNING))
1884		requires_tuning_nonuhs = true;
1885
1886	if (((ctrl & SDHCI_CTRL_UHS_MASK) == SDHCI_CTRL_UHS_SDR104) ||
1887	    requires_tuning_nonuhs)
1888		ctrl |= SDHCI_CTRL_EXEC_TUNING;
1889	else {
1890		spin_unlock_irqrestore(&host->lock, flags);
1891		sdhci_runtime_pm_put(host);
1892		return 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1893	}
1894
1895	if (host->ops->platform_execute_tuning) {
1896		spin_unlock_irqrestore(&host->lock, flags);
1897		err = host->ops->platform_execute_tuning(host, opcode);
1898		sdhci_runtime_pm_put(host);
1899		return err;
1900	}
1901
 
 
 
 
1902	sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1903
1904	/*
1905	 * As per the Host Controller spec v3.00, tuning command
1906	 * generates Buffer Read Ready interrupt, so enable that.
1907	 *
1908	 * Note: The spec clearly says that when tuning sequence
1909	 * is being performed, the controller does not generate
1910	 * interrupts other than Buffer Read Ready interrupt. But
1911	 * to make sure we don't hit a controller bug, we _only_
1912	 * enable Buffer Read Ready interrupt here.
1913	 */
1914	ier = sdhci_readl(host, SDHCI_INT_ENABLE);
1915	sdhci_clear_set_irqs(host, ier, SDHCI_INT_DATA_AVAIL);
1916
1917	/*
1918	 * Issue CMD19 repeatedly till Execute Tuning is set to 0 or the number
1919	 * of loops reaches 40 times or a timeout of 150ms occurs.
1920	 */
1921	timeout = 150;
1922	do {
1923		struct mmc_command cmd = {0};
1924		struct mmc_request mrq = {NULL};
1925
1926		if (!tuning_loop_counter && !timeout)
1927			break;
1928
1929		cmd.opcode = opcode;
1930		cmd.arg = 0;
1931		cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
1932		cmd.retries = 0;
1933		cmd.data = NULL;
1934		cmd.error = 0;
1935
 
 
 
1936		mrq.cmd = &cmd;
1937		host->mrq = &mrq;
1938
1939		/*
1940		 * In response to CMD19, the card sends 64 bytes of tuning
1941		 * block to the Host Controller. So we set the block size
1942		 * to 64 here.
1943		 */
1944		if (cmd.opcode == MMC_SEND_TUNING_BLOCK_HS200) {
1945			if (mmc->ios.bus_width == MMC_BUS_WIDTH_8)
1946				sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 128),
1947					     SDHCI_BLOCK_SIZE);
1948			else if (mmc->ios.bus_width == MMC_BUS_WIDTH_4)
1949				sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 64),
1950					     SDHCI_BLOCK_SIZE);
1951		} else {
1952			sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, 64),
1953				     SDHCI_BLOCK_SIZE);
1954		}
1955
1956		/*
1957		 * The tuning block is sent by the card to the host controller.
1958		 * So we set the TRNS_READ bit in the Transfer Mode register.
1959		 * This also takes care of setting DMA Enable and Multi Block
1960		 * Select in the same register to 0.
1961		 */
1962		sdhci_writew(host, SDHCI_TRNS_READ, SDHCI_TRANSFER_MODE);
1963
1964		sdhci_send_command(host, &cmd);
1965
1966		host->cmd = NULL;
1967		host->mrq = NULL;
1968
1969		spin_unlock_irqrestore(&host->lock, flags);
1970		/* Wait for Buffer Read Ready interrupt */
1971		wait_event_interruptible_timeout(host->buf_ready_int,
1972					(host->tuning_done == 1),
1973					msecs_to_jiffies(50));
1974		spin_lock_irqsave(&host->lock, flags);
1975
1976		if (!host->tuning_done) {
1977			pr_info(DRIVER_NAME ": Timeout waiting for "
1978				"Buffer Read Ready interrupt during tuning "
1979				"procedure, falling back to fixed sampling "
1980				"clock\n");
1981			ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1982			ctrl &= ~SDHCI_CTRL_TUNED_CLK;
1983			ctrl &= ~SDHCI_CTRL_EXEC_TUNING;
1984			sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
1985
1986			err = -EIO;
1987			goto out;
1988		}
1989
1990		host->tuning_done = 0;
1991
1992		ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
1993		tuning_loop_counter--;
1994		timeout--;
1995		mdelay(1);
 
1996	} while (ctrl & SDHCI_CTRL_EXEC_TUNING);
1997
1998	/*
1999	 * The Host Driver has exhausted the maximum number of loops allowed,
2000	 * so use fixed sampling frequency.
2001	 */
2002	if (!tuning_loop_counter || !timeout) {
2003		ctrl &= ~SDHCI_CTRL_TUNED_CLK;
2004		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
 
 
 
2005		err = -EIO;
2006	} else {
2007		if (!(ctrl & SDHCI_CTRL_TUNED_CLK)) {
2008			pr_info(DRIVER_NAME ": Tuning procedure"
2009				" failed, falling back to fixed sampling"
2010				" clock\n");
2011			err = -EIO;
2012		}
2013	}
2014
2015out:
2016	/*
2017	 * If this is the very first time we are here, we start the retuning
2018	 * timer. Since only during the first time, SDHCI_NEEDS_RETUNING
2019	 * flag won't be set, we check this condition before actually starting
2020	 * the timer.
2021	 */
2022	if (!(host->flags & SDHCI_NEEDS_RETUNING) && host->tuning_count &&
2023	    (host->tuning_mode == SDHCI_TUNING_MODE_1)) {
2024		host->flags |= SDHCI_USING_RETUNING_TIMER;
2025		mod_timer(&host->tuning_timer, jiffies +
2026			host->tuning_count * HZ);
2027		/* Tuning mode 1 limits the maximum data length to 4MB */
2028		mmc->max_blk_count = (4 * 1024 * 1024) / mmc->max_blk_size;
2029	} else if (host->flags & SDHCI_USING_RETUNING_TIMER) {
2030		host->flags &= ~SDHCI_NEEDS_RETUNING;
2031		/* Reload the new initial value for timer */
2032		mod_timer(&host->tuning_timer, jiffies +
2033			  host->tuning_count * HZ);
2034	}
2035
2036	/*
2037	 * In case tuning fails, host controllers which support re-tuning can
2038	 * try tuning again at a later time, when the re-tuning timer expires.
2039	 * So for these controllers, we return 0. Since there might be other
2040	 * controllers who do not have this capability, we return error for
2041	 * them. SDHCI_USING_RETUNING_TIMER means the host is currently using
2042	 * a retuning timer to do the retuning for the card.
2043	 */
2044	if (err && (host->flags & SDHCI_USING_RETUNING_TIMER))
2045		err = 0;
2046
2047	sdhci_clear_set_irqs(host, SDHCI_INT_DATA_AVAIL, ier);
 
 
2048	spin_unlock_irqrestore(&host->lock, flags);
2049	sdhci_runtime_pm_put(host);
2050
2051	return err;
2052}
2053
 
 
 
 
 
 
 
 
 
 
 
 
2054
2055static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable)
2056{
2057	u16 ctrl;
2058
2059	/* Host Controller v3.00 defines preset value registers */
2060	if (host->version < SDHCI_SPEC_300)
2061		return;
2062
2063	ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2);
2064
2065	/*
2066	 * We only enable or disable Preset Value if they are not already
2067	 * enabled or disabled respectively. Otherwise, we bail out.
2068	 */
2069	if (enable && !(ctrl & SDHCI_CTRL_PRESET_VAL_ENABLE)) {
2070		ctrl |= SDHCI_CTRL_PRESET_VAL_ENABLE;
 
 
 
 
 
 
2071		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
2072		host->flags |= SDHCI_PV_ENABLED;
2073	} else if (!enable && (ctrl & SDHCI_CTRL_PRESET_VAL_ENABLE)) {
2074		ctrl &= ~SDHCI_CTRL_PRESET_VAL_ENABLE;
2075		sdhci_writew(host, ctrl, SDHCI_HOST_CONTROL2);
2076		host->flags &= ~SDHCI_PV_ENABLED;
 
 
2077	}
2078}
2079
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2080static void sdhci_card_event(struct mmc_host *mmc)
2081{
2082	struct sdhci_host *host = mmc_priv(mmc);
2083	unsigned long flags;
 
2084
2085	/* First check if client has provided their own card event */
2086	if (host->ops->card_event)
2087		host->ops->card_event(host);
2088
 
 
2089	spin_lock_irqsave(&host->lock, flags);
2090
2091	/* Check host->mrq first in case we are runtime suspended */
2092	if (host->mrq && !sdhci_do_get_cd(host)) {
2093		pr_err("%s: Card removed during transfer!\n",
2094			mmc_hostname(host->mmc));
2095		pr_err("%s: Resetting controller.\n",
2096			mmc_hostname(host->mmc));
2097
2098		sdhci_reset(host, SDHCI_RESET_CMD);
2099		sdhci_reset(host, SDHCI_RESET_DATA);
2100
2101		host->mrq->cmd->error = -ENOMEDIUM;
2102		tasklet_schedule(&host->finish_tasklet);
2103	}
2104
2105	spin_unlock_irqrestore(&host->lock, flags);
2106}
2107
2108static const struct mmc_host_ops sdhci_ops = {
2109	.request	= sdhci_request,
 
 
2110	.set_ios	= sdhci_set_ios,
2111	.get_cd		= sdhci_get_cd,
2112	.get_ro		= sdhci_get_ro,
2113	.hw_reset	= sdhci_hw_reset,
2114	.enable_sdio_irq = sdhci_enable_sdio_irq,
2115	.start_signal_voltage_switch	= sdhci_start_signal_voltage_switch,
 
2116	.execute_tuning			= sdhci_execute_tuning,
 
2117	.card_event			= sdhci_card_event,
2118	.card_busy	= sdhci_card_busy,
2119};
2120
2121/*****************************************************************************\
2122 *                                                                           *
2123 * Tasklets                                                                  *
2124 *                                                                           *
2125\*****************************************************************************/
2126
2127static void sdhci_tasklet_card(unsigned long param)
2128{
2129	struct sdhci_host *host = (struct sdhci_host*)param;
2130
2131	sdhci_card_event(host->mmc);
2132
2133	mmc_detect_change(host->mmc, msecs_to_jiffies(200));
2134}
2135
2136static void sdhci_tasklet_finish(unsigned long param)
2137{
2138	struct sdhci_host *host;
2139	unsigned long flags;
2140	struct mmc_request *mrq;
2141
2142	host = (struct sdhci_host*)param;
2143
2144	spin_lock_irqsave(&host->lock, flags);
2145
2146        /*
2147         * If this tasklet gets rescheduled while running, it will
2148         * be run again afterwards but without any active request.
2149         */
2150	if (!host->mrq) {
2151		spin_unlock_irqrestore(&host->lock, flags);
2152		return;
2153	}
2154
2155	del_timer(&host->timer);
2156
2157	mrq = host->mrq;
2158
2159	/*
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2160	 * The controller needs a reset of internal state machines
2161	 * upon error conditions.
2162	 */
2163	if (!(host->flags & SDHCI_DEVICE_DEAD) &&
2164	    ((mrq->cmd && mrq->cmd->error) ||
2165		 (mrq->data && (mrq->data->error ||
2166		  (mrq->data->stop && mrq->data->stop->error))) ||
2167		   (host->quirks & SDHCI_QUIRK_RESET_AFTER_REQUEST))) {
 
2168
2169		/* Some controllers need this kick or reset won't work here */
2170		if (host->quirks & SDHCI_QUIRK_CLOCK_BEFORE_RESET)
2171			/* This is to force an update */
2172			sdhci_update_clock(host);
2173
2174		/* Spec says we should do both at the same time, but Ricoh
2175		   controllers do not like that. */
2176		sdhci_reset(host, SDHCI_RESET_CMD);
2177		sdhci_reset(host, SDHCI_RESET_DATA);
2178	}
2179
2180	host->mrq = NULL;
2181	host->cmd = NULL;
2182	host->data = NULL;
2183
2184#ifndef SDHCI_USE_LEDS_CLASS
2185	sdhci_deactivate_led(host);
2186#endif
2187
2188	mmiowb();
2189	spin_unlock_irqrestore(&host->lock, flags);
2190
2191	mmc_request_done(host->mmc, mrq);
2192	sdhci_runtime_pm_put(host);
2193}
2194
2195static void sdhci_timeout_timer(unsigned long data)
2196{
2197	struct sdhci_host *host;
2198	unsigned long flags;
2199
2200	host = (struct sdhci_host*)data;
2201
2202	spin_lock_irqsave(&host->lock, flags);
2203
2204	if (host->mrq) {
2205		pr_err("%s: Timeout waiting for hardware "
2206			"interrupt.\n", mmc_hostname(host->mmc));
2207		sdhci_dumpregs(host);
2208
2209		if (host->data) {
2210			host->data->error = -ETIMEDOUT;
2211			sdhci_finish_data(host);
2212		} else {
2213			if (host->cmd)
2214				host->cmd->error = -ETIMEDOUT;
2215			else
2216				host->mrq->cmd->error = -ETIMEDOUT;
2217
2218			tasklet_schedule(&host->finish_tasklet);
2219		}
2220	}
2221
2222	mmiowb();
2223	spin_unlock_irqrestore(&host->lock, flags);
2224}
2225
2226static void sdhci_tuning_timer(unsigned long data)
2227{
2228	struct sdhci_host *host;
2229	unsigned long flags;
2230
2231	host = (struct sdhci_host *)data;
2232
2233	spin_lock_irqsave(&host->lock, flags);
2234
2235	host->flags |= SDHCI_NEEDS_RETUNING;
2236
2237	spin_unlock_irqrestore(&host->lock, flags);
2238}
2239
2240/*****************************************************************************\
2241 *                                                                           *
2242 * Interrupt handling                                                        *
2243 *                                                                           *
2244\*****************************************************************************/
2245
2246static void sdhci_cmd_irq(struct sdhci_host *host, u32 intmask)
2247{
2248	BUG_ON(intmask == 0);
2249
2250	if (!host->cmd) {
2251		pr_err("%s: Got command interrupt 0x%08x even "
2252			"though no command operation was in progress.\n",
2253			mmc_hostname(host->mmc), (unsigned)intmask);
2254		sdhci_dumpregs(host);
2255		return;
2256	}
2257
2258	if (intmask & SDHCI_INT_TIMEOUT)
2259		host->cmd->error = -ETIMEDOUT;
2260	else if (intmask & (SDHCI_INT_CRC | SDHCI_INT_END_BIT |
2261			SDHCI_INT_INDEX))
2262		host->cmd->error = -EILSEQ;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2263
2264	if (host->cmd->error) {
2265		tasklet_schedule(&host->finish_tasklet);
2266		return;
2267	}
2268
2269	/*
2270	 * The host can send and interrupt when the busy state has
2271	 * ended, allowing us to wait without wasting CPU cycles.
2272	 * Unfortunately this is overloaded on the "data complete"
2273	 * interrupt, so we need to take some care when handling
2274	 * it.
2275	 *
2276	 * Note: The 1.0 specification is a bit ambiguous about this
2277	 *       feature so there might be some problems with older
2278	 *       controllers.
2279	 */
2280	if (host->cmd->flags & MMC_RSP_BUSY) {
2281		if (host->cmd->data)
2282			DBG("Cannot wait for busy signal when also "
2283				"doing a data transfer");
2284		else if (!(host->quirks & SDHCI_QUIRK_NO_BUSY_IRQ))
 
 
2285			return;
 
2286
2287		/* The controller does not support the end-of-busy IRQ,
2288		 * fall through and take the SDHCI_INT_RESPONSE */
 
 
 
2289	}
2290
2291	if (intmask & SDHCI_INT_RESPONSE)
2292		sdhci_finish_command(host);
2293}
2294
2295#ifdef CONFIG_MMC_DEBUG
2296static void sdhci_show_adma_error(struct sdhci_host *host)
2297{
2298	const char *name = mmc_hostname(host->mmc);
2299	u8 *desc = host->adma_desc;
2300	__le32 *dma;
2301	__le16 *len;
2302	u8 attr;
2303
2304	sdhci_dumpregs(host);
2305
2306	while (true) {
2307		dma = (__le32 *)(desc + 4);
2308		len = (__le16 *)(desc + 2);
2309		attr = *desc;
2310
2311		DBG("%s: %p: DMA 0x%08x, LEN 0x%04x, Attr=0x%02x\n",
2312		    name, desc, le32_to_cpu(*dma), le16_to_cpu(*len), attr);
 
 
 
 
 
 
 
 
 
2313
2314		desc += 8;
2315
2316		if (attr & 2)
2317			break;
2318	}
2319}
2320#else
2321static void sdhci_show_adma_error(struct sdhci_host *host) { }
2322#endif
2323
2324static void sdhci_data_irq(struct sdhci_host *host, u32 intmask)
2325{
2326	u32 command;
2327	BUG_ON(intmask == 0);
2328
2329	/* CMD19 generates _only_ Buffer Read Ready interrupt */
2330	if (intmask & SDHCI_INT_DATA_AVAIL) {
2331		command = SDHCI_GET_CMD(sdhci_readw(host, SDHCI_COMMAND));
2332		if (command == MMC_SEND_TUNING_BLOCK ||
2333		    command == MMC_SEND_TUNING_BLOCK_HS200) {
2334			host->tuning_done = 1;
2335			wake_up(&host->buf_ready_int);
2336			return;
2337		}
2338	}
2339
2340	if (!host->data) {
2341		/*
2342		 * The "data complete" interrupt is also used to
2343		 * indicate that a busy state has ended. See comment
2344		 * above in sdhci_cmd_irq().
2345		 */
2346		if (host->cmd && (host->cmd->flags & MMC_RSP_BUSY)) {
 
 
 
 
 
2347			if (intmask & SDHCI_INT_DATA_END) {
2348				sdhci_finish_command(host);
 
 
 
 
 
 
 
 
2349				return;
2350			}
2351		}
2352
2353		pr_err("%s: Got data interrupt 0x%08x even "
2354			"though no data operation was in progress.\n",
2355			mmc_hostname(host->mmc), (unsigned)intmask);
2356		sdhci_dumpregs(host);
2357
2358		return;
2359	}
2360
2361	if (intmask & SDHCI_INT_DATA_TIMEOUT)
2362		host->data->error = -ETIMEDOUT;
2363	else if (intmask & SDHCI_INT_DATA_END_BIT)
2364		host->data->error = -EILSEQ;
2365	else if ((intmask & SDHCI_INT_DATA_CRC) &&
2366		SDHCI_GET_CMD(sdhci_readw(host, SDHCI_COMMAND))
2367			!= MMC_BUS_TEST_R)
2368		host->data->error = -EILSEQ;
2369	else if (intmask & SDHCI_INT_ADMA_ERROR) {
2370		pr_err("%s: ADMA error\n", mmc_hostname(host->mmc));
2371		sdhci_show_adma_error(host);
2372		host->data->error = -EIO;
2373		if (host->ops->adma_workaround)
2374			host->ops->adma_workaround(host, intmask);
2375	}
2376
2377	if (host->data->error)
2378		sdhci_finish_data(host);
2379	else {
2380		if (intmask & (SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL))
2381			sdhci_transfer_pio(host);
2382
2383		/*
2384		 * We currently don't do anything fancy with DMA
2385		 * boundaries, but as we can't disable the feature
2386		 * we need to at least restart the transfer.
2387		 *
2388		 * According to the spec sdhci_readl(host, SDHCI_DMA_ADDRESS)
2389		 * should return a valid address to continue from, but as
2390		 * some controllers are faulty, don't trust them.
2391		 */
2392		if (intmask & SDHCI_INT_DMA_END) {
2393			u32 dmastart, dmanow;
2394			dmastart = sg_dma_address(host->data->sg);
2395			dmanow = dmastart + host->data->bytes_xfered;
2396			/*
2397			 * Force update to the next DMA block boundary.
2398			 */
2399			dmanow = (dmanow &
2400				~(SDHCI_DEFAULT_BOUNDARY_SIZE - 1)) +
2401				SDHCI_DEFAULT_BOUNDARY_SIZE;
2402			host->data->bytes_xfered = dmanow - dmastart;
2403			DBG("%s: DMA base 0x%08x, transferred 0x%06x bytes,"
2404				" next 0x%08x\n",
2405				mmc_hostname(host->mmc), dmastart,
2406				host->data->bytes_xfered, dmanow);
2407			sdhci_writel(host, dmanow, SDHCI_DMA_ADDRESS);
2408		}
2409
2410		if (intmask & SDHCI_INT_DATA_END) {
2411			if (host->cmd) {
2412				/*
2413				 * Data managed to finish before the
2414				 * command completed. Make sure we do
2415				 * things in the proper order.
2416				 */
2417				host->data_early = 1;
2418			} else {
2419				sdhci_finish_data(host);
2420			}
2421		}
2422	}
2423}
2424
2425static irqreturn_t sdhci_irq(int irq, void *dev_id)
2426{
2427	irqreturn_t result;
2428	struct sdhci_host *host = dev_id;
2429	u32 intmask, unexpected = 0;
2430	int cardint = 0, max_loops = 16;
2431
2432	spin_lock(&host->lock);
2433
2434	if (host->runtime_suspended) {
2435		spin_unlock(&host->lock);
2436		return IRQ_NONE;
2437	}
2438
2439	intmask = sdhci_readl(host, SDHCI_INT_STATUS);
2440
2441	if (!intmask || intmask == 0xffffffff) {
2442		result = IRQ_NONE;
2443		goto out;
2444	}
2445
2446again:
2447	DBG("*** %s got interrupt: 0x%08x\n",
2448		mmc_hostname(host->mmc), intmask);
2449
2450	if (intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
2451		u32 present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
2452			      SDHCI_CARD_PRESENT;
 
 
 
 
 
2453
2454		/*
2455		 * There is a observation on i.mx esdhc.  INSERT bit will be
2456		 * immediately set again when it gets cleared, if a card is
2457		 * inserted.  We have to mask the irq to prevent interrupt
2458		 * storm which will freeze the system.  And the REMOVE gets
2459		 * the same situation.
2460		 *
2461		 * More testing are needed here to ensure it works for other
2462		 * platforms though.
2463		 */
2464		sdhci_mask_irqs(host, present ? SDHCI_INT_CARD_INSERT :
2465						SDHCI_INT_CARD_REMOVE);
2466		sdhci_unmask_irqs(host, present ? SDHCI_INT_CARD_REMOVE :
2467						  SDHCI_INT_CARD_INSERT);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2468
2469		sdhci_writel(host, intmask & (SDHCI_INT_CARD_INSERT |
2470			     SDHCI_INT_CARD_REMOVE), SDHCI_INT_STATUS);
2471		intmask &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE);
2472		tasklet_schedule(&host->card_tasklet);
2473	}
2474
2475	if (intmask & SDHCI_INT_CMD_MASK) {
2476		sdhci_writel(host, intmask & SDHCI_INT_CMD_MASK,
2477			SDHCI_INT_STATUS);
2478		sdhci_cmd_irq(host, intmask & SDHCI_INT_CMD_MASK);
2479	}
2480
2481	if (intmask & SDHCI_INT_DATA_MASK) {
2482		sdhci_writel(host, intmask & SDHCI_INT_DATA_MASK,
2483			SDHCI_INT_STATUS);
2484		sdhci_data_irq(host, intmask & SDHCI_INT_DATA_MASK);
2485	}
2486
2487	intmask &= ~(SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK);
 
 
 
2488
2489	intmask &= ~SDHCI_INT_ERROR;
2490
2491	if (intmask & SDHCI_INT_BUS_POWER) {
2492		pr_err("%s: Card is consuming too much power!\n",
2493			mmc_hostname(host->mmc));
2494		sdhci_writel(host, SDHCI_INT_BUS_POWER, SDHCI_INT_STATUS);
2495	}
2496
2497	intmask &= ~SDHCI_INT_BUS_POWER;
2498
2499	if (intmask & SDHCI_INT_CARD_INT)
2500		cardint = 1;
2501
2502	intmask &= ~SDHCI_INT_CARD_INT;
2503
2504	if (intmask) {
2505		unexpected |= intmask;
2506		sdhci_writel(host, intmask, SDHCI_INT_STATUS);
2507	}
2508
2509	result = IRQ_HANDLED;
2510
2511	intmask = sdhci_readl(host, SDHCI_INT_STATUS);
2512
2513	/*
2514	 * If we know we'll call the driver to signal SDIO IRQ, disregard
2515	 * further indications of Card Interrupt in the status to avoid a
2516	 * needless loop.
2517	 */
2518	if (cardint)
2519		intmask &= ~SDHCI_INT_CARD_INT;
2520	if (intmask && --max_loops)
2521		goto again;
2522out:
2523	spin_unlock(&host->lock);
2524
2525	if (unexpected) {
2526		pr_err("%s: Unexpected interrupt 0x%08x.\n",
2527			   mmc_hostname(host->mmc), unexpected);
2528		sdhci_dumpregs(host);
2529	}
2530	/*
2531	 * We have to delay this as it calls back into the driver.
2532	 */
2533	if (cardint)
2534		mmc_signal_sdio_irq(host->mmc);
2535
2536	return result;
2537}
2538
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2539/*****************************************************************************\
2540 *                                                                           *
2541 * Suspend/resume                                                            *
2542 *                                                                           *
2543\*****************************************************************************/
2544
2545#ifdef CONFIG_PM
2546void sdhci_enable_irq_wakeups(struct sdhci_host *host)
2547{
2548	u8 val;
2549	u8 mask = SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE
2550			| SDHCI_WAKE_ON_INT;
2551
2552	val = sdhci_readb(host, SDHCI_WAKE_UP_CONTROL);
2553	val |= mask ;
2554	/* Avoid fake wake up */
2555	if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
2556		val &= ~(SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE);
2557	sdhci_writeb(host, val, SDHCI_WAKE_UP_CONTROL);
2558}
2559EXPORT_SYMBOL_GPL(sdhci_enable_irq_wakeups);
2560
2561void sdhci_disable_irq_wakeups(struct sdhci_host *host)
2562{
2563	u8 val;
2564	u8 mask = SDHCI_WAKE_ON_INSERT | SDHCI_WAKE_ON_REMOVE
2565			| SDHCI_WAKE_ON_INT;
2566
2567	val = sdhci_readb(host, SDHCI_WAKE_UP_CONTROL);
2568	val &= ~mask;
2569	sdhci_writeb(host, val, SDHCI_WAKE_UP_CONTROL);
2570}
2571EXPORT_SYMBOL_GPL(sdhci_disable_irq_wakeups);
2572
2573int sdhci_suspend_host(struct sdhci_host *host)
2574{
2575	if (host->ops->platform_suspend)
2576		host->ops->platform_suspend(host);
2577
2578	sdhci_disable_card_detection(host);
2579
2580	/* Disable tuning since we are suspending */
2581	if (host->flags & SDHCI_USING_RETUNING_TIMER) {
2582		del_timer_sync(&host->tuning_timer);
2583		host->flags &= ~SDHCI_NEEDS_RETUNING;
2584	}
2585
2586	if (!device_may_wakeup(mmc_dev(host->mmc))) {
2587		sdhci_mask_irqs(host, SDHCI_INT_ALL_MASK);
 
 
2588		free_irq(host->irq, host);
2589	} else {
2590		sdhci_enable_irq_wakeups(host);
2591		enable_irq_wake(host->irq);
2592	}
2593	return 0;
2594}
2595
2596EXPORT_SYMBOL_GPL(sdhci_suspend_host);
2597
2598int sdhci_resume_host(struct sdhci_host *host)
2599{
2600	int ret = 0;
2601
2602	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
2603		if (host->ops->enable_dma)
2604			host->ops->enable_dma(host);
2605	}
2606
2607	if (!device_may_wakeup(mmc_dev(host->mmc))) {
2608		ret = request_irq(host->irq, sdhci_irq, IRQF_SHARED,
2609				  mmc_hostname(host->mmc), host);
2610		if (ret)
2611			return ret;
2612	} else {
2613		sdhci_disable_irq_wakeups(host);
2614		disable_irq_wake(host->irq);
2615	}
2616
2617	if ((host->mmc->pm_flags & MMC_PM_KEEP_POWER) &&
2618	    (host->quirks2 & SDHCI_QUIRK2_HOST_OFF_CARD_ON)) {
2619		/* Card keeps power but host controller does not */
2620		sdhci_init(host, 0);
2621		host->pwr = 0;
2622		host->clock = 0;
2623		sdhci_do_set_ios(host, &host->mmc->ios);
2624	} else {
2625		sdhci_init(host, (host->mmc->pm_flags & MMC_PM_KEEP_POWER));
2626		mmiowb();
2627	}
2628
 
 
 
 
 
 
 
 
 
 
 
2629	sdhci_enable_card_detection(host);
2630
2631	if (host->ops->platform_resume)
2632		host->ops->platform_resume(host);
2633
2634	/* Set the re-tuning expiration flag */
2635	if (host->flags & SDHCI_USING_RETUNING_TIMER)
2636		host->flags |= SDHCI_NEEDS_RETUNING;
2637
2638	return ret;
2639}
2640
2641EXPORT_SYMBOL_GPL(sdhci_resume_host);
2642#endif /* CONFIG_PM */
2643
2644#ifdef CONFIG_PM_RUNTIME
2645
2646static int sdhci_runtime_pm_get(struct sdhci_host *host)
2647{
2648	return pm_runtime_get_sync(host->mmc->parent);
2649}
2650
2651static int sdhci_runtime_pm_put(struct sdhci_host *host)
2652{
2653	pm_runtime_mark_last_busy(host->mmc->parent);
2654	return pm_runtime_put_autosuspend(host->mmc->parent);
2655}
2656
2657static void sdhci_runtime_pm_bus_on(struct sdhci_host *host)
2658{
2659	if (host->runtime_suspended || host->bus_on)
2660		return;
2661	host->bus_on = true;
2662	pm_runtime_get_noresume(host->mmc->parent);
2663}
2664
2665static void sdhci_runtime_pm_bus_off(struct sdhci_host *host)
2666{
2667	if (host->runtime_suspended || !host->bus_on)
2668		return;
2669	host->bus_on = false;
2670	pm_runtime_put_noidle(host->mmc->parent);
2671}
2672
2673int sdhci_runtime_suspend_host(struct sdhci_host *host)
2674{
2675	unsigned long flags;
2676	int ret = 0;
2677
2678	/* Disable tuning since we are suspending */
2679	if (host->flags & SDHCI_USING_RETUNING_TIMER) {
2680		del_timer_sync(&host->tuning_timer);
2681		host->flags &= ~SDHCI_NEEDS_RETUNING;
2682	}
2683
2684	spin_lock_irqsave(&host->lock, flags);
2685	sdhci_mask_irqs(host, SDHCI_INT_ALL_MASK);
 
 
2686	spin_unlock_irqrestore(&host->lock, flags);
2687
2688	synchronize_irq(host->irq);
2689
2690	spin_lock_irqsave(&host->lock, flags);
2691	host->runtime_suspended = true;
2692	spin_unlock_irqrestore(&host->lock, flags);
2693
2694	return ret;
2695}
2696EXPORT_SYMBOL_GPL(sdhci_runtime_suspend_host);
2697
2698int sdhci_runtime_resume_host(struct sdhci_host *host)
2699{
2700	unsigned long flags;
2701	int ret = 0, host_flags = host->flags;
2702
2703	if (host_flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
2704		if (host->ops->enable_dma)
2705			host->ops->enable_dma(host);
2706	}
2707
2708	sdhci_init(host, 0);
2709
2710	/* Force clock and power re-program */
2711	host->pwr = 0;
2712	host->clock = 0;
 
2713	sdhci_do_set_ios(host, &host->mmc->ios);
2714
2715	sdhci_do_start_signal_voltage_switch(host, &host->mmc->ios);
2716	if ((host_flags & SDHCI_PV_ENABLED) &&
2717		!(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN)) {
2718		spin_lock_irqsave(&host->lock, flags);
2719		sdhci_enable_preset_value(host, true);
2720		spin_unlock_irqrestore(&host->lock, flags);
2721	}
2722
2723	/* Set the re-tuning expiration flag */
2724	if (host->flags & SDHCI_USING_RETUNING_TIMER)
2725		host->flags |= SDHCI_NEEDS_RETUNING;
2726
2727	spin_lock_irqsave(&host->lock, flags);
2728
2729	host->runtime_suspended = false;
2730
2731	/* Enable SDIO IRQ */
2732	if ((host->flags & SDHCI_SDIO_IRQ_ENABLED))
2733		sdhci_enable_sdio_irq_nolock(host, true);
2734
2735	/* Enable Card Detection */
2736	sdhci_enable_card_detection(host);
2737
2738	spin_unlock_irqrestore(&host->lock, flags);
2739
2740	return ret;
2741}
2742EXPORT_SYMBOL_GPL(sdhci_runtime_resume_host);
2743
2744#endif
2745
2746/*****************************************************************************\
2747 *                                                                           *
2748 * Device allocation/registration                                            *
2749 *                                                                           *
2750\*****************************************************************************/
2751
2752struct sdhci_host *sdhci_alloc_host(struct device *dev,
2753	size_t priv_size)
2754{
2755	struct mmc_host *mmc;
2756	struct sdhci_host *host;
2757
2758	WARN_ON(dev == NULL);
2759
2760	mmc = mmc_alloc_host(sizeof(struct sdhci_host) + priv_size, dev);
2761	if (!mmc)
2762		return ERR_PTR(-ENOMEM);
2763
2764	host = mmc_priv(mmc);
2765	host->mmc = mmc;
 
 
2766
2767	return host;
2768}
2769
2770EXPORT_SYMBOL_GPL(sdhci_alloc_host);
2771
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2772int sdhci_add_host(struct sdhci_host *host)
2773{
2774	struct mmc_host *mmc;
2775	u32 caps[2] = {0, 0};
2776	u32 max_current_caps;
2777	unsigned int ocr_avail;
 
 
2778	int ret;
2779
2780	WARN_ON(host == NULL);
2781	if (host == NULL)
2782		return -EINVAL;
2783
2784	mmc = host->mmc;
2785
2786	if (debug_quirks)
2787		host->quirks = debug_quirks;
2788	if (debug_quirks2)
2789		host->quirks2 = debug_quirks2;
2790
2791	sdhci_reset(host, SDHCI_RESET_ALL);
 
 
2792
2793	host->version = sdhci_readw(host, SDHCI_HOST_VERSION);
2794	host->version = (host->version & SDHCI_SPEC_VER_MASK)
2795				>> SDHCI_SPEC_VER_SHIFT;
2796	if (host->version > SDHCI_SPEC_300) {
2797		pr_err("%s: Unknown controller version (%d). "
2798			"You may experience problems.\n", mmc_hostname(mmc),
2799			host->version);
2800	}
2801
2802	caps[0] = (host->quirks & SDHCI_QUIRK_MISSING_CAPS) ? host->caps :
2803		sdhci_readl(host, SDHCI_CAPABILITIES);
2804
2805	if (host->version >= SDHCI_SPEC_300)
2806		caps[1] = (host->quirks & SDHCI_QUIRK_MISSING_CAPS) ?
2807			host->caps1 :
2808			sdhci_readl(host, SDHCI_CAPABILITIES_1);
2809
2810	if (host->quirks & SDHCI_QUIRK_FORCE_DMA)
2811		host->flags |= SDHCI_USE_SDMA;
2812	else if (!(caps[0] & SDHCI_CAN_DO_SDMA))
2813		DBG("Controller doesn't have SDMA capability\n");
2814	else
2815		host->flags |= SDHCI_USE_SDMA;
2816
2817	if ((host->quirks & SDHCI_QUIRK_BROKEN_DMA) &&
2818		(host->flags & SDHCI_USE_SDMA)) {
2819		DBG("Disabling DMA as it is marked broken\n");
2820		host->flags &= ~SDHCI_USE_SDMA;
2821	}
2822
2823	if ((host->version >= SDHCI_SPEC_200) &&
2824		(caps[0] & SDHCI_CAN_DO_ADMA2))
2825		host->flags |= SDHCI_USE_ADMA;
2826
2827	if ((host->quirks & SDHCI_QUIRK_BROKEN_ADMA) &&
2828		(host->flags & SDHCI_USE_ADMA)) {
2829		DBG("Disabling ADMA as it is marked broken\n");
2830		host->flags &= ~SDHCI_USE_ADMA;
2831	}
2832
 
 
 
 
 
 
 
 
 
 
2833	if (host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA)) {
2834		if (host->ops->enable_dma) {
2835			if (host->ops->enable_dma(host)) {
2836				pr_warning("%s: No suitable DMA "
2837					"available. Falling back to PIO.\n",
2838					mmc_hostname(mmc));
2839				host->flags &=
2840					~(SDHCI_USE_SDMA | SDHCI_USE_ADMA);
2841			}
 
 
 
2842		}
2843	}
2844
 
 
 
 
2845	if (host->flags & SDHCI_USE_ADMA) {
 
 
 
2846		/*
2847		 * We need to allocate descriptors for all sg entries
2848		 * (128) and potentially one alignment transfer for
2849		 * each of those entries.
 
2850		 */
2851		host->adma_desc = kmalloc((128 * 2 + 1) * 4, GFP_KERNEL);
2852		host->align_buffer = kmalloc(128 * 4, GFP_KERNEL);
2853		if (!host->adma_desc || !host->align_buffer) {
2854			kfree(host->adma_desc);
2855			kfree(host->align_buffer);
2856			pr_warning("%s: Unable to allocate ADMA "
2857				"buffers. Falling back to standard DMA.\n",
 
 
 
 
 
 
 
 
2858				mmc_hostname(mmc));
2859			host->flags &= ~SDHCI_USE_ADMA;
 
 
 
 
 
 
 
 
 
 
 
 
 
2860		}
2861	}
2862
2863	/*
2864	 * If we use DMA, then it's up to the caller to set the DMA
2865	 * mask, but PIO does not need the hw shim so we set a new
2866	 * mask here in that case.
2867	 */
2868	if (!(host->flags & (SDHCI_USE_SDMA | SDHCI_USE_ADMA))) {
2869		host->dma_mask = DMA_BIT_MASK(64);
2870		mmc_dev(host->mmc)->dma_mask = &host->dma_mask;
2871	}
2872
2873	if (host->version >= SDHCI_SPEC_300)
2874		host->max_clk = (caps[0] & SDHCI_CLOCK_V3_BASE_MASK)
2875			>> SDHCI_CLOCK_BASE_SHIFT;
2876	else
2877		host->max_clk = (caps[0] & SDHCI_CLOCK_BASE_MASK)
2878			>> SDHCI_CLOCK_BASE_SHIFT;
2879
2880	host->max_clk *= 1000000;
2881	if (host->max_clk == 0 || host->quirks &
2882			SDHCI_QUIRK_CAP_CLOCK_BASE_BROKEN) {
2883		if (!host->ops->get_max_clock) {
2884			pr_err("%s: Hardware doesn't specify base clock "
2885			       "frequency.\n", mmc_hostname(mmc));
2886			return -ENODEV;
2887		}
2888		host->max_clk = host->ops->get_max_clock(host);
2889	}
2890
2891	/*
2892	 * In case of Host Controller v3.00, find out whether clock
2893	 * multiplier is supported.
2894	 */
2895	host->clk_mul = (caps[1] & SDHCI_CLOCK_MUL_MASK) >>
2896			SDHCI_CLOCK_MUL_SHIFT;
2897
2898	/*
2899	 * In case the value in Clock Multiplier is 0, then programmable
2900	 * clock mode is not supported, otherwise the actual clock
2901	 * multiplier is one more than the value of Clock Multiplier
2902	 * in the Capabilities Register.
2903	 */
2904	if (host->clk_mul)
2905		host->clk_mul += 1;
2906
2907	/*
2908	 * Set host parameters.
2909	 */
2910	mmc->ops = &sdhci_ops;
2911	mmc->f_max = host->max_clk;
2912	if (host->ops->get_min_clock)
2913		mmc->f_min = host->ops->get_min_clock(host);
2914	else if (host->version >= SDHCI_SPEC_300) {
2915		if (host->clk_mul) {
2916			mmc->f_min = (host->max_clk * host->clk_mul) / 1024;
2917			mmc->f_max = host->max_clk * host->clk_mul;
2918		} else
2919			mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_300;
2920	} else
2921		mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_200;
2922
2923	host->timeout_clk =
2924		(caps[0] & SDHCI_TIMEOUT_CLK_MASK) >> SDHCI_TIMEOUT_CLK_SHIFT;
2925	if (host->timeout_clk == 0) {
2926		if (host->ops->get_timeout_clock) {
2927			host->timeout_clk = host->ops->get_timeout_clock(host);
2928		} else if (!(host->quirks &
2929				SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK)) {
2930			pr_err("%s: Hardware doesn't specify timeout clock "
2931			       "frequency.\n", mmc_hostname(mmc));
2932			return -ENODEV;
 
 
 
 
 
2933		}
2934	}
2935	if (caps[0] & SDHCI_TIMEOUT_CLK_UNIT)
2936		host->timeout_clk *= 1000;
2937
2938	if (host->quirks & SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK)
2939		host->timeout_clk = mmc->f_max / 1000;
2940
2941	mmc->max_busy_timeout = (1 << 27) / host->timeout_clk;
 
 
 
 
 
 
2942
2943	mmc->caps |= MMC_CAP_SDIO_IRQ | MMC_CAP_ERASE | MMC_CAP_CMD23;
 
2944
2945	if (host->quirks & SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12)
2946		host->flags |= SDHCI_AUTO_CMD12;
2947
2948	/* Auto-CMD23 stuff only works in ADMA or PIO. */
2949	if ((host->version >= SDHCI_SPEC_300) &&
2950	    ((host->flags & SDHCI_USE_ADMA) ||
2951	     !(host->flags & SDHCI_USE_SDMA))) {
 
2952		host->flags |= SDHCI_AUTO_CMD23;
2953		DBG("%s: Auto-CMD23 available\n", mmc_hostname(mmc));
2954	} else {
2955		DBG("%s: Auto-CMD23 unavailable\n", mmc_hostname(mmc));
2956	}
2957
2958	/*
2959	 * A controller may support 8-bit width, but the board itself
2960	 * might not have the pins brought out.  Boards that support
2961	 * 8-bit width must set "mmc->caps |= MMC_CAP_8_BIT_DATA;" in
2962	 * their platform code before calling sdhci_add_host(), and we
2963	 * won't assume 8-bit width for hosts without that CAP.
2964	 */
2965	if (!(host->quirks & SDHCI_QUIRK_FORCE_1_BIT_DATA))
2966		mmc->caps |= MMC_CAP_4_BIT_DATA;
2967
2968	if (host->quirks2 & SDHCI_QUIRK2_HOST_NO_CMD23)
2969		mmc->caps &= ~MMC_CAP_CMD23;
2970
2971	if (caps[0] & SDHCI_CAN_DO_HISPD)
2972		mmc->caps |= MMC_CAP_SD_HIGHSPEED | MMC_CAP_MMC_HIGHSPEED;
2973
2974	if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) &&
2975	    !(host->mmc->caps & MMC_CAP_NONREMOVABLE))
 
2976		mmc->caps |= MMC_CAP_NEEDS_POLL;
2977
 
 
 
 
2978	/* If vqmmc regulator and no 1.8V signalling, then there's no UHS */
2979	host->vqmmc = regulator_get_optional(mmc_dev(mmc), "vqmmc");
2980	if (IS_ERR_OR_NULL(host->vqmmc)) {
2981		if (PTR_ERR(host->vqmmc) < 0) {
2982			pr_info("%s: no vqmmc regulator found\n",
2983				mmc_hostname(mmc));
2984			host->vqmmc = NULL;
2985		}
2986	} else {
2987		ret = regulator_enable(host->vqmmc);
2988		if (!regulator_is_supported_voltage(host->vqmmc, 1700000,
2989			1950000))
2990			caps[1] &= ~(SDHCI_SUPPORT_SDR104 |
2991					SDHCI_SUPPORT_SDR50 |
2992					SDHCI_SUPPORT_DDR50);
2993		if (ret) {
2994			pr_warn("%s: Failed to enable vqmmc regulator: %d\n",
2995				mmc_hostname(mmc), ret);
2996			host->vqmmc = NULL;
2997		}
2998	}
2999
3000	if (host->quirks2 & SDHCI_QUIRK2_NO_1_8_V)
3001		caps[1] &= ~(SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
3002		       SDHCI_SUPPORT_DDR50);
3003
3004	/* Any UHS-I mode in caps implies SDR12 and SDR25 support. */
3005	if (caps[1] & (SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
3006		       SDHCI_SUPPORT_DDR50))
3007		mmc->caps |= MMC_CAP_UHS_SDR12 | MMC_CAP_UHS_SDR25;
3008
3009	/* SDR104 supports also implies SDR50 support */
3010	if (caps[1] & SDHCI_SUPPORT_SDR104) {
3011		mmc->caps |= MMC_CAP_UHS_SDR104 | MMC_CAP_UHS_SDR50;
3012		/* SD3.0: SDR104 is supported so (for eMMC) the caps2
3013		 * field can be promoted to support HS200.
3014		 */
3015		if (!(host->quirks2 & SDHCI_QUIRK2_BROKEN_HS200))
3016			mmc->caps2 |= MMC_CAP2_HS200;
3017	} else if (caps[1] & SDHCI_SUPPORT_SDR50)
3018		mmc->caps |= MMC_CAP_UHS_SDR50;
3019
 
 
 
 
 
 
 
 
 
 
3020	if ((caps[1] & SDHCI_SUPPORT_DDR50) &&
3021		!(host->quirks2 & SDHCI_QUIRK2_BROKEN_DDR50))
3022		mmc->caps |= MMC_CAP_UHS_DDR50;
3023
3024	/* Does the host need tuning for SDR50? */
3025	if (caps[1] & SDHCI_USE_SDR50_TUNING)
3026		host->flags |= SDHCI_SDR50_NEEDS_TUNING;
3027
3028	/* Does the host need tuning for SDR104 / HS200? */
3029	if (mmc->caps2 & MMC_CAP2_HS200)
3030		host->flags |= SDHCI_SDR104_NEEDS_TUNING;
3031
3032	/* Driver Type(s) (A, C, D) supported by the host */
3033	if (caps[1] & SDHCI_DRIVER_TYPE_A)
3034		mmc->caps |= MMC_CAP_DRIVER_TYPE_A;
3035	if (caps[1] & SDHCI_DRIVER_TYPE_C)
3036		mmc->caps |= MMC_CAP_DRIVER_TYPE_C;
3037	if (caps[1] & SDHCI_DRIVER_TYPE_D)
3038		mmc->caps |= MMC_CAP_DRIVER_TYPE_D;
3039
3040	/* Initial value for re-tuning timer count */
3041	host->tuning_count = (caps[1] & SDHCI_RETUNING_TIMER_COUNT_MASK) >>
3042			      SDHCI_RETUNING_TIMER_COUNT_SHIFT;
3043
3044	/*
3045	 * In case Re-tuning Timer is not disabled, the actual value of
3046	 * re-tuning timer will be 2 ^ (n - 1).
3047	 */
3048	if (host->tuning_count)
3049		host->tuning_count = 1 << (host->tuning_count - 1);
3050
3051	/* Re-tuning mode supported by the Host Controller */
3052	host->tuning_mode = (caps[1] & SDHCI_RETUNING_MODE_MASK) >>
3053			     SDHCI_RETUNING_MODE_SHIFT;
3054
3055	ocr_avail = 0;
3056
3057	host->vmmc = regulator_get_optional(mmc_dev(mmc), "vmmc");
3058	if (IS_ERR_OR_NULL(host->vmmc)) {
3059		if (PTR_ERR(host->vmmc) < 0) {
3060			pr_info("%s: no vmmc regulator found\n",
3061				mmc_hostname(mmc));
3062			host->vmmc = NULL;
3063		}
3064	}
3065
3066#ifdef CONFIG_REGULATOR
3067	/*
3068	 * Voltage range check makes sense only if regulator reports
3069	 * any voltage value.
3070	 */
3071	if (host->vmmc && regulator_get_voltage(host->vmmc) > 0) {
3072		ret = regulator_is_supported_voltage(host->vmmc, 2700000,
3073			3600000);
3074		if ((ret <= 0) || (!(caps[0] & SDHCI_CAN_VDD_330)))
3075			caps[0] &= ~SDHCI_CAN_VDD_330;
3076		if ((ret <= 0) || (!(caps[0] & SDHCI_CAN_VDD_300)))
3077			caps[0] &= ~SDHCI_CAN_VDD_300;
3078		ret = regulator_is_supported_voltage(host->vmmc, 1700000,
3079			1950000);
3080		if ((ret <= 0) || (!(caps[0] & SDHCI_CAN_VDD_180)))
3081			caps[0] &= ~SDHCI_CAN_VDD_180;
3082	}
3083#endif /* CONFIG_REGULATOR */
3084
3085	/*
3086	 * According to SD Host Controller spec v3.00, if the Host System
3087	 * can afford more than 150mA, Host Driver should set XPC to 1. Also
3088	 * the value is meaningful only if Voltage Support in the Capabilities
3089	 * register is set. The actual current value is 4 times the register
3090	 * value.
3091	 */
3092	max_current_caps = sdhci_readl(host, SDHCI_MAX_CURRENT);
3093	if (!max_current_caps && host->vmmc) {
3094		u32 curr = regulator_get_current_limit(host->vmmc);
3095		if (curr > 0) {
3096
3097			/* convert to SDHCI_MAX_CURRENT format */
3098			curr = curr/1000;  /* convert to mA */
3099			curr = curr/SDHCI_MAX_CURRENT_MULTIPLIER;
3100
3101			curr = min_t(u32, curr, SDHCI_MAX_CURRENT_LIMIT);
3102			max_current_caps =
3103				(curr << SDHCI_MAX_CURRENT_330_SHIFT) |
3104				(curr << SDHCI_MAX_CURRENT_300_SHIFT) |
3105				(curr << SDHCI_MAX_CURRENT_180_SHIFT);
3106		}
3107	}
3108
3109	if (caps[0] & SDHCI_CAN_VDD_330) {
3110		ocr_avail |= MMC_VDD_32_33 | MMC_VDD_33_34;
3111
3112		mmc->max_current_330 = ((max_current_caps &
3113				   SDHCI_MAX_CURRENT_330_MASK) >>
3114				   SDHCI_MAX_CURRENT_330_SHIFT) *
3115				   SDHCI_MAX_CURRENT_MULTIPLIER;
3116	}
3117	if (caps[0] & SDHCI_CAN_VDD_300) {
3118		ocr_avail |= MMC_VDD_29_30 | MMC_VDD_30_31;
3119
3120		mmc->max_current_300 = ((max_current_caps &
3121				   SDHCI_MAX_CURRENT_300_MASK) >>
3122				   SDHCI_MAX_CURRENT_300_SHIFT) *
3123				   SDHCI_MAX_CURRENT_MULTIPLIER;
3124	}
3125	if (caps[0] & SDHCI_CAN_VDD_180) {
3126		ocr_avail |= MMC_VDD_165_195;
3127
3128		mmc->max_current_180 = ((max_current_caps &
3129				   SDHCI_MAX_CURRENT_180_MASK) >>
3130				   SDHCI_MAX_CURRENT_180_SHIFT) *
3131				   SDHCI_MAX_CURRENT_MULTIPLIER;
3132	}
3133
 
3134	if (host->ocr_mask)
3135		ocr_avail = host->ocr_mask;
3136
 
 
 
 
3137	mmc->ocr_avail = ocr_avail;
3138	mmc->ocr_avail_sdio = ocr_avail;
3139	if (host->ocr_avail_sdio)
3140		mmc->ocr_avail_sdio &= host->ocr_avail_sdio;
3141	mmc->ocr_avail_sd = ocr_avail;
3142	if (host->ocr_avail_sd)
3143		mmc->ocr_avail_sd &= host->ocr_avail_sd;
3144	else /* normal SD controllers don't support 1.8V */
3145		mmc->ocr_avail_sd &= ~MMC_VDD_165_195;
3146	mmc->ocr_avail_mmc = ocr_avail;
3147	if (host->ocr_avail_mmc)
3148		mmc->ocr_avail_mmc &= host->ocr_avail_mmc;
3149
3150	if (mmc->ocr_avail == 0) {
3151		pr_err("%s: Hardware doesn't report any "
3152			"support voltages.\n", mmc_hostname(mmc));
3153		return -ENODEV;
3154	}
3155
3156	spin_lock_init(&host->lock);
3157
3158	/*
3159	 * Maximum number of segments. Depends on if the hardware
3160	 * can do scatter/gather or not.
3161	 */
3162	if (host->flags & SDHCI_USE_ADMA)
3163		mmc->max_segs = 128;
3164	else if (host->flags & SDHCI_USE_SDMA)
3165		mmc->max_segs = 1;
3166	else /* PIO */
3167		mmc->max_segs = 128;
3168
3169	/*
3170	 * Maximum number of sectors in one transfer. Limited by DMA boundary
3171	 * size (512KiB).
 
3172	 */
3173	mmc->max_req_size = 524288;
3174
3175	/*
3176	 * Maximum segment size. Could be one segment with the maximum number
3177	 * of bytes. When doing hardware scatter/gather, each entry cannot
3178	 * be larger than 64 KiB though.
3179	 */
3180	if (host->flags & SDHCI_USE_ADMA) {
3181		if (host->quirks & SDHCI_QUIRK_BROKEN_ADMA_ZEROLEN_DESC)
3182			mmc->max_seg_size = 65535;
3183		else
3184			mmc->max_seg_size = 65536;
3185	} else {
3186		mmc->max_seg_size = mmc->max_req_size;
3187	}
3188
3189	/*
3190	 * Maximum block size. This varies from controller to controller and
3191	 * is specified in the capabilities register.
3192	 */
3193	if (host->quirks & SDHCI_QUIRK_FORCE_BLK_SZ_2048) {
3194		mmc->max_blk_size = 2;
3195	} else {
3196		mmc->max_blk_size = (caps[0] & SDHCI_MAX_BLOCK_MASK) >>
3197				SDHCI_MAX_BLOCK_SHIFT;
3198		if (mmc->max_blk_size >= 3) {
3199			pr_warning("%s: Invalid maximum block size, "
3200				"assuming 512 bytes\n", mmc_hostname(mmc));
3201			mmc->max_blk_size = 0;
3202		}
3203	}
3204
3205	mmc->max_blk_size = 512 << mmc->max_blk_size;
3206
3207	/*
3208	 * Maximum block count.
3209	 */
3210	mmc->max_blk_count = (host->quirks & SDHCI_QUIRK_NO_MULTIBLOCK) ? 1 : 65535;
3211
3212	/*
3213	 * Init tasklets.
3214	 */
3215	tasklet_init(&host->card_tasklet,
3216		sdhci_tasklet_card, (unsigned long)host);
3217	tasklet_init(&host->finish_tasklet,
3218		sdhci_tasklet_finish, (unsigned long)host);
3219
3220	setup_timer(&host->timer, sdhci_timeout_timer, (unsigned long)host);
3221
3222	if (host->version >= SDHCI_SPEC_300) {
3223		init_waitqueue_head(&host->buf_ready_int);
3224
3225		/* Initialize re-tuning timer */
3226		init_timer(&host->tuning_timer);
3227		host->tuning_timer.data = (unsigned long)host;
3228		host->tuning_timer.function = sdhci_tuning_timer;
3229	}
3230
3231	sdhci_init(host, 0);
3232
3233	ret = request_irq(host->irq, sdhci_irq, IRQF_SHARED,
3234		mmc_hostname(mmc), host);
3235	if (ret) {
3236		pr_err("%s: Failed to request IRQ %d: %d\n",
3237		       mmc_hostname(mmc), host->irq, ret);
3238		goto untasklet;
3239	}
3240
3241#ifdef CONFIG_MMC_DEBUG
3242	sdhci_dumpregs(host);
3243#endif
3244
3245#ifdef SDHCI_USE_LEDS_CLASS
3246	snprintf(host->led_name, sizeof(host->led_name),
3247		"%s::", mmc_hostname(mmc));
3248	host->led.name = host->led_name;
3249	host->led.brightness = LED_OFF;
3250	host->led.default_trigger = mmc_hostname(mmc);
3251	host->led.brightness_set = sdhci_led_control;
3252
3253	ret = led_classdev_register(mmc_dev(mmc), &host->led);
3254	if (ret) {
3255		pr_err("%s: Failed to register LED device: %d\n",
3256		       mmc_hostname(mmc), ret);
3257		goto reset;
3258	}
3259#endif
3260
3261	mmiowb();
3262
3263	mmc_add_host(mmc);
3264
3265	pr_info("%s: SDHCI controller on %s [%s] using %s\n",
3266		mmc_hostname(mmc), host->hw_name, dev_name(mmc_dev(mmc)),
3267		(host->flags & SDHCI_USE_ADMA) ? "ADMA" :
 
3268		(host->flags & SDHCI_USE_SDMA) ? "DMA" : "PIO");
3269
3270	sdhci_enable_card_detection(host);
3271
3272	return 0;
3273
3274#ifdef SDHCI_USE_LEDS_CLASS
3275reset:
3276	sdhci_reset(host, SDHCI_RESET_ALL);
3277	sdhci_mask_irqs(host, SDHCI_INT_ALL_MASK);
 
3278	free_irq(host->irq, host);
3279#endif
3280untasklet:
3281	tasklet_kill(&host->card_tasklet);
3282	tasklet_kill(&host->finish_tasklet);
3283
3284	return ret;
3285}
3286
3287EXPORT_SYMBOL_GPL(sdhci_add_host);
3288
3289void sdhci_remove_host(struct sdhci_host *host, int dead)
3290{
 
3291	unsigned long flags;
3292
3293	if (dead) {
3294		spin_lock_irqsave(&host->lock, flags);
3295
3296		host->flags |= SDHCI_DEVICE_DEAD;
3297
3298		if (host->mrq) {
3299			pr_err("%s: Controller removed during "
3300				" transfer!\n", mmc_hostname(host->mmc));
3301
3302			host->mrq->cmd->error = -ENOMEDIUM;
3303			tasklet_schedule(&host->finish_tasklet);
3304		}
3305
3306		spin_unlock_irqrestore(&host->lock, flags);
3307	}
3308
3309	sdhci_disable_card_detection(host);
3310
3311	mmc_remove_host(host->mmc);
3312
3313#ifdef SDHCI_USE_LEDS_CLASS
3314	led_classdev_unregister(&host->led);
3315#endif
3316
3317	if (!dead)
3318		sdhci_reset(host, SDHCI_RESET_ALL);
3319
3320	sdhci_mask_irqs(host, SDHCI_INT_ALL_MASK);
 
3321	free_irq(host->irq, host);
3322
3323	del_timer_sync(&host->timer);
3324
3325	tasklet_kill(&host->card_tasklet);
3326	tasklet_kill(&host->finish_tasklet);
3327
3328	if (host->vmmc) {
3329		regulator_disable(host->vmmc);
3330		regulator_put(host->vmmc);
3331	}
3332
3333	if (host->vqmmc) {
3334		regulator_disable(host->vqmmc);
3335		regulator_put(host->vqmmc);
3336	}
3337
3338	kfree(host->adma_desc);
3339	kfree(host->align_buffer);
 
 
3340
3341	host->adma_desc = NULL;
3342	host->align_buffer = NULL;
3343}
3344
3345EXPORT_SYMBOL_GPL(sdhci_remove_host);
3346
3347void sdhci_free_host(struct sdhci_host *host)
3348{
3349	mmc_free_host(host->mmc);
3350}
3351
3352EXPORT_SYMBOL_GPL(sdhci_free_host);
3353
3354/*****************************************************************************\
3355 *                                                                           *
3356 * Driver init/exit                                                          *
3357 *                                                                           *
3358\*****************************************************************************/
3359
3360static int __init sdhci_drv_init(void)
3361{
3362	pr_info(DRIVER_NAME
3363		": Secure Digital Host Controller Interface driver\n");
3364	pr_info(DRIVER_NAME ": Copyright(c) Pierre Ossman\n");
3365
3366	return 0;
3367}
3368
3369static void __exit sdhci_drv_exit(void)
3370{
3371}
3372
3373module_init(sdhci_drv_init);
3374module_exit(sdhci_drv_exit);
3375
3376module_param(debug_quirks, uint, 0444);
3377module_param(debug_quirks2, uint, 0444);
3378
3379MODULE_AUTHOR("Pierre Ossman <pierre@ossman.eu>");
3380MODULE_DESCRIPTION("Secure Digital Host Controller Interface core driver");
3381MODULE_LICENSE("GPL");
3382
3383MODULE_PARM_DESC(debug_quirks, "Force certain quirks.");
3384MODULE_PARM_DESC(debug_quirks2, "Force certain other quirks.");