SAFE public projects git trees. - safe/jmp/linux-2.6/blob - 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 "net_user.h"
  20 #include "etap.h"
  21 #include "os.h"
  22 #include "um_malloc.h"
  23 #include "kern_constants.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         CATCH_EINTR(n = write(fd, &change, sizeof(change)));
  52         if(n != sizeof(change)){
  53                 printk("etap_change - request failed, err = %d\n", errno);
  54                 return;
  55         }
  56
  57         output = kmalloc(UM_KERN_PAGE_SIZE, UM_GFP_KERNEL);
  58         if(output == NULL)
  59                 printk("etap_change : Failed to allocate output buffer\n");
  60         read_output(fd, output, UM_KERN_PAGE_SIZE);
  61         if(output != NULL){
  62                 printk("%s", output);
  63                 kfree(output);
  64         }
  65 }
  66
  67 static void etap_open_addr(unsigned char *addr, unsigned char *netmask,
  68                            void *arg)
  69 {
  70         etap_change(ADD_ADDR, addr, netmask, *((int *) arg));
  71 }
  72
  73 static void etap_close_addr(unsigned char *addr, unsigned char *netmask,
  74                             void *arg)
  75 {
  76         etap_change(DEL_ADDR, addr, netmask, *((int *) arg));
  77 }
  78
  79 struct etap_pre_exec_data {
  80         int control_remote;
  81         int control_me;
  82         int data_me;
  83 };
  84
  85 static void etap_pre_exec(void *arg)
  86 {
  87         struct etap_pre_exec_data *data = arg;
  88
  89         dup2(data->control_remote, 1);
  90         close(data->data_me);
  91         close(data->control_me);
  92 }
  93
  94 static int etap_tramp(char *dev, char *gate, int control_me,
  95                       int control_remote, int data_me, int data_remote)
  96 {
  97         struct etap_pre_exec_data pe_data;
  98         int pid, status, err, n;
  99         char version_buf[sizeof("nnnnn\0")];
 100         char data_fd_buf[sizeof("nnnnnn\0")];
 101         char gate_buf[sizeof("nnn.nnn.nnn.nnn\0")];
 102         char *setup_args[] = { "uml_net", version_buf, "ethertap", dev,
 103                                data_fd_buf, gate_buf, NULL };
 104         char *nosetup_args[] = { "uml_net", version_buf, "ethertap",
 105                                  dev, data_fd_buf, NULL };
 106         char **args, c;
 107
 108         sprintf(data_fd_buf, "%d", data_remote);
 109         sprintf(version_buf, "%d", UML_NET_VERSION);
 110         if(gate != NULL){
 111                 strcpy(gate_buf, gate);
 112                 args = setup_args;
 113         }
 114         else args = nosetup_args;
 115
 116         err = 0;
 117         pe_data.control_remote = control_remote;
 118         pe_data.control_me = control_me;
 119         pe_data.data_me = data_me;
 120         pid = run_helper(etap_pre_exec, &pe_data, args);
 121
 122         if(pid < 0)
 123                 err = pid;
 124         close(data_remote);
 125         close(control_remote);
 126         CATCH_EINTR(n = read(control_me, &c, sizeof(c)));
 127         if(n != sizeof(c)){
 128                 err = -errno;
 129                 printk("etap_tramp : read of status failed, err = %d\n", -err);
 130                 return err;
 131         }
 132         if(c != 1){
 133                 printk("etap_tramp : uml_net failed\n");
 134                 err = -EINVAL;
 135                 CATCH_EINTR(n = waitpid(pid, &status, 0));
 136                 if(n < 0)
 137                         err = -errno;
 138                 else if(!WIFEXITED(status) || (WEXITSTATUS(status) != 1))
 139                         printk("uml_net didn't exit with status 1\n");
 140         }
 141         return err;
 142 }
 143
 144 static int etap_open(void *data)
 145 {
 146         struct ethertap_data *pri = data;
 147         char *output;
 148         int data_fds[2], control_fds[2], err, output_len;
 149
 150         err = tap_open_common(pri->dev, pri->gate_addr);
 151         if(err)
 152                 return err;
 153
 154         err = socketpair(AF_UNIX, SOCK_DGRAM, 0, data_fds);
 155         if(err){
 156                 err = -errno;
 157                 printk("etap_open - data socketpair failed - err = %d\n",
 158                        errno);
 159                 return err;
 160         }
 161
 162         err = socketpair(AF_UNIX, SOCK_STREAM, 0, control_fds);
 163         if(err){
 164                 err = -errno;
 165                 printk("etap_open - control socketpair failed - err = %d\n",
 166                        errno);
 167                 goto out_close_data;
 168         }
 169
 170         err = etap_tramp(pri->dev_name, pri->gate_addr, control_fds[0],
 171                          control_fds[1], data_fds[0], data_fds[1]);
 172         output_len = UM_KERN_PAGE_SIZE;
 173         output = kmalloc(output_len, UM_GFP_KERNEL);
 174         read_output(control_fds[0], output, output_len);
 175
 176         if(output == NULL)
 177                 printk("etap_open : failed to allocate output buffer\n");
 178         else {
 179                 printk("%s", output);
 180                 kfree(output);
 181         }
 182
 183         if(err < 0){
 184                 printk("etap_tramp failed - err = %d\n", -err);
 185                 goto out_close_control;
 186         }
 187
 188         pri->data_fd = data_fds[0];
 189         pri->control_fd = control_fds[0];
 190         iter_addresses(pri->dev, etap_open_addr, &pri->control_fd);
 191         return data_fds[0];
 192
 193 out_close_control:
 194         close(control_fds[0]);
 195         close(control_fds[1]);
 196 out_close_data:
 197         close(data_fds[0]);
 198         close(data_fds[1]);
 199         return err;
 200 }
 201
 202 static void etap_close(int fd, void *data)
 203 {
 204         struct ethertap_data *pri = data;
 205
 206         iter_addresses(pri->dev, etap_close_addr, &pri->control_fd);
 207         close(fd);
 208
 209         if(shutdown(pri->data_fd, SHUT_RDWR) < 0)
 210                 printk("etap_close - shutdown data socket failed, errno = %d\n",
 211                        errno);
 212
 213         if(shutdown(pri->control_fd, SHUT_RDWR) < 0)
 214                 printk("etap_close - shutdown control socket failed, "
 215                        "errno = %d\n", errno);
 216
 217         close(pri->data_fd);
 218         pri->data_fd = -1;
 219         close(pri->control_fd);
 220         pri->control_fd = -1;
 221 }
 222
 223 static int etap_set_mtu(int mtu, void *data)
 224 {
 225         return mtu;
 226 }
 227
 228 static void etap_add_addr(unsigned char *addr, unsigned char *netmask,
 229                           void *data)
 230 {
 231         struct ethertap_data *pri = data;
 232
 233         tap_check_ips(pri->gate_addr, addr);
 234         if(pri->control_fd == -1)
 235                 return;
 236         etap_open_addr(addr, netmask, &pri->control_fd);
 237 }
 238
 239 static void etap_del_addr(unsigned char *addr, unsigned char *netmask,
 240                           void *data)
 241 {
 242         struct ethertap_data *pri = data;
 243
 244         if(pri->control_fd == -1)
 245                 return;
 246
 247         etap_close_addr(addr, netmask, &pri->control_fd);
 248 }
 249
 250 const struct net_user_info ethertap_user_info = {
 251         .init           = etap_user_init,
 252         .open           = etap_open,
 253         .close          = etap_close,
 254         .remove         = NULL,
 255         .set_mtu        = etap_set_mtu,
 256         .add_address    = etap_add_addr,
 257         .delete_address = etap_del_addr,
 258         .max_packet     = MAX_PACKET - ETH_HEADER_ETHERTAP
 259 };