sys/arch/newsmips/dev/hb.c

   1 /*      $NetBSD: hb.c,v 1.17 2005/12/11 12:18:24 christos Exp $ */
   2
   3 #include <sys/cdefs.h>
   4 __KERNEL_RCSID(0, "$NetBSD: hb.c,v 1.17 2005/12/11 12:18:24 christos Exp $");
   5
   6 #include <sys/param.h>
   7 #include <sys/systm.h>
   8 #include <sys/device.h>
   9 #include <sys/malloc.h>
  10
  11 #include <machine/autoconf.h>
  12 #include <machine/intr.h>
  13
  14 #include <newsmips/dev/hbvar.h>
  15
  16 #include "ioconf.h"
  17
  18 static int      hb_match(device_t, cfdata_t, void *);
  19 static void     hb_attach(device_t, device_t, void *);
  20 static int      hb_search(device_t, cfdata_t, const int *, void *);
  21 static int      hb_print(void *, const char *);
  22
  23 CFATTACH_DECL_NEW(hb, 0,
  24     hb_match, hb_attach, NULL, NULL);
  25
  26 #define NLEVEL  4
  27 static struct newsmips_intr hbintr_tab[NLEVEL];
  28
  29 static int
  30 hb_match(device_t parent, cfdata_t cf, void *aux)
  31 {
  32         struct confargs *ca = aux;
  33
  34         if (strcmp(ca->ca_name, hb_cd.cd_name) != 0)
  35                 return 0;
  36
  37         return 1;
  38 }
  39
  40 static void
  41 hb_attach(device_t parent, device_t self, void *aux)
  42 {
  43         struct hb_attach_args ha;
  44         struct newsmips_intr *ip;
  45         int i;
  46
  47         aprint_normal("\n");
  48
  49         memset(&ha, 0, sizeof(ha));
  50         for (i = 0; i < NLEVEL; i++) {
  51                 ip = &hbintr_tab[i];
  52                 LIST_INIT(&ip->intr_q);
  53         }
  54
  55         config_search_ia(hb_search, self, "hb", &ha);
  56 }
  57
  58 static int
  59 hb_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
  60 {
  61         struct hb_attach_args *ha = aux;
  62
  63         ha->ha_name = cf->cf_name;
  64         ha->ha_addr = cf->cf_addr;
  65         ha->ha_level = cf->cf_level;
  66
  67         if (config_match(parent, cf, ha) > 0)
  68                 config_attach(parent, cf, ha, hb_print);
  69
  70         return 0;
  71 }
  72
  73 /*
  74  * Print out the confargs.  The (parent) name is non-NULL
  75  * when there was no match found by config_found().
  76  */
  77 static int
  78 hb_print(void *args, const char *name)
  79 {
  80         struct hb_attach_args *ha = args;
  81
  82         /* Be quiet about empty HB locations. */
  83         if (name)
  84                 return QUIET;
  85
  86         if (ha->ha_addr != -1)
  87                 aprint_normal(" addr 0x%x", ha->ha_addr);
  88
  89         return UNCONF;
  90 }
  91
  92 void *
  93 hb_intr_establish(int level, int mask, int priority, int (*func)(void *),
  94     void *arg)
  95 {
  96         struct newsmips_intr *ip;
  97         struct newsmips_intrhand *ih, *curih;
  98
  99         ip = &hbintr_tab[level];
 100
 101         ih = malloc(sizeof(*ih), M_DEVBUF, M_NOWAIT);
 102         if (ih == NULL)
 103                 panic("%s: malloc failed", __func__);
 104
 105         ih->ih_func = func;
 106         ih->ih_arg = arg;
 107         ih->ih_level = level;
 108         ih->ih_mask = mask;
 109         ih->ih_priority = priority;
 110
 111         if (LIST_EMPTY(&ip->intr_q)) {
 112                 LIST_INSERT_HEAD(&ip->intr_q, ih, ih_q);
 113                 goto done;
 114         }
 115
 116         for (curih = LIST_FIRST(&ip->intr_q);
 117             LIST_NEXT(curih, ih_q) != NULL;
 118             curih = LIST_NEXT(curih, ih_q)) {
 119                 if (ih->ih_priority > curih->ih_priority) {
 120                         LIST_INSERT_BEFORE(curih, ih, ih_q);
 121                         goto done;
 122                 }
 123         }
 124
 125         LIST_INSERT_AFTER(curih, ih, ih_q);
 126
 127  done:
 128         return ih;
 129 }
 130
 131 void
 132 hb_intr_dispatch(int level, int stat)
 133 {
 134         struct newsmips_intr *ip;
 135         struct newsmips_intrhand *ih;
 136
 137         ip = &hbintr_tab[level];
 138
 139         LIST_FOREACH(ih, &ip->intr_q, ih_q) {
 140                 if (ih->ih_mask & stat)
 141                         (*ih->ih_func)(ih->ih_arg);
 142         }
 143 }