git.oblomov.eu Git - linux-2.6/blob - drivers/mmc/host/sdhci.c

   1 /*
   2  *  linux/drivers/mmc/host/sdhci.c - Secure Digital Host Controller Interface driver
   3  *
   4  *  Copyright (C) 2005-2008 Pierre Ossman, All Rights Reserved.
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or (at
   9  * your option) any later version.
  10  *
  11  * Thanks to the following companies for their support:
  12  *
  13  *     - JMicron (hardware and technical support)
  14  */
  15
  16 #include <linux/delay.h>
  17 #include <linux/highmem.h>
  18 #include <linux/io.h>
  19 #include <linux/dma-mapping.h>
  20 #include <linux/scatterlist.h>
  21
  22 #include <linux/leds.h>
  23
  24 #include <linux/mmc/host.h>
  25
  26 #include "sdhci.h"
  27
  28 #define DRIVER_NAME "sdhci"
  29
  30 #define DBG(f, x...) \
  31         pr_debug(DRIVER_NAME " [%s()]: " f, __func__,## x)
  32
  33 #if defined(CONFIG_LEDS_CLASS) || (defined(CONFIG_LEDS_CLASS_MODULE) && \
  34         defined(CONFIG_MMC_SDHCI_MODULE))
  35 #define SDHCI_USE_LEDS_CLASS
  36 #endif
  37
  38 static unsigned int debug_quirks = 0;
  39
  40 static void sdhci_prepare_data(struct sdhci_host *, struct mmc_data *);
  41 static void sdhci_finish_data(struct sdhci_host *);
  42
  43 static void sdhci_send_command(struct sdhci_host *, struct mmc_command *);
  44 static void sdhci_finish_command(struct sdhci_host *);
  45
  46 static void sdhci_dumpregs(struct sdhci_host *host)
  47 {
  48         printk(KERN_DEBUG DRIVER_NAME ": ============== REGISTER DUMP ==============\n");
  49
  50         printk(KERN_DEBUG DRIVER_NAME ": Sys addr: 0x%08x | Version:  0x%08x\n",
  51                 sdhci_readl(host, SDHCI_DMA_ADDRESS),
  52                 sdhci_readw(host, SDHCI_HOST_VERSION));
  53         printk(KERN_DEBUG DRIVER_NAME ": Blk size: 0x%08x | Blk cnt:  0x%08x\n",
  54                 sdhci_readw(host, SDHCI_BLOCK_SIZE),
  55                 sdhci_readw(host, SDHCI_BLOCK_COUNT));
  56         printk(KERN_DEBUG DRIVER_NAME ": Argument: 0x%08x | Trn mode: 0x%08x\n",
  57                 sdhci_readl(host, SDHCI_ARGUMENT),
  58                 sdhci_readw(host, SDHCI_TRANSFER_MODE));
  59         printk(KERN_DEBUG DRIVER_NAME ": Present:  0x%08x | Host ctl: 0x%08x\n",
  60                 sdhci_readl(host, SDHCI_PRESENT_STATE),
  61                 sdhci_readb(host, SDHCI_HOST_CONTROL));
  62         printk(KERN_DEBUG DRIVER_NAME ": Power:    0x%08x | Blk gap:  0x%08x\n",
  63                 sdhci_readb(host, SDHCI_POWER_CONTROL),
  64                 sdhci_readb(host, SDHCI_BLOCK_GAP_CONTROL));
  65         printk(KERN_DEBUG DRIVER_NAME ": Wake-up:  0x%08x | Clock:    0x%08x\n",
  66                 sdhci_readb(host, SDHCI_WAKE_UP_CONTROL),
  67                 sdhci_readw(host, SDHCI_CLOCK_CONTROL));
  68         printk(KERN_DEBUG DRIVER_NAME ": Timeout:  0x%08x | Int stat: 0x%08x\n",
  69                 sdhci_readb(host, SDHCI_TIMEOUT_CONTROL),
  70                 sdhci_readl(host, SDHCI_INT_STATUS));
  71         printk(KERN_DEBUG DRIVER_NAME ": Int enab: 0x%08x | Sig enab: 0x%08x\n",
  72                 sdhci_readl(host, SDHCI_INT_ENABLE),
  73                 sdhci_readl(host, SDHCI_SIGNAL_ENABLE));
  74         printk(KERN_DEBUG DRIVER_NAME ": AC12 err: 0x%08x | Slot int: 0x%08x\n",
  75                 sdhci_readw(host, SDHCI_ACMD12_ERR),
  76                 sdhci_readw(host, SDHCI_SLOT_INT_STATUS));
  77         printk(KERN_DEBUG DRIVER_NAME ": Caps:     0x%08x | Max curr: 0x%08x\n",
  78                 sdhci_readl(host, SDHCI_CAPABILITIES),
  79                 sdhci_readl(host, SDHCI_MAX_CURRENT));
  80
  81         printk(KERN_DEBUG DRIVER_NAME ": ===========================================\n");
  82 }
  83
  84 /*****************************************************************************\
  85  *                                                                           *
  86  * Low level functions                                                       *
  87  *                                                                           *
  88 \*****************************************************************************/
  89
  90 static void sdhci_clear_set_irqs(struct sdhci_host *host, u32 clear, u32 set)
  91 {
  92         u32 ier;
  93
  94         ier = sdhci_readl(host, SDHCI_INT_ENABLE);
  95         ier &= ~clear;
  96         ier |= set;
  97         sdhci_writel(host, ier, SDHCI_INT_ENABLE);
  98         sdhci_writel(host, ier, SDHCI_SIGNAL_ENABLE);
  99 }
 100
 101 static void sdhci_unmask_irqs(struct sdhci_host *host, u32 irqs)
 102 {
 103         sdhci_clear_set_irqs(host, 0, irqs);
 104 }
 105
 106 static void sdhci_mask_irqs(struct sdhci_host *host, u32 irqs)
 107 {
 108         sdhci_clear_set_irqs(host, irqs, 0);
 109 }
 110
 111 static void sdhci_set_card_detection(struct sdhci_host *host, bool enable)
 112 {
 113         u32 irqs = SDHCI_INT_CARD_REMOVE | SDHCI_INT_CARD_INSERT;
 114
 115         if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
 116                 return;
 117
 118         if (enable)
 119                 sdhci_unmask_irqs(host, irqs);
 120         else
 121                 sdhci_mask_irqs(host, irqs);
 122 }
 123
 124 static void sdhci_enable_card_detection(struct sdhci_host *host)
 125 {
 126         sdhci_set_card_detection(host, true);
 127 }
 128
 129 static void sdhci_disable_card_detection(struct sdhci_host *host)
 130 {
 131         sdhci_set_card_detection(host, false);
 132 }
 133
 134 static void sdhci_reset(struct sdhci_host *host, u8 mask)
 135 {
 136         unsigned long timeout;
 137         u32 uninitialized_var(ier);
 138
 139         if (host->quirks & SDHCI_QUIRK_NO_CARD_NO_RESET) {
 140                 if (!(sdhci_readl(host, SDHCI_PRESENT_STATE) &
 141                         SDHCI_CARD_PRESENT))
 142                         return;
 143         }
 144
 145         if (host->quirks & SDHCI_QUIRK_RESTORE_IRQS_AFTER_RESET)
 146                 ier = sdhci_readl(host, SDHCI_INT_ENABLE);
 147
 148         sdhci_writeb(host, mask, SDHCI_SOFTWARE_RESET);
 149
 150         if (mask & SDHCI_RESET_ALL)
 151                 host->clock = 0;
 152
 153         /* Wait max 100 ms */
 154         timeout = 100;
 155
 156         /* hw clears the bit when it's done */
 157         while (sdhci_readb(host, SDHCI_SOFTWARE_RESET) & mask) {
 158                 if (timeout == 0) {
 159                         printk(KERN_ERR "%s: Reset 0x%x never completed.\n",
 160                                 mmc_hostname(host->mmc), (int)mask);
 161                         sdhci_dumpregs(host);
 162                         return;
 163                 }
 164                 timeout--;
 165                 mdelay(1);
 166         }
 167
 168         if (host->quirks & SDHCI_QUIRK_RESTORE_IRQS_AFTER_RESET)
 169                 sdhci_clear_set_irqs(host, SDHCI_INT_ALL_MASK, ier);
 170 }
 171
 172 static void sdhci_init(struct sdhci_host *host)
 173 {
 174         sdhci_reset(host, SDHCI_RESET_ALL);
 175
 176         sdhci_clear_set_irqs(host, SDHCI_INT_ALL_MASK,
 177                 SDHCI_INT_BUS_POWER | SDHCI_INT_DATA_END_BIT |
 178                 SDHCI_INT_DATA_CRC | SDHCI_INT_DATA_TIMEOUT | SDHCI_INT_INDEX |
 179                 SDHCI_INT_END_BIT | SDHCI_INT_CRC | SDHCI_INT_TIMEOUT |
 180                 SDHCI_INT_DATA_END | SDHCI_INT_RESPONSE);
 181 }
 182
 183 static void sdhci_reinit(struct sdhci_host *host)
 184 {
 185         sdhci_init(host);
 186         sdhci_enable_card_detection(host);
 187 }
 188
 189 static void sdhci_activate_led(struct sdhci_host *host)
 190 {
 191         u8 ctrl;
 192
 193         ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
 194         ctrl |= SDHCI_CTRL_LED;
 195         sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
 196 }
 197
 198 static void sdhci_deactivate_led(struct sdhci_host *host)
 199 {
 200         u8 ctrl;
 201
 202         ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
 203         ctrl &= ~SDHCI_CTRL_LED;
 204         sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
 205 }
 206
 207 #ifdef SDHCI_USE_LEDS_CLASS
 208 static void sdhci_led_control(struct led_classdev *led,
 209         enum led_brightness brightness)
 210 {
 211         struct sdhci_host *host = container_of(led, struct sdhci_host, led);
 212         unsigned long flags;
 213
 214         spin_lock_irqsave(&host->lock, flags);
 215
 216         if (brightness == LED_OFF)
 217                 sdhci_deactivate_led(host);
 218         else
 219                 sdhci_activate_led(host);
 220
 221         spin_unlock_irqrestore(&host->lock, flags);
 222 }
 223 #endif
 224
 225 /*****************************************************************************\
 226  *                                                                           *
 227  * Core functions                                                            *
 228  *                                                                           *
 229 \*****************************************************************************/
 230
 231 static void sdhci_read_block_pio(struct sdhci_host *host)
 232 {
 233         unsigned long flags;
 234         size_t blksize, len, chunk;
 235         u32 uninitialized_var(scratch);
 236         u8 *buf;
 237
 238         DBG("PIO reading\n");
 239
 240         blksize = host->data->blksz;
 241         chunk = 0;
 242
 243         local_irq_save(flags);
 244
 245         while (blksize) {
 246                 if (!sg_miter_next(&host->sg_miter))
 247                         BUG();
 248
 249                 len = min(host->sg_miter.length, blksize);
 250
 251                 blksize -= len;
 252                 host->sg_miter.consumed = len;
 253
 254                 buf = host->sg_miter.addr;
 255
 256                 while (len) {
 257                         if (chunk == 0) {
 258                                 scratch = sdhci_readl(host, SDHCI_BUFFER);
 259                                 chunk = 4;
 260                         }
 261
 262                         *buf = scratch & 0xFF;
 263
 264                         buf++;
 265                         scratch >>= 8;
 266                         chunk--;
 267                         len--;
 268                 }
 269         }
 270
 271         sg_miter_stop(&host->sg_miter);
 272
 273         local_irq_restore(flags);
 274 }
 275
 276 static void sdhci_write_block_pio(struct sdhci_host *host)
 277 {
 278         unsigned long flags;
 279         size_t blksize, len, chunk;
 280         u32 scratch;
 281         u8 *buf;
 282
 283         DBG("PIO writing\n");
 284
 285         blksize = host->data->blksz;
 286         chunk = 0;
 287         scratch = 0;
 288
 289         local_irq_save(flags);
 290
 291         while (blksize) {
 292                 if (!sg_miter_next(&host->sg_miter))
 293                         BUG();
 294
 295                 len = min(host->sg_miter.length, blksize);
 296
 297                 blksize -= len;
 298                 host->sg_miter.consumed = len;
 299
 300                 buf = host->sg_miter.addr;
 301
 302                 while (len) {
 303                         scratch |= (u32)*buf << (chunk * 8);
 304
 305                         buf++;
 306                         chunk++;
 307                         len--;
 308
 309                         if ((chunk == 4) || ((len == 0) && (blksize == 0))) {
 310                                 sdhci_writel(host, scratch, SDHCI_BUFFER);
 311                                 chunk = 0;
 312                                 scratch = 0;
 313                         }
 314                 }
 315         }
 316
 317         sg_miter_stop(&host->sg_miter);
 318
 319         local_irq_restore(flags);
 320 }
 321
 322 static void sdhci_transfer_pio(struct sdhci_host *host)
 323 {
 324         u32 mask;
 325
 326         BUG_ON(!host->data);
 327
 328         if (host->blocks == 0)
 329                 return;
 330
 331         if (host->data->flags & MMC_DATA_READ)
 332                 mask = SDHCI_DATA_AVAILABLE;
 333         else
 334                 mask = SDHCI_SPACE_AVAILABLE;
 335
 336         /*
 337          * Some controllers (JMicron JMB38x) mess up the buffer bits
 338          * for transfers < 4 bytes. As long as it is just one block,
 339          * we can ignore the bits.
 340          */
 341         if ((host->quirks & SDHCI_QUIRK_BROKEN_SMALL_PIO) &&
 342                 (host->data->blocks == 1))
 343                 mask = ~0;
 344
 345         while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
 346                 if (host->quirks & SDHCI_QUIRK_PIO_NEEDS_DELAY)
 347                         udelay(100);
 348
 349                 if (host->data->flags & MMC_DATA_READ)
 350                         sdhci_read_block_pio(host);
 351                 else
 352                         sdhci_write_block_pio(host);
 353
 354                 host->blocks--;
 355                 if (host->blocks == 0)
 356                         break;
 357         }
 358
 359         DBG("PIO transfer complete.\n");
 360 }
 361
 362 static char *sdhci_kmap_atomic(struct scatterlist *sg, unsigned long *flags)
 363 {
 364         local_irq_save(*flags);
 365         return kmap_atomic(sg_page(sg), KM_BIO_SRC_IRQ) + sg->offset;
 366 }
 367
 368 static void sdhci_kunmap_atomic(void *buffer, unsigned long *flags)
 369 {
 370         kunmap_atomic(buffer, KM_BIO_SRC_IRQ);
 371         local_irq_restore(*flags);
 372 }
 373
 374 static int sdhci_adma_table_pre(struct sdhci_host *host,
 375         struct mmc_data *data)
 376 {
 377         int direction;
 378
 379         u8 *desc;
 380         u8 *align;
 381         dma_addr_t addr;
 382         dma_addr_t align_addr;
 383         int len, offset;
 384
 385         struct scatterlist *sg;
 386         int i;
 387         char *buffer;
 388         unsigned long flags;
 389
 390         /*
 391          * The spec does not specify endianness of descriptor table.
 392          * We currently guess that it is LE.
 393          */
 394
 395         if (data->flags & MMC_DATA_READ)
 396                 direction = DMA_FROM_DEVICE;
 397         else
 398                 direction = DMA_TO_DEVICE;
 399
 400         /*
 401          * The ADMA descriptor table is mapped further down as we
 402          * need to fill it with data first.
 403          */
 404
 405         host->align_addr = dma_map_single(mmc_dev(host->mmc),
 406                 host->align_buffer, 128 * 4, direction);
 407         if (dma_mapping_error(mmc_dev(host->mmc), host->align_addr))
 408                 goto fail;
 409         BUG_ON(host->align_addr & 0x3);
 410
 411         host->sg_count = dma_map_sg(mmc_dev(host->mmc),
 412                 data->sg, data->sg_len, direction);
 413         if (host->sg_count == 0)
 414                 goto unmap_align;
 415
 416         desc = host->adma_desc;
 417         align = host->align_buffer;
 418
 419         align_addr = host->align_addr;
 420
 421         for_each_sg(data->sg, sg, host->sg_count, i) {
 422                 addr = sg_dma_address(sg);
 423                 len = sg_dma_len(sg);
 424
 425                 /*
 426                  * The SDHCI specification states that ADMA
 427                  * addresses must be 32-bit aligned. If they
 428                  * aren't, then we use a bounce buffer for
 429                  * the (up to three) bytes that screw up the
 430                  * alignment.
 431                  */
 432                 offset = (4 - (addr & 0x3)) & 0x3;
 433                 if (offset) {
 434                         if (data->flags & MMC_DATA_WRITE) {
 435                                 buffer = sdhci_kmap_atomic(sg, &flags);
 436                                 WARN_ON(((long)buffer & PAGE_MASK) > (PAGE_SIZE - 3));
 437                                 memcpy(align, buffer, offset);
 438                                 sdhci_kunmap_atomic(buffer, &flags);
 439                         }
 440
 441                         desc[7] = (align_addr >> 24) & 0xff;
 442                         desc[6] = (align_addr >> 16) & 0xff;
 443                         desc[5] = (align_addr >> 8) & 0xff;
 444                         desc[4] = (align_addr >> 0) & 0xff;
 445
 446                         BUG_ON(offset > 65536);
 447
 448                         desc[3] = (offset >> 8) & 0xff;
 449                         desc[2] = (offset >> 0) & 0xff;
 450
 451                         desc[1] = 0x00;
 452                         desc[0] = 0x21; /* tran, valid */
 453
 454                         align += 4;
 455                         align_addr += 4;
 456
 457                         desc += 8;
 458
 459                         addr += offset;
 460                         len -= offset;
 461                 }
 462
 463                 desc[7] = (addr >> 24) & 0xff;
 464                 desc[6] = (addr >> 16) & 0xff;
 465                 desc[5] = (addr >> 8) & 0xff;
 466                 desc[4] = (addr >> 0) & 0xff;
 467
 468                 BUG_ON(len > 65536);
 469
 470                 desc[3] = (len >> 8) & 0xff;
 471                 desc[2] = (len >> 0) & 0xff;
 472
 473                 desc[1] = 0x00;
 474                 desc[0] = 0x21; /* tran, valid */
 475
 476                 desc += 8;
 477
 478                 /*
 479                  * If this triggers then we have a calculation bug
 480                  * somewhere. :/
 481                  */
 482                 WARN_ON((desc - host->adma_desc) > (128 * 2 + 1) * 4);
 483         }
 484
 485         /*
 486          * Add a terminating entry.
 487          */
 488         desc[7] = 0;
 489         desc[6] = 0;
 490         desc[5] = 0;
 491         desc[4] = 0;
 492
 493         desc[3] = 0;
 494         desc[2] = 0;
 495
 496         desc[1] = 0x00;
 497         desc[0] = 0x03; /* nop, end, valid */
 498
 499         /*
 500          * Resync align buffer as we might have changed it.
 501          */
 502         if (data->flags & MMC_DATA_WRITE) {
 503                 dma_sync_single_for_device(mmc_dev(host->mmc),
 504                         host->align_addr, 128 * 4, direction);
 505         }
 506
 507         host->adma_addr = dma_map_single(mmc_dev(host->mmc),
 508                 host->adma_desc, (128 * 2 + 1) * 4, DMA_TO_DEVICE);
 509         if (dma_mapping_error(mmc_dev(host->mmc), host->adma_addr))
 510                 goto unmap_entries;
 511         BUG_ON(host->adma_addr & 0x3);
 512
 513         return 0;
 514
 515 unmap_entries:
 516         dma_unmap_sg(mmc_dev(host->mmc), data->sg,
 517                 data->sg_len, direction);
 518 unmap_align:
 519         dma_unmap_single(mmc_dev(host->mmc), host->align_addr,
 520                 128 * 4, direction);
 521 fail:
 522         return -EINVAL;
 523 }
 524
 525 static void sdhci_adma_table_post(struct sdhci_host *host,
 526         struct mmc_data *data)
 527 {
 528         int direction;
 529
 530         struct scatterlist *sg;
 531         int i, size;
 532         u8 *align;
 533         char *buffer;
 534         unsigned long flags;
 535
 536         if (data->flags & MMC_DATA_READ)
 537                 direction = DMA_FROM_DEVICE;
 538         else
 539                 direction = DMA_TO_DEVICE;
 540
 541         dma_unmap_single(mmc_dev(host->mmc), host->adma_addr,
 542                 (128 * 2 + 1) * 4, DMA_TO_DEVICE);
 543
 544         dma_unmap_single(mmc_dev(host->mmc), host->align_addr,
 545                 128 * 4, direction);
 546
 547         if (data->flags & MMC_DATA_READ) {
 548                 dma_sync_sg_for_cpu(mmc_dev(host->mmc), data->sg,
 549                         data->sg_len, direction);
 550
 551                 align = host->align_buffer;
 552
 553                 for_each_sg(data->sg, sg, host->sg_count, i) {
 554                         if (sg_dma_address(sg) & 0x3) {
 555                                 size = 4 - (sg_dma_address(sg) & 0x3);
 556
 557                                 buffer = sdhci_kmap_atomic(sg, &flags);
 558                                 WARN_ON(((long)buffer & PAGE_MASK) > (PAGE_SIZE - 3));
 559                                 memcpy(buffer, align, size);
 560                                 sdhci_kunmap_atomic(buffer, &flags);
 561
 562                                 align += 4;
 563                         }
 564                 }
 565         }
 566
 567         dma_unmap_sg(mmc_dev(host->mmc), data->sg,
 568                 data->sg_len, direction);
 569 }
 570
 571 static u8 sdhci_calc_timeout(struct sdhci_host *host, struct mmc_data *data)
 572 {
 573         u8 count;
 574         unsigned target_timeout, current_timeout;
 575
 576         /*
 577          * If the host controller provides us with an incorrect timeout
 578          * value, just skip the check and use 0xE.  The hardware may take
 579          * longer to time out, but that's much better than having a too-short
 580          * timeout value.
 581          */
 582         if ((host->quirks & SDHCI_QUIRK_BROKEN_TIMEOUT_VAL))
 583                 return 0xE;
 584
 585         /* timeout in us */
 586         target_timeout = data->timeout_ns / 1000 +
 587                 data->timeout_clks / host->clock;
 588
 589         /*
 590          * Figure out needed cycles.
 591          * We do this in steps in order to fit inside a 32 bit int.
 592          * The first step is the minimum timeout, which will have a
 593          * minimum resolution of 6 bits:
 594          * (1) 2^13*1000 > 2^22,
 595          * (2) host->timeout_clk < 2^16
 596          *     =>
 597          *     (1) / (2) > 2^6
 598          */
 599         count = 0;
 600         current_timeout = (1 << 13) * 1000 / host->timeout_clk;
 601         while (current_timeout < target_timeout) {
 602                 count++;
 603                 current_timeout <<= 1;
 604                 if (count >= 0xF)
 605                         break;
 606         }
 607
 608         if (count >= 0xF) {
 609                 printk(KERN_WARNING "%s: Too large timeout requested!\n",
 610                         mmc_hostname(host->mmc));
 611                 count = 0xE;
 612         }
 613
 614         return count;
 615 }
 616
 617 static void sdhci_set_transfer_irqs(struct sdhci_host *host)
 618 {
 619         u32 pio_irqs = SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL;
 620         u32 dma_irqs = SDHCI_INT_DMA_END | SDHCI_INT_ADMA_ERROR;
 621
 622         if (host->flags & SDHCI_REQ_USE_DMA)
 623                 sdhci_clear_set_irqs(host, pio_irqs, dma_irqs);
 624         else
 625                 sdhci_clear_set_irqs(host, dma_irqs, pio_irqs);
 626 }
 627
 628 static void sdhci_prepare_data(struct sdhci_host *host, struct mmc_data *data)
 629 {
 630         u8 count;
 631         u8 ctrl;
 632         int ret;
 633
 634         WARN_ON(host->data);
 635
 636         if (data == NULL)
 637                 return;
 638
 639         /* Sanity checks */
 640         BUG_ON(data->blksz * data->blocks > 524288);
 641         BUG_ON(data->blksz > host->mmc->max_blk_size);
 642         BUG_ON(data->blocks > 65535);
 643
 644         host->data = data;
 645         host->data_early = 0;
 646
 647         count = sdhci_calc_timeout(host, data);
 648         sdhci_writeb(host, count, SDHCI_TIMEOUT_CONTROL);
 649
 650         if (host->flags & SDHCI_USE_DMA)
 651                 host->flags |= SDHCI_REQ_USE_DMA;
 652
 653         /*
 654          * FIXME: This doesn't account for merging when mapping the
 655          * scatterlist.
 656          */
 657         if (host->flags & SDHCI_REQ_USE_DMA) {
 658                 int broken, i;
 659                 struct scatterlist *sg;
 660
 661                 broken = 0;
 662                 if (host->flags & SDHCI_USE_ADMA) {
 663                         if (host->quirks & SDHCI_QUIRK_32BIT_ADMA_SIZE)
 664                                 broken = 1;
 665                 } else {
 666                         if (host->quirks & SDHCI_QUIRK_32BIT_DMA_SIZE)
 667                                 broken = 1;
 668                 }
 669
 670                 if (unlikely(broken)) {
 671                         for_each_sg(data->sg, sg, data->sg_len, i) {
 672                                 if (sg->length & 0x3) {
 673                                         DBG("Reverting to PIO because of "
 674                                                 "transfer size (%d)\n",
 675                                                 sg->length);
 676                                         host->flags &= ~SDHCI_REQ_USE_DMA;
 677                                         break;
 678                                 }
 679                         }
 680                 }
 681         }
 682
 683         /*
 684          * The assumption here being that alignment is the same after
 685          * translation to device address space.
 686          */
 687         if (host->flags & SDHCI_REQ_USE_DMA) {
 688                 int broken, i;
 689                 struct scatterlist *sg;
 690
 691                 broken = 0;
 692                 if (host->flags & SDHCI_USE_ADMA) {
 693                         /*
 694                          * As we use 3 byte chunks to work around
 695                          * alignment problems, we need to check this
 696                          * quirk.
 697                          */
 698                         if (host->quirks & SDHCI_QUIRK_32BIT_ADMA_SIZE)
 699                                 broken = 1;
 700                 } else {
 701                         if (host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR)
 702                                 broken = 1;
 703                 }
 704
 705                 if (unlikely(broken)) {
 706                         for_each_sg(data->sg, sg, data->sg_len, i) {
 707                                 if (sg->offset & 0x3) {
 708                                         DBG("Reverting to PIO because of "
 709                                                 "bad alignment\n");
 710                                         host->flags &= ~SDHCI_REQ_USE_DMA;
 711                                         break;
 712                                 }
 713                         }
 714                 }
 715         }
 716
 717         if (host->flags & SDHCI_REQ_USE_DMA) {
 718                 if (host->flags & SDHCI_USE_ADMA) {
 719                         ret = sdhci_adma_table_pre(host, data);
 720                         if (ret) {
 721                                 /*
 722                                  * This only happens when someone fed
 723                                  * us an invalid request.
 724                                  */
 725                                 WARN_ON(1);
 726                                 host->flags &= ~SDHCI_REQ_USE_DMA;
 727                         } else {
 728                                 sdhci_writel(host, host->adma_addr,
 729                                         SDHCI_ADMA_ADDRESS);
 730                         }
 731                 } else {
 732                         int sg_cnt;
 733
 734                         sg_cnt = dma_map_sg(mmc_dev(host->mmc),
 735                                         data->sg, data->sg_len,
 736                                         (data->flags & MMC_DATA_READ) ?
 737                                                 DMA_FROM_DEVICE :
 738                                                 DMA_TO_DEVICE);
 739                         if (sg_cnt == 0) {
 740                                 /*
 741                                  * This only happens when someone fed
 742                                  * us an invalid request.
 743                                  */
 744                                 WARN_ON(1);
 745                                 host->flags &= ~SDHCI_REQ_USE_DMA;
 746                         } else {
 747                                 WARN_ON(sg_cnt != 1);
 748                                 sdhci_writel(host, sg_dma_address(data->sg),
 749                                         SDHCI_DMA_ADDRESS);
 750                         }
 751                 }
 752         }
 753
 754         /*
 755          * Always adjust the DMA selection as some controllers
 756          * (e.g. JMicron) can't do PIO properly when the selection
 757          * is ADMA.
 758          */
 759         if (host->version >= SDHCI_SPEC_200) {
 760                 ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
 761                 ctrl &= ~SDHCI_CTRL_DMA_MASK;
 762                 if ((host->flags & SDHCI_REQ_USE_DMA) &&
 763                         (host->flags & SDHCI_USE_ADMA))
 764                         ctrl |= SDHCI_CTRL_ADMA32;
 765                 else
 766                         ctrl |= SDHCI_CTRL_SDMA;
 767                 sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
 768         }
 769
 770         if (!(host->flags & SDHCI_REQ_USE_DMA)) {
 771                 sg_miter_start(&host->sg_miter,
 772                         data->sg, data->sg_len, SG_MITER_ATOMIC);
 773                 host->blocks = data->blocks;
 774         }
 775
 776         sdhci_set_transfer_irqs(host);
 777
 778         /* We do not handle DMA boundaries, so set it to max (512 KiB) */
 779         sdhci_writew(host, SDHCI_MAKE_BLKSZ(7, data->blksz), SDHCI_BLOCK_SIZE);
 780         sdhci_writew(host, data->blocks, SDHCI_BLOCK_COUNT);
 781 }
 782
 783 static void sdhci_set_transfer_mode(struct sdhci_host *host,
 784         struct mmc_data *data)
 785 {
 786         u16 mode;
 787
 788         if (data == NULL)
 789                 return;
 790
 791         WARN_ON(!host->data);
 792
 793         mode = SDHCI_TRNS_BLK_CNT_EN;
 794         if (data->blocks > 1)
 795                 mode |= SDHCI_TRNS_MULTI;
 796         if (data->flags & MMC_DATA_READ)
 797                 mode |= SDHCI_TRNS_READ;
 798         if (host->flags & SDHCI_REQ_USE_DMA)
 799                 mode |= SDHCI_TRNS_DMA;
 800
 801         sdhci_writew(host, mode, SDHCI_TRANSFER_MODE);
 802 }
 803
 804 static void sdhci_finish_data(struct sdhci_host *host)
 805 {
 806         struct mmc_data *data;
 807
 808         BUG_ON(!host->data);
 809
 810         data = host->data;
 811         host->data = NULL;
 812
 813         if (host->flags & SDHCI_REQ_USE_DMA) {
 814                 if (host->flags & SDHCI_USE_ADMA)
 815                         sdhci_adma_table_post(host, data);
 816                 else {
 817                         dma_unmap_sg(mmc_dev(host->mmc), data->sg,
 818                                 data->sg_len, (data->flags & MMC_DATA_READ) ?
 819                                         DMA_FROM_DEVICE : DMA_TO_DEVICE);
 820                 }
 821         }
 822
 823         /*
 824          * The specification states that the block count register must
 825          * be updated, but it does not specify at what point in the
 826          * data flow. That makes the register entirely useless to read
 827          * back so we have to assume that nothing made it to the card
 828          * in the event of an error.
 829          */
 830         if (data->error)
 831                 data->bytes_xfered = 0;
 832         else
 833                 data->bytes_xfered = data->blksz * data->blocks;
 834
 835         if (data->stop) {
 836                 /*
 837                  * The controller needs a reset of internal state machines
 838                  * upon error conditions.
 839                  */
 840                 if (data->error) {
 841                         sdhci_reset(host, SDHCI_RESET_CMD);
 842                         sdhci_reset(host, SDHCI_RESET_DATA);
 843                 }
 844
 845                 sdhci_send_command(host, data->stop);
 846         } else
 847                 tasklet_schedule(&host->finish_tasklet);
 848 }
 849
 850 static void sdhci_send_command(struct sdhci_host *host, struct mmc_command *cmd)
 851 {
 852         int flags;
 853         u32 mask;
 854         unsigned long timeout;
 855
 856         WARN_ON(host->cmd);
 857
 858         /* Wait max 10 ms */
 859         timeout = 10;
 860
 861         mask = SDHCI_CMD_INHIBIT;
 862         if ((cmd->data != NULL) || (cmd->flags & MMC_RSP_BUSY))
 863                 mask |= SDHCI_DATA_INHIBIT;
 864
 865         /* We shouldn't wait for data inihibit for stop commands, even
 866            though they might use busy signaling */
 867         if (host->mrq->data && (cmd == host->mrq->data->stop))
 868                 mask &= ~SDHCI_DATA_INHIBIT;
 869
 870         while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
 871                 if (timeout == 0) {
 872                         printk(KERN_ERR "%s: Controller never released "
 873                                 "inhibit bit(s).\n", mmc_hostname(host->mmc));
 874                         sdhci_dumpregs(host);
 875                         cmd->error = -EIO;
 876                         tasklet_schedule(&host->finish_tasklet);
 877                         return;
 878                 }
 879                 timeout--;
 880                 mdelay(1);
 881         }
 882
 883         mod_timer(&host->timer, jiffies + 10 * HZ);
 884
 885         host->cmd = cmd;
 886
 887         sdhci_prepare_data(host, cmd->data);
 888
 889         sdhci_writel(host, cmd->arg, SDHCI_ARGUMENT);
 890
 891         sdhci_set_transfer_mode(host, cmd->data);
 892
 893         if ((cmd->flags & MMC_RSP_136) && (cmd->flags & MMC_RSP_BUSY)) {
 894                 printk(KERN_ERR "%s: Unsupported response type!\n",
 895                         mmc_hostname(host->mmc));
 896                 cmd->error = -EINVAL;
 897                 tasklet_schedule(&host->finish_tasklet);
 898                 return;
 899         }
 900
 901         if (!(cmd->flags & MMC_RSP_PRESENT))
 902                 flags = SDHCI_CMD_RESP_NONE;
 903         else if (cmd->flags & MMC_RSP_136)
 904                 flags = SDHCI_CMD_RESP_LONG;
 905         else if (cmd->flags & MMC_RSP_BUSY)
 906                 flags = SDHCI_CMD_RESP_SHORT_BUSY;
 907         else
 908                 flags = SDHCI_CMD_RESP_SHORT;
 909
 910         if (cmd->flags & MMC_RSP_CRC)
 911                 flags |= SDHCI_CMD_CRC;
 912         if (cmd->flags & MMC_RSP_OPCODE)
 913                 flags |= SDHCI_CMD_INDEX;
 914         if (cmd->data)
 915                 flags |= SDHCI_CMD_DATA;
 916
 917         sdhci_writew(host, SDHCI_MAKE_CMD(cmd->opcode, flags), SDHCI_COMMAND);
 918 }
 919
 920 static void sdhci_finish_command(struct sdhci_host *host)
 921 {
 922         int i;
 923
 924         BUG_ON(host->cmd == NULL);
 925
 926         if (host->cmd->flags & MMC_RSP_PRESENT) {
 927                 if (host->cmd->flags & MMC_RSP_136) {
 928                         /* CRC is stripped so we need to do some shifting. */
 929                         for (i = 0;i < 4;i++) {
 930                                 host->cmd->resp[i] = sdhci_readl(host,
 931                                         SDHCI_RESPONSE + (3-i)*4) << 8;
 932                                 if (i != 3)
 933                                         host->cmd->resp[i] |=
 934                                                 sdhci_readb(host,
 935                                                 SDHCI_RESPONSE + (3-i)*4-1);
 936                         }
 937                 } else {
 938                         host->cmd->resp[0] = sdhci_readl(host, SDHCI_RESPONSE);
 939                 }
 940         }
 941
 942         host->cmd->error = 0;
 943
 944         if (host->data && host->data_early)
 945                 sdhci_finish_data(host);
 946
 947         if (!host->cmd->data)
 948                 tasklet_schedule(&host->finish_tasklet);
 949
 950         host->cmd = NULL;
 951 }
 952
 953 static void sdhci_set_clock(struct sdhci_host *host, unsigned int clock)
 954 {
 955         int div;
 956         u16 clk;
 957         unsigned long timeout;
 958
 959         if (clock == host->clock)
 960                 return;
 961
 962         if (host->ops->set_clock) {
 963                 host->ops->set_clock(host, clock);
 964                 if (host->quirks & SDHCI_QUIRK_NONSTANDARD_CLOCK)
 965                         return;
 966         }
 967
 968         sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL);
 969
 970         if (clock == 0)
 971                 goto out;
 972
 973         for (div = 1;div < 256;div *= 2) {
 974                 if ((host->max_clk / div) <= clock)
 975                         break;
 976         }
 977         div >>= 1;
 978
 979         clk = div << SDHCI_DIVIDER_SHIFT;
 980         clk |= SDHCI_CLOCK_INT_EN;
 981         sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
 982
 983         /* Wait max 10 ms */
 984         timeout = 10;
 985         while (!((clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL))
 986                 & SDHCI_CLOCK_INT_STABLE)) {
 987                 if (timeout == 0) {
 988                         printk(KERN_ERR "%s: Internal clock never "
 989                                 "stabilised.\n", mmc_hostname(host->mmc));
 990                         sdhci_dumpregs(host);
 991                         return;
 992                 }
 993                 timeout--;
 994                 mdelay(1);
 995         }
 996
 997         clk |= SDHCI_CLOCK_CARD_EN;
 998         sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
 999
1000 out:
1001         host->clock = clock;
1002 }
1003
1004 static void sdhci_set_power(struct sdhci_host *host, unsigned short power)
1005 {
1006         u8 pwr;
1007
1008         if (power == (unsigned short)-1)
1009                 pwr = 0;
1010         else {
1011                 switch (1 << power) {
1012                 case MMC_VDD_165_195:
1013                         pwr = SDHCI_POWER_180;
1014                         break;
1015                 case MMC_VDD_29_30:
1016                 case MMC_VDD_30_31:
1017                         pwr = SDHCI_POWER_300;
1018                         break;
1019                 case MMC_VDD_32_33:
1020                 case MMC_VDD_33_34:
1021                         pwr = SDHCI_POWER_330;
1022                         break;
1023                 default:
1024                         BUG();
1025                 }
1026         }
1027
1028         if (host->pwr == pwr)
1029                 return;
1030
1031         host->pwr = pwr;
1032
1033         if (pwr == 0) {
1034                 sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
1035                 return;
1036         }
1037
1038         /*
1039          * Spec says that we should clear the power reg before setting
1040          * a new value. Some controllers don't seem to like this though.
1041          */
1042         if (!(host->quirks & SDHCI_QUIRK_SINGLE_POWER_WRITE))
1043                 sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
1044
1045         /*
1046          * At least the Marvell CaFe chip gets confused if we set the voltage
1047          * and set turn on power at the same time, so set the voltage first.
1048          */
1049         if ((host->quirks & SDHCI_QUIRK_NO_SIMULT_VDD_AND_POWER))
1050                 sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
1051
1052         pwr |= SDHCI_POWER_ON;
1053
1054         sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
1055 }
1056
1057 /*****************************************************************************\
1058  *                                                                           *
1059  * MMC callbacks                                                             *
1060  *                                                                           *
1061 \*****************************************************************************/
1062
1063 static void sdhci_request(struct mmc_host *mmc, struct mmc_request *mrq)
1064 {
1065         struct sdhci_host *host;
1066         bool present;
1067         unsigned long flags;
1068
1069         host = mmc_priv(mmc);
1070
1071         spin_lock_irqsave(&host->lock, flags);
1072
1073         WARN_ON(host->mrq != NULL);
1074
1075 #ifndef SDHCI_USE_LEDS_CLASS
1076         sdhci_activate_led(host);
1077 #endif
1078
1079         host->mrq = mrq;
1080
1081         /* If polling, assume that the card is always present. */
1082         if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
1083                 present = true;
1084         else
1085                 present = sdhci_readl(host, SDHCI_PRESENT_STATE) &
1086                                 SDHCI_CARD_PRESENT;
1087
1088         if (!present || host->flags & SDHCI_DEVICE_DEAD) {
1089                 host->mrq->cmd->error = -ENOMEDIUM;
1090                 tasklet_schedule(&host->finish_tasklet);
1091         } else
1092                 sdhci_send_command(host, mrq->cmd);
1093
1094         mmiowb();
1095         spin_unlock_irqrestore(&host->lock, flags);
1096 }
1097
1098 static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
1099 {
1100         struct sdhci_host *host;
1101         unsigned long flags;
1102         u8 ctrl;
1103
1104         host = mmc_priv(mmc);
1105
1106         spin_lock_irqsave(&host->lock, flags);
1107
1108         if (host->flags & SDHCI_DEVICE_DEAD)
1109                 goto out;
1110
1111         /*
1112          * Reset the chip on each power off.
1113          * Should clear out any weird states.
1114          */
1115         if (ios->power_mode == MMC_POWER_OFF) {
1116                 sdhci_writel(host, 0, SDHCI_SIGNAL_ENABLE);
1117                 sdhci_reinit(host);
1118         }
1119
1120         sdhci_set_clock(host, ios->clock);
1121
1122         if (ios->power_mode == MMC_POWER_OFF)
1123                 sdhci_set_power(host, -1);
1124         else
1125                 sdhci_set_power(host, ios->vdd);
1126
1127         ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
1128
1129         if (ios->bus_width == MMC_BUS_WIDTH_4)
1130                 ctrl |= SDHCI_CTRL_4BITBUS;
1131         else
1132                 ctrl &= ~SDHCI_CTRL_4BITBUS;
1133
1134         if (ios->timing == MMC_TIMING_SD_HS)
1135                 ctrl |= SDHCI_CTRL_HISPD;
1136         else
1137                 ctrl &= ~SDHCI_CTRL_HISPD;
1138
1139         sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
1140
1141         /*
1142          * Some (ENE) controllers go apeshit on some ios operation,
1143          * signalling timeout and CRC errors even on CMD0. Resetting
1144          * it on each ios seems to solve the problem.
1145          */
1146         if(host->quirks & SDHCI_QUIRK_RESET_CMD_DATA_ON_IOS)
1147                 sdhci_reset(host, SDHCI_RESET_CMD | SDHCI_RESET_DATA);
1148
1149 out:
1150         mmiowb();
1151         spin_unlock_irqrestore(&host->lock, flags);
1152 }
1153
1154 static int sdhci_get_ro(struct mmc_host *mmc)
1155 {
1156         struct sdhci_host *host;
1157         unsigned long flags;
1158         int present;
1159
1160         host = mmc_priv(mmc);
1161
1162         spin_lock_irqsave(&host->lock, flags);
1163
1164         if (host->flags & SDHCI_DEVICE_DEAD)
1165                 present = 0;
1166         else
1167                 present = sdhci_readl(host, SDHCI_PRESENT_STATE);
1168
1169         spin_unlock_irqrestore(&host->lock, flags);
1170
1171         if (host->quirks & SDHCI_QUIRK_INVERTED_WRITE_PROTECT)
1172                 return !!(present & SDHCI_WRITE_PROTECT);
1173         return !(present & SDHCI_WRITE_PROTECT);
1174 }
1175
1176 static void sdhci_enable_sdio_irq(struct mmc_host *mmc, int enable)
1177 {
1178         struct sdhci_host *host;
1179         unsigned long flags;
1180
1181         host = mmc_priv(mmc);
1182
1183         spin_lock_irqsave(&host->lock, flags);
1184
1185         if (host->flags & SDHCI_DEVICE_DEAD)
1186                 goto out;
1187
1188         if (enable)
1189                 sdhci_unmask_irqs(host, SDHCI_INT_CARD_INT);
1190         else
1191                 sdhci_mask_irqs(host, SDHCI_INT_CARD_INT);
1192 out:
1193         mmiowb();
1194
1195         spin_unlock_irqrestore(&host->lock, flags);
1196 }
1197
1198 static const struct mmc_host_ops sdhci_ops = {
1199         .request        = sdhci_request,
1200         .set_ios        = sdhci_set_ios,
1201         .get_ro         = sdhci_get_ro,
1202         .enable_sdio_irq = sdhci_enable_sdio_irq,
1203 };
1204
1205 /*****************************************************************************\
1206  *                                                                           *
1207  * Tasklets                                                                  *
1208  *                                                                           *
1209 \*****************************************************************************/
1210
1211 static void sdhci_tasklet_card(unsigned long param)
1212 {
1213         struct sdhci_host *host;
1214         unsigned long flags;
1215
1216         host = (struct sdhci_host*)param;
1217
1218         spin_lock_irqsave(&host->lock, flags);
1219
1220         if (!(sdhci_readl(host, SDHCI_PRESENT_STATE) & SDHCI_CARD_PRESENT)) {
1221                 if (host->mrq) {
1222                         printk(KERN_ERR "%s: Card removed during transfer!\n",
1223                                 mmc_hostname(host->mmc));
1224                         printk(KERN_ERR "%s: Resetting controller.\n",
1225                                 mmc_hostname(host->mmc));
1226
1227                         sdhci_reset(host, SDHCI_RESET_CMD);
1228                         sdhci_reset(host, SDHCI_RESET_DATA);
1229
1230                         host->mrq->cmd->error = -ENOMEDIUM;
1231                         tasklet_schedule(&host->finish_tasklet);
1232                 }
1233         }
1234
1235         spin_unlock_irqrestore(&host->lock, flags);
1236
1237         mmc_detect_change(host->mmc, msecs_to_jiffies(200));
1238 }
1239
1240 static void sdhci_tasklet_finish(unsigned long param)
1241 {
1242         struct sdhci_host *host;
1243         unsigned long flags;
1244         struct mmc_request *mrq;
1245
1246         host = (struct sdhci_host*)param;
1247
1248         spin_lock_irqsave(&host->lock, flags);
1249
1250         del_timer(&host->timer);
1251
1252         mrq = host->mrq;
1253
1254         /*
1255          * The controller needs a reset of internal state machines
1256          * upon error conditions.
1257          */
1258         if (!(host->flags & SDHCI_DEVICE_DEAD) &&
1259                 (mrq->cmd->error ||
1260                  (mrq->data && (mrq->data->error ||
1261                   (mrq->data->stop && mrq->data->stop->error))) ||
1262                    (host->quirks & SDHCI_QUIRK_RESET_AFTER_REQUEST))) {
1263
1264                 /* Some controllers need this kick or reset won't work here */
1265                 if (host->quirks & SDHCI_QUIRK_CLOCK_BEFORE_RESET) {
1266                         unsigned int clock;
1267
1268                         /* This is to force an update */
1269                         clock = host->clock;
1270                         host->clock = 0;
1271                         sdhci_set_clock(host, clock);
1272                 }
1273
1274                 /* Spec says we should do both at the same time, but Ricoh
1275                    controllers do not like that. */
1276                 sdhci_reset(host, SDHCI_RESET_CMD);
1277                 sdhci_reset(host, SDHCI_RESET_DATA);
1278         }
1279
1280         host->mrq = NULL;
1281         host->cmd = NULL;
1282         host->data = NULL;
1283
1284 #ifndef SDHCI_USE_LEDS_CLASS
1285         sdhci_deactivate_led(host);
1286 #endif
1287
1288         mmiowb();
1289         spin_unlock_irqrestore(&host->lock, flags);
1290
1291         mmc_request_done(host->mmc, mrq);
1292 }
1293
1294 static void sdhci_timeout_timer(unsigned long data)
1295 {
1296         struct sdhci_host *host;
1297         unsigned long flags;
1298
1299         host = (struct sdhci_host*)data;
1300
1301         spin_lock_irqsave(&host->lock, flags);
1302
1303         if (host->mrq) {
1304                 printk(KERN_ERR "%s: Timeout waiting for hardware "
1305                         "interrupt.\n", mmc_hostname(host->mmc));
1306                 sdhci_dumpregs(host);
1307
1308                 if (host->data) {
1309                         host->data->error = -ETIMEDOUT;
1310                         sdhci_finish_data(host);
1311                 } else {
1312                         if (host->cmd)
1313                                 host->cmd->error = -ETIMEDOUT;
1314                         else
1315                                 host->mrq->cmd->error = -ETIMEDOUT;
1316
1317                         tasklet_schedule(&host->finish_tasklet);
1318                 }
1319         }
1320
1321         mmiowb();
1322         spin_unlock_irqrestore(&host->lock, flags);
1323 }
1324
1325 /*****************************************************************************\
1326  *                                                                           *
1327  * Interrupt handling                                                        *
1328  *                                                                           *
1329 \*****************************************************************************/
1330
1331 static void sdhci_cmd_irq(struct sdhci_host *host, u32 intmask)
1332 {
1333         BUG_ON(intmask == 0);
1334
1335         if (!host->cmd) {
1336                 printk(KERN_ERR "%s: Got command interrupt 0x%08x even "
1337                         "though no command operation was in progress.\n",
1338                         mmc_hostname(host->mmc), (unsigned)intmask);
1339                 sdhci_dumpregs(host);
1340                 return;
1341         }
1342
1343         if (intmask & SDHCI_INT_TIMEOUT)
1344                 host->cmd->error = -ETIMEDOUT;
1345         else if (intmask & (SDHCI_INT_CRC | SDHCI_INT_END_BIT |
1346                         SDHCI_INT_INDEX))
1347                 host->cmd->error = -EILSEQ;
1348
1349         if (host->cmd->error) {
1350                 tasklet_schedule(&host->finish_tasklet);
1351                 return;
1352         }
1353
1354         /*
1355          * The host can send and interrupt when the busy state has
1356          * ended, allowing us to wait without wasting CPU cycles.
1357          * Unfortunately this is overloaded on the "data complete"
1358          * interrupt, so we need to take some care when handling
1359          * it.
1360          *
1361          * Note: The 1.0 specification is a bit ambiguous about this
1362          *       feature so there might be some problems with older
1363          *       controllers.
1364          */
1365         if (host->cmd->flags & MMC_RSP_BUSY) {
1366                 if (host->cmd->data)
1367                         DBG("Cannot wait for busy signal when also "
1368                                 "doing a data transfer");
1369                 else if (!(host->quirks & SDHCI_QUIRK_NO_BUSY_IRQ))
1370                         return;
1371
1372                 /* The controller does not support the end-of-busy IRQ,
1373                  * fall through and take the SDHCI_INT_RESPONSE */
1374         }
1375
1376         if (intmask & SDHCI_INT_RESPONSE)
1377                 sdhci_finish_command(host);
1378 }
1379
1380 static void sdhci_data_irq(struct sdhci_host *host, u32 intmask)
1381 {
1382         BUG_ON(intmask == 0);
1383
1384         if (!host->data) {
1385                 /*
1386                  * The "data complete" interrupt is also used to
1387                  * indicate that a busy state has ended. See comment
1388                  * above in sdhci_cmd_irq().
1389                  */
1390                 if (host->cmd && (host->cmd->flags & MMC_RSP_BUSY)) {
1391                         if (intmask & SDHCI_INT_DATA_END) {
1392                                 sdhci_finish_command(host);
1393                                 return;
1394                         }
1395                 }
1396
1397                 printk(KERN_ERR "%s: Got data interrupt 0x%08x even "
1398                         "though no data operation was in progress.\n",
1399                         mmc_hostname(host->mmc), (unsigned)intmask);
1400                 sdhci_dumpregs(host);
1401
1402                 return;
1403         }
1404
1405         if (intmask & SDHCI_INT_DATA_TIMEOUT)
1406                 host->data->error = -ETIMEDOUT;
1407         else if (intmask & (SDHCI_INT_DATA_CRC | SDHCI_INT_DATA_END_BIT))
1408                 host->data->error = -EILSEQ;
1409         else if (intmask & SDHCI_INT_ADMA_ERROR)
1410                 host->data->error = -EIO;
1411
1412         if (host->data->error)
1413                 sdhci_finish_data(host);
1414         else {
1415                 if (intmask & (SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL))
1416                         sdhci_transfer_pio(host);
1417
1418                 /*
1419                  * We currently don't do anything fancy with DMA
1420                  * boundaries, but as we can't disable the feature
1421                  * we need to at least restart the transfer.
1422                  */
1423                 if (intmask & SDHCI_INT_DMA_END)
1424                         sdhci_writel(host, sdhci_readl(host, SDHCI_DMA_ADDRESS),
1425                                 SDHCI_DMA_ADDRESS);
1426
1427                 if (intmask & SDHCI_INT_DATA_END) {
1428                         if (host->cmd) {
1429                                 /*
1430                                  * Data managed to finish before the
1431                                  * command completed. Make sure we do
1432                                  * things in the proper order.
1433                                  */
1434                                 host->data_early = 1;
1435                         } else {
1436                                 sdhci_finish_data(host);
1437                         }
1438                 }
1439         }
1440 }
1441
1442 static irqreturn_t sdhci_irq(int irq, void *dev_id)
1443 {
1444         irqreturn_t result;
1445         struct sdhci_host* host = dev_id;
1446         u32 intmask;
1447         int cardint = 0;
1448
1449         spin_lock(&host->lock);
1450
1451         intmask = sdhci_readl(host, SDHCI_INT_STATUS);
1452
1453         if (!intmask || intmask == 0xffffffff) {
1454                 result = IRQ_NONE;
1455                 goto out;
1456         }
1457
1458         DBG("*** %s got interrupt: 0x%08x\n",
1459                 mmc_hostname(host->mmc), intmask);
1460
1461         if (intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) {
1462                 sdhci_writel(host, intmask & (SDHCI_INT_CARD_INSERT |
1463                         SDHCI_INT_CARD_REMOVE), SDHCI_INT_STATUS);
1464                 tasklet_schedule(&host->card_tasklet);
1465         }
1466
1467         intmask &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE);
1468
1469         if (intmask & SDHCI_INT_CMD_MASK) {
1470                 sdhci_writel(host, intmask & SDHCI_INT_CMD_MASK,
1471                         SDHCI_INT_STATUS);
1472                 sdhci_cmd_irq(host, intmask & SDHCI_INT_CMD_MASK);
1473         }
1474
1475         if (intmask & SDHCI_INT_DATA_MASK) {
1476                 sdhci_writel(host, intmask & SDHCI_INT_DATA_MASK,
1477                         SDHCI_INT_STATUS);
1478                 sdhci_data_irq(host, intmask & SDHCI_INT_DATA_MASK);
1479         }
1480
1481         intmask &= ~(SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK);
1482
1483         intmask &= ~SDHCI_INT_ERROR;
1484
1485         if (intmask & SDHCI_INT_BUS_POWER) {
1486                 printk(KERN_ERR "%s: Card is consuming too much power!\n",
1487                         mmc_hostname(host->mmc));
1488                 sdhci_writel(host, SDHCI_INT_BUS_POWER, SDHCI_INT_STATUS);
1489         }
1490
1491         intmask &= ~SDHCI_INT_BUS_POWER;
1492
1493         if (intmask & SDHCI_INT_CARD_INT)
1494                 cardint = 1;
1495
1496         intmask &= ~SDHCI_INT_CARD_INT;
1497
1498         if (intmask) {
1499                 printk(KERN_ERR "%s: Unexpected interrupt 0x%08x.\n",
1500                         mmc_hostname(host->mmc), intmask);
1501                 sdhci_dumpregs(host);
1502
1503                 sdhci_writel(host, intmask, SDHCI_INT_STATUS);
1504         }
1505
1506         result = IRQ_HANDLED;
1507
1508         mmiowb();
1509 out:
1510         spin_unlock(&host->lock);
1511
1512         /*
1513          * We have to delay this as it calls back into the driver.
1514          */
1515         if (cardint)
1516                 mmc_signal_sdio_irq(host->mmc);
1517
1518         return result;
1519 }
1520
1521 /*****************************************************************************\
1522  *                                                                           *
1523  * Suspend/resume                                                            *
1524  *                                                                           *
1525 \*****************************************************************************/
1526
1527 #ifdef CONFIG_PM
1528
1529 int sdhci_suspend_host(struct sdhci_host *host, pm_message_t state)
1530 {
1531         int ret;
1532
1533         sdhci_disable_card_detection(host);
1534
1535         ret = mmc_suspend_host(host->mmc, state);
1536         if (ret)
1537                 return ret;
1538
1539         free_irq(host->irq, host);
1540
1541         return 0;
1542 }
1543
1544 EXPORT_SYMBOL_GPL(sdhci_suspend_host);
1545
1546 int sdhci_resume_host(struct sdhci_host *host)
1547 {
1548         int ret;
1549
1550         if (host->flags & SDHCI_USE_DMA) {
1551                 if (host->ops->enable_dma)
1552                         host->ops->enable_dma(host);
1553         }
1554
1555         ret = request_irq(host->irq, sdhci_irq, IRQF_SHARED,
1556                           mmc_hostname(host->mmc), host);
1557         if (ret)
1558                 return ret;
1559
1560         sdhci_init(host);
1561         mmiowb();
1562
1563         ret = mmc_resume_host(host->mmc);
1564         if (ret)
1565                 return ret;
1566
1567         sdhci_enable_card_detection(host);
1568
1569         return 0;
1570 }
1571
1572 EXPORT_SYMBOL_GPL(sdhci_resume_host);
1573
1574 #endif /* CONFIG_PM */
1575
1576 /*****************************************************************************\
1577  *                                                                           *
1578  * Device allocation/registration                                            *
1579  *                                                                           *
1580 \*****************************************************************************/
1581
1582 struct sdhci_host *sdhci_alloc_host(struct device *dev,
1583         size_t priv_size)
1584 {
1585         struct mmc_host *mmc;
1586         struct sdhci_host *host;
1587
1588         WARN_ON(dev == NULL);
1589
1590         mmc = mmc_alloc_host(sizeof(struct sdhci_host) + priv_size, dev);
1591         if (!mmc)
1592                 return ERR_PTR(-ENOMEM);
1593
1594         host = mmc_priv(mmc);
1595         host->mmc = mmc;
1596
1597         return host;
1598 }
1599
1600 EXPORT_SYMBOL_GPL(sdhci_alloc_host);
1601
1602 int sdhci_add_host(struct sdhci_host *host)
1603 {
1604         struct mmc_host *mmc;
1605         unsigned int caps;
1606         int ret;
1607
1608         WARN_ON(host == NULL);
1609         if (host == NULL)
1610                 return -EINVAL;
1611
1612         mmc = host->mmc;
1613
1614         if (debug_quirks)
1615                 host->quirks = debug_quirks;
1616
1617         sdhci_reset(host, SDHCI_RESET_ALL);
1618
1619         host->version = sdhci_readw(host, SDHCI_HOST_VERSION);
1620         host->version = (host->version & SDHCI_SPEC_VER_MASK)
1621                                 >> SDHCI_SPEC_VER_SHIFT;
1622         if (host->version > SDHCI_SPEC_200) {
1623                 printk(KERN_ERR "%s: Unknown controller version (%d). "
1624                         "You may experience problems.\n", mmc_hostname(mmc),
1625                         host->version);
1626         }
1627
1628         caps = sdhci_readl(host, SDHCI_CAPABILITIES);
1629
1630         if (host->quirks & SDHCI_QUIRK_FORCE_DMA)
1631                 host->flags |= SDHCI_USE_DMA;
1632         else if (!(caps & SDHCI_CAN_DO_DMA))
1633                 DBG("Controller doesn't have DMA capability\n");
1634         else
1635                 host->flags |= SDHCI_USE_DMA;
1636
1637         if ((host->quirks & SDHCI_QUIRK_BROKEN_DMA) &&
1638                 (host->flags & SDHCI_USE_DMA)) {
1639                 DBG("Disabling DMA as it is marked broken\n");
1640                 host->flags &= ~SDHCI_USE_DMA;
1641         }
1642
1643         if (host->flags & SDHCI_USE_DMA) {
1644                 if ((host->version >= SDHCI_SPEC_200) &&
1645                                 (caps & SDHCI_CAN_DO_ADMA2))
1646                         host->flags |= SDHCI_USE_ADMA;
1647         }
1648
1649         if ((host->quirks & SDHCI_QUIRK_BROKEN_ADMA) &&
1650                 (host->flags & SDHCI_USE_ADMA)) {
1651                 DBG("Disabling ADMA as it is marked broken\n");
1652                 host->flags &= ~SDHCI_USE_ADMA;
1653         }
1654
1655         if (host->flags & SDHCI_USE_DMA) {
1656                 if (host->ops->enable_dma) {
1657                         if (host->ops->enable_dma(host)) {
1658                                 printk(KERN_WARNING "%s: No suitable DMA "
1659                                         "available. Falling back to PIO.\n",
1660                                         mmc_hostname(mmc));
1661                                 host->flags &= ~(SDHCI_USE_DMA | SDHCI_USE_ADMA);
1662                         }
1663                 }
1664         }
1665
1666         if (host->flags & SDHCI_USE_ADMA) {
1667                 /*
1668                  * We need to allocate descriptors for all sg entries
1669                  * (128) and potentially one alignment transfer for
1670                  * each of those entries.
1671                  */
1672                 host->adma_desc = kmalloc((128 * 2 + 1) * 4, GFP_KERNEL);
1673                 host->align_buffer = kmalloc(128 * 4, GFP_KERNEL);
1674                 if (!host->adma_desc || !host->align_buffer) {
1675                         kfree(host->adma_desc);
1676                         kfree(host->align_buffer);
1677                         printk(KERN_WARNING "%s: Unable to allocate ADMA "
1678                                 "buffers. Falling back to standard DMA.\n",
1679                                 mmc_hostname(mmc));
1680                         host->flags &= ~SDHCI_USE_ADMA;
1681                 }
1682         }
1683
1684         /*
1685          * If we use DMA, then it's up to the caller to set the DMA
1686          * mask, but PIO does not need the hw shim so we set a new
1687          * mask here in that case.
1688          */
1689         if (!(host->flags & SDHCI_USE_DMA)) {
1690                 host->dma_mask = DMA_BIT_MASK(64);
1691                 mmc_dev(host->mmc)->dma_mask = &host->dma_mask;
1692         }
1693
1694         host->max_clk =
1695                 (caps & SDHCI_CLOCK_BASE_MASK) >> SDHCI_CLOCK_BASE_SHIFT;
1696         host->max_clk *= 1000000;
1697         if (host->max_clk == 0) {
1698                 if (!host->ops->get_max_clock) {
1699                         printk(KERN_ERR
1700                                "%s: Hardware doesn't specify base clock "
1701                                "frequency.\n", mmc_hostname(mmc));
1702                         return -ENODEV;
1703                 }
1704                 host->max_clk = host->ops->get_max_clock(host);
1705         }
1706
1707         host->timeout_clk =
1708                 (caps & SDHCI_TIMEOUT_CLK_MASK) >> SDHCI_TIMEOUT_CLK_SHIFT;
1709         if (host->timeout_clk == 0) {
1710                 if (!host->ops->get_timeout_clock) {
1711                         printk(KERN_ERR
1712                                "%s: Hardware doesn't specify timeout clock "
1713                                "frequency.\n", mmc_hostname(mmc));
1714                         return -ENODEV;
1715                 }
1716                 host->timeout_clk = host->ops->get_timeout_clock(host);
1717         }
1718         if (caps & SDHCI_TIMEOUT_CLK_UNIT)
1719                 host->timeout_clk *= 1000;
1720
1721         /*
1722          * Set host parameters.
1723          */
1724         mmc->ops = &sdhci_ops;
1725         mmc->f_min = host->max_clk / 256;
1726         mmc->f_max = host->max_clk;
1727         mmc->caps = MMC_CAP_4_BIT_DATA | MMC_CAP_SDIO_IRQ;
1728
1729         if (caps & SDHCI_CAN_DO_HISPD)
1730                 mmc->caps |= MMC_CAP_SD_HIGHSPEED;
1731
1732         if (host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION)
1733                 mmc->caps |= MMC_CAP_NEEDS_POLL;
1734
1735         mmc->ocr_avail = 0;
1736         if (caps & SDHCI_CAN_VDD_330)
1737                 mmc->ocr_avail |= MMC_VDD_32_33|MMC_VDD_33_34;
1738         if (caps & SDHCI_CAN_VDD_300)
1739                 mmc->ocr_avail |= MMC_VDD_29_30|MMC_VDD_30_31;
1740         if (caps & SDHCI_CAN_VDD_180)
1741                 mmc->ocr_avail |= MMC_VDD_165_195;
1742
1743         if (mmc->ocr_avail == 0) {
1744                 printk(KERN_ERR "%s: Hardware doesn't report any "
1745                         "support voltages.\n", mmc_hostname(mmc));
1746                 return -ENODEV;
1747         }
1748
1749         spin_lock_init(&host->lock);
1750
1751         /*
1752          * Maximum number of segments. Depends on if the hardware
1753          * can do scatter/gather or not.
1754          */
1755         if (host->flags & SDHCI_USE_ADMA)
1756                 mmc->max_hw_segs = 128;
1757         else if (host->flags & SDHCI_USE_DMA)
1758                 mmc->max_hw_segs = 1;
1759         else /* PIO */
1760                 mmc->max_hw_segs = 128;
1761         mmc->max_phys_segs = 128;
1762
1763         /*
1764          * Maximum number of sectors in one transfer. Limited by DMA boundary
1765          * size (512KiB).
1766          */
1767         mmc->max_req_size = 524288;
1768
1769         /*
1770          * Maximum segment size. Could be one segment with the maximum number
1771          * of bytes. When doing hardware scatter/gather, each entry cannot
1772          * be larger than 64 KiB though.
1773          */
1774         if (host->flags & SDHCI_USE_ADMA)
1775                 mmc->max_seg_size = 65536;
1776         else
1777                 mmc->max_seg_size = mmc->max_req_size;
1778
1779         /*
1780          * Maximum block size. This varies from controller to controller and
1781          * is specified in the capabilities register.
1782          */
1783         if (host->quirks & SDHCI_QUIRK_FORCE_BLK_SZ_2048) {
1784                 mmc->max_blk_size = 2;
1785         } else {
1786                 mmc->max_blk_size = (caps & SDHCI_MAX_BLOCK_MASK) >>
1787                                 SDHCI_MAX_BLOCK_SHIFT;
1788                 if (mmc->max_blk_size >= 3) {
1789                         printk(KERN_WARNING "%s: Invalid maximum block size, "
1790                                 "assuming 512 bytes\n", mmc_hostname(mmc));
1791                         mmc->max_blk_size = 0;
1792                 }
1793         }
1794
1795         mmc->max_blk_size = 512 << mmc->max_blk_size;
1796
1797         /*
1798          * Maximum block count.
1799          */
1800         mmc->max_blk_count = 65535;
1801
1802         /*
1803          * Init tasklets.
1804          */
1805         tasklet_init(&host->card_tasklet,
1806                 sdhci_tasklet_card, (unsigned long)host);
1807         tasklet_init(&host->finish_tasklet,
1808                 sdhci_tasklet_finish, (unsigned long)host);
1809
1810         setup_timer(&host->timer, sdhci_timeout_timer, (unsigned long)host);
1811
1812         ret = request_irq(host->irq, sdhci_irq, IRQF_SHARED,
1813                 mmc_hostname(mmc), host);
1814         if (ret)
1815                 goto untasklet;
1816
1817         sdhci_init(host);
1818
1819 #ifdef CONFIG_MMC_DEBUG
1820         sdhci_dumpregs(host);
1821 #endif
1822
1823 #ifdef SDHCI_USE_LEDS_CLASS
1824         snprintf(host->led_name, sizeof(host->led_name),
1825                 "%s::", mmc_hostname(mmc));
1826         host->led.name = host->led_name;
1827         host->led.brightness = LED_OFF;
1828         host->led.default_trigger = mmc_hostname(mmc);
1829         host->led.brightness_set = sdhci_led_control;
1830
1831         ret = led_classdev_register(mmc_dev(mmc), &host->led);
1832         if (ret)
1833                 goto reset;
1834 #endif
1835
1836         mmiowb();
1837
1838         mmc_add_host(mmc);
1839
1840         printk(KERN_INFO "%s: SDHCI controller on %s [%s] using %s%s\n",
1841                 mmc_hostname(mmc), host->hw_name, dev_name(mmc_dev(mmc)),
1842                 (host->flags & SDHCI_USE_ADMA)?"A":"",
1843                 (host->flags & SDHCI_USE_DMA)?"DMA":"PIO");
1844
1845         sdhci_enable_card_detection(host);
1846
1847         return 0;
1848
1849 #ifdef SDHCI_USE_LEDS_CLASS
1850 reset:
1851         sdhci_reset(host, SDHCI_RESET_ALL);
1852         free_irq(host->irq, host);
1853 #endif
1854 untasklet:
1855         tasklet_kill(&host->card_tasklet);
1856         tasklet_kill(&host->finish_tasklet);
1857
1858         return ret;
1859 }
1860
1861 EXPORT_SYMBOL_GPL(sdhci_add_host);
1862
1863 void sdhci_remove_host(struct sdhci_host *host, int dead)
1864 {
1865         unsigned long flags;
1866
1867         if (dead) {
1868                 spin_lock_irqsave(&host->lock, flags);
1869
1870                 host->flags |= SDHCI_DEVICE_DEAD;
1871
1872                 if (host->mrq) {
1873                         printk(KERN_ERR "%s: Controller removed during "
1874                                 " transfer!\n", mmc_hostname(host->mmc));
1875
1876                         host->mrq->cmd->error = -ENOMEDIUM;
1877                         tasklet_schedule(&host->finish_tasklet);
1878                 }
1879
1880                 spin_unlock_irqrestore(&host->lock, flags);
1881         }
1882
1883         sdhci_disable_card_detection(host);
1884
1885         mmc_remove_host(host->mmc);
1886
1887 #ifdef SDHCI_USE_LEDS_CLASS
1888         led_classdev_unregister(&host->led);
1889 #endif
1890
1891         if (!dead)
1892                 sdhci_reset(host, SDHCI_RESET_ALL);
1893
1894         free_irq(host->irq, host);
1895
1896         del_timer_sync(&host->timer);
1897
1898         tasklet_kill(&host->card_tasklet);
1899         tasklet_kill(&host->finish_tasklet);
1900
1901         kfree(host->adma_desc);
1902         kfree(host->align_buffer);
1903
1904         host->adma_desc = NULL;
1905         host->align_buffer = NULL;
1906 }
1907
1908 EXPORT_SYMBOL_GPL(sdhci_remove_host);
1909
1910 void sdhci_free_host(struct sdhci_host *host)
1911 {
1912         mmc_free_host(host->mmc);
1913 }
1914
1915 EXPORT_SYMBOL_GPL(sdhci_free_host);
1916
1917 /*****************************************************************************\
1918  *                                                                           *
1919  * Driver init/exit                                                          *
1920  *                                                                           *
1921 \*****************************************************************************/
1922
1923 static int __init sdhci_drv_init(void)
1924 {
1925         printk(KERN_INFO DRIVER_NAME
1926                 ": Secure Digital Host Controller Interface driver\n");
1927         printk(KERN_INFO DRIVER_NAME ": Copyright(c) Pierre Ossman\n");
1928
1929         return 0;
1930 }
1931
1932 static void __exit sdhci_drv_exit(void)
1933 {
1934 }
1935
1936 module_init(sdhci_drv_init);
1937 module_exit(sdhci_drv_exit);
1938
1939 module_param(debug_quirks, uint, 0444);
1940
1941 MODULE_AUTHOR("Pierre Ossman <pierre@ossman.eu>");
1942 MODULE_DESCRIPTION("Secure Digital Host Controller Interface core driver");
1943 MODULE_LICENSE("GPL");
1944
1945 MODULE_PARM_DESC(debug_quirks, "Force certain quirks.");