mipssim_intr.c revision 1.2 1 1.2 reinoud /* $NetBSD: mipssim_intr.c,v 1.2 2021/02/15 22:39:46 reinoud Exp $ */
2 1.1 simonb
3 1.1 simonb /*-
4 1.1 simonb * Copyright (c) 2014 Michael Lorenz
5 1.1 simonb * All rights reserved.
6 1.1 simonb *
7 1.1 simonb * Redistribution and use in source and binary forms, with or without
8 1.1 simonb * modification, are permitted provided that the following conditions
9 1.1 simonb * are met:
10 1.1 simonb * 1. Redistributions of source code must retain the above copyright
11 1.1 simonb * notice, this list of conditions and the following disclaimer.
12 1.1 simonb * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 simonb * notice, this list of conditions and the following disclaimer in the
14 1.1 simonb * documentation and/or other materials provided with the distribution.
15 1.1 simonb *
16 1.1 simonb * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 1.1 simonb * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.1 simonb * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.1 simonb * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 1.1 simonb * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 1.1 simonb * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 1.1 simonb * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 1.1 simonb * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 1.1 simonb * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 1.1 simonb * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 1.1 simonb * POSSIBILITY OF SUCH DAMAGE.
27 1.1 simonb */
28 1.1 simonb
29 1.1 simonb #include <sys/cdefs.h>
30 1.2 reinoud __KERNEL_RCSID(0, "$NetBSD: mipssim_intr.c,v 1.2 2021/02/15 22:39:46 reinoud Exp $");
31 1.1 simonb
32 1.1 simonb #define __INTR_PRIVATE
33 1.1 simonb
34 1.1 simonb #include <sys/param.h>
35 1.1 simonb #include <sys/cpu.h>
36 1.1 simonb #include <sys/kernel.h>
37 1.1 simonb #include <sys/systm.h>
38 1.2 reinoud #include <sys/kmem.h>
39 1.1 simonb
40 1.1 simonb #include <mips/locore.h>
41 1.1 simonb #include <machine/intr.h>
42 1.1 simonb
43 1.1 simonb /*
44 1.1 simonb * This is a mask of bits to clear in the SR when we go to a
45 1.1 simonb * given hardware interrupt priority level.
46 1.1 simonb */
47 1.1 simonb static const struct ipl_sr_map mipssim_ipl_sr_map = {
48 1.1 simonb .sr_bits = {
49 1.1 simonb [IPL_NONE] = 0,
50 1.1 simonb [IPL_SOFTCLOCK] = MIPS_SOFT_INT_MASK_0,
51 1.1 simonb [IPL_SOFTNET] = MIPS_SOFT_INT_MASK,
52 1.1 simonb [IPL_VM] = MIPS_SOFT_INT_MASK
53 1.2 reinoud | MIPS_INT_MASK_0 | MIPS_INT_MASK_1
54 1.2 reinoud | MIPS_INT_MASK_2,
55 1.1 simonb [IPL_SCHED] = MIPS_SOFT_INT_MASK
56 1.2 reinoud | MIPS_INT_MASK_0 | MIPS_INT_MASK_1
57 1.2 reinoud | MIPS_INT_MASK_2 | MIPS_INT_MASK_5,
58 1.1 simonb [IPL_DDB] = MIPS_INT_MASK,
59 1.1 simonb [IPL_HIGH] = MIPS_INT_MASK,
60 1.1 simonb },
61 1.1 simonb };
62 1.1 simonb
63 1.1 simonb /* XXX - add evcnt bits to <machine/intr.h> struct evbmips_intrhand */
64 1.1 simonb struct intrhand {
65 1.1 simonb LIST_ENTRY(intrhand) ih_q;
66 1.1 simonb int (*ih_func)(void *);
67 1.1 simonb void *ih_arg;
68 1.1 simonb int ih_irq;
69 1.1 simonb };
70 1.1 simonb
71 1.1 simonb
72 1.1 simonb /*
73 1.1 simonb * Use CPU interrupts INT0 .. INT4. Clock interrupts (INT5)
74 1.1 simonb * are handled in cpu_intr() before evbmips_iointr() is called.
75 1.1 simonb */
76 1.1 simonb #define NINTR 5 /* MIPS INT0 - INT4 */
77 1.1 simonb
78 1.2 reinoud LIST_HEAD(intrlist, intrhand) intrs[NINTR];
79 1.2 reinoud struct evcnt ih_count[NINTR];
80 1.2 reinoud
81 1.1 simonb const char * const intrnames[NINTR] = {
82 1.1 simonb "int 0 (mipsnet)",
83 1.2 reinoud "int 1 (virtio)",
84 1.1 simonb "int 2 (uart)",
85 1.1 simonb "int 3 (unused)",
86 1.1 simonb "int 4 (unused)",
87 1.1 simonb };
88 1.1 simonb
89 1.1 simonb void mipssim_irq(int);
90 1.1 simonb
91 1.1 simonb void
92 1.1 simonb evbmips_intr_init(void)
93 1.1 simonb {
94 1.1 simonb int i;
95 1.1 simonb
96 1.1 simonb ipl_sr_map = mipssim_ipl_sr_map;
97 1.1 simonb
98 1.1 simonb /* zero all handlers */
99 1.1 simonb for (i = 0; i < NINTR; i++) {
100 1.2 reinoud LIST_INIT(&intrs[i]);
101 1.2 reinoud evcnt_attach_dynamic(&ih_count[i], EVCNT_TYPE_INTR,
102 1.1 simonb NULL, "cpu", intrnames[i]);
103 1.1 simonb }
104 1.1 simonb }
105 1.1 simonb
106 1.1 simonb void
107 1.1 simonb evbmips_iointr(int ipl, uint32_t ipending, struct clockframe *cf)
108 1.1 simonb {
109 1.2 reinoud struct intrlist *list;
110 1.1 simonb
111 1.1 simonb for (int level = NINTR - 1; level >= 0; level--) {
112 1.1 simonb struct intrhand *ih;
113 1.1 simonb
114 1.1 simonb if ((ipending & (MIPS_INT_MASK_0 << level)) == 0)
115 1.1 simonb continue;
116 1.1 simonb
117 1.2 reinoud ih_count[level].ev_count++;
118 1.2 reinoud list = &intrs[level];
119 1.1 simonb
120 1.2 reinoud LIST_FOREACH(ih, list, ih_q) {
121 1.2 reinoud if (ih->ih_func) {
122 1.2 reinoud (*ih->ih_func)(ih->ih_arg);
123 1.2 reinoud }
124 1.1 simonb }
125 1.1 simonb }
126 1.1 simonb }
127 1.1 simonb
128 1.1 simonb void *
129 1.1 simonb evbmips_intr_establish(int irq, int (*func)(void *), void *arg)
130 1.1 simonb {
131 1.2 reinoud struct intrlist *list;
132 1.1 simonb struct intrhand *ih;
133 1.1 simonb int s;
134 1.1 simonb
135 1.1 simonb if ((irq < 0) || (irq >= NINTR)) {
136 1.1 simonb aprint_error("%s: invalid irq %d\n", __func__, irq);
137 1.1 simonb return NULL;
138 1.1 simonb }
139 1.1 simonb
140 1.2 reinoud list = &intrs[irq];
141 1.2 reinoud ih = kmem_alloc(sizeof(struct intrhand), KM_SLEEP);
142 1.1 simonb
143 1.1 simonb s = splhigh();
144 1.2 reinoud
145 1.1 simonb ih->ih_func = func;
146 1.1 simonb ih->ih_arg = arg;
147 1.2 reinoud ih->ih_irq = irq;
148 1.2 reinoud LIST_INSERT_HEAD(list, ih, ih_q);
149 1.1 simonb
150 1.1 simonb /* now enable the IRQ (nothing to do here?) */
151 1.1 simonb
152 1.1 simonb splx(s);
153 1.1 simonb
154 1.1 simonb return ih;
155 1.1 simonb }
156 1.1 simonb
157 1.1 simonb void
158 1.1 simonb evbmips_intr_disestablish(void *cookie)
159 1.1 simonb {
160 1.1 simonb panic("untested %s", __func__); /* XXX! */
161 1.1 simonb
162 1.1 simonb struct intrhand *ih = cookie;
163 1.1 simonb int s;
164 1.1 simonb
165 1.1 simonb s = splhigh();
166 1.1 simonb
167 1.1 simonb /* now disable the IRQ (nothing to do here?) */
168 1.1 simonb
169 1.1 simonb ih->ih_func = NULL;
170 1.1 simonb ih->ih_arg = NULL;
171 1.2 reinoud LIST_REMOVE(ih, ih_q);
172 1.2 reinoud kmem_free(ih, sizeof(struct intrhand));
173 1.1 simonb
174 1.1 simonb splx(s);
175 1.1 simonb }
176