ide-lib.c revision 9780e2dd8254351f6cbe11304849126b51dbd561 
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
17void 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
34static 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
52u64 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}
66EXPORT_SYMBOL_GPL(ide_get_lba_addr);
67
68static 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
92static 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)blk_rq_pos(rq));
118	}
119	printk(KERN_CONT "\n");
120}
121
122static 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
150u8 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}
185EXPORT_SYMBOL(ide_dump_status);
186