#include <sys/param.h>
#include <sys/systm.h>
#include <sys/ioctl.h>
#include <sys/proc.h>
#define TTYDEFCHARS
#include <sys/tty.h>
#undef TTYDEFCHARS
#include <sys/fcntl.h>
#include <sys/conf.h>
#include <sys/uio.h>
#include <sys/kernel.h>
#include <sys/vnode.h>
#include <sys/lock.h>
#include <sys/malloc.h>
#include <sys/msgbuf.h>
#include <sys/signalvar.h>
#include <sys/resourcevar.h>
#include <sys/sysctl.h>
#include <sys/pool.h>
#include <sys/unistd.h>
#include <sys/pledge.h>
#include <sys/namei.h>
#include <uvm/uvm_extern.h>
#include <dev/cons.h>
#include "pty.h"
static int ttnread(struct tty *);
static void ttyblock(struct tty *);
void ttyunblock(struct tty *);
static void ttyecho(int, struct tty *);
static void ttyrubo(struct tty *, int);
int filt_ttyread(struct knote *kn, long hint);
void filt_ttyrdetach(struct knote *kn);
int filt_ttywrite(struct knote *kn, long hint);
void filt_ttywdetach(struct knote *kn);
int filt_ttyexcept(struct knote *kn, long hint);
void ttystats_init(struct itty **, int *, size_t *);
int ttywait_nsec(struct tty *, uint64_t);
char ttclos[] = "ttycls";
char ttopen[] = "ttyopn";
char ttybg[] = "ttybg";
char ttyin[] = "ttyin";
char ttyout[] = "ttyout";
#define E 0x00
#define O 0x80
#define PARITY(c) (char_type[c] & O)
#define ALPHA 0x40
#define ISALPHA(c) (char_type[(c) & TTY_CHARMASK] & ALPHA)
#define CCLASSMASK 0x3f
#define CCLASS(c) (char_type[c] & CCLASSMASK)
#define BS BACKSPACE
#define CC CONTROL
#define CR RETURN
#define NA ORDINARY | ALPHA
#define NL NEWLINE
#define NO ORDINARY
#define TB TAB
#define VT VTAB
u_char const char_type[] = {
E|CC, O|CC, O|CC, E|CC, O|CC, E|CC, E|CC, O|CC,
O|BS, E|TB, E|NL, O|CC, E|VT, O|CR, O|CC, E|CC,
O|CC, E|CC, E|CC, O|CC, E|CC, O|CC, O|CC, E|CC,
E|CC, O|CC, O|CC, E|CC, O|CC, E|CC, E|CC, O|CC,
O|NO, E|NO, E|NO, O|NO, E|NO, O|NO, O|NO, E|NO,
E|NO, O|NO, O|NO, E|NO, O|NO, E|NO, E|NO, O|NO,
E|NA, O|NA, O|NA, E|NA, O|NA, E|NA, E|NA, O|NA,
O|NA, E|NA, E|NO, O|NO, E|NO, O|NO, O|NO, E|NO,
O|NO, E|NA, E|NA, O|NA, E|NA, O|NA, O|NA, E|NA,
E|NA, O|NA, O|NA, E|NA, O|NA, E|NA, E|NA, O|NA,
E|NA, O|NA, O|NA, E|NA, O|NA, E|NA, E|NA, O|NA,
O|NA, E|NA, E|NA, O|NO, E|NO, O|NO, O|NO, O|NA,
E|NO, O|NA, O|NA, E|NA, O|NA, E|NA, E|NA, O|NA,
O|NA, E|NA, E|NA, O|NA, E|NA, O|NA, O|NA, E|NA,
O|NA, E|NA, E|NA, O|NA, E|NA, O|NA, O|NA, E|NA,
E|NA, O|NA, O|NA, E|NO, O|NO, E|NO, E|NO, O|CC,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
NA, NA, NA, NA, NA, NA, NA, NA,
};
#undef BS
#undef CC
#undef CR
#undef NA
#undef NL
#undef NO
#undef TB
#undef VT
#define islower(c) ((c) >= 'a' && (c) <= 'z')
#define isupper(c) ((c) >= 'A' && (c) <= 'Z')
#define tolower(c) ((c) - 'A' + 'a')
#define toupper(c) ((c) - 'a' + 'A')
struct ttylist_head ttylist;
int tty_count;
struct rwlock ttylist_lock = RWLOCK_INITIALIZER("ttylist");
int64_t tk_cancc, tk_nin, tk_nout, tk_rawcc;
int
ttyopen(dev_t device, struct tty *tp, struct proc *p)
{
int s;
s = spltty();
tp->t_dev = device;
if (!ISSET(tp->t_state, TS_ISOPEN)) {
SET(tp->t_state, TS_ISOPEN);
memset(&tp->t_winsize, 0, sizeof(tp->t_winsize));
tp->t_column = 0;
}
CLR(tp->t_state, TS_WOPEN);
splx(s);
return (0);
}
int
ttyclose(struct tty *tp)
{
if (constty == tp)
constty = NULL;
ttyflush(tp, FREAD | FWRITE);
tp->t_gen++;
tp->t_pgrp = NULL;
if (tp->t_session)
SESSRELE(tp->t_session);
tp->t_session = NULL;
tp->t_state = 0;
return (0);
}
#define FLUSHQ(q) { \
if ((q)->c_cc) \
ndflush(q, (q)->c_cc); \
}
#define TTBREAKC(c, lflag) \
((c) == '\n' || (((c) == cc[VEOF] || (c) == cc[VEOL] || \
((c) == cc[VEOL2] && (lflag & IEXTEN))) && (c) != _POSIX_VDISABLE))
int
ttyinput(int c, struct tty *tp)
{
int iflag, lflag;
u_char *cc;
int i, error, ret = 0;
int s;
enqueue_randomness(tp->t_dev << 8 | c);
if (!ISSET(tp->t_cflag, CREAD))
return (0);
lflag = tp->t_lflag;
s = spltty();
if (ISSET(lflag, PENDIN))
ttypend(tp);
splx(s);
if (ISSET(lflag, ICANON)) {
++tk_cancc;
++tp->t_cancc;
} else {
++tk_rawcc;
++tp->t_rawcc;
}
++tk_nin;
cc = tp->t_cc;
iflag = tp->t_iflag;
if ((error = (ISSET(c, TTY_ERRORMASK))) != 0) {
CLR(c, TTY_ERRORMASK);
if (ISSET(error, TTY_FE) && !c) {
if (ISSET(iflag, IGNBRK))
return (0);
ttyflush(tp, FREAD | FWRITE);
if (ISSET(iflag, BRKINT)) {
pgsignal(tp->t_pgrp, SIGINT, 1);
goto endcase;
}
else if (ISSET(iflag, PARMRK))
goto parmrk;
} else if ((ISSET(error, TTY_PE) && ISSET(iflag, INPCK)) ||
ISSET(error, TTY_FE)) {
if (ISSET(iflag, IGNPAR))
goto endcase;
else if (ISSET(iflag, PARMRK)) {
parmrk: (void)putc(0377 | TTY_QUOTE, &tp->t_rawq);
if (ISSET(iflag, ISTRIP) || c != 0377)
(void)putc(0 | TTY_QUOTE, &tp->t_rawq);
(void)putc(c | TTY_QUOTE, &tp->t_rawq);
goto endcase;
} else
c = 0;
}
}
if (c == 0377 && !ISSET(iflag, ISTRIP) && ISSET(iflag, PARMRK))
goto parmrk;
if (ISSET(iflag, IXOFF) || ISSET(tp->t_cflag, CHWFLOW))
ttyblock(tp);
if (!ISSET(tp->t_state, TS_TYPEN) && ISSET(iflag, ISTRIP))
CLR(c, 0x80);
if (!ISSET(lflag, EXTPROC)) {
if (ISSET(tp->t_state, TS_LNCH)) {
SET(c, TTY_QUOTE);
CLR(tp->t_state, TS_LNCH);
}
if (ISSET(lflag, IEXTEN)) {
if (CCEQ(cc[VLNEXT], c)) {
if (ISSET(lflag, ECHO)) {
if (ISSET(lflag, ECHOE)) {
(void)ttyoutput('^', tp);
(void)ttyoutput('\b', tp);
} else
ttyecho(c, tp);
}
SET(tp->t_state, TS_LNCH);
goto endcase;
}
if (CCEQ(cc[VDISCARD], c)) {
if (ISSET(lflag, FLUSHO))
CLR(tp->t_lflag, FLUSHO);
else {
ttyflush(tp, FWRITE);
ttyecho(c, tp);
if (tp->t_rawq.c_cc + tp->t_canq.c_cc)
ret = ttyretype(tp);
SET(tp->t_lflag, FLUSHO);
}
goto startoutput;
}
}
if (ISSET(lflag, ISIG)) {
if (CCEQ(cc[VINTR], c) || CCEQ(cc[VQUIT], c)) {
if (!ISSET(lflag, NOFLSH))
ttyflush(tp, FREAD | FWRITE);
ttyecho(c, tp);
pgsignal(tp->t_pgrp,
CCEQ(cc[VINTR], c) ? SIGINT : SIGQUIT, 1);
goto endcase;
}
if (CCEQ(cc[VSUSP], c)) {
if (!ISSET(lflag, NOFLSH))
ttyflush(tp, FREAD);
ttyecho(c, tp);
pgsignal(tp->t_pgrp, SIGTSTP, 1);
goto endcase;
}
}
if (ISSET(iflag, IXON)) {
if (CCEQ(cc[VSTOP], c)) {
if (!ISSET(tp->t_state, TS_TTSTOP)) {
SET(tp->t_state, TS_TTSTOP);
(*cdevsw[major(tp->t_dev)].d_stop)(tp,
0);
return (0);
}
if (!CCEQ(cc[VSTART], c))
return (0);
goto endcase;
}
if (CCEQ(cc[VSTART], c))
goto restartoutput;
}
if (c == '\r') {
if (ISSET(iflag, IGNCR))
goto endcase;
else if (ISSET(iflag, ICRNL))
c = '\n';
} else if (c == '\n' && ISSET(iflag, INLCR))
c = '\r';
}
if (!ISSET(tp->t_lflag, EXTPROC) && ISSET(lflag, ICANON)) {
if (ISSET(lflag, XCASE) && ISSET(iflag, IUCLC)) {
if (ISSET(tp->t_state, TS_BKSL)) {
CLR(tp->t_state, TS_BKSL);
switch (c) {
case '\'':
c = '`';
break;
case '!':
c = '|';
break;
case '^':
c = '~';
break;
case '(':
c = '{';
break;
case ')':
c = '}';
break;
}
}
else if (c == '\\') {
SET(tp->t_state, TS_BKSL);
goto endcase;
}
else if (isupper(c))
c = tolower(c);
}
else if (ISSET(iflag, IUCLC) && isupper(c))
c = tolower(c);
if (CCEQ(cc[VERASE], c)) {
if (tp->t_rawq.c_cc)
ret = ttyrub(unputc(&tp->t_rawq), tp);
goto endcase;
}
if (CCEQ(cc[VKILL], c)) {
if (ISSET(lflag, ECHOKE) &&
tp->t_rawq.c_cc == tp->t_rocount &&
!ISSET(lflag, ECHOPRT)) {
while (tp->t_rawq.c_cc)
if (ttyrub(unputc(&tp->t_rawq), tp))
ret = 1;
} else {
ttyecho(c, tp);
if (ISSET(lflag, ECHOK) ||
ISSET(lflag, ECHOKE))
ttyecho('\n', tp);
FLUSHQ(&tp->t_rawq);
tp->t_rocount = 0;
}
CLR(tp->t_state, TS_LOCAL);
goto endcase;
}
if (CCEQ(cc[VWERASE], c) && ISSET(lflag, IEXTEN)) {
int alt = ISSET(lflag, ALTWERASE);
int ctype;
while ((c = unputc(&tp->t_rawq)) == ' ' || c == '\t')
if (ttyrub(c, tp))
ret = 1;
if (c == -1)
goto endcase;
if (ttyrub(c, tp))
ret = 1;
c = unputc(&tp->t_rawq);
if (c == -1)
goto endcase;
if (c == ' ' || c == '\t') {
(void)putc(c, &tp->t_rawq);
goto endcase;
}
ctype = ISALPHA(c);
do {
if (ttyrub(c, tp))
ret = 1;
c = unputc(&tp->t_rawq);
if (c == -1)
goto endcase;
} while (c != ' ' && c != '\t' &&
(alt == 0 || ISALPHA(c) == ctype));
(void)putc(c, &tp->t_rawq);
goto endcase;
}
if (CCEQ(cc[VREPRINT], c) && ISSET(lflag, IEXTEN)) {
ret = ttyretype(tp);
goto endcase;
}
if (CCEQ(cc[VSTATUS], c) && ISSET(lflag, IEXTEN)) {
if (ISSET(lflag, ISIG))
pgsignal(tp->t_pgrp, SIGINFO, 1);
if (!ISSET(lflag, NOKERNINFO))
ttyinfo(tp);
goto endcase;
}
}
if (tp->t_rawq.c_cc + tp->t_canq.c_cc >= TTYHOG(tp)) {
if (ISSET(iflag, IMAXBEL)) {
if (tp->t_outq.c_cc < tp->t_hiwat)
(void)ttyoutput(CTRL('g'), tp);
} else
ttyflush(tp, FREAD | FWRITE);
goto endcase;
}
if (putc(c, &tp->t_rawq) >= 0) {
if (!ISSET(lflag, ICANON)) {
ttwakeup(tp);
ttyecho(c, tp);
goto endcase;
}
if (TTBREAKC(c, lflag)) {
tp->t_rocount = 0;
catq(&tp->t_rawq, &tp->t_canq);
ttwakeup(tp);
} else if (tp->t_rocount++ == 0)
tp->t_rocol = tp->t_column;
if (ISSET(tp->t_state, TS_ERASE)) {
CLR(tp->t_state, TS_ERASE);
(void)ttyoutput('/', tp);
}
i = tp->t_column;
ttyecho(c, tp);
if (CCEQ(cc[VEOF], c) && ISSET(lflag, ECHO)) {
i = min(2, tp->t_column - i);
while (i > 0) {
(void)ttyoutput('\b', tp);
i--;
}
}
}
endcase:
if (ISSET(tp->t_state, TS_TTSTOP) &&
!ISSET(iflag, IXANY) && cc[VSTART] != cc[VSTOP])
return (ret);
restartoutput:
CLR(tp->t_lflag, FLUSHO);
CLR(tp->t_state, TS_TTSTOP);
startoutput:
ttstart(tp);
return (ret);
}
int
ttyoutput(int c, struct tty *tp)
{
long oflag;
int col, notout, s, c2;
oflag = tp->t_oflag;
if (!ISSET(oflag, OPOST)) {
tk_nout++;
tp->t_outcc++;
if (!ISSET(tp->t_lflag, FLUSHO) && putc(c, &tp->t_outq))
return (c);
return (-1);
}
CLR(c, ~TTY_CHARMASK);
if (c == '\t' &&
ISSET(oflag, OXTABS) && !ISSET(tp->t_lflag, EXTPROC)) {
c = 8 - (tp->t_column & 7);
if (ISSET(tp->t_lflag, FLUSHO)) {
notout = 0;
} else {
s = spltty();
notout = b_to_q(" ", c, &tp->t_outq);
c -= notout;
tk_nout += c;
tp->t_outcc += c;
splx(s);
}
tp->t_column += c;
return (notout ? '\t' : -1);
}
if (c == CEOT && ISSET(oflag, ONOEOT))
return (-1);
if (c == '\n' && ISSET(tp->t_oflag, ONLCR)) {
tk_nout++;
tp->t_outcc++;
if (!ISSET(tp->t_lflag, FLUSHO) && putc('\r', &tp->t_outq))
return (c);
tp->t_column = 0;
}
else if (c == '\r' && ISSET(tp->t_oflag, OCRNL))
c = '\n';
if (ISSET(tp->t_oflag, OLCUC) && islower(c))
c = toupper(c);
else if (ISSET(tp->t_oflag, OLCUC) && ISSET(tp->t_lflag, XCASE)) {
c2 = c;
switch (c) {
case '`':
c2 = '\'';
break;
case '|':
c2 = '!';
break;
case '~':
c2 = '^';
break;
case '{':
c2 = '(';
break;
case '}':
c2 = ')';
break;
}
if (c == '\\' || isupper(c) || c != c2) {
tk_nout++;
tp->t_outcc++;
if (putc('\\', &tp->t_outq))
return (c);
c = c2;
}
}
if (ISSET(tp->t_oflag, ONOCR) && c == '\r' && tp->t_column == 0)
return (-1);
tk_nout++;
tp->t_outcc++;
if (!ISSET(tp->t_lflag, FLUSHO) && putc(c, &tp->t_outq))
return (c);
col = tp->t_column;
switch (CCLASS(c)) {
case BACKSPACE:
if (col > 0)
--col;
break;
case CONTROL:
break;
case NEWLINE:
if (ISSET(tp->t_oflag, ONLRET) || ISSET(tp->t_oflag, OCRNL))
col = 0;
break;
case RETURN:
col = 0;
break;
case ORDINARY:
++col;
break;
case TAB:
col = (col + 8) & ~7;
break;
}
tp->t_column = col;
return (-1);
}
int
ttioctl(struct tty *tp, u_long cmd, caddr_t data, int flag, struct proc *p)
{
extern int nlinesw;
struct process *pr = p->p_p;
int s, error;
switch (cmd) {
case FIOSETOWN:
case TIOCFLUSH:
case TIOCDRAIN:
case TIOCSBRK:
case TIOCCBRK:
case TIOCSETA:
case TIOCSETD:
case TIOCSETAF:
case TIOCSETAW:
case TIOCSPGRP:
case TIOCSTAT:
case TIOCSWINSZ:
while (isbackground(pr, tp) &&
(pr->ps_flags & PS_PPWAIT) == 0 &&
!sigismasked(p, SIGTTOU)) {
if (pr->ps_pgrp->pg_jobc == 0)
return (EIO);
pgsignal(pr->ps_pgrp, SIGTTOU, 1);
error = ttysleep_nsec(tp, &nowake, TTOPRI | PCATCH,
ttybg, SEC_TO_NSEC(1));
if (error)
return (error);
}
break;
}
switch (cmd) {
case FIOASYNC:
s = spltty();
if (*(int *)data)
SET(tp->t_state, TS_ASYNC);
else
CLR(tp->t_state, TS_ASYNC);
splx(s);
break;
case FIONREAD:
s = spltty();
*(int *)data = ttnread(tp);
splx(s);
break;
case TIOCEXCL:
s = spltty();
SET(tp->t_state, TS_XCLUDE);
splx(s);
break;
case TIOCFLUSH: {
int flags = *(int *)data;
if (flags == 0)
flags = FREAD | FWRITE;
else
flags &= FREAD | FWRITE;
ttyflush(tp, flags);
break;
}
case TIOCCONS: {
if (*(int *)data) {
struct nameidata nid;
if (constty != NULL && constty != tp &&
ISSET(constty->t_state, TS_CARR_ON | TS_ISOPEN) ==
(TS_CARR_ON | TS_ISOPEN))
return (EBUSY);
NDINIT(&nid, LOOKUP, FOLLOW, UIO_SYSSPACE, "/dev/console", p);
nid.ni_pledge = PLEDGE_RPATH | PLEDGE_WPATH;
nid.ni_unveil = UNVEIL_READ | UNVEIL_WRITE;
error = namei(&nid);
if (error)
return (error);
vn_lock(nid.ni_vp, LK_EXCLUSIVE | LK_RETRY);
error = VOP_ACCESS(nid.ni_vp, VREAD, p->p_ucred, p);
VOP_UNLOCK(nid.ni_vp);
vrele(nid.ni_vp);
if (error)
return (error);
constty = tp;
} else if (tp == constty)
constty = NULL;
break;
}
case TIOCDRAIN:
if ((error = ttywait(tp)) != 0)
return (error);
break;
case TIOCGETA: {
struct termios *t = (struct termios *)data;
memcpy(t, &tp->t_termios, sizeof(struct termios));
break;
}
case TIOCGETD:
*(int *)data = tp->t_line;
break;
case TIOCGWINSZ:
*(struct winsize *)data = tp->t_winsize;
break;
case TIOCGTSTAMP:
s = spltty();
*(struct timeval *)data = tp->t_tv;
splx(s);
break;
case FIOGETOWN:
if (!isctty(pr, tp) && suser(p))
return (ENOTTY);
*(int *)data = tp->t_pgrp ? -tp->t_pgrp->pg_id : 0;
break;
case TIOCGPGRP:
if (!isctty(pr, tp) && suser(p))
return (ENOTTY);
*(int *)data = tp->t_pgrp ? tp->t_pgrp->pg_id : NO_PID;
break;
case TIOCGSID:
if (!isctty(pr, tp))
return (ENOTTY);
*(int *)data = tp->t_session->s_leader->ps_pid;
break;
case TIOCNXCL:
s = spltty();
CLR(tp->t_state, TS_XCLUDE);
splx(s);
break;
case TIOCOUTQ:
*(int *)data = tp->t_outq.c_cc;
break;
case TIOCSETA:
case TIOCSETAW:
case TIOCSETAF: {
struct termios *t = (struct termios *)data;
s = spltty();
if (cmd == TIOCSETAW || cmd == TIOCSETAF) {
if ((error = ttywait(tp)) != 0) {
splx(s);
return (error);
}
if (cmd == TIOCSETAF)
ttyflush(tp, FREAD);
}
if (!ISSET(t->c_cflag, CIGNORE)) {
if (t->c_ispeed < 0 || t->c_ospeed < 0) {
splx(s);
return (EINVAL);
}
if (tp->t_param && (error = (*tp->t_param)(tp, t))) {
splx(s);
return (error);
} else {
if (!ISSET(tp->t_state, TS_CARR_ON) &&
ISSET(tp->t_cflag, CLOCAL) &&
!ISSET(t->c_cflag, CLOCAL)) {
CLR(tp->t_state, TS_ISOPEN);
SET(tp->t_state, TS_WOPEN);
ttwakeup(tp);
}
tp->t_cflag = t->c_cflag;
tp->t_ispeed = t->c_ispeed;
tp->t_ospeed = t->c_ospeed;
if (t->c_ospeed == 0 && tp->t_session &&
tp->t_session->s_leader)
prsignal(tp->t_session->s_leader,
SIGHUP);
}
ttsetwater(tp);
}
if (cmd != TIOCSETAF) {
if (ISSET(t->c_lflag, ICANON) !=
ISSET(tp->t_lflag, ICANON)) {
if (ISSET(t->c_lflag, ICANON)) {
SET(tp->t_lflag, PENDIN);
ttwakeup(tp);
} else {
struct clist tq;
catq(&tp->t_rawq, &tp->t_canq);
tq = tp->t_rawq;
tp->t_rawq = tp->t_canq;
tp->t_canq = tq;
CLR(tp->t_lflag, PENDIN);
}
}
}
tp->t_iflag = t->c_iflag;
tp->t_oflag = t->c_oflag;
if (ISSET(tp->t_lflag, EXTPROC))
SET(t->c_lflag, EXTPROC);
else
CLR(t->c_lflag, EXTPROC);
tp->t_lflag = t->c_lflag | ISSET(tp->t_lflag, PENDIN);
memcpy(tp->t_cc, t->c_cc, sizeof(t->c_cc));
splx(s);
break;
}
case TIOCSETD: {
int t = *(int *)data;
dev_t device = tp->t_dev;
if ((u_int)t >= nlinesw)
return (ENXIO);
if (t != tp->t_line) {
s = spltty();
(*linesw[tp->t_line].l_close)(tp, flag, p);
error = (*linesw[t].l_open)(device, tp, p);
if (error) {
(*linesw[tp->t_line].l_open)(device, tp, p);
splx(s);
return (error);
}
tp->t_line = t;
splx(s);
}
break;
}
case TIOCSTART:
s = spltty();
if (ISSET(tp->t_state, TS_TTSTOP) ||
ISSET(tp->t_lflag, FLUSHO)) {
CLR(tp->t_lflag, FLUSHO);
CLR(tp->t_state, TS_TTSTOP);
ttstart(tp);
}
splx(s);
break;
case TIOCSTOP:
s = spltty();
if (!ISSET(tp->t_state, TS_TTSTOP)) {
SET(tp->t_state, TS_TTSTOP);
(*cdevsw[major(tp->t_dev)].d_stop)(tp, 0);
}
splx(s);
break;
case TIOCSCTTY:
if (!SESS_LEADER(pr) ||
((pr->ps_session->s_ttyvp || tp->t_session) &&
(tp->t_session != pr->ps_session)))
return (EPERM);
if (tp->t_session)
SESSRELE(tp->t_session);
SESSHOLD(pr->ps_session);
tp->t_session = pr->ps_session;
tp->t_pgrp = pr->ps_pgrp;
pr->ps_session->s_ttyp = tp;
atomic_setbits_int(&pr->ps_flags, PS_CONTROLT);
break;
case FIOSETOWN: {
struct pgrp *pgrp;
struct process *pr1;
pid_t pgid = *(int *)data;
if (!isctty(pr, tp))
return (ENOTTY);
if (pgid < 0) {
pgrp = pgfind(-pgid);
} else {
pr1 = prfind(pgid);
if (pr1 == NULL)
return (ESRCH);
pgrp = pr1->ps_pgrp;
}
if (pgrp == NULL)
return (EINVAL);
else if (pgrp->pg_session != pr->ps_session)
return (EPERM);
tp->t_pgrp = pgrp;
break;
}
case TIOCSPGRP: {
struct pgrp *pgrp = pgfind(*(int *)data);
if (!isctty(pr, tp))
return (ENOTTY);
else if (pgrp == NULL)
return (EINVAL);
else if (pgrp->pg_session != pr->ps_session)
return (EPERM);
tp->t_pgrp = pgrp;
break;
}
case TIOCSTAT:
ttyinfo(tp);
break;
case TIOCSWINSZ:
if (bcmp((caddr_t)&tp->t_winsize, data,
sizeof (struct winsize))) {
tp->t_winsize = *(struct winsize *)data;
pgsignal(tp->t_pgrp, SIGWINCH, 1);
}
break;
case TIOCSTSTAMP: {
struct tstamps *ts = (struct tstamps *)data;
s = spltty();
CLR(tp->t_flags, TS_TSTAMPDCDSET);
CLR(tp->t_flags, TS_TSTAMPCTSSET);
CLR(tp->t_flags, TS_TSTAMPDCDCLR);
CLR(tp->t_flags, TS_TSTAMPCTSCLR);
if (ISSET(ts->ts_set, TIOCM_CAR))
SET(tp->t_flags, TS_TSTAMPDCDSET);
if (ISSET(ts->ts_set, TIOCM_CTS))
SET(tp->t_flags, TS_TSTAMPCTSSET);
if (ISSET(ts->ts_clr, TIOCM_CAR))
SET(tp->t_flags, TS_TSTAMPDCDCLR);
if (ISSET(ts->ts_clr, TIOCM_CTS))
SET(tp->t_flags, TS_TSTAMPCTSCLR);
splx(s);
break;
}
default:
return (-1);
}
return (0);
}
const struct filterops ttyread_filtops = {
.f_flags = FILTEROP_ISFD,
.f_attach = NULL,
.f_detach = filt_ttyrdetach,
.f_event = filt_ttyread,
};
const struct filterops ttywrite_filtops = {
.f_flags = FILTEROP_ISFD,
.f_attach = NULL,
.f_detach = filt_ttywdetach,
.f_event = filt_ttywrite,
};
const struct filterops ttyexcept_filtops = {
.f_flags = FILTEROP_ISFD,
.f_attach = NULL,
.f_detach = filt_ttyrdetach,
.f_event = filt_ttyexcept,
};
int
ttkqfilter(dev_t dev, struct knote *kn)
{
struct tty *tp = (*cdevsw[major(dev)].d_tty)(dev);
struct klist *klist;
int s;
switch (kn->kn_filter) {
case EVFILT_READ:
klist = &tp->t_rsel.si_note;
kn->kn_fop = &ttyread_filtops;
break;
case EVFILT_WRITE:
klist = &tp->t_wsel.si_note;
kn->kn_fop = &ttywrite_filtops;
break;
case EVFILT_EXCEPT:
if (kn->kn_flags & __EV_SELECT) {
return (EPERM);
}
if ((kn->kn_flags & __EV_POLL) == 0) {
return (EINVAL);
}
klist = &tp->t_rsel.si_note;
kn->kn_fop = &ttyexcept_filtops;
break;
default:
return (EINVAL);
}
kn->kn_hook = tp;
s = spltty();
klist_insert_locked(klist, kn);
splx(s);
return (0);
}
void
filt_ttyrdetach(struct knote *kn)
{
struct tty *tp = kn->kn_hook;
int s;
s = spltty();
klist_remove_locked(&tp->t_rsel.si_note, kn);
splx(s);
}
int
filt_ttyread(struct knote *kn, long hint)
{
struct tty *tp = kn->kn_hook;
int active, s;
s = spltty();
kn->kn_data = ttnread(tp);
active = (kn->kn_data > 0);
if (!ISSET(tp->t_cflag, CLOCAL) && !ISSET(tp->t_state, TS_CARR_ON)) {
kn->kn_flags |= EV_EOF;
if (kn->kn_flags & __EV_POLL)
kn->kn_flags |= __EV_HUP;
active = 1;
} else {
kn->kn_flags &= ~(EV_EOF | __EV_HUP);
}
splx(s);
return (active);
}
void
filt_ttywdetach(struct knote *kn)
{
struct tty *tp = kn->kn_hook;
int s;
s = spltty();
klist_remove_locked(&tp->t_wsel.si_note, kn);
splx(s);
}
int
filt_ttywrite(struct knote *kn, long hint)
{
struct tty *tp = kn->kn_hook;
int active, s;
s = spltty();
kn->kn_data = tp->t_outq.c_cn - tp->t_outq.c_cc;
active = (tp->t_outq.c_cc <= tp->t_lowat);
if (kn->kn_flags & (__EV_POLL | __EV_SELECT)) {
if (!ISSET(tp->t_cflag, CLOCAL) &&
!ISSET(tp->t_state, TS_CARR_ON)) {
kn->kn_flags |= __EV_HUP;
active = 1;
} else {
kn->kn_flags &= ~__EV_HUP;
}
}
splx(s);
return (active);
}
int
filt_ttyexcept(struct knote *kn, long hint)
{
struct tty *tp = kn->kn_hook;
int active = 0;
int s;
s = spltty();
if (kn->kn_flags & __EV_POLL) {
if (!ISSET(tp->t_cflag, CLOCAL) &&
!ISSET(tp->t_state, TS_CARR_ON)) {
kn->kn_flags |= __EV_HUP;
active = 1;
} else {
kn->kn_flags &= ~__EV_HUP;
}
}
splx(s);
return (active);
}
static int
ttnread(struct tty *tp)
{
int nread;
splassert(IPL_TTY);
if (ISSET(tp->t_lflag, PENDIN))
ttypend(tp);
nread = tp->t_canq.c_cc;
if (!ISSET(tp->t_lflag, ICANON)) {
nread += tp->t_rawq.c_cc;
if (nread < tp->t_cc[VMIN] && !tp->t_cc[VTIME])
nread = 0;
}
return (nread);
}
int
ttywait_nsec(struct tty *tp, uint64_t nsecs)
{
int error, s;
error = 0;
s = spltty();
while ((tp->t_outq.c_cc || ISSET(tp->t_state, TS_BUSY)) &&
(ISSET(tp->t_state, TS_CARR_ON) || ISSET(tp->t_cflag, CLOCAL)) &&
tp->t_oproc) {
(*tp->t_oproc)(tp);
if ((tp->t_outq.c_cc || ISSET(tp->t_state, TS_BUSY)) &&
(ISSET(tp->t_state, TS_CARR_ON) || ISSET(tp->t_cflag, CLOCAL))
&& tp->t_oproc) {
SET(tp->t_state, TS_ASLEEP);
error = ttysleep_nsec(tp, &tp->t_outq, TTOPRI | PCATCH,
ttyout, nsecs);
if (error == EWOULDBLOCK)
ttyflush(tp, FWRITE);
if (error)
break;
} else
break;
}
splx(s);
return (error);
}
int
ttywait(struct tty *tp)
{
return (ttywait_nsec(tp, INFSLP));
}
int
ttywflush(struct tty *tp)
{
int error;
error = ttywait_nsec(tp, SEC_TO_NSEC(5));
if (error == 0 || error == EWOULDBLOCK)
ttyflush(tp, FREAD);
return (error);
}
void
ttyflush(struct tty *tp, int rw)
{
int s;
s = spltty();
if (rw & FREAD) {
FLUSHQ(&tp->t_canq);
FLUSHQ(&tp->t_rawq);
tp->t_rocount = 0;
tp->t_rocol = 0;
CLR(tp->t_state, TS_LOCAL);
ttyunblock(tp);
ttwakeup(tp);
}
if (rw & FWRITE) {
CLR(tp->t_state, TS_TTSTOP);
(*cdevsw[major(tp->t_dev)].d_stop)(tp, rw);
FLUSHQ(&tp->t_outq);
wakeup((caddr_t)&tp->t_outq);
selwakeup(&tp->t_wsel);
}
splx(s);
}
void
ttychars(struct tty *tp)
{
memcpy(tp->t_cc, ttydefchars, sizeof(ttydefchars));
}
static void
ttyblock(struct tty *tp)
{
int total;
total = tp->t_rawq.c_cc + tp->t_canq.c_cc;
if (tp->t_rawq.c_cc > TTYHOG(tp)) {
ttyflush(tp, FREAD | FWRITE);
CLR(tp->t_state, TS_TBLOCK);
}
if ((total >= TTYHOG(tp) / 2 &&
!ISSET(tp->t_state, TS_TBLOCK) &&
!ISSET(tp->t_lflag, ICANON)) || tp->t_canq.c_cc > 0) {
if (ISSET(tp->t_iflag, IXOFF) &&
tp->t_cc[VSTOP] != _POSIX_VDISABLE &&
putc(tp->t_cc[VSTOP], &tp->t_outq) == 0) {
SET(tp->t_state, TS_TBLOCK);
ttstart(tp);
}
if (ISSET(tp->t_cflag, CHWFLOW) && tp->t_hwiflow &&
(*tp->t_hwiflow)(tp, 1) != 0)
SET(tp->t_state, TS_TBLOCK);
}
}
void
ttrstrt(void *arg)
{
struct tty *tp = (struct tty *)arg;
int s;
#ifdef DIAGNOSTIC
if (tp == NULL)
panic("ttrstrt");
#endif
s = spltty();
CLR(tp->t_state, TS_TIMEOUT);
ttstart(tp);
splx(s);
}
int
ttstart(struct tty *tp)
{
if (tp->t_oproc != NULL)
(*tp->t_oproc)(tp);
return (0);
}
int
ttylclose(struct tty *tp, int flag, struct proc *p)
{
if (flag & FNONBLOCK)
ttyflush(tp, FREAD | FWRITE);
else
ttywflush(tp);
return (0);
}
int
ttymodem(struct tty *tp, int flag)
{
if (!ISSET(tp->t_state, TS_WOPEN) && ISSET(tp->t_cflag, MDMBUF)) {
if (flag) {
CLR(tp->t_state, TS_TTSTOP);
ttstart(tp);
} else if (!ISSET(tp->t_state, TS_TTSTOP)) {
SET(tp->t_state, TS_TTSTOP);
(*cdevsw[major(tp->t_dev)].d_stop)(tp, 0);
}
} else if (flag == 0) {
CLR(tp->t_state, TS_CARR_ON);
if (ISSET(tp->t_state, TS_ISOPEN) &&
!ISSET(tp->t_cflag, CLOCAL)) {
if (tp->t_session && tp->t_session->s_leader)
prsignal(tp->t_session->s_leader, SIGHUP);
ttyflush(tp, FREAD | FWRITE);
return (0);
}
} else {
SET(tp->t_state, TS_CARR_ON);
ttwakeup(tp);
}
return (1);
}
int
nullmodem(struct tty *tp, int flag)
{
if (flag)
SET(tp->t_state, TS_CARR_ON);
else {
CLR(tp->t_state, TS_CARR_ON);
if (ISSET(tp->t_state, TS_ISOPEN) &&
!ISSET(tp->t_cflag, CLOCAL)) {
if (tp->t_session && tp->t_session->s_leader)
prsignal(tp->t_session->s_leader, SIGHUP);
ttyflush(tp, FREAD | FWRITE);
return (0);
}
}
return (1);
}
void
ttypend(struct tty *tp)
{
struct clist tq;
int c;
splassert(IPL_TTY);
CLR(tp->t_lflag, PENDIN);
SET(tp->t_state, TS_TYPEN);
tq = tp->t_rawq;
tp->t_rawq.c_cc = 0;
tp->t_rawq.c_cf = tp->t_rawq.c_cl = NULL;
while ((c = getc(&tq)) >= 0)
ttyinput(c, tp);
CLR(tp->t_state, TS_TYPEN);
}
void ttvtimeout(void *);
void
ttvtimeout(void *arg)
{
struct tty *tp = (struct tty *)arg;
wakeup(&tp->t_rawq);
}
int
ttread(struct tty *tp, struct uio *uio, int flag)
{
struct timeout *stime = NULL;
struct proc *p = curproc;
struct process *pr = p->p_p;
int s, first, error = 0;
u_char *cc = tp->t_cc;
struct clist *qp;
int last_cc = 0;
long lflag;
int c;
loop: lflag = tp->t_lflag;
s = spltty();
if (ISSET(lflag, PENDIN))
ttypend(tp);
splx(s);
if (isbackground(pr, tp)) {
if (sigismasked(p, SIGTTIN) ||
pr->ps_flags & PS_PPWAIT || pr->ps_pgrp->pg_jobc == 0) {
error = EIO;
goto out;
}
pgsignal(pr->ps_pgrp, SIGTTIN, 1);
error = ttysleep_nsec(tp, &nowake, TTIPRI | PCATCH, ttybg,
SEC_TO_NSEC(1));
if (error)
goto out;
goto loop;
}
s = spltty();
if (!ISSET(lflag, ICANON)) {
int min = cc[VMIN];
int time = cc[VTIME] * 100;
qp = &tp->t_rawq;
if (time == 0) {
if (qp->c_cc < min)
goto sleep;
goto read;
}
if (min > 0) {
if (qp->c_cc <= 0)
goto sleep;
if (qp->c_cc >= min)
goto read;
if (stime == NULL) {
alloc_timer:
stime = malloc(sizeof(*stime), M_TEMP, M_WAITOK);
timeout_set(stime, ttvtimeout, tp);
timeout_add_msec(stime, time);
} else if (qp->c_cc > last_cc) {
timeout_add_msec(stime, time);
}
} else {
if (qp->c_cc > 0)
goto read;
if (stime == NULL) {
goto alloc_timer;
}
}
last_cc = qp->c_cc;
if (stime && !timeout_triggered(stime)) {
goto sleep;
}
} else if ((qp = &tp->t_canq)->c_cc <= 0) {
int carrier;
sleep:
carrier = ISSET(tp->t_state, TS_CARR_ON) ||
ISSET(tp->t_cflag, CLOCAL);
if (!carrier && ISSET(tp->t_state, TS_ISOPEN)) {
splx(s);
error = 0;
goto out;
}
if (flag & IO_NDELAY) {
splx(s);
error = EWOULDBLOCK;
goto out;
}
error = ttysleep(tp, &tp->t_rawq, TTIPRI | PCATCH,
carrier ? ttyin : ttopen);
splx(s);
if (stime && timeout_triggered(stime))
error = EWOULDBLOCK;
if (cc[VMIN] == 0 && error == EWOULDBLOCK) {
error = 0;
goto out;
}
if (error && error != EWOULDBLOCK)
goto out;
error = 0;
goto loop;
}
read:
splx(s);
first = 1;
while ((c = getc(qp)) >= 0) {
if (CCEQ(cc[VDSUSP], c) &&
ISSET(lflag, IEXTEN | ISIG) == (IEXTEN | ISIG)) {
pgsignal(tp->t_pgrp, SIGTSTP, 1);
if (first) {
error = ttysleep_nsec(tp, &nowake, TTIPRI | PCATCH,
ttybg, SEC_TO_NSEC(1));
if (error)
break;
goto loop;
}
break;
}
if (CCEQ(cc[VEOF], c) && ISSET(lflag, ICANON))
break;
error = ureadc(c, uio);
if (error)
break;
if (uio->uio_resid == 0)
break;
if (ISSET(lflag, ICANON) && TTBREAKC(c, lflag))
break;
first = 0;
}
s = spltty();
if (tp->t_rawq.c_cc < TTYHOG(tp)/5)
ttyunblock(tp);
splx(s);
out:
if (stime) {
timeout_del(stime);
free(stime, M_TEMP, sizeof(*stime));
}
return (error);
}
void
ttyunblock(struct tty *tp)
{
u_char *cc = tp->t_cc;
splassert(IPL_TTY);
if (ISSET(tp->t_state, TS_TBLOCK)) {
if (ISSET(tp->t_iflag, IXOFF) &&
cc[VSTART] != _POSIX_VDISABLE &&
putc(cc[VSTART], &tp->t_outq) == 0) {
CLR(tp->t_state, TS_TBLOCK);
ttstart(tp);
}
if (ISSET(tp->t_cflag, CHWFLOW) && tp->t_hwiflow &&
(*tp->t_hwiflow)(tp, 0) != 0)
CLR(tp->t_state, TS_TBLOCK);
}
}
int
ttycheckoutq(struct tty *tp, int wait)
{
int hiwat, s, oldsig;
hiwat = tp->t_hiwat;
s = spltty();
oldsig = wait ? SIGPENDING(curproc) : 0;
if (tp->t_outq.c_cc > hiwat + TTHIWATMINSPACE)
while (tp->t_outq.c_cc > hiwat) {
ttstart(tp);
if (wait == 0 || SIGPENDING(curproc) != oldsig) {
splx(s);
return (0);
}
SET(tp->t_state, TS_ASLEEP);
tsleep_nsec(&tp->t_outq, PZERO - 1, "ttckoutq",
SEC_TO_NSEC(1));
}
splx(s);
return (1);
}
int
ttwrite(struct tty *tp, struct uio *uio, int flag)
{
u_char *cp = NULL;
int cc, ce, obufcc = 0;
struct proc *p;
struct process *pr;
int hiwat, error, s;
size_t cnt;
u_char obuf[OBUFSIZ];
hiwat = tp->t_hiwat;
cnt = uio->uio_resid;
error = 0;
cc = 0;
loop:
s = spltty();
if (!ISSET(tp->t_state, TS_CARR_ON) &&
!ISSET(tp->t_cflag, CLOCAL)) {
if (ISSET(tp->t_state, TS_ISOPEN)) {
splx(s);
error = EIO;
goto done;
} else if (flag & IO_NDELAY) {
splx(s);
error = EWOULDBLOCK;
goto out;
} else {
error = ttysleep(tp,
&tp->t_rawq, TTIPRI | PCATCH, ttopen);
splx(s);
if (error)
goto out;
goto loop;
}
}
splx(s);
p = curproc;
pr = p->p_p;
if (isbackground(pr, tp) &&
ISSET(tp->t_lflag, TOSTOP) && (pr->ps_flags & PS_PPWAIT) == 0 &&
!sigismasked(p, SIGTTOU)) {
if (pr->ps_pgrp->pg_jobc == 0) {
error = EIO;
goto out;
}
pgsignal(pr->ps_pgrp, SIGTTOU, 1);
error = ttysleep_nsec(tp, &nowake, TTIPRI | PCATCH, ttybg,
SEC_TO_NSEC(1));
if (error)
goto out;
goto loop;
}
while (uio->uio_resid > 0 || cc > 0) {
if (ISSET(tp->t_lflag, FLUSHO)) {
uio->uio_resid = 0;
goto done;
}
if (tp->t_outq.c_cc > hiwat)
goto ovhiwat;
if (cc == 0) {
cc = MIN(uio->uio_resid, OBUFSIZ);
cp = obuf;
error = uiomove(cp, cc, uio);
if (error) {
cc = 0;
break;
}
if (cc > obufcc)
obufcc = cc;
if (consbufp && cn_tab &&
cn_tab->cn_dev == tp->t_dev && tp->t_gen == 0) {
int i;
for (i = 0; i < cc; i++) {
char c = cp[i];
if (c != '\0' && c != '\r' && c != 0177)
msgbuf_putchar(consbufp, c);
}
}
}
while (cc > 0) {
int i;
if (!ISSET(tp->t_oflag, OPOST))
ce = cc;
else {
ce = cc - scanc((u_int)cc, cp, char_type,
CCLASSMASK);
if (ce == 0) {
tp->t_rocount = 0;
if (ttyoutput(*cp, tp) >= 0) {
goto ovhiwat;
}
cp++;
cc--;
if (ISSET(tp->t_lflag, FLUSHO) ||
tp->t_outq.c_cc > hiwat)
goto ovhiwat;
continue;
}
}
tp->t_rocount = 0;
i = b_to_q(cp, ce, &tp->t_outq);
ce -= i;
tp->t_column += ce;
cp += ce, cc -= ce, tk_nout += ce;
tp->t_outcc += ce;
if (i > 0) {
goto ovhiwat;
}
if (ISSET(tp->t_lflag, FLUSHO) ||
tp->t_outq.c_cc > hiwat)
break;
}
ttstart(tp);
}
out:
uio->uio_resid += cc;
done:
if (obufcc)
explicit_bzero(obuf, obufcc);
return (error);
ovhiwat:
ttstart(tp);
s = spltty();
if (tp->t_outq.c_cc <= hiwat) {
splx(s);
goto loop;
}
if (flag & IO_NDELAY) {
splx(s);
uio->uio_resid += cc;
if (obufcc)
explicit_bzero(obuf, obufcc);
return (uio->uio_resid == cnt ? EWOULDBLOCK : 0);
}
SET(tp->t_state, TS_ASLEEP);
error = ttysleep(tp, &tp->t_outq, TTOPRI | PCATCH, ttyout);
splx(s);
if (error)
goto out;
goto loop;
}
int
ttyrub(int c, struct tty *tp)
{
u_char *cp;
int savecol;
int tabc, s, cc;
if (!ISSET(tp->t_lflag, ECHO) || ISSET(tp->t_lflag, EXTPROC))
return 0;
CLR(tp->t_lflag, FLUSHO);
if (ISSET(tp->t_lflag, ECHOE)) {
if (tp->t_rocount == 0) {
return ttyretype(tp);
}
if (c == ('\t' | TTY_QUOTE) || c == ('\n' | TTY_QUOTE))
ttyrubo(tp, 2);
else {
CLR(c, ~TTY_CHARMASK);
switch (CCLASS(c)) {
case ORDINARY:
ttyrubo(tp, 1);
break;
case BACKSPACE:
case CONTROL:
case NEWLINE:
case RETURN:
case VTAB:
if (ISSET(tp->t_lflag, ECHOCTL))
ttyrubo(tp, 2);
break;
case TAB:
if (tp->t_rocount < tp->t_rawq.c_cc)
return ttyretype(tp);
s = spltty();
savecol = tp->t_column;
SET(tp->t_state, TS_CNTTB);
SET(tp->t_lflag, FLUSHO);
tp->t_column = tp->t_rocol;
for (cp = firstc(&tp->t_rawq, &tabc, &cc); cp;
cp = nextc(&tp->t_rawq, cp, &tabc, &cc))
ttyecho(tabc, tp);
CLR(tp->t_lflag, FLUSHO);
CLR(tp->t_state, TS_CNTTB);
splx(s);
savecol -= tp->t_column;
tp->t_column += savecol;
if (savecol > 8)
savecol = 8;
while (--savecol >= 0)
(void)ttyoutput('\b', tp);
break;
default:
#define PANICSTR "ttyrub: would panic c = %d, val = %d"
(void)printf(PANICSTR "\n", c, CCLASS(c));
#ifdef notdef
panic(PANICSTR, c, CCLASS(c));
#endif
}
}
} else if (ISSET(tp->t_lflag, ECHOPRT)) {
if (!ISSET(tp->t_state, TS_ERASE)) {
SET(tp->t_state, TS_ERASE);
(void)ttyoutput('\\', tp);
}
ttyecho(c, tp);
} else
ttyecho(tp->t_cc[VERASE], tp);
--tp->t_rocount;
return 0;
}
static void
ttyrubo(struct tty *tp, int cnt)
{
while (cnt-- > 0) {
(void)ttyoutput('\b', tp);
(void)ttyoutput(' ', tp);
(void)ttyoutput('\b', tp);
}
}
int
ttyretype(struct tty *tp)
{
u_char *cp;
int s, c, cc;
if (tp->t_cc[VREPRINT] != _POSIX_VDISABLE)
ttyecho(tp->t_cc[VREPRINT], tp);
(void)ttyoutput('\n', tp);
s = spltty();
for (cp = firstc(&tp->t_canq, &c, &cc); cp;
cp = nextc(&tp->t_canq, cp, &c, &cc))
ttyecho(c, tp);
for (cp = firstc(&tp->t_rawq, &c, &cc); cp;
cp = nextc(&tp->t_rawq, cp, &c, &cc))
ttyecho(c, tp);
CLR(tp->t_state, TS_ERASE);
splx(s);
tp->t_rocount = tp->t_rawq.c_cc;
tp->t_rocol = 0;
return (1);
}
static void
ttyecho(int c, struct tty *tp)
{
if (!ISSET(tp->t_state, TS_CNTTB))
CLR(tp->t_lflag, FLUSHO);
if ((!ISSET(tp->t_lflag, ECHO) &&
(!ISSET(tp->t_lflag, ECHONL) || c != '\n')) ||
ISSET(tp->t_lflag, EXTPROC))
return;
if (((ISSET(tp->t_lflag, ECHOCTL) &&
(ISSET(c, TTY_CHARMASK) <= 037 && c != '\t' && c != '\n')) ||
ISSET(c, TTY_CHARMASK) == 0177)) {
(void)ttyoutput('^', tp);
CLR(c, ~TTY_CHARMASK);
if (c == 0177)
c = '?';
else
c += 'A' - 1;
}
(void)ttyoutput(c, tp);
}
void
ttwakeupwr(struct tty *tp)
{
if (tp->t_outq.c_cc <= tp->t_lowat) {
if (ISSET(tp->t_state, TS_ASLEEP)) {
CLR(tp->t_state, TS_ASLEEP);
wakeup(&tp->t_outq);
}
selwakeup(&tp->t_wsel);
}
}
void
ttwakeup(struct tty *tp)
{
selwakeup(&tp->t_rsel);
if (ISSET(tp->t_state, TS_ASYNC))
pgsignal(tp->t_pgrp, SIGIO, 1);
wakeup((caddr_t)&tp->t_rawq);
}
int
ttspeedtab(int speed, const struct speedtab *table)
{
for ( ; table->sp_speed != -1; table++)
if (table->sp_speed == speed)
return (table->sp_code);
return (-1);
}
void
ttsetwater(struct tty *tp)
{
int cps, x;
#define CLAMP(x, h, l) ((x) > h ? h : ((x) < l) ? l : (x))
cps = tp->t_ospeed / 10;
tp->t_lowat = x = CLAMP(cps / 2, TTMAXLOWAT, TTMINLOWAT);
x += cps;
tp->t_hiwat = CLAMP(x, tp->t_outq.c_cn - TTHIWATMINSPACE, TTMINHIWAT);
#undef CLAMP
}
static int
process_sum(struct process *pr, fixpt_t *pctcpup)
{
struct proc *p;
fixpt_t pctcpu;
int ret;
ret = 0;
pctcpu = 0;
TAILQ_FOREACH(p, &pr->ps_threads, p_thr_link) {
if (p->p_stat == SRUN || p->p_stat == SONPROC)
ret = 1;
pctcpu += p->p_pctcpu;
}
*pctcpup = pctcpu;
return (ret);
}
void
ttyinfo(struct tty *tp)
{
struct process *pr, *pickpr;
struct proc *p, *pick;
struct tusage tu;
struct timespec utime, stime;
int tmp;
if (ttycheckoutq(tp,0) == 0)
return;
tmp = (averunnable.ldavg[0] * 100 + FSCALE / 2) >> FSHIFT;
ttyprintf(tp, "load: %d.%02d ", tmp / 100, tmp % 100);
if (tp->t_session == NULL)
ttyprintf(tp, "not a controlling terminal\n");
else if (tp->t_pgrp == NULL)
ttyprintf(tp, "no foreground process group\n");
else if ((pr = LIST_FIRST(&tp->t_pgrp->pg_members)) == NULL)
empty: ttyprintf(tp, "empty foreground process group\n");
else {
const char *state;
fixpt_t pctcpu, pctcpu2;
int run, run2;
int calc_pctcpu;
long rss = 0;
pickpr = pr;
run = process_sum(pickpr, &pctcpu);
while ((pr = LIST_NEXT(pr, ps_pglist)) != NULL) {
run2 = process_sum(pr, &pctcpu2);
if (run) {
if (run2 && pctcpu2 >= pctcpu)
goto update_pickpr;
continue;
}
if (run2 || pctcpu2 > pctcpu)
goto update_pickpr;
if (pctcpu2 < pctcpu || (pr->ps_flags & PS_EXITING))
continue;
update_pickpr:
pickpr = pr;
run = run2;
pctcpu = pctcpu2;
}
calc_pctcpu = (pctcpu * 10000 + FSCALE / 2) >> FSHIFT;
if ((pickpr->ps_flags & (PS_EMBRYO | PS_EXITING)) == 0 &&
pickpr->ps_vmspace != NULL)
rss = vm_resident_count(pickpr->ps_vmspace);
tuagg_get_process(&tu, pickpr);
calctsru(&tu, &utime, &stime, NULL);
utime.tv_nsec += 5000000;
if (utime.tv_nsec >= 1000000000) {
utime.tv_sec += 1;
utime.tv_nsec -= 1000000000;
}
stime.tv_nsec += 5000000;
if (stime.tv_nsec >= 1000000000) {
stime.tv_sec += 1;
stime.tv_nsec -= 1000000000;
}
pick = p = TAILQ_FIRST(&pickpr->ps_threads);
if (p == NULL)
goto empty;
run = p->p_stat == SRUN || p->p_stat == SONPROC;
pctcpu = p->p_pctcpu;
while ((p = TAILQ_NEXT(p, p_thr_link)) != NULL) {
run2 = p->p_stat == SRUN || p->p_stat == SONPROC;
pctcpu2 = p->p_pctcpu;
if (run) {
if (run2 && pctcpu2 >= pctcpu)
goto update_pick;
continue;
}
if (run2 || pctcpu2 > pctcpu)
goto update_pick;
if (pctcpu2 < pctcpu || p->p_flag & P_WEXIT)
continue;
update_pick:
pick = p;
run = run2;
pctcpu = p->p_pctcpu;
}
state = pick->p_stat == SONPROC ? "running" :
pick->p_stat == SRUN ? "runnable" :
pick->p_wmesg ? pick->p_wmesg : "iowait";
ttyprintf(tp,
" cmd: %s %d [%s] %lld.%02ldu %lld.%02lds %d%% %ldk\n",
pickpr->ps_comm, pickpr->ps_pid, state,
(long long)utime.tv_sec, utime.tv_nsec / 10000000,
(long long)stime.tv_sec, stime.tv_nsec / 10000000,
calc_pctcpu / 100, rss);
}
tp->t_rocount = 0;
}
int
tputchar(int c, struct tty *tp)
{
int s;
s = spltty();
if (ISSET(tp->t_state, TS_ISOPEN) == 0 ||
!(ISSET(tp->t_state, TS_CARR_ON) || ISSET(tp->t_cflag, CLOCAL))) {
splx(s);
return (-1);
}
if (c == '\n')
(void)ttyoutput('\r', tp);
(void)ttyoutput(c, tp);
ttstart(tp);
splx(s);
return (0);
}
int
ttysleep(struct tty *tp, void *chan, int pri, char *wmesg)
{
return (ttysleep_nsec(tp, chan, pri, wmesg, INFSLP));
}
int
ttysleep_nsec(struct tty *tp, void *chan, int pri, char *wmesg, uint64_t nsecs)
{
int error;
short gen;
gen = tp->t_gen;
if ((error = tsleep_nsec(chan, pri, wmesg, nsecs)) != 0)
return (error);
return (tp->t_gen == gen ? 0 : ERESTART);
}
void
tty_init(void)
{
TAILQ_INIT(&ttylist);
tty_count = 0;
}
struct tty *
ttymalloc(int baud)
{
struct tty *tp;
tp = malloc(sizeof(struct tty), M_TTYS, M_WAITOK|M_ZERO);
if (baud == 0)
baud = 115200;
if (baud <= 9600)
tp->t_qlen = 1024;
else if (baud <= 115200)
tp->t_qlen = 4096;
else
tp->t_qlen = 8192;
clalloc(&tp->t_rawq, tp->t_qlen, 1);
clalloc(&tp->t_canq, tp->t_qlen, 1);
clalloc(&tp->t_outq, tp->t_qlen, 0);
rw_enter_write(&ttylist_lock);
TAILQ_INSERT_TAIL(&ttylist, tp, tty_link);
++tty_count;
rw_exit_write(&ttylist_lock);
timeout_set(&tp->t_rstrt_to, ttrstrt, tp);
return(tp);
}
void
ttyfree(struct tty *tp)
{
int s;
rw_enter_write(&ttylist_lock);
--tty_count;
#ifdef DIAGNOSTIC
if (tty_count < 0)
panic("ttyfree: tty_count < 0");
#endif
TAILQ_REMOVE(&ttylist, tp, tty_link);
rw_exit_write(&ttylist_lock);
s = spltty();
klist_invalidate(&tp->t_rsel.si_note);
klist_invalidate(&tp->t_wsel.si_note);
splx(s);
clfree(&tp->t_rawq);
clfree(&tp->t_canq);
clfree(&tp->t_outq);
free(tp, M_TTYS, sizeof(*tp));
}
void
ttystats_init(struct itty **ttystats, int *ttycp, size_t *ttystatssiz)
{
int ntty = 0, ttyc;
struct itty *itp;
struct tty *tp;
int show_pointers = suser(curproc) == 0;
ttyc = tty_count;
*ttystatssiz = ttyc * sizeof(struct itty);
*ttystats = mallocarray(ttyc, sizeof(struct itty),
M_SYSCTL, M_WAITOK|M_ZERO);
rw_enter_write(&ttylist_lock);
for (tp = TAILQ_FIRST(&ttylist), itp = *ttystats; tp && ntty++ < ttyc;
tp = TAILQ_NEXT(tp, tty_link), itp++) {
itp->t_dev = tp->t_dev;
itp->t_rawq_c_cc = tp->t_rawq.c_cc;
itp->t_canq_c_cc = tp->t_canq.c_cc;
itp->t_outq_c_cc = tp->t_outq.c_cc;
itp->t_hiwat = tp->t_hiwat;
itp->t_lowat = tp->t_lowat;
if (ISSET(tp->t_oflag, OPOST))
itp->t_column = tp->t_column;
itp->t_state = tp->t_state;
if (show_pointers)
itp->t_session = tp->t_session;
if (tp->t_pgrp)
itp->t_pgrp_pg_id = tp->t_pgrp->pg_id;
else
itp->t_pgrp_pg_id = 0;
itp->t_line = tp->t_line;
}
rw_exit_write(&ttylist_lock);
*ttycp = ntty;
}
#ifndef SMALL_KERNEL
int
sysctl_tty(int *name, u_int namelen, void *oldp, size_t *oldlenp, void *newp,
size_t newlen)
{
int err;
if (namelen != 1)
return (ENOTDIR);
switch (name[0]) {
case KERN_TTY_TKNIN:
return (sysctl_rdquad(oldp, oldlenp, newp, tk_nin));
case KERN_TTY_TKNOUT:
return (sysctl_rdquad(oldp, oldlenp, newp, tk_nout));
case KERN_TTY_TKRAWCC:
return (sysctl_rdquad(oldp, oldlenp, newp, tk_rawcc));
case KERN_TTY_TKCANCC:
return (sysctl_rdquad(oldp, oldlenp, newp, tk_cancc));
case KERN_TTY_INFO:
{
struct itty *ttystats;
size_t ttystatssiz;
int ttyc;
ttystats_init(&ttystats, &ttyc, &ttystatssiz);
err = sysctl_rdstruct(oldp, oldlenp, newp, ttystats,
ttyc * sizeof(struct itty));
free(ttystats, M_SYSCTL, ttystatssiz);
return (err);
}
default:
#if NPTY > 0
return (sysctl_pty(name, namelen, oldp, oldlenp, newp, newlen));
#else
return (EOPNOTSUPP);
#endif
}
}
#endif
void
ttytstamp(struct tty *tp, int octs, int ncts, int odcd, int ndcd)
{
int doit = 0;
if (ncts ^ octs)
doit |= ncts ? ISSET(tp->t_flags, TS_TSTAMPCTSSET) :
ISSET(tp->t_flags, TS_TSTAMPCTSCLR);
if (ndcd ^ odcd)
doit |= ndcd ? ISSET(tp->t_flags, TS_TSTAMPDCDSET) :
ISSET(tp->t_flags, TS_TSTAMPDCDCLR);
if (doit)
microtime(&tp->t_tv);
}