3 * Copyright (C) 2016 Cumulus Networks, Inc.
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful, but
12 * WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * General Public License for more details.
16 * You should have received a copy of the GNU General Public License along
17 * with this program; see the file COPYING; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
25 #include "pim_igmpv2.h"
26 #include "pim_igmpv3.h"
32 static void on_trace(const char *label
, struct interface
*ifp
,
35 if (PIM_DEBUG_IGMP_TRACE
) {
36 char from_str
[INET_ADDRSTRLEN
];
37 pim_inet4_dump("<from?>", from
, from_str
, sizeof(from_str
));
38 zlog_debug("%s: from %s on %s", label
, from_str
, ifp
->name
);
42 void igmp_v2_send_query(struct igmp_group
*group
, int fd
, const char *ifname
,
43 char *query_buf
, struct in_addr dst_addr
,
44 struct in_addr group_addr
,
45 int query_max_response_time_dsec
)
48 uint8_t max_resp_code
;
50 struct sockaddr_in to
;
54 /* max_resp_code must be non-zero else this will look like an IGMP v1
56 max_resp_code
= igmp_msg_encode16to8(query_max_response_time_dsec
);
57 zassert(max_resp_code
> 0);
59 query_buf
[0] = PIM_IGMP_MEMBERSHIP_QUERY
;
60 query_buf
[1] = max_resp_code
;
61 *(uint16_t *)(query_buf
+ IGMP_CHECKSUM_OFFSET
) =
62 0; /* for computing checksum */
63 memcpy(query_buf
+ 4, &group_addr
, sizeof(struct in_addr
));
65 checksum
= in_cksum(query_buf
, msg_size
);
66 *(uint16_t *)(query_buf
+ IGMP_CHECKSUM_OFFSET
) = checksum
;
68 if (PIM_DEBUG_IGMP_PACKETS
) {
69 char dst_str
[INET_ADDRSTRLEN
];
70 char group_str
[INET_ADDRSTRLEN
];
71 pim_inet4_dump("<dst?>", dst_addr
, dst_str
, sizeof(dst_str
));
72 pim_inet4_dump("<group?>", group_addr
, group_str
,
74 zlog_debug("Send IGMPv2 QUERY to %s on %s for group %s",
75 dst_str
, ifname
, group_str
);
78 memset(&to
, 0, sizeof(to
));
79 to
.sin_family
= AF_INET
;
80 to
.sin_addr
= dst_addr
;
83 sent
= sendto(fd
, query_buf
, msg_size
, MSG_DONTWAIT
,
84 (struct sockaddr
*)&to
, tolen
);
85 if (sent
!= (ssize_t
)msg_size
) {
86 char dst_str
[INET_ADDRSTRLEN
];
87 char group_str
[INET_ADDRSTRLEN
];
88 pim_inet4_dump("<dst?>", dst_addr
, dst_str
, sizeof(dst_str
));
89 pim_inet4_dump("<group?>", group_addr
, group_str
,
93 "Send IGMPv2 QUERY failed due to %s on %s: group=%s msg_size=%zd: errno=%d: %s",
94 dst_str
, ifname
, group_str
, msg_size
, errno
,
95 safe_strerror(errno
));
98 "Send IGMPv2 QUERY failed due to %s on %s: group=%s msg_size=%zd: sent=%zd",
99 dst_str
, ifname
, group_str
, msg_size
, sent
);
105 int igmp_v2_recv_report(struct igmp_sock
*igmp
, struct in_addr from
,
106 const char *from_str
, char *igmp_msg
, int igmp_msg_len
)
108 struct interface
*ifp
= igmp
->interface
;
109 struct in_addr group_addr
;
110 char group_str
[INET_ADDRSTRLEN
];
112 on_trace(__func__
, igmp
->interface
, from
);
114 if (igmp
->mtrace_only
)
117 if (igmp_msg_len
!= IGMP_V12_MSG_SIZE
) {
119 "Recv IGMPv2 REPORT from %s on %s: size=%d other than correct=%d",
120 from_str
, ifp
->name
, igmp_msg_len
, IGMP_V12_MSG_SIZE
);
124 if (igmp_validate_checksum(igmp_msg
, igmp_msg_len
) == -1) {
126 "Recv IGMPv2 REPORT from %s on %s: size=%d with invalid checksum",
127 from_str
, ifp
->name
, igmp_msg_len
);
131 /* Collecting IGMP Rx stats */
132 igmp
->rx_stats
.report_v2
++;
134 memcpy(&group_addr
, igmp_msg
+ 4, sizeof(struct in_addr
));
136 if (PIM_DEBUG_IGMP_PACKETS
) {
137 pim_inet4_dump("<dst?>", group_addr
, group_str
,
139 zlog_debug("Recv IGMPv2 REPORT from %s on %s for %s", from_str
,
140 ifp
->name
, group_str
);
145 * 7.3.2. In the Presence of Older Version Group Members
147 * When Group Compatibility Mode is IGMPv2, a router internally
148 * translates the following IGMPv2 messages for that group to their
149 * IGMPv3 equivalents:
151 * IGMPv2 Message IGMPv3 Equivalent
152 * -------------- -----------------
156 igmpv3_report_isex(igmp
, from
, group_addr
, 0, NULL
, 1);
161 int igmp_v2_recv_leave(struct igmp_sock
*igmp
, struct in_addr from
,
162 const char *from_str
, char *igmp_msg
, int igmp_msg_len
)
164 struct interface
*ifp
= igmp
->interface
;
165 struct in_addr group_addr
;
166 char group_str
[INET_ADDRSTRLEN
];
168 on_trace(__func__
, igmp
->interface
, from
);
170 if (igmp
->mtrace_only
)
173 if (igmp_msg_len
!= IGMP_V12_MSG_SIZE
) {
175 "Recv IGMPv2 LEAVE from %s on %s: size=%d other than correct=%d",
176 from_str
, ifp
->name
, igmp_msg_len
, IGMP_V12_MSG_SIZE
);
180 if (igmp_validate_checksum(igmp_msg
, igmp_msg_len
) == -1) {
182 "Recv IGMPv2 LEAVE from %s on %s with invalid checksum",
183 from_str
, ifp
->name
);
187 /* Collecting IGMP Rx stats */
188 igmp
->rx_stats
.leave_v2
++;
190 memcpy(&group_addr
, igmp_msg
+ 4, sizeof(struct in_addr
));
192 if (PIM_DEBUG_IGMP_PACKETS
) {
193 pim_inet4_dump("<dst?>", group_addr
, group_str
,
195 zlog_debug("Recv IGMPv2 LEAVE from %s on %s for %s", from_str
,
196 ifp
->name
, group_str
);
201 * 7.3.2. In the Presence of Older Version Group Members
203 * When Group Compatibility Mode is IGMPv2, a router internally
204 * translates the following IGMPv2 messages for that group to their
205 * IGMPv3 equivalents:
207 * IGMPv2 Message IGMPv3 Equivalent
208 * -------------- -----------------
212 igmpv3_report_toin(igmp
, from
, group_addr
, 0, NULL
);