#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: kb_kbc.c,v 1.12 2021/08/07 16:19:00 thorpej Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <machine/bus.h>
#include <machine/cpu.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wskbdvar.h>
#include <dev/wscons/wsksymdef.h>
#include <dev/wscons/wsksymvar.h>
#include <news68k/dev/kbcreg.h>
#include <news68k/dev/kbcvar.h>
#include <news68k/dev/kbvar.h>
#include <news68k/news68k/isr.h>
static int kb_kbc_match(device_t, cfdata_t, void *);
static void kb_kbc_attach(device_t, device_t, void *);
static void kb_kbc_init(struct kb_softc *);
int kb_kbc_intr(void *);
int kb_kbc_cnattach(void);
CFATTACH_DECL_NEW(kb_kbc, sizeof(struct kb_softc),
kb_kbc_match, kb_kbc_attach, NULL, NULL);
struct console_softc kb_kbc_conssc;
static int
kb_kbc_match(device_t parent, cfdata_t cf, void *aux)
{
struct kbc_attach_args *ka = aux;
if (strcmp(ka->ka_name, "kb"))
return 0;
return 1;
}
static void
kb_kbc_attach(device_t parent, device_t self, void *aux)
{
struct kb_softc *sc = device_private(self);
struct kbc_attach_args *ka = aux;
struct wskbddev_attach_args wsa;
int ipl;
sc->sc_dev = self;
aprint_normal("\n");
sc->sc_bt = ka->ka_bt;
sc->sc_bh = ka->ka_bh;
sc->sc_offset = KBC_KBREG_DATA;
sc->sc_conssc = &kb_kbc_conssc;
ipl = ka->ka_ipl;
kb_kbc_init(sc);
isrlink_autovec(kb_kbc_intr, (void *)sc, ipl, IPL_TTY);
wsa.console = kb_kbc_conssc.cs_isconsole;
wsa.keymap = &kb_keymapdata;
wsa.accessops = &kb_accessops;
wsa.accesscookie = sc;
sc->sc_wskbddev = config_found(self, &wsa, wskbddevprint, CFARGS_NONE);
}
static void
kb_kbc_init(struct kb_softc *sc)
{
bus_space_tag_t bt = sc->sc_bt;
bus_space_handle_t bh = sc->sc_bh;
bus_space_write_1(bt, bh, KBC_KBREG_RESET, 0);
bus_space_write_1(bt, bh, KBC_KBREG_INTE, KBC_INTE);
}
int
kb_kbc_intr(void *arg)
{
struct kb_softc *sc = (struct kb_softc *)arg;
struct console_softc *kb_conssc = sc->sc_conssc;
bus_space_tag_t bt = sc->sc_bt;
bus_space_handle_t bh = sc->sc_bh;
int stat, handled = 0;
kb_conssc->cs_nintr++;
stat = bus_space_read_1(bt, bh, KBC_KBREG_STAT);
if (stat & KBCSTAT_KBRDY) {
kb_intr(sc);
handled = 1;
bus_space_write_1(bt, bh, KBC_KBREG_INTE, KBC_INTE);
}
return handled;
}
int
kb_kbc_cnattach(void)
{
kb_kbc_conssc.cs_isconsole = 1;
return kb_cnattach(&kb_kbc_conssc);
}