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