1 /*- 2 * Copyright (c) 1982, 1986, 1991, 1993 3 * The Regents of the University of California. All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 4. Neither the name of the University nor the names of its contributors 14 * may be used to endorse or promote products derived from this software 15 * without specific prior written permission. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 * SUCH DAMAGE. 28 * 29 * @(#)tty_compat.c 8.1 (Berkeley) 6/10/93 30 */ 31 32 #include <sys/cdefs.h> 33 __FBSDID("$FreeBSD$"); 34 35 #include "opt_compat.h" 36 37 /* 38 * mapping routines for old line discipline (yuck) 39 */ 40 41 #include <sys/param.h> 42 #include <sys/systm.h> 43 #include <sys/ioctl_compat.h> 44 #include <sys/tty.h> 45 #include <sys/kernel.h> 46 #include <sys/sysctl.h> 47 48 struct speedtab { 49 int sp_speed; /* Speed. */ 50 int sp_code; /* Code. */ 51 }; 52 53 static int ttcompatgetflags(struct tty *tp); 54 static void ttcompatsetflags(struct tty *tp, struct termios *t); 55 static void ttcompatsetlflags(struct tty *tp, struct termios *t); 56 static int ttcompatspeedtab(int speed, struct speedtab *table); 57 58 static int ttydebug = 0; 59 SYSCTL_INT(_debug, OID_AUTO, ttydebug, CTLFLAG_RW, &ttydebug, 0, ""); 60 61 static struct speedtab compatspeeds[] = { 62 #define MAX_SPEED 17 63 { 115200, 17 }, 64 { 57600, 16 }, 65 { 38400, 15 }, 66 { 19200, 14 }, 67 { 9600, 13 }, 68 { 4800, 12 }, 69 { 2400, 11 }, 70 { 1800, 10 }, 71 { 1200, 9 }, 72 { 600, 8 }, 73 { 300, 7 }, 74 { 200, 6 }, 75 { 150, 5 }, 76 { 134, 4 }, 77 { 110, 3 }, 78 { 75, 2 }, 79 { 50, 1 }, 80 { 0, 0 }, 81 { -1, -1 }, 82 }; 83 static int compatspcodes[] = { 84 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 85 1800, 2400, 4800, 9600, 19200, 38400, 57600, 115200, 86 }; 87 88 static int 89 ttcompatspeedtab(int speed, struct speedtab *table) 90 { 91 if (speed == 0) 92 return (0); /* hangup */ 93 for ( ; table->sp_speed > 0; table++) 94 if (table->sp_speed <= speed) /* nearest one, rounded down */ 95 return (table->sp_code); 96 return (1); /* 50, min and not hangup */ 97 } 98 99 static int 100 ttsetcompat(struct tty *tp, u_long *com, caddr_t data, struct termios *term) 101 { 102 switch (*com) { 103 case TIOCSETP: 104 case TIOCSETN: { 105 struct sgttyb *sg = (struct sgttyb *)data; 106 int speed; 107 108 if ((speed = sg->sg_ispeed) > MAX_SPEED || speed < 0) 109 return(EINVAL); 110 else if (speed != ttcompatspeedtab(tp->t_termios.c_ispeed, 111 compatspeeds)) 112 term->c_ispeed = compatspcodes[speed]; 113 else 114 term->c_ispeed = tp->t_termios.c_ispeed; 115 if ((speed = sg->sg_ospeed) > MAX_SPEED || speed < 0) 116 return(EINVAL); 117 else if (speed != ttcompatspeedtab(tp->t_termios.c_ospeed, 118 compatspeeds)) 119 term->c_ospeed = compatspcodes[speed]; 120 else 121 term->c_ospeed = tp->t_termios.c_ospeed; 122 term->c_cc[VERASE] = sg->sg_erase; 123 term->c_cc[VKILL] = sg->sg_kill; 124 tp->t_compatflags = (tp->t_compatflags&0xffff0000) | 125 (sg->sg_flags&0xffff); 126 ttcompatsetflags(tp, term); 127 *com = (*com == TIOCSETP) ? TIOCSETAF : TIOCSETA; 128 break; 129 } 130 case TIOCSETC: { 131 struct tchars *tc = (struct tchars *)data; 132 cc_t *cc; 133 134 cc = term->c_cc; 135 cc[VINTR] = tc->t_intrc; 136 cc[VQUIT] = tc->t_quitc; 137 cc[VSTART] = tc->t_startc; 138 cc[VSTOP] = tc->t_stopc; 139 cc[VEOF] = tc->t_eofc; 140 cc[VEOL] = tc->t_brkc; 141 if (tc->t_brkc == (char)_POSIX_VDISABLE) 142 cc[VEOL2] = _POSIX_VDISABLE; 143 *com = TIOCSETA; 144 break; 145 } 146 case TIOCSLTC: { 147 struct ltchars *ltc = (struct ltchars *)data; 148 cc_t *cc; 149 150 cc = term->c_cc; 151 cc[VSUSP] = ltc->t_suspc; 152 cc[VDSUSP] = ltc->t_dsuspc; 153 cc[VREPRINT] = ltc->t_rprntc; 154 cc[VDISCARD] = ltc->t_flushc; 155 cc[VWERASE] = ltc->t_werasc; 156 cc[VLNEXT] = ltc->t_lnextc; 157 *com = TIOCSETA; 158 break; 159 } 160 case TIOCLBIS: 161 case TIOCLBIC: 162 case TIOCLSET: 163 if (*com == TIOCLSET) 164 tp->t_compatflags = (tp->t_compatflags&0xffff) | 165 *(int *)data<<16; 166 else { 167 tp->t_compatflags = (ttcompatgetflags(tp)&0xffff0000) | 168 (tp->t_compatflags&0xffff); 169 if (*com == TIOCLBIS) 170 tp->t_compatflags |= *(int *)data<<16; 171 else 172 tp->t_compatflags &= ~(*(int *)data<<16); 173 } 174 ttcompatsetlflags(tp, term); 175 *com = TIOCSETA; 176 break; 177 } 178 return 0; 179 } 180 181 /*ARGSUSED*/ 182 int 183 tty_ioctl_compat(struct tty *tp, u_long com, caddr_t data, struct thread *td) 184 { 185 switch (com) { 186 case TIOCSETP: 187 case TIOCSETN: 188 case TIOCSETC: 189 case TIOCSLTC: 190 case TIOCLBIS: 191 case TIOCLBIC: 192 case TIOCLSET: { 193 struct termios term; 194 int error; 195 196 term = tp->t_termios; 197 if ((error = ttsetcompat(tp, &com, data, &term)) != 0) 198 return error; 199 return tty_ioctl(tp, com, &term, td); 200 } 201 case TIOCGETP: { 202 struct sgttyb *sg = (struct sgttyb *)data; 203 cc_t *cc = tp->t_termios.c_cc; 204 205 sg->sg_ospeed = ttcompatspeedtab(tp->t_termios.c_ospeed, 206 compatspeeds); 207 if (tp->t_termios.c_ispeed == 0) 208 sg->sg_ispeed = sg->sg_ospeed; 209 else 210 sg->sg_ispeed = ttcompatspeedtab(tp->t_termios.c_ispeed, 211 compatspeeds); 212 sg->sg_erase = cc[VERASE]; 213 sg->sg_kill = cc[VKILL]; 214 sg->sg_flags = tp->t_compatflags = ttcompatgetflags(tp); 215 break; 216 } 217 case TIOCGETC: { 218 struct tchars *tc = (struct tchars *)data; 219 cc_t *cc = tp->t_termios.c_cc; 220 221 tc->t_intrc = cc[VINTR]; 222 tc->t_quitc = cc[VQUIT]; 223 tc->t_startc = cc[VSTART]; 224 tc->t_stopc = cc[VSTOP]; 225 tc->t_eofc = cc[VEOF]; 226 tc->t_brkc = cc[VEOL]; 227 break; 228 } 229 case TIOCGLTC: { 230 struct ltchars *ltc = (struct ltchars *)data; 231 cc_t *cc = tp->t_termios.c_cc; 232 233 ltc->t_suspc = cc[VSUSP]; 234 ltc->t_dsuspc = cc[VDSUSP]; 235 ltc->t_rprntc = cc[VREPRINT]; 236 ltc->t_flushc = cc[VDISCARD]; 237 ltc->t_werasc = cc[VWERASE]; 238 ltc->t_lnextc = cc[VLNEXT]; 239 break; 240 } 241 case TIOCLGET: 242 tp->t_compatflags = 243 (ttcompatgetflags(tp) & 0xffff0000UL) 244 | (tp->t_compatflags & 0xffff); 245 *(int *)data = tp->t_compatflags>>16; 246 if (ttydebug) 247 printf("CLGET: returning %x\n", *(int *)data); 248 break; 249 250 case OTIOCGETD: 251 *(int *)data = 2; 252 break; 253 254 case OTIOCSETD: { 255 int ldisczero = 0; 256 257 return (tty_ioctl(tp, TIOCSETD, 258 *(int *)data == 2 ? (caddr_t)&ldisczero : data, td)); 259 } 260 261 case OTIOCCONS: 262 *(int *)data = 1; 263 return (tty_ioctl(tp, TIOCCONS, data, td)); 264 265 default: 266 return (ENOIOCTL); 267 } 268 return (0); 269 } 270 271 static int 272 ttcompatgetflags(struct tty *tp) 273 { 274 tcflag_t iflag = tp->t_termios.c_iflag; 275 tcflag_t lflag = tp->t_termios.c_lflag; 276 tcflag_t oflag = tp->t_termios.c_oflag; 277 tcflag_t cflag = tp->t_termios.c_cflag; 278 int flags = 0; 279 280 if (iflag&IXOFF) 281 flags |= TANDEM; 282 if (iflag&ICRNL || oflag&ONLCR) 283 flags |= CRMOD; 284 if ((cflag&CSIZE) == CS8) { 285 flags |= PASS8; 286 if (iflag&ISTRIP) 287 flags |= ANYP; 288 } 289 else if (cflag&PARENB) { 290 if (iflag&INPCK) { 291 if (cflag&PARODD) 292 flags |= ODDP; 293 else 294 flags |= EVENP; 295 } else 296 flags |= EVENP | ODDP; 297 } 298 299 if ((lflag&ICANON) == 0) { 300 /* fudge */ 301 if (iflag&(INPCK|ISTRIP|IXON) || lflag&(IEXTEN|ISIG) 302 || (cflag&(CSIZE|PARENB)) != CS8) 303 flags |= CBREAK; 304 else 305 flags |= RAW; 306 } 307 if (!(flags&RAW) && !(oflag&OPOST) && (cflag&(CSIZE|PARENB)) == CS8) 308 flags |= LITOUT; 309 if (cflag&MDMBUF) 310 flags |= MDMBUF; 311 if ((cflag&HUPCL) == 0) 312 flags |= NOHANG; 313 if (oflag&TAB3) 314 flags |= XTABS; 315 if (lflag&ECHOE) 316 flags |= CRTERA|CRTBS; 317 if (lflag&ECHOKE) 318 flags |= CRTKIL|CRTBS; 319 if (lflag&ECHOPRT) 320 flags |= PRTERA; 321 if (lflag&ECHOCTL) 322 flags |= CTLECH; 323 if ((iflag&IXANY) == 0) 324 flags |= DECCTQ; 325 flags |= lflag&(ECHO|TOSTOP|FLUSHO|PENDIN|NOFLSH); 326 if (ttydebug) 327 printf("getflags: %x\n", flags); 328 return (flags); 329 } 330 331 static void 332 ttcompatsetflags(struct tty *tp, struct termios *t) 333 { 334 int flags = tp->t_compatflags; 335 tcflag_t iflag = t->c_iflag; 336 tcflag_t oflag = t->c_oflag; 337 tcflag_t lflag = t->c_lflag; 338 tcflag_t cflag = t->c_cflag; 339 340 if (flags & RAW) { 341 iflag = IGNBRK; 342 lflag &= ~(ECHOCTL|ISIG|ICANON|IEXTEN); 343 } else { 344 iflag &= ~(PARMRK|IGNPAR|IGNCR|INLCR); 345 iflag |= BRKINT|IXON|IMAXBEL; 346 lflag |= ISIG|IEXTEN|ECHOCTL; /* XXX was echoctl on ? */ 347 if (flags & XTABS) 348 oflag |= TAB3; 349 else 350 oflag &= ~TAB3; 351 if (flags & CBREAK) 352 lflag &= ~ICANON; 353 else 354 lflag |= ICANON; 355 if (flags&CRMOD) { 356 iflag |= ICRNL; 357 oflag |= ONLCR; 358 } else { 359 iflag &= ~ICRNL; 360 oflag &= ~ONLCR; 361 } 362 } 363 if (flags&ECHO) 364 lflag |= ECHO; 365 else 366 lflag &= ~ECHO; 367 368 cflag &= ~(CSIZE|PARENB); 369 if (flags&(RAW|LITOUT|PASS8)) { 370 cflag |= CS8; 371 if (!(flags&(RAW|PASS8)) 372 || (flags&(RAW|PASS8|ANYP)) == (PASS8|ANYP)) 373 iflag |= ISTRIP; 374 else 375 iflag &= ~ISTRIP; 376 if (flags&(RAW|LITOUT)) 377 oflag &= ~OPOST; 378 else 379 oflag |= OPOST; 380 } else { 381 cflag |= CS7|PARENB; 382 iflag |= ISTRIP; 383 oflag |= OPOST; 384 } 385 /* XXX don't set INPCK if RAW or PASS8? */ 386 if ((flags&(EVENP|ODDP)) == EVENP) { 387 iflag |= INPCK; 388 cflag &= ~PARODD; 389 } else if ((flags&(EVENP|ODDP)) == ODDP) { 390 iflag |= INPCK; 391 cflag |= PARODD; 392 } else 393 iflag &= ~INPCK; 394 if (flags&TANDEM) 395 iflag |= IXOFF; 396 else 397 iflag &= ~IXOFF; 398 if ((flags&DECCTQ) == 0) 399 iflag |= IXANY; 400 else 401 iflag &= ~IXANY; 402 t->c_iflag = iflag; 403 t->c_oflag = oflag; 404 t->c_lflag = lflag; 405 t->c_cflag = cflag; 406 } 407 408 static void 409 ttcompatsetlflags(struct tty *tp, struct termios *t) 410 { 411 int flags = tp->t_compatflags; 412 tcflag_t iflag = t->c_iflag; 413 tcflag_t oflag = t->c_oflag; 414 tcflag_t lflag = t->c_lflag; 415 tcflag_t cflag = t->c_cflag; 416 417 iflag &= ~(PARMRK|IGNPAR|IGNCR|INLCR); 418 if (flags&CRTERA) 419 lflag |= ECHOE; 420 else 421 lflag &= ~ECHOE; 422 if (flags&CRTKIL) 423 lflag |= ECHOKE; 424 else 425 lflag &= ~ECHOKE; 426 if (flags&PRTERA) 427 lflag |= ECHOPRT; 428 else 429 lflag &= ~ECHOPRT; 430 if (flags&CTLECH) 431 lflag |= ECHOCTL; 432 else 433 lflag &= ~ECHOCTL; 434 if (flags&TANDEM) 435 iflag |= IXOFF; 436 else 437 iflag &= ~IXOFF; 438 if ((flags&DECCTQ) == 0) 439 iflag |= IXANY; 440 else 441 iflag &= ~IXANY; 442 if (flags & MDMBUF) 443 cflag |= MDMBUF; 444 else 445 cflag &= ~MDMBUF; 446 if (flags&NOHANG) 447 cflag &= ~HUPCL; 448 else 449 cflag |= HUPCL; 450 lflag &= ~(TOSTOP|FLUSHO|PENDIN|NOFLSH); 451 lflag |= flags&(TOSTOP|FLUSHO|PENDIN|NOFLSH); 452 453 /* 454 * The next if-else statement is copied from above so don't bother 455 * checking it separately. We could avoid fiddlling with the 456 * character size if the mode is already RAW or if neither the 457 * LITOUT bit or the PASS8 bit is being changed, but the delta of 458 * the change is not available here and skipping the RAW case would 459 * make the code different from above. 460 */ 461 cflag &= ~(CSIZE|PARENB); 462 if (flags&(RAW|LITOUT|PASS8)) { 463 cflag |= CS8; 464 if (!(flags&(RAW|PASS8)) 465 || (flags&(RAW|PASS8|ANYP)) == (PASS8|ANYP)) 466 iflag |= ISTRIP; 467 else 468 iflag &= ~ISTRIP; 469 if (flags&(RAW|LITOUT)) 470 oflag &= ~OPOST; 471 else 472 oflag |= OPOST; 473 } else { 474 cflag |= CS7|PARENB; 475 iflag |= ISTRIP; 476 oflag |= OPOST; 477 } 478 t->c_iflag = iflag; 479 t->c_oflag = oflag; 480 t->c_lflag = lflag; 481 t->c_cflag = cflag; 482 } 483