• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * ipmaddr.c		"ip maddress".
3  *
4  *		This program is free software; you can redistribute it and/or
5  *		modify it under the terms of the GNU General Public License
6  *		as published by the Free Software Foundation; either version
7  *		2 of the License, or (at your option) any later version.
8  *
9  * Authors:	Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
10  *
11  */
12 
13 #include <stdio.h>
14 #include <stdlib.h>
15 #include <unistd.h>
16 #include <syslog.h>
17 #include <fcntl.h>
18 #include <sys/ioctl.h>
19 #include <sys/socket.h>
20 #include <netinet/in.h>
21 #include <arpa/inet.h>
22 #include <string.h>
23 
24 #include <linux/netdevice.h>
25 #include <linux/if.h>
26 #include <linux/if_arp.h>
27 #include <linux/sockios.h>
28 
29 #include "rt_names.h"
30 #include "utils.h"
31 
32 static struct {
33 	char *dev;
34 	int  family;
35 } filter;
36 
37 static void usage(void) __attribute__((noreturn));
38 
usage(void)39 static void usage(void)
40 {
41 	fprintf(stderr, "Usage: ip maddr [ add | del ] MULTIADDR dev STRING\n");
42 	fprintf(stderr, "       ip maddr show [ dev STRING ]\n");
43 	exit(-1);
44 }
45 
parse_hex(char * str,unsigned char * addr,size_t size)46 static int parse_hex(char *str, unsigned char *addr, size_t size)
47 {
48 	int len=0;
49 
50 	while (*str && (len < 2 * size)) {
51 		int tmp;
52 		if (str[1] == 0)
53 			return -1;
54 		if (sscanf(str, "%02x", &tmp) != 1)
55 			return -1;
56 		addr[len] = tmp;
57 		len++;
58 		str += 2;
59 	}
60 	return len;
61 }
62 
63 struct ma_info
64 {
65 	struct ma_info *next;
66 	int		index;
67 	int		users;
68 	char		*features;
69 	char		name[IFNAMSIZ];
70 	inet_prefix	addr;
71 };
72 
maddr_ins(struct ma_info ** lst,struct ma_info * m)73 void maddr_ins(struct ma_info **lst, struct ma_info *m)
74 {
75 	struct ma_info *mp;
76 
77 	for (; (mp=*lst) != NULL; lst = &mp->next) {
78 		if (mp->index > m->index)
79 			break;
80 	}
81 	m->next = *lst;
82 	*lst = m;
83 }
84 
read_dev_mcast(struct ma_info ** result_p)85 void read_dev_mcast(struct ma_info **result_p)
86 {
87 	char buf[256];
88 	FILE *fp = fopen("/proc/net/dev_mcast", "r");
89 
90 	if (!fp)
91 		return;
92 
93 	while (fgets(buf, sizeof(buf), fp)) {
94 		char hexa[256];
95 		struct ma_info m;
96 		int len;
97 		int st;
98 
99 		memset(&m, 0, sizeof(m));
100 		sscanf(buf, "%d%s%d%d%s", &m.index, m.name, &m.users, &st,
101 		       hexa);
102 		if (filter.dev && strcmp(filter.dev, m.name))
103 			continue;
104 
105 		m.addr.family = AF_PACKET;
106 
107 		len = parse_hex(hexa, (unsigned char*)&m.addr.data, sizeof (m.addr.data));
108 		if (len >= 0) {
109 			struct ma_info *ma = malloc(sizeof(m));
110 
111 			memcpy(ma, &m, sizeof(m));
112 			ma->addr.bytelen = len;
113 			ma->addr.bitlen = len<<3;
114 			if (st)
115 				ma->features = "static";
116 			maddr_ins(result_p, ma);
117 		}
118 	}
119 	fclose(fp);
120 }
121 
read_igmp(struct ma_info ** result_p)122 void read_igmp(struct ma_info **result_p)
123 {
124 	struct ma_info m;
125 	char buf[256];
126 	FILE *fp = fopen("/proc/net/igmp", "r");
127 
128 	if (!fp)
129 		return;
130 	memset(&m, 0, sizeof(m));
131 	fgets(buf, sizeof(buf), fp);
132 
133 	m.addr.family = AF_INET;
134 	m.addr.bitlen = 32;
135 	m.addr.bytelen = 4;
136 
137 	while (fgets(buf, sizeof(buf), fp)) {
138 		struct ma_info *ma = malloc(sizeof(m));
139 
140 		if (buf[0] != '\t') {
141 			sscanf(buf, "%d%s", &m.index, m.name);
142 			continue;
143 		}
144 
145 		if (filter.dev && strcmp(filter.dev, m.name))
146 			continue;
147 
148 		sscanf(buf, "%08x%d", (__u32*)&m.addr.data, &m.users);
149 
150 		ma = malloc(sizeof(m));
151 		memcpy(ma, &m, sizeof(m));
152 		maddr_ins(result_p, ma);
153 	}
154 	fclose(fp);
155 }
156 
157 
read_igmp6(struct ma_info ** result_p)158 void read_igmp6(struct ma_info **result_p)
159 {
160 	char buf[256];
161 	FILE *fp = fopen("/proc/net/igmp6", "r");
162 
163 	if (!fp)
164 		return;
165 
166 	while (fgets(buf, sizeof(buf), fp)) {
167 		char hexa[256];
168 		struct ma_info m;
169 		int len;
170 
171 		memset(&m, 0, sizeof(m));
172 		sscanf(buf, "%d%s%s%d", &m.index, m.name, hexa, &m.users);
173 
174 		if (filter.dev && strcmp(filter.dev, m.name))
175 			continue;
176 
177 		m.addr.family = AF_INET6;
178 
179 		len = parse_hex(hexa, (unsigned char*)&m.addr.data, sizeof (m.addr.data));
180 		if (len >= 0) {
181 			struct ma_info *ma = malloc(sizeof(m));
182 
183 			memcpy(ma, &m, sizeof(m));
184 
185 			ma->addr.bytelen = len;
186 			ma->addr.bitlen = len<<3;
187 			maddr_ins(result_p, ma);
188 		}
189 	}
190 	fclose(fp);
191 }
192 
print_maddr(FILE * fp,struct ma_info * list)193 static void print_maddr(FILE *fp, struct ma_info *list)
194 {
195 	fprintf(fp, "\t");
196 
197 	if (list->addr.family == AF_PACKET) {
198 		SPRINT_BUF(b1);
199 		fprintf(fp, "link  %s", ll_addr_n2a((unsigned char*)list->addr.data,
200 						    list->addr.bytelen, 0,
201 						    b1, sizeof(b1)));
202 	} else {
203 		char abuf[256];
204 		switch(list->addr.family) {
205 		case AF_INET:
206 			fprintf(fp, "inet  ");
207 			break;
208 		case AF_INET6:
209 			fprintf(fp, "inet6 ");
210 			break;
211 		default:
212 			fprintf(fp, "family %d ", list->addr.family);
213 			break;
214 		}
215 		fprintf(fp, "%s",
216 			format_host(list->addr.family,
217 				    -1,
218 				    list->addr.data,
219 				    abuf, sizeof(abuf)));
220 	}
221 	if (list->users != 1)
222 		fprintf(fp, " users %d", list->users);
223 	if (list->features)
224 		fprintf(fp, " %s", list->features);
225 	fprintf(fp, "\n");
226 }
227 
print_mlist(FILE * fp,struct ma_info * list)228 static void print_mlist(FILE *fp, struct ma_info *list)
229 {
230 	int cur_index = 0;
231 
232 	for (; list; list = list->next) {
233 		if (oneline) {
234 			cur_index = list->index;
235 			fprintf(fp, "%d:\t%s%s", cur_index, list->name, _SL_);
236 		} else if (cur_index != list->index) {
237 			cur_index = list->index;
238 			fprintf(fp, "%d:\t%s\n", cur_index, list->name);
239 		}
240 		print_maddr(fp, list);
241 	}
242 }
243 
multiaddr_list(int argc,char ** argv)244 static int multiaddr_list(int argc, char **argv)
245 {
246 	struct ma_info *list = NULL;
247 
248 	if (!filter.family)
249 		filter.family = preferred_family;
250 
251 	while (argc > 0) {
252 		if (1) {
253 			if (strcmp(*argv, "dev") == 0) {
254 				NEXT_ARG();
255 			}
256 			if (matches(*argv, "help") == 0)
257 				usage();
258 			if (filter.dev)
259 				duparg2("dev", *argv);
260 			filter.dev = *argv;
261 		}
262 		argv++; argc--;
263 	}
264 
265 	if (!filter.family || filter.family == AF_PACKET)
266 		read_dev_mcast(&list);
267 	if (!filter.family || filter.family == AF_INET)
268 		read_igmp(&list);
269 	if (!filter.family || filter.family == AF_INET6)
270 		read_igmp6(&list);
271 	print_mlist(stdout, list);
272 	return 0;
273 }
274 
multiaddr_modify(int cmd,int argc,char ** argv)275 int multiaddr_modify(int cmd, int argc, char **argv)
276 {
277 	struct ifreq ifr;
278 	int fd;
279 
280 	memset(&ifr, 0, sizeof(ifr));
281 
282 	if (cmd == RTM_NEWADDR)
283 		cmd = SIOCADDMULTI;
284 	else
285 		cmd = SIOCDELMULTI;
286 
287 	while (argc > 0) {
288 		if (strcmp(*argv, "dev") == 0) {
289 			NEXT_ARG();
290 			if (ifr.ifr_name[0])
291 				duparg("dev", *argv);
292 			strncpy(ifr.ifr_name, *argv, IFNAMSIZ);
293 		} else {
294 			if (matches(*argv, "address") == 0) {
295 				NEXT_ARG();
296 			}
297 			if (matches(*argv, "help") == 0)
298 				usage();
299 			if (ifr.ifr_hwaddr.sa_data[0])
300 				duparg("address", *argv);
301 			if (ll_addr_a2n(ifr.ifr_hwaddr.sa_data,
302 					14, *argv) < 0) {
303 				fprintf(stderr, "Error: \"%s\" is not a legal ll address.\n", *argv);
304 				exit(1);
305 			}
306 		}
307 		argc--; argv++;
308 	}
309 	if (ifr.ifr_name[0] == 0) {
310 		fprintf(stderr, "Not enough information: \"dev\" is required.\n");
311 		exit(-1);
312 	}
313 
314 	fd = socket(AF_INET, SOCK_DGRAM, 0);
315 	if (fd < 0) {
316 		perror("Cannot create socket");
317 		exit(1);
318 	}
319 	if (ioctl(fd, cmd, (char*)&ifr) != 0) {
320 		perror("ioctl");
321 		exit(1);
322 	}
323 	close(fd);
324 
325 	exit(0);
326 }
327 
328 
do_multiaddr(int argc,char ** argv)329 int do_multiaddr(int argc, char **argv)
330 {
331 	if (argc < 1)
332 		return multiaddr_list(0, NULL);
333 	if (matches(*argv, "add") == 0)
334 		return multiaddr_modify(RTM_NEWADDR, argc-1, argv+1);
335 	if (matches(*argv, "delete") == 0)
336 		return multiaddr_modify(RTM_DELADDR, argc-1, argv+1);
337 	if (matches(*argv, "list") == 0 || matches(*argv, "show") == 0
338 	    || matches(*argv, "lst") == 0)
339 		return multiaddr_list(argc-1, argv+1);
340 	if (matches(*argv, "help") == 0)
341 		usage();
342 	fprintf(stderr, "Command \"%s\" is unknown, try \"ip maddr help\".\n", *argv);
343 	exit(-1);
344 }
345