#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/conf.h>
#include <sys/timeout.h>
#include <machine/bus.h>
#include <machine/autoconf.h>
#include <machine/openfirm.h>
#include <sparc64/dev/centralvar.h>
#include <sparc64/dev/fhcreg.h>
#include <sparc64/dev/fhcvar.h>
int fhc_central_match(struct device *, void *, void *);
void fhc_central_attach(struct device *, struct device *, void *);
const struct cfattach fhc_central_ca = {
sizeof(struct fhc_softc), fhc_central_match, fhc_central_attach
};
int
fhc_central_match(struct device *parent, void *match, void *aux)
{
struct central_attach_args *ca = aux;
if (strcmp(ca->ca_name, "fhc") == 0)
return (1);
return (0);
}
void
fhc_central_attach(struct device *parent, struct device *self, void *aux)
{
struct fhc_softc *sc = (struct fhc_softc *)self;
struct central_attach_args *ca = aux;
u_int32_t board;
sc->sc_node = ca->ca_node;
sc->sc_bt = ca->ca_bustag;
sc->sc_is_central = 1;
if (central_bus_map(sc->sc_bt, ca->ca_reg[0].cbr_slot,
ca->ca_reg[0].cbr_offset, ca->ca_reg[0].cbr_size, 0,
&sc->sc_preg)) {
printf(": failed to map preg\n");
return;
}
if (central_bus_map(sc->sc_bt, ca->ca_reg[1].cbr_slot,
ca->ca_reg[1].cbr_offset, ca->ca_reg[1].cbr_size, 0,
&sc->sc_ireg)) {
printf(": failed to map ireg\n");
return;
}
if (central_bus_map(sc->sc_bt, ca->ca_reg[2].cbr_slot,
ca->ca_reg[2].cbr_offset, ca->ca_reg[2].cbr_size,
BUS_SPACE_MAP_LINEAR, &sc->sc_freg)) {
printf(": failed to map freg\n");
return;
}
if (central_bus_map(sc->sc_bt, ca->ca_reg[3].cbr_slot,
ca->ca_reg[3].cbr_offset, ca->ca_reg[3].cbr_size,
BUS_SPACE_MAP_LINEAR, &sc->sc_sreg)) {
printf(": failed to map sreg\n");
return;
}
if (central_bus_map(sc->sc_bt, ca->ca_reg[4].cbr_slot,
ca->ca_reg[4].cbr_offset, ca->ca_reg[4].cbr_size,
BUS_SPACE_MAP_LINEAR, &sc->sc_ureg)) {
printf(": failed to map ureg\n");
return;
}
if (central_bus_map(sc->sc_bt, ca->ca_reg[5].cbr_slot,
ca->ca_reg[5].cbr_offset, ca->ca_reg[5].cbr_size,
BUS_SPACE_MAP_LINEAR, &sc->sc_treg)) {
printf(": failed to map treg\n");
return;
}
board = bus_space_read_4(sc->sc_bt, sc->sc_preg, FHC_P_BSR);
sc->sc_board = ((board >> 16) & 0x1) | ((board >> 12) & 0xe);
fhc_attach(sc);
return;
}