| Current Path : /sys/amd64/compile/hs32/modules/usr/src/sys/modules/usb/uipaq/@/kern/ |
FreeBSD hs32.drive.ne.jp 9.1-RELEASE FreeBSD 9.1-RELEASE #1: Wed Jan 14 12:18:08 JST 2015 root@hs32.drive.ne.jp:/sys/amd64/compile/hs32 amd64 |
| Current File : //sys/amd64/compile/hs32/modules/usr/src/sys/modules/usb/uipaq/@/kern/tty_compat.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: release/9.1.0/sys/kern/tty_compat.c 201532 2010-01-04 20:59:52Z ed $");
#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, int fflag,
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, fflag, 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,
fflag, td));
}
case OTIOCCONS:
*(int *)data = 1;
return (tty_ioctl(tp, TIOCCONS, data, fflag, 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;
}