]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/arm/arm/intr.c
MFV r324145,324147:
[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 "opt_platform.h"
40 #include "opt_hwpmc_hooks.h"
41
42 #include <sys/cdefs.h>
43 __FBSDID("$FreeBSD$");
44
45 #include <sys/param.h>
46 #include <sys/systm.h>
47 #include <sys/syslog.h>
48 #include <sys/kernel.h>
49 #include <sys/malloc.h>
50 #include <sys/proc.h>
51 #include <sys/bus.h>
52 #include <sys/interrupt.h>
53 #include <sys/conf.h>
54 #include <sys/pmc.h>
55 #include <sys/pmckern.h>
56 #include <sys/vmmeter.h>
57
58 #include <machine/atomic.h>
59 #include <machine/bus.h>
60 #include <machine/intr.h>
61 #include <machine/cpu.h>
62
63 #ifdef FDT
64 #include <dev/fdt/fdt_common.h>
65 #include <machine/fdt.h>
66 #endif
67
68 #define INTRNAME_LEN    (MAXCOMLEN + 1)
69
70 typedef void (*mask_fn)(void *);
71
72 static struct intr_event *intr_events[NIRQ];
73
74 void    intr_irq_handler(struct trapframe *);
75
76 void (*arm_post_filter)(void *) = NULL;
77 int (*arm_config_irq)(int irq, enum intr_trigger trig,
78     enum intr_polarity pol) = NULL;
79
80 /* Data for statistics reporting. */
81 u_long intrcnt[NIRQ];
82 char intrnames[(NIRQ * INTRNAME_LEN) + 1];
83 size_t sintrcnt = sizeof(intrcnt);
84 size_t sintrnames = sizeof(intrnames);
85
86 /*
87  * Pre-format intrnames into an array of fixed-size strings containing spaces.
88  * This allows us to avoid the need for an intermediate table of indices into
89  * the names and counts arrays, while still meeting the requirements and
90  * assumptions of vmstat(8) and the kdb "show intrcnt" command, the two
91  * consumers of this data.
92  */
93 static void
94 intr_init(void *unused)
95 {
96         int i;
97
98         for (i = 0; i < NIRQ; ++i) {
99                 snprintf(&intrnames[i * INTRNAME_LEN], INTRNAME_LEN, "%-*s",
100                     INTRNAME_LEN - 1, "");
101         }
102 }
103
104 SYSINIT(intr_init, SI_SUB_INTR, SI_ORDER_FIRST, intr_init, NULL);
105
106 #ifdef FDT
107 int
108 intr_fdt_map_irq(phandle_t iparent, pcell_t *intr, int icells)
109 {
110         fdt_pic_decode_t intr_decode;
111         phandle_t intr_parent;
112         int i, rv, interrupt, trig, pol;
113
114         intr_parent = OF_node_from_xref(iparent);
115         for (i = 0; i < icells; i++)
116                 intr[i] = cpu_to_fdt32(intr[i]);
117
118         for (i = 0; fdt_pic_table[i] != NULL; i++) {
119                 intr_decode = fdt_pic_table[i];
120                 rv = intr_decode(intr_parent, intr, &interrupt, &trig, &pol);
121
122                 if (rv == 0) {
123                         /* This was recognized as our PIC and decoded. */
124                         interrupt = FDT_MAP_IRQ(intr_parent, interrupt);
125                         return (interrupt);
126                 }
127         }
128
129         /* Not in table, so guess */
130         interrupt = FDT_MAP_IRQ(intr_parent, fdt32_to_cpu(intr[0]));
131
132         return (interrupt);
133 }
134 #endif
135
136 void
137 arm_setup_irqhandler(const char *name, driver_filter_t *filt,
138     void (*hand)(void*), void *arg, int irq, int flags, void **cookiep)
139 {
140         struct intr_event *event;
141         int error;
142
143         if (irq < 0 || irq >= NIRQ)
144                 return;
145         event = intr_events[irq];
146         if (event == NULL) {
147                 error = intr_event_create(&event, (void *)irq, 0, irq,
148                     (mask_fn)arm_mask_irq, (mask_fn)arm_unmask_irq,
149                     arm_post_filter, NULL, "intr%d:", irq);
150                 if (error)
151                         return;
152                 intr_events[irq] = event;
153                 snprintf(&intrnames[irq * INTRNAME_LEN], INTRNAME_LEN,
154                     "irq%d: %-*s", irq, INTRNAME_LEN - 1, name);
155         }
156         intr_event_add_handler(event, name, filt, hand, arg,
157             intr_priority(flags), flags, cookiep);
158 }
159
160 int
161 arm_remove_irqhandler(int irq, void *cookie)
162 {
163         struct intr_event *event;
164         int error;
165
166         event = intr_events[irq];
167         arm_mask_irq(irq);
168
169         error = intr_event_remove_handler(cookie);
170
171         if (!TAILQ_EMPTY(&event->ie_handlers))
172                 arm_unmask_irq(irq);
173         return (error);
174 }
175
176 void dosoftints(void);
177 void
178 dosoftints(void)
179 {
180 }
181
182 void
183 intr_irq_handler(struct trapframe *frame)
184 {
185         struct intr_event *event;
186         int i;
187
188         VM_CNT_INC(v_intr);
189         i = -1;
190         while ((i = arm_get_next_irq(i)) != -1) {
191                 intrcnt[i]++;
192                 event = intr_events[i];
193                 if (intr_event_handle(event, frame) != 0) {
194                         /* XXX: Log stray IRQs */
195                         arm_mask_irq(i);
196                 }
197         }
198 #ifdef HWPMC_HOOKS
199         if (pmc_hook && (PCPU_GET(curthread)->td_pflags & TDP_CALLCHAIN))
200                 pmc_hook(PCPU_GET(curthread), PMC_FN_USER_CALLCHAIN, frame);
201 #endif
202 }