Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/sage/ceph...
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / tty / pty.c
1 /*
2 * Copyright (C) 1991, 1992 Linus Torvalds
3 *
4 * Added support for a Unix98-style ptmx device.
5 * -- C. Scott Ananian <cananian@alumni.princeton.edu>, 14-Jan-1998
6 *
7 */
8
9 #include <linux/module.h>
10
11 #include <linux/errno.h>
12 #include <linux/interrupt.h>
13 #include <linux/tty.h>
14 #include <linux/tty_flip.h>
15 #include <linux/fcntl.h>
16 #include <linux/sched.h>
17 #include <linux/string.h>
18 #include <linux/major.h>
19 #include <linux/mm.h>
20 #include <linux/init.h>
21 #include <linux/device.h>
22 #include <linux/uaccess.h>
23 #include <linux/bitops.h>
24 #include <linux/devpts_fs.h>
25 #include <linux/slab.h>
26 #include <linux/mutex.h>
27
28
29 #ifdef CONFIG_UNIX98_PTYS
30 static struct tty_driver *ptm_driver;
31 static struct tty_driver *pts_driver;
32 static DEFINE_MUTEX(devpts_mutex);
33 #endif
34
35 static void pty_close(struct tty_struct *tty, struct file *filp)
36 {
37 BUG_ON(!tty);
38 if (tty->driver->subtype == PTY_TYPE_MASTER)
39 WARN_ON(tty->count > 1);
40 else {
41 if (test_bit(TTY_IO_ERROR, &tty->flags))
42 return;
43 if (tty->count > 2)
44 return;
45 }
46 set_bit(TTY_IO_ERROR, &tty->flags);
47 wake_up_interruptible(&tty->read_wait);
48 wake_up_interruptible(&tty->write_wait);
49 tty->packet = 0;
50 /* Review - krefs on tty_link ?? */
51 if (!tty->link)
52 return;
53 set_bit(TTY_OTHER_CLOSED, &tty->link->flags);
54 wake_up_interruptible(&tty->link->read_wait);
55 wake_up_interruptible(&tty->link->write_wait);
56 if (tty->driver->subtype == PTY_TYPE_MASTER) {
57 set_bit(TTY_OTHER_CLOSED, &tty->flags);
58 #ifdef CONFIG_UNIX98_PTYS
59 if (tty->driver == ptm_driver) {
60 mutex_lock(&devpts_mutex);
61 if (tty->link->driver_data)
62 devpts_pty_kill(tty->link->driver_data);
63 mutex_unlock(&devpts_mutex);
64 }
65 #endif
66 tty_unlock(tty);
67 tty_vhangup(tty->link);
68 tty_lock(tty);
69 }
70 }
71
72 /*
73 * The unthrottle routine is called by the line discipline to signal
74 * that it can receive more characters. For PTY's, the TTY_THROTTLED
75 * flag is always set, to force the line discipline to always call the
76 * unthrottle routine when there are fewer than TTY_THRESHOLD_UNTHROTTLE
77 * characters in the queue. This is necessary since each time this
78 * happens, we need to wake up any sleeping processes that could be
79 * (1) trying to send data to the pty, or (2) waiting in wait_until_sent()
80 * for the pty buffer to be drained.
81 */
82 static void pty_unthrottle(struct tty_struct *tty)
83 {
84 tty_wakeup(tty->link);
85 set_bit(TTY_THROTTLED, &tty->flags);
86 }
87
88 /**
89 * pty_space - report space left for writing
90 * @to: tty we are writing into
91 *
92 * The tty buffers allow 64K but we sneak a peak and clip at 8K this
93 * allows a lot of overspill room for echo and other fun messes to
94 * be handled properly
95 */
96
97 static int pty_space(struct tty_struct *to)
98 {
99 int n = 8192 - to->port->buf.memory_used;
100 if (n < 0)
101 return 0;
102 return n;
103 }
104
105 /**
106 * pty_write - write to a pty
107 * @tty: the tty we write from
108 * @buf: kernel buffer of data
109 * @count: bytes to write
110 *
111 * Our "hardware" write method. Data is coming from the ldisc which
112 * may be in a non sleeping state. We simply throw this at the other
113 * end of the link as if we were an IRQ handler receiving stuff for
114 * the other side of the pty/tty pair.
115 */
116
117 static int pty_write(struct tty_struct *tty, const unsigned char *buf, int c)
118 {
119 struct tty_struct *to = tty->link;
120
121 if (tty->stopped)
122 return 0;
123
124 if (c > 0) {
125 /* Stuff the data into the input queue of the other end */
126 c = tty_insert_flip_string(to->port, buf, c);
127 /* And shovel */
128 if (c) {
129 tty_flip_buffer_push(to->port);
130 tty_wakeup(tty);
131 }
132 }
133 return c;
134 }
135
136 /**
137 * pty_write_room - write space
138 * @tty: tty we are writing from
139 *
140 * Report how many bytes the ldisc can send into the queue for
141 * the other device.
142 */
143
144 static int pty_write_room(struct tty_struct *tty)
145 {
146 if (tty->stopped)
147 return 0;
148 return pty_space(tty->link);
149 }
150
151 /**
152 * pty_chars_in_buffer - characters currently in our tx queue
153 * @tty: our tty
154 *
155 * Report how much we have in the transmit queue. As everything is
156 * instantly at the other end this is easy to implement.
157 */
158
159 static int pty_chars_in_buffer(struct tty_struct *tty)
160 {
161 return 0;
162 }
163
164 /* Set the lock flag on a pty */
165 static int pty_set_lock(struct tty_struct *tty, int __user *arg)
166 {
167 int val;
168 if (get_user(val, arg))
169 return -EFAULT;
170 if (val)
171 set_bit(TTY_PTY_LOCK, &tty->flags);
172 else
173 clear_bit(TTY_PTY_LOCK, &tty->flags);
174 return 0;
175 }
176
177 static int pty_get_lock(struct tty_struct *tty, int __user *arg)
178 {
179 int locked = test_bit(TTY_PTY_LOCK, &tty->flags);
180 return put_user(locked, arg);
181 }
182
183 /* Set the packet mode on a pty */
184 static int pty_set_pktmode(struct tty_struct *tty, int __user *arg)
185 {
186 unsigned long flags;
187 int pktmode;
188
189 if (get_user(pktmode, arg))
190 return -EFAULT;
191
192 spin_lock_irqsave(&tty->ctrl_lock, flags);
193 if (pktmode) {
194 if (!tty->packet) {
195 tty->packet = 1;
196 tty->link->ctrl_status = 0;
197 }
198 } else
199 tty->packet = 0;
200 spin_unlock_irqrestore(&tty->ctrl_lock, flags);
201
202 return 0;
203 }
204
205 /* Get the packet mode of a pty */
206 static int pty_get_pktmode(struct tty_struct *tty, int __user *arg)
207 {
208 int pktmode = tty->packet;
209 return put_user(pktmode, arg);
210 }
211
212 /* Send a signal to the slave */
213 static int pty_signal(struct tty_struct *tty, int sig)
214 {
215 unsigned long flags;
216 struct pid *pgrp;
217
218 if (tty->link) {
219 spin_lock_irqsave(&tty->link->ctrl_lock, flags);
220 pgrp = get_pid(tty->link->pgrp);
221 spin_unlock_irqrestore(&tty->link->ctrl_lock, flags);
222
223 kill_pgrp(pgrp, sig, 1);
224 put_pid(pgrp);
225 }
226 return 0;
227 }
228
229 static void pty_flush_buffer(struct tty_struct *tty)
230 {
231 struct tty_struct *to = tty->link;
232 unsigned long flags;
233
234 if (!to)
235 return;
236 /* tty_buffer_flush(to); FIXME */
237 if (to->packet) {
238 spin_lock_irqsave(&tty->ctrl_lock, flags);
239 tty->ctrl_status |= TIOCPKT_FLUSHWRITE;
240 wake_up_interruptible(&to->read_wait);
241 spin_unlock_irqrestore(&tty->ctrl_lock, flags);
242 }
243 }
244
245 static int pty_open(struct tty_struct *tty, struct file *filp)
246 {
247 int retval = -ENODEV;
248
249 if (!tty || !tty->link)
250 goto out;
251
252 set_bit(TTY_IO_ERROR, &tty->flags);
253
254 retval = -EIO;
255 if (test_bit(TTY_OTHER_CLOSED, &tty->flags))
256 goto out;
257 if (test_bit(TTY_PTY_LOCK, &tty->link->flags))
258 goto out;
259 if (tty->driver->subtype == PTY_TYPE_SLAVE && tty->link->count != 1)
260 goto out;
261
262 clear_bit(TTY_IO_ERROR, &tty->flags);
263 clear_bit(TTY_OTHER_CLOSED, &tty->link->flags);
264 set_bit(TTY_THROTTLED, &tty->flags);
265 retval = 0;
266 out:
267 return retval;
268 }
269
270 static void pty_set_termios(struct tty_struct *tty,
271 struct ktermios *old_termios)
272 {
273 tty->termios.c_cflag &= ~(CSIZE | PARENB);
274 tty->termios.c_cflag |= (CS8 | CREAD);
275 }
276
277 /**
278 * pty_do_resize - resize event
279 * @tty: tty being resized
280 * @ws: window size being set.
281 *
282 * Update the termios variables and send the necessary signals to
283 * peform a terminal resize correctly
284 */
285
286 static int pty_resize(struct tty_struct *tty, struct winsize *ws)
287 {
288 struct pid *pgrp, *rpgrp;
289 unsigned long flags;
290 struct tty_struct *pty = tty->link;
291
292 /* For a PTY we need to lock the tty side */
293 mutex_lock(&tty->termios_mutex);
294 if (!memcmp(ws, &tty->winsize, sizeof(*ws)))
295 goto done;
296
297 /* Get the PID values and reference them so we can
298 avoid holding the tty ctrl lock while sending signals.
299 We need to lock these individually however. */
300
301 spin_lock_irqsave(&tty->ctrl_lock, flags);
302 pgrp = get_pid(tty->pgrp);
303 spin_unlock_irqrestore(&tty->ctrl_lock, flags);
304
305 spin_lock_irqsave(&pty->ctrl_lock, flags);
306 rpgrp = get_pid(pty->pgrp);
307 spin_unlock_irqrestore(&pty->ctrl_lock, flags);
308
309 if (pgrp)
310 kill_pgrp(pgrp, SIGWINCH, 1);
311 if (rpgrp != pgrp && rpgrp)
312 kill_pgrp(rpgrp, SIGWINCH, 1);
313
314 put_pid(pgrp);
315 put_pid(rpgrp);
316
317 tty->winsize = *ws;
318 pty->winsize = *ws; /* Never used so will go away soon */
319 done:
320 mutex_unlock(&tty->termios_mutex);
321 return 0;
322 }
323
324 /**
325 * pty_common_install - set up the pty pair
326 * @driver: the pty driver
327 * @tty: the tty being instantiated
328 * @bool: legacy, true if this is BSD style
329 *
330 * Perform the initial set up for the tty/pty pair. Called from the
331 * tty layer when the port is first opened.
332 *
333 * Locking: the caller must hold the tty_mutex
334 */
335 static int pty_common_install(struct tty_driver *driver, struct tty_struct *tty,
336 bool legacy)
337 {
338 struct tty_struct *o_tty;
339 struct tty_port *ports[2];
340 int idx = tty->index;
341 int retval = -ENOMEM;
342
343 o_tty = alloc_tty_struct();
344 if (!o_tty)
345 goto err;
346 ports[0] = kmalloc(sizeof **ports, GFP_KERNEL);
347 ports[1] = kmalloc(sizeof **ports, GFP_KERNEL);
348 if (!ports[0] || !ports[1])
349 goto err_free_tty;
350 if (!try_module_get(driver->other->owner)) {
351 /* This cannot in fact currently happen */
352 goto err_free_tty;
353 }
354 initialize_tty_struct(o_tty, driver->other, idx);
355
356 if (legacy) {
357 /* We always use new tty termios data so we can do this
358 the easy way .. */
359 retval = tty_init_termios(tty);
360 if (retval)
361 goto err_deinit_tty;
362
363 retval = tty_init_termios(o_tty);
364 if (retval)
365 goto err_free_termios;
366
367 driver->other->ttys[idx] = o_tty;
368 driver->ttys[idx] = tty;
369 } else {
370 memset(&tty->termios_locked, 0, sizeof(tty->termios_locked));
371 tty->termios = driver->init_termios;
372 memset(&o_tty->termios_locked, 0, sizeof(tty->termios_locked));
373 o_tty->termios = driver->other->init_termios;
374 }
375
376 /*
377 * Everything allocated ... set up the o_tty structure.
378 */
379 tty_driver_kref_get(driver->other);
380 if (driver->subtype == PTY_TYPE_MASTER)
381 o_tty->count++;
382 /* Establish the links in both directions */
383 tty->link = o_tty;
384 o_tty->link = tty;
385 tty_port_init(ports[0]);
386 tty_port_init(ports[1]);
387 o_tty->port = ports[0];
388 tty->port = ports[1];
389 o_tty->port->itty = o_tty;
390
391 tty_driver_kref_get(driver);
392 tty->count++;
393 return 0;
394 err_free_termios:
395 if (legacy)
396 tty_free_termios(tty);
397 err_deinit_tty:
398 deinitialize_tty_struct(o_tty);
399 module_put(o_tty->driver->owner);
400 err_free_tty:
401 kfree(ports[0]);
402 kfree(ports[1]);
403 free_tty_struct(o_tty);
404 err:
405 return retval;
406 }
407
408 static void pty_cleanup(struct tty_struct *tty)
409 {
410 tty_port_put(tty->port);
411 }
412
413 /* Traditional BSD devices */
414 #ifdef CONFIG_LEGACY_PTYS
415
416 static int pty_install(struct tty_driver *driver, struct tty_struct *tty)
417 {
418 return pty_common_install(driver, tty, true);
419 }
420
421 static void pty_remove(struct tty_driver *driver, struct tty_struct *tty)
422 {
423 struct tty_struct *pair = tty->link;
424 driver->ttys[tty->index] = NULL;
425 if (pair)
426 pair->driver->ttys[pair->index] = NULL;
427 }
428
429 static int pty_bsd_ioctl(struct tty_struct *tty,
430 unsigned int cmd, unsigned long arg)
431 {
432 switch (cmd) {
433 case TIOCSPTLCK: /* Set PT Lock (disallow slave open) */
434 return pty_set_lock(tty, (int __user *) arg);
435 case TIOCGPTLCK: /* Get PT Lock status */
436 return pty_get_lock(tty, (int __user *)arg);
437 case TIOCPKT: /* Set PT packet mode */
438 return pty_set_pktmode(tty, (int __user *)arg);
439 case TIOCGPKT: /* Get PT packet mode */
440 return pty_get_pktmode(tty, (int __user *)arg);
441 case TIOCSIG: /* Send signal to other side of pty */
442 return pty_signal(tty, (int) arg);
443 case TIOCGPTN: /* TTY returns ENOTTY, but glibc expects EINVAL here */
444 return -EINVAL;
445 }
446 return -ENOIOCTLCMD;
447 }
448
449 static int legacy_count = CONFIG_LEGACY_PTY_COUNT;
450 module_param(legacy_count, int, 0);
451
452 /*
453 * The master side of a pty can do TIOCSPTLCK and thus
454 * has pty_bsd_ioctl.
455 */
456 static const struct tty_operations master_pty_ops_bsd = {
457 .install = pty_install,
458 .open = pty_open,
459 .close = pty_close,
460 .write = pty_write,
461 .write_room = pty_write_room,
462 .flush_buffer = pty_flush_buffer,
463 .chars_in_buffer = pty_chars_in_buffer,
464 .unthrottle = pty_unthrottle,
465 .set_termios = pty_set_termios,
466 .ioctl = pty_bsd_ioctl,
467 .cleanup = pty_cleanup,
468 .resize = pty_resize,
469 .remove = pty_remove
470 };
471
472 static const struct tty_operations slave_pty_ops_bsd = {
473 .install = pty_install,
474 .open = pty_open,
475 .close = pty_close,
476 .write = pty_write,
477 .write_room = pty_write_room,
478 .flush_buffer = pty_flush_buffer,
479 .chars_in_buffer = pty_chars_in_buffer,
480 .unthrottle = pty_unthrottle,
481 .set_termios = pty_set_termios,
482 .cleanup = pty_cleanup,
483 .resize = pty_resize,
484 .remove = pty_remove
485 };
486
487 static void __init legacy_pty_init(void)
488 {
489 struct tty_driver *pty_driver, *pty_slave_driver;
490
491 if (legacy_count <= 0)
492 return;
493
494 pty_driver = tty_alloc_driver(legacy_count,
495 TTY_DRIVER_RESET_TERMIOS |
496 TTY_DRIVER_REAL_RAW |
497 TTY_DRIVER_DYNAMIC_ALLOC);
498 if (IS_ERR(pty_driver))
499 panic("Couldn't allocate pty driver");
500
501 pty_slave_driver = tty_alloc_driver(legacy_count,
502 TTY_DRIVER_RESET_TERMIOS |
503 TTY_DRIVER_REAL_RAW |
504 TTY_DRIVER_DYNAMIC_ALLOC);
505 if (IS_ERR(pty_slave_driver))
506 panic("Couldn't allocate pty slave driver");
507
508 pty_driver->driver_name = "pty_master";
509 pty_driver->name = "pty";
510 pty_driver->major = PTY_MASTER_MAJOR;
511 pty_driver->minor_start = 0;
512 pty_driver->type = TTY_DRIVER_TYPE_PTY;
513 pty_driver->subtype = PTY_TYPE_MASTER;
514 pty_driver->init_termios = tty_std_termios;
515 pty_driver->init_termios.c_iflag = 0;
516 pty_driver->init_termios.c_oflag = 0;
517 pty_driver->init_termios.c_cflag = B38400 | CS8 | CREAD;
518 pty_driver->init_termios.c_lflag = 0;
519 pty_driver->init_termios.c_ispeed = 38400;
520 pty_driver->init_termios.c_ospeed = 38400;
521 pty_driver->other = pty_slave_driver;
522 tty_set_operations(pty_driver, &master_pty_ops_bsd);
523
524 pty_slave_driver->driver_name = "pty_slave";
525 pty_slave_driver->name = "ttyp";
526 pty_slave_driver->major = PTY_SLAVE_MAJOR;
527 pty_slave_driver->minor_start = 0;
528 pty_slave_driver->type = TTY_DRIVER_TYPE_PTY;
529 pty_slave_driver->subtype = PTY_TYPE_SLAVE;
530 pty_slave_driver->init_termios = tty_std_termios;
531 pty_slave_driver->init_termios.c_cflag = B38400 | CS8 | CREAD;
532 pty_slave_driver->init_termios.c_ispeed = 38400;
533 pty_slave_driver->init_termios.c_ospeed = 38400;
534 pty_slave_driver->other = pty_driver;
535 tty_set_operations(pty_slave_driver, &slave_pty_ops_bsd);
536
537 if (tty_register_driver(pty_driver))
538 panic("Couldn't register pty driver");
539 if (tty_register_driver(pty_slave_driver))
540 panic("Couldn't register pty slave driver");
541 }
542 #else
543 static inline void legacy_pty_init(void) { }
544 #endif
545
546 /* Unix98 devices */
547 #ifdef CONFIG_UNIX98_PTYS
548
549 static struct cdev ptmx_cdev;
550
551 static int pty_unix98_ioctl(struct tty_struct *tty,
552 unsigned int cmd, unsigned long arg)
553 {
554 switch (cmd) {
555 case TIOCSPTLCK: /* Set PT Lock (disallow slave open) */
556 return pty_set_lock(tty, (int __user *)arg);
557 case TIOCGPTLCK: /* Get PT Lock status */
558 return pty_get_lock(tty, (int __user *)arg);
559 case TIOCPKT: /* Set PT packet mode */
560 return pty_set_pktmode(tty, (int __user *)arg);
561 case TIOCGPKT: /* Get PT packet mode */
562 return pty_get_pktmode(tty, (int __user *)arg);
563 case TIOCGPTN: /* Get PT Number */
564 return put_user(tty->index, (unsigned int __user *)arg);
565 case TIOCSIG: /* Send signal to other side of pty */
566 return pty_signal(tty, (int) arg);
567 }
568
569 return -ENOIOCTLCMD;
570 }
571
572 /**
573 * ptm_unix98_lookup - find a pty master
574 * @driver: ptm driver
575 * @idx: tty index
576 *
577 * Look up a pty master device. Called under the tty_mutex for now.
578 * This provides our locking.
579 */
580
581 static struct tty_struct *ptm_unix98_lookup(struct tty_driver *driver,
582 struct inode *ptm_inode, int idx)
583 {
584 /* Master must be open via /dev/ptmx */
585 return ERR_PTR(-EIO);
586 }
587
588 /**
589 * pts_unix98_lookup - find a pty slave
590 * @driver: pts driver
591 * @idx: tty index
592 *
593 * Look up a pty master device. Called under the tty_mutex for now.
594 * This provides our locking for the tty pointer.
595 */
596
597 static struct tty_struct *pts_unix98_lookup(struct tty_driver *driver,
598 struct inode *pts_inode, int idx)
599 {
600 struct tty_struct *tty;
601
602 mutex_lock(&devpts_mutex);
603 tty = devpts_get_priv(pts_inode);
604 mutex_unlock(&devpts_mutex);
605 /* Master must be open before slave */
606 if (!tty)
607 return ERR_PTR(-EIO);
608 return tty;
609 }
610
611 /* We have no need to install and remove our tty objects as devpts does all
612 the work for us */
613
614 static int pty_unix98_install(struct tty_driver *driver, struct tty_struct *tty)
615 {
616 return pty_common_install(driver, tty, false);
617 }
618
619 static void pty_unix98_remove(struct tty_driver *driver, struct tty_struct *tty)
620 {
621 }
622
623 /* this is called once with whichever end is closed last */
624 static void pty_unix98_shutdown(struct tty_struct *tty)
625 {
626 devpts_kill_index(tty->driver_data, tty->index);
627 }
628
629 static const struct tty_operations ptm_unix98_ops = {
630 .lookup = ptm_unix98_lookup,
631 .install = pty_unix98_install,
632 .remove = pty_unix98_remove,
633 .open = pty_open,
634 .close = pty_close,
635 .write = pty_write,
636 .write_room = pty_write_room,
637 .flush_buffer = pty_flush_buffer,
638 .chars_in_buffer = pty_chars_in_buffer,
639 .unthrottle = pty_unthrottle,
640 .set_termios = pty_set_termios,
641 .ioctl = pty_unix98_ioctl,
642 .resize = pty_resize,
643 .shutdown = pty_unix98_shutdown,
644 .cleanup = pty_cleanup
645 };
646
647 static const struct tty_operations pty_unix98_ops = {
648 .lookup = pts_unix98_lookup,
649 .install = pty_unix98_install,
650 .remove = pty_unix98_remove,
651 .open = pty_open,
652 .close = pty_close,
653 .write = pty_write,
654 .write_room = pty_write_room,
655 .flush_buffer = pty_flush_buffer,
656 .chars_in_buffer = pty_chars_in_buffer,
657 .unthrottle = pty_unthrottle,
658 .set_termios = pty_set_termios,
659 .shutdown = pty_unix98_shutdown,
660 .cleanup = pty_cleanup,
661 };
662
663 /**
664 * ptmx_open - open a unix 98 pty master
665 * @inode: inode of device file
666 * @filp: file pointer to tty
667 *
668 * Allocate a unix98 pty master device from the ptmx driver.
669 *
670 * Locking: tty_mutex protects the init_dev work. tty->count should
671 * protect the rest.
672 * allocated_ptys_lock handles the list of free pty numbers
673 */
674
675 static int ptmx_open(struct inode *inode, struct file *filp)
676 {
677 struct tty_struct *tty;
678 struct inode *slave_inode;
679 int retval;
680 int index;
681
682 nonseekable_open(inode, filp);
683
684 /* We refuse fsnotify events on ptmx, since it's a shared resource */
685 filp->f_mode |= FMODE_NONOTIFY;
686
687 retval = tty_alloc_file(filp);
688 if (retval)
689 return retval;
690
691 /* find a device that is not in use. */
692 mutex_lock(&devpts_mutex);
693 index = devpts_new_index(inode);
694 if (index < 0) {
695 retval = index;
696 mutex_unlock(&devpts_mutex);
697 goto err_file;
698 }
699
700 mutex_unlock(&devpts_mutex);
701
702 mutex_lock(&tty_mutex);
703 tty = tty_init_dev(ptm_driver, index);
704
705 if (IS_ERR(tty)) {
706 retval = PTR_ERR(tty);
707 goto out;
708 }
709
710 /* The tty returned here is locked so we can safely
711 drop the mutex */
712 mutex_unlock(&tty_mutex);
713
714 set_bit(TTY_PTY_LOCK, &tty->flags); /* LOCK THE SLAVE */
715 tty->driver_data = inode;
716
717 tty_add_file(tty, filp);
718
719 slave_inode = devpts_pty_new(inode,
720 MKDEV(UNIX98_PTY_SLAVE_MAJOR, index), index,
721 tty->link);
722 if (IS_ERR(slave_inode)) {
723 retval = PTR_ERR(slave_inode);
724 goto err_release;
725 }
726 tty->link->driver_data = slave_inode;
727
728 retval = ptm_driver->ops->open(tty, filp);
729 if (retval)
730 goto err_release;
731
732 tty_unlock(tty);
733 return 0;
734 err_release:
735 tty_unlock(tty);
736 tty_release(inode, filp);
737 return retval;
738 out:
739 mutex_unlock(&tty_mutex);
740 devpts_kill_index(inode, index);
741 err_file:
742 tty_free_file(filp);
743 return retval;
744 }
745
746 static struct file_operations ptmx_fops;
747
748 static void __init unix98_pty_init(void)
749 {
750 ptm_driver = tty_alloc_driver(NR_UNIX98_PTY_MAX,
751 TTY_DRIVER_RESET_TERMIOS |
752 TTY_DRIVER_REAL_RAW |
753 TTY_DRIVER_DYNAMIC_DEV |
754 TTY_DRIVER_DEVPTS_MEM |
755 TTY_DRIVER_DYNAMIC_ALLOC);
756 if (IS_ERR(ptm_driver))
757 panic("Couldn't allocate Unix98 ptm driver");
758 pts_driver = tty_alloc_driver(NR_UNIX98_PTY_MAX,
759 TTY_DRIVER_RESET_TERMIOS |
760 TTY_DRIVER_REAL_RAW |
761 TTY_DRIVER_DYNAMIC_DEV |
762 TTY_DRIVER_DEVPTS_MEM |
763 TTY_DRIVER_DYNAMIC_ALLOC);
764 if (IS_ERR(pts_driver))
765 panic("Couldn't allocate Unix98 pts driver");
766
767 ptm_driver->driver_name = "pty_master";
768 ptm_driver->name = "ptm";
769 ptm_driver->major = UNIX98_PTY_MASTER_MAJOR;
770 ptm_driver->minor_start = 0;
771 ptm_driver->type = TTY_DRIVER_TYPE_PTY;
772 ptm_driver->subtype = PTY_TYPE_MASTER;
773 ptm_driver->init_termios = tty_std_termios;
774 ptm_driver->init_termios.c_iflag = 0;
775 ptm_driver->init_termios.c_oflag = 0;
776 ptm_driver->init_termios.c_cflag = B38400 | CS8 | CREAD;
777 ptm_driver->init_termios.c_lflag = 0;
778 ptm_driver->init_termios.c_ispeed = 38400;
779 ptm_driver->init_termios.c_ospeed = 38400;
780 ptm_driver->other = pts_driver;
781 tty_set_operations(ptm_driver, &ptm_unix98_ops);
782
783 pts_driver->driver_name = "pty_slave";
784 pts_driver->name = "pts";
785 pts_driver->major = UNIX98_PTY_SLAVE_MAJOR;
786 pts_driver->minor_start = 0;
787 pts_driver->type = TTY_DRIVER_TYPE_PTY;
788 pts_driver->subtype = PTY_TYPE_SLAVE;
789 pts_driver->init_termios = tty_std_termios;
790 pts_driver->init_termios.c_cflag = B38400 | CS8 | CREAD;
791 pts_driver->init_termios.c_ispeed = 38400;
792 pts_driver->init_termios.c_ospeed = 38400;
793 pts_driver->other = ptm_driver;
794 tty_set_operations(pts_driver, &pty_unix98_ops);
795
796 if (tty_register_driver(ptm_driver))
797 panic("Couldn't register Unix98 ptm driver");
798 if (tty_register_driver(pts_driver))
799 panic("Couldn't register Unix98 pts driver");
800
801 /* Now create the /dev/ptmx special device */
802 tty_default_fops(&ptmx_fops);
803 ptmx_fops.open = ptmx_open;
804
805 cdev_init(&ptmx_cdev, &ptmx_fops);
806 if (cdev_add(&ptmx_cdev, MKDEV(TTYAUX_MAJOR, 2), 1) ||
807 register_chrdev_region(MKDEV(TTYAUX_MAJOR, 2), 1, "/dev/ptmx") < 0)
808 panic("Couldn't register /dev/ptmx driver");
809 device_create(tty_class, NULL, MKDEV(TTYAUX_MAJOR, 2), NULL, "ptmx");
810 }
811
812 #else
813 static inline void unix98_pty_init(void) { }
814 #endif
815
816 static int __init pty_init(void)
817 {
818 legacy_pty_init();
819 unix98_pty_init();
820 return 0;
821 }
822 module_init(pty_init);