#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: zs_kgdb.c,v 1.22 2023/10/24 19:05:07 andvar Exp $");
#include "opt_kgdb.h"
#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/kernel.h>
#include <sys/syslog.h>
#include <sys/kgdb.h>
#include <dev/ic/z8530reg.h>
#include <machine/z8530var.h>
#include <machine/autoconf.h>
#include <machine/promlib.h>
#include <sparc/dev/cons.h>
#define PCLK (9600 * 512)
struct zschan {
volatile u_char zc_csr;
u_char zc_xxx0;
volatile u_char zc_data;
u_char zc_xxx1;
};
struct zsdevice {
struct zschan zs_chan_b;
struct zschan zs_chan_a;
};
static void zs_setparam(struct zs_chanstate *, int, int);
static void *findzs(int);
struct zsops zsops_kgdb;
extern int zs_getc(void *);
extern void zs_putc(void *, int);
static u_char zs_kgdb_regs[16] = {
0,
0,
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 | ZSWR9_NO_VECTOR,
0,
ZSWR11_TXCLK_BAUD | ZSWR11_RXCLK_BAUD,
14,
0,
ZSWR14_BAUD_ENA | ZSWR14_BAUD_FROM_PCLK,
ZSWR15_BREAK_IE,
};
static void
zs_setparam(struct zs_chanstate *cs, int iena, int rate)
{
int s, tconst;
memcpy(cs->cs_preg, zs_kgdb_regs, 16);
if (iena) {
cs->cs_preg[1] = ZSWR1_RIE | ZSWR1_SIE;
}
tconst = BPS_TO_TCONST(cs->cs_brg_clk, rate);
cs->cs_preg[5] |= ZSWR5_DTR | ZSWR5_RTS;
cs->cs_preg[12] = tconst;
cs->cs_preg[13] = tconst >> 8;
s = splhigh();
zs_loadchannelregs(cs);
splx(s);
}
void
zs_kgdb_init(void)
{
struct zs_chanstate cs;
struct zsdevice *zsd;
volatile struct zschan *zc;
int channel, promzs_unit;
extern const struct cdevsw zstty_cdevsw;
if (cdevsw_lookup(kgdb_dev) != &zstty_cdevsw)
return;
promzs_unit = (kgdb_dev & 2) ? 2 : 0;
channel = kgdb_dev & 1;
printf("zs_kgdb_init: attaching Serial(%lld) at %d baud\n",
(kgdb_dev & 3), kgdb_rate);
memset((void *)&cs, 0, sizeof(cs));
zsd = findzs(promzs_unit);
if (zsd == NULL) {
printf("zs_kgdb_init: zs not mapped.\n");
return;
}
zc = (channel == 0) ? &zsd->zs_chan_a : &zsd->zs_chan_b;
cs.cs_channel = channel;
cs.cs_brg_clk = PCLK / 16;
cs.cs_reg_csr = &zc->zc_csr;
cs.cs_reg_data = &zc->zc_data;
zs_setparam(&cs, 0, kgdb_rate);
kgdb_attach(zs_getc, zs_putc, __UNVOLATILE(zc));
}
int
zs_check_kgdb(struct zs_chanstate *cs, int dev)
{
if (dev != kgdb_dev)
return (0);
cs->cs_private = NULL;
cs->cs_ops = &zsops_kgdb;
zs_setparam(cs, 1, kgdb_rate);
return (1);
}
void
zskgdb(struct zs_chanstate *cs)
{
int unit = minor(kgdb_dev);
printf("zstty%d: kgdb interrupt\n", unit);
kgdb_connect(1);
}
static void zs_kgdb_rxint(struct zs_chanstate *);
static void zs_kgdb_stint(struct zs_chanstate *, int);
static void zs_kgdb_txint(struct zs_chanstate *);
static void zs_kgdb_softint(struct zs_chanstate *);
int kgdb_input_lost;
static void
zs_kgdb_rxint(struct zs_chanstate *cs)
{
register u_char c, rr1;
rr1 = zs_read_reg(cs, 1);
c = zs_read_data(cs);
if (rr1 & (ZSRR1_FE | ZSRR1_DO | ZSRR1_PE)) {
zs_write_csr(cs, ZSWR0_RESET_ERRORS);
}
if (c == KGDB_START) {
zskgdb(cs);
} else {
kgdb_input_lost++;
}
}
static void
zs_kgdb_txint(struct zs_chanstate *cs)
{
zs_write_csr(cs, ZSWR0_RESET_TXINT);
}
static void
zs_kgdb_stint(struct zs_chanstate *cs, int force)
{
register int rr0;
rr0 = zs_read_csr(cs);
zs_write_csr(cs, ZSWR0_RESET_STATUS);
if (rr0 & ZSRR0_BREAK) {
zskgdb(cs);
}
}
static void
zs_kgdb_softint(struct zs_chanstate *cs)
{
printf("zs_kgdb_softint?\n");
}
struct zsops zsops_kgdb = {
zs_kgdb_rxint,
zs_kgdb_stint,
zs_kgdb_txint,
zs_kgdb_softint,
};
static void *
findzs(int zs)
{
#if defined(SUN4)
if (CPU_ISSUN4) {
#define ZS0_PHYS 0xf1000000
#define ZS1_PHYS 0xf0000000
#define ZS2_PHYS 0xe0000000
bus_space_handle_t bh;
bus_addr_t paddr;
switch (zs) {
case 0:
paddr = ZS0_PHYS;
break;
case 1:
paddr = ZS1_PHYS;
break;
case 2:
paddr = ZS2_PHYS;
break;
default:
return (NULL);
}
if (cpuinfo.cpu_type == CPUTYP_4_100)
paddr &= ~0xf0000000;
if (obio_find_rom_map(paddr, PAGE_SIZE, &bh) != 0)
return (NULL);
return ((void *)bh);
}
#endif
#if defined(SUN4C) || defined(SUN4M)
if (CPU_ISSUN4C || CPU_ISSUN4M) {
int node;
node = firstchild(findroot());
if (CPU_ISSUN4M) {
node = findnode(node, "obio");
if (node == 0)
panic("findzs: no obio node");
node = firstchild(node);
}
while ((node = findnode(node, "zs")) != 0) {
int nvaddrs, *vaddrs, vstore[10];
if (prom_getpropint(node, "slave", -1) != zs) {
node = nextsibling(node);
continue;
}
vaddrs = vstore;
nvaddrs = sizeof(vstore)/sizeof(vstore[0]);
if (prom_getprop(node, "address", sizeof(int),
&nvaddrs, &vaddrs) != 0)
return (NULL);
return ((void *)vaddrs[0]);
}
}
#endif
return (NULL);
}