1 1.24 thorpej /* $NetBSD: vrpciu.c,v 1.24 2021/08/07 16:18:54 thorpej Exp $ */ 2 1.1 enami 3 1.1 enami /*- 4 1.1 enami * Copyright (c) 2001 Enami Tsugutomo. 5 1.1 enami * All rights reserved. 6 1.1 enami * 7 1.1 enami * Redistribution and use in source and binary forms, with or without 8 1.1 enami * modification, are permitted provided that the following conditions 9 1.1 enami * are met: 10 1.1 enami * 1. Redistributions of source code must retain the above copyright 11 1.1 enami * notice, this list of conditions and the following disclaimer. 12 1.1 enami * 2. Redistributions in binary form must reproduce the above copyright 13 1.1 enami * notice, this list of conditions and the following disclaimer in the 14 1.1 enami * documentation and/or other materials provided with the distribution. 15 1.1 enami * 16 1.1 enami * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 17 1.1 enami * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18 1.1 enami * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19 1.1 enami * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 20 1.1 enami * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21 1.1 enami * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22 1.1 enami * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 1.1 enami * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24 1.1 enami * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.1 enami * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.1 enami * SUCH DAMAGE. 27 1.1 enami */ 28 1.14 lukem 29 1.14 lukem #include <sys/cdefs.h> 30 1.24 thorpej __KERNEL_RCSID(0, "$NetBSD: vrpciu.c,v 1.24 2021/08/07 16:18:54 thorpej Exp $"); 31 1.1 enami 32 1.1 enami #include <sys/param.h> 33 1.1 enami #include <sys/systm.h> 34 1.1 enami #include <sys/device.h> 35 1.1 enami 36 1.1 enami #include <machine/bus.h> 37 1.2 takemura #include <machine/bus_space_hpcmips.h> 38 1.2 takemura #include <machine/bus_dma_hpcmips.h> 39 1.4 takemura #include <machine/config_hook.h> 40 1.5 shin #include <machine/platid.h> 41 1.5 shin #include <machine/platid_mask.h> 42 1.1 enami 43 1.1 enami #include <dev/pci/pcivar.h> 44 1.3 takemura #include <dev/pci/pcidevs.h> 45 1.5 shin #include <dev/pci/pciidereg.h> 46 1.1 enami 47 1.1 enami #include <hpcmips/vr/icureg.h> 48 1.6 takemura #include <hpcmips/vr/vripif.h> 49 1.1 enami #include <hpcmips/vr/vrpciureg.h> 50 1.1 enami 51 1.1 enami #include "pci.h" 52 1.1 enami 53 1.1 enami #ifdef DEBUG 54 1.1 enami #define DPRINTF(args) printf args 55 1.1 enami #else 56 1.1 enami #define DPRINTF(args) 57 1.1 enami #endif 58 1.1 enami 59 1.1 enami struct vrpciu_softc { 60 1.20 chs device_t sc_dev; 61 1.1 enami 62 1.1 enami vrip_chipset_tag_t sc_vc; 63 1.1 enami bus_space_tag_t sc_iot; 64 1.1 enami bus_space_handle_t sc_ioh; 65 1.1 enami void *sc_ih; 66 1.1 enami 67 1.1 enami struct vrc4173bcu_softc *sc_bcu; /* vrc4173bcu */ 68 1.1 enami 69 1.1 enami struct hpcmips_pci_chipset sc_pc; 70 1.1 enami }; 71 1.1 enami 72 1.1 enami static void vrpciu_write(struct vrpciu_softc *, int, u_int32_t); 73 1.1 enami static u_int32_t 74 1.1 enami vrpciu_read(struct vrpciu_softc *, int); 75 1.1 enami #ifdef DEBUG 76 1.1 enami static void vrpciu_write_2(struct vrpciu_softc *, int, u_int16_t) 77 1.1 enami __attribute__((unused)); 78 1.1 enami static u_int16_t 79 1.1 enami vrpciu_read_2(struct vrpciu_softc *, int); 80 1.1 enami #endif 81 1.20 chs static int vrpciu_match(device_t, cfdata_t, void *); 82 1.20 chs static void vrpciu_attach(device_t, device_t, void *); 83 1.1 enami static int vrpciu_intr(void *); 84 1.20 chs static void vrpciu_attach_hook(device_t, device_t, 85 1.1 enami struct pcibus_attach_args *); 86 1.1 enami static int vrpciu_bus_maxdevs(pci_chipset_tag_t, int); 87 1.19 dyoung static int vrpciu_bus_devorder(pci_chipset_tag_t, int, uint8_t *, int); 88 1.1 enami static pcitag_t vrpciu_make_tag(pci_chipset_tag_t, int, int, int); 89 1.1 enami static void vrpciu_decompose_tag(pci_chipset_tag_t, pcitag_t, int *, int *, 90 1.1 enami int *); 91 1.1 enami static pcireg_t vrpciu_conf_read(pci_chipset_tag_t, pcitag_t, int); 92 1.1 enami static void vrpciu_conf_write(pci_chipset_tag_t, pcitag_t, int, pcireg_t); 93 1.20 chs static int vrpciu_intr_map(const struct pci_attach_args *, pci_intr_handle_t *); 94 1.21 christos static const char *vrpciu_intr_string(pci_chipset_tag_t, pci_intr_handle_t, 95 1.21 christos char *, size_t); 96 1.4 takemura static const struct evcnt *vrpciu_intr_evcnt(pci_chipset_tag_t, 97 1.4 takemura pci_intr_handle_t); 98 1.1 enami static void *vrpciu_intr_establish(pci_chipset_tag_t, pci_intr_handle_t, 99 1.1 enami int, int (*)(void *), void *); 100 1.1 enami static void vrpciu_intr_disestablish(pci_chipset_tag_t, void *); 101 1.1 enami 102 1.20 chs CFATTACH_DECL_NEW(vrpciu, sizeof(struct vrpciu_softc), 103 1.11 thorpej vrpciu_match, vrpciu_attach, NULL, NULL); 104 1.1 enami 105 1.1 enami static void 106 1.1 enami vrpciu_write(struct vrpciu_softc *sc, int offset, u_int32_t val) 107 1.1 enami { 108 1.1 enami 109 1.1 enami bus_space_write_4(sc->sc_iot, sc->sc_ioh, offset, val); 110 1.1 enami } 111 1.1 enami 112 1.1 enami static u_int32_t 113 1.1 enami vrpciu_read(struct vrpciu_softc *sc, int offset) 114 1.1 enami { 115 1.1 enami 116 1.1 enami return (bus_space_read_4(sc->sc_iot, sc->sc_ioh, offset)); 117 1.1 enami } 118 1.1 enami 119 1.1 enami #ifdef DEBUG 120 1.1 enami static void 121 1.1 enami vrpciu_write_2(struct vrpciu_softc *sc, int offset, u_int16_t val) 122 1.1 enami { 123 1.1 enami 124 1.1 enami bus_space_write_2(sc->sc_iot, sc->sc_ioh, offset, val); 125 1.1 enami } 126 1.1 enami 127 1.1 enami static u_int16_t 128 1.1 enami vrpciu_read_2(struct vrpciu_softc *sc, int offset) 129 1.1 enami { 130 1.1 enami 131 1.1 enami return (bus_space_read_2(sc->sc_iot, sc->sc_ioh, offset)); 132 1.1 enami } 133 1.1 enami #endif 134 1.1 enami 135 1.1 enami static int 136 1.20 chs vrpciu_match(device_t parent, cfdata_t match, void *aux) 137 1.1 enami { 138 1.1 enami 139 1.1 enami return (1); 140 1.1 enami } 141 1.1 enami 142 1.1 enami static void 143 1.20 chs vrpciu_attach(device_t parent, device_t self, void *aux) 144 1.1 enami { 145 1.20 chs struct vrpciu_softc *sc = device_private(self); 146 1.1 enami pci_chipset_tag_t pc = &sc->sc_pc; 147 1.1 enami struct vrip_attach_args *va = aux; 148 1.7 takemura #if defined(DEBUG) || NPCI > 0 149 1.7 takemura u_int32_t reg; 150 1.7 takemura #endif 151 1.7 takemura #if NPCI > 0 152 1.2 takemura struct bus_space_tag_hpcmips *iot; 153 1.2 takemura char tmpbuf[16]; 154 1.1 enami struct pcibus_attach_args pba; 155 1.1 enami #endif 156 1.1 enami 157 1.20 chs sc->sc_dev = self; 158 1.1 enami sc->sc_vc = va->va_vc; 159 1.1 enami sc->sc_iot = va->va_iot; 160 1.1 enami if (bus_space_map(sc->sc_iot, va->va_addr, va->va_size, 0, 161 1.1 enami &sc->sc_ioh)) { 162 1.1 enami printf(": couldn't map io space\n"); 163 1.1 enami return; 164 1.1 enami } 165 1.1 enami 166 1.6 takemura sc->sc_ih = vrip_intr_establish(va->va_vc, va->va_unit, 0, IPL_TTY, 167 1.1 enami vrpciu_intr, sc); 168 1.1 enami if (sc->sc_ih == NULL) { 169 1.1 enami printf(": couldn't establish interrupt\n"); 170 1.1 enami return; 171 1.1 enami } 172 1.1 enami 173 1.1 enami /* Enable level 2 interrupt */ 174 1.1 enami vrip_intr_setmask2(va->va_vc, sc->sc_ih, PCIINT_INT0, 1); 175 1.1 enami 176 1.1 enami printf("\n"); 177 1.1 enami 178 1.1 enami #ifdef DEBUG 179 1.1 enami #define DUMP_MAW(sc, name, reg) do { \ 180 1.20 chs printf("%s: %s =\t0x%08x\n", device_xname((sc)->sc_dev), \ 181 1.1 enami (name), (reg)); \ 182 1.1 enami printf("%s:\tIBA/MASK =\t0x%08x/0x%08x (0x%08x - 0x%08x)\n", \ 183 1.20 chs device_xname((sc)->sc_dev), \ 184 1.1 enami reg & VRPCIU_MAW_IBAMASK, VRPCIU_MAW_ADDRMASK(reg), \ 185 1.1 enami VRPCIU_MAW_ADDR(reg), \ 186 1.1 enami VRPCIU_MAW_ADDR(reg) + VRPCIU_MAW_SIZE(reg)); \ 187 1.20 chs printf("%s:\tWINEN =\t0x%08x\n", device_xname((sc)->sc_dev), \ 188 1.1 enami reg & VRPCIU_MAW_WINEN); \ 189 1.20 chs printf("%s:\tPCIADR =\t0x%08x\n", device_xname((sc)->sc_dev), \ 190 1.1 enami VRPCIU_MAW_PCIADDR(reg)); \ 191 1.1 enami } while (0) 192 1.20 chs #define DUMP_TAW(sc, name, reg) do { \ 193 1.20 chs printf("%s: %s =\t\t0x%08x\n", device_xname((sc)->sc_dev), \ 194 1.20 chs (name), (reg)); \ 195 1.20 chs printf("%s:\tMASK =\t0x%08x\n", device_xname((sc)->sc_dev), \ 196 1.20 chs VRPCIU_TAW_ADDRMASK(reg)); \ 197 1.20 chs printf("%s:\tWINEN =\t0x%08x\n", device_xname((sc)->sc_dev), \ 198 1.20 chs reg & VRPCIU_TAW_WINEN); \ 199 1.20 chs printf("%s:\tIBA =\t0x%08x\n", device_xname((sc)->sc_dev), \ 200 1.20 chs VRPCIU_TAW_IBA(reg)); \ 201 1.1 enami } while (0) 202 1.1 enami reg = vrpciu_read(sc, VRPCIU_MMAW1REG); 203 1.1 enami DUMP_MAW(sc, "MMAW1", reg); 204 1.1 enami reg = vrpciu_read(sc, VRPCIU_MMAW2REG); 205 1.1 enami DUMP_MAW(sc, "MMAW2", reg); 206 1.1 enami reg = vrpciu_read(sc, VRPCIU_TAW1REG); 207 1.1 enami DUMP_TAW(sc, "TAW1", reg); 208 1.1 enami reg = vrpciu_read(sc, VRPCIU_TAW2REG); 209 1.1 enami DUMP_TAW(sc, "TAW2", reg); 210 1.1 enami reg = vrpciu_read(sc, VRPCIU_MIOAWREG); 211 1.1 enami DUMP_MAW(sc, "MIOAW", reg); 212 1.20 chs printf("%s: BUSERRAD =\t0x%08x\n", device_xname(sc->sc_dev), 213 1.1 enami vrpciu_read(sc, VRPCIU_BUSERRADREG)); 214 1.20 chs printf("%s: INTCNTSTA =\t0x%08x\n", device_xname(sc->sc_dev), 215 1.1 enami vrpciu_read(sc, VRPCIU_INTCNTSTAREG)); 216 1.20 chs printf("%s: EXACC =\t0x%08x\n", device_xname(sc->sc_dev), 217 1.1 enami vrpciu_read(sc, VRPCIU_EXACCREG)); 218 1.20 chs printf("%s: RECONT =\t0x%08x\n", device_xname(sc->sc_dev), 219 1.1 enami vrpciu_read(sc, VRPCIU_RECONTREG)); 220 1.20 chs printf("%s: PCIEN =\t0x%08x\n", device_xname(sc->sc_dev), 221 1.1 enami vrpciu_read(sc, VRPCIU_ENREG)); 222 1.20 chs printf("%s: CLOCKSEL =\t0x%08x\n", device_xname(sc->sc_dev), 223 1.1 enami vrpciu_read(sc, VRPCIU_CLKSELREG)); 224 1.20 chs printf("%s: TRDYV =\t0x%08x\n", device_xname(sc->sc_dev), 225 1.1 enami vrpciu_read(sc, VRPCIU_TRDYVREG)); 226 1.20 chs printf("%s: CLKRUN =\t0x%08x\n", device_xname(sc->sc_dev), 227 1.1 enami vrpciu_read_2(sc, VRPCIU_CLKRUNREG)); 228 1.20 chs printf("%s: IDREG =\t0x%08x\n", device_xname(sc->sc_dev), 229 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_ID_REG)); 230 1.1 enami reg = vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_COMMAND_STATUS_REG); 231 1.20 chs printf("%s: CSR =\t\t0x%08x\n", device_xname(sc->sc_dev), reg); 232 1.1 enami vrpciu_write(sc, VRPCIU_CONF_BASE + PCI_COMMAND_STATUS_REG, reg); 233 1.20 chs printf("%s: CSR =\t\t0x%08x\n", device_xname(sc->sc_dev), 234 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_COMMAND_STATUS_REG)); 235 1.20 chs printf("%s: CLASS =\t0x%08x\n", device_xname(sc->sc_dev), 236 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_CLASS_REG)); 237 1.20 chs printf("%s: BHLC =\t\t0x%08x\n", device_xname(sc->sc_dev), 238 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_BHLC_REG)); 239 1.20 chs printf("%s: MAIL =\t\t0x%08x\n", device_xname(sc->sc_dev), 240 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + VRPCIU_CONF_MAILREG)); 241 1.20 chs printf("%s: MBA1 =\t\t0x%08x\n", device_xname(sc->sc_dev), 242 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + VRPCIU_CONF_MBA1REG)); 243 1.20 chs printf("%s: MBA2 =\t\t0x%08x\n", device_xname(sc->sc_dev), 244 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + VRPCIU_CONF_MBA2REG)); 245 1.20 chs printf("%s: INTR =\t\t0x%08x\n", device_xname(sc->sc_dev), 246 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_INTERRUPT_REG)); 247 1.1 enami #if 0 248 1.1 enami vrpciu_write(sc, VRPCIU_CONF_BASE + PCI_INTERRUPT_REG, 249 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_INTERRUPT_REG) | 0x01); 250 1.20 chs printf("%s: INTR =\t\t0x%08x\n", device_xname(sc->sc_dev), 251 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_INTERRUPT_REG)); 252 1.1 enami #endif 253 1.1 enami #endif 254 1.1 enami 255 1.20 chs pc->pc_dev = sc->sc_dev; 256 1.1 enami pc->pc_attach_hook = vrpciu_attach_hook; 257 1.1 enami pc->pc_bus_maxdevs = vrpciu_bus_maxdevs; 258 1.3 takemura pc->pc_bus_devorder = vrpciu_bus_devorder; 259 1.1 enami pc->pc_make_tag = vrpciu_make_tag; 260 1.1 enami pc->pc_decompose_tag = vrpciu_decompose_tag; 261 1.1 enami pc->pc_conf_read = vrpciu_conf_read; 262 1.1 enami pc->pc_conf_write = vrpciu_conf_write; 263 1.4 takemura pc->pc_intr_map = vrpciu_intr_map; 264 1.4 takemura pc->pc_intr_string = vrpciu_intr_string; 265 1.4 takemura pc->pc_intr_evcnt = vrpciu_intr_evcnt; 266 1.1 enami pc->pc_intr_establish = vrpciu_intr_establish; 267 1.1 enami pc->pc_intr_disestablish = vrpciu_intr_disestablish; 268 1.1 enami 269 1.1 enami #if 0 270 1.1 enami { 271 1.1 enami int i; 272 1.1 enami 273 1.1 enami for (i = 0; i < 8; i++) 274 1.1 enami printf("%s: ID_REG(0, 0, %d) = 0x%08x\n", 275 1.20 chs device_xname(sc->sc_dev), i, 276 1.1 enami pci_conf_read(pc, pci_make_tag(pc, 0, 0, i), 277 1.1 enami PCI_ID_REG)); 278 1.1 enami } 279 1.1 enami #endif 280 1.1 enami 281 1.1 enami #if NPCI > 0 282 1.1 enami memset(&pba, 0, sizeof(pba)); 283 1.1 enami 284 1.1 enami /* For now, just inherit window mappings set by WinCE. XXX. */ 285 1.1 enami 286 1.2 takemura iot = hpcmips_alloc_bus_space_tag(); 287 1.1 enami reg = vrpciu_read(sc, VRPCIU_MIOAWREG); 288 1.2 takemura snprintf(tmpbuf, sizeof(tmpbuf), "%s/iot", 289 1.20 chs device_xname(sc->sc_dev)); 290 1.2 takemura hpcmips_init_bus_space(iot, (struct bus_space_tag_hpcmips *)sc->sc_iot, 291 1.2 takemura tmpbuf, VRPCIU_MAW_ADDR(reg), VRPCIU_MAW_SIZE(reg)); 292 1.2 takemura pba.pba_iot = &iot->bst; 293 1.1 enami 294 1.1 enami /* 295 1.1 enami * Just use system bus space tag. It works since WinCE maps 296 1.1 enami * PCI bus space at same offset. But this isn't right thing 297 1.1 enami * of course. XXX. 298 1.1 enami */ 299 1.1 enami pba.pba_memt = sc->sc_iot; 300 1.2 takemura pba.pba_dmat = &hpcmips_default_bus_dma_tag.bdt; 301 1.13 fvdl pba.pba_dmat64 = NULL; 302 1.1 enami pba.pba_bus = 0; 303 1.9 thorpej pba.pba_bridgetag = NULL; 304 1.5 shin 305 1.5 shin if (platid_match(&platid, &platid_mask_MACH_LASER5_L_BOARD)) { 306 1.5 shin /* 307 1.16 abs * fix PCI device configuration for L-Router. 308 1.5 shin */ 309 1.5 shin /* change IDE controller to native mode */ 310 1.5 shin reg = pci_conf_read(pc, pci_make_tag(pc, 0, 16, 0), 311 1.5 shin PCI_CLASS_REG); 312 1.5 shin reg |= PCIIDE_INTERFACE_PCI(0) << PCI_INTERFACE_SHIFT; 313 1.5 shin reg |= PCIIDE_INTERFACE_PCI(1) << PCI_INTERFACE_SHIFT; 314 1.5 shin pci_conf_write(pc, pci_make_tag(pc, 0, 16, 0), PCI_CLASS_REG, 315 1.5 shin reg); 316 1.5 shin /* fix broken BAR setting of fxp0, fxp1 */ 317 1.5 shin pci_conf_write(pc, pci_make_tag(pc, 0, 0, 0), PCI_MAPREG_START, 318 1.5 shin 0x11100000); 319 1.5 shin pci_conf_write(pc, pci_make_tag(pc, 0, 1, 0), PCI_MAPREG_START, 320 1.5 shin 0x11200000); 321 1.5 shin } 322 1.5 shin 323 1.18 dyoung pba.pba_flags = PCI_FLAGS_IO_OKAY | PCI_FLAGS_MEM_OKAY | 324 1.1 enami PCI_FLAGS_MRL_OKAY; 325 1.1 enami pba.pba_pc = pc; 326 1.1 enami 327 1.24 thorpej config_found(self, &pba, pcibusprint, CFARGS_NONE); 328 1.1 enami #endif 329 1.1 enami } 330 1.1 enami 331 1.1 enami /* 332 1.1 enami * Handle PCI error interrupts. 333 1.1 enami */ 334 1.1 enami int 335 1.1 enami vrpciu_intr(void *arg) 336 1.1 enami { 337 1.1 enami struct vrpciu_softc *sc = (struct vrpciu_softc *)arg; 338 1.8 takemura u_int32_t isr, baddr; 339 1.1 enami 340 1.1 enami isr = vrpciu_read(sc, VRPCIU_INTCNTSTAREG); 341 1.8 takemura baddr = vrpciu_read(sc, VRPCIU_BUSERRADREG); 342 1.8 takemura printf("%s: status=0x%08x bad addr=0x%08x\n", 343 1.20 chs device_xname(sc->sc_dev), isr, baddr); 344 1.1 enami return ((isr & 0x0f) ? 1 : 0); 345 1.1 enami } 346 1.1 enami 347 1.1 enami void 348 1.20 chs vrpciu_attach_hook(device_t parent, device_t self, 349 1.1 enami struct pcibus_attach_args *pba) 350 1.1 enami { 351 1.1 enami 352 1.1 enami return; 353 1.1 enami } 354 1.1 enami 355 1.1 enami int 356 1.1 enami vrpciu_bus_maxdevs(pci_chipset_tag_t pc, int busno) 357 1.1 enami { 358 1.1 enami 359 1.1 enami return (32); 360 1.1 enami } 361 1.1 enami 362 1.3 takemura int 363 1.19 dyoung vrpciu_bus_devorder(pci_chipset_tag_t pc, int busno, uint8_t *devs, int maxdevs) 364 1.3 takemura { 365 1.19 dyoung int dev, i, n; 366 1.19 dyoung uint8_t *devn; 367 1.3 takemura char priorities[32]; 368 1.3 takemura static pcireg_t ids[] = { 369 1.3 takemura /* these devices should be attached first */ 370 1.3 takemura PCI_ID_CODE(PCI_VENDOR_NEC, PCI_PRODUCT_NEC_VRC4173_BCU), 371 1.3 takemura }; 372 1.3 takemura 373 1.19 dyoung n = MIN(32, maxdevs); 374 1.19 dyoung if (n <= 0) 375 1.19 dyoung return 0; 376 1.19 dyoung 377 1.19 dyoung devn = devs + n; 378 1.19 dyoung 379 1.3 takemura /* scan PCI devices and check the id table */ 380 1.3 takemura memset(priorities, 0, sizeof(priorities)); 381 1.3 takemura for (dev = 0; dev < 32; dev++) { 382 1.3 takemura pcireg_t id; 383 1.19 dyoung id = pci_conf_read(pc, pci_make_tag(pc, 0, dev, 0), PCI_ID_REG); 384 1.19 dyoung for (i = 0; i < __arraycount(ids); i++) 385 1.3 takemura if (id == ids[i]) 386 1.3 takemura priorities[dev] = 1; 387 1.3 takemura } 388 1.3 takemura 389 1.3 takemura /* fill order array */ 390 1.19 dyoung for (i = 1; 0 <= i; i--) { 391 1.19 dyoung for (dev = 0; dev < 32; dev++) { 392 1.19 dyoung if (priorities[dev] == i && devs != devn) 393 1.3 takemura *devs++ = dev; 394 1.19 dyoung } 395 1.19 dyoung } 396 1.3 takemura 397 1.19 dyoung return n; 398 1.3 takemura } 399 1.3 takemura 400 1.1 enami pcitag_t 401 1.1 enami vrpciu_make_tag(pci_chipset_tag_t pc, int bus, int device, int function) 402 1.1 enami { 403 1.1 enami 404 1.1 enami return ((bus << 16) | (device << 11) | (function << 8)); 405 1.1 enami } 406 1.1 enami 407 1.1 enami void 408 1.1 enami vrpciu_decompose_tag(pci_chipset_tag_t pc, pcitag_t tag, int *bp, int *dp, 409 1.1 enami int *fp) 410 1.1 enami { 411 1.1 enami 412 1.1 enami if (bp != NULL) 413 1.1 enami *bp = (tag >> 16) & 0xff; 414 1.1 enami if (dp != NULL) 415 1.1 enami *dp = (tag >> 11) & 0x1f; 416 1.1 enami if (fp != NULL) 417 1.1 enami *fp = (tag >> 8) & 0x07; 418 1.1 enami } 419 1.1 enami 420 1.1 enami pcireg_t 421 1.1 enami vrpciu_conf_read(pci_chipset_tag_t pc, pcitag_t tag, int reg) 422 1.1 enami { 423 1.20 chs struct vrpciu_softc *sc = device_private(pc->pc_dev); 424 1.1 enami u_int32_t val; 425 1.1 enami int bus, device, function; 426 1.1 enami 427 1.22 msaitoh if ((unsigned int)reg >= PCI_CONF_SIZE) 428 1.22 msaitoh return ((pcireg_t) -1); 429 1.22 msaitoh 430 1.1 enami pci_decompose_tag(pc, tag, &bus, &device, &function); 431 1.1 enami if (bus == 0) { 432 1.1 enami if (device > 21) 433 1.1 enami return ((pcitag_t)-1); 434 1.1 enami tag = (1 << (device + 11)) | (function << 8); /* Type 0 */ 435 1.1 enami } else 436 1.1 enami tag |= VRPCIU_CONF_TYPE1; 437 1.1 enami 438 1.1 enami vrpciu_write(sc, VRPCIU_CONFAREG, tag | reg); 439 1.1 enami val = vrpciu_read(sc, VRPCIU_CONFDREG); 440 1.1 enami #if 0 441 1.1 enami printf("%s: conf_read: tag = 0x%08x, reg = 0x%x, val = 0x%08x\n", 442 1.20 chs device_xname(sc->sc_dev), (u_int32_t)tag, reg, val); 443 1.1 enami #endif 444 1.1 enami return (val); 445 1.1 enami } 446 1.1 enami 447 1.1 enami void 448 1.1 enami vrpciu_conf_write(pci_chipset_tag_t pc, pcitag_t tag, int reg, 449 1.1 enami pcireg_t data) 450 1.1 enami { 451 1.20 chs struct vrpciu_softc *sc = device_private(pc->pc_dev); 452 1.1 enami int bus, device, function; 453 1.1 enami 454 1.1 enami #if 0 455 1.1 enami printf("%s: conf_write: tag = 0x%08x, reg = 0x%x, val = 0x%08x\n", 456 1.20 chs device_xname(sc->sc_dev), (u_int32_t)tag, reg, (u_int32_t)data); 457 1.1 enami #endif 458 1.22 msaitoh 459 1.22 msaitoh if ((unsigned int)reg >= PCI_CONF_SIZE) 460 1.22 msaitoh return; 461 1.22 msaitoh 462 1.1 enami vrpciu_decompose_tag(pc, tag, &bus, &device, &function); 463 1.1 enami if (bus == 0) { 464 1.1 enami if (device > 21) 465 1.1 enami return; 466 1.1 enami tag = (1 << (device + 11)) | (function << 8); /* Type 0 */ 467 1.1 enami } else 468 1.1 enami tag |= VRPCIU_CONF_TYPE1; 469 1.1 enami 470 1.1 enami vrpciu_write(sc, VRPCIU_CONFAREG, tag | reg); 471 1.1 enami vrpciu_write(sc, VRPCIU_CONFDREG, data); 472 1.1 enami } 473 1.1 enami 474 1.4 takemura int 475 1.20 chs vrpciu_intr_map(const struct pci_attach_args *pa, pci_intr_handle_t *ihp) 476 1.4 takemura { 477 1.4 takemura pci_chipset_tag_t pc = pa->pa_pc; 478 1.4 takemura pcitag_t intrtag = pa->pa_intrtag; 479 1.4 takemura int bus, dev, func; 480 1.4 takemura #ifdef DEBUG 481 1.4 takemura int line = pa->pa_intrline; 482 1.4 takemura int pin = pa->pa_intrpin; 483 1.4 takemura #endif 484 1.4 takemura 485 1.4 takemura pci_decompose_tag(pc, intrtag, &bus, &dev, &func); 486 1.20 chs DPRINTF(("%s(%d, %d, %d): line = %d, pin = %d\n", device_xname(pc->pc_dev), 487 1.4 takemura bus, dev, func, line, pin)); 488 1.4 takemura 489 1.4 takemura *ihp = CONFIG_HOOK_PCIINTR_ID(bus, dev, func); 490 1.4 takemura 491 1.4 takemura return (0); 492 1.4 takemura } 493 1.4 takemura 494 1.4 takemura const char * 495 1.21 christos vrpciu_intr_string(pci_chipset_tag_t pc, pci_intr_handle_t ih, char *buf, 496 1.21 christos size_t len) 497 1.1 enami { 498 1.21 christos snprintf(buf, len, "pciintr %d:%d:%d", 499 1.4 takemura CONFIG_HOOK_PCIINTR_BUS((int)ih), 500 1.4 takemura CONFIG_HOOK_PCIINTR_DEVICE((int)ih), 501 1.4 takemura CONFIG_HOOK_PCIINTR_FUNCTION((int)ih)); 502 1.1 enami 503 1.21 christos return buf; 504 1.1 enami } 505 1.1 enami 506 1.4 takemura const struct evcnt * 507 1.4 takemura vrpciu_intr_evcnt(pci_chipset_tag_t pc, pci_intr_handle_t ih) 508 1.1 enami { 509 1.1 enami 510 1.4 takemura /* XXX for now, no evcnt parent reported */ 511 1.4 takemura 512 1.4 takemura return (NULL); 513 1.1 enami } 514 1.1 enami 515 1.1 enami void * 516 1.4 takemura vrpciu_intr_establish(pci_chipset_tag_t pc, pci_intr_handle_t ih, int level, 517 1.1 enami int (*func)(void *), void *arg) 518 1.1 enami { 519 1.1 enami 520 1.4 takemura if (ih == -1) 521 1.4 takemura return (NULL); 522 1.7 takemura DPRINTF(("vrpciu_intr_establish: %lx\n", ih)); 523 1.3 takemura 524 1.4 takemura return (config_hook(CONFIG_HOOK_PCIINTR, ih, CONFIG_HOOK_EXCLUSIVE, 525 1.4 takemura (int (*)(void *, int, long, void *))func, arg)); 526 1.1 enami } 527 1.1 enami 528 1.1 enami void 529 1.4 takemura vrpciu_intr_disestablish(pci_chipset_tag_t pc, void *cookie) 530 1.1 enami { 531 1.1 enami 532 1.7 takemura DPRINTF(("vrpciu_intr_disestablish: %p\n", cookie)); 533 1.4 takemura config_unhook(cookie); 534 1.1 enami } 535