#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: fhc_central.c,v 1.3 2012/03/18 05:26:58 mrg Exp $");
#include <sys/types.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/conf.h>
#include <sys/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(device_t, cfdata_t, void *);
void fhc_central_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(fhc_central, sizeof(struct fhc_softc),
fhc_central_match, fhc_central_attach, NULL, NULL);
int
fhc_central_match(device_t parent, cfdata_t match, void *aux)
{
struct central_attach_args *ca = aux;
if (strcmp(ca->ca_name, "fhc") == 0)
return (1);
return (0);
}
void
fhc_central_attach(device_t parent, device_t self, void *aux)
{
struct fhc_softc *sc = device_private(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);
sc->sc_dev = self;
fhc_attach(sc);
return;
}