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