pyro.c revision 1.15 1 /* $NetBSD: pyro.c,v 1.15 2013/08/10 00:48:04 mrg Exp $ */
2 /* from: $OpenBSD: pyro.c,v 1.20 2010/12/05 15:15:14 kettenis Exp $ */
3
4 /*
5 * Copyright (c) 2002 Jason L. Wright (jason (at) thought.net)
6 * Copyright (c) 2003 Henric Jungheim
7 * Copyright (c) 2007 Mark Kettenis
8 * Copyright (c) 2011 Matthew R. Green
9 * All rights reserved.
10 *
11 * Redistribution and use in source and binary forms, with or without
12 * modification, are permitted provided that the following conditions
13 * are met:
14 * 1. Redistributions of source code must retain the above copyright
15 * notice, this list of conditions and the following disclaimer.
16 * 2. Redistributions in binary form must reproduce the above copyright
17 * notice, this list of conditions and the following disclaimer in the
18 * documentation and/or other materials provided with the distribution.
19 *
20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
22 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
23 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
24 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
25 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
26 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
28 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
29 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 * POSSIBILITY OF SUCH DAMAGE.
31 */
32
33 #include <sys/cdefs.h>
34 __KERNEL_RCSID(0, "$NetBSD: pyro.c,v 1.15 2013/08/10 00:48:04 mrg Exp $");
35
36 #include <sys/param.h>
37 #include <sys/device.h>
38 #include <sys/errno.h>
39 #include <sys/malloc.h>
40 #include <sys/systm.h>
41
42 #define _SPARC_BUS_DMA_PRIVATE
43 #include <sys/bus.h>
44 #include <machine/autoconf.h>
45
46 #ifdef DDB
47 #include <machine/db_machdep.h>
48 #endif
49
50 #include <dev/pci/pcivar.h>
51 #include <dev/pci/pcireg.h>
52
53 #include <sparc64/dev/iommureg.h>
54 #include <sparc64/dev/iommuvar.h>
55 #include <sparc64/dev/pyrovar.h>
56
57 #ifdef DEBUG
58 #define PDB_PROM 0x01
59 #define PDB_BUSMAP 0x02
60 #define PDB_INTR 0x04
61 #define PDB_CONF 0x08
62 int pyro_debug = 0x0;
63 #define DPRINTF(l, s) do { if (pyro_debug & l) printf s; } while (0)
64 #else
65 #define DPRINTF(l, s)
66 #endif
67
68 #define FIRE_RESET_GEN 0x7010
69
70 #define FIRE_RESET_GEN_XIR 0x0000000000000002L
71
72 #define FIRE_INTRMAP_INT_CNTRL_NUM_MASK 0x000003c0
73 #define FIRE_INTRMAP_INT_CNTRL_NUM0 0x00000040
74 #define FIRE_INTRMAP_INT_CNTRL_NUM1 0x00000080
75 #define FIRE_INTRMAP_INT_CNTRL_NUM2 0x00000100
76 #define FIRE_INTRMAP_INT_CNTRL_NUM3 0x00000200
77 #define FIRE_INTRMAP_T_JPID_SHIFT 26
78 #define FIRE_INTRMAP_T_JPID_MASK 0x7c000000
79
80 #define OBERON_INTRMAP_T_DESTID_SHIFT 21
81 #define OBERON_INTRMAP_T_DESTID_MASK 0x7fe00000
82
83 extern struct sparc_pci_chipset _sparc_pci_chipset;
84
85 int pyro_match(device_t, cfdata_t, void *);
86 void pyro_attach(device_t, device_t, void *);
87 int pyro_print(void *, const char *);
88
89 CFATTACH_DECL_NEW(pyro, sizeof(struct pyro_softc),
90 pyro_match, pyro_attach, NULL, NULL);
91
92 void pyro_init(struct pyro_softc *, int);
93 void pyro_init_iommu(struct pyro_softc *, struct pyro_pbm *);
94
95 pci_chipset_tag_t pyro_alloc_chipset(struct pyro_pbm *, int,
96 pci_chipset_tag_t);
97 bus_space_tag_t pyro_alloc_mem_tag(struct pyro_pbm *);
98 bus_space_tag_t pyro_alloc_io_tag(struct pyro_pbm *);
99 bus_space_tag_t pyro_alloc_config_tag(struct pyro_pbm *);
100 bus_space_tag_t pyro_alloc_bus_tag(struct pyro_pbm *, const char *, int);
101 bus_dma_tag_t pyro_alloc_dma_tag(struct pyro_pbm *);
102
103 #if 0
104 int pyro_conf_size(pci_chipset_tag_t, pcitag_t);
105 #endif
106 pcireg_t pyro_conf_read(pci_chipset_tag_t, pcitag_t, int);
107 void pyro_conf_write(pci_chipset_tag_t, pcitag_t, int, pcireg_t);
108
109 static void * pyro_pci_intr_establish(pci_chipset_tag_t pc,
110 pci_intr_handle_t ih, int level,
111 int (*func)(void *), void *arg);
112
113 int pyro_intr_map(const struct pci_attach_args *, pci_intr_handle_t *);
114 int pyro_bus_map(bus_space_tag_t, bus_addr_t,
115 bus_size_t, int, vaddr_t, bus_space_handle_t *);
116 paddr_t pyro_bus_mmap(bus_space_tag_t, bus_addr_t, off_t,
117 int, int);
118 void *pyro_intr_establish(bus_space_tag_t, int, int,
119 int (*)(void *), void *, void (*)(void));
120
121 int pyro_dmamap_create(bus_dma_tag_t, bus_size_t, int,
122 bus_size_t, bus_size_t, int, bus_dmamap_t *);
123
124 int
125 pyro_match(device_t parent, cfdata_t match, void *aux)
126 {
127 struct mainbus_attach_args *ma = aux;
128 char *str;
129
130 if (strcmp(ma->ma_name, "pci") != 0)
131 return (0);
132
133 str = prom_getpropstring(ma->ma_node, "compatible");
134 if (strcmp(str, "pciex108e,80f0") == 0 ||
135 strcmp(str, "pciex108e,80f8") == 0)
136 return (1);
137
138 return (0);
139 }
140
141 void
142 pyro_attach(device_t parent, device_t self, void *aux)
143 {
144 struct pyro_softc *sc = device_private(self);
145 struct mainbus_attach_args *ma = aux;
146 char *str;
147 int busa;
148
149 sc->sc_dev = self;
150 sc->sc_node = ma->ma_node;
151 sc->sc_dmat = ma->ma_dmatag;
152 sc->sc_bustag = ma->ma_bustag;
153 sc->sc_csr = ma->ma_reg[0].ur_paddr;
154 sc->sc_xbc = ma->ma_reg[1].ur_paddr;
155 sc->sc_ign = INTIGN(ma->ma_upaid << INTMAP_IGN_SHIFT);
156
157 if ((ma->ma_reg[0].ur_paddr & 0x00700000) == 0x00600000)
158 busa = 1;
159 else
160 busa = 0;
161
162 if (bus_space_map(sc->sc_bustag, sc->sc_csr,
163 ma->ma_reg[0].ur_len, BUS_SPACE_MAP_LINEAR, &sc->sc_csrh)) {
164 printf(": failed to map csr registers\n");
165 return;
166 }
167
168 if (bus_space_map(sc->sc_bustag, sc->sc_xbc,
169 ma->ma_reg[1].ur_len, 0, &sc->sc_xbch)) {
170 printf(": failed to map xbc registers\n");
171 return;
172 }
173
174 str = prom_getpropstring(ma->ma_node, "compatible");
175 if (strcmp(str, "pciex108e,80f8") == 0)
176 sc->sc_oberon = 1;
177
178 pyro_init(sc, busa);
179 }
180
181 void
182 pyro_init(struct pyro_softc *sc, int busa)
183 {
184 struct pyro_pbm *pbm;
185 struct pcibus_attach_args pba;
186 int *busranges = NULL, nranges;
187
188 pbm = malloc(sizeof(*pbm), M_DEVBUF, M_NOWAIT | M_ZERO);
189 if (pbm == NULL)
190 panic("pyro: can't alloc pyro pbm");
191
192 pbm->pp_sc = sc;
193 pbm->pp_bus_a = busa;
194
195 if (prom_getprop(sc->sc_node, "ranges", sizeof(struct pyro_range),
196 &pbm->pp_nrange, (void **)&pbm->pp_range))
197 panic("pyro: can't get ranges");
198
199 if (prom_getprop(sc->sc_node, "bus-range", sizeof(int), &nranges,
200 (void **)&busranges))
201 panic("pyro: can't get bus-range");
202
203 printf(": \"%s\", rev %d, ign %x, bus %c %d to %d\n",
204 sc->sc_oberon ? "Oberon" : "Fire",
205 prom_getpropint(sc->sc_node, "module-revision#", 0), sc->sc_ign,
206 busa ? 'A' : 'B', busranges[0], busranges[1]);
207
208 printf("%s: ", device_xname(sc->sc_dev));
209 pyro_init_iommu(sc, pbm);
210
211 pbm->pp_memt = pyro_alloc_mem_tag(pbm);
212 pbm->pp_iot = pyro_alloc_io_tag(pbm);
213 pbm->pp_cfgt = pyro_alloc_config_tag(pbm);
214 pbm->pp_dmat = pyro_alloc_dma_tag(pbm);
215 pbm->pp_flags = (pbm->pp_memt ? PCI_FLAGS_MEM_OKAY : 0) |
216 (pbm->pp_iot ? PCI_FLAGS_IO_OKAY : 0);
217
218 if (bus_space_map(pbm->pp_cfgt, 0, 0x10000000, 0, &pbm->pp_cfgh))
219 panic("pyro: can't map config space");
220
221 pbm->pp_pc = pyro_alloc_chipset(pbm, sc->sc_node, &_sparc_pci_chipset);
222 pbm->pp_pc->spc_busmax = busranges[1];
223 pbm->pp_pc->spc_busnode = malloc(sizeof(*pbm->pp_pc->spc_busnode),
224 M_DEVBUF, M_NOWAIT | M_ZERO);
225 if (pbm->pp_pc->spc_busnode == NULL)
226 panic("pyro: malloc busnode");
227
228 #if 0
229 pbm->pp_pc->bustag = pbm->pp_cfgt;
230 pbm->pp_pc->bushandle = pbm->pp_cfgh;
231 #endif
232
233 bzero(&pba, sizeof(pba));
234 pba.pba_bus = busranges[0];
235 pba.pba_pc = pbm->pp_pc;
236 pba.pba_flags = pbm->pp_flags;
237 pba.pba_dmat = pbm->pp_dmat;
238 pba.pba_dmat64 = NULL; /* XXX */
239 pba.pba_memt = pbm->pp_memt;
240 pba.pba_iot = pbm->pp_iot;
241
242 free(busranges, M_DEVBUF);
243
244 config_found(sc->sc_dev, &pba, pyro_print);
245 }
246
247 void
248 pyro_init_iommu(struct pyro_softc *sc, struct pyro_pbm *pbm)
249 {
250 struct iommu_state *is = &pbm->pp_is;
251 int tsbsize = 7;
252 u_int32_t iobase = -1;
253 char *name;
254
255 pbm->pp_sb.sb_is = is;
256 is->is_bustag = sc->sc_bustag;
257
258 if (bus_space_subregion(is->is_bustag, sc->sc_csrh,
259 0x40000, 0x100, &is->is_iommu)) {
260 panic("pyro: unable to create iommu handle");
261 }
262
263 /* We have no STC. */
264 is->is_sb[0] = NULL;
265
266 name = (char *)malloc(32, M_DEVBUF, M_NOWAIT);
267 if (name == NULL)
268 panic("couldn't malloc iommu name");
269 snprintf(name, 32, "%s dvma", device_xname(sc->sc_dev));
270
271 /* Tell iommu how to set the TSB size. */
272 is->is_flags = IOMMU_TSBSIZE_IN_PTSB;
273
274 /* On Oberon, we need to flush the cache. */
275 if (sc->sc_oberon)
276 is->is_flags |= IOMMU_FLUSH_CACHE;
277
278 iommu_init(name, is, tsbsize, iobase);
279 }
280
281 int
282 pyro_print(void *aux, const char *p)
283 {
284 if (p == NULL)
285 return (UNCONF);
286 return (QUIET);
287 }
288
289 pcireg_t
290 pyro_conf_read(pci_chipset_tag_t pc, pcitag_t tag, int reg)
291 {
292 struct pyro_pbm *pp = pc->cookie;
293 struct cpu_info *ci = curcpu();
294 pcireg_t val = (pcireg_t)~0;
295 int s;
296
297 DPRINTF(PDB_CONF, ("%s: tag %lx reg %x ", __func__, (long)tag, reg));
298 if (PCITAG_NODE(tag) != -1) {
299 s = splhigh();
300 ci->ci_pci_probe = true;
301 membar_Sync();
302 val = bus_space_read_4(pp->pp_cfgt, pp->pp_cfgh,
303 (PCITAG_OFFSET(tag) << 4) + reg);
304 membar_Sync();
305 if (ci->ci_pci_fault)
306 val = (pcireg_t)~0;
307 ci->ci_pci_probe = ci->ci_pci_fault = false;
308 splx(s);
309 }
310 DPRINTF(PDB_CONF, (" returning %08x\n", (u_int)val));
311 return (val);
312 }
313
314 void
315 pyro_conf_write(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t data)
316 {
317 struct pyro_pbm *pp = pc->cookie;
318
319 DPRINTF(PDB_CONF, ("%s: tag %lx; reg %x; data %x", __func__,
320 (long)tag, reg, (int)data));
321
322 /* If we don't know it, just punt it. */
323 if (PCITAG_NODE(tag) == -1) {
324 DPRINTF(PDB_CONF, (" .. bad addr\n"));
325 return;
326 }
327
328 bus_space_write_4(pp->pp_cfgt, pp->pp_cfgh,
329 (PCITAG_OFFSET(tag) << 4) + reg, data);
330 DPRINTF(PDB_CONF, (" .. done\n"));
331 }
332
333 /*
334 * Bus-specific interrupt mapping
335 */
336 int
337 pyro_intr_map(const struct pci_attach_args *pa, pci_intr_handle_t *ihp)
338 {
339 struct pyro_pbm *pp = pa->pa_pc->cookie;
340 struct pyro_softc *sc = pp->pp_sc;
341 u_int dev;
342
343 if (*ihp != (pci_intr_handle_t)-1) {
344 *ihp |= sc->sc_ign;
345 DPRINTF(PDB_INTR, ("%s: not -1 -> ih %lx\n", __func__, (u_long)*ihp));
346 return (0);
347 }
348
349 /*
350 * We didn't find a PROM mapping for this interrupt. Try to
351 * construct one ourselves based on the swizzled interrupt pin
352 * and the interrupt mapping for PCI slots documented in the
353 * UltraSPARC-IIi User's Manual.
354 */
355
356 if (pa->pa_intrpin == 0) {
357 DPRINTF(PDB_INTR, ("%s: no intrpen\n", __func__));
358 return (-1);
359 }
360
361 /*
362 * This deserves some documentation. Should anyone
363 * have anything official looking, please speak up.
364 */
365 dev = pa->pa_device - 1;
366
367 *ihp = (pa->pa_intrpin - 1) & INTMAP_PCIINT;
368 *ihp |= (dev << 2) & INTMAP_PCISLOT;
369 *ihp |= sc->sc_ign;
370
371 DPRINTF(PDB_INTR, ("%s: weird hack -> ih %lx\n", __func__, (u_long)*ihp));
372 return (0);
373 }
374
375 bus_space_tag_t
376 pyro_alloc_mem_tag(struct pyro_pbm *pp)
377 {
378 return (pyro_alloc_bus_tag(pp, "mem", PCI_MEMORY_BUS_SPACE));
379 }
380
381 bus_space_tag_t
382 pyro_alloc_io_tag(struct pyro_pbm *pp)
383 {
384 return (pyro_alloc_bus_tag(pp, "io", PCI_IO_BUS_SPACE));
385 }
386
387 bus_space_tag_t
388 pyro_alloc_config_tag(struct pyro_pbm *pp)
389 {
390 return (pyro_alloc_bus_tag(pp, "cfg", PCI_CONFIG_BUS_SPACE));
391 }
392
393 bus_space_tag_t
394 pyro_alloc_bus_tag(struct pyro_pbm *pbm, const char *name, int type)
395 {
396 struct pyro_softc *sc = pbm->pp_sc;
397 struct sparc_bus_space_tag *bt;
398
399 bt = malloc(sizeof(*bt), M_DEVBUF, M_NOWAIT | M_ZERO);
400 if (bt == NULL)
401 panic("pyro: could not allocate bus tag");
402
403 #if 0
404 snprintf(bt->name, sizeof(bt->name), "%s-pbm_%s(%d/%2.2x)",
405 device_xname(sc->sc_dev), name, ss, asi);
406 #endif
407
408 bt->cookie = pbm;
409 bt->parent = sc->sc_bustag;
410 bt->type = type;
411 bt->sparc_bus_map = pyro_bus_map;
412 bt->sparc_bus_mmap = pyro_bus_mmap;
413 bt->sparc_intr_establish = pyro_intr_establish;
414 return (bt);
415 }
416
417 bus_dma_tag_t
418 pyro_alloc_dma_tag(struct pyro_pbm *pbm)
419 {
420 struct pyro_softc *sc = pbm->pp_sc;
421 bus_dma_tag_t dt, pdt = sc->sc_dmat;
422
423 dt = malloc(sizeof(*dt), M_DEVBUF, M_NOWAIT | M_ZERO);
424 if (dt == NULL)
425 panic("pyro: could not alloc dma tag");
426
427 dt->_cookie = pbm;
428 dt->_parent = pdt;
429 #define PCOPY(x) dt->x = pdt->x
430 dt->_dmamap_create = pyro_dmamap_create;
431 PCOPY(_dmamap_destroy);
432 dt->_dmamap_load = iommu_dvmamap_load;
433 PCOPY(_dmamap_load_mbuf);
434 PCOPY(_dmamap_load_uio);
435 dt->_dmamap_load_raw = iommu_dvmamap_load_raw;
436 dt->_dmamap_unload = iommu_dvmamap_unload;
437 dt->_dmamap_sync = iommu_dvmamap_sync;
438 dt->_dmamem_alloc = iommu_dvmamem_alloc;
439 dt->_dmamem_free = iommu_dvmamem_free;
440 dt->_dmamem_map = iommu_dvmamem_map;
441 dt->_dmamem_unmap = iommu_dvmamem_unmap;
442 PCOPY(_dmamem_mmap);
443 #undef PCOPY
444 return (dt);
445 }
446
447 pci_chipset_tag_t
448 pyro_alloc_chipset(struct pyro_pbm *pbm, int node, pci_chipset_tag_t pc)
449 {
450 pci_chipset_tag_t npc;
451
452 npc = malloc(sizeof *npc, M_DEVBUF, M_NOWAIT);
453 if (npc == NULL)
454 panic("pyro: could not allocate pci_chipset_tag_t");
455 memcpy(npc, pc, sizeof *pc);
456 npc->cookie = pbm;
457 npc->rootnode = node;
458 npc->spc_conf_read = pyro_conf_read;
459 npc->spc_conf_write = pyro_conf_write;
460 npc->spc_intr_map = pyro_intr_map;
461 npc->spc_intr_establish = pyro_pci_intr_establish;
462 npc->spc_find_ino = NULL;
463 return (npc);
464 }
465
466 int
467 pyro_dmamap_create(bus_dma_tag_t t, bus_size_t size,
468 int nsegments, bus_size_t maxsegsz, bus_size_t boundary, int flags,
469 bus_dmamap_t *dmamp)
470 {
471 struct pyro_pbm *pbm = t->_cookie;
472 int error;
473
474 error = bus_dmamap_create(t->_parent, size, nsegments, maxsegsz,
475 boundary, flags, dmamp);
476 if (error == 0)
477 (*dmamp)->_dm_cookie = &pbm->pp_sb;
478 return error;
479 }
480
481 int
482 pyro_bus_map(bus_space_tag_t t, bus_addr_t offset,
483 bus_size_t size, int flags, vaddr_t unused, bus_space_handle_t *hp)
484 {
485 struct pyro_pbm *pbm = t->cookie;
486 struct pyro_softc *sc = pbm->pp_sc;
487 int i, ss;
488
489 DPRINTF(PDB_BUSMAP, ("pyro_bus_map: type %d off %qx sz %qx flags %d",
490 t->type,
491 (unsigned long long)offset,
492 (unsigned long long)size,
493 flags));
494
495 ss = sparc_pci_childspace(t->type);
496 DPRINTF(PDB_BUSMAP, (" cspace %d", ss));
497
498 if (t->parent == 0 || t->parent->sparc_bus_map == 0) {
499 printf("\n_pyro_bus_map: invalid parent");
500 return (EINVAL);
501 }
502
503 for (i = 0; i < pbm->pp_nrange; i++) {
504 bus_addr_t paddr;
505 struct pyro_range *pr = &pbm->pp_range[i];
506
507 if (((pr->cspace >> 24) & 0x03) != ss)
508 continue;
509
510 paddr = BUS_ADDR(pr->phys_hi, pr->phys_lo + offset);
511 return ((*sc->sc_bustag->sparc_bus_map)(t, paddr, size,
512 flags, 0, hp));
513 }
514
515 return (EINVAL);
516 }
517
518 paddr_t
519 pyro_bus_mmap(bus_space_tag_t t, bus_addr_t paddr,
520 off_t off, int prot, int flags)
521 {
522 bus_addr_t offset = paddr;
523 struct pyro_pbm *pbm = t->cookie;
524 struct pyro_softc *sc = pbm->pp_sc;
525 int i, ss;
526
527 ss = sparc_pci_childspace(t->type);
528
529 DPRINTF(PDB_BUSMAP, ("pyro_bus_mmap: prot %d flags %d pa %qx\n",
530 prot, flags, (unsigned long long)paddr));
531
532 if (t->parent == 0 || t->parent->sparc_bus_mmap == 0) {
533 printf("\n_pyro_bus_mmap: invalid parent");
534 return (-1);
535 }
536
537 for (i = 0; i < pbm->pp_nrange; i++) {
538 struct pyro_range *pr = &pbm->pp_range[i];
539
540 if (((pr->cspace >> 24) & 0x03) != ss)
541 continue;
542
543 paddr = BUS_ADDR(pr->phys_hi, pr->phys_lo + offset);
544 return (bus_space_mmap(sc->sc_bustag, paddr, off,
545 prot, flags));
546 }
547
548 return (-1);
549 }
550
551 void *
552 pyro_intr_establish(bus_space_tag_t t, int ihandle, int level,
553 int (*handler)(void *), void *arg, void (*fastvec)(void) /* ignored */)
554 {
555 struct pyro_pbm *pbm = t->cookie;
556 struct pyro_softc *sc = pbm->pp_sc;
557 struct intrhand *ih = NULL;
558 volatile u_int64_t *intrmapptr = NULL, *intrclrptr = NULL;
559 u_int64_t *imapbase, *iclrbase;
560 int ino;
561
562 ino = INTINO(ihandle);
563 DPRINTF(PDB_INTR, ("%s: ih %lx; level %d ino %#x", __func__, (u_long)ihandle, level, ino));
564
565 if (level == IPL_NONE)
566 level = INTLEV(ihandle);
567 if (level == IPL_NONE) {
568 printf(": no IPL, setting IPL 2.\n");
569 level = 2;
570 }
571
572 imapbase = (uint64_t *)((uintptr_t)bus_space_vaddr(sc->sc_bustag, sc->sc_csrh) + 0x1000);
573 iclrbase = (uint64_t *)((uintptr_t)bus_space_vaddr(sc->sc_bustag, sc->sc_csrh) + 0x1400);
574 intrmapptr = &imapbase[ino];
575 intrclrptr = &iclrbase[ino];
576 DPRINTF(PDB_INTR, (" mapptr %p clrptr %p\n", intrmapptr, intrclrptr));
577
578 ino |= INTVEC(ihandle);
579
580 ih = malloc(sizeof *ih, M_DEVBUF, M_NOWAIT);
581 if (ih == NULL)
582 return (NULL);
583
584 /* Register the map and clear intr registers */
585 ih->ih_map = intrmapptr;
586 ih->ih_clr = intrclrptr;
587
588 ih->ih_ivec = ihandle;
589 ih->ih_fun = handler;
590 ih->ih_arg = arg;
591 ih->ih_pil = level;
592 ih->ih_number = ino;
593 ih->ih_pending = 0;
594
595 intr_establish(ih->ih_pil, level != IPL_VM, ih);
596
597 if (intrmapptr != NULL) {
598 u_int64_t imap;
599
600 imap = *intrmapptr;
601 DPRINTF(PDB_INTR, ("%s: read intrmap = %016qx", __func__,
602 (unsigned long long)imap));
603 imap &= ~FIRE_INTRMAP_INT_CNTRL_NUM_MASK;
604 imap |= FIRE_INTRMAP_INT_CNTRL_NUM0;
605 DPRINTF(PDB_INTR, ("; set intr group intrmap = %016qx",
606 (unsigned long long)imap));
607 if (sc->sc_oberon) {
608 imap &= ~OBERON_INTRMAP_T_DESTID_MASK;
609 imap |= CPU_JUPITERID <<
610 OBERON_INTRMAP_T_DESTID_SHIFT;
611 } else {
612 imap &= ~FIRE_INTRMAP_T_JPID_MASK;
613 imap |= CPU_UPAID << FIRE_INTRMAP_T_JPID_SHIFT;
614 }
615 DPRINTF(PDB_INTR, ("; set cpuid num intrmap = %016qx",
616 (unsigned long long)imap));
617 imap |= INTMAP_V;
618 *intrmapptr = imap;
619 DPRINTF(PDB_INTR, ("; writing intrmap = %016qx",
620 (unsigned long long)imap));
621 imap = *intrmapptr;
622 ih->ih_number |= imap & INTMAP_INR;
623 DPRINTF(PDB_INTR, ("; reread intrmap = %016qx, "
624 "set ih_number to %x\n",
625 (unsigned long long)imap, ih->ih_number));
626 }
627 if (intrclrptr) {
628 /* set state to IDLE */
629 *intrclrptr = 0;
630 }
631
632 return (ih);
633 }
634
635 static void *
636 pyro_pci_intr_establish(pci_chipset_tag_t pc, pci_intr_handle_t ih, int level,
637 int (*func)(void *), void *arg)
638 {
639 void *cookie;
640 struct pyro_pbm *pbm = (struct pyro_pbm *)pc->cookie;
641
642 DPRINTF(PDB_INTR, ("%s: ih %lx; level %d\n", __func__, (u_long)ih, level));
643 cookie = bus_intr_establish(pbm->pp_memt, ih, level, func, arg);
644
645 DPRINTF(PDB_INTR, ("%s: returning handle %p\n", __func__, cookie));
646 return (cookie);
647 }
648