diff options
Diffstat (limited to 'sys/sparc64/fhc/fhc_central.c')
-rw-r--r-- | sys/sparc64/fhc/fhc_central.c | 125 |
1 files changed, 125 insertions, 0 deletions
diff --git a/sys/sparc64/fhc/fhc_central.c b/sys/sparc64/fhc/fhc_central.c new file mode 100644 index 000000000000..a1daee9bbe49 --- /dev/null +++ b/sys/sparc64/fhc/fhc_central.c @@ -0,0 +1,125 @@ +/*- + * Copyright (c) 2003 Jake Burkholder. + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + * $FreeBSD$ + */ + +#include <sys/param.h> +#include <sys/systm.h> +#include <sys/bus.h> +#include <sys/kernel.h> +#include <sys/malloc.h> + +#include <dev/ofw/openfirm.h> + +#include <machine/bus.h> +#include <machine/resource.h> + +#include <sys/rman.h> + +#include <sparc64/central/centralvar.h> +#include <sparc64/fhc/fhcreg.h> +#include <sparc64/fhc/fhcvar.h> +#include <sparc64/sbus/ofw_sbus.h> + +static int fhc_central_probe(device_t dev); +static int fhc_central_attach(device_t dev); + +static device_method_t fhc_central_methods[] = { + /* Device interface. */ + DEVMETHOD(device_probe, fhc_central_probe), + DEVMETHOD(device_attach, fhc_central_attach), + + /* Bus interface. */ + DEVMETHOD(bus_print_child, fhc_print_child), + DEVMETHOD(bus_probe_nomatch, fhc_probe_nomatch), + DEVMETHOD(bus_read_ivar, fhc_read_ivar), + DEVMETHOD(bus_write_ivar, fhc_write_ivar), + DEVMETHOD(bus_setup_intr, fhc_setup_intr), + DEVMETHOD(bus_teardown_intr, fhc_teardown_intr), + DEVMETHOD(bus_alloc_resource, fhc_alloc_resource), + DEVMETHOD(bus_release_resource, fhc_release_resource), + DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), + DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), + + { NULL, NULL } +}; + +static driver_t fhc_central_driver = { + "fhc", + fhc_central_methods, + sizeof(struct fhc_softc), +}; + +static devclass_t fhc_central_devclass; + +DRIVER_MODULE(fhc, central, fhc_central_driver, fhc_central_devclass, 0, 0); + +static int +fhc_central_probe(device_t dev) +{ + + if (strcmp(central_get_name(dev), "fhc") == 0) { + device_set_desc(dev, "fhc"); + return (fhc_probe(dev)); + } + return (ENXIO); +} + +static int +fhc_central_attach(device_t dev) +{ + struct sbus_regs *reg; + struct fhc_softc *sc; + bus_addr_t size; + bus_addr_t off; + phandle_t node; + int nreg; + int rid; + int i; + + sc = device_get_softc(dev); + node = central_get_node(dev); + sc->sc_node = node; + + nreg = OF_getprop_alloc(node, "reg", sizeof(*reg), (void **)®); + if (nreg != FHC_NREG) { + device_printf(dev, "can't get registers"); + return (ENXIO); + } + for (i = 0; i < nreg; i++) { + off = reg[i].sbr_offset; + size = reg[i].sbr_size; + rid = 0; + sc->sc_memres[i] = bus_alloc_resource(dev, SYS_RES_MEMORY, + &rid, off, off + size - 1, size, RF_ACTIVE); + if (sc->sc_memres[i] == NULL) + panic("fhc_central_attach: can't allocate registers"); + sc->sc_bt[i] = rman_get_bustag(sc->sc_memres[i]); + sc->sc_bh[i] = rman_get_bushandle(sc->sc_memres[i]); + } + free(reg, M_OFWPROP); + return (fhc_attach(dev)); +} |