tty_ldisc.c 19.3 KB
Newer Older
1 2
#include <linux/types.h>
#include <linux/errno.h>
3
#include <linux/kmod.h>
4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19
#include <linux/sched.h>
#include <linux/interrupt.h>
#include <linux/tty.h>
#include <linux/tty_driver.h>
#include <linux/file.h>
#include <linux/mm.h>
#include <linux/string.h>
#include <linux/slab.h>
#include <linux/poll.h>
#include <linux/proc_fs.h>
#include <linux/module.h>
#include <linux/device.h>
#include <linux/wait.h>
#include <linux/bitops.h>
#include <linux/seq_file.h>
#include <linux/uaccess.h>
20
#include <linux/ratelimit.h>
21

22 23 24
#undef LDISC_DEBUG_HANGUP

#ifdef LDISC_DEBUG_HANGUP
25
#define tty_ldisc_debug(tty, f, args...)	tty_debug(tty, f, ##args)
26 27 28 29
#else
#define tty_ldisc_debug(tty, f, args...)
#endif

30 31 32 33 34 35 36
/* lockdep nested classes for tty->ldisc_sem */
enum {
	LDISC_SEM_NORMAL,
	LDISC_SEM_OTHER,
};


37 38 39 40 41 42
/*
 *	This guards the refcounted line discipline lists. The lock
 *	must be taken with irqs off because there are hangup path
 *	callers who will do ldisc lookups and cannot sleep.
 */

43
static DEFINE_RAW_SPINLOCK(tty_ldiscs_lock);
44 45 46 47 48 49 50 51 52 53 54 55 56
/* Line disc dispatch table */
static struct tty_ldisc_ops *tty_ldiscs[NR_LDISCS];

/**
 *	tty_register_ldisc	-	install a line discipline
 *	@disc: ldisc number
 *	@new_ldisc: pointer to the ldisc object
 *
 *	Installs a new line discipline into the kernel. The discipline
 *	is set up as unreferenced and then made available to the kernel
 *	from this point onwards.
 *
 *	Locking:
57
 *		takes tty_ldiscs_lock to guard against ldisc races
58 59 60 61 62 63 64 65 66 67
 */

int tty_register_ldisc(int disc, struct tty_ldisc_ops *new_ldisc)
{
	unsigned long flags;
	int ret = 0;

	if (disc < N_TTY || disc >= NR_LDISCS)
		return -EINVAL;

68
	raw_spin_lock_irqsave(&tty_ldiscs_lock, flags);
69 70 71
	tty_ldiscs[disc] = new_ldisc;
	new_ldisc->num = disc;
	new_ldisc->refcount = 0;
72
	raw_spin_unlock_irqrestore(&tty_ldiscs_lock, flags);
73 74 75 76 77 78 79 80 81 82 83 84 85 86

	return ret;
}
EXPORT_SYMBOL(tty_register_ldisc);

/**
 *	tty_unregister_ldisc	-	unload a line discipline
 *	@disc: ldisc number
 *	@new_ldisc: pointer to the ldisc object
 *
 *	Remove a line discipline from the kernel providing it is not
 *	currently in use.
 *
 *	Locking:
87
 *		takes tty_ldiscs_lock to guard against ldisc races
88 89 90 91 92 93 94 95 96 97
 */

int tty_unregister_ldisc(int disc)
{
	unsigned long flags;
	int ret = 0;

	if (disc < N_TTY || disc >= NR_LDISCS)
		return -EINVAL;

98
	raw_spin_lock_irqsave(&tty_ldiscs_lock, flags);
99 100 101 102
	if (tty_ldiscs[disc]->refcount)
		ret = -EBUSY;
	else
		tty_ldiscs[disc] = NULL;
103
	raw_spin_unlock_irqrestore(&tty_ldiscs_lock, flags);
104 105 106 107 108

	return ret;
}
EXPORT_SYMBOL(tty_unregister_ldisc);

109 110 111 112 113
static struct tty_ldisc_ops *get_ldops(int disc)
{
	unsigned long flags;
	struct tty_ldisc_ops *ldops, *ret;

114
	raw_spin_lock_irqsave(&tty_ldiscs_lock, flags);
115 116 117 118 119 120 121 122 123
	ret = ERR_PTR(-EINVAL);
	ldops = tty_ldiscs[disc];
	if (ldops) {
		ret = ERR_PTR(-EAGAIN);
		if (try_module_get(ldops->owner)) {
			ldops->refcount++;
			ret = ldops;
		}
	}
124
	raw_spin_unlock_irqrestore(&tty_ldiscs_lock, flags);
125 126 127 128 129 130 131
	return ret;
}

static void put_ldops(struct tty_ldisc_ops *ldops)
{
	unsigned long flags;

132
	raw_spin_lock_irqsave(&tty_ldiscs_lock, flags);
133 134
	ldops->refcount--;
	module_put(ldops->owner);
135
	raw_spin_unlock_irqrestore(&tty_ldiscs_lock, flags);
136
}
137 138 139 140 141 142

/**
 *	tty_ldisc_get		-	take a reference to an ldisc
 *	@disc: ldisc number
 *
 *	Takes a reference to a line discipline. Deals with refcounts and
143 144 145 146 147 148 149 150 151 152
 *	module locking counts.
 *
 *	Returns: -EINVAL if the discipline index is not [N_TTY..NR_LDISCS] or
 *			 if the discipline is not registered
 *		 -EAGAIN if request_module() failed to load or register the
 *			 the discipline
 *		 -ENOMEM if allocation failure
 *
 *		 Otherwise, returns a pointer to the discipline and bumps the
 *		 ref count
153 154
 *
 *	Locking:
155
 *		takes tty_ldiscs_lock to guard against ldisc races
156 157
 */

158
static struct tty_ldisc *tty_ldisc_get(struct tty_struct *tty, int disc)
159
{
A
Alan Cox 已提交
160
	struct tty_ldisc *ld;
161
	struct tty_ldisc_ops *ldops;
162 163

	if (disc < N_TTY || disc >= NR_LDISCS)
A
Alan Cox 已提交
164
		return ERR_PTR(-EINVAL);
165 166 167 168 169 170 171

	/*
	 * Get the ldisc ops - we may need to request them to be loaded
	 * dynamically and try again.
	 */
	ldops = get_ldops(disc);
	if (IS_ERR(ldops)) {
172
		request_module("tty-ldisc-%d", disc);
173 174 175 176 177 178 179 180 181
		ldops = get_ldops(disc);
		if (IS_ERR(ldops))
			return ERR_CAST(ldops);
	}

	ld = kmalloc(sizeof(struct tty_ldisc), GFP_KERNEL);
	if (ld == NULL) {
		put_ldops(ldops);
		return ERR_PTR(-ENOMEM);
182
	}
183 184

	ld->ops = ldops;
185
	ld->tty = tty;
186

A
Alan Cox 已提交
187
	return ld;
188 189
}

190 191 192 193 194
/**
 *	tty_ldisc_put		-	release the ldisc
 *
 *	Complement of tty_ldisc_get().
 */
195
static void tty_ldisc_put(struct tty_ldisc *ld)
196 197 198 199
{
	if (WARN_ON_ONCE(!ld))
		return;

200
	put_ldops(ld->ops);
201 202 203
	kfree(ld);
}

A
Alan Cox 已提交
204
static void *tty_ldiscs_seq_start(struct seq_file *m, loff_t *pos)
205 206 207 208
{
	return (*pos < NR_LDISCS) ? pos : NULL;
}

A
Alan Cox 已提交
209
static void *tty_ldiscs_seq_next(struct seq_file *m, void *v, loff_t *pos)
210 211 212 213 214 215 216 217 218 219 220 221
{
	(*pos)++;
	return (*pos < NR_LDISCS) ? pos : NULL;
}

static void tty_ldiscs_seq_stop(struct seq_file *m, void *v)
{
}

static int tty_ldiscs_seq_show(struct seq_file *m, void *v)
{
	int i = *(loff_t *)v;
222
	struct tty_ldisc_ops *ldops;
A
Alan Cox 已提交
223

224 225
	ldops = get_ldops(i);
	if (IS_ERR(ldops))
226
		return 0;
227 228
	seq_printf(m, "%-10s %2d\n", ldops->name ? ldops->name : "???", i);
	put_ldops(ldops);
229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259
	return 0;
}

static const struct seq_operations tty_ldiscs_seq_ops = {
	.start	= tty_ldiscs_seq_start,
	.next	= tty_ldiscs_seq_next,
	.stop	= tty_ldiscs_seq_stop,
	.show	= tty_ldiscs_seq_show,
};

static int proc_tty_ldiscs_open(struct inode *inode, struct file *file)
{
	return seq_open(file, &tty_ldiscs_seq_ops);
}

const struct file_operations tty_ldiscs_proc_fops = {
	.owner		= THIS_MODULE,
	.open		= proc_tty_ldiscs_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= seq_release,
};

/**
 *	tty_ldisc_ref_wait	-	wait for the tty ldisc
 *	@tty: tty device
 *
 *	Dereference the line discipline for the terminal and take a
 *	reference to it. If the line discipline is in flux then
 *	wait patiently until it changes.
 *
260 261 262
 *	Returns: NULL if the tty has been hungup and not re-opened with
 *		 a new file descriptor, otherwise valid ldisc reference
 *
263 264 265 266 267
 *	Note: Must not be called from an IRQ/timer context. The caller
 *	must also be careful not to hold other locks that will deadlock
 *	against a discipline change, such as an existing ldisc reference
 *	(which we check for)
 *
268 269
 *	Note: a file_operations routine (read/poll/write) should use this
 *	function to wait for any ldisc lifetime events to finish.
270 271 272 273
 */

struct tty_ldisc *tty_ldisc_ref_wait(struct tty_struct *tty)
{
274 275
	struct tty_ldisc *ld;

276
	ldsem_down_read(&tty->ldisc_sem, MAX_SCHEDULE_TIMEOUT);
277 278
	ld = tty->ldisc;
	if (!ld)
P
Peter Hurley 已提交
279
		ldsem_up_read(&tty->ldisc_sem);
280
	return ld;
281 282 283 284 285 286 287 288 289 290 291 292 293 294
}
EXPORT_SYMBOL_GPL(tty_ldisc_ref_wait);

/**
 *	tty_ldisc_ref		-	get the tty ldisc
 *	@tty: tty device
 *
 *	Dereference the line discipline for the terminal and take a
 *	reference to it. If the line discipline is in flux then
 *	return NULL. Can be called from IRQ and timer functions.
 */

struct tty_ldisc *tty_ldisc_ref(struct tty_struct *tty)
{
295 296 297 298 299 300 301 302
	struct tty_ldisc *ld = NULL;

	if (ldsem_down_read_trylock(&tty->ldisc_sem)) {
		ld = tty->ldisc;
		if (!ld)
			ldsem_up_read(&tty->ldisc_sem);
	}
	return ld;
303 304 305 306 307 308 309 310 311 312 313 314 315
}
EXPORT_SYMBOL_GPL(tty_ldisc_ref);

/**
 *	tty_ldisc_deref		-	free a tty ldisc reference
 *	@ld: reference to free up
 *
 *	Undoes the effect of tty_ldisc_ref or tty_ldisc_ref_wait. May
 *	be called in IRQ context.
 */

void tty_ldisc_deref(struct tty_ldisc *ld)
{
316
	ldsem_up_read(&ld->tty->ldisc_sem);
317 318 319
}
EXPORT_SYMBOL_GPL(tty_ldisc_deref);

320

321
static inline int
322
__tty_ldisc_lock(struct tty_struct *tty, unsigned long timeout)
323 324 325 326
{
	return ldsem_down_write(&tty->ldisc_sem, timeout);
}

327
static inline int
328
__tty_ldisc_lock_nested(struct tty_struct *tty, unsigned long timeout)
329 330 331 332 333
{
	return ldsem_down_write_nested(&tty->ldisc_sem,
				       LDISC_SEM_OTHER, timeout);
}

334
static inline void __tty_ldisc_unlock(struct tty_struct *tty)
335
{
336
	ldsem_up_write(&tty->ldisc_sem);
337 338
}

339
static int tty_ldisc_lock(struct tty_struct *tty, unsigned long timeout)
P
Peter Hurley 已提交
340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355
{
	int ret;

	ret = __tty_ldisc_lock(tty, timeout);
	if (!ret)
		return -EBUSY;
	set_bit(TTY_LDISC_HALTED, &tty->flags);
	return 0;
}

static void tty_ldisc_unlock(struct tty_struct *tty)
{
	clear_bit(TTY_LDISC_HALTED, &tty->flags);
	__tty_ldisc_unlock(tty);
}

356
static int
357 358 359 360 361 362
tty_ldisc_lock_pair_timeout(struct tty_struct *tty, struct tty_struct *tty2,
			    unsigned long timeout)
{
	int ret;

	if (tty < tty2) {
363
		ret = __tty_ldisc_lock(tty, timeout);
364
		if (ret) {
365
			ret = __tty_ldisc_lock_nested(tty2, timeout);
366
			if (!ret)
367
				__tty_ldisc_unlock(tty);
368 369 370 371 372
		}
	} else {
		/* if this is possible, it has lots of implications */
		WARN_ON_ONCE(tty == tty2);
		if (tty2 && tty != tty2) {
373
			ret = __tty_ldisc_lock(tty2, timeout);
374
			if (ret) {
375
				ret = __tty_ldisc_lock_nested(tty, timeout);
376
				if (!ret)
377
					__tty_ldisc_unlock(tty2);
378 379
			}
		} else
380
			ret = __tty_ldisc_lock(tty, timeout);
381 382 383 384 385 386 387 388 389 390 391
	}

	if (!ret)
		return -EBUSY;

	set_bit(TTY_LDISC_HALTED, &tty->flags);
	if (tty2)
		set_bit(TTY_LDISC_HALTED, &tty2->flags);
	return 0;
}

392
static void tty_ldisc_lock_pair(struct tty_struct *tty, struct tty_struct *tty2)
393 394 395 396
{
	tty_ldisc_lock_pair_timeout(tty, tty2, MAX_SCHEDULE_TIMEOUT);
}

397 398
static void tty_ldisc_unlock_pair(struct tty_struct *tty,
				  struct tty_struct *tty2)
399
{
400
	__tty_ldisc_unlock(tty);
401
	if (tty2)
402
		__tty_ldisc_unlock(tty2);
403 404
}

A
Alan Cox 已提交
405 406 407 408
/**
 *	tty_ldisc_flush	-	flush line discipline queue
 *	@tty: tty
 *
409 410
 *	Flush the line discipline queue (if any) and the tty flip buffers
 *	for this tty.
A
Alan Cox 已提交
411 412 413 414 415
 */

void tty_ldisc_flush(struct tty_struct *tty)
{
	struct tty_ldisc *ld = tty_ldisc_ref(tty);
416 417 418

	tty_buffer_flush(tty, ld);
	if (ld)
A
Alan Cox 已提交
419 420 421 422
		tty_ldisc_deref(ld);
}
EXPORT_SYMBOL_GPL(tty_ldisc_flush);

423 424 425
/**
 *	tty_set_termios_ldisc		-	set ldisc field
 *	@tty: tty structure
426
 *	@disc: line discipline number
427 428 429 430 431
 *
 *	This is probably overkill for real world processors but
 *	they are not on hot paths so a little discipline won't do
 *	any harm.
 *
432 433 434 435
 *	The line discipline-related tty_struct fields are reset to
 *	prevent the ldisc driver from re-using stale information for
 *	the new ldisc instance.
 *
436
 *	Locking: takes termios_rwsem
437 438
 */

439
static void tty_set_termios_ldisc(struct tty_struct *tty, int disc)
440
{
441
	down_write(&tty->termios_rwsem);
442
	tty->termios.c_line = disc;
443
	up_write(&tty->termios_rwsem);
444 445 446

	tty->disc_data = NULL;
	tty->receive_room = 0;
447 448
}

A
Alan Cox 已提交
449 450 451 452 453 454 455
/**
 *	tty_ldisc_open		-	open a line discipline
 *	@tty: tty we are opening the ldisc on
 *	@ld: discipline to open
 *
 *	A helper opening method. Also a convenient debugging and check
 *	point.
456 457
 *
 *	Locking: always called with BTM already held.
A
Alan Cox 已提交
458 459 460 461 462
 */

static int tty_ldisc_open(struct tty_struct *tty, struct tty_ldisc *ld)
{
	WARN_ON(test_and_set_bit(TTY_LDISC_OPEN, &tty->flags));
463 464
	if (ld->ops->open) {
		int ret;
465
                /* BTM here locks versus a hangup event */
466
		ret = ld->ops->open(tty);
J
Jiri Slaby 已提交
467 468
		if (ret)
			clear_bit(TTY_LDISC_OPEN, &tty->flags);
469

P
Peter Hurley 已提交
470
		tty_ldisc_debug(tty, "%p: opened\n", ld);
471 472
		return ret;
	}
A
Alan Cox 已提交
473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490
	return 0;
}

/**
 *	tty_ldisc_close		-	close a line discipline
 *	@tty: tty we are opening the ldisc on
 *	@ld: discipline to close
 *
 *	A helper close method. Also a convenient debugging and check
 *	point.
 */

static void tty_ldisc_close(struct tty_struct *tty, struct tty_ldisc *ld)
{
	WARN_ON(!test_bit(TTY_LDISC_OPEN, &tty->flags));
	clear_bit(TTY_LDISC_OPEN, &tty->flags);
	if (ld->ops->close)
		ld->ops->close(tty);
P
Peter Hurley 已提交
491
	tty_ldisc_debug(tty, "%p: closed\n", ld);
A
Alan Cox 已提交
492
}
493

494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528
/**
 *	tty_ldisc_restore	-	helper for tty ldisc change
 *	@tty: tty to recover
 *	@old: previous ldisc
 *
 *	Restore the previous line discipline or N_TTY when a line discipline
 *	change fails due to an open error
 */

static void tty_ldisc_restore(struct tty_struct *tty, struct tty_ldisc *old)
{
	struct tty_ldisc *new_ldisc;
	int r;

	/* There is an outstanding reference here so this is safe */
	old = tty_ldisc_get(tty, old->ops->num);
	WARN_ON(IS_ERR(old));
	tty->ldisc = old;
	tty_set_termios_ldisc(tty, old->ops->num);
	if (tty_ldisc_open(tty, old) < 0) {
		tty_ldisc_put(old);
		/* This driver is always present */
		new_ldisc = tty_ldisc_get(tty, N_TTY);
		if (IS_ERR(new_ldisc))
			panic("n_tty: get");
		tty->ldisc = new_ldisc;
		tty_set_termios_ldisc(tty, N_TTY);
		r = tty_ldisc_open(tty, new_ldisc);
		if (r < 0)
			panic("Couldn't open N_TTY ldisc for "
			      "%s --- error %d.",
			      tty_name(tty), r);
	}
}

529 530 531 532 533 534
/**
 *	tty_set_ldisc		-	set line discipline
 *	@tty: the terminal to set
 *	@ldisc: the line discipline
 *
 *	Set the discipline of a tty line. Must be called from a process
A
Alan Cox 已提交
535 536 537
 *	context. The ldisc change logic has to protect itself against any
 *	overlapping ldisc change (including on the other end of pty pairs),
 *	the close of one side of a tty/pty pair, and eventually hangup.
538 539
 */

540
int tty_set_ldisc(struct tty_struct *tty, int disc)
541
{
542 543 544 545 546 547
	int retval;
	struct tty_ldisc *old_ldisc, *new_ldisc;

	new_ldisc = tty_ldisc_get(tty, disc);
	if (IS_ERR(new_ldisc))
		return PTR_ERR(new_ldisc);
548

549
	tty_lock(tty);
P
Peter Hurley 已提交
550
	retval = tty_ldisc_lock(tty, 5 * HZ);
551 552
	if (retval)
		goto err;
553

P
Peter Hurley 已提交
554 555 556 557 558
	if (!tty->ldisc) {
		retval = -EIO;
		goto out;
	}

559
	/* Check the no-op case */
560
	if (tty->ldisc->ops->num == disc)
561
		goto out;
A
Alan Cox 已提交
562

563 564 565 566
	if (test_bit(TTY_HUPPED, &tty->flags)) {
		/* We were raced by hangup */
		retval = -EIO;
		goto out;
567 568
	}

569 570 571 572 573 574 575 576 577 578
	old_ldisc = tty->ldisc;

	/* Shutdown the old discipline. */
	tty_ldisc_close(tty, old_ldisc);

	/* Now set up the new line discipline. */
	tty->ldisc = new_ldisc;
	tty_set_termios_ldisc(tty, disc);

	retval = tty_ldisc_open(tty, new_ldisc);
579
	if (retval < 0) {
A
Alan Cox 已提交
580
		/* Back to the old one or N_TTY if we can't */
581 582
		tty_ldisc_put(new_ldisc);
		tty_ldisc_restore(tty, old_ldisc);
583
	}
A
Alan Cox 已提交
584

585
	if (tty->ldisc->ops->num != old_ldisc->ops->num && tty->ops->set_ldisc) {
586
		down_read(&tty->termios_rwsem);
587
		tty->ops->set_ldisc(tty);
588 589
		up_read(&tty->termios_rwsem);
	}
590

591 592 593 594 595 596
	/* At this point we hold a reference to the new ldisc and a
	   reference to the old ldisc, or we hold two references to
	   the old ldisc (if it was restored as part of error cleanup
	   above). In either case, releasing a single reference from
	   the old ldisc is correct. */
	new_ldisc = old_ldisc;
597
out:
P
Peter Hurley 已提交
598
	tty_ldisc_unlock(tty);
599

A
Alan Cox 已提交
600
	/* Restart the work queue in case no characters kick it off. Safe if
601
	   already running */
602
	tty_buffer_restart_work(tty->port);
603
err:
604
	tty_ldisc_put(new_ldisc);	/* drop the extra reference */
A
Alan Cox 已提交
605
	tty_unlock(tty);
606 607 608
	return retval;
}

P
Peter Hurley 已提交
609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627
/**
 *	tty_ldisc_kill	-	teardown ldisc
 *	@tty: tty being released
 *
 *	Perform final close of the ldisc and reset tty->ldisc
 */
static void tty_ldisc_kill(struct tty_struct *tty)
{
	if (!tty->ldisc)
		return;
	/*
	 * Now kill off the ldisc
	 */
	tty_ldisc_close(tty, tty->ldisc);
	tty_ldisc_put(tty->ldisc);
	/* Force an oops if we mess this up */
	tty->ldisc = NULL;
}

A
Alan Cox 已提交
628 629 630 631 632 633 634 635 636
/**
 *	tty_reset_termios	-	reset terminal state
 *	@tty: tty to reset
 *
 *	Restore a terminal to the driver default state.
 */

static void tty_reset_termios(struct tty_struct *tty)
{
637
	down_write(&tty->termios_rwsem);
638 639 640
	tty->termios = tty->driver->init_termios;
	tty->termios.c_ispeed = tty_termios_input_baud_rate(&tty->termios);
	tty->termios.c_ospeed = tty_termios_baud_rate(&tty->termios);
641
	up_write(&tty->termios_rwsem);
A
Alan Cox 已提交
642 643 644 645 646 647
}


/**
 *	tty_ldisc_reinit	-	reinitialise the tty ldisc
 *	@tty: tty to reinit
648
 *	@disc: line discipline to reinitialize
A
Alan Cox 已提交
649
 *
650
 *	Completely reinitialize the line discipline state, by closing the
651 652 653 654
 *	current instance, if there is one, and opening a new instance. If
 *	an error occurs opening the new non-N_TTY instance, the instance
 *	is dropped and tty->ldisc reset to NULL. The caller can then retry
 *	with N_TTY instead.
655 656
 *
 *	Returns 0 if successful, otherwise error code < 0
A
Alan Cox 已提交
657 658
 */

659
int tty_ldisc_reinit(struct tty_struct *tty, int disc)
A
Alan Cox 已提交
660
{
661 662
	struct tty_ldisc *ld;
	int retval;
663

664
	ld = tty_ldisc_get(tty, disc);
665 666
	if (IS_ERR(ld)) {
		BUG_ON(disc == N_TTY);
667
		return PTR_ERR(ld);
668
	}
A
Alan Cox 已提交
669

670 671 672 673 674 675
	if (tty->ldisc) {
		tty_ldisc_close(tty, tty->ldisc);
		tty_ldisc_put(tty->ldisc);
	}

	/* switch the line discipline */
676
	tty->ldisc = ld;
677
	tty_set_termios_ldisc(tty, disc);
678 679
	retval = tty_ldisc_open(tty, tty->ldisc);
	if (retval) {
680 681 682 683
		if (!WARN_ON(disc == N_TTY)) {
			tty_ldisc_put(tty->ldisc);
			tty->ldisc = NULL;
		}
684 685
	}
	return retval;
A
Alan Cox 已提交
686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702
}

/**
 *	tty_ldisc_hangup		-	hangup ldisc reset
 *	@tty: tty being hung up
 *
 *	Some tty devices reset their termios when they receive a hangup
 *	event. In that situation we must also switch back to N_TTY properly
 *	before we reset the termios data.
 *
 *	Locking: We can take the ldisc mutex as the rest of the code is
 *	careful to allow for this.
 *
 *	In the pty pair case this occurs in the close() path of the
 *	tty itself so we must be careful about locking rules.
 */

703
void tty_ldisc_hangup(struct tty_struct *tty, bool reinit)
A
Alan Cox 已提交
704 705 706
{
	struct tty_ldisc *ld;

P
Peter Hurley 已提交
707
	tty_ldisc_debug(tty, "%p: hangup\n", tty->ldisc);
708

A
Alan Cox 已提交
709 710 711 712 713 714 715 716 717 718 719 720
	ld = tty_ldisc_ref(tty);
	if (ld != NULL) {
		if (ld->ops->flush_buffer)
			ld->ops->flush_buffer(tty);
		tty_driver_flush_buffer(tty);
		if ((test_bit(TTY_DO_WRITE_WAKEUP, &tty->flags)) &&
		    ld->ops->write_wakeup)
			ld->ops->write_wakeup(tty);
		if (ld->ops->hangup)
			ld->ops->hangup(tty);
		tty_ldisc_deref(ld);
	}
721

A
Alan Cox 已提交
722 723
	wake_up_interruptible_poll(&tty->write_wait, POLLOUT);
	wake_up_interruptible_poll(&tty->read_wait, POLLIN);
724

A
Alan Cox 已提交
725 726
	/*
	 * Shutdown the current line discipline, and reset it to
A
Alan Cox 已提交
727 728 729
	 * N_TTY if need be.
	 *
	 * Avoid racing set_ldisc or tty_ldisc_release
A
Alan Cox 已提交
730
	 */
P
Peter Hurley 已提交
731
	tty_ldisc_lock(tty, MAX_SCHEDULE_TIMEOUT);
A
Arnd Bergmann 已提交
732

733 734
	if (tty->driver->flags & TTY_DRIVER_RESET_TERMIOS)
		tty_reset_termios(tty);
735

736 737 738 739 740 741
	if (tty->ldisc) {
		if (reinit) {
			if (tty_ldisc_reinit(tty, tty->termios.c_line) < 0)
				tty_ldisc_reinit(tty, N_TTY);
		} else
			tty_ldisc_kill(tty);
A
Alan Cox 已提交
742
	}
P
Peter Hurley 已提交
743
	tty_ldisc_unlock(tty);
A
Alan Cox 已提交
744
}
745 746 747 748 749 750 751

/**
 *	tty_ldisc_setup			-	open line discipline
 *	@tty: tty being shut down
 *	@o_tty: pair tty for pty/tty pairs
 *
 *	Called during the initial open of a tty/pty pair in order to set up the
A
Alan Cox 已提交
752 753
 *	line disciplines and bind them to the tty. This has no locking issues
 *	as the device isn't yet active.
754 755 756 757
 */

int tty_ldisc_setup(struct tty_struct *tty, struct tty_struct *o_tty)
{
758
	int retval = tty_ldisc_open(tty, tty->ldisc);
A
Alan Cox 已提交
759 760 761 762 763
	if (retval)
		return retval;

	if (o_tty) {
		retval = tty_ldisc_open(o_tty, o_tty->ldisc);
764
		if (retval) {
765
			tty_ldisc_close(tty, tty->ldisc);
766 767 768 769 770
			return retval;
		}
	}
	return 0;
}
A
Alan Cox 已提交
771

772 773
/**
 *	tty_ldisc_release		-	release line discipline
774
 *	@tty: tty being shut down (or one end of pty pair)
775
 *
776
 *	Called during the final close of a tty or a pty pair in order to shut
777
 *	down the line discpline layer. On exit, each tty's ldisc is NULL.
778 779
 */

780
void tty_ldisc_release(struct tty_struct *tty)
781
{
782 783
	struct tty_struct *o_tty = tty->link;

784
	/*
785 786
	 * Shutdown this line discipline. As this is the final close,
	 * it does not race with the set_ldisc code path.
787 788
	 */

789
	tty_ldisc_lock_pair(tty, o_tty);
A
Alan Cox 已提交
790
	tty_ldisc_kill(tty);
A
Alan Cox 已提交
791
	if (o_tty)
A
Alan Cox 已提交
792
		tty_ldisc_kill(o_tty);
793 794
	tty_ldisc_unlock_pair(tty, o_tty);

795 796
	/* And the memory resources remaining (buffers, termios) will be
	   disposed of when the kref hits zero */
797

798
	tty_ldisc_debug(tty, "released\n");
799 800 801 802 803 804 805 806 807 808 809 810
}

/**
 *	tty_ldisc_init		-	ldisc setup for new tty
 *	@tty: tty being allocated
 *
 *	Set up the line discipline objects for a newly allocated tty. Note that
 *	the tty structure is not completely set up when this call is made.
 */

void tty_ldisc_init(struct tty_struct *tty)
{
811
	struct tty_ldisc *ld = tty_ldisc_get(tty, N_TTY);
A
Alan Cox 已提交
812
	if (IS_ERR(ld))
813
		panic("n_tty: init_tty");
814
	tty->ldisc = ld;
815 816
}

817
/**
818
 *	tty_ldisc_deinit	-	ldisc cleanup for new tty
819 820 821 822 823 824 825
 *	@tty: tty that was allocated recently
 *
 *	The tty structure must not becompletely set up (tty_ldisc_setup) when
 *      this call is made.
 */
void tty_ldisc_deinit(struct tty_struct *tty)
{
826 827
	if (tty->ldisc)
		tty_ldisc_put(tty->ldisc);
828
	tty->ldisc = NULL;
829
}