err.no Git - linux-2.6/blob - arch/um/drivers/mcast_user.c

   1 /*
   2  * user-mode-linux networking multicast transport
   3  * Copyright (C) 2001 by Harald Welte <laforge@gnumonks.org>
   4  *
   5  * based on the existing uml-networking code, which is
   6  * Copyright (C) 2001 Lennert Buytenhek (buytenh@gnu.org) and
   7  * James Leu (jleu@mindspring.net).
   8  * Copyright (C) 2001 by various other people who didn't put their name here.
   9  *
  10  * Licensed under the GPL.
  11  *
  12  */
  13
  14 #include <errno.h>
  15 #include <unistd.h>
  16 #include <sys/socket.h>
  17 #include <sys/un.h>
  18 #include <sys/time.h>
  19 #include <netinet/in.h>
  20 #include "net_user.h"
  21 #include "mcast.h"
  22 #include "kern_util.h"
  23 #include "user_util.h"
  24 #include "user.h"
  25 #include "os.h"
  26 #include "um_malloc.h"
  27
  28 #define MAX_PACKET (ETH_MAX_PACKET + ETH_HEADER_OTHER)
  29
  30 static struct sockaddr_in *new_addr(char *addr, unsigned short port)
  31 {
  32         struct sockaddr_in *sin;
  33
  34         sin = um_kmalloc(sizeof(struct sockaddr_in));
  35         if(sin == NULL){
  36                 printk("new_addr: allocation of sockaddr_in failed\n");
  37                 return NULL;
  38         }
  39         sin->sin_family = AF_INET;
  40         sin->sin_addr.s_addr = in_aton(addr);
  41         sin->sin_port = htons(port);
  42         return sin;
  43 }
  44
  45 static int mcast_user_init(void *data, void *dev)
  46 {
  47         struct mcast_data *pri = data;
  48
  49         pri->mcast_addr = new_addr(pri->addr, pri->port);
  50         pri->dev = dev;
  51         return 0;
  52 }
  53
  54 static void mcast_remove(void *data)
  55 {
  56         struct mcast_data *pri = data;
  57
  58         kfree(pri->mcast_addr);
  59         pri->mcast_addr = NULL;
  60 }
  61
  62 static int mcast_open(void *data)
  63 {
  64         struct mcast_data *pri = data;
  65         struct sockaddr_in *sin = pri->mcast_addr;
  66         struct ip_mreq mreq;
  67         int fd, yes = 1, err = -EINVAL;
  68
  69
  70         if ((sin->sin_addr.s_addr == 0) || (sin->sin_port == 0))
  71                 goto out;
  72
  73         fd = socket(AF_INET, SOCK_DGRAM, 0);
  74
  75         if (fd < 0){
  76                 err = -errno;
  77                 printk("mcast_open : data socket failed, errno = %d\n",
  78                        errno);
  79                 goto out;
  80         }
  81
  82         if (setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, &yes, sizeof(yes)) < 0) {
  83                 err = -errno;
  84                 printk("mcast_open: SO_REUSEADDR failed, errno = %d\n",
  85                         errno);
  86                 goto out_close;
  87         }
  88
  89         /* set ttl according to config */
  90         if (setsockopt(fd, SOL_IP, IP_MULTICAST_TTL, &pri->ttl,
  91                        sizeof(pri->ttl)) < 0) {
  92                 err = -errno;
  93                 printk("mcast_open: IP_MULTICAST_TTL failed, error = %d\n",
  94                         errno);
  95                 goto out_close;
  96         }
  97
  98         /* set LOOP, so data does get fed back to local sockets */
  99         if (setsockopt(fd, SOL_IP, IP_MULTICAST_LOOP, &yes, sizeof(yes)) < 0) {
 100                 err = -errno;
 101                 printk("mcast_open: IP_MULTICAST_LOOP failed, error = %d\n",
 102                         errno);
 103                 goto out_close;
 104         }
 105
 106         /* bind socket to mcast address */
 107         if (bind(fd, (struct sockaddr *) sin, sizeof(*sin)) < 0) {
 108                 err = -errno;
 109                 printk("mcast_open : data bind failed, errno = %d\n", errno);
 110                 goto out_close;
 111         }
 112
 113         /* subscribe to the multicast group */
 114         mreq.imr_multiaddr.s_addr = sin->sin_addr.s_addr;
 115         mreq.imr_interface.s_addr = 0;
 116         if (setsockopt(fd, SOL_IP, IP_ADD_MEMBERSHIP,
 117                        &mreq, sizeof(mreq)) < 0) {
 118                 err = -errno;
 119                 printk("mcast_open: IP_ADD_MEMBERSHIP failed, error = %d\n",
 120                         errno);
 121                 printk("There appears not to be a multicast-capable network "
 122                        "interface on the host.\n");
 123                 printk("eth0 should be configured in order to use the "
 124                        "multicast transport.\n");
 125                 goto out_close;
 126         }
 127
 128         return fd;
 129
 130  out_close:
 131         os_close_file(fd);
 132  out:
 133         return err;
 134 }
 135
 136 static void mcast_close(int fd, void *data)
 137 {
 138         struct ip_mreq mreq;
 139         struct mcast_data *pri = data;
 140         struct sockaddr_in *sin = pri->mcast_addr;
 141
 142         mreq.imr_multiaddr.s_addr = sin->sin_addr.s_addr;
 143         mreq.imr_interface.s_addr = 0;
 144         if (setsockopt(fd, SOL_IP, IP_DROP_MEMBERSHIP,
 145                        &mreq, sizeof(mreq)) < 0) {
 146                 printk("mcast_open: IP_DROP_MEMBERSHIP failed, error = %d\n",
 147                         errno);
 148         }
 149
 150         os_close_file(fd);
 151 }
 152
 153 int mcast_user_write(int fd, void *buf, int len, struct mcast_data *pri)
 154 {
 155         struct sockaddr_in *data_addr = pri->mcast_addr;
 156
 157         return net_sendto(fd, buf, len, data_addr, sizeof(*data_addr));
 158 }
 159
 160 static int mcast_set_mtu(int mtu, void *data)
 161 {
 162         return mtu;
 163 }
 164
 165 const struct net_user_info mcast_user_info = {
 166         .init           = mcast_user_init,
 167         .open           = mcast_open,
 168         .close          = mcast_close,
 169         .remove         = mcast_remove,
 170         .set_mtu        = mcast_set_mtu,
 171         .add_address    = NULL,
 172         .delete_address = NULL,
 173         .max_packet     = MAX_PACKET - ETH_HEADER_OTHER
 174 };