342 lines
6.9 KiB
C
342 lines
6.9 KiB
C
/*
|
|
* ipmaddr.c "ip maddress".
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version
|
|
* 2 of the License, or (at your option) any later version.
|
|
*
|
|
* Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
|
|
*
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <syslog.h>
|
|
#include <fcntl.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/socket.h>
|
|
#include <netinet/in.h>
|
|
#include <arpa/inet.h>
|
|
#include <string.h>
|
|
|
|
#include <linux/netdevice.h>
|
|
#include <linux/if.h>
|
|
#include <linux/if_arp.h>
|
|
#include <linux/sockios.h>
|
|
|
|
#include "rt_names.h"
|
|
#include "utils.h"
|
|
#include "ip_common.h"
|
|
|
|
static struct {
|
|
char *dev;
|
|
int family;
|
|
} filter;
|
|
|
|
static void usage(void) __attribute__((noreturn));
|
|
|
|
static void usage(void)
|
|
{
|
|
fprintf(stderr, "Usage: ip maddr [ add | del ] MULTIADDR dev STRING\n");
|
|
fprintf(stderr, " ip maddr show [ dev STRING ]\n");
|
|
exit(-1);
|
|
}
|
|
|
|
static int parse_hex(char *str, unsigned char *addr, size_t size)
|
|
{
|
|
int len = 0;
|
|
|
|
while (*str && (len < 2 * size)) {
|
|
int tmp;
|
|
|
|
if (str[1] == 0)
|
|
return -1;
|
|
if (sscanf(str, "%02x", &tmp) != 1)
|
|
return -1;
|
|
addr[len] = tmp;
|
|
len++;
|
|
str += 2;
|
|
}
|
|
return len;
|
|
}
|
|
|
|
struct ma_info {
|
|
struct ma_info *next;
|
|
int index;
|
|
int users;
|
|
char *features;
|
|
char name[IFNAMSIZ];
|
|
inet_prefix addr;
|
|
};
|
|
|
|
static void maddr_ins(struct ma_info **lst, struct ma_info *m)
|
|
{
|
|
struct ma_info *mp;
|
|
|
|
for (; (mp = *lst) != NULL; lst = &mp->next) {
|
|
if (mp->index > m->index)
|
|
break;
|
|
}
|
|
m->next = *lst;
|
|
*lst = m;
|
|
}
|
|
|
|
static void read_dev_mcast(struct ma_info **result_p)
|
|
{
|
|
char buf[256];
|
|
FILE *fp = fopen("/proc/net/dev_mcast", "r");
|
|
|
|
if (!fp)
|
|
return;
|
|
|
|
while (fgets(buf, sizeof(buf), fp)) {
|
|
char hexa[256];
|
|
struct ma_info m = { .addr.family = AF_PACKET };
|
|
int len;
|
|
int st;
|
|
|
|
sscanf(buf, "%d%s%d%d%s", &m.index, m.name, &m.users, &st,
|
|
hexa);
|
|
if (filter.dev && strcmp(filter.dev, m.name))
|
|
continue;
|
|
|
|
len = parse_hex(hexa, (unsigned char *)&m.addr.data, sizeof(m.addr.data));
|
|
if (len >= 0) {
|
|
struct ma_info *ma = malloc(sizeof(m));
|
|
|
|
memcpy(ma, &m, sizeof(m));
|
|
ma->addr.bytelen = len;
|
|
ma->addr.bitlen = len<<3;
|
|
if (st)
|
|
ma->features = "static";
|
|
maddr_ins(result_p, ma);
|
|
}
|
|
}
|
|
fclose(fp);
|
|
}
|
|
|
|
static void read_igmp(struct ma_info **result_p)
|
|
{
|
|
struct ma_info m = {
|
|
.addr.family = AF_INET,
|
|
.addr.bitlen = 32,
|
|
.addr.bytelen = 4,
|
|
};
|
|
char buf[256];
|
|
FILE *fp = fopen("/proc/net/igmp", "r");
|
|
|
|
if (!fp)
|
|
return;
|
|
if (!fgets(buf, sizeof(buf), fp)) {
|
|
fclose(fp);
|
|
return;
|
|
}
|
|
|
|
while (fgets(buf, sizeof(buf), fp)) {
|
|
struct ma_info *ma;
|
|
|
|
if (buf[0] != '\t') {
|
|
size_t len;
|
|
|
|
sscanf(buf, "%d%s", &m.index, m.name);
|
|
len = strlen(m.name);
|
|
if (m.name[len - 1] == ':')
|
|
m.name[len - 1] = '\0';
|
|
continue;
|
|
}
|
|
|
|
if (filter.dev && strcmp(filter.dev, m.name))
|
|
continue;
|
|
|
|
sscanf(buf, "%08x%d", (__u32 *)&m.addr.data, &m.users);
|
|
|
|
ma = malloc(sizeof(m));
|
|
memcpy(ma, &m, sizeof(m));
|
|
maddr_ins(result_p, ma);
|
|
}
|
|
fclose(fp);
|
|
}
|
|
|
|
|
|
static void read_igmp6(struct ma_info **result_p)
|
|
{
|
|
char buf[256];
|
|
FILE *fp = fopen("/proc/net/igmp6", "r");
|
|
|
|
if (!fp)
|
|
return;
|
|
|
|
while (fgets(buf, sizeof(buf), fp)) {
|
|
char hexa[256];
|
|
struct ma_info m = { .addr.family = AF_INET6 };
|
|
int len;
|
|
|
|
sscanf(buf, "%d%s%s%d", &m.index, m.name, hexa, &m.users);
|
|
|
|
if (filter.dev && strcmp(filter.dev, m.name))
|
|
continue;
|
|
|
|
len = parse_hex(hexa, (unsigned char *)&m.addr.data, sizeof(m.addr.data));
|
|
if (len >= 0) {
|
|
struct ma_info *ma = malloc(sizeof(m));
|
|
|
|
memcpy(ma, &m, sizeof(m));
|
|
|
|
ma->addr.bytelen = len;
|
|
ma->addr.bitlen = len<<3;
|
|
maddr_ins(result_p, ma);
|
|
}
|
|
}
|
|
fclose(fp);
|
|
}
|
|
|
|
static void print_maddr(FILE *fp, struct ma_info *list)
|
|
{
|
|
fprintf(fp, "\t");
|
|
|
|
if (list->addr.family == AF_PACKET) {
|
|
SPRINT_BUF(b1);
|
|
fprintf(fp, "link %s", ll_addr_n2a((unsigned char *)list->addr.data,
|
|
list->addr.bytelen, 0,
|
|
b1, sizeof(b1)));
|
|
} else {
|
|
switch (list->addr.family) {
|
|
case AF_INET:
|
|
fprintf(fp, "inet ");
|
|
break;
|
|
case AF_INET6:
|
|
fprintf(fp, "inet6 ");
|
|
break;
|
|
default:
|
|
fprintf(fp, "family %d ", list->addr.family);
|
|
break;
|
|
}
|
|
fprintf(fp, "%s",
|
|
format_host(list->addr.family,
|
|
-1, list->addr.data));
|
|
}
|
|
if (list->users != 1)
|
|
fprintf(fp, " users %d", list->users);
|
|
if (list->features)
|
|
fprintf(fp, " %s", list->features);
|
|
fprintf(fp, "\n");
|
|
}
|
|
|
|
static void print_mlist(FILE *fp, struct ma_info *list)
|
|
{
|
|
int cur_index = 0;
|
|
|
|
for (; list; list = list->next) {
|
|
if (oneline) {
|
|
cur_index = list->index;
|
|
fprintf(fp, "%d:\t%s%s", cur_index, list->name, _SL_);
|
|
} else if (cur_index != list->index) {
|
|
cur_index = list->index;
|
|
fprintf(fp, "%d:\t%s\n", cur_index, list->name);
|
|
}
|
|
print_maddr(fp, list);
|
|
}
|
|
}
|
|
|
|
static int multiaddr_list(int argc, char **argv)
|
|
{
|
|
struct ma_info *list = NULL;
|
|
|
|
if (!filter.family)
|
|
filter.family = preferred_family;
|
|
|
|
while (argc > 0) {
|
|
if (1) {
|
|
if (strcmp(*argv, "dev") == 0) {
|
|
NEXT_ARG();
|
|
} else if (matches(*argv, "help") == 0)
|
|
usage();
|
|
if (filter.dev)
|
|
duparg2("dev", *argv);
|
|
filter.dev = *argv;
|
|
}
|
|
argv++; argc--;
|
|
}
|
|
|
|
if (!filter.family || filter.family == AF_PACKET)
|
|
read_dev_mcast(&list);
|
|
if (!filter.family || filter.family == AF_INET)
|
|
read_igmp(&list);
|
|
if (!filter.family || filter.family == AF_INET6)
|
|
read_igmp6(&list);
|
|
print_mlist(stdout, list);
|
|
return 0;
|
|
}
|
|
|
|
static int multiaddr_modify(int cmd, int argc, char **argv)
|
|
{
|
|
struct ifreq ifr = {};
|
|
int fd;
|
|
|
|
if (cmd == RTM_NEWADDR)
|
|
cmd = SIOCADDMULTI;
|
|
else
|
|
cmd = SIOCDELMULTI;
|
|
|
|
while (argc > 0) {
|
|
if (strcmp(*argv, "dev") == 0) {
|
|
NEXT_ARG();
|
|
if (ifr.ifr_name[0])
|
|
duparg("dev", *argv);
|
|
if (get_ifname(ifr.ifr_name, *argv))
|
|
invarg("\"dev\" not a valid ifname", *argv);
|
|
} else {
|
|
if (matches(*argv, "address") == 0) {
|
|
NEXT_ARG();
|
|
}
|
|
if (matches(*argv, "help") == 0)
|
|
usage();
|
|
if (ifr.ifr_hwaddr.sa_data[0])
|
|
duparg("address", *argv);
|
|
if (ll_addr_a2n(ifr.ifr_hwaddr.sa_data,
|
|
14, *argv) < 0) {
|
|
fprintf(stderr, "Error: \"%s\" is not a legal ll address.\n", *argv);
|
|
exit(1);
|
|
}
|
|
}
|
|
argc--; argv++;
|
|
}
|
|
if (ifr.ifr_name[0] == 0) {
|
|
fprintf(stderr, "Not enough information: \"dev\" is required.\n");
|
|
exit(-1);
|
|
}
|
|
|
|
fd = socket(AF_INET, SOCK_DGRAM, 0);
|
|
if (fd < 0) {
|
|
perror("Cannot create socket");
|
|
exit(1);
|
|
}
|
|
if (ioctl(fd, cmd, (char *)&ifr) != 0) {
|
|
perror("ioctl");
|
|
exit(1);
|
|
}
|
|
close(fd);
|
|
|
|
exit(0);
|
|
}
|
|
|
|
|
|
int do_multiaddr(int argc, char **argv)
|
|
{
|
|
if (argc < 1)
|
|
return multiaddr_list(0, NULL);
|
|
if (matches(*argv, "add") == 0)
|
|
return multiaddr_modify(RTM_NEWADDR, argc-1, argv+1);
|
|
if (matches(*argv, "delete") == 0)
|
|
return multiaddr_modify(RTM_DELADDR, argc-1, argv+1);
|
|
if (matches(*argv, "list") == 0 || matches(*argv, "show") == 0
|
|
|| matches(*argv, "lst") == 0)
|
|
return multiaddr_list(argc-1, argv+1);
|
|
if (matches(*argv, "help") == 0)
|
|
usage();
|
|
fprintf(stderr, "Command \"%s\" is unknown, try \"ip maddr help\".\n", *argv);
|
|
exit(-1);
|
|
}
|