uml: network interface hotplug error handling
[pandora-kernel.git] / arch / um / os-Linux / drivers / ethertap_user.c
1 /*
2  * Copyright (C) 2001 Lennert Buytenhek (buytenh@gnu.org) and 
3  * James Leu (jleu@mindspring.net).
4  * Copyright (C) 2001 by various other people who didn't put their name here.
5  * Licensed under the GPL.
6  */
7
8 #include <stdio.h>
9 #include <unistd.h>
10 #include <stddef.h>
11 #include <stdlib.h>
12 #include <sys/errno.h>
13 #include <sys/socket.h>
14 #include <sys/wait.h>
15 #include <sys/un.h>
16 #include <net/if.h>
17 #include "user.h"
18 #include "kern_util.h"
19 #include "user_util.h"
20 #include "net_user.h"
21 #include "etap.h"
22 #include "os.h"
23 #include "um_malloc.h"
24
25 #define MAX_PACKET ETH_MAX_PACKET
26
27 static int etap_user_init(void *data, void *dev)
28 {
29         struct ethertap_data *pri = data;
30
31         pri->dev = dev;
32         return 0;
33 }
34
35 struct addr_change {
36         enum { ADD_ADDR, DEL_ADDR } what;
37         unsigned char addr[4];
38         unsigned char netmask[4];
39 };
40
41 static void etap_change(int op, unsigned char *addr, unsigned char *netmask,
42                         int fd)
43 {
44         struct addr_change change;
45         char *output;
46         int n;
47
48         change.what = op;
49         memcpy(change.addr, addr, sizeof(change.addr));
50         memcpy(change.netmask, netmask, sizeof(change.netmask));
51         n = os_write_file(fd, &change, sizeof(change));
52         if(n != sizeof(change))
53                 printk("etap_change - request failed, err = %d\n", -n);
54         output = um_kmalloc(page_size());
55         if(output == NULL)
56                 printk("etap_change : Failed to allocate output buffer\n");
57         read_output(fd, output, page_size());
58         if(output != NULL){
59                 printk("%s", output);
60                 kfree(output);
61         }
62 }
63
64 static void etap_open_addr(unsigned char *addr, unsigned char *netmask,
65                            void *arg)
66 {
67         etap_change(ADD_ADDR, addr, netmask, *((int *) arg));
68 }
69
70 static void etap_close_addr(unsigned char *addr, unsigned char *netmask,
71                             void *arg)
72 {
73         etap_change(DEL_ADDR, addr, netmask, *((int *) arg));
74 }
75
76 struct etap_pre_exec_data {
77         int control_remote;
78         int control_me;
79         int data_me;
80 };
81
82 static void etap_pre_exec(void *arg)
83 {
84         struct etap_pre_exec_data *data = arg;
85
86         dup2(data->control_remote, 1);
87         os_close_file(data->data_me);
88         os_close_file(data->control_me);
89 }
90
91 static int etap_tramp(char *dev, char *gate, int control_me, 
92                       int control_remote, int data_me, int data_remote)
93 {
94         struct etap_pre_exec_data pe_data;
95         int pid, status, err, n;
96         char version_buf[sizeof("nnnnn\0")];
97         char data_fd_buf[sizeof("nnnnnn\0")];
98         char gate_buf[sizeof("nnn.nnn.nnn.nnn\0")];
99         char *setup_args[] = { "uml_net", version_buf, "ethertap", dev,
100                                data_fd_buf, gate_buf, NULL };
101         char *nosetup_args[] = { "uml_net", version_buf, "ethertap", 
102                                  dev, data_fd_buf, NULL };
103         char **args, c;
104
105         sprintf(data_fd_buf, "%d", data_remote);
106         sprintf(version_buf, "%d", UML_NET_VERSION);
107         if(gate != NULL){
108                 strcpy(gate_buf, gate);
109                 args = setup_args;
110         }
111         else args = nosetup_args;
112
113         err = 0;
114         pe_data.control_remote = control_remote;
115         pe_data.control_me = control_me;
116         pe_data.data_me = data_me;
117         pid = run_helper(etap_pre_exec, &pe_data, args, NULL);
118
119         if(pid < 0) err = pid;
120         os_close_file(data_remote);
121         os_close_file(control_remote);
122         n = os_read_file(control_me, &c, sizeof(c));
123         if(n != sizeof(c)){
124                 printk("etap_tramp : read of status failed, err = %d\n", -n);
125                 return -EINVAL;
126         }
127         if(c != 1){
128                 printk("etap_tramp : uml_net failed\n");
129                 err = -EINVAL;
130                 CATCH_EINTR(n = waitpid(pid, &status, 0));
131                 if(n < 0)
132                         err = -errno;
133                 else if(!WIFEXITED(status) || (WEXITSTATUS(status) != 1))
134                         printk("uml_net didn't exit with status 1\n");
135         }
136         return err;
137 }
138
139 static int etap_open(void *data)
140 {
141         struct ethertap_data *pri = data;
142         char *output;
143         int data_fds[2], control_fds[2], err, output_len;
144
145         err = tap_open_common(pri->dev, pri->gate_addr);
146         if(err)
147                 return err;
148
149         err = os_pipe(data_fds, 0, 0);
150         if(err < 0){
151                 printk("data os_pipe failed - err = %d\n", -err);
152                 return err;
153         }
154
155         err = os_pipe(control_fds, 1, 0);
156         if(err < 0){
157                 printk("control os_pipe failed - err = %d\n", -err);
158                 return err;
159         }
160
161         err = etap_tramp(pri->dev_name, pri->gate_addr, control_fds[0], 
162                          control_fds[1], data_fds[0], data_fds[1]);
163         output_len = page_size();
164         output = um_kmalloc(output_len);
165         read_output(control_fds[0], output, output_len);
166
167         if(output == NULL)
168                 printk("etap_open : failed to allocate output buffer\n");
169         else {
170                 printk("%s", output);
171                 kfree(output);
172         }
173
174         if(err < 0){
175                 printk("etap_tramp failed - err = %d\n", -err);
176                 return err;
177         }
178
179         pri->data_fd = data_fds[0];
180         pri->control_fd = control_fds[0];
181         iter_addresses(pri->dev, etap_open_addr, &pri->control_fd);
182         return data_fds[0];
183 }
184
185 static void etap_close(int fd, void *data)
186 {
187         struct ethertap_data *pri = data;
188
189         iter_addresses(pri->dev, etap_close_addr, &pri->control_fd);
190         os_close_file(fd);
191         os_shutdown_socket(pri->data_fd, 1, 1);
192         os_close_file(pri->data_fd);
193         pri->data_fd = -1;
194         os_close_file(pri->control_fd);
195         pri->control_fd = -1;
196 }
197
198 static int etap_set_mtu(int mtu, void *data)
199 {
200         return mtu;
201 }
202
203 static void etap_add_addr(unsigned char *addr, unsigned char *netmask,
204                           void *data)
205 {
206         struct ethertap_data *pri = data;
207
208         tap_check_ips(pri->gate_addr, addr);
209         if(pri->control_fd == -1)
210                 return;
211         etap_open_addr(addr, netmask, &pri->control_fd);
212 }
213
214 static void etap_del_addr(unsigned char *addr, unsigned char *netmask, 
215                           void *data)
216 {
217         struct ethertap_data *pri = data;
218
219         if(pri->control_fd == -1)
220                 return;
221         etap_close_addr(addr, netmask, &pri->control_fd);
222 }
223
224 const struct net_user_info ethertap_user_info = {
225         .init           = etap_user_init,
226         .open           = etap_open,
227         .close          = etap_close,
228         .remove         = NULL,
229         .set_mtu        = etap_set_mtu,
230         .add_address    = etap_add_addr,
231         .delete_address = etap_del_addr,
232         .max_packet     = MAX_PACKET - ETH_HEADER_ETHERTAP
233 };