arch/um/drivers/daemon_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 <stdint.h>
  10 #include <unistd.h>
  11 #include <errno.h>
  12 #include <sys/types.h>
  13 #include <sys/socket.h>
  14 #include <sys/time.h>
  15 #include <sys/un.h>
  16 #include "daemon.h"
  17 #include "net_user.h"
  18 #include "os.h"
  19 #include "um_malloc.h"
  20 #include "user.h"
  21
  22 enum request_type { REQ_NEW_CONTROL };
  23
  24 #define SWITCH_MAGIC 0xfeedface
  25
  26 struct request_v3 {
  27         uint32_t magic;
  28         uint32_t version;
  29         enum request_type type;
  30         struct sockaddr_un sock;
  31 };
  32
  33 static struct sockaddr_un *new_addr(void *name, int len)
  34 {
  35         struct sockaddr_un *sun;
  36
  37         sun = kmalloc(sizeof(struct sockaddr_un), UM_GFP_KERNEL);
  38         if (sun == NULL) {
  39                 printk(UM_KERN_ERR "new_addr: allocation of sockaddr_un "
  40                        "failed\n");
  41                 return NULL;
  42         }
  43         sun->sun_family = AF_UNIX;
  44         memcpy(sun->sun_path, name, len);
  45         return sun;
  46 }
  47
  48 static int connect_to_switch(struct daemon_data *pri)
  49 {
  50         struct sockaddr_un *ctl_addr = pri->ctl_addr;
  51         struct sockaddr_un *local_addr = pri->local_addr;
  52         struct sockaddr_un *sun;
  53         struct request_v3 req;
  54         int fd, n, err;
  55
  56         pri->control = socket(AF_UNIX, SOCK_STREAM, 0);
  57         if (pri->control < 0) {
  58                 err = -errno;
  59                 printk(UM_KERN_ERR "daemon_open : control socket failed, "
  60                        "errno = %d\n", -err);
  61                 return err;
  62         }
  63
  64         if (connect(pri->control, (struct sockaddr *) ctl_addr,
  65                    sizeof(*ctl_addr)) < 0) {
  66                 err = -errno;
  67                 printk(UM_KERN_ERR "daemon_open : control connect failed, "
  68                        "errno = %d\n", -err);
  69                 goto out;
  70         }
  71
  72         fd = socket(AF_UNIX, SOCK_DGRAM, 0);
  73         if (fd < 0) {
  74                 err = -errno;
  75                 printk(UM_KERN_ERR "daemon_open : data socket failed, "
  76                        "errno = %d\n", -err);
  77                 goto out;
  78         }
  79         if (bind(fd, (struct sockaddr *) local_addr, sizeof(*local_addr)) < 0) {
  80                 err = -errno;
  81                 printk(UM_KERN_ERR "daemon_open : data bind failed, "
  82                        "errno = %d\n", -err);
  83                 goto out_close;
  84         }
  85
  86         sun = kmalloc(sizeof(struct sockaddr_un), UM_GFP_KERNEL);
  87         if (sun == NULL) {
  88                 printk(UM_KERN_ERR "new_addr: allocation of sockaddr_un "
  89                        "failed\n");
  90                 err = -ENOMEM;
  91                 goto out_close;
  92         }
  93
  94         req.magic = SWITCH_MAGIC;
  95         req.version = SWITCH_VERSION;
  96         req.type = REQ_NEW_CONTROL;
  97         req.sock = *local_addr;
  98         n = write(pri->control, &req, sizeof(req));
  99         if (n != sizeof(req)) {
 100                 printk(UM_KERN_ERR "daemon_open : control setup request "
 101                        "failed, err = %d\n", -errno);
 102                 err = -ENOTCONN;
 103                 goto out_free;
 104         }
 105
 106         n = read(pri->control, sun, sizeof(*sun));
 107         if (n != sizeof(*sun)) {
 108                 printk(UM_KERN_ERR "daemon_open : read of data socket failed, "
 109                        "err = %d\n", -errno);
 110                 err = -ENOTCONN;
 111                 goto out_free;
 112         }
 113
 114         pri->data_addr = sun;
 115         return fd;
 116
 117  out_free:
 118         kfree(sun);
 119  out_close:
 120         close(fd);
 121  out:
 122         close(pri->control);
 123         return err;
 124 }
 125
 126 static int daemon_user_init(void *data, void *dev)
 127 {
 128         struct daemon_data *pri = data;
 129         struct timeval tv;
 130         struct {
 131                 char zero;
 132                 int pid;
 133                 int usecs;
 134         } name;
 135
 136         if (!strcmp(pri->sock_type, "unix"))
 137                 pri->ctl_addr = new_addr(pri->ctl_sock,
 138                                          strlen(pri->ctl_sock) + 1);
 139         name.zero = 0;
 140         name.pid = os_getpid();
 141         gettimeofday(&tv, NULL);
 142         name.usecs = tv.tv_usec;
 143         pri->local_addr = new_addr(&name, sizeof(name));
 144         pri->dev = dev;
 145         pri->fd = connect_to_switch(pri);
 146         if (pri->fd < 0) {
 147                 kfree(pri->local_addr);
 148                 pri->local_addr = NULL;
 149                 return pri->fd;
 150         }
 151
 152         return 0;
 153 }
 154
 155 static int daemon_open(void *data)
 156 {
 157         struct daemon_data *pri = data;
 158         return pri->fd;
 159 }
 160
 161 static void daemon_remove(void *data)
 162 {
 163         struct daemon_data *pri = data;
 164
 165         close(pri->fd);
 166         pri->fd = -1;
 167         close(pri->control);
 168         pri->control = -1;
 169
 170         kfree(pri->data_addr);
 171         pri->data_addr = NULL;
 172         kfree(pri->ctl_addr);
 173         pri->ctl_addr = NULL;
 174         kfree(pri->local_addr);
 175         pri->local_addr = NULL;
 176 }
 177
 178 int daemon_user_write(int fd, void *buf, int len, struct daemon_data *pri)
 179 {
 180         struct sockaddr_un *data_addr = pri->data_addr;
 181
 182         return net_sendto(fd, buf, len, data_addr, sizeof(*data_addr));
 183 }
 184
 185 const struct net_user_info daemon_user_info = {
 186         .init           = daemon_user_init,
 187         .open           = daemon_open,
 188         .close          = NULL,
 189         .remove         = daemon_remove,
 190         .add_address    = NULL,
 191         .delete_address = NULL,
 192         .mtu            = ETH_MAX_PACKET,
 193         .max_packet     = ETH_MAX_PACKET + ETH_HEADER_OTHER,
 194 };