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