1
2
3
4
5
6
7
8#include <stdio.h>
9#include <stdlib.h>
10#include <unistd.h>
11#include <fcntl.h>
12#include <sys/ioctl.h>
13#include <sys/socket.h>
14#include <netinet/in.h>
15#include <arpa/inet.h>
16#include <string.h>
17
18#include <linux/netdevice.h>
19#include <linux/if.h>
20#include <linux/if_arp.h>
21#include <linux/sockios.h>
22
23#include "rt_names.h"
24#include "utils.h"
25#include "ip_common.h"
26#include "json_print.h"
27
28static struct {
29 char *dev;
30 int family;
31} filter;
32
33static void usage(void) __attribute__((noreturn));
34
35static void usage(void)
36{
37 fprintf(stderr,
38 "Usage: ip maddr [ add | del ] MULTIADDR dev STRING\n"
39 " ip maddr show [ dev STRING ]\n");
40 exit(-1);
41}
42
43static int parse_hex(char *str, unsigned char *addr, size_t size)
44{
45 int len = 0;
46
47 while (*str && (len < 2 * size)) {
48 int tmp;
49
50 if (str[1] == 0)
51 return -1;
52 if (sscanf(str, "%02x", &tmp) != 1)
53 return -1;
54 addr[len] = tmp;
55 len++;
56 str += 2;
57 }
58 return len;
59}
60
61struct ma_info {
62 struct ma_info *next;
63 int index;
64 int users;
65 char *features;
66 char name[IFNAMSIZ];
67 inet_prefix addr;
68};
69
70static void maddr_ins(struct ma_info **lst, struct ma_info *m)
71{
72 struct ma_info *mp;
73
74 for (; (mp = *lst) != NULL; lst = &mp->next) {
75 if (mp->index > m->index)
76 break;
77 }
78 m->next = *lst;
79 *lst = m;
80}
81
82static void maddr_clear(struct ma_info *lst)
83{
84 struct ma_info *mp;
85
86 while ((mp = lst) != NULL) {
87 lst = mp->next;
88 free(mp);
89 }
90}
91
92static void read_dev_mcast(struct ma_info **result_p)
93{
94 char buf[256];
95 FILE *fp = fopen("/proc/net/dev_mcast", "r");
96
97 if (!fp)
98 return;
99
100 while (fgets(buf, sizeof(buf), fp)) {
101 char hexa[256];
102 struct ma_info m = { .addr.family = AF_PACKET };
103 int len;
104 int st;
105
106 sscanf(buf, "%d%s%d%d%s", &m.index, m.name, &m.users, &st,
107 hexa);
108 if (filter.dev && strcmp(filter.dev, m.name))
109 continue;
110
111 len = parse_hex(hexa, (unsigned char *)&m.addr.data, sizeof(m.addr.data));
112 if (len >= 0) {
113 struct ma_info *ma = malloc(sizeof(m));
114
115 if (ma == NULL)
116 break;
117 memcpy(ma, &m, sizeof(m));
118 ma->addr.bytelen = len;
119 ma->addr.bitlen = len<<3;
120 if (st)
121 ma->features = "static";
122 maddr_ins(result_p, ma);
123 }
124 }
125 fclose(fp);
126}
127
128static void read_igmp(struct ma_info **result_p)
129{
130 struct ma_info m = {
131 .addr.family = AF_INET,
132 .addr.bitlen = 32,
133 .addr.bytelen = 4,
134 };
135 char buf[256];
136 FILE *fp = fopen("/proc/net/igmp", "r");
137
138 if (!fp)
139 return;
140 if (!fgets(buf, sizeof(buf), fp)) {
141 fclose(fp);
142 return;
143 }
144
145 while (fgets(buf, sizeof(buf), fp)) {
146 struct ma_info *ma;
147
148 if (buf[0] != '\t') {
149 size_t len;
150
151 sscanf(buf, "%d%s", &m.index, m.name);
152 len = strlen(m.name);
153 if (len == 0)
154 continue;
155 if (m.name[len - 1] == ':')
156 m.name[len - 1] = '\0';
157 continue;
158 }
159
160 if (filter.dev && strcmp(filter.dev, m.name))
161 continue;
162
163 sscanf(buf, "%08x%d", (__u32 *)&m.addr.data, &m.users);
164
165 ma = malloc(sizeof(m));
166 if (ma == NULL)
167 break;
168
169 memcpy(ma, &m, sizeof(m));
170 maddr_ins(result_p, ma);
171 }
172 fclose(fp);
173}
174
175
176static void read_igmp6(struct ma_info **result_p)
177{
178 char buf[256];
179 FILE *fp = fopen("/proc/net/igmp6", "r");
180
181 if (!fp)
182 return;
183
184 while (fgets(buf, sizeof(buf), fp)) {
185 char hexa[256];
186 struct ma_info m = { .addr.family = AF_INET6 };
187 int len;
188
189 sscanf(buf, "%d%s%s%d", &m.index, m.name, hexa, &m.users);
190
191 if (filter.dev && strcmp(filter.dev, m.name))
192 continue;
193
194 len = parse_hex(hexa, (unsigned char *)&m.addr.data, sizeof(m.addr.data));
195 if (len >= 0) {
196 struct ma_info *ma = malloc(sizeof(m));
197
198 if (ma == NULL)
199 break;
200
201 memcpy(ma, &m, sizeof(m));
202 ma->addr.bytelen = len;
203 ma->addr.bitlen = len<<3;
204 maddr_ins(result_p, ma);
205 }
206 }
207 fclose(fp);
208}
209
210static void print_maddr(FILE *fp, struct ma_info *list)
211{
212 print_string(PRINT_FP, NULL, "\t", NULL);
213
214 open_json_object(NULL);
215 if (list->addr.family == AF_PACKET) {
216 SPRINT_BUF(b1);
217
218 print_string(PRINT_FP, NULL, "link ", NULL);
219 print_color_string(PRINT_ANY, COLOR_MAC, "link", "%s",
220 ll_addr_n2a((void *)list->addr.data, list->addr.bytelen,
221 0, b1, sizeof(b1)));
222 } else {
223 print_string(PRINT_ANY, "family", "%-5s ",
224 family_name(list->addr.family));
225 print_color_string(PRINT_ANY, ifa_family_color(list->addr.family),
226 "address", "%s",
227 format_host(list->addr.family,
228 -1, list->addr.data));
229 }
230
231 if (list->users != 1)
232 print_uint(PRINT_ANY, "users", " users %u", list->users);
233
234 if (list->features)
235 print_string(PRINT_ANY, "features", " %s", list->features);
236
237 print_string(PRINT_FP, NULL, "\n", NULL);
238 close_json_object();
239}
240
241static void print_mlist(FILE *fp, struct ma_info *list)
242{
243 int cur_index = 0;
244
245 new_json_obj(json);
246 for (; list; list = list->next) {
247
248 if (list->index != cur_index || oneline) {
249 if (cur_index) {
250 close_json_array(PRINT_JSON, NULL);
251 close_json_object();
252 }
253 open_json_object(NULL);
254
255 print_uint(PRINT_ANY, "ifindex", "%d:", list->index);
256 print_color_string(PRINT_ANY, COLOR_IFNAME,
257 "ifname", "\t%s", list->name);
258 print_nl();
259 cur_index = list->index;
260
261 open_json_array(PRINT_JSON, "maddr");
262 }
263
264 print_maddr(fp, list);
265 }
266 if (cur_index) {
267 close_json_array(PRINT_JSON, NULL);
268 close_json_object();
269 }
270
271 delete_json_obj();
272}
273
274static int multiaddr_list(int argc, char **argv)
275{
276 struct ma_info *list = NULL;
277
278 if (!filter.family)
279 filter.family = preferred_family;
280
281 while (argc > 0) {
282 if (1) {
283 if (strcmp(*argv, "dev") == 0) {
284 NEXT_ARG();
285 } else if (matches(*argv, "help") == 0)
286 usage();
287 if (filter.dev)
288 duparg2("dev", *argv);
289 filter.dev = *argv;
290 }
291 argv++; argc--;
292 }
293
294 if (!filter.family || filter.family == AF_PACKET)
295 read_dev_mcast(&list);
296 if (!filter.family || filter.family == AF_INET)
297 read_igmp(&list);
298 if (!filter.family || filter.family == AF_INET6)
299 read_igmp6(&list);
300 print_mlist(stdout, list);
301 maddr_clear(list);
302 return 0;
303}
304
305static int multiaddr_modify(int cmd, int argc, char **argv)
306{
307 struct ifreq ifr = {};
308 int family;
309 int fd, len;
310
311 if (cmd == RTM_NEWADDR)
312 cmd = SIOCADDMULTI;
313 else
314 cmd = SIOCDELMULTI;
315
316 while (argc > 0) {
317 if (strcmp(*argv, "dev") == 0) {
318 NEXT_ARG();
319 if (ifr.ifr_name[0])
320 duparg("dev", *argv);
321 if (get_ifname(ifr.ifr_name, *argv))
322 invarg("\"dev\" not a valid ifname", *argv);
323 } else {
324 if (matches(*argv, "address") == 0) {
325 NEXT_ARG();
326 }
327 if (matches(*argv, "help") == 0)
328 usage();
329 if (ifr.ifr_hwaddr.sa_data[0])
330 duparg("address", *argv);
331 len = ll_addr_a2n(ifr.ifr_hwaddr.sa_data,
332 sizeof(ifr.ifr_hwaddr.sa_data),
333 *argv);
334 if (len < 0)
335 exit(1);
336
337 if (len != ETH_ALEN) {
338 fprintf(stderr, "Error: Invalid address length %d - must be %d bytes\n", len, ETH_ALEN);
339 exit(1);
340 }
341 }
342 argc--; argv++;
343 }
344 if (ifr.ifr_name[0] == 0) {
345 fprintf(stderr, "Not enough information: \"dev\" is required.\n");
346 exit(-1);
347 }
348
349 switch (preferred_family) {
350 case AF_INET6:
351 case AF_PACKET:
352 case AF_INET:
353 family = preferred_family;
354 break;
355 default:
356 family = AF_INET;
357 }
358
359 fd = socket(family, SOCK_DGRAM, 0);
360 if (fd < 0) {
361 perror("Cannot create socket");
362 exit(1);
363 }
364 if (ioctl(fd, cmd, (char *)&ifr) != 0) {
365 perror("ioctl");
366 exit(1);
367 }
368 close(fd);
369
370 exit(0);
371}
372
373
374int do_multiaddr(int argc, char **argv)
375{
376 if (argc < 1)
377 return multiaddr_list(0, NULL);
378 if (matches(*argv, "add") == 0)
379 return multiaddr_modify(RTM_NEWADDR, argc-1, argv+1);
380 if (matches(*argv, "delete") == 0)
381 return multiaddr_modify(RTM_DELADDR, argc-1, argv+1);
382 if (matches(*argv, "list") == 0 || matches(*argv, "show") == 0
383 || matches(*argv, "lst") == 0)
384 return multiaddr_list(argc-1, argv+1);
385 if (matches(*argv, "help") == 0)
386 usage();
387 fprintf(stderr, "Command \"%s\" is unknown, try \"ip maddr help\".\n", *argv);
388 exit(-1);
389}
390
