#include <sys/param.h>
#include <sys/systm.h>
#include <sys/proc.h>
#include <sys/device.h>
#include <sys/conf.h>
#include <sys/ioctl.h>
#include <sys/malloc.h>
#include <sys/tty.h>
#include <sys/time.h>
#include <sys/kernel.h>
#include <sys/syslog.h>
#include <machine/autoconf.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wskbdvar.h>
#include <dev/sun/sunkbdreg.h>
#include <dev/sun/sunkbdvar.h>
#include <dev/ic/z8530reg.h>
#include <machine/z8530var.h>
#include <dev/cons.h>
#ifndef ZSKBD_RING_SIZE
#define ZSKBD_RING_SIZE 2048
#endif
struct cfdriver zskbd_cd = {
NULL, "zskbd", DV_TTY
};
u_int zskbd_rbuf_size = ZSKBD_RING_SIZE;
u_int zskbd_rbuf_hiwat = (ZSKBD_RING_SIZE * 1) / 4;
u_int zskbd_rbuf_lowat = (ZSKBD_RING_SIZE * 3) / 4;
struct zskbd_softc {
struct sunkbd_softc sc_base;
struct zs_chanstate *zst_cs;
struct timeout zst_diag_ch;
u_int zst_overflows,
zst_floods,
zst_errors;
int zst_hwflags,
zst_swflags;
u_int zst_r_hiwat,
zst_r_lowat;
u_char *volatile zst_rbget,
*volatile zst_rbput;
volatile u_int zst_rbavail;
u_char *zst_rbuf,
*zst_ebuf;
u_char *zst_tba;
u_int zst_tbc,
zst_heldtbc;
u_char zst_tbuf[ZSKBD_RING_SIZE];
u_char *zst_tbeg, *zst_tend, *zst_tbp;
volatile u_char zst_rx_flags,
#define RX_TTY_BLOCKED 0x01
#define RX_TTY_OVERFLOWED 0x02
#define RX_IBUF_BLOCKED 0x04
#define RX_IBUF_OVERFLOWED 0x08
#define RX_ANY_BLOCK 0x0f
zst_tx_busy,
zst_tx_done,
zst_tx_stopped,
zst_st_check,
zst_rx_ready;
u_char zst_ppsmask;
u_char zst_ppsassert;
u_char zst_ppsclear;
};
static int zskbd_match(struct device *, void *, void *);
static void zskbd_attach(struct device *, struct device *, void *);
const struct cfattach zskbd_ca = {
sizeof(struct zskbd_softc), zskbd_match, zskbd_attach
};
struct zsops zsops_kbd;
static void zs_modem(struct zskbd_softc *, int);
static void zs_hwiflow(struct zskbd_softc *);
static void zs_maskintr(struct zskbd_softc *);
static void zskbd_rxint(struct zs_chanstate *);
static void zskbd_stint(struct zs_chanstate *, int);
static void zskbd_txint(struct zs_chanstate *);
static void zskbd_softint(struct zs_chanstate *);
static void zskbd_diag(void *);
int zskbd_init(struct zskbd_softc *);
void zskbd_putc(struct zskbd_softc *, u_int8_t);
void zskbd_cngetc(void *, u_int *, int *);
void zskbd_cnpollc(void *, int);
void zsstart_tx(struct zskbd_softc *);
int zsenqueue_tx(void *, u_int8_t *, u_int);
struct wskbd_consops zskbd_consops = {
zskbd_cngetc,
zskbd_cnpollc
};
#define ZSKBDUNIT(x) (minor(x) & 0x7ffff)
int
zskbd_match(struct device *parent, void *vcf, void *aux)
{
struct cfdata *cf = vcf;
struct zsc_attach_args *args = aux;
int ret;
if (strcmp(args->type, "keyboard") != 0)
return (0);
ret = 10;
if (cf->cf_loc[ZSCCF_CHANNEL] == args->channel)
ret += 2;
if (cf->cf_loc[ZSCCF_CHANNEL] == ZSCCF_CHANNEL_DEFAULT)
ret += 1;
return (ret);
}
void
zskbd_attach(struct device *parent, struct device *self, void *aux)
{
struct zsc_softc *zsc = (void *)parent;
struct zskbd_softc *zst = (void *)self;
struct sunkbd_softc *ss = (void *)self;
struct cfdata *cf = self->dv_cfdata;
struct zsc_attach_args *args = aux;
struct wskbddev_attach_args a;
struct zs_chanstate *cs;
int channel, s, tty_unit, console = 0;
dev_t dev;
ss->sc_sendcmd = zsenqueue_tx;
timeout_set(&ss->sc_bellto, sunkbd_bellstop, zst);
timeout_set(&zst->zst_diag_ch, zskbd_diag, zst);
zst->zst_tbp = zst->zst_tba = zst->zst_tbeg = zst->zst_tbuf;
zst->zst_tend = zst->zst_tbeg + ZSKBD_RING_SIZE;
tty_unit = ss->sc_dev.dv_unit;
channel = args->channel;
cs = zsc->zsc_cs[channel];
cs->cs_private = zst;
cs->cs_ops = &zsops_kbd;
zst->zst_cs = cs;
zst->zst_swflags = cf->cf_flags;
zst->zst_hwflags = args->hwflags;
dev = makedev(zs_major, tty_unit);
if (zst->zst_swflags)
printf(" flags 0x%x", zst->zst_swflags);
if ((zst->zst_hwflags & ZS_HWFLAG_CONSOLE_INPUT) != 0) {
if ((args->hwflags & ZS_HWFLAG_USE_CONSDEV) != 0) {
args->consdev->cn_dev = dev;
cn_tab->cn_pollc = wskbd_cnpollc;
cn_tab->cn_getc = wskbd_cngetc;
}
cn_tab->cn_dev = dev;
console = 1;
}
zst->zst_rbuf = malloc(zskbd_rbuf_size << 1, M_DEVBUF, M_WAITOK);
zst->zst_ebuf = zst->zst_rbuf + (zskbd_rbuf_size << 1);
zst->zst_r_hiwat = 0;
zst->zst_r_lowat = 0;
zst->zst_rbget = zst->zst_rbput = zst->zst_rbuf;
zst->zst_rbavail = zskbd_rbuf_size;
if (!cs->enable)
cs->enabled = 1;
if (ISSET(zst->zst_hwflags, ZS_HWFLAG_CONSOLE)) {
DELAY(10000);
} else if (!ISSET(zst->zst_hwflags, ZS_HWFLAG_NORESET)) {
int reset;
reset = (channel == 0) ? ZSWR9_A_RESET : ZSWR9_B_RESET;
s = splzs();
zs_write_reg(cs, 9, reset);
splx(s);
}
if (zskbd_init(zst)) {
SET(cs->cs_preg[1], ZSWR1_RIE | ZSWR1_SIE);
zs_write_reg(cs, 1, cs->cs_creg[1]);
s = splzs();
zs_modem(zst, 1);
splx(s);
} else {
s = splzs();
zs_modem(zst, 0);
splx(s);
return;
}
ss->sc_click =
strcmp(getpropstring(optionsnode, "keyboard-click?"), "true") == 0;
sunkbd_setclick(ss, ss->sc_click);
a.console = console;
if (ISTYPE5(ss->sc_layout)) {
a.keymap = &sunkbd5_keymapdata;
#ifndef SUNKBD5_LAYOUT
if (ss->sc_layout < MAXSUNLAYOUT &&
sunkbd_layouts[ss->sc_layout] != -1)
sunkbd5_keymapdata.layout =
sunkbd_layouts[ss->sc_layout];
#endif
} else {
a.keymap = &sunkbd_keymapdata;
#ifndef SUNKBD_LAYOUT
if (ss->sc_layout < MAXSUNLAYOUT &&
sunkbd_layouts[ss->sc_layout] != -1)
sunkbd_keymapdata.layout =
sunkbd_layouts[ss->sc_layout];
#endif
}
a.accessops = &sunkbd_accessops;
a.accesscookie = zst;
if (console)
wskbd_cnattach(&zskbd_consops, zst, a.keymap);
sunkbd_attach(ss, &a);
}
int
zskbd_init(struct zskbd_softc *zst)
{
struct sunkbd_softc *ss = (void *)zst;
struct zs_chanstate *cs = zst->zst_cs;
int s, tries;
u_int8_t v3, v4, v5, rr0;
if (zs_set_speed(cs, 1200)) {
printf(": failed to set baudrate\n");
return 0;
}
if (zs_set_modes(cs, CS8 | CLOCAL)) {
printf(": failed to set modes\n");
return 0;
}
s = splzs();
zs_maskintr(zst);
v3 = cs->cs_preg[3];
v5 = cs->cs_preg[5];
CLR(v3, ZSWR3_RXSIZE);
CLR(v5, ZSWR5_TXSIZE);
SET(v3, ZSWR3_RX_8);
SET(v5, ZSWR5_TX_8);
cs->cs_preg[3] = v3;
cs->cs_preg[5] = v5;
v4 = cs->cs_preg[4];
CLR(v4, ZSWR4_SBMASK | ZSWR4_PARMASK);
SET(v4, ZSWR4_ONESB | ZSWR4_EVENP);
cs->cs_preg[4] = v4;
if (!cs->cs_heldchange) {
if (zst->zst_tx_busy) {
zst->zst_heldtbc = zst->zst_tbc;
zst->zst_tbc = 0;
cs->cs_heldchange = 1;
} else
zs_loadchannelregs(cs);
}
zst->zst_r_hiwat = 0;
zst->zst_r_lowat = 0;
if (ISSET(zst->zst_rx_flags, RX_TTY_OVERFLOWED)) {
CLR(zst->zst_rx_flags, RX_TTY_OVERFLOWED);
zst->zst_rx_ready = 1;
cs->cs_softreq = 1;
}
if (ISSET(zst->zst_rx_flags, RX_TTY_BLOCKED|RX_IBUF_BLOCKED)) {
CLR(zst->zst_rx_flags, RX_TTY_BLOCKED|RX_IBUF_BLOCKED);
zs_hwiflow(zst);
}
zskbd_stint(cs, 1);
splx(s);
if (zst->zst_tx_stopped) {
zst->zst_tx_stopped = 0;
zsstart_tx(zst);
}
zskbd_softint(cs);
s = splhigh();
for (tries = 5; tries != 0; tries--) {
int ltries;
ss->sc_leds = 0;
ss->sc_layout = -1;
zskbd_putc(zst, SKBD_CMD_RESET);
ltries = 1000;
while (--ltries > 0) {
rr0 = *cs->cs_reg_csr;
if (rr0 & ZSRR0_RX_READY) {
sunkbd_raw(ss, *cs->cs_reg_data);
if (ss->sc_kbdstate == SKBD_STATE_RESET)
break;
}
DELAY(1000);
}
if (ltries == 0)
continue;
ltries = 1000;
while (--ltries > 0) {
rr0 = *cs->cs_reg_csr;
if (rr0 & ZSRR0_RX_READY) {
sunkbd_raw(ss, *cs->cs_reg_data);
if (ss->sc_kbdstate == SKBD_STATE_GETKEY)
break;
}
DELAY(1000);
}
if (ltries == 0)
continue;
DELAY(5000);
zskbd_putc(zst, SKBD_CMD_LAYOUT);
ltries = 1000;
while (--ltries > 0) {
rr0 = *cs->cs_reg_csr;
if (rr0 & ZSRR0_RX_READY) {
sunkbd_raw(ss, *cs->cs_reg_data);
if (ss->sc_layout != -1)
break;
}
DELAY(1000);
}
if (ltries == 0)
continue;
break;
}
if (tries == 0)
printf(": no keyboard\n");
else
printf(": layout %d\n", ss->sc_layout);
splx(s);
return tries;
}
void
zskbd_putc(struct zskbd_softc *zst, u_int8_t c)
{
u_int8_t rr0;
int s;
s = splhigh();
do {
rr0 = *zst->zst_cs->cs_reg_csr;
} while ((rr0 & ZSRR0_TX_READY) == 0);
*zst->zst_cs->cs_reg_data = c;
delay(2);
splx(s);
}
int
zsenqueue_tx(void *v, u_int8_t *str, u_int len)
{
struct zskbd_softc *zst = v;
int s;
u_int i;
s = splzs();
if (zst->zst_tbc + len > ZSKBD_RING_SIZE) {
splx(s);
return (-1);
}
zst->zst_tbc += len;
for (i = 0; i < len; i++) {
*zst->zst_tbp = str[i];
if (++zst->zst_tbp == zst->zst_tend)
zst->zst_tbp = zst->zst_tbeg;
}
splx(s);
zsstart_tx(zst);
return (0);
}
void
zsstart_tx(struct zskbd_softc *zst)
{
struct zs_chanstate *cs = zst->zst_cs;
int s, s1;
s = spltty();
if (zst->zst_tx_stopped)
goto out;
if (zst->zst_tbc == 0)
goto out;
s1 = splzs();
zst->zst_tx_busy = 1;
if (!ISSET(cs->cs_preg[1], ZSWR1_TIE)) {
SET(cs->cs_preg[1], ZSWR1_TIE);
cs->cs_creg[1] = cs->cs_preg[1];
zs_write_reg(cs, 1, cs->cs_creg[1]);
}
zs_write_data(cs, *zst->zst_tba);
zst->zst_tbc--;
if (++zst->zst_tba == zst->zst_tend)
zst->zst_tba = zst->zst_tbeg;
splx(s1);
out:
splx(s);
}
static void
zs_maskintr(struct zskbd_softc *zst)
{
struct zs_chanstate *cs = zst->zst_cs;
int tmp15;
cs->cs_rr0_mask = cs->cs_rr0_cts | cs->cs_rr0_dcd;
if (zst->zst_ppsmask != 0)
cs->cs_rr0_mask |= cs->cs_rr0_pps;
tmp15 = cs->cs_preg[15];
if (ISSET(cs->cs_rr0_mask, ZSRR0_DCD))
SET(tmp15, ZSWR15_DCD_IE);
else
CLR(tmp15, ZSWR15_DCD_IE);
if (ISSET(cs->cs_rr0_mask, ZSRR0_CTS))
SET(tmp15, ZSWR15_CTS_IE);
else
CLR(tmp15, ZSWR15_CTS_IE);
cs->cs_preg[15] = tmp15;
}
static void
zs_modem(struct zskbd_softc *zst, int onoff)
{
struct zs_chanstate *cs = zst->zst_cs;
if (cs->cs_wr5_dtr == 0)
return;
if (onoff)
SET(cs->cs_preg[5], cs->cs_wr5_dtr);
else
CLR(cs->cs_preg[5], cs->cs_wr5_dtr);
if (!cs->cs_heldchange) {
if (zst->zst_tx_busy) {
zst->zst_heldtbc = zst->zst_tbc;
zst->zst_tbc = 0;
cs->cs_heldchange = 1;
} else
zs_loadchannelregs(cs);
}
}
static void
zs_hwiflow(struct zskbd_softc *zst)
{
struct zs_chanstate *cs = zst->zst_cs;
if (cs->cs_wr5_rts == 0)
return;
if (ISSET(zst->zst_rx_flags, RX_ANY_BLOCK)) {
CLR(cs->cs_preg[5], cs->cs_wr5_rts);
CLR(cs->cs_creg[5], cs->cs_wr5_rts);
} else {
SET(cs->cs_preg[5], cs->cs_wr5_rts);
SET(cs->cs_creg[5], cs->cs_wr5_rts);
}
zs_write_reg(cs, 5, cs->cs_creg[5]);
}
#define integrate
integrate void zskbd_rxsoft(struct zskbd_softc *);
integrate void zskbd_txsoft(struct zskbd_softc *);
integrate void zskbd_stsoft(struct zskbd_softc *);
static void
zskbd_rxint(struct zs_chanstate *cs)
{
struct zskbd_softc *zst = cs->cs_private;
u_char *put, *end;
u_int cc;
u_char rr0, rr1, c;
end = zst->zst_ebuf;
put = zst->zst_rbput;
cc = zst->zst_rbavail;
while (cc > 0) {
rr1 = zs_read_reg(cs, 1);
c = zs_read_data(cs);
if (ISSET(rr1, ZSRR1_FE | ZSRR1_DO | ZSRR1_PE)) {
zs_write_csr(cs, ZSWR0_RESET_ERRORS);
}
put[0] = c;
put[1] = rr1;
put += 2;
if (put >= end)
put = zst->zst_rbuf;
cc--;
rr0 = zs_read_csr(cs);
if (!ISSET(rr0, ZSRR0_RX_READY))
break;
}
zst->zst_rbput = put;
zst->zst_rbavail = cc;
if (!ISSET(zst->zst_rx_flags, RX_TTY_OVERFLOWED)) {
zst->zst_rx_ready = 1;
cs->cs_softreq = 1;
}
if (!ISSET(zst->zst_rx_flags, RX_IBUF_BLOCKED) &&
cc < zst->zst_r_hiwat) {
SET(zst->zst_rx_flags, RX_IBUF_BLOCKED);
zs_hwiflow(zst);
}
if (!cc) {
SET(zst->zst_rx_flags, RX_IBUF_OVERFLOWED);
CLR(cs->cs_preg[1], ZSWR1_RIE);
cs->cs_creg[1] = cs->cs_preg[1];
zs_write_reg(cs, 1, cs->cs_creg[1]);
}
}
static void
zskbd_txint(struct zs_chanstate *cs)
{
struct zskbd_softc *zst = cs->cs_private;
if (cs->cs_heldchange) {
zs_loadchannelregs(cs);
cs->cs_heldchange = 0;
zst->zst_tbc = zst->zst_heldtbc;
zst->zst_heldtbc = 0;
}
if (zst->zst_tbc > 0) {
zs_write_data(cs, *zst->zst_tba);
zst->zst_tbc--;
if (++zst->zst_tba == zst->zst_tend)
zst->zst_tba = zst->zst_tbeg;
} else {
if (ISSET(cs->cs_preg[1], ZSWR1_TIE)) {
CLR(cs->cs_preg[1], ZSWR1_TIE);
cs->cs_creg[1] = cs->cs_preg[1];
zs_write_reg(cs, 1, cs->cs_creg[1]);
}
if (zst->zst_tx_busy) {
zst->zst_tx_busy = 0;
zst->zst_tx_done = 1;
cs->cs_softreq = 1;
}
}
}
static void
zskbd_stint(struct zs_chanstate *cs, int force)
{
struct zskbd_softc *zst = cs->cs_private;
u_char rr0, delta;
rr0 = zs_read_csr(cs);
zs_write_csr(cs, ZSWR0_RESET_STATUS);
if (!force)
delta = rr0 ^ cs->cs_rr0;
else
delta = cs->cs_rr0_mask;
cs->cs_rr0 = rr0;
if (ISSET(delta, cs->cs_rr0_mask)) {
SET(cs->cs_rr0_delta, delta);
if (ISSET(~rr0, cs->cs_rr0_mask)) {
zst->zst_tbc = 0;
zst->zst_heldtbc = 0;
}
zst->zst_st_check = 1;
cs->cs_softreq = 1;
}
}
void
zskbd_diag(void *arg)
{
struct zskbd_softc *zst = arg;
struct sunkbd_softc *ss = arg;
int overflows, floods;
int s;
s = splzs();
overflows = zst->zst_overflows;
zst->zst_overflows = 0;
floods = zst->zst_floods;
zst->zst_floods = 0;
zst->zst_errors = 0;
splx(s);
log(LOG_WARNING, "%s: %d silo overflow%s, %d ibuf flood%s\n",
ss->sc_dev.dv_xname,
overflows, overflows == 1 ? "" : "s",
floods, floods == 1 ? "" : "s");
}
integrate void
zskbd_rxsoft(struct zskbd_softc *zst)
{
struct sunkbd_softc *ss = (void *)zst;
struct zs_chanstate *cs = zst->zst_cs;
u_char *get, *end;
u_int cc, scc;
u_char rr1;
int code;
int s;
u_int8_t cbuf[SUNKBD_MAX_INPUT_SIZE], *c;
end = zst->zst_ebuf;
get = zst->zst_rbget;
scc = cc = zskbd_rbuf_size - zst->zst_rbavail;
if (cc == zskbd_rbuf_size) {
zst->zst_floods++;
if (zst->zst_errors++ == 0)
timeout_add_sec(&zst->zst_diag_ch, 60);
}
c = cbuf;
while (cc) {
code = get[0];
rr1 = get[1];
if (ISSET(rr1, ZSRR1_DO | ZSRR1_FE | ZSRR1_PE)) {
if (ISSET(rr1, ZSRR1_DO)) {
zst->zst_overflows++;
if (zst->zst_errors++ == 0)
timeout_add_sec(&zst->zst_diag_ch, 60);
}
if (ISSET(rr1, ZSRR1_FE))
SET(code, TTY_FE);
if (ISSET(rr1, ZSRR1_PE))
SET(code, TTY_PE);
}
*c++ = code;
if (c - cbuf == sizeof cbuf) {
sunkbd_input(ss, cbuf, c - cbuf);
c = cbuf;
}
get += 2;
if (get >= end)
get = zst->zst_rbuf;
cc--;
}
if (c != cbuf)
sunkbd_input(ss, cbuf, c - cbuf);
if (cc != scc) {
zst->zst_rbget = get;
s = splzs();
cc = zst->zst_rbavail += scc - cc;
if (cc >= zst->zst_r_lowat) {
if (ISSET(zst->zst_rx_flags, RX_IBUF_OVERFLOWED)) {
CLR(zst->zst_rx_flags, RX_IBUF_OVERFLOWED);
SET(cs->cs_preg[1], ZSWR1_RIE);
cs->cs_creg[1] = cs->cs_preg[1];
zs_write_reg(cs, 1, cs->cs_creg[1]);
}
if (ISSET(zst->zst_rx_flags, RX_IBUF_BLOCKED)) {
CLR(zst->zst_rx_flags, RX_IBUF_BLOCKED);
zs_hwiflow(zst);
}
}
splx(s);
}
}
integrate void
zskbd_txsoft(struct zskbd_softc *zst)
{
}
integrate void
zskbd_stsoft(struct zskbd_softc *zst)
{
struct zs_chanstate *cs = zst->zst_cs;
u_char rr0, delta;
int s;
s = splzs();
rr0 = cs->cs_rr0;
delta = cs->cs_rr0_delta;
cs->cs_rr0_delta = 0;
splx(s);
if (ISSET(delta, cs->cs_rr0_cts)) {
if (ISSET(rr0, cs->cs_rr0_cts))
zst->zst_tx_stopped = 0;
else
zst->zst_tx_stopped = 1;
}
}
static void
zskbd_softint(struct zs_chanstate *cs)
{
struct zskbd_softc *zst = cs->cs_private;
int s;
s = spltty();
if (zst->zst_rx_ready) {
zst->zst_rx_ready = 0;
zskbd_rxsoft(zst);
}
if (zst->zst_st_check) {
zst->zst_st_check = 0;
zskbd_stsoft(zst);
}
if (zst->zst_tx_done) {
zst->zst_tx_done = 0;
zskbd_txsoft(zst);
}
splx(s);
}
struct zsops zsops_kbd = {
zskbd_rxint,
zskbd_stint,
zskbd_txint,
zskbd_softint,
};
void
zskbd_cnpollc(void *v, int on)
{
}
void
zskbd_cngetc(void *v, u_int *type, int *data)
{
struct zskbd_softc *zst = v;
int s;
u_int8_t c, rr0;
s = splhigh();
do {
rr0 = *zst->zst_cs->cs_reg_csr;
} while ((rr0 & ZSRR0_RX_READY) == 0);
c = *zst->zst_cs->cs_reg_data;
splx(s);
sunkbd_decode(c, type, data);
}