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