#include "opt_ddb.h"
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ite.c,v 1.100 2022/05/28 10:36:22 andvar Exp $");
#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/fcntl.h>
#include <sys/malloc.h>
#include <sys/ioctl.h>
#include <sys/tty.h>
#include <sys/termios.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <sys/proc.h>
#include <dev/cons.h>
#include <sys/kauth.h>
#include <amiga/amiga/cc.h>
#include <amiga/amiga/color.h>
#include <amiga/amiga/custom.h>
#include <amiga/amiga/device.h>
#include <amiga/amiga/isr.h>
#include <amiga/dev/iteioctl.h>
#include <amiga/dev/itevar.h>
#include <amiga/dev/kbdmap.h>
#include <amiga/dev/grfioctl.h>
#include <amiga/dev/grfvar.h>
#include <machine/cpu.h>
#include <sys/conf.h>
#include "grfcc.h"
#include "ite.h"
#define ITEUNIT(dev) (minor(dev))
#define SUBR_INIT(ip) (ip)->grf->g_iteinit(ip)
#define SUBR_DEINIT(ip) (ip)->grf->g_itedeinit(ip)
#define SUBR_PUTC(ip,c,dy,dx,m) (ip)->grf->g_iteputc(ip,c,dy,dx,m)
#define SUBR_CURSOR(ip,flg) (ip)->grf->g_itecursor(ip,flg)
#define SUBR_CLEAR(ip,sy,sx,h,w) (ip)->grf->g_iteclear(ip,sy,sx,h,w)
#define SUBR_SCROLL(ip,sy,sx,count,dir) \
(ip)->grf->g_itescroll(ip,sy,sx,count,dir)
int start_repeat_timeo = 30;
int next_repeat_timeo = 10;
int ite_default_wrap = 1;
struct ite_softc con_itesoftc;
u_char cons_tabs[MAX_TABS];
struct ite_softc *kbd_ite;
u_int bvolume = 10;
u_int bpitch = 660;
u_int bmsec = 75;
static char *bsamplep;
static char sample[20] = {
0,39,75,103,121,127,121,103,75,39,0,
-39,-75,-103,-121,-127,-121,-103,-75,-39
};
static callout_t repeat_ch;
void iteputchar(int c, struct ite_softc *ip);
void ite_putstr(const char * s, int len, dev_t dev);
void iteattach(device_t, device_t, void *);
int itematch(device_t, cfdata_t, void *);
static void iteprecheckwrap(struct ite_softc *);
static void itecheckwrap(struct ite_softc *);
struct ite_softc *getitesp(dev_t);
void init_bell(void);
void ite_bell(void);
void itecnpollc(dev_t, int);
static void repeat_handler(void *);
inline static void ite_sendstr(const char *);
static void alignment_display(struct ite_softc *);
inline static void snap_cury(struct ite_softc *);
inline static void ite_dnchar(struct ite_softc *, int);
inline static void ite_inchar(struct ite_softc *, int);
inline static void ite_clrtoeol(struct ite_softc *);
inline static void ite_clrtobol(struct ite_softc *);
inline static void ite_clrline(struct ite_softc *);
inline static void ite_clrtoeos(struct ite_softc *);
inline static void ite_clrtobos(struct ite_softc *);
inline static void ite_clrscreen(struct ite_softc *);
inline static void ite_dnline(struct ite_softc *, int);
inline static void ite_inline(struct ite_softc *, int);
inline static void ite_lf(struct ite_softc *);
inline static void ite_crlf(struct ite_softc *);
inline static void ite_cr(struct ite_softc *);
inline static void ite_rlf(struct ite_softc *);
inline static int atoi(const char *);
inline static int ite_argnum(struct ite_softc *);
inline static int ite_zargnum(struct ite_softc *);
CFATTACH_DECL_NEW(ite, sizeof(struct ite_softc),
itematch, iteattach, NULL, NULL);
extern struct cfdriver ite_cd;
dev_type_open(iteopen);
dev_type_close(iteclose);
dev_type_read(iteread);
dev_type_write(itewrite);
dev_type_ioctl(iteioctl);
dev_type_tty(itetty);
dev_type_poll(itepoll);
const struct cdevsw ite_cdevsw = {
.d_open = iteopen,
.d_close = iteclose,
.d_read = iteread,
.d_write = itewrite,
.d_ioctl = iteioctl,
.d_stop = nostop,
.d_tty = itetty,
.d_poll = itepoll,
.d_mmap = nommap,
.d_kqfilter = ttykqfilter,
.d_discard = nodiscard,
.d_flag = D_TTY
};
int
itematch(device_t parent, cfdata_t cf, void *aux)
{
struct grf_softc *gp;
int maj;
gp = aux;
maj = cdevsw_lookup_major(&ite_cdevsw);
gp->g_itedev = makedev(maj, cf->cf_unit);
return(1);
}
void
iteattach(device_t parent, device_t self, void *aux)
{
struct grf_softc *gp;
struct ite_softc *ip;
int s;
gp = aux;
if (self) {
ip = device_private(self);
s = spltty();
if (con_itesoftc.grf != NULL &&
con_itesoftc.grf->g_unit == gp->g_unit) {
memcpy(&ip->grf, &con_itesoftc.grf,
(char *)&ip[1] - (char *)&ip->grf);
con_itesoftc.grf = NULL;
kbd_ite = ip;
}
ip->grf = gp;
splx(s);
iteinit(gp->g_itedev);
printf(": rows %d cols %d", ip->rows, ip->cols);
printf(" repeat at (%d/100)s next at (%d/100)s",
start_repeat_timeo, next_repeat_timeo);
if (kbd_ite == NULL)
kbd_ite = ip;
if (kbd_ite == ip)
printf(" has keyboard");
printf("\n");
ip->flags |= ITE_ATTACHED;
} else {
if (con_itesoftc.grf != NULL &&
con_itesoftc.grf->g_conpri > gp->g_conpri)
return;
con_itesoftc.grf = gp;
con_itesoftc.tabs = cons_tabs;
}
}
struct ite_softc *
getitesp(dev_t dev)
{
if (amiga_realconfig && con_itesoftc.grf == NULL)
return(device_lookup_private(&ite_cd, ITEUNIT(dev)));
if (con_itesoftc.grf == NULL)
panic("no ite_softc for console");
return(&con_itesoftc);
}
void
itecnprobe(struct consdev *cd)
{
if (con_itesoftc.grf == NULL)
cd->cn_pri = CN_DEAD;
else {
cd->cn_pri = con_itesoftc.grf->g_conpri;
cd->cn_dev = con_itesoftc.grf->g_itedev;
}
}
void
init_bell(void)
{
if (bsamplep != NULL)
return;
bsamplep = alloc_chipmem(20);
if (bsamplep == NULL)
panic("no chipmem for ite_bell");
memcpy(bsamplep, sample, 20);
}
void
ite_bell(void)
{
u_int clock;
u_int period;
u_int count;
clock = 3579545;
period = clock / (bpitch * 20);
count = bmsec * bpitch / 1000;
play_sample(10, PREP_DMA_MEM(bsamplep), period, bvolume, 0x3, count);
}
void
itecninit(struct consdev *cd)
{
struct ite_softc *ip;
ip = getitesp(cd->cn_dev);
iteinit(cd->cn_dev);
ip->flags |= ITE_ACTIVE | ITE_ISCONS;
#ifdef DRACO
if (!is_draco())
#endif
init_bell();
}
void
ite_cnfinish(struct ite_softc *ip)
{
static int done;
if (done)
return;
done = 1;
}
int
itecngetc(dev_t dev)
{
int c;
kbdenable();
do {
c = kbdgetcn();
c = ite_cnfilter(c, ITEFILT_CONSOLE);
} while (c == -1);
return (c);
}
void
itecnputc(dev_t dev, int c)
{
static int paniced;
struct ite_softc *ip;
char ch;
ip = getitesp(dev);
ch = c;
if (panicstr && !paniced &&
(ip->flags & (ITE_ACTIVE | ITE_INGRF)) != ITE_ACTIVE) {
ite_on(dev, 3);
paniced = 1;
}
iteputchar(ch, ip);
}
void
itecnpollc(dev_t dev, int on)
{
}
void
iteinit(dev_t dev)
{
struct ite_softc *ip;
static int kbdmap_loaded = 0;
ip = getitesp(dev);
if (ip->flags & ITE_INITED)
return;
if (kbdmap_loaded == 0) {
memcpy(&kbdmap, &ascii_kbdmap, sizeof(struct kbdmap));
kbdmap_loaded = 1;
}
callout_init(&repeat_ch, 0);
ip->cursorx = 0;
ip->cursory = 0;
if (ip->grf->g_iteinit == NULL)
return;
SUBR_INIT(ip);
SUBR_CURSOR(ip, DRAW_CURSOR);
if (ip->tabs == NULL)
ip->tabs = malloc(MAX_TABS * sizeof(u_char),M_DEVBUF,M_WAITOK);
ite_reset(ip);
ip->flags |= ITE_INITED;
}
int
iteopen(dev_t dev, int mode, int devtype, struct lwp *l)
{
struct ite_softc *ip;
struct tty *tp;
int error, first, unit;
unit = ITEUNIT(dev);
first = 0;
if (unit >= ite_cd.cd_ndevs)
return ENXIO;
ip = getitesp(dev);
if (ip == NULL)
return ENXIO;
if ((ip->flags & ITE_ATTACHED) == 0)
return ENXIO;
if (ip->tp == NULL) {
tp = ip->tp = tty_alloc();
tty_attach(tp);
} else
tp = ip->tp;
if (kauth_authorize_device_tty(l->l_cred, KAUTH_DEVICE_TTY_OPEN, tp))
return (EBUSY);
if ((ip->flags & ITE_ACTIVE) == 0) {
ite_on(dev, 0);
first = 1;
}
tp->t_oproc = itestart;
tp->t_param = ite_param;
tp->t_dev = dev;
if ((tp->t_state & TS_ISOPEN) == 0 && tp->t_wopen == 0) {
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;
tp->t_state = TS_CARR_ON;
ttsetwater(tp);
}
error = ttyopen(tp, 0, mode & O_NONBLOCK);
if (error)
goto bad;
error = tp->t_linesw->l_open(dev, tp);
if (error)
goto bad;
tp->t_winsize.ws_row = ip->rows;
tp->t_winsize.ws_col = ip->cols;
kbdenable();
return (0);
bad:
if (first)
ite_off(dev, 0);
return (error);
}
int
iteclose(dev_t dev, int flag, int mode, struct lwp *l)
{
struct tty *tp;
tp = getitesp(dev)->tp;
KDASSERT(tp);
tp->t_linesw->l_close(tp, flag);
ttyclose(tp);
ite_off(dev, 0);
return (0);
}
int
iteread(dev_t dev, struct uio *uio, int flag)
{
struct tty *tp;
tp = getitesp(dev)->tp;
KDASSERT(tp);
return tp->t_linesw->l_read(tp, uio, flag);
}
int
itewrite(dev_t dev, struct uio *uio, int flag)
{
struct tty *tp;
tp = getitesp(dev)->tp;
KDASSERT(tp);
return tp->t_linesw->l_write(tp, uio, flag);
}
int
itepoll(dev_t dev, int events, struct lwp *l)
{
struct tty *tp;
tp = getitesp(dev)->tp;
KDASSERT(tp);
return ((*tp->t_linesw->l_poll)(tp, events, l));
}
struct tty *
itetty(dev_t dev)
{
return (getitesp(dev)->tp);
}
int
iteioctl(dev_t dev, u_long cmd, void *addr, int flag, struct lwp *l)
{
struct iterepeat *irp;
struct ite_softc *ip;
struct itebell *ib;
struct tty *tp;
int error;
ip = getitesp(dev);
tp = ip->tp;
KDASSERT(tp);
error = tp->t_linesw->l_ioctl(tp, cmd, addr, flag, l);
if (error != EPASSTHROUGH)
return (error);
error = ttioctl(tp, cmd, addr, flag, l);
if (error != EPASSTHROUGH)
return (error);
switch (cmd) {
case ITEIOCGBELL:
ib = (struct itebell *)addr;
ib->volume = bvolume;
ib->pitch = bpitch;
ib->msec = bmsec;
return (0);
case ITEIOCSBELL:
ib = (struct itebell *)addr;
if (ib->pitch > MAXBPITCH || ib->pitch < MINBPITCH ||
ib->volume > MAXBVOLUME || ib->msec > MAXBTIME)
return (EINVAL);
bvolume = ib->volume;
bpitch = ib->pitch;
bmsec = ib->msec;
return (0);
case ITEIOCSKMAP:
if (addr == 0)
return(EFAULT);
memcpy(&kbdmap, addr, sizeof(struct kbdmap));
return(0);
case ITEIOCGKMAP:
if (addr == NULL)
return(EFAULT);
memcpy(addr, &kbdmap, sizeof(struct kbdmap));
return(0);
case ITEIOCGREPT:
irp = (struct iterepeat *)addr;
irp->start = start_repeat_timeo;
irp->next = next_repeat_timeo;
return (0);
case ITEIOCSREPT:
irp = (struct iterepeat *)addr;
if (irp->start < ITEMINREPEAT && irp->next < ITEMINREPEAT)
return(EINVAL);
start_repeat_timeo = irp->start;
next_repeat_timeo = irp->next;
return(0);
}
#if NGRFCC > 0
if (minor(dev) == 0) {
error = ite_grf_ioctl(ip, cmd, addr, flag, l);
if (error >= 0)
return (error);
}
#endif
return (EPASSTHROUGH);
}
void
itestart(struct tty *tp)
{
struct clist *rbp;
u_char buf[ITEBURST];
int s, len;
(void)getitesp(tp->t_dev);
KDASSERT(tp);
s = spltty(); {
if (tp->t_state & (TS_TIMEOUT | TS_BUSY | TS_TTSTOP))
goto out;
tp->t_state |= TS_BUSY;
rbp = &tp->t_outq;
len = q_to_b(rbp, buf, ITEBURST);
} splx(s);
ite_putstr(buf, len, tp->t_dev);
s = spltty(); {
tp->t_state &= ~TS_BUSY;
if (ttypull(tp)) {
tp->t_state |= TS_TIMEOUT;
callout_schedule(&tp->t_rstrt_ch, 1);
}
}
out:
splx(s);
}
void
ite_on(dev_t dev, int flag)
{
struct ite_softc *ip;
ip = getitesp(dev);
if (flag & 1) {
ip->flags |= ITE_ACTIVE;
ip->flags &= ~(ITE_INGRF | ITE_INITED);
}
if (flag & 2) {
ip->flags &= ~ITE_INGRF;
if ((ip->flags & ITE_ACTIVE) == 0)
return;
}
ip->flags |= ITE_ACTIVE;
if (ip->flags & ITE_INGRF)
return;
iteinit(dev);
}
void
ite_off(dev_t dev, int flag)
{
struct ite_softc *ip;
ip = getitesp(dev);
if (flag & 2)
ip->flags |= ITE_INGRF;
if ((ip->flags & ITE_ACTIVE) == 0)
return;
if ((flag & 1) ||
(ip->flags & (ITE_INGRF | ITE_ISCONS | ITE_INITED)) == ITE_INITED)
SUBR_DEINIT(ip);
if ((flag & 2) == 0)
ip->flags &= ~ITE_ACTIVE;
}
void
ite_reinit(dev_t dev)
{
struct ite_softc *ip;
ip = getitesp(dev);
ip->flags &= ~ITE_INITED;
iteinit(dev);
}
int
ite_param(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);
}
void
ite_reset(struct ite_softc *ip)
{
int i;
ip->curx = 0;
ip->cury = 0;
ip->attribute = ATTR_NOR;
ip->save_curx = 0;
ip->save_cury = 0;
ip->save_attribute = ATTR_NOR;
ip->ap = ip->argbuf;
ip->emul_level = 0;
ip->eightbit_C1 = 0;
ip->top_margin = 0;
ip->bottom_margin = ip->rows - 1;
ip->inside_margins = 0;
ip->linefeed_newline = 0;
ip->auto_wrap = ite_default_wrap;
ip->cursor_appmode = 0;
ip->keypad_appmode = 0;
ip->imode = 0;
ip->key_repeat = 1;
memset(ip->tabs, 0, ip->cols);
for (i = 0; i < ip->cols; i++)
ip->tabs[i] = ((i & 7) == 0);
}
static u_char key_mod;
static u_char last_dead;
int
ite_cnfilter(u_char c, enum caller caller)
{
struct key key;
u_char code, up, mask;
int s, i;
up = c & 0x80 ? 1 : 0;
c &= 0x7f;
code = 0;
s = spltty();
i = (int)c - KBD_LEFT_SHIFT;
if (i >= 0 && i <= (KBD_RIGHT_META - KBD_LEFT_SHIFT)) {
mask = 1 << i;
if (up)
key_mod &= ~mask;
else
key_mod |= mask;
splx(s);
return -1;
}
if (up) {
splx(s);
return -1;
}
if (key_mod & KBD_MOD_SHIFT) {
if (key_mod & KBD_MOD_ALT)
key = kbdmap.alt_shift_keys[c];
else
key = kbdmap.shift_keys[c];
} else if (key_mod & KBD_MOD_ALT)
key = kbdmap.alt_keys[c];
else {
key = kbdmap.keys[c];
if ((key_mod & KBD_MOD_CAPS) && (key.mode & KBD_MODE_CAPS))
key = kbdmap.shift_keys[c];
}
code = key.code;
if (key.mode & (KBD_MODE_STRING | KBD_MODE_KPAD)) {
splx(s);
return -1;
}
if (key.mode & KBD_MODE_DEAD) {
if (last_dead == (key.mode & KBD_MODE_ACCMASK))
last_dead = 0;
else {
last_dead = key.mode & KBD_MODE_ACCMASK;
splx(s);
return -1;
}
}
if (last_dead) {
if (code >= '@' && code < 0x7f)
code =
acctable[KBD_MODE_ACCENT(last_dead)][code - '@'];
last_dead = 0;
}
if (key_mod & KBD_MOD_CTRL)
code &= 0x1f;
if (key_mod & KBD_MOD_META)
code |= 0x80;
code = code == '\r' ? '\n' : code;
splx(s);
return (code);
}
static u_char last_char;
static u_char tout_pending;
static void
repeat_handler(void *arg)
{
tout_pending = 0;
if (last_char)
ite_filter(last_char, ITEFILT_REPEATER);
}
void
ite_filter(u_char c, enum caller caller)
{
struct tty *kbd_tty;
u_char code, *str, up, mask;
struct key key;
int s, i;
if (kbd_ite == NULL || kbd_ite->tp == NULL)
return;
kbd_tty = kbd_ite->tp;
s = spltty();
up = c & 0x80 ? 1 : 0;
c &= 0x7f;
code = 0;
i = (int)c - KBD_LEFT_SHIFT;
if (i >= 0 && i <= (KBD_RIGHT_META - KBD_LEFT_SHIFT)) {
mask = 1 << i;
if (up)
key_mod &= ~mask;
else
key_mod |= mask;
splx(s);
return;
}
if (up) {
if (tout_pending) {
callout_stop(&repeat_ch);
tout_pending = 0;
last_char = 0;
}
splx(s);
return;
} else if (tout_pending && last_char != c) {
callout_stop(&repeat_ch);
tout_pending = 0;
last_char = 0;
}
if (key_mod == (KBD_MOD_LALT | KBD_MOD_LMETA) && c == 0x50) {
memcpy(&kbdmap, &ascii_kbdmap, sizeof(struct kbdmap));
splx(s);
return;
#ifdef DDB
} else if (key_mod == (KBD_MOD_LALT | KBD_MOD_LMETA) && c == 0x59) {
Debugger();
splx(s);
return;
#endif
}
if (key_mod & KBD_MOD_SHIFT) {
if (key_mod & KBD_MOD_ALT)
key = kbdmap.alt_shift_keys[c];
else
key = kbdmap.shift_keys[c];
} else if (key_mod & KBD_MOD_ALT)
key = kbdmap.alt_keys[c];
else {
key = kbdmap.keys[c];
if ((key_mod & KBD_MOD_CAPS) && (key.mode & KBD_MODE_CAPS))
key = kbdmap.shift_keys[c];
}
code = key.code;
if (!tout_pending && caller == ITEFILT_TTY && kbd_ite->key_repeat) {
tout_pending = 1;
last_char = c;
callout_reset(&repeat_ch,
start_repeat_timeo * hz / 100, repeat_handler, NULL);
} else if (!tout_pending && caller == ITEFILT_REPEATER &&
kbd_ite->key_repeat) {
tout_pending = 1;
last_char = c;
callout_reset(&repeat_ch,
next_repeat_timeo * hz / 100, repeat_handler, NULL);
}
if (key.mode & KBD_MODE_DEAD) {
if (last_dead == (key.mode & KBD_MODE_ACCMASK))
last_dead = 0;
else {
last_dead = key.mode & KBD_MODE_ACCMASK;
splx(s);
return;
}
}
if (last_dead) {
if (!(key.mode & KBD_MODE_STRING) && code >= '@' &&
code < 0x7f)
code = acctable[KBD_MODE_ACCENT(last_dead)][code - '@'];
last_dead = 0;
}
if (!(key.mode & KBD_MODE_STRING)
&& (!(key.mode & KBD_MODE_KPAD) ||
(kbd_ite && !kbd_ite->keypad_appmode))) {
if (key_mod & KBD_MOD_CTRL)
code &= 0x1f;
if (key_mod & KBD_MOD_META)
code |= 0x80;
} else if ((key.mode & KBD_MODE_KPAD) &&
(kbd_ite && kbd_ite->keypad_appmode)) {
static char in[] = {
0x0f , 0x1d , 0x1e , 0x1f ,
0x2d , 0x2e , 0x2f , 0x3d ,
0x3e , 0x3f , 0x4a , 0x5e ,
0x3c , 0x43 , 0x5a , 0x5b ,
0x5c , 0x5d
};
static const char *out = "pqrstuvwxymlnMPQRS";
char *cp = strchr(in, c);
kbd_tty->t_linesw->l_rint(27, kbd_tty);
kbd_tty->t_linesw->l_rint('O', kbd_tty);
kbd_tty->t_linesw->l_rint(out[cp - in], kbd_tty);
splx(s);
return;
} else {
static u_char app_cursor[] =
{
3, 27, 'O', 'A',
3, 27, 'O', 'B',
3, 27, 'O', 'C',
3, 27, 'O', 'D'};
str = kbdmap.strings + code;
if (c >= 0x4c && c <= 0x4f && kbd_ite->cursor_appmode
&& !memcmp(str, "\x03\x1b[", 3) &&
strchr("ABCD", str[3]))
str = app_cursor + 4 * (str[3] - 'A');
for (i = *str++; i; i--)
kbd_tty->t_linesw->l_rint(*str++, kbd_tty);
splx(s);
return;
}
kbd_tty->t_linesw->l_rint(code, kbd_tty);
splx(s);
return;
}
inline static void
ite_sendstr(const char *str)
{
struct tty *kbd_tty;
kbd_tty = kbd_ite->tp;
KDASSERT(kbd_tty);
while (*str)
kbd_tty->t_linesw->l_rint(*str++, kbd_tty);
}
static void
alignment_display(struct ite_softc *ip)
{
int i, j;
for (j = 0; j < ip->rows; j++)
for (i = 0; i < ip->cols; i++)
SUBR_PUTC(ip, 'E', j, i, ATTR_NOR);
attrclr(ip, 0, 0, ip->rows, ip->cols);
SUBR_CURSOR(ip, DRAW_CURSOR);
}
inline static void
snap_cury(struct ite_softc *ip)
{
if (ip->inside_margins)
{
if (ip->cury < ip->top_margin)
ip->cury = ip->top_margin;
if (ip->cury > ip->bottom_margin)
ip->cury = ip->bottom_margin;
}
}
inline static void
ite_dnchar(struct ite_softc *ip, int n)
{
n = uimin(n, ip->cols - ip->curx);
if (n < ip->cols - ip->curx)
{
SUBR_SCROLL(ip, ip->cury, ip->curx + n, n, SCROLL_LEFT);
attrmov(ip, ip->cury, ip->curx + n, ip->cury, ip->curx,
1, ip->cols - ip->curx - n);
attrclr(ip, ip->cury, ip->cols - n, 1, n);
}
while (n-- > 0)
SUBR_PUTC(ip, ' ', ip->cury, ip->cols - n - 1, ATTR_NOR);
SUBR_CURSOR(ip, DRAW_CURSOR);
}
inline static void
ite_inchar(struct ite_softc *ip, int n)
{
n = uimin(n, ip->cols - ip->curx);
if (n < ip->cols - ip->curx)
{
SUBR_SCROLL(ip, ip->cury, ip->curx, n, SCROLL_RIGHT);
attrmov(ip, ip->cury, ip->curx, ip->cury, ip->curx + n,
1, ip->cols - ip->curx - n);
attrclr(ip, ip->cury, ip->curx, 1, n);
}
while (n--)
SUBR_PUTC(ip, ' ', ip->cury, ip->curx + n, ATTR_NOR);
SUBR_CURSOR(ip, DRAW_CURSOR);
}
inline static void
ite_clrtoeol(struct ite_softc *ip)
{
int y = ip->cury, x = ip->curx;
if (ip->cols - x > 0)
{
SUBR_CLEAR(ip, y, x, 1, ip->cols - x);
attrclr(ip, y, x, 1, ip->cols - x);
SUBR_CURSOR(ip, DRAW_CURSOR);
}
}
inline static void
ite_clrtobol(struct ite_softc *ip)
{
int y = ip->cury, x = uimin(ip->curx + 1, ip->cols);
SUBR_CLEAR(ip, y, 0, 1, x);
attrclr(ip, y, 0, 1, x);
SUBR_CURSOR(ip, DRAW_CURSOR);
}
inline static void
ite_clrline(struct ite_softc *ip)
{
int y = ip->cury;
SUBR_CLEAR(ip, y, 0, 1, ip->cols);
attrclr(ip, y, 0, 1, ip->cols);
SUBR_CURSOR(ip, DRAW_CURSOR);
}
inline static void
ite_clrtoeos(struct ite_softc *ip)
{
ite_clrtoeol(ip);
if (ip->cury < ip->rows - 1)
{
SUBR_CLEAR(ip, ip->cury + 1, 0, ip->rows - 1 - ip->cury, ip->cols);
attrclr(ip, ip->cury, 0, ip->rows - ip->cury, ip->cols);
SUBR_CURSOR(ip, DRAW_CURSOR);
}
}
inline static void
ite_clrtobos(struct ite_softc *ip)
{
ite_clrtobol(ip);
if (ip->cury > 0)
{
SUBR_CLEAR(ip, 0, 0, ip->cury, ip->cols);
attrclr(ip, 0, 0, ip->cury, ip->cols);
SUBR_CURSOR(ip, DRAW_CURSOR);
}
}
inline static void
ite_clrscreen(struct ite_softc *ip)
{
SUBR_CLEAR(ip, 0, 0, ip->rows, ip->cols);
attrclr(ip, 0, 0, ip->rows, ip->cols);
SUBR_CURSOR(ip, DRAW_CURSOR);
}
inline static void
ite_dnline(struct ite_softc *ip, int n)
{
if (ip->cury < ip->top_margin || ip->cury > ip->bottom_margin)
return;
n = uimin(n, ip->bottom_margin + 1 - ip->cury);
if (n <= ip->bottom_margin - ip->cury)
{
SUBR_SCROLL(ip, ip->cury + n, 0, n, SCROLL_UP);
attrmov(ip, ip->cury + n, 0, ip->cury, 0,
ip->bottom_margin + 1 - ip->cury - n, ip->cols);
}
SUBR_CLEAR(ip, ip->bottom_margin - n + 1, 0, n, ip->cols);
attrclr(ip, ip->bottom_margin - n + 1, 0, n, ip->cols);
SUBR_CURSOR(ip, DRAW_CURSOR);
}
inline static void
ite_inline(struct ite_softc *ip, int n)
{
if (ip->cury < ip->top_margin || ip->cury > ip->bottom_margin)
return;
n = uimin(n, ip->bottom_margin + 1 - ip->cury);
if (n <= ip->bottom_margin - ip->cury)
{
SUBR_SCROLL(ip, ip->cury, 0, n, SCROLL_DOWN);
attrmov(ip, ip->cury, 0, ip->cury + n, 0,
ip->bottom_margin + 1 - ip->cury - n, ip->cols);
}
SUBR_CLEAR(ip, ip->cury, 0, n, ip->cols);
attrclr(ip, ip->cury, 0, n, ip->cols);
SUBR_CURSOR(ip, DRAW_CURSOR);
}
inline static void
ite_lf(struct ite_softc *ip)
{
++ip->cury;
if ((ip->cury == ip->bottom_margin+1) || (ip->cury == ip->rows))
{
ip->cury--;
SUBR_SCROLL(ip, ip->top_margin + 1, 0, 1, SCROLL_UP);
ite_clrline(ip);
}
SUBR_CURSOR(ip, MOVE_CURSOR);
clr_attr(ip, ATTR_INV);
}
inline static void
ite_crlf(struct ite_softc *ip)
{
ip->curx = 0;
ite_lf (ip);
}
inline static void
ite_cr(struct ite_softc *ip)
{
if (ip->curx)
{
ip->curx = 0;
SUBR_CURSOR(ip, MOVE_CURSOR);
}
}
inline static void
ite_rlf(struct ite_softc *ip)
{
ip->cury--;
if ((ip->cury < 0) || (ip->cury == ip->top_margin - 1))
{
ip->cury++;
SUBR_SCROLL(ip, ip->top_margin, 0, 1, SCROLL_DOWN);
ite_clrline(ip);
}
SUBR_CURSOR(ip, MOVE_CURSOR);
clr_attr(ip, ATTR_INV);
}
inline static int
atoi(const char *cp)
{
int n;
for (n = 0; *cp && *cp >= '0' && *cp <= '9'; cp++)
n = n * 10 + *cp - '0';
return n;
}
inline static int
ite_argnum(struct ite_softc *ip)
{
char ch;
int n;
if (ip->ap == ip->argbuf)
return 1;
ch = *ip->ap;
*ip->ap = 0;
n = atoi (ip->argbuf);
*ip->ap = ch;
return n;
}
inline static int
ite_zargnum(struct ite_softc *ip)
{
char ch;
int n;
if (ip->ap == ip->argbuf)
return 0;
ch = *ip->ap;
*ip->ap = 0;
n = atoi (ip->argbuf);
*ip->ap = ch;
return n;
}
void
ite_putstr(const char *s, int len, dev_t dev)
{
struct ite_softc *ip;
int i;
ip = getitesp(dev);
if ((ip->flags & (ITE_ACTIVE|ITE_INGRF)) != ITE_ACTIVE)
return;
SUBR_CURSOR(ip, START_CURSOROPT);
for (i = 0; i < len; i++)
if (s[i])
iteputchar(s[i], ip);
SUBR_CURSOR(ip, END_CURSOROPT);
}
static void
iteprecheckwrap(struct ite_softc *ip)
{
if (ip->auto_wrap && ip->curx == ip->cols) {
ip->curx = 0;
clr_attr(ip, ATTR_INV);
if (++ip->cury >= ip->bottom_margin + 1) {
ip->cury = ip->bottom_margin;
SUBR_CURSOR(ip, MOVE_CURSOR);
SUBR_SCROLL(ip, ip->top_margin + 1, 0, 1, SCROLL_UP);
ite_clrtoeol(ip);
} else
SUBR_CURSOR(ip, MOVE_CURSOR);
}
}
static void
itecheckwrap(struct ite_softc *ip)
{
#if 0
if (++ip->curx == ip->cols) {
if (ip->auto_wrap) {
ip->curx = 0;
clr_attr(ip, ATTR_INV);
if (++ip->cury >= ip->bottom_margin + 1) {
ip->cury = ip->bottom_margin;
SUBR_CURSOR(ip, MOVE_CURSOR);
SUBR_SCROLL(ip, ip->top_margin + 1, 0, 1, SCROLL_UP);
ite_clrtoeol(ip);
return;
}
} else
ip->curx--;
}
#else
if (ip->curx < ip->cols) {
ip->curx++;
SUBR_CURSOR(ip, MOVE_CURSOR);
}
#endif
}
void
iteputchar(register int c, struct ite_softc *ip)
{
struct tty *kbd_tty;
int n, x, y;
char *cp;
if (kbd_ite == NULL)
kbd_tty = NULL;
else
kbd_tty = kbd_ite->tp;
if (ip->escape) {
switch (ip->escape) {
case ESC:
switch (c) {
case 'D':
c = IND;
ip->escape = 0;
break;
case 'E':
c = NEL;
ip->escape = 0;
break;
case 'H':
c = HTS;
ip->escape = 0;
break;
case 'M':
c = RI;
ip->escape = 0;
break;
case 'N':
c = SS2;
ip->escape = 0;
break;
case 'O':
c = SS3;
ip->escape = 0;
break;
case 'P':
c = DCS;
ip->escape = 0;
break;
case '[':
c = CSI;
ip->escape = 0;
break;
case '\\':
c = ST;
ip->escape = 0;
break;
case ']':
c = OSC;
ip->escape = 0;
break;
case '^':
c = PM;
ip->escape = 0;
break;
case '_':
c = APC;
ip->escape = 0;
break;
case ' ':
ip->escape = ' ';
break;
case '(':
case ')':
ip->escape = c;
return;
case '*':
case '+':
case 'B':
case 'A':
case '<':
case '0':
case '-':
case '.':
case '/':
case '4':
case '5':
case 'C':
case 'R':
case 'Q':
case 'K':
case 'Y':
case '6':
ip->escape = 0;
return;
case '`':
ip->GR = ip->G1;
ip->escape = 0;
return;
case 'n':
ip->GL = ip->G2;
ip->escape = 0;
return;
case '}':
ip->GR = ip->G2;
ip->escape = 0;
return;
case 'o':
ip->GL = ip->G3;
ip->escape = 0;
return;
case '|':
ip->GR = ip->G3;
ip->escape = 0;
return;
case '#':
ip->escape = '#';
return;
case 'c':
ite_reset(ip);
SUBR_CURSOR(ip, MOVE_CURSOR);
ip->escape = 0;
return;
case '7':
ip->save_curx = ip->curx;
ip->save_cury = ip->cury;
ip->save_attribute = ip->attribute;
ip->escape = 0;
return;
case '8':
ip->curx = ip->save_curx;
ip->cury = ip->save_cury;
ip->attribute = ip->save_attribute;
SUBR_CURSOR(ip, MOVE_CURSOR);
ip->escape = 0;
return;
case '=':
ip->keypad_appmode = 1;
ip->escape = 0;
return;
case '>':
ip->keypad_appmode = 0;
ip->escape = 0;
return;
case 'Z':
if (ip->emul_level == EMUL_VT100)
ite_sendstr("\033[?61;0c");
else
ite_sendstr("\033[?63;0c");
ip->escape = 0;
return;
default:
ip->escape = 0;
return;
}
break;
case '(':
case ')':
ip->escape = 0;
return;
case ' ':
switch (c) {
case 'F':
ip->eightbit_C1 = 0;
ip->escape = 0;
return;
case 'G':
ip->eightbit_C1 = 1;
ip->escape = 0;
return;
default:
ip->escape = 0;
return;
}
break;
case '#':
switch (c) {
case '5':
ip->escape = 0;
return;
case '6':
ip->escape = 0;
return;
case '3':
ip->escape = 0;
return;
case '4':
ip->escape = 0;
return;
case '8':
alignment_display(ip);
ip->escape = 0;
return;
default:
ip->escape = 0;
return;
}
break;
case CSI:
switch (c) {
case '0':
case '1':
case '2':
case '3':
case '4':
case '5':
case '6':
case '7':
case '8':
case '9':
case ';':
case '\"':
case '$':
case '>':
if (ip->ap < ip->argbuf + MAX_ARGSIZE)
*ip->ap++ = c;
return;
case BS:
if (--ip->curx < 0)
ip->curx = 0;
else
SUBR_CURSOR(ip, MOVE_CURSOR);
break;
case 'p':
*ip->ap = 0;
if (!strncmp(ip->argbuf, "61\"", 3))
ip->emul_level = EMUL_VT100;
else if (!strncmp(ip->argbuf, "63;1\"", 5)
|| !strncmp(ip->argbuf, "62;1\"", 5))
ip->emul_level = EMUL_VT300_7;
else
ip->emul_level = EMUL_VT300_8;
ip->escape = 0;
return;
case '?':
*ip->ap = 0;
ip->escape = '?';
ip->ap = ip->argbuf;
return;
case 'c':
*ip->ap = 0;
if (ip->argbuf[0] == '>') {
ite_sendstr("\033[>24;0;0;0c");
} else
switch (ite_zargnum(ip)) {
case 0:
if (ip->emul_level
== EMUL_VT100)
ite_sendstr(
"\033[?1;1c");
else
ite_sendstr(
"\033[?63;1c");
break;
}
ip->escape = 0;
return;
case 'n':
switch (ite_zargnum(ip)) {
case 5:
ite_sendstr("\033[0n");
break;
case 6:
snprintf(ip->argbuf, sizeof(ip->argbuf),
"\033[%d;%dR",
ip->cury + 1, ip->curx + 1);
ite_sendstr(ip->argbuf);
break;
}
ip->escape = 0;
return;
case 'x':
switch (ite_zargnum(ip)) {
case 0:
ite_sendstr("\033[2;1;1;112;112;1;0x");
break;
case 1:
ite_sendstr("\033[3;1;1;112;112;1;0x");
break;
}
ip->escape = 0;
return;
case 'g':
switch (ite_zargnum(ip)) {
case 0:
if (ip->curx < ip->cols)
ip->tabs[ip->curx] = 0;
break;
case 3:
for (n = 0; n < ip->cols; n++)
ip->tabs[n] = 0;
break;
}
ip->escape = 0;
return;
case 'h':
case 'l':
n = ite_zargnum(ip);
switch (n) {
case 4:
ip->imode = (c == 'h');
break;
case 20:
ip->linefeed_newline = (c == 'h');
break;
}
ip->escape = 0;
return;
case 'M':
ite_dnline(ip, ite_argnum(ip));
ip->escape = 0;
return;
case 'L':
ite_inline(ip, ite_argnum(ip));
ip->escape = 0;
return;
case 'P':
ite_dnchar(ip, ite_argnum(ip));
ip->escape = 0;
return;
case '@':
ite_inchar(ip, ite_argnum(ip));
ip->escape = 0;
return;
case 'G':
*ip->ap = 0;
x = atoi(ip->argbuf);
if (x)
x--;
ip->curx = uimin(x, ip->cols - 1);
ip->escape = 0;
SUBR_CURSOR(ip, MOVE_CURSOR);
clr_attr(ip, ATTR_INV);
return;
case 'd':
*ip->ap = 0;
y = atoi(ip->argbuf);
if (y)
y--;
if (ip->inside_margins)
y += ip->top_margin;
ip->cury = uimin(y, ip->rows - 1);
ip->escape = 0;
snap_cury(ip);
SUBR_CURSOR(ip, MOVE_CURSOR);
clr_attr(ip, ATTR_INV);
return;
case 'H':
case 'f':
*ip->ap = 0;
y = atoi(ip->argbuf);
x = 0;
cp = strchr(ip->argbuf, ';');
if (cp)
x = atoi(cp + 1);
if (x)
x--;
if (y)
y--;
if (ip->inside_margins)
y += ip->top_margin;
ip->cury = uimin(y, ip->rows - 1);
ip->curx = uimin(x, ip->cols - 1);
ip->escape = 0;
snap_cury(ip);
SUBR_CURSOR(ip, MOVE_CURSOR);
clr_attr(ip, ATTR_INV);
return;
case 'A':
n = ite_argnum(ip);
n = ip->cury - (n ? n : 1);
if (n < 0)
n = 0;
if (ip->inside_margins)
n = uimax(ip->top_margin, n);
else if (n == ip->top_margin - 1)
n = ip->top_margin;
ip->cury = n;
ip->escape = 0;
SUBR_CURSOR(ip, MOVE_CURSOR);
clr_attr(ip, ATTR_INV);
return;
case 'B':
n = ite_argnum(ip);
n = ip->cury + (n ? n : 1);
n = uimin(ip->rows - 1, n);
if (ip->inside_margins)
n = uimin(ip->bottom_margin, n);
else if (n == ip->bottom_margin + 1)
n = ip->bottom_margin;
ip->cury = n;
ip->escape = 0;
SUBR_CURSOR(ip, MOVE_CURSOR);
clr_attr(ip, ATTR_INV);
return;
case 'C':
n = ite_argnum(ip);
n = n ? n : 1;
ip->curx = uimin(ip->curx + n, ip->cols - 1);
ip->escape = 0;
SUBR_CURSOR(ip, MOVE_CURSOR);
clr_attr(ip, ATTR_INV);
return;
case 'D':
n = ite_argnum(ip);
n = n ? n : 1;
n = ip->curx - n;
ip->curx = n >= 0 ? n : 0;
ip->escape = 0;
SUBR_CURSOR(ip, MOVE_CURSOR);
clr_attr(ip, ATTR_INV);
return;
case 'J':
*ip->ap = 0;
n = ite_zargnum(ip);
if (n == 0)
ite_clrtoeos(ip);
else if (n == 1)
ite_clrtobos(ip);
else if (n == 2)
ite_clrscreen(ip);
ip->escape = 0;
return;
case 'K':
n = ite_zargnum(ip);
if (n == 0)
ite_clrtoeol(ip);
else if (n == 1)
ite_clrtobol(ip);
else if (n == 2)
ite_clrline(ip);
ip->escape = 0;
return;
case 'X':
n = ite_argnum(ip) - 1;
n = uimin(n, ip->cols - 1 - ip->curx);
for (; n >= 0; n--) {
attrclr(ip, ip->cury, ip->curx + n, 1, 1);
SUBR_PUTC(ip, ' ', ip->cury, ip->curx + n, ATTR_NOR);
}
ip->escape = 0;
return;
case '}':
case '`':
ip->escape = 0;
return;
case 'r':
*ip->ap = 0;
x = atoi(ip->argbuf);
x = x ? x : 1;
y = ip->rows;
cp = strchr(ip->argbuf, ';');
if (cp) {
y = atoi(cp + 1);
y = y ? y : ip->rows;
}
if (y - x < 2) {
x = 1;
y = ip->rows;
}
x--;
y--;
ip->top_margin = uimin(x, ip->rows - 1);
ip->bottom_margin = uimin(y, ip->rows - 1);
if (ip->inside_margins) {
ip->cury = ip->top_margin;
ip->curx = 0;
SUBR_CURSOR(ip, MOVE_CURSOR);
}
ip->escape = 0;
return;
case 'm':
{ char *_cp;
*ip->ap = 0;
if (ip->ap == ip->argbuf)
ip->ap++;
for (_cp = ip->argbuf; _cp < ip->ap;) {
switch (*_cp) {
case 0:
case '0':
clr_attr(ip, ATTR_ALL);
_cp++;
break;
case '1':
set_attr(ip, ATTR_BOLD);
_cp++;
break;
case '2':
switch (_cp[1]) {
case '2':
clr_attr(ip, ATTR_BOLD);
_cp += 2;
break;
case '4':
clr_attr(ip, ATTR_UL);
_cp += 2;
break;
case '5':
clr_attr(ip, ATTR_BLINK);
_cp += 2;
break;
case '7':
clr_attr(ip, ATTR_INV);
_cp += 2;
break;
default:
_cp++;
break;
}
break;
case '4':
set_attr(ip, ATTR_UL);
_cp++;
break;
case '5':
set_attr(ip, ATTR_BLINK);
_cp++;
break;
case '7':
set_attr(ip, ATTR_INV);
_cp++;
break;
default:
_cp++;
break;
}
}
ip->escape = 0;
return; }
case 'u':
ite_sendstr("\033P\033\\");
ip->escape = 0;
return;
default:
ip->escape = 0;
return;
}
break;
case '?':
switch (c) {
case '0':
case '1':
case '2':
case '3':
case '4':
case '5':
case '6':
case '7':
case '8':
case '9':
case ';':
case '\"':
case '$':
if (ip->ap < ip->argbuf + MAX_ARGSIZE - 1)
*ip->ap++ = c;
return;
case 'n':
*ip->ap = 0;
if (ip->ap == &ip->argbuf[2]) {
if (!strncmp(ip->argbuf, "15", 2))
ite_sendstr("\033[13n");
else if (!strncmp(ip->argbuf, "25", 2))
ite_sendstr("\033[20n");
else if (!strncmp(ip->argbuf, "26", 2))
ite_sendstr("\033[27;1n");
}
ip->escape = 0;
return;
case 'h':
case 'l':
n = ite_zargnum(ip);
switch (n) {
case 1:
ip->cursor_appmode = (c == 'h');
break;
case 3:
break;
case 4:
break;
case 5:
break;
case 6:
ip->inside_margins = (c == 'h');
ip->curx = 0;
ip->cury = ip->inside_margins ?
ip->top_margin : 0;
SUBR_CURSOR(ip, MOVE_CURSOR);
break;
case 7:
ip->auto_wrap = (c == 'h');
break;
case 8:
ip->key_repeat = (c == 'h');
break;
case 20:
ip->linefeed_newline = (c == 'h');
break;
case 25:
SUBR_CURSOR(ip, (c == 'h') ?
DRAW_CURSOR : ERASE_CURSOR);
break;
}
ip->escape = 0;
return;
default:
ip->escape = 0;
return;
}
break;
default:
ip->escape = 0;
return;
}
}
switch (c) {
case VT:
case FF:
case LF:
if (ip->linefeed_newline)
ite_crlf(ip);
else
ite_lf(ip);
break;
case CR:
ite_cr(ip);
break;
case BS:
if (--ip->curx < 0)
ip->curx = 0;
else
SUBR_CURSOR(ip, MOVE_CURSOR);
break;
case HT:
for (n = ip->curx + 1; n < ip->cols; n++) {
if (ip->tabs[n]) {
ip->curx = n;
SUBR_CURSOR(ip, MOVE_CURSOR);
break;
}
}
break;
case BEL:
if (kbd_tty && kbd_ite && kbd_ite->tp == kbd_tty
#ifdef DRACO
&& !is_draco()
#endif
)
ite_bell();
break;
case SO:
ip->GL = ip->G1;
break;
case SI:
ip->GL = ip->G0;
break;
case ENQ:
break;
case CAN:
ip->escape = 0;
break;
case SUB:
ip->escape = 0;
break;
case ESC:
ip->escape = ESC;
break;
case IND:
ite_lf(ip);
break;
case NEL:
ite_crlf(ip);
break;
case HTS:
if (ip->curx < ip->cols)
ip->tabs[ip->curx] = 1;
break;
case RI:
ite_rlf(ip);
break;
case SS2:
break;
case SS3:
break;
case DCS:
ip->escape = DCS;
ip->ap = ip->argbuf;
break;
case CSI:
ip->escape = CSI;
ip->ap = ip->argbuf;
break;
case ST:
break;
case OSC:
ip->escape = OSC;
break;
case PM:
ip->escape = PM;
break;
case APC:
ip->escape = APC;
break;
default:
if ((c & 0x7f) < ' ' || c == DEL)
break;
if (ip->imode)
ite_inchar(ip, 1);
iteprecheckwrap(ip);
#ifdef DO_WEIRD_ATTRIBUTES
if ((ip->attribute & ATTR_INV) || attrtest(ip, ATTR_INV)) {
attrset(ip, ATTR_INV);
SUBR_PUTC(ip, c, ip->cury, ip->curx, ATTR_INV);
} else
SUBR_PUTC(ip, c, ip->cury, ip->curx, ATTR_NOR);
#else
SUBR_PUTC(ip, c, ip->cury, ip->curx, ip->attribute);
#endif
SUBR_CURSOR(ip, DRAW_CURSOR);
itecheckwrap(ip);
break;
}
}