drivers/char/tty_ldisc.c

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