tty_ldisc.c 23 KB

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