Make the interrupt handler wrapper capable of correctly support filter+ithread handler.

Discussed and reviewed with: bsdimp, simokawa
This commit is contained in:
piso 2007-05-31 19:29:20 +00:00
parent 42dfc78150
commit b5a7cab3ba
4 changed files with 42 additions and 25 deletions

View File

@ -118,7 +118,8 @@ static struct resource *pccard_alloc_resource(device_t dev,
static int pccard_release_resource(device_t dev, device_t child, int type, static int pccard_release_resource(device_t dev, device_t child, int type,
int rid, struct resource *r); int rid, struct resource *r);
static void pccard_child_detached(device_t parent, device_t dev); static void pccard_child_detached(device_t parent, device_t dev);
static int pccard_intr(void *arg); static int pccard_filter(void *arg);
static void pccard_intr(void *arg);
static int pccard_setup_intr(device_t dev, device_t child, static int pccard_setup_intr(device_t dev, device_t child,
struct resource *irq, int flags, driver_filter_t *filt, struct resource *irq, int flags, driver_filter_t *filt,
driver_intr_t *intr, void *arg, void **cookiep); driver_intr_t *intr, void *arg, void **cookiep);
@ -1177,7 +1178,7 @@ pccard_child_detached(device_t parent, device_t dev)
} }
static int static int
pccard_intr(void *arg) pccard_filter(void *arg)
{ {
struct pccard_function *pf = (struct pccard_function*) arg; struct pccard_function *pf = (struct pccard_function*) arg;
int reg; int reg;
@ -1208,12 +1209,20 @@ pccard_intr(void *arg)
doisr = 0; doisr = 0;
} }
if (doisr) { if (doisr) {
if (pf->filt_handler != NULL) if (pf->intr_filter != NULL)
pf->filt_handler(pf->intr_handler_arg); return (pf->intr_filter(pf->intr_handler_arg));
else else
pf->intr_handler(pf->intr_handler_arg); return (FILTER_SCHEDULE_THREAD);
} }
return (FILTER_HANDLED); return (FILTER_STRAY);
}
static void
pccard_intr(void *arg)
{
struct pccard_function *pf = (struct pccard_function*) arg;
pf->intr_handler(pf->intr_handler_arg);
} }
static int static int
@ -1226,19 +1235,13 @@ pccard_setup_intr(device_t dev, device_t child, struct resource *irq,
struct pccard_function *pf = ivar->pf; struct pccard_function *pf = ivar->pf;
int err; int err;
if (pf->intr_handler != NULL) if (pf->intr_filter != NULL || pf->intr_handler != NULL)
panic("Only one interrupt handler per function allowed"); panic("Only one interrupt handler per function allowed");
if (filt != NULL && intr != NULL) err = bus_generic_setup_intr(dev, child, irq, flags, pccard_filter,
return (EINVAL); pccard_intr, pf, cookiep);
if (filt != NULL)
err = bus_generic_setup_intr(dev, child, irq, flags,
pccard_intr, NULL, pf, cookiep);
else
err = bus_generic_setup_intr(dev, child, irq, flags,
NULL, (driver_intr_t *)pccard_intr, pf, cookiep);
if (err != 0) if (err != 0)
return (err); return (err);
pf->filt_handler = filt; pf->intr_filter = filt;
pf->intr_handler = intr; pf->intr_handler = intr;
pf->intr_handler_arg = arg; pf->intr_handler_arg = arg;
pf->intr_handler_cookie = *cookiep; pf->intr_handler_cookie = *cookiep;

View File

@ -112,7 +112,7 @@ struct pccard_function {
bus_addr_t pf_mfc_iobase; bus_addr_t pf_mfc_iobase;
bus_addr_t pf_mfc_iomax; bus_addr_t pf_mfc_iomax;
int pf_flags; int pf_flags;
driver_filter_t *filt_handler; driver_filter_t *intr_filter;
driver_intr_t *intr_handler; driver_intr_t *intr_handler;
void *intr_handler_arg; void *intr_handler_arg;
void *intr_handler_cookie; void *intr_handler_cookie;

View File

@ -84,6 +84,7 @@ __FBSDID("$FreeBSD$");
#include <sys/kernel.h> #include <sys/kernel.h>
#include <sys/module.h> #include <sys/module.h>
#include <sys/kthread.h> #include <sys/kthread.h>
#include <sys/interrupt.h>
#include <sys/lock.h> #include <sys/lock.h>
#include <sys/malloc.h> #include <sys/malloc.h>
#include <sys/mutex.h> #include <sys/mutex.h>
@ -176,6 +177,7 @@ static int cbb_cardbus_power_enable_socket(device_t brdev,
device_t child); device_t child);
static void cbb_cardbus_power_disable_socket(device_t brdev, static void cbb_cardbus_power_disable_socket(device_t brdev,
device_t child); device_t child);
static int cbb_func_filt(void *arg);
static void cbb_func_intr(void *arg); static void cbb_func_intr(void *arg);
static void static void
@ -365,18 +367,19 @@ cbb_setup_intr(device_t dev, device_t child, struct resource *irq,
struct cbb_softc *sc = device_get_softc(dev); struct cbb_softc *sc = device_get_softc(dev);
int err; int err;
if (filt == NULL && intr == NULL)
return (EINVAL);
/* /*
* Well, this is no longer strictly true. You can have multiple * Well, this is no longer strictly true. You can have multiple
* FAST ISRs, but can't mix fast and slow, so we have to assume * FAST ISRs, but can't mix fast and slow, so we have to assume
* least common denominator until the base system supports mixing * least common denominator until the base system supports mixing
* and matching better. * and matching better.
*/ */
if (filt != NULL)
return (EINVAL);
ih = malloc(sizeof(struct cbb_intrhand), M_DEVBUF, M_NOWAIT); ih = malloc(sizeof(struct cbb_intrhand), M_DEVBUF, M_NOWAIT);
if (ih == NULL) if (ih == NULL)
return (ENOMEM); return (ENOMEM);
*cookiep = ih; *cookiep = ih;
ih->filt = filt;
ih->intr = intr; ih->intr = intr;
ih->arg = arg; ih->arg = arg;
ih->sc = sc; ih->sc = sc;
@ -385,7 +388,7 @@ cbb_setup_intr(device_t dev, device_t child, struct resource *irq,
* XXX for now that's all we need to do. * XXX for now that's all we need to do.
*/ */
err = BUS_SETUP_INTR(device_get_parent(dev), child, irq, flags, err = BUS_SETUP_INTR(device_get_parent(dev), child, irq, flags,
NULL, cbb_func_intr, ih, &ih->cookie); cbb_func_filt, cbb_func_intr, ih, &ih->cookie);
if (err != 0) { if (err != 0) {
free(ih, M_DEVBUF); free(ih, M_DEVBUF);
return (err); return (err);
@ -612,8 +615,8 @@ cbb_removal(struct cbb_softc *sc)
* cbb_func_intr(), we could just check the SOCKET_MASK register and if * cbb_func_intr(), we could just check the SOCKET_MASK register and if
* CD changes were clear there, then we'd know the card was gone. * CD changes were clear there, then we'd know the card was gone.
*/ */
static void static int
cbb_func_intr(void *arg) cbb_func_filt(void *arg)
{ {
struct cbb_intrhand *ih = (struct cbb_intrhand *)arg; struct cbb_intrhand *ih = (struct cbb_intrhand *)arg;
struct cbb_softc *sc = ih->sc; struct cbb_softc *sc = ih->sc;
@ -622,17 +625,27 @@ cbb_func_intr(void *arg)
* Make sure that the card is really there. * Make sure that the card is really there.
*/ */
if ((sc->flags & CBB_CARD_OK) == 0) if ((sc->flags & CBB_CARD_OK) == 0)
return; return (FILTER_STRAY);
if (!CBB_CARD_PRESENT(cbb_get(sc, CBB_SOCKET_STATE))) { if (!CBB_CARD_PRESENT(cbb_get(sc, CBB_SOCKET_STATE))) {
sc->flags &= ~CBB_CARD_OK; sc->flags &= ~CBB_CARD_OK;
return; return (FILTER_STRAY);
} }
/* /*
* nb: don't have to check for giant or not, since that's done * nb: don't have to check for giant or not, since that's done
* in the ISR dispatch * in the ISR dispatch
*/ */
(*ih->intr)(ih->arg); if (ih->filt != NULL)
return ((*ih->filt)(ih->arg));
return (FILTER_SCHEDULE_THREAD);
}
static void
cbb_func_intr(void *arg)
{
struct cbb_intrhand *ih = (struct cbb_intrhand *)arg;
ih->intr(ih->arg);
} }
/************************************************************************/ /************************************************************************/

View File

@ -32,6 +32,7 @@
*/ */
struct cbb_intrhand { struct cbb_intrhand {
driver_filter_t *filt;
driver_intr_t *intr; driver_intr_t *intr;
void *arg; void *arg;
struct cbb_softc *sc; struct cbb_softc *sc;