#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/tty.h>
#include <sys/time.h>
#include <sys/kernel.h>
#include <sys/syslog.h>
#include <dev/cons.h>
#include <dev/ofw/openfirm.h>
#include <dev/ic/z8530reg.h>
#include <machine/z8530var.h>
#include <machine/autoconf.h>
#include <machine/cpu.h>
#include "zs.h"
int zs_def_cflag = (CREAD | CS8 | HUPCL);
int zs_major = 7;
struct zsdevice {
struct zschan zs_chan_b;
struct zschan zs_chan_a;
};
static int zs_hwflags[NZS][2];
static int zs_defspeed[NZS][2] = {
{ 38400,
38400 },
};
void *zs_conschan = 0;
#ifdef ZS_CONSOLE_ABORT
int zs_cons_canabort = 1;
#else
int zs_cons_canabort = 0;
#endif
int zs_get_speed(struct zs_chanstate *);
static u_char zs_init_reg[16] = {
0,
ZSWR1_RIE | ZSWR1_TIE | ZSWR1_SIE,
0,
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)/38400)-2,
0,
ZSWR14_BAUD_ENA,
ZSWR15_BREAK_IE,
};
struct cfdriver zs_cd = {
NULL, "zs", DV_TTY
};
int zs_match(struct device *, void *, void *);
void zs_attach(struct device *, struct device *, void *);
int zs_print(void *, const char *name);
int zs_enable (struct zs_chanstate *);
void zs_disable (struct zs_chanstate *);
const struct cfattach zs_ca = {
sizeof(struct zsc_softc), zs_match, zs_attach
};
int zshard(void *);
void zssoft(void *);
#ifdef ZS_TXDMA
int zs_txdma_int(void *);
#endif
int
zs_match(struct device *parent, void *match, void *aux)
{
struct confargs *ca = aux;
struct cfdata *cf = match;
if (strcmp(ca->ca_name, "escc") != 0)
return 0;
if (ca->ca_nreg < 8)
return 0;
if (cf->cf_unit > 1)
return 0;
return 1;
}
void
zs_attach(struct device *parent, struct device *self, void *aux)
{
struct zsc_softc *zsc = (void *)self;
struct confargs *ca = aux;
struct zsc_attach_args zsc_args;
volatile struct zschan *zc;
struct xzs_chanstate *xcs;
struct zs_chanstate *cs;
struct zsdevice *zsd;
int zs_unit, channel;
int s;
int node, intr[3][3];
u_int regs[16];
zs_unit = zsc->zsc_dev.dv_unit;
zsd = mapiodev(ca->ca_baseaddr + ca->ca_reg[0], ca->ca_reg[1]);
node = OF_child(ca->ca_node);
for (channel = 0; channel < 2; channel++) {
if (OF_getprop(node, "AAPL,interrupts",
intr[channel], sizeof(intr[0])) == -1 &&
OF_getprop(node, "interrupts",
intr[channel], sizeof(intr[0])) == -1) {
printf(": cannot find interrupt property\n");
return;
}
if (OF_getprop(node, "reg", regs, sizeof(regs)) < 24) {
printf(": cannot find reg property\n");
return;
}
regs[2] += ca->ca_baseaddr;
regs[4] += ca->ca_baseaddr;
#ifdef ZS_TXDMA
zsc->zsc_txdmareg[channel] = mapiodev(regs[2], regs[3]);
zsc->zsc_txdmacmd[channel] =
dbdma_alloc(sizeof(dbdma_command_t) * 3);
memset(zsc->zsc_txdmacmd[channel], 0,
sizeof(dbdma_command_t) * 3);
dbdma_reset(zsc->zsc_txdmareg[channel]);
#endif
node = OF_peer(node);
}
printf(": irq %d,%d\n", intr[0][0], intr[1][0]);
for (channel = 0; channel < 2; channel++) {
zsc_args.channel = channel;
zsc_args.hwflags = zs_hwflags[zs_unit][channel];
xcs = &zsc->xzsc_xcs_store[channel];
cs = &xcs->xzs_cs;
zsc->zsc_cs[channel] = cs;
cs->cs_channel = channel;
cs->cs_private = NULL;
cs->cs_ops = &zsops_null;
zc = (channel == 0) ? &zsd->zs_chan_a : &zsd->zs_chan_b;
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);
cs->cs_brg_clk = PCLK / 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;
cs->cs_wr5_rts = 0;
#ifdef __notyet__
cs->cs_slave_type = ZS_SLAVE_NONE;
#endif
xcs->cs_clocks[0].clk = PCLK;
xcs->cs_clocks[0].flags = ZSC_RTXBRG | ZSC_RTXDIV;
xcs->cs_clocks[1].flags =
ZSC_RTXBRG | ZSC_RTXDIV | ZSC_VARIABLE | ZSC_EXTERN;
xcs->cs_clocks[2].flags = ZSC_TRXDIV | ZSC_VARIABLE;
xcs->cs_clock_count = 3;
if (channel == 0) {
xcs->cs_clocks[1].clk = 0;
xcs->cs_clocks[2].clk = 0;
} else {
xcs->cs_clocks[1].flags = ZSC_VARIABLE;
xcs->cs_clocks[1].clk = 0;
xcs->cs_clocks[2].clk = 0;
}
if (xcs->cs_clocks[1].clk)
zsc_args.hwflags |= ZS_HWFLAG_NO_DCD;
if (xcs->cs_clocks[2].clk)
zsc_args.hwflags |= ZS_HWFLAG_NO_CTS;
xcs->cs_csource = 0;
xcs->cs_psource = 0;
xcs->cs_cclk_flag = 0;
xcs->cs_pclk_flag = 0;
xcs->cs_chip = 0;
xcs->cs_hwflags = zsc_args.hwflags;
if (!config_found(self, (void *)&zsc_args, zs_print)) {
u_char reset = (channel == 0) ?
ZSWR9_A_RESET : ZSWR9_B_RESET;
s = splzs();
zs_write_reg(cs, 9, reset);
splx(s);
}
}
mac_intr_establish(parent, intr[0][0], IST_LEVEL, IPL_TTY,
zshard, NULL, "zs0");
mac_intr_establish(parent, intr[1][0], IST_LEVEL, IPL_TTY,
zshard, NULL, "zs1");
#ifdef ZS_TXDMA
mac_intr_establish(parent, intr[0][1], IST_LEVEL, IPL_TTY,
zs_txdma_int, NULL, "zsdma0");
mac_intr_establish(parent, intr[1][1], IST_LEVEL, IPL_TTY,
zs_txdma_int, (void *)1, "zsdma1");
#endif
zsc->zsc_softintr = softintr_establish(IPL_SOFTTTY, zssoft, zsc);
if (zsc->zsc_softintr == NULL)
panic("zsattach: could not establish soft interrupt");
cs = zsc->zsc_cs[0];
s = splzs();
zs_write_reg(cs, 2, zs_init_reg[2]);
zs_write_reg(cs, 9, zs_init_reg[9]);
splx(s);
cs->enable = zs_enable;
cs->disable = zs_disable;
}
int
zs_print(void *aux, const char *name)
{
struct zsc_attach_args *args = aux;
if (name != NULL)
printf("%s: ", name);
if (args->channel != -1)
printf(" channel %d", args->channel);
return UNCONF;
}
int
zsmdioctl(struct zs_chanstate *cs, u_long cmd, caddr_t data)
{
switch (cmd) {
default:
return (-1);
}
return (0);
}
void
zsmd_setclock(struct zs_chanstate *cs)
{
#ifdef NOTYET
struct xzs_chanstate *xcs = (void *)cs;
if (cs->cs_channel != 0)
return;
via_set_modem((xcs->cs_pclk_flag & ZSC_EXTERN) ? 1 : 0);
#endif
}
static int zssoftpending;
int
zshard(void *arg)
{
struct zsc_softc *zsc;
int unit, rval;
rval = 0;
for (unit = 0; unit < zs_cd.cd_ndevs; unit++) {
zsc = zs_cd.cd_devs[unit];
if (zsc == NULL)
continue;
rval |= zsc_intr_hard(zsc);
if (zsc->zsc_cs[0]->cs_softreq)
{
if (zssoftpending == 0) {
zssoftpending = 1;
softintr_schedule(zsc->zsc_softintr);
}
}
}
return (rval);
}
void
zssoft(void *arg)
{
struct zsc_softc *zsc;
int unit;
if (zssoftpending == 0)
return;
zssoftpending = 0;
for (unit = 0; unit < zs_cd.cd_ndevs; ++unit) {
zsc = zs_cd.cd_devs[unit];
if (zsc == NULL)
continue;
(void) zsc_intr_soft(zsc);
}
}
#ifdef ZS_TXDMA
int
zs_txdma_int(void *arg)
{
int ch = (int)arg;
struct zsc_softc *zsc;
struct zs_chanstate *cs;
int unit = 0;
extern int zstty_txdma_int();
zsc = zs_cd.cd_devs[unit];
if (zsc == NULL)
panic("zs_txdma_int");
cs = zsc->zsc_cs[ch];
zstty_txdma_int(cs);
if (cs->cs_softreq) {
if (zssoftpending == 0) {
zssoftpending = 1;
softintr_schedule(zsc->zsc_softintr);
}
}
return 1;
}
void
zs_dma_setup(struct zs_chanstate *cs, caddr_t pa, int len)
{
struct zsc_softc *zsc;
dbdma_command_t *cmdp;
int ch = cs->cs_channel;
zsc = zs_cd.cd_devs[ch];
cmdp = zsc->zsc_txdmacmd[ch];
DBDMA_BUILD(cmdp, DBDMA_CMD_OUT_LAST, 0, len, kvtop(pa),
DBDMA_INT_ALWAYS, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
cmdp++;
DBDMA_BUILD(cmdp, DBDMA_CMD_STOP, 0, 0, 0,
DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
__asm volatile("eieio");
dbdma_start(zsc->zsc_txdmareg[ch], zsc->zsc_txdmacmd[ch]);
}
#endif
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);
}
#ifndef ZS_TOLERANCE
#define ZS_TOLERANCE 51
#endif
int
zs_set_speed(struct zs_chanstate *cs, int bps)
{
struct xzs_chanstate *xcs = (void *)cs;
int i, tc, tc0 = 0, tc1, s, sf = 0;
int src, rate0, rate1, err, tol;
if (bps == 0)
return (0);
src = -1;
tol = ZS_TOLERANCE;
for (i = 0; i < xcs->cs_clock_count; i++) {
if (xcs->cs_clocks[i].clk <= 0)
continue;
if (xcs->cs_clocks[i].flags & ZSC_BRG) {
tc1 = BPS_TO_TCONST(xcs->cs_clocks[i].clk >> 4, bps);
if (tc1 >= 0) {
rate1 = TCONST_TO_BPS(xcs->cs_clocks[i].clk >> 4, tc1);
err = abs(((rate1 - bps)*1000)/bps);
if (err < tol) {
tol = err;
src = i;
sf = xcs->cs_clocks[i].flags & ~ZSC_DIV;
tc0 = tc1;
rate0 = rate1;
}
}
}
if (xcs->cs_clocks[i].flags & ZSC_DIV) {
int b0 = xcs->cs_clocks[i].clk, e0 = abs(b0-bps);
int b1 = b0 >> 4, e1 = abs(b1-bps);
int b2 = b1 >> 1, e2 = abs(b2-bps);
int b3 = b2 >> 1, e3 = abs(b3-bps);
if (e0 < e1 && e0 < e2 && e0 < e3) {
err = e0;
rate1 = b0;
tc1 = ZSWR4_CLK_X1;
} else if (e0 > e1 && e1 < e2 && e1 < e3) {
err = e1;
rate1 = b1;
tc1 = ZSWR4_CLK_X16;
} else if (e0 > e2 && e1 > e2 && e2 < e3) {
err = e2;
rate1 = b2;
tc1 = ZSWR4_CLK_X32;
} else {
err = e3;
rate1 = b3;
tc1 = ZSWR4_CLK_X64;
}
err = (err * 1000)/bps;
if (err < tol) {
tol = err;
src = i;
sf = xcs->cs_clocks[i].flags & ~ZSC_BRG;
tc0 = tc1;
rate0 = rate1;
}
}
}
#ifdef ZSMACDEBUG
printf("Checking for rate %d. Found source #%d.\n",bps, src);
#endif
if (src == -1)
return (EINVAL);
if (sf & ZSC_EXTERN)
cs->cs_brg_clk = xcs->cs_clocks[i].clk >> 4;
else
cs->cs_brg_clk = PCLK / 16;
s = splzs();
xcs->cs_psource = src;
xcs->cs_pclk_flag = sf;
bps = rate0;
if (sf & ZSC_BRG) {
cs->cs_preg[4] = ZSWR4_CLK_X16;
cs->cs_preg[11]= ZSWR11_RXCLK_BAUD | ZSWR11_TXCLK_BAUD;
if (sf & ZSC_PCLK) {
cs->cs_preg[14] = ZSWR14_BAUD_ENA | ZSWR14_BAUD_FROM_PCLK;
} else {
cs->cs_preg[14] = ZSWR14_BAUD_ENA;
}
tc = tc0;
} else {
cs->cs_preg[4] = tc0;
if (sf & ZSC_RTXDIV) {
cs->cs_preg[11] = ZSWR11_RXCLK_RTXC | ZSWR11_TXCLK_RTXC;
} else {
cs->cs_preg[11] = ZSWR11_RXCLK_TRXC | ZSWR11_TXCLK_TRXC;
}
cs->cs_preg[14]= 0;
tc = 0xffff;
}
cs->cs_preg[12] = tc;
cs->cs_preg[13] = tc >> 8;
splx(s);
#ifdef ZSMACDEBUG
printf("Rate is %7d, tc is %7d, source no. %2d, flags %4x\n", \
bps, tc, src, sf);
printf("Registers are: 4 %x, 11 %x, 14 %x\n\n",
cs->cs_preg[4], cs->cs_preg[11], cs->cs_preg[14]);
#endif
cs->cs_preg[5] |= ZSWR5_RTS;
return (0);
}
int
zs_set_modes(struct zs_chanstate *cs, int cflag)
{
struct xzs_chanstate *xcs = (void*)cs;
int s;
if (xcs->cs_hwflags & ZS_HWFLAG_NO_DCD) {
if (cflag & MDMBUF)
return (EINVAL);
cflag |= CLOCAL;
}
#if 0
if ((xcs->cs_hwflags & ZS_HWFLAG_NO_CTS) && (cflag & CRTSCTS))
return (EINVAL);
#endif
s = splzs();
if ((cflag & (CLOCAL | MDMBUF)) != 0)
cs->cs_rr0_dcd = 0;
else
cs->cs_rr0_dcd = ZSRR0_DCD;
if ((cflag & CRTSCTS) != 0) {
cs->cs_wr5_dtr = ZSWR5_DTR;
cs->cs_wr5_rts = 0;
cs->cs_rr0_cts = ZSRR0_CTS;
#if 0
} else if ((cflag & CDTRCTS) != 0) {
cs->cs_wr5_dtr = 0;
cs->cs_wr5_rts = ZSWR5_DTR;
cs->cs_rr0_cts = ZSRR0_CTS;
#endif
} 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;
cs->cs_wr5_rts = 0;
cs->cs_rr0_cts = 0;
}
splx(s);
return (0);
}
#define ZS_DELAY()
u_char
zs_read_reg(struct zs_chanstate *cs, u_char reg)
{
u_char val;
out8(cs->cs_reg_csr, reg);
ZS_DELAY();
val = in8(cs->cs_reg_csr);
ZS_DELAY();
return val;
}
void
zs_write_reg(struct zs_chanstate *cs, u_char reg, u_char val)
{
out8(cs->cs_reg_csr, reg);
ZS_DELAY();
out8(cs->cs_reg_csr, val);
ZS_DELAY();
}
u_char
zs_read_csr(struct zs_chanstate *cs)
{
u_char val;
val = in8(cs->cs_reg_csr);
ZS_DELAY();
val ^= ZSRR0_CTS;
return val;
}
void
zs_write_csr(struct zs_chanstate *cs, u_char val)
{
out8(cs->cs_reg_csr, val);
ZS_DELAY();
}
u_char
zs_read_data(struct zs_chanstate *cs)
{
u_char val;
val = in8(cs->cs_reg_data);
ZS_DELAY();
return val;
}
void
zs_write_data(struct zs_chanstate *cs, u_char val)
{
out8(cs->cs_reg_data, val);
ZS_DELAY();
}
void macobio_modem_power(int enable);
int
zs_enable(struct zs_chanstate *cs)
{
macobio_modem_power(1);
cs->enabled = 1;
return(0);
}
void
zs_disable(struct zs_chanstate *cs)
{
macobio_modem_power(0);
cs->enabled = 0;
}
cons_decl(zs);
void zs_putc(volatile struct zschan *, int);
int zs_getc(volatile struct zschan *);
extern int zsopen( dev_t dev, int flags, int mode, struct proc *p);
static int stdin, stdout;
int
zs_getc(volatile struct zschan *zc)
{
register int s, c, rr0;
s = splhigh();
do {
rr0 = in8(&zc->zc_csr);
ZS_DELAY();
} while ((rr0 & ZSRR0_RX_READY) == 0);
c = in8(&zc->zc_data);
ZS_DELAY();
splx(s);
return (c);
}
void
zs_putc(volatile struct zschan *zc, int c)
{
register int s, rr0;
register long wait = 0;
s = splhigh();
do {
rr0 = in8(&zc->zc_csr);
ZS_DELAY();
} while (((rr0 & ZSRR0_TX_READY) == 0) && (wait++ < 1000000));
if ((rr0 & ZSRR0_TX_READY) != 0) {
out8(&zc->zc_data, c);
ZS_DELAY();
}
splx(s);
}
int
zscngetc(dev_t dev)
{
register volatile struct zschan *zc = zs_conschan;
register int c;
if (zc) {
c = zs_getc(zc);
} else {
char ch = 0;
OF_read(stdin, &ch, 1);
c = ch;
}
return c;
}
void
zscnputc(dev_t dev, int c)
{
register volatile struct zschan *zc = zs_conschan;
if (zc) {
zs_putc(zc, c);
} else {
char ch = c;
OF_write(stdout, &ch, 1);
}
}
void
zscnprobe(struct consdev *cp)
{
int chosen, pkg;
int unit = 0;
int maj;
char name[16];
if ((chosen = OF_finddevice("/chosen")) == -1)
return;
if (OF_getprop(chosen, "stdin", &stdin, sizeof(stdin)) == -1)
return;
if (OF_getprop(chosen, "stdout", &stdout, sizeof(stdout)) == -1)
return;
if ((pkg = OF_instance_to_package(stdin)) == -1)
return;
bzero(name, sizeof(name));
if (OF_getprop(pkg, "device_type", name, sizeof(name)) == -1)
return;
if (strcmp(name, "serial") != 0)
return;
bzero(name, sizeof(name));
if (OF_getprop(pkg, "name", name, sizeof(name)) == -1)
return;
if (strcmp(name, "ch-b") == 0)
unit = 1;
for (maj = 0; maj < nchrdev; maj++)
if (cdevsw[maj].d_open == zsopen)
break;
cp->cn_dev = makedev(maj, unit);
cp->cn_pri = CN_HIGHPRI;
}
void
zscninit(struct consdev *cp)
{
int escc, escc_ch, obio;
unsigned int zs_offset, zs_size;
int ch = 0;
u_int32_t reg[5];
char name[16];
if ((escc_ch = OF_instance_to_package(stdin)) == -1)
return;
bzero(name, sizeof(name));
if (OF_getprop(escc_ch, "name", name, sizeof(name)) == -1)
return;
if (strcmp(name, "ch-b") == 0)
ch = 1;
if (OF_getprop(escc_ch, "reg", reg, sizeof(reg)) < 8)
return;
zs_offset = reg[0];
zs_size = reg[1];
escc = OF_parent(escc_ch);
obio = OF_parent(escc);
if (OF_getprop(obio, "assigned-addresses", reg, sizeof(reg)) < 12)
return;
zs_conschan = mapiodev(reg[2] + zs_offset, zs_size);
zs_hwflags[0][ch] = ZS_HWFLAG_CONSOLE;
}
void
zs_abort(struct zs_chanstate *channel)
{
volatile struct zschan *zc = zs_conschan;
int rr0;
do {
rr0 = zc->zc_csr;
ZS_DELAY();
} while (rr0 & ZSRR0_BREAK);
#if defined(DDB)
if (!db_active)
db_enter();
#endif
}
void
zscnpollc(dev_t dev, int on)
{
#if 0
if (on)
swallow_zsintrs++;
else
swallow_zsintrs--;
#endif
}