#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: pckbc_pbus.c,v 1.5 2020/11/21 15:42:20 thorpej Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/kmem.h>
#include <machine/intr.h>
#include <machine/walnut.h>
#include <arch/walnut/dev/pbusvar.h>
#include <powerpc/ibm4xx/dev/plbvar.h>
#include <dev/ic/i8042reg.h>
#include <dev/ic/pckbcvar.h>
struct pckbc_pbus_softc {
struct pckbc_softc sc_pckbc;
int sc_irq[PCKBC_NSLOTS];
};
static int pckbc_pbus_probe(device_t, cfdata_t, void *);
static void pckbc_pbus_attach(device_t, device_t, void *);
static void pckbc_pbus_intr_establish(struct pckbc_softc *, pckbc_slot_t);
CFATTACH_DECL_NEW(pckbc_pbus, sizeof(struct pckbc_pbus_softc),
pckbc_pbus_probe, pckbc_pbus_attach, NULL, NULL);
int pckbcfound = 0;
int
pckbc_pbus_probe(device_t parent, cfdata_t cf, void *aux)
{
struct pbus_attach_args *paa = aux;
if (strcmp(paa->pb_name, cf->cf_name) != 0)
return 0;
return (pckbcfound < 1);
}
struct pckbc_softc *pckbc0;
void
pckbc_pbus_attach(device_t parent, device_t self, void *aux)
{
struct pckbc_pbus_softc *msc = device_private(self);
struct pckbc_softc *sc = &msc->sc_pckbc;
struct pbus_attach_args *paa = aux;
struct pckbc_internal *t;
bus_space_handle_t ioh_d, ioh_c;
bus_space_tag_t iot = paa->pb_bt;
u_long addr = paa->pb_addr;
sc->sc_dv = self;
msc->sc_irq[PCKBC_KBD_SLOT] = paa->pb_irq;
msc->sc_irq[PCKBC_AUX_SLOT] = paa->pb_irq + 1;
sc->intr_establish = pckbc_pbus_intr_establish;
if (pckbc_is_console(iot, addr)) {
t = &pckbc_consdata;
pckbc_console_attached = 1;
} else {
if (bus_space_map(iot, addr + KEY_MOUSE_DATA, 1, 0, &ioh_d) ||
bus_space_map(iot, addr + KEY_MOUSE_CMD, 1, 0, &ioh_c))
panic("pckbc_attach: couldn't map");
t = kmem_zalloc(sizeof(struct pckbc_internal), KM_SLEEP);
t->t_iot = iot;
t->t_ioh_d = ioh_d;
t->t_ioh_c = ioh_c;
t->t_addr = addr;
t->t_cmdbyte = KC8_CPU;
}
t->t_sc = sc;
sc->id = t;
aprint_normal("\n");
pckbc_attach(sc);
pckbcfound++;
return;
}
static void
pckbc_pbus_intr_establish(struct pckbc_softc *sc, pckbc_slot_t slot)
{
struct pckbc_pbus_softc *msc = (void *)sc;
int irq = msc->sc_irq[slot];
if (slot > PCKBC_NSLOTS) {
aprint_error("pckbc_pbus_intr_establish: attempt to establish "
"interrupt at slot %d\n", slot);
return;
}
intr_establish(irq, IST_LEVEL, IPL_SERIAL, pckbcintr, sc);
aprint_normal_dev(sc->sc_dv, "%s slot interrupting at irq %d\n",
pckbc_slot_names[slot], irq);
}