Commit | Line | Data |
---|---|---|
67608e0c | 1 | /* |
e99525f9 | 2 | * Copyright (C) 2001 - 2007 Jeff Dike (jdike@{linux.intel,addtoit}.com) |
1da177e4 LT |
3 | * Licensed under the GPL |
4 | */ | |
5 | ||
6 | #include <stdio.h> | |
1da177e4 | 7 | #include <stdlib.h> |
1da177e4 | 8 | #include <errno.h> |
1da177e4 | 9 | #include <termios.h> |
e99525f9 | 10 | #include <unistd.h> |
1da177e4 | 11 | #include <netinet/in.h> |
1da177e4 | 12 | #include "chan_user.h" |
37185b33 | 13 | #include <os.h> |
e99525f9 | 14 | #include "port.h" |
37185b33 | 15 | #include <um_malloc.h> |
1da177e4 LT |
16 | |
17 | struct port_chan { | |
18 | int raw; | |
19 | struct termios tt; | |
20 | void *kernel_data; | |
21 | char dev[sizeof("32768\0")]; | |
22 | }; | |
23 | ||
5e7672ec | 24 | static void *port_init(char *str, int device, const struct chan_opts *opts) |
1da177e4 LT |
25 | { |
26 | struct port_chan *data; | |
27 | void *kern_data; | |
28 | char *end; | |
29 | int port; | |
30 | ||
e99525f9 JD |
31 | if (*str != ':') { |
32 | printk(UM_KERN_ERR "port_init : channel type 'port' must " | |
33 | "specify a port number\n"); | |
67608e0c | 34 | return NULL; |
1da177e4 LT |
35 | } |
36 | str++; | |
37 | port = strtoul(str, &end, 0); | |
e99525f9 JD |
38 | if ((*end != '\0') || (end == str)) { |
39 | printk(UM_KERN_ERR "port_init : couldn't parse port '%s'\n", | |
40 | str); | |
67608e0c | 41 | return NULL; |
1da177e4 LT |
42 | } |
43 | ||
44 | kern_data = port_data(port); | |
e99525f9 | 45 | if (kern_data == NULL) |
67608e0c | 46 | return NULL; |
1da177e4 | 47 | |
43f5b308 | 48 | data = uml_kmalloc(sizeof(*data), UM_GFP_KERNEL); |
e99525f9 | 49 | if (data == NULL) |
1da177e4 LT |
50 | goto err; |
51 | ||
52 | *data = ((struct port_chan) { .raw = opts->raw, | |
53 | .kernel_data = kern_data }); | |
54 | sprintf(data->dev, "%d", port); | |
55 | ||
67608e0c | 56 | return data; |
1da177e4 LT |
57 | err: |
58 | port_kern_free(kern_data); | |
67608e0c | 59 | return NULL; |
1da177e4 LT |
60 | } |
61 | ||
62 | static void port_free(void *d) | |
63 | { | |
64 | struct port_chan *data = d; | |
65 | ||
66 | port_kern_free(data->kernel_data); | |
67 | kfree(data); | |
68 | } | |
69 | ||
70 | static int port_open(int input, int output, int primary, void *d, | |
71 | char **dev_out) | |
72 | { | |
73 | struct port_chan *data = d; | |
74 | int fd, err; | |
75 | ||
76 | fd = port_wait(data->kernel_data); | |
e99525f9 | 77 | if ((fd >= 0) && data->raw) { |
1da177e4 | 78 | CATCH_EINTR(err = tcgetattr(fd, &data->tt)); |
e99525f9 | 79 | if (err) |
67608e0c | 80 | return err; |
1da177e4 LT |
81 | |
82 | err = raw(fd); | |
e99525f9 | 83 | if (err) |
67608e0c | 84 | return err; |
1da177e4 LT |
85 | } |
86 | *dev_out = data->dev; | |
67608e0c | 87 | return fd; |
1da177e4 LT |
88 | } |
89 | ||
90 | static void port_close(int fd, void *d) | |
91 | { | |
92 | struct port_chan *data = d; | |
93 | ||
94 | port_remove_dev(data->kernel_data); | |
95 | os_close_file(fd); | |
96 | } | |
97 | ||
5e7672ec | 98 | const struct chan_ops port_ops = { |
1da177e4 LT |
99 | .type = "port", |
100 | .init = port_init, | |
101 | .open = port_open, | |
102 | .close = port_close, | |
103 | .read = generic_read, | |
104 | .write = generic_write, | |
fd9bc53b | 105 | .console_write = generic_console_write, |
1da177e4 LT |
106 | .window_size = generic_window_size, |
107 | .free = port_free, | |
108 | .winch = 1, | |
109 | }; | |
110 | ||
111 | int port_listen_fd(int port) | |
112 | { | |
113 | struct sockaddr_in addr; | |
114 | int fd, err, arg; | |
115 | ||
116 | fd = socket(PF_INET, SOCK_STREAM, 0); | |
e99525f9 | 117 | if (fd == -1) |
67608e0c | 118 | return -errno; |
1da177e4 LT |
119 | |
120 | arg = 1; | |
e99525f9 | 121 | if (setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, &arg, sizeof(arg)) < 0) { |
1da177e4 LT |
122 | err = -errno; |
123 | goto out; | |
124 | } | |
125 | ||
126 | addr.sin_family = AF_INET; | |
127 | addr.sin_port = htons(port); | |
128 | addr.sin_addr.s_addr = htonl(INADDR_ANY); | |
e99525f9 | 129 | if (bind(fd, (struct sockaddr *) &addr, sizeof(addr)) < 0) { |
1da177e4 LT |
130 | err = -errno; |
131 | goto out; | |
132 | } | |
67608e0c | 133 | |
e99525f9 | 134 | if (listen(fd, 1) < 0) { |
1da177e4 LT |
135 | err = -errno; |
136 | goto out; | |
137 | } | |
138 | ||
139 | err = os_set_fd_block(fd, 0); | |
e99525f9 | 140 | if (err < 0) |
1da177e4 LT |
141 | goto out; |
142 | ||
67608e0c | 143 | return fd; |
1da177e4 | 144 | out: |
e99525f9 | 145 | close(fd); |
67608e0c | 146 | return err; |
1da177e4 LT |
147 | } |
148 | ||
149 | struct port_pre_exec_data { | |
150 | int sock_fd; | |
151 | int pipe_fd; | |
152 | }; | |
153 | ||
1605ec04 | 154 | static void port_pre_exec(void *arg) |
1da177e4 LT |
155 | { |
156 | struct port_pre_exec_data *data = arg; | |
157 | ||
158 | dup2(data->sock_fd, 0); | |
159 | dup2(data->sock_fd, 1); | |
160 | dup2(data->sock_fd, 2); | |
e99525f9 | 161 | close(data->sock_fd); |
1da177e4 | 162 | dup2(data->pipe_fd, 3); |
e99525f9 JD |
163 | shutdown(3, SHUT_RD); |
164 | close(data->pipe_fd); | |
1da177e4 LT |
165 | } |
166 | ||
167 | int port_connection(int fd, int *socket, int *pid_out) | |
168 | { | |
169 | int new, err; | |
67608e0c | 170 | char *argv[] = { "/usr/sbin/in.telnetd", "-L", |
1da177e4 LT |
171 | "/usr/lib/uml/port-helper", NULL }; |
172 | struct port_pre_exec_data data; | |
173 | ||
e99525f9 JD |
174 | new = accept(fd, NULL, 0); |
175 | if (new < 0) | |
176 | return -errno; | |
1da177e4 LT |
177 | |
178 | err = os_pipe(socket, 0, 0); | |
e99525f9 | 179 | if (err < 0) |
1da177e4 LT |
180 | goto out_close; |
181 | ||
182 | data = ((struct port_pre_exec_data) | |
183 | { .sock_fd = new, | |
184 | .pipe_fd = socket[1] }); | |
185 | ||
c4399016 | 186 | err = run_helper(port_pre_exec, &data, argv); |
e99525f9 | 187 | if (err < 0) |
1da177e4 LT |
188 | goto out_shutdown; |
189 | ||
190 | *pid_out = err; | |
67608e0c | 191 | return new; |
1da177e4 LT |
192 | |
193 | out_shutdown: | |
e99525f9 JD |
194 | shutdown(socket[0], SHUT_RDWR); |
195 | close(socket[0]); | |
196 | shutdown(socket[1], SHUT_RDWR); | |
197 | close(socket[1]); | |
1da177e4 | 198 | out_close: |
e99525f9 | 199 | close(new); |
67608e0c | 200 | return err; |
1da177e4 | 201 | } |