arch/um/os-Linux/drivers/ethertap_user.c

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