28aa9d1022
When I migrated tty_compat.c to MPSAFE TTY, I just hooked it up to the build and fixed it until it compiled and somewhat worked. It turns out this was not the smartest thing, because the old TTY layer also had a field called t_flags, which contained a set of sgtty flags. This means our current COMPAT_43TTY code overwrites the TTY flags, causing all strange problems to occur. Fix this code to use a new struct member called t_compatflags. This commit may cause kern/127054 to be fixed, but this still has to be tested/confirmed by the originator. It has to be fixed anyway. PR: kern/127054
483 lines
11 KiB
C
483 lines
11 KiB
C
/*-
|
|
* Copyright (c) 1982, 1986, 1991, 1993
|
|
* The Regents of the University of California. All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 4. Neither the name of the University nor the names of its contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*
|
|
* @(#)tty_compat.c 8.1 (Berkeley) 6/10/93
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include "opt_compat.h"
|
|
|
|
/*
|
|
* mapping routines for old line discipline (yuck)
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/ioctl_compat.h>
|
|
#include <sys/tty.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/sysctl.h>
|
|
|
|
struct speedtab {
|
|
int sp_speed; /* Speed. */
|
|
int sp_code; /* Code. */
|
|
};
|
|
|
|
static int ttcompatgetflags(struct tty *tp);
|
|
static void ttcompatsetflags(struct tty *tp, struct termios *t);
|
|
static void ttcompatsetlflags(struct tty *tp, struct termios *t);
|
|
static int ttcompatspeedtab(int speed, struct speedtab *table);
|
|
|
|
static int ttydebug = 0;
|
|
SYSCTL_INT(_debug, OID_AUTO, ttydebug, CTLFLAG_RW, &ttydebug, 0, "");
|
|
|
|
static struct speedtab compatspeeds[] = {
|
|
#define MAX_SPEED 17
|
|
{ 115200, 17 },
|
|
{ 57600, 16 },
|
|
{ 38400, 15 },
|
|
{ 19200, 14 },
|
|
{ 9600, 13 },
|
|
{ 4800, 12 },
|
|
{ 2400, 11 },
|
|
{ 1800, 10 },
|
|
{ 1200, 9 },
|
|
{ 600, 8 },
|
|
{ 300, 7 },
|
|
{ 200, 6 },
|
|
{ 150, 5 },
|
|
{ 134, 4 },
|
|
{ 110, 3 },
|
|
{ 75, 2 },
|
|
{ 50, 1 },
|
|
{ 0, 0 },
|
|
{ -1, -1 },
|
|
};
|
|
static int compatspcodes[] = {
|
|
0, 50, 75, 110, 134, 150, 200, 300, 600, 1200,
|
|
1800, 2400, 4800, 9600, 19200, 38400, 57600, 115200,
|
|
};
|
|
|
|
static int
|
|
ttcompatspeedtab(int speed, struct speedtab *table)
|
|
{
|
|
if (speed == 0)
|
|
return (0); /* hangup */
|
|
for ( ; table->sp_speed > 0; table++)
|
|
if (table->sp_speed <= speed) /* nearest one, rounded down */
|
|
return (table->sp_code);
|
|
return (1); /* 50, min and not hangup */
|
|
}
|
|
|
|
static int
|
|
ttsetcompat(struct tty *tp, u_long *com, caddr_t data, struct termios *term)
|
|
{
|
|
switch (*com) {
|
|
case TIOCSETP:
|
|
case TIOCSETN: {
|
|
struct sgttyb *sg = (struct sgttyb *)data;
|
|
int speed;
|
|
|
|
if ((speed = sg->sg_ispeed) > MAX_SPEED || speed < 0)
|
|
return(EINVAL);
|
|
else if (speed != ttcompatspeedtab(tp->t_termios.c_ispeed,
|
|
compatspeeds))
|
|
term->c_ispeed = compatspcodes[speed];
|
|
else
|
|
term->c_ispeed = tp->t_termios.c_ispeed;
|
|
if ((speed = sg->sg_ospeed) > MAX_SPEED || speed < 0)
|
|
return(EINVAL);
|
|
else if (speed != ttcompatspeedtab(tp->t_termios.c_ospeed,
|
|
compatspeeds))
|
|
term->c_ospeed = compatspcodes[speed];
|
|
else
|
|
term->c_ospeed = tp->t_termios.c_ospeed;
|
|
term->c_cc[VERASE] = sg->sg_erase;
|
|
term->c_cc[VKILL] = sg->sg_kill;
|
|
tp->t_compatflags = (tp->t_compatflags&0xffff0000) |
|
|
(sg->sg_flags&0xffff);
|
|
ttcompatsetflags(tp, term);
|
|
*com = (*com == TIOCSETP) ? TIOCSETAF : TIOCSETA;
|
|
break;
|
|
}
|
|
case TIOCSETC: {
|
|
struct tchars *tc = (struct tchars *)data;
|
|
cc_t *cc;
|
|
|
|
cc = term->c_cc;
|
|
cc[VINTR] = tc->t_intrc;
|
|
cc[VQUIT] = tc->t_quitc;
|
|
cc[VSTART] = tc->t_startc;
|
|
cc[VSTOP] = tc->t_stopc;
|
|
cc[VEOF] = tc->t_eofc;
|
|
cc[VEOL] = tc->t_brkc;
|
|
if (tc->t_brkc == (char)_POSIX_VDISABLE)
|
|
cc[VEOL2] = _POSIX_VDISABLE;
|
|
*com = TIOCSETA;
|
|
break;
|
|
}
|
|
case TIOCSLTC: {
|
|
struct ltchars *ltc = (struct ltchars *)data;
|
|
cc_t *cc;
|
|
|
|
cc = term->c_cc;
|
|
cc[VSUSP] = ltc->t_suspc;
|
|
cc[VDSUSP] = ltc->t_dsuspc;
|
|
cc[VREPRINT] = ltc->t_rprntc;
|
|
cc[VDISCARD] = ltc->t_flushc;
|
|
cc[VWERASE] = ltc->t_werasc;
|
|
cc[VLNEXT] = ltc->t_lnextc;
|
|
*com = TIOCSETA;
|
|
break;
|
|
}
|
|
case TIOCLBIS:
|
|
case TIOCLBIC:
|
|
case TIOCLSET:
|
|
if (*com == TIOCLSET)
|
|
tp->t_compatflags = (tp->t_compatflags&0xffff) |
|
|
*(int *)data<<16;
|
|
else {
|
|
tp->t_compatflags = (ttcompatgetflags(tp)&0xffff0000) |
|
|
(tp->t_compatflags&0xffff);
|
|
if (*com == TIOCLBIS)
|
|
tp->t_compatflags |= *(int *)data<<16;
|
|
else
|
|
tp->t_compatflags &= ~(*(int *)data<<16);
|
|
}
|
|
ttcompatsetlflags(tp, term);
|
|
*com = TIOCSETA;
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/*ARGSUSED*/
|
|
int
|
|
tty_ioctl_compat(struct tty *tp, u_long com, caddr_t data, struct thread *td)
|
|
{
|
|
switch (com) {
|
|
case TIOCSETP:
|
|
case TIOCSETN:
|
|
case TIOCSETC:
|
|
case TIOCSLTC:
|
|
case TIOCLBIS:
|
|
case TIOCLBIC:
|
|
case TIOCLSET: {
|
|
struct termios term;
|
|
int error;
|
|
|
|
term = tp->t_termios;
|
|
if ((error = ttsetcompat(tp, &com, data, &term)) != 0)
|
|
return error;
|
|
return tty_ioctl(tp, com, &term, td);
|
|
}
|
|
case TIOCGETP: {
|
|
struct sgttyb *sg = (struct sgttyb *)data;
|
|
cc_t *cc = tp->t_termios.c_cc;
|
|
|
|
sg->sg_ospeed = ttcompatspeedtab(tp->t_termios.c_ospeed,
|
|
compatspeeds);
|
|
if (tp->t_termios.c_ispeed == 0)
|
|
sg->sg_ispeed = sg->sg_ospeed;
|
|
else
|
|
sg->sg_ispeed = ttcompatspeedtab(tp->t_termios.c_ispeed,
|
|
compatspeeds);
|
|
sg->sg_erase = cc[VERASE];
|
|
sg->sg_kill = cc[VKILL];
|
|
sg->sg_flags = tp->t_compatflags = ttcompatgetflags(tp);
|
|
break;
|
|
}
|
|
case TIOCGETC: {
|
|
struct tchars *tc = (struct tchars *)data;
|
|
cc_t *cc = tp->t_termios.c_cc;
|
|
|
|
tc->t_intrc = cc[VINTR];
|
|
tc->t_quitc = cc[VQUIT];
|
|
tc->t_startc = cc[VSTART];
|
|
tc->t_stopc = cc[VSTOP];
|
|
tc->t_eofc = cc[VEOF];
|
|
tc->t_brkc = cc[VEOL];
|
|
break;
|
|
}
|
|
case TIOCGLTC: {
|
|
struct ltchars *ltc = (struct ltchars *)data;
|
|
cc_t *cc = tp->t_termios.c_cc;
|
|
|
|
ltc->t_suspc = cc[VSUSP];
|
|
ltc->t_dsuspc = cc[VDSUSP];
|
|
ltc->t_rprntc = cc[VREPRINT];
|
|
ltc->t_flushc = cc[VDISCARD];
|
|
ltc->t_werasc = cc[VWERASE];
|
|
ltc->t_lnextc = cc[VLNEXT];
|
|
break;
|
|
}
|
|
case TIOCLGET:
|
|
tp->t_compatflags =
|
|
(ttcompatgetflags(tp) & 0xffff0000UL)
|
|
| (tp->t_compatflags & 0xffff);
|
|
*(int *)data = tp->t_compatflags>>16;
|
|
if (ttydebug)
|
|
printf("CLGET: returning %x\n", *(int *)data);
|
|
break;
|
|
|
|
case OTIOCGETD:
|
|
*(int *)data = 2;
|
|
break;
|
|
|
|
case OTIOCSETD: {
|
|
int ldisczero = 0;
|
|
|
|
return (tty_ioctl(tp, TIOCSETD,
|
|
*(int *)data == 2 ? (caddr_t)&ldisczero : data, td));
|
|
}
|
|
|
|
case OTIOCCONS:
|
|
*(int *)data = 1;
|
|
return (tty_ioctl(tp, TIOCCONS, data, td));
|
|
|
|
default:
|
|
return (ENOIOCTL);
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
ttcompatgetflags(struct tty *tp)
|
|
{
|
|
tcflag_t iflag = tp->t_termios.c_iflag;
|
|
tcflag_t lflag = tp->t_termios.c_lflag;
|
|
tcflag_t oflag = tp->t_termios.c_oflag;
|
|
tcflag_t cflag = tp->t_termios.c_cflag;
|
|
int flags = 0;
|
|
|
|
if (iflag&IXOFF)
|
|
flags |= TANDEM;
|
|
if (iflag&ICRNL || oflag&ONLCR)
|
|
flags |= CRMOD;
|
|
if ((cflag&CSIZE) == CS8) {
|
|
flags |= PASS8;
|
|
if (iflag&ISTRIP)
|
|
flags |= ANYP;
|
|
}
|
|
else if (cflag&PARENB) {
|
|
if (iflag&INPCK) {
|
|
if (cflag&PARODD)
|
|
flags |= ODDP;
|
|
else
|
|
flags |= EVENP;
|
|
} else
|
|
flags |= EVENP | ODDP;
|
|
}
|
|
|
|
if ((lflag&ICANON) == 0) {
|
|
/* fudge */
|
|
if (iflag&(INPCK|ISTRIP|IXON) || lflag&(IEXTEN|ISIG)
|
|
|| (cflag&(CSIZE|PARENB)) != CS8)
|
|
flags |= CBREAK;
|
|
else
|
|
flags |= RAW;
|
|
}
|
|
if (!(flags&RAW) && !(oflag&OPOST) && (cflag&(CSIZE|PARENB)) == CS8)
|
|
flags |= LITOUT;
|
|
if (cflag&MDMBUF)
|
|
flags |= MDMBUF;
|
|
if ((cflag&HUPCL) == 0)
|
|
flags |= NOHANG;
|
|
if (oflag&TAB3)
|
|
flags |= XTABS;
|
|
if (lflag&ECHOE)
|
|
flags |= CRTERA|CRTBS;
|
|
if (lflag&ECHOKE)
|
|
flags |= CRTKIL|CRTBS;
|
|
if (lflag&ECHOPRT)
|
|
flags |= PRTERA;
|
|
if (lflag&ECHOCTL)
|
|
flags |= CTLECH;
|
|
if ((iflag&IXANY) == 0)
|
|
flags |= DECCTQ;
|
|
flags |= lflag&(ECHO|TOSTOP|FLUSHO|PENDIN|NOFLSH);
|
|
if (ttydebug)
|
|
printf("getflags: %x\n", flags);
|
|
return (flags);
|
|
}
|
|
|
|
static void
|
|
ttcompatsetflags(struct tty *tp, struct termios *t)
|
|
{
|
|
int flags = tp->t_compatflags;
|
|
tcflag_t iflag = t->c_iflag;
|
|
tcflag_t oflag = t->c_oflag;
|
|
tcflag_t lflag = t->c_lflag;
|
|
tcflag_t cflag = t->c_cflag;
|
|
|
|
if (flags & RAW) {
|
|
iflag = IGNBRK;
|
|
lflag &= ~(ECHOCTL|ISIG|ICANON|IEXTEN);
|
|
} else {
|
|
iflag &= ~(PARMRK|IGNPAR|IGNCR|INLCR);
|
|
iflag |= BRKINT|IXON|IMAXBEL;
|
|
lflag |= ISIG|IEXTEN|ECHOCTL; /* XXX was echoctl on ? */
|
|
if (flags & XTABS)
|
|
oflag |= TAB3;
|
|
else
|
|
oflag &= ~TAB3;
|
|
if (flags & CBREAK)
|
|
lflag &= ~ICANON;
|
|
else
|
|
lflag |= ICANON;
|
|
if (flags&CRMOD) {
|
|
iflag |= ICRNL;
|
|
oflag |= ONLCR;
|
|
} else {
|
|
iflag &= ~ICRNL;
|
|
oflag &= ~ONLCR;
|
|
}
|
|
}
|
|
if (flags&ECHO)
|
|
lflag |= ECHO;
|
|
else
|
|
lflag &= ~ECHO;
|
|
|
|
cflag &= ~(CSIZE|PARENB);
|
|
if (flags&(RAW|LITOUT|PASS8)) {
|
|
cflag |= CS8;
|
|
if (!(flags&(RAW|PASS8))
|
|
|| (flags&(RAW|PASS8|ANYP)) == (PASS8|ANYP))
|
|
iflag |= ISTRIP;
|
|
else
|
|
iflag &= ~ISTRIP;
|
|
if (flags&(RAW|LITOUT))
|
|
oflag &= ~OPOST;
|
|
else
|
|
oflag |= OPOST;
|
|
} else {
|
|
cflag |= CS7|PARENB;
|
|
iflag |= ISTRIP;
|
|
oflag |= OPOST;
|
|
}
|
|
/* XXX don't set INPCK if RAW or PASS8? */
|
|
if ((flags&(EVENP|ODDP)) == EVENP) {
|
|
iflag |= INPCK;
|
|
cflag &= ~PARODD;
|
|
} else if ((flags&(EVENP|ODDP)) == ODDP) {
|
|
iflag |= INPCK;
|
|
cflag |= PARODD;
|
|
} else
|
|
iflag &= ~INPCK;
|
|
if (flags&TANDEM)
|
|
iflag |= IXOFF;
|
|
else
|
|
iflag &= ~IXOFF;
|
|
if ((flags&DECCTQ) == 0)
|
|
iflag |= IXANY;
|
|
else
|
|
iflag &= ~IXANY;
|
|
t->c_iflag = iflag;
|
|
t->c_oflag = oflag;
|
|
t->c_lflag = lflag;
|
|
t->c_cflag = cflag;
|
|
}
|
|
|
|
static void
|
|
ttcompatsetlflags(struct tty *tp, struct termios *t)
|
|
{
|
|
int flags = tp->t_compatflags;
|
|
tcflag_t iflag = t->c_iflag;
|
|
tcflag_t oflag = t->c_oflag;
|
|
tcflag_t lflag = t->c_lflag;
|
|
tcflag_t cflag = t->c_cflag;
|
|
|
|
iflag &= ~(PARMRK|IGNPAR|IGNCR|INLCR);
|
|
if (flags&CRTERA)
|
|
lflag |= ECHOE;
|
|
else
|
|
lflag &= ~ECHOE;
|
|
if (flags&CRTKIL)
|
|
lflag |= ECHOKE;
|
|
else
|
|
lflag &= ~ECHOKE;
|
|
if (flags&PRTERA)
|
|
lflag |= ECHOPRT;
|
|
else
|
|
lflag &= ~ECHOPRT;
|
|
if (flags&CTLECH)
|
|
lflag |= ECHOCTL;
|
|
else
|
|
lflag &= ~ECHOCTL;
|
|
if (flags&TANDEM)
|
|
iflag |= IXOFF;
|
|
else
|
|
iflag &= ~IXOFF;
|
|
if ((flags&DECCTQ) == 0)
|
|
iflag |= IXANY;
|
|
else
|
|
iflag &= ~IXANY;
|
|
if (flags & MDMBUF)
|
|
cflag |= MDMBUF;
|
|
else
|
|
cflag &= ~MDMBUF;
|
|
if (flags&NOHANG)
|
|
cflag &= ~HUPCL;
|
|
else
|
|
cflag |= HUPCL;
|
|
lflag &= ~(TOSTOP|FLUSHO|PENDIN|NOFLSH);
|
|
lflag |= flags&(TOSTOP|FLUSHO|PENDIN|NOFLSH);
|
|
|
|
/*
|
|
* The next if-else statement is copied from above so don't bother
|
|
* checking it separately. We could avoid fiddlling with the
|
|
* character size if the mode is already RAW or if neither the
|
|
* LITOUT bit or the PASS8 bit is being changed, but the delta of
|
|
* the change is not available here and skipping the RAW case would
|
|
* make the code different from above.
|
|
*/
|
|
cflag &= ~(CSIZE|PARENB);
|
|
if (flags&(RAW|LITOUT|PASS8)) {
|
|
cflag |= CS8;
|
|
if (!(flags&(RAW|PASS8))
|
|
|| (flags&(RAW|PASS8|ANYP)) == (PASS8|ANYP))
|
|
iflag |= ISTRIP;
|
|
else
|
|
iflag &= ~ISTRIP;
|
|
if (flags&(RAW|LITOUT))
|
|
oflag &= ~OPOST;
|
|
else
|
|
oflag |= OPOST;
|
|
} else {
|
|
cflag |= CS7|PARENB;
|
|
iflag |= ISTRIP;
|
|
oflag |= OPOST;
|
|
}
|
|
t->c_iflag = iflag;
|
|
t->c_oflag = oflag;
|
|
t->c_lflag = lflag;
|
|
t->c_cflag = cflag;
|
|
}
|