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         n = os_write_file(fd, &change, sizeof(change));
  52         if(n != sizeof(change)){
  53                 printk("etap_change - request failed, err = %d\n", -n);
  54                 return;
  55         }
  56
  57         output = um_kmalloc(UM_KERN_PAGE_SIZE);
  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         os_close_file(data->data_me);
  91         os_close_file(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, NULL);
 121
 122         if(pid < 0)
 123                 err = pid;
 124         os_close_file(data_remote);
 125         os_close_file(control_remote);
 126         n = os_read_file(control_me, &c, sizeof(c));
 127         if(n != sizeof(c)){
 128                 printk("etap_tramp : read of status failed, err = %d\n", -n);
 129                 return -EINVAL;
 130         }
 131         if(c != 1){
 132                 printk("etap_tramp : uml_net failed\n");
 133                 err = -EINVAL;
 134                 CATCH_EINTR(n = waitpid(pid, &status, 0));
 135                 if(n < 0)
 136                         err = -errno;
 137                 else if(!WIFEXITED(status) || (WEXITSTATUS(status) != 1))
 138                         printk("uml_net didn't exit with status 1\n");
 139         }
 140         return err;
 141 }
 142
 143 static int etap_open(void *data)
 144 {
 145         struct ethertap_data *pri = data;
 146         char *output;
 147         int data_fds[2], control_fds[2], err, output_len;
 148
 149         err = tap_open_common(pri->dev, pri->gate_addr);
 150         if(err)
 151                 return err;
 152
 153         err = os_pipe(data_fds, 0, 0);
 154         if(err < 0){
 155                 printk("data os_pipe failed - err = %d\n", -err);
 156                 return err;
 157         }
 158
 159         err = os_pipe(control_fds, 1, 0);
 160         if(err < 0){
 161                 printk("control os_pipe failed - err = %d\n", -err);
 162                 return err;
 163         }
 164
 165         err = etap_tramp(pri->dev_name, pri->gate_addr, control_fds[0],
 166                          control_fds[1], data_fds[0], data_fds[1]);
 167         output_len = UM_KERN_PAGE_SIZE;
 168         output = um_kmalloc(output_len);
 169         read_output(control_fds[0], output, output_len);
 170
 171         if(output == NULL)
 172                 printk("etap_open : failed to allocate output buffer\n");
 173         else {
 174                 printk("%s", output);
 175                 kfree(output);
 176         }
 177
 178         if(err < 0){
 179                 printk("etap_tramp failed - err = %d\n", -err);
 180                 return err;
 181         }
 182
 183         pri->data_fd = data_fds[0];
 184         pri->control_fd = control_fds[0];
 185         iter_addresses(pri->dev, etap_open_addr, &pri->control_fd);
 186         return data_fds[0];
 187 }
 188
 189 static void etap_close(int fd, void *data)
 190 {
 191         struct ethertap_data *pri = data;
 192
 193         iter_addresses(pri->dev, etap_close_addr, &pri->control_fd);
 194         os_close_file(fd);
 195         os_shutdown_socket(pri->data_fd, 1, 1);
 196         os_close_file(pri->data_fd);
 197         pri->data_fd = -1;
 198         os_close_file(pri->control_fd);
 199         pri->control_fd = -1;
 200 }
 201
 202 static int etap_set_mtu(int mtu, void *data)
 203 {
 204         return mtu;
 205 }
 206
 207 static void etap_add_addr(unsigned char *addr, unsigned char *netmask,
 208                           void *data)
 209 {
 210         struct ethertap_data *pri = data;
 211
 212         tap_check_ips(pri->gate_addr, addr);
 213         if(pri->control_fd == -1)
 214                 return;
 215         etap_open_addr(addr, netmask, &pri->control_fd);
 216 }
 217
 218 static void etap_del_addr(unsigned char *addr, unsigned char *netmask,
 219                           void *data)
 220 {
 221         struct ethertap_data *pri = data;
 222
 223         if(pri->control_fd == -1)
 224                 return;
 225         etap_close_addr(addr, netmask, &pri->control_fd);
 226 }
 227
 228 const struct net_user_info ethertap_user_info = {
 229         .init           = etap_user_init,
 230         .open           = etap_open,
 231         .close          = etap_close,
 232         .remove         = NULL,
 233         .set_mtu        = etap_set_mtu,
 234         .add_address    = etap_add_addr,
 235         .delete_address = etap_del_addr,
 236         .max_packet     = MAX_PACKET - ETH_HEADER_ETHERTAP
 237 };