1 // SPDX-License-Identifier: GPL-1.0+ 2 /* 3 * n_tty.c --- implements the N_TTY line discipline. 4 * 5 * This code used to be in tty_io.c, but things are getting hairy 6 * enough that it made sense to split things off. (The N_TTY 7 * processing has changed so much that it's hardly recognizable, 8 * anyway...) 9 * 10 * Note that the open routine for N_TTY is guaranteed never to return 11 * an error. This is because Linux will fall back to setting a line 12 * to N_TTY if it can not switch to any other line discipline. 13 * 14 * Written by Theodore Ts'o, Copyright 1994. 15 * 16 * This file also contains code originally written by Linus Torvalds, 17 * Copyright 1991, 1992, 1993, and by Julian Cowley, Copyright 1994. 18 * 19 * Reduced memory usage for older ARM systems - Russell King. 20 * 21 * 2000/01/20 Fixed SMP locking on put_tty_queue using bits of 22 * the patch by Andrew J. Kroll <ag784@freenet.buffalo.edu> 23 * who actually finally proved there really was a race. 24 * 25 * 2002/03/18 Implemented n_tty_wakeup to send SIGIO POLL_OUTs to 26 * waiting writing processes-Sapan Bhatia <sapan@corewars.org>. 27 * Also fixed a bug in BLOCKING mode where n_tty_write returns 28 * EAGAIN 29 */ 30 31 #include <linux/types.h> 32 #include <linux/major.h> 33 #include <linux/errno.h> 34 #include <linux/signal.h> 35 #include <linux/fcntl.h> 36 #include <linux/sched.h> 37 #include <linux/interrupt.h> 38 #include <linux/tty.h> 39 #include <linux/timer.h> 40 #include <linux/ctype.h> 41 #include <linux/mm.h> 42 #include <linux/string.h> 43 #include <linux/slab.h> 44 #include <linux/poll.h> 45 #include <linux/bitops.h> 46 #include <linux/audit.h> 47 #include <linux/file.h> 48 #include <linux/uaccess.h> 49 #include <linux/module.h> 50 #include <linux/ratelimit.h> 51 #include <linux/vmalloc.h> 52 #include "tty.h" 53 54 /* 55 * Until this number of characters is queued in the xmit buffer, select will 56 * return "we have room for writes". 57 */ 58 #define WAKEUP_CHARS 256 59 60 /* 61 * This defines the low- and high-watermarks for throttling and 62 * unthrottling the TTY driver. These watermarks are used for 63 * controlling the space in the read buffer. 64 */ 65 #define TTY_THRESHOLD_THROTTLE 128 /* now based on remaining room */ 66 #define TTY_THRESHOLD_UNTHROTTLE 128 67 68 /* 69 * Special byte codes used in the echo buffer to represent operations 70 * or special handling of characters. Bytes in the echo buffer that 71 * are not part of such special blocks are treated as normal character 72 * codes. 73 */ 74 #define ECHO_OP_START 0xff 75 #define ECHO_OP_MOVE_BACK_COL 0x80 76 #define ECHO_OP_SET_CANON_COL 0x81 77 #define ECHO_OP_ERASE_TAB 0x82 78 79 #define ECHO_COMMIT_WATERMARK 256 80 #define ECHO_BLOCK 256 81 #define ECHO_DISCARD_WATERMARK N_TTY_BUF_SIZE - (ECHO_BLOCK + 32) 82 83 84 #undef N_TTY_TRACE 85 #ifdef N_TTY_TRACE 86 # define n_tty_trace(f, args...) trace_printk(f, ##args) 87 #else 88 # define n_tty_trace(f, args...) no_printk(f, ##args) 89 #endif 90 91 struct n_tty_data { 92 /* producer-published */ 93 size_t read_head; 94 size_t commit_head; 95 size_t canon_head; 96 size_t echo_head; 97 size_t echo_commit; 98 size_t echo_mark; 99 DECLARE_BITMAP(char_map, 256); 100 101 /* private to n_tty_receive_overrun (single-threaded) */ 102 unsigned long overrun_time; 103 int num_overrun; 104 105 /* non-atomic */ 106 bool no_room; 107 108 /* must hold exclusive termios_rwsem to reset these */ 109 unsigned char lnext:1, erasing:1, raw:1, real_raw:1, icanon:1; 110 unsigned char push:1; 111 112 /* shared by producer and consumer */ 113 char read_buf[N_TTY_BUF_SIZE]; 114 DECLARE_BITMAP(read_flags, N_TTY_BUF_SIZE); 115 unsigned char echo_buf[N_TTY_BUF_SIZE]; 116 117 /* consumer-published */ 118 size_t read_tail; 119 size_t line_start; 120 121 /* protected by output lock */ 122 unsigned int column; 123 unsigned int canon_column; 124 size_t echo_tail; 125 126 struct mutex atomic_read_lock; 127 struct mutex output_lock; 128 }; 129 130 #define MASK(x) ((x) & (N_TTY_BUF_SIZE - 1)) 131 132 static inline size_t read_cnt(struct n_tty_data *ldata) 133 { 134 return ldata->read_head - ldata->read_tail; 135 } 136 137 static inline unsigned char read_buf(struct n_tty_data *ldata, size_t i) 138 { 139 return ldata->read_buf[i & (N_TTY_BUF_SIZE - 1)]; 140 } 141 142 static inline unsigned char *read_buf_addr(struct n_tty_data *ldata, size_t i) 143 { 144 return &ldata->read_buf[i & (N_TTY_BUF_SIZE - 1)]; 145 } 146 147 static inline unsigned char echo_buf(struct n_tty_data *ldata, size_t i) 148 { 149 smp_rmb(); /* Matches smp_wmb() in add_echo_byte(). */ 150 return ldata->echo_buf[i & (N_TTY_BUF_SIZE - 1)]; 151 } 152 153 static inline unsigned char *echo_buf_addr(struct n_tty_data *ldata, size_t i) 154 { 155 return &ldata->echo_buf[i & (N_TTY_BUF_SIZE - 1)]; 156 } 157 158 /* If we are not echoing the data, perhaps this is a secret so erase it */ 159 static void zero_buffer(struct tty_struct *tty, u8 *buffer, int size) 160 { 161 bool icanon = !!L_ICANON(tty); 162 bool no_echo = !L_ECHO(tty); 163 164 if (icanon && no_echo) 165 memset(buffer, 0x00, size); 166 } 167 168 static void tty_copy(struct tty_struct *tty, void *to, size_t tail, size_t n) 169 { 170 struct n_tty_data *ldata = tty->disc_data; 171 size_t size = N_TTY_BUF_SIZE - tail; 172 void *from = read_buf_addr(ldata, tail); 173 174 if (n > size) { 175 tty_audit_add_data(tty, from, size); 176 memcpy(to, from, size); 177 zero_buffer(tty, from, size); 178 to += size; 179 n -= size; 180 from = ldata->read_buf; 181 } 182 183 tty_audit_add_data(tty, from, n); 184 memcpy(to, from, n); 185 zero_buffer(tty, from, n); 186 } 187 188 /** 189 * n_tty_kick_worker - start input worker (if required) 190 * @tty: terminal 191 * 192 * Re-schedules the flip buffer work if it may have stopped. 193 * 194 * Locking: 195 * * Caller holds exclusive %termios_rwsem, or 196 * * n_tty_read()/consumer path: 197 * holds non-exclusive %termios_rwsem 198 */ 199 static void n_tty_kick_worker(struct tty_struct *tty) 200 { 201 struct n_tty_data *ldata = tty->disc_data; 202 203 /* Did the input worker stop? Restart it */ 204 if (unlikely(ldata->no_room)) { 205 ldata->no_room = 0; 206 207 WARN_RATELIMIT(tty->port->itty == NULL, 208 "scheduling with invalid itty\n"); 209 /* see if ldisc has been killed - if so, this means that 210 * even though the ldisc has been halted and ->buf.work 211 * cancelled, ->buf.work is about to be rescheduled 212 */ 213 WARN_RATELIMIT(test_bit(TTY_LDISC_HALTED, &tty->flags), 214 "scheduling buffer work for halted ldisc\n"); 215 tty_buffer_restart_work(tty->port); 216 } 217 } 218 219 static ssize_t chars_in_buffer(struct tty_struct *tty) 220 { 221 struct n_tty_data *ldata = tty->disc_data; 222 ssize_t n = 0; 223 224 if (!ldata->icanon) 225 n = ldata->commit_head - ldata->read_tail; 226 else 227 n = ldata->canon_head - ldata->read_tail; 228 return n; 229 } 230 231 /** 232 * n_tty_write_wakeup - asynchronous I/O notifier 233 * @tty: tty device 234 * 235 * Required for the ptys, serial driver etc. since processes that attach 236 * themselves to the master and rely on ASYNC IO must be woken up. 237 */ 238 static void n_tty_write_wakeup(struct tty_struct *tty) 239 { 240 clear_bit(TTY_DO_WRITE_WAKEUP, &tty->flags); 241 kill_fasync(&tty->fasync, SIGIO, POLL_OUT); 242 } 243 244 static void n_tty_check_throttle(struct tty_struct *tty) 245 { 246 struct n_tty_data *ldata = tty->disc_data; 247 248 /* 249 * Check the remaining room for the input canonicalization 250 * mode. We don't want to throttle the driver if we're in 251 * canonical mode and don't have a newline yet! 252 */ 253 if (ldata->icanon && ldata->canon_head == ldata->read_tail) 254 return; 255 256 while (1) { 257 int throttled; 258 tty_set_flow_change(tty, TTY_THROTTLE_SAFE); 259 if (N_TTY_BUF_SIZE - read_cnt(ldata) >= TTY_THRESHOLD_THROTTLE) 260 break; 261 throttled = tty_throttle_safe(tty); 262 if (!throttled) 263 break; 264 } 265 __tty_set_flow_change(tty, 0); 266 } 267 268 static void n_tty_check_unthrottle(struct tty_struct *tty) 269 { 270 if (tty->driver->type == TTY_DRIVER_TYPE_PTY) { 271 if (chars_in_buffer(tty) > TTY_THRESHOLD_UNTHROTTLE) 272 return; 273 n_tty_kick_worker(tty); 274 tty_wakeup(tty->link); 275 return; 276 } 277 278 /* If there is enough space in the read buffer now, let the 279 * low-level driver know. We use chars_in_buffer() to 280 * check the buffer, as it now knows about canonical mode. 281 * Otherwise, if the driver is throttled and the line is 282 * longer than TTY_THRESHOLD_UNTHROTTLE in canonical mode, 283 * we won't get any more characters. 284 */ 285 286 while (1) { 287 int unthrottled; 288 tty_set_flow_change(tty, TTY_UNTHROTTLE_SAFE); 289 if (chars_in_buffer(tty) > TTY_THRESHOLD_UNTHROTTLE) 290 break; 291 n_tty_kick_worker(tty); 292 unthrottled = tty_unthrottle_safe(tty); 293 if (!unthrottled) 294 break; 295 } 296 __tty_set_flow_change(tty, 0); 297 } 298 299 /** 300 * put_tty_queue - add character to tty 301 * @c: character 302 * @ldata: n_tty data 303 * 304 * Add a character to the tty read_buf queue. 305 * 306 * Locking: 307 * * n_tty_receive_buf()/producer path: 308 * caller holds non-exclusive %termios_rwsem 309 */ 310 static inline void put_tty_queue(unsigned char c, struct n_tty_data *ldata) 311 { 312 *read_buf_addr(ldata, ldata->read_head) = c; 313 ldata->read_head++; 314 } 315 316 /** 317 * reset_buffer_flags - reset buffer state 318 * @ldata: line disc data to reset 319 * 320 * Reset the read buffer counters and clear the flags. Called from 321 * n_tty_open() and n_tty_flush_buffer(). 322 * 323 * Locking: 324 * * caller holds exclusive %termios_rwsem, or 325 * * (locking is not required) 326 */ 327 static void reset_buffer_flags(struct n_tty_data *ldata) 328 { 329 ldata->read_head = ldata->canon_head = ldata->read_tail = 0; 330 ldata->commit_head = 0; 331 ldata->line_start = 0; 332 333 ldata->erasing = 0; 334 bitmap_zero(ldata->read_flags, N_TTY_BUF_SIZE); 335 ldata->push = 0; 336 } 337 338 static void n_tty_packet_mode_flush(struct tty_struct *tty) 339 { 340 unsigned long flags; 341 342 if (tty->link->ctrl.packet) { 343 spin_lock_irqsave(&tty->ctrl.lock, flags); 344 tty->ctrl.pktstatus |= TIOCPKT_FLUSHREAD; 345 spin_unlock_irqrestore(&tty->ctrl.lock, flags); 346 wake_up_interruptible(&tty->link->read_wait); 347 } 348 } 349 350 /** 351 * n_tty_flush_buffer - clean input queue 352 * @tty: terminal device 353 * 354 * Flush the input buffer. Called when the tty layer wants the buffer flushed 355 * (eg at hangup) or when the %N_TTY line discipline internally has to clean 356 * the pending queue (for example some signals). 357 * 358 * Holds %termios_rwsem to exclude producer/consumer while buffer indices are 359 * reset. 360 * 361 * Locking: %ctrl.lock, exclusive %termios_rwsem 362 */ 363 static void n_tty_flush_buffer(struct tty_struct *tty) 364 { 365 down_write(&tty->termios_rwsem); 366 reset_buffer_flags(tty->disc_data); 367 n_tty_kick_worker(tty); 368 369 if (tty->link) 370 n_tty_packet_mode_flush(tty); 371 up_write(&tty->termios_rwsem); 372 } 373 374 /** 375 * is_utf8_continuation - utf8 multibyte check 376 * @c: byte to check 377 * 378 * Returns: true if the utf8 character @c is a multibyte continuation 379 * character. We use this to correctly compute the on-screen size of the 380 * character when printing. 381 */ 382 static inline int is_utf8_continuation(unsigned char c) 383 { 384 return (c & 0xc0) == 0x80; 385 } 386 387 /** 388 * is_continuation - multibyte check 389 * @c: byte to check 390 * @tty: terminal device 391 * 392 * Returns: true if the utf8 character @c is a multibyte continuation character 393 * and the terminal is in unicode mode. 394 */ 395 static inline int is_continuation(unsigned char c, struct tty_struct *tty) 396 { 397 return I_IUTF8(tty) && is_utf8_continuation(c); 398 } 399 400 /** 401 * do_output_char - output one character 402 * @c: character (or partial unicode symbol) 403 * @tty: terminal device 404 * @space: space available in tty driver write buffer 405 * 406 * This is a helper function that handles one output character (including 407 * special characters like TAB, CR, LF, etc.), doing OPOST processing and 408 * putting the results in the tty driver's write buffer. 409 * 410 * Note that Linux currently ignores TABDLY, CRDLY, VTDLY, FFDLY and NLDLY. 411 * They simply aren't relevant in the world today. If you ever need them, add 412 * them here. 413 * 414 * Returns: the number of bytes of buffer space used or -1 if no space left. 415 * 416 * Locking: should be called under the %output_lock to protect the column state 417 * and space left in the buffer. 418 */ 419 static int do_output_char(unsigned char c, struct tty_struct *tty, int space) 420 { 421 struct n_tty_data *ldata = tty->disc_data; 422 int spaces; 423 424 if (!space) 425 return -1; 426 427 switch (c) { 428 case '\n': 429 if (O_ONLRET(tty)) 430 ldata->column = 0; 431 if (O_ONLCR(tty)) { 432 if (space < 2) 433 return -1; 434 ldata->canon_column = ldata->column = 0; 435 tty->ops->write(tty, "\r\n", 2); 436 return 2; 437 } 438 ldata->canon_column = ldata->column; 439 break; 440 case '\r': 441 if (O_ONOCR(tty) && ldata->column == 0) 442 return 0; 443 if (O_OCRNL(tty)) { 444 c = '\n'; 445 if (O_ONLRET(tty)) 446 ldata->canon_column = ldata->column = 0; 447 break; 448 } 449 ldata->canon_column = ldata->column = 0; 450 break; 451 case '\t': 452 spaces = 8 - (ldata->column & 7); 453 if (O_TABDLY(tty) == XTABS) { 454 if (space < spaces) 455 return -1; 456 ldata->column += spaces; 457 tty->ops->write(tty, " ", spaces); 458 return spaces; 459 } 460 ldata->column += spaces; 461 break; 462 case '\b': 463 if (ldata->column > 0) 464 ldata->column--; 465 break; 466 default: 467 if (!iscntrl(c)) { 468 if (O_OLCUC(tty)) 469 c = toupper(c); 470 if (!is_continuation(c, tty)) 471 ldata->column++; 472 } 473 break; 474 } 475 476 tty_put_char(tty, c); 477 return 1; 478 } 479 480 /** 481 * process_output - output post processor 482 * @c: character (or partial unicode symbol) 483 * @tty: terminal device 484 * 485 * Output one character with OPOST processing. 486 * 487 * Returns: -1 when the output device is full and the character must be 488 * retried. 489 * 490 * Locking: %output_lock to protect column state and space left (also, this is 491 *called from n_tty_write() under the tty layer write lock). 492 */ 493 static int process_output(unsigned char c, struct tty_struct *tty) 494 { 495 struct n_tty_data *ldata = tty->disc_data; 496 int space, retval; 497 498 mutex_lock(&ldata->output_lock); 499 500 space = tty_write_room(tty); 501 retval = do_output_char(c, tty, space); 502 503 mutex_unlock(&ldata->output_lock); 504 if (retval < 0) 505 return -1; 506 else 507 return 0; 508 } 509 510 /** 511 * process_output_block - block post processor 512 * @tty: terminal device 513 * @buf: character buffer 514 * @nr: number of bytes to output 515 * 516 * Output a block of characters with OPOST processing. 517 * 518 * This path is used to speed up block console writes, among other things when 519 * processing blocks of output data. It handles only the simple cases normally 520 * found and helps to generate blocks of symbols for the console driver and 521 * thus improve performance. 522 * 523 * Returns: the number of characters output. 524 * 525 * Locking: %output_lock to protect column state and space left (also, this is 526 * called from n_tty_write() under the tty layer write lock). 527 */ 528 static ssize_t process_output_block(struct tty_struct *tty, 529 const unsigned char *buf, unsigned int nr) 530 { 531 struct n_tty_data *ldata = tty->disc_data; 532 int space; 533 int i; 534 const unsigned char *cp; 535 536 mutex_lock(&ldata->output_lock); 537 538 space = tty_write_room(tty); 539 if (space <= 0) { 540 mutex_unlock(&ldata->output_lock); 541 return space; 542 } 543 if (nr > space) 544 nr = space; 545 546 for (i = 0, cp = buf; i < nr; i++, cp++) { 547 unsigned char c = *cp; 548 549 switch (c) { 550 case '\n': 551 if (O_ONLRET(tty)) 552 ldata->column = 0; 553 if (O_ONLCR(tty)) 554 goto break_out; 555 ldata->canon_column = ldata->column; 556 break; 557 case '\r': 558 if (O_ONOCR(tty) && ldata->column == 0) 559 goto break_out; 560 if (O_OCRNL(tty)) 561 goto break_out; 562 ldata->canon_column = ldata->column = 0; 563 break; 564 case '\t': 565 goto break_out; 566 case '\b': 567 if (ldata->column > 0) 568 ldata->column--; 569 break; 570 default: 571 if (!iscntrl(c)) { 572 if (O_OLCUC(tty)) 573 goto break_out; 574 if (!is_continuation(c, tty)) 575 ldata->column++; 576 } 577 break; 578 } 579 } 580 break_out: 581 i = tty->ops->write(tty, buf, i); 582 583 mutex_unlock(&ldata->output_lock); 584 return i; 585 } 586 587 /** 588 * __process_echoes - write pending echo characters 589 * @tty: terminal device 590 * 591 * Write previously buffered echo (and other ldisc-generated) characters to the 592 * tty. 593 * 594 * Characters generated by the ldisc (including echoes) need to be buffered 595 * because the driver's write buffer can fill during heavy program output. 596 * Echoing straight to the driver will often fail under these conditions, 597 * causing lost characters and resulting mismatches of ldisc state information. 598 * 599 * Since the ldisc state must represent the characters actually sent to the 600 * driver at the time of the write, operations like certain changes in column 601 * state are also saved in the buffer and executed here. 602 * 603 * A circular fifo buffer is used so that the most recent characters are 604 * prioritized. Also, when control characters are echoed with a prefixed "^", 605 * the pair is treated atomically and thus not separated. 606 * 607 * Locking: callers must hold %output_lock. 608 */ 609 static size_t __process_echoes(struct tty_struct *tty) 610 { 611 struct n_tty_data *ldata = tty->disc_data; 612 int space, old_space; 613 size_t tail; 614 unsigned char c; 615 616 old_space = space = tty_write_room(tty); 617 618 tail = ldata->echo_tail; 619 while (MASK(ldata->echo_commit) != MASK(tail)) { 620 c = echo_buf(ldata, tail); 621 if (c == ECHO_OP_START) { 622 unsigned char op; 623 int no_space_left = 0; 624 625 /* 626 * Since add_echo_byte() is called without holding 627 * output_lock, we might see only portion of multi-byte 628 * operation. 629 */ 630 if (MASK(ldata->echo_commit) == MASK(tail + 1)) 631 goto not_yet_stored; 632 /* 633 * If the buffer byte is the start of a multi-byte 634 * operation, get the next byte, which is either the 635 * op code or a control character value. 636 */ 637 op = echo_buf(ldata, tail + 1); 638 639 switch (op) { 640 case ECHO_OP_ERASE_TAB: { 641 unsigned int num_chars, num_bs; 642 643 if (MASK(ldata->echo_commit) == MASK(tail + 2)) 644 goto not_yet_stored; 645 num_chars = echo_buf(ldata, tail + 2); 646 647 /* 648 * Determine how many columns to go back 649 * in order to erase the tab. 650 * This depends on the number of columns 651 * used by other characters within the tab 652 * area. If this (modulo 8) count is from 653 * the start of input rather than from a 654 * previous tab, we offset by canon column. 655 * Otherwise, tab spacing is normal. 656 */ 657 if (!(num_chars & 0x80)) 658 num_chars += ldata->canon_column; 659 num_bs = 8 - (num_chars & 7); 660 661 if (num_bs > space) { 662 no_space_left = 1; 663 break; 664 } 665 space -= num_bs; 666 while (num_bs--) { 667 tty_put_char(tty, '\b'); 668 if (ldata->column > 0) 669 ldata->column--; 670 } 671 tail += 3; 672 break; 673 } 674 case ECHO_OP_SET_CANON_COL: 675 ldata->canon_column = ldata->column; 676 tail += 2; 677 break; 678 679 case ECHO_OP_MOVE_BACK_COL: 680 if (ldata->column > 0) 681 ldata->column--; 682 tail += 2; 683 break; 684 685 case ECHO_OP_START: 686 /* This is an escaped echo op start code */ 687 if (!space) { 688 no_space_left = 1; 689 break; 690 } 691 tty_put_char(tty, ECHO_OP_START); 692 ldata->column++; 693 space--; 694 tail += 2; 695 break; 696 697 default: 698 /* 699 * If the op is not a special byte code, 700 * it is a ctrl char tagged to be echoed 701 * as "^X" (where X is the letter 702 * representing the control char). 703 * Note that we must ensure there is 704 * enough space for the whole ctrl pair. 705 * 706 */ 707 if (space < 2) { 708 no_space_left = 1; 709 break; 710 } 711 tty_put_char(tty, '^'); 712 tty_put_char(tty, op ^ 0100); 713 ldata->column += 2; 714 space -= 2; 715 tail += 2; 716 } 717 718 if (no_space_left) 719 break; 720 } else { 721 if (O_OPOST(tty)) { 722 int retval = do_output_char(c, tty, space); 723 if (retval < 0) 724 break; 725 space -= retval; 726 } else { 727 if (!space) 728 break; 729 tty_put_char(tty, c); 730 space -= 1; 731 } 732 tail += 1; 733 } 734 } 735 736 /* If the echo buffer is nearly full (so that the possibility exists 737 * of echo overrun before the next commit), then discard enough 738 * data at the tail to prevent a subsequent overrun */ 739 while (ldata->echo_commit > tail && 740 ldata->echo_commit - tail >= ECHO_DISCARD_WATERMARK) { 741 if (echo_buf(ldata, tail) == ECHO_OP_START) { 742 if (echo_buf(ldata, tail + 1) == ECHO_OP_ERASE_TAB) 743 tail += 3; 744 else 745 tail += 2; 746 } else 747 tail++; 748 } 749 750 not_yet_stored: 751 ldata->echo_tail = tail; 752 return old_space - space; 753 } 754 755 static void commit_echoes(struct tty_struct *tty) 756 { 757 struct n_tty_data *ldata = tty->disc_data; 758 size_t nr, old, echoed; 759 size_t head; 760 761 mutex_lock(&ldata->output_lock); 762 head = ldata->echo_head; 763 ldata->echo_mark = head; 764 old = ldata->echo_commit - ldata->echo_tail; 765 766 /* Process committed echoes if the accumulated # of bytes 767 * is over the threshold (and try again each time another 768 * block is accumulated) */ 769 nr = head - ldata->echo_tail; 770 if (nr < ECHO_COMMIT_WATERMARK || 771 (nr % ECHO_BLOCK > old % ECHO_BLOCK)) { 772 mutex_unlock(&ldata->output_lock); 773 return; 774 } 775 776 ldata->echo_commit = head; 777 echoed = __process_echoes(tty); 778 mutex_unlock(&ldata->output_lock); 779 780 if (echoed && tty->ops->flush_chars) 781 tty->ops->flush_chars(tty); 782 } 783 784 static void process_echoes(struct tty_struct *tty) 785 { 786 struct n_tty_data *ldata = tty->disc_data; 787 size_t echoed; 788 789 if (ldata->echo_mark == ldata->echo_tail) 790 return; 791 792 mutex_lock(&ldata->output_lock); 793 ldata->echo_commit = ldata->echo_mark; 794 echoed = __process_echoes(tty); 795 mutex_unlock(&ldata->output_lock); 796 797 if (echoed && tty->ops->flush_chars) 798 tty->ops->flush_chars(tty); 799 } 800 801 /* NB: echo_mark and echo_head should be equivalent here */ 802 static void flush_echoes(struct tty_struct *tty) 803 { 804 struct n_tty_data *ldata = tty->disc_data; 805 806 if ((!L_ECHO(tty) && !L_ECHONL(tty)) || 807 ldata->echo_commit == ldata->echo_head) 808 return; 809 810 mutex_lock(&ldata->output_lock); 811 ldata->echo_commit = ldata->echo_head; 812 __process_echoes(tty); 813 mutex_unlock(&ldata->output_lock); 814 } 815 816 /** 817 * add_echo_byte - add a byte to the echo buffer 818 * @c: unicode byte to echo 819 * @ldata: n_tty data 820 * 821 * Add a character or operation byte to the echo buffer. 822 */ 823 static inline void add_echo_byte(unsigned char c, struct n_tty_data *ldata) 824 { 825 *echo_buf_addr(ldata, ldata->echo_head) = c; 826 smp_wmb(); /* Matches smp_rmb() in echo_buf(). */ 827 ldata->echo_head++; 828 } 829 830 /** 831 * echo_move_back_col - add operation to move back a column 832 * @ldata: n_tty data 833 * 834 * Add an operation to the echo buffer to move back one column. 835 */ 836 static void echo_move_back_col(struct n_tty_data *ldata) 837 { 838 add_echo_byte(ECHO_OP_START, ldata); 839 add_echo_byte(ECHO_OP_MOVE_BACK_COL, ldata); 840 } 841 842 /** 843 * echo_set_canon_col - add operation to set the canon column 844 * @ldata: n_tty data 845 * 846 * Add an operation to the echo buffer to set the canon column to the current 847 * column. 848 */ 849 static void echo_set_canon_col(struct n_tty_data *ldata) 850 { 851 add_echo_byte(ECHO_OP_START, ldata); 852 add_echo_byte(ECHO_OP_SET_CANON_COL, ldata); 853 } 854 855 /** 856 * echo_erase_tab - add operation to erase a tab 857 * @num_chars: number of character columns already used 858 * @after_tab: true if num_chars starts after a previous tab 859 * @ldata: n_tty data 860 * 861 * Add an operation to the echo buffer to erase a tab. 862 * 863 * Called by the eraser function, which knows how many character columns have 864 * been used since either a previous tab or the start of input. This 865 * information will be used later, along with canon column (if applicable), to 866 * go back the correct number of columns. 867 */ 868 static void echo_erase_tab(unsigned int num_chars, int after_tab, 869 struct n_tty_data *ldata) 870 { 871 add_echo_byte(ECHO_OP_START, ldata); 872 add_echo_byte(ECHO_OP_ERASE_TAB, ldata); 873 874 /* We only need to know this modulo 8 (tab spacing) */ 875 num_chars &= 7; 876 877 /* Set the high bit as a flag if num_chars is after a previous tab */ 878 if (after_tab) 879 num_chars |= 0x80; 880 881 add_echo_byte(num_chars, ldata); 882 } 883 884 /** 885 * echo_char_raw - echo a character raw 886 * @c: unicode byte to echo 887 * @ldata: line disc data 888 * 889 * Echo user input back onto the screen. This must be called only when 890 * L_ECHO(tty) is true. Called from the &tty_driver.receive_buf() path. 891 * 892 * This variant does not treat control characters specially. 893 */ 894 static void echo_char_raw(unsigned char c, struct n_tty_data *ldata) 895 { 896 if (c == ECHO_OP_START) { 897 add_echo_byte(ECHO_OP_START, ldata); 898 add_echo_byte(ECHO_OP_START, ldata); 899 } else { 900 add_echo_byte(c, ldata); 901 } 902 } 903 904 /** 905 * echo_char - echo a character 906 * @c: unicode byte to echo 907 * @tty: terminal device 908 * 909 * Echo user input back onto the screen. This must be called only when 910 * L_ECHO(tty) is true. Called from the &tty_driver.receive_buf() path. 911 * 912 * This variant tags control characters to be echoed as "^X" (where X is the 913 * letter representing the control char). 914 */ 915 static void echo_char(unsigned char c, struct tty_struct *tty) 916 { 917 struct n_tty_data *ldata = tty->disc_data; 918 919 if (c == ECHO_OP_START) { 920 add_echo_byte(ECHO_OP_START, ldata); 921 add_echo_byte(ECHO_OP_START, ldata); 922 } else { 923 if (L_ECHOCTL(tty) && iscntrl(c) && c != '\t') 924 add_echo_byte(ECHO_OP_START, ldata); 925 add_echo_byte(c, ldata); 926 } 927 } 928 929 /** 930 * finish_erasing - complete erase 931 * @ldata: n_tty data 932 */ 933 static inline void finish_erasing(struct n_tty_data *ldata) 934 { 935 if (ldata->erasing) { 936 echo_char_raw('/', ldata); 937 ldata->erasing = 0; 938 } 939 } 940 941 /** 942 * eraser - handle erase function 943 * @c: character input 944 * @tty: terminal device 945 * 946 * Perform erase and necessary output when an erase character is present in the 947 * stream from the driver layer. Handles the complexities of UTF-8 multibyte 948 * symbols. 949 * 950 * Locking: n_tty_receive_buf()/producer path: 951 * caller holds non-exclusive %termios_rwsem 952 */ 953 static void eraser(unsigned char c, struct tty_struct *tty) 954 { 955 struct n_tty_data *ldata = tty->disc_data; 956 enum { ERASE, WERASE, KILL } kill_type; 957 size_t head; 958 size_t cnt; 959 int seen_alnums; 960 961 if (ldata->read_head == ldata->canon_head) { 962 /* process_output('\a', tty); */ /* what do you think? */ 963 return; 964 } 965 if (c == ERASE_CHAR(tty)) 966 kill_type = ERASE; 967 else if (c == WERASE_CHAR(tty)) 968 kill_type = WERASE; 969 else { 970 if (!L_ECHO(tty)) { 971 ldata->read_head = ldata->canon_head; 972 return; 973 } 974 if (!L_ECHOK(tty) || !L_ECHOKE(tty) || !L_ECHOE(tty)) { 975 ldata->read_head = ldata->canon_head; 976 finish_erasing(ldata); 977 echo_char(KILL_CHAR(tty), tty); 978 /* Add a newline if ECHOK is on and ECHOKE is off. */ 979 if (L_ECHOK(tty)) 980 echo_char_raw('\n', ldata); 981 return; 982 } 983 kill_type = KILL; 984 } 985 986 seen_alnums = 0; 987 while (MASK(ldata->read_head) != MASK(ldata->canon_head)) { 988 head = ldata->read_head; 989 990 /* erase a single possibly multibyte character */ 991 do { 992 head--; 993 c = read_buf(ldata, head); 994 } while (is_continuation(c, tty) && 995 MASK(head) != MASK(ldata->canon_head)); 996 997 /* do not partially erase */ 998 if (is_continuation(c, tty)) 999 break; 1000 1001 if (kill_type == WERASE) { 1002 /* Equivalent to BSD's ALTWERASE. */ 1003 if (isalnum(c) || c == '_') 1004 seen_alnums++; 1005 else if (seen_alnums) 1006 break; 1007 } 1008 cnt = ldata->read_head - head; 1009 ldata->read_head = head; 1010 if (L_ECHO(tty)) { 1011 if (L_ECHOPRT(tty)) { 1012 if (!ldata->erasing) { 1013 echo_char_raw('\\', ldata); 1014 ldata->erasing = 1; 1015 } 1016 /* if cnt > 1, output a multi-byte character */ 1017 echo_char(c, tty); 1018 while (--cnt > 0) { 1019 head++; 1020 echo_char_raw(read_buf(ldata, head), ldata); 1021 echo_move_back_col(ldata); 1022 } 1023 } else if (kill_type == ERASE && !L_ECHOE(tty)) { 1024 echo_char(ERASE_CHAR(tty), tty); 1025 } else if (c == '\t') { 1026 unsigned int num_chars = 0; 1027 int after_tab = 0; 1028 size_t tail = ldata->read_head; 1029 1030 /* 1031 * Count the columns used for characters 1032 * since the start of input or after a 1033 * previous tab. 1034 * This info is used to go back the correct 1035 * number of columns. 1036 */ 1037 while (MASK(tail) != MASK(ldata->canon_head)) { 1038 tail--; 1039 c = read_buf(ldata, tail); 1040 if (c == '\t') { 1041 after_tab = 1; 1042 break; 1043 } else if (iscntrl(c)) { 1044 if (L_ECHOCTL(tty)) 1045 num_chars += 2; 1046 } else if (!is_continuation(c, tty)) { 1047 num_chars++; 1048 } 1049 } 1050 echo_erase_tab(num_chars, after_tab, ldata); 1051 } else { 1052 if (iscntrl(c) && L_ECHOCTL(tty)) { 1053 echo_char_raw('\b', ldata); 1054 echo_char_raw(' ', ldata); 1055 echo_char_raw('\b', ldata); 1056 } 1057 if (!iscntrl(c) || L_ECHOCTL(tty)) { 1058 echo_char_raw('\b', ldata); 1059 echo_char_raw(' ', ldata); 1060 echo_char_raw('\b', ldata); 1061 } 1062 } 1063 } 1064 if (kill_type == ERASE) 1065 break; 1066 } 1067 if (ldata->read_head == ldata->canon_head && L_ECHO(tty)) 1068 finish_erasing(ldata); 1069 } 1070 1071 1072 static void __isig(int sig, struct tty_struct *tty) 1073 { 1074 struct pid *tty_pgrp = tty_get_pgrp(tty); 1075 if (tty_pgrp) { 1076 kill_pgrp(tty_pgrp, sig, 1); 1077 put_pid(tty_pgrp); 1078 } 1079 } 1080 1081 /** 1082 * isig - handle the ISIG optio 1083 * @sig: signal 1084 * @tty: terminal 1085 * 1086 * Called when a signal is being sent due to terminal input. Called from the 1087 * &tty_driver.receive_buf() path, so serialized. 1088 * 1089 * Performs input and output flush if !NOFLSH. In this context, the echo 1090 * buffer is 'output'. The signal is processed first to alert any current 1091 * readers or writers to discontinue and exit their i/o loops. 1092 * 1093 * Locking: %ctrl.lock 1094 */ 1095 static void isig(int sig, struct tty_struct *tty) 1096 { 1097 struct n_tty_data *ldata = tty->disc_data; 1098 1099 if (L_NOFLSH(tty)) { 1100 /* signal only */ 1101 __isig(sig, tty); 1102 1103 } else { /* signal and flush */ 1104 up_read(&tty->termios_rwsem); 1105 down_write(&tty->termios_rwsem); 1106 1107 __isig(sig, tty); 1108 1109 /* clear echo buffer */ 1110 mutex_lock(&ldata->output_lock); 1111 ldata->echo_head = ldata->echo_tail = 0; 1112 ldata->echo_mark = ldata->echo_commit = 0; 1113 mutex_unlock(&ldata->output_lock); 1114 1115 /* clear output buffer */ 1116 tty_driver_flush_buffer(tty); 1117 1118 /* clear input buffer */ 1119 reset_buffer_flags(tty->disc_data); 1120 1121 /* notify pty master of flush */ 1122 if (tty->link) 1123 n_tty_packet_mode_flush(tty); 1124 1125 up_write(&tty->termios_rwsem); 1126 down_read(&tty->termios_rwsem); 1127 } 1128 } 1129 1130 /** 1131 * n_tty_receive_break - handle break 1132 * @tty: terminal 1133 * 1134 * An RS232 break event has been hit in the incoming bitstream. This can cause 1135 * a variety of events depending upon the termios settings. 1136 * 1137 * Locking: n_tty_receive_buf()/producer path: 1138 * caller holds non-exclusive termios_rwsem 1139 * 1140 * Note: may get exclusive %termios_rwsem if flushing input buffer 1141 */ 1142 static void n_tty_receive_break(struct tty_struct *tty) 1143 { 1144 struct n_tty_data *ldata = tty->disc_data; 1145 1146 if (I_IGNBRK(tty)) 1147 return; 1148 if (I_BRKINT(tty)) { 1149 isig(SIGINT, tty); 1150 return; 1151 } 1152 if (I_PARMRK(tty)) { 1153 put_tty_queue('\377', ldata); 1154 put_tty_queue('\0', ldata); 1155 } 1156 put_tty_queue('\0', ldata); 1157 } 1158 1159 /** 1160 * n_tty_receive_overrun - handle overrun reporting 1161 * @tty: terminal 1162 * 1163 * Data arrived faster than we could process it. While the tty driver has 1164 * flagged this the bits that were missed are gone forever. 1165 * 1166 * Called from the receive_buf path so single threaded. Does not need locking 1167 * as num_overrun and overrun_time are function private. 1168 */ 1169 static void n_tty_receive_overrun(struct tty_struct *tty) 1170 { 1171 struct n_tty_data *ldata = tty->disc_data; 1172 1173 ldata->num_overrun++; 1174 if (time_after(jiffies, ldata->overrun_time + HZ) || 1175 time_after(ldata->overrun_time, jiffies)) { 1176 tty_warn(tty, "%d input overrun(s)\n", ldata->num_overrun); 1177 ldata->overrun_time = jiffies; 1178 ldata->num_overrun = 0; 1179 } 1180 } 1181 1182 /** 1183 * n_tty_receive_parity_error - error notifier 1184 * @tty: terminal device 1185 * @c: character 1186 * 1187 * Process a parity error and queue the right data to indicate the error case 1188 * if necessary. 1189 * 1190 * Locking: n_tty_receive_buf()/producer path: 1191 * caller holds non-exclusive %termios_rwsem 1192 */ 1193 static void n_tty_receive_parity_error(struct tty_struct *tty, unsigned char c) 1194 { 1195 struct n_tty_data *ldata = tty->disc_data; 1196 1197 if (I_INPCK(tty)) { 1198 if (I_IGNPAR(tty)) 1199 return; 1200 if (I_PARMRK(tty)) { 1201 put_tty_queue('\377', ldata); 1202 put_tty_queue('\0', ldata); 1203 put_tty_queue(c, ldata); 1204 } else 1205 put_tty_queue('\0', ldata); 1206 } else 1207 put_tty_queue(c, ldata); 1208 } 1209 1210 static void 1211 n_tty_receive_signal_char(struct tty_struct *tty, int signal, unsigned char c) 1212 { 1213 isig(signal, tty); 1214 if (I_IXON(tty)) 1215 start_tty(tty); 1216 if (L_ECHO(tty)) { 1217 echo_char(c, tty); 1218 commit_echoes(tty); 1219 } else 1220 process_echoes(tty); 1221 } 1222 1223 /* Returns true if c is consumed as flow-control character */ 1224 static bool n_tty_receive_char_flow_ctrl(struct tty_struct *tty, unsigned char c) 1225 { 1226 if (c == START_CHAR(tty)) { 1227 start_tty(tty); 1228 process_echoes(tty); 1229 return true; 1230 } 1231 if (c == STOP_CHAR(tty)) { 1232 stop_tty(tty); 1233 return true; 1234 } 1235 1236 return false; 1237 } 1238 1239 static void n_tty_receive_char_special(struct tty_struct *tty, unsigned char c) 1240 { 1241 struct n_tty_data *ldata = tty->disc_data; 1242 1243 if (I_IXON(tty) && n_tty_receive_char_flow_ctrl(tty, c)) 1244 return; 1245 1246 if (L_ISIG(tty)) { 1247 if (c == INTR_CHAR(tty)) { 1248 n_tty_receive_signal_char(tty, SIGINT, c); 1249 return; 1250 } else if (c == QUIT_CHAR(tty)) { 1251 n_tty_receive_signal_char(tty, SIGQUIT, c); 1252 return; 1253 } else if (c == SUSP_CHAR(tty)) { 1254 n_tty_receive_signal_char(tty, SIGTSTP, c); 1255 return; 1256 } 1257 } 1258 1259 if (tty->flow.stopped && !tty->flow.tco_stopped && I_IXON(tty) && I_IXANY(tty)) { 1260 start_tty(tty); 1261 process_echoes(tty); 1262 } 1263 1264 if (c == '\r') { 1265 if (I_IGNCR(tty)) 1266 return; 1267 if (I_ICRNL(tty)) 1268 c = '\n'; 1269 } else if (c == '\n' && I_INLCR(tty)) 1270 c = '\r'; 1271 1272 if (ldata->icanon) { 1273 if (c == ERASE_CHAR(tty) || c == KILL_CHAR(tty) || 1274 (c == WERASE_CHAR(tty) && L_IEXTEN(tty))) { 1275 eraser(c, tty); 1276 commit_echoes(tty); 1277 return; 1278 } 1279 if (c == LNEXT_CHAR(tty) && L_IEXTEN(tty)) { 1280 ldata->lnext = 1; 1281 if (L_ECHO(tty)) { 1282 finish_erasing(ldata); 1283 if (L_ECHOCTL(tty)) { 1284 echo_char_raw('^', ldata); 1285 echo_char_raw('\b', ldata); 1286 commit_echoes(tty); 1287 } 1288 } 1289 return; 1290 } 1291 if (c == REPRINT_CHAR(tty) && L_ECHO(tty) && L_IEXTEN(tty)) { 1292 size_t tail = ldata->canon_head; 1293 1294 finish_erasing(ldata); 1295 echo_char(c, tty); 1296 echo_char_raw('\n', ldata); 1297 while (MASK(tail) != MASK(ldata->read_head)) { 1298 echo_char(read_buf(ldata, tail), tty); 1299 tail++; 1300 } 1301 commit_echoes(tty); 1302 return; 1303 } 1304 if (c == '\n') { 1305 if (L_ECHO(tty) || L_ECHONL(tty)) { 1306 echo_char_raw('\n', ldata); 1307 commit_echoes(tty); 1308 } 1309 goto handle_newline; 1310 } 1311 if (c == EOF_CHAR(tty)) { 1312 c = __DISABLED_CHAR; 1313 goto handle_newline; 1314 } 1315 if ((c == EOL_CHAR(tty)) || 1316 (c == EOL2_CHAR(tty) && L_IEXTEN(tty))) { 1317 /* 1318 * XXX are EOL_CHAR and EOL2_CHAR echoed?!? 1319 */ 1320 if (L_ECHO(tty)) { 1321 /* Record the column of first canon char. */ 1322 if (ldata->canon_head == ldata->read_head) 1323 echo_set_canon_col(ldata); 1324 echo_char(c, tty); 1325 commit_echoes(tty); 1326 } 1327 /* 1328 * XXX does PARMRK doubling happen for 1329 * EOL_CHAR and EOL2_CHAR? 1330 */ 1331 if (c == (unsigned char) '\377' && I_PARMRK(tty)) 1332 put_tty_queue(c, ldata); 1333 1334 handle_newline: 1335 set_bit(ldata->read_head & (N_TTY_BUF_SIZE - 1), ldata->read_flags); 1336 put_tty_queue(c, ldata); 1337 smp_store_release(&ldata->canon_head, ldata->read_head); 1338 kill_fasync(&tty->fasync, SIGIO, POLL_IN); 1339 wake_up_interruptible_poll(&tty->read_wait, EPOLLIN | EPOLLRDNORM); 1340 return; 1341 } 1342 } 1343 1344 if (L_ECHO(tty)) { 1345 finish_erasing(ldata); 1346 if (c == '\n') 1347 echo_char_raw('\n', ldata); 1348 else { 1349 /* Record the column of first canon char. */ 1350 if (ldata->canon_head == ldata->read_head) 1351 echo_set_canon_col(ldata); 1352 echo_char(c, tty); 1353 } 1354 commit_echoes(tty); 1355 } 1356 1357 /* PARMRK doubling check */ 1358 if (c == (unsigned char) '\377' && I_PARMRK(tty)) 1359 put_tty_queue(c, ldata); 1360 1361 put_tty_queue(c, ldata); 1362 } 1363 1364 /** 1365 * n_tty_receive_char - perform processing 1366 * @tty: terminal device 1367 * @c: character 1368 * 1369 * Process an individual character of input received from the driver. This is 1370 * serialized with respect to itself by the rules for the driver above. 1371 * 1372 * Locking: n_tty_receive_buf()/producer path: 1373 * caller holds non-exclusive %termios_rwsem 1374 * publishes canon_head if canonical mode is active 1375 */ 1376 static void n_tty_receive_char(struct tty_struct *tty, unsigned char c) 1377 { 1378 struct n_tty_data *ldata = tty->disc_data; 1379 1380 if (tty->flow.stopped && !tty->flow.tco_stopped && I_IXON(tty) && I_IXANY(tty)) { 1381 start_tty(tty); 1382 process_echoes(tty); 1383 } 1384 if (L_ECHO(tty)) { 1385 finish_erasing(ldata); 1386 /* Record the column of first canon char. */ 1387 if (ldata->canon_head == ldata->read_head) 1388 echo_set_canon_col(ldata); 1389 echo_char(c, tty); 1390 commit_echoes(tty); 1391 } 1392 /* PARMRK doubling check */ 1393 if (c == (unsigned char) '\377' && I_PARMRK(tty)) 1394 put_tty_queue(c, ldata); 1395 put_tty_queue(c, ldata); 1396 } 1397 1398 static void n_tty_receive_char_closing(struct tty_struct *tty, unsigned char c) 1399 { 1400 if (I_ISTRIP(tty)) 1401 c &= 0x7f; 1402 if (I_IUCLC(tty) && L_IEXTEN(tty)) 1403 c = tolower(c); 1404 1405 if (I_IXON(tty)) { 1406 if (c == STOP_CHAR(tty)) 1407 stop_tty(tty); 1408 else if (c == START_CHAR(tty) || 1409 (tty->flow.stopped && !tty->flow.tco_stopped && I_IXANY(tty) && 1410 c != INTR_CHAR(tty) && c != QUIT_CHAR(tty) && 1411 c != SUSP_CHAR(tty))) { 1412 start_tty(tty); 1413 process_echoes(tty); 1414 } 1415 } 1416 } 1417 1418 static void 1419 n_tty_receive_char_flagged(struct tty_struct *tty, unsigned char c, char flag) 1420 { 1421 switch (flag) { 1422 case TTY_BREAK: 1423 n_tty_receive_break(tty); 1424 break; 1425 case TTY_PARITY: 1426 case TTY_FRAME: 1427 n_tty_receive_parity_error(tty, c); 1428 break; 1429 case TTY_OVERRUN: 1430 n_tty_receive_overrun(tty); 1431 break; 1432 default: 1433 tty_err(tty, "unknown flag %d\n", flag); 1434 break; 1435 } 1436 } 1437 1438 static void 1439 n_tty_receive_char_lnext(struct tty_struct *tty, unsigned char c, char flag) 1440 { 1441 struct n_tty_data *ldata = tty->disc_data; 1442 1443 ldata->lnext = 0; 1444 if (likely(flag == TTY_NORMAL)) { 1445 if (I_ISTRIP(tty)) 1446 c &= 0x7f; 1447 if (I_IUCLC(tty) && L_IEXTEN(tty)) 1448 c = tolower(c); 1449 n_tty_receive_char(tty, c); 1450 } else 1451 n_tty_receive_char_flagged(tty, c, flag); 1452 } 1453 1454 static void 1455 n_tty_receive_buf_real_raw(struct tty_struct *tty, const unsigned char *cp, 1456 const char *fp, int count) 1457 { 1458 struct n_tty_data *ldata = tty->disc_data; 1459 size_t n, head; 1460 1461 head = ldata->read_head & (N_TTY_BUF_SIZE - 1); 1462 n = min_t(size_t, count, N_TTY_BUF_SIZE - head); 1463 memcpy(read_buf_addr(ldata, head), cp, n); 1464 ldata->read_head += n; 1465 cp += n; 1466 count -= n; 1467 1468 head = ldata->read_head & (N_TTY_BUF_SIZE - 1); 1469 n = min_t(size_t, count, N_TTY_BUF_SIZE - head); 1470 memcpy(read_buf_addr(ldata, head), cp, n); 1471 ldata->read_head += n; 1472 } 1473 1474 static void 1475 n_tty_receive_buf_raw(struct tty_struct *tty, const unsigned char *cp, 1476 const char *fp, int count) 1477 { 1478 struct n_tty_data *ldata = tty->disc_data; 1479 char flag = TTY_NORMAL; 1480 1481 while (count--) { 1482 if (fp) 1483 flag = *fp++; 1484 if (likely(flag == TTY_NORMAL)) 1485 put_tty_queue(*cp++, ldata); 1486 else 1487 n_tty_receive_char_flagged(tty, *cp++, flag); 1488 } 1489 } 1490 1491 static void 1492 n_tty_receive_buf_closing(struct tty_struct *tty, const unsigned char *cp, 1493 const char *fp, int count) 1494 { 1495 char flag = TTY_NORMAL; 1496 1497 while (count--) { 1498 if (fp) 1499 flag = *fp++; 1500 if (likely(flag == TTY_NORMAL)) 1501 n_tty_receive_char_closing(tty, *cp++); 1502 } 1503 } 1504 1505 static void n_tty_receive_buf_standard(struct tty_struct *tty, 1506 const unsigned char *cp, const char *fp, int count) 1507 { 1508 struct n_tty_data *ldata = tty->disc_data; 1509 char flag = TTY_NORMAL; 1510 1511 while (count--) { 1512 unsigned char c = *cp++; 1513 1514 if (fp) 1515 flag = *fp++; 1516 1517 if (ldata->lnext) { 1518 n_tty_receive_char_lnext(tty, c, flag); 1519 continue; 1520 } 1521 1522 if (unlikely(flag != TTY_NORMAL)) { 1523 n_tty_receive_char_flagged(tty, c, flag); 1524 continue; 1525 } 1526 1527 if (I_ISTRIP(tty)) 1528 c &= 0x7f; 1529 if (I_IUCLC(tty) && L_IEXTEN(tty)) 1530 c = tolower(c); 1531 if (L_EXTPROC(tty)) { 1532 put_tty_queue(c, ldata); 1533 continue; 1534 } 1535 1536 if (test_bit(c, ldata->char_map)) 1537 n_tty_receive_char_special(tty, c); 1538 else 1539 n_tty_receive_char(tty, c); 1540 } 1541 } 1542 1543 static void __receive_buf(struct tty_struct *tty, const unsigned char *cp, 1544 const char *fp, int count) 1545 { 1546 struct n_tty_data *ldata = tty->disc_data; 1547 bool preops = I_ISTRIP(tty) || (I_IUCLC(tty) && L_IEXTEN(tty)); 1548 1549 if (ldata->real_raw) 1550 n_tty_receive_buf_real_raw(tty, cp, fp, count); 1551 else if (ldata->raw || (L_EXTPROC(tty) && !preops)) 1552 n_tty_receive_buf_raw(tty, cp, fp, count); 1553 else if (tty->closing && !L_EXTPROC(tty)) 1554 n_tty_receive_buf_closing(tty, cp, fp, count); 1555 else { 1556 n_tty_receive_buf_standard(tty, cp, fp, count); 1557 1558 flush_echoes(tty); 1559 if (tty->ops->flush_chars) 1560 tty->ops->flush_chars(tty); 1561 } 1562 1563 if (ldata->icanon && !L_EXTPROC(tty)) 1564 return; 1565 1566 /* publish read_head to consumer */ 1567 smp_store_release(&ldata->commit_head, ldata->read_head); 1568 1569 if (read_cnt(ldata)) { 1570 kill_fasync(&tty->fasync, SIGIO, POLL_IN); 1571 wake_up_interruptible_poll(&tty->read_wait, EPOLLIN | EPOLLRDNORM); 1572 } 1573 } 1574 1575 /** 1576 * n_tty_receive_buf_common - process input 1577 * @tty: device to receive input 1578 * @cp: input chars 1579 * @fp: flags for each char (if %NULL, all chars are %TTY_NORMAL) 1580 * @count: number of input chars in @cp 1581 * @flow: enable flow control 1582 * 1583 * Called by the terminal driver when a block of characters has been received. 1584 * This function must be called from soft contexts not from interrupt context. 1585 * The driver is responsible for making calls one at a time and in order (or 1586 * using flush_to_ldisc()). 1587 * 1588 * Returns: the # of input chars from @cp which were processed. 1589 * 1590 * In canonical mode, the maximum line length is 4096 chars (including the line 1591 * termination char); lines longer than 4096 chars are truncated. After 4095 1592 * chars, input data is still processed but not stored. Overflow processing 1593 * ensures the tty can always receive more input until at least one line can be 1594 * read. 1595 * 1596 * In non-canonical mode, the read buffer will only accept 4095 chars; this 1597 * provides the necessary space for a newline char if the input mode is 1598 * switched to canonical. 1599 * 1600 * Note it is possible for the read buffer to _contain_ 4096 chars in 1601 * non-canonical mode: the read buffer could already contain the maximum canon 1602 * line of 4096 chars when the mode is switched to non-canonical. 1603 * 1604 * Locking: n_tty_receive_buf()/producer path: 1605 * claims non-exclusive %termios_rwsem 1606 * publishes commit_head or canon_head 1607 */ 1608 static int 1609 n_tty_receive_buf_common(struct tty_struct *tty, const unsigned char *cp, 1610 const char *fp, int count, int flow) 1611 { 1612 struct n_tty_data *ldata = tty->disc_data; 1613 int room, n, rcvd = 0, overflow; 1614 1615 down_read(&tty->termios_rwsem); 1616 1617 do { 1618 /* 1619 * When PARMRK is set, each input char may take up to 3 chars 1620 * in the read buf; reduce the buffer space avail by 3x 1621 * 1622 * If we are doing input canonicalization, and there are no 1623 * pending newlines, let characters through without limit, so 1624 * that erase characters will be handled. Other excess 1625 * characters will be beeped. 1626 * 1627 * paired with store in *_copy_from_read_buf() -- guarantees 1628 * the consumer has loaded the data in read_buf up to the new 1629 * read_tail (so this producer will not overwrite unread data) 1630 */ 1631 size_t tail = smp_load_acquire(&ldata->read_tail); 1632 1633 room = N_TTY_BUF_SIZE - (ldata->read_head - tail); 1634 if (I_PARMRK(tty)) 1635 room = (room + 2) / 3; 1636 room--; 1637 if (room <= 0) { 1638 overflow = ldata->icanon && ldata->canon_head == tail; 1639 if (overflow && room < 0) 1640 ldata->read_head--; 1641 room = overflow; 1642 ldata->no_room = flow && !room; 1643 } else 1644 overflow = 0; 1645 1646 n = min(count, room); 1647 if (!n) 1648 break; 1649 1650 /* ignore parity errors if handling overflow */ 1651 if (!overflow || !fp || *fp != TTY_PARITY) 1652 __receive_buf(tty, cp, fp, n); 1653 1654 cp += n; 1655 if (fp) 1656 fp += n; 1657 count -= n; 1658 rcvd += n; 1659 } while (!test_bit(TTY_LDISC_CHANGING, &tty->flags)); 1660 1661 tty->receive_room = room; 1662 1663 /* Unthrottle if handling overflow on pty */ 1664 if (tty->driver->type == TTY_DRIVER_TYPE_PTY) { 1665 if (overflow) { 1666 tty_set_flow_change(tty, TTY_UNTHROTTLE_SAFE); 1667 tty_unthrottle_safe(tty); 1668 __tty_set_flow_change(tty, 0); 1669 } 1670 } else 1671 n_tty_check_throttle(tty); 1672 1673 up_read(&tty->termios_rwsem); 1674 1675 return rcvd; 1676 } 1677 1678 static void n_tty_receive_buf(struct tty_struct *tty, const unsigned char *cp, 1679 const char *fp, int count) 1680 { 1681 n_tty_receive_buf_common(tty, cp, fp, count, 0); 1682 } 1683 1684 static int n_tty_receive_buf2(struct tty_struct *tty, const unsigned char *cp, 1685 const char *fp, int count) 1686 { 1687 return n_tty_receive_buf_common(tty, cp, fp, count, 1); 1688 } 1689 1690 /** 1691 * n_tty_set_termios - termios data changed 1692 * @tty: terminal 1693 * @old: previous data 1694 * 1695 * Called by the tty layer when the user changes termios flags so that the line 1696 * discipline can plan ahead. This function cannot sleep and is protected from 1697 * re-entry by the tty layer. The user is guaranteed that this function will 1698 * not be re-entered or in progress when the ldisc is closed. 1699 * 1700 * Locking: Caller holds @tty->termios_rwsem 1701 */ 1702 static void n_tty_set_termios(struct tty_struct *tty, struct ktermios *old) 1703 { 1704 struct n_tty_data *ldata = tty->disc_data; 1705 1706 if (!old || (old->c_lflag ^ tty->termios.c_lflag) & (ICANON | EXTPROC)) { 1707 bitmap_zero(ldata->read_flags, N_TTY_BUF_SIZE); 1708 ldata->line_start = ldata->read_tail; 1709 if (!L_ICANON(tty) || !read_cnt(ldata)) { 1710 ldata->canon_head = ldata->read_tail; 1711 ldata->push = 0; 1712 } else { 1713 set_bit((ldata->read_head - 1) & (N_TTY_BUF_SIZE - 1), 1714 ldata->read_flags); 1715 ldata->canon_head = ldata->read_head; 1716 ldata->push = 1; 1717 } 1718 ldata->commit_head = ldata->read_head; 1719 ldata->erasing = 0; 1720 ldata->lnext = 0; 1721 } 1722 1723 ldata->icanon = (L_ICANON(tty) != 0); 1724 1725 if (I_ISTRIP(tty) || I_IUCLC(tty) || I_IGNCR(tty) || 1726 I_ICRNL(tty) || I_INLCR(tty) || L_ICANON(tty) || 1727 I_IXON(tty) || L_ISIG(tty) || L_ECHO(tty) || 1728 I_PARMRK(tty)) { 1729 bitmap_zero(ldata->char_map, 256); 1730 1731 if (I_IGNCR(tty) || I_ICRNL(tty)) 1732 set_bit('\r', ldata->char_map); 1733 if (I_INLCR(tty)) 1734 set_bit('\n', ldata->char_map); 1735 1736 if (L_ICANON(tty)) { 1737 set_bit(ERASE_CHAR(tty), ldata->char_map); 1738 set_bit(KILL_CHAR(tty), ldata->char_map); 1739 set_bit(EOF_CHAR(tty), ldata->char_map); 1740 set_bit('\n', ldata->char_map); 1741 set_bit(EOL_CHAR(tty), ldata->char_map); 1742 if (L_IEXTEN(tty)) { 1743 set_bit(WERASE_CHAR(tty), ldata->char_map); 1744 set_bit(LNEXT_CHAR(tty), ldata->char_map); 1745 set_bit(EOL2_CHAR(tty), ldata->char_map); 1746 if (L_ECHO(tty)) 1747 set_bit(REPRINT_CHAR(tty), 1748 ldata->char_map); 1749 } 1750 } 1751 if (I_IXON(tty)) { 1752 set_bit(START_CHAR(tty), ldata->char_map); 1753 set_bit(STOP_CHAR(tty), ldata->char_map); 1754 } 1755 if (L_ISIG(tty)) { 1756 set_bit(INTR_CHAR(tty), ldata->char_map); 1757 set_bit(QUIT_CHAR(tty), ldata->char_map); 1758 set_bit(SUSP_CHAR(tty), ldata->char_map); 1759 } 1760 clear_bit(__DISABLED_CHAR, ldata->char_map); 1761 ldata->raw = 0; 1762 ldata->real_raw = 0; 1763 } else { 1764 ldata->raw = 1; 1765 if ((I_IGNBRK(tty) || (!I_BRKINT(tty) && !I_PARMRK(tty))) && 1766 (I_IGNPAR(tty) || !I_INPCK(tty)) && 1767 (tty->driver->flags & TTY_DRIVER_REAL_RAW)) 1768 ldata->real_raw = 1; 1769 else 1770 ldata->real_raw = 0; 1771 } 1772 /* 1773 * Fix tty hang when I_IXON(tty) is cleared, but the tty 1774 * been stopped by STOP_CHAR(tty) before it. 1775 */ 1776 if (!I_IXON(tty) && old && (old->c_iflag & IXON) && !tty->flow.tco_stopped) { 1777 start_tty(tty); 1778 process_echoes(tty); 1779 } 1780 1781 /* The termios change make the tty ready for I/O */ 1782 wake_up_interruptible(&tty->write_wait); 1783 wake_up_interruptible(&tty->read_wait); 1784 } 1785 1786 /** 1787 * n_tty_close - close the ldisc for this tty 1788 * @tty: device 1789 * 1790 * Called from the terminal layer when this line discipline is being shut down, 1791 * either because of a close or becsuse of a discipline change. The function 1792 * will not be called while other ldisc methods are in progress. 1793 */ 1794 static void n_tty_close(struct tty_struct *tty) 1795 { 1796 struct n_tty_data *ldata = tty->disc_data; 1797 1798 if (tty->link) 1799 n_tty_packet_mode_flush(tty); 1800 1801 down_write(&tty->termios_rwsem); 1802 vfree(ldata); 1803 tty->disc_data = NULL; 1804 up_write(&tty->termios_rwsem); 1805 } 1806 1807 /** 1808 * n_tty_open - open an ldisc 1809 * @tty: terminal to open 1810 * 1811 * Called when this line discipline is being attached to the terminal device. 1812 * Can sleep. Called serialized so that no other events will occur in parallel. 1813 * No further open will occur until a close. 1814 */ 1815 static int n_tty_open(struct tty_struct *tty) 1816 { 1817 struct n_tty_data *ldata; 1818 1819 /* Currently a malloc failure here can panic */ 1820 ldata = vzalloc(sizeof(*ldata)); 1821 if (!ldata) 1822 return -ENOMEM; 1823 1824 ldata->overrun_time = jiffies; 1825 mutex_init(&ldata->atomic_read_lock); 1826 mutex_init(&ldata->output_lock); 1827 1828 tty->disc_data = ldata; 1829 tty->closing = 0; 1830 /* indicate buffer work may resume */ 1831 clear_bit(TTY_LDISC_HALTED, &tty->flags); 1832 n_tty_set_termios(tty, NULL); 1833 tty_unthrottle(tty); 1834 return 0; 1835 } 1836 1837 static inline int input_available_p(struct tty_struct *tty, int poll) 1838 { 1839 struct n_tty_data *ldata = tty->disc_data; 1840 int amt = poll && !TIME_CHAR(tty) && MIN_CHAR(tty) ? MIN_CHAR(tty) : 1; 1841 1842 if (ldata->icanon && !L_EXTPROC(tty)) 1843 return ldata->canon_head != ldata->read_tail; 1844 else 1845 return ldata->commit_head - ldata->read_tail >= amt; 1846 } 1847 1848 /** 1849 * copy_from_read_buf - copy read data directly 1850 * @tty: terminal device 1851 * @kbp: data 1852 * @nr: size of data 1853 * 1854 * Helper function to speed up n_tty_read(). It is only called when %ICANON is 1855 * off; it copies characters straight from the tty queue. 1856 * 1857 * Returns: true if it successfully copied data, but there is still more data 1858 * to be had. 1859 * 1860 * Locking: 1861 * * called under the @ldata->atomic_read_lock sem 1862 * * n_tty_read()/consumer path: 1863 * caller holds non-exclusive %termios_rwsem; 1864 * read_tail published 1865 */ 1866 static bool copy_from_read_buf(struct tty_struct *tty, 1867 unsigned char **kbp, 1868 size_t *nr) 1869 1870 { 1871 struct n_tty_data *ldata = tty->disc_data; 1872 size_t n; 1873 bool is_eof; 1874 size_t head = smp_load_acquire(&ldata->commit_head); 1875 size_t tail = ldata->read_tail & (N_TTY_BUF_SIZE - 1); 1876 1877 n = min(head - ldata->read_tail, N_TTY_BUF_SIZE - tail); 1878 n = min(*nr, n); 1879 if (n) { 1880 unsigned char *from = read_buf_addr(ldata, tail); 1881 memcpy(*kbp, from, n); 1882 is_eof = n == 1 && *from == EOF_CHAR(tty); 1883 tty_audit_add_data(tty, from, n); 1884 zero_buffer(tty, from, n); 1885 smp_store_release(&ldata->read_tail, ldata->read_tail + n); 1886 /* Turn single EOF into zero-length read */ 1887 if (L_EXTPROC(tty) && ldata->icanon && is_eof && 1888 (head == ldata->read_tail)) 1889 return false; 1890 *kbp += n; 1891 *nr -= n; 1892 1893 /* If we have more to copy, let the caller know */ 1894 return head != ldata->read_tail; 1895 } 1896 return false; 1897 } 1898 1899 /** 1900 * canon_copy_from_read_buf - copy read data in canonical mode 1901 * @tty: terminal device 1902 * @kbp: data 1903 * @nr: size of data 1904 * 1905 * Helper function for n_tty_read(). It is only called when %ICANON is on; it 1906 * copies one line of input up to and including the line-delimiting character 1907 * into the result buffer. 1908 * 1909 * Note: When termios is changed from non-canonical to canonical mode and the 1910 * read buffer contains data, n_tty_set_termios() simulates an EOF push (as if 1911 * C-d were input) _without_ the %DISABLED_CHAR in the buffer. This causes data 1912 * already processed as input to be immediately available as input although a 1913 * newline has not been received. 1914 * 1915 * Locking: 1916 * * called under the %atomic_read_lock mutex 1917 * * n_tty_read()/consumer path: 1918 * caller holds non-exclusive %termios_rwsem; 1919 * read_tail published 1920 */ 1921 static bool canon_copy_from_read_buf(struct tty_struct *tty, 1922 unsigned char **kbp, 1923 size_t *nr) 1924 { 1925 struct n_tty_data *ldata = tty->disc_data; 1926 size_t n, size, more, c; 1927 size_t eol; 1928 size_t tail, canon_head; 1929 int found = 0; 1930 1931 /* N.B. avoid overrun if nr == 0 */ 1932 if (!*nr) 1933 return false; 1934 1935 canon_head = smp_load_acquire(&ldata->canon_head); 1936 n = min(*nr, canon_head - ldata->read_tail); 1937 1938 tail = ldata->read_tail & (N_TTY_BUF_SIZE - 1); 1939 size = min_t(size_t, tail + n, N_TTY_BUF_SIZE); 1940 1941 n_tty_trace("%s: nr:%zu tail:%zu n:%zu size:%zu\n", 1942 __func__, *nr, tail, n, size); 1943 1944 eol = find_next_bit(ldata->read_flags, size, tail); 1945 more = n - (size - tail); 1946 if (eol == N_TTY_BUF_SIZE && more) { 1947 /* scan wrapped without finding set bit */ 1948 eol = find_first_bit(ldata->read_flags, more); 1949 found = eol != more; 1950 } else 1951 found = eol != size; 1952 1953 n = eol - tail; 1954 if (n > N_TTY_BUF_SIZE) 1955 n += N_TTY_BUF_SIZE; 1956 c = n + found; 1957 1958 if (!found || read_buf(ldata, eol) != __DISABLED_CHAR) 1959 n = c; 1960 1961 n_tty_trace("%s: eol:%zu found:%d n:%zu c:%zu tail:%zu more:%zu\n", 1962 __func__, eol, found, n, c, tail, more); 1963 1964 tty_copy(tty, *kbp, tail, n); 1965 *kbp += n; 1966 *nr -= n; 1967 1968 if (found) 1969 clear_bit(eol, ldata->read_flags); 1970 smp_store_release(&ldata->read_tail, ldata->read_tail + c); 1971 1972 if (found) { 1973 if (!ldata->push) 1974 ldata->line_start = ldata->read_tail; 1975 else 1976 ldata->push = 0; 1977 tty_audit_push(); 1978 return false; 1979 } 1980 1981 /* No EOL found - do a continuation retry if there is more data */ 1982 return ldata->read_tail != canon_head; 1983 } 1984 1985 /* 1986 * If we finished a read at the exact location of an 1987 * EOF (special EOL character that's a __DISABLED_CHAR) 1988 * in the stream, silently eat the EOF. 1989 */ 1990 static void canon_skip_eof(struct tty_struct *tty) 1991 { 1992 struct n_tty_data *ldata = tty->disc_data; 1993 size_t tail, canon_head; 1994 1995 canon_head = smp_load_acquire(&ldata->canon_head); 1996 tail = ldata->read_tail; 1997 1998 // No data? 1999 if (tail == canon_head) 2000 return; 2001 2002 // See if the tail position is EOF in the circular buffer 2003 tail &= (N_TTY_BUF_SIZE - 1); 2004 if (!test_bit(tail, ldata->read_flags)) 2005 return; 2006 if (read_buf(ldata, tail) != __DISABLED_CHAR) 2007 return; 2008 2009 // Clear the EOL bit, skip the EOF char. 2010 clear_bit(tail, ldata->read_flags); 2011 smp_store_release(&ldata->read_tail, ldata->read_tail + 1); 2012 } 2013 2014 /** 2015 * job_control - check job control 2016 * @tty: tty 2017 * @file: file handle 2018 * 2019 * Perform job control management checks on this @file/@tty descriptor and if 2020 * appropriate send any needed signals and return a negative error code if 2021 * action should be taken. 2022 * 2023 * Locking: 2024 * * redirected write test is safe 2025 * * current->signal->tty check is safe 2026 * * ctrl.lock to safely reference @tty->ctrl.pgrp 2027 */ 2028 static int job_control(struct tty_struct *tty, struct file *file) 2029 { 2030 /* Job control check -- must be done at start and after 2031 every sleep (POSIX.1 7.1.1.4). */ 2032 /* NOTE: not yet done after every sleep pending a thorough 2033 check of the logic of this change. -- jlc */ 2034 /* don't stop on /dev/console */ 2035 if (file->f_op->write_iter == redirected_tty_write) 2036 return 0; 2037 2038 return __tty_check_change(tty, SIGTTIN); 2039 } 2040 2041 2042 /** 2043 * n_tty_read - read function for tty 2044 * @tty: tty device 2045 * @file: file object 2046 * @kbuf: kernelspace buffer pointer 2047 * @nr: size of I/O 2048 * @cookie: if non-%NULL, this is a continuation read 2049 * @offset: where to continue reading from (unused in n_tty) 2050 * 2051 * Perform reads for the line discipline. We are guaranteed that the line 2052 * discipline will not be closed under us but we may get multiple parallel 2053 * readers and must handle this ourselves. We may also get a hangup. Always 2054 * called in user context, may sleep. 2055 * 2056 * This code must be sure never to sleep through a hangup. 2057 * 2058 * Locking: n_tty_read()/consumer path: 2059 * claims non-exclusive termios_rwsem; 2060 * publishes read_tail 2061 */ 2062 static ssize_t n_tty_read(struct tty_struct *tty, struct file *file, 2063 unsigned char *kbuf, size_t nr, 2064 void **cookie, unsigned long offset) 2065 { 2066 struct n_tty_data *ldata = tty->disc_data; 2067 unsigned char *kb = kbuf; 2068 DEFINE_WAIT_FUNC(wait, woken_wake_function); 2069 int c; 2070 int minimum, time; 2071 ssize_t retval = 0; 2072 long timeout; 2073 bool packet; 2074 size_t tail; 2075 2076 /* 2077 * Is this a continuation of a read started earler? 2078 * 2079 * If so, we still hold the atomic_read_lock and the 2080 * termios_rwsem, and can just continue to copy data. 2081 */ 2082 if (*cookie) { 2083 if (ldata->icanon && !L_EXTPROC(tty)) { 2084 /* 2085 * If we have filled the user buffer, see 2086 * if we should skip an EOF character before 2087 * releasing the lock and returning done. 2088 */ 2089 if (!nr) 2090 canon_skip_eof(tty); 2091 else if (canon_copy_from_read_buf(tty, &kb, &nr)) 2092 return kb - kbuf; 2093 } else { 2094 if (copy_from_read_buf(tty, &kb, &nr)) 2095 return kb - kbuf; 2096 } 2097 2098 /* No more data - release locks and stop retries */ 2099 n_tty_kick_worker(tty); 2100 n_tty_check_unthrottle(tty); 2101 up_read(&tty->termios_rwsem); 2102 mutex_unlock(&ldata->atomic_read_lock); 2103 *cookie = NULL; 2104 return kb - kbuf; 2105 } 2106 2107 c = job_control(tty, file); 2108 if (c < 0) 2109 return c; 2110 2111 /* 2112 * Internal serialization of reads. 2113 */ 2114 if (file->f_flags & O_NONBLOCK) { 2115 if (!mutex_trylock(&ldata->atomic_read_lock)) 2116 return -EAGAIN; 2117 } else { 2118 if (mutex_lock_interruptible(&ldata->atomic_read_lock)) 2119 return -ERESTARTSYS; 2120 } 2121 2122 down_read(&tty->termios_rwsem); 2123 2124 minimum = time = 0; 2125 timeout = MAX_SCHEDULE_TIMEOUT; 2126 if (!ldata->icanon) { 2127 minimum = MIN_CHAR(tty); 2128 if (minimum) { 2129 time = (HZ / 10) * TIME_CHAR(tty); 2130 } else { 2131 timeout = (HZ / 10) * TIME_CHAR(tty); 2132 minimum = 1; 2133 } 2134 } 2135 2136 packet = tty->ctrl.packet; 2137 tail = ldata->read_tail; 2138 2139 add_wait_queue(&tty->read_wait, &wait); 2140 while (nr) { 2141 /* First test for status change. */ 2142 if (packet && tty->link->ctrl.pktstatus) { 2143 unsigned char cs; 2144 if (kb != kbuf) 2145 break; 2146 spin_lock_irq(&tty->link->ctrl.lock); 2147 cs = tty->link->ctrl.pktstatus; 2148 tty->link->ctrl.pktstatus = 0; 2149 spin_unlock_irq(&tty->link->ctrl.lock); 2150 *kb++ = cs; 2151 nr--; 2152 break; 2153 } 2154 2155 if (!input_available_p(tty, 0)) { 2156 up_read(&tty->termios_rwsem); 2157 tty_buffer_flush_work(tty->port); 2158 down_read(&tty->termios_rwsem); 2159 if (!input_available_p(tty, 0)) { 2160 if (test_bit(TTY_OTHER_CLOSED, &tty->flags)) { 2161 retval = -EIO; 2162 break; 2163 } 2164 if (tty_hung_up_p(file)) 2165 break; 2166 /* 2167 * Abort readers for ttys which never actually 2168 * get hung up. See __tty_hangup(). 2169 */ 2170 if (test_bit(TTY_HUPPING, &tty->flags)) 2171 break; 2172 if (!timeout) 2173 break; 2174 if (tty_io_nonblock(tty, file)) { 2175 retval = -EAGAIN; 2176 break; 2177 } 2178 if (signal_pending(current)) { 2179 retval = -ERESTARTSYS; 2180 break; 2181 } 2182 up_read(&tty->termios_rwsem); 2183 2184 timeout = wait_woken(&wait, TASK_INTERRUPTIBLE, 2185 timeout); 2186 2187 down_read(&tty->termios_rwsem); 2188 continue; 2189 } 2190 } 2191 2192 if (ldata->icanon && !L_EXTPROC(tty)) { 2193 if (canon_copy_from_read_buf(tty, &kb, &nr)) 2194 goto more_to_be_read; 2195 } else { 2196 /* Deal with packet mode. */ 2197 if (packet && kb == kbuf) { 2198 *kb++ = TIOCPKT_DATA; 2199 nr--; 2200 } 2201 2202 /* 2203 * Copy data, and if there is more to be had 2204 * and we have nothing more to wait for, then 2205 * let's mark us for retries. 2206 * 2207 * NOTE! We return here with both the termios_sem 2208 * and atomic_read_lock still held, the retries 2209 * will release them when done. 2210 */ 2211 if (copy_from_read_buf(tty, &kb, &nr) && kb - kbuf >= minimum) { 2212 more_to_be_read: 2213 remove_wait_queue(&tty->read_wait, &wait); 2214 *cookie = cookie; 2215 return kb - kbuf; 2216 } 2217 } 2218 2219 n_tty_check_unthrottle(tty); 2220 2221 if (kb - kbuf >= minimum) 2222 break; 2223 if (time) 2224 timeout = time; 2225 } 2226 if (tail != ldata->read_tail) 2227 n_tty_kick_worker(tty); 2228 up_read(&tty->termios_rwsem); 2229 2230 remove_wait_queue(&tty->read_wait, &wait); 2231 mutex_unlock(&ldata->atomic_read_lock); 2232 2233 if (kb - kbuf) 2234 retval = kb - kbuf; 2235 2236 return retval; 2237 } 2238 2239 /** 2240 * n_tty_write - write function for tty 2241 * @tty: tty device 2242 * @file: file object 2243 * @buf: userspace buffer pointer 2244 * @nr: size of I/O 2245 * 2246 * Write function of the terminal device. This is serialized with respect to 2247 * other write callers but not to termios changes, reads and other such events. 2248 * Since the receive code will echo characters, thus calling driver write 2249 * methods, the %output_lock is used in the output processing functions called 2250 * here as well as in the echo processing function to protect the column state 2251 * and space left in the buffer. 2252 * 2253 * This code must be sure never to sleep through a hangup. 2254 * 2255 * Locking: output_lock to protect column state and space left 2256 * (note that the process_output*() functions take this lock themselves) 2257 */ 2258 2259 static ssize_t n_tty_write(struct tty_struct *tty, struct file *file, 2260 const unsigned char *buf, size_t nr) 2261 { 2262 const unsigned char *b = buf; 2263 DEFINE_WAIT_FUNC(wait, woken_wake_function); 2264 int c; 2265 ssize_t retval = 0; 2266 2267 /* Job control check -- must be done at start (POSIX.1 7.1.1.4). */ 2268 if (L_TOSTOP(tty) && file->f_op->write_iter != redirected_tty_write) { 2269 retval = tty_check_change(tty); 2270 if (retval) 2271 return retval; 2272 } 2273 2274 down_read(&tty->termios_rwsem); 2275 2276 /* Write out any echoed characters that are still pending */ 2277 process_echoes(tty); 2278 2279 add_wait_queue(&tty->write_wait, &wait); 2280 while (1) { 2281 if (signal_pending(current)) { 2282 retval = -ERESTARTSYS; 2283 break; 2284 } 2285 if (tty_hung_up_p(file) || (tty->link && !tty->link->count)) { 2286 retval = -EIO; 2287 break; 2288 } 2289 if (O_OPOST(tty)) { 2290 while (nr > 0) { 2291 ssize_t num = process_output_block(tty, b, nr); 2292 if (num < 0) { 2293 if (num == -EAGAIN) 2294 break; 2295 retval = num; 2296 goto break_out; 2297 } 2298 b += num; 2299 nr -= num; 2300 if (nr == 0) 2301 break; 2302 c = *b; 2303 if (process_output(c, tty) < 0) 2304 break; 2305 b++; nr--; 2306 } 2307 if (tty->ops->flush_chars) 2308 tty->ops->flush_chars(tty); 2309 } else { 2310 struct n_tty_data *ldata = tty->disc_data; 2311 2312 while (nr > 0) { 2313 mutex_lock(&ldata->output_lock); 2314 c = tty->ops->write(tty, b, nr); 2315 mutex_unlock(&ldata->output_lock); 2316 if (c < 0) { 2317 retval = c; 2318 goto break_out; 2319 } 2320 if (!c) 2321 break; 2322 b += c; 2323 nr -= c; 2324 } 2325 } 2326 if (!nr) 2327 break; 2328 if (tty_io_nonblock(tty, file)) { 2329 retval = -EAGAIN; 2330 break; 2331 } 2332 up_read(&tty->termios_rwsem); 2333 2334 wait_woken(&wait, TASK_INTERRUPTIBLE, MAX_SCHEDULE_TIMEOUT); 2335 2336 down_read(&tty->termios_rwsem); 2337 } 2338 break_out: 2339 remove_wait_queue(&tty->write_wait, &wait); 2340 if (nr && tty->fasync) 2341 set_bit(TTY_DO_WRITE_WAKEUP, &tty->flags); 2342 up_read(&tty->termios_rwsem); 2343 return (b - buf) ? b - buf : retval; 2344 } 2345 2346 /** 2347 * n_tty_poll - poll method for N_TTY 2348 * @tty: terminal device 2349 * @file: file accessing it 2350 * @wait: poll table 2351 * 2352 * Called when the line discipline is asked to poll() for data or for special 2353 * events. This code is not serialized with respect to other events save 2354 * open/close. 2355 * 2356 * This code must be sure never to sleep through a hangup. 2357 * 2358 * Locking: called without the kernel lock held -- fine. 2359 */ 2360 static __poll_t n_tty_poll(struct tty_struct *tty, struct file *file, 2361 poll_table *wait) 2362 { 2363 __poll_t mask = 0; 2364 2365 poll_wait(file, &tty->read_wait, wait); 2366 poll_wait(file, &tty->write_wait, wait); 2367 if (input_available_p(tty, 1)) 2368 mask |= EPOLLIN | EPOLLRDNORM; 2369 else { 2370 tty_buffer_flush_work(tty->port); 2371 if (input_available_p(tty, 1)) 2372 mask |= EPOLLIN | EPOLLRDNORM; 2373 } 2374 if (tty->ctrl.packet && tty->link->ctrl.pktstatus) 2375 mask |= EPOLLPRI | EPOLLIN | EPOLLRDNORM; 2376 if (test_bit(TTY_OTHER_CLOSED, &tty->flags)) 2377 mask |= EPOLLHUP; 2378 if (tty_hung_up_p(file)) 2379 mask |= EPOLLHUP; 2380 if (tty->ops->write && !tty_is_writelocked(tty) && 2381 tty_chars_in_buffer(tty) < WAKEUP_CHARS && 2382 tty_write_room(tty) > 0) 2383 mask |= EPOLLOUT | EPOLLWRNORM; 2384 return mask; 2385 } 2386 2387 static unsigned long inq_canon(struct n_tty_data *ldata) 2388 { 2389 size_t nr, head, tail; 2390 2391 if (ldata->canon_head == ldata->read_tail) 2392 return 0; 2393 head = ldata->canon_head; 2394 tail = ldata->read_tail; 2395 nr = head - tail; 2396 /* Skip EOF-chars.. */ 2397 while (MASK(head) != MASK(tail)) { 2398 if (test_bit(tail & (N_TTY_BUF_SIZE - 1), ldata->read_flags) && 2399 read_buf(ldata, tail) == __DISABLED_CHAR) 2400 nr--; 2401 tail++; 2402 } 2403 return nr; 2404 } 2405 2406 static int n_tty_ioctl(struct tty_struct *tty, unsigned int cmd, 2407 unsigned long arg) 2408 { 2409 struct n_tty_data *ldata = tty->disc_data; 2410 int retval; 2411 2412 switch (cmd) { 2413 case TIOCOUTQ: 2414 return put_user(tty_chars_in_buffer(tty), (int __user *) arg); 2415 case TIOCINQ: 2416 down_write(&tty->termios_rwsem); 2417 if (L_ICANON(tty) && !L_EXTPROC(tty)) 2418 retval = inq_canon(ldata); 2419 else 2420 retval = read_cnt(ldata); 2421 up_write(&tty->termios_rwsem); 2422 return put_user(retval, (unsigned int __user *) arg); 2423 default: 2424 return n_tty_ioctl_helper(tty, cmd, arg); 2425 } 2426 } 2427 2428 static struct tty_ldisc_ops n_tty_ops = { 2429 .owner = THIS_MODULE, 2430 .num = N_TTY, 2431 .name = "n_tty", 2432 .open = n_tty_open, 2433 .close = n_tty_close, 2434 .flush_buffer = n_tty_flush_buffer, 2435 .read = n_tty_read, 2436 .write = n_tty_write, 2437 .ioctl = n_tty_ioctl, 2438 .set_termios = n_tty_set_termios, 2439 .poll = n_tty_poll, 2440 .receive_buf = n_tty_receive_buf, 2441 .write_wakeup = n_tty_write_wakeup, 2442 .receive_buf2 = n_tty_receive_buf2, 2443 }; 2444 2445 /** 2446 * n_tty_inherit_ops - inherit N_TTY methods 2447 * @ops: struct tty_ldisc_ops where to save N_TTY methods 2448 * 2449 * Enables a 'subclass' line discipline to 'inherit' N_TTY methods. 2450 */ 2451 2452 void n_tty_inherit_ops(struct tty_ldisc_ops *ops) 2453 { 2454 *ops = n_tty_ops; 2455 ops->owner = NULL; 2456 } 2457 EXPORT_SYMBOL_GPL(n_tty_inherit_ops); 2458 2459 void __init n_tty_init(void) 2460 { 2461 tty_register_ldisc(&n_tty_ops); 2462 } 2463