blob: 5793aa0d3bfb0e21445d721eb64f925fd55b1606 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * n_tty.c --- implements the N_TTY line discipline.
Alan Cox4edf1822008-02-08 04:18:44 -08003 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07004 * 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
Alan Cox4edf1822008-02-08 04:18:44 -080011 * to N_TTY if it can not switch to any other line discipline.
Linus Torvalds1da177e2005-04-16 15:20:36 -070012 *
13 * Written by Theodore Ts'o, Copyright 1994.
Alan Cox4edf1822008-02-08 04:18:44 -080014 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070015 * This file also contains code originally written by Linus Torvalds,
16 * Copyright 1991, 1992, 1993, and by Julian Cowley, Copyright 1994.
Alan Cox4edf1822008-02-08 04:18:44 -080017 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 * 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 *
Alan Cox4edf1822008-02-08 04:18:44 -080023 * 2000/01/20 Fixed SMP locking on put_tty_queue using bits of
Linus Torvalds1da177e2005-04-16 15:20:36 -070024 * 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>.
Alan Cox11a96d12008-10-13 10:46:24 +010029 * Also fixed a bug in BLOCKING mode where n_tty_write returns
Linus Torvalds1da177e2005-04-16 15:20:36 -070030 * 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>
Miloslav Trmac522ed772007-07-15 23:40:56 -070048#include <linux/audit.h>
49#include <linux/file.h>
Alan Cox300a6202009-01-02 13:41:04 +000050#include <linux/uaccess.h>
Rodolfo Giometti572b9ad2010-03-10 15:23:46 -080051#include <linux/module.h>
George Spelvin593fb1ae42013-02-12 02:00:43 -050052#include <linux/ratelimit.h>
Peter Hurley86e35ae2013-07-24 09:30:05 -040053#include <linux/vmalloc.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070054
Linus Torvalds1da177e2005-04-16 15:20:36 -070055
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 */
Thorsten Wißmannbbd20752011-12-08 17:47:33 +010065#define TTY_THRESHOLD_UNTHROTTLE 128
Linus Torvalds1da177e2005-04-16 15:20:36 -070066
Joe Petersona88a69c2009-01-02 13:40:53 +000067/*
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
Peter Hurleycbfd0342013-06-15 10:04:26 -040078#define ECHO_COMMIT_WATERMARK 256
79#define ECHO_BLOCK 256
80#define ECHO_DISCARD_WATERMARK N_TTY_BUF_SIZE - (ECHO_BLOCK + 32)
81
82
Peter Hurley32f13522013-06-15 09:14:17 -040083#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
Jiri Slaby70ece7a2012-10-18 22:26:38 +020090struct n_tty_data {
Peter Hurleyfb7aa032013-06-15 09:14:30 -040091 /* producer-published */
92 size_t read_head;
Peter Hurley70aca712015-01-16 15:05:37 -050093 size_t commit_head;
Peter Hurleyfb7aa032013-06-15 09:14:30 -040094 size_t canon_head;
Peter Hurley9dfd16d2013-06-15 10:04:29 -040095 size_t echo_head;
96 size_t echo_commit;
Peter Hurley1075a6e2013-12-09 18:06:07 -050097 size_t echo_mark;
Peter Hurley1bb9d562013-06-15 10:21:20 -040098 DECLARE_BITMAP(char_map, 256);
Peter Hurleyfb7aa032013-06-15 09:14:30 -040099
100 /* private to n_tty_receive_overrun (single-threaded) */
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200101 unsigned long overrun_time;
102 int num_overrun;
103
Peter Hurley24a89d12013-06-15 09:14:15 -0400104 /* non-atomic */
105 bool no_room;
106
Peter Hurleyfb7aa032013-06-15 09:14:30 -0400107 /* must hold exclusive termios_rwsem to reset these */
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200108 unsigned char lnext:1, erasing:1, raw:1, real_raw:1, icanon:1;
Peter Hurley4d0ed182013-12-10 17:12:02 -0500109 unsigned char push:1;
Jiri Slaby3fe780b2012-10-18 22:26:40 +0200110
Peter Hurleyfb7aa032013-06-15 09:14:30 -0400111 /* shared by producer and consumer */
Peter Hurley20bafb32013-06-15 10:21:19 -0400112 char read_buf[N_TTY_BUF_SIZE];
Jiri Slaby3fe780b2012-10-18 22:26:40 +0200113 DECLARE_BITMAP(read_flags, N_TTY_BUF_SIZE);
Peter Hurley20bafb32013-06-15 10:21:19 -0400114 unsigned char echo_buf[N_TTY_BUF_SIZE];
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200115
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -0400116 int minimum_to_wake;
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200117
Peter Hurleyfb7aa032013-06-15 09:14:30 -0400118 /* consumer-published */
119 size_t read_tail;
Peter Hurley40d5e092013-06-15 10:21:17 -0400120 size_t line_start;
Peter Hurleyfb7aa032013-06-15 09:14:30 -0400121
Peter Hurleyfb7aa032013-06-15 09:14:30 -0400122 /* protected by output lock */
123 unsigned int column;
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200124 unsigned int canon_column;
Peter Hurley9dfd16d2013-06-15 10:04:29 -0400125 size_t echo_tail;
Jiri Slabybddc7152012-10-18 22:26:42 +0200126
127 struct mutex atomic_read_lock;
128 struct mutex output_lock;
Jiri Slaby70ece7a2012-10-18 22:26:38 +0200129};
130
Peter Hurleyce741172013-06-15 09:14:20 -0400131static inline size_t read_cnt(struct n_tty_data *ldata)
132{
Peter Hurleya2f73be2013-06-15 09:14:22 -0400133 return ldata->read_head - ldata->read_tail;
Peter Hurleyce741172013-06-15 09:14:20 -0400134}
135
Peter Hurleybc5a5e32013-06-15 09:14:21 -0400136static inline unsigned char read_buf(struct n_tty_data *ldata, size_t i)
137{
138 return ldata->read_buf[i & (N_TTY_BUF_SIZE - 1)];
139}
140
141static inline unsigned char *read_buf_addr(struct n_tty_data *ldata, size_t i)
142{
143 return &ldata->read_buf[i & (N_TTY_BUF_SIZE - 1)];
144}
145
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400146static inline unsigned char echo_buf(struct n_tty_data *ldata, size_t i)
147{
148 return ldata->echo_buf[i & (N_TTY_BUF_SIZE - 1)];
149}
150
151static inline unsigned char *echo_buf_addr(struct n_tty_data *ldata, size_t i)
152{
153 return &ldata->echo_buf[i & (N_TTY_BUF_SIZE - 1)];
154}
155
Miloslav Trmac522ed772007-07-15 23:40:56 -0700156static inline int tty_put_user(struct tty_struct *tty, unsigned char x,
157 unsigned char __user *ptr)
158{
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200159 struct n_tty_data *ldata = tty->disc_data;
160
161 tty_audit_add_data(tty, &x, 1, ldata->icanon);
Miloslav Trmac522ed772007-07-15 23:40:56 -0700162 return put_user(x, ptr);
163}
164
Peter Hurley24a89d12013-06-15 09:14:15 -0400165/**
Peter Hurley2c5dc462015-01-16 15:05:34 -0500166 * n_tty_kick_worker - start input worker (if required)
Peter Hurley24a89d12013-06-15 09:14:15 -0400167 * @tty: terminal
168 *
Peter Hurley2c5dc462015-01-16 15:05:34 -0500169 * Re-schedules the flip buffer work if it may have stopped
Peter Hurley24a89d12013-06-15 09:14:15 -0400170 *
Peter Hurley6d76bd22013-06-15 09:14:26 -0400171 * Caller holds exclusive termios_rwsem
172 * or
173 * n_tty_read()/consumer path:
174 * holds non-exclusive termios_rwsem
Peter Hurley24a89d12013-06-15 09:14:15 -0400175 */
176
Peter Hurley2c5dc462015-01-16 15:05:34 -0500177static void n_tty_kick_worker(struct tty_struct *tty)
Peter Hurley7879a9f2013-06-15 07:28:31 -0400178{
Peter Hurley24a89d12013-06-15 09:14:15 -0400179 struct n_tty_data *ldata = tty->disc_data;
180
Peter Hurley2c5dc462015-01-16 15:05:34 -0500181 /* Did the input worker stop? Restart it */
182 if (unlikely(ldata->no_room)) {
Peter Hurley24a89d12013-06-15 09:14:15 -0400183 ldata->no_room = 0;
184
Jiri Slabyecbbfd42012-10-18 22:26:47 +0200185 WARN_RATELIMIT(tty->port->itty == NULL,
Sasha Levincadf7482012-10-25 14:26:35 -0400186 "scheduling with invalid itty\n");
Peter Hurley21622932013-03-11 16:44:21 -0400187 /* see if ldisc has been killed - if so, this means that
188 * even though the ldisc has been halted and ->buf.work
189 * cancelled, ->buf.work is about to be rescheduled
190 */
191 WARN_RATELIMIT(test_bit(TTY_LDISC_HALTED, &tty->flags),
192 "scheduling buffer work for halted ldisc\n");
Peter Hurleyf0f947c2013-06-15 09:14:36 -0400193 queue_work(system_unbound_wq, &tty->port->buf.work);
Jiri Slabyecbbfd42012-10-18 22:26:47 +0200194 }
Linus Torvalds55db4c62011-06-04 06:33:24 +0900195}
196
Peter Hurley9a4aec22013-06-15 09:14:32 -0400197static ssize_t chars_in_buffer(struct tty_struct *tty)
198{
199 struct n_tty_data *ldata = tty->disc_data;
200 ssize_t n = 0;
201
202 if (!ldata->icanon)
Peter Hurley70aca712015-01-16 15:05:37 -0500203 n = ldata->commit_head - ldata->read_tail;
Peter Hurley9a4aec22013-06-15 09:14:32 -0400204 else
205 n = ldata->canon_head - ldata->read_tail;
206 return n;
207}
208
Peter Hurleyee0bab82013-06-15 09:14:34 -0400209/**
210 * n_tty_write_wakeup - asynchronous I/O notifier
211 * @tty: tty device
212 *
213 * Required for the ptys, serial driver etc. since processes
214 * that attach themselves to the master and rely on ASYNC
215 * IO must be woken up
216 */
217
218static void n_tty_write_wakeup(struct tty_struct *tty)
219{
220 if (tty->fasync && test_and_clear_bit(TTY_DO_WRITE_WAKEUP, &tty->flags))
221 kill_fasync(&tty->fasync, SIGIO, POLL_OUT);
222}
223
Peter Hurley4a23a4d2013-06-15 10:21:22 -0400224static void n_tty_check_throttle(struct tty_struct *tty)
Peter Hurley6367ca72013-06-15 09:14:33 -0400225{
Peter Hurleya3428462015-01-16 15:05:35 -0500226 struct n_tty_data *ldata = tty->disc_data;
227
Peter Hurley6367ca72013-06-15 09:14:33 -0400228 /*
229 * Check the remaining room for the input canonicalization
230 * mode. We don't want to throttle the driver if we're in
231 * canonical mode and don't have a newline yet!
232 */
Peter Hurleya3428462015-01-16 15:05:35 -0500233 if (ldata->icanon && ldata->canon_head == ldata->read_tail)
234 return;
235
Peter Hurley6367ca72013-06-15 09:14:33 -0400236 while (1) {
237 int throttled;
238 tty_set_flow_change(tty, TTY_THROTTLE_SAFE);
Peter Hurley5e28cca2015-01-16 15:05:36 -0500239 if (N_TTY_BUF_SIZE - read_cnt(ldata) >= TTY_THRESHOLD_THROTTLE)
Peter Hurley6367ca72013-06-15 09:14:33 -0400240 break;
241 throttled = tty_throttle_safe(tty);
242 if (!throttled)
243 break;
244 }
245 __tty_set_flow_change(tty, 0);
246}
247
Peter Hurley4b293492013-07-24 08:29:55 -0400248static void n_tty_check_unthrottle(struct tty_struct *tty)
Peter Hurley6367ca72013-06-15 09:14:33 -0400249{
Peter Hurley3afb1b392013-07-23 08:47:30 -0400250 if (tty->driver->type == TTY_DRIVER_TYPE_PTY &&
251 tty->link->ldisc->ops->write_wakeup == n_tty_write_wakeup) {
252 if (chars_in_buffer(tty) > TTY_THRESHOLD_UNTHROTTLE)
253 return;
254 if (!tty->count)
255 return;
Peter Hurley2c5dc462015-01-16 15:05:34 -0500256 n_tty_kick_worker(tty);
Peter Hurley3afb1b392013-07-23 08:47:30 -0400257 n_tty_write_wakeup(tty->link);
Peter Hurley6c677162013-12-02 14:24:46 -0500258 if (waitqueue_active(&tty->link->write_wait))
259 wake_up_interruptible_poll(&tty->link->write_wait, POLLOUT);
Peter Hurley3afb1b392013-07-23 08:47:30 -0400260 return;
261 }
262
Peter Hurley6367ca72013-06-15 09:14:33 -0400263 /* If there is enough space in the read buffer now, let the
264 * low-level driver know. We use chars_in_buffer() to
265 * check the buffer, as it now knows about canonical mode.
266 * Otherwise, if the driver is throttled and the line is
267 * longer than TTY_THRESHOLD_UNTHROTTLE in canonical mode,
268 * we won't get any more characters.
269 */
270
271 while (1) {
272 int unthrottled;
273 tty_set_flow_change(tty, TTY_UNTHROTTLE_SAFE);
274 if (chars_in_buffer(tty) > TTY_THRESHOLD_UNTHROTTLE)
275 break;
276 if (!tty->count)
277 break;
Peter Hurley2c5dc462015-01-16 15:05:34 -0500278 n_tty_kick_worker(tty);
Peter Hurley6367ca72013-06-15 09:14:33 -0400279 unthrottled = tty_unthrottle_safe(tty);
280 if (!unthrottled)
281 break;
282 }
283 __tty_set_flow_change(tty, 0);
284}
285
Alan Cox17b82062008-10-13 10:45:06 +0100286/**
287 * put_tty_queue - add character to tty
288 * @c: character
Jiri Slaby57c94122012-10-18 22:26:43 +0200289 * @ldata: n_tty data
Alan Cox17b82062008-10-13 10:45:06 +0100290 *
Peter Hurley6d76bd22013-06-15 09:14:26 -0400291 * Add a character to the tty read_buf queue.
292 *
293 * n_tty_receive_buf()/producer path:
294 * caller holds non-exclusive termios_rwsem
Alan Cox17b82062008-10-13 10:45:06 +0100295 */
296
Peter Hurley19e2ad62013-07-24 08:29:54 -0400297static inline void put_tty_queue(unsigned char c, struct n_tty_data *ldata)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298{
Christian Riesch8bfbe2d2014-11-13 05:53:26 +0100299 *read_buf_addr(ldata, ldata->read_head) = c;
300 ldata->read_head++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301}
302
303/**
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304 * reset_buffer_flags - reset buffer state
305 * @tty: terminal to reset
306 *
Peter Hurley25518c62013-03-11 16:44:31 -0400307 * Reset the read buffer counters and clear the flags.
308 * Called from n_tty_open() and n_tty_flush_buffer().
Alan Cox17b82062008-10-13 10:45:06 +0100309 *
Peter Hurley6d76bd22013-06-15 09:14:26 -0400310 * Locking: caller holds exclusive termios_rwsem
311 * (or locking is not required)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700312 */
Joe Petersona88a69c2009-01-02 13:40:53 +0000313
Peter Hurleyb66f4fa2013-03-11 16:44:32 -0400314static void reset_buffer_flags(struct n_tty_data *ldata)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700315{
Peter Hurleya73d3d62013-06-15 09:14:25 -0400316 ldata->read_head = ldata->canon_head = ldata->read_tail = 0;
Peter Hurley17bd7902013-06-15 10:04:24 -0400317 ldata->echo_head = ldata->echo_tail = ldata->echo_commit = 0;
Peter Hurley70aca712015-01-16 15:05:37 -0500318 ldata->commit_head = 0;
Peter Hurley1075a6e2013-12-09 18:06:07 -0500319 ldata->echo_mark = 0;
Peter Hurley40d5e092013-06-15 10:21:17 -0400320 ldata->line_start = 0;
Joe Petersona88a69c2009-01-02 13:40:53 +0000321
Peter Hurleya73d3d62013-06-15 09:14:25 -0400322 ldata->erasing = 0;
Jiri Slaby3fe780b2012-10-18 22:26:40 +0200323 bitmap_zero(ldata->read_flags, N_TTY_BUF_SIZE);
Peter Hurley4d0ed182013-12-10 17:12:02 -0500324 ldata->push = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700325}
326
Peter Hurleya30737a2013-03-11 16:44:22 -0400327static void n_tty_packet_mode_flush(struct tty_struct *tty)
328{
329 unsigned long flags;
330
Peter Hurleya30737a2013-03-11 16:44:22 -0400331 if (tty->link->packet) {
Peter Hurley54e8e5f2014-10-16 15:33:26 -0400332 spin_lock_irqsave(&tty->ctrl_lock, flags);
Peter Hurleya30737a2013-03-11 16:44:22 -0400333 tty->ctrl_status |= TIOCPKT_FLUSHREAD;
Peter Hurley54e8e5f2014-10-16 15:33:26 -0400334 spin_unlock_irqrestore(&tty->ctrl_lock, flags);
Peter Hurley6c677162013-12-02 14:24:46 -0500335 if (waitqueue_active(&tty->link->read_wait))
336 wake_up_interruptible(&tty->link->read_wait);
Peter Hurleya30737a2013-03-11 16:44:22 -0400337 }
Peter Hurleya30737a2013-03-11 16:44:22 -0400338}
339
Linus Torvalds1da177e2005-04-16 15:20:36 -0700340/**
341 * n_tty_flush_buffer - clean input queue
342 * @tty: terminal device
343 *
Peter Hurley25518c62013-03-11 16:44:31 -0400344 * Flush the input buffer. Called when the tty layer wants the
345 * buffer flushed (eg at hangup) or when the N_TTY line discipline
346 * internally has to clean the pending queue (for example some signals).
Linus Torvalds1da177e2005-04-16 15:20:36 -0700347 *
Peter Hurley6d76bd22013-06-15 09:14:26 -0400348 * Holds termios_rwsem to exclude producer/consumer while
349 * buffer indices are reset.
350 *
351 * Locking: ctrl_lock, exclusive termios_rwsem
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352 */
Alan Cox4edf1822008-02-08 04:18:44 -0800353
354static void n_tty_flush_buffer(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355{
Peter Hurley6d76bd22013-06-15 09:14:26 -0400356 down_write(&tty->termios_rwsem);
Peter Hurleyb66f4fa2013-03-11 16:44:32 -0400357 reset_buffer_flags(tty->disc_data);
Peter Hurley2c5dc462015-01-16 15:05:34 -0500358 n_tty_kick_worker(tty);
Alan Cox4edf1822008-02-08 04:18:44 -0800359
Peter Hurleya30737a2013-03-11 16:44:22 -0400360 if (tty->link)
361 n_tty_packet_mode_flush(tty);
Peter Hurley6d76bd22013-06-15 09:14:26 -0400362 up_write(&tty->termios_rwsem);
363}
364
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365/**
366 * n_tty_chars_in_buffer - report available bytes
367 * @tty: tty device
368 *
369 * Report the number of characters buffered to be delivered to user
Alan Cox4edf1822008-02-08 04:18:44 -0800370 * at this instant in time.
Alan Cox17b82062008-10-13 10:45:06 +0100371 *
Peter Hurley6d76bd22013-06-15 09:14:26 -0400372 * Locking: exclusive termios_rwsem
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373 */
Alan Cox4edf1822008-02-08 04:18:44 -0800374
Peter Hurleya19d0c62013-06-15 09:14:18 -0400375static ssize_t n_tty_chars_in_buffer(struct tty_struct *tty)
376{
Peter Hurley6d76bd22013-06-15 09:14:26 -0400377 ssize_t n;
378
Peter Hurley47534082013-06-15 09:14:19 -0400379 WARN_ONCE(1, "%s is deprecated and scheduled for removal.", __func__);
Peter Hurley6d76bd22013-06-15 09:14:26 -0400380
381 down_write(&tty->termios_rwsem);
382 n = chars_in_buffer(tty);
383 up_write(&tty->termios_rwsem);
384 return n;
Peter Hurleya19d0c62013-06-15 09:14:18 -0400385}
386
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387/**
388 * is_utf8_continuation - utf8 multibyte check
389 * @c: byte to check
390 *
391 * Returns true if the utf8 character 'c' is a multibyte continuation
392 * character. We use this to correctly compute the on screen size
393 * of the character when printing
394 */
Alan Cox4edf1822008-02-08 04:18:44 -0800395
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396static inline int is_utf8_continuation(unsigned char c)
397{
398 return (c & 0xc0) == 0x80;
399}
400
401/**
402 * is_continuation - multibyte check
403 * @c: byte to check
404 *
405 * Returns true if the utf8 character 'c' is a multibyte continuation
406 * character and the terminal is in unicode mode.
407 */
Alan Cox4edf1822008-02-08 04:18:44 -0800408
Linus Torvalds1da177e2005-04-16 15:20:36 -0700409static inline int is_continuation(unsigned char c, struct tty_struct *tty)
410{
411 return I_IUTF8(tty) && is_utf8_continuation(c);
412}
413
414/**
Joe Petersona88a69c2009-01-02 13:40:53 +0000415 * do_output_char - output one character
416 * @c: character (or partial unicode symbol)
417 * @tty: terminal device
418 * @space: space available in tty driver write buffer
419 *
420 * This is a helper function that handles one output character
421 * (including special characters like TAB, CR, LF, etc.),
Joe Petersonee5aa7b2009-09-09 15:03:13 -0600422 * doing OPOST processing and putting the results in the
423 * tty driver's write buffer.
Joe Petersona88a69c2009-01-02 13:40:53 +0000424 *
425 * Note that Linux currently ignores TABDLY, CRDLY, VTDLY, FFDLY
426 * and NLDLY. They simply aren't relevant in the world today.
427 * If you ever need them, add them here.
428 *
429 * Returns the number of bytes of buffer space used or -1 if
430 * no space left.
431 *
432 * Locking: should be called under the output_lock to protect
433 * the column state and space left in the buffer
434 */
435
436static int do_output_char(unsigned char c, struct tty_struct *tty, int space)
437{
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200438 struct n_tty_data *ldata = tty->disc_data;
Joe Petersona88a69c2009-01-02 13:40:53 +0000439 int spaces;
440
441 if (!space)
442 return -1;
Alan Cox300a6202009-01-02 13:41:04 +0000443
Joe Petersona88a69c2009-01-02 13:40:53 +0000444 switch (c) {
445 case '\n':
446 if (O_ONLRET(tty))
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200447 ldata->column = 0;
Joe Petersona88a69c2009-01-02 13:40:53 +0000448 if (O_ONLCR(tty)) {
449 if (space < 2)
450 return -1;
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200451 ldata->canon_column = ldata->column = 0;
Linus Torvalds37f81fa2009-09-05 12:46:07 -0700452 tty->ops->write(tty, "\r\n", 2);
Joe Petersona88a69c2009-01-02 13:40:53 +0000453 return 2;
454 }
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200455 ldata->canon_column = ldata->column;
Joe Petersona88a69c2009-01-02 13:40:53 +0000456 break;
457 case '\r':
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200458 if (O_ONOCR(tty) && ldata->column == 0)
Joe Petersona88a69c2009-01-02 13:40:53 +0000459 return 0;
460 if (O_OCRNL(tty)) {
461 c = '\n';
462 if (O_ONLRET(tty))
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200463 ldata->canon_column = ldata->column = 0;
Joe Petersona88a69c2009-01-02 13:40:53 +0000464 break;
465 }
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200466 ldata->canon_column = ldata->column = 0;
Joe Petersona88a69c2009-01-02 13:40:53 +0000467 break;
468 case '\t':
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200469 spaces = 8 - (ldata->column & 7);
Joe Petersona88a69c2009-01-02 13:40:53 +0000470 if (O_TABDLY(tty) == XTABS) {
471 if (space < spaces)
472 return -1;
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200473 ldata->column += spaces;
Joe Petersona88a69c2009-01-02 13:40:53 +0000474 tty->ops->write(tty, " ", spaces);
475 return spaces;
476 }
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200477 ldata->column += spaces;
Joe Petersona88a69c2009-01-02 13:40:53 +0000478 break;
479 case '\b':
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200480 if (ldata->column > 0)
481 ldata->column--;
Joe Petersona88a69c2009-01-02 13:40:53 +0000482 break;
483 default:
Joe Petersona59c0d62009-01-02 13:43:25 +0000484 if (!iscntrl(c)) {
485 if (O_OLCUC(tty))
486 c = toupper(c);
487 if (!is_continuation(c, tty))
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200488 ldata->column++;
Joe Petersona59c0d62009-01-02 13:43:25 +0000489 }
Joe Petersona88a69c2009-01-02 13:40:53 +0000490 break;
491 }
492
493 tty_put_char(tty, c);
494 return 1;
495}
496
497/**
498 * process_output - output post processor
Linus Torvalds1da177e2005-04-16 15:20:36 -0700499 * @c: character (or partial unicode symbol)
500 * @tty: terminal device
501 *
Joe Petersonee5aa7b2009-09-09 15:03:13 -0600502 * Output one character with OPOST processing.
503 * Returns -1 when the output device is full and the character
504 * must be retried.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505 *
Joe Petersona88a69c2009-01-02 13:40:53 +0000506 * Locking: output_lock to protect column state and space left
507 * (also, this is called from n_tty_write under the
508 * tty layer write lock)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700509 */
Alan Cox4edf1822008-02-08 04:18:44 -0800510
Joe Petersona88a69c2009-01-02 13:40:53 +0000511static int process_output(unsigned char c, struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512{
Jiri Slabybddc7152012-10-18 22:26:42 +0200513 struct n_tty_data *ldata = tty->disc_data;
Joe Petersona88a69c2009-01-02 13:40:53 +0000514 int space, retval;
515
Jiri Slabybddc7152012-10-18 22:26:42 +0200516 mutex_lock(&ldata->output_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700517
Alan Coxf34d7a52008-04-30 00:54:13 -0700518 space = tty_write_room(tty);
Joe Petersona88a69c2009-01-02 13:40:53 +0000519 retval = do_output_char(c, tty, space);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520
Jiri Slabybddc7152012-10-18 22:26:42 +0200521 mutex_unlock(&ldata->output_lock);
Joe Petersona88a69c2009-01-02 13:40:53 +0000522 if (retval < 0)
523 return -1;
524 else
525 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526}
527
528/**
Joe Petersona88a69c2009-01-02 13:40:53 +0000529 * process_output_block - block post processor
Linus Torvalds1da177e2005-04-16 15:20:36 -0700530 * @tty: terminal device
Joe Petersonee5aa7b2009-09-09 15:03:13 -0600531 * @buf: character buffer
532 * @nr: number of bytes to output
533 *
534 * Output a block of characters with OPOST processing.
535 * Returns the number of characters output.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536 *
537 * This path is used to speed up block console writes, among other
538 * things when processing blocks of output data. It handles only
539 * the simple cases normally found and helps to generate blocks of
540 * symbols for the console driver and thus improve performance.
541 *
Joe Petersona88a69c2009-01-02 13:40:53 +0000542 * Locking: output_lock to protect column state and space left
543 * (also, this is called from n_tty_write under the
544 * tty layer write lock)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545 */
Alan Cox4edf1822008-02-08 04:18:44 -0800546
Joe Petersona88a69c2009-01-02 13:40:53 +0000547static ssize_t process_output_block(struct tty_struct *tty,
548 const unsigned char *buf, unsigned int nr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549{
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200550 struct n_tty_data *ldata = tty->disc_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700551 int space;
Thorsten Wißmannbbd20752011-12-08 17:47:33 +0100552 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700553 const unsigned char *cp;
554
Jiri Slabybddc7152012-10-18 22:26:42 +0200555 mutex_lock(&ldata->output_lock);
Joe Petersona88a69c2009-01-02 13:40:53 +0000556
Alan Coxf34d7a52008-04-30 00:54:13 -0700557 space = tty_write_room(tty);
Alan Cox300a6202009-01-02 13:41:04 +0000558 if (!space) {
Jiri Slabybddc7152012-10-18 22:26:42 +0200559 mutex_unlock(&ldata->output_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700560 return 0;
Joe Petersona88a69c2009-01-02 13:40:53 +0000561 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700562 if (nr > space)
563 nr = space;
564
565 for (i = 0, cp = buf; i < nr; i++, cp++) {
Joe Petersona59c0d62009-01-02 13:43:25 +0000566 unsigned char c = *cp;
567
568 switch (c) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700569 case '\n':
570 if (O_ONLRET(tty))
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200571 ldata->column = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572 if (O_ONLCR(tty))
573 goto break_out;
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200574 ldata->canon_column = ldata->column;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575 break;
576 case '\r':
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200577 if (O_ONOCR(tty) && ldata->column == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700578 goto break_out;
579 if (O_OCRNL(tty))
580 goto break_out;
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200581 ldata->canon_column = ldata->column = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700582 break;
583 case '\t':
584 goto break_out;
585 case '\b':
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200586 if (ldata->column > 0)
587 ldata->column--;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700588 break;
589 default:
Joe Petersona59c0d62009-01-02 13:43:25 +0000590 if (!iscntrl(c)) {
591 if (O_OLCUC(tty))
592 goto break_out;
593 if (!is_continuation(c, tty))
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200594 ldata->column++;
Joe Petersona59c0d62009-01-02 13:43:25 +0000595 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700596 break;
597 }
598 }
599break_out:
Alan Coxf34d7a52008-04-30 00:54:13 -0700600 i = tty->ops->write(tty, buf, i);
Joe Petersona88a69c2009-01-02 13:40:53 +0000601
Jiri Slabybddc7152012-10-18 22:26:42 +0200602 mutex_unlock(&ldata->output_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603 return i;
604}
605
Joe Petersona88a69c2009-01-02 13:40:53 +0000606/**
607 * process_echoes - write pending echo characters
608 * @tty: terminal device
609 *
610 * Write previously buffered echo (and other ldisc-generated)
611 * characters to the tty.
612 *
613 * Characters generated by the ldisc (including echoes) need to
614 * be buffered because the driver's write buffer can fill during
615 * heavy program output. Echoing straight to the driver will
616 * often fail under these conditions, causing lost characters and
617 * resulting mismatches of ldisc state information.
618 *
619 * Since the ldisc state must represent the characters actually sent
620 * to the driver at the time of the write, operations like certain
621 * changes in column state are also saved in the buffer and executed
622 * here.
623 *
624 * A circular fifo buffer is used so that the most recent characters
625 * are prioritized. Also, when control characters are echoed with a
626 * prefixed "^", the pair is treated atomically and thus not separated.
627 *
Peter Hurley019ebdf2013-06-15 10:04:25 -0400628 * Locking: callers must hold output_lock
Joe Petersona88a69c2009-01-02 13:40:53 +0000629 */
630
Peter Hurleybc5b1ec2013-06-15 10:04:27 -0400631static size_t __process_echoes(struct tty_struct *tty)
Joe Petersona88a69c2009-01-02 13:40:53 +0000632{
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200633 struct n_tty_data *ldata = tty->disc_data;
Peter Hurleybc5b1ec2013-06-15 10:04:27 -0400634 int space, old_space;
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400635 size_t tail;
Joe Petersona88a69c2009-01-02 13:40:53 +0000636 unsigned char c;
Joe Petersona88a69c2009-01-02 13:40:53 +0000637
Peter Hurleybc5b1ec2013-06-15 10:04:27 -0400638 old_space = space = tty_write_room(tty);
Joe Petersona88a69c2009-01-02 13:40:53 +0000639
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400640 tail = ldata->echo_tail;
Peter Hurley29c7c5c2013-06-15 10:04:28 -0400641 while (ldata->echo_commit != tail) {
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400642 c = echo_buf(ldata, tail);
Joe Petersona88a69c2009-01-02 13:40:53 +0000643 if (c == ECHO_OP_START) {
644 unsigned char op;
Joe Petersona88a69c2009-01-02 13:40:53 +0000645 int no_space_left = 0;
646
647 /*
648 * If the buffer byte is the start of a multi-byte
649 * operation, get the next byte, which is either the
650 * op code or a control character value.
651 */
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400652 op = echo_buf(ldata, tail + 1);
Alan Cox300a6202009-01-02 13:41:04 +0000653
Joe Petersona88a69c2009-01-02 13:40:53 +0000654 switch (op) {
655 unsigned int num_chars, num_bs;
656
657 case ECHO_OP_ERASE_TAB:
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400658 num_chars = echo_buf(ldata, tail + 2);
Joe Petersona88a69c2009-01-02 13:40:53 +0000659
660 /*
661 * Determine how many columns to go back
662 * in order to erase the tab.
663 * This depends on the number of columns
664 * used by other characters within the tab
665 * area. If this (modulo 8) count is from
666 * the start of input rather than from a
667 * previous tab, we offset by canon column.
668 * Otherwise, tab spacing is normal.
669 */
670 if (!(num_chars & 0x80))
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200671 num_chars += ldata->canon_column;
Joe Petersona88a69c2009-01-02 13:40:53 +0000672 num_bs = 8 - (num_chars & 7);
673
674 if (num_bs > space) {
675 no_space_left = 1;
676 break;
677 }
678 space -= num_bs;
679 while (num_bs--) {
680 tty_put_char(tty, '\b');
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200681 if (ldata->column > 0)
682 ldata->column--;
Joe Petersona88a69c2009-01-02 13:40:53 +0000683 }
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400684 tail += 3;
Joe Petersona88a69c2009-01-02 13:40:53 +0000685 break;
686
687 case ECHO_OP_SET_CANON_COL:
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200688 ldata->canon_column = ldata->column;
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400689 tail += 2;
Joe Petersona88a69c2009-01-02 13:40:53 +0000690 break;
691
692 case ECHO_OP_MOVE_BACK_COL:
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200693 if (ldata->column > 0)
694 ldata->column--;
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400695 tail += 2;
Joe Petersona88a69c2009-01-02 13:40:53 +0000696 break;
697
698 case ECHO_OP_START:
699 /* This is an escaped echo op start code */
700 if (!space) {
701 no_space_left = 1;
702 break;
703 }
704 tty_put_char(tty, ECHO_OP_START);
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200705 ldata->column++;
Joe Petersona88a69c2009-01-02 13:40:53 +0000706 space--;
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400707 tail += 2;
Joe Petersona88a69c2009-01-02 13:40:53 +0000708 break;
709
710 default:
Joe Petersona88a69c2009-01-02 13:40:53 +0000711 /*
Joe Peterson62b26352009-09-09 15:03:47 -0600712 * If the op is not a special byte code,
713 * it is a ctrl char tagged to be echoed
714 * as "^X" (where X is the letter
715 * representing the control char).
716 * Note that we must ensure there is
717 * enough space for the whole ctrl pair.
718 *
Joe Petersona88a69c2009-01-02 13:40:53 +0000719 */
Joe Peterson62b26352009-09-09 15:03:47 -0600720 if (space < 2) {
721 no_space_left = 1;
722 break;
723 }
724 tty_put_char(tty, '^');
725 tty_put_char(tty, op ^ 0100);
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200726 ldata->column += 2;
Joe Peterson62b26352009-09-09 15:03:47 -0600727 space -= 2;
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400728 tail += 2;
Joe Petersona88a69c2009-01-02 13:40:53 +0000729 }
730
731 if (no_space_left)
732 break;
733 } else {
Peter Hurley582f5592013-05-17 12:49:48 -0400734 if (O_OPOST(tty)) {
Joe Petersonee5aa7b2009-09-09 15:03:13 -0600735 int retval = do_output_char(c, tty, space);
736 if (retval < 0)
737 break;
738 space -= retval;
739 } else {
740 if (!space)
741 break;
742 tty_put_char(tty, c);
743 space -= 1;
744 }
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400745 tail += 1;
Joe Petersona88a69c2009-01-02 13:40:53 +0000746 }
Joe Petersona88a69c2009-01-02 13:40:53 +0000747 }
748
Peter Hurleycbfd0342013-06-15 10:04:26 -0400749 /* If the echo buffer is nearly full (so that the possibility exists
750 * of echo overrun before the next commit), then discard enough
751 * data at the tail to prevent a subsequent overrun */
752 while (ldata->echo_commit - tail >= ECHO_DISCARD_WATERMARK) {
Roel Kluinc476f652013-10-11 22:08:49 +0200753 if (echo_buf(ldata, tail) == ECHO_OP_START) {
Peter Hurley6f222532013-11-08 09:42:18 -0500754 if (echo_buf(ldata, tail + 1) == ECHO_OP_ERASE_TAB)
Peter Hurleycbfd0342013-06-15 10:04:26 -0400755 tail += 3;
756 else
757 tail += 2;
758 } else
759 tail++;
760 }
761
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400762 ldata->echo_tail = tail;
Peter Hurleybc5b1ec2013-06-15 10:04:27 -0400763 return old_space - space;
Joe Petersona88a69c2009-01-02 13:40:53 +0000764}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700765
Peter Hurley17bd7902013-06-15 10:04:24 -0400766static void commit_echoes(struct tty_struct *tty)
767{
768 struct n_tty_data *ldata = tty->disc_data;
Peter Hurleybc5b1ec2013-06-15 10:04:27 -0400769 size_t nr, old, echoed;
Peter Hurleycbfd0342013-06-15 10:04:26 -0400770 size_t head;
771
772 head = ldata->echo_head;
Peter Hurley1075a6e2013-12-09 18:06:07 -0500773 ldata->echo_mark = head;
Peter Hurleycbfd0342013-06-15 10:04:26 -0400774 old = ldata->echo_commit - ldata->echo_tail;
775
776 /* Process committed echoes if the accumulated # of bytes
777 * is over the threshold (and try again each time another
778 * block is accumulated) */
779 nr = head - ldata->echo_tail;
780 if (nr < ECHO_COMMIT_WATERMARK || (nr % ECHO_BLOCK > old % ECHO_BLOCK))
781 return;
Peter Hurley17bd7902013-06-15 10:04:24 -0400782
Peter Hurley019ebdf2013-06-15 10:04:25 -0400783 mutex_lock(&ldata->output_lock);
Peter Hurleycbfd0342013-06-15 10:04:26 -0400784 ldata->echo_commit = head;
Peter Hurleybc5b1ec2013-06-15 10:04:27 -0400785 echoed = __process_echoes(tty);
Peter Hurley019ebdf2013-06-15 10:04:25 -0400786 mutex_unlock(&ldata->output_lock);
787
Peter Hurleybc5b1ec2013-06-15 10:04:27 -0400788 if (echoed && tty->ops->flush_chars)
Peter Hurley019ebdf2013-06-15 10:04:25 -0400789 tty->ops->flush_chars(tty);
790}
791
792static void process_echoes(struct tty_struct *tty)
793{
794 struct n_tty_data *ldata = tty->disc_data;
Peter Hurleybc5b1ec2013-06-15 10:04:27 -0400795 size_t echoed;
Peter Hurley019ebdf2013-06-15 10:04:25 -0400796
Peter Hurleye2613be2014-02-11 16:34:55 -0500797 if (ldata->echo_mark == ldata->echo_tail)
Peter Hurley019ebdf2013-06-15 10:04:25 -0400798 return;
799
800 mutex_lock(&ldata->output_lock);
Peter Hurley1075a6e2013-12-09 18:06:07 -0500801 ldata->echo_commit = ldata->echo_mark;
Peter Hurleybc5b1ec2013-06-15 10:04:27 -0400802 echoed = __process_echoes(tty);
Peter Hurley019ebdf2013-06-15 10:04:25 -0400803 mutex_unlock(&ldata->output_lock);
804
Peter Hurleybc5b1ec2013-06-15 10:04:27 -0400805 if (echoed && tty->ops->flush_chars)
Peter Hurley019ebdf2013-06-15 10:04:25 -0400806 tty->ops->flush_chars(tty);
Peter Hurley17bd7902013-06-15 10:04:24 -0400807}
808
Peter Hurley1075a6e2013-12-09 18:06:07 -0500809/* NB: echo_mark and echo_head should be equivalent here */
Peter Hurleycbfd0342013-06-15 10:04:26 -0400810static void flush_echoes(struct tty_struct *tty)
811{
812 struct n_tty_data *ldata = tty->disc_data;
813
Peter Hurley39434ab2013-11-29 12:56:10 -0500814 if ((!L_ECHO(tty) && !L_ECHONL(tty)) ||
815 ldata->echo_commit == ldata->echo_head)
Peter Hurleycbfd0342013-06-15 10:04:26 -0400816 return;
817
818 mutex_lock(&ldata->output_lock);
819 ldata->echo_commit = ldata->echo_head;
820 __process_echoes(tty);
821 mutex_unlock(&ldata->output_lock);
822}
823
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824/**
Joe Petersona88a69c2009-01-02 13:40:53 +0000825 * add_echo_byte - add a byte to the echo buffer
826 * @c: unicode byte to echo
Jiri Slaby57c94122012-10-18 22:26:43 +0200827 * @ldata: n_tty data
Joe Petersona88a69c2009-01-02 13:40:53 +0000828 *
829 * Add a character or operation byte to the echo buffer.
Joe Petersona88a69c2009-01-02 13:40:53 +0000830 */
831
Peter Hurleycbfd0342013-06-15 10:04:26 -0400832static inline void add_echo_byte(unsigned char c, struct n_tty_data *ldata)
Joe Petersona88a69c2009-01-02 13:40:53 +0000833{
Peter Hurleyaddaebc2013-06-15 10:04:22 -0400834 *echo_buf_addr(ldata, ldata->echo_head++) = c;
Joe Petersona88a69c2009-01-02 13:40:53 +0000835}
836
837/**
838 * echo_move_back_col - add operation to move back a column
Jiri Slaby57c94122012-10-18 22:26:43 +0200839 * @ldata: n_tty data
Joe Petersona88a69c2009-01-02 13:40:53 +0000840 *
841 * Add an operation to the echo buffer to move back one column.
Joe Petersona88a69c2009-01-02 13:40:53 +0000842 */
843
Jiri Slaby57c94122012-10-18 22:26:43 +0200844static void echo_move_back_col(struct n_tty_data *ldata)
Joe Petersona88a69c2009-01-02 13:40:53 +0000845{
Jiri Slaby57c94122012-10-18 22:26:43 +0200846 add_echo_byte(ECHO_OP_START, ldata);
847 add_echo_byte(ECHO_OP_MOVE_BACK_COL, ldata);
Joe Petersona88a69c2009-01-02 13:40:53 +0000848}
849
850/**
851 * echo_set_canon_col - add operation to set the canon column
Jiri Slaby57c94122012-10-18 22:26:43 +0200852 * @ldata: n_tty data
Joe Petersona88a69c2009-01-02 13:40:53 +0000853 *
854 * Add an operation to the echo buffer to set the canon column
855 * to the current column.
Joe Petersona88a69c2009-01-02 13:40:53 +0000856 */
857
Jiri Slaby57c94122012-10-18 22:26:43 +0200858static void echo_set_canon_col(struct n_tty_data *ldata)
Joe Petersona88a69c2009-01-02 13:40:53 +0000859{
Jiri Slaby57c94122012-10-18 22:26:43 +0200860 add_echo_byte(ECHO_OP_START, ldata);
861 add_echo_byte(ECHO_OP_SET_CANON_COL, ldata);
Joe Petersona88a69c2009-01-02 13:40:53 +0000862}
863
864/**
865 * echo_erase_tab - add operation to erase a tab
866 * @num_chars: number of character columns already used
867 * @after_tab: true if num_chars starts after a previous tab
Jiri Slaby57c94122012-10-18 22:26:43 +0200868 * @ldata: n_tty data
Joe Petersona88a69c2009-01-02 13:40:53 +0000869 *
870 * Add an operation to the echo buffer to erase a tab.
871 *
872 * Called by the eraser function, which knows how many character
873 * columns have been used since either a previous tab or the start
874 * of input. This information will be used later, along with
875 * canon column (if applicable), to go back the correct number
876 * of columns.
Joe Petersona88a69c2009-01-02 13:40:53 +0000877 */
878
879static void echo_erase_tab(unsigned int num_chars, int after_tab,
Jiri Slaby57c94122012-10-18 22:26:43 +0200880 struct n_tty_data *ldata)
Joe Petersona88a69c2009-01-02 13:40:53 +0000881{
Jiri Slaby57c94122012-10-18 22:26:43 +0200882 add_echo_byte(ECHO_OP_START, ldata);
883 add_echo_byte(ECHO_OP_ERASE_TAB, ldata);
Joe Petersona88a69c2009-01-02 13:40:53 +0000884
885 /* We only need to know this modulo 8 (tab spacing) */
886 num_chars &= 7;
887
888 /* Set the high bit as a flag if num_chars is after a previous tab */
889 if (after_tab)
890 num_chars |= 0x80;
Alan Cox300a6202009-01-02 13:41:04 +0000891
Jiri Slaby57c94122012-10-18 22:26:43 +0200892 add_echo_byte(num_chars, ldata);
Joe Petersona88a69c2009-01-02 13:40:53 +0000893}
894
895/**
896 * echo_char_raw - echo a character raw
Linus Torvalds1da177e2005-04-16 15:20:36 -0700897 * @c: unicode byte to echo
898 * @tty: terminal device
899 *
Alan Cox4edf1822008-02-08 04:18:44 -0800900 * Echo user input back onto the screen. This must be called only when
Linus Torvalds1da177e2005-04-16 15:20:36 -0700901 * L_ECHO(tty) is true. Called from the driver receive_buf path.
Alan Cox17b82062008-10-13 10:45:06 +0100902 *
Joe Petersona88a69c2009-01-02 13:40:53 +0000903 * This variant does not treat control characters specially.
Joe Petersona88a69c2009-01-02 13:40:53 +0000904 */
905
Jiri Slaby57c94122012-10-18 22:26:43 +0200906static void echo_char_raw(unsigned char c, struct n_tty_data *ldata)
Joe Petersona88a69c2009-01-02 13:40:53 +0000907{
Joe Petersona88a69c2009-01-02 13:40:53 +0000908 if (c == ECHO_OP_START) {
Jiri Slaby57c94122012-10-18 22:26:43 +0200909 add_echo_byte(ECHO_OP_START, ldata);
910 add_echo_byte(ECHO_OP_START, ldata);
Joe Petersona88a69c2009-01-02 13:40:53 +0000911 } else {
Jiri Slaby57c94122012-10-18 22:26:43 +0200912 add_echo_byte(c, ldata);
Joe Petersona88a69c2009-01-02 13:40:53 +0000913 }
Joe Petersona88a69c2009-01-02 13:40:53 +0000914}
915
916/**
917 * echo_char - echo a character
918 * @c: unicode byte to echo
919 * @tty: terminal device
920 *
921 * Echo user input back onto the screen. This must be called only when
922 * L_ECHO(tty) is true. Called from the driver receive_buf path.
923 *
Joe Peterson62b26352009-09-09 15:03:47 -0600924 * This variant tags control characters to be echoed as "^X"
925 * (where X is the letter representing the control char).
Linus Torvalds1da177e2005-04-16 15:20:36 -0700926 */
927
928static void echo_char(unsigned char c, struct tty_struct *tty)
929{
Jiri Slabybddc7152012-10-18 22:26:42 +0200930 struct n_tty_data *ldata = tty->disc_data;
931
Joe Petersona88a69c2009-01-02 13:40:53 +0000932 if (c == ECHO_OP_START) {
Jiri Slaby57c94122012-10-18 22:26:43 +0200933 add_echo_byte(ECHO_OP_START, ldata);
934 add_echo_byte(ECHO_OP_START, ldata);
Joe Petersona88a69c2009-01-02 13:40:53 +0000935 } else {
Joe Peterson62b26352009-09-09 15:03:47 -0600936 if (L_ECHOCTL(tty) && iscntrl(c) && c != '\t')
Jiri Slaby57c94122012-10-18 22:26:43 +0200937 add_echo_byte(ECHO_OP_START, ldata);
938 add_echo_byte(c, ldata);
Joe Petersona88a69c2009-01-02 13:40:53 +0000939 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700940}
941
Alan Cox17b82062008-10-13 10:45:06 +0100942/**
Joe Petersona88a69c2009-01-02 13:40:53 +0000943 * finish_erasing - complete erase
Jiri Slaby57c94122012-10-18 22:26:43 +0200944 * @ldata: n_tty data
Alan Cox17b82062008-10-13 10:45:06 +0100945 */
Joe Petersona88a69c2009-01-02 13:40:53 +0000946
Jiri Slaby57c94122012-10-18 22:26:43 +0200947static inline void finish_erasing(struct n_tty_data *ldata)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700948{
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200949 if (ldata->erasing) {
Jiri Slaby57c94122012-10-18 22:26:43 +0200950 echo_char_raw('/', ldata);
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200951 ldata->erasing = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700952 }
953}
954
955/**
956 * eraser - handle erase function
957 * @c: character input
958 * @tty: terminal device
959 *
Robert P. J. Day3a4fa0a2007-10-19 23:10:43 +0200960 * Perform erase and necessary output when an erase character is
Linus Torvalds1da177e2005-04-16 15:20:36 -0700961 * present in the stream from the driver layer. Handles the complexities
962 * of UTF-8 multibyte symbols.
Alan Cox17b82062008-10-13 10:45:06 +0100963 *
Peter Hurley6d76bd22013-06-15 09:14:26 -0400964 * n_tty_receive_buf()/producer path:
965 * caller holds non-exclusive termios_rwsem
Linus Torvalds1da177e2005-04-16 15:20:36 -0700966 */
Alan Cox4edf1822008-02-08 04:18:44 -0800967
Linus Torvalds1da177e2005-04-16 15:20:36 -0700968static void eraser(unsigned char c, struct tty_struct *tty)
969{
Jiri Slaby53c5ee22012-10-18 22:26:39 +0200970 struct n_tty_data *ldata = tty->disc_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700971 enum { ERASE, WERASE, KILL } kill_type;
Peter Hurleybc5a5e32013-06-15 09:14:21 -0400972 size_t head;
973 size_t cnt;
974 int seen_alnums;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700975
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200976 if (ldata->read_head == ldata->canon_head) {
Joe Peterson7e94b1d2009-01-02 13:43:40 +0000977 /* process_output('\a', tty); */ /* what do you think? */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700978 return;
979 }
980 if (c == ERASE_CHAR(tty))
981 kill_type = ERASE;
982 else if (c == WERASE_CHAR(tty))
983 kill_type = WERASE;
984 else {
985 if (!L_ECHO(tty)) {
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200986 ldata->read_head = ldata->canon_head;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700987 return;
988 }
989 if (!L_ECHOK(tty) || !L_ECHOKE(tty) || !L_ECHOE(tty)) {
Jiri Slabyba2e68a2012-10-18 22:26:41 +0200990 ldata->read_head = ldata->canon_head;
Jiri Slaby57c94122012-10-18 22:26:43 +0200991 finish_erasing(ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700992 echo_char(KILL_CHAR(tty), tty);
993 /* Add a newline if ECHOK is on and ECHOKE is off. */
994 if (L_ECHOK(tty))
Jiri Slaby57c94122012-10-18 22:26:43 +0200995 echo_char_raw('\n', ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700996 return;
997 }
998 kill_type = KILL;
999 }
1000
1001 seen_alnums = 0;
Jiri Slabyba2e68a2012-10-18 22:26:41 +02001002 while (ldata->read_head != ldata->canon_head) {
1003 head = ldata->read_head;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001004
1005 /* erase a single possibly multibyte character */
1006 do {
Peter Hurleybc5a5e32013-06-15 09:14:21 -04001007 head--;
1008 c = read_buf(ldata, head);
Jiri Slabyba2e68a2012-10-18 22:26:41 +02001009 } while (is_continuation(c, tty) && head != ldata->canon_head);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001010
1011 /* do not partially erase */
1012 if (is_continuation(c, tty))
1013 break;
1014
1015 if (kill_type == WERASE) {
1016 /* Equivalent to BSD's ALTWERASE. */
1017 if (isalnum(c) || c == '_')
1018 seen_alnums++;
1019 else if (seen_alnums)
1020 break;
1021 }
Peter Hurleybc5a5e32013-06-15 09:14:21 -04001022 cnt = ldata->read_head - head;
Jiri Slabyba2e68a2012-10-18 22:26:41 +02001023 ldata->read_head = head;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001024 if (L_ECHO(tty)) {
1025 if (L_ECHOPRT(tty)) {
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001026 if (!ldata->erasing) {
Jiri Slaby57c94122012-10-18 22:26:43 +02001027 echo_char_raw('\\', ldata);
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001028 ldata->erasing = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001029 }
1030 /* if cnt > 1, output a multi-byte character */
1031 echo_char(c, tty);
1032 while (--cnt > 0) {
Peter Hurleybc5a5e32013-06-15 09:14:21 -04001033 head++;
1034 echo_char_raw(read_buf(ldata, head), ldata);
Jiri Slaby57c94122012-10-18 22:26:43 +02001035 echo_move_back_col(ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001036 }
1037 } else if (kill_type == ERASE && !L_ECHOE(tty)) {
1038 echo_char(ERASE_CHAR(tty), tty);
1039 } else if (c == '\t') {
Joe Petersona88a69c2009-01-02 13:40:53 +00001040 unsigned int num_chars = 0;
1041 int after_tab = 0;
Peter Hurleybc5a5e32013-06-15 09:14:21 -04001042 size_t tail = ldata->read_head;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001043
Joe Petersona88a69c2009-01-02 13:40:53 +00001044 /*
1045 * Count the columns used for characters
1046 * since the start of input or after a
1047 * previous tab.
1048 * This info is used to go back the correct
1049 * number of columns.
1050 */
Jiri Slabyba2e68a2012-10-18 22:26:41 +02001051 while (tail != ldata->canon_head) {
Peter Hurleybc5a5e32013-06-15 09:14:21 -04001052 tail--;
1053 c = read_buf(ldata, tail);
Joe Petersona88a69c2009-01-02 13:40:53 +00001054 if (c == '\t') {
1055 after_tab = 1;
1056 break;
Alan Cox300a6202009-01-02 13:41:04 +00001057 } else if (iscntrl(c)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001058 if (L_ECHOCTL(tty))
Joe Petersona88a69c2009-01-02 13:40:53 +00001059 num_chars += 2;
1060 } else if (!is_continuation(c, tty)) {
1061 num_chars++;
1062 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001063 }
Jiri Slaby57c94122012-10-18 22:26:43 +02001064 echo_erase_tab(num_chars, after_tab, ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001065 } else {
1066 if (iscntrl(c) && L_ECHOCTL(tty)) {
Jiri Slaby57c94122012-10-18 22:26:43 +02001067 echo_char_raw('\b', ldata);
1068 echo_char_raw(' ', ldata);
1069 echo_char_raw('\b', ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001070 }
1071 if (!iscntrl(c) || L_ECHOCTL(tty)) {
Jiri Slaby57c94122012-10-18 22:26:43 +02001072 echo_char_raw('\b', ldata);
1073 echo_char_raw(' ', ldata);
1074 echo_char_raw('\b', ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075 }
1076 }
1077 }
1078 if (kill_type == ERASE)
1079 break;
1080 }
Jiri Slabyba2e68a2012-10-18 22:26:41 +02001081 if (ldata->read_head == ldata->canon_head && L_ECHO(tty))
Jiri Slaby57c94122012-10-18 22:26:43 +02001082 finish_erasing(ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001083}
1084
1085/**
1086 * isig - handle the ISIG optio
1087 * @sig: signal
1088 * @tty: terminal
Linus Torvalds1da177e2005-04-16 15:20:36 -07001089 *
Peter Hurley8c985d12013-03-06 08:38:19 -05001090 * Called when a signal is being sent due to terminal input.
1091 * Called from the driver receive_buf path so serialized.
Alan Cox17b82062008-10-13 10:45:06 +01001092 *
Peter Hurley8c985d12013-03-06 08:38:19 -05001093 * Locking: ctrl_lock
Linus Torvalds1da177e2005-04-16 15:20:36 -07001094 */
Alan Cox4edf1822008-02-08 04:18:44 -08001095
Peter Hurley4b293492013-07-24 08:29:55 -04001096static void isig(int sig, struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001097{
Peter Hurley8c985d12013-03-06 08:38:19 -05001098 struct pid *tty_pgrp = tty_get_pgrp(tty);
1099 if (tty_pgrp) {
1100 kill_pgrp(tty_pgrp, sig, 1);
1101 put_pid(tty_pgrp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001102 }
1103}
1104
1105/**
1106 * n_tty_receive_break - handle break
1107 * @tty: terminal
1108 *
1109 * An RS232 break event has been hit in the incoming bitstream. This
1110 * can cause a variety of events depending upon the termios settings.
1111 *
Peter Hurley6d76bd22013-06-15 09:14:26 -04001112 * n_tty_receive_buf()/producer path:
1113 * caller holds non-exclusive termios_rwsem
Peter Hurley6d76bd22013-06-15 09:14:26 -04001114 *
1115 * Note: may get exclusive termios_rwsem if flushing input buffer
Linus Torvalds1da177e2005-04-16 15:20:36 -07001116 */
Alan Cox4edf1822008-02-08 04:18:44 -08001117
Peter Hurley4b293492013-07-24 08:29:55 -04001118static void n_tty_receive_break(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001119{
Jiri Slaby57c94122012-10-18 22:26:43 +02001120 struct n_tty_data *ldata = tty->disc_data;
1121
Linus Torvalds1da177e2005-04-16 15:20:36 -07001122 if (I_IGNBRK(tty))
1123 return;
1124 if (I_BRKINT(tty)) {
Peter Hurley8c985d12013-03-06 08:38:19 -05001125 isig(SIGINT, tty);
1126 if (!L_NOFLSH(tty)) {
Peter Hurley6d76bd22013-06-15 09:14:26 -04001127 /* flushing needs exclusive termios_rwsem */
1128 up_read(&tty->termios_rwsem);
Peter Hurley8c985d12013-03-06 08:38:19 -05001129 n_tty_flush_buffer(tty);
1130 tty_driver_flush_buffer(tty);
Peter Hurley6d76bd22013-06-15 09:14:26 -04001131 down_read(&tty->termios_rwsem);
Peter Hurley8c985d12013-03-06 08:38:19 -05001132 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001133 return;
1134 }
1135 if (I_PARMRK(tty)) {
Jiri Slaby57c94122012-10-18 22:26:43 +02001136 put_tty_queue('\377', ldata);
1137 put_tty_queue('\0', ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001138 }
Jiri Slaby57c94122012-10-18 22:26:43 +02001139 put_tty_queue('\0', ldata);
Peter Hurley6c677162013-12-02 14:24:46 -05001140 if (waitqueue_active(&tty->read_wait))
Peter Hurley57087d52014-08-07 07:14:10 -04001141 wake_up_interruptible_poll(&tty->read_wait, POLLIN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001142}
1143
1144/**
1145 * n_tty_receive_overrun - handle overrun reporting
1146 * @tty: terminal
1147 *
1148 * Data arrived faster than we could process it. While the tty
1149 * driver has flagged this the bits that were missed are gone
1150 * forever.
1151 *
1152 * Called from the receive_buf path so single threaded. Does not
1153 * need locking as num_overrun and overrun_time are function
1154 * private.
1155 */
Alan Cox4edf1822008-02-08 04:18:44 -08001156
Peter Hurley4b293492013-07-24 08:29:55 -04001157static void n_tty_receive_overrun(struct tty_struct *tty)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001158{
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001159 struct n_tty_data *ldata = tty->disc_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001160 char buf[64];
1161
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001162 ldata->num_overrun++;
1163 if (time_after(jiffies, ldata->overrun_time + HZ) ||
1164 time_after(ldata->overrun_time, jiffies)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001165 printk(KERN_WARNING "%s: %d input overrun(s)\n",
1166 tty_name(tty, buf),
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001167 ldata->num_overrun);
1168 ldata->overrun_time = jiffies;
1169 ldata->num_overrun = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001170 }
1171}
1172
1173/**
1174 * n_tty_receive_parity_error - error notifier
1175 * @tty: terminal device
1176 * @c: character
1177 *
1178 * Process a parity error and queue the right data to indicate
Peter Hurley6d76bd22013-06-15 09:14:26 -04001179 * the error case if necessary.
1180 *
1181 * n_tty_receive_buf()/producer path:
1182 * caller holds non-exclusive termios_rwsem
Linus Torvalds1da177e2005-04-16 15:20:36 -07001183 */
Peter Hurley4b293492013-07-24 08:29:55 -04001184static void n_tty_receive_parity_error(struct tty_struct *tty, unsigned char c)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001185{
Jiri Slaby57c94122012-10-18 22:26:43 +02001186 struct n_tty_data *ldata = tty->disc_data;
1187
Peter Hurley66528f92014-06-16 08:10:42 -04001188 if (I_INPCK(tty)) {
1189 if (I_IGNPAR(tty))
1190 return;
1191 if (I_PARMRK(tty)) {
1192 put_tty_queue('\377', ldata);
1193 put_tty_queue('\0', ldata);
1194 put_tty_queue(c, ldata);
1195 } else
1196 put_tty_queue('\0', ldata);
1197 } else
Jiri Slaby57c94122012-10-18 22:26:43 +02001198 put_tty_queue(c, ldata);
Peter Hurley6c677162013-12-02 14:24:46 -05001199 if (waitqueue_active(&tty->read_wait))
Peter Hurley57087d52014-08-07 07:14:10 -04001200 wake_up_interruptible_poll(&tty->read_wait, POLLIN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001201}
1202
Peter Hurleyb0ac50b2013-06-15 10:21:23 -04001203static void
1204n_tty_receive_signal_char(struct tty_struct *tty, int signal, unsigned char c)
1205{
1206 if (!L_NOFLSH(tty)) {
1207 /* flushing needs exclusive termios_rwsem */
1208 up_read(&tty->termios_rwsem);
1209 n_tty_flush_buffer(tty);
1210 tty_driver_flush_buffer(tty);
1211 down_read(&tty->termios_rwsem);
1212 }
1213 if (I_IXON(tty))
1214 start_tty(tty);
1215 if (L_ECHO(tty)) {
1216 echo_char(c, tty);
1217 commit_echoes(tty);
Peter Hurleye2613be2014-02-11 16:34:55 -05001218 } else
1219 process_echoes(tty);
Peter Hurleyb0ac50b2013-06-15 10:21:23 -04001220 isig(signal, tty);
1221 return;
1222}
1223
Linus Torvalds1da177e2005-04-16 15:20:36 -07001224/**
1225 * n_tty_receive_char - perform processing
1226 * @tty: terminal device
1227 * @c: character
1228 *
1229 * Process an individual character of input received from the driver.
Alan Cox4edf1822008-02-08 04:18:44 -08001230 * This is serialized with respect to itself by the rules for the
Linus Torvalds1da177e2005-04-16 15:20:36 -07001231 * driver above.
Peter Hurley6d76bd22013-06-15 09:14:26 -04001232 *
1233 * n_tty_receive_buf()/producer path:
1234 * caller holds non-exclusive termios_rwsem
1235 * publishes canon_head if canonical mode is active
Peter Hurleye60d27c2013-07-24 08:29:56 -04001236 *
1237 * Returns 1 if LNEXT was received, else returns 0
Linus Torvalds1da177e2005-04-16 15:20:36 -07001238 */
1239
Peter Hurleye60d27c2013-07-24 08:29:56 -04001240static int
Peter Hurley4b1f79c2013-07-24 08:29:51 -04001241n_tty_receive_char_special(struct tty_struct *tty, unsigned char c)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001242{
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001243 struct n_tty_data *ldata = tty->disc_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001244
Linus Torvalds1da177e2005-04-16 15:20:36 -07001245 if (I_IXON(tty)) {
1246 if (c == START_CHAR(tty)) {
1247 start_tty(tty);
Peter Hurleye2613be2014-02-11 16:34:55 -05001248 process_echoes(tty);
Peter Hurleye60d27c2013-07-24 08:29:56 -04001249 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001250 }
1251 if (c == STOP_CHAR(tty)) {
1252 stop_tty(tty);
Peter Hurleye60d27c2013-07-24 08:29:56 -04001253 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001254 }
1255 }
Joe Peterson575537b32008-04-30 00:53:30 -07001256
Linus Torvalds1da177e2005-04-16 15:20:36 -07001257 if (L_ISIG(tty)) {
Peter Hurleyb0ac50b2013-06-15 10:21:23 -04001258 if (c == INTR_CHAR(tty)) {
1259 n_tty_receive_signal_char(tty, SIGINT, c);
Peter Hurleye60d27c2013-07-24 08:29:56 -04001260 return 0;
Peter Hurleyb0ac50b2013-06-15 10:21:23 -04001261 } else if (c == QUIT_CHAR(tty)) {
1262 n_tty_receive_signal_char(tty, SIGQUIT, c);
Peter Hurleye60d27c2013-07-24 08:29:56 -04001263 return 0;
Peter Hurleyb0ac50b2013-06-15 10:21:23 -04001264 } else if (c == SUSP_CHAR(tty)) {
1265 n_tty_receive_signal_char(tty, SIGTSTP, c);
Peter Hurleye60d27c2013-07-24 08:29:56 -04001266 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001267 }
1268 }
Joe Peterson575537b32008-04-30 00:53:30 -07001269
Peter Hurley855df3c2013-07-24 08:29:50 -04001270 if (tty->stopped && !tty->flow_stopped && I_IXON(tty) && I_IXANY(tty)) {
1271 start_tty(tty);
1272 process_echoes(tty);
1273 }
1274
Joe Peterson575537b32008-04-30 00:53:30 -07001275 if (c == '\r') {
1276 if (I_IGNCR(tty))
Peter Hurleye60d27c2013-07-24 08:29:56 -04001277 return 0;
Joe Peterson575537b32008-04-30 00:53:30 -07001278 if (I_ICRNL(tty))
1279 c = '\n';
1280 } else if (c == '\n' && I_INLCR(tty))
1281 c = '\r';
1282
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001283 if (ldata->icanon) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001284 if (c == ERASE_CHAR(tty) || c == KILL_CHAR(tty) ||
1285 (c == WERASE_CHAR(tty) && L_IEXTEN(tty))) {
1286 eraser(c, tty);
Peter Hurley17bd7902013-06-15 10:04:24 -04001287 commit_echoes(tty);
Peter Hurleye60d27c2013-07-24 08:29:56 -04001288 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001289 }
1290 if (c == LNEXT_CHAR(tty) && L_IEXTEN(tty)) {
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001291 ldata->lnext = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001292 if (L_ECHO(tty)) {
Jiri Slaby57c94122012-10-18 22:26:43 +02001293 finish_erasing(ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001294 if (L_ECHOCTL(tty)) {
Jiri Slaby57c94122012-10-18 22:26:43 +02001295 echo_char_raw('^', ldata);
1296 echo_char_raw('\b', ldata);
Peter Hurley17bd7902013-06-15 10:04:24 -04001297 commit_echoes(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001298 }
1299 }
Peter Hurleye60d27c2013-07-24 08:29:56 -04001300 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001301 }
Peter Hurleye60d27c2013-07-24 08:29:56 -04001302 if (c == REPRINT_CHAR(tty) && L_ECHO(tty) && L_IEXTEN(tty)) {
Peter Hurleybc5a5e32013-06-15 09:14:21 -04001303 size_t tail = ldata->canon_head;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001304
Jiri Slaby57c94122012-10-18 22:26:43 +02001305 finish_erasing(ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001306 echo_char(c, tty);
Jiri Slaby57c94122012-10-18 22:26:43 +02001307 echo_char_raw('\n', ldata);
Jiri Slabyba2e68a2012-10-18 22:26:41 +02001308 while (tail != ldata->read_head) {
Peter Hurleybc5a5e32013-06-15 09:14:21 -04001309 echo_char(read_buf(ldata, tail), tty);
1310 tail++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001311 }
Peter Hurley17bd7902013-06-15 10:04:24 -04001312 commit_echoes(tty);
Peter Hurleye60d27c2013-07-24 08:29:56 -04001313 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001314 }
1315 if (c == '\n') {
Joe Petersonacc71bb2009-01-02 13:43:32 +00001316 if (L_ECHO(tty) || L_ECHONL(tty)) {
Jiri Slaby57c94122012-10-18 22:26:43 +02001317 echo_char_raw('\n', ldata);
Peter Hurley17bd7902013-06-15 10:04:24 -04001318 commit_echoes(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001319 }
1320 goto handle_newline;
1321 }
1322 if (c == EOF_CHAR(tty)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001323 c = __DISABLED_CHAR;
1324 goto handle_newline;
1325 }
1326 if ((c == EOL_CHAR(tty)) ||
1327 (c == EOL2_CHAR(tty) && L_IEXTEN(tty))) {
1328 /*
1329 * XXX are EOL_CHAR and EOL2_CHAR echoed?!?
1330 */
1331 if (L_ECHO(tty)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001332 /* Record the column of first canon char. */
Jiri Slabyba2e68a2012-10-18 22:26:41 +02001333 if (ldata->canon_head == ldata->read_head)
Jiri Slaby57c94122012-10-18 22:26:43 +02001334 echo_set_canon_col(ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001335 echo_char(c, tty);
Peter Hurley17bd7902013-06-15 10:04:24 -04001336 commit_echoes(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001337 }
1338 /*
1339 * XXX does PARMRK doubling happen for
1340 * EOL_CHAR and EOL2_CHAR?
1341 */
Peter Hurley001ba922013-12-02 14:24:44 -05001342 if (c == (unsigned char) '\377' && I_PARMRK(tty))
Jiri Slaby57c94122012-10-18 22:26:43 +02001343 put_tty_queue(c, ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001344
Alan Cox4edf1822008-02-08 04:18:44 -08001345handle_newline:
Peter Hurleybc5a5e32013-06-15 09:14:21 -04001346 set_bit(ldata->read_head & (N_TTY_BUF_SIZE - 1), ldata->read_flags);
Peter Hurley6d76bd22013-06-15 09:14:26 -04001347 put_tty_queue(c, ldata);
Peter Hurley70aca712015-01-16 15:05:37 -05001348 smp_store_release(&ldata->canon_head, ldata->read_head);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001349 kill_fasync(&tty->fasync, SIGIO, POLL_IN);
1350 if (waitqueue_active(&tty->read_wait))
Peter Hurley57087d52014-08-07 07:14:10 -04001351 wake_up_interruptible_poll(&tty->read_wait, POLLIN);
Peter Hurleye60d27c2013-07-24 08:29:56 -04001352 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001353 }
1354 }
Alan Cox4edf1822008-02-08 04:18:44 -08001355
Joe Petersonacc71bb2009-01-02 13:43:32 +00001356 if (L_ECHO(tty)) {
Jiri Slaby57c94122012-10-18 22:26:43 +02001357 finish_erasing(ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001358 if (c == '\n')
Jiri Slaby57c94122012-10-18 22:26:43 +02001359 echo_char_raw('\n', ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001360 else {
1361 /* Record the column of first canon char. */
Jiri Slabyba2e68a2012-10-18 22:26:41 +02001362 if (ldata->canon_head == ldata->read_head)
Jiri Slaby57c94122012-10-18 22:26:43 +02001363 echo_set_canon_col(ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001364 echo_char(c, tty);
1365 }
Peter Hurley17bd7902013-06-15 10:04:24 -04001366 commit_echoes(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001367 }
1368
Peter Hurley001ba922013-12-02 14:24:44 -05001369 /* PARMRK doubling check */
1370 if (c == (unsigned char) '\377' && I_PARMRK(tty))
Jiri Slaby57c94122012-10-18 22:26:43 +02001371 put_tty_queue(c, ldata);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001372
Jiri Slaby57c94122012-10-18 22:26:43 +02001373 put_tty_queue(c, ldata);
Peter Hurleye60d27c2013-07-24 08:29:56 -04001374 return 0;
Alan Cox4edf1822008-02-08 04:18:44 -08001375}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001376
Peter Hurleye60d27c2013-07-24 08:29:56 -04001377static inline void
1378n_tty_receive_char_inline(struct tty_struct *tty, unsigned char c)
Peter Hurley4b1f79c2013-07-24 08:29:51 -04001379{
1380 struct n_tty_data *ldata = tty->disc_data;
Peter Hurley4b1f79c2013-07-24 08:29:51 -04001381
Peter Hurleye60d27c2013-07-24 08:29:56 -04001382 if (tty->stopped && !tty->flow_stopped && I_IXON(tty) && I_IXANY(tty)) {
1383 start_tty(tty);
1384 process_echoes(tty);
Peter Hurley4b1f79c2013-07-24 08:29:51 -04001385 }
Peter Hurleye60d27c2013-07-24 08:29:56 -04001386 if (L_ECHO(tty)) {
1387 finish_erasing(ldata);
1388 /* Record the column of first canon char. */
1389 if (ldata->canon_head == ldata->read_head)
1390 echo_set_canon_col(ldata);
1391 echo_char(c, tty);
1392 commit_echoes(tty);
1393 }
Peter Hurley001ba922013-12-02 14:24:44 -05001394 /* PARMRK doubling check */
1395 if (c == (unsigned char) '\377' && I_PARMRK(tty))
Peter Hurleye60d27c2013-07-24 08:29:56 -04001396 put_tty_queue(c, ldata);
1397 put_tty_queue(c, ldata);
1398}
Peter Hurley4b1f79c2013-07-24 08:29:51 -04001399
Peter Hurleyeb3e4662013-12-02 14:24:42 -05001400static void n_tty_receive_char(struct tty_struct *tty, unsigned char c)
Peter Hurleye60d27c2013-07-24 08:29:56 -04001401{
1402 n_tty_receive_char_inline(tty, c);
Peter Hurley4b1f79c2013-07-24 08:29:51 -04001403}
1404
Peter Hurleyad0cc7b2013-06-15 10:21:27 -04001405static inline void
Peter Hurley7de971b2013-07-24 08:29:53 -04001406n_tty_receive_char_fast(struct tty_struct *tty, unsigned char c)
1407{
1408 struct n_tty_data *ldata = tty->disc_data;
1409
Peter Hurleye60d27c2013-07-24 08:29:56 -04001410 if (tty->stopped && !tty->flow_stopped && I_IXON(tty) && I_IXANY(tty)) {
1411 start_tty(tty);
1412 process_echoes(tty);
Peter Hurley7de971b2013-07-24 08:29:53 -04001413 }
Peter Hurleye60d27c2013-07-24 08:29:56 -04001414 if (L_ECHO(tty)) {
1415 finish_erasing(ldata);
1416 /* Record the column of first canon char. */
1417 if (ldata->canon_head == ldata->read_head)
1418 echo_set_canon_col(ldata);
1419 echo_char(c, tty);
1420 commit_echoes(tty);
1421 }
1422 put_tty_queue(c, ldata);
Peter Hurley7de971b2013-07-24 08:29:53 -04001423}
1424
Peter Hurley8dc4b252013-12-02 14:24:43 -05001425static void n_tty_receive_char_closing(struct tty_struct *tty, unsigned char c)
Peter Hurleyad0cc7b2013-06-15 10:21:27 -04001426{
1427 if (I_ISTRIP(tty))
1428 c &= 0x7f;
1429 if (I_IUCLC(tty) && L_IEXTEN(tty))
1430 c = tolower(c);
1431
1432 if (I_IXON(tty)) {
1433 if (c == STOP_CHAR(tty))
1434 stop_tty(tty);
1435 else if (c == START_CHAR(tty) ||
1436 (tty->stopped && !tty->flow_stopped && I_IXANY(tty) &&
1437 c != INTR_CHAR(tty) && c != QUIT_CHAR(tty) &&
1438 c != SUSP_CHAR(tty))) {
1439 start_tty(tty);
1440 process_echoes(tty);
1441 }
1442 }
1443}
1444
Peter Hurleyd2f8d7a2013-06-15 10:21:24 -04001445static void
1446n_tty_receive_char_flagged(struct tty_struct *tty, unsigned char c, char flag)
1447{
1448 char buf[64];
1449
1450 switch (flag) {
1451 case TTY_BREAK:
1452 n_tty_receive_break(tty);
1453 break;
1454 case TTY_PARITY:
1455 case TTY_FRAME:
1456 n_tty_receive_parity_error(tty, c);
1457 break;
1458 case TTY_OVERRUN:
1459 n_tty_receive_overrun(tty);
1460 break;
1461 default:
1462 printk(KERN_ERR "%s: unknown flag %d\n",
1463 tty_name(tty, buf), flag);
1464 break;
1465 }
1466}
1467
Peter Hurleye60d27c2013-07-24 08:29:56 -04001468static void
1469n_tty_receive_char_lnext(struct tty_struct *tty, unsigned char c, char flag)
1470{
1471 struct n_tty_data *ldata = tty->disc_data;
1472
1473 ldata->lnext = 0;
1474 if (likely(flag == TTY_NORMAL)) {
1475 if (I_ISTRIP(tty))
1476 c &= 0x7f;
1477 if (I_IUCLC(tty) && L_IEXTEN(tty))
1478 c = tolower(c);
1479 n_tty_receive_char(tty, c);
1480 } else
1481 n_tty_receive_char_flagged(tty, c, flag);
1482}
1483
Peter Hurley4a23a4d2013-06-15 10:21:22 -04001484static void
1485n_tty_receive_buf_real_raw(struct tty_struct *tty, const unsigned char *cp,
1486 char *fp, int count)
1487{
1488 struct n_tty_data *ldata = tty->disc_data;
1489 size_t n, head;
1490
1491 head = ldata->read_head & (N_TTY_BUF_SIZE - 1);
Peter Hurley70aca712015-01-16 15:05:37 -05001492 n = min_t(size_t, count, N_TTY_BUF_SIZE - head);
Peter Hurley4a23a4d2013-06-15 10:21:22 -04001493 memcpy(read_buf_addr(ldata, head), cp, n);
1494 ldata->read_head += n;
1495 cp += n;
1496 count -= n;
1497
1498 head = ldata->read_head & (N_TTY_BUF_SIZE - 1);
Peter Hurley70aca712015-01-16 15:05:37 -05001499 n = min_t(size_t, count, N_TTY_BUF_SIZE - head);
Peter Hurley4a23a4d2013-06-15 10:21:22 -04001500 memcpy(read_buf_addr(ldata, head), cp, n);
1501 ldata->read_head += n;
1502}
1503
Peter Hurley554117bd2013-06-15 10:21:25 -04001504static void
1505n_tty_receive_buf_raw(struct tty_struct *tty, const unsigned char *cp,
1506 char *fp, int count)
1507{
1508 struct n_tty_data *ldata = tty->disc_data;
1509 char flag = TTY_NORMAL;
1510
1511 while (count--) {
1512 if (fp)
1513 flag = *fp++;
1514 if (likely(flag == TTY_NORMAL))
1515 put_tty_queue(*cp++, ldata);
1516 else
1517 n_tty_receive_char_flagged(tty, *cp++, flag);
1518 }
1519}
1520
Peter Hurleyad0cc7b2013-06-15 10:21:27 -04001521static void
1522n_tty_receive_buf_closing(struct tty_struct *tty, const unsigned char *cp,
1523 char *fp, int count)
1524{
1525 char flag = TTY_NORMAL;
1526
1527 while (count--) {
1528 if (fp)
1529 flag = *fp++;
1530 if (likely(flag == TTY_NORMAL))
1531 n_tty_receive_char_closing(tty, *cp++);
1532 else
1533 n_tty_receive_char_flagged(tty, *cp++, flag);
1534 }
1535}
1536
Peter Hurley7d88d632013-07-24 08:29:49 -04001537static void
1538n_tty_receive_buf_standard(struct tty_struct *tty, const unsigned char *cp,
Peter Hurley6baad002013-07-24 08:29:52 -04001539 char *fp, int count)
1540{
1541 struct n_tty_data *ldata = tty->disc_data;
1542 char flag = TTY_NORMAL;
1543
1544 while (count--) {
1545 if (fp)
1546 flag = *fp++;
1547 if (likely(flag == TTY_NORMAL)) {
1548 unsigned char c = *cp++;
1549
1550 if (I_ISTRIP(tty))
1551 c &= 0x7f;
1552 if (I_IUCLC(tty) && L_IEXTEN(tty))
1553 c = tolower(c);
1554 if (L_EXTPROC(tty)) {
1555 put_tty_queue(c, ldata);
1556 continue;
1557 }
Peter Hurleye60d27c2013-07-24 08:29:56 -04001558 if (!test_bit(c, ldata->char_map))
1559 n_tty_receive_char_inline(tty, c);
1560 else if (n_tty_receive_char_special(tty, c) && count) {
1561 if (fp)
1562 flag = *fp++;
1563 n_tty_receive_char_lnext(tty, *cp++, flag);
1564 count--;
1565 }
Peter Hurley6baad002013-07-24 08:29:52 -04001566 } else
1567 n_tty_receive_char_flagged(tty, *cp++, flag);
1568 }
1569}
1570
1571static void
1572n_tty_receive_buf_fast(struct tty_struct *tty, const unsigned char *cp,
1573 char *fp, int count)
Peter Hurley7d88d632013-07-24 08:29:49 -04001574{
Peter Hurleye60d27c2013-07-24 08:29:56 -04001575 struct n_tty_data *ldata = tty->disc_data;
Peter Hurley7d88d632013-07-24 08:29:49 -04001576 char flag = TTY_NORMAL;
1577
1578 while (count--) {
1579 if (fp)
1580 flag = *fp++;
Peter Hurleye60d27c2013-07-24 08:29:56 -04001581 if (likely(flag == TTY_NORMAL)) {
1582 unsigned char c = *cp++;
1583
1584 if (!test_bit(c, ldata->char_map))
1585 n_tty_receive_char_fast(tty, c);
1586 else if (n_tty_receive_char_special(tty, c) && count) {
1587 if (fp)
1588 flag = *fp++;
1589 n_tty_receive_char_lnext(tty, *cp++, flag);
1590 count--;
1591 }
1592 } else
Peter Hurley7d88d632013-07-24 08:29:49 -04001593 n_tty_receive_char_flagged(tty, *cp++, flag);
1594 }
1595}
1596
Peter Hurley24a89d12013-06-15 09:14:15 -04001597static void __receive_buf(struct tty_struct *tty, const unsigned char *cp,
1598 char *fp, int count)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001599{
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001600 struct n_tty_data *ldata = tty->disc_data;
Peter Hurleya1dd30e2013-06-15 10:21:26 -04001601 bool preops = I_ISTRIP(tty) || (I_IUCLC(tty) && L_IEXTEN(tty));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001602
Peter Hurley4a23a4d2013-06-15 10:21:22 -04001603 if (ldata->real_raw)
1604 n_tty_receive_buf_real_raw(tty, cp, fp, count);
Peter Hurleya1dd30e2013-06-15 10:21:26 -04001605 else if (ldata->raw || (L_EXTPROC(tty) && !preops))
Peter Hurley554117bd2013-06-15 10:21:25 -04001606 n_tty_receive_buf_raw(tty, cp, fp, count);
Peter Hurleyad0cc7b2013-06-15 10:21:27 -04001607 else if (tty->closing && !L_EXTPROC(tty))
1608 n_tty_receive_buf_closing(tty, cp, fp, count);
Peter Hurley4a23a4d2013-06-15 10:21:22 -04001609 else {
Peter Hurleye60d27c2013-07-24 08:29:56 -04001610 if (ldata->lnext) {
1611 char flag = TTY_NORMAL;
1612
1613 if (fp)
1614 flag = *fp++;
1615 n_tty_receive_char_lnext(tty, *cp++, flag);
1616 count--;
1617 }
1618
Peter Hurley7de971b2013-07-24 08:29:53 -04001619 if (!preops && !I_PARMRK(tty))
Peter Hurley6baad002013-07-24 08:29:52 -04001620 n_tty_receive_buf_fast(tty, cp, fp, count);
1621 else
1622 n_tty_receive_buf_standard(tty, cp, fp, count);
Peter Hurleycbfd0342013-06-15 10:04:26 -04001623
1624 flush_echoes(tty);
Alan Coxf34d7a52008-04-30 00:54:13 -07001625 if (tty->ops->flush_chars)
1626 tty->ops->flush_chars(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001627 }
1628
Peter Hurley70aca712015-01-16 15:05:37 -05001629 if (ldata->icanon && !L_EXTPROC(tty))
1630 return;
1631
1632 /* publish read_head to consumer */
1633 smp_store_release(&ldata->commit_head, ldata->read_head);
1634
1635 if ((read_cnt(ldata) >= ldata->minimum_to_wake) || L_EXTPROC(tty)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001636 kill_fasync(&tty->fasync, SIGIO, POLL_IN);
1637 if (waitqueue_active(&tty->read_wait))
Peter Hurley57087d52014-08-07 07:14:10 -04001638 wake_up_interruptible_poll(&tty->read_wait, POLLIN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001639 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001640}
1641
Peter Hurleyfb5ef9e2015-01-16 15:05:39 -05001642/**
1643 * n_tty_receive_buf_common - process input
1644 * @tty: device to receive input
1645 * @cp: input chars
1646 * @fp: flags for each char (if NULL, all chars are TTY_NORMAL)
1647 * @count: number of input chars in @cp
1648 *
1649 * Called by the terminal driver when a block of characters has
1650 * been received. This function must be called from soft contexts
1651 * not from interrupt context. The driver is responsible for making
1652 * calls one at a time and in order (or using flush_to_ldisc)
1653 *
1654 * Returns the # of input chars from @cp which were processed.
1655 *
1656 * In canonical mode, the maximum line length is 4096 chars (including
1657 * the line termination char); lines longer than 4096 chars are
1658 * truncated. After 4095 chars, input data is still processed but
1659 * not stored. Overflow processing ensures the tty can always
1660 * receive more input until at least one line can be read.
1661 *
1662 * In non-canonical mode, the read buffer will only accept 4095 chars;
1663 * this provides the necessary space for a newline char if the input
1664 * mode is switched to canonical.
1665 *
1666 * Note it is possible for the read buffer to _contain_ 4096 chars
1667 * in non-canonical mode: the read buffer could already contain the
1668 * maximum canon line of 4096 chars when the mode is switched to
1669 * non-canonical.
1670 *
1671 * n_tty_receive_buf()/producer path:
1672 * claims non-exclusive termios_rwsem
1673 * publishes commit_head or canon_head
1674 */
Peter Hurley5c32d122013-12-02 14:24:41 -05001675static int
1676n_tty_receive_buf_common(struct tty_struct *tty, const unsigned char *cp,
1677 char *fp, int count, int flow)
Peter Hurley24a89d12013-06-15 09:14:15 -04001678{
1679 struct n_tty_data *ldata = tty->disc_data;
Peter Hurleyfb5ef9e2015-01-16 15:05:39 -05001680 int room, n, rcvd = 0, overflow;
Peter Hurley24a89d12013-06-15 09:14:15 -04001681
Peter Hurley9356b532013-06-15 09:14:24 -04001682 down_read(&tty->termios_rwsem);
1683
Peter Hurley19e2ad62013-07-24 08:29:54 -04001684 while (1) {
Peter Hurley70aca712015-01-16 15:05:37 -05001685 /*
Peter Hurley06c49f92015-01-16 15:05:38 -05001686 * When PARMRK is set, each input char may take up to 3 chars
1687 * in the read buf; reduce the buffer space avail by 3x
Peter Hurley70aca712015-01-16 15:05:37 -05001688 *
1689 * If we are doing input canonicalization, and there are no
1690 * pending newlines, let characters through without limit, so
1691 * that erase characters will be handled. Other excess
1692 * characters will be beeped.
1693 *
1694 * paired with store in *_copy_from_read_buf() -- guarantees
1695 * the consumer has loaded the data in read_buf up to the new
1696 * read_tail (so this producer will not overwrite unread data)
1697 */
1698 size_t tail = smp_load_acquire(&ldata->read_tail);
Peter Hurley70aca712015-01-16 15:05:37 -05001699
Peter Hurleyfb5ef9e2015-01-16 15:05:39 -05001700 room = N_TTY_BUF_SIZE - (ldata->read_head - tail);
Peter Hurley70aca712015-01-16 15:05:37 -05001701 if (I_PARMRK(tty))
Peter Hurleyfb5ef9e2015-01-16 15:05:39 -05001702 room = (room + 2) / 3;
1703 room--;
1704 if (room <= 0) {
1705 overflow = ldata->icanon && ldata->canon_head == tail;
1706 if (overflow && room < 0)
1707 ldata->read_head--;
1708 room = overflow;
1709 ldata->no_room = flow && !room;
1710 } else
1711 overflow = 0;
Peter Hurley70aca712015-01-16 15:05:37 -05001712
Peter Hurley19e2ad62013-07-24 08:29:54 -04001713 n = min(count, room);
Peter Hurleyfb5ef9e2015-01-16 15:05:39 -05001714 if (!n)
Peter Hurley19e2ad62013-07-24 08:29:54 -04001715 break;
Peter Hurleyfb5ef9e2015-01-16 15:05:39 -05001716
1717 /* ignore parity errors if handling overflow */
1718 if (!overflow || !fp || *fp != TTY_PARITY)
1719 __receive_buf(tty, cp, fp, n);
1720
Peter Hurley19e2ad62013-07-24 08:29:54 -04001721 cp += n;
1722 if (fp)
1723 fp += n;
1724 count -= n;
1725 rcvd += n;
Peter Hurley4a23a4d2013-06-15 10:21:22 -04001726 }
Peter Hurley24a89d12013-06-15 09:14:15 -04001727
Peter Hurley19e2ad62013-07-24 08:29:54 -04001728 tty->receive_room = room;
Peter Hurleyfb5ef9e2015-01-16 15:05:39 -05001729
1730 /* Unthrottle if handling overflow on pty */
1731 if (tty->driver->type == TTY_DRIVER_TYPE_PTY) {
1732 if (overflow) {
1733 tty_set_flow_change(tty, TTY_UNTHROTTLE_SAFE);
1734 tty_unthrottle_safe(tty);
1735 __tty_set_flow_change(tty, 0);
1736 }
1737 } else
1738 n_tty_check_throttle(tty);
1739
Peter Hurley9356b532013-06-15 09:14:24 -04001740 up_read(&tty->termios_rwsem);
1741
Peter Hurley19e2ad62013-07-24 08:29:54 -04001742 return rcvd;
Peter Hurley24a89d12013-06-15 09:14:15 -04001743}
1744
Peter Hurley5c32d122013-12-02 14:24:41 -05001745static void n_tty_receive_buf(struct tty_struct *tty, const unsigned char *cp,
1746 char *fp, int count)
1747{
1748 n_tty_receive_buf_common(tty, cp, fp, count, 0);
1749}
1750
1751static int n_tty_receive_buf2(struct tty_struct *tty, const unsigned char *cp,
1752 char *fp, int count)
1753{
1754 return n_tty_receive_buf_common(tty, cp, fp, count, 1);
1755}
1756
Linus Torvalds1da177e2005-04-16 15:20:36 -07001757int is_ignored(int sig)
1758{
1759 return (sigismember(&current->blocked, sig) ||
Alan Cox4edf1822008-02-08 04:18:44 -08001760 current->sighand->action[sig-1].sa.sa_handler == SIG_IGN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001761}
1762
1763/**
1764 * n_tty_set_termios - termios data changed
1765 * @tty: terminal
1766 * @old: previous data
1767 *
1768 * Called by the tty layer when the user changes termios flags so
1769 * that the line discipline can plan ahead. This function cannot sleep
Alan Cox4edf1822008-02-08 04:18:44 -08001770 * and is protected from re-entry by the tty layer. The user is
Linus Torvalds1da177e2005-04-16 15:20:36 -07001771 * guaranteed that this function will not be re-entered or in progress
1772 * when the ldisc is closed.
Alan Cox17b82062008-10-13 10:45:06 +01001773 *
Peter Hurley6a1c0682013-06-15 09:14:23 -04001774 * Locking: Caller holds tty->termios_rwsem
Linus Torvalds1da177e2005-04-16 15:20:36 -07001775 */
Alan Cox4edf1822008-02-08 04:18:44 -08001776
1777static void n_tty_set_termios(struct tty_struct *tty, struct ktermios *old)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001778{
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001779 struct n_tty_data *ldata = tty->disc_data;
Alan Cox47afa7a2008-10-13 10:44:17 +01001780
Peter Hurleyc786f742013-09-17 12:53:35 -04001781 if (!old || (old->c_lflag ^ tty->termios.c_lflag) & ICANON) {
Jiri Slaby3fe780b2012-10-18 22:26:40 +02001782 bitmap_zero(ldata->read_flags, N_TTY_BUF_SIZE);
Peter Hurley4d0ed182013-12-10 17:12:02 -05001783 ldata->line_start = ldata->read_tail;
1784 if (!L_ICANON(tty) || !read_cnt(ldata)) {
1785 ldata->canon_head = ldata->read_tail;
1786 ldata->push = 0;
1787 } else {
1788 set_bit((ldata->read_head - 1) & (N_TTY_BUF_SIZE - 1),
1789 ldata->read_flags);
1790 ldata->canon_head = ldata->read_head;
1791 ldata->push = 1;
1792 }
Peter Hurley70aca712015-01-16 15:05:37 -05001793 ldata->commit_head = ldata->read_head;
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001794 ldata->erasing = 0;
Peter Hurley6f9b0282013-06-15 09:14:27 -04001795 ldata->lnext = 0;
Alan Cox47afa7a2008-10-13 10:44:17 +01001796 }
1797
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001798 ldata->icanon = (L_ICANON(tty) != 0);
Peter Hurley582f5592013-05-17 12:49:48 -04001799
Linus Torvalds1da177e2005-04-16 15:20:36 -07001800 if (I_ISTRIP(tty) || I_IUCLC(tty) || I_IGNCR(tty) ||
1801 I_ICRNL(tty) || I_INLCR(tty) || L_ICANON(tty) ||
1802 I_IXON(tty) || L_ISIG(tty) || L_ECHO(tty) ||
1803 I_PARMRK(tty)) {
Peter Hurley1bb9d562013-06-15 10:21:20 -04001804 bitmap_zero(ldata->char_map, 256);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001805
1806 if (I_IGNCR(tty) || I_ICRNL(tty))
Peter Hurley1bb9d562013-06-15 10:21:20 -04001807 set_bit('\r', ldata->char_map);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001808 if (I_INLCR(tty))
Peter Hurley1bb9d562013-06-15 10:21:20 -04001809 set_bit('\n', ldata->char_map);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001810
1811 if (L_ICANON(tty)) {
Peter Hurley1bb9d562013-06-15 10:21:20 -04001812 set_bit(ERASE_CHAR(tty), ldata->char_map);
1813 set_bit(KILL_CHAR(tty), ldata->char_map);
1814 set_bit(EOF_CHAR(tty), ldata->char_map);
1815 set_bit('\n', ldata->char_map);
1816 set_bit(EOL_CHAR(tty), ldata->char_map);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001817 if (L_IEXTEN(tty)) {
Peter Hurley1bb9d562013-06-15 10:21:20 -04001818 set_bit(WERASE_CHAR(tty), ldata->char_map);
1819 set_bit(LNEXT_CHAR(tty), ldata->char_map);
1820 set_bit(EOL2_CHAR(tty), ldata->char_map);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001821 if (L_ECHO(tty))
1822 set_bit(REPRINT_CHAR(tty),
Peter Hurley1bb9d562013-06-15 10:21:20 -04001823 ldata->char_map);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001824 }
1825 }
1826 if (I_IXON(tty)) {
Peter Hurley1bb9d562013-06-15 10:21:20 -04001827 set_bit(START_CHAR(tty), ldata->char_map);
1828 set_bit(STOP_CHAR(tty), ldata->char_map);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001829 }
1830 if (L_ISIG(tty)) {
Peter Hurley1bb9d562013-06-15 10:21:20 -04001831 set_bit(INTR_CHAR(tty), ldata->char_map);
1832 set_bit(QUIT_CHAR(tty), ldata->char_map);
1833 set_bit(SUSP_CHAR(tty), ldata->char_map);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001834 }
Peter Hurley1bb9d562013-06-15 10:21:20 -04001835 clear_bit(__DISABLED_CHAR, ldata->char_map);
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001836 ldata->raw = 0;
1837 ldata->real_raw = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001838 } else {
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001839 ldata->raw = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001840 if ((I_IGNBRK(tty) || (!I_BRKINT(tty) && !I_PARMRK(tty))) &&
1841 (I_IGNPAR(tty) || !I_INPCK(tty)) &&
1842 (tty->driver->flags & TTY_DRIVER_REAL_RAW))
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001843 ldata->real_raw = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001844 else
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001845 ldata->real_raw = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001846 }
Wang YanQingdab73b42013-05-09 14:16:47 +08001847 /*
1848 * Fix tty hang when I_IXON(tty) is cleared, but the tty
1849 * been stopped by STOP_CHAR(tty) before it.
1850 */
Peter Hurleye2613be2014-02-11 16:34:55 -05001851 if (!I_IXON(tty) && old && (old->c_iflag & IXON) && !tty->flow_stopped) {
Wang YanQingdab73b42013-05-09 14:16:47 +08001852 start_tty(tty);
Peter Hurleye2613be2014-02-11 16:34:55 -05001853 process_echoes(tty);
1854 }
Wang YanQingdab73b42013-05-09 14:16:47 +08001855
Alan Coxf34d7a52008-04-30 00:54:13 -07001856 /* The termios change make the tty ready for I/O */
Peter Hurley6c677162013-12-02 14:24:46 -05001857 if (waitqueue_active(&tty->write_wait))
1858 wake_up_interruptible(&tty->write_wait);
1859 if (waitqueue_active(&tty->read_wait))
1860 wake_up_interruptible(&tty->read_wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001861}
1862
1863/**
1864 * n_tty_close - close the ldisc for this tty
1865 * @tty: device
1866 *
Alan Cox4edf1822008-02-08 04:18:44 -08001867 * Called from the terminal layer when this line discipline is
1868 * being shut down, either because of a close or becsuse of a
Linus Torvalds1da177e2005-04-16 15:20:36 -07001869 * discipline change. The function will not be called while other
1870 * ldisc methods are in progress.
1871 */
Alan Cox4edf1822008-02-08 04:18:44 -08001872
Linus Torvalds1da177e2005-04-16 15:20:36 -07001873static void n_tty_close(struct tty_struct *tty)
1874{
Jiri Slaby70ece7a2012-10-18 22:26:38 +02001875 struct n_tty_data *ldata = tty->disc_data;
1876
Peter Hurley79901312013-03-11 16:44:23 -04001877 if (tty->link)
1878 n_tty_packet_mode_flush(tty);
1879
Peter Hurley20bafb32013-06-15 10:21:19 -04001880 vfree(ldata);
Jiri Slaby70ece7a2012-10-18 22:26:38 +02001881 tty->disc_data = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001882}
1883
1884/**
1885 * n_tty_open - open an ldisc
1886 * @tty: terminal to open
1887 *
Alan Cox4edf1822008-02-08 04:18:44 -08001888 * Called when this line discipline is being attached to the
Linus Torvalds1da177e2005-04-16 15:20:36 -07001889 * terminal device. Can sleep. Called serialized so that no
1890 * other events will occur in parallel. No further open will occur
1891 * until a close.
1892 */
1893
1894static int n_tty_open(struct tty_struct *tty)
1895{
Jiri Slaby70ece7a2012-10-18 22:26:38 +02001896 struct n_tty_data *ldata;
1897
Peter Hurley20bafb32013-06-15 10:21:19 -04001898 /* Currently a malloc failure here can panic */
1899 ldata = vmalloc(sizeof(*ldata));
Jiri Slaby70ece7a2012-10-18 22:26:38 +02001900 if (!ldata)
1901 goto err;
1902
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001903 ldata->overrun_time = jiffies;
Jiri Slabybddc7152012-10-18 22:26:42 +02001904 mutex_init(&ldata->atomic_read_lock);
1905 mutex_init(&ldata->output_lock);
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001906
Jiri Slaby70ece7a2012-10-18 22:26:38 +02001907 tty->disc_data = ldata;
Peter Hurleyb66f4fa2013-03-11 16:44:32 -04001908 reset_buffer_flags(tty->disc_data);
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001909 ldata->column = 0;
Peter Hurley20bafb32013-06-15 10:21:19 -04001910 ldata->canon_column = 0;
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04001911 ldata->minimum_to_wake = 1;
Peter Hurley20bafb32013-06-15 10:21:19 -04001912 ldata->num_overrun = 0;
1913 ldata->no_room = 0;
1914 ldata->lnext = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001915 tty->closing = 0;
Peter Hurleyb66f4fa2013-03-11 16:44:32 -04001916 /* indicate buffer work may resume */
1917 clear_bit(TTY_LDISC_HALTED, &tty->flags);
1918 n_tty_set_termios(tty, NULL);
1919 tty_unthrottle(tty);
Jiri Slaby70ece7a2012-10-18 22:26:38 +02001920
Linus Torvalds1da177e2005-04-16 15:20:36 -07001921 return 0;
Jiri Slaby70ece7a2012-10-18 22:26:38 +02001922err:
Jiri Slabyb91939f2012-10-18 22:26:35 +02001923 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001924}
1925
Peter Hurleyeafbe672013-12-02 14:24:45 -05001926static inline int input_available_p(struct tty_struct *tty, int poll)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001927{
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001928 struct n_tty_data *ldata = tty->disc_data;
Peter Hurleya5934802014-02-11 11:49:58 -05001929 int amt = poll && !TIME_CHAR(tty) && MIN_CHAR(tty) ? MIN_CHAR(tty) : 1;
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001930
Peter Hurley25e8d0e2014-02-11 18:55:30 -05001931 if (ldata->icanon && !L_EXTPROC(tty))
1932 return ldata->canon_head != ldata->read_tail;
1933 else
Peter Hurley70aca712015-01-16 15:05:37 -05001934 return ldata->commit_head - ldata->read_tail >= amt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001935}
1936
1937/**
Thorsten Wißmannbbd20752011-12-08 17:47:33 +01001938 * copy_from_read_buf - copy read data directly
Linus Torvalds1da177e2005-04-16 15:20:36 -07001939 * @tty: terminal device
1940 * @b: user data
1941 * @nr: size of data
1942 *
Alan Cox11a96d12008-10-13 10:46:24 +01001943 * Helper function to speed up n_tty_read. It is only called when
Linus Torvalds1da177e2005-04-16 15:20:36 -07001944 * ICANON is off; it copies characters straight from the tty queue to
1945 * user space directly. It can be profitably called twice; once to
1946 * drain the space from the tail pointer to the (physical) end of the
1947 * buffer, and once to drain the space from the (physical) beginning of
1948 * the buffer to head pointer.
1949 *
Jiri Slabybddc7152012-10-18 22:26:42 +02001950 * Called under the ldata->atomic_read_lock sem
Linus Torvalds1da177e2005-04-16 15:20:36 -07001951 *
Peter Hurley6d76bd22013-06-15 09:14:26 -04001952 * n_tty_read()/consumer path:
1953 * caller holds non-exclusive termios_rwsem
1954 * read_tail published
Linus Torvalds1da177e2005-04-16 15:20:36 -07001955 */
Alan Cox4edf1822008-02-08 04:18:44 -08001956
Alan Cox33f0f882006-01-09 20:54:13 -08001957static int copy_from_read_buf(struct tty_struct *tty,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001958 unsigned char __user **b,
1959 size_t *nr)
1960
1961{
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001962 struct n_tty_data *ldata = tty->disc_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001963 int retval;
1964 size_t n;
Jiri Slaby3fa10cc2012-04-26 20:13:00 +02001965 bool is_eof;
Peter Hurley70aca712015-01-16 15:05:37 -05001966 size_t head = smp_load_acquire(&ldata->commit_head);
Peter Hurleybc5a5e32013-06-15 09:14:21 -04001967 size_t tail = ldata->read_tail & (N_TTY_BUF_SIZE - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001968
1969 retval = 0;
Peter Hurley70aca712015-01-16 15:05:37 -05001970 n = min(head - ldata->read_tail, N_TTY_BUF_SIZE - tail);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001971 n = min(*nr, n);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001972 if (n) {
Peter Hurleybc5a5e32013-06-15 09:14:21 -04001973 retval = copy_to_user(*b, read_buf_addr(ldata, tail), n);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001974 n -= retval;
Peter Hurleybc5a5e32013-06-15 09:14:21 -04001975 is_eof = n == 1 && read_buf(ldata, tail) == EOF_CHAR(tty);
1976 tty_audit_add_data(tty, read_buf_addr(ldata, tail), n,
Jiri Slaby53c5ee22012-10-18 22:26:39 +02001977 ldata->icanon);
Peter Hurley70aca712015-01-16 15:05:37 -05001978 smp_store_release(&ldata->read_tail, ldata->read_tail + n);
hyc@symas.com26df6d12010-06-22 10:14:49 -07001979 /* Turn single EOF into zero-length read */
Peter Hurley70aca712015-01-16 15:05:37 -05001980 if (L_EXTPROC(tty) && ldata->icanon && is_eof &&
1981 (head == ldata->read_tail))
Jiri Slaby3fa10cc2012-04-26 20:13:00 +02001982 n = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001983 *b += n;
1984 *nr -= n;
1985 }
1986 return retval;
1987}
1988
Peter Hurley88bb0de2013-06-15 09:14:16 -04001989/**
Peter Hurley32f13522013-06-15 09:14:17 -04001990 * canon_copy_from_read_buf - copy read data in canonical mode
Peter Hurley88bb0de2013-06-15 09:14:16 -04001991 * @tty: terminal device
1992 * @b: user data
1993 * @nr: size of data
1994 *
1995 * Helper function for n_tty_read. It is only called when ICANON is on;
Peter Hurley32f13522013-06-15 09:14:17 -04001996 * it copies one line of input up to and including the line-delimiting
1997 * character into the user-space buffer.
Peter Hurley88bb0de2013-06-15 09:14:16 -04001998 *
Peter Hurley4d0ed182013-12-10 17:12:02 -05001999 * NB: When termios is changed from non-canonical to canonical mode and
2000 * the read buffer contains data, n_tty_set_termios() simulates an EOF
2001 * push (as if C-d were input) _without_ the DISABLED_CHAR in the buffer.
2002 * This causes data already processed as input to be immediately available
2003 * as input although a newline has not been received.
2004 *
Peter Hurley88bb0de2013-06-15 09:14:16 -04002005 * Called under the atomic_read_lock mutex
Peter Hurley6d76bd22013-06-15 09:14:26 -04002006 *
2007 * n_tty_read()/consumer path:
2008 * caller holds non-exclusive termios_rwsem
2009 * read_tail published
Peter Hurley88bb0de2013-06-15 09:14:16 -04002010 */
2011
Peter Hurley32f13522013-06-15 09:14:17 -04002012static int canon_copy_from_read_buf(struct tty_struct *tty,
2013 unsigned char __user **b,
2014 size_t *nr)
Peter Hurley88bb0de2013-06-15 09:14:16 -04002015{
2016 struct n_tty_data *ldata = tty->disc_data;
Peter Hurley32f13522013-06-15 09:14:17 -04002017 size_t n, size, more, c;
Peter Hurleybc5a5e32013-06-15 09:14:21 -04002018 size_t eol;
2019 size_t tail;
2020 int ret, found = 0;
Peter Hurley40d5e092013-06-15 10:21:17 -04002021 bool eof_push = 0;
Peter Hurley88bb0de2013-06-15 09:14:16 -04002022
2023 /* N.B. avoid overrun if nr == 0 */
Peter Hurley70aca712015-01-16 15:05:37 -05002024 n = min(*nr, smp_load_acquire(&ldata->canon_head) - ldata->read_tail);
Peter Hurley6d76bd22013-06-15 09:14:26 -04002025 if (!n)
Peter Hurley32f13522013-06-15 09:14:17 -04002026 return 0;
Peter Hurley88bb0de2013-06-15 09:14:16 -04002027
Peter Hurleybc5a5e32013-06-15 09:14:21 -04002028 tail = ldata->read_tail & (N_TTY_BUF_SIZE - 1);
Peter Hurley32f13522013-06-15 09:14:17 -04002029 size = min_t(size_t, tail + n, N_TTY_BUF_SIZE);
2030
Peter Hurleybc5a5e32013-06-15 09:14:21 -04002031 n_tty_trace("%s: nr:%zu tail:%zu n:%zu size:%zu\n",
Peter Hurley32f13522013-06-15 09:14:17 -04002032 __func__, *nr, tail, n, size);
2033
2034 eol = find_next_bit(ldata->read_flags, size, tail);
2035 more = n - (size - tail);
2036 if (eol == N_TTY_BUF_SIZE && more) {
2037 /* scan wrapped without finding set bit */
2038 eol = find_next_bit(ldata->read_flags, more, 0);
2039 if (eol != more)
2040 found = 1;
2041 } else if (eol != size)
2042 found = 1;
2043
2044 size = N_TTY_BUF_SIZE - tail;
Peter Hurleyc77569d2013-11-22 07:16:25 -05002045 n = eol - tail;
2046 if (n > 4096)
2047 n += 4096;
2048 n += found;
Peter Hurley32f13522013-06-15 09:14:17 -04002049 c = n;
2050
Peter Hurley4d0ed182013-12-10 17:12:02 -05002051 if (found && !ldata->push && read_buf(ldata, eol) == __DISABLED_CHAR) {
Peter Hurley32f13522013-06-15 09:14:17 -04002052 n--;
Peter Hurley40d5e092013-06-15 10:21:17 -04002053 eof_push = !n && ldata->read_tail != ldata->line_start;
2054 }
Peter Hurley32f13522013-06-15 09:14:17 -04002055
Peter Hurleybc5a5e32013-06-15 09:14:21 -04002056 n_tty_trace("%s: eol:%zu found:%d n:%zu c:%zu size:%zu more:%zu\n",
Peter Hurley32f13522013-06-15 09:14:17 -04002057 __func__, eol, found, n, c, size, more);
2058
Peter Hurley32f13522013-06-15 09:14:17 -04002059 if (n > size) {
Peter Hurleybc5a5e32013-06-15 09:14:21 -04002060 ret = copy_to_user(*b, read_buf_addr(ldata, tail), size);
Peter Hurley32f13522013-06-15 09:14:17 -04002061 if (ret)
2062 return -EFAULT;
2063 ret = copy_to_user(*b + size, ldata->read_buf, n - size);
2064 } else
Peter Hurleybc5a5e32013-06-15 09:14:21 -04002065 ret = copy_to_user(*b, read_buf_addr(ldata, tail), n);
Peter Hurley32f13522013-06-15 09:14:17 -04002066
2067 if (ret)
2068 return -EFAULT;
2069 *b += n;
2070 *nr -= n;
2071
Peter Hurleya73d3d62013-06-15 09:14:25 -04002072 if (found)
Peter Hurley6d76bd22013-06-15 09:14:26 -04002073 clear_bit(eol, ldata->read_flags);
Peter Hurley70aca712015-01-16 15:05:37 -05002074 smp_store_release(&ldata->read_tail, ldata->read_tail + c);
Peter Hurley88bb0de2013-06-15 09:14:16 -04002075
Peter Hurley40d5e092013-06-15 10:21:17 -04002076 if (found) {
Peter Hurley4d0ed182013-12-10 17:12:02 -05002077 if (!ldata->push)
2078 ldata->line_start = ldata->read_tail;
2079 else
2080 ldata->push = 0;
Peter Hurley32f13522013-06-15 09:14:17 -04002081 tty_audit_push(tty);
Peter Hurley40d5e092013-06-15 10:21:17 -04002082 }
2083 return eof_push ? -EAGAIN : 0;
Peter Hurley88bb0de2013-06-15 09:14:16 -04002084}
2085
Al Virocc4191d2008-03-29 03:08:48 +00002086extern ssize_t redirected_tty_write(struct file *, const char __user *,
Alan Cox4edf1822008-02-08 04:18:44 -08002087 size_t, loff_t *);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002088
2089/**
2090 * job_control - check job control
2091 * @tty: tty
2092 * @file: file handle
2093 *
2094 * Perform job control management checks on this file/tty descriptor
Alan Cox4edf1822008-02-08 04:18:44 -08002095 * and if appropriate send any needed signals and return a negative
Linus Torvalds1da177e2005-04-16 15:20:36 -07002096 * error code if action should be taken.
Alan Cox04f378b2008-04-30 00:53:29 -07002097 *
Peter Hurley01a5e442013-03-06 08:38:20 -05002098 * Locking: redirected write test is safe
2099 * current->signal->tty check is safe
2100 * ctrl_lock to safely reference tty->pgrp
Linus Torvalds1da177e2005-04-16 15:20:36 -07002101 */
Alan Cox4edf1822008-02-08 04:18:44 -08002102
Linus Torvalds1da177e2005-04-16 15:20:36 -07002103static int job_control(struct tty_struct *tty, struct file *file)
2104{
2105 /* Job control check -- must be done at start and after
2106 every sleep (POSIX.1 7.1.1.4). */
2107 /* NOTE: not yet done after every sleep pending a thorough
2108 check of the logic of this change. -- jlc */
2109 /* don't stop on /dev/console */
Peter Hurley01a5e442013-03-06 08:38:20 -05002110 if (file->f_op->write == redirected_tty_write ||
2111 current->signal->tty != tty)
2112 return 0;
2113
2114 spin_lock_irq(&tty->ctrl_lock);
2115 if (!tty->pgrp)
2116 printk(KERN_ERR "n_tty_read: no tty->pgrp!\n");
2117 else if (task_pgrp(current) != tty->pgrp) {
2118 spin_unlock_irq(&tty->ctrl_lock);
2119 if (is_ignored(SIGTTIN) || is_current_pgrp_orphaned())
2120 return -EIO;
2121 kill_pgrp(task_pgrp(current), SIGTTIN, 1);
2122 set_thread_flag(TIF_SIGPENDING);
2123 return -ERESTARTSYS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002124 }
Peter Hurley01a5e442013-03-06 08:38:20 -05002125 spin_unlock_irq(&tty->ctrl_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002126 return 0;
2127}
Alan Cox4edf1822008-02-08 04:18:44 -08002128
Linus Torvalds1da177e2005-04-16 15:20:36 -07002129
2130/**
Alan Cox11a96d12008-10-13 10:46:24 +01002131 * n_tty_read - read function for tty
Linus Torvalds1da177e2005-04-16 15:20:36 -07002132 * @tty: tty device
2133 * @file: file object
2134 * @buf: userspace buffer pointer
2135 * @nr: size of I/O
2136 *
2137 * Perform reads for the line discipline. We are guaranteed that the
2138 * line discipline will not be closed under us but we may get multiple
2139 * parallel readers and must handle this ourselves. We may also get
2140 * a hangup. Always called in user context, may sleep.
2141 *
2142 * This code must be sure never to sleep through a hangup.
Peter Hurley6d76bd22013-06-15 09:14:26 -04002143 *
2144 * n_tty_read()/consumer path:
2145 * claims non-exclusive termios_rwsem
2146 * publishes read_tail
Linus Torvalds1da177e2005-04-16 15:20:36 -07002147 */
Alan Cox4edf1822008-02-08 04:18:44 -08002148
Alan Cox11a96d12008-10-13 10:46:24 +01002149static ssize_t n_tty_read(struct tty_struct *tty, struct file *file,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002150 unsigned char __user *buf, size_t nr)
2151{
Jiri Slaby53c5ee22012-10-18 22:26:39 +02002152 struct n_tty_data *ldata = tty->disc_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002153 unsigned char __user *b = buf;
Peter Zijlstra97d9e282014-09-24 10:18:51 +02002154 DEFINE_WAIT_FUNC(wait, woken_wake_function);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002155 int c;
2156 int minimum, time;
2157 ssize_t retval = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002158 long timeout;
Alan Cox04f378b2008-04-30 00:53:29 -07002159 int packet;
Peter Hurley2c5dc462015-01-16 15:05:34 -05002160 size_t tail;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002161
Linus Torvalds1da177e2005-04-16 15:20:36 -07002162 c = job_control(tty, file);
Alan Cox4edf1822008-02-08 04:18:44 -08002163 if (c < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002164 return c;
Alan Cox4edf1822008-02-08 04:18:44 -08002165
Peter Hurleyaefceaf2013-08-11 08:04:23 -04002166 /*
2167 * Internal serialization of reads.
2168 */
2169 if (file->f_flags & O_NONBLOCK) {
2170 if (!mutex_trylock(&ldata->atomic_read_lock))
2171 return -EAGAIN;
2172 } else {
2173 if (mutex_lock_interruptible(&ldata->atomic_read_lock))
2174 return -ERESTARTSYS;
2175 }
2176
Peter Hurley9356b532013-06-15 09:14:24 -04002177 down_read(&tty->termios_rwsem);
2178
Linus Torvalds1da177e2005-04-16 15:20:36 -07002179 minimum = time = 0;
2180 timeout = MAX_SCHEDULE_TIMEOUT;
Jiri Slaby53c5ee22012-10-18 22:26:39 +02002181 if (!ldata->icanon) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002182 minimum = MIN_CHAR(tty);
2183 if (minimum) {
Peter Hurleya6e54312013-06-15 07:28:29 -04002184 time = (HZ / 10) * TIME_CHAR(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002185 if (time)
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04002186 ldata->minimum_to_wake = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002187 else if (!waitqueue_active(&tty->read_wait) ||
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04002188 (ldata->minimum_to_wake > minimum))
2189 ldata->minimum_to_wake = minimum;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002190 } else {
Peter Hurleya6e54312013-06-15 07:28:29 -04002191 timeout = (HZ / 10) * TIME_CHAR(tty);
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04002192 ldata->minimum_to_wake = minimum = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002193 }
2194 }
2195
Alan Cox04f378b2008-04-30 00:53:29 -07002196 packet = tty->packet;
Peter Hurley2c5dc462015-01-16 15:05:34 -05002197 tail = ldata->read_tail;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002198
2199 add_wait_queue(&tty->read_wait, &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002200 while (nr) {
2201 /* First test for status change. */
Alan Cox04f378b2008-04-30 00:53:29 -07002202 if (packet && tty->link->ctrl_status) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002203 unsigned char cs;
2204 if (b != buf)
2205 break;
Peter Hurley6054c16e2014-10-16 15:33:25 -04002206 spin_lock_irq(&tty->link->ctrl_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002207 cs = tty->link->ctrl_status;
2208 tty->link->ctrl_status = 0;
Peter Hurley6054c16e2014-10-16 15:33:25 -04002209 spin_unlock_irq(&tty->link->ctrl_lock);
Miloslav Trmac522ed772007-07-15 23:40:56 -07002210 if (tty_put_user(tty, cs, b++)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002211 retval = -EFAULT;
2212 b--;
2213 break;
2214 }
2215 nr--;
2216 break;
2217 }
Alan Cox4edf1822008-02-08 04:18:44 -08002218
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04002219 if (((minimum - (b - buf)) < ldata->minimum_to_wake) &&
Linus Torvalds1da177e2005-04-16 15:20:36 -07002220 ((minimum - (b - buf)) >= 1))
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04002221 ldata->minimum_to_wake = (minimum - (b - buf));
Alan Cox4edf1822008-02-08 04:18:44 -08002222
Linus Torvalds1da177e2005-04-16 15:20:36 -07002223 if (!input_available_p(tty, 0)) {
2224 if (test_bit(TTY_OTHER_CLOSED, &tty->flags)) {
Peter Hurley52bce7f2014-11-05 12:13:05 -05002225 retval = -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002226 break;
2227 }
Peter Hurley52bce7f2014-11-05 12:13:05 -05002228 if (tty_hung_up_p(file))
2229 break;
2230 if (!timeout)
2231 break;
2232 if (file->f_flags & O_NONBLOCK) {
2233 retval = -EAGAIN;
2234 break;
2235 }
2236 if (signal_pending(current)) {
2237 retval = -ERESTARTSYS;
2238 break;
2239 }
Peter Hurley52bce7f2014-11-05 12:13:05 -05002240 up_read(&tty->termios_rwsem);
2241
Linus Torvalds37da7bb2014-12-14 15:23:32 -08002242 timeout = wait_woken(&wait, TASK_INTERRUPTIBLE,
2243 timeout);
Peter Hurley52bce7f2014-11-05 12:13:05 -05002244
2245 down_read(&tty->termios_rwsem);
2246 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002247 }
2248
Jiri Slaby53c5ee22012-10-18 22:26:39 +02002249 if (ldata->icanon && !L_EXTPROC(tty)) {
Peter Hurley32f13522013-06-15 09:14:17 -04002250 retval = canon_copy_from_read_buf(tty, &b, &nr);
Peter Hurley40d5e092013-06-15 10:21:17 -04002251 if (retval == -EAGAIN) {
2252 retval = 0;
2253 continue;
2254 } else if (retval)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002255 break;
2256 } else {
2257 int uncopied;
Peter Hurley95ea90d2014-10-16 15:33:30 -04002258
2259 /* Deal with packet mode. */
2260 if (packet && b == buf) {
2261 if (tty_put_user(tty, TIOCPKT_DATA, b++)) {
2262 retval = -EFAULT;
2263 b--;
2264 break;
2265 }
2266 nr--;
2267 }
2268
Linus Torvalds1da177e2005-04-16 15:20:36 -07002269 uncopied = copy_from_read_buf(tty, &b, &nr);
2270 uncopied += copy_from_read_buf(tty, &b, &nr);
2271 if (uncopied) {
2272 retval = -EFAULT;
2273 break;
2274 }
2275 }
2276
Peter Hurley6367ca72013-06-15 09:14:33 -04002277 n_tty_check_unthrottle(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002278
2279 if (b - buf >= minimum)
2280 break;
2281 if (time)
2282 timeout = time;
2283 }
Peter Hurley2c5dc462015-01-16 15:05:34 -05002284 if (tail != ldata->read_tail)
2285 n_tty_kick_worker(tty);
Peter Hurley42458f42013-11-07 13:59:46 -05002286 up_read(&tty->termios_rwsem);
2287
Linus Torvalds1da177e2005-04-16 15:20:36 -07002288 remove_wait_queue(&tty->read_wait, &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002289 if (!waitqueue_active(&tty->read_wait))
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04002290 ldata->minimum_to_wake = minimum;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002291
Peter Hurleyaebf04532013-11-07 14:01:57 -05002292 mutex_unlock(&ldata->atomic_read_lock);
2293
Peter Hurley40d5e092013-06-15 10:21:17 -04002294 if (b - buf)
2295 retval = b - buf;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002296
2297 return retval;
2298}
2299
2300/**
Alan Cox11a96d12008-10-13 10:46:24 +01002301 * n_tty_write - write function for tty
Linus Torvalds1da177e2005-04-16 15:20:36 -07002302 * @tty: tty device
2303 * @file: file object
2304 * @buf: userspace buffer pointer
2305 * @nr: size of I/O
2306 *
Joe Petersona88a69c2009-01-02 13:40:53 +00002307 * Write function of the terminal device. This is serialized with
Linus Torvalds1da177e2005-04-16 15:20:36 -07002308 * respect to other write callers but not to termios changes, reads
Joe Petersona88a69c2009-01-02 13:40:53 +00002309 * and other such events. Since the receive code will echo characters,
2310 * thus calling driver write methods, the output_lock is used in
2311 * the output processing functions called here as well as in the
2312 * echo processing function to protect the column state and space
2313 * left in the buffer.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002314 *
2315 * This code must be sure never to sleep through a hangup.
Joe Petersona88a69c2009-01-02 13:40:53 +00002316 *
2317 * Locking: output_lock to protect column state and space left
2318 * (note that the process_output*() functions take this
2319 * lock themselves)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002320 */
Alan Cox4edf1822008-02-08 04:18:44 -08002321
Alan Cox11a96d12008-10-13 10:46:24 +01002322static ssize_t n_tty_write(struct tty_struct *tty, struct file *file,
Joe Petersona88a69c2009-01-02 13:40:53 +00002323 const unsigned char *buf, size_t nr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002324{
2325 const unsigned char *b = buf;
Peter Zijlstra97d9e282014-09-24 10:18:51 +02002326 DEFINE_WAIT_FUNC(wait, woken_wake_function);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002327 int c;
2328 ssize_t retval = 0;
2329
2330 /* Job control check -- must be done at start (POSIX.1 7.1.1.4). */
2331 if (L_TOSTOP(tty) && file->f_op->write != redirected_tty_write) {
2332 retval = tty_check_change(tty);
2333 if (retval)
2334 return retval;
2335 }
2336
Peter Hurley9356b532013-06-15 09:14:24 -04002337 down_read(&tty->termios_rwsem);
2338
Joe Petersona88a69c2009-01-02 13:40:53 +00002339 /* Write out any echoed characters that are still pending */
2340 process_echoes(tty);
Alan Cox300a6202009-01-02 13:41:04 +00002341
Linus Torvalds1da177e2005-04-16 15:20:36 -07002342 add_wait_queue(&tty->write_wait, &wait);
2343 while (1) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002344 if (signal_pending(current)) {
2345 retval = -ERESTARTSYS;
2346 break;
2347 }
2348 if (tty_hung_up_p(file) || (tty->link && !tty->link->count)) {
2349 retval = -EIO;
2350 break;
2351 }
Peter Hurley582f5592013-05-17 12:49:48 -04002352 if (O_OPOST(tty)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002353 while (nr > 0) {
Joe Petersona88a69c2009-01-02 13:40:53 +00002354 ssize_t num = process_output_block(tty, b, nr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002355 if (num < 0) {
2356 if (num == -EAGAIN)
2357 break;
2358 retval = num;
2359 goto break_out;
2360 }
2361 b += num;
2362 nr -= num;
2363 if (nr == 0)
2364 break;
2365 c = *b;
Joe Petersona88a69c2009-01-02 13:40:53 +00002366 if (process_output(c, tty) < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002367 break;
2368 b++; nr--;
2369 }
Alan Coxf34d7a52008-04-30 00:54:13 -07002370 if (tty->ops->flush_chars)
2371 tty->ops->flush_chars(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002372 } else {
Peter Hurley42910862014-05-03 14:04:59 +02002373 struct n_tty_data *ldata = tty->disc_data;
2374
Roman Zippeld6afe272005-07-07 17:56:55 -07002375 while (nr > 0) {
Peter Hurley42910862014-05-03 14:04:59 +02002376 mutex_lock(&ldata->output_lock);
Alan Coxf34d7a52008-04-30 00:54:13 -07002377 c = tty->ops->write(tty, b, nr);
Peter Hurley42910862014-05-03 14:04:59 +02002378 mutex_unlock(&ldata->output_lock);
Roman Zippeld6afe272005-07-07 17:56:55 -07002379 if (c < 0) {
2380 retval = c;
2381 goto break_out;
2382 }
2383 if (!c)
2384 break;
2385 b += c;
2386 nr -= c;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002387 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002388 }
2389 if (!nr)
2390 break;
2391 if (file->f_flags & O_NONBLOCK) {
2392 retval = -EAGAIN;
2393 break;
2394 }
Peter Hurley9356b532013-06-15 09:14:24 -04002395 up_read(&tty->termios_rwsem);
2396
Peter Zijlstra97d9e282014-09-24 10:18:51 +02002397 wait_woken(&wait, TASK_INTERRUPTIBLE, MAX_SCHEDULE_TIMEOUT);
Peter Hurley9356b532013-06-15 09:14:24 -04002398
2399 down_read(&tty->termios_rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002400 }
2401break_out:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002402 remove_wait_queue(&tty->write_wait, &wait);
Thomas Pfaffff8cb0f2009-01-02 13:47:13 +00002403 if (b - buf != nr && tty->fasync)
2404 set_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
Peter Hurley9356b532013-06-15 09:14:24 -04002405 up_read(&tty->termios_rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002406 return (b - buf) ? b - buf : retval;
2407}
2408
2409/**
Alan Cox11a96d12008-10-13 10:46:24 +01002410 * n_tty_poll - poll method for N_TTY
Linus Torvalds1da177e2005-04-16 15:20:36 -07002411 * @tty: terminal device
2412 * @file: file accessing it
2413 * @wait: poll table
2414 *
2415 * Called when the line discipline is asked to poll() for data or
2416 * for special events. This code is not serialized with respect to
2417 * other events save open/close.
2418 *
2419 * This code must be sure never to sleep through a hangup.
2420 * Called without the kernel lock held - fine
Linus Torvalds1da177e2005-04-16 15:20:36 -07002421 */
Alan Cox4edf1822008-02-08 04:18:44 -08002422
Alan Cox11a96d12008-10-13 10:46:24 +01002423static unsigned int n_tty_poll(struct tty_struct *tty, struct file *file,
Alan Cox4edf1822008-02-08 04:18:44 -08002424 poll_table *wait)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002425{
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04002426 struct n_tty_data *ldata = tty->disc_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002427 unsigned int mask = 0;
2428
2429 poll_wait(file, &tty->read_wait, wait);
2430 poll_wait(file, &tty->write_wait, wait);
Francesco Ruggeric4dc3042014-10-10 13:09:53 -07002431 if (input_available_p(tty, 1))
2432 mask |= POLLIN | POLLRDNORM;
Francesco Ruggeric4dc3042014-10-10 13:09:53 -07002433 if (tty->packet && tty->link->ctrl_status)
2434 mask |= POLLPRI | POLLIN | POLLRDNORM;
Peter Hurley2ce3c102014-12-30 07:17:09 -05002435 if (test_bit(TTY_OTHER_CLOSED, &tty->flags))
2436 mask |= POLLHUP;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002437 if (tty_hung_up_p(file))
2438 mask |= POLLHUP;
2439 if (!(mask & (POLLHUP | POLLIN | POLLRDNORM))) {
2440 if (MIN_CHAR(tty) && !TIME_CHAR(tty))
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04002441 ldata->minimum_to_wake = MIN_CHAR(tty);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002442 else
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04002443 ldata->minimum_to_wake = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002444 }
Alan Coxf34d7a52008-04-30 00:54:13 -07002445 if (tty->ops->write && !tty_is_writelocked(tty) &&
2446 tty_chars_in_buffer(tty) < WAKEUP_CHARS &&
2447 tty_write_room(tty) > 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002448 mask |= POLLOUT | POLLWRNORM;
2449 return mask;
2450}
2451
Jiri Slaby57c94122012-10-18 22:26:43 +02002452static unsigned long inq_canon(struct n_tty_data *ldata)
Alan Cox47afa7a2008-10-13 10:44:17 +01002453{
Peter Hurleybc5a5e32013-06-15 09:14:21 -04002454 size_t nr, head, tail;
Alan Cox47afa7a2008-10-13 10:44:17 +01002455
Peter Hurleya73d3d62013-06-15 09:14:25 -04002456 if (ldata->canon_head == ldata->read_tail)
Alan Cox47afa7a2008-10-13 10:44:17 +01002457 return 0;
Jiri Slabyba2e68a2012-10-18 22:26:41 +02002458 head = ldata->canon_head;
2459 tail = ldata->read_tail;
Peter Hurleybc5a5e32013-06-15 09:14:21 -04002460 nr = head - tail;
Alan Cox47afa7a2008-10-13 10:44:17 +01002461 /* Skip EOF-chars.. */
2462 while (head != tail) {
Peter Hurleybc5a5e32013-06-15 09:14:21 -04002463 if (test_bit(tail & (N_TTY_BUF_SIZE - 1), ldata->read_flags) &&
2464 read_buf(ldata, tail) == __DISABLED_CHAR)
Alan Cox47afa7a2008-10-13 10:44:17 +01002465 nr--;
Peter Hurleybc5a5e32013-06-15 09:14:21 -04002466 tail++;
Alan Cox47afa7a2008-10-13 10:44:17 +01002467 }
2468 return nr;
2469}
2470
2471static int n_tty_ioctl(struct tty_struct *tty, struct file *file,
2472 unsigned int cmd, unsigned long arg)
2473{
Jiri Slabyba2e68a2012-10-18 22:26:41 +02002474 struct n_tty_data *ldata = tty->disc_data;
Alan Cox47afa7a2008-10-13 10:44:17 +01002475 int retval;
2476
2477 switch (cmd) {
2478 case TIOCOUTQ:
2479 return put_user(tty_chars_in_buffer(tty), (int __user *) arg);
2480 case TIOCINQ:
Peter Hurley6d76bd22013-06-15 09:14:26 -04002481 down_write(&tty->termios_rwsem);
Alan Cox47afa7a2008-10-13 10:44:17 +01002482 if (L_ICANON(tty))
Jiri Slaby57c94122012-10-18 22:26:43 +02002483 retval = inq_canon(ldata);
Peter Hurley6d76bd22013-06-15 09:14:26 -04002484 else
2485 retval = read_cnt(ldata);
2486 up_write(&tty->termios_rwsem);
Alan Cox47afa7a2008-10-13 10:44:17 +01002487 return put_user(retval, (unsigned int __user *) arg);
2488 default:
2489 return n_tty_ioctl_helper(tty, file, cmd, arg);
2490 }
2491}
2492
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04002493static void n_tty_fasync(struct tty_struct *tty, int on)
2494{
2495 struct n_tty_data *ldata = tty->disc_data;
2496
2497 if (!waitqueue_active(&tty->read_wait)) {
2498 if (on)
2499 ldata->minimum_to_wake = 1;
2500 else if (!tty->fasync)
2501 ldata->minimum_to_wake = N_TTY_BUF_SIZE;
2502 }
2503}
2504
Alan Coxa352def2008-07-16 21:53:12 +01002505struct tty_ldisc_ops tty_ldisc_N_TTY = {
Paul Fulghume10cc1d2007-05-10 22:22:50 -07002506 .magic = TTY_LDISC_MAGIC,
2507 .name = "n_tty",
2508 .open = n_tty_open,
2509 .close = n_tty_close,
2510 .flush_buffer = n_tty_flush_buffer,
2511 .chars_in_buffer = n_tty_chars_in_buffer,
Alan Cox11a96d12008-10-13 10:46:24 +01002512 .read = n_tty_read,
2513 .write = n_tty_write,
Paul Fulghume10cc1d2007-05-10 22:22:50 -07002514 .ioctl = n_tty_ioctl,
2515 .set_termios = n_tty_set_termios,
Alan Cox11a96d12008-10-13 10:46:24 +01002516 .poll = n_tty_poll,
Paul Fulghume10cc1d2007-05-10 22:22:50 -07002517 .receive_buf = n_tty_receive_buf,
Peter Hurleyf6c8dbe2013-06-15 07:28:28 -04002518 .write_wakeup = n_tty_write_wakeup,
2519 .fasync = n_tty_fasync,
Peter Hurley24a89d12013-06-15 09:14:15 -04002520 .receive_buf2 = n_tty_receive_buf2,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002521};
Rodolfo Giometti572b9ad2010-03-10 15:23:46 -08002522
2523/**
2524 * n_tty_inherit_ops - inherit N_TTY methods
2525 * @ops: struct tty_ldisc_ops where to save N_TTY methods
2526 *
George Spelvin593fb1ae42013-02-12 02:00:43 -05002527 * Enables a 'subclass' line discipline to 'inherit' N_TTY
Rodolfo Giometti572b9ad2010-03-10 15:23:46 -08002528 * methods.
2529 */
2530
2531void n_tty_inherit_ops(struct tty_ldisc_ops *ops)
2532{
2533 *ops = tty_ldisc_N_TTY;
2534 ops->owner = NULL;
2535 ops->refcount = ops->flags = 0;
2536}
2537EXPORT_SYMBOL_GPL(n_tty_inherit_ops);