ide: sanitize ide_finish_cmd()
[safe/jmp/linux-2.6] / 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         u8 stat = 0, dma_stat = 0;
93
94         dma_stat = hwif->dma_ops->dma_end(drive);
95         stat = hwif->tp_ops->read_status(hwif);
96
97         if (OK_STAT(stat, DRIVE_READY, drive->bad_wstat | ATA_DRQ)) {
98                 if (!dma_stat) {
99                         struct ide_cmd *cmd = &hwif->cmd;
100
101                         if ((cmd->tf_flags & IDE_TFLAG_FS) == 0)
102                                 ide_finish_cmd(drive, cmd, stat);
103                         else
104                                 ide_end_request(drive, 1, cmd->rq->nr_sectors);
105                         return ide_stopped;
106                 }
107                 printk(KERN_ERR "%s: %s: bad DMA status (0x%02x)\n",
108                         drive->name, __func__, dma_stat);
109         }
110         return ide_error(drive, "dma_intr", stat);
111 }
112 EXPORT_SYMBOL_GPL(ide_dma_intr);
113
114 int ide_dma_good_drive(ide_drive_t *drive)
115 {
116         return ide_in_drive_list(drive->id, drive_whitelist);
117 }
118
119 /**
120  *      ide_build_sglist        -       map IDE scatter gather for DMA I/O
121  *      @drive: the drive to build the DMA table for
122  *      @rq: the request holding the sg list
123  *
124  *      Perform the DMA mapping magic necessary to access the source or
125  *      target buffers of a request via DMA.  The lower layers of the
126  *      kernel provide the necessary cache management so that we can
127  *      operate in a portable fashion.
128  */
129
130 int ide_build_sglist(ide_drive_t *drive, struct request *rq)
131 {
132         ide_hwif_t *hwif = drive->hwif;
133         struct scatterlist *sg = hwif->sg_table;
134         struct ide_cmd *cmd = &hwif->cmd;
135         int i;
136
137         ide_map_sg(drive, rq);
138
139         if (rq_data_dir(rq) == READ)
140                 cmd->sg_dma_direction = DMA_FROM_DEVICE;
141         else
142                 cmd->sg_dma_direction = DMA_TO_DEVICE;
143
144         i = dma_map_sg(hwif->dev, sg, cmd->sg_nents, cmd->sg_dma_direction);
145         if (i == 0)
146                 ide_map_sg(drive, rq);
147         else {
148                 cmd->orig_sg_nents = cmd->sg_nents;
149                 cmd->sg_nents = i;
150         }
151
152         return i;
153 }
154
155 /**
156  *      ide_destroy_dmatable    -       clean up DMA mapping
157  *      @drive: The drive to unmap
158  *
159  *      Teardown mappings after DMA has completed. This must be called
160  *      after the completion of each use of ide_build_dmatable and before
161  *      the next use of ide_build_dmatable. Failure to do so will cause
162  *      an oops as only one mapping can be live for each target at a given
163  *      time.
164  */
165
166 void ide_destroy_dmatable(ide_drive_t *drive)
167 {
168         ide_hwif_t *hwif = drive->hwif;
169         struct ide_cmd *cmd = &hwif->cmd;
170
171         dma_unmap_sg(hwif->dev, hwif->sg_table, cmd->orig_sg_nents,
172                      cmd->sg_dma_direction);
173 }
174 EXPORT_SYMBOL_GPL(ide_destroy_dmatable);
175
176 /**
177  *      ide_dma_off_quietly     -       Generic DMA kill
178  *      @drive: drive to control
179  *
180  *      Turn off the current DMA on this IDE controller.
181  */
182
183 void ide_dma_off_quietly(ide_drive_t *drive)
184 {
185         drive->dev_flags &= ~IDE_DFLAG_USING_DMA;
186         ide_toggle_bounce(drive, 0);
187
188         drive->hwif->dma_ops->dma_host_set(drive, 0);
189 }
190 EXPORT_SYMBOL(ide_dma_off_quietly);
191
192 /**
193  *      ide_dma_off     -       disable DMA on a device
194  *      @drive: drive to disable DMA on
195  *
196  *      Disable IDE DMA for a device on this IDE controller.
197  *      Inform the user that DMA has been disabled.
198  */
199
200 void ide_dma_off(ide_drive_t *drive)
201 {
202         printk(KERN_INFO "%s: DMA disabled\n", drive->name);
203         ide_dma_off_quietly(drive);
204 }
205 EXPORT_SYMBOL(ide_dma_off);
206
207 /**
208  *      ide_dma_on              -       Enable DMA on a device
209  *      @drive: drive to enable DMA on
210  *
211  *      Enable IDE DMA for a device on this IDE controller.
212  */
213
214 void ide_dma_on(ide_drive_t *drive)
215 {
216         drive->dev_flags |= IDE_DFLAG_USING_DMA;
217         ide_toggle_bounce(drive, 1);
218
219         drive->hwif->dma_ops->dma_host_set(drive, 1);
220 }
221
222 int __ide_dma_bad_drive(ide_drive_t *drive)
223 {
224         u16 *id = drive->id;
225
226         int blacklist = ide_in_drive_list(id, drive_blacklist);
227         if (blacklist) {
228                 printk(KERN_WARNING "%s: Disabling (U)DMA for %s (blacklisted)\n",
229                                     drive->name, (char *)&id[ATA_ID_PROD]);
230                 return blacklist;
231         }
232         return 0;
233 }
234 EXPORT_SYMBOL(__ide_dma_bad_drive);
235
236 static const u8 xfer_mode_bases[] = {
237         XFER_UDMA_0,
238         XFER_MW_DMA_0,
239         XFER_SW_DMA_0,
240 };
241
242 static unsigned int ide_get_mode_mask(ide_drive_t *drive, u8 base, u8 req_mode)
243 {
244         u16 *id = drive->id;
245         ide_hwif_t *hwif = drive->hwif;
246         const struct ide_port_ops *port_ops = hwif->port_ops;
247         unsigned int mask = 0;
248
249         switch (base) {
250         case XFER_UDMA_0:
251                 if ((id[ATA_ID_FIELD_VALID] & 4) == 0)
252                         break;
253
254                 if (port_ops && port_ops->udma_filter)
255                         mask = port_ops->udma_filter(drive);
256                 else
257                         mask = hwif->ultra_mask;
258                 mask &= id[ATA_ID_UDMA_MODES];
259
260                 /*
261                  * avoid false cable warning from eighty_ninty_three()
262                  */
263                 if (req_mode > XFER_UDMA_2) {
264                         if ((mask & 0x78) && (eighty_ninty_three(drive) == 0))
265                                 mask &= 0x07;
266                 }
267                 break;
268         case XFER_MW_DMA_0:
269                 if ((id[ATA_ID_FIELD_VALID] & 2) == 0)
270                         break;
271                 if (port_ops && port_ops->mdma_filter)
272                         mask = port_ops->mdma_filter(drive);
273                 else
274                         mask = hwif->mwdma_mask;
275                 mask &= id[ATA_ID_MWDMA_MODES];
276                 break;
277         case XFER_SW_DMA_0:
278                 if (id[ATA_ID_FIELD_VALID] & 2) {
279                         mask = id[ATA_ID_SWDMA_MODES] & hwif->swdma_mask;
280                 } else if (id[ATA_ID_OLD_DMA_MODES] >> 8) {
281                         u8 mode = id[ATA_ID_OLD_DMA_MODES] >> 8;
282
283                         /*
284                          * if the mode is valid convert it to the mask
285                          * (the maximum allowed mode is XFER_SW_DMA_2)
286                          */
287                         if (mode <= 2)
288                                 mask = ((2 << mode) - 1) & hwif->swdma_mask;
289                 }
290                 break;
291         default:
292                 BUG();
293                 break;
294         }
295
296         return mask;
297 }
298
299 /**
300  *      ide_find_dma_mode       -       compute DMA speed
301  *      @drive: IDE device
302  *      @req_mode: requested mode
303  *
304  *      Checks the drive/host capabilities and finds the speed to use for
305  *      the DMA transfer.  The speed is then limited by the requested mode.
306  *
307  *      Returns 0 if the drive/host combination is incapable of DMA transfers
308  *      or if the requested mode is not a DMA mode.
309  */
310
311 u8 ide_find_dma_mode(ide_drive_t *drive, u8 req_mode)
312 {
313         ide_hwif_t *hwif = drive->hwif;
314         unsigned int mask;
315         int x, i;
316         u8 mode = 0;
317
318         if (drive->media != ide_disk) {
319                 if (hwif->host_flags & IDE_HFLAG_NO_ATAPI_DMA)
320                         return 0;
321         }
322
323         for (i = 0; i < ARRAY_SIZE(xfer_mode_bases); i++) {
324                 if (req_mode < xfer_mode_bases[i])
325                         continue;
326                 mask = ide_get_mode_mask(drive, xfer_mode_bases[i], req_mode);
327                 x = fls(mask) - 1;
328                 if (x >= 0) {
329                         mode = xfer_mode_bases[i] + x;
330                         break;
331                 }
332         }
333
334         if (hwif->chipset == ide_acorn && mode == 0) {
335                 /*
336                  * is this correct?
337                  */
338                 if (ide_dma_good_drive(drive) &&
339                     drive->id[ATA_ID_EIDE_DMA_TIME] < 150)
340                         mode = XFER_MW_DMA_1;
341         }
342
343         mode = min(mode, req_mode);
344
345         printk(KERN_INFO "%s: %s mode selected\n", drive->name,
346                           mode ? ide_xfer_verbose(mode) : "no DMA");
347
348         return mode;
349 }
350 EXPORT_SYMBOL_GPL(ide_find_dma_mode);
351
352 static int ide_tune_dma(ide_drive_t *drive)
353 {
354         ide_hwif_t *hwif = drive->hwif;
355         u8 speed;
356
357         if (ata_id_has_dma(drive->id) == 0 ||
358             (drive->dev_flags & IDE_DFLAG_NODMA))
359                 return 0;
360
361         /* consult the list of known "bad" drives */
362         if (__ide_dma_bad_drive(drive))
363                 return 0;
364
365         if (ide_id_dma_bug(drive))
366                 return 0;
367
368         if (hwif->host_flags & IDE_HFLAG_TRUST_BIOS_FOR_DMA)
369                 return config_drive_for_dma(drive);
370
371         speed = ide_max_dma_mode(drive);
372
373         if (!speed)
374                 return 0;
375
376         if (ide_set_dma_mode(drive, speed))
377                 return 0;
378
379         return 1;
380 }
381
382 static int ide_dma_check(ide_drive_t *drive)
383 {
384         ide_hwif_t *hwif = drive->hwif;
385
386         if (ide_tune_dma(drive))
387                 return 0;
388
389         /* TODO: always do PIO fallback */
390         if (hwif->host_flags & IDE_HFLAG_TRUST_BIOS_FOR_DMA)
391                 return -1;
392
393         ide_set_max_pio(drive);
394
395         return -1;
396 }
397
398 int ide_id_dma_bug(ide_drive_t *drive)
399 {
400         u16 *id = drive->id;
401
402         if (id[ATA_ID_FIELD_VALID] & 4) {
403                 if ((id[ATA_ID_UDMA_MODES] >> 8) &&
404                     (id[ATA_ID_MWDMA_MODES] >> 8))
405                         goto err_out;
406         } else if (id[ATA_ID_FIELD_VALID] & 2) {
407                 if ((id[ATA_ID_MWDMA_MODES] >> 8) &&
408                     (id[ATA_ID_SWDMA_MODES] >> 8))
409                         goto err_out;
410         }
411         return 0;
412 err_out:
413         printk(KERN_ERR "%s: bad DMA info in identify block\n", drive->name);
414         return 1;
415 }
416
417 int ide_set_dma(ide_drive_t *drive)
418 {
419         int rc;
420
421         /*
422          * Force DMAing for the beginning of the check.
423          * Some chipsets appear to do interesting
424          * things, if not checked and cleared.
425          *   PARANOIA!!!
426          */
427         ide_dma_off_quietly(drive);
428
429         rc = ide_dma_check(drive);
430         if (rc)
431                 return rc;
432
433         ide_dma_on(drive);
434
435         return 0;
436 }
437
438 void ide_check_dma_crc(ide_drive_t *drive)
439 {
440         u8 mode;
441
442         ide_dma_off_quietly(drive);
443         drive->crc_count = 0;
444         mode = drive->current_speed;
445         /*
446          * Don't try non Ultra-DMA modes without iCRC's.  Force the
447          * device to PIO and make the user enable SWDMA/MWDMA modes.
448          */
449         if (mode > XFER_UDMA_0 && mode <= XFER_UDMA_7)
450                 mode--;
451         else
452                 mode = XFER_PIO_4;
453         ide_set_xfer_rate(drive, mode);
454         if (drive->current_speed >= XFER_SW_DMA_0)
455                 ide_dma_on(drive);
456 }
457
458 void ide_dma_lost_irq(ide_drive_t *drive)
459 {
460         printk(KERN_ERR "%s: DMA interrupt recovery\n", drive->name);
461 }
462 EXPORT_SYMBOL_GPL(ide_dma_lost_irq);
463
464 void ide_dma_timeout(ide_drive_t *drive)
465 {
466         ide_hwif_t *hwif = drive->hwif;
467
468         printk(KERN_ERR "%s: timeout waiting for DMA\n", drive->name);
469
470         if (hwif->dma_ops->dma_test_irq(drive))
471                 return;
472
473         ide_dump_status(drive, "DMA timeout", hwif->tp_ops->read_status(hwif));
474
475         hwif->dma_ops->dma_end(drive);
476 }
477 EXPORT_SYMBOL_GPL(ide_dma_timeout);
478
479 /*
480  * un-busy the port etc, and clear any pending DMA status. we want to
481  * retry the current request in pio mode instead of risking tossing it
482  * all away
483  */
484 ide_startstop_t ide_dma_timeout_retry(ide_drive_t *drive, int error)
485 {
486         ide_hwif_t *hwif = drive->hwif;
487         struct request *rq;
488         ide_startstop_t ret = ide_stopped;
489
490         /*
491          * end current dma transaction
492          */
493
494         if (error < 0) {
495                 printk(KERN_WARNING "%s: DMA timeout error\n", drive->name);
496                 (void)hwif->dma_ops->dma_end(drive);
497                 ret = ide_error(drive, "dma timeout error",
498                                 hwif->tp_ops->read_status(hwif));
499         } else {
500                 printk(KERN_WARNING "%s: DMA timeout retry\n", drive->name);
501                 hwif->dma_ops->dma_timeout(drive);
502         }
503
504         /*
505          * disable dma for now, but remember that we did so because of
506          * a timeout -- we'll reenable after we finish this next request
507          * (or rather the first chunk of it) in pio.
508          */
509         drive->dev_flags |= IDE_DFLAG_DMA_PIO_RETRY;
510         drive->retry_pio++;
511         ide_dma_off_quietly(drive);
512
513         /*
514          * un-busy drive etc and make sure request is sane
515          */
516
517         rq = hwif->rq;
518         if (!rq)
519                 goto out;
520
521         hwif->rq = NULL;
522
523         rq->errors = 0;
524
525         if (!rq->bio)
526                 goto out;
527
528         rq->sector = rq->bio->bi_sector;
529         rq->current_nr_sectors = bio_iovec(rq->bio)->bv_len >> 9;
530         rq->hard_cur_sectors = rq->current_nr_sectors;
531         rq->buffer = bio_data(rq->bio);
532 out:
533         return ret;
534 }
535
536 void ide_release_dma_engine(ide_hwif_t *hwif)
537 {
538         if (hwif->dmatable_cpu) {
539                 int prd_size = hwif->prd_max_nents * hwif->prd_ent_size;
540
541                 dma_free_coherent(hwif->dev, prd_size,
542                                   hwif->dmatable_cpu, hwif->dmatable_dma);
543                 hwif->dmatable_cpu = NULL;
544         }
545 }
546 EXPORT_SYMBOL_GPL(ide_release_dma_engine);
547
548 int ide_allocate_dma_engine(ide_hwif_t *hwif)
549 {
550         int prd_size;
551
552         if (hwif->prd_max_nents == 0)
553                 hwif->prd_max_nents = PRD_ENTRIES;
554         if (hwif->prd_ent_size == 0)
555                 hwif->prd_ent_size = PRD_BYTES;
556
557         prd_size = hwif->prd_max_nents * hwif->prd_ent_size;
558
559         hwif->dmatable_cpu = dma_alloc_coherent(hwif->dev, prd_size,
560                                                 &hwif->dmatable_dma,
561                                                 GFP_ATOMIC);
562         if (hwif->dmatable_cpu == NULL) {
563                 printk(KERN_ERR "%s: unable to allocate PRD table\n",
564                         hwif->name);
565                 return -ENOMEM;
566         }
567
568         return 0;
569 }
570 EXPORT_SYMBOL_GPL(ide_allocate_dma_engine);