gicv3.c revision 1.4 1 1.4 jmcneill /* $NetBSD: gicv3.c,v 1.4 2018/11/05 11:50:15 jmcneill Exp $ */
2 1.1 jmcneill
3 1.1 jmcneill /*-
4 1.1 jmcneill * Copyright (c) 2018 Jared McNeill <jmcneill (at) invisible.ca>
5 1.1 jmcneill * All rights reserved.
6 1.1 jmcneill *
7 1.1 jmcneill * Redistribution and use in source and binary forms, with or without
8 1.1 jmcneill * modification, are permitted provided that the following conditions
9 1.1 jmcneill * are met:
10 1.1 jmcneill * 1. Redistributions of source code must retain the above copyright
11 1.1 jmcneill * notice, this list of conditions and the following disclaimer.
12 1.1 jmcneill * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 jmcneill * notice, this list of conditions and the following disclaimer in the
14 1.1 jmcneill * documentation and/or other materials provided with the distribution.
15 1.1 jmcneill *
16 1.1 jmcneill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1 jmcneill * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1 jmcneill * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1 jmcneill * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1 jmcneill * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 1.1 jmcneill * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 1.1 jmcneill * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 1.1 jmcneill * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 1.1 jmcneill * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 jmcneill * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 jmcneill * SUCH DAMAGE.
27 1.1 jmcneill */
28 1.1 jmcneill
29 1.1 jmcneill #include "opt_multiprocessor.h"
30 1.1 jmcneill
31 1.1 jmcneill #define _INTR_PRIVATE
32 1.1 jmcneill
33 1.1 jmcneill #include <sys/cdefs.h>
34 1.4 jmcneill __KERNEL_RCSID(0, "$NetBSD: gicv3.c,v 1.4 2018/11/05 11:50:15 jmcneill Exp $");
35 1.1 jmcneill
36 1.1 jmcneill #include <sys/param.h>
37 1.1 jmcneill #include <sys/kernel.h>
38 1.1 jmcneill #include <sys/bus.h>
39 1.1 jmcneill #include <sys/device.h>
40 1.1 jmcneill #include <sys/intr.h>
41 1.1 jmcneill #include <sys/systm.h>
42 1.1 jmcneill #include <sys/cpu.h>
43 1.1 jmcneill
44 1.1 jmcneill #include <arm/locore.h>
45 1.1 jmcneill #include <arm/armreg.h>
46 1.1 jmcneill
47 1.1 jmcneill #include <arm/cortex/gicv3.h>
48 1.1 jmcneill #include <arm/cortex/gic_reg.h>
49 1.1 jmcneill
50 1.1 jmcneill #define PICTOSOFTC(pic) \
51 1.1 jmcneill ((void *)((uintptr_t)(pic) - offsetof(struct gicv3_softc, sc_pic)))
52 1.1 jmcneill
53 1.4 jmcneill #define IPL_TO_PRIORITY(ipl) ((IPL_HIGH - (ipl)) << 4)
54 1.1 jmcneill
55 1.1 jmcneill static struct gicv3_softc *gicv3_softc;
56 1.1 jmcneill
57 1.1 jmcneill static inline uint32_t
58 1.1 jmcneill gicd_read_4(struct gicv3_softc *sc, bus_size_t reg)
59 1.1 jmcneill {
60 1.1 jmcneill return bus_space_read_4(sc->sc_bst, sc->sc_bsh_d, reg);
61 1.1 jmcneill }
62 1.1 jmcneill
63 1.1 jmcneill static inline void
64 1.1 jmcneill gicd_write_4(struct gicv3_softc *sc, bus_size_t reg, uint32_t val)
65 1.1 jmcneill {
66 1.1 jmcneill bus_space_write_4(sc->sc_bst, sc->sc_bsh_d, reg, val);
67 1.1 jmcneill }
68 1.1 jmcneill
69 1.1 jmcneill static inline void
70 1.1 jmcneill gicd_write_8(struct gicv3_softc *sc, bus_size_t reg, uint64_t val)
71 1.1 jmcneill {
72 1.1 jmcneill bus_space_write_8(sc->sc_bst, sc->sc_bsh_d, reg, val);
73 1.1 jmcneill }
74 1.1 jmcneill
75 1.1 jmcneill static inline uint32_t
76 1.1 jmcneill gicr_read_4(struct gicv3_softc *sc, u_int index, bus_size_t reg)
77 1.1 jmcneill {
78 1.1 jmcneill KASSERT(index < sc->sc_bsh_r_count);
79 1.1 jmcneill return bus_space_read_4(sc->sc_bst, sc->sc_bsh_r[index], reg);
80 1.1 jmcneill }
81 1.1 jmcneill
82 1.1 jmcneill static inline void
83 1.1 jmcneill gicr_write_4(struct gicv3_softc *sc, u_int index, bus_size_t reg, uint32_t val)
84 1.1 jmcneill {
85 1.1 jmcneill KASSERT(index < sc->sc_bsh_r_count);
86 1.1 jmcneill bus_space_write_4(sc->sc_bst, sc->sc_bsh_r[index], reg, val);
87 1.1 jmcneill }
88 1.1 jmcneill
89 1.1 jmcneill static inline uint64_t
90 1.1 jmcneill gicr_read_8(struct gicv3_softc *sc, u_int index, bus_size_t reg)
91 1.1 jmcneill {
92 1.1 jmcneill KASSERT(index < sc->sc_bsh_r_count);
93 1.1 jmcneill return bus_space_read_8(sc->sc_bst, sc->sc_bsh_r[index], reg);
94 1.1 jmcneill }
95 1.1 jmcneill
96 1.1 jmcneill static inline void
97 1.1 jmcneill gicr_write_8(struct gicv3_softc *sc, u_int index, bus_size_t reg, uint64_t val)
98 1.1 jmcneill {
99 1.1 jmcneill KASSERT(index < sc->sc_bsh_r_count);
100 1.1 jmcneill bus_space_write_8(sc->sc_bst, sc->sc_bsh_r[index], reg, val);
101 1.1 jmcneill }
102 1.1 jmcneill
103 1.1 jmcneill static void
104 1.1 jmcneill gicv3_unblock_irqs(struct pic_softc *pic, size_t irqbase, uint32_t mask)
105 1.1 jmcneill {
106 1.1 jmcneill struct gicv3_softc * const sc = PICTOSOFTC(pic);
107 1.1 jmcneill struct cpu_info * const ci = curcpu();
108 1.1 jmcneill const u_int group = irqbase / 32;
109 1.1 jmcneill
110 1.1 jmcneill if (group == 0) {
111 1.1 jmcneill sc->sc_enabled_sgippi |= mask;
112 1.1 jmcneill gicr_write_4(sc, ci->ci_gic_redist, GICR_ISENABLER0, mask);
113 1.1 jmcneill while (gicr_read_4(sc, ci->ci_gic_redist, GICR_CTRL) & GICR_CTRL_RWP)
114 1.1 jmcneill ;
115 1.1 jmcneill } else {
116 1.1 jmcneill gicd_write_4(sc, GICD_ISENABLERn(group), mask);
117 1.1 jmcneill while (gicd_read_4(sc, GICD_CTRL) & GICD_CTRL_RWP)
118 1.1 jmcneill ;
119 1.1 jmcneill }
120 1.1 jmcneill }
121 1.1 jmcneill
122 1.1 jmcneill static void
123 1.1 jmcneill gicv3_block_irqs(struct pic_softc *pic, size_t irqbase, uint32_t mask)
124 1.1 jmcneill {
125 1.1 jmcneill struct gicv3_softc * const sc = PICTOSOFTC(pic);
126 1.1 jmcneill struct cpu_info * const ci = curcpu();
127 1.1 jmcneill const u_int group = irqbase / 32;
128 1.1 jmcneill
129 1.1 jmcneill if (group == 0) {
130 1.1 jmcneill sc->sc_enabled_sgippi &= ~mask;
131 1.1 jmcneill gicr_write_4(sc, ci->ci_gic_redist, GICR_ICENABLER0, mask);
132 1.1 jmcneill while (gicr_read_4(sc, ci->ci_gic_redist, GICR_CTRL) & GICR_CTRL_RWP)
133 1.1 jmcneill ;
134 1.1 jmcneill } else {
135 1.1 jmcneill gicd_write_4(sc, GICD_ICENABLERn(group), mask);
136 1.1 jmcneill while (gicd_read_4(sc, GICD_CTRL) & GICD_CTRL_RWP)
137 1.1 jmcneill ;
138 1.1 jmcneill }
139 1.1 jmcneill }
140 1.1 jmcneill
141 1.1 jmcneill static void
142 1.1 jmcneill gicv3_establish_irq(struct pic_softc *pic, struct intrsource *is)
143 1.1 jmcneill {
144 1.1 jmcneill struct gicv3_softc * const sc = PICTOSOFTC(pic);
145 1.1 jmcneill const u_int group = is->is_irq / 32;
146 1.1 jmcneill uint32_t ipriority, icfg;
147 1.1 jmcneill uint64_t irouter;
148 1.1 jmcneill u_int n;
149 1.1 jmcneill
150 1.4 jmcneill const u_int ipriority_val = 0x80 | IPL_TO_PRIORITY(is->is_ipl);
151 1.1 jmcneill const u_int ipriority_shift = (is->is_irq & 0x3) * 8;
152 1.1 jmcneill const u_int icfg_shift = (is->is_irq & 0xf) * 2;
153 1.1 jmcneill
154 1.1 jmcneill if (group == 0) {
155 1.1 jmcneill /* SGIs and PPIs are always MP-safe */
156 1.1 jmcneill is->is_mpsafe = true;
157 1.1 jmcneill
158 1.1 jmcneill /* Update interrupt configuration and priority on all redistributors */
159 1.1 jmcneill for (n = 0; n < sc->sc_bsh_r_count; n++) {
160 1.1 jmcneill icfg = gicr_read_4(sc, n, GICR_ICFGRn(is->is_irq / 16));
161 1.1 jmcneill if (is->is_type == IST_LEVEL)
162 1.1 jmcneill icfg &= ~(0x2 << icfg_shift);
163 1.1 jmcneill if (is->is_type == IST_EDGE)
164 1.1 jmcneill icfg |= (0x2 << icfg_shift);
165 1.1 jmcneill gicr_write_4(sc, n, GICR_ICFGRn(is->is_irq / 16), icfg);
166 1.1 jmcneill
167 1.1 jmcneill ipriority = gicr_read_4(sc, n, GICR_IPRIORITYRn(is->is_irq / 4));
168 1.1 jmcneill ipriority &= ~(0xff << ipriority_shift);
169 1.2 jmcneill ipriority |= (ipriority_val << ipriority_shift);
170 1.1 jmcneill gicr_write_4(sc, n, GICR_IPRIORITYRn(is->is_irq / 4), ipriority);
171 1.1 jmcneill }
172 1.1 jmcneill } else {
173 1.1 jmcneill if (is->is_mpsafe) {
174 1.1 jmcneill /* Route MP-safe interrupts to all participating PEs */
175 1.1 jmcneill irouter = GICD_IROUTER_Interrupt_Routing_mode;
176 1.1 jmcneill } else {
177 1.1 jmcneill /* Route non-MP-safe interrupts to the primary PE only */
178 1.1 jmcneill irouter = sc->sc_default_irouter;
179 1.1 jmcneill }
180 1.1 jmcneill gicd_write_8(sc, GICD_IROUTER(is->is_irq), irouter);
181 1.1 jmcneill
182 1.1 jmcneill /* Update interrupt configuration */
183 1.1 jmcneill icfg = gicd_read_4(sc, GICD_ICFGRn(is->is_irq / 16));
184 1.1 jmcneill if (is->is_type == IST_LEVEL)
185 1.1 jmcneill icfg &= ~(0x2 << icfg_shift);
186 1.1 jmcneill if (is->is_type == IST_EDGE)
187 1.1 jmcneill icfg |= (0x2 << icfg_shift);
188 1.1 jmcneill gicd_write_4(sc, GICD_ICFGRn(is->is_irq / 16), icfg);
189 1.1 jmcneill
190 1.1 jmcneill /* Update interrupt priority */
191 1.1 jmcneill ipriority = gicd_read_4(sc, GICD_IPRIORITYRn(is->is_irq / 4));
192 1.1 jmcneill ipriority &= ~(0xff << ipriority_shift);
193 1.2 jmcneill ipriority |= (ipriority_val << ipriority_shift);
194 1.1 jmcneill gicd_write_4(sc, GICD_IPRIORITYRn(is->is_irq / 4), ipriority);
195 1.1 jmcneill }
196 1.1 jmcneill }
197 1.1 jmcneill
198 1.1 jmcneill static void
199 1.1 jmcneill gicv3_set_priority(struct pic_softc *pic, int ipl)
200 1.1 jmcneill {
201 1.4 jmcneill icc_pmr_write(IPL_TO_PRIORITY(ipl) << 1);
202 1.1 jmcneill }
203 1.1 jmcneill
204 1.1 jmcneill static void
205 1.1 jmcneill gicv3_dist_enable(struct gicv3_softc *sc)
206 1.1 jmcneill {
207 1.1 jmcneill uint32_t gicd_ctrl;
208 1.1 jmcneill u_int n;
209 1.1 jmcneill
210 1.1 jmcneill /* Disable the distributor */
211 1.1 jmcneill gicd_write_4(sc, GICD_CTRL, 0);
212 1.1 jmcneill
213 1.1 jmcneill /* Wait for register write to complete */
214 1.1 jmcneill while (gicd_read_4(sc, GICD_CTRL) & GICD_CTRL_RWP)
215 1.1 jmcneill ;
216 1.1 jmcneill
217 1.1 jmcneill /* Clear all INTID enable bits */
218 1.1 jmcneill for (n = 32; n < sc->sc_pic.pic_maxsources; n += 32)
219 1.1 jmcneill gicd_write_4(sc, GICD_ICENABLERn(n / 32), ~0);
220 1.1 jmcneill
221 1.1 jmcneill /* Set default priorities to lowest */
222 1.1 jmcneill for (n = 32; n < sc->sc_pic.pic_maxsources; n += 4)
223 1.1 jmcneill gicd_write_4(sc, GICD_IPRIORITYRn(n / 4), ~0);
224 1.1 jmcneill
225 1.1 jmcneill /* Set all interrupts to G1NS */
226 1.1 jmcneill for (n = 32; n < sc->sc_pic.pic_maxsources; n += 32) {
227 1.1 jmcneill gicd_write_4(sc, GICD_IGROUPRn(n / 32), ~0);
228 1.1 jmcneill gicd_write_4(sc, GICD_IGRPMODRn(n / 32), 0);
229 1.1 jmcneill }
230 1.1 jmcneill
231 1.1 jmcneill /* Set all interrupts level-sensitive by default */
232 1.1 jmcneill for (n = 32; n < sc->sc_pic.pic_maxsources; n += 16)
233 1.1 jmcneill gicd_write_4(sc, GICD_ICFGRn(n / 16), 0);
234 1.1 jmcneill
235 1.1 jmcneill /* Wait for register writes to complete */
236 1.1 jmcneill while (gicd_read_4(sc, GICD_CTRL) & GICD_CTRL_RWP)
237 1.1 jmcneill ;
238 1.1 jmcneill
239 1.1 jmcneill /* Enable Affinity routing and G1NS interrupts */
240 1.1 jmcneill gicd_ctrl = GICD_CTRL_EnableGrp1NS | GICD_CTRL_Enable | GICD_CTRL_ARE_NS;
241 1.1 jmcneill gicd_write_4(sc, GICD_CTRL, gicd_ctrl);
242 1.1 jmcneill }
243 1.1 jmcneill
244 1.1 jmcneill static void
245 1.1 jmcneill gicv3_redist_enable(struct gicv3_softc *sc, struct cpu_info *ci)
246 1.1 jmcneill {
247 1.1 jmcneill uint32_t icfg;
248 1.1 jmcneill u_int n, o;
249 1.1 jmcneill
250 1.1 jmcneill /* Clear INTID enable bits */
251 1.1 jmcneill gicr_write_4(sc, ci->ci_gic_redist, GICR_ICENABLER0, ~0);
252 1.1 jmcneill
253 1.1 jmcneill /* Wait for register write to complete */
254 1.1 jmcneill while (gicr_read_4(sc, ci->ci_gic_redist, GICR_CTRL) & GICR_CTRL_RWP)
255 1.1 jmcneill ;
256 1.1 jmcneill
257 1.1 jmcneill /* Set default priorities */
258 1.1 jmcneill for (n = 0; n < 32; n += 4) {
259 1.1 jmcneill uint32_t priority = 0;
260 1.1 jmcneill size_t byte_shift = 0;
261 1.1 jmcneill for (o = 0; o < 4; o++, byte_shift += 8) {
262 1.1 jmcneill struct intrsource * const is = sc->sc_pic.pic_sources[n + o];
263 1.1 jmcneill if (is == NULL)
264 1.1 jmcneill priority |= 0xff << byte_shift;
265 1.2 jmcneill else {
266 1.2 jmcneill const u_int ipriority_val = 0x80 | IPL_TO_PRIORITY(is->is_ipl);
267 1.2 jmcneill priority |= ipriority_val << byte_shift;
268 1.2 jmcneill }
269 1.1 jmcneill }
270 1.1 jmcneill gicr_write_4(sc, ci->ci_gic_redist, GICR_IPRIORITYRn(n / 4), priority);
271 1.1 jmcneill }
272 1.1 jmcneill
273 1.1 jmcneill /* Set all interrupts to G1NS */
274 1.1 jmcneill gicr_write_4(sc, ci->ci_gic_redist, GICR_IGROUPR0, ~0);
275 1.1 jmcneill gicr_write_4(sc, ci->ci_gic_redist, GICR_IGRPMODR0, 0);
276 1.1 jmcneill
277 1.1 jmcneill /* Restore PPI configs */
278 1.1 jmcneill for (n = 0, icfg = 0; n < 16; n++) {
279 1.1 jmcneill struct intrsource * const is = sc->sc_pic.pic_sources[16 + n];
280 1.1 jmcneill if (is != NULL && is->is_type == IST_EDGE)
281 1.1 jmcneill icfg |= (0x2 << (n * 2));
282 1.1 jmcneill }
283 1.1 jmcneill gicr_write_4(sc, ci->ci_gic_redist, GICR_ICFGRn(1), icfg);
284 1.1 jmcneill
285 1.1 jmcneill /* Restore current enable bits */
286 1.1 jmcneill gicr_write_4(sc, ci->ci_gic_redist, GICR_ISENABLER0, sc->sc_enabled_sgippi);
287 1.1 jmcneill
288 1.1 jmcneill /* Wait for register write to complete */
289 1.1 jmcneill while (gicr_read_4(sc, ci->ci_gic_redist, GICR_CTRL) & GICR_CTRL_RWP)
290 1.1 jmcneill ;
291 1.1 jmcneill }
292 1.1 jmcneill
293 1.1 jmcneill static uint64_t
294 1.1 jmcneill gicv3_cpu_identity(void)
295 1.1 jmcneill {
296 1.1 jmcneill u_int aff3, aff2, aff1, aff0;
297 1.1 jmcneill
298 1.1 jmcneill #ifdef __aarch64__
299 1.1 jmcneill const register_t mpidr = reg_mpidr_el1_read();
300 1.1 jmcneill aff0 = __SHIFTOUT(mpidr, MPIDR_AFF0);
301 1.1 jmcneill aff1 = __SHIFTOUT(mpidr, MPIDR_AFF1);
302 1.1 jmcneill aff2 = __SHIFTOUT(mpidr, MPIDR_AFF2);
303 1.1 jmcneill aff3 = __SHIFTOUT(mpidr, MPIDR_AFF3);
304 1.1 jmcneill #else
305 1.1 jmcneill const register_t mpidr = armreg_mpidr_read();
306 1.1 jmcneill aff0 = __SHIFTOUT(mpidr, MPIDR_AFF0);
307 1.1 jmcneill aff1 = __SHIFTOUT(mpidr, MPIDR_AFF1);
308 1.1 jmcneill aff2 = __SHIFTOUT(mpidr, MPIDR_AFF2);
309 1.1 jmcneill aff3 = 0;
310 1.1 jmcneill #endif
311 1.1 jmcneill
312 1.1 jmcneill return __SHIFTIN(aff0, GICR_TYPER_Affinity_Value_Aff0) |
313 1.1 jmcneill __SHIFTIN(aff1, GICR_TYPER_Affinity_Value_Aff1) |
314 1.1 jmcneill __SHIFTIN(aff2, GICR_TYPER_Affinity_Value_Aff2) |
315 1.1 jmcneill __SHIFTIN(aff3, GICR_TYPER_Affinity_Value_Aff3);
316 1.1 jmcneill }
317 1.1 jmcneill
318 1.1 jmcneill static u_int
319 1.1 jmcneill gicv3_find_redist(struct gicv3_softc *sc)
320 1.1 jmcneill {
321 1.1 jmcneill uint64_t gicr_typer;
322 1.1 jmcneill u_int n;
323 1.1 jmcneill
324 1.1 jmcneill const uint64_t cpu_identity = gicv3_cpu_identity();
325 1.1 jmcneill
326 1.1 jmcneill for (n = 0; n < sc->sc_bsh_r_count; n++) {
327 1.1 jmcneill gicr_typer = gicr_read_8(sc, n, GICR_TYPER);
328 1.1 jmcneill if ((gicr_typer & GICR_TYPER_Affinity_Value) == cpu_identity)
329 1.1 jmcneill return n;
330 1.1 jmcneill }
331 1.1 jmcneill
332 1.1 jmcneill const u_int aff0 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff0);
333 1.1 jmcneill const u_int aff1 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff1);
334 1.1 jmcneill const u_int aff2 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff2);
335 1.1 jmcneill const u_int aff3 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff3);
336 1.1 jmcneill
337 1.1 jmcneill panic("%s: could not find GICv3 redistributor for cpu %d.%d.%d.%d",
338 1.1 jmcneill cpu_name(curcpu()), aff3, aff2, aff1, aff0);
339 1.1 jmcneill }
340 1.1 jmcneill
341 1.1 jmcneill static uint64_t
342 1.1 jmcneill gicv3_sgir(struct gicv3_softc *sc)
343 1.1 jmcneill {
344 1.1 jmcneill const uint64_t cpu_identity = gicv3_cpu_identity();
345 1.1 jmcneill
346 1.1 jmcneill const u_int aff0 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff0);
347 1.1 jmcneill const u_int aff1 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff1);
348 1.1 jmcneill const u_int aff2 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff2);
349 1.1 jmcneill const u_int aff3 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff3);
350 1.1 jmcneill
351 1.1 jmcneill return __SHIFTIN(__BIT(aff0), ICC_SGIR_EL1_TargetList) |
352 1.1 jmcneill __SHIFTIN(aff1, ICC_SGIR_EL1_Aff1) |
353 1.1 jmcneill __SHIFTIN(aff2, ICC_SGIR_EL1_Aff2) |
354 1.1 jmcneill __SHIFTIN(aff3, ICC_SGIR_EL1_Aff3);
355 1.1 jmcneill }
356 1.1 jmcneill
357 1.1 jmcneill static void
358 1.1 jmcneill gicv3_cpu_init(struct pic_softc *pic, struct cpu_info *ci)
359 1.1 jmcneill {
360 1.1 jmcneill struct gicv3_softc * const sc = PICTOSOFTC(pic);
361 1.1 jmcneill uint32_t icc_sre, icc_ctlr, gicr_waker;
362 1.1 jmcneill
363 1.1 jmcneill ci->ci_gic_redist = gicv3_find_redist(sc);
364 1.1 jmcneill ci->ci_gic_sgir = gicv3_sgir(sc);
365 1.1 jmcneill
366 1.1 jmcneill if (CPU_IS_PRIMARY(ci)) {
367 1.1 jmcneill /* Store route to primary CPU for non-MPSAFE SPIs */
368 1.1 jmcneill const uint64_t cpu_identity = gicv3_cpu_identity();
369 1.1 jmcneill const u_int aff0 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff0);
370 1.1 jmcneill const u_int aff1 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff1);
371 1.1 jmcneill const u_int aff2 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff2);
372 1.1 jmcneill const u_int aff3 = __SHIFTOUT(cpu_identity, GICR_TYPER_Affinity_Value_Aff3);
373 1.1 jmcneill sc->sc_default_irouter =
374 1.1 jmcneill __SHIFTIN(aff0, GICD_IROUTER_Aff0) |
375 1.1 jmcneill __SHIFTIN(aff1, GICD_IROUTER_Aff1) |
376 1.1 jmcneill __SHIFTIN(aff2, GICD_IROUTER_Aff2) |
377 1.1 jmcneill __SHIFTIN(aff3, GICD_IROUTER_Aff3);
378 1.1 jmcneill }
379 1.1 jmcneill
380 1.1 jmcneill /* Enable System register access and disable IRQ/FIQ bypass */
381 1.1 jmcneill icc_sre = ICC_SRE_EL1_SRE | ICC_SRE_EL1_DFB | ICC_SRE_EL1_DIB;
382 1.1 jmcneill icc_sre_write(icc_sre);
383 1.1 jmcneill
384 1.1 jmcneill /* Mark the connected PE as being awake */
385 1.1 jmcneill gicr_waker = gicr_read_4(sc, ci->ci_gic_redist, GICR_WAKER);
386 1.1 jmcneill gicr_waker &= ~GICR_WAKER_ProcessorSleep;
387 1.1 jmcneill gicr_write_4(sc, ci->ci_gic_redist, GICR_WAKER, gicr_waker);
388 1.1 jmcneill while (gicr_read_4(sc, ci->ci_gic_redist, GICR_WAKER) & GICR_WAKER_ChildrenAsleep)
389 1.1 jmcneill ;
390 1.1 jmcneill
391 1.1 jmcneill /* Set initial priority mask */
392 1.4 jmcneill gicv3_set_priority(pic, IPL_HIGH);
393 1.1 jmcneill
394 1.1 jmcneill /* Disable preemption */
395 1.1 jmcneill const uint32_t icc_bpr = __SHIFTIN(0x7, ICC_BPR_EL1_BinaryPoint);
396 1.1 jmcneill icc_bpr1_write(icc_bpr);
397 1.1 jmcneill
398 1.1 jmcneill /* Enable group 1 interrupt signaling */
399 1.1 jmcneill icc_igrpen1_write(ICC_IGRPEN_EL1_Enable);
400 1.1 jmcneill
401 1.1 jmcneill /* Set EOI mode */
402 1.1 jmcneill icc_ctlr = icc_ctlr_read();
403 1.1 jmcneill icc_ctlr &= ~ICC_CTLR_EL1_EOImode;
404 1.1 jmcneill icc_ctlr_write(icc_ctlr);
405 1.1 jmcneill
406 1.1 jmcneill /* Enable redistributor */
407 1.1 jmcneill gicv3_redist_enable(sc, ci);
408 1.1 jmcneill
409 1.1 jmcneill /* Allow IRQ exceptions */
410 1.1 jmcneill cpsie(I32_bit);
411 1.1 jmcneill }
412 1.1 jmcneill
413 1.1 jmcneill #ifdef MULTIPROCESSOR
414 1.1 jmcneill static void
415 1.1 jmcneill gicv3_ipi_send(struct pic_softc *pic, const kcpuset_t *kcp, u_long ipi)
416 1.1 jmcneill {
417 1.1 jmcneill CPU_INFO_ITERATOR cii;
418 1.1 jmcneill struct cpu_info *ci;
419 1.1 jmcneill uint64_t intid, aff, targets;
420 1.1 jmcneill
421 1.1 jmcneill intid = __SHIFTIN(ipi, ICC_SGIR_EL1_INTID);
422 1.1 jmcneill if (kcp == NULL) {
423 1.1 jmcneill /* Interrupts routed to all PEs, excluding "self" */
424 1.1 jmcneill if (ncpu == 1)
425 1.1 jmcneill return;
426 1.1 jmcneill icc_sgi1r_write(intid | ICC_SGIR_EL1_IRM);
427 1.1 jmcneill } else {
428 1.1 jmcneill /* Interrupts routed to specific PEs */
429 1.1 jmcneill aff = 0;
430 1.1 jmcneill targets = 0;
431 1.1 jmcneill for (CPU_INFO_FOREACH(cii, ci)) {
432 1.2 jmcneill if (!kcpuset_isset(kcp, cpu_index(ci)))
433 1.2 jmcneill continue;
434 1.1 jmcneill if ((ci->ci_gic_sgir & ICC_SGIR_EL1_Aff) != aff) {
435 1.1 jmcneill if (targets != 0) {
436 1.1 jmcneill icc_sgi1r_write(intid | aff | targets);
437 1.1 jmcneill targets = 0;
438 1.1 jmcneill }
439 1.1 jmcneill aff = (ci->ci_gic_sgir & ICC_SGIR_EL1_Aff);
440 1.1 jmcneill }
441 1.1 jmcneill targets |= (ci->ci_gic_sgir & ICC_SGIR_EL1_TargetList);
442 1.1 jmcneill }
443 1.1 jmcneill if (targets != 0)
444 1.1 jmcneill icc_sgi1r_write(intid | aff | targets);
445 1.1 jmcneill }
446 1.1 jmcneill }
447 1.1 jmcneill #endif
448 1.1 jmcneill
449 1.1 jmcneill static const struct pic_ops gicv3_picops = {
450 1.1 jmcneill .pic_unblock_irqs = gicv3_unblock_irqs,
451 1.1 jmcneill .pic_block_irqs = gicv3_block_irqs,
452 1.1 jmcneill .pic_establish_irq = gicv3_establish_irq,
453 1.1 jmcneill .pic_set_priority = gicv3_set_priority,
454 1.1 jmcneill #ifdef MULTIPROCESSOR
455 1.1 jmcneill .pic_cpu_init = gicv3_cpu_init,
456 1.1 jmcneill .pic_ipi_send = gicv3_ipi_send,
457 1.1 jmcneill #endif
458 1.1 jmcneill };
459 1.1 jmcneill
460 1.1 jmcneill void
461 1.1 jmcneill gicv3_irq_handler(void *frame)
462 1.1 jmcneill {
463 1.1 jmcneill struct cpu_info * const ci = curcpu();
464 1.1 jmcneill struct gicv3_softc * const sc = gicv3_softc;
465 1.1 jmcneill const int oldipl = ci->ci_cpl;
466 1.1 jmcneill
467 1.1 jmcneill ci->ci_data.cpu_nintr++;
468 1.1 jmcneill
469 1.1 jmcneill for (;;) {
470 1.1 jmcneill const uint32_t iar = icc_iar1_read();
471 1.1 jmcneill const uint32_t irq = __SHIFTOUT(iar, ICC_IAR_INTID);
472 1.1 jmcneill if (irq == ICC_IAR_INTID_SPURIOUS)
473 1.1 jmcneill break;
474 1.1 jmcneill
475 1.1 jmcneill if (irq >= sc->sc_pic.pic_maxsources)
476 1.1 jmcneill continue;
477 1.1 jmcneill
478 1.1 jmcneill struct intrsource * const is = sc->sc_pic.pic_sources[irq];
479 1.1 jmcneill KASSERT(is != NULL);
480 1.1 jmcneill
481 1.1 jmcneill const int ipl = is->is_ipl;
482 1.2 jmcneill if (ci->ci_cpl < ipl)
483 1.1 jmcneill pic_set_priority(ci, ipl);
484 1.1 jmcneill
485 1.1 jmcneill cpsie(I32_bit);
486 1.1 jmcneill pic_dispatch(is, frame);
487 1.1 jmcneill cpsid(I32_bit);
488 1.1 jmcneill
489 1.1 jmcneill icc_eoi1r_write(iar);
490 1.1 jmcneill }
491 1.1 jmcneill
492 1.1 jmcneill if (ci->ci_cpl != oldipl)
493 1.1 jmcneill pic_set_priority(ci, oldipl);
494 1.1 jmcneill }
495 1.1 jmcneill
496 1.1 jmcneill int
497 1.1 jmcneill gicv3_init(struct gicv3_softc *sc)
498 1.1 jmcneill {
499 1.1 jmcneill const uint32_t gicd_typer = gicd_read_4(sc, GICD_TYPER);
500 1.1 jmcneill
501 1.1 jmcneill KASSERT(CPU_IS_PRIMARY(curcpu()));
502 1.1 jmcneill
503 1.1 jmcneill sc->sc_pic.pic_ops = &gicv3_picops;
504 1.1 jmcneill sc->sc_pic.pic_maxsources = GICD_TYPER_LINES(gicd_typer);
505 1.1 jmcneill snprintf(sc->sc_pic.pic_name, sizeof(sc->sc_pic.pic_name), "gicv3");
506 1.1 jmcneill #ifdef MULTIPROCESSOR
507 1.1 jmcneill sc->sc_pic.pic_cpus = kcpuset_running;
508 1.1 jmcneill #endif
509 1.1 jmcneill pic_add(&sc->sc_pic, 0);
510 1.1 jmcneill
511 1.1 jmcneill KASSERT(gicv3_softc == NULL);
512 1.1 jmcneill gicv3_softc = sc;
513 1.1 jmcneill
514 1.1 jmcneill for (int i = 0; i < sc->sc_bsh_r_count; i++) {
515 1.1 jmcneill const uint64_t gicr_typer = gicr_read_8(sc, i, GICR_TYPER);
516 1.1 jmcneill const u_int aff0 = __SHIFTOUT(gicr_typer, GICR_TYPER_Affinity_Value_Aff0);
517 1.1 jmcneill const u_int aff1 = __SHIFTOUT(gicr_typer, GICR_TYPER_Affinity_Value_Aff1);
518 1.1 jmcneill const u_int aff2 = __SHIFTOUT(gicr_typer, GICR_TYPER_Affinity_Value_Aff2);
519 1.1 jmcneill const u_int aff3 = __SHIFTOUT(gicr_typer, GICR_TYPER_Affinity_Value_Aff3);
520 1.1 jmcneill
521 1.1 jmcneill aprint_debug_dev(sc->sc_dev, "redist %d: cpu %d.%d.%d.%d\n",
522 1.1 jmcneill i, aff3, aff2, aff1, aff0);
523 1.1 jmcneill }
524 1.1 jmcneill
525 1.1 jmcneill gicv3_dist_enable(sc);
526 1.1 jmcneill
527 1.1 jmcneill gicv3_cpu_init(&sc->sc_pic, curcpu());
528 1.1 jmcneill
529 1.1 jmcneill #ifdef __HAVE_PIC_FAST_SOFTINTS
530 1.1 jmcneill intr_establish(SOFTINT_BIO, IPL_SOFTBIO, IST_MPSAFE | IST_EDGE, pic_handle_softint, (void *)SOFTINT_BIO);
531 1.1 jmcneill intr_establish(SOFTINT_CLOCK, IPL_SOFTCLOCK, IST_MPSAFE | IST_EDGE, pic_handle_softint, (void *)SOFTINT_CLOCK);
532 1.1 jmcneill intr_establish(SOFTINT_NET, IPL_SOFTNET, IST_MPSAFE | IST_EDGE, pic_handle_softint, (void *)SOFTINT_NET);
533 1.1 jmcneill intr_establish(SOFTINT_SERIAL, IPL_SOFTSERIAL, IST_MPSAFE | IST_EDGE, pic_handle_softint, (void *)SOFTINT_SERIAL);
534 1.1 jmcneill #endif
535 1.1 jmcneill
536 1.1 jmcneill #ifdef MULTIPROCESSOR
537 1.1 jmcneill intr_establish(IPI_AST, IPL_VM, IST_MPSAFE | IST_EDGE, pic_ipi_ast, (void *)-1);
538 1.1 jmcneill intr_establish(IPI_XCALL, IPL_HIGH, IST_MPSAFE | IST_EDGE, pic_ipi_xcall, (void *)-1);
539 1.1 jmcneill intr_establish(IPI_GENERIC, IPL_HIGH, IST_MPSAFE | IST_EDGE, pic_ipi_generic, (void *)-1);
540 1.1 jmcneill intr_establish(IPI_NOP, IPL_VM, IST_MPSAFE | IST_EDGE, pic_ipi_nop, (void *)-1);
541 1.1 jmcneill intr_establish(IPI_SHOOTDOWN, IPL_SCHED, IST_MPSAFE | IST_EDGE, pic_ipi_shootdown, (void *)-1);
542 1.1 jmcneill #ifdef DDB
543 1.1 jmcneill intr_establish(IPI_DDB, IPL_HIGH, IST_MPSAFE | IST_EDGE, pic_ipi_ddb, NULL);
544 1.1 jmcneill #endif
545 1.1 jmcneill #ifdef __HAVE_PREEMPTION
546 1.1 jmcneill intr_establish(IPI_KPREEMPT, IPL_VM, IST_MPSAFE | IST_EDGE, pic_ipi_kpreempt, (void *)-1);
547 1.1 jmcneill #endif
548 1.1 jmcneill #endif
549 1.1 jmcneill
550 1.1 jmcneill return 0;
551 1.1 jmcneill }
552