#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: kd.c,v 1.53 2014/07/25 08:10:35 dholland Exp $");
#include <sys/param.h>
#include <sys/proc.h>
#include <sys/systm.h>
#include <sys/ioctl.h>
#include <sys/tty.h>
#include <sys/file.h>
#include <sys/conf.h>
#include <sys/device.h>
#include <sys/kauth.h>
#include <machine/openfirm.h>
#include <machine/eeprom.h>
#include <machine/psl.h>
#include <machine/cpu.h>
#include <machine/kbd.h>
#include <machine/autoconf.h>
#include <dev/cons.h>
#include <dev/sun/event_var.h>
#include <dev/sun/kbd_xlate.h>
#include <dev/sun/kbdvar.h>
#include <sparc64/dev/cons.h>
dev_type_open(kdopen);
dev_type_close(kdclose);
dev_type_read(kdread);
dev_type_write(kdwrite);
dev_type_ioctl(kdioctl);
dev_type_tty(kdtty);
dev_type_poll(kdpoll);
const struct cdevsw kd_cdevsw = {
.d_open = kdopen,
.d_close = kdclose,
.d_read = kdread,
.d_write = kdwrite,
.d_ioctl = kdioctl,
.d_stop = nostop,
.d_tty = kdtty,
.d_poll = kdpoll,
.d_mmap = nommap,
.d_kqfilter = ttykqfilter,
.d_discard = nodiscard,
.d_flag = D_TTY
};
struct tty *fbconstty = 0;
#define PUT_WSIZE 64
struct kd_softc {
struct tty *kd_tty;
int rows, cols;
struct cons_channel *kd_in;
};
static struct kd_softc kd_softc;
static int kd_is_console;
static int kdparam(struct tty *, struct termios *);
static void kdstart(struct tty *);
static void kd_init(struct kd_softc *);
static void kd_cons_input(int);
static int kdcngetc(dev_t);
static void kd_later(void*);
static void kd_putfb(struct tty *);
int cons_ocount;
void
kd_init(struct kd_softc *kd)
{
struct tty *tp;
char prop[6+1];
kd = &kd_softc;
tp = tty_alloc();
callout_setfunc(&tp->t_rstrt_ch, kd_later, tp);
tp->t_oproc = kdstart;
tp->t_param = kdparam;
tp->t_dev = makedev(cdevsw_lookup_major(&kd_cdevsw), 0);
tty_attach(tp);
kd->kd_tty = tp;
if (kd_is_console) {
fbconstty = tp;
}
if (kd->rows == 0 &&
prom_getoption("screen-#rows", prop, sizeof prop) == 0)
kd->rows = strtoul(prop, NULL, 10);
if (kd->cols == 0 &&
prom_getoption("screen-#columns", prop, sizeof prop) == 0)
kd->cols = strtoul(prop, NULL, 10);
}
struct tty *
kdtty(dev_t dev)
{
struct kd_softc *kd;
kd = &kd_softc;
return (kd->kd_tty);
}
int
kdopen(dev_t dev, int flag, int mode, struct lwp *l)
{
struct kd_softc *kd;
int error, s, unit;
struct tty *tp;
static int firstopen = 1;
unit = minor(dev);
if (unit != 0)
return ENXIO;
kd = &kd_softc;
if (firstopen) {
kd_init(kd);
firstopen = 0;
}
tp = kd->kd_tty;
if (kauth_authorize_device_tty(l->l_cred, KAUTH_DEVICE_TTY_OPEN, tp))
return (EBUSY);
s = spltty();
if ((tp->t_state & TS_ISOPEN) == 0) {
struct cons_channel *cc = kd->kd_in;
if (cc != NULL &&
(error = (*cc->cc_iopen)(cc)) != 0) {
splx(s);
return (error);
}
ttychars(tp);
tp->t_iflag = TTYDEF_IFLAG;
tp->t_oflag = TTYDEF_OFLAG;
tp->t_cflag = TTYDEF_CFLAG;
tp->t_lflag = TTYDEF_LFLAG;
tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
(void) kdparam(tp, &tp->t_termios);
ttsetwater(tp);
tp->t_winsize.ws_row = kd->rows;
tp->t_winsize.ws_col = kd->cols;
tp->t_state |= TS_CARR_ON;
}
splx(s);
return ((*tp->t_linesw->l_open)(dev, tp));
}
int
kdclose(dev_t dev, int flag, int mode, struct lwp *l)
{
struct kd_softc *kd;
struct tty *tp;
struct cons_channel *cc;
kd = &kd_softc;
tp = kd->kd_tty;
if ((tp->t_state & TS_ISOPEN) == 0)
return 0;
(*tp->t_linesw->l_close)(tp, flag);
ttyclose(tp);
if ((cc = kd->kd_in) != NULL)
(void)(*cc->cc_iclose)(cc);
return (0);
}
int
kdread(dev_t dev, struct uio *uio, int flag)
{
struct kd_softc *kd;
struct tty *tp;
kd = &kd_softc;
tp = kd->kd_tty;
return ((*tp->t_linesw->l_read)(tp, uio, flag));
}
int
kdwrite(dev_t dev, struct uio *uio, int flag)
{
struct kd_softc *kd;
struct tty *tp;
kd = &kd_softc;
tp = kd->kd_tty;
return ((*tp->t_linesw->l_write)(tp, uio, flag));
}
int
kdpoll(dev_t dev, int events, struct lwp *l)
{
struct kd_softc *kd;
struct tty *tp;
kd = &kd_softc;
tp = kd->kd_tty;
return ((*tp->t_linesw->l_poll)(tp, events, l));
}
int
kdioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
{
struct kd_softc *kd;
struct tty *tp;
int error;
kd = &kd_softc;
tp = kd->kd_tty;
error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, l);
if (error != EPASSTHROUGH)
return error;
error = ttioctl(tp, cmd, data, flag, l);
if (error != EPASSTHROUGH)
return error;
return EPASSTHROUGH;
}
static int
kdparam(struct tty *tp, struct termios *t)
{
tp->t_ispeed = t->c_ispeed;
tp->t_ospeed = t->c_ospeed;
tp->t_cflag = t->c_cflag;
return 0;
}
static void
kdstart(struct tty *tp)
{
struct clist *cl;
int s1, s2;
s1 = splsoftclock();
s2 = spltty();
if (tp->t_state & (TS_BUSY|TS_TTSTOP|TS_TIMEOUT))
goto out;
cl = &tp->t_outq;
if (cl->c_cc) {
if (kd_is_console) {
tp->t_state |= TS_BUSY;
if (s1 == 0) {
splx(s2);
kd_putfb(tp);
s2 = spltty();
tp->t_state &= ~TS_BUSY;
} else {
callout_schedule(&tp->t_rstrt_ch, 0);
}
} else {
ndflush(cl, cl->c_cc);
}
}
ttypull(tp);
out:
splx(s2);
splx(s1);
}
static void
kd_later(void *tpaddr)
{
struct tty *tp = tpaddr;
register int s;
kd_putfb(tp);
s = spltty();
tp->t_state &= ~TS_BUSY;
(*tp->t_linesw->l_start)(tp);
splx(s);
}
static void
kd_putfb(struct tty *tp)
{
char buf[PUT_WSIZE];
struct clist *cl = &tp->t_outq;
char *p, *end;
int len;
while ((len = q_to_b(cl, buf, PUT_WSIZE-1)) > 0) {
p = buf;
end = buf + len;
while (p < end)
*p++ &= 0x7f;
prom_write(prom_stdout(), buf, len);
}
}
static int kd_rom_iopen(struct cons_channel *);
static int kd_rom_iclose(struct cons_channel *);
static struct cons_channel prom_cons_channel;
int
kd_rom_iopen(struct cons_channel *cc)
{
return (0);
}
int
kd_rom_iclose(struct cons_channel *cc)
{
return (0);
}
void
kd_cons_input(int c)
{
struct kd_softc *kd = &kd_softc;
struct tty *tp;
tp = kd->kd_tty;
if (tp == NULL)
return;
if ((tp->t_state & TS_ISOPEN) == 0)
return;
(*tp->t_linesw->l_rint)(c, tp);
}
static struct kbd_state *kdcn_state;
static void kdcnprobe(struct consdev *);
static void kdcninit(struct consdev *);
static void kdcnputc(dev_t, int);
static void kdcnpollc(dev_t, int);
extern struct consdev consdev_prom;
struct consdev consdev_kd = {
.cn_probe = kdcnprobe,
.cn_init = kdcninit,
.cn_getc = kdcngetc,
.cn_putc = kdcnputc,
.cn_pollc = kdcnpollc,
};
struct consdev *cn_hw = &consdev_kd;
void
cons_attach_input(struct cons_channel *cc, struct consdev *cn)
{
struct kd_softc *kd = &kd_softc;
struct kbd_softc *kds = cc->cc_private;
struct kbd_state *ks;
kdcn_state = ks = &kds->k_state;
kd->kd_in = cc;
cc->cc_upstream = kd_cons_input;
cn_hw->cn_dev = cn->cn_dev;
cn_hw->cn_pollc = cn->cn_pollc;
cn_hw->cn_getc = cn->cn_getc;
cn_tab->cn_dev = makedev(cdevsw_lookup_major(&kd_cdevsw), 0);
cn_tab->cn_probe = kdcnprobe;
cn_tab->cn_init = kdcninit;
cn_tab->cn_getc = kdcngetc;
cn_tab->cn_pollc = kdcnpollc;
cn_tab->cn_pri = CN_INTERNAL;
prom_cons_channel.cc_private = NULL;
prom_cons_channel.cc_iopen = kd_rom_iopen;
prom_cons_channel.cc_iclose = kd_rom_iclose;
kd_is_console = 1;
}
void kd_attach_input(struct cons_channel *);
void
kd_attach_input(struct cons_channel *cc)
{
struct kd_softc *kd = &kd_softc;
kd->kd_in = cc;
cc->cc_upstream = kd_cons_input;
}
static void
kdcnprobe(struct consdev *cn)
{
}
static void
kdcninit(struct consdev *cn)
{
#if 0
struct kbd_state *ks = kdcn_state;
cn->cn_dev = makedev(cdevsw_lookup_major(&kd_cdevsw), 0);
cn->cn_pri = CN_INTERNAL;
ks->kbd_id = KBD_MIN_TYPE;
kbd_xlate_init(ks);
prom_cons_channel.cc_private = NULL;
prom_cons_channel.cc_iopen = kd_rom_iopen;
prom_cons_channel.cc_iclose = kd_rom_iclose;
cons_attach_input(&prom_cons_channel);
kd_is_console = 1;
#endif
}
static int
kdcngetc(dev_t dev)
{
struct kbd_state *ks = kdcn_state;
int code, class, data, keysym;
extern int prom_cngetc(dev_t);
if (cn_hw->cn_getc == prom_cngetc) return (*cn_hw->cn_getc)(dev);
for (;;) {
code = (*cn_hw->cn_getc)(dev);
keysym = kbd_code_to_keysym(ks, code);
class = KEYSYM_CLASS(keysym);
switch (class) {
case KEYSYM_ASCII:
goto out;
case KEYSYM_CLRMOD:
case KEYSYM_SETMOD:
data = (keysym & 0x1F);
if (data > KBMOD_SHIFT_R)
break;
data = 1 << data;
if (class == KEYSYM_SETMOD)
ks->kbd_modbits |= data;
else
ks->kbd_modbits &= ~data;
break;
case KEYSYM_ALL_UP:
ks->kbd_modbits = 0;
break;
default:
break;
}
}
out:
return (keysym);
}
static void
kdcnputc(dev_t dev, int c)
{
int s;
char c0 = (c & 0x7f);
s = splhigh();
prom_write(prom_stdout(), &c0, 1);
splx(s);
}
static void
kdcnpollc(dev_t dev, int on)
{
struct kbd_state *ks = kdcn_state;
if (on) {
#if NFB > 0
fb_unblank();
#endif
ks->kbd_modbits = 0;
} else {
}
(*cn_hw->cn_pollc)(dev, on);
}