Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
75886f21 | 2 | * Copyright (C) 2001 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com) |
1da177e4 LT |
3 | * Licensed under the GPL |
4 | */ | |
5 | ||
6 | #include <stdio.h> | |
24fa6c08 | 7 | #include <stdlib.h> |
1da177e4 LT |
8 | #include <unistd.h> |
9 | #include <string.h> | |
75886f21 | 10 | #include <fcntl.h> |
1da177e4 LT |
11 | #include <errno.h> |
12 | #include <termios.h> | |
75886f21 | 13 | #include <sys/stat.h> |
1da177e4 | 14 | #include "chan_user.h" |
1da177e4 | 15 | #include "os.h" |
75886f21 JD |
16 | #include "user.h" |
17 | #include "kern_constants.h" | |
c13e5690 | 18 | #include "um_malloc.h" |
1da177e4 LT |
19 | |
20 | struct pty_chan { | |
21 | void (*announce)(char *dev_name, int dev); | |
22 | int dev; | |
23 | int raw; | |
24 | struct termios tt; | |
25 | char dev_name[sizeof("/dev/pts/0123456\0")]; | |
26 | }; | |
27 | ||
5e7672ec | 28 | static void *pty_chan_init(char *str, int device, const struct chan_opts *opts) |
1da177e4 LT |
29 | { |
30 | struct pty_chan *data; | |
31 | ||
e4c4bf99 | 32 | data = kmalloc(sizeof(*data), UM_GFP_KERNEL); |
75886f21 JD |
33 | if (data == NULL) |
34 | return NULL; | |
35 | ||
1da177e4 LT |
36 | *data = ((struct pty_chan) { .announce = opts->announce, |
37 | .dev = device, | |
38 | .raw = opts->raw }); | |
75886f21 | 39 | return data; |
1da177e4 LT |
40 | } |
41 | ||
42 | static int pts_open(int input, int output, int primary, void *d, | |
43 | char **dev_out) | |
44 | { | |
45 | struct pty_chan *data = d; | |
46 | char *dev; | |
47 | int fd, err; | |
48 | ||
49 | fd = get_pty(); | |
75886f21 | 50 | if (fd < 0) { |
b4fd310e | 51 | err = -errno; |
75886f21 | 52 | printk(UM_KERN_ERR "open_pts : Failed to open pts\n"); |
b4fd310e | 53 | return err; |
1da177e4 | 54 | } |
75886f21 JD |
55 | |
56 | if (data->raw) { | |
1da177e4 | 57 | CATCH_EINTR(err = tcgetattr(fd, &data->tt)); |
75886f21 JD |
58 | if (err) |
59 | return err; | |
1da177e4 LT |
60 | |
61 | err = raw(fd); | |
75886f21 JD |
62 | if (err) |
63 | return err; | |
1da177e4 LT |
64 | } |
65 | ||
66 | dev = ptsname(fd); | |
67 | sprintf(data->dev_name, "%s", dev); | |
68 | *dev_out = data->dev_name; | |
75886f21 | 69 | |
1da177e4 LT |
70 | if (data->announce) |
71 | (*data->announce)(dev, data->dev); | |
75886f21 JD |
72 | |
73 | return fd; | |
1da177e4 LT |
74 | } |
75 | ||
76 | static int getmaster(char *line) | |
77 | { | |
75886f21 | 78 | struct stat buf; |
1da177e4 LT |
79 | char *pty, *bank, *cp; |
80 | int master, err; | |
81 | ||
82 | pty = &line[strlen("/dev/ptyp")]; | |
83 | for (bank = "pqrs"; *bank; bank++) { | |
84 | line[strlen("/dev/pty")] = *bank; | |
85 | *pty = '0'; | |
75886f21 JD |
86 | /* Did we hit the end ? */ |
87 | if ((stat(line, &buf) < 0) && (errno == ENOENT)) | |
1da177e4 | 88 | break; |
75886f21 | 89 | |
1da177e4 LT |
90 | for (cp = "0123456789abcdef"; *cp; cp++) { |
91 | *pty = *cp; | |
75886f21 | 92 | master = open(line, O_RDWR); |
1da177e4 LT |
93 | if (master >= 0) { |
94 | char *tp = &line[strlen("/dev/")]; | |
95 | ||
96 | /* verify slave side is usable */ | |
97 | *tp = 't'; | |
75886f21 | 98 | err = access(line, R_OK | W_OK); |
1da177e4 | 99 | *tp = 'p'; |
75886f21 JD |
100 | if(!err) |
101 | return master; | |
102 | close(master); | |
1da177e4 LT |
103 | } |
104 | } | |
105 | } | |
75886f21 JD |
106 | |
107 | printk(UM_KERN_ERR "getmaster - no usable host pty devices\n"); | |
108 | return -ENOENT; | |
1da177e4 LT |
109 | } |
110 | ||
111 | static int pty_open(int input, int output, int primary, void *d, | |
112 | char **dev_out) | |
113 | { | |
114 | struct pty_chan *data = d; | |
115 | int fd, err; | |
116 | char dev[sizeof("/dev/ptyxx\0")] = "/dev/ptyxx"; | |
117 | ||
118 | fd = getmaster(dev); | |
75886f21 JD |
119 | if (fd < 0) |
120 | return fd; | |
1da177e4 LT |
121 | |
122 | if(data->raw){ | |
123 | err = raw(fd); | |
75886f21 JD |
124 | if (err) |
125 | return err; | |
1da177e4 LT |
126 | } |
127 | ||
75886f21 JD |
128 | if (data->announce) |
129 | (*data->announce)(dev, data->dev); | |
1da177e4 LT |
130 | |
131 | sprintf(data->dev_name, "%s", dev); | |
132 | *dev_out = data->dev_name; | |
75886f21 JD |
133 | |
134 | return fd; | |
1da177e4 LT |
135 | } |
136 | ||
5e7672ec | 137 | const struct chan_ops pty_ops = { |
1da177e4 LT |
138 | .type = "pty", |
139 | .init = pty_chan_init, | |
140 | .open = pty_open, | |
141 | .close = generic_close, | |
142 | .read = generic_read, | |
143 | .write = generic_write, | |
fd9bc53b | 144 | .console_write = generic_console_write, |
1da177e4 LT |
145 | .window_size = generic_window_size, |
146 | .free = generic_free, | |
147 | .winch = 0, | |
148 | }; | |
149 | ||
5e7672ec | 150 | const struct chan_ops pts_ops = { |
1da177e4 LT |
151 | .type = "pts", |
152 | .init = pty_chan_init, | |
153 | .open = pts_open, | |
154 | .close = generic_close, | |
155 | .read = generic_read, | |
156 | .write = generic_write, | |
fd9bc53b | 157 | .console_write = generic_console_write, |
1da177e4 LT |
158 | .window_size = generic_window_size, |
159 | .free = generic_free, | |
160 | .winch = 0, | |
161 | }; |