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