25939bc6040261fd064a0cf5ad9f3f97a2b1971b
[linux-2.6.git] / drivers / ide / ide-atapi.c
1 /*
2  * ATAPI support.
3  */
4
5 #include <linux/kernel.h>
6 #include <linux/delay.h>
7 #include <linux/ide.h>
8
9 static u8 ide_wait_ireason(ide_drive_t *drive, u8 ireason)
10 {
11         ide_hwif_t *hwif = drive->hwif;
12         int retries = 100;
13
14         while (retries-- && ((ireason & CD) == 0 || (ireason & IO))) {
15                 printk(KERN_ERR "%s: (IO,CoD != (0,1) while issuing "
16                                 "a packet command, retrying\n", drive->name);
17                 udelay(100);
18                 ireason = hwif->INB(hwif->io_ports.nsect_addr);
19                 if (retries == 0) {
20                         printk(KERN_ERR "%s: (IO,CoD != (0,1) while issuing "
21                                         "a packet command, ignoring\n",
22                                         drive->name);
23                         ireason |= CD;
24                         ireason &= ~IO;
25                 }
26         }
27
28         return ireason;
29 }
30
31 ide_startstop_t ide_transfer_pc(ide_drive_t *drive, struct ide_atapi_pc *pc,
32                                 ide_handler_t *handler, unsigned int timeout,
33                                 ide_expiry_t *expiry)
34 {
35         ide_hwif_t *hwif = drive->hwif;
36         ide_startstop_t startstop;
37         u8 ireason;
38
39         if (ide_wait_stat(&startstop, drive, DRQ_STAT, BUSY_STAT, WAIT_READY)) {
40                 printk(KERN_ERR "%s: Strange, packet command initiated yet "
41                                 "DRQ isn't asserted\n", drive->name);
42                 return startstop;
43         }
44
45         ireason = hwif->INB(hwif->io_ports.nsect_addr);
46         if (drive->media == ide_tape && !drive->scsi)
47                 ireason = ide_wait_ireason(drive, ireason);
48
49         if ((ireason & CD) == 0 || (ireason & IO)) {
50                 printk(KERN_ERR "%s: (IO,CoD) != (0,1) while issuing "
51                                 "a packet command\n", drive->name);
52                 return ide_do_reset(drive);
53         }
54
55         /* Set the interrupt routine */
56         ide_set_handler(drive, handler, timeout, expiry);
57
58         /* Begin DMA, if necessary */
59         if (pc->flags & PC_FLAG_DMA_OK) {
60                 pc->flags |= PC_FLAG_DMA_IN_PROGRESS;
61                 hwif->dma_ops->dma_start(drive);
62         }
63
64         /* Send the actual packet */
65         if ((pc->flags & PC_FLAG_ZIP_DRIVE) == 0)
66                 hwif->output_data(drive, NULL, pc->c, 12);
67
68         return ide_started;
69 }
70 EXPORT_SYMBOL_GPL(ide_transfer_pc);