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