Merge with rsync://fileserver/linux
[linux-2.6] / arch / um / drivers / port_user.c
1 /* 
2  * Copyright (C) 2001 Jeff Dike (jdike@karaya.com)
3  * Licensed under the GPL
4  */
5
6 #include <stdio.h>
7 #include <stddef.h>
8 #include <stdlib.h>
9 #include <string.h>
10 #include <errno.h>
11 #include <unistd.h>
12 #include <termios.h>
13 #include <sys/socket.h>
14 #include <sys/un.h>
15 #include <netinet/in.h>
16 #include "user_util.h"
17 #include "kern_util.h"
18 #include "user.h"
19 #include "chan_user.h"
20 #include "port.h"
21 #include "helper.h"
22 #include "os.h"
23
24 struct port_chan {
25         int raw;
26         struct termios tt;
27         void *kernel_data;
28         char dev[sizeof("32768\0")];
29 };
30
31 static void *port_init(char *str, int device, struct chan_opts *opts)
32 {
33         struct port_chan *data;
34         void *kern_data;
35         char *end;
36         int port;
37
38         if(*str != ':'){
39                 printk("port_init : channel type 'port' must specify a "
40                        "port number\n");
41                 return(NULL);
42         }
43         str++;
44         port = strtoul(str, &end, 0);
45         if((*end != '\0') || (end == str)){
46                 printk("port_init : couldn't parse port '%s'\n", str);
47                 return(NULL);
48         }
49
50         kern_data = port_data(port);
51         if(kern_data == NULL)
52                 return(NULL);
53
54         data = um_kmalloc(sizeof(*data));
55         if(data == NULL)
56                 goto err;
57
58         *data = ((struct port_chan) { .raw              = opts->raw,
59                                       .kernel_data      = kern_data });
60         sprintf(data->dev, "%d", port);
61
62         return(data);
63  err:
64         port_kern_free(kern_data);
65         return(NULL);
66 }
67
68 static void port_free(void *d)
69 {
70         struct port_chan *data = d;
71
72         port_kern_free(data->kernel_data);
73         kfree(data);
74 }
75
76 static int port_open(int input, int output, int primary, void *d,
77                      char **dev_out)
78 {
79         struct port_chan *data = d;
80         int fd, err;
81
82         fd = port_wait(data->kernel_data);
83         if((fd >= 0) && data->raw){
84                 CATCH_EINTR(err = tcgetattr(fd, &data->tt));
85                 if(err)
86                         return(err);
87
88                 err = raw(fd);
89                 if(err)
90                         return(err);
91         }
92         *dev_out = data->dev;
93         return(fd);
94 }
95
96 static void port_close(int fd, void *d)
97 {
98         struct port_chan *data = d;
99
100         port_remove_dev(data->kernel_data);
101         os_close_file(fd);
102 }
103
104 static int port_console_write(int fd, const char *buf, int n, void *d)
105 {
106         struct port_chan *data = d;
107
108         return(generic_console_write(fd, buf, n, &data->tt));
109 }
110
111 struct chan_ops port_ops = {
112         .type           = "port",
113         .init           = port_init,
114         .open           = port_open,
115         .close          = port_close,
116         .read           = generic_read,
117         .write          = generic_write,
118         .console_write  = port_console_write,
119         .window_size    = generic_window_size,
120         .free           = port_free,
121         .winch          = 1,
122 };
123
124 int port_listen_fd(int port)
125 {
126         struct sockaddr_in addr;
127         int fd, err, arg;
128
129         fd = socket(PF_INET, SOCK_STREAM, 0);
130         if(fd == -1) 
131                 return(-errno);
132
133         arg = 1;
134         if(setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, &arg, sizeof(arg)) < 0){
135                 err = -errno;
136                 goto out;
137         }
138
139         addr.sin_family = AF_INET;
140         addr.sin_port = htons(port);
141         addr.sin_addr.s_addr = htonl(INADDR_ANY);
142         if(bind(fd, (struct sockaddr *) &addr, sizeof(addr)) < 0){
143                 err = -errno;
144                 goto out;
145         }
146   
147         if(listen(fd, 1) < 0){
148                 err = -errno;
149                 goto out;
150         }
151
152         err = os_set_fd_block(fd, 0);
153         if(err < 0)
154                 goto out;
155
156         return(fd);
157  out:
158         os_close_file(fd);
159         return(err);
160 }
161
162 struct port_pre_exec_data {
163         int sock_fd;
164         int pipe_fd;
165 };
166
167 void port_pre_exec(void *arg)
168 {
169         struct port_pre_exec_data *data = arg;
170
171         dup2(data->sock_fd, 0);
172         dup2(data->sock_fd, 1);
173         dup2(data->sock_fd, 2);
174         os_close_file(data->sock_fd);
175         dup2(data->pipe_fd, 3);
176         os_shutdown_socket(3, 1, 0);
177         os_close_file(data->pipe_fd);
178 }
179
180 int port_connection(int fd, int *socket, int *pid_out)
181 {
182         int new, err;
183         char *argv[] = { "/usr/sbin/in.telnetd", "-L", 
184                          "/usr/lib/uml/port-helper", NULL };
185         struct port_pre_exec_data data;
186
187         new = os_accept_connection(fd);
188         if(new < 0)
189                 return(new);
190
191         err = os_pipe(socket, 0, 0);
192         if(err < 0)
193                 goto out_close;
194
195         data = ((struct port_pre_exec_data)
196                 { .sock_fd              = new,
197                   .pipe_fd              = socket[1] });
198
199         err = run_helper(port_pre_exec, &data, argv, NULL);
200         if(err < 0) 
201                 goto out_shutdown;
202
203         *pid_out = err;
204         return(new);
205
206  out_shutdown:
207         os_shutdown_socket(socket[0], 1, 1);
208         os_close_file(socket[0]);
209         os_shutdown_socket(socket[1], 1, 1);    
210         os_close_file(socket[1]);
211  out_close:
212         os_close_file(new);
213         return(err);
214 }
215
216 /*
217  * Overrides for Emacs so that we follow Linus's tabbing style.
218  * Emacs will notice this stuff at the end of the file and automatically
219  * adjust the settings for this buffer only.  This must remain at the end
220  * of the file.
221  * ---------------------------------------------------------------------------
222  * Local variables:
223  * c-file-style: "linux"
224  * End:
225  */