mirror of
https://github.com/Stichting-MINIX-Research-Foundation/netbsd.git
synced 2025-09-12 00:24:52 -04:00
145 lines
2.8 KiB
C
145 lines
2.8 KiB
C
/* $NetBSD: hb.c,v 1.19 2011/02/20 07:56:31 matt Exp $ */
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: hb.c,v 1.19 2011/02/20 07:56:31 matt Exp $");
|
|
|
|
#define __INTR_PRIVATE
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/intr.h>
|
|
|
|
#include <machine/autoconf.h>
|
|
|
|
#include <newsmips/dev/hbvar.h>
|
|
|
|
#include "ioconf.h"
|
|
|
|
static int hb_match(device_t, cfdata_t, void *);
|
|
static void hb_attach(device_t, device_t, void *);
|
|
static int hb_search(device_t, cfdata_t, const int *, void *);
|
|
static int hb_print(void *, const char *);
|
|
|
|
CFATTACH_DECL_NEW(hb, 0,
|
|
hb_match, hb_attach, NULL, NULL);
|
|
|
|
#define NLEVEL 4
|
|
static struct newsmips_intr hbintr_tab[NLEVEL];
|
|
|
|
static int
|
|
hb_match(device_t parent, cfdata_t 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(device_t parent, device_t self, void *aux)
|
|
{
|
|
struct hb_attach_args ha;
|
|
struct newsmips_intr *ip;
|
|
int i;
|
|
|
|
aprint_normal("\n");
|
|
|
|
memset(&ha, 0, sizeof(ha));
|
|
for (i = 0; i < NLEVEL; i++) {
|
|
ip = &hbintr_tab[i];
|
|
LIST_INIT(&ip->intr_q);
|
|
}
|
|
|
|
config_search_ia(hb_search, self, "hb", &ha);
|
|
}
|
|
|
|
static int
|
|
hb_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
|
|
{
|
|
struct hb_attach_args *ha = aux;
|
|
|
|
ha->ha_name = cf->cf_name;
|
|
ha->ha_addr = cf->cf_addr;
|
|
ha->ha_level = cf->cf_level;
|
|
|
|
if (config_match(parent, cf, ha) > 0)
|
|
config_attach(parent, cf, ha, 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(void *args, const char *name)
|
|
{
|
|
struct hb_attach_args *ha = args;
|
|
|
|
/* Be quiet about empty HB locations. */
|
|
if (name)
|
|
return QUIET;
|
|
|
|
if (ha->ha_addr != -1)
|
|
aprint_normal(" addr 0x%x", ha->ha_addr);
|
|
|
|
return UNCONF;
|
|
}
|
|
|
|
void *
|
|
hb_intr_establish(int level, int mask, int priority, int (*func)(void *),
|
|
void *arg)
|
|
{
|
|
struct newsmips_intr *ip;
|
|
struct newsmips_intrhand *ih, *curih;
|
|
|
|
ip = &hbintr_tab[level];
|
|
|
|
ih = malloc(sizeof(*ih), M_DEVBUF, M_NOWAIT);
|
|
if (ih == NULL)
|
|
panic("%s: malloc failed", __func__);
|
|
|
|
ih->ih_func = func;
|
|
ih->ih_arg = arg;
|
|
ih->ih_level = level;
|
|
ih->ih_mask = mask;
|
|
ih->ih_priority = priority;
|
|
|
|
if (LIST_EMPTY(&ip->intr_q)) {
|
|
LIST_INSERT_HEAD(&ip->intr_q, ih, ih_q);
|
|
goto done;
|
|
}
|
|
|
|
for (curih = LIST_FIRST(&ip->intr_q);
|
|
LIST_NEXT(curih, ih_q) != NULL;
|
|
curih = LIST_NEXT(curih, ih_q)) {
|
|
if (ih->ih_priority > curih->ih_priority) {
|
|
LIST_INSERT_BEFORE(curih, ih, ih_q);
|
|
goto done;
|
|
}
|
|
}
|
|
|
|
LIST_INSERT_AFTER(curih, ih, ih_q);
|
|
|
|
done:
|
|
return ih;
|
|
}
|
|
|
|
void
|
|
hb_intr_dispatch(int level, int stat)
|
|
{
|
|
struct newsmips_intr *ip;
|
|
struct newsmips_intrhand *ih;
|
|
|
|
ip = &hbintr_tab[level];
|
|
|
|
LIST_FOREACH(ih, &ip->intr_q, ih_q) {
|
|
if (ih->ih_mask & stat)
|
|
(*ih->ih_func)(ih->ih_arg);
|
|
}
|
|
}
|