LXR linux/drivers/ide/ide-lib.c

   1#include <linux/types.h>
   2#include <linux/string.h>
   3#include <linux/kernel.h>
   4#include <linux/export.h>
   5#include <linux/interrupt.h>
   6#include <linux/ide.h>
   7#include <linux/bitops.h>
   8
   9u64 ide_get_lba_addr(struct ide_cmd *cmd, int lba48)
  10{
  11        struct ide_taskfile *tf = &cmd->tf;
  12        u32 high, low;
  13
  14        low  = (tf->lbah << 16) | (tf->lbam << 8) | tf->lbal;
  15        if (lba48) {
  16                tf = &cmd->hob;
  17                high = (tf->lbah << 16) | (tf->lbam << 8) | tf->lbal;
  18        } else
  19                high = tf->device & 0xf;
  20
  21        return ((u64)high << 24) | low;
  22}
  23EXPORT_SYMBOL_GPL(ide_get_lba_addr);
  24
  25static void ide_dump_sector(ide_drive_t *drive)
  26{
  27        struct ide_cmd cmd;
  28        struct ide_taskfile *tf = &cmd.tf;
  29        u8 lba48 = !!(drive->dev_flags & IDE_DFLAG_LBA48);
  30
  31        memset(&cmd, 0, sizeof(cmd));
  32        if (lba48) {
  33                cmd.valid.in.tf  = IDE_VALID_LBA;
  34                cmd.valid.in.hob = IDE_VALID_LBA;
  35                cmd.tf_flags = IDE_TFLAG_LBA48;
  36        } else
  37                cmd.valid.in.tf  = IDE_VALID_LBA | IDE_VALID_DEVICE;
  38
  39        ide_tf_readback(drive, &cmd);
  40
  41        if (lba48 || (tf->device & ATA_LBA))
  42                printk(KERN_CONT ", LBAsect=%llu",
  43                        (unsigned long long)ide_get_lba_addr(&cmd, lba48));
  44        else
  45                printk(KERN_CONT ", CHS=%d/%d/%d", (tf->lbah << 8) + tf->lbam,
  46                        tf->device & 0xf, tf->lbal);
  47}
  48
  49static void ide_dump_ata_error(ide_drive_t *drive, u8 err)
  50{
  51        printk(KERN_CONT "{ ");
  52        if (err & ATA_ABORTED)
  53                printk(KERN_CONT "DriveStatusError ");
  54        if (err & ATA_ICRC)
  55                printk(KERN_CONT "%s",
  56                        (err & ATA_ABORTED) ? "BadCRC " : "BadSector ");
  57        if (err & ATA_UNC)
  58                printk(KERN_CONT "UncorrectableError ");
  59        if (err & ATA_IDNF)
  60                printk(KERN_CONT "SectorIdNotFound ");
  61        if (err & ATA_TRK0NF)
  62                printk(KERN_CONT "TrackZeroNotFound ");
  63        if (err & ATA_AMNF)
  64                printk(KERN_CONT "AddrMarkNotFound ");
  65        printk(KERN_CONT "}");
  66        if ((err & (ATA_BBK | ATA_ABORTED)) == ATA_BBK ||
  67            (err & (ATA_UNC | ATA_IDNF | ATA_AMNF))) {
  68                struct request *rq = drive->hwif->rq;
  69
  70                ide_dump_sector(drive);
  71
  72                if (rq)
  73                        printk(KERN_CONT ", sector=%llu",
  74                               (unsigned long long)blk_rq_pos(rq));
  75        }
  76        printk(KERN_CONT "\n");
  77}
  78
  79static void ide_dump_atapi_error(ide_drive_t *drive, u8 err)
  80{
  81        printk(KERN_CONT "{ ");
  82        if (err & ATAPI_ILI)
  83                printk(KERN_CONT "IllegalLengthIndication ");
  84        if (err & ATAPI_EOM)
  85                printk(KERN_CONT "EndOfMedia ");
  86        if (err & ATA_ABORTED)
  87                printk(KERN_CONT "AbortedCommand ");
  88        if (err & ATA_MCR)
  89                printk(KERN_CONT "MediaChangeRequested ");
  90        if (err & ATAPI_LFS)
  91                printk(KERN_CONT "LastFailedSense=0x%02x ",
  92                        (err & ATAPI_LFS) >> 4);
  93        printk(KERN_CONT "}\n");
  94}
  95
  96/**
  97 *      ide_dump_status         -       translate ATA/ATAPI error
  98 *      @drive: drive that status applies to
  99 *      @msg: text message to print
 100 *      @stat: status byte to decode
 101 *
 102 *      Error reporting, in human readable form (luxurious, but a memory hog).
 103 *      Combines the drive name, message and status byte to provide a
 104 *      user understandable explanation of the device error.
 105 */
 106
 107u8 ide_dump_status(ide_drive_t *drive, const char *msg, u8 stat)
 108{
 109        u8 err = 0;
 110
 111        printk(KERN_ERR "%s: %s: status=0x%02x { ", drive->name, msg, stat);
 112        if (stat & ATA_BUSY)
 113                printk(KERN_CONT "Busy ");
 114        else {
 115                if (stat & ATA_DRDY)
 116                        printk(KERN_CONT "DriveReady ");
 117                if (stat & ATA_DF)
 118                        printk(KERN_CONT "DeviceFault ");
 119                if (stat & ATA_DSC)
 120                        printk(KERN_CONT "SeekComplete ");
 121                if (stat & ATA_DRQ)
 122                        printk(KERN_CONT "DataRequest ");
 123                if (stat & ATA_CORR)
 124                        printk(KERN_CONT "CorrectedError ");
 125                if (stat & ATA_SENSE)
 126                        printk(KERN_CONT "Sense ");
 127                if (stat & ATA_ERR)
 128                        printk(KERN_CONT "Error ");
 129        }
 130        printk(KERN_CONT "}\n");
 131        if ((stat & (ATA_BUSY | ATA_ERR)) == ATA_ERR) {
 132                err = ide_read_error(drive);
 133                printk(KERN_ERR "%s: %s: error=0x%02x ", drive->name, msg, err);
 134                if (drive->media == ide_disk)
 135                        ide_dump_ata_error(drive, err);
 136                else
 137                        ide_dump_atapi_error(drive, err);
 138        }
 139
 140        printk(KERN_ERR "%s: possibly failed opcode: 0x%02x\n",
 141                drive->name, drive->hwif->cmd.tf.command);
 142
 143        return err;
 144}
 145EXPORT_SYMBOL(ide_dump_status);
 146