git.oblomov.eu Git - linux-2.6/blob - drivers/ide/ide-lib.c

   1 #include <linux/types.h>
   2 #include <linux/string.h>
   3 #include <linux/kernel.h>
   4 #include <linux/interrupt.h>
   5 #include <linux/ide.h>
   6 #include <linux/bitops.h>
   7
   8 /**
   9  *      ide_toggle_bounce       -       handle bounce buffering
  10  *      @drive: drive to update
  11  *      @on: on/off boolean
  12  *
  13  *      Enable or disable bounce buffering for the device. Drives move
  14  *      between PIO and DMA and that changes the rules we need.
  15  */
  16
  17 void ide_toggle_bounce(ide_drive_t *drive, int on)
  18 {
  19         u64 addr = BLK_BOUNCE_HIGH;     /* dma64_addr_t */
  20
  21         if (!PCI_DMA_BUS_IS_PHYS) {
  22                 addr = BLK_BOUNCE_ANY;
  23         } else if (on && drive->media == ide_disk) {
  24                 struct device *dev = drive->hwif->dev;
  25
  26                 if (dev && dev->dma_mask)
  27                         addr = *dev->dma_mask;
  28         }
  29
  30         if (drive->queue)
  31                 blk_queue_bounce_limit(drive->queue, addr);
  32 }
  33
  34 static void ide_dump_opcode(ide_drive_t *drive)
  35 {
  36         struct request *rq = drive->hwif->rq;
  37         struct ide_cmd *cmd = NULL;
  38
  39         if (!rq)
  40                 return;
  41
  42         if (rq->cmd_type == REQ_TYPE_ATA_TASKFILE)
  43                 cmd = rq->special;
  44
  45         printk(KERN_ERR "ide: failed opcode was: ");
  46         if (cmd == NULL)
  47                 printk(KERN_CONT "unknown\n");
  48         else
  49                 printk(KERN_CONT "0x%02x\n", cmd->tf.command);
  50 }
  51
  52 u64 ide_get_lba_addr(struct ide_cmd *cmd, int lba48)
  53 {
  54         struct ide_taskfile *tf = &cmd->tf;
  55         u32 high, low;
  56
  57         low  = (tf->lbah << 16) | (tf->lbam << 8) | tf->lbal;
  58         if (lba48) {
  59                 tf = &cmd->hob;
  60                 high = (tf->lbah << 16) | (tf->lbam << 8) | tf->lbal;
  61         } else
  62                 high = tf->device & 0xf;
  63
  64         return ((u64)high << 24) | low;
  65 }
  66 EXPORT_SYMBOL_GPL(ide_get_lba_addr);
  67
  68 static void ide_dump_sector(ide_drive_t *drive)
  69 {
  70         struct ide_cmd cmd;
  71         struct ide_taskfile *tf = &cmd.tf;
  72         u8 lba48 = !!(drive->dev_flags & IDE_DFLAG_LBA48);
  73
  74         memset(&cmd, 0, sizeof(cmd));
  75         if (lba48) {
  76                 cmd.valid.in.tf  = IDE_VALID_LBA;
  77                 cmd.valid.in.hob = IDE_VALID_LBA;
  78                 cmd.tf_flags = IDE_TFLAG_LBA48;
  79         } else
  80                 cmd.valid.in.tf  = IDE_VALID_LBA | IDE_VALID_DEVICE;
  81
  82         ide_tf_readback(drive, &cmd);
  83
  84         if (lba48 || (tf->device & ATA_LBA))
  85                 printk(KERN_CONT ", LBAsect=%llu",
  86                         (unsigned long long)ide_get_lba_addr(&cmd, lba48));
  87         else
  88                 printk(KERN_CONT ", CHS=%d/%d/%d", (tf->lbah << 8) + tf->lbam,
  89                         tf->device & 0xf, tf->lbal);
  90 }
  91
  92 static void ide_dump_ata_error(ide_drive_t *drive, u8 err)
  93 {
  94         printk(KERN_ERR "{ ");
  95         if (err & ATA_ABORTED)
  96                 printk(KERN_CONT "DriveStatusError ");
  97         if (err & ATA_ICRC)
  98                 printk(KERN_CONT "%s",
  99                         (err & ATA_ABORTED) ? "BadCRC " : "BadSector ");
 100         if (err & ATA_UNC)
 101                 printk(KERN_CONT "UncorrectableError ");
 102         if (err & ATA_IDNF)
 103                 printk(KERN_CONT "SectorIdNotFound ");
 104         if (err & ATA_TRK0NF)
 105                 printk(KERN_CONT "TrackZeroNotFound ");
 106         if (err & ATA_AMNF)
 107                 printk(KERN_CONT "AddrMarkNotFound ");
 108         printk(KERN_CONT "}");
 109         if ((err & (ATA_BBK | ATA_ABORTED)) == ATA_BBK ||
 110             (err & (ATA_UNC | ATA_IDNF | ATA_AMNF))) {
 111                 struct request *rq = drive->hwif->rq;
 112
 113                 ide_dump_sector(drive);
 114
 115                 if (rq)
 116                         printk(KERN_CONT ", sector=%llu",
 117                                (unsigned long long)rq->sector);
 118         }
 119         printk(KERN_CONT "\n");
 120 }
 121
 122 static void ide_dump_atapi_error(ide_drive_t *drive, u8 err)
 123 {
 124         printk(KERN_ERR "{ ");
 125         if (err & ATAPI_ILI)
 126                 printk(KERN_CONT "IllegalLengthIndication ");
 127         if (err & ATAPI_EOM)
 128                 printk(KERN_CONT "EndOfMedia ");
 129         if (err & ATA_ABORTED)
 130                 printk(KERN_CONT "AbortedCommand ");
 131         if (err & ATA_MCR)
 132                 printk(KERN_CONT "MediaChangeRequested ");
 133         if (err & ATAPI_LFS)
 134                 printk(KERN_CONT "LastFailedSense=0x%02x ",
 135                         (err & ATAPI_LFS) >> 4);
 136         printk(KERN_CONT "}\n");
 137 }
 138
 139 /**
 140  *      ide_dump_status         -       translate ATA/ATAPI error
 141  *      @drive: drive that status applies to
 142  *      @msg: text message to print
 143  *      @stat: status byte to decode
 144  *
 145  *      Error reporting, in human readable form (luxurious, but a memory hog).
 146  *      Combines the drive name, message and status byte to provide a
 147  *      user understandable explanation of the device error.
 148  */
 149
 150 u8 ide_dump_status(ide_drive_t *drive, const char *msg, u8 stat)
 151 {
 152         u8 err = 0;
 153
 154         printk(KERN_ERR "%s: %s: status=0x%02x { ", drive->name, msg, stat);
 155         if (stat & ATA_BUSY)
 156                 printk(KERN_CONT "Busy ");
 157         else {
 158                 if (stat & ATA_DRDY)
 159                         printk(KERN_CONT "DriveReady ");
 160                 if (stat & ATA_DF)
 161                         printk(KERN_CONT "DeviceFault ");
 162                 if (stat & ATA_DSC)
 163                         printk(KERN_CONT "SeekComplete ");
 164                 if (stat & ATA_DRQ)
 165                         printk(KERN_CONT "DataRequest ");
 166                 if (stat & ATA_CORR)
 167                         printk(KERN_CONT "CorrectedError ");
 168                 if (stat & ATA_IDX)
 169                         printk(KERN_CONT "Index ");
 170                 if (stat & ATA_ERR)
 171                         printk(KERN_CONT "Error ");
 172         }
 173         printk(KERN_CONT "}\n");
 174         if ((stat & (ATA_BUSY | ATA_ERR)) == ATA_ERR) {
 175                 err = ide_read_error(drive);
 176                 printk(KERN_ERR "%s: %s: error=0x%02x ", drive->name, msg, err);
 177                 if (drive->media == ide_disk)
 178                         ide_dump_ata_error(drive, err);
 179                 else
 180                         ide_dump_atapi_error(drive, err);
 181         }
 182         ide_dump_opcode(drive);
 183         return err;
 184 }
 185 EXPORT_SYMBOL(ide_dump_status);