0bdf3824685c93b2a5a29a72ad7f66aab019d4d3
[dragonfly.git] / sys / platform / pc32 / apic / ioapic_abi.c
1 /*
2  * Copyright (c) 2005 The DragonFly Project.  All rights reserved.
3  * Copyright (c) 1996, by Steve Passe.  All rights reserved.
4  * Copyright (c) 1991 The Regents of the University of California.
5  * All rights reserved.
6  * 
7  * This code is derived from software contributed to The DragonFly Project
8  * by Matthew Dillon <dillon@backplane.com>
9  *
10  * This code is derived from software contributed to Berkeley by
11  * William Jolitz.
12  * 
13  * Redistribution and use in source and binary forms, with or without
14  * modification, are permitted provided that the following conditions
15  * are met:
16  * 
17  * 1. Redistributions of source code must retain the above copyright
18  *    notice, this list of conditions and the following disclaimer.
19  * 2. Redistributions in binary form must reproduce the above copyright
20  *    notice, this list of conditions and the following disclaimer in
21  *    the documentation and/or other materials provided with the
22  *    distribution.
23  * 3. Neither the name of The DragonFly Project nor the names of its
24  *    contributors may be used to endorse or promote products derived
25  *    from this software without specific, prior written permission.
26  * 
27  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
28  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
29  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
30  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE
31  * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
32  * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING,
33  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
34  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
35  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
36  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
37  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
38  * SUCH DAMAGE.
39  */
40
41 #include <sys/param.h>
42 #include <sys/systm.h>
43 #include <sys/kernel.h>
44 #include <sys/machintr.h>
45 #include <sys/interrupt.h>
46 #include <sys/bus.h>
47 #include <sys/rman.h>
48 #include <sys/thread2.h>
49
50 #include <machine/smp.h>
51 #include <machine/segments.h>
52 #include <machine/md_var.h>
53 #include <machine/intr_machdep.h>
54 #include <machine/globaldata.h>
55 #include <machine/msi_var.h>
56
57 #include <machine_base/isa/isa_intr.h>
58 #include <machine_base/icu/icu.h>
59 #include <machine_base/icu/icu_var.h>
60 #include <machine_base/apic/ioapic.h>
61 #include <machine_base/apic/ioapic_abi.h>
62 #include <machine_base/apic/ioapic_ipl.h>
63 #include <machine_base/apic/apicreg.h>
64
65 #include <dev/acpica5/acpi_sci_var.h>
66
67 #define IOAPIC_HWI_VECTORS      IDT_HWI_VECTORS
68
69 extern inthand_t
70         IDTVEC(ioapic_intr0),
71         IDTVEC(ioapic_intr1),
72         IDTVEC(ioapic_intr2),
73         IDTVEC(ioapic_intr3),
74         IDTVEC(ioapic_intr4),
75         IDTVEC(ioapic_intr5),
76         IDTVEC(ioapic_intr6),
77         IDTVEC(ioapic_intr7),
78         IDTVEC(ioapic_intr8),
79         IDTVEC(ioapic_intr9),
80         IDTVEC(ioapic_intr10),
81         IDTVEC(ioapic_intr11),
82         IDTVEC(ioapic_intr12),
83         IDTVEC(ioapic_intr13),
84         IDTVEC(ioapic_intr14),
85         IDTVEC(ioapic_intr15),
86         IDTVEC(ioapic_intr16),
87         IDTVEC(ioapic_intr17),
88         IDTVEC(ioapic_intr18),
89         IDTVEC(ioapic_intr19),
90         IDTVEC(ioapic_intr20),
91         IDTVEC(ioapic_intr21),
92         IDTVEC(ioapic_intr22),
93         IDTVEC(ioapic_intr23),
94         IDTVEC(ioapic_intr24),
95         IDTVEC(ioapic_intr25),
96         IDTVEC(ioapic_intr26),
97         IDTVEC(ioapic_intr27),
98         IDTVEC(ioapic_intr28),
99         IDTVEC(ioapic_intr29),
100         IDTVEC(ioapic_intr30),
101         IDTVEC(ioapic_intr31),
102         IDTVEC(ioapic_intr32),
103         IDTVEC(ioapic_intr33),
104         IDTVEC(ioapic_intr34),
105         IDTVEC(ioapic_intr35),
106         IDTVEC(ioapic_intr36),
107         IDTVEC(ioapic_intr37),
108         IDTVEC(ioapic_intr38),
109         IDTVEC(ioapic_intr39),
110         IDTVEC(ioapic_intr40),
111         IDTVEC(ioapic_intr41),
112         IDTVEC(ioapic_intr42),
113         IDTVEC(ioapic_intr43),
114         IDTVEC(ioapic_intr44),
115         IDTVEC(ioapic_intr45),
116         IDTVEC(ioapic_intr46),
117         IDTVEC(ioapic_intr47),
118         IDTVEC(ioapic_intr48),
119         IDTVEC(ioapic_intr49),
120         IDTVEC(ioapic_intr50),
121         IDTVEC(ioapic_intr51),
122         IDTVEC(ioapic_intr52),
123         IDTVEC(ioapic_intr53),
124         IDTVEC(ioapic_intr54),
125         IDTVEC(ioapic_intr55),
126         IDTVEC(ioapic_intr56),
127         IDTVEC(ioapic_intr57),
128         IDTVEC(ioapic_intr58),
129         IDTVEC(ioapic_intr59),
130         IDTVEC(ioapic_intr60),
131         IDTVEC(ioapic_intr61),
132         IDTVEC(ioapic_intr62),
133         IDTVEC(ioapic_intr63),
134         IDTVEC(ioapic_intr64),
135         IDTVEC(ioapic_intr65),
136         IDTVEC(ioapic_intr66),
137         IDTVEC(ioapic_intr67),
138         IDTVEC(ioapic_intr68),
139         IDTVEC(ioapic_intr69),
140         IDTVEC(ioapic_intr70),
141         IDTVEC(ioapic_intr71),
142         IDTVEC(ioapic_intr72),
143         IDTVEC(ioapic_intr73),
144         IDTVEC(ioapic_intr74),
145         IDTVEC(ioapic_intr75),
146         IDTVEC(ioapic_intr76),
147         IDTVEC(ioapic_intr77),
148         IDTVEC(ioapic_intr78),
149         IDTVEC(ioapic_intr79),
150         IDTVEC(ioapic_intr80),
151         IDTVEC(ioapic_intr81),
152         IDTVEC(ioapic_intr82),
153         IDTVEC(ioapic_intr83),
154         IDTVEC(ioapic_intr84),
155         IDTVEC(ioapic_intr85),
156         IDTVEC(ioapic_intr86),
157         IDTVEC(ioapic_intr87),
158         IDTVEC(ioapic_intr88),
159         IDTVEC(ioapic_intr89),
160         IDTVEC(ioapic_intr90),
161         IDTVEC(ioapic_intr91),
162         IDTVEC(ioapic_intr92),
163         IDTVEC(ioapic_intr93),
164         IDTVEC(ioapic_intr94),
165         IDTVEC(ioapic_intr95),
166         IDTVEC(ioapic_intr96),
167         IDTVEC(ioapic_intr97),
168         IDTVEC(ioapic_intr98),
169         IDTVEC(ioapic_intr99),
170         IDTVEC(ioapic_intr100),
171         IDTVEC(ioapic_intr101),
172         IDTVEC(ioapic_intr102),
173         IDTVEC(ioapic_intr103),
174         IDTVEC(ioapic_intr104),
175         IDTVEC(ioapic_intr105),
176         IDTVEC(ioapic_intr106),
177         IDTVEC(ioapic_intr107),
178         IDTVEC(ioapic_intr108),
179         IDTVEC(ioapic_intr109),
180         IDTVEC(ioapic_intr110),
181         IDTVEC(ioapic_intr111),
182         IDTVEC(ioapic_intr112),
183         IDTVEC(ioapic_intr113),
184         IDTVEC(ioapic_intr114),
185         IDTVEC(ioapic_intr115),
186         IDTVEC(ioapic_intr116),
187         IDTVEC(ioapic_intr117),
188         IDTVEC(ioapic_intr118),
189         IDTVEC(ioapic_intr119),
190         IDTVEC(ioapic_intr120),
191         IDTVEC(ioapic_intr121),
192         IDTVEC(ioapic_intr122),
193         IDTVEC(ioapic_intr123),
194         IDTVEC(ioapic_intr124),
195         IDTVEC(ioapic_intr125),
196         IDTVEC(ioapic_intr126),
197         IDTVEC(ioapic_intr127),
198         IDTVEC(ioapic_intr128),
199         IDTVEC(ioapic_intr129),
200         IDTVEC(ioapic_intr130),
201         IDTVEC(ioapic_intr131),
202         IDTVEC(ioapic_intr132),
203         IDTVEC(ioapic_intr133),
204         IDTVEC(ioapic_intr134),
205         IDTVEC(ioapic_intr135),
206         IDTVEC(ioapic_intr136),
207         IDTVEC(ioapic_intr137),
208         IDTVEC(ioapic_intr138),
209         IDTVEC(ioapic_intr139),
210         IDTVEC(ioapic_intr140),
211         IDTVEC(ioapic_intr141),
212         IDTVEC(ioapic_intr142),
213         IDTVEC(ioapic_intr143),
214         IDTVEC(ioapic_intr144),
215         IDTVEC(ioapic_intr145),
216         IDTVEC(ioapic_intr146),
217         IDTVEC(ioapic_intr147),
218         IDTVEC(ioapic_intr148),
219         IDTVEC(ioapic_intr149),
220         IDTVEC(ioapic_intr150),
221         IDTVEC(ioapic_intr151),
222         IDTVEC(ioapic_intr152),
223         IDTVEC(ioapic_intr153),
224         IDTVEC(ioapic_intr154),
225         IDTVEC(ioapic_intr155),
226         IDTVEC(ioapic_intr156),
227         IDTVEC(ioapic_intr157),
228         IDTVEC(ioapic_intr158),
229         IDTVEC(ioapic_intr159),
230         IDTVEC(ioapic_intr160),
231         IDTVEC(ioapic_intr161),
232         IDTVEC(ioapic_intr162),
233         IDTVEC(ioapic_intr163),
234         IDTVEC(ioapic_intr164),
235         IDTVEC(ioapic_intr165),
236         IDTVEC(ioapic_intr166),
237         IDTVEC(ioapic_intr167),
238         IDTVEC(ioapic_intr168),
239         IDTVEC(ioapic_intr169),
240         IDTVEC(ioapic_intr170),
241         IDTVEC(ioapic_intr171),
242         IDTVEC(ioapic_intr172),
243         IDTVEC(ioapic_intr173),
244         IDTVEC(ioapic_intr174),
245         IDTVEC(ioapic_intr175),
246         IDTVEC(ioapic_intr176),
247         IDTVEC(ioapic_intr177),
248         IDTVEC(ioapic_intr178),
249         IDTVEC(ioapic_intr179),
250         IDTVEC(ioapic_intr180),
251         IDTVEC(ioapic_intr181),
252         IDTVEC(ioapic_intr182),
253         IDTVEC(ioapic_intr183),
254         IDTVEC(ioapic_intr184),
255         IDTVEC(ioapic_intr185),
256         IDTVEC(ioapic_intr186),
257         IDTVEC(ioapic_intr187),
258         IDTVEC(ioapic_intr188),
259         IDTVEC(ioapic_intr189),
260         IDTVEC(ioapic_intr190),
261         IDTVEC(ioapic_intr191);
262
263 static inthand_t *ioapic_intr[IOAPIC_HWI_VECTORS] = {
264         &IDTVEC(ioapic_intr0),
265         &IDTVEC(ioapic_intr1),
266         &IDTVEC(ioapic_intr2),
267         &IDTVEC(ioapic_intr3),
268         &IDTVEC(ioapic_intr4),
269         &IDTVEC(ioapic_intr5),
270         &IDTVEC(ioapic_intr6),
271         &IDTVEC(ioapic_intr7),
272         &IDTVEC(ioapic_intr8),
273         &IDTVEC(ioapic_intr9),
274         &IDTVEC(ioapic_intr10),
275         &IDTVEC(ioapic_intr11),
276         &IDTVEC(ioapic_intr12),
277         &IDTVEC(ioapic_intr13),
278         &IDTVEC(ioapic_intr14),
279         &IDTVEC(ioapic_intr15),
280         &IDTVEC(ioapic_intr16),
281         &IDTVEC(ioapic_intr17),
282         &IDTVEC(ioapic_intr18),
283         &IDTVEC(ioapic_intr19),
284         &IDTVEC(ioapic_intr20),
285         &IDTVEC(ioapic_intr21),
286         &IDTVEC(ioapic_intr22),
287         &IDTVEC(ioapic_intr23),
288         &IDTVEC(ioapic_intr24),
289         &IDTVEC(ioapic_intr25),
290         &IDTVEC(ioapic_intr26),
291         &IDTVEC(ioapic_intr27),
292         &IDTVEC(ioapic_intr28),
293         &IDTVEC(ioapic_intr29),
294         &IDTVEC(ioapic_intr30),
295         &IDTVEC(ioapic_intr31),
296         &IDTVEC(ioapic_intr32),
297         &IDTVEC(ioapic_intr33),
298         &IDTVEC(ioapic_intr34),
299         &IDTVEC(ioapic_intr35),
300         &IDTVEC(ioapic_intr36),
301         &IDTVEC(ioapic_intr37),
302         &IDTVEC(ioapic_intr38),
303         &IDTVEC(ioapic_intr39),
304         &IDTVEC(ioapic_intr40),
305         &IDTVEC(ioapic_intr41),
306         &IDTVEC(ioapic_intr42),
307         &IDTVEC(ioapic_intr43),
308         &IDTVEC(ioapic_intr44),
309         &IDTVEC(ioapic_intr45),
310         &IDTVEC(ioapic_intr46),
311         &IDTVEC(ioapic_intr47),
312         &IDTVEC(ioapic_intr48),
313         &IDTVEC(ioapic_intr49),
314         &IDTVEC(ioapic_intr50),
315         &IDTVEC(ioapic_intr51),
316         &IDTVEC(ioapic_intr52),
317         &IDTVEC(ioapic_intr53),
318         &IDTVEC(ioapic_intr54),
319         &IDTVEC(ioapic_intr55),
320         &IDTVEC(ioapic_intr56),
321         &IDTVEC(ioapic_intr57),
322         &IDTVEC(ioapic_intr58),
323         &IDTVEC(ioapic_intr59),
324         &IDTVEC(ioapic_intr60),
325         &IDTVEC(ioapic_intr61),
326         &IDTVEC(ioapic_intr62),
327         &IDTVEC(ioapic_intr63),
328         &IDTVEC(ioapic_intr64),
329         &IDTVEC(ioapic_intr65),
330         &IDTVEC(ioapic_intr66),
331         &IDTVEC(ioapic_intr67),
332         &IDTVEC(ioapic_intr68),
333         &IDTVEC(ioapic_intr69),
334         &IDTVEC(ioapic_intr70),
335         &IDTVEC(ioapic_intr71),
336         &IDTVEC(ioapic_intr72),
337         &IDTVEC(ioapic_intr73),
338         &IDTVEC(ioapic_intr74),
339         &IDTVEC(ioapic_intr75),
340         &IDTVEC(ioapic_intr76),
341         &IDTVEC(ioapic_intr77),
342         &IDTVEC(ioapic_intr78),
343         &IDTVEC(ioapic_intr79),
344         &IDTVEC(ioapic_intr80),
345         &IDTVEC(ioapic_intr81),
346         &IDTVEC(ioapic_intr82),
347         &IDTVEC(ioapic_intr83),
348         &IDTVEC(ioapic_intr84),
349         &IDTVEC(ioapic_intr85),
350         &IDTVEC(ioapic_intr86),
351         &IDTVEC(ioapic_intr87),
352         &IDTVEC(ioapic_intr88),
353         &IDTVEC(ioapic_intr89),
354         &IDTVEC(ioapic_intr90),
355         &IDTVEC(ioapic_intr91),
356         &IDTVEC(ioapic_intr92),
357         &IDTVEC(ioapic_intr93),
358         &IDTVEC(ioapic_intr94),
359         &IDTVEC(ioapic_intr95),
360         &IDTVEC(ioapic_intr96),
361         &IDTVEC(ioapic_intr97),
362         &IDTVEC(ioapic_intr98),
363         &IDTVEC(ioapic_intr99),
364         &IDTVEC(ioapic_intr100),
365         &IDTVEC(ioapic_intr101),
366         &IDTVEC(ioapic_intr102),
367         &IDTVEC(ioapic_intr103),
368         &IDTVEC(ioapic_intr104),
369         &IDTVEC(ioapic_intr105),
370         &IDTVEC(ioapic_intr106),
371         &IDTVEC(ioapic_intr107),
372         &IDTVEC(ioapic_intr108),
373         &IDTVEC(ioapic_intr109),
374         &IDTVEC(ioapic_intr110),
375         &IDTVEC(ioapic_intr111),
376         &IDTVEC(ioapic_intr112),
377         &IDTVEC(ioapic_intr113),
378         &IDTVEC(ioapic_intr114),
379         &IDTVEC(ioapic_intr115),
380         &IDTVEC(ioapic_intr116),
381         &IDTVEC(ioapic_intr117),
382         &IDTVEC(ioapic_intr118),
383         &IDTVEC(ioapic_intr119),
384         &IDTVEC(ioapic_intr120),
385         &IDTVEC(ioapic_intr121),
386         &IDTVEC(ioapic_intr122),
387         &IDTVEC(ioapic_intr123),
388         &IDTVEC(ioapic_intr124),
389         &IDTVEC(ioapic_intr125),
390         &IDTVEC(ioapic_intr126),
391         &IDTVEC(ioapic_intr127),
392         &IDTVEC(ioapic_intr128),
393         &IDTVEC(ioapic_intr129),
394         &IDTVEC(ioapic_intr130),
395         &IDTVEC(ioapic_intr131),
396         &IDTVEC(ioapic_intr132),
397         &IDTVEC(ioapic_intr133),
398         &IDTVEC(ioapic_intr134),
399         &IDTVEC(ioapic_intr135),
400         &IDTVEC(ioapic_intr136),
401         &IDTVEC(ioapic_intr137),
402         &IDTVEC(ioapic_intr138),
403         &IDTVEC(ioapic_intr139),
404         &IDTVEC(ioapic_intr140),
405         &IDTVEC(ioapic_intr141),
406         &IDTVEC(ioapic_intr142),
407         &IDTVEC(ioapic_intr143),
408         &IDTVEC(ioapic_intr144),
409         &IDTVEC(ioapic_intr145),
410         &IDTVEC(ioapic_intr146),
411         &IDTVEC(ioapic_intr147),
412         &IDTVEC(ioapic_intr148),
413         &IDTVEC(ioapic_intr149),
414         &IDTVEC(ioapic_intr150),
415         &IDTVEC(ioapic_intr151),
416         &IDTVEC(ioapic_intr152),
417         &IDTVEC(ioapic_intr153),
418         &IDTVEC(ioapic_intr154),
419         &IDTVEC(ioapic_intr155),
420         &IDTVEC(ioapic_intr156),
421         &IDTVEC(ioapic_intr157),
422         &IDTVEC(ioapic_intr158),
423         &IDTVEC(ioapic_intr159),
424         &IDTVEC(ioapic_intr160),
425         &IDTVEC(ioapic_intr161),
426         &IDTVEC(ioapic_intr162),
427         &IDTVEC(ioapic_intr163),
428         &IDTVEC(ioapic_intr164),
429         &IDTVEC(ioapic_intr165),
430         &IDTVEC(ioapic_intr166),
431         &IDTVEC(ioapic_intr167),
432         &IDTVEC(ioapic_intr168),
433         &IDTVEC(ioapic_intr169),
434         &IDTVEC(ioapic_intr170),
435         &IDTVEC(ioapic_intr171),
436         &IDTVEC(ioapic_intr172),
437         &IDTVEC(ioapic_intr173),
438         &IDTVEC(ioapic_intr174),
439         &IDTVEC(ioapic_intr175),
440         &IDTVEC(ioapic_intr176),
441         &IDTVEC(ioapic_intr177),
442         &IDTVEC(ioapic_intr178),
443         &IDTVEC(ioapic_intr179),
444         &IDTVEC(ioapic_intr180),
445         &IDTVEC(ioapic_intr181),
446         &IDTVEC(ioapic_intr182),
447         &IDTVEC(ioapic_intr183),
448         &IDTVEC(ioapic_intr184),
449         &IDTVEC(ioapic_intr185),
450         &IDTVEC(ioapic_intr186),
451         &IDTVEC(ioapic_intr187),
452         &IDTVEC(ioapic_intr188),
453         &IDTVEC(ioapic_intr189),
454         &IDTVEC(ioapic_intr190),
455         &IDTVEC(ioapic_intr191)
456 };
457
458 #define IOAPIC_HWI_SYSCALL      (IDT_OFFSET_SYSCALL - IDT_OFFSET)
459
460 static struct ioapic_irqmap {
461         int                     im_type;        /* IOAPIC_IMT_ */
462         enum intr_trigger       im_trig;
463         enum intr_polarity      im_pola;
464         int                     im_gsi;
465         int                     im_msi_base;
466         uint32_t                im_flags;       /* IOAPIC_IMF_ */
467 } ioapic_irqmaps[MAXCPU][IOAPIC_HWI_VECTORS];
468
469 static struct lwkt_token ioapic_irqmap_tok =
470         LWKT_TOKEN_INITIALIZER(ioapic_irqmap_token);
471
472 #define IOAPIC_IMT_UNUSED       0
473 #define IOAPIC_IMT_RESERVED     1
474 #define IOAPIC_IMT_LEGACY       2
475 #define IOAPIC_IMT_SYSCALL      3
476 #define IOAPIC_IMT_SHADOW       4
477 #define IOAPIC_IMT_MSI          5
478 #define IOAPIC_IMT_MSIX         6
479
480 #define IOAPIC_IMT_ISHWI(map)   ((map)->im_type != IOAPIC_IMT_RESERVED && \
481                                  (map)->im_type != IOAPIC_IMT_SYSCALL && \
482                                  (map)->im_type != IOAPIC_IMT_SHADOW)
483
484 #define IOAPIC_IMF_CONF         0x1
485
486 extern void     IOAPIC_INTREN(int);
487 extern void     IOAPIC_INTRDIS(int);
488
489 extern int      imcr_present;
490
491 static void     ioapic_abi_intr_enable(int);
492 static void     ioapic_abi_intr_disable(int);
493 static void     ioapic_abi_intr_setup(int, int);
494 static void     ioapic_abi_intr_teardown(int);
495
496 static void     ioapic_abi_legacy_intr_config(int,
497                     enum intr_trigger, enum intr_polarity);
498 static int      ioapic_abi_legacy_intr_cpuid(int);
499
500 static int      ioapic_abi_msi_alloc(int [], int, int);
501 static void     ioapic_abi_msi_release(const int [], int, int);
502 static void     ioapic_abi_msi_map(int, uint64_t *, uint32_t *, int);
503 static int      ioapic_abi_msix_alloc(int *, int);
504 static void     ioapic_abi_msix_release(int, int);
505
506 static int      ioapic_abi_msi_alloc_intern(int, const char *,
507                     int [], int, int);
508 static void     ioapic_abi_msi_release_intern(int, const char *,
509                     const int [], int, int);
510
511 static void     ioapic_abi_finalize(void);
512 static void     ioapic_abi_cleanup(void);
513 static void     ioapic_abi_setdefault(void);
514 static void     ioapic_abi_stabilize(void);
515 static void     ioapic_abi_initmap(void);
516 static void     ioapic_abi_rman_setup(struct rman *);
517
518 static int      ioapic_abi_gsi_cpuid(int, int);
519
520 struct machintr_abi MachIntrABI_IOAPIC = {
521         MACHINTR_IOAPIC,
522
523         .intr_disable   = ioapic_abi_intr_disable,
524         .intr_enable    = ioapic_abi_intr_enable,
525         .intr_setup     = ioapic_abi_intr_setup,
526         .intr_teardown  = ioapic_abi_intr_teardown,
527
528         .legacy_intr_config = ioapic_abi_legacy_intr_config,
529         .legacy_intr_cpuid = ioapic_abi_legacy_intr_cpuid,
530
531         .msi_alloc      = ioapic_abi_msi_alloc,
532         .msi_release    = ioapic_abi_msi_release,
533         .msi_map        = ioapic_abi_msi_map,
534         .msix_alloc     = ioapic_abi_msix_alloc,
535         .msix_release   = ioapic_abi_msix_release,
536
537         .finalize       = ioapic_abi_finalize,
538         .cleanup        = ioapic_abi_cleanup,
539         .setdefault     = ioapic_abi_setdefault,
540         .stabilize      = ioapic_abi_stabilize,
541         .initmap        = ioapic_abi_initmap,
542         .rman_setup     = ioapic_abi_rman_setup
543 };
544
545 static int      ioapic_abi_extint_irq = -1;
546 static int      ioapic_abi_legacy_irq_max;
547 static int      ioapic_abi_gsi_balance;
548 static int      ioapic_abi_msi_start;   /* NOTE: for testing only */
549
550 struct ioapic_irqinfo   ioapic_irqs[IOAPIC_HWI_VECTORS];
551
552 static void
553 ioapic_abi_intr_enable(int irq)
554 {
555         const struct ioapic_irqmap *map;
556
557         KASSERT(irq >= 0 && irq < IOAPIC_HWI_VECTORS,
558             ("ioapic enable, invalid irq %d", irq));
559
560         map = &ioapic_irqmaps[mycpuid][irq];
561         KASSERT(IOAPIC_IMT_ISHWI(map),
562             ("ioapic enable, not hwi irq %d, type %d, cpu%d",
563              irq, map->im_type, mycpuid));
564         if (map->im_type != IOAPIC_IMT_LEGACY)
565                 return;
566
567         IOAPIC_INTREN(irq);
568 }
569
570 static void
571 ioapic_abi_intr_disable(int irq)
572 {
573         const struct ioapic_irqmap *map;
574
575         KASSERT(irq >= 0 && irq < IOAPIC_HWI_VECTORS,
576             ("ioapic disable, invalid irq %d", irq));
577
578         map = &ioapic_irqmaps[mycpuid][irq];
579         KASSERT(IOAPIC_IMT_ISHWI(map),
580             ("ioapic disable, not hwi irq %d, type %d, cpu%d",
581              irq, map->im_type, mycpuid));
582         if (map->im_type != IOAPIC_IMT_LEGACY)
583                 return;
584
585         IOAPIC_INTRDIS(irq);
586 }
587
588 static void
589 ioapic_abi_finalize(void)
590 {
591         KKASSERT(MachIntrABI.type == MACHINTR_IOAPIC);
592         KKASSERT(ioapic_enable);
593
594         /*
595          * If an IMCR is present, program bit 0 to disconnect the 8259
596          * from the BSP.
597          */
598         if (imcr_present) {
599                 outb(0x22, 0x70);       /* select IMCR */
600                 outb(0x23, 0x01);       /* disconnect 8259 */
601         }
602 }
603
604 /*
605  * This routine is called after physical interrupts are enabled but before
606  * the critical section is released.  We need to clean out any interrupts
607  * that had already been posted to the cpu.
608  */
609 static void
610 ioapic_abi_cleanup(void)
611 {
612         bzero(mdcpu->gd_ipending, sizeof(mdcpu->gd_ipending));
613 }
614
615 /* Must never be called */
616 static void
617 ioapic_abi_stabilize(void)
618 {
619         panic("ioapic_stabilize() is called");
620 }
621
622 static void
623 ioapic_abi_intr_setup(int intr, int flags)
624 {
625         const struct ioapic_irqmap *map;
626         int vector, select;
627         uint32_t value;
628         u_long ef;
629
630         KASSERT(intr >= 0 && intr < IOAPIC_HWI_VECTORS,
631             ("ioapic setup, invalid irq %d", intr));
632
633         map = &ioapic_irqmaps[mycpuid][intr];
634         KASSERT(IOAPIC_IMT_ISHWI(map),
635             ("ioapic setup, not hwi irq %d, type %d, cpu%d",
636              intr, map->im_type, mycpuid));
637         if (map->im_type != IOAPIC_IMT_LEGACY)
638                 return;
639
640         KASSERT(ioapic_irqs[intr].io_addr != NULL,
641             ("ioapic setup, no GSI information, irq %d", intr));
642
643         ef = read_eflags();
644         cpu_disable_intr();
645
646         vector = IDT_OFFSET + intr;
647
648         /*
649          * Now reprogram the vector in the IO APIC.  In order to avoid
650          * losing an EOI for a level interrupt, which is vector based,
651          * make sure that the IO APIC is programmed for edge-triggering
652          * first, then reprogrammed with the new vector.  This should
653          * clear the IRR bit.
654          */
655         imen_lock();
656
657         select = ioapic_irqs[intr].io_idx;
658         value = ioapic_read(ioapic_irqs[intr].io_addr, select);
659         value |= IOART_INTMSET;
660
661         ioapic_write(ioapic_irqs[intr].io_addr, select,
662             (value & ~APIC_TRIGMOD_MASK));
663         ioapic_write(ioapic_irqs[intr].io_addr, select,
664             (value & ~IOART_INTVEC) | vector);
665
666         imen_unlock();
667
668         IOAPIC_INTREN(intr);
669
670         write_eflags(ef);
671 }
672
673 static void
674 ioapic_abi_intr_teardown(int intr)
675 {
676         const struct ioapic_irqmap *map;
677         int vector, select;
678         uint32_t value;
679         u_long ef;
680
681         KASSERT(intr >= 0 && intr < IOAPIC_HWI_VECTORS,
682             ("ioapic teardown, invalid irq %d", intr));
683
684         map = &ioapic_irqmaps[mycpuid][intr];
685         KASSERT(IOAPIC_IMT_ISHWI(map),
686             ("ioapic teardown, not hwi irq %d, type %d, cpu%d",
687              intr, map->im_type, mycpuid));
688         if (map->im_type != IOAPIC_IMT_LEGACY)
689                 return;
690
691         KASSERT(ioapic_irqs[intr].io_addr != NULL,
692             ("ioapic teardown, no GSI information, irq %d", intr));
693
694         ef = read_eflags();
695         cpu_disable_intr();
696
697         /*
698          * Teardown an interrupt vector.  The vector should already be
699          * installed in the cpu's IDT, but make sure.
700          */
701         IOAPIC_INTRDIS(intr);
702
703         vector = IDT_OFFSET + intr;
704
705         /*
706          * In order to avoid losing an EOI for a level interrupt, which
707          * is vector based, make sure that the IO APIC is programmed for
708          * edge-triggering first, then reprogrammed with the new vector.
709          * This should clear the IRR bit.
710          */
711         imen_lock();
712
713         select = ioapic_irqs[intr].io_idx;
714         value = ioapic_read(ioapic_irqs[intr].io_addr, select);
715
716         ioapic_write(ioapic_irqs[intr].io_addr, select,
717             (value & ~APIC_TRIGMOD_MASK));
718         ioapic_write(ioapic_irqs[intr].io_addr, select,
719             (value & ~IOART_INTVEC) | vector);
720
721         imen_unlock();
722
723         write_eflags(ef);
724 }
725
726 static void
727 ioapic_abi_setdefault(void)
728 {
729         int intr;
730
731         for (intr = 0; intr < IOAPIC_HWI_VECTORS; ++intr) {
732                 if (intr == IOAPIC_HWI_SYSCALL)
733                         continue;
734                 setidt(IDT_OFFSET + intr, ioapic_intr[intr], SDT_SYS386IGT,
735                        SEL_KPL, GSEL(GCODE_SEL, SEL_KPL));
736         }
737 }
738
739 static void
740 ioapic_abi_initmap(void)
741 {
742         int cpu;
743
744         kgetenv_int("hw.ioapic.gsi.balance", &ioapic_abi_gsi_balance);
745
746         kgetenv_int("hw.ioapic.msi_start", &ioapic_abi_msi_start);
747         ioapic_abi_msi_start &= ~0x1f;  /* MUST be 32 aligned */
748
749         /*
750          * NOTE: ncpus is not ready yet
751          */
752         for (cpu = 0; cpu < MAXCPU; ++cpu) {
753                 int i;
754
755                 for (i = 0; i < IOAPIC_HWI_VECTORS; ++i) {
756                         ioapic_irqmaps[cpu][i].im_gsi = -1;
757                         ioapic_irqmaps[cpu][i].im_msi_base = -1;
758                 }
759                 ioapic_irqmaps[cpu][IOAPIC_HWI_SYSCALL].im_type =
760                     IOAPIC_IMT_SYSCALL;
761         }
762 }
763
764 void
765 ioapic_set_legacy_irqmap(int irq, int gsi, enum intr_trigger trig,
766     enum intr_polarity pola)
767 {
768         struct ioapic_irqinfo *info;
769         struct ioapic_irqmap *map;
770         void *ioaddr;
771         int pin, cpuid;
772
773         KKASSERT(trig == INTR_TRIGGER_EDGE || trig == INTR_TRIGGER_LEVEL);
774         KKASSERT(pola == INTR_POLARITY_HIGH || pola == INTR_POLARITY_LOW);
775
776         KKASSERT(irq >= 0 && irq < IOAPIC_HWI_VECTORS);
777         if (irq > ioapic_abi_legacy_irq_max)
778                 ioapic_abi_legacy_irq_max = irq;
779
780         cpuid = ioapic_abi_gsi_cpuid(irq, gsi);
781
782         map = &ioapic_irqmaps[cpuid][irq];
783
784         KKASSERT(map->im_type == IOAPIC_IMT_UNUSED);
785         map->im_type = IOAPIC_IMT_LEGACY;
786
787         map->im_gsi = gsi;
788         map->im_trig = trig;
789         map->im_pola = pola;
790
791         if (bootverbose) {
792                 kprintf("IOAPIC: irq %d -> gsi %d %s/%s\n",
793                         irq, map->im_gsi,
794                         intr_str_trigger(map->im_trig),
795                         intr_str_polarity(map->im_pola));
796         }
797
798         pin = ioapic_gsi_pin(map->im_gsi);
799         ioaddr = ioapic_gsi_ioaddr(map->im_gsi);
800
801         info = &ioapic_irqs[irq];
802
803         imen_lock();
804
805         info->io_addr = ioaddr;
806         info->io_idx = IOAPIC_REDTBL + (2 * pin);
807         info->io_flags = IOAPIC_IRQI_FLAG_MASKED;
808         if (map->im_trig == INTR_TRIGGER_LEVEL)
809                 info->io_flags |= IOAPIC_IRQI_FLAG_LEVEL;
810
811         ioapic_pin_setup(ioaddr, pin, IDT_OFFSET + irq,
812             map->im_trig, map->im_pola, cpuid);
813
814         imen_unlock();
815 }
816
817 void
818 ioapic_fixup_legacy_irqmaps(void)
819 {
820         int cpu;
821
822         ioapic_abi_legacy_irq_max += 1;
823         if (bootverbose) {
824                 kprintf("IOAPIC: legacy irq max %d\n",
825                     ioapic_abi_legacy_irq_max);
826         }
827
828         for (cpu = 0; cpu < ncpus; ++cpu) {
829                 int i;
830
831                 for (i = 0; i < ioapic_abi_legacy_irq_max; ++i) {
832                         struct ioapic_irqmap *map = &ioapic_irqmaps[cpu][i];
833
834                         if (map->im_type == IOAPIC_IMT_UNUSED) {
835                                 map->im_type = IOAPIC_IMT_RESERVED;
836                                 if (bootverbose) {
837                                         kprintf("IOAPIC: "
838                                             "cpu%d irq %d reserved\n", cpu, i);
839                                 }
840                         }
841                 }
842         }
843 }
844
845 int
846 ioapic_find_legacy_by_gsi(int gsi, enum intr_trigger trig,
847     enum intr_polarity pola)
848 {
849         int cpu;
850
851         KKASSERT(trig == INTR_TRIGGER_EDGE || trig == INTR_TRIGGER_LEVEL);
852         KKASSERT(pola == INTR_POLARITY_HIGH || pola == INTR_POLARITY_LOW);
853
854         for (cpu = 0; cpu < ncpus; ++cpu) {
855                 int irq;
856
857                 for (irq = 0; irq < ioapic_abi_legacy_irq_max; ++irq) {
858                         const struct ioapic_irqmap *map =
859                             &ioapic_irqmaps[cpu][irq];
860
861                         if (map->im_gsi == gsi) {
862                                 KKASSERT(map->im_type == IOAPIC_IMT_LEGACY);
863
864                                 if (map->im_flags & IOAPIC_IMF_CONF) {
865                                         if (map->im_trig != trig ||
866                                             map->im_pola != pola)
867                                                 return -1;
868                                 }
869                                 return irq;
870                         }
871                 }
872         }
873         return -1;
874 }
875
876 int
877 ioapic_find_legacy_by_irq(int irq, enum intr_trigger trig,
878     enum intr_polarity pola)
879 {
880         int cpu;
881
882         KKASSERT(trig == INTR_TRIGGER_EDGE || trig == INTR_TRIGGER_LEVEL);
883         KKASSERT(pola == INTR_POLARITY_HIGH || pola == INTR_POLARITY_LOW);
884
885         if (irq < 0 || irq >= ioapic_abi_legacy_irq_max)
886                 return -1;
887
888         for (cpu = 0; cpu < ncpus; ++cpu) {
889                 const struct ioapic_irqmap *map = &ioapic_irqmaps[cpu][irq];
890
891                 if (map->im_type == IOAPIC_IMT_LEGACY) {
892                         if (map->im_flags & IOAPIC_IMF_CONF) {
893                                 if (map->im_trig != trig ||
894                                     map->im_pola != pola)
895                                         return -1;
896                         }
897                         return irq;
898                 }
899         }
900         return -1;
901 }
902
903 static void
904 ioapic_abi_legacy_intr_config(int irq, enum intr_trigger trig,
905     enum intr_polarity pola)
906 {
907         struct ioapic_irqinfo *info;
908         struct ioapic_irqmap *map = NULL;
909         void *ioaddr;
910         int pin, cpuid;
911
912         KKASSERT(trig == INTR_TRIGGER_EDGE || trig == INTR_TRIGGER_LEVEL);
913         KKASSERT(pola == INTR_POLARITY_HIGH || pola == INTR_POLARITY_LOW);
914
915         KKASSERT(irq >= 0 && irq < ioapic_abi_legacy_irq_max);
916         for (cpuid = 0; cpuid < ncpus; ++cpuid) {
917                 map = &ioapic_irqmaps[cpuid][irq];
918                 if (map->im_type == IOAPIC_IMT_LEGACY)
919                         break;
920         }
921         KKASSERT(cpuid < ncpus);
922
923 #ifdef notyet
924         if (map->im_flags & IOAPIC_IMF_CONF) {
925                 if (trig != map->im_trig) {
926                         panic("ioapic_intr_config: trig %s -> %s",
927                               intr_str_trigger(map->im_trig),
928                               intr_str_trigger(trig));
929                 }
930                 if (pola != map->im_pola) {
931                         panic("ioapic_intr_config: pola %s -> %s",
932                               intr_str_polarity(map->im_pola),
933                               intr_str_polarity(pola));
934                 }
935                 return;
936         }
937 #endif
938         map->im_flags |= IOAPIC_IMF_CONF;
939
940         if (trig == map->im_trig && pola == map->im_pola)
941                 return;
942
943         if (bootverbose) {
944                 kprintf("IOAPIC: irq %d, gsi %d %s/%s -> %s/%s\n",
945                         irq, map->im_gsi,
946                         intr_str_trigger(map->im_trig),
947                         intr_str_polarity(map->im_pola),
948                         intr_str_trigger(trig),
949                         intr_str_polarity(pola));
950         }
951         map->im_trig = trig;
952         map->im_pola = pola;
953
954         pin = ioapic_gsi_pin(map->im_gsi);
955         ioaddr = ioapic_gsi_ioaddr(map->im_gsi);
956
957         info = &ioapic_irqs[irq];
958
959         imen_lock();
960
961         info->io_flags &= ~IOAPIC_IRQI_FLAG_LEVEL;
962         if (map->im_trig == INTR_TRIGGER_LEVEL)
963                 info->io_flags |= IOAPIC_IRQI_FLAG_LEVEL;
964
965         ioapic_pin_setup(ioaddr, pin, IDT_OFFSET + irq,
966             map->im_trig, map->im_pola, cpuid);
967
968         imen_unlock();
969 }
970
971 int
972 ioapic_conf_legacy_extint(int irq)
973 {
974         struct ioapic_irqinfo *info;
975         struct ioapic_irqmap *map;
976         void *ioaddr;
977         int pin, error, vec;
978
979         /* XXX only irq0 is allowed */
980         KKASSERT(irq == 0);
981
982         vec = IDT_OFFSET + irq;
983
984         if (ioapic_abi_extint_irq == irq)
985                 return 0;
986         else if (ioapic_abi_extint_irq >= 0)
987                 return EEXIST;
988
989         error = icu_ioapic_extint(irq, vec);
990         if (error)
991                 return error;
992
993         /* ExtINT is always targeted to cpu0 */
994         map = &ioapic_irqmaps[0][irq];
995
996         KKASSERT(map->im_type == IOAPIC_IMT_RESERVED ||
997                  map->im_type == IOAPIC_IMT_LEGACY);
998         if (map->im_type == IOAPIC_IMT_LEGACY) {
999                 if (map->im_flags & IOAPIC_IMF_CONF)
1000                         return EEXIST;
1001         }
1002         ioapic_abi_extint_irq = irq;
1003
1004         map->im_type = IOAPIC_IMT_LEGACY;
1005         map->im_trig = INTR_TRIGGER_EDGE;
1006         map->im_pola = INTR_POLARITY_HIGH;
1007         map->im_flags = IOAPIC_IMF_CONF;
1008
1009         map->im_gsi = ioapic_extpin_gsi();
1010         KKASSERT(map->im_gsi >= 0);
1011
1012         if (bootverbose) {
1013                 kprintf("IOAPIC: irq %d -> extint gsi %d %s/%s\n",
1014                         irq, map->im_gsi,
1015                         intr_str_trigger(map->im_trig),
1016                         intr_str_polarity(map->im_pola));
1017         }
1018
1019         pin = ioapic_gsi_pin(map->im_gsi);
1020         ioaddr = ioapic_gsi_ioaddr(map->im_gsi);
1021
1022         info = &ioapic_irqs[irq];
1023
1024         imen_lock();
1025
1026         info->io_addr = ioaddr;
1027         info->io_idx = IOAPIC_REDTBL + (2 * pin);
1028         info->io_flags = IOAPIC_IRQI_FLAG_MASKED;
1029
1030         ioapic_extpin_setup(ioaddr, pin, vec);
1031
1032         imen_unlock();
1033
1034         return 0;
1035 }
1036
1037 static int
1038 ioapic_abi_legacy_intr_cpuid(int irq)
1039 {
1040         const struct ioapic_irqmap *map = NULL;
1041         int cpuid;
1042
1043         KKASSERT(irq >= 0 && irq < ioapic_abi_legacy_irq_max);
1044
1045         for (cpuid = 0; cpuid < ncpus; ++cpuid) {
1046                 map = &ioapic_irqmaps[cpuid][irq];
1047                 if (map->im_type == IOAPIC_IMT_LEGACY)
1048                         return cpuid;
1049         }
1050
1051         /* XXX some drivers tries to peek at reserved IRQs */
1052         for (cpuid = 0; cpuid < ncpus; ++cpuid) {
1053                 map = &ioapic_irqmaps[cpuid][irq];
1054                 KKASSERT(map->im_type == IOAPIC_IMT_RESERVED);
1055         }
1056         return 0;
1057 }
1058
1059 static int
1060 ioapic_abi_gsi_cpuid(int irq, int gsi)
1061 {
1062         char envpath[32];
1063         int cpuid = -1;
1064
1065         KKASSERT(gsi >= 0);
1066
1067         if (irq == 0 || gsi == 0) {
1068                 if (bootverbose) {
1069                         kprintf("IOAPIC: irq %d, gsi %d -> cpu0 (0)\n",
1070                             irq, gsi);
1071                 }
1072                 return 0;
1073         }
1074
1075         if (irq == acpi_sci_irqno()) {
1076                 if (bootverbose) {
1077                         kprintf("IOAPIC: irq %d, gsi %d -> cpu0 (sci)\n",
1078                             irq, gsi);
1079                 }
1080                 return 0;
1081         }
1082
1083         ksnprintf(envpath, sizeof(envpath), "hw.ioapic.gsi.%d.cpu", gsi);
1084         kgetenv_int(envpath, &cpuid);
1085
1086         if (cpuid < 0) {
1087                 if (!ioapic_abi_gsi_balance) {
1088                         if (bootverbose) {
1089                                 kprintf("IOAPIC: irq %d, gsi %d -> cpu0 "
1090                                     "(fixed)\n", irq, gsi);
1091                         }
1092                         return 0;
1093                 }
1094
1095                 cpuid = gsi % ncpus;
1096                 if (bootverbose) {
1097                         kprintf("IOAPIC: irq %d, gsi %d -> cpu%d (auto)\n",
1098                             irq, gsi, cpuid);
1099                 }
1100         } else if (cpuid >= ncpus) {
1101                 cpuid = ncpus - 1;
1102                 if (bootverbose) {
1103                         kprintf("IOAPIC: irq %d, gsi %d -> cpu%d (fixup)\n",
1104                             irq, gsi, cpuid);
1105                 }
1106         } else {
1107                 if (bootverbose) {
1108                         kprintf("IOAPIC: irq %d, gsi %d -> cpu%d (user)\n",
1109                             irq, gsi, cpuid);
1110                 }
1111         }
1112         return cpuid;
1113 }
1114
1115 static void
1116 ioapic_abi_rman_setup(struct rman *rm)
1117 {
1118         int start, end, i;
1119
1120         KASSERT(rm->rm_cpuid >= 0 && rm->rm_cpuid < MAXCPU,
1121             ("invalid rman cpuid %d", rm->rm_cpuid));
1122
1123         start = end = -1;
1124         for (i = 0; i < IOAPIC_HWI_VECTORS; ++i) {
1125                 const struct ioapic_irqmap *map =
1126                     &ioapic_irqmaps[rm->rm_cpuid][i];
1127
1128                 if (start < 0) {
1129                         if (IOAPIC_IMT_ISHWI(map))
1130                                 start = end = i;
1131                 } else {
1132                         if (IOAPIC_IMT_ISHWI(map)) {
1133                                 end = i;
1134                         } else {
1135                                 KKASSERT(end >= 0);
1136                                 if (bootverbose) {
1137                                         kprintf("IOAPIC: rman cpu%d %d - %d\n",
1138                                             rm->rm_cpuid, start, end);
1139                                 }
1140                                 if (rman_manage_region(rm, start, end)) {
1141                                         panic("rman_manage_region"
1142                                             "(cpu%d %d - %d)", rm->rm_cpuid,
1143                                             start, end);
1144                                 }
1145                                 start = end = -1;
1146                         }
1147                 }
1148         }
1149         if (start >= 0) {
1150                 KKASSERT(end >= 0);
1151                 if (bootverbose) {
1152                         kprintf("IOAPIC: rman cpu%d %d - %d\n",
1153                             rm->rm_cpuid, start, end);
1154                 }
1155                 if (rman_manage_region(rm, start, end)) {
1156                         panic("rman_manage_region(cpu%d %d - %d)",
1157                             rm->rm_cpuid, start, end);
1158                 }
1159         }
1160 }
1161
1162 static int
1163 ioapic_abi_msi_alloc_intern(int type, const char *desc,
1164     int intrs[], int count, int cpuid)
1165 {
1166         int i, error;
1167
1168         KASSERT(cpuid >= 0 && cpuid < ncpus,
1169             ("invalid cpuid %d", cpuid));
1170
1171         KASSERT(count > 0 && count <= 32, ("invalid count %d", count));
1172         KASSERT((count & (count - 1)) == 0,
1173             ("count %d is not power of 2", count));
1174
1175         lwkt_gettoken(&ioapic_irqmap_tok);
1176
1177         /*
1178          * NOTE:
1179          * Since IDT_OFFSET is 32, which is the maximum valid 'count',
1180          * we do not need to find out the first properly aligned
1181          * interrupt vector.
1182          */
1183
1184         error = EMSGSIZE;
1185         for (i = ioapic_abi_msi_start; i < IOAPIC_HWI_VECTORS; i += count) {
1186                 int j;
1187
1188                 if (ioapic_irqmaps[cpuid][i].im_type != IOAPIC_IMT_UNUSED)
1189                         continue;
1190
1191                 for (j = 1; j < count; ++j) {
1192                         if (ioapic_irqmaps[cpuid][i + j].im_type !=
1193                             IOAPIC_IMT_UNUSED)
1194                                 break;
1195                 }
1196                 if (j != count)
1197                         continue;
1198
1199                 for (j = 0; j < count; ++j) {
1200                         int intr = i + j, cpu;
1201
1202                         for (cpu = 0; cpu < ncpus; ++cpu) {
1203                                 struct ioapic_irqmap *map;
1204
1205                                 map = &ioapic_irqmaps[cpu][intr];
1206                                 KASSERT(map->im_msi_base < 0,
1207                                     ("intr %d cpu%d, stale %s-base %d",
1208                                      intr, cpu, desc, map->im_msi_base));
1209                                 KASSERT(map->im_type == IOAPIC_IMT_UNUSED,
1210                                     ("intr %d cpu%d, already allocated",
1211                                      intr, cpu));
1212
1213                                 if (cpu == cpuid) {
1214                                         map->im_type = type;
1215                                         map->im_msi_base = i;
1216                                 } else {
1217                                         map->im_type = IOAPIC_IMT_SHADOW;
1218                                 }
1219                         }
1220
1221                         intrs[j] = intr;
1222                         msi_setup(intr);
1223
1224                         if (bootverbose) {
1225                                 kprintf("alloc %s intr %d on cpu%d\n",
1226                                     desc, intr, cpuid);
1227                         }
1228                 }
1229                 error = 0;
1230                 break;
1231         }
1232
1233         lwkt_reltoken(&ioapic_irqmap_tok);
1234
1235         return error;
1236 }
1237
1238 static void
1239 ioapic_abi_msi_release_intern(int type, const char *desc,
1240     const int intrs[], int count, int cpuid)
1241 {
1242         int i, msi_base = -1, intr_next = -1, mask;
1243
1244         KASSERT(cpuid >= 0 && cpuid < ncpus,
1245             ("invalid cpuid %d", cpuid));
1246
1247         KASSERT(count > 0 && count <= 32, ("invalid count %d", count));
1248
1249         mask = count - 1;
1250         KASSERT((count & mask) == 0, ("count %d is not power of 2", count));
1251
1252         lwkt_gettoken(&ioapic_irqmap_tok);
1253
1254         for (i = 0; i < count; ++i) {
1255                 int intr = intrs[i], cpu;
1256
1257                 KASSERT(intr >= 0 && intr < IOAPIC_HWI_VECTORS,
1258                     ("invalid intr %d", intr));
1259
1260                 for (cpu = 0; cpu < ncpus; ++cpu) {
1261                         struct ioapic_irqmap *map;
1262
1263                         map = &ioapic_irqmaps[cpu][intr];
1264
1265                         if (cpu == cpuid) {
1266                                 KASSERT(map->im_type == type,
1267                                     ("trying to release non-%s intr %d cpu%d, "
1268                                      "type %d", desc, intr, cpu,
1269                                      map->im_type));
1270                                 KASSERT(map->im_msi_base >= 0 &&
1271                                     map->im_msi_base <= intr,
1272                                     ("intr %d cpu%d, invalid %s-base %d",
1273                                      intr, cpu, desc, map->im_msi_base));
1274                                 KASSERT((map->im_msi_base & mask) == 0,
1275                                     ("intr %d cpu%d, %s-base %d is "
1276                                      "not properly aligned %d",
1277                                      intr, cpu, desc, map->im_msi_base, count));
1278
1279                                 if (msi_base < 0) {
1280                                         msi_base = map->im_msi_base;
1281                                 } else {
1282                                         KASSERT(map->im_msi_base == msi_base,
1283                                             ("intr %d cpu%d, "
1284                                              "inconsistent %s-base, "
1285                                              "was %d, now %d",
1286                                              intr, cpu, desc,
1287                                              msi_base, map->im_msi_base));
1288                                 }
1289                                 map->im_msi_base = -1;
1290                         } else {
1291                                 KASSERT(map->im_type == IOAPIC_IMT_SHADOW,
1292                                     ("trying to release non-%ssh intr %d cpu%d, "
1293                                      "type %d", desc, intr, cpu,
1294                                      map->im_type));
1295                                 KASSERT(map->im_msi_base < 0,
1296                                     ("intr %d cpu%d, invalid %ssh-base %d",
1297                                      intr, cpu, desc, map->im_msi_base));
1298                         }
1299                         map->im_type = IOAPIC_IMT_UNUSED;
1300                 }
1301
1302                 if (intr_next < intr)
1303                         intr_next = intr;
1304
1305                 if (bootverbose) {
1306                         kprintf("release %s intr %d on cpu%d\n",
1307                             desc, intr, cpuid);
1308                 }
1309         }
1310
1311         KKASSERT(intr_next > 0);
1312         KKASSERT(msi_base >= 0);
1313
1314         ++intr_next;
1315         if (intr_next < IOAPIC_HWI_VECTORS) {
1316                 int cpu;
1317
1318                 for (cpu = 0; cpu < ncpus; ++cpu) {
1319                         const struct ioapic_irqmap *map =
1320                             &ioapic_irqmaps[cpu][intr_next];
1321
1322                         if (map->im_type == type) {
1323                                 KASSERT(map->im_msi_base != msi_base,
1324                                     ("more than %d %s was allocated",
1325                                      count, desc));
1326                         }
1327                 }
1328         }
1329
1330         lwkt_reltoken(&ioapic_irqmap_tok);
1331 }
1332
1333 static int
1334 ioapic_abi_msi_alloc(int intrs[], int count, int cpuid)
1335 {
1336         return ioapic_abi_msi_alloc_intern(IOAPIC_IMT_MSI, "MSI",
1337             intrs, count, cpuid);
1338 }
1339
1340 static void
1341 ioapic_abi_msi_release(const int intrs[], int count, int cpuid)
1342 {
1343         ioapic_abi_msi_release_intern(IOAPIC_IMT_MSI, "MSI",
1344             intrs, count, cpuid);
1345 }
1346
1347 static int
1348 ioapic_abi_msix_alloc(int *intr, int cpuid)
1349 {
1350         return ioapic_abi_msi_alloc_intern(IOAPIC_IMT_MSIX, "MSI-X",
1351             intr, 1, cpuid);
1352 }
1353
1354 static void
1355 ioapic_abi_msix_release(int intr, int cpuid)
1356 {
1357         ioapic_abi_msi_release_intern(IOAPIC_IMT_MSIX, "MSI-X",
1358             &intr, 1, cpuid);
1359 }
1360
1361 static void
1362 ioapic_abi_msi_map(int intr, uint64_t *addr, uint32_t *data, int cpuid)
1363 {
1364         const struct ioapic_irqmap *map;
1365
1366         KASSERT(cpuid >= 0 && cpuid < ncpus,
1367             ("invalid cpuid %d", cpuid));
1368
1369         KASSERT(intr >= 0 && intr < IOAPIC_HWI_VECTORS,
1370             ("invalid intr %d", intr));
1371
1372         lwkt_gettoken(&ioapic_irqmap_tok);
1373
1374         map = &ioapic_irqmaps[cpuid][intr];
1375         KASSERT(map->im_type == IOAPIC_IMT_MSI ||
1376             map->im_type == IOAPIC_IMT_MSIX,
1377             ("trying to map non-MSI/MSI-X intr %d, type %d", intr, map->im_type));
1378         KASSERT(map->im_msi_base >= 0 && map->im_msi_base <= intr,
1379             ("intr %d, invalid %s-base %d", intr,
1380              map->im_type == IOAPIC_IMT_MSI ? "MSI" : "MSI-X",
1381              map->im_msi_base));
1382
1383         msi_map(map->im_msi_base, addr, data, cpuid);
1384
1385         if (bootverbose) {
1386                 kprintf("map %s intr %d on cpu%d\n",
1387                     map->im_type == IOAPIC_IMT_MSI ? "MSI" : "MSI-X",
1388                     intr, cpuid);
1389         }
1390
1391         lwkt_reltoken(&ioapic_irqmap_tok);
1392 }