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