1 /* 2 * Copyright (C) 1991, 1992, 1993, 1994 Linus Torvalds 3 * 4 * Modified by Fred N. van Kempen, 01/29/93, to add line disciplines 5 * which can be dynamically activated and de-activated by the line 6 * discipline handling modules (like SLIP). 7 */ 8 9 #include <linux/types.h> 10 #include <linux/termios.h> 11 #include <linux/errno.h> 12 #include <linux/sched.h> 13 #include <linux/kernel.h> 14 #include <linux/major.h> 15 #include <linux/tty.h> 16 #include <linux/fcntl.h> 17 #include <linux/string.h> 18 #include <linux/mm.h> 19 #include <linux/module.h> 20 #include <linux/bitops.h> 21 #include <linux/mutex.h> 22 #include <linux/compat.h> 23 24 #include <asm/io.h> 25 #include <asm/uaccess.h> 26 27 #undef TTY_DEBUG_WAIT_UNTIL_SENT 28 29 #ifdef TTY_DEBUG_WAIT_UNTIL_SENT 30 # define tty_debug_wait_until_sent(tty, f, args...) tty_debug(tty, f, ##args) 31 #else 32 # define tty_debug_wait_until_sent(tty, f, args...) do {} while (0) 33 #endif 34 35 #undef DEBUG 36 37 /* 38 * Internal flag options for termios setting behavior 39 */ 40 #define TERMIOS_FLUSH 1 41 #define TERMIOS_WAIT 2 42 #define TERMIOS_TERMIO 4 43 #define TERMIOS_OLD 8 44 45 46 /** 47 * tty_chars_in_buffer - characters pending 48 * @tty: terminal 49 * 50 * Return the number of bytes of data in the device private 51 * output queue. If no private method is supplied there is assumed 52 * to be no queue on the device. 53 */ 54 55 int tty_chars_in_buffer(struct tty_struct *tty) 56 { 57 if (tty->ops->chars_in_buffer) 58 return tty->ops->chars_in_buffer(tty); 59 else 60 return 0; 61 } 62 EXPORT_SYMBOL(tty_chars_in_buffer); 63 64 /** 65 * tty_write_room - write queue space 66 * @tty: terminal 67 * 68 * Return the number of bytes that can be queued to this device 69 * at the present time. The result should be treated as a guarantee 70 * and the driver cannot offer a value it later shrinks by more than 71 * the number of bytes written. If no method is provided 2K is always 72 * returned and data may be lost as there will be no flow control. 73 */ 74 75 int tty_write_room(struct tty_struct *tty) 76 { 77 if (tty->ops->write_room) 78 return tty->ops->write_room(tty); 79 return 2048; 80 } 81 EXPORT_SYMBOL(tty_write_room); 82 83 /** 84 * tty_driver_flush_buffer - discard internal buffer 85 * @tty: terminal 86 * 87 * Discard the internal output buffer for this device. If no method 88 * is provided then either the buffer cannot be hardware flushed or 89 * there is no buffer driver side. 90 */ 91 void tty_driver_flush_buffer(struct tty_struct *tty) 92 { 93 if (tty->ops->flush_buffer) 94 tty->ops->flush_buffer(tty); 95 } 96 EXPORT_SYMBOL(tty_driver_flush_buffer); 97 98 /** 99 * tty_throttle - flow control 100 * @tty: terminal 101 * 102 * Indicate that a tty should stop transmitting data down the stack. 103 * Takes the termios rwsem to protect against parallel throttle/unthrottle 104 * and also to ensure the driver can consistently reference its own 105 * termios data at this point when implementing software flow control. 106 */ 107 108 void tty_throttle(struct tty_struct *tty) 109 { 110 down_write(&tty->termios_rwsem); 111 /* check TTY_THROTTLED first so it indicates our state */ 112 if (!test_and_set_bit(TTY_THROTTLED, &tty->flags) && 113 tty->ops->throttle) 114 tty->ops->throttle(tty); 115 tty->flow_change = 0; 116 up_write(&tty->termios_rwsem); 117 } 118 EXPORT_SYMBOL(tty_throttle); 119 120 /** 121 * tty_unthrottle - flow control 122 * @tty: terminal 123 * 124 * Indicate that a tty may continue transmitting data down the stack. 125 * Takes the termios rwsem to protect against parallel throttle/unthrottle 126 * and also to ensure the driver can consistently reference its own 127 * termios data at this point when implementing software flow control. 128 * 129 * Drivers should however remember that the stack can issue a throttle, 130 * then change flow control method, then unthrottle. 131 */ 132 133 void tty_unthrottle(struct tty_struct *tty) 134 { 135 down_write(&tty->termios_rwsem); 136 if (test_and_clear_bit(TTY_THROTTLED, &tty->flags) && 137 tty->ops->unthrottle) 138 tty->ops->unthrottle(tty); 139 tty->flow_change = 0; 140 up_write(&tty->termios_rwsem); 141 } 142 EXPORT_SYMBOL(tty_unthrottle); 143 144 /** 145 * tty_throttle_safe - flow control 146 * @tty: terminal 147 * 148 * Similar to tty_throttle() but will only attempt throttle 149 * if tty->flow_change is TTY_THROTTLE_SAFE. Prevents an accidental 150 * throttle due to race conditions when throttling is conditional 151 * on factors evaluated prior to throttling. 152 * 153 * Returns 0 if tty is throttled (or was already throttled) 154 */ 155 156 int tty_throttle_safe(struct tty_struct *tty) 157 { 158 int ret = 0; 159 160 mutex_lock(&tty->throttle_mutex); 161 if (!tty_throttled(tty)) { 162 if (tty->flow_change != TTY_THROTTLE_SAFE) 163 ret = 1; 164 else { 165 set_bit(TTY_THROTTLED, &tty->flags); 166 if (tty->ops->throttle) 167 tty->ops->throttle(tty); 168 } 169 } 170 mutex_unlock(&tty->throttle_mutex); 171 172 return ret; 173 } 174 175 /** 176 * tty_unthrottle_safe - flow control 177 * @tty: terminal 178 * 179 * Similar to tty_unthrottle() but will only attempt unthrottle 180 * if tty->flow_change is TTY_UNTHROTTLE_SAFE. Prevents an accidental 181 * unthrottle due to race conditions when unthrottling is conditional 182 * on factors evaluated prior to unthrottling. 183 * 184 * Returns 0 if tty is unthrottled (or was already unthrottled) 185 */ 186 187 int tty_unthrottle_safe(struct tty_struct *tty) 188 { 189 int ret = 0; 190 191 mutex_lock(&tty->throttle_mutex); 192 if (tty_throttled(tty)) { 193 if (tty->flow_change != TTY_UNTHROTTLE_SAFE) 194 ret = 1; 195 else { 196 clear_bit(TTY_THROTTLED, &tty->flags); 197 if (tty->ops->unthrottle) 198 tty->ops->unthrottle(tty); 199 } 200 } 201 mutex_unlock(&tty->throttle_mutex); 202 203 return ret; 204 } 205 206 /** 207 * tty_wait_until_sent - wait for I/O to finish 208 * @tty: tty we are waiting for 209 * @timeout: how long we will wait 210 * 211 * Wait for characters pending in a tty driver to hit the wire, or 212 * for a timeout to occur (eg due to flow control) 213 * 214 * Locking: none 215 */ 216 217 void tty_wait_until_sent(struct tty_struct *tty, long timeout) 218 { 219 tty_debug_wait_until_sent(tty, "wait until sent, timeout=%ld\n", timeout); 220 221 if (!timeout) 222 timeout = MAX_SCHEDULE_TIMEOUT; 223 224 timeout = wait_event_interruptible_timeout(tty->write_wait, 225 !tty_chars_in_buffer(tty), timeout); 226 if (timeout <= 0) 227 return; 228 229 if (timeout == MAX_SCHEDULE_TIMEOUT) 230 timeout = 0; 231 232 if (tty->ops->wait_until_sent) 233 tty->ops->wait_until_sent(tty, timeout); 234 } 235 EXPORT_SYMBOL(tty_wait_until_sent); 236 237 238 /* 239 * Termios Helper Methods 240 */ 241 242 static void unset_locked_termios(struct tty_struct *tty, struct ktermios *old) 243 { 244 struct ktermios *termios = &tty->termios; 245 struct ktermios *locked = &tty->termios_locked; 246 int i; 247 248 #define NOSET_MASK(x, y, z) (x = ((x) & ~(z)) | ((y) & (z))) 249 250 NOSET_MASK(termios->c_iflag, old->c_iflag, locked->c_iflag); 251 NOSET_MASK(termios->c_oflag, old->c_oflag, locked->c_oflag); 252 NOSET_MASK(termios->c_cflag, old->c_cflag, locked->c_cflag); 253 NOSET_MASK(termios->c_lflag, old->c_lflag, locked->c_lflag); 254 termios->c_line = locked->c_line ? old->c_line : termios->c_line; 255 for (i = 0; i < NCCS; i++) 256 termios->c_cc[i] = locked->c_cc[i] ? 257 old->c_cc[i] : termios->c_cc[i]; 258 /* FIXME: What should we do for i/ospeed */ 259 } 260 261 /* 262 * Routine which returns the baud rate of the tty 263 * 264 * Note that the baud_table needs to be kept in sync with the 265 * include/asm/termbits.h file. 266 */ 267 static const speed_t baud_table[] = { 268 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800, 269 9600, 19200, 38400, 57600, 115200, 230400, 460800, 270 #ifdef __sparc__ 271 76800, 153600, 307200, 614400, 921600 272 #else 273 500000, 576000, 921600, 1000000, 1152000, 1500000, 2000000, 274 2500000, 3000000, 3500000, 4000000 275 #endif 276 }; 277 278 #ifndef __sparc__ 279 static const tcflag_t baud_bits[] = { 280 B0, B50, B75, B110, B134, B150, B200, B300, B600, 281 B1200, B1800, B2400, B4800, B9600, B19200, B38400, 282 B57600, B115200, B230400, B460800, B500000, B576000, 283 B921600, B1000000, B1152000, B1500000, B2000000, B2500000, 284 B3000000, B3500000, B4000000 285 }; 286 #else 287 static const tcflag_t baud_bits[] = { 288 B0, B50, B75, B110, B134, B150, B200, B300, B600, 289 B1200, B1800, B2400, B4800, B9600, B19200, B38400, 290 B57600, B115200, B230400, B460800, B76800, B153600, 291 B307200, B614400, B921600 292 }; 293 #endif 294 295 static int n_baud_table = ARRAY_SIZE(baud_table); 296 297 /** 298 * tty_termios_baud_rate 299 * @termios: termios structure 300 * 301 * Convert termios baud rate data into a speed. This should be called 302 * with the termios lock held if this termios is a terminal termios 303 * structure. May change the termios data. Device drivers can call this 304 * function but should use ->c_[io]speed directly as they are updated. 305 * 306 * Locking: none 307 */ 308 309 speed_t tty_termios_baud_rate(struct ktermios *termios) 310 { 311 unsigned int cbaud; 312 313 cbaud = termios->c_cflag & CBAUD; 314 315 #ifdef BOTHER 316 /* Magic token for arbitrary speed via c_ispeed/c_ospeed */ 317 if (cbaud == BOTHER) 318 return termios->c_ospeed; 319 #endif 320 if (cbaud & CBAUDEX) { 321 cbaud &= ~CBAUDEX; 322 323 if (cbaud < 1 || cbaud + 15 > n_baud_table) 324 termios->c_cflag &= ~CBAUDEX; 325 else 326 cbaud += 15; 327 } 328 return baud_table[cbaud]; 329 } 330 EXPORT_SYMBOL(tty_termios_baud_rate); 331 332 /** 333 * tty_termios_input_baud_rate 334 * @termios: termios structure 335 * 336 * Convert termios baud rate data into a speed. This should be called 337 * with the termios lock held if this termios is a terminal termios 338 * structure. May change the termios data. Device drivers can call this 339 * function but should use ->c_[io]speed directly as they are updated. 340 * 341 * Locking: none 342 */ 343 344 speed_t tty_termios_input_baud_rate(struct ktermios *termios) 345 { 346 #ifdef IBSHIFT 347 unsigned int cbaud = (termios->c_cflag >> IBSHIFT) & CBAUD; 348 349 if (cbaud == B0) 350 return tty_termios_baud_rate(termios); 351 352 /* Magic token for arbitrary speed via c_ispeed*/ 353 if (cbaud == BOTHER) 354 return termios->c_ispeed; 355 356 if (cbaud & CBAUDEX) { 357 cbaud &= ~CBAUDEX; 358 359 if (cbaud < 1 || cbaud + 15 > n_baud_table) 360 termios->c_cflag &= ~(CBAUDEX << IBSHIFT); 361 else 362 cbaud += 15; 363 } 364 return baud_table[cbaud]; 365 #else 366 return tty_termios_baud_rate(termios); 367 #endif 368 } 369 EXPORT_SYMBOL(tty_termios_input_baud_rate); 370 371 /** 372 * tty_termios_encode_baud_rate 373 * @termios: ktermios structure holding user requested state 374 * @ispeed: input speed 375 * @ospeed: output speed 376 * 377 * Encode the speeds set into the passed termios structure. This is 378 * used as a library helper for drivers so that they can report back 379 * the actual speed selected when it differs from the speed requested 380 * 381 * For maximal back compatibility with legacy SYS5/POSIX *nix behaviour 382 * we need to carefully set the bits when the user does not get the 383 * desired speed. We allow small margins and preserve as much of possible 384 * of the input intent to keep compatibility. 385 * 386 * Locking: Caller should hold termios lock. This is already held 387 * when calling this function from the driver termios handler. 388 * 389 * The ifdefs deal with platforms whose owners have yet to update them 390 * and will all go away once this is done. 391 */ 392 393 void tty_termios_encode_baud_rate(struct ktermios *termios, 394 speed_t ibaud, speed_t obaud) 395 { 396 int i = 0; 397 int ifound = -1, ofound = -1; 398 int iclose = ibaud/50, oclose = obaud/50; 399 int ibinput = 0; 400 401 if (obaud == 0) /* CD dropped */ 402 ibaud = 0; /* Clear ibaud to be sure */ 403 404 termios->c_ispeed = ibaud; 405 termios->c_ospeed = obaud; 406 407 #ifdef BOTHER 408 /* If the user asked for a precise weird speed give a precise weird 409 answer. If they asked for a Bfoo speed they may have problems 410 digesting non-exact replies so fuzz a bit */ 411 412 if ((termios->c_cflag & CBAUD) == BOTHER) 413 oclose = 0; 414 if (((termios->c_cflag >> IBSHIFT) & CBAUD) == BOTHER) 415 iclose = 0; 416 if ((termios->c_cflag >> IBSHIFT) & CBAUD) 417 ibinput = 1; /* An input speed was specified */ 418 #endif 419 termios->c_cflag &= ~CBAUD; 420 421 /* 422 * Our goal is to find a close match to the standard baud rate 423 * returned. Walk the baud rate table and if we get a very close 424 * match then report back the speed as a POSIX Bxxxx value by 425 * preference 426 */ 427 428 do { 429 if (obaud - oclose <= baud_table[i] && 430 obaud + oclose >= baud_table[i]) { 431 termios->c_cflag |= baud_bits[i]; 432 ofound = i; 433 } 434 if (ibaud - iclose <= baud_table[i] && 435 ibaud + iclose >= baud_table[i]) { 436 /* For the case input == output don't set IBAUD bits 437 if the user didn't do so */ 438 if (ofound == i && !ibinput) 439 ifound = i; 440 #ifdef IBSHIFT 441 else { 442 ifound = i; 443 termios->c_cflag |= (baud_bits[i] << IBSHIFT); 444 } 445 #endif 446 } 447 } while (++i < n_baud_table); 448 449 /* 450 * If we found no match then use BOTHER if provided or warn 451 * the user their platform maintainer needs to wake up if not. 452 */ 453 #ifdef BOTHER 454 if (ofound == -1) 455 termios->c_cflag |= BOTHER; 456 /* Set exact input bits only if the input and output differ or the 457 user already did */ 458 if (ifound == -1 && (ibaud != obaud || ibinput)) 459 termios->c_cflag |= (BOTHER << IBSHIFT); 460 #else 461 if (ifound == -1 || ofound == -1) 462 pr_warn_once("tty: Unable to return correct speed data as your architecture needs updating.\n"); 463 #endif 464 } 465 EXPORT_SYMBOL_GPL(tty_termios_encode_baud_rate); 466 467 /** 468 * tty_encode_baud_rate - set baud rate of the tty 469 * @ibaud: input baud rate 470 * @obad: output baud rate 471 * 472 * Update the current termios data for the tty with the new speed 473 * settings. The caller must hold the termios_rwsem for the tty in 474 * question. 475 */ 476 477 void tty_encode_baud_rate(struct tty_struct *tty, speed_t ibaud, speed_t obaud) 478 { 479 tty_termios_encode_baud_rate(&tty->termios, ibaud, obaud); 480 } 481 EXPORT_SYMBOL_GPL(tty_encode_baud_rate); 482 483 /** 484 * tty_termios_copy_hw - copy hardware settings 485 * @new: New termios 486 * @old: Old termios 487 * 488 * Propagate the hardware specific terminal setting bits from 489 * the old termios structure to the new one. This is used in cases 490 * where the hardware does not support reconfiguration or as a helper 491 * in some cases where only minimal reconfiguration is supported 492 */ 493 494 void tty_termios_copy_hw(struct ktermios *new, struct ktermios *old) 495 { 496 /* The bits a dumb device handles in software. Smart devices need 497 to always provide a set_termios method */ 498 new->c_cflag &= HUPCL | CREAD | CLOCAL; 499 new->c_cflag |= old->c_cflag & ~(HUPCL | CREAD | CLOCAL); 500 new->c_ispeed = old->c_ispeed; 501 new->c_ospeed = old->c_ospeed; 502 } 503 EXPORT_SYMBOL(tty_termios_copy_hw); 504 505 /** 506 * tty_termios_hw_change - check for setting change 507 * @a: termios 508 * @b: termios to compare 509 * 510 * Check if any of the bits that affect a dumb device have changed 511 * between the two termios structures, or a speed change is needed. 512 */ 513 514 int tty_termios_hw_change(struct ktermios *a, struct ktermios *b) 515 { 516 if (a->c_ispeed != b->c_ispeed || a->c_ospeed != b->c_ospeed) 517 return 1; 518 if ((a->c_cflag ^ b->c_cflag) & ~(HUPCL | CREAD | CLOCAL)) 519 return 1; 520 return 0; 521 } 522 EXPORT_SYMBOL(tty_termios_hw_change); 523 524 /** 525 * tty_set_termios - update termios values 526 * @tty: tty to update 527 * @new_termios: desired new value 528 * 529 * Perform updates to the termios values set on this terminal. 530 * A master pty's termios should never be set. 531 * 532 * Locking: termios_rwsem 533 */ 534 535 int tty_set_termios(struct tty_struct *tty, struct ktermios *new_termios) 536 { 537 struct ktermios old_termios; 538 struct tty_ldisc *ld; 539 540 WARN_ON(tty->driver->type == TTY_DRIVER_TYPE_PTY && 541 tty->driver->subtype == PTY_TYPE_MASTER); 542 /* 543 * Perform the actual termios internal changes under lock. 544 */ 545 546 547 /* FIXME: we need to decide on some locking/ordering semantics 548 for the set_termios notification eventually */ 549 down_write(&tty->termios_rwsem); 550 old_termios = tty->termios; 551 tty->termios = *new_termios; 552 unset_locked_termios(tty, &old_termios); 553 554 if (tty->ops->set_termios) 555 tty->ops->set_termios(tty, &old_termios); 556 else 557 tty_termios_copy_hw(&tty->termios, &old_termios); 558 559 ld = tty_ldisc_ref(tty); 560 if (ld != NULL) { 561 if (ld->ops->set_termios) 562 ld->ops->set_termios(tty, &old_termios); 563 tty_ldisc_deref(ld); 564 } 565 up_write(&tty->termios_rwsem); 566 return 0; 567 } 568 EXPORT_SYMBOL_GPL(tty_set_termios); 569 570 /** 571 * set_termios - set termios values for a tty 572 * @tty: terminal device 573 * @arg: user data 574 * @opt: option information 575 * 576 * Helper function to prepare termios data and run necessary other 577 * functions before using tty_set_termios to do the actual changes. 578 * 579 * Locking: 580 * Called functions take ldisc and termios_rwsem locks 581 */ 582 583 static int set_termios(struct tty_struct *tty, void __user *arg, int opt) 584 { 585 struct ktermios tmp_termios; 586 struct tty_ldisc *ld; 587 int retval = tty_check_change(tty); 588 589 if (retval) 590 return retval; 591 592 down_read(&tty->termios_rwsem); 593 tmp_termios = tty->termios; 594 up_read(&tty->termios_rwsem); 595 596 if (opt & TERMIOS_TERMIO) { 597 if (user_termio_to_kernel_termios(&tmp_termios, 598 (struct termio __user *)arg)) 599 return -EFAULT; 600 #ifdef TCGETS2 601 } else if (opt & TERMIOS_OLD) { 602 if (user_termios_to_kernel_termios_1(&tmp_termios, 603 (struct termios __user *)arg)) 604 return -EFAULT; 605 } else { 606 if (user_termios_to_kernel_termios(&tmp_termios, 607 (struct termios2 __user *)arg)) 608 return -EFAULT; 609 } 610 #else 611 } else if (user_termios_to_kernel_termios(&tmp_termios, 612 (struct termios __user *)arg)) 613 return -EFAULT; 614 #endif 615 616 /* If old style Bfoo values are used then load c_ispeed/c_ospeed 617 * with the real speed so its unconditionally usable */ 618 tmp_termios.c_ispeed = tty_termios_input_baud_rate(&tmp_termios); 619 tmp_termios.c_ospeed = tty_termios_baud_rate(&tmp_termios); 620 621 ld = tty_ldisc_ref(tty); 622 623 if (ld != NULL) { 624 if ((opt & TERMIOS_FLUSH) && ld->ops->flush_buffer) 625 ld->ops->flush_buffer(tty); 626 tty_ldisc_deref(ld); 627 } 628 629 if (opt & TERMIOS_WAIT) { 630 tty_wait_until_sent(tty, 0); 631 if (signal_pending(current)) 632 return -ERESTARTSYS; 633 } 634 635 tty_set_termios(tty, &tmp_termios); 636 637 /* FIXME: Arguably if tmp_termios == tty->termios AND the 638 actual requested termios was not tmp_termios then we may 639 want to return an error as no user requested change has 640 succeeded */ 641 return 0; 642 } 643 644 static void copy_termios(struct tty_struct *tty, struct ktermios *kterm) 645 { 646 down_read(&tty->termios_rwsem); 647 *kterm = tty->termios; 648 up_read(&tty->termios_rwsem); 649 } 650 651 static void copy_termios_locked(struct tty_struct *tty, struct ktermios *kterm) 652 { 653 down_read(&tty->termios_rwsem); 654 *kterm = tty->termios_locked; 655 up_read(&tty->termios_rwsem); 656 } 657 658 static int get_termio(struct tty_struct *tty, struct termio __user *termio) 659 { 660 struct ktermios kterm; 661 copy_termios(tty, &kterm); 662 if (kernel_termios_to_user_termio(termio, &kterm)) 663 return -EFAULT; 664 return 0; 665 } 666 667 668 #ifdef TCGETX 669 670 /** 671 * set_termiox - set termiox fields if possible 672 * @tty: terminal 673 * @arg: termiox structure from user 674 * @opt: option flags for ioctl type 675 * 676 * Implement the device calling points for the SYS5 termiox ioctl 677 * interface in Linux 678 */ 679 680 static int set_termiox(struct tty_struct *tty, void __user *arg, int opt) 681 { 682 struct termiox tnew; 683 struct tty_ldisc *ld; 684 685 if (tty->termiox == NULL) 686 return -EINVAL; 687 if (copy_from_user(&tnew, arg, sizeof(struct termiox))) 688 return -EFAULT; 689 690 ld = tty_ldisc_ref(tty); 691 if (ld != NULL) { 692 if ((opt & TERMIOS_FLUSH) && ld->ops->flush_buffer) 693 ld->ops->flush_buffer(tty); 694 tty_ldisc_deref(ld); 695 } 696 if (opt & TERMIOS_WAIT) { 697 tty_wait_until_sent(tty, 0); 698 if (signal_pending(current)) 699 return -ERESTARTSYS; 700 } 701 702 down_write(&tty->termios_rwsem); 703 if (tty->ops->set_termiox) 704 tty->ops->set_termiox(tty, &tnew); 705 up_write(&tty->termios_rwsem); 706 return 0; 707 } 708 709 #endif 710 711 712 #ifdef TIOCGETP 713 /* 714 * These are deprecated, but there is limited support.. 715 * 716 * The "sg_flags" translation is a joke.. 717 */ 718 static int get_sgflags(struct tty_struct *tty) 719 { 720 int flags = 0; 721 722 if (!L_ICANON(tty)) { 723 if (L_ISIG(tty)) 724 flags |= 0x02; /* cbreak */ 725 else 726 flags |= 0x20; /* raw */ 727 } 728 if (L_ECHO(tty)) 729 flags |= 0x08; /* echo */ 730 if (O_OPOST(tty)) 731 if (O_ONLCR(tty)) 732 flags |= 0x10; /* crmod */ 733 return flags; 734 } 735 736 static int get_sgttyb(struct tty_struct *tty, struct sgttyb __user *sgttyb) 737 { 738 struct sgttyb tmp; 739 740 down_read(&tty->termios_rwsem); 741 tmp.sg_ispeed = tty->termios.c_ispeed; 742 tmp.sg_ospeed = tty->termios.c_ospeed; 743 tmp.sg_erase = tty->termios.c_cc[VERASE]; 744 tmp.sg_kill = tty->termios.c_cc[VKILL]; 745 tmp.sg_flags = get_sgflags(tty); 746 up_read(&tty->termios_rwsem); 747 748 return copy_to_user(sgttyb, &tmp, sizeof(tmp)) ? -EFAULT : 0; 749 } 750 751 static void set_sgflags(struct ktermios *termios, int flags) 752 { 753 termios->c_iflag = ICRNL | IXON; 754 termios->c_oflag = 0; 755 termios->c_lflag = ISIG | ICANON; 756 if (flags & 0x02) { /* cbreak */ 757 termios->c_iflag = 0; 758 termios->c_lflag &= ~ICANON; 759 } 760 if (flags & 0x08) { /* echo */ 761 termios->c_lflag |= ECHO | ECHOE | ECHOK | 762 ECHOCTL | ECHOKE | IEXTEN; 763 } 764 if (flags & 0x10) { /* crmod */ 765 termios->c_oflag |= OPOST | ONLCR; 766 } 767 if (flags & 0x20) { /* raw */ 768 termios->c_iflag = 0; 769 termios->c_lflag &= ~(ISIG | ICANON); 770 } 771 if (!(termios->c_lflag & ICANON)) { 772 termios->c_cc[VMIN] = 1; 773 termios->c_cc[VTIME] = 0; 774 } 775 } 776 777 /** 778 * set_sgttyb - set legacy terminal values 779 * @tty: tty structure 780 * @sgttyb: pointer to old style terminal structure 781 * 782 * Updates a terminal from the legacy BSD style terminal information 783 * structure. 784 * 785 * Locking: termios_rwsem 786 */ 787 788 static int set_sgttyb(struct tty_struct *tty, struct sgttyb __user *sgttyb) 789 { 790 int retval; 791 struct sgttyb tmp; 792 struct ktermios termios; 793 794 retval = tty_check_change(tty); 795 if (retval) 796 return retval; 797 798 if (copy_from_user(&tmp, sgttyb, sizeof(tmp))) 799 return -EFAULT; 800 801 down_write(&tty->termios_rwsem); 802 termios = tty->termios; 803 termios.c_cc[VERASE] = tmp.sg_erase; 804 termios.c_cc[VKILL] = tmp.sg_kill; 805 set_sgflags(&termios, tmp.sg_flags); 806 /* Try and encode into Bfoo format */ 807 #ifdef BOTHER 808 tty_termios_encode_baud_rate(&termios, termios.c_ispeed, 809 termios.c_ospeed); 810 #endif 811 up_write(&tty->termios_rwsem); 812 tty_set_termios(tty, &termios); 813 return 0; 814 } 815 #endif 816 817 #ifdef TIOCGETC 818 static int get_tchars(struct tty_struct *tty, struct tchars __user *tchars) 819 { 820 struct tchars tmp; 821 822 down_read(&tty->termios_rwsem); 823 tmp.t_intrc = tty->termios.c_cc[VINTR]; 824 tmp.t_quitc = tty->termios.c_cc[VQUIT]; 825 tmp.t_startc = tty->termios.c_cc[VSTART]; 826 tmp.t_stopc = tty->termios.c_cc[VSTOP]; 827 tmp.t_eofc = tty->termios.c_cc[VEOF]; 828 tmp.t_brkc = tty->termios.c_cc[VEOL2]; /* what is brkc anyway? */ 829 up_read(&tty->termios_rwsem); 830 return copy_to_user(tchars, &tmp, sizeof(tmp)) ? -EFAULT : 0; 831 } 832 833 static int set_tchars(struct tty_struct *tty, struct tchars __user *tchars) 834 { 835 struct tchars tmp; 836 837 if (copy_from_user(&tmp, tchars, sizeof(tmp))) 838 return -EFAULT; 839 down_write(&tty->termios_rwsem); 840 tty->termios.c_cc[VINTR] = tmp.t_intrc; 841 tty->termios.c_cc[VQUIT] = tmp.t_quitc; 842 tty->termios.c_cc[VSTART] = tmp.t_startc; 843 tty->termios.c_cc[VSTOP] = tmp.t_stopc; 844 tty->termios.c_cc[VEOF] = tmp.t_eofc; 845 tty->termios.c_cc[VEOL2] = tmp.t_brkc; /* what is brkc anyway? */ 846 up_write(&tty->termios_rwsem); 847 return 0; 848 } 849 #endif 850 851 #ifdef TIOCGLTC 852 static int get_ltchars(struct tty_struct *tty, struct ltchars __user *ltchars) 853 { 854 struct ltchars tmp; 855 856 down_read(&tty->termios_rwsem); 857 tmp.t_suspc = tty->termios.c_cc[VSUSP]; 858 /* what is dsuspc anyway? */ 859 tmp.t_dsuspc = tty->termios.c_cc[VSUSP]; 860 tmp.t_rprntc = tty->termios.c_cc[VREPRINT]; 861 /* what is flushc anyway? */ 862 tmp.t_flushc = tty->termios.c_cc[VEOL2]; 863 tmp.t_werasc = tty->termios.c_cc[VWERASE]; 864 tmp.t_lnextc = tty->termios.c_cc[VLNEXT]; 865 up_read(&tty->termios_rwsem); 866 return copy_to_user(ltchars, &tmp, sizeof(tmp)) ? -EFAULT : 0; 867 } 868 869 static int set_ltchars(struct tty_struct *tty, struct ltchars __user *ltchars) 870 { 871 struct ltchars tmp; 872 873 if (copy_from_user(&tmp, ltchars, sizeof(tmp))) 874 return -EFAULT; 875 876 down_write(&tty->termios_rwsem); 877 tty->termios.c_cc[VSUSP] = tmp.t_suspc; 878 /* what is dsuspc anyway? */ 879 tty->termios.c_cc[VEOL2] = tmp.t_dsuspc; 880 tty->termios.c_cc[VREPRINT] = tmp.t_rprntc; 881 /* what is flushc anyway? */ 882 tty->termios.c_cc[VEOL2] = tmp.t_flushc; 883 tty->termios.c_cc[VWERASE] = tmp.t_werasc; 884 tty->termios.c_cc[VLNEXT] = tmp.t_lnextc; 885 up_write(&tty->termios_rwsem); 886 return 0; 887 } 888 #endif 889 890 /** 891 * tty_change_softcar - carrier change ioctl helper 892 * @tty: tty to update 893 * @arg: enable/disable CLOCAL 894 * 895 * Perform a change to the CLOCAL state and call into the driver 896 * layer to make it visible. All done with the termios rwsem 897 */ 898 899 static int tty_change_softcar(struct tty_struct *tty, int arg) 900 { 901 int ret = 0; 902 int bit = arg ? CLOCAL : 0; 903 struct ktermios old; 904 905 down_write(&tty->termios_rwsem); 906 old = tty->termios; 907 tty->termios.c_cflag &= ~CLOCAL; 908 tty->termios.c_cflag |= bit; 909 if (tty->ops->set_termios) 910 tty->ops->set_termios(tty, &old); 911 if (C_CLOCAL(tty) != bit) 912 ret = -EINVAL; 913 up_write(&tty->termios_rwsem); 914 return ret; 915 } 916 917 /** 918 * tty_mode_ioctl - mode related ioctls 919 * @tty: tty for the ioctl 920 * @file: file pointer for the tty 921 * @cmd: command 922 * @arg: ioctl argument 923 * 924 * Perform non line discipline specific mode control ioctls. This 925 * is designed to be called by line disciplines to ensure they provide 926 * consistent mode setting. 927 */ 928 929 int tty_mode_ioctl(struct tty_struct *tty, struct file *file, 930 unsigned int cmd, unsigned long arg) 931 { 932 struct tty_struct *real_tty; 933 void __user *p = (void __user *)arg; 934 int ret = 0; 935 struct ktermios kterm; 936 937 BUG_ON(file == NULL); 938 939 if (tty->driver->type == TTY_DRIVER_TYPE_PTY && 940 tty->driver->subtype == PTY_TYPE_MASTER) 941 real_tty = tty->link; 942 else 943 real_tty = tty; 944 945 switch (cmd) { 946 #ifdef TIOCGETP 947 case TIOCGETP: 948 return get_sgttyb(real_tty, (struct sgttyb __user *) arg); 949 case TIOCSETP: 950 case TIOCSETN: 951 return set_sgttyb(real_tty, (struct sgttyb __user *) arg); 952 #endif 953 #ifdef TIOCGETC 954 case TIOCGETC: 955 return get_tchars(real_tty, p); 956 case TIOCSETC: 957 return set_tchars(real_tty, p); 958 #endif 959 #ifdef TIOCGLTC 960 case TIOCGLTC: 961 return get_ltchars(real_tty, p); 962 case TIOCSLTC: 963 return set_ltchars(real_tty, p); 964 #endif 965 case TCSETSF: 966 return set_termios(real_tty, p, TERMIOS_FLUSH | TERMIOS_WAIT | TERMIOS_OLD); 967 case TCSETSW: 968 return set_termios(real_tty, p, TERMIOS_WAIT | TERMIOS_OLD); 969 case TCSETS: 970 return set_termios(real_tty, p, TERMIOS_OLD); 971 #ifndef TCGETS2 972 case TCGETS: 973 copy_termios(real_tty, &kterm); 974 if (kernel_termios_to_user_termios((struct termios __user *)arg, &kterm)) 975 ret = -EFAULT; 976 return ret; 977 #else 978 case TCGETS: 979 copy_termios(real_tty, &kterm); 980 if (kernel_termios_to_user_termios_1((struct termios __user *)arg, &kterm)) 981 ret = -EFAULT; 982 return ret; 983 case TCGETS2: 984 copy_termios(real_tty, &kterm); 985 if (kernel_termios_to_user_termios((struct termios2 __user *)arg, &kterm)) 986 ret = -EFAULT; 987 return ret; 988 case TCSETSF2: 989 return set_termios(real_tty, p, TERMIOS_FLUSH | TERMIOS_WAIT); 990 case TCSETSW2: 991 return set_termios(real_tty, p, TERMIOS_WAIT); 992 case TCSETS2: 993 return set_termios(real_tty, p, 0); 994 #endif 995 case TCGETA: 996 return get_termio(real_tty, p); 997 case TCSETAF: 998 return set_termios(real_tty, p, TERMIOS_FLUSH | TERMIOS_WAIT | TERMIOS_TERMIO); 999 case TCSETAW: 1000 return set_termios(real_tty, p, TERMIOS_WAIT | TERMIOS_TERMIO); 1001 case TCSETA: 1002 return set_termios(real_tty, p, TERMIOS_TERMIO); 1003 #ifndef TCGETS2 1004 case TIOCGLCKTRMIOS: 1005 copy_termios_locked(real_tty, &kterm); 1006 if (kernel_termios_to_user_termios((struct termios __user *)arg, &kterm)) 1007 ret = -EFAULT; 1008 return ret; 1009 case TIOCSLCKTRMIOS: 1010 if (!capable(CAP_SYS_ADMIN)) 1011 return -EPERM; 1012 copy_termios_locked(real_tty, &kterm); 1013 if (user_termios_to_kernel_termios(&kterm, 1014 (struct termios __user *) arg)) 1015 return -EFAULT; 1016 down_write(&real_tty->termios_rwsem); 1017 real_tty->termios_locked = kterm; 1018 up_write(&real_tty->termios_rwsem); 1019 return 0; 1020 #else 1021 case TIOCGLCKTRMIOS: 1022 copy_termios_locked(real_tty, &kterm); 1023 if (kernel_termios_to_user_termios_1((struct termios __user *)arg, &kterm)) 1024 ret = -EFAULT; 1025 return ret; 1026 case TIOCSLCKTRMIOS: 1027 if (!capable(CAP_SYS_ADMIN)) 1028 return -EPERM; 1029 copy_termios_locked(real_tty, &kterm); 1030 if (user_termios_to_kernel_termios_1(&kterm, 1031 (struct termios __user *) arg)) 1032 return -EFAULT; 1033 down_write(&real_tty->termios_rwsem); 1034 real_tty->termios_locked = kterm; 1035 up_write(&real_tty->termios_rwsem); 1036 return ret; 1037 #endif 1038 #ifdef TCGETX 1039 case TCGETX: { 1040 struct termiox ktermx; 1041 if (real_tty->termiox == NULL) 1042 return -EINVAL; 1043 down_read(&real_tty->termios_rwsem); 1044 memcpy(&ktermx, real_tty->termiox, sizeof(struct termiox)); 1045 up_read(&real_tty->termios_rwsem); 1046 if (copy_to_user(p, &ktermx, sizeof(struct termiox))) 1047 ret = -EFAULT; 1048 return ret; 1049 } 1050 case TCSETX: 1051 return set_termiox(real_tty, p, 0); 1052 case TCSETXW: 1053 return set_termiox(real_tty, p, TERMIOS_WAIT); 1054 case TCSETXF: 1055 return set_termiox(real_tty, p, TERMIOS_FLUSH); 1056 #endif 1057 case TIOCGSOFTCAR: 1058 copy_termios(real_tty, &kterm); 1059 ret = put_user((kterm.c_cflag & CLOCAL) ? 1 : 0, 1060 (int __user *)arg); 1061 return ret; 1062 case TIOCSSOFTCAR: 1063 if (get_user(arg, (unsigned int __user *) arg)) 1064 return -EFAULT; 1065 return tty_change_softcar(real_tty, arg); 1066 default: 1067 return -ENOIOCTLCMD; 1068 } 1069 } 1070 EXPORT_SYMBOL_GPL(tty_mode_ioctl); 1071 1072 1073 /* Caller guarantees ldisc reference is held */ 1074 static int __tty_perform_flush(struct tty_struct *tty, unsigned long arg) 1075 { 1076 struct tty_ldisc *ld = tty->ldisc; 1077 1078 switch (arg) { 1079 case TCIFLUSH: 1080 if (ld && ld->ops->flush_buffer) { 1081 ld->ops->flush_buffer(tty); 1082 tty_unthrottle(tty); 1083 } 1084 break; 1085 case TCIOFLUSH: 1086 if (ld && ld->ops->flush_buffer) { 1087 ld->ops->flush_buffer(tty); 1088 tty_unthrottle(tty); 1089 } 1090 /* fall through */ 1091 case TCOFLUSH: 1092 tty_driver_flush_buffer(tty); 1093 break; 1094 default: 1095 return -EINVAL; 1096 } 1097 return 0; 1098 } 1099 1100 int tty_perform_flush(struct tty_struct *tty, unsigned long arg) 1101 { 1102 struct tty_ldisc *ld; 1103 int retval = tty_check_change(tty); 1104 if (retval) 1105 return retval; 1106 1107 ld = tty_ldisc_ref_wait(tty); 1108 retval = __tty_perform_flush(tty, arg); 1109 if (ld) 1110 tty_ldisc_deref(ld); 1111 return retval; 1112 } 1113 EXPORT_SYMBOL_GPL(tty_perform_flush); 1114 1115 int n_tty_ioctl_helper(struct tty_struct *tty, struct file *file, 1116 unsigned int cmd, unsigned long arg) 1117 { 1118 int retval; 1119 1120 switch (cmd) { 1121 case TCXONC: 1122 retval = tty_check_change(tty); 1123 if (retval) 1124 return retval; 1125 switch (arg) { 1126 case TCOOFF: 1127 spin_lock_irq(&tty->flow_lock); 1128 if (!tty->flow_stopped) { 1129 tty->flow_stopped = 1; 1130 __stop_tty(tty); 1131 } 1132 spin_unlock_irq(&tty->flow_lock); 1133 break; 1134 case TCOON: 1135 spin_lock_irq(&tty->flow_lock); 1136 if (tty->flow_stopped) { 1137 tty->flow_stopped = 0; 1138 __start_tty(tty); 1139 } 1140 spin_unlock_irq(&tty->flow_lock); 1141 break; 1142 case TCIOFF: 1143 if (STOP_CHAR(tty) != __DISABLED_CHAR) 1144 retval = tty_send_xchar(tty, STOP_CHAR(tty)); 1145 break; 1146 case TCION: 1147 if (START_CHAR(tty) != __DISABLED_CHAR) 1148 retval = tty_send_xchar(tty, START_CHAR(tty)); 1149 break; 1150 default: 1151 return -EINVAL; 1152 } 1153 return retval; 1154 case TCFLSH: 1155 retval = tty_check_change(tty); 1156 if (retval) 1157 return retval; 1158 return __tty_perform_flush(tty, arg); 1159 default: 1160 /* Try the mode commands */ 1161 return tty_mode_ioctl(tty, file, cmd, arg); 1162 } 1163 } 1164 EXPORT_SYMBOL(n_tty_ioctl_helper); 1165 1166 #ifdef CONFIG_COMPAT 1167 long n_tty_compat_ioctl_helper(struct tty_struct *tty, struct file *file, 1168 unsigned int cmd, unsigned long arg) 1169 { 1170 switch (cmd) { 1171 case TIOCGLCKTRMIOS: 1172 case TIOCSLCKTRMIOS: 1173 return tty_mode_ioctl(tty, file, cmd, (unsigned long) compat_ptr(arg)); 1174 default: 1175 return -ENOIOCTLCMD; 1176 } 1177 } 1178 EXPORT_SYMBOL(n_tty_compat_ioctl_helper); 1179 #endif 1180 1181