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