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