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