Commit | Line | Data |
---|---|---|
cb8fa61c | 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 | 8 | #include <unistd.h> |
1da177e4 | 9 | #include <errno.h> |
cb8fa61c JD |
10 | #include <fcntl.h> |
11 | #include <string.h> | |
1da177e4 | 12 | #include <termios.h> |
75886f21 | 13 | #include <sys/stat.h> |
1da177e4 | 14 | #include "chan_user.h" |
75886f21 | 15 | #include "kern_constants.h" |
cb8fa61c | 16 | #include "os.h" |
c13e5690 | 17 | #include "um_malloc.h" |
cb8fa61c | 18 | #include "user.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 | ||
43f5b308 | 32 | data = uml_kmalloc(sizeof(*data), UM_GFP_KERNEL); |
75886f21 JD |
33 | if (data == NULL) |
34 | return NULL; | |
35 | ||
cb8fa61c | 36 | *data = ((struct pty_chan) { .announce = opts->announce, |
1da177e4 LT |
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 | 58 | if (err) |
e99525f9 | 59 | goto out_close; |
1da177e4 LT |
60 | |
61 | err = raw(fd); | |
75886f21 | 62 | if (err) |
e99525f9 | 63 | goto out_close; |
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; | |
e99525f9 JD |
74 | |
75 | out_close: | |
76 | close(fd); | |
77 | return err; | |
1da177e4 LT |
78 | } |
79 | ||
80 | static int getmaster(char *line) | |
81 | { | |
75886f21 | 82 | struct stat buf; |
1da177e4 LT |
83 | char *pty, *bank, *cp; |
84 | int master, err; | |
85 | ||
86 | pty = &line[strlen("/dev/ptyp")]; | |
87 | for (bank = "pqrs"; *bank; bank++) { | |
88 | line[strlen("/dev/pty")] = *bank; | |
89 | *pty = '0'; | |
75886f21 JD |
90 | /* Did we hit the end ? */ |
91 | if ((stat(line, &buf) < 0) && (errno == ENOENT)) | |
1da177e4 | 92 | break; |
75886f21 | 93 | |
1da177e4 LT |
94 | for (cp = "0123456789abcdef"; *cp; cp++) { |
95 | *pty = *cp; | |
75886f21 | 96 | master = open(line, O_RDWR); |
1da177e4 LT |
97 | if (master >= 0) { |
98 | char *tp = &line[strlen("/dev/")]; | |
99 | ||
100 | /* verify slave side is usable */ | |
101 | *tp = 't'; | |
75886f21 | 102 | err = access(line, R_OK | W_OK); |
1da177e4 | 103 | *tp = 'p'; |
cb8fa61c | 104 | if (!err) |
75886f21 JD |
105 | return master; |
106 | close(master); | |
1da177e4 LT |
107 | } |
108 | } | |
109 | } | |
75886f21 JD |
110 | |
111 | printk(UM_KERN_ERR "getmaster - no usable host pty devices\n"); | |
112 | return -ENOENT; | |
1da177e4 LT |
113 | } |
114 | ||
115 | static int pty_open(int input, int output, int primary, void *d, | |
116 | char **dev_out) | |
117 | { | |
118 | struct pty_chan *data = d; | |
119 | int fd, err; | |
120 | char dev[sizeof("/dev/ptyxx\0")] = "/dev/ptyxx"; | |
121 | ||
122 | fd = getmaster(dev); | |
75886f21 JD |
123 | if (fd < 0) |
124 | return fd; | |
1da177e4 | 125 | |
e99525f9 | 126 | if (data->raw) { |
1da177e4 | 127 | err = raw(fd); |
e99525f9 JD |
128 | if (err) { |
129 | close(fd); | |
75886f21 | 130 | return err; |
e99525f9 | 131 | } |
1da177e4 | 132 | } |
cb8fa61c | 133 | |
75886f21 JD |
134 | if (data->announce) |
135 | (*data->announce)(dev, data->dev); | |
1da177e4 LT |
136 | |
137 | sprintf(data->dev_name, "%s", dev); | |
138 | *dev_out = data->dev_name; | |
75886f21 JD |
139 | |
140 | return fd; | |
1da177e4 LT |
141 | } |
142 | ||
5e7672ec | 143 | const struct chan_ops pty_ops = { |
1da177e4 LT |
144 | .type = "pty", |
145 | .init = pty_chan_init, | |
146 | .open = pty_open, | |
147 | .close = generic_close, | |
148 | .read = generic_read, | |
149 | .write = generic_write, | |
fd9bc53b | 150 | .console_write = generic_console_write, |
1da177e4 LT |
151 | .window_size = generic_window_size, |
152 | .free = generic_free, | |
153 | .winch = 0, | |
154 | }; | |
155 | ||
5e7672ec | 156 | const struct chan_ops pts_ops = { |
1da177e4 LT |
157 | .type = "pts", |
158 | .init = pty_chan_init, | |
159 | .open = pts_open, | |
160 | .close = generic_close, | |
161 | .read = generic_read, | |
162 | .write = generic_write, | |
fd9bc53b | 163 | .console_write = generic_console_write, |
1da177e4 LT |
164 | .window_size = generic_window_size, |
165 | .free = generic_free, | |
166 | .winch = 0, | |
167 | }; |