15667c0fd64577ad26ea5719283719fc60c94e28
[firefly-linux-kernel-4.4.55.git] / drivers / tty / tty_ldisc.c
1 #include <linux/types.h>
2 #include <linux/errno.h>
3 #include <linux/kmod.h>
4 #include <linux/sched.h>
5 #include <linux/interrupt.h>
6 #include <linux/tty.h>
7 #include <linux/tty_driver.h>
8 #include <linux/file.h>
9 #include <linux/mm.h>
10 #include <linux/string.h>
11 #include <linux/slab.h>
12 #include <linux/poll.h>
13 #include <linux/proc_fs.h>
14 #include <linux/init.h>
15 #include <linux/module.h>
16 #include <linux/device.h>
17 #include <linux/wait.h>
18 #include <linux/bitops.h>
19 #include <linux/seq_file.h>
20 #include <linux/uaccess.h>
21 #include <linux/ratelimit.h>
22
23 /*
24  *      This guards the refcounted line discipline lists. The lock
25  *      must be taken with irqs off because there are hangup path
26  *      callers who will do ldisc lookups and cannot sleep.
27  */
28
29 static DEFINE_RAW_SPINLOCK(tty_ldisc_lock);
30 static DECLARE_WAIT_QUEUE_HEAD(tty_ldisc_wait);
31 /* Line disc dispatch table */
32 static struct tty_ldisc_ops *tty_ldiscs[NR_LDISCS];
33
34 static inline struct tty_ldisc *get_ldisc(struct tty_ldisc *ld)
35 {
36         if (ld)
37                 atomic_inc(&ld->users);
38         return ld;
39 }
40
41 static void put_ldisc(struct tty_ldisc *ld)
42 {
43         unsigned long flags;
44
45         if (WARN_ON_ONCE(!ld))
46                 return;
47
48         /*
49          * If this is the last user, free the ldisc, and
50          * release the ldisc ops.
51          *
52          * We really want an "atomic_dec_and_raw_lock_irqsave()",
53          * but we don't have it, so this does it by hand.
54          */
55         raw_spin_lock_irqsave(&tty_ldisc_lock, flags);
56         if (atomic_dec_and_test(&ld->users)) {
57                 struct tty_ldisc_ops *ldo = ld->ops;
58
59                 ldo->refcount--;
60                 module_put(ldo->owner);
61                 raw_spin_unlock_irqrestore(&tty_ldisc_lock, flags);
62
63                 kfree(ld);
64                 return;
65         }
66         raw_spin_unlock_irqrestore(&tty_ldisc_lock, flags);
67
68         if (waitqueue_active(&ld->wq_idle))
69                 wake_up(&ld->wq_idle);
70 }
71
72 /**
73  *      tty_register_ldisc      -       install a line discipline
74  *      @disc: ldisc number
75  *      @new_ldisc: pointer to the ldisc object
76  *
77  *      Installs a new line discipline into the kernel. The discipline
78  *      is set up as unreferenced and then made available to the kernel
79  *      from this point onwards.
80  *
81  *      Locking:
82  *              takes tty_ldisc_lock to guard against ldisc races
83  */
84
85 int tty_register_ldisc(int disc, struct tty_ldisc_ops *new_ldisc)
86 {
87         unsigned long flags;
88         int ret = 0;
89
90         if (disc < N_TTY || disc >= NR_LDISCS)
91                 return -EINVAL;
92
93         raw_spin_lock_irqsave(&tty_ldisc_lock, flags);
94         tty_ldiscs[disc] = new_ldisc;
95         new_ldisc->num = disc;
96         new_ldisc->refcount = 0;
97         raw_spin_unlock_irqrestore(&tty_ldisc_lock, flags);
98
99         return ret;
100 }
101 EXPORT_SYMBOL(tty_register_ldisc);
102
103 /**
104  *      tty_unregister_ldisc    -       unload a line discipline
105  *      @disc: ldisc number
106  *      @new_ldisc: pointer to the ldisc object
107  *
108  *      Remove a line discipline from the kernel providing it is not
109  *      currently in use.
110  *
111  *      Locking:
112  *              takes tty_ldisc_lock to guard against ldisc races
113  */
114
115 int tty_unregister_ldisc(int disc)
116 {
117         unsigned long flags;
118         int ret = 0;
119
120         if (disc < N_TTY || disc >= NR_LDISCS)
121                 return -EINVAL;
122
123         raw_spin_lock_irqsave(&tty_ldisc_lock, flags);
124         if (tty_ldiscs[disc]->refcount)
125                 ret = -EBUSY;
126         else
127                 tty_ldiscs[disc] = NULL;
128         raw_spin_unlock_irqrestore(&tty_ldisc_lock, flags);
129
130         return ret;
131 }
132 EXPORT_SYMBOL(tty_unregister_ldisc);
133
134 static struct tty_ldisc_ops *get_ldops(int disc)
135 {
136         unsigned long flags;
137         struct tty_ldisc_ops *ldops, *ret;
138
139         raw_spin_lock_irqsave(&tty_ldisc_lock, flags);
140         ret = ERR_PTR(-EINVAL);
141         ldops = tty_ldiscs[disc];
142         if (ldops) {
143                 ret = ERR_PTR(-EAGAIN);
144                 if (try_module_get(ldops->owner)) {
145                         ldops->refcount++;
146                         ret = ldops;
147                 }
148         }
149         raw_spin_unlock_irqrestore(&tty_ldisc_lock, flags);
150         return ret;
151 }
152
153 static void put_ldops(struct tty_ldisc_ops *ldops)
154 {
155         unsigned long flags;
156
157         raw_spin_lock_irqsave(&tty_ldisc_lock, flags);
158         ldops->refcount--;
159         module_put(ldops->owner);
160         raw_spin_unlock_irqrestore(&tty_ldisc_lock, flags);
161 }
162
163 /**
164  *      tty_ldisc_get           -       take a reference to an ldisc
165  *      @disc: ldisc number
166  *
167  *      Takes a reference to a line discipline. Deals with refcounts and
168  *      module locking counts. Returns NULL if the discipline is not available.
169  *      Returns a pointer to the discipline and bumps the ref count if it is
170  *      available
171  *
172  *      Locking:
173  *              takes tty_ldisc_lock to guard against ldisc races
174  */
175
176 static struct tty_ldisc *tty_ldisc_get(int disc)
177 {
178         struct tty_ldisc *ld;
179         struct tty_ldisc_ops *ldops;
180
181         if (disc < N_TTY || disc >= NR_LDISCS)
182                 return ERR_PTR(-EINVAL);
183
184         /*
185          * Get the ldisc ops - we may need to request them to be loaded
186          * dynamically and try again.
187          */
188         ldops = get_ldops(disc);
189         if (IS_ERR(ldops)) {
190                 request_module("tty-ldisc-%d", disc);
191                 ldops = get_ldops(disc);
192                 if (IS_ERR(ldops))
193                         return ERR_CAST(ldops);
194         }
195
196         ld = kmalloc(sizeof(struct tty_ldisc), GFP_KERNEL);
197         if (ld == NULL) {
198                 put_ldops(ldops);
199                 return ERR_PTR(-ENOMEM);
200         }
201
202         ld->ops = ldops;
203         atomic_set(&ld->users, 1);
204         init_waitqueue_head(&ld->wq_idle);
205
206         return ld;
207 }
208
209 static void *tty_ldiscs_seq_start(struct seq_file *m, loff_t *pos)
210 {
211         return (*pos < NR_LDISCS) ? pos : NULL;
212 }
213
214 static void *tty_ldiscs_seq_next(struct seq_file *m, void *v, loff_t *pos)
215 {
216         (*pos)++;
217         return (*pos < NR_LDISCS) ? pos : NULL;
218 }
219
220 static void tty_ldiscs_seq_stop(struct seq_file *m, void *v)
221 {
222 }
223
224 static int tty_ldiscs_seq_show(struct seq_file *m, void *v)
225 {
226         int i = *(loff_t *)v;
227         struct tty_ldisc_ops *ldops;
228
229         ldops = get_ldops(i);
230         if (IS_ERR(ldops))
231                 return 0;
232         seq_printf(m, "%-10s %2d\n", ldops->name ? ldops->name : "???", i);
233         put_ldops(ldops);
234         return 0;
235 }
236
237 static const struct seq_operations tty_ldiscs_seq_ops = {
238         .start  = tty_ldiscs_seq_start,
239         .next   = tty_ldiscs_seq_next,
240         .stop   = tty_ldiscs_seq_stop,
241         .show   = tty_ldiscs_seq_show,
242 };
243
244 static int proc_tty_ldiscs_open(struct inode *inode, struct file *file)
245 {
246         return seq_open(file, &tty_ldiscs_seq_ops);
247 }
248
249 const struct file_operations tty_ldiscs_proc_fops = {
250         .owner          = THIS_MODULE,
251         .open           = proc_tty_ldiscs_open,
252         .read           = seq_read,
253         .llseek         = seq_lseek,
254         .release        = seq_release,
255 };
256
257 /**
258  *      tty_ldisc_assign        -       set ldisc on a tty
259  *      @tty: tty to assign
260  *      @ld: line discipline
261  *
262  *      Install an instance of a line discipline into a tty structure. The
263  *      ldisc must have a reference count above zero to ensure it remains.
264  *      The tty instance refcount starts at zero.
265  *
266  *      Locking:
267  *              Caller must hold references
268  */
269
270 static void tty_ldisc_assign(struct tty_struct *tty, struct tty_ldisc *ld)
271 {
272         tty->ldisc = ld;
273 }
274
275 /**
276  *      tty_ldisc_try           -       internal helper
277  *      @tty: the tty
278  *
279  *      Make a single attempt to grab and bump the refcount on
280  *      the tty ldisc. Return 0 on failure or 1 on success. This is
281  *      used to implement both the waiting and non waiting versions
282  *      of tty_ldisc_ref
283  *
284  *      Locking: takes tty_ldisc_lock
285  */
286
287 static struct tty_ldisc *tty_ldisc_try(struct tty_struct *tty)
288 {
289         unsigned long flags;
290         struct tty_ldisc *ld;
291
292         raw_spin_lock_irqsave(&tty_ldisc_lock, flags);
293         ld = NULL;
294         if (test_bit(TTY_LDISC, &tty->flags))
295                 ld = get_ldisc(tty->ldisc);
296         raw_spin_unlock_irqrestore(&tty_ldisc_lock, flags);
297         return ld;
298 }
299
300 /**
301  *      tty_ldisc_ref_wait      -       wait for the tty ldisc
302  *      @tty: tty device
303  *
304  *      Dereference the line discipline for the terminal and take a
305  *      reference to it. If the line discipline is in flux then
306  *      wait patiently until it changes.
307  *
308  *      Note: Must not be called from an IRQ/timer context. The caller
309  *      must also be careful not to hold other locks that will deadlock
310  *      against a discipline change, such as an existing ldisc reference
311  *      (which we check for)
312  *
313  *      Locking: call functions take tty_ldisc_lock
314  */
315
316 struct tty_ldisc *tty_ldisc_ref_wait(struct tty_struct *tty)
317 {
318         struct tty_ldisc *ld;
319
320         /* wait_event is a macro */
321         wait_event(tty_ldisc_wait, (ld = tty_ldisc_try(tty)) != NULL);
322         return ld;
323 }
324 EXPORT_SYMBOL_GPL(tty_ldisc_ref_wait);
325
326 /**
327  *      tty_ldisc_ref           -       get the tty ldisc
328  *      @tty: tty device
329  *
330  *      Dereference the line discipline for the terminal and take a
331  *      reference to it. If the line discipline is in flux then
332  *      return NULL. Can be called from IRQ and timer functions.
333  *
334  *      Locking: called functions take tty_ldisc_lock
335  */
336
337 struct tty_ldisc *tty_ldisc_ref(struct tty_struct *tty)
338 {
339         return tty_ldisc_try(tty);
340 }
341 EXPORT_SYMBOL_GPL(tty_ldisc_ref);
342
343 /**
344  *      tty_ldisc_deref         -       free a tty ldisc reference
345  *      @ld: reference to free up
346  *
347  *      Undoes the effect of tty_ldisc_ref or tty_ldisc_ref_wait. May
348  *      be called in IRQ context.
349  *
350  *      Locking: takes tty_ldisc_lock
351  */
352
353 void tty_ldisc_deref(struct tty_ldisc *ld)
354 {
355         put_ldisc(ld);
356 }
357 EXPORT_SYMBOL_GPL(tty_ldisc_deref);
358
359 static inline void tty_ldisc_put(struct tty_ldisc *ld)
360 {
361         put_ldisc(ld);
362 }
363
364 /**
365  *      tty_ldisc_enable        -       allow ldisc use
366  *      @tty: terminal to activate ldisc on
367  *
368  *      Set the TTY_LDISC flag when the line discipline can be called
369  *      again. Do necessary wakeups for existing sleepers. Clear the LDISC
370  *      changing flag to indicate any ldisc change is now over.
371  *
372  *      Note: nobody should set the TTY_LDISC bit except via this function.
373  *      Clearing directly is allowed.
374  */
375
376 void tty_ldisc_enable(struct tty_struct *tty)
377 {
378         clear_bit(TTY_LDISC_HALTED, &tty->flags);
379         set_bit(TTY_LDISC, &tty->flags);
380         clear_bit(TTY_LDISC_CHANGING, &tty->flags);
381         wake_up(&tty_ldisc_wait);
382 }
383
384 /**
385  *      tty_ldisc_flush -       flush line discipline queue
386  *      @tty: tty
387  *
388  *      Flush the line discipline queue (if any) for this tty. If there
389  *      is no line discipline active this is a no-op.
390  */
391
392 void tty_ldisc_flush(struct tty_struct *tty)
393 {
394         struct tty_ldisc *ld = tty_ldisc_ref(tty);
395         if (ld) {
396                 if (ld->ops->flush_buffer)
397                         ld->ops->flush_buffer(tty);
398                 tty_ldisc_deref(ld);
399         }
400         tty_buffer_flush(tty);
401 }
402 EXPORT_SYMBOL_GPL(tty_ldisc_flush);
403
404 /**
405  *      tty_set_termios_ldisc           -       set ldisc field
406  *      @tty: tty structure
407  *      @num: line discipline number
408  *
409  *      This is probably overkill for real world processors but
410  *      they are not on hot paths so a little discipline won't do
411  *      any harm.
412  *
413  *      Locking: takes termios_mutex
414  */
415
416 static void tty_set_termios_ldisc(struct tty_struct *tty, int num)
417 {
418         mutex_lock(&tty->termios_mutex);
419         tty->termios.c_line = num;
420         mutex_unlock(&tty->termios_mutex);
421 }
422
423 /**
424  *      tty_ldisc_open          -       open a line discipline
425  *      @tty: tty we are opening the ldisc on
426  *      @ld: discipline to open
427  *
428  *      A helper opening method. Also a convenient debugging and check
429  *      point.
430  *
431  *      Locking: always called with BTM already held.
432  */
433
434 static int tty_ldisc_open(struct tty_struct *tty, struct tty_ldisc *ld)
435 {
436         WARN_ON(test_and_set_bit(TTY_LDISC_OPEN, &tty->flags));
437         if (ld->ops->open) {
438                 int ret;
439                 /* BTM here locks versus a hangup event */
440                 ret = ld->ops->open(tty);
441                 if (ret)
442                         clear_bit(TTY_LDISC_OPEN, &tty->flags);
443                 return ret;
444         }
445         return 0;
446 }
447
448 /**
449  *      tty_ldisc_close         -       close a line discipline
450  *      @tty: tty we are opening the ldisc on
451  *      @ld: discipline to close
452  *
453  *      A helper close method. Also a convenient debugging and check
454  *      point.
455  */
456
457 static void tty_ldisc_close(struct tty_struct *tty, struct tty_ldisc *ld)
458 {
459         WARN_ON(!test_bit(TTY_LDISC_OPEN, &tty->flags));
460         clear_bit(TTY_LDISC_OPEN, &tty->flags);
461         if (ld->ops->close)
462                 ld->ops->close(tty);
463 }
464
465 /**
466  *      tty_ldisc_restore       -       helper for tty ldisc change
467  *      @tty: tty to recover
468  *      @old: previous ldisc
469  *
470  *      Restore the previous line discipline or N_TTY when a line discipline
471  *      change fails due to an open error
472  */
473
474 static void tty_ldisc_restore(struct tty_struct *tty, struct tty_ldisc *old)
475 {
476         char buf[64];
477         struct tty_ldisc *new_ldisc;
478         int r;
479
480         /* There is an outstanding reference here so this is safe */
481         old = tty_ldisc_get(old->ops->num);
482         WARN_ON(IS_ERR(old));
483         tty_ldisc_assign(tty, old);
484         tty_set_termios_ldisc(tty, old->ops->num);
485         if (tty_ldisc_open(tty, old) < 0) {
486                 tty_ldisc_put(old);
487                 /* This driver is always present */
488                 new_ldisc = tty_ldisc_get(N_TTY);
489                 if (IS_ERR(new_ldisc))
490                         panic("n_tty: get");
491                 tty_ldisc_assign(tty, new_ldisc);
492                 tty_set_termios_ldisc(tty, N_TTY);
493                 r = tty_ldisc_open(tty, new_ldisc);
494                 if (r < 0)
495                         panic("Couldn't open N_TTY ldisc for "
496                               "%s --- error %d.",
497                               tty_name(tty, buf), r);
498         }
499 }
500
501 /**
502  *      tty_ldisc_halt          -       shut down the line discipline
503  *      @tty: tty device
504  *
505  *      Shut down the line discipline and work queue for this tty device.
506  *      The TTY_LDISC flag being cleared ensures no further references can
507  *      be obtained while the delayed work queue halt ensures that no more
508  *      data is fed to the ldisc.
509  *
510  *      You need to do a 'flush_scheduled_work()' (outside the ldisc_mutex)
511  *      in order to make sure any currently executing ldisc work is also
512  *      flushed.
513  */
514
515 static int tty_ldisc_halt(struct tty_struct *tty)
516 {
517         int scheduled;
518         clear_bit(TTY_LDISC, &tty->flags);
519         scheduled = cancel_work_sync(&tty->port->buf.work);
520         set_bit(TTY_LDISC_HALTED, &tty->flags);
521         return scheduled;
522 }
523
524 /**
525  *      tty_ldisc_flush_works   -       flush all works of a tty
526  *      @tty: tty device to flush works for
527  *
528  *      Sync flush all works belonging to @tty.
529  */
530 static void tty_ldisc_flush_works(struct tty_struct *tty)
531 {
532         flush_work(&tty->hangup_work);
533         flush_work(&tty->SAK_work);
534         flush_work(&tty->port->buf.work);
535 }
536
537 /**
538  *      tty_ldisc_wait_idle     -       wait for the ldisc to become idle
539  *      @tty: tty to wait for
540  *      @timeout: for how long to wait at most
541  *
542  *      Wait for the line discipline to become idle. The discipline must
543  *      have been halted for this to guarantee it remains idle.
544  */
545 static int tty_ldisc_wait_idle(struct tty_struct *tty, long timeout)
546 {
547         long ret;
548         ret = wait_event_timeout(tty->ldisc->wq_idle,
549                         atomic_read(&tty->ldisc->users) == 1, timeout);
550         return ret > 0 ? 0 : -EBUSY;
551 }
552
553 /**
554  *      tty_ldisc_hangup_halt - halt the line discipline for hangup
555  *      @tty: tty being hung up
556  *
557  *      Shut down the line discipline and work queue for the tty device
558  *      being hungup. Clear the TTY_LDISC flag to ensure no further
559  *      references can be obtained, wait for remaining references to be
560  *      released, and cancel pending buffer work to ensure no more
561  *      data is fed to this ldisc.
562  *      Caller must hold legacy and ->ldisc_mutex.
563  *
564  *      NB: tty_set_ldisc() is prevented from changing the ldisc concurrently
565  *      with this function by checking the TTY_HUPPING flag.
566  *
567  *      NB: if tty->ldisc is NULL then buffer work does not need to be
568  *      cancelled because it must already have done as a precondition
569  *      of closing the ldisc and setting tty->ldisc to NULL
570  */
571 static bool tty_ldisc_hangup_halt(struct tty_struct *tty)
572 {
573         char cur_n[TASK_COMM_LEN], tty_n[64];
574         long timeout = 3 * HZ;
575
576         clear_bit(TTY_LDISC, &tty->flags);
577
578         if (tty->ldisc) {       /* Not yet closed */
579                 tty_unlock(tty);
580
581                 while (tty_ldisc_wait_idle(tty, timeout) == -EBUSY) {
582                         timeout = MAX_SCHEDULE_TIMEOUT;
583                         printk_ratelimited(KERN_WARNING
584                                 "%s: waiting (%s) for %s took too long, but we keep waiting...\n",
585                                 __func__, get_task_comm(cur_n, current),
586                                 tty_name(tty, tty_n));
587                 }
588
589                 cancel_work_sync(&tty->port->buf.work);
590                 set_bit(TTY_LDISC_HALTED, &tty->flags);
591
592                 /* must reacquire both locks and preserve lock order */
593                 mutex_unlock(&tty->ldisc_mutex);
594                 tty_lock(tty);
595                 mutex_lock(&tty->ldisc_mutex);
596         }
597         return !!tty->ldisc;
598 }
599
600 /**
601  *      tty_set_ldisc           -       set line discipline
602  *      @tty: the terminal to set
603  *      @ldisc: the line discipline
604  *
605  *      Set the discipline of a tty line. Must be called from a process
606  *      context. The ldisc change logic has to protect itself against any
607  *      overlapping ldisc change (including on the other end of pty pairs),
608  *      the close of one side of a tty/pty pair, and eventually hangup.
609  *
610  *      Locking: takes tty_ldisc_lock, termios_mutex
611  */
612
613 int tty_set_ldisc(struct tty_struct *tty, int ldisc)
614 {
615         int retval;
616         struct tty_ldisc *o_ldisc, *new_ldisc;
617         int work, o_work = 0;
618         struct tty_struct *o_tty;
619
620         new_ldisc = tty_ldisc_get(ldisc);
621         if (IS_ERR(new_ldisc))
622                 return PTR_ERR(new_ldisc);
623
624         tty_lock(tty);
625         /*
626          *      We need to look at the tty locking here for pty/tty pairs
627          *      when both sides try to change in parallel.
628          */
629
630         o_tty = tty->link;      /* o_tty is the pty side or NULL */
631
632
633         /*
634          *      Check the no-op case
635          */
636
637         if (tty->ldisc->ops->num == ldisc) {
638                 tty_unlock(tty);
639                 tty_ldisc_put(new_ldisc);
640                 return 0;
641         }
642
643         tty_unlock(tty);
644         /*
645          *      Problem: What do we do if this blocks ?
646          *      We could deadlock here
647          */
648
649         tty_wait_until_sent(tty, 0);
650
651         tty_lock(tty);
652         mutex_lock(&tty->ldisc_mutex);
653
654         /*
655          *      We could be midstream of another ldisc change which has
656          *      dropped the lock during processing. If so we need to wait.
657          */
658
659         while (test_bit(TTY_LDISC_CHANGING, &tty->flags)) {
660                 mutex_unlock(&tty->ldisc_mutex);
661                 tty_unlock(tty);
662                 wait_event(tty_ldisc_wait,
663                         test_bit(TTY_LDISC_CHANGING, &tty->flags) == 0);
664                 tty_lock(tty);
665                 mutex_lock(&tty->ldisc_mutex);
666         }
667
668         set_bit(TTY_LDISC_CHANGING, &tty->flags);
669
670         /*
671          *      No more input please, we are switching. The new ldisc
672          *      will update this value in the ldisc open function
673          */
674
675         tty->receive_room = 0;
676
677         o_ldisc = tty->ldisc;
678
679         tty_unlock(tty);
680         /*
681          *      Make sure we don't change while someone holds a
682          *      reference to the line discipline. The TTY_LDISC bit
683          *      prevents anyone taking a reference once it is clear.
684          *      We need the lock to avoid racing reference takers.
685          *
686          *      We must clear the TTY_LDISC bit here to avoid a livelock
687          *      with a userspace app continually trying to use the tty in
688          *      parallel to the change and re-referencing the tty.
689          */
690
691         work = tty_ldisc_halt(tty);
692         if (o_tty)
693                 o_work = tty_ldisc_halt(o_tty);
694
695         /*
696          * Wait for ->hangup_work and ->buf.work handlers to terminate.
697          * We must drop the mutex here in case a hangup is also in process.
698          */
699
700         mutex_unlock(&tty->ldisc_mutex);
701
702         tty_ldisc_flush_works(tty);
703
704         retval = tty_ldisc_wait_idle(tty, 5 * HZ);
705
706         tty_lock(tty);
707         mutex_lock(&tty->ldisc_mutex);
708
709         /* handle wait idle failure locked */
710         if (retval) {
711                 tty_ldisc_put(new_ldisc);
712                 goto enable;
713         }
714
715         if (test_bit(TTY_HUPPING, &tty->flags)) {
716                 /* We were raced by the hangup method. It will have stomped
717                    the ldisc data and closed the ldisc down */
718                 clear_bit(TTY_LDISC_CHANGING, &tty->flags);
719                 mutex_unlock(&tty->ldisc_mutex);
720                 tty_ldisc_put(new_ldisc);
721                 tty_unlock(tty);
722                 return -EIO;
723         }
724
725         /* Shutdown the current discipline. */
726         tty_ldisc_close(tty, o_ldisc);
727
728         /* Now set up the new line discipline. */
729         tty_ldisc_assign(tty, new_ldisc);
730         tty_set_termios_ldisc(tty, ldisc);
731
732         retval = tty_ldisc_open(tty, new_ldisc);
733         if (retval < 0) {
734                 /* Back to the old one or N_TTY if we can't */
735                 tty_ldisc_put(new_ldisc);
736                 tty_ldisc_restore(tty, o_ldisc);
737         }
738
739         /* At this point we hold a reference to the new ldisc and a
740            a reference to the old ldisc. If we ended up flipping back
741            to the existing ldisc we have two references to it */
742
743         if (tty->ldisc->ops->num != o_ldisc->ops->num && tty->ops->set_ldisc)
744                 tty->ops->set_ldisc(tty);
745
746         tty_ldisc_put(o_ldisc);
747
748 enable:
749         /*
750          *      Allow ldisc referencing to occur again
751          */
752
753         tty_ldisc_enable(tty);
754         if (o_tty)
755                 tty_ldisc_enable(o_tty);
756
757         /* Restart the work queue in case no characters kick it off. Safe if
758            already running */
759         if (work)
760                 schedule_work(&tty->port->buf.work);
761         if (o_work)
762                 schedule_work(&o_tty->port->buf.work);
763         mutex_unlock(&tty->ldisc_mutex);
764         tty_unlock(tty);
765         return retval;
766 }
767
768 /**
769  *      tty_reset_termios       -       reset terminal state
770  *      @tty: tty to reset
771  *
772  *      Restore a terminal to the driver default state.
773  */
774
775 static void tty_reset_termios(struct tty_struct *tty)
776 {
777         mutex_lock(&tty->termios_mutex);
778         tty->termios = tty->driver->init_termios;
779         tty->termios.c_ispeed = tty_termios_input_baud_rate(&tty->termios);
780         tty->termios.c_ospeed = tty_termios_baud_rate(&tty->termios);
781         mutex_unlock(&tty->termios_mutex);
782 }
783
784
785 /**
786  *      tty_ldisc_reinit        -       reinitialise the tty ldisc
787  *      @tty: tty to reinit
788  *      @ldisc: line discipline to reinitialize
789  *
790  *      Switch the tty to a line discipline and leave the ldisc
791  *      state closed
792  */
793
794 static int tty_ldisc_reinit(struct tty_struct *tty, int ldisc)
795 {
796         struct tty_ldisc *ld = tty_ldisc_get(ldisc);
797
798         if (IS_ERR(ld))
799                 return -1;
800
801         tty_ldisc_close(tty, tty->ldisc);
802         tty_ldisc_put(tty->ldisc);
803         tty->ldisc = NULL;
804         /*
805          *      Switch the line discipline back
806          */
807         tty_ldisc_assign(tty, ld);
808         tty_set_termios_ldisc(tty, ldisc);
809
810         return 0;
811 }
812
813 /**
814  *      tty_ldisc_hangup                -       hangup ldisc reset
815  *      @tty: tty being hung up
816  *
817  *      Some tty devices reset their termios when they receive a hangup
818  *      event. In that situation we must also switch back to N_TTY properly
819  *      before we reset the termios data.
820  *
821  *      Locking: We can take the ldisc mutex as the rest of the code is
822  *      careful to allow for this.
823  *
824  *      In the pty pair case this occurs in the close() path of the
825  *      tty itself so we must be careful about locking rules.
826  */
827
828 void tty_ldisc_hangup(struct tty_struct *tty)
829 {
830         struct tty_ldisc *ld;
831         int reset = tty->driver->flags & TTY_DRIVER_RESET_TERMIOS;
832         int err = 0;
833
834         /*
835          * FIXME! What are the locking issues here? This may me overdoing
836          * things... This question is especially important now that we've
837          * removed the irqlock.
838          */
839         ld = tty_ldisc_ref(tty);
840         if (ld != NULL) {
841                 /* We may have no line discipline at this point */
842                 if (ld->ops->flush_buffer)
843                         ld->ops->flush_buffer(tty);
844                 tty_driver_flush_buffer(tty);
845                 if ((test_bit(TTY_DO_WRITE_WAKEUP, &tty->flags)) &&
846                     ld->ops->write_wakeup)
847                         ld->ops->write_wakeup(tty);
848                 if (ld->ops->hangup)
849                         ld->ops->hangup(tty);
850                 tty_ldisc_deref(ld);
851         }
852         /*
853          * FIXME: Once we trust the LDISC code better we can wait here for
854          * ldisc completion and fix the driver call race
855          */
856         wake_up_interruptible_poll(&tty->write_wait, POLLOUT);
857         wake_up_interruptible_poll(&tty->read_wait, POLLIN);
858         /*
859          * Shutdown the current line discipline, and reset it to
860          * N_TTY if need be.
861          *
862          * Avoid racing set_ldisc or tty_ldisc_release
863          */
864         mutex_lock(&tty->ldisc_mutex);
865
866         /* At this point we have a closed ldisc and we want to
867            reopen it. We could defer this to the next open but
868            it means auditing a lot of other paths so this is
869            a FIXME */
870         if (tty_ldisc_hangup_halt(tty)) {
871                 if (reset == 0) {
872
873                         if (!tty_ldisc_reinit(tty, tty->termios.c_line))
874                                 err = tty_ldisc_open(tty, tty->ldisc);
875                         else
876                                 err = 1;
877                 }
878                 /* If the re-open fails or we reset then go to N_TTY. The
879                    N_TTY open cannot fail */
880                 if (reset || err) {
881                         BUG_ON(tty_ldisc_reinit(tty, N_TTY));
882                         WARN_ON(tty_ldisc_open(tty, tty->ldisc));
883                 }
884                 tty_ldisc_enable(tty);
885         }
886         mutex_unlock(&tty->ldisc_mutex);
887         if (reset)
888                 tty_reset_termios(tty);
889 }
890
891 /**
892  *      tty_ldisc_setup                 -       open line discipline
893  *      @tty: tty being shut down
894  *      @o_tty: pair tty for pty/tty pairs
895  *
896  *      Called during the initial open of a tty/pty pair in order to set up the
897  *      line disciplines and bind them to the tty. This has no locking issues
898  *      as the device isn't yet active.
899  */
900
901 int tty_ldisc_setup(struct tty_struct *tty, struct tty_struct *o_tty)
902 {
903         struct tty_ldisc *ld = tty->ldisc;
904         int retval;
905
906         retval = tty_ldisc_open(tty, ld);
907         if (retval)
908                 return retval;
909
910         if (o_tty) {
911                 retval = tty_ldisc_open(o_tty, o_tty->ldisc);
912                 if (retval) {
913                         tty_ldisc_close(tty, ld);
914                         return retval;
915                 }
916                 tty_ldisc_enable(o_tty);
917         }
918         tty_ldisc_enable(tty);
919         return 0;
920 }
921
922 static void tty_ldisc_kill(struct tty_struct *tty)
923 {
924         /* There cannot be users from userspace now. But there still might be
925          * drivers holding a reference via tty_ldisc_ref. Do not steal them the
926          * ldisc until they are done. */
927         tty_ldisc_wait_idle(tty, MAX_SCHEDULE_TIMEOUT);
928
929         mutex_lock(&tty->ldisc_mutex);
930         /*
931          * Now kill off the ldisc
932          */
933         tty_ldisc_close(tty, tty->ldisc);
934         tty_ldisc_put(tty->ldisc);
935         /* Force an oops if we mess this up */
936         tty->ldisc = NULL;
937
938         /* Ensure the next open requests the N_TTY ldisc */
939         tty_set_termios_ldisc(tty, N_TTY);
940         mutex_unlock(&tty->ldisc_mutex);
941 }
942
943 /**
944  *      tty_ldisc_release               -       release line discipline
945  *      @tty: tty being shut down
946  *      @o_tty: pair tty for pty/tty pairs
947  *
948  *      Called during the final close of a tty/pty pair in order to shut down
949  *      the line discpline layer. On exit the ldisc assigned is N_TTY and the
950  *      ldisc has not been opened.
951  */
952
953 void tty_ldisc_release(struct tty_struct *tty, struct tty_struct *o_tty)
954 {
955         /*
956          * Prevent flush_to_ldisc() from rescheduling the work for later.  Then
957          * kill any delayed work. As this is the final close it does not
958          * race with the set_ldisc code path.
959          */
960
961         tty_ldisc_halt(tty);
962         if (o_tty)
963                 tty_ldisc_halt(o_tty);
964
965         tty_ldisc_flush_works(tty);
966         if (o_tty)
967                 tty_ldisc_flush_works(o_tty);
968
969         tty_lock_pair(tty, o_tty);
970         /* This will need doing differently if we need to lock */
971         tty_ldisc_kill(tty);
972         if (o_tty)
973                 tty_ldisc_kill(o_tty);
974
975         tty_unlock_pair(tty, o_tty);
976         /* And the memory resources remaining (buffers, termios) will be
977            disposed of when the kref hits zero */
978 }
979
980 /**
981  *      tty_ldisc_init          -       ldisc setup for new tty
982  *      @tty: tty being allocated
983  *
984  *      Set up the line discipline objects for a newly allocated tty. Note that
985  *      the tty structure is not completely set up when this call is made.
986  */
987
988 void tty_ldisc_init(struct tty_struct *tty)
989 {
990         struct tty_ldisc *ld = tty_ldisc_get(N_TTY);
991         if (IS_ERR(ld))
992                 panic("n_tty: init_tty");
993         tty_ldisc_assign(tty, ld);
994 }
995
996 /**
997  *      tty_ldisc_init          -       ldisc cleanup for new tty
998  *      @tty: tty that was allocated recently
999  *
1000  *      The tty structure must not becompletely set up (tty_ldisc_setup) when
1001  *      this call is made.
1002  */
1003 void tty_ldisc_deinit(struct tty_struct *tty)
1004 {
1005         put_ldisc(tty->ldisc);
1006         tty_ldisc_assign(tty, NULL);
1007 }
1008
1009 void tty_ldisc_begin(void)
1010 {
1011         /* Setup the default TTY line discipline. */
1012         (void) tty_register_ldisc(N_TTY, &tty_ldisc_N_TTY);
1013 }