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