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