NetBSD/sys/arch/newsmips/dev/hb.c

140 lines
2.4 KiB
C

/* $NetBSD: hb.c,v 1.4 1999/12/17 03:06:14 tsubai Exp $ */
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <machine/autoconf.h>
static int hb_match __P((struct device *, struct cfdata *, void *));
static void hb_attach __P((struct device *, struct device *, void *));
static int hb_search __P((struct device *, struct cfdata *, void *));
static int hb_print __P((void *, const char *));
struct cfattach hb_ca = {
sizeof(struct device), hb_match, hb_attach
};
extern struct cfdriver hb_cd;
struct intrhand {
int (*func) __P((void *));
void *arg;
};
#define NHBINTR 4
struct intrhand hb_intrhand[6][NHBINTR];
static int
hb_match(parent, cf, aux)
struct device *parent;
struct cfdata *cf;
void *aux;
{
struct confargs *ca = aux;
if (strcmp(ca->ca_name, hb_cd.cd_name) != 0)
return 0;
return 1;
}
static void
hb_attach(parent, self, aux)
struct device *parent;
struct device *self;
void *aux;
{
struct confargs *ca = aux;
printf("\n");
config_search(hb_search, self, ca);
}
static int
hb_search(parent, cf, aux)
struct device *parent;
struct cfdata *cf;
void *aux;
{
struct confargs *ca = aux;
ca->ca_addr = cf->cf_addr;
ca->ca_name = cf->cf_driver->cd_name;
if ((*cf->cf_attach->ca_match)(parent, cf, ca) > 0)
config_attach(parent, cf, ca, hb_print);
return 0;
}
/*
* Print out the confargs. The (parent) name is non-NULL
* when there was no match found by config_found().
*/
static int
hb_print(args, name)
void *args;
const char *name;
{
struct confargs *ca = args;
/* Be quiet about empty HB locations. */
if (name)
return QUIET;
if (ca->ca_addr != -1)
printf(" addr 0x%x", ca->ca_addr);
return UNCONF;
}
void *
hb_intr_establish(irq, level, func, arg)
int irq, level;
int (*func) __P((void *));
void *arg;
{
struct intrhand *ih = hb_intrhand[irq];
int i;
for (i = NHBINTR; i > 0; i--) {
if (ih->func == NULL)
goto found;
ih++;
}
panic("hb_intr_establish: no room");
found:
ih->func = func;
ih->arg = arg;
#ifdef HB_DEBUG
for (irq = 0; irq <= 2; irq++) {
for (i = 0; i < NHBINTR; i++) {
printf("%p(%p) ",
hb_intrhand[irq][i].func,
hb_intrhand[irq][i].arg);
}
printf("\n");
}
#endif
return ih;
}
void
hb_intr_dispatch(irq)
int irq;
{
struct intrhand *ih;
int i;
ih = hb_intrhand[irq];
for (i = NHBINTR; i > 0; i--) {
if (ih->func)
(*ih->func)(ih->arg);
ih++;
}
}