]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/arm/arm/intr.c
Merge from vendor/ntp/dist: r182856:
[FreeBSD/FreeBSD.git] / 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 typedef void (*mask_fn)(void *);
54
55 static struct intr_event *intr_events[NIRQ];
56 static int intrcnt_tab[NIRQ];
57 static int intrcnt_index = 0;
58 static int last_printed = 0;
59
60 void    arm_handler_execute(struct trapframe *, int);
61
62 void (*arm_post_filter)(void *) = NULL;
63
64 void
65 arm_setup_irqhandler(const char *name, driver_filter_t *filt, 
66     void (*hand)(void*), void *arg, int irq, int flags, void **cookiep)
67 {
68         struct intr_event *event;
69         int error;
70
71         if (irq < 0 || irq >= NIRQ)
72                 return;
73         event = intr_events[irq];
74         if (event == NULL) {
75                 error = intr_event_create(&event, (void *)irq, 0, irq,
76                     (mask_fn)arm_mask_irq, (mask_fn)arm_unmask_irq,
77                     arm_post_filter, NULL, "intr%d:", irq);
78                 if (error)
79                         return;
80                 intr_events[irq] = event;
81                 last_printed += 
82                     snprintf(intrnames + last_printed,
83                     MAXCOMLEN + 1,
84                     "irq%d: %s", irq, name);
85                 last_printed++;
86                 intrcnt_tab[irq] = intrcnt_index;
87                 intrcnt_index++;
88                 
89         }
90         intr_event_add_handler(event, name, filt, hand, arg,
91             intr_priority(flags), flags, cookiep);
92 }
93
94 int
95 arm_remove_irqhandler(void *cookie)
96 {
97         return (intr_event_remove_handler(cookie));
98 }
99
100 void dosoftints(void);
101 void
102 dosoftints(void)
103 {
104 }
105
106 void
107 arm_handler_execute(struct trapframe *frame, int irqnb)
108 {
109         struct intr_event *event;
110         int i;
111
112         PCPU_INC(cnt.v_intr);
113         while ((i = arm_get_next_irq()) != -1) {
114                 intrcnt[intrcnt_tab[i]]++;
115                 event = intr_events[i];
116                 if (intr_event_handle(event, frame) != 0) {
117                         /* XXX: Log stray IRQs */
118                         arm_mask_irq(i);
119                 }
120         }
121 }