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