1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
|
// SPDX-License-Identifier: GPL-2.0-or-later
/*
* PIM for Quagga
* Copyright (C) 2008 Everton da Silva Marques
*/
#include <zebra.h>
#include <stdlib.h>
#include <stdio.h>
#include <errno.h>
#include <string.h>
#include <unistd.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <net/if.h>
#include <arpa/inet.h>
#include "if.h"
#include "pim_igmp_join.h"
const char *prog_name = 0;
static int iface_solve_index(const char *ifname)
{
struct if_nameindex *ini;
ifindex_t ifindex = -1;
int i;
if (!ifname)
return -1;
ini = if_nameindex();
if (!ini) {
int err = errno;
fprintf(stderr,
"%s: interface=%s: failure solving index: errno=%d: %s\n",
prog_name, ifname, err, strerror(err));
errno = err;
return -1;
}
for (i = 0; ini[i].if_index; ++i) {
if (!strcmp(ini[i].if_name, ifname)) {
ifindex = ini[i].if_index;
break;
}
}
if_freenameindex(ini);
return ifindex;
}
int main(int argc, const char *argv[])
{
struct in_addr group_addr;
struct in_addr source_addr;
const char *ifname;
const char *group;
const char *source;
ifindex_t ifindex;
int result;
int fd;
prog_name = argv[0];
fd = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
if (fd < 0) {
fprintf(stderr,
"%s: could not create socket: socket(): errno=%d: %s\n",
prog_name, errno, strerror(errno));
exit(1);
}
if (argc != 4) {
fprintf(stderr,
"usage: %s interface group source\n"
"example: %s eth0 232.1.1.1 1.1.1.1\n",
prog_name, prog_name);
exit(1);
}
ifname = argv[1];
group = argv[2];
source = argv[3];
ifindex = iface_solve_index(ifname);
if (ifindex < 0) {
fprintf(stderr, "%s: could not find interface: %s\n", prog_name,
ifname);
exit(1);
}
result = inet_pton(AF_INET, group, &group_addr);
if (result <= 0) {
fprintf(stderr, "%s: bad group address: %s\n", prog_name,
group);
exit(1);
}
result = inet_pton(AF_INET, source, &source_addr);
if (result <= 0) {
fprintf(stderr, "%s: bad source address: %s\n", prog_name,
source);
exit(1);
}
result = pim_igmp_join_source(fd, ifindex, group_addr, source_addr);
if (result) {
fprintf(stderr,
"%s: setsockopt(fd=%d) failure for IGMP group %s source %s ifindex %d on interface %s: errno=%d: %s\n",
prog_name, fd, group, source, ifindex, ifname, errno,
strerror(errno));
exit(1);
}
printf("%s: joined channel (S,G)=(%s,%s) on interface %s\n", prog_name,
source, group, ifname);
printf("%s: waiting...\n", prog_name);
if (getchar() == EOF)
fprintf(stderr, "getchar failure\n");
close(fd);
printf("%s: left channel (S,G)=(%s,%s) on interface %s\n", prog_name,
source, group, ifname);
exit(0);
}
|
