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