SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/ide/ide-dma.c

   1 /*
   2  *  IDE DMA support (including IDE PCI BM-DMA).
   3  *
   4  *  Copyright (C) 1995-1998   Mark Lord
   5  *  Copyright (C) 1999-2000   Andre Hedrick <andre@linux-ide.org>
   6  *  Copyright (C) 2004, 2007  Bartlomiej Zolnierkiewicz
   7  *
   8  *  May be copied or modified under the terms of the GNU General Public License
   9  *
  10  *  DMA is supported for all IDE devices (disk drives, cdroms, tapes, floppies).
  11  */
  12
  13 /*
  14  *  Special Thanks to Mark for his Six years of work.
  15  */
  16
  17 /*
  18  * Thanks to "Christopher J. Reimer" <reimer@doe.carleton.ca> for
  19  * fixing the problem with the BIOS on some Acer motherboards.
  20  *
  21  * Thanks to "Benoit Poulot-Cazajous" <poulot@chorus.fr> for testing
  22  * "TX" chipset compatibility and for providing patches for the "TX" chipset.
  23  *
  24  * Thanks to Christian Brunner <chb@muc.de> for taking a good first crack
  25  * at generic DMA -- his patches were referred to when preparing this code.
  26  *
  27  * Most importantly, thanks to Robert Bringman <rob@mars.trion.com>
  28  * for supplying a Promise UDMA board & WD UDMA drive for this work!
  29  */
  30
  31 #include <linux/types.h>
  32 #include <linux/kernel.h>
  33 #include <linux/ide.h>
  34 #include <linux/scatterlist.h>
  35 #include <linux/dma-mapping.h>
  36
  37 static const struct drive_list_entry drive_whitelist[] = {
  38         { "Micropolis 2112A"    ,       NULL            },
  39         { "CONNER CTMA 4000"    ,       NULL            },
  40         { "CONNER CTT8000-A"    ,       NULL            },
  41         { "ST34342A"            ,       NULL            },
  42         { NULL                  ,       NULL            }
  43 };
  44
  45 static const struct drive_list_entry drive_blacklist[] = {
  46         { "WDC AC11000H"        ,       NULL            },
  47         { "WDC AC22100H"        ,       NULL            },
  48         { "WDC AC32500H"        ,       NULL            },
  49         { "WDC AC33100H"        ,       NULL            },
  50         { "WDC AC31600H"        ,       NULL            },
  51         { "WDC AC32100H"        ,       "24.09P07"      },
  52         { "WDC AC23200L"        ,       "21.10N21"      },
  53         { "Compaq CRD-8241B"    ,       NULL            },
  54         { "CRD-8400B"           ,       NULL            },
  55         { "CRD-8480B",                  NULL            },
  56         { "CRD-8482B",                  NULL            },
  57         { "CRD-84"              ,       NULL            },
  58         { "SanDisk SDP3B"       ,       NULL            },
  59         { "SanDisk SDP3B-64"    ,       NULL            },
  60         { "SANYO CD-ROM CRD"    ,       NULL            },
  61         { "HITACHI CDR-8"       ,       NULL            },
  62         { "HITACHI CDR-8335"    ,       NULL            },
  63         { "HITACHI CDR-8435"    ,       NULL            },
  64         { "Toshiba CD-ROM XM-6202B"     ,       NULL            },
  65         { "TOSHIBA CD-ROM XM-1702BC",   NULL            },
  66         { "CD-532E-A"           ,       NULL            },
  67         { "E-IDE CD-ROM CR-840",        NULL            },
  68         { "CD-ROM Drive/F5A",   NULL            },
  69         { "WPI CDD-820",                NULL            },
  70         { "SAMSUNG CD-ROM SC-148C",     NULL            },
  71         { "SAMSUNG CD-ROM SC",  NULL            },
  72         { "ATAPI CD-ROM DRIVE 40X MAXIMUM",     NULL            },
  73         { "_NEC DV5800A",               NULL            },
  74         { "SAMSUNG CD-ROM SN-124",      "N001" },
  75         { "Seagate STT20000A",          NULL  },
  76         { "CD-ROM CDR_U200",            "1.09" },
  77         { NULL                  ,       NULL            }
  78
  79 };
  80
  81 /**
  82  *      ide_dma_intr    -       IDE DMA interrupt handler
  83  *      @drive: the drive the interrupt is for
  84  *
  85  *      Handle an interrupt completing a read/write DMA transfer on an
  86  *      IDE device
  87  */
  88
  89 ide_startstop_t ide_dma_intr(ide_drive_t *drive)
  90 {
  91         ide_hwif_t *hwif = drive->hwif;
  92         struct ide_cmd *cmd = &hwif->cmd;
  93         u8 stat = 0, dma_stat = 0;
  94
  95         drive->waiting_for_dma = 0;
  96         dma_stat = hwif->dma_ops->dma_end(drive);
  97         ide_dma_unmap_sg(drive, cmd);
  98         stat = hwif->tp_ops->read_status(hwif);
  99
 100         if (OK_STAT(stat, DRIVE_READY, drive->bad_wstat | ATA_DRQ)) {
 101                 if (!dma_stat) {
 102                         if ((cmd->tf_flags & IDE_TFLAG_FS) == 0)
 103                                 ide_finish_cmd(drive, cmd, stat);
 104                         else
 105                                 ide_complete_rq(drive, 0,
 106                                                 cmd->rq->nr_sectors << 9);
 107                         return ide_stopped;
 108                 }
 109                 printk(KERN_ERR "%s: %s: bad DMA status (0x%02x)\n",
 110                         drive->name, __func__, dma_stat);
 111         }
 112         return ide_error(drive, "dma_intr", stat);
 113 }
 114
 115 int ide_dma_good_drive(ide_drive_t *drive)
 116 {
 117         return ide_in_drive_list(drive->id, drive_whitelist);
 118 }
 119
 120 /**
 121  *      ide_dma_map_sg  -       map IDE scatter gather for DMA I/O
 122  *      @drive: the drive to map the DMA table for
 123  *      @cmd: command
 124  *
 125  *      Perform the DMA mapping magic necessary to access the source or
 126  *      target buffers of a request via DMA.  The lower layers of the
 127  *      kernel provide the necessary cache management so that we can
 128  *      operate in a portable fashion.
 129  */
 130
 131 static int ide_dma_map_sg(ide_drive_t *drive, struct ide_cmd *cmd)
 132 {
 133         ide_hwif_t *hwif = drive->hwif;
 134         struct scatterlist *sg = hwif->sg_table;
 135         int i;
 136
 137         if (cmd->tf_flags & IDE_TFLAG_WRITE)
 138                 cmd->sg_dma_direction = DMA_TO_DEVICE;
 139         else
 140                 cmd->sg_dma_direction = DMA_FROM_DEVICE;
 141
 142         i = dma_map_sg(hwif->dev, sg, cmd->sg_nents, cmd->sg_dma_direction);
 143         if (i) {
 144                 cmd->orig_sg_nents = cmd->sg_nents;
 145                 cmd->sg_nents = i;
 146         }
 147
 148         return i;
 149 }
 150
 151 /**
 152  *      ide_dma_unmap_sg        -       clean up DMA mapping
 153  *      @drive: The drive to unmap
 154  *
 155  *      Teardown mappings after DMA has completed. This must be called
 156  *      after the completion of each use of ide_build_dmatable and before
 157  *      the next use of ide_build_dmatable. Failure to do so will cause
 158  *      an oops as only one mapping can be live for each target at a given
 159  *      time.
 160  */
 161
 162 void ide_dma_unmap_sg(ide_drive_t *drive, struct ide_cmd *cmd)
 163 {
 164         ide_hwif_t *hwif = drive->hwif;
 165
 166         dma_unmap_sg(hwif->dev, hwif->sg_table, cmd->orig_sg_nents,
 167                      cmd->sg_dma_direction);
 168 }
 169 EXPORT_SYMBOL_GPL(ide_dma_unmap_sg);
 170
 171 /**
 172  *      ide_dma_off_quietly     -       Generic DMA kill
 173  *      @drive: drive to control
 174  *
 175  *      Turn off the current DMA on this IDE controller.
 176  */
 177
 178 void ide_dma_off_quietly(ide_drive_t *drive)
 179 {
 180         drive->dev_flags &= ~IDE_DFLAG_USING_DMA;
 181         ide_toggle_bounce(drive, 0);
 182
 183         drive->hwif->dma_ops->dma_host_set(drive, 0);
 184 }
 185 EXPORT_SYMBOL(ide_dma_off_quietly);
 186
 187 /**
 188  *      ide_dma_off     -       disable DMA on a device
 189  *      @drive: drive to disable DMA on
 190  *
 191  *      Disable IDE DMA for a device on this IDE controller.
 192  *      Inform the user that DMA has been disabled.
 193  */
 194
 195 void ide_dma_off(ide_drive_t *drive)
 196 {
 197         printk(KERN_INFO "%s: DMA disabled\n", drive->name);
 198         ide_dma_off_quietly(drive);
 199 }
 200 EXPORT_SYMBOL(ide_dma_off);
 201
 202 /**
 203  *      ide_dma_on              -       Enable DMA on a device
 204  *      @drive: drive to enable DMA on
 205  *
 206  *      Enable IDE DMA for a device on this IDE controller.
 207  */
 208
 209 void ide_dma_on(ide_drive_t *drive)
 210 {
 211         drive->dev_flags |= IDE_DFLAG_USING_DMA;
 212         ide_toggle_bounce(drive, 1);
 213
 214         drive->hwif->dma_ops->dma_host_set(drive, 1);
 215 }
 216
 217 int __ide_dma_bad_drive(ide_drive_t *drive)
 218 {
 219         u16 *id = drive->id;
 220
 221         int blacklist = ide_in_drive_list(id, drive_blacklist);
 222         if (blacklist) {
 223                 printk(KERN_WARNING "%s: Disabling (U)DMA for %s (blacklisted)\n",
 224                                     drive->name, (char *)&id[ATA_ID_PROD]);
 225                 return blacklist;
 226         }
 227         return 0;
 228 }
 229 EXPORT_SYMBOL(__ide_dma_bad_drive);
 230
 231 static const u8 xfer_mode_bases[] = {
 232         XFER_UDMA_0,
 233         XFER_MW_DMA_0,
 234         XFER_SW_DMA_0,
 235 };
 236
 237 static unsigned int ide_get_mode_mask(ide_drive_t *drive, u8 base, u8 req_mode)
 238 {
 239         u16 *id = drive->id;
 240         ide_hwif_t *hwif = drive->hwif;
 241         const struct ide_port_ops *port_ops = hwif->port_ops;
 242         unsigned int mask = 0;
 243
 244         switch (base) {
 245         case XFER_UDMA_0:
 246                 if ((id[ATA_ID_FIELD_VALID] & 4) == 0)
 247                         break;
 248                 mask = id[ATA_ID_UDMA_MODES];
 249                 if (port_ops && port_ops->udma_filter)
 250                         mask &= port_ops->udma_filter(drive);
 251                 else
 252                         mask &= hwif->ultra_mask;
 253
 254                 /*
 255                  * avoid false cable warning from eighty_ninty_three()
 256                  */
 257                 if (req_mode > XFER_UDMA_2) {
 258                         if ((mask & 0x78) && (eighty_ninty_three(drive) == 0))
 259                                 mask &= 0x07;
 260                 }
 261                 break;
 262         case XFER_MW_DMA_0:
 263                 mask = id[ATA_ID_MWDMA_MODES];
 264                 if (port_ops && port_ops->mdma_filter)
 265                         mask &= port_ops->mdma_filter(drive);
 266                 else
 267                         mask &= hwif->mwdma_mask;
 268                 break;
 269         case XFER_SW_DMA_0:
 270                 mask = id[ATA_ID_SWDMA_MODES];
 271                 if (!(mask & ATA_SWDMA2) && (id[ATA_ID_OLD_DMA_MODES] >> 8)) {
 272                         u8 mode = id[ATA_ID_OLD_DMA_MODES] >> 8;
 273
 274                         /*
 275                          * if the mode is valid convert it to the mask
 276                          * (the maximum allowed mode is XFER_SW_DMA_2)
 277                          */
 278                         if (mode <= 2)
 279                                 mask = (2 << mode) - 1;
 280                 }
 281                 mask &= hwif->swdma_mask;
 282                 break;
 283         default:
 284                 BUG();
 285                 break;
 286         }
 287
 288         return mask;
 289 }
 290
 291 /**
 292  *      ide_find_dma_mode       -       compute DMA speed
 293  *      @drive: IDE device
 294  *      @req_mode: requested mode
 295  *
 296  *      Checks the drive/host capabilities and finds the speed to use for
 297  *      the DMA transfer.  The speed is then limited by the requested mode.
 298  *
 299  *      Returns 0 if the drive/host combination is incapable of DMA transfers
 300  *      or if the requested mode is not a DMA mode.
 301  */
 302
 303 u8 ide_find_dma_mode(ide_drive_t *drive, u8 req_mode)
 304 {
 305         ide_hwif_t *hwif = drive->hwif;
 306         unsigned int mask;
 307         int x, i;
 308         u8 mode = 0;
 309
 310         if (drive->media != ide_disk) {
 311                 if (hwif->host_flags & IDE_HFLAG_NO_ATAPI_DMA)
 312                         return 0;
 313         }
 314
 315         for (i = 0; i < ARRAY_SIZE(xfer_mode_bases); i++) {
 316                 if (req_mode < xfer_mode_bases[i])
 317                         continue;
 318                 mask = ide_get_mode_mask(drive, xfer_mode_bases[i], req_mode);
 319                 x = fls(mask) - 1;
 320                 if (x >= 0) {
 321                         mode = xfer_mode_bases[i] + x;
 322                         break;
 323                 }
 324         }
 325
 326         if (hwif->chipset == ide_acorn && mode == 0) {
 327                 /*
 328                  * is this correct?
 329                  */
 330                 if (ide_dma_good_drive(drive) &&
 331                     drive->id[ATA_ID_EIDE_DMA_TIME] < 150)
 332                         mode = XFER_MW_DMA_1;
 333         }
 334
 335         mode = min(mode, req_mode);
 336
 337         printk(KERN_INFO "%s: %s mode selected\n", drive->name,
 338                           mode ? ide_xfer_verbose(mode) : "no DMA");
 339
 340         return mode;
 341 }
 342 EXPORT_SYMBOL_GPL(ide_find_dma_mode);
 343
 344 static int ide_tune_dma(ide_drive_t *drive)
 345 {
 346         ide_hwif_t *hwif = drive->hwif;
 347         u8 speed;
 348
 349         if (ata_id_has_dma(drive->id) == 0 ||
 350             (drive->dev_flags & IDE_DFLAG_NODMA))
 351                 return 0;
 352
 353         /* consult the list of known "bad" drives */
 354         if (__ide_dma_bad_drive(drive))
 355                 return 0;
 356
 357         if (ide_id_dma_bug(drive))
 358                 return 0;
 359
 360         if (hwif->host_flags & IDE_HFLAG_TRUST_BIOS_FOR_DMA)
 361                 return config_drive_for_dma(drive);
 362
 363         speed = ide_max_dma_mode(drive);
 364
 365         if (!speed)
 366                 return 0;
 367
 368         if (ide_set_dma_mode(drive, speed))
 369                 return 0;
 370
 371         return 1;
 372 }
 373
 374 static int ide_dma_check(ide_drive_t *drive)
 375 {
 376         ide_hwif_t *hwif = drive->hwif;
 377
 378         if (ide_tune_dma(drive))
 379                 return 0;
 380
 381         /* TODO: always do PIO fallback */
 382         if (hwif->host_flags & IDE_HFLAG_TRUST_BIOS_FOR_DMA)
 383                 return -1;
 384
 385         ide_set_max_pio(drive);
 386
 387         return -1;
 388 }
 389
 390 int ide_id_dma_bug(ide_drive_t *drive)
 391 {
 392         u16 *id = drive->id;
 393
 394         if (id[ATA_ID_FIELD_VALID] & 4) {
 395                 if ((id[ATA_ID_UDMA_MODES] >> 8) &&
 396                     (id[ATA_ID_MWDMA_MODES] >> 8))
 397                         goto err_out;
 398         } else if ((id[ATA_ID_MWDMA_MODES] >> 8) &&
 399                    (id[ATA_ID_SWDMA_MODES] >> 8))
 400                 goto err_out;
 401
 402         return 0;
 403 err_out:
 404         printk(KERN_ERR "%s: bad DMA info in identify block\n", drive->name);
 405         return 1;
 406 }
 407
 408 int ide_set_dma(ide_drive_t *drive)
 409 {
 410         int rc;
 411
 412         /*
 413          * Force DMAing for the beginning of the check.
 414          * Some chipsets appear to do interesting
 415          * things, if not checked and cleared.
 416          *   PARANOIA!!!
 417          */
 418         ide_dma_off_quietly(drive);
 419
 420         rc = ide_dma_check(drive);
 421         if (rc)
 422                 return rc;
 423
 424         ide_dma_on(drive);
 425
 426         return 0;
 427 }
 428
 429 void ide_check_dma_crc(ide_drive_t *drive)
 430 {
 431         u8 mode;
 432
 433         ide_dma_off_quietly(drive);
 434         drive->crc_count = 0;
 435         mode = drive->current_speed;
 436         /*
 437          * Don't try non Ultra-DMA modes without iCRC's.  Force the
 438          * device to PIO and make the user enable SWDMA/MWDMA modes.
 439          */
 440         if (mode > XFER_UDMA_0 && mode <= XFER_UDMA_7)
 441                 mode--;
 442         else
 443                 mode = XFER_PIO_4;
 444         ide_set_xfer_rate(drive, mode);
 445         if (drive->current_speed >= XFER_SW_DMA_0)
 446                 ide_dma_on(drive);
 447 }
 448
 449 void ide_dma_lost_irq(ide_drive_t *drive)
 450 {
 451         printk(KERN_ERR "%s: DMA interrupt recovery\n", drive->name);
 452 }
 453 EXPORT_SYMBOL_GPL(ide_dma_lost_irq);
 454
 455 /*
 456  * un-busy the port etc, and clear any pending DMA status. we want to
 457  * retry the current request in pio mode instead of risking tossing it
 458  * all away
 459  */
 460 ide_startstop_t ide_dma_timeout_retry(ide_drive_t *drive, int error)
 461 {
 462         ide_hwif_t *hwif = drive->hwif;
 463         const struct ide_dma_ops *dma_ops = hwif->dma_ops;
 464         struct ide_cmd *cmd = &hwif->cmd;
 465         struct request *rq;
 466         ide_startstop_t ret = ide_stopped;
 467
 468         /*
 469          * end current dma transaction
 470          */
 471
 472         if (error < 0) {
 473                 printk(KERN_WARNING "%s: DMA timeout error\n", drive->name);
 474                 drive->waiting_for_dma = 0;
 475                 (void)dma_ops->dma_end(drive);
 476                 ide_dma_unmap_sg(drive, cmd);
 477                 ret = ide_error(drive, "dma timeout error",
 478                                 hwif->tp_ops->read_status(hwif));
 479         } else {
 480                 printk(KERN_WARNING "%s: DMA timeout retry\n", drive->name);
 481                 if (dma_ops->dma_clear)
 482                         dma_ops->dma_clear(drive);
 483                 printk(KERN_ERR "%s: timeout waiting for DMA\n", drive->name);
 484                 if (dma_ops->dma_test_irq(drive) == 0) {
 485                         ide_dump_status(drive, "DMA timeout",
 486                                         hwif->tp_ops->read_status(hwif));
 487                         drive->waiting_for_dma = 0;
 488                         (void)dma_ops->dma_end(drive);
 489                         ide_dma_unmap_sg(drive, cmd);
 490                 }
 491         }
 492
 493         /*
 494          * disable dma for now, but remember that we did so because of
 495          * a timeout -- we'll reenable after we finish this next request
 496          * (or rather the first chunk of it) in pio.
 497          */
 498         drive->dev_flags |= IDE_DFLAG_DMA_PIO_RETRY;
 499         drive->retry_pio++;
 500         ide_dma_off_quietly(drive);
 501
 502         /*
 503          * un-busy drive etc and make sure request is sane
 504          */
 505
 506         rq = hwif->rq;
 507         if (!rq)
 508                 goto out;
 509
 510         hwif->rq = NULL;
 511
 512         rq->errors = 0;
 513
 514         if (!rq->bio)
 515                 goto out;
 516
 517         rq->sector = rq->bio->bi_sector;
 518         rq->current_nr_sectors = bio_iovec(rq->bio)->bv_len >> 9;
 519         rq->hard_cur_sectors = rq->current_nr_sectors;
 520         rq->buffer = bio_data(rq->bio);
 521 out:
 522         return ret;
 523 }
 524
 525 void ide_release_dma_engine(ide_hwif_t *hwif)
 526 {
 527         if (hwif->dmatable_cpu) {
 528                 int prd_size = hwif->prd_max_nents * hwif->prd_ent_size;
 529
 530                 dma_free_coherent(hwif->dev, prd_size,
 531                                   hwif->dmatable_cpu, hwif->dmatable_dma);
 532                 hwif->dmatable_cpu = NULL;
 533         }
 534 }
 535 EXPORT_SYMBOL_GPL(ide_release_dma_engine);
 536
 537 int ide_allocate_dma_engine(ide_hwif_t *hwif)
 538 {
 539         int prd_size;
 540
 541         if (hwif->prd_max_nents == 0)
 542                 hwif->prd_max_nents = PRD_ENTRIES;
 543         if (hwif->prd_ent_size == 0)
 544                 hwif->prd_ent_size = PRD_BYTES;
 545
 546         prd_size = hwif->prd_max_nents * hwif->prd_ent_size;
 547
 548         hwif->dmatable_cpu = dma_alloc_coherent(hwif->dev, prd_size,
 549                                                 &hwif->dmatable_dma,
 550                                                 GFP_ATOMIC);
 551         if (hwif->dmatable_cpu == NULL) {
 552                 printk(KERN_ERR "%s: unable to allocate PRD table\n",
 553                         hwif->name);
 554                 return -ENOMEM;
 555         }
 556
 557         return 0;
 558 }
 559 EXPORT_SYMBOL_GPL(ide_allocate_dma_engine);
 560
 561 int ide_dma_prepare(ide_drive_t *drive, struct ide_cmd *cmd)
 562 {
 563         const struct ide_dma_ops *dma_ops = drive->hwif->dma_ops;
 564
 565         if ((drive->dev_flags & IDE_DFLAG_USING_DMA) == 0 ||
 566             (dma_ops->dma_check && dma_ops->dma_check(drive, cmd)))
 567                 goto out;
 568         ide_map_sg(drive, cmd);
 569         if (ide_dma_map_sg(drive, cmd) == 0)
 570                 goto out_map;
 571         if (dma_ops->dma_setup(drive, cmd))
 572                 goto out_dma_unmap;
 573         drive->waiting_for_dma = 1;
 574         return 0;
 575 out_dma_unmap:
 576         ide_dma_unmap_sg(drive, cmd);
 577 out_map:
 578         ide_map_sg(drive, cmd);
 579 out:
 580         return 1;
 581 }