forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
146 lines
3.8 KiB
146 lines
3.8 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
#include <linux/types.h> |
|
#include <linux/string.h> |
|
#include <linux/kernel.h> |
|
#include <linux/export.h> |
|
#include <linux/interrupt.h> |
|
#include <linux/ide.h> |
|
#include <linux/bitops.h> |
|
|
|
u64 ide_get_lba_addr(struct ide_cmd *cmd, int lba48) |
|
{ |
|
struct ide_taskfile *tf = &cmd->tf; |
|
u32 high, low; |
|
|
|
low = (tf->lbah << 16) | (tf->lbam << 8) | tf->lbal; |
|
if (lba48) { |
|
tf = &cmd->hob; |
|
high = (tf->lbah << 16) | (tf->lbam << 8) | tf->lbal; |
|
} else |
|
high = tf->device & 0xf; |
|
|
|
return ((u64)high << 24) | low; |
|
} |
|
EXPORT_SYMBOL_GPL(ide_get_lba_addr); |
|
|
|
static void ide_dump_sector(ide_drive_t *drive) |
|
{ |
|
struct ide_cmd cmd; |
|
struct ide_taskfile *tf = &cmd.tf; |
|
u8 lba48 = !!(drive->dev_flags & IDE_DFLAG_LBA48); |
|
|
|
memset(&cmd, 0, sizeof(cmd)); |
|
if (lba48) { |
|
cmd.valid.in.tf = IDE_VALID_LBA; |
|
cmd.valid.in.hob = IDE_VALID_LBA; |
|
cmd.tf_flags = IDE_TFLAG_LBA48; |
|
} else |
|
cmd.valid.in.tf = IDE_VALID_LBA | IDE_VALID_DEVICE; |
|
|
|
ide_tf_readback(drive, &cmd); |
|
|
|
if (lba48 || (tf->device & ATA_LBA)) |
|
printk(KERN_CONT ", LBAsect=%llu", |
|
(unsigned long long)ide_get_lba_addr(&cmd, lba48)); |
|
else |
|
printk(KERN_CONT ", CHS=%d/%d/%d", (tf->lbah << 8) + tf->lbam, |
|
tf->device & 0xf, tf->lbal); |
|
} |
|
|
|
static void ide_dump_ata_error(ide_drive_t *drive, u8 err) |
|
{ |
|
printk(KERN_CONT "{ "); |
|
if (err & ATA_ABORTED) |
|
printk(KERN_CONT "DriveStatusError "); |
|
if (err & ATA_ICRC) |
|
printk(KERN_CONT "%s", |
|
(err & ATA_ABORTED) ? "BadCRC " : "BadSector "); |
|
if (err & ATA_UNC) |
|
printk(KERN_CONT "UncorrectableError "); |
|
if (err & ATA_IDNF) |
|
printk(KERN_CONT "SectorIdNotFound "); |
|
if (err & ATA_TRK0NF) |
|
printk(KERN_CONT "TrackZeroNotFound "); |
|
if (err & ATA_AMNF) |
|
printk(KERN_CONT "AddrMarkNotFound "); |
|
printk(KERN_CONT "}"); |
|
if ((err & (ATA_BBK | ATA_ABORTED)) == ATA_BBK || |
|
(err & (ATA_UNC | ATA_IDNF | ATA_AMNF))) { |
|
struct request *rq = drive->hwif->rq; |
|
|
|
ide_dump_sector(drive); |
|
|
|
if (rq) |
|
printk(KERN_CONT ", sector=%llu", |
|
(unsigned long long)blk_rq_pos(rq)); |
|
} |
|
printk(KERN_CONT "\n"); |
|
} |
|
|
|
static void ide_dump_atapi_error(ide_drive_t *drive, u8 err) |
|
{ |
|
printk(KERN_CONT "{ "); |
|
if (err & ATAPI_ILI) |
|
printk(KERN_CONT "IllegalLengthIndication "); |
|
if (err & ATAPI_EOM) |
|
printk(KERN_CONT "EndOfMedia "); |
|
if (err & ATA_ABORTED) |
|
printk(KERN_CONT "AbortedCommand "); |
|
if (err & ATA_MCR) |
|
printk(KERN_CONT "MediaChangeRequested "); |
|
if (err & ATAPI_LFS) |
|
printk(KERN_CONT "LastFailedSense=0x%02x ", |
|
(err & ATAPI_LFS) >> 4); |
|
printk(KERN_CONT "}\n"); |
|
} |
|
|
|
/** |
|
* ide_dump_status - translate ATA/ATAPI error |
|
* @drive: drive that status applies to |
|
* @msg: text message to print |
|
* @stat: status byte to decode |
|
* |
|
* Error reporting, in human readable form (luxurious, but a memory hog). |
|
* Combines the drive name, message and status byte to provide a |
|
* user understandable explanation of the device error. |
|
*/ |
|
|
|
u8 ide_dump_status(ide_drive_t *drive, const char *msg, u8 stat) |
|
{ |
|
u8 err = 0; |
|
|
|
printk(KERN_ERR "%s: %s: status=0x%02x { ", drive->name, msg, stat); |
|
if (stat & ATA_BUSY) |
|
printk(KERN_CONT "Busy "); |
|
else { |
|
if (stat & ATA_DRDY) |
|
printk(KERN_CONT "DriveReady "); |
|
if (stat & ATA_DF) |
|
printk(KERN_CONT "DeviceFault "); |
|
if (stat & ATA_DSC) |
|
printk(KERN_CONT "SeekComplete "); |
|
if (stat & ATA_DRQ) |
|
printk(KERN_CONT "DataRequest "); |
|
if (stat & ATA_CORR) |
|
printk(KERN_CONT "CorrectedError "); |
|
if (stat & ATA_SENSE) |
|
printk(KERN_CONT "Sense "); |
|
if (stat & ATA_ERR) |
|
printk(KERN_CONT "Error "); |
|
} |
|
printk(KERN_CONT "}\n"); |
|
if ((stat & (ATA_BUSY | ATA_ERR)) == ATA_ERR) { |
|
err = ide_read_error(drive); |
|
printk(KERN_ERR "%s: %s: error=0x%02x ", drive->name, msg, err); |
|
if (drive->media == ide_disk) |
|
ide_dump_ata_error(drive, err); |
|
else |
|
ide_dump_atapi_error(drive, err); |
|
} |
|
|
|
printk(KERN_ERR "%s: possibly failed opcode: 0x%02x\n", |
|
drive->name, drive->hwif->cmd.tf.command); |
|
|
|
return err; |
|
} |
|
EXPORT_SYMBOL(ide_dump_status);
|
|
|