Add a ata_queue_idle() function, which freeze a queue and tsleep() until the

controller is idle.
Change the powerhook function to call ata_queue_idle() on standby/suspend,
and ata_reset_channel() on resume (to wake up the disks and start from a
clean state).
Fix PR kern/30194 by Lubomir Sedlacik.
This commit is contained in:
bouyer 2005-05-16 21:43:33 +00:00
parent d3f9123bd5
commit eaa19a67b8
2 changed files with 38 additions and 20 deletions

View File

@ -1,4 +1,4 @@
/* $NetBSD: ata.c,v 1.67 2005/04/11 04:24:54 matt Exp $ */
/* $NetBSD: ata.c,v 1.68 2005/05/16 21:43:33 bouyer Exp $ */
/*
* Copyright (c) 1998, 2001 Manuel Bouyer. All rights reserved.
@ -30,7 +30,7 @@
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ata.c,v 1.67 2005/04/11 04:24:54 matt Exp $");
__KERNEL_RCSID(0, "$NetBSD: ata.c,v 1.68 2005/05/16 21:43:33 bouyer Exp $");
#ifndef ATADEBUG
#define ATADEBUG
@ -158,6 +158,7 @@ ata_channel_attach(struct ata_channel *chp)
TAILQ_INIT(&chp->ch_queue->queue_xfer);
chp->ch_queue->queue_freeze = 0;
chp->ch_queue->queue_flags = 0;
chp->ch_queue->active_xfer = NULL;
chp->atabus = config_found(&chp->ch_atac->atac_dev, chp, atabusprint);
@ -322,11 +323,7 @@ atabus_thread(void *arg)
splx(s);
/* Configure the devices on the bus. */
if (sc->sc_sleeping == 1) {
printf("%s: resuming...\n", sc->sc_dev.dv_xname);
sc->sc_sleeping = 0;
} else
atabusconfig(sc);
atabusconfig(sc);
for (;;) {
s = splbio();
@ -430,7 +427,6 @@ atabus_attach(struct device *parent, struct device *self, void *aux)
config_pending_incr();
kthread_create(atabus_create_thread, sc);
sc->sc_sleeping = 0;
sc->sc_powerhook = powerhook_establish(atabus_powerhook, sc);
if (sc->sc_powerhook == NULL)
printf("%s: WARNING: unable to establish power hook\n",
@ -698,6 +694,22 @@ ata_dmaerr(struct ata_drive_datas *drvp, int flags)
}
}
/*
* freeze the queue and wait for the controller to be idle. Caller has to
* unfreeze/restart the queue
*/
void
ata_queue_idle(struct ata_queue *queue)
{
int s = splbio();
queue->queue_freeze++;
while (queue->active_xfer != NULL) {
queue->queue_flags |= QF_IDLE_WAIT;
tsleep(&queue->queue_flags, PRIBIO, "qidl", 0);
}
splx(s);
}
/*
* Add a command to the queue and start controller.
*
@ -772,7 +784,11 @@ atastart(struct ata_channel *chp)
return; /* channel aleady active */
}
if (__predict_false(chp->ch_queue->queue_freeze > 0)) {
return; /* queue froozen */
if (chp->ch_queue->queue_flags & QF_IDLE_WAIT) {
chp->ch_queue->queue_flags &= ~QF_IDLE_WAIT;
wakeup(&chp->ch_queue->queue_flags);
}
return; /* queue frozen */
}
/*
* if someone is waiting for the command to be active, wake it up
@ -1422,17 +1438,17 @@ atabus_powerhook(int why, void *hdl)
switch (why) {
case PWR_SOFTSUSPEND:
case PWR_SOFTSTANDBY:
sc->sc_sleeping = 1;
s = splbio();
chp->ch_flags = ATACH_SHUTDOWN;
splx(s);
wakeup(&chp->ch_thread);
while (chp->ch_thread != NULL)
(void) tsleep((void *)&chp->ch_flags, PRIBIO,
"atadown", 0);
/* freeze the queue and wait for the controller to be idle */
ata_queue_idle(chp->ch_queue);
break;
case PWR_RESUME:
atabus_create_thread(sc);
printf("%s: resuming...\n", sc->sc_dev.dv_xname);
s = splbio();
KASSERT(chp->ch_queue->queue_freeze > 0);
/* unfreeze the queue and reset drives (to wake them up) */
chp->ch_queue->queue_freeze--;
ata_reset_channel(chp, AT_WAIT);
splx(s);
break;
case PWR_SUSPEND:
case PWR_STANDBY:

View File

@ -1,4 +1,4 @@
/* $NetBSD: atavar.h,v 1.67 2005/02/27 00:26:59 perry Exp $ */
/* $NetBSD: atavar.h,v 1.68 2005/05/16 21:43:33 bouyer Exp $ */
/*
* Copyright (c) 1998, 2001 Manuel Bouyer.
@ -88,6 +88,8 @@ struct ata_queue {
TAILQ_HEAD(, ata_xfer) queue_xfer; /* queue of pending commands */
int queue_freeze; /* freeze count for the queue */
struct ata_xfer *active_xfer; /* active command */
int queue_flags; /* flags for this queue */
#define QF_IDLE_WAIT 0x01 /* someone is wants the controller idle */
};
/* ATA bus instance state information. */
@ -97,7 +99,6 @@ struct atabus_softc {
int sc_flags;
#define ATABUSCF_OPEN 0x01
void *sc_powerhook;
int sc_sleeping;
};
/*
@ -441,6 +442,7 @@ int ata_downgrade_mode(struct ata_drive_datas *, int);
void ata_probe_caps(struct ata_drive_datas *);
void ata_dmaerr(struct ata_drive_datas *, int);
void ata_queue_idle(struct ata_queue *);
#endif /* _KERNEL */
#endif /* _DEV_ATA_ATAVAR_H_ */