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