#include "opt_uconsole.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/uio.h>
#include <sys/filio.h>
#include <sys/malloc.h>
#include <sys/proc.h>
#include <sys/caps.h>
#include <sys/tty.h>
#define TTYDEFCHARS
#include <sys/ttydefaults.h>
#undef TTYDEFCHARS
#include <sys/fcntl.h>
#include <sys/conf.h>
#include <sys/dkstat.h>
#include <sys/kernel.h>
#include <sys/vnode.h>
#include <sys/signalvar.h>
#include <sys/signal2.h>
#include <sys/resourcevar.h>
#include <sys/filedesc.h>
#include <sys/sysctl.h>
#include <sys/thread2.h>
#include <vm/vm.h>
#include <sys/lock.h>
#include <vm/pmap.h>
#include <vm/vm_map.h>
#include <vm/vm_extern.h>
MALLOC_DEFINE(M_TTYS, "ttys", "tty data structures");
static int proc_compare (struct proc *p1, struct proc *p2);
static int ttnread (struct tty *tp);
static void ttyecho (int c, struct tty *tp);
static int ttyoutput (int c, struct tty *tp);
static void ttypend (struct tty *tp);
static void ttyretype (struct tty *tp);
static void ttyrub (int c, struct tty *tp);
static void ttyrubo (struct tty *tp, int cnt);
static void ttyunblock (struct tty *tp);
static int ttywflush (struct tty *tp);
static int filt_ttyread (struct knote *kn, long hint);
static void filt_ttyrdetach (struct knote *kn);
static int filt_ttywrite (struct knote *kn, long hint);
static void filt_ttywdetach (struct knote *kn);
#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
static 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 SET(t, f) (t) |= (f)
#define CLR(t, f) (t) &= ~(f)
#define ISSET(t, f) ((t) & (f))
#undef MAX_INPUT
#define MAX_INPUT TTYHOG
uint64_t tk_nin;
SYSCTL_OPAQUE(_kern, OID_AUTO, tk_nin, CTLFLAG_RD, &tk_nin, sizeof(tk_nin),
"LU", "TTY input statistic");
uint64_t tk_nout;
SYSCTL_OPAQUE(_kern, OID_AUTO, tk_nout, CTLFLAG_RD, &tk_nout, sizeof(tk_nout),
"LU", "TTY output statistic");
uint64_t tk_rawcc;
static TAILQ_HEAD(, tty) tty_list = TAILQ_HEAD_INITIALIZER(tty_list);
int
ttyopen(cdev_t device, struct tty *tp)
{
lwkt_gettoken(&tp->t_token);
tp->t_dev = device;
if (!ISSET(tp->t_state, TS_ISOPEN)) {
SET(tp->t_state, TS_ISOPEN);
if (ISSET(tp->t_cflag, CLOCAL)) {
SET(tp->t_state, TS_CONNECTED);
}
bzero(&tp->t_winsize, sizeof(tp->t_winsize));
}
ttsetwater(tp);
lwkt_reltoken(&tp->t_token);
return (0);
}
int
ttyclose(struct tty *tp)
{
lwkt_gettoken(&tp->t_token);
funsetown(&tp->t_sigio);
if (constty == tp)
constty = NULL;
ttyflush(tp, FREAD | FWRITE);
clist_free_cblocks(&tp->t_canq);
clist_free_cblocks(&tp->t_outq);
clist_free_cblocks(&tp->t_rawq);
tp->t_gen++;
tp->t_line = TTYDISC;
ttyclearsession(tp);
tp->t_state &= TS_REGISTERED;
lwkt_reltoken(&tp->t_token);
return (0);
}
void
ttyclearsession(struct tty *tp)
{
struct session *sp;
struct procglob *prg;
struct pgrp *opgrp;
lwkt_gettoken(&tp->t_token);
opgrp = tp->t_pgrp;
tp->t_pgrp = NULL;
if (opgrp) {
pgrel(opgrp);
opgrp = NULL;
}
again:
if ((sp = tp->t_session) != NULL) {
prg = sp->s_prg;
lwkt_gettoken(&prg->proc_token);
if (sp != tp->t_session) {
lwkt_reltoken(&prg->proc_token);
goto again;
}
tp->t_session = NULL;
#ifdef TTY_DO_FULL_CLOSE
if (sp->s_ttyp == tp) {
sp->s_ttyp = NULL;
ttyunhold(tp);
} else {
kprintf("ttyclearsession: warning: sp->s_ttyp != tp "
"%p/%p\n", sp->s_ttyp, tp);
}
#endif
lwkt_reltoken(&prg->proc_token);
}
lwkt_reltoken(&tp->t_token);
}
void
ttyclosesession(struct session *sp, int dorevoke)
{
struct vnode *vp;
struct procglob *prg;
prg = sp->s_prg;
lwkt_gettoken(&prg->proc_token);
retry:
if ((vp = sp->s_ttyvp) == NULL) {
lwkt_reltoken(&prg->proc_token);
return;
}
if ((vp->v_flag & VCTTYISOPEN) || dorevoke) {
vhold(vp);
if (vn_lock(vp, LK_EXCLUSIVE | LK_RETRY | LK_FAILRECLAIM)) {
vdrop(vp);
goto retry;
}
if (vp != sp->s_ttyvp) {
vn_unlock(vp);
vdrop(vp);
goto retry;
}
sp->s_ttyvp = NULL;
if (vp->v_flag & VCTTYISOPEN) {
vclrflags(vp, VCTTYISOPEN);
VOP_CLOSE(vp, FREAD|FWRITE, NULL);
}
vn_unlock(vp);
if (dorevoke)
vrevoke(vp, proc0.p_ucred);
vdrop(vp);
} else {
sp->s_ttyvp = NULL;
}
vrele(vp);
lwkt_reltoken(&prg->proc_token);
}
#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)
{
tcflag_t iflag, lflag;
cc_t *cc;
int i, err;
lwkt_gettoken(&tp->t_token);
lflag = tp->t_lflag;
if (ISSET(lflag, PENDIN))
ttypend(tp);
if (ISSET(lflag, ICANON))
++tp->t_cancc;
else
++tp->t_rawcc;
++tk_nin;
iflag = tp->t_iflag;
if (tp->t_rawq.c_cc + tp->t_canq.c_cc > tp->t_ihiwat - 3 &&
(!ISSET(lflag, ICANON) || tp->t_canq.c_cc != 0) &&
(ISSET(tp->t_cflag, CRTS_IFLOW) || ISSET(iflag, IXOFF)) &&
!ISSET(tp->t_state, TS_TBLOCK))
ttyblock(tp);
cc = tp->t_cc;
err = (ISSET(c, TTY_ERRORMASK));
if (err) {
CLR(c, TTY_ERRORMASK);
if (ISSET(err, TTY_BI)) {
if (ISSET(iflag, IGNBRK)) {
lwkt_reltoken(&tp->t_token);
return (0);
}
if (ISSET(iflag, BRKINT)) {
ttyflush(tp, FREAD | FWRITE);
pgsignal(tp->t_pgrp, SIGINT, 1);
goto endcase;
}
if (ISSET(iflag, PARMRK))
goto parmrk;
} else if ((ISSET(err, TTY_PE) && ISSET(iflag, INPCK))
|| ISSET(err, TTY_FE)) {
if (ISSET(iflag, IGNPAR)) {
lwkt_reltoken(&tp->t_token);
return (0);
}
else if (ISSET(iflag, PARMRK)) {
parmrk:
if (tp->t_rawq.c_cc + tp->t_canq.c_cc >
MAX_INPUT - 3)
goto input_overflow;
clist_putc(0377 | TTY_QUOTE, &tp->t_rawq);
clist_putc(0 | TTY_QUOTE, &tp->t_rawq);
clist_putc(c | TTY_QUOTE, &tp->t_rawq);
goto endcase;
} else
c = 0;
}
}
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)
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);
(*tp->t_stop)(tp, 0);
lwkt_reltoken(&tp->t_token);
return (0);
}
if (!CCEQ(cc[VSTART], c)) {
lwkt_reltoken(&tp->t_token);
return (0);
}
goto endcase;
}
if (CCEQ(cc[VSTART], c))
goto restartoutput;
}
if (c == '\r') {
if (ISSET(iflag, IGNCR)) {
lwkt_reltoken(&tp->t_token);
return (0);
}
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 (CCEQ(cc[VERASE], c) || CCEQ(cc[VERASE2], c) ) {
if (tp->t_rawq.c_cc)
ttyrub(clist_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)
ttyrub(clist_unputc(&tp->t_rawq), tp);
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 ctype;
while ((c = clist_unputc(&tp->t_rawq)) == ' ' || c == '\t')
ttyrub(c, tp);
if (c == -1)
goto endcase;
ttyrub(c, tp);
c = clist_unputc(&tp->t_rawq);
if (c == -1)
goto endcase;
if (c == ' ' || c == '\t') {
clist_putc(c, &tp->t_rawq);
goto endcase;
}
ctype = ISALPHA(c);
do {
ttyrub(c, tp);
c = clist_unputc(&tp->t_rawq);
if (c == -1)
goto endcase;
} while (c != ' ' && c != '\t' &&
(!ISSET(lflag, ALTWERASE) || ISALPHA(c) == ctype));
clist_putc(c, &tp->t_rawq);
goto endcase;
}
if (CCEQ(cc[VREPRINT], c) && ISSET(lflag, IEXTEN)) {
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 (CCEQ(cc[VCHECKPT], c) && ISSET(lflag, IEXTEN)) {
if (ISSET(lflag, ISIG))
pgsignal(tp->t_pgrp, SIGCKPT, 1);
goto endcase;
}
}
if (tp->t_rawq.c_cc + tp->t_canq.c_cc >= MAX_INPUT) {
input_overflow:
if (ISSET(iflag, IMAXBEL)) {
if (tp->t_outq.c_cc < tp->t_ohiwat)
(void)ttyoutput(CTRL('g'), tp);
}
goto endcase;
}
if (c == 0377 && ISSET(iflag, PARMRK) && !ISSET(iflag, ISTRIP) &&
ISSET(iflag, IGNBRK|IGNPAR) != (IGNBRK|IGNPAR)) {
clist_putc(0377 | TTY_QUOTE, &tp->t_rawq);
}
if (clist_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;
clist_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 = imin(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]) {
lwkt_reltoken(&tp->t_token);
return (0);
}
restartoutput:
CLR(tp->t_lflag, FLUSHO);
CLR(tp->t_state, TS_TTSTOP);
startoutput:
lwkt_reltoken(&tp->t_token);
return (ttstart(tp));
}
static int
ttyoutput(int c, struct tty *tp)
{
tcflag_t oflag;
int col;
lwkt_gettoken(&tp->t_token);
oflag = tp->t_oflag;
if (!ISSET(oflag, OPOST)) {
if (ISSET(tp->t_lflag, FLUSHO)) {
lwkt_reltoken(&tp->t_token);
return (-1);
}
if (clist_putc(c, &tp->t_outq)) {
lwkt_reltoken(&tp->t_token);
return (c);
}
tk_nout++;
tp->t_outcc++;
lwkt_reltoken(&tp->t_token);
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)) {
c -= clist_btoq(" ", c, &tp->t_outq);
tk_nout += c;
tp->t_outcc += c;
}
tp->t_column += c;
lwkt_reltoken(&tp->t_token);
return (c ? -1 : '\t');
}
if (c == CEOT && ISSET(oflag, ONOEOT)) {
lwkt_reltoken(&tp->t_token);
return (-1);
}
if (c == '\n' && ISSET(tp->t_oflag, ONLCR)) {
tk_nout++;
tp->t_outcc++;
if (!ISSET(tp->t_lflag, FLUSHO) && clist_putc('\r', &tp->t_outq)) {
lwkt_reltoken(&tp->t_token);
return (c);
}
}
else if (c == '\r' && ISSET(tp->t_oflag, OCRNL))
c = '\n';
else if (c == '\r' && ISSET(tp->t_oflag, ONOCR) && tp->t_column == 0) {
lwkt_reltoken(&tp->t_token);
return (-1);
}
tk_nout++;
tp->t_outcc++;
if (!ISSET(tp->t_lflag, FLUSHO) && clist_putc(c, &tp->t_outq)) {
lwkt_reltoken(&tp->t_token);
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, ONLCR | ONLRET))
col = 0;
break;
case RETURN:
col = 0;
break;
case ORDINARY:
++col;
break;
case TAB:
col = (col + 8) & ~7;
break;
}
tp->t_column = col;
lwkt_reltoken(&tp->t_token);
return (-1);
}
int
ttioctl(struct tty *tp, u_long cmd, void *data, int flag)
{
struct thread *td = curthread;
struct lwp *lp = td->td_lwp;
struct proc *p = td->td_proc;
struct pgrp *opgrp;
struct tty *otp;
int error;
KKASSERT(p);
lwkt_gettoken(&tp->t_token);
lwkt_gettoken(&p->p_token);
switch (cmd) {
case TIOCCBRK:
case TIOCCONS:
case TIOCDRAIN:
case TIOCEXCL:
case TIOCFLUSH:
#ifdef TIOCHPCL
case TIOCHPCL:
#endif
case TIOCNXCL:
case TIOCSBRK:
case TIOCSCTTY:
case TIOCSDRAINWAIT:
case TIOCSETA:
case TIOCSETAF:
case TIOCSETAW:
case TIOCSETD:
case TIOCSPGRP:
case TIOCSTART:
case TIOCSTAT:
case TIOCSTI:
case TIOCSTOP:
case TIOCSWINSZ:
while (isbackground(p, tp) && !(p->p_flags & P_PPWAIT) &&
!SIGISMEMBER(p->p_sigignore, SIGTTOU) &&
!SIGISMEMBER(lp->lwp_sigmask, SIGTTOU)) {
if (p->p_pgrp->pg_jobc == 0) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (EIO);
}
pgsignal(p->p_pgrp, SIGTTOU, 1);
error = ttysleep(tp, &lbolt, PCATCH, "ttybg1",
0);
if (error) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (error);
}
}
break;
}
switch (cmd) {
case FIOASYNC:
if (*(int *)data)
SET(tp->t_state, TS_ASYNC);
else
CLR(tp->t_state, TS_ASYNC);
break;
case FIONREAD:
*(int *)data = ttnread(tp);
break;
case FIOSETOWN:
if (tp->t_session != NULL && !isctty(p, tp)) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (ENOTTY);
}
error = fsetown(*(int *)data, &tp->t_sigio);
if (error) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (error);
}
break;
case FIOGETOWN:
if (tp->t_session != NULL && !isctty(p, tp)) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (ENOTTY);
}
*(int *)data = fgetown(&tp->t_sigio);
break;
case TIOCEXCL:
SET(tp->t_state, TS_XCLUDE);
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) {
if (constty && constty != tp &&
ISSET(constty->t_state, TS_CONNECTED)) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (EBUSY);
}
#ifndef UCONSOLE
error = caps_priv_check_td(td, SYSCAP_RESTRICTEDROOT);
if (error) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (error);
}
#endif
constty = tp;
} else if (tp == constty)
constty = NULL;
break;
case TIOCDRAIN:
error = ttywait(tp);
if (error) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (error);
}
break;
case TIOCGETA: {
struct termios *t = (struct termios *)data;
bcopy(&tp->t_termios, t, sizeof(struct termios));
break;
}
case TIOCGETD:
*(int *)data = tp->t_line;
break;
case TIOCGWINSZ:
*(struct winsize *)data = tp->t_winsize;
break;
case TIOCGPGRP:
if (!isctty(p, tp)) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (ENOTTY);
}
*(int *)data = tp->t_pgrp ? tp->t_pgrp->pg_id : NO_PID;
break;
case TIOCGSID:
if (!isctty(p, tp)) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (ENOTTY);
}
*(int *)data = tp->t_session->s_sid;
break;
#ifdef TIOCHPCL
case TIOCHPCL:
SET(tp->t_cflag, HUPCL);
break;
#endif
case TIOCNXCL:
CLR(tp->t_state, TS_XCLUDE);
break;
case TIOCOUTQ:
*(int *)data = tp->t_outq.c_cc;
break;
case TIOCSETA:
case TIOCSETAW:
case TIOCSETAF: {
struct termios *t = (struct termios *)data;
if (t->c_ispeed == 0)
t->c_ispeed = t->c_ospeed;
if (t->c_ispeed == 0)
t->c_ispeed = tp->t_ospeed;
if (t->c_ispeed == 0) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (EINVAL);
}
if (cmd == TIOCSETAW || cmd == TIOCSETAF) {
error = ttywait(tp);
if (error) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (error);
}
if (cmd == TIOCSETAF)
ttyflush(tp, FREAD);
}
if (!ISSET(t->c_cflag, CIGNORE)) {
if (tp->t_param && (error = (*tp->t_param)(tp, t))) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (error);
}
if (ISSET(t->c_cflag, CLOCAL) &&
!ISSET(tp->t_cflag, CLOCAL)) {
CLR(tp->t_state, TS_ZOMBIE);
wakeup(TSA_CARR_ON(tp));
ttwakeup(tp);
ttwwakeup(tp);
}
if ((ISSET(tp->t_state, TS_CARR_ON) ||
ISSET(t->c_cflag, CLOCAL)) &&
!ISSET(tp->t_state, TS_ZOMBIE))
SET(tp->t_state, TS_CONNECTED);
else
CLR(tp->t_state, TS_CONNECTED);
tp->t_cflag = t->c_cflag;
tp->t_ispeed = t->c_ispeed;
if (t->c_ospeed != 0)
tp->t_ospeed = t->c_ospeed;
ttsetwater(tp);
}
if (ISSET(t->c_lflag, ICANON) != ISSET(tp->t_lflag, ICANON) &&
cmd != TIOCSETAF) {
if (ISSET(t->c_lflag, ICANON))
SET(tp->t_lflag, PENDIN);
else {
if (tp->t_canq.c_ccmax > 0 &&
tp->t_rawq.c_ccmax > 0) {
clist_catq(&tp->t_rawq, &tp->t_canq);
clist_catq(&tp->t_canq, &tp->t_rawq);
}
CLR(tp->t_lflag, PENDIN);
}
ttwakeup(tp);
}
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);
if (t->c_cc[VMIN] != tp->t_cc[VMIN] ||
t->c_cc[VTIME] != tp->t_cc[VTIME])
ttwakeup(tp);
bcopy(t->c_cc, tp->t_cc, sizeof(t->c_cc));
break;
}
case TIOCSETD: {
int t = *(int *)data;
cdev_t device = tp->t_dev;
if ((u_int)t >= nlinesw) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (ENXIO);
}
if (t != tp->t_line) {
(*linesw[tp->t_line].l_close)(tp, flag);
error = (*linesw[t].l_open)(device, tp);
if (error) {
(void)(*linesw[tp->t_line].l_open)(device, tp);
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (error);
}
tp->t_line = t;
}
break;
}
case TIOCSTART:
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);
}
break;
case TIOCSTI:
if ((flag & FREAD) == 0 &&
caps_priv_check_td(td, SYSCAP_RESTRICTEDROOT))
{
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (EPERM);
}
if (!isctty(p, tp) &&
caps_priv_check_td(td, SYSCAP_RESTRICTEDROOT))
{
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (EACCES);
}
(*linesw[tp->t_line].l_rint)(*(u_char *)data, tp);
break;
case TIOCSTOP:
if (!ISSET(tp->t_state, TS_TTSTOP)) {
SET(tp->t_state, TS_TTSTOP);
(*tp->t_stop)(tp, 0);
}
break;
case TIOCSCTTY:
if (!SESS_LEADER(p) ||
((p->p_session->s_ttyvp || tp->t_session) &&
(tp->t_session != p->p_session))) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (EPERM);
}
ttyhold(tp);
tp->t_session = p->p_session;
opgrp = tp->t_pgrp;
pgref(p->p_pgrp);
tp->t_pgrp = p->p_pgrp;
otp = p->p_session->s_ttyp;
p->p_session->s_ttyp = tp;
p->p_flags |= P_CONTROLT;
if (otp)
ttyunhold(otp);
if (opgrp) {
pgrel(opgrp);
opgrp = NULL;
}
break;
case TIOCSPGRP: {
pid_t pgid = *(int *)data;
if (!isctty(p, tp)) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (ENOTTY);
}
else if (pgid < 1 || pgid > PID_MAX) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (EINVAL);
} else {
struct pgrp *pgrp = pgfind(pgid);
if (pgrp == NULL || pgrp->pg_session != p->p_session) {
if (pgrp)
pgrel(pgrp);
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (EPERM);
}
opgrp = tp->t_pgrp;
tp->t_pgrp = pgrp;
if (opgrp) {
pgrel(opgrp);
opgrp = NULL;
}
}
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 TIOCSDRAINWAIT:
error = caps_priv_check_td(td, SYSCAP_RESTRICTEDROOT);
if (error) {
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (error);
}
tp->t_timeout = *(int *)data * hz;
wakeup(TSA_OCOMPLETE(tp));
wakeup(TSA_OLOWAT(tp));
break;
case TIOCGDRAINWAIT:
*(int *)data = tp->t_timeout / hz;
break;
default:
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (ENOIOCTL);
}
lwkt_reltoken(&p->p_token);
lwkt_reltoken(&tp->t_token);
return (0);
}
static struct filterops ttyread_filtops =
{ FILTEROP_ISFD|FILTEROP_MPSAFE, NULL, filt_ttyrdetach, filt_ttyread };
static struct filterops ttywrite_filtops =
{ FILTEROP_ISFD|FILTEROP_MPSAFE, NULL, filt_ttywdetach, filt_ttywrite };
int
ttykqfilter(struct dev_kqfilter_args *ap)
{
cdev_t dev = ap->a_head.a_dev;
struct knote *kn = ap->a_kn;
struct tty *tp = dev->si_tty;
struct klist *klist;
ap->a_result = 0;
lwkt_gettoken(&tp->t_token);
switch (kn->kn_filter) {
case EVFILT_READ:
klist = &tp->t_rkq.ki_note;
kn->kn_fop = &ttyread_filtops;
break;
case EVFILT_WRITE:
klist = &tp->t_wkq.ki_note;
kn->kn_fop = &ttywrite_filtops;
break;
default:
ap->a_result = EOPNOTSUPP;
lwkt_reltoken(&tp->t_token);
return (0);
}
lwkt_reltoken(&tp->t_token);
kn->kn_hook = (caddr_t)dev;
knote_insert(klist, kn);
return (0);
}
static void
filt_ttyrdetach(struct knote *kn)
{
struct tty *tp = ((cdev_t)kn->kn_hook)->si_tty;
lwkt_gettoken(&tp->t_token);
knote_remove(&tp->t_rkq.ki_note, kn);
lwkt_reltoken(&tp->t_token);
}
static int
filt_ttyread(struct knote *kn, long hint)
{
struct tty *tp = ((cdev_t)kn->kn_hook)->si_tty;
lwkt_gettoken(&tp->t_token);
kn->kn_data = ttnread(tp);
if (ISSET(tp->t_state, TS_ZOMBIE)) {
kn->kn_flags |= (EV_EOF | EV_NODATA);
lwkt_reltoken(&tp->t_token);
return (1);
}
lwkt_reltoken(&tp->t_token);
return (kn->kn_data > 0);
}
static void
filt_ttywdetach(struct knote *kn)
{
struct tty *tp = ((cdev_t)kn->kn_hook)->si_tty;
lwkt_gettoken(&tp->t_token);
knote_remove(&tp->t_wkq.ki_note, kn);
lwkt_reltoken(&tp->t_token);
}
static int
filt_ttywrite(struct knote *kn, long hint)
{
struct tty *tp = ((cdev_t)kn->kn_hook)->si_tty;
int ret;
lwkt_gettoken(&tp->t_token);
kn->kn_data = tp->t_outq.c_cc;
if (ISSET(tp->t_state, TS_ZOMBIE)) {
lwkt_reltoken(&tp->t_token);
return (1);
}
ret = (kn->kn_data <= tp->t_olowat &&
ISSET(tp->t_state, TS_CONNECTED));
lwkt_reltoken(&tp->t_token);
return ret;
}
static int
ttnread(struct tty *tp)
{
int nread;
ASSERT_LWKT_TOKEN_HELD(&tp->t_token);
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] == 0)
nread = 0;
}
return (nread);
}
int
ttywait(struct tty *tp)
{
int error;
error = 0;
lwkt_gettoken(&tp->t_token);
while ((tp->t_outq.c_cc || ISSET(tp->t_state, TS_BUSY)) &&
ISSET(tp->t_state, TS_CONNECTED) && tp->t_oproc) {
(*tp->t_oproc)(tp);
if ((tp->t_outq.c_cc || ISSET(tp->t_state, TS_BUSY)) &&
ISSET(tp->t_state, TS_CONNECTED)) {
SET(tp->t_state, TS_SO_OCOMPLETE);
error = ttysleep(tp, TSA_OCOMPLETE(tp),
PCATCH, "ttywai",
tp->t_timeout);
if (error) {
if (error == EWOULDBLOCK)
error = EIO;
break;
}
} else
break;
}
if (!error && (tp->t_outq.c_cc || ISSET(tp->t_state, TS_BUSY)))
error = EIO;
lwkt_reltoken(&tp->t_token);
return (error);
}
static int
ttywflush(struct tty *tp)
{
int error;
if ((error = ttywait(tp)) == 0)
ttyflush(tp, FREAD);
return (error);
}
void
ttyflush(struct tty *tp, int rw)
{
lwkt_gettoken(&tp->t_token);
#if 0
again:
#endif
if (rw & FWRITE) {
FLUSHQ(&tp->t_outq);
CLR(tp->t_state, TS_TTSTOP);
}
(*tp->t_stop)(tp, rw);
if (rw & FREAD) {
FLUSHQ(&tp->t_canq);
FLUSHQ(&tp->t_rawq);
CLR(tp->t_lflag, PENDIN);
tp->t_rocount = 0;
tp->t_rocol = 0;
CLR(tp->t_state, TS_LOCAL);
ttwakeup(tp);
if (ISSET(tp->t_state, TS_TBLOCK)) {
if (rw & FWRITE)
FLUSHQ(&tp->t_outq);
ttyunblock(tp);
CLR(tp->t_state, TS_TBLOCK);
#if 0
if (ISSET(tp->t_iflag, IXOFF)) {
SET(tp->t_state, TS_SO_OCOMPLETE);
ttysleep(tp, TSA_OCOMPLETE(tp), 0,
"ttyfls", hz / 10);
CLR(tp->t_state, TS_TBLOCK);
goto again;
}
#endif
}
}
if (rw & FWRITE) {
FLUSHQ(&tp->t_outq);
ttwwakeup(tp);
}
lwkt_reltoken(&tp->t_token);
}
void
termioschars(struct termios *t)
{
bcopy(ttydefchars, t->c_cc, sizeof t->c_cc);
}
void
ttychars(struct tty *tp)
{
lwkt_gettoken(&tp->t_token);
termioschars(&tp->t_termios);
lwkt_reltoken(&tp->t_token);
}
void
ttyblock(struct tty *tp)
{
lwkt_gettoken(&tp->t_token);
SET(tp->t_state, TS_TBLOCK);
if (ISSET(tp->t_iflag, IXOFF) && tp->t_cc[VSTOP] != _POSIX_VDISABLE &&
clist_putc(tp->t_cc[VSTOP], &tp->t_outq) != 0)
CLR(tp->t_state, TS_TBLOCK);
ttstart(tp);
lwkt_reltoken(&tp->t_token);
}
static void
ttyunblock(struct tty *tp)
{
lwkt_gettoken(&tp->t_token);
CLR(tp->t_state, TS_TBLOCK);
if (ISSET(tp->t_iflag, IXOFF) && tp->t_cc[VSTART] != _POSIX_VDISABLE &&
clist_putc(tp->t_cc[VSTART], &tp->t_outq) != 0)
SET(tp->t_state, TS_TBLOCK);
ttstart(tp);
lwkt_reltoken(&tp->t_token);
}
int
ttstart(struct tty *tp)
{
lwkt_gettoken(&tp->t_token);
if (tp->t_oproc != NULL)
(*tp->t_oproc)(tp);
lwkt_reltoken(&tp->t_token);
return (0);
}
int
ttylclose(struct tty *tp, int flag)
{
lwkt_gettoken(&tp->t_token);
if (flag & FNONBLOCK || ttywflush(tp))
ttyflush(tp, FREAD | FWRITE);
lwkt_reltoken(&tp->t_token);
return (0);
}
void
ttyhold(struct tty *tp)
{
lwkt_gettoken(&tp->t_token);
++tp->t_refs;
lwkt_reltoken(&tp->t_token);
}
void
ttyunhold(struct tty *tp)
{
lwkt_gettoken(&tp->t_token);
if (tp->t_unhold)
tp->t_unhold(tp);
else
--tp->t_refs;
lwkt_reltoken(&tp->t_token);
}
int
ttymodem(struct tty *tp, int flag)
{
lwkt_gettoken(&tp->t_token);
if (ISSET(tp->t_state, TS_CARR_ON) && ISSET(tp->t_cflag, MDMBUF)) {
if (flag) {
CLR(tp->t_state, TS_CAR_OFLOW);
CLR(tp->t_state, TS_TTSTOP);
ttstart(tp);
} else if (!ISSET(tp->t_state, TS_CAR_OFLOW)) {
SET(tp->t_state, TS_CAR_OFLOW);
SET(tp->t_state, TS_TTSTOP);
(*tp->t_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)) {
SET(tp->t_state, TS_ZOMBIE);
CLR(tp->t_state, TS_CONNECTED);
if (tp->t_session && tp->t_session->s_leader)
ksignal(tp->t_session->s_leader, SIGHUP);
ttyflush(tp, FREAD | FWRITE);
lwkt_reltoken(&tp->t_token);
return (0);
}
} else {
SET(tp->t_state, TS_CARR_ON);
if (!ISSET(tp->t_state, TS_ZOMBIE))
SET(tp->t_state, TS_CONNECTED);
wakeup(TSA_CARR_ON(tp));
ttwakeup(tp);
ttwwakeup(tp);
}
lwkt_reltoken(&tp->t_token);
return (1);
}
static void
ttypend(struct tty *tp)
{
struct clist tq;
int c;
lwkt_gettoken(&tp->t_token);
CLR(tp->t_lflag, PENDIN);
SET(tp->t_state, TS_TYPEN);
tq = tp->t_rawq;
bzero(&tp->t_rawq, sizeof tp->t_rawq);
clist_alloc_cblocks(&tp->t_rawq, tq.c_ccmax);
while ((c = clist_getc(&tq)) >= 0)
ttyinput(c, tp);
CLR(tp->t_state, TS_TYPEN);
clist_free_cblocks(&tq);
lwkt_reltoken(&tp->t_token);
}
int
ttread(struct tty *tp, struct uio *uio, int flag)
{
struct clist *qp;
int c;
tcflag_t lflag;
cc_t *cc = tp->t_cc;
struct proc *pp;
struct lwp *lp;
int first, error = 0;
int has_stime = 0, last_cc = 0;
long slp = 0;
struct timeval stime;
lp = curthread->td_lwp;
stime.tv_sec = 0;
stime.tv_usec = 0;
lwkt_gettoken(&tp->t_token);
loop:
lflag = tp->t_lflag;
if (ISSET(lflag, PENDIN)) {
ttypend(tp);
splz();
lflag = tp->t_lflag;
}
if ((pp = curproc) != NULL)
lwkt_gettoken(&pp->p_token);
if (pp && isbackground(pp, tp)) {
if (SIGISMEMBER(pp->p_sigignore, SIGTTIN) ||
SIGISMEMBER(lp->lwp_sigmask, SIGTTIN) ||
(pp->p_flags & P_PPWAIT) || pp->p_pgrp->pg_jobc == 0) {
lwkt_reltoken(&pp->p_token);
lwkt_reltoken(&tp->t_token);
return (EIO);
}
pgsignal(pp->p_pgrp, SIGTTIN, 1);
error = ttysleep(tp, &lbolt, PCATCH, "ttybg2", 0);
if (error) {
lwkt_reltoken(&pp->p_token);
lwkt_reltoken(&tp->t_token);
return (error);
}
lwkt_reltoken(&pp->p_token);
goto loop;
}
if (pp)
lwkt_reltoken(&pp->p_token);
if (ISSET(tp->t_state, TS_ZOMBIE)) {
lwkt_reltoken(&tp->t_token);
return (0);
}
qp = ISSET(lflag, ICANON) ? &tp->t_canq : &tp->t_rawq;
if (flag & IO_NDELAY) {
if (qp->c_cc > 0)
goto read;
if (!ISSET(lflag, ICANON) && cc[VMIN] == 0) {
lwkt_reltoken(&tp->t_token);
return (0);
}
lwkt_reltoken(&tp->t_token);
return (EWOULDBLOCK);
}
if (!ISSET(lflag, ICANON)) {
int m = cc[VMIN];
long t = cc[VTIME];
struct timeval timecopy;
if (t == 0) {
if (qp->c_cc < m)
goto sleep;
if (qp->c_cc > 0)
goto read;
lwkt_reltoken(&tp->t_token);
return (0);
}
t *= 100000;
#define diff(t1, t2) (((t1).tv_sec - (t2).tv_sec) * 1000000 + \
((t1).tv_usec - (t2).tv_usec))
if (m > 0) {
if (qp->c_cc <= 0)
goto sleep;
if (qp->c_cc >= m)
goto read;
getmicrotime(&timecopy);
if (has_stime == 0) {
has_stime = 1;
stime = timecopy;
slp = t;
} else if (qp->c_cc > last_cc) {
stime = timecopy;
slp = t;
} else {
slp = t - diff(timecopy, stime);
if (slp <= 0)
goto read;
}
last_cc = qp->c_cc;
} else {
if (qp->c_cc > 0)
goto read;
getmicrotime(&timecopy);
if (has_stime == 0) {
has_stime = 1;
stime = timecopy;
slp = t;
} else {
slp = t - diff(timecopy, stime);
if (slp <= 0) {
lwkt_reltoken(&tp->t_token);
return (0);
}
}
}
#undef diff
slp = (long) (((u_long)slp * hz) + 999999) / 1000000;
goto sleep;
}
if (qp->c_cc <= 0) {
sleep:
error = ttysleep(tp, TSA_HUP_OR_INPUT(tp), PCATCH,
ISSET(tp->t_state, TS_CONNECTED) ?
"ttyin" : "ttyhup", (int)slp);
if (error == EWOULDBLOCK)
error = 0;
else if (error) {
lwkt_reltoken(&tp->t_token);
return (error);
}
slp = 0;
goto loop;
}
read:
first = 1;
if (ISSET(lflag, ICANON | ISIG))
goto slowcase;
for (;;) {
char ibuf[IBUFSIZ];
int icc;
icc = (int)szmin(uio->uio_resid, IBUFSIZ);
icc = clist_qtob(qp, ibuf, icc);
if (icc <= 0) {
if (first)
goto loop;
break;
}
error = uiomove(ibuf, (size_t)icc, uio);
if (error)
break;
if (uio->uio_resid == 0)
break;
first = 0;
}
goto out;
slowcase:
for (;;) {
c = clist_getc(qp);
if (c < 0) {
if (first)
goto loop;
break;
}
if (CCEQ(cc[VDSUSP], c) &&
ISSET(lflag, IEXTEN | ISIG) == (IEXTEN | ISIG)) {
pgsignal(tp->t_pgrp, SIGTSTP, 1);
if (first) {
error = ttysleep(tp, &lbolt, PCATCH,
"ttybg3", 0);
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;
}
out:
if (ISSET(tp->t_state, TS_TBLOCK) &&
tp->t_rawq.c_cc + tp->t_canq.c_cc <= tp->t_ilowat) {
ttyunblock(tp);
}
lwkt_reltoken(&tp->t_token);
return (error);
}
int
ttycheckoutq(struct tty *tp, int wait)
{
struct lwp *lp = curthread->td_lwp;
int hiwat;
sigset_t oldset, newset;
lwkt_gettoken(&tp->t_token);
hiwat = tp->t_ohiwat;
SIGEMPTYSET(oldset);
SIGEMPTYSET(newset);
if (wait)
oldset = lwp_sigpend(lp);
if (tp->t_outq.c_cc > hiwat + OBUFSIZ + 100) {
while (tp->t_outq.c_cc > hiwat) {
ttstart(tp);
if (tp->t_outq.c_cc <= hiwat)
break;
if (wait)
newset = lwp_sigpend(lp);
if (!wait || SIGSETNEQ(oldset, newset)) {
lwkt_reltoken(&tp->t_token);
return (0);
}
SET(tp->t_state, TS_SO_OLOWAT);
tsleep(TSA_OLOWAT(tp), 0, "ttoutq", hz);
}
}
lwkt_reltoken(&tp->t_token);
return (1);
}
int
ttwrite(struct tty *tp, struct uio *uio, int flag)
{
char *cp = NULL;
int cc, ce;
struct proc *pp;
struct lwp *lp;
int i, hiwat, error;
size_t cnt;
char obuf[OBUFSIZ];
lwkt_gettoken(&tp->t_token);
lp = curthread->td_lwp;
hiwat = tp->t_ohiwat;
cnt = uio->uio_resid;
error = 0;
cc = 0;
loop:
if (ISSET(tp->t_state, TS_ZOMBIE)) {
if (uio->uio_resid == cnt)
error = EIO;
goto out;
}
if (!ISSET(tp->t_state, TS_CONNECTED)) {
if (flag & IO_NDELAY) {
error = EWOULDBLOCK;
goto out;
}
error = ttysleep(tp, TSA_CARR_ON(tp), PCATCH, "ttydcd", 0);
if (error)
goto out;
goto loop;
}
if ((pp = curproc) != NULL)
lwkt_gettoken(&pp->p_token);
if (pp && isbackground(pp, tp) &&
ISSET(tp->t_lflag, TOSTOP) && !(pp->p_flags & P_PPWAIT) &&
!SIGISMEMBER(pp->p_sigignore, SIGTTOU) &&
!SIGISMEMBER(lp->lwp_sigmask, SIGTTOU)) {
if (pp->p_pgrp->pg_jobc == 0) {
error = EIO;
lwkt_reltoken(&pp->p_token);
goto out;
}
pgsignal(pp->p_pgrp, SIGTTOU, 1);
lwkt_reltoken(&pp->p_token);
error = ttysleep(tp, &lbolt, PCATCH, "ttybg4", 0);
if (error)
goto out;
goto loop;
}
if (pp)
lwkt_reltoken(&pp->p_token);
while (uio->uio_resid > 0 || cc > 0) {
if (ISSET(tp->t_lflag, FLUSHO)) {
uio->uio_resid = 0;
lwkt_reltoken(&tp->t_token);
return (0);
}
if (tp->t_outq.c_cc > hiwat)
goto ovhiwat;
if (cc == 0) {
cc = szmin(uio->uio_resid, OBUFSIZ);
cp = obuf;
error = uiomove(cp, (size_t)cc, uio);
if (error) {
cc = 0;
break;
}
}
while (cc > 0) {
if (!ISSET(tp->t_oflag, OPOST))
ce = cc;
else {
ce = cc - scanc((u_int)cc, (u_char *)cp,
char_type, CCLASSMASK);
if (ce == 0) {
tp->t_rocount = 0;
if (ttyoutput(*cp, tp) >= 0) {
ttstart(tp);
if (flag & IO_NDELAY) {
error = EWOULDBLOCK;
goto out;
}
error = ttysleep(tp, &lbolt,
PCATCH,
"ttybf1", 0);
if (error)
goto out;
goto loop;
}
cp++;
cc--;
if (ISSET(tp->t_lflag, FLUSHO) ||
tp->t_outq.c_cc > hiwat)
goto ovhiwat;
continue;
}
}
tp->t_rocount = 0;
i = clist_btoq(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) {
ttstart(tp);
if (flag & IO_NDELAY) {
error = EWOULDBLOCK;
goto out;
}
error = ttysleep(tp, &lbolt, PCATCH,
"ttybf2", 0);
if (error)
goto out;
goto loop;
}
if (ISSET(tp->t_lflag, FLUSHO) ||
tp->t_outq.c_cc > hiwat)
break;
}
ttstart(tp);
}
out:
uio->uio_resid += cc;
lwkt_reltoken(&tp->t_token);
return (error);
ovhiwat:
ttstart(tp);
if (tp->t_outq.c_cc <= hiwat) {
goto loop;
}
if (flag & IO_NDELAY) {
uio->uio_resid += cc;
lwkt_reltoken(&tp->t_token);
return (uio->uio_resid == cnt ? EWOULDBLOCK : 0);
}
SET(tp->t_state, TS_SO_OLOWAT);
error = ttysleep(tp, TSA_OLOWAT(tp), PCATCH, "ttywri", tp->t_timeout);
if (error == EWOULDBLOCK)
error = EIO;
if (error)
goto out;
goto loop;
}
static void
ttyrub(int c, struct tty *tp)
{
void *cp;
int savecol;
int tabc;
ASSERT_LWKT_TOKEN_HELD(&tp->t_token);
if (!ISSET(tp->t_lflag, ECHO) || ISSET(tp->t_lflag, EXTPROC))
return;
CLR(tp->t_lflag, FLUSHO);
if (ISSET(tp->t_lflag, ECHOE)) {
if (tp->t_rocount == 0) {
ttyretype(tp);
return;
}
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) {
ttyretype(tp);
return;
}
savecol = tp->t_column;
SET(tp->t_state, TS_CNTTB);
SET(tp->t_lflag, FLUSHO);
tp->t_column = tp->t_rocol;
cp = clist_nextc(&tp->t_rawq, NULL, &tabc);
while (cp) {
ttyecho(tabc, tp);
cp = clist_nextc(&tp->t_rawq,
cp, &tabc);
}
CLR(tp->t_lflag, FLUSHO);
CLR(tp->t_state, TS_CNTTB);
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\n"
(void)kprintf(PANICSTR, 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;
}
static void
ttyrubo(struct tty *tp, int cnt)
{
ASSERT_LWKT_TOKEN_HELD(&tp->t_token);
while (cnt-- > 0) {
(void)ttyoutput('\b', tp);
(void)ttyoutput(' ', tp);
(void)ttyoutput('\b', tp);
}
}
static void
ttyretype(struct tty *tp)
{
void *cp;
int c;
ASSERT_LWKT_TOKEN_HELD(&tp->t_token);
if (tp->t_cc[VREPRINT] != _POSIX_VDISABLE)
ttyecho(tp->t_cc[VREPRINT], tp);
(void)ttyoutput('\n', tp);
cp = clist_nextc(&tp->t_canq, NULL, &c);
while (cp) {
ttyecho(c, tp);
cp = clist_nextc(&tp->t_canq, cp, &c);
}
cp = clist_nextc(&tp->t_rawq, NULL, &c);
while (cp) {
ttyecho(c, tp);
cp = clist_nextc(&tp->t_rawq, cp, &c);
}
CLR(tp->t_state, TS_ERASE);
tp->t_rocount = tp->t_rawq.c_cc;
tp->t_rocol = 0;
}
static void
ttyecho(int c, struct tty *tp)
{
ASSERT_LWKT_TOKEN_HELD(&tp->t_token);
if (!ISSET(tp->t_state, TS_CNTTB))
CLR(tp->t_lflag, FLUSHO);
if ((!ISSET(tp->t_lflag, ECHO) &&
(c != '\n' || !ISSET(tp->t_lflag, ECHONL))) ||
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
ttwakeup(struct tty *tp)
{
lwkt_gettoken(&tp->t_token);
if (ISSET(tp->t_state, TS_ASYNC) && tp->t_sigio != NULL)
pgsigio(tp->t_sigio, SIGIO, (tp->t_session != NULL));
wakeup(TSA_HUP_OR_INPUT(tp));
KNOTE(&tp->t_rkq.ki_note, 0);
lwkt_reltoken(&tp->t_token);
}
void
ttwwakeup(struct tty *tp)
{
lwkt_gettoken(&tp->t_token);
if (ISSET(tp->t_state, TS_ASYNC) && tp->t_sigio != NULL)
pgsigio(tp->t_sigio, SIGIO, (tp->t_session != NULL));
if (ISSET(tp->t_state, TS_BUSY | TS_SO_OCOMPLETE) ==
TS_SO_OCOMPLETE && tp->t_outq.c_cc == 0) {
CLR(tp->t_state, TS_SO_OCOMPLETE);
wakeup(TSA_OCOMPLETE(tp));
}
if (ISSET(tp->t_state, TS_SO_OLOWAT) &&
tp->t_outq.c_cc <= tp->t_olowat) {
CLR(tp->t_state, TS_SO_OLOWAT);
wakeup(TSA_OLOWAT(tp));
}
KNOTE(&tp->t_wkq.ki_note, 0);
lwkt_reltoken(&tp->t_token);
}
int
ttspeedtab(int speed, struct speedtab *table)
{
for ( ; table->sp_speed != -1; table++)
if (table->sp_speed == speed)
return (table->sp_code);
return (-1);
}
#define CLAMP(x, h, l) ((x) > h ? h : ((x) < l) ? l : (x))
void
ttsetwater(struct tty *tp)
{
int ttmaxhiwat;
int cps;
int x;
lwkt_gettoken(&tp->t_token);
clist_alloc_cblocks(&tp->t_canq, TTYHOG);
switch (tp->t_ispeedwat) {
case (speed_t)-1:
cps = tp->t_ispeed / 10;
break;
case 0:
cps = TTYHOG - 2 * 256;
tp->t_ififosize = 2 * 2048;
break;
default:
cps = tp->t_ispeedwat / 10;
break;
}
tp->t_ihiwat = cps;
tp->t_ilowat = 7 * cps / 8;
x = cps + tp->t_ififosize;
clist_alloc_cblocks(&tp->t_rawq, x);
switch (tp->t_ospeedwat) {
case (speed_t)-1:
cps = tp->t_ospeed / 10;
ttmaxhiwat = 2 * TTMAXHIWAT;
break;
case 0:
cps = tp->t_ospeed / 10;
ttmaxhiwat = TTMAXHIWAT;
break;
default:
cps = tp->t_ospeedwat / 10;
ttmaxhiwat = 8 * TTMAXHIWAT;
break;
}
x = CLAMP(cps / 2, TTMAXLOWAT, TTMINLOWAT);
tp->t_olowat = x;
x += cps;
x = CLAMP(x, ttmaxhiwat, TTMINHIWAT);
tp->t_ohiwat = x;
x = imax(tp->t_ohiwat, TTMAXHIWAT);
x += OBUFSIZ + 100;
clist_alloc_cblocks(&tp->t_outq, x);
lwkt_reltoken(&tp->t_token);
}
#undef CLAMP
void
ttyinfo(struct tty *tp)
{
struct pgrp *pgrp;
struct proc *p, *pick;
struct lwp *lp;
struct rusage ru;
char buf[64];
const char *str;
struct vmspace *vm;
long vmsz;
int pctcpu;
int tmp;
if (ttycheckoutq(tp,0) == 0)
return;
lwkt_gettoken(&tp->t_token);
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");
goto done2;
}
if ((pgrp = tp->t_pgrp) == NULL) {
ttyprintf(tp, "no foreground process group\n");
goto done2;
}
pgref(pgrp);
lwkt_gettoken(&pgrp->pg_token);
pick = NULL;
for (p = LIST_FIRST(&pgrp->pg_members);
p != NULL;
p = LIST_NEXT(p, p_pglist)) {
PHOLD(p);
if (proc_compare(pick, p)) {
if (pick)
PRELE(pick);
pick = p;
} else {
PRELE(p);
}
}
if (pick == NULL) {
ttyprintf(tp, "empty foreground process group\n");
goto done1;
}
lp = FIRST_LWP_IN_PROC(pick);
if (lp == NULL) {
PRELE(pick);
ttyprintf(tp, "foreground process without lwp\n");
goto done1;
}
LWPHOLD(lp);
if (pick->p_flags & P_WEXIT)
str = "exiting";
else if (lp->lwp_stat == LSRUN)
str = "running";
else if (pick->p_stat == SIDL)
str = "spawning";
else if (lp->lwp_wmesg)
str = lp->lwp_wmesg;
else
str = "iowait";
ksnprintf(buf, sizeof(buf), "cmd: %s %d [%s]",
pick->p_comm, pick->p_pid, str);
if (lp->lwp_thread)
calcru_proc(pick, &ru);
pctcpu = (lp->lwp_pctcpu * 10000 + FSCALE / 2) >> FSHIFT;
LWPRELE(lp);
if (pick->p_stat == SIDL || pick->p_stat == SZOMB) {
vmsz = 0;
} else if ((vm = pick->p_vmspace) == NULL) {
vmsz = 0;
} else {
vmspace_hold(vm);
vmsz = pgtok(vmspace_resident_count(vm));
vmspace_drop(vm);
}
PRELE(pick);
ttyprintf(tp, " %s ",
buf);
ttyprintf(tp, "%ld.%02ldu ",
ru.ru_utime.tv_sec, ru.ru_utime.tv_usec / 10000);
ttyprintf(tp, "%ld.%02lds ",
ru.ru_stime.tv_sec, ru.ru_stime.tv_usec / 10000);
ttyprintf(tp, "%d%% %ldk\n",
pctcpu / 100, vmsz);
done1:
lwkt_reltoken(&pgrp->pg_token);
pgrel(pgrp);
done2:
tp->t_rocount = 0;
lwkt_reltoken(&tp->t_token);
}
#define ISRUN(lp) ((lp)->lwp_stat == LSRUN)
#define TESTAB(a, b) ((a)<<1 | (b))
#define ONLYA 2
#define ONLYB 1
#define BOTH 3
static int
proc_compare(struct proc *p1, struct proc *p2)
{
struct lwp *lp1, *lp2;
int res;
if (p1 == NULL)
return (1);
if (lwkt_trytoken(&p1->p_token) == 0)
return (1);
if (lwkt_trytoken(&p2->p_token) == 0) {
lwkt_reltoken(&p1->p_token);
return (0);
}
switch (TESTAB(p1->p_stat == SZOMB, p2->p_stat == SZOMB)) {
case ONLYA:
res = 1;
goto done;
case ONLYB:
res = 0;
goto done;
case BOTH:
res = (p2->p_pid > p1->p_pid);
goto done;
default:
break;
}
lp1 = FIRST_LWP_IN_PROC(p1);
lp2 = FIRST_LWP_IN_PROC(p2);
if (lp1 == NULL) {
res = 1;
goto done;
}
if (lp2 == NULL) {
res = 0;
goto done;
}
switch (TESTAB(ISRUN(lp1), ISRUN(lp2))) {
case ONLYA:
res = 0;
goto done;
case ONLYB:
res = 1;
goto done;
case BOTH:
if (lp2->lwp_cpticks > lp1->lwp_cpticks)
res = 1;
else if (lp1->lwp_cpticks > lp2->lwp_cpticks)
res = 0;
else
res = (p2->p_pid > p1->p_pid);
goto done;
default:
break;
}
if (lp2->lwp_slptime > lp1->lwp_slptime) {
res = 0;
goto done;
}
if (lp1->lwp_slptime > lp2->lwp_slptime) {
res = 1;
goto done;
}
if ((lp1->lwp_flags & LWP_SINTR) && (lp2->lwp_flags & LWP_SINTR) == 0)
res = 1;
else
if ((lp2->lwp_flags & LWP_SINTR) && (lp1->lwp_flags & LWP_SINTR) == 0)
res = 0;
else
res = (p2->p_pid > p1->p_pid);
done:
lwkt_reltoken(&p2->p_token);
lwkt_reltoken(&p1->p_token);
return (res);
}
int
tputchar(int c, struct tty *tp)
{
lwkt_gettoken(&tp->t_token);
if (!ISSET(tp->t_state, TS_CONNECTED)) {
lwkt_reltoken(&tp->t_token);
return (-1);
}
if (c == '\n')
(void)ttyoutput('\r', tp);
(void)ttyoutput(c, tp);
ttstart(tp);
lwkt_reltoken(&tp->t_token);
return (0);
}
int
ttysleep(struct tty *tp, void *chan, int slpflags, char *wmesg, int timo)
{
int error;
int gen;
gen = tp->t_gen;
error = tsleep(chan, slpflags, wmesg, timo);
if (error)
return (error);
return (tp->t_gen == gen ? 0 : ERESTART);
}
int
ttyrevoke(struct dev_revoke_args *ap)
{
struct tty *tp;
tp = ap->a_head.a_dev->si_tty;
lwkt_gettoken(&tp->t_token);
tp->t_gen++;
ttyflush(tp, FREAD | FWRITE);
wakeup(TSA_CARR_ON(tp));
ttwakeup(tp);
ttwwakeup(tp);
lwkt_reltoken(&tp->t_token);
return (0);
}
struct tty *
ttymalloc(struct tty **tpp)
{
struct tty *tp;
if ((tp = *tpp) == NULL) {
tp = kmalloc(sizeof *tp, M_TTYS, M_WAITOK|M_ZERO);
lwkt_gettoken(&tty_token);
if (*tpp == NULL) {
*tpp = tp;
ttyinit(tp);
ttyregister(tp);
} else {
kfree(tp, M_TTYS);
}
lwkt_reltoken(&tty_token);
}
return (tp);
}
void
ttyunregister(struct tty *tp)
{
lwkt_gettoken(&tty_token);
if (ISSET(tp->t_state, TS_REGISTERED)) {
CLR(tp->t_state, TS_REGISTERED);
TAILQ_REMOVE(&tty_list, tp, t_list);
}
lwkt_reltoken(&tty_token);
}
void
ttyinit(struct tty *tp)
{
lwkt_token_init(&tp->t_token, "tp");
}
void
ttyregister(struct tty *tp)
{
lwkt_gettoken(&tty_token);
if (!ISSET(tp->t_state, TS_REGISTERED)) {
SET(tp->t_state, TS_REGISTERED);
TAILQ_INSERT_HEAD(&tty_list, tp, t_list);
}
lwkt_reltoken(&tty_token);
}
static int
sysctl_kern_ttys(SYSCTL_HANDLER_ARGS)
{
int error;
struct tty *tp;
struct tty t;
struct tty marker;
bzero(&marker, sizeof(marker));
marker.t_state = TS_MARKER;
error = 0;
lwkt_gettoken(&tty_token);
TAILQ_INSERT_HEAD(&tty_list, &marker, t_list);
while ((tp = TAILQ_NEXT(&marker, t_list)) != NULL) {
TAILQ_REMOVE(&tty_list, &marker, t_list);
TAILQ_INSERT_AFTER(&tty_list, tp, &marker, t_list);
if (tp->t_state & TS_MARKER)
continue;
t = *tp;
if (t.t_dev)
t.t_dev = (cdev_t)(uintptr_t)devid_from_dev(t.t_dev);
error = SYSCTL_OUT(req, (caddr_t)&t, sizeof(t));
if (error)
break;
}
TAILQ_REMOVE(&tty_list, &marker, t_list);
lwkt_reltoken(&tty_token);
return (error);
}
SYSCTL_PROC(_kern, OID_AUTO, ttys, CTLTYPE_OPAQUE|CTLFLAG_RD,
0, 0, sysctl_kern_ttys, "S,tty", "All struct ttys");
void
nottystop(struct tty *tp, int rw)
{
return;
}
int
ttyread(struct dev_read_args *ap)
{
struct tty *tp;
int ret;
tp = ap->a_head.a_dev->si_tty;
if (tp == NULL)
return (ENODEV);
lwkt_gettoken(&tp->t_token);
ret = ((*linesw[tp->t_line].l_read)(tp, ap->a_uio, ap->a_ioflag));
lwkt_reltoken(&tp->t_token);
return ret;
}
int
ttywrite(struct dev_write_args *ap)
{
struct tty *tp;
int ret;
tp = ap->a_head.a_dev->si_tty;
if (tp == NULL)
return (ENODEV);
lwkt_gettoken(&tp->t_token);
ret = ((*linesw[tp->t_line].l_write)(tp, ap->a_uio, ap->a_ioflag));
lwkt_reltoken(&tp->t_token);
return ret;
}