1 /* $NetBSD: vpci.c,v 1.11 2021/05/10 23:53:44 thorpej Exp $ */ 2 /* 3 * Copyright (c) 2015 Palle Lyckegaard 4 * All rights reserved. 5 * 6 * Driver for virtual PCIe host bridge on sun4v systems. 7 * 8 * Based on NetBSD pyro and OpenBSD vpci drivers. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 20 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 21 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 22 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 23 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 24 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 25 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 27 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 28 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 #include <sys/cdefs.h> 33 __KERNEL_RCSID(0, "$NetBSD: vpci.c,v 1.11 2021/05/10 23:53:44 thorpej Exp $"); 34 35 #include <sys/param.h> 36 #include <sys/device.h> 37 #include <sys/errno.h> 38 #include <sys/malloc.h> 39 #include <sys/kmem.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/vpcivar.h> 56 57 #include <machine/hypervisor.h> 58 59 #ifdef DEBUG 60 #define VDB_PROM 0x01 61 #define VDB_BUSMAP 0x02 62 #define VDB_INTR 0x04 63 #define VDB_CONF_READ 0x08 64 #define VDB_CONF_WRITE 0x10 65 #define VDB_CONF VDB_CONF_READ|VDB_CONF_WRITE 66 int vpci_debug = 0x00; 67 #define DPRINTF(l, s) do { if (vpci_debug & l) printf s; } while (0) 68 #else 69 #define DPRINTF(l, s) 70 #endif 71 72 #if 0 73 FIXME 74 #define FIRE_RESET_GEN 0x7010 75 76 #define FIRE_RESET_GEN_XIR 0x0000000000000002L 77 78 #define FIRE_INTRMAP_INT_CNTRL_NUM_MASK 0x000003c0 79 #define FIRE_INTRMAP_INT_CNTRL_NUM0 0x00000040 80 #define FIRE_INTRMAP_INT_CNTRL_NUM1 0x00000080 81 #define FIRE_INTRMAP_INT_CNTRL_NUM2 0x00000100 82 #define FIRE_INTRMAP_INT_CNTRL_NUM3 0x00000200 83 #define FIRE_INTRMAP_T_JPID_SHIFT 26 84 #define FIRE_INTRMAP_T_JPID_MASK 0x7c000000 85 86 #define OBERON_INTRMAP_T_DESTID_SHIFT 21 87 #define OBERON_INTRMAP_T_DESTID_MASK 0x7fe00000 88 #endif 89 90 extern struct sparc_pci_chipset _sparc_pci_chipset; 91 92 int vpci_match(device_t, cfdata_t, void *); 93 void vpci_attach(device_t, device_t, void *); 94 int vpci_print(void *, const char *); 95 96 CFATTACH_DECL_NEW(vpci, sizeof(struct vpci_softc), 97 vpci_match, vpci_attach, NULL, NULL); 98 99 void vpci_init(struct vpci_softc */*FIXME, int*/, struct mainbus_attach_args *); 100 void vpci_init_iommu(struct vpci_softc *, struct vpci_pbm *); 101 pci_chipset_tag_t vpci_alloc_chipset(struct vpci_pbm *, int, 102 pci_chipset_tag_t); 103 bus_space_tag_t vpci_alloc_mem_tag(struct vpci_pbm *); 104 bus_space_tag_t vpci_alloc_io_tag(struct vpci_pbm *); 105 bus_space_tag_t vpci_alloc_config_tag(struct vpci_pbm *); 106 bus_space_tag_t vpci_alloc_bus_tag(struct vpci_pbm *, const char *, int); 107 bus_dma_tag_t vpci_alloc_dma_tag(struct vpci_pbm *); 108 109 #if 0 110 int vpci_conf_size(pci_chipset_tag_t, pcitag_t); 111 #endif 112 pcireg_t vpci_conf_read(pci_chipset_tag_t, pcitag_t, int); 113 void vpci_conf_write(pci_chipset_tag_t, pcitag_t, int, pcireg_t); 114 115 static void * vpci_pci_intr_establish(pci_chipset_tag_t pc, 116 pci_intr_handle_t ih, int level, 117 int (*func)(void *), void *arg); 118 void vpci_intr_ack(struct intrhand *); 119 int vpci_intr_map(const struct pci_attach_args *, pci_intr_handle_t *); 120 int vpci_bus_map(bus_space_tag_t, bus_addr_t, 121 bus_size_t, int, vaddr_t, bus_space_handle_t *); 122 paddr_t vpci_bus_mmap(bus_space_tag_t, bus_addr_t, off_t, 123 int, int); 124 void *vpci_intr_establish(bus_space_tag_t, int, int, 125 int (*)(void *), void *, void (*)(void)); 126 127 int vpci_dmamap_create(bus_dma_tag_t, bus_size_t, int, 128 bus_size_t, bus_size_t, int, bus_dmamap_t *); 129 130 int 131 vpci_match(device_t parent, cfdata_t match, void *aux) 132 { 133 struct mainbus_attach_args *ma = aux; 134 char compat[32]; 135 136 if (strcmp(ma->ma_name, "pci") != 0) 137 return (0); 138 139 if (OF_getprop(ma->ma_node, "compatible", compat, sizeof(compat)) == -1) 140 return (0); 141 142 if (strcmp(compat, "SUNW,sun4v-pci") == 0) 143 return (1); 144 145 return (0); 146 } 147 148 void 149 vpci_attach(device_t parent, device_t self, void *aux) 150 { 151 struct vpci_softc *sc = device_private(self); 152 struct mainbus_attach_args *ma = aux; 153 #if 0 154 FIXME 155 char *str; 156 int busa; 157 #endif 158 sc->sc_dev = self; 159 sc->sc_node = ma->ma_node; 160 sc->sc_dmat = ma->ma_dmatag; 161 sc->sc_bustag = ma->ma_bustag; 162 sc->sc_csr = ma->ma_reg[0].ur_paddr; 163 #if 0 164 FIXME 165 sc->sc_xbc = ma->ma_reg[1].ur_paddr; 166 sc->sc_ign = INTIGN(ma->ma_upaid << INTMAP_IGN_SHIFT); 167 168 if ((ma->ma_reg[0].ur_paddr & 0x00700000) == 0x00600000) 169 busa = 1; 170 else 171 busa = 0; 172 #endif 173 #if 0 174 FIXME 175 if (bus_space_map(sc->sc_bustag, sc->sc_csr, 176 ma->ma_reg[0].ur_len, BUS_SPACE_MAP_LINEAR, &sc->sc_csrh)) { 177 printf(": failed to map csr registers\n"); 178 return; 179 } 180 #endif 181 #if 0 182 FIXME 183 if (bus_space_map(sc->sc_bustag, sc->sc_xbc, 184 ma->ma_reg[1].ur_len, 0, &sc->sc_xbch)) { 185 printf(": failed to map xbc registers\n"); 186 return; 187 } 188 189 str = prom_getpropstring(ma->ma_node, "compatible"); 190 if (strcmp(str, "pciex108e,80f8") == 0) 191 sc->sc_oberon = 1; 192 193 #endif 194 vpci_init(sc/*FIXME, busa*/, ma); 195 } 196 197 void 198 vpci_init(struct vpci_softc *sc/*FIXME, int busa*/, struct mainbus_attach_args *ma) 199 { 200 struct vpci_pbm *pbm; 201 struct pcibus_attach_args pba; 202 int *busranges = NULL, nranges; 203 204 pbm = kmem_zalloc(sizeof(*pbm), KM_SLEEP); 205 pbm->vp_sc = sc; 206 pbm->vp_devhandle = (ma->ma_reg[0].ur_paddr >> 32) & 0x0fffffff; 207 #if 0 208 FiXME 209 pbm->vp_bus_a = busa; 210 #endif 211 212 if (prom_getprop(sc->sc_node, "ranges", sizeof(struct vpci_range), 213 &pbm->vp_nrange, (void **)&pbm->vp_range)) 214 panic("vpci: can't get ranges"); 215 for (int range = 0; range < pbm->vp_nrange; range++) 216 DPRINTF(VDB_PROM, 217 ("\nvpci_attach: range %d cspace %08x " 218 "child_hi %08x child_lo %08x phys_hi %08x phys_lo %08x " 219 "size_hi %08x size_lo %08x", range, 220 pbm->vp_range[range].cspace, 221 pbm->vp_range[range].child_hi, 222 pbm->vp_range[range].child_lo, 223 pbm->vp_range[range].phys_hi, 224 pbm->vp_range[range].phys_lo, 225 pbm->vp_range[range].size_hi, 226 pbm->vp_range[range].size_lo)); 227 228 if (prom_getprop(sc->sc_node, "bus-range", sizeof(int), &nranges, 229 (void **)&busranges)) 230 panic("vpci: can't get bus-range"); 231 for (int range = 0; range < nranges; range++) 232 DPRINTF(VDB_PROM, ("\nvpci_attach: bus-range %d %08x", range, busranges[range])); 233 234 aprint_normal(": bus %d to %d", busranges[0], busranges[1]); 235 236 vpci_init_iommu(sc, pbm); 237 238 pbm->vp_memt = vpci_alloc_mem_tag(pbm); 239 pbm->vp_iot = vpci_alloc_io_tag(pbm); 240 pbm->vp_cfgt = vpci_alloc_config_tag(pbm); 241 pbm->vp_dmat = vpci_alloc_dma_tag(pbm); 242 pbm->vp_flags = (pbm->vp_memt ? PCI_FLAGS_MEM_OKAY : 0) | 243 (pbm->vp_iot ? PCI_FLAGS_IO_OKAY : 0); 244 #if 0 245 FIXME 246 if (bus_space_map(pbm->vp_cfgt, 0, 0x10000000, 0, &pbm->vp_cfgh)) 247 panic("vpci: can't map config space"); 248 #endif 249 pbm->vp_pc = vpci_alloc_chipset(pbm, sc->sc_node, &_sparc_pci_chipset); 250 pbm->vp_pc->spc_busmax = busranges[1]; 251 pbm->vp_pc->spc_busnode = kmem_zalloc(sizeof(*pbm->vp_pc->spc_busnode), 252 KM_SLEEP); 253 254 #if 0 255 pbm->vp_pc->bustag = pbm->vp_cfgt; 256 pbm->vp_pc->bushandle = pbm->vp_cfgh; 257 #endif 258 259 bzero(&pba, sizeof(pba)); 260 pba.pba_bus = busranges[0]; 261 pba.pba_pc = pbm->vp_pc; 262 pba.pba_flags = pbm->vp_flags; 263 pba.pba_dmat = pbm->vp_dmat; 264 pba.pba_dmat64 = NULL; /* XXX */ 265 pba.pba_memt = pbm->vp_memt; 266 pba.pba_iot = pbm->vp_iot; 267 268 free(busranges, M_DEVBUF); 269 270 config_found(sc->sc_dev, &pba, vpci_print, 271 CFARG_DEVHANDLE, prom_node_to_devhandle(sc->sc_node), 272 CFARG_EOL); 273 } 274 275 void 276 vpci_init_iommu(struct vpci_softc *sc, struct vpci_pbm *pbm) 277 { 278 struct iommu_state *is = &pbm->vp_is; 279 int *vdma = NULL; 280 int nitem; 281 int tsbsize = 0; 282 u_int32_t iobase = -1; 283 u_int32_t iolen = 0; 284 char *name; 285 286 pbm->vp_sb.sb_is = is; 287 is->is_bustag = sc->sc_bustag; 288 289 if (bus_space_subregion(is->is_bustag, sc->sc_csrh, 290 0x40000, 0x100, &is->is_iommu)) { 291 panic("vpci: unable to create iommu handle"); 292 } 293 294 /* Construct tsbsize */ 295 if (!prom_getprop(sc->sc_node, "virtual-dma", sizeof(vdma), &nitem, 296 (void **)&vdma)) { 297 DPRINTF(VDB_BUSMAP, ("vpci_init_iommu: vdma[0]=0x%x vdma[1]=0x%x\n", 298 vdma[0], vdma[1])); 299 iobase = vdma[0]; 300 iolen = vdma[1]; 301 for (tsbsize = 8; (1 << (tsbsize+23)) > iolen;) 302 tsbsize--; 303 DPRINTF(VDB_BUSMAP, ("vpci_init_iommu: iobase=0x%x iolen = 0x%x tsbsize=0x%x\n", 304 iobase, iolen, tsbsize)); 305 free(vdma, M_DEVBUF); 306 } else 307 panic("vpci_init_iommu: getprop virtual-dma failed"); 308 309 aprint_normal(" vdma %x length %x\n", iobase, iolen); 310 aprint_naive("\n"); 311 312 /* We have no STC. */ 313 is->is_sb[0] = NULL; 314 315 name = kmem_asprintf("%s dvma", device_xname(sc->sc_dev)); 316 317 /* Tell iommu how to set the TSB size. */ 318 is->is_flags = IOMMU_TSBSIZE_IN_PTSB; 319 320 is->is_devhandle = pbm->vp_devhandle; 321 iommu_init(name, is, tsbsize, iobase); 322 } 323 324 325 int 326 vpci_print(void *aux, const char *p) 327 { 328 if (p == NULL) 329 return (UNCONF); 330 return (QUIET); 331 } 332 333 pcireg_t 334 vpci_conf_read(pci_chipset_tag_t pc, pcitag_t tag, int reg) 335 { 336 struct vpci_pbm *pbm = pc->cookie; 337 uint64_t error_flag, data; 338 339 int64_t hv_rc; 340 DPRINTF(VDB_CONF_READ, ("%s: tag %lx reg %x ", __func__, (long)tag, reg)); 341 hv_rc = hv_pci_config_get(pbm->vp_devhandle, PCITAG_OFFSET(tag), reg, 4, 342 &error_flag, &data); 343 if (hv_rc != H_EOK) 344 panic("hv_pci_config_get() failed - rc = %" PRId64 "\n", 345 hv_rc); 346 347 pcireg_t val = error_flag ? (pcireg_t)~0 : data; 348 DPRINTF(VDB_CONF_READ, (" returning %08x\n", (u_int)val)); 349 return val; 350 } 351 352 void 353 vpci_conf_write(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t data) 354 { 355 356 struct vpci_pbm *pbm = pc->cookie; 357 uint64_t error_flag; 358 int64_t hv_rc; 359 DPRINTF(VDB_CONF_WRITE, ("%s: tag %lx; reg %x; data %x", __func__, 360 (long)tag, reg, (int)data)); 361 hv_rc = hv_pci_config_put(pbm->vp_devhandle, PCITAG_OFFSET(tag), reg, 4, 362 data, &error_flag); 363 if (hv_rc != H_EOK) 364 panic("hv_pci_config_put() failed - rc = %" PRId64 "\n", 365 hv_rc); 366 DPRINTF(VDB_CONF_WRITE, (" .. done\n")); 367 } 368 369 /* 370 * Bus-specific interrupt mapping 371 */ 372 int 373 vpci_intr_map(const struct pci_attach_args *pa, pci_intr_handle_t *ihp) 374 { 375 struct vpci_pbm *pbm = pa->pa_pc->cookie; 376 uint64_t devhandle = pbm->vp_devhandle; 377 uint64_t devino = INTINO(*ihp); 378 DPRINTF(VDB_INTR, ("vpci_intr_map(): devino 0x%lx\n", devino)); 379 uint64_t sysino; 380 int err; 381 382 if (*ihp != (pci_intr_handle_t)-1) { 383 err = hv_intr_devino_to_sysino(devhandle, devino, &sysino); 384 if (err != H_EOK) 385 return (-1); 386 387 KASSERT(sysino == INTVEC(sysino)); 388 *ihp = sysino; 389 DPRINTF(VDB_INTR, ("vpci_intr_map(): sysino 0x%lx\n", sysino)); 390 return (0); 391 } 392 393 return (-1); 394 } 395 396 bus_space_tag_t 397 vpci_alloc_mem_tag(struct vpci_pbm *vp) 398 { 399 return (vpci_alloc_bus_tag(vp, "mem", PCI_MEMORY_BUS_SPACE)); 400 } 401 402 bus_space_tag_t 403 vpci_alloc_io_tag(struct vpci_pbm *vp) 404 { 405 return (vpci_alloc_bus_tag(vp, "io", PCI_IO_BUS_SPACE)); 406 } 407 408 bus_space_tag_t 409 vpci_alloc_config_tag(struct vpci_pbm *vp) 410 { 411 return (vpci_alloc_bus_tag(vp, "cfg", PCI_CONFIG_BUS_SPACE)); 412 } 413 414 bus_space_tag_t 415 vpci_alloc_bus_tag(struct vpci_pbm *pbm, const char *name, int type) 416 { 417 struct vpci_softc *sc = pbm->vp_sc; 418 struct sparc_bus_space_tag *bt; 419 420 bt = kmem_zalloc(sizeof(*bt), KM_SLEEP); 421 422 #if 0 423 snprintf(bt->name, sizeof(bt->name), "%s-pbm_%s(%d/%2.2x)", 424 device_xname(sc->sc_dev), name, ss, asi); 425 #endif 426 427 bt->cookie = pbm; 428 bt->parent = sc->sc_bustag; 429 bt->type = type; 430 bt->sparc_bus_map = vpci_bus_map; 431 bt->sparc_bus_mmap = vpci_bus_mmap; 432 bt->sparc_intr_establish = vpci_intr_establish; 433 return (bt); 434 } 435 436 bus_dma_tag_t 437 vpci_alloc_dma_tag(struct vpci_pbm *pbm) 438 { 439 struct vpci_softc *sc = pbm->vp_sc; 440 bus_dma_tag_t dt, pdt = sc->sc_dmat; 441 442 dt = kmem_zalloc(sizeof(*dt), KM_SLEEP); 443 dt->_cookie = pbm; 444 dt->_parent = pdt; 445 #define PCOPY(x) dt->x = pdt->x 446 dt->_dmamap_create = vpci_dmamap_create; 447 PCOPY(_dmamap_destroy); 448 dt->_dmamap_load = iommu_dvmamap_load; 449 PCOPY(_dmamap_load_mbuf); 450 PCOPY(_dmamap_load_uio); 451 dt->_dmamap_load_raw = iommu_dvmamap_load_raw; 452 dt->_dmamap_unload = iommu_dvmamap_unload; 453 dt->_dmamap_sync = iommu_dvmamap_sync; 454 dt->_dmamem_alloc = iommu_dvmamem_alloc; 455 dt->_dmamem_free = iommu_dvmamem_free; 456 dt->_dmamem_map = iommu_dvmamem_map; 457 dt->_dmamem_unmap = iommu_dvmamem_unmap; 458 PCOPY(_dmamem_mmap); 459 #undef PCOPY 460 return (dt); 461 } 462 463 pci_chipset_tag_t 464 vpci_alloc_chipset(struct vpci_pbm *pbm, int node, pci_chipset_tag_t pc) 465 { 466 pci_chipset_tag_t npc; 467 468 npc = kmem_alloc(sizeof *npc, KM_SLEEP); 469 memcpy(npc, pc, sizeof *pc); 470 npc->cookie = pbm; 471 npc->rootnode = node; 472 npc->spc_conf_read = vpci_conf_read; 473 npc->spc_conf_write = vpci_conf_write; 474 npc->spc_intr_map = vpci_intr_map; 475 npc->spc_intr_establish = vpci_pci_intr_establish; 476 npc->spc_find_ino = NULL; 477 return (npc); 478 } 479 480 int 481 vpci_dmamap_create(bus_dma_tag_t t, bus_size_t size, 482 int nsegments, bus_size_t maxsegsz, bus_size_t boundary, int flags, 483 bus_dmamap_t *dmamp) 484 { 485 struct vpci_pbm *pbm = t->_cookie; 486 int error; 487 488 error = bus_dmamap_create(t->_parent, size, nsegments, maxsegsz, 489 boundary, flags, dmamp); 490 if (error == 0) 491 (*dmamp)->_dm_cookie = &pbm->vp_sb; 492 return error; 493 } 494 495 int 496 vpci_bus_map(bus_space_tag_t t, bus_addr_t offset, 497 bus_size_t size, int flags, vaddr_t unused, bus_space_handle_t *hp) 498 { 499 struct vpci_pbm *pbm = t->cookie; 500 struct vpci_softc *sc = pbm->vp_sc; 501 int i, ss; 502 503 DPRINTF(VDB_BUSMAP, ("vpci_bus_map: type %d off %qx sz %qx flags %d", 504 t->type, 505 (unsigned long long)offset, 506 (unsigned long long)size, 507 flags)); 508 509 ss = sparc_pci_childspace(t->type); 510 DPRINTF(VDB_BUSMAP, (" cspace %d\n", ss)); 511 512 if (t->parent == 0 || t->parent->sparc_bus_map == 0) { 513 printf("\n_vpci_bus_map: invalid parent"); 514 return (EINVAL); 515 } 516 517 for (i = 0; i < pbm->vp_nrange; i++) { 518 bus_addr_t paddr; 519 struct vpci_range *pr = &pbm->vp_range[i]; 520 521 if (((pr->cspace >> 24) & 0x03) != ss) 522 continue; 523 524 paddr = BUS_ADDR(pr->phys_hi, pr->phys_lo + offset); 525 return ((*sc->sc_bustag->sparc_bus_map)(t, paddr, size, 526 flags, 0, hp)); 527 } 528 529 return (EINVAL); 530 } 531 532 paddr_t 533 vpci_bus_mmap(bus_space_tag_t t, bus_addr_t paddr, 534 off_t off, int prot, int flags) 535 { 536 bus_addr_t offset = paddr; 537 struct vpci_pbm *pbm = t->cookie; 538 struct vpci_softc *sc = pbm->vp_sc; 539 int i, ss; 540 541 ss = sparc_pci_childspace(t->type); 542 543 DPRINTF(VDB_BUSMAP, ("vpci_bus_mmap: prot %d flags %d pa %qx\n", 544 prot, flags, (unsigned long long)paddr)); 545 546 if (t->parent == 0 || t->parent->sparc_bus_mmap == 0) { 547 printf("\n_vpci_bus_mmap: invalid parent"); 548 return (-1); 549 } 550 551 for (i = 0; i < pbm->vp_nrange; i++) { 552 struct vpci_range *pr = &pbm->vp_range[i]; 553 554 if (((pr->cspace >> 24) & 0x03) != ss) 555 continue; 556 557 paddr = BUS_ADDR(pr->phys_hi, pr->phys_lo + offset); 558 return (bus_space_mmap(sc->sc_bustag, paddr, off, 559 prot, flags)); 560 } 561 562 return (-1); 563 } 564 565 void * 566 vpci_intr_establish(bus_space_tag_t t, int ihandle, int level, 567 int (*handler)(void *), void *arg, void (*fastvec)(void) /* ignored */) 568 { 569 struct intrhand *ih = NULL; 570 int ino; 571 572 ino = INTINO(ihandle); 573 DPRINTF(VDB_INTR, ("%s: ih %lx; level %d ino %#x\n", __func__, (u_long)ihandle, level, ino)); 574 575 if (level == IPL_NONE) { 576 level = INTLEV(ihandle); 577 printf(": IPL_NONE, setting IPL %d.\n", level); 578 } 579 if (level == IPL_NONE) { 580 level = 2; 581 printf(": no IPL, setting IPL 2.\n"); 582 } 583 584 ino |= INTVEC(ihandle); 585 DPRINTF(VDB_INTR, ("%s: ih %lx; level %d ino %#x\n", __func__, (u_long)ihandle, level, ino)); 586 587 ih = intrhand_alloc(); 588 589 ih->ih_ivec = ihandle; 590 ih->ih_fun = handler; 591 ih->ih_arg = arg; 592 ih->ih_pil = level; 593 ih->ih_number = ino; 594 ih->ih_pending = 0; 595 ih->ih_ack = vpci_intr_ack; 596 intr_establish(ih->ih_pil, level != IPL_VM, ih); 597 598 uint64_t sysino = INTVEC(ihandle); 599 DPRINTF(VDB_INTR, ("vpci_intr_establish(): sysino 0x%lx\n", sysino)); 600 601 int err; 602 603 err = hv_intr_settarget(sysino, cpus->ci_cpuid); 604 if (err != H_EOK) 605 printf("hv_intr_settarget(%lu, %u) failed - err = %d\n", 606 (long unsigned int)sysino, cpus->ci_cpuid, err); 607 608 /* Clear pending interrupts. */ 609 err = hv_intr_setstate(sysino, INTR_IDLE); 610 if (err != H_EOK) 611 printf("hv_intr_setstate(%lu, INTR_IDLE) failed - err = %d\n", 612 (long unsigned int)sysino, err); 613 614 err = hv_intr_setenabled(sysino, INTR_ENABLED); 615 if (err != H_EOK) 616 printf("hv_intr_setenabled(%lu) failed - err = %d\n", 617 (long unsigned int)sysino, err); 618 619 DPRINTF(VDB_INTR, ("%s() returning %p\n", __func__, ih)); 620 return (ih); 621 } 622 623 void 624 vpci_intr_ack(struct intrhand *ih) 625 { 626 int err; 627 err = hv_intr_setstate(ih->ih_number, INTR_IDLE); 628 if (err != H_EOK) 629 panic("%s(%u, INTR_IDLE) failed - err = %d\n", 630 __func__, ih->ih_number, err); 631 } 632 633 static void * 634 vpci_pci_intr_establish(pci_chipset_tag_t pc, pci_intr_handle_t ih, int level, 635 int (*func)(void *), void *arg) 636 { 637 void *cookie; 638 struct vpci_pbm *pbm = (struct vpci_pbm *)pc->cookie; 639 640 DPRINTF(VDB_INTR, ("%s: ih %lx; level %d\n", __func__, (u_long)ih, level)); 641 cookie = bus_intr_establish(pbm->vp_memt, ih, level, func, arg); 642 643 DPRINTF(VDB_INTR, ("%s: returning handle %p\n", __func__, cookie)); 644 return (cookie); 645 } 646