2 * Copyright (C) 2000-2002 Andre Hedrick <andre@linux-ide.org>
3 * Copyright (C) 2003 Red Hat
7 #include <linux/module.h>
8 #include <linux/types.h>
9 #include <linux/string.h>
10 #include <linux/kernel.h>
11 #include <linux/timer.h>
13 #include <linux/interrupt.h>
14 #include <linux/major.h>
15 #include <linux/errno.h>
16 #include <linux/genhd.h>
17 #include <linux/blkpg.h>
18 #include <linux/slab.h>
19 #include <linux/pci.h>
20 #include <linux/delay.h>
21 #include <linux/ide.h>
22 #include <linux/bitops.h>
23 #include <linux/nmi.h>
25 #include <asm/byteorder.h>
27 #include <asm/uaccess.h>
30 void SELECT_MASK(ide_drive_t
*drive
, int mask
)
32 const struct ide_port_ops
*port_ops
= drive
->hwif
->port_ops
;
34 if (port_ops
&& port_ops
->maskproc
)
35 port_ops
->maskproc(drive
, mask
);
38 u8
ide_read_error(ide_drive_t
*drive
)
40 struct ide_taskfile tf
;
42 drive
->hwif
->tp_ops
->tf_read(drive
, &tf
, IDE_VALID_ERROR
);
46 EXPORT_SYMBOL_GPL(ide_read_error
);
48 void ide_fix_driveid(u16
*id
)
50 #ifndef __LITTLE_ENDIAN
54 for (i
= 0; i
< 256; i
++)
55 id
[i
] = __le16_to_cpu(id
[i
]);
57 # error "Please fix <asm/byteorder.h>"
63 * ide_fixstring() cleans up and (optionally) byte-swaps a text string,
64 * removing leading/trailing blanks and compressing internal blanks.
65 * It is primarily used to tidy up the model name/number fields as
66 * returned by the ATA_CMD_ID_ATA[PI] commands.
69 void ide_fixstring(u8
*s
, const int bytecount
, const int byteswap
)
71 u8
*p
, *end
= &s
[bytecount
& ~1]; /* bytecount must be even */
74 /* convert from big-endian to host byte order */
75 for (p
= s
; p
!= end
; p
+= 2)
76 be16_to_cpus((u16
*) p
);
79 /* strip leading blanks */
81 while (s
!= end
&& *s
== ' ')
83 /* compress internal blanks and strip trailing blanks */
84 while (s
!= end
&& *s
) {
85 if (*s
++ != ' ' || (s
!= end
&& *s
&& *s
!= ' '))
88 /* wipe out trailing garbage */
92 EXPORT_SYMBOL(ide_fixstring
);
95 * This routine busy-waits for the drive status to be not "busy".
96 * It then checks the status for all of the "good" bits and none
97 * of the "bad" bits, and if all is okay it returns 0. All other
98 * cases return error -- caller may then invoke ide_error().
100 * This routine should get fixed to not hog the cpu during extra long waits..
101 * That could be done by busy-waiting for the first jiffy or two, and then
102 * setting a timer to wake up at half second intervals thereafter,
103 * until timeout is achieved, before timing out.
105 static int __ide_wait_stat(ide_drive_t
*drive
, u8 good
, u8 bad
,
106 unsigned long timeout
, u8
*rstat
)
108 ide_hwif_t
*hwif
= drive
->hwif
;
109 const struct ide_tp_ops
*tp_ops
= hwif
->tp_ops
;
114 udelay(1); /* spec allows drive 400ns to assert "BUSY" */
115 stat
= tp_ops
->read_status(hwif
);
117 if (stat
& ATA_BUSY
) {
118 local_save_flags(flags
);
119 local_irq_enable_in_hardirq();
121 while ((stat
= tp_ops
->read_status(hwif
)) & ATA_BUSY
) {
122 if (time_after(jiffies
, timeout
)) {
124 * One last read after the timeout in case
125 * heavy interrupt load made us not make any
126 * progress during the timeout..
128 stat
= tp_ops
->read_status(hwif
);
129 if ((stat
& ATA_BUSY
) == 0)
132 local_irq_restore(flags
);
137 local_irq_restore(flags
);
140 * Allow status to settle, then read it again.
141 * A few rare drives vastly violate the 400ns spec here,
142 * so we'll wait up to 10usec for a "good" status
143 * rather than expensively fail things immediately.
144 * This fix courtesy of Matthew Faupel & Niccolo Rigacci.
146 for (i
= 0; i
< 10; i
++) {
148 stat
= tp_ops
->read_status(hwif
);
150 if (OK_STAT(stat
, good
, bad
)) {
160 * In case of error returns error value after doing "*startstop = ide_error()".
161 * The caller should return the updated value of "startstop" in this case,
162 * "startstop" is unchanged when the function returns 0.
164 int ide_wait_stat(ide_startstop_t
*startstop
, ide_drive_t
*drive
, u8 good
,
165 u8 bad
, unsigned long timeout
)
170 /* bail early if we've exceeded max_failures */
171 if (drive
->max_failures
&& (drive
->failures
> drive
->max_failures
)) {
172 *startstop
= ide_stopped
;
176 err
= __ide_wait_stat(drive
, good
, bad
, timeout
, &stat
);
179 char *s
= (err
== -EBUSY
) ? "status timeout" : "status error";
180 *startstop
= ide_error(drive
, s
, stat
);
185 EXPORT_SYMBOL(ide_wait_stat
);
188 * ide_in_drive_list - look for drive in black/white list
189 * @id: drive identifier
190 * @table: list to inspect
192 * Look for a drive in the blacklist and the whitelist tables
193 * Returns 1 if the drive is found in the table.
196 int ide_in_drive_list(u16
*id
, const struct drive_list_entry
*table
)
198 for ( ; table
->id_model
; table
++)
199 if ((!strcmp(table
->id_model
, (char *)&id
[ATA_ID_PROD
])) &&
200 (!table
->id_firmware
||
201 strstr((char *)&id
[ATA_ID_FW_REV
], table
->id_firmware
)))
205 EXPORT_SYMBOL_GPL(ide_in_drive_list
);
208 * Early UDMA66 devices don't set bit14 to 1, only bit13 is valid.
209 * Some optical devices with the buggy firmwares have the same problem.
211 static const struct drive_list_entry ivb_list
[] = {
212 { "QUANTUM FIREBALLlct10 05" , "A03.0900" },
213 { "TSSTcorp CDDVDW SH-S202J" , "SB00" },
214 { "TSSTcorp CDDVDW SH-S202J" , "SB01" },
215 { "TSSTcorp CDDVDW SH-S202N" , "SB00" },
216 { "TSSTcorp CDDVDW SH-S202N" , "SB01" },
217 { "TSSTcorp CDDVDW SH-S202H" , "SB00" },
218 { "TSSTcorp CDDVDW SH-S202H" , "SB01" },
219 { "SAMSUNG SP0822N" , "WA100-10" },
224 * All hosts that use the 80c ribbon must use!
225 * The name is derived from upper byte of word 93 and the 80c ribbon.
227 u8
eighty_ninty_three(ide_drive_t
*drive
)
229 ide_hwif_t
*hwif
= drive
->hwif
;
231 int ivb
= ide_in_drive_list(id
, ivb_list
);
233 if (hwif
->cbl
== ATA_CBL_PATA40_SHORT
)
237 printk(KERN_DEBUG
"%s: skipping word 93 validity check\n",
240 if (ata_id_is_sata(id
) && !ivb
)
243 if (hwif
->cbl
!= ATA_CBL_PATA80
&& !ivb
)
248 * - change master/slave IDENTIFY order
249 * - force bit13 (80c cable present) check also for !ivb devices
250 * (unless the slave device is pre-ATA3)
252 if (id
[ATA_ID_HW_CONFIG
] & 0x4000)
256 const char *model
= (char *)&id
[ATA_ID_PROD
];
258 if (strstr(model
, "TSSTcorp CDDVDW SH-S202")) {
260 * These ATAPI devices always report 80c cable
261 * so we have to depend on the host in this case.
263 if (hwif
->cbl
== ATA_CBL_PATA80
)
266 /* Depend on the device side cable detection. */
267 if (id
[ATA_ID_HW_CONFIG
] & 0x2000)
272 if (drive
->dev_flags
& IDE_DFLAG_UDMA33_WARNED
)
275 printk(KERN_WARNING
"%s: %s side 80-wire cable detection failed, "
276 "limiting max speed to UDMA33\n",
278 hwif
->cbl
== ATA_CBL_PATA80
? "drive" : "host");
280 drive
->dev_flags
|= IDE_DFLAG_UDMA33_WARNED
;
285 int ide_driveid_update(ide_drive_t
*drive
)
290 id
= kmalloc(SECTOR_SIZE
, GFP_ATOMIC
);
294 SELECT_MASK(drive
, 1);
295 rc
= ide_dev_read_id(drive
, ATA_CMD_ID_ATA
, id
);
296 SELECT_MASK(drive
, 0);
301 drive
->id
[ATA_ID_UDMA_MODES
] = id
[ATA_ID_UDMA_MODES
];
302 drive
->id
[ATA_ID_MWDMA_MODES
] = id
[ATA_ID_MWDMA_MODES
];
303 drive
->id
[ATA_ID_SWDMA_MODES
] = id
[ATA_ID_SWDMA_MODES
];
304 drive
->id
[ATA_ID_CFA_MODES
] = id
[ATA_ID_CFA_MODES
];
305 /* anything more ? */
309 if ((drive
->dev_flags
& IDE_DFLAG_USING_DMA
) && ide_id_dma_bug(drive
))
314 SELECT_MASK(drive
, 0);
316 printk(KERN_ERR
"%s: %s: bad status\n", drive
->name
, __func__
);
321 int ide_config_drive_speed(ide_drive_t
*drive
, u8 speed
)
323 ide_hwif_t
*hwif
= drive
->hwif
;
324 const struct ide_tp_ops
*tp_ops
= hwif
->tp_ops
;
325 struct ide_taskfile tf
;
326 u16
*id
= drive
->id
, i
;
330 #ifdef CONFIG_BLK_DEV_IDEDMA
331 if (hwif
->dma_ops
) /* check if host supports DMA */
332 hwif
->dma_ops
->dma_host_set(drive
, 0);
335 /* Skip setting PIO flow-control modes on pre-EIDE drives */
336 if ((speed
& 0xf8) == XFER_PIO_0
&& ata_id_has_iordy(drive
->id
) == 0)
340 * Don't use ide_wait_cmd here - it will
341 * attempt to set_geometry and recalibrate,
342 * but for some reason these don't work at
343 * this point (lost interrupt).
347 * FIXME: we race against the running IRQ here if
348 * this is called from non IRQ context. If we use
349 * disable_irq() we hang on the error path. Work
352 disable_irq_nosync(hwif
->irq
);
355 tp_ops
->dev_select(drive
);
356 SELECT_MASK(drive
, 1);
358 tp_ops
->write_devctl(hwif
, ATA_NIEN
| ATA_DEVCTL_OBS
);
360 memset(&tf
, 0, sizeof(tf
));
361 tf
.feature
= SETFEATURES_XFER
;
364 tp_ops
->tf_load(drive
, &tf
, IDE_VALID_FEATURE
| IDE_VALID_NSECT
);
366 tp_ops
->exec_command(hwif
, ATA_CMD_SET_FEATURES
);
368 if (drive
->quirk_list
== 2)
369 tp_ops
->write_devctl(hwif
, ATA_DEVCTL_OBS
);
371 error
= __ide_wait_stat(drive
, drive
->ready_stat
,
372 ATA_BUSY
| ATA_DRQ
| ATA_ERR
,
375 SELECT_MASK(drive
, 0);
377 enable_irq(hwif
->irq
);
380 (void) ide_dump_status(drive
, "set_drive_speed_status", stat
);
384 if (speed
>= XFER_SW_DMA_0
) {
385 id
[ATA_ID_UDMA_MODES
] &= ~0xFF00;
386 id
[ATA_ID_MWDMA_MODES
] &= ~0x0700;
387 id
[ATA_ID_SWDMA_MODES
] &= ~0x0700;
388 if (ata_id_is_cfa(id
))
389 id
[ATA_ID_CFA_MODES
] &= ~0x0E00;
390 } else if (ata_id_is_cfa(id
))
391 id
[ATA_ID_CFA_MODES
] &= ~0x01C0;
394 #ifdef CONFIG_BLK_DEV_IDEDMA
395 if (speed
>= XFER_SW_DMA_0
&& (drive
->dev_flags
& IDE_DFLAG_USING_DMA
))
396 hwif
->dma_ops
->dma_host_set(drive
, 1);
397 else if (hwif
->dma_ops
) /* check if host supports DMA */
398 ide_dma_off_quietly(drive
);
401 if (speed
>= XFER_UDMA_0
) {
402 i
= 1 << (speed
- XFER_UDMA_0
);
403 id
[ATA_ID_UDMA_MODES
] |= (i
<< 8 | i
);
404 } else if (ata_id_is_cfa(id
) && speed
>= XFER_MW_DMA_3
) {
405 i
= speed
- XFER_MW_DMA_2
;
406 id
[ATA_ID_CFA_MODES
] |= i
<< 9;
407 } else if (speed
>= XFER_MW_DMA_0
) {
408 i
= 1 << (speed
- XFER_MW_DMA_0
);
409 id
[ATA_ID_MWDMA_MODES
] |= (i
<< 8 | i
);
410 } else if (speed
>= XFER_SW_DMA_0
) {
411 i
= 1 << (speed
- XFER_SW_DMA_0
);
412 id
[ATA_ID_SWDMA_MODES
] |= (i
<< 8 | i
);
413 } else if (ata_id_is_cfa(id
) && speed
>= XFER_PIO_5
) {
414 i
= speed
- XFER_PIO_4
;
415 id
[ATA_ID_CFA_MODES
] |= i
<< 6;
418 if (!drive
->init_speed
)
419 drive
->init_speed
= speed
;
420 drive
->current_speed
= speed
;
425 * This should get invoked any time we exit the driver to
426 * wait for an interrupt response from a drive. handler() points
427 * at the appropriate code to handle the next interrupt, and a
428 * timer is started to prevent us from waiting forever in case
429 * something goes wrong (see the ide_timer_expiry() handler later on).
431 * See also ide_execute_command
433 void __ide_set_handler(ide_drive_t
*drive
, ide_handler_t
*handler
,
434 unsigned int timeout
)
436 ide_hwif_t
*hwif
= drive
->hwif
;
438 BUG_ON(hwif
->handler
);
439 hwif
->handler
= handler
;
440 hwif
->timer
.expires
= jiffies
+ timeout
;
441 hwif
->req_gen_timer
= hwif
->req_gen
;
442 add_timer(&hwif
->timer
);
445 void ide_set_handler(ide_drive_t
*drive
, ide_handler_t
*handler
,
446 unsigned int timeout
)
448 ide_hwif_t
*hwif
= drive
->hwif
;
451 spin_lock_irqsave(&hwif
->lock
, flags
);
452 __ide_set_handler(drive
, handler
, timeout
);
453 spin_unlock_irqrestore(&hwif
->lock
, flags
);
455 EXPORT_SYMBOL(ide_set_handler
);
458 * ide_execute_command - execute an IDE command
459 * @drive: IDE drive to issue the command against
461 * @handler: handler for next phase
462 * @timeout: timeout for command
464 * Helper function to issue an IDE command. This handles the
465 * atomicity requirements, command timing and ensures that the
466 * handler and IRQ setup do not race. All IDE command kick off
467 * should go via this function or do equivalent locking.
470 void ide_execute_command(ide_drive_t
*drive
, struct ide_cmd
*cmd
,
471 ide_handler_t
*handler
, unsigned timeout
)
473 ide_hwif_t
*hwif
= drive
->hwif
;
476 spin_lock_irqsave(&hwif
->lock
, flags
);
477 if ((cmd
->protocol
!= ATAPI_PROT_DMA
&&
478 cmd
->protocol
!= ATAPI_PROT_PIO
) ||
479 (drive
->atapi_flags
& IDE_AFLAG_DRQ_INTERRUPT
))
480 __ide_set_handler(drive
, handler
, timeout
);
481 hwif
->tp_ops
->exec_command(hwif
, cmd
->tf
.command
);
483 * Drive takes 400nS to respond, we must avoid the IRQ being
484 * serviced before that.
486 * FIXME: we could skip this delay with care on non shared devices
489 spin_unlock_irqrestore(&hwif
->lock
, flags
);
493 * ide_wait_not_busy() waits for the currently selected device on the hwif
494 * to report a non-busy status, see comments in ide_probe_port().
496 int ide_wait_not_busy(ide_hwif_t
*hwif
, unsigned long timeout
)
502 * Turn this into a schedule() sleep once I'm sure
503 * about locking issues (2.5 work ?).
506 stat
= hwif
->tp_ops
->read_status(hwif
);
507 if ((stat
& ATA_BUSY
) == 0)
510 * Assume a value of 0xff means nothing is connected to
511 * the interface and it doesn't implement the pull-down
516 touch_softlockup_watchdog();
517 touch_nmi_watchdog();