sys/arm/arm/intr.c

   1 /*      $NetBSD: intr.c,v 1.12 2003/07/15 00:24:41 lukem Exp $  */
   2
   3 /*-
   4  * Copyright (c) 2004 Olivier Houchard.
   5  * Copyright (c) 1994-1998 Mark Brinicombe.
   6  * All rights reserved.
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that the following conditions
  10  * are met:
  11  * 1. Redistributions of source code must retain the above copyright
  12  *    notice, this list of conditions and the following disclaimer.
  13  * 2. Redistributions in binary form must reproduce the above copyright
  14  *    notice, this list of conditions and the following disclaimer in the
  15  *    documentation and/or other materials provided with the distribution.
  16  * 3. All advertising materials mentioning features or use of this software
  17  *    must display the following acknowledgement:
  18  *      This product includes software developed by Mark Brinicombe
  19  *      for the NetBSD Project.
  20  * 4. The name of the company nor the name of the author may be used to
  21  *    endorse or promote products derived from this software without specific
  22  *    prior written permission.
  23  *
  24  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  25  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  26  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  27  * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
  28  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  29  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
  30  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  31  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  32  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  33  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  34  * SUCH DAMAGE.
  35  *
  36  * Soft interrupt and other generic interrupt functions.
  37  */
  38
  39 #include <sys/cdefs.h>
  40 __FBSDID("$FreeBSD$");
  41 #include <sys/param.h>
  42 #include <sys/systm.h>
  43 #include <sys/syslog.h>
  44 #include <sys/malloc.h>
  45 #include <sys/proc.h>
  46 #include <sys/bus.h>
  47 #include <sys/interrupt.h>
  48 #include <sys/conf.h>
  49 #include <machine/atomic.h>
  50 #include <machine/intr.h>
  51 #include <machine/cpu.h>
  52
  53 static struct intr_event *intr_events[NIRQ];
  54 static int intrcnt_tab[NIRQ];
  55 static int intrcnt_index = 0;
  56 static int last_printed = 0;
  57
  58 void    arm_handler_execute(struct trapframe *, int);
  59
  60 #ifdef INTR_FILTER
  61 static void
  62 intr_disab_eoi_src(void *arg)
  63 {
  64         uintptr_t nb;
  65
  66         nb = (uintptr_t)arg;
  67         arm_mask_irq(nb);
  68 }
  69
  70 static void
  71 intr_eoi_src(void *arg)
  72 {
  73         uintptr_t nb;
  74
  75         nb = (uintptr_t)arg;
  76         arm_unmask_irq(nb);
  77 }
  78
  79 #endif
  80
  81 void
  82 arm_setup_irqhandler(const char *name, driver_filter_t *filt,
  83     void (*hand)(void*), void *arg, int irq, int flags, void **cookiep)
  84 {
  85         struct intr_event *event;
  86         int error;
  87
  88         if (irq < 0 || irq >= NIRQ)
  89                 return;
  90         event = intr_events[irq];
  91         if (event == NULL) {
  92 #ifdef INTR_FILTER
  93                 error = intr_event_create(&event, (void *)irq, 0,
  94                     (void (*)(void *))arm_unmask_irq, intr_eoi_src,
  95                     intr_disab_eoi_src, NULL, "intr%d:", irq);
  96 #else
  97                 error = intr_event_create(&event, (void *)irq, 0,
  98                     (void (*)(void *))arm_unmask_irq, NULL, "intr%d:", irq);
  99 #endif
 100                 if (error)
 101                         return;
 102                 intr_events[irq] = event;
 103                 last_printed +=
 104                     snprintf(intrnames + last_printed,
 105                     MAXCOMLEN + 1,
 106                     "irq%d: %s", irq, name);
 107                 last_printed++;
 108                 intrcnt_tab[irq] = intrcnt_index;
 109                 intrcnt_index++;
 110
 111         }
 112         intr_event_add_handler(event, name, filt, hand, arg,
 113             intr_priority(flags), flags, cookiep);
 114 }
 115
 116 int
 117 arm_remove_irqhandler(void *cookie)
 118 {
 119         return (intr_event_remove_handler(cookie));
 120 }
 121
 122 void dosoftints(void);
 123 void
 124 dosoftints(void)
 125 {
 126 }
 127
 128 void
 129 arm_handler_execute(struct trapframe *frame, int irqnb)
 130 {
 131         struct intr_event *event;
 132         struct thread *td = curthread;
 133 #ifdef INTR_FILTER
 134         int i;
 135 #else
 136         int i, thread, ret;
 137         struct intr_handler *ih;
 138 #endif
 139
 140         PCPU_INC(cnt.v_intr);
 141         td->td_intr_nesting_level++;
 142         while ((i = arm_get_next_irq()) != -1) {
 143 #ifndef INTR_FILTER
 144                 arm_mask_irq(i);
 145 #endif
 146                 intrcnt[intrcnt_tab[i]]++;
 147                 event = intr_events[i];
 148                 if (!event || TAILQ_EMPTY(&event->ie_handlers)) {
 149 #ifdef INTR_FILTER
 150                         arm_mask_irq(i);
 151 #endif
 152                         continue;
 153                 }
 154
 155 #ifdef INTR_FILTER
 156                 intr_event_handle(event, frame);
 157                 /* XXX: Log stray IRQs */
 158 #else
 159                 /* Execute fast handlers. */
 160                 ret = 0;
 161                 thread = 0;
 162                 TAILQ_FOREACH(ih, &event->ie_handlers, ih_next) {
 163                         if (ih->ih_filter == NULL)
 164                                 thread = 1;
 165                         else
 166                                 ret = ih->ih_filter(ih->ih_argument ?
 167                                     ih->ih_argument : frame);
 168                         /*
 169                          * Wrapper handler special case: see
 170                          * i386/intr_machdep.c::intr_execute_handlers()
 171                          */
 172                         if (!thread) {
 173                                 if (ret == FILTER_SCHEDULE_THREAD)
 174                                         thread = 1;
 175                         }
 176                 }
 177
 178                 /* Schedule thread if needed. */
 179                 if (thread)
 180                         intr_event_schedule_thread(event);
 181                 else
 182                         arm_unmask_irq(i);
 183 #endif
 184         }
 185         td->td_intr_nesting_level--;
 186 }