mirror of https://gitee.com/openkylin/linux.git
ide-pmac: use __ide_wait_stat()
* Use __ide_wait_stat() instead of wait_for_ready() in pmac_ide_do_setfeature(). While at it do following changes to match __ide_wait_stat() call in ide_config_drive_speed(): * Wait WAIT_CMD time (20 sec) instead of 2 sec for device to clear BUSY_STAT. * Check DRQ_STAT bit (shouldn't be set for good device status). Also remove no longer needed wait_for_ready() from ide-iops.c. Acked-by: Benjamin Herrenschmidt <benh@kernel.crashing.org> Signed-off-by: Bartlomiej Zolnierkiewicz <bzolnier@gmail.com>
This commit is contained in:
parent
218ee5f364
commit
ddf151026a
|
@ -472,35 +472,6 @@ int drive_is_ready (ide_drive_t *drive)
|
||||||
|
|
||||||
EXPORT_SYMBOL(drive_is_ready);
|
EXPORT_SYMBOL(drive_is_ready);
|
||||||
|
|
||||||
/*
|
|
||||||
* Global for All, and taken from ide-pmac.c. Can be called
|
|
||||||
* with spinlock held & IRQs disabled, so don't schedule !
|
|
||||||
*/
|
|
||||||
int wait_for_ready (ide_drive_t *drive, int timeout)
|
|
||||||
{
|
|
||||||
ide_hwif_t *hwif = HWIF(drive);
|
|
||||||
u8 stat = 0;
|
|
||||||
|
|
||||||
while(--timeout) {
|
|
||||||
stat = hwif->INB(IDE_STATUS_REG);
|
|
||||||
if (!(stat & BUSY_STAT)) {
|
|
||||||
if (drive->ready_stat == 0)
|
|
||||||
break;
|
|
||||||
else if ((stat & drive->ready_stat)||(stat & ERR_STAT))
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
mdelay(1);
|
|
||||||
}
|
|
||||||
if ((stat & ERR_STAT) || timeout <= 0) {
|
|
||||||
if (stat & ERR_STAT) {
|
|
||||||
printk(KERN_ERR "%s: wait_for_ready, "
|
|
||||||
"error status: %x\n", drive->name, stat);
|
|
||||||
}
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* This routine busy-waits for the drive status to be not "busy".
|
* This routine busy-waits for the drive status to be not "busy".
|
||||||
* It then checks the status for all of the "good" bits and none
|
* It then checks the status for all of the "good" bits and none
|
||||||
|
@ -512,7 +483,7 @@ int wait_for_ready (ide_drive_t *drive, int timeout)
|
||||||
* setting a timer to wake up at half second intervals thereafter,
|
* setting a timer to wake up at half second intervals thereafter,
|
||||||
* until timeout is achieved, before timing out.
|
* until timeout is achieved, before timing out.
|
||||||
*/
|
*/
|
||||||
static int __ide_wait_stat(ide_drive_t *drive, u8 good, u8 bad, unsigned long timeout, u8 *rstat)
|
int __ide_wait_stat(ide_drive_t *drive, u8 good, u8 bad, unsigned long timeout, u8 *rstat)
|
||||||
{
|
{
|
||||||
ide_hwif_t *hwif = drive->hwif;
|
ide_hwif_t *hwif = drive->hwif;
|
||||||
unsigned long flags;
|
unsigned long flags;
|
||||||
|
|
|
@ -541,7 +541,8 @@ static int
|
||||||
pmac_ide_do_setfeature(ide_drive_t *drive, u8 command)
|
pmac_ide_do_setfeature(ide_drive_t *drive, u8 command)
|
||||||
{
|
{
|
||||||
ide_hwif_t *hwif = HWIF(drive);
|
ide_hwif_t *hwif = HWIF(drive);
|
||||||
int result = 1;
|
int result;
|
||||||
|
u8 stat;
|
||||||
|
|
||||||
disable_irq_nosync(hwif->irq);
|
disable_irq_nosync(hwif->irq);
|
||||||
udelay(1);
|
udelay(1);
|
||||||
|
@ -552,9 +553,9 @@ pmac_ide_do_setfeature(ide_drive_t *drive, u8 command)
|
||||||
hwif->OUTB(command, IDE_NSECTOR_REG);
|
hwif->OUTB(command, IDE_NSECTOR_REG);
|
||||||
hwif->OUTB(SETFEATURES_XFER, IDE_FEATURE_REG);
|
hwif->OUTB(SETFEATURES_XFER, IDE_FEATURE_REG);
|
||||||
hwif->OUTBSYNC(drive, WIN_SETFEATURES, IDE_COMMAND_REG);
|
hwif->OUTBSYNC(drive, WIN_SETFEATURES, IDE_COMMAND_REG);
|
||||||
udelay(1);
|
result = __ide_wait_stat(drive, drive->ready_stat,
|
||||||
/* Timeout bumped for some powerbooks */
|
BUSY_STAT|DRQ_STAT|ERR_STAT,
|
||||||
result = wait_for_ready(drive, 2000);
|
WAIT_CMD, &stat);
|
||||||
hwif->OUTB(drive->ctl, IDE_CONTROL_REG);
|
hwif->OUTB(drive->ctl, IDE_CONTROL_REG);
|
||||||
if (result)
|
if (result)
|
||||||
printk(KERN_ERR "%s: pmac_ide_do_setfeature disk not ready "
|
printk(KERN_ERR "%s: pmac_ide_do_setfeature disk not ready "
|
||||||
|
|
|
@ -1153,7 +1153,7 @@ extern void SELECT_MASK(ide_drive_t *, int);
|
||||||
extern void QUIRK_LIST(ide_drive_t *);
|
extern void QUIRK_LIST(ide_drive_t *);
|
||||||
|
|
||||||
extern int drive_is_ready(ide_drive_t *);
|
extern int drive_is_ready(ide_drive_t *);
|
||||||
extern int wait_for_ready(ide_drive_t *, int /* timeout */);
|
int __ide_wait_stat(ide_drive_t *, u8, u8, unsigned long);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* taskfile io for disks for now...and builds request from ide_ioctl
|
* taskfile io for disks for now...and builds request from ide_ioctl
|
||||||
|
|
Loading…
Reference in New Issue