예제 #1
0
static int
si_pci_attach(device_t dev)
{
    struct si_softc *sc;
    void *ih;
    int error;

    error = 0;
    ih = NULL;
    sc = device_get_softc(dev);

    switch (pci_get_devid(dev)) {
    case 0x400011cb:
        sc->sc_type = SIPCI;
        sc->sc_mem_rid = SIPCIBADR;
        break;
    case 0x200011cb:
        sc->sc_type = SIJETPCI;
        sc->sc_mem_rid = SIJETBADR;
        break;
    }

    sc->sc_mem_res = bus_alloc_resource(dev, SYS_RES_MEMORY,
                                        &sc->sc_mem_rid,
                                        0, ~0, 1, RF_ACTIVE);
    if (!sc->sc_mem_res) {
        device_printf(dev, "couldn't map memory\n");
        goto fail;
    }
    sc->sc_paddr = (caddr_t)rman_get_start(sc->sc_mem_res);
    sc->sc_maddr = rman_get_virtual(sc->sc_mem_res);

    sc->sc_irq_rid = 0;
    sc->sc_irq_res = bus_alloc_resource(dev, SYS_RES_IRQ, &sc->sc_irq_rid,
                                        0, ~0, 1, RF_ACTIVE | RF_SHAREABLE);
    if (!sc->sc_irq_res) {
        device_printf(dev, "couldn't map interrupt\n");
        goto fail;
    }
    sc->sc_irq = rman_get_start(sc->sc_irq_res);
    error = bus_setup_intr(dev, sc->sc_irq_res, INTR_MPSAFE, si_intr, sc, &ih, NULL);
    if (error) {
        device_printf(dev, "could not activate interrupt\n");
        goto fail;
    }

    error = siattach(dev);
    if (error)
        goto fail;
    return (0);		/* success */

fail:
    if (error == 0)
        error = ENXIO;
    if (sc->sc_irq_res) {
        if (ih)
            bus_teardown_intr(dev, sc->sc_irq_res, ih);
        bus_release_resource(dev, SYS_RES_IRQ,
                             sc->sc_irq_rid, sc->sc_irq_res);
        sc->sc_irq_res = 0;
    }
    if (sc->sc_mem_res) {
        bus_release_resource(dev, SYS_RES_MEMORY,
                             sc->sc_mem_rid, sc->sc_mem_res);
        sc->sc_mem_res = 0;
    }
    return (error);
}
예제 #2
0
static int
si_pci_attach(device_t dev)
{
	struct si_softc *sc;
	void *ih;
	int error;

	error = 0;
	ih = NULL;
	sc = device_get_softc(dev);

	switch (pci_get_devid(dev)) {
	case 0x400011cb:
		sc->sc_type = SIPCI;
		sc->sc_mem_rid = SIPCIBADR;
		break;
	case 0x200011cb:
		sc->sc_type = SIJETPCI;
		sc->sc_mem_rid = SIJETBADR;
		break;
	}

	sc->sc_mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
						&sc->sc_mem_rid,
						RF_ACTIVE);
	if (!sc->sc_mem_res) {
		device_printf(dev, "couldn't map memory\n");
		goto fail;
	}
	sc->sc_paddr = (caddr_t)rman_get_start(sc->sc_mem_res);
	sc->sc_maddr = rman_get_virtual(sc->sc_mem_res);

	sc->sc_irq_rid = 0;
	sc->sc_irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ,
						&sc->sc_irq_rid,
						RF_ACTIVE | RF_SHAREABLE);
	if (!sc->sc_irq_res) {
		device_printf(dev, "couldn't map interrupt\n");
		goto fail;
	}
	sc->sc_irq = rman_get_start(sc->sc_irq_res);
	error = bus_setup_intr(dev, sc->sc_irq_res, INTR_TYPE_TTY,
			       NULL, si_intr, sc, &ih);
	if (error) {
		device_printf(dev, "could not activate interrupt\n");
		goto fail;
	}

	if (pci_get_devid(dev) == 0x200011cb) {
		int rid;
		struct resource *plx_res;
		uint32_t *addr;
		uint32_t oldvalue;

		/* Perform a PLX control register fixup */
		rid = PCIR_BAR(0);
		plx_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
		    RF_ACTIVE);
		if (plx_res == NULL) {
			device_printf(dev, "couldn't map plx registers\n");
		} else {
			addr = rman_get_virtual(plx_res);
			oldvalue = addr[0x50 / 4];
			if (oldvalue != 0x18260000) {
				device_printf(dev, "PLX register 0x50: 0x%08x changed to 0x%08x\n", oldvalue, 0x18260000);
				addr[0x50 / 4] = 0x18260000;
			}
			bus_release_resource(dev, SYS_RES_MEMORY, rid, plx_res);
		}
	}

	error = siattach(dev);
	if (error)
		goto fail;
	return (0);		/* success */

fail:
	if (error == 0)
		error = ENXIO;
	if (sc->sc_irq_res) {
		if (ih)
			bus_teardown_intr(dev, sc->sc_irq_res, ih);
		bus_release_resource(dev, SYS_RES_IRQ,
				     sc->sc_irq_rid, sc->sc_irq_res);
		sc->sc_irq_res = 0;
	}
	if (sc->sc_mem_res) {
		bus_release_resource(dev, SYS_RES_MEMORY,
				     sc->sc_mem_rid, sc->sc_mem_res);
		sc->sc_mem_res = 0;
	}
	return (error);
}