#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: zs.c,v 1.92 2024/12/20 23:52:00 tsutsui Exp $");
#include "opt_kgdb.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/conf.h>
#include <sys/device.h>
#include <sys/file.h>
#include <sys/ioctl.h>
#include <sys/kernel.h>
#include <sys/proc.h>
#include <sys/tty.h>
#include <sys/time.h>
#include <sys/syslog.h>
#include <sys/cpu.h>
#include <sys/intr.h>
#include <uvm/uvm_extern.h>
#include <machine/autoconf.h>
#include <machine/mon.h>
#include <machine/z8530var.h>
#include <sun3/sun3/machdep.h>
#ifdef _SUN3X_
#include <sun3/sun3x/obio.h>
#else
#include <sun3/sun3/obio.h>
#endif
#include <sun3/dev/zs_cons.h>
#include <dev/cons.h>
#include <dev/ic/z8530reg.h>
#include "ioconf.h"
#include "kbd.h"
#include "zsc.h"
#define NZS NZSC
#if NZS < 2
#undef NZS
#define NZS 2
#endif
int zs_def_cflag = (CREAD | CS8 | HUPCL);
#define PCLK (9600 * 512)
#define ZSHARD_PRI 6
#define ZSSOFT_PRI _IPL_SOFT_LEVEL3
#define ZS_DELAY() delay(2)
struct zschan {
volatile uint8_t zc_csr;
uint8_t zc_xxx0;
volatile uint8_t zc_data;
uint8_t zc_xxx1;
};
struct zsdevice {
struct zschan zs_chan_b;
struct zschan zs_chan_a;
};
static int zs_physaddr[NZS] = {
OBIO_ZS_KBD_MS,
OBIO_ZS_TTY_AB };
static struct zsdevice *zsaddr[NZS];
static int zs_hwflags[NZS][2];
static int zs_defspeed[NZS][2] = {
{ 1200,
1200 },
{ 9600,
9600 },
};
static uint8_t zs_init_reg[16] = {
0,
0,
0x18 + ZSHARD_PRI,
ZSWR3_RX_8 | ZSWR3_RX_ENABLE,
ZSWR4_CLK_X16 | ZSWR4_ONESB | ZSWR4_EVENP,
ZSWR5_TX_8 | ZSWR5_TX_ENABLE,
0,
0,
0,
ZSWR9_MASTER_IE,
0,
ZSWR11_TXCLK_BAUD | ZSWR11_RXCLK_BAUD,
((PCLK/32)/9600)-2,
0,
ZSWR14_BAUD_ENA | ZSWR14_BAUD_FROM_PCLK,
ZSWR15_BREAK_IE,
};
void
zs_init(void)
{
vaddr_t va;
int i;
for (i = 0; i < NZS; i++) {
if (find_prom_map(zs_physaddr[i], PMAP_OBIO,
sizeof(struct zschan), &va) == 0)
zsaddr[i] = (void *)va;
}
}
struct zschan *
zs_get_chan_addr(int zs_unit, int channel)
{
struct zsdevice *addr;
struct zschan *zc;
if (zs_unit >= NZS)
return NULL;
addr = zsaddr[zs_unit];
if (addr == NULL)
return NULL;
if (channel == 0) {
zc = &addr->zs_chan_a;
} else {
zc = &addr->zs_chan_b;
}
return (zc);
}
static int zs_match(device_t, cfdata_t, void *);
static void zs_attach(device_t, device_t, void *);
static int zs_print(void *, const char *);
CFATTACH_DECL_NEW(zsc, sizeof(struct zsc_softc),
zs_match, zs_attach, NULL, NULL);
static int zshard(void *);
static int zs_get_speed(struct zs_chanstate *);
static int
zs_match(device_t parent, cfdata_t cf, void *aux)
{
struct confargs *ca = aux;
int unit;
void *va;
if (ca->ca_paddr == zs_physaddr[0]) {
unit = 0;
} else if (ca->ca_paddr == zs_physaddr[1]) {
unit = 1;
} else {
return (0);
}
va = zsaddr[unit];
if (va == NULL)
return (0);
if (peek_byte(va) == -1)
return (0);
if (ca->ca_intpri == -1)
ca->ca_intpri = ZSHARD_PRI;
return (1);
}
static void
zs_attach(device_t parent, device_t self, void *aux)
{
struct zsc_softc *zsc = device_private(self);
struct confargs *ca = aux;
struct zsc_attach_args zsc_args;
volatile struct zschan *zc;
struct zs_chanstate *cs;
int zs_unit, channel;
zsc->zsc_dev = self;
zs_unit = device_unit(self);
aprint_normal(": (softpri %d)\n", ZSSOFT_PRI);
if (zsaddr[zs_unit] == NULL)
panic("zs_attach: zs%d not mapped", zs_unit);
for (channel = 0; channel < 2; channel++) {
zsc_args.channel = channel;
zsc_args.hwflags = zs_hwflags[zs_unit][channel];
cs = &zsc->zsc_cs_store[channel];
zsc->zsc_cs[channel] = cs;
zs_lock_init(cs);
cs->cs_channel = channel;
cs->cs_private = NULL;
cs->cs_ops = &zsops_null;
cs->cs_brg_clk = PCLK / 16;
zc = zs_get_chan_addr(zs_unit, channel);
cs->cs_reg_csr = &zc->zc_csr;
cs->cs_reg_data = &zc->zc_data;
memcpy(cs->cs_creg, zs_init_reg, 16);
memcpy(cs->cs_preg, zs_init_reg, 16);
if (zsc_args.hwflags & ZS_HWFLAG_CONSOLE)
cs->cs_defspeed = zs_get_speed(cs);
else
cs->cs_defspeed = zs_defspeed[zs_unit][channel];
cs->cs_defcflag = zs_def_cflag;
cs->cs_rr0_dcd = ZSRR0_DCD;
cs->cs_rr0_cts = 0;
cs->cs_wr5_dtr = ZSWR5_DTR | ZSWR5_RTS;
cs->cs_wr5_rts = 0;
if (channel == 0) {
zs_write_reg(cs, 9, 0);
}
if (!config_found(self, (void *)&zsc_args, zs_print,
CFARGS_NONE)) {
uint8_t reset = (channel == 0) ?
ZSWR9_A_RESET : ZSWR9_B_RESET;
zs_lock_chan(cs);
zs_write_reg(cs, 9, reset);
zs_unlock_chan(cs);
}
}
isr_add_autovect(zshard, zsc, ca->ca_intpri);
zsc->zs_si = softint_establish(SOFTINT_SERIAL,
(void (*)(void *))zsc_intr_soft, zsc);
cs = zsc->zsc_cs[0];
zs_lock_chan(cs);
zs_write_reg(cs, 2, zs_init_reg[2]);
zs_write_reg(cs, 9, zs_init_reg[9]);
zs_unlock_chan(cs);
if (zs_unit == 1) {
(void)spl5();
}
}
static int
zs_print(void *aux, const char *name)
{
struct zsc_attach_args *args = aux;
if (name != NULL)
aprint_normal("%s: ", name);
if (args->channel != -1)
aprint_normal(" channel %d", args->channel);
return UNCONF;
}
static int
zshard(void *arg)
{
struct zsc_softc *zsc = arg;
int rval;
rval = zsc_intr_hard(zsc);
if (zsc->zsc_cs[0]->cs_softreq || zsc->zsc_cs[1]->cs_softreq)
softint_schedule(zsc->zs_si);
return (rval);
}
static int
zs_get_speed(struct zs_chanstate *cs)
{
int tconst;
tconst = zs_read_reg(cs, 12);
tconst |= zs_read_reg(cs, 13) << 8;
return (TCONST_TO_BPS(cs->cs_brg_clk, tconst));
}
int
zs_set_speed(struct zs_chanstate *cs, int bps)
{
int tconst, real_bps;
if (bps == 0)
return (0);
#ifdef DIAGNOSTIC
if (cs->cs_brg_clk == 0)
panic("zs_set_speed");
#endif
tconst = BPS_TO_TCONST(cs->cs_brg_clk, bps);
if (tconst < 0)
return (EINVAL);
real_bps = TCONST_TO_BPS(cs->cs_brg_clk, tconst);
if (real_bps != bps)
return (EINVAL);
cs->cs_preg[12] = tconst;
cs->cs_preg[13] = tconst >> 8;
return (0);
}
int
zs_set_modes(struct zs_chanstate *cs, int cflag )
{
zs_lock_chan(cs);
cs->cs_rr0_pps = 0;
if ((cflag & (CLOCAL | MDMBUF)) != 0) {
cs->cs_rr0_dcd = 0;
if ((cflag & MDMBUF) == 0)
cs->cs_rr0_pps = ZSRR0_DCD;
} else
cs->cs_rr0_dcd = ZSRR0_DCD;
if ((cflag & CRTSCTS) != 0) {
cs->cs_wr5_dtr = ZSWR5_DTR;
cs->cs_wr5_rts = ZSWR5_RTS;
cs->cs_rr0_cts = ZSRR0_CTS;
} else if ((cflag & MDMBUF) != 0) {
cs->cs_wr5_dtr = 0;
cs->cs_wr5_rts = ZSWR5_DTR;
cs->cs_rr0_cts = ZSRR0_DCD;
} else {
cs->cs_wr5_dtr = ZSWR5_DTR | ZSWR5_RTS;
cs->cs_wr5_rts = 0;
cs->cs_rr0_cts = 0;
}
zs_unlock_chan(cs);
return (0);
}
uint8_t
zs_read_reg(struct zs_chanstate *cs, uint8_t reg)
{
uint8_t val;
*cs->cs_reg_csr = reg;
ZS_DELAY();
val = *cs->cs_reg_csr;
ZS_DELAY();
return val;
}
void
zs_write_reg(struct zs_chanstate *cs, uint8_t reg, uint8_t val)
{
*cs->cs_reg_csr = reg;
ZS_DELAY();
*cs->cs_reg_csr = val;
ZS_DELAY();
}
uint8_t
zs_read_csr(struct zs_chanstate *cs)
{
uint8_t val;
val = *cs->cs_reg_csr;
ZS_DELAY();
return val;
}
void
zs_write_csr(struct zs_chanstate *cs, uint8_t val)
{
*cs->cs_reg_csr = val;
ZS_DELAY();
}
uint8_t
zs_read_data(struct zs_chanstate *cs)
{
uint8_t val;
val = *cs->cs_reg_data;
ZS_DELAY();
return val;
}
void
zs_write_data(struct zs_chanstate *cs, uint8_t val)
{
*cs->cs_reg_data = val;
ZS_DELAY();
}
void *zs_conschan;
void
zs_abort(struct zs_chanstate *cs)
{
volatile struct zschan *zc = zs_conschan;
int rr0;
do {
rr0 = zc->zc_csr;
ZS_DELAY();
} while (rr0 & ZSRR0_BREAK);
Debugger();
}
int
zs_getc(void *arg)
{
volatile struct zschan *zc = arg;
int s, c, rr0;
s = splhigh();
do {
rr0 = zc->zc_csr;
ZS_DELAY();
} while ((rr0 & ZSRR0_RX_READY) == 0);
c = zc->zc_data;
ZS_DELAY();
splx(s);
return (c);
}
void
zs_putc(void *arg, int c)
{
volatile struct zschan *zc = arg;
int s, rr0;
s = splhigh();
do {
rr0 = zc->zc_csr;
ZS_DELAY();
} while ((rr0 & ZSRR0_TX_READY) == 0);
zc->zc_data = c;
ZS_DELAY();
splx(s);
}
static void zscninit(struct consdev *);
static int zscngetc(dev_t);
static void zscnputc(dev_t, int);
struct consdev consdev_tty = {
nullcnprobe,
zscninit,
zscngetc,
zscnputc,
nullcnpollc,
NULL,
};
static void
zscninit(struct consdev *cn)
{
}
static int
zscngetc(dev_t dev)
{
return (zs_getc(zs_conschan));
}
static void
zscnputc(dev_t dev, int c)
{
zs_putc(zs_conschan, c);
}
static void prom_cninit(struct consdev *);
static int prom_cngetc(dev_t);
static void prom_cnputc(dev_t, int);
struct consdev consdev_prom = {
nullcnprobe,
prom_cninit,
prom_cngetc,
prom_cnputc,
nullcnpollc,
};
void
nullcnprobe(struct consdev *cn)
{
}
static void
prom_cninit(struct consdev *cn)
{
}
static int
prom_cngetc(dev_t dev)
{
return (0);
}
static void
prom_cnputc(dev_t dev, int c)
{
(*romVectorPtr->putChar)(c & 0x7f);
}
extern struct consdev consdev_kd;
static const struct {
int zs_unit, channel;
} zstty_conf[NZS*2] = {
{ 1, 0 },
{ 1, 1 },
{ 0, 0 },
{ 0, 1 },
};
static const char * const prom_inSrc_name[] = {
"keyboard/display",
"ttya", "ttyb",
"ttyc", "ttyd" };
void
cninit(void)
{
struct sunromvec *v;
struct zschan *zc;
struct consdev *cn;
int channel, zs_unit, zstty_unit;
uint8_t inSource, outSink;
extern const struct cdevsw zstty_cdevsw;
zs_init();
v = romVectorPtr;
inSource = *v->inSource;
outSink = *v->outSink;
if (inSource != outSink) {
mon_printf("cninit: mismatched PROM output selector\n");
}
switch (inSource) {
default:
mon_printf("cninit: invalid inSource=%d\n", inSource);
sunmon_abort();
inSource = 0;
case 0:
#if NKBD > 0
zs_unit = 0;
channel = 0;
cn = &consdev_kd;
break;
#else
mon_printf("cninit: kdb/display not configured\n");
sunmon_abort();
inSource = 1;
#endif
case 1:
case 2:
case 3:
case 4:
zstty_unit = inSource - 1;
zs_unit = zstty_conf[zstty_unit].zs_unit;
channel = zstty_conf[zstty_unit].channel;
cn = &consdev_tty;
cn->cn_dev = makedev(cdevsw_lookup_major(&zstty_cdevsw),
zstty_unit);
cn->cn_pri = CN_REMOTE;
break;
}
mon_printf("console is %s\n", prom_inSrc_name[inSource]);
zc = zs_get_chan_addr(zs_unit, channel);
if (zc == NULL) {
mon_printf("cninit: zs not mapped.\n");
return;
}
zs_conschan = zc;
zs_hwflags[zs_unit][channel] = ZS_HWFLAG_CONSOLE;
cn_tab = cn;
(*cn->cn_init)(cn);
#ifdef KGDB
zs_kgdb_init();
#endif
}