1
2
3
4
5
6
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 <linux/uaccess.h>
26
27#undef TTY_DEBUG_WAIT_UNTIL_SENT
28
29#ifdef TTY_DEBUG_WAIT_UNTIL_SENT
30# define tty_debug_wait_until_sent(tty, f, args...) tty_debug(tty, f, ##args)
31#else
32# define tty_debug_wait_until_sent(tty, f, args...) do {} while (0)
33#endif
34
35#undef DEBUG
36
37
38
39
40#define TERMIOS_FLUSH 1
41#define TERMIOS_WAIT 2
42#define TERMIOS_TERMIO 4
43#define TERMIOS_OLD 8
44
45
46
47
48
49
50
51
52
53
54
55int tty_chars_in_buffer(struct tty_struct *tty)
56{
57 if (tty->ops->chars_in_buffer)
58 return tty->ops->chars_in_buffer(tty);
59 else
60 return 0;
61}
62EXPORT_SYMBOL(tty_chars_in_buffer);
63
64
65
66
67
68
69
70
71
72
73
74
75int tty_write_room(struct tty_struct *tty)
76{
77 if (tty->ops->write_room)
78 return tty->ops->write_room(tty);
79 return 2048;
80}
81EXPORT_SYMBOL(tty_write_room);
82
83
84
85
86
87
88
89
90
91void tty_driver_flush_buffer(struct tty_struct *tty)
92{
93 if (tty->ops->flush_buffer)
94 tty->ops->flush_buffer(tty);
95}
96EXPORT_SYMBOL(tty_driver_flush_buffer);
97
98
99
100
101
102
103
104
105
106
107
108void tty_throttle(struct tty_struct *tty)
109{
110 down_write(&tty->termios_rwsem);
111
112 if (!test_and_set_bit(TTY_THROTTLED, &tty->flags) &&
113 tty->ops->throttle)
114 tty->ops->throttle(tty);
115 tty->flow_change = 0;
116 up_write(&tty->termios_rwsem);
117}
118EXPORT_SYMBOL(tty_throttle);
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133void tty_unthrottle(struct tty_struct *tty)
134{
135 down_write(&tty->termios_rwsem);
136 if (test_and_clear_bit(TTY_THROTTLED, &tty->flags) &&
137 tty->ops->unthrottle)
138 tty->ops->unthrottle(tty);
139 tty->flow_change = 0;
140 up_write(&tty->termios_rwsem);
141}
142EXPORT_SYMBOL(tty_unthrottle);
143
144
145
146
147
148
149
150
151
152
153
154
155
156int tty_throttle_safe(struct tty_struct *tty)
157{
158 int ret = 0;
159
160 mutex_lock(&tty->throttle_mutex);
161 if (!tty_throttled(tty)) {
162 if (tty->flow_change != TTY_THROTTLE_SAFE)
163 ret = 1;
164 else {
165 set_bit(TTY_THROTTLED, &tty->flags);
166 if (tty->ops->throttle)
167 tty->ops->throttle(tty);
168 }
169 }
170 mutex_unlock(&tty->throttle_mutex);
171
172 return ret;
173}
174
175
176
177
178
179
180
181
182
183
184
185
186
187int tty_unthrottle_safe(struct tty_struct *tty)
188{
189 int ret = 0;
190
191 mutex_lock(&tty->throttle_mutex);
192 if (tty_throttled(tty)) {
193 if (tty->flow_change != TTY_UNTHROTTLE_SAFE)
194 ret = 1;
195 else {
196 clear_bit(TTY_THROTTLED, &tty->flags);
197 if (tty->ops->unthrottle)
198 tty->ops->unthrottle(tty);
199 }
200 }
201 mutex_unlock(&tty->throttle_mutex);
202
203 return ret;
204}
205
206
207
208
209
210
211
212
213
214
215
216
217void tty_wait_until_sent(struct tty_struct *tty, long timeout)
218{
219 tty_debug_wait_until_sent(tty, "wait until sent, timeout=%ld\n", timeout);
220
221 if (!timeout)
222 timeout = MAX_SCHEDULE_TIMEOUT;
223
224 timeout = wait_event_interruptible_timeout(tty->write_wait,
225 !tty_chars_in_buffer(tty), timeout);
226 if (timeout <= 0)
227 return;
228
229 if (timeout == MAX_SCHEDULE_TIMEOUT)
230 timeout = 0;
231
232 if (tty->ops->wait_until_sent)
233 tty->ops->wait_until_sent(tty, timeout);
234}
235EXPORT_SYMBOL(tty_wait_until_sent);
236
237
238
239
240
241
242static void unset_locked_termios(struct tty_struct *tty, struct ktermios *old)
243{
244 struct ktermios *termios = &tty->termios;
245 struct ktermios *locked = &tty->termios_locked;
246 int i;
247
248#define NOSET_MASK(x, y, z) (x = ((x) & ~(z)) | ((y) & (z)))
249
250 NOSET_MASK(termios->c_iflag, old->c_iflag, locked->c_iflag);
251 NOSET_MASK(termios->c_oflag, old->c_oflag, locked->c_oflag);
252 NOSET_MASK(termios->c_cflag, old->c_cflag, locked->c_cflag);
253 NOSET_MASK(termios->c_lflag, old->c_lflag, locked->c_lflag);
254 termios->c_line = locked->c_line ? old->c_line : termios->c_line;
255 for (i = 0; i < NCCS; i++)
256 termios->c_cc[i] = locked->c_cc[i] ?
257 old->c_cc[i] : termios->c_cc[i];
258
259}
260
261
262
263
264
265
266
267static const speed_t baud_table[] = {
268 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
269 9600, 19200, 38400, 57600, 115200, 230400, 460800,
270#ifdef __sparc__
271 76800, 153600, 307200, 614400, 921600
272#else
273 500000, 576000, 921600, 1000000, 1152000, 1500000, 2000000,
274 2500000, 3000000, 3500000, 4000000
275#endif
276};
277
278#ifndef __sparc__
279static const tcflag_t baud_bits[] = {
280 B0, B50, B75, B110, B134, B150, B200, B300, B600,
281 B1200, B1800, B2400, B4800, B9600, B19200, B38400,
282 B57600, B115200, B230400, B460800, B500000, B576000,
283 B921600, B1000000, B1152000, B1500000, B2000000, B2500000,
284 B3000000, B3500000, B4000000
285};
286#else
287static const tcflag_t baud_bits[] = {
288 B0, B50, B75, B110, B134, B150, B200, B300, B600,
289 B1200, B1800, B2400, B4800, B9600, B19200, B38400,
290 B57600, B115200, B230400, B460800, B76800, B153600,
291 B307200, B614400, B921600
292};
293#endif
294
295static int n_baud_table = ARRAY_SIZE(baud_table);
296
297
298
299
300
301
302
303
304
305
306
307
308
309speed_t tty_termios_baud_rate(struct ktermios *termios)
310{
311 unsigned int cbaud;
312
313 cbaud = termios->c_cflag & CBAUD;
314
315#ifdef BOTHER
316
317 if (cbaud == BOTHER)
318 return termios->c_ospeed;
319#endif
320 if (cbaud & CBAUDEX) {
321 cbaud &= ~CBAUDEX;
322
323 if (cbaud < 1 || cbaud + 15 > n_baud_table)
324 termios->c_cflag &= ~CBAUDEX;
325 else
326 cbaud += 15;
327 }
328 return baud_table[cbaud];
329}
330EXPORT_SYMBOL(tty_termios_baud_rate);
331
332
333
334
335
336
337
338
339
340
341
342
343
344speed_t tty_termios_input_baud_rate(struct ktermios *termios)
345{
346#ifdef IBSHIFT
347 unsigned int cbaud = (termios->c_cflag >> IBSHIFT) & CBAUD;
348
349 if (cbaud == B0)
350 return tty_termios_baud_rate(termios);
351
352
353 if (cbaud == BOTHER)
354 return termios->c_ispeed;
355
356 if (cbaud & CBAUDEX) {
357 cbaud &= ~CBAUDEX;
358
359 if (cbaud < 1 || cbaud + 15 > n_baud_table)
360 termios->c_cflag &= ~(CBAUDEX << IBSHIFT);
361 else
362 cbaud += 15;
363 }
364 return baud_table[cbaud];
365#else
366 return tty_termios_baud_rate(termios);
367#endif
368}
369EXPORT_SYMBOL(tty_termios_input_baud_rate);
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393void tty_termios_encode_baud_rate(struct ktermios *termios,
394 speed_t ibaud, speed_t obaud)
395{
396 int i = 0;
397 int ifound = -1, ofound = -1;
398 int iclose = ibaud/50, oclose = obaud/50;
399 int ibinput = 0;
400
401 if (obaud == 0)
402 ibaud = 0;
403
404 termios->c_ispeed = ibaud;
405 termios->c_ospeed = obaud;
406
407#ifdef BOTHER
408
409
410
411
412 if ((termios->c_cflag & CBAUD) == BOTHER)
413 oclose = 0;
414 if (((termios->c_cflag >> IBSHIFT) & CBAUD) == BOTHER)
415 iclose = 0;
416 if ((termios->c_cflag >> IBSHIFT) & CBAUD)
417 ibinput = 1;
418#endif
419 termios->c_cflag &= ~CBAUD;
420
421
422
423
424
425
426
427
428 do {
429 if (obaud - oclose <= baud_table[i] &&
430 obaud + oclose >= baud_table[i]) {
431 termios->c_cflag |= baud_bits[i];
432 ofound = i;
433 }
434 if (ibaud - iclose <= baud_table[i] &&
435 ibaud + iclose >= baud_table[i]) {
436
437
438 if (ofound == i && !ibinput)
439 ifound = i;
440#ifdef IBSHIFT
441 else {
442 ifound = i;
443 termios->c_cflag |= (baud_bits[i] << IBSHIFT);
444 }
445#endif
446 }
447 } while (++i < n_baud_table);
448
449
450
451
452
453#ifdef BOTHER
454 if (ofound == -1)
455 termios->c_cflag |= BOTHER;
456
457
458 if (ifound == -1 && (ibaud != obaud || ibinput))
459 termios->c_cflag |= (BOTHER << IBSHIFT);
460#else
461 if (ifound == -1 || ofound == -1)
462 pr_warn_once("tty: Unable to return correct speed data as your architecture needs updating.\n");
463#endif
464}
465EXPORT_SYMBOL_GPL(tty_termios_encode_baud_rate);
466
467
468
469
470
471
472
473
474
475
476
477void tty_encode_baud_rate(struct tty_struct *tty, speed_t ibaud, speed_t obaud)
478{
479 tty_termios_encode_baud_rate(&tty->termios, ibaud, obaud);
480}
481EXPORT_SYMBOL_GPL(tty_encode_baud_rate);
482
483
484
485
486
487
488
489
490
491
492
493
494void tty_termios_copy_hw(struct ktermios *new, struct ktermios *old)
495{
496
497
498 new->c_cflag &= HUPCL | CREAD | CLOCAL;
499 new->c_cflag |= old->c_cflag & ~(HUPCL | CREAD | CLOCAL);
500 new->c_ispeed = old->c_ispeed;
501 new->c_ospeed = old->c_ospeed;
502}
503EXPORT_SYMBOL(tty_termios_copy_hw);
504
505
506
507
508
509
510
511
512
513
514int tty_termios_hw_change(struct ktermios *a, struct ktermios *b)
515{
516 if (a->c_ispeed != b->c_ispeed || a->c_ospeed != b->c_ospeed)
517 return 1;
518 if ((a->c_cflag ^ b->c_cflag) & ~(HUPCL | CREAD | CLOCAL))
519 return 1;
520 return 0;
521}
522EXPORT_SYMBOL(tty_termios_hw_change);
523
524
525
526
527
528
529
530
531
532
533
534
535int tty_set_termios(struct tty_struct *tty, struct ktermios *new_termios)
536{
537 struct ktermios old_termios;
538 struct tty_ldisc *ld;
539
540 WARN_ON(tty->driver->type == TTY_DRIVER_TYPE_PTY &&
541 tty->driver->subtype == PTY_TYPE_MASTER);
542
543
544
545
546
547
548
549 down_write(&tty->termios_rwsem);
550 old_termios = tty->termios;
551 tty->termios = *new_termios;
552 unset_locked_termios(tty, &old_termios);
553
554 if (tty->ops->set_termios)
555 tty->ops->set_termios(tty, &old_termios);
556 else
557 tty_termios_copy_hw(&tty->termios, &old_termios);
558
559 ld = tty_ldisc_ref(tty);
560 if (ld != NULL) {
561 if (ld->ops->set_termios)
562 ld->ops->set_termios(tty, &old_termios);
563 tty_ldisc_deref(ld);
564 }
565 up_write(&tty->termios_rwsem);
566 return 0;
567}
568EXPORT_SYMBOL_GPL(tty_set_termios);
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583static int set_termios(struct tty_struct *tty, void __user *arg, int opt)
584{
585 struct ktermios tmp_termios;
586 struct tty_ldisc *ld;
587 int retval = tty_check_change(tty);
588
589 if (retval)
590 return retval;
591
592 down_read(&tty->termios_rwsem);
593 tmp_termios = tty->termios;
594 up_read(&tty->termios_rwsem);
595
596 if (opt & TERMIOS_TERMIO) {
597 if (user_termio_to_kernel_termios(&tmp_termios,
598 (struct termio __user *)arg))
599 return -EFAULT;
600#ifdef TCGETS2
601 } else if (opt & TERMIOS_OLD) {
602 if (user_termios_to_kernel_termios_1(&tmp_termios,
603 (struct termios __user *)arg))
604 return -EFAULT;
605 } else {
606 if (user_termios_to_kernel_termios(&tmp_termios,
607 (struct termios2 __user *)arg))
608 return -EFAULT;
609 }
610#else
611 } else if (user_termios_to_kernel_termios(&tmp_termios,
612 (struct termios __user *)arg))
613 return -EFAULT;
614#endif
615
616
617
618 tmp_termios.c_ispeed = tty_termios_input_baud_rate(&tmp_termios);
619 tmp_termios.c_ospeed = tty_termios_baud_rate(&tmp_termios);
620
621 ld = tty_ldisc_ref(tty);
622
623 if (ld != NULL) {
624 if ((opt & TERMIOS_FLUSH) && ld->ops->flush_buffer)
625 ld->ops->flush_buffer(tty);
626 tty_ldisc_deref(ld);
627 }
628
629 if (opt & TERMIOS_WAIT) {
630 tty_wait_until_sent(tty, 0);
631 if (signal_pending(current))
632 return -ERESTARTSYS;
633 }
634
635 tty_set_termios(tty, &tmp_termios);
636
637
638
639
640
641 return 0;
642}
643
644static void copy_termios(struct tty_struct *tty, struct ktermios *kterm)
645{
646 down_read(&tty->termios_rwsem);
647 *kterm = tty->termios;
648 up_read(&tty->termios_rwsem);
649}
650
651static void copy_termios_locked(struct tty_struct *tty, struct ktermios *kterm)
652{
653 down_read(&tty->termios_rwsem);
654 *kterm = tty->termios_locked;
655 up_read(&tty->termios_rwsem);
656}
657
658static int get_termio(struct tty_struct *tty, struct termio __user *termio)
659{
660 struct ktermios kterm;
661 copy_termios(tty, &kterm);
662 if (kernel_termios_to_user_termio(termio, &kterm))
663 return -EFAULT;
664 return 0;
665}
666
667
668#ifdef TCGETX
669
670
671
672
673
674
675
676
677
678
679
680static int set_termiox(struct tty_struct *tty, void __user *arg, int opt)
681{
682 struct termiox tnew;
683 struct tty_ldisc *ld;
684
685 if (tty->termiox == NULL)
686 return -EINVAL;
687 if (copy_from_user(&tnew, arg, sizeof(struct termiox)))
688 return -EFAULT;
689
690 ld = tty_ldisc_ref(tty);
691 if (ld != NULL) {
692 if ((opt & TERMIOS_FLUSH) && ld->ops->flush_buffer)
693 ld->ops->flush_buffer(tty);
694 tty_ldisc_deref(ld);
695 }
696 if (opt & TERMIOS_WAIT) {
697 tty_wait_until_sent(tty, 0);
698 if (signal_pending(current))
699 return -ERESTARTSYS;
700 }
701
702 down_write(&tty->termios_rwsem);
703 if (tty->ops->set_termiox)
704 tty->ops->set_termiox(tty, &tnew);
705 up_write(&tty->termios_rwsem);
706 return 0;
707}
708
709#endif
710
711
712#ifdef TIOCGETP
713
714
715
716
717
718static int get_sgflags(struct tty_struct *tty)
719{
720 int flags = 0;
721
722 if (!L_ICANON(tty)) {
723 if (L_ISIG(tty))
724 flags |= 0x02;
725 else
726 flags |= 0x20;
727 }
728 if (L_ECHO(tty))
729 flags |= 0x08;
730 if (O_OPOST(tty))
731 if (O_ONLCR(tty))
732 flags |= 0x10;
733 return flags;
734}
735
736static int get_sgttyb(struct tty_struct *tty, struct sgttyb __user *sgttyb)
737{
738 struct sgttyb tmp;
739
740 down_read(&tty->termios_rwsem);
741 tmp.sg_ispeed = tty->termios.c_ispeed;
742 tmp.sg_ospeed = tty->termios.c_ospeed;
743 tmp.sg_erase = tty->termios.c_cc[VERASE];
744 tmp.sg_kill = tty->termios.c_cc[VKILL];
745 tmp.sg_flags = get_sgflags(tty);
746 up_read(&tty->termios_rwsem);
747
748 return copy_to_user(sgttyb, &tmp, sizeof(tmp)) ? -EFAULT : 0;
749}
750
751static void set_sgflags(struct ktermios *termios, int flags)
752{
753 termios->c_iflag = ICRNL | IXON;
754 termios->c_oflag = 0;
755 termios->c_lflag = ISIG | ICANON;
756 if (flags & 0x02) {
757 termios->c_iflag = 0;
758 termios->c_lflag &= ~ICANON;
759 }
760 if (flags & 0x08) {
761 termios->c_lflag |= ECHO | ECHOE | ECHOK |
762 ECHOCTL | ECHOKE | IEXTEN;
763 }
764 if (flags & 0x10) {
765 termios->c_oflag |= OPOST | ONLCR;
766 }
767 if (flags & 0x20) {
768 termios->c_iflag = 0;
769 termios->c_lflag &= ~(ISIG | ICANON);
770 }
771 if (!(termios->c_lflag & ICANON)) {
772 termios->c_cc[VMIN] = 1;
773 termios->c_cc[VTIME] = 0;
774 }
775}
776
777
778
779
780
781
782
783
784
785
786
787
788static int set_sgttyb(struct tty_struct *tty, struct sgttyb __user *sgttyb)
789{
790 int retval;
791 struct sgttyb tmp;
792 struct ktermios termios;
793
794 retval = tty_check_change(tty);
795 if (retval)
796 return retval;
797
798 if (copy_from_user(&tmp, sgttyb, sizeof(tmp)))
799 return -EFAULT;
800
801 down_write(&tty->termios_rwsem);
802 termios = tty->termios;
803 termios.c_cc[VERASE] = tmp.sg_erase;
804 termios.c_cc[VKILL] = tmp.sg_kill;
805 set_sgflags(&termios, tmp.sg_flags);
806
807#ifdef BOTHER
808 tty_termios_encode_baud_rate(&termios, termios.c_ispeed,
809 termios.c_ospeed);
810#endif
811 up_write(&tty->termios_rwsem);
812 tty_set_termios(tty, &termios);
813 return 0;
814}
815#endif
816
817#ifdef TIOCGETC
818static int get_tchars(struct tty_struct *tty, struct tchars __user *tchars)
819{
820 struct tchars tmp;
821
822 down_read(&tty->termios_rwsem);
823 tmp.t_intrc = tty->termios.c_cc[VINTR];
824 tmp.t_quitc = tty->termios.c_cc[VQUIT];
825 tmp.t_startc = tty->termios.c_cc[VSTART];
826 tmp.t_stopc = tty->termios.c_cc[VSTOP];
827 tmp.t_eofc = tty->termios.c_cc[VEOF];
828 tmp.t_brkc = tty->termios.c_cc[VEOL2];
829 up_read(&tty->termios_rwsem);
830 return copy_to_user(tchars, &tmp, sizeof(tmp)) ? -EFAULT : 0;
831}
832
833static int set_tchars(struct tty_struct *tty, struct tchars __user *tchars)
834{
835 struct tchars tmp;
836
837 if (copy_from_user(&tmp, tchars, sizeof(tmp)))
838 return -EFAULT;
839 down_write(&tty->termios_rwsem);
840 tty->termios.c_cc[VINTR] = tmp.t_intrc;
841 tty->termios.c_cc[VQUIT] = tmp.t_quitc;
842 tty->termios.c_cc[VSTART] = tmp.t_startc;
843 tty->termios.c_cc[VSTOP] = tmp.t_stopc;
844 tty->termios.c_cc[VEOF] = tmp.t_eofc;
845 tty->termios.c_cc[VEOL2] = tmp.t_brkc;
846 up_write(&tty->termios_rwsem);
847 return 0;
848}
849#endif
850
851#ifdef TIOCGLTC
852static int get_ltchars(struct tty_struct *tty, struct ltchars __user *ltchars)
853{
854 struct ltchars tmp;
855
856 down_read(&tty->termios_rwsem);
857 tmp.t_suspc = tty->termios.c_cc[VSUSP];
858
859 tmp.t_dsuspc = tty->termios.c_cc[VSUSP];
860 tmp.t_rprntc = tty->termios.c_cc[VREPRINT];
861
862 tmp.t_flushc = tty->termios.c_cc[VEOL2];
863 tmp.t_werasc = tty->termios.c_cc[VWERASE];
864 tmp.t_lnextc = tty->termios.c_cc[VLNEXT];
865 up_read(&tty->termios_rwsem);
866 return copy_to_user(ltchars, &tmp, sizeof(tmp)) ? -EFAULT : 0;
867}
868
869static int set_ltchars(struct tty_struct *tty, struct ltchars __user *ltchars)
870{
871 struct ltchars tmp;
872
873 if (copy_from_user(&tmp, ltchars, sizeof(tmp)))
874 return -EFAULT;
875
876 down_write(&tty->termios_rwsem);
877 tty->termios.c_cc[VSUSP] = tmp.t_suspc;
878
879 tty->termios.c_cc[VEOL2] = tmp.t_dsuspc;
880 tty->termios.c_cc[VREPRINT] = tmp.t_rprntc;
881
882 tty->termios.c_cc[VEOL2] = tmp.t_flushc;
883 tty->termios.c_cc[VWERASE] = tmp.t_werasc;
884 tty->termios.c_cc[VLNEXT] = tmp.t_lnextc;
885 up_write(&tty->termios_rwsem);
886 return 0;
887}
888#endif
889
890
891
892
893
894
895
896
897
898
899static int tty_change_softcar(struct tty_struct *tty, int arg)
900{
901 int ret = 0;
902 int bit = arg ? CLOCAL : 0;
903 struct ktermios old;
904
905 down_write(&tty->termios_rwsem);
906 old = tty->termios;
907 tty->termios.c_cflag &= ~CLOCAL;
908 tty->termios.c_cflag |= bit;
909 if (tty->ops->set_termios)
910 tty->ops->set_termios(tty, &old);
911 if (C_CLOCAL(tty) != bit)
912 ret = -EINVAL;
913 up_write(&tty->termios_rwsem);
914 return ret;
915}
916
917
918
919
920
921
922
923
924
925
926
927
928
929int tty_mode_ioctl(struct tty_struct *tty, struct file *file,
930 unsigned int cmd, unsigned long arg)
931{
932 struct tty_struct *real_tty;
933 void __user *p = (void __user *)arg;
934 int ret = 0;
935 struct ktermios kterm;
936
937 BUG_ON(file == NULL);
938
939 if (tty->driver->type == TTY_DRIVER_TYPE_PTY &&
940 tty->driver->subtype == PTY_TYPE_MASTER)
941 real_tty = tty->link;
942 else
943 real_tty = tty;
944
945 switch (cmd) {
946#ifdef TIOCGETP
947 case TIOCGETP:
948 return get_sgttyb(real_tty, (struct sgttyb __user *) arg);
949 case TIOCSETP:
950 case TIOCSETN:
951 return set_sgttyb(real_tty, (struct sgttyb __user *) arg);
952#endif
953#ifdef TIOCGETC
954 case TIOCGETC:
955 return get_tchars(real_tty, p);
956 case TIOCSETC:
957 return set_tchars(real_tty, p);
958#endif
959#ifdef TIOCGLTC
960 case TIOCGLTC:
961 return get_ltchars(real_tty, p);
962 case TIOCSLTC:
963 return set_ltchars(real_tty, p);
964#endif
965 case TCSETSF:
966 return set_termios(real_tty, p, TERMIOS_FLUSH | TERMIOS_WAIT | TERMIOS_OLD);
967 case TCSETSW:
968 return set_termios(real_tty, p, TERMIOS_WAIT | TERMIOS_OLD);
969 case TCSETS:
970 return set_termios(real_tty, p, TERMIOS_OLD);
971#ifndef TCGETS2
972 case TCGETS:
973 copy_termios(real_tty, &kterm);
974 if (kernel_termios_to_user_termios((struct termios __user *)arg, &kterm))
975 ret = -EFAULT;
976 return ret;
977#else
978 case TCGETS:
979 copy_termios(real_tty, &kterm);
980 if (kernel_termios_to_user_termios_1((struct termios __user *)arg, &kterm))
981 ret = -EFAULT;
982 return ret;
983 case TCGETS2:
984 copy_termios(real_tty, &kterm);
985 if (kernel_termios_to_user_termios((struct termios2 __user *)arg, &kterm))
986 ret = -EFAULT;
987 return ret;
988 case TCSETSF2:
989 return set_termios(real_tty, p, TERMIOS_FLUSH | TERMIOS_WAIT);
990 case TCSETSW2:
991 return set_termios(real_tty, p, TERMIOS_WAIT);
992 case TCSETS2:
993 return set_termios(real_tty, p, 0);
994#endif
995 case TCGETA:
996 return get_termio(real_tty, p);
997 case TCSETAF:
998 return set_termios(real_tty, p, TERMIOS_FLUSH | TERMIOS_WAIT | TERMIOS_TERMIO);
999 case TCSETAW:
1000 return set_termios(real_tty, p, TERMIOS_WAIT | TERMIOS_TERMIO);
1001 case TCSETA:
1002 return set_termios(real_tty, p, TERMIOS_TERMIO);
1003#ifndef TCGETS2
1004 case TIOCGLCKTRMIOS:
1005 copy_termios_locked(real_tty, &kterm);
1006 if (kernel_termios_to_user_termios((struct termios __user *)arg, &kterm))
1007 ret = -EFAULT;
1008 return ret;
1009 case TIOCSLCKTRMIOS:
1010 if (!capable(CAP_SYS_ADMIN))
1011 return -EPERM;
1012 copy_termios_locked(real_tty, &kterm);
1013 if (user_termios_to_kernel_termios(&kterm,
1014 (struct termios __user *) arg))
1015 return -EFAULT;
1016 down_write(&real_tty->termios_rwsem);
1017 real_tty->termios_locked = kterm;
1018 up_write(&real_tty->termios_rwsem);
1019 return 0;
1020#else
1021 case TIOCGLCKTRMIOS:
1022 copy_termios_locked(real_tty, &kterm);
1023 if (kernel_termios_to_user_termios_1((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_1(&kterm,
1031 (struct termios __user *) arg))
1032 return -EFAULT;
1033 down_write(&real_tty->termios_rwsem);
1034 real_tty->termios_locked = kterm;
1035 up_write(&real_tty->termios_rwsem);
1036 return ret;
1037#endif
1038#ifdef TCGETX
1039 case TCGETX: {
1040 struct termiox ktermx;
1041 if (real_tty->termiox == NULL)
1042 return -EINVAL;
1043 down_read(&real_tty->termios_rwsem);
1044 memcpy(&ktermx, real_tty->termiox, sizeof(struct termiox));
1045 up_read(&real_tty->termios_rwsem);
1046 if (copy_to_user(p, &ktermx, sizeof(struct termiox)))
1047 ret = -EFAULT;
1048 return ret;
1049 }
1050 case TCSETX:
1051 return set_termiox(real_tty, p, 0);
1052 case TCSETXW:
1053 return set_termiox(real_tty, p, TERMIOS_WAIT);
1054 case TCSETXF:
1055 return set_termiox(real_tty, p, TERMIOS_FLUSH);
1056#endif
1057 case TIOCGSOFTCAR:
1058 copy_termios(real_tty, &kterm);
1059 ret = put_user((kterm.c_cflag & CLOCAL) ? 1 : 0,
1060 (int __user *)arg);
1061 return ret;
1062 case TIOCSSOFTCAR:
1063 if (get_user(arg, (unsigned int __user *) arg))
1064 return -EFAULT;
1065 return tty_change_softcar(real_tty, arg);
1066 default:
1067 return -ENOIOCTLCMD;
1068 }
1069}
1070EXPORT_SYMBOL_GPL(tty_mode_ioctl);
1071
1072
1073
1074static int __tty_perform_flush(struct tty_struct *tty, unsigned long arg)
1075{
1076 struct tty_ldisc *ld = tty->ldisc;
1077
1078 switch (arg) {
1079 case TCIFLUSH:
1080 if (ld && ld->ops->flush_buffer) {
1081 ld->ops->flush_buffer(tty);
1082 tty_unthrottle(tty);
1083 }
1084 break;
1085 case TCIOFLUSH:
1086 if (ld && ld->ops->flush_buffer) {
1087 ld->ops->flush_buffer(tty);
1088 tty_unthrottle(tty);
1089 }
1090
1091 case TCOFLUSH:
1092 tty_driver_flush_buffer(tty);
1093 break;
1094 default:
1095 return -EINVAL;
1096 }
1097 return 0;
1098}
1099
1100int tty_perform_flush(struct tty_struct *tty, unsigned long arg)
1101{
1102 struct tty_ldisc *ld;
1103 int retval = tty_check_change(tty);
1104 if (retval)
1105 return retval;
1106
1107 ld = tty_ldisc_ref_wait(tty);
1108 retval = __tty_perform_flush(tty, arg);
1109 if (ld)
1110 tty_ldisc_deref(ld);
1111 return retval;
1112}
1113EXPORT_SYMBOL_GPL(tty_perform_flush);
1114
1115int n_tty_ioctl_helper(struct tty_struct *tty, struct file *file,
1116 unsigned int cmd, unsigned long arg)
1117{
1118 int retval;
1119
1120 switch (cmd) {
1121 case TCXONC:
1122 retval = tty_check_change(tty);
1123 if (retval)
1124 return retval;
1125 switch (arg) {
1126 case TCOOFF:
1127 spin_lock_irq(&tty->flow_lock);
1128 if (!tty->flow_stopped) {
1129 tty->flow_stopped = 1;
1130 __stop_tty(tty);
1131 }
1132 spin_unlock_irq(&tty->flow_lock);
1133 break;
1134 case TCOON:
1135 spin_lock_irq(&tty->flow_lock);
1136 if (tty->flow_stopped) {
1137 tty->flow_stopped = 0;
1138 __start_tty(tty);
1139 }
1140 spin_unlock_irq(&tty->flow_lock);
1141 break;
1142 case TCIOFF:
1143 if (STOP_CHAR(tty) != __DISABLED_CHAR)
1144 retval = tty_send_xchar(tty, STOP_CHAR(tty));
1145 break;
1146 case TCION:
1147 if (START_CHAR(tty) != __DISABLED_CHAR)
1148 retval = tty_send_xchar(tty, START_CHAR(tty));
1149 break;
1150 default:
1151 return -EINVAL;
1152 }
1153 return retval;
1154 case TCFLSH:
1155 retval = tty_check_change(tty);
1156 if (retval)
1157 return retval;
1158 return __tty_perform_flush(tty, arg);
1159 default:
1160
1161 return tty_mode_ioctl(tty, file, cmd, arg);
1162 }
1163}
1164EXPORT_SYMBOL(n_tty_ioctl_helper);
1165
1166#ifdef CONFIG_COMPAT
1167long n_tty_compat_ioctl_helper(struct tty_struct *tty, struct file *file,
1168 unsigned int cmd, unsigned long arg)
1169{
1170 switch (cmd) {
1171 case TIOCGLCKTRMIOS:
1172 case TIOCSLCKTRMIOS:
1173 return tty_mode_ioctl(tty, file, cmd, (unsigned long) compat_ptr(arg));
1174 default:
1175 return -ENOIOCTLCMD;
1176 }
1177}
1178EXPORT_SYMBOL(n_tty_compat_ioctl_helper);
1179#endif
1180
1181