blob: 5a2aac17805ba99615ca187172655274010e6d57 [file] [log] [blame]
Sven Eckelmann0046b042016-01-01 00:01:03 +01001/* Copyright (C) 2014-2016 B.A.T.M.A.N. contributors:
Linus Lüssingc5caf4e2014-02-15 17:47:49 +01002 *
3 * Linus Lüssing
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of version 2 of the GNU General Public
7 * License as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, see <http://www.gnu.org/licenses/>.
16 */
17
Linus Lüssingc5caf4e2014-02-15 17:47:49 +010018#include "multicast.h"
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020019#include "main.h"
20
21#include <linux/atomic.h>
Linus Lüssing9c936e32015-06-16 17:10:25 +020022#include <linux/bitops.h>
Linus Lüssing8a4023c2015-06-16 17:10:26 +020023#include <linux/bug.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020024#include <linux/byteorder/generic.h>
25#include <linux/errno.h>
26#include <linux/etherdevice.h>
27#include <linux/fs.h>
Linus Lüssingbd2a9792016-05-10 18:41:24 +020028#include <linux/icmpv6.h>
Linus Lüssing687937a2016-05-10 18:41:25 +020029#include <linux/if_bridge.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020030#include <linux/if_ether.h>
Linus Lüssingbd2a9792016-05-10 18:41:24 +020031#include <linux/igmp.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020032#include <linux/in.h>
Linus Lüssingbd2a9792016-05-10 18:41:24 +020033#include <linux/in6.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020034#include <linux/ip.h>
35#include <linux/ipv6.h>
Linus Lüssing72f7b2d2016-05-10 18:41:26 +020036#include <linux/kernel.h>
Sven Eckelmann7c124392016-01-16 10:29:56 +010037#include <linux/kref.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020038#include <linux/list.h>
Sven Eckelmann2c72d652015-06-21 14:45:14 +020039#include <linux/lockdep.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020040#include <linux/netdevice.h>
Linus Lüssing687937a2016-05-10 18:41:25 +020041#include <linux/printk.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020042#include <linux/rculist.h>
43#include <linux/rcupdate.h>
Linus Lüssing4e3e8232016-05-10 18:41:27 +020044#include <linux/seq_file.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020045#include <linux/skbuff.h>
46#include <linux/slab.h>
47#include <linux/spinlock.h>
48#include <linux/stddef.h>
49#include <linux/string.h>
50#include <linux/types.h>
51#include <net/addrconf.h>
Linus Lüssing687937a2016-05-10 18:41:25 +020052#include <net/if_inet6.h>
53#include <net/ip.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020054#include <net/ipv6.h>
55
Linus Lüssing4e3e8232016-05-10 18:41:27 +020056#include "hard-interface.h"
57#include "hash.h"
Sven Eckelmannba412082016-05-15 23:48:31 +020058#include "log.h"
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020059#include "packet.h"
Linus Lüssingc5caf4e2014-02-15 17:47:49 +010060#include "translation-table.h"
Markus Pargmann1f8dce42016-05-15 11:07:43 +020061#include "tvlv.h"
Linus Lüssingc5caf4e2014-02-15 17:47:49 +010062
63/**
Linus Lüssing687937a2016-05-10 18:41:25 +020064 * batadv_mcast_get_bridge - get the bridge on top of the softif if it exists
65 * @soft_iface: netdev struct of the mesh interface
66 *
67 * If the given soft interface has a bridge on top then the refcount
68 * of the according net device is increased.
69 *
70 * Return: NULL if no such bridge exists. Otherwise the net device of the
71 * bridge.
72 */
73static struct net_device *batadv_mcast_get_bridge(struct net_device *soft_iface)
74{
75 struct net_device *upper = soft_iface;
76
77 rcu_read_lock();
78 do {
79 upper = netdev_master_upper_dev_get_rcu(upper);
80 } while (upper && !(upper->priv_flags & IFF_EBRIDGE));
81
82 if (upper)
83 dev_hold(upper);
84 rcu_read_unlock();
85
86 return upper;
87}
88
89/**
Linus Lüssingc5caf4e2014-02-15 17:47:49 +010090 * batadv_mcast_mla_softif_get - get softif multicast listeners
91 * @dev: the device to collect multicast addresses from
92 * @mcast_list: a list to put found addresses into
93 *
Linus Lüssing687937a2016-05-10 18:41:25 +020094 * Collects multicast addresses of multicast listeners residing
95 * on this kernel on the given soft interface, dev, in
96 * the given mcast_list. In general, multicast listeners provided by
97 * your multicast receiving applications run directly on this node.
98 *
99 * If there is a bridge interface on top of dev, collects from that one
100 * instead. Just like with IP addresses and routes, multicast listeners
101 * will(/should) register to the bridge interface instead of an
102 * enslaved bat0.
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100103 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200104 * Return: -ENOMEM on memory allocation error or the number of
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100105 * items added to the mcast_list otherwise.
106 */
107static int batadv_mcast_mla_softif_get(struct net_device *dev,
108 struct hlist_head *mcast_list)
109{
Linus Lüssing687937a2016-05-10 18:41:25 +0200110 struct net_device *bridge = batadv_mcast_get_bridge(dev);
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100111 struct netdev_hw_addr *mc_list_entry;
112 struct batadv_hw_addr *new;
113 int ret = 0;
114
Linus Lüssing687937a2016-05-10 18:41:25 +0200115 netif_addr_lock_bh(bridge ? bridge : dev);
116 netdev_for_each_mc_addr(mc_list_entry, bridge ? bridge : dev) {
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100117 new = kmalloc(sizeof(*new), GFP_ATOMIC);
118 if (!new) {
119 ret = -ENOMEM;
120 break;
121 }
122
123 ether_addr_copy(new->addr, mc_list_entry->addr);
124 hlist_add_head(&new->list, mcast_list);
125 ret++;
126 }
Linus Lüssing687937a2016-05-10 18:41:25 +0200127 netif_addr_unlock_bh(bridge ? bridge : dev);
128
129 if (bridge)
130 dev_put(bridge);
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100131
132 return ret;
133}
134
135/**
136 * batadv_mcast_mla_is_duplicate - check whether an address is in a list
137 * @mcast_addr: the multicast address to check
138 * @mcast_list: the list with multicast addresses to search in
139 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200140 * Return: true if the given address is already in the given list.
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100141 * Otherwise returns false.
142 */
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200143static bool batadv_mcast_mla_is_duplicate(u8 *mcast_addr,
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100144 struct hlist_head *mcast_list)
145{
146 struct batadv_hw_addr *mcast_entry;
147
148 hlist_for_each_entry(mcast_entry, mcast_list, list)
149 if (batadv_compare_eth(mcast_entry->addr, mcast_addr))
150 return true;
151
152 return false;
153}
154
155/**
Linus Lüssing687937a2016-05-10 18:41:25 +0200156 * batadv_mcast_mla_br_addr_cpy - copy a bridge multicast address
157 * @dst: destination to write to - a multicast MAC address
158 * @src: source to read from - a multicast IP address
159 *
160 * Converts a given multicast IPv4/IPv6 address from a bridge
161 * to its matching multicast MAC address and copies it into the given
162 * destination buffer.
163 *
164 * Caller needs to make sure the destination buffer can hold
165 * at least ETH_ALEN bytes.
166 */
167static void batadv_mcast_mla_br_addr_cpy(char *dst, const struct br_ip *src)
168{
169 if (src->proto == htons(ETH_P_IP))
170 ip_eth_mc_map(src->u.ip4, dst);
171#if IS_ENABLED(CONFIG_IPV6)
172 else if (src->proto == htons(ETH_P_IPV6))
173 ipv6_eth_mc_map(&src->u.ip6, dst);
174#endif
175 else
176 eth_zero_addr(dst);
177}
178
179/**
180 * batadv_mcast_mla_bridge_get - get bridged-in multicast listeners
181 * @dev: a bridge slave whose bridge to collect multicast addresses from
182 * @mcast_list: a list to put found addresses into
183 *
184 * Collects multicast addresses of multicast listeners residing
185 * on foreign, non-mesh devices which we gave access to our mesh via
186 * a bridge on top of the given soft interface, dev, in the given
187 * mcast_list.
188 *
189 * Return: -ENOMEM on memory allocation error or the number of
190 * items added to the mcast_list otherwise.
191 */
192static int batadv_mcast_mla_bridge_get(struct net_device *dev,
193 struct hlist_head *mcast_list)
194{
195 struct list_head bridge_mcast_list = LIST_HEAD_INIT(bridge_mcast_list);
196 struct br_ip_list *br_ip_entry, *tmp;
197 struct batadv_hw_addr *new;
198 u8 mcast_addr[ETH_ALEN];
199 int ret;
200
201 /* we don't need to detect these devices/listeners, the IGMP/MLD
202 * snooping code of the Linux bridge already does that for us
203 */
204 ret = br_multicast_list_adjacent(dev, &bridge_mcast_list);
205 if (ret < 0)
206 goto out;
207
208 list_for_each_entry(br_ip_entry, &bridge_mcast_list, list) {
209 batadv_mcast_mla_br_addr_cpy(mcast_addr, &br_ip_entry->addr);
210 if (batadv_mcast_mla_is_duplicate(mcast_addr, mcast_list))
211 continue;
212
213 new = kmalloc(sizeof(*new), GFP_ATOMIC);
214 if (!new) {
215 ret = -ENOMEM;
216 break;
217 }
218
219 ether_addr_copy(new->addr, mcast_addr);
220 hlist_add_head(&new->list, mcast_list);
221 }
222
223out:
224 list_for_each_entry_safe(br_ip_entry, tmp, &bridge_mcast_list, list) {
225 list_del(&br_ip_entry->list);
226 kfree(br_ip_entry);
227 }
228
229 return ret;
230}
231
232/**
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100233 * batadv_mcast_mla_list_free - free a list of multicast addresses
Sven Eckelmann2c72d652015-06-21 14:45:14 +0200234 * @bat_priv: the bat priv with all the soft interface information
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100235 * @mcast_list: the list to free
236 *
237 * Removes and frees all items in the given mcast_list.
238 */
Sven Eckelmann2c72d652015-06-21 14:45:14 +0200239static void batadv_mcast_mla_list_free(struct batadv_priv *bat_priv,
240 struct hlist_head *mcast_list)
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100241{
242 struct batadv_hw_addr *mcast_entry;
243 struct hlist_node *tmp;
244
Sven Eckelmann2c72d652015-06-21 14:45:14 +0200245 lockdep_assert_held(&bat_priv->tt.commit_lock);
246
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100247 hlist_for_each_entry_safe(mcast_entry, tmp, mcast_list, list) {
248 hlist_del(&mcast_entry->list);
249 kfree(mcast_entry);
250 }
251}
252
253/**
254 * batadv_mcast_mla_tt_retract - clean up multicast listener announcements
255 * @bat_priv: the bat priv with all the soft interface information
256 * @mcast_list: a list of addresses which should _not_ be removed
257 *
258 * Retracts the announcement of any multicast listener from the
259 * translation table except the ones listed in the given mcast_list.
260 *
261 * If mcast_list is NULL then all are retracted.
262 */
263static void batadv_mcast_mla_tt_retract(struct batadv_priv *bat_priv,
264 struct hlist_head *mcast_list)
265{
266 struct batadv_hw_addr *mcast_entry;
267 struct hlist_node *tmp;
268
Sven Eckelmann2c72d652015-06-21 14:45:14 +0200269 lockdep_assert_held(&bat_priv->tt.commit_lock);
270
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100271 hlist_for_each_entry_safe(mcast_entry, tmp, &bat_priv->mcast.mla_list,
272 list) {
273 if (mcast_list &&
274 batadv_mcast_mla_is_duplicate(mcast_entry->addr,
275 mcast_list))
276 continue;
277
278 batadv_tt_local_remove(bat_priv, mcast_entry->addr,
279 BATADV_NO_FLAGS,
280 "mcast TT outdated", false);
281
282 hlist_del(&mcast_entry->list);
283 kfree(mcast_entry);
284 }
285}
286
287/**
288 * batadv_mcast_mla_tt_add - add multicast listener announcements
289 * @bat_priv: the bat priv with all the soft interface information
290 * @mcast_list: a list of addresses which are going to get added
291 *
292 * Adds multicast listener announcements from the given mcast_list to the
293 * translation table if they have not been added yet.
294 */
295static void batadv_mcast_mla_tt_add(struct batadv_priv *bat_priv,
296 struct hlist_head *mcast_list)
297{
298 struct batadv_hw_addr *mcast_entry;
299 struct hlist_node *tmp;
300
Sven Eckelmann2c72d652015-06-21 14:45:14 +0200301 lockdep_assert_held(&bat_priv->tt.commit_lock);
302
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100303 if (!mcast_list)
304 return;
305
306 hlist_for_each_entry_safe(mcast_entry, tmp, mcast_list, list) {
307 if (batadv_mcast_mla_is_duplicate(mcast_entry->addr,
308 &bat_priv->mcast.mla_list))
309 continue;
310
311 if (!batadv_tt_local_add(bat_priv->soft_iface,
312 mcast_entry->addr, BATADV_NO_FLAGS,
313 BATADV_NULL_IFINDEX, BATADV_NO_MARK))
314 continue;
315
316 hlist_del(&mcast_entry->list);
317 hlist_add_head(&mcast_entry->list, &bat_priv->mcast.mla_list);
318 }
319}
320
321/**
322 * batadv_mcast_has_bridge - check whether the soft-iface is bridged
323 * @bat_priv: the bat priv with all the soft interface information
324 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200325 * Checks whether there is a bridge on top of our soft interface.
326 *
327 * Return: true if there is a bridge, false otherwise.
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100328 */
329static bool batadv_mcast_has_bridge(struct batadv_priv *bat_priv)
330{
331 struct net_device *upper = bat_priv->soft_iface;
332
333 rcu_read_lock();
334 do {
335 upper = netdev_master_upper_dev_get_rcu(upper);
336 } while (upper && !(upper->priv_flags & IFF_EBRIDGE));
337 rcu_read_unlock();
338
339 return upper;
340}
341
342/**
Linus Lüssing72f7b2d2016-05-10 18:41:26 +0200343 * batadv_mcast_querier_log - debug output regarding the querier status on link
344 * @bat_priv: the bat priv with all the soft interface information
345 * @str_proto: a string for the querier protocol (e.g. "IGMP" or "MLD")
346 * @old_state: the previous querier state on our link
347 * @new_state: the new querier state on our link
348 *
349 * Outputs debug messages to the logging facility with log level 'mcast'
350 * regarding changes to the querier status on the link which are relevant
351 * to our multicast optimizations.
352 *
353 * Usually this is about whether a querier appeared or vanished in
354 * our mesh or whether the querier is in the suboptimal position of being
355 * behind our local bridge segment: Snooping switches will directly
356 * forward listener reports to the querier, therefore batman-adv and
357 * the bridge will potentially not see these listeners - the querier is
358 * potentially shadowing listeners from us then.
359 *
360 * This is only interesting for nodes with a bridge on top of their
361 * soft interface.
362 */
363static void
364batadv_mcast_querier_log(struct batadv_priv *bat_priv, char *str_proto,
365 struct batadv_mcast_querier_state *old_state,
366 struct batadv_mcast_querier_state *new_state)
367{
368 if (!old_state->exists && new_state->exists)
369 batadv_info(bat_priv->soft_iface, "%s Querier appeared\n",
370 str_proto);
371 else if (old_state->exists && !new_state->exists)
372 batadv_info(bat_priv->soft_iface,
373 "%s Querier disappeared - multicast optimizations disabled\n",
374 str_proto);
375 else if (!bat_priv->mcast.bridged && !new_state->exists)
376 batadv_info(bat_priv->soft_iface,
377 "No %s Querier present - multicast optimizations disabled\n",
378 str_proto);
379
380 if (new_state->exists) {
381 if ((!old_state->shadowing && new_state->shadowing) ||
382 (!old_state->exists && new_state->shadowing))
383 batadv_dbg(BATADV_DBG_MCAST, bat_priv,
384 "%s Querier is behind our bridged segment: Might shadow listeners\n",
385 str_proto);
386 else if (old_state->shadowing && !new_state->shadowing)
387 batadv_dbg(BATADV_DBG_MCAST, bat_priv,
388 "%s Querier is not behind our bridged segment\n",
389 str_proto);
390 }
391}
392
393/**
394 * batadv_mcast_bridge_log - debug output for topology changes in bridged setups
395 * @bat_priv: the bat priv with all the soft interface information
396 * @bridged: a flag about whether the soft interface is currently bridged or not
397 * @querier_ipv4: (maybe) new status of a potential, selected IGMP querier
398 * @querier_ipv6: (maybe) new status of a potential, selected MLD querier
399 *
400 * If no bridges are ever used on this node, then this function does nothing.
401 *
402 * Otherwise this function outputs debug information to the 'mcast' log level
403 * which might be relevant to our multicast optimizations.
404 *
405 * More precisely, it outputs information when a bridge interface is added or
406 * removed from a soft interface. And when a bridge is present, it further
407 * outputs information about the querier state which is relevant for the
408 * multicast flags this node is going to set.
409 */
410static void
411batadv_mcast_bridge_log(struct batadv_priv *bat_priv, bool bridged,
412 struct batadv_mcast_querier_state *querier_ipv4,
413 struct batadv_mcast_querier_state *querier_ipv6)
414{
415 if (!bat_priv->mcast.bridged && bridged)
416 batadv_dbg(BATADV_DBG_MCAST, bat_priv,
417 "Bridge added: Setting Unsnoopables(U)-flag\n");
418 else if (bat_priv->mcast.bridged && !bridged)
419 batadv_dbg(BATADV_DBG_MCAST, bat_priv,
420 "Bridge removed: Unsetting Unsnoopables(U)-flag\n");
421
422 if (bridged) {
423 batadv_mcast_querier_log(bat_priv, "IGMP",
424 &bat_priv->mcast.querier_ipv4,
425 querier_ipv4);
426 batadv_mcast_querier_log(bat_priv, "MLD",
427 &bat_priv->mcast.querier_ipv6,
428 querier_ipv6);
429 }
430}
431
432/**
433 * batadv_mcast_flags_logs - output debug information about mcast flag changes
434 * @bat_priv: the bat priv with all the soft interface information
435 * @flags: flags indicating the new multicast state
436 *
437 * Whenever the multicast flags this nodes announces changes (@mcast_flags vs.
438 * bat_priv->mcast.flags), this notifies userspace via the 'mcast' log level.
439 */
440static void batadv_mcast_flags_log(struct batadv_priv *bat_priv, u8 flags)
441{
442 u8 old_flags = bat_priv->mcast.flags;
443 char str_old_flags[] = "[...]";
444
445 sprintf(str_old_flags, "[%c%c%c]",
446 (old_flags & BATADV_MCAST_WANT_ALL_UNSNOOPABLES) ? 'U' : '.',
447 (old_flags & BATADV_MCAST_WANT_ALL_IPV4) ? '4' : '.',
448 (old_flags & BATADV_MCAST_WANT_ALL_IPV6) ? '6' : '.');
449
450 batadv_dbg(BATADV_DBG_MCAST, bat_priv,
451 "Changing multicast flags from '%s' to '[%c%c%c]'\n",
452 bat_priv->mcast.enabled ? str_old_flags : "<undefined>",
453 (flags & BATADV_MCAST_WANT_ALL_UNSNOOPABLES) ? 'U' : '.',
454 (flags & BATADV_MCAST_WANT_ALL_IPV4) ? '4' : '.',
455 (flags & BATADV_MCAST_WANT_ALL_IPV6) ? '6' : '.');
456}
457
458/**
Linus Lüssing60432d72014-02-15 17:47:51 +0100459 * batadv_mcast_mla_tvlv_update - update multicast tvlv
460 * @bat_priv: the bat priv with all the soft interface information
461 *
462 * Updates the own multicast tvlv with our current multicast related settings,
463 * capabilities and inabilities.
464 *
Linus Lüssing687937a2016-05-10 18:41:25 +0200465 * Return: false if we want all IPv4 && IPv6 multicast traffic and true
466 * otherwise.
Linus Lüssing60432d72014-02-15 17:47:51 +0100467 */
468static bool batadv_mcast_mla_tvlv_update(struct batadv_priv *bat_priv)
469{
470 struct batadv_tvlv_mcast_data mcast_data;
Linus Lüssing687937a2016-05-10 18:41:25 +0200471 struct batadv_mcast_querier_state querier4 = {false, false};
472 struct batadv_mcast_querier_state querier6 = {false, false};
473 struct net_device *dev = bat_priv->soft_iface;
Linus Lüssing72f7b2d2016-05-10 18:41:26 +0200474 bool bridged;
Linus Lüssing60432d72014-02-15 17:47:51 +0100475
476 mcast_data.flags = BATADV_NO_FLAGS;
477 memset(mcast_data.reserved, 0, sizeof(mcast_data.reserved));
478
Linus Lüssing72f7b2d2016-05-10 18:41:26 +0200479 bridged = batadv_mcast_has_bridge(bat_priv);
480 if (!bridged)
Linus Lüssing687937a2016-05-10 18:41:25 +0200481 goto update;
482
483#if !IS_ENABLED(CONFIG_BRIDGE_IGMP_SNOOPING)
484 pr_warn_once("No bridge IGMP snooping compiled - multicast optimizations disabled\n");
485#endif
486
487 querier4.exists = br_multicast_has_querier_anywhere(dev, ETH_P_IP);
488 querier4.shadowing = br_multicast_has_querier_adjacent(dev, ETH_P_IP);
489
490 querier6.exists = br_multicast_has_querier_anywhere(dev, ETH_P_IPV6);
491 querier6.shadowing = br_multicast_has_querier_adjacent(dev, ETH_P_IPV6);
492
493 mcast_data.flags |= BATADV_MCAST_WANT_ALL_UNSNOOPABLES;
494
495 /* 1) If no querier exists at all, then multicast listeners on
496 * our local TT clients behind the bridge will keep silent.
497 * 2) If the selected querier is on one of our local TT clients,
498 * behind the bridge, then this querier might shadow multicast
499 * listeners on our local TT clients, behind this bridge.
500 *
501 * In both cases, we will signalize other batman nodes that
502 * we need all multicast traffic of the according protocol.
Linus Lüssing60432d72014-02-15 17:47:51 +0100503 */
Linus Lüssing687937a2016-05-10 18:41:25 +0200504 if (!querier4.exists || querier4.shadowing)
505 mcast_data.flags |= BATADV_MCAST_WANT_ALL_IPV4;
Linus Lüssing60432d72014-02-15 17:47:51 +0100506
Linus Lüssing687937a2016-05-10 18:41:25 +0200507 if (!querier6.exists || querier6.shadowing)
508 mcast_data.flags |= BATADV_MCAST_WANT_ALL_IPV6;
Linus Lüssing60432d72014-02-15 17:47:51 +0100509
Linus Lüssing687937a2016-05-10 18:41:25 +0200510update:
Linus Lüssing72f7b2d2016-05-10 18:41:26 +0200511 batadv_mcast_bridge_log(bat_priv, bridged, &querier4, &querier6);
512
513 bat_priv->mcast.querier_ipv4.exists = querier4.exists;
514 bat_priv->mcast.querier_ipv4.shadowing = querier4.shadowing;
515
516 bat_priv->mcast.querier_ipv6.exists = querier6.exists;
517 bat_priv->mcast.querier_ipv6.shadowing = querier6.shadowing;
518
519 bat_priv->mcast.bridged = bridged;
520
Linus Lüssing60432d72014-02-15 17:47:51 +0100521 if (!bat_priv->mcast.enabled ||
522 mcast_data.flags != bat_priv->mcast.flags) {
Linus Lüssing72f7b2d2016-05-10 18:41:26 +0200523 batadv_mcast_flags_log(bat_priv, mcast_data.flags);
Linus Lüssingbd2a9792016-05-10 18:41:24 +0200524 batadv_tvlv_container_register(bat_priv, BATADV_TVLV_MCAST, 2,
Linus Lüssing60432d72014-02-15 17:47:51 +0100525 &mcast_data, sizeof(mcast_data));
526 bat_priv->mcast.flags = mcast_data.flags;
527 bat_priv->mcast.enabled = true;
528 }
529
Linus Lüssing585f1ef2018-03-04 13:08:17 +0100530 return !(mcast_data.flags & BATADV_MCAST_WANT_ALL_IPV4 &&
531 mcast_data.flags & BATADV_MCAST_WANT_ALL_IPV6);
Linus Lüssing60432d72014-02-15 17:47:51 +0100532}
533
534/**
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100535 * batadv_mcast_mla_update - update the own MLAs
536 * @bat_priv: the bat priv with all the soft interface information
537 *
Linus Lüssing60432d72014-02-15 17:47:51 +0100538 * Updates the own multicast listener announcements in the translation
539 * table as well as the own, announced multicast tvlv container.
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100540 */
541void batadv_mcast_mla_update(struct batadv_priv *bat_priv)
542{
543 struct net_device *soft_iface = bat_priv->soft_iface;
544 struct hlist_head mcast_list = HLIST_HEAD_INIT;
545 int ret;
546
Linus Lüssing60432d72014-02-15 17:47:51 +0100547 if (!batadv_mcast_mla_tvlv_update(bat_priv))
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100548 goto update;
549
550 ret = batadv_mcast_mla_softif_get(soft_iface, &mcast_list);
551 if (ret < 0)
552 goto out;
553
Linus Lüssing687937a2016-05-10 18:41:25 +0200554 ret = batadv_mcast_mla_bridge_get(soft_iface, &mcast_list);
555 if (ret < 0)
556 goto out;
557
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100558update:
559 batadv_mcast_mla_tt_retract(bat_priv, &mcast_list);
560 batadv_mcast_mla_tt_add(bat_priv, &mcast_list);
561
562out:
Sven Eckelmann2c72d652015-06-21 14:45:14 +0200563 batadv_mcast_mla_list_free(bat_priv, &mcast_list);
Linus Lüssingc5caf4e2014-02-15 17:47:49 +0100564}
565
566/**
Linus Lüssingbd2a9792016-05-10 18:41:24 +0200567 * batadv_mcast_is_report_ipv4 - check for IGMP reports
568 * @skb: the ethernet frame destined for the mesh
569 *
570 * This call might reallocate skb data.
571 *
572 * Checks whether the given frame is a valid IGMP report.
573 *
574 * Return: If so then true, otherwise false.
575 */
576static bool batadv_mcast_is_report_ipv4(struct sk_buff *skb)
577{
578 if (ip_mc_check_igmp(skb, NULL) < 0)
579 return false;
580
581 switch (igmp_hdr(skb)->type) {
582 case IGMP_HOST_MEMBERSHIP_REPORT:
583 case IGMPV2_HOST_MEMBERSHIP_REPORT:
584 case IGMPV3_HOST_MEMBERSHIP_REPORT:
585 return true;
586 }
587
588 return false;
589}
590
591/**
Linus Lüssingab498862014-02-15 17:47:53 +0100592 * batadv_mcast_forw_mode_check_ipv4 - check for optimized forwarding potential
593 * @bat_priv: the bat priv with all the soft interface information
594 * @skb: the IPv4 packet to check
595 * @is_unsnoopable: stores whether the destination is snoopable
596 *
597 * Checks whether the given IPv4 packet has the potential to be forwarded with a
598 * mode more optimal than classic flooding.
599 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200600 * Return: If so then 0. Otherwise -EINVAL or -ENOMEM in case of memory
601 * allocation failure.
Linus Lüssingab498862014-02-15 17:47:53 +0100602 */
603static int batadv_mcast_forw_mode_check_ipv4(struct batadv_priv *bat_priv,
604 struct sk_buff *skb,
605 bool *is_unsnoopable)
606{
607 struct iphdr *iphdr;
608
609 /* We might fail due to out-of-memory -> drop it */
610 if (!pskb_may_pull(skb, sizeof(struct ethhdr) + sizeof(*iphdr)))
611 return -ENOMEM;
612
Linus Lüssingbd2a9792016-05-10 18:41:24 +0200613 if (batadv_mcast_is_report_ipv4(skb))
614 return -EINVAL;
615
Linus Lüssingab498862014-02-15 17:47:53 +0100616 iphdr = ip_hdr(skb);
617
618 /* TODO: Implement Multicast Router Discovery (RFC4286),
619 * then allow scope > link local, too
620 */
621 if (!ipv4_is_local_multicast(iphdr->daddr))
622 return -EINVAL;
623
624 /* link-local multicast listeners behind a bridge are
625 * not snoopable (see RFC4541, section 2.1.2.2)
626 */
627 *is_unsnoopable = true;
628
629 return 0;
630}
631
Linus Lüssingbd2a9792016-05-10 18:41:24 +0200632#if IS_ENABLED(CONFIG_IPV6)
633/**
634 * batadv_mcast_is_report_ipv6 - check for MLD reports
635 * @skb: the ethernet frame destined for the mesh
636 *
637 * This call might reallocate skb data.
638 *
639 * Checks whether the given frame is a valid MLD report.
640 *
641 * Return: If so then true, otherwise false.
642 */
643static bool batadv_mcast_is_report_ipv6(struct sk_buff *skb)
644{
645 if (ipv6_mc_check_mld(skb, NULL) < 0)
646 return false;
647
648 switch (icmp6_hdr(skb)->icmp6_type) {
649 case ICMPV6_MGM_REPORT:
650 case ICMPV6_MLD2_REPORT:
651 return true;
652 }
653
654 return false;
655}
656
Linus Lüssingab498862014-02-15 17:47:53 +0100657/**
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100658 * batadv_mcast_forw_mode_check_ipv6 - check for optimized forwarding potential
659 * @bat_priv: the bat priv with all the soft interface information
660 * @skb: the IPv6 packet to check
Linus Lüssingab498862014-02-15 17:47:53 +0100661 * @is_unsnoopable: stores whether the destination is snoopable
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100662 *
663 * Checks whether the given IPv6 packet has the potential to be forwarded with a
664 * mode more optimal than classic flooding.
665 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200666 * Return: If so then 0. Otherwise -EINVAL is or -ENOMEM if we are out of memory
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100667 */
668static int batadv_mcast_forw_mode_check_ipv6(struct batadv_priv *bat_priv,
Linus Lüssingab498862014-02-15 17:47:53 +0100669 struct sk_buff *skb,
670 bool *is_unsnoopable)
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100671{
672 struct ipv6hdr *ip6hdr;
673
674 /* We might fail due to out-of-memory -> drop it */
675 if (!pskb_may_pull(skb, sizeof(struct ethhdr) + sizeof(*ip6hdr)))
676 return -ENOMEM;
677
Linus Lüssingbd2a9792016-05-10 18:41:24 +0200678 if (batadv_mcast_is_report_ipv6(skb))
679 return -EINVAL;
680
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100681 ip6hdr = ipv6_hdr(skb);
682
683 /* TODO: Implement Multicast Router Discovery (RFC4286),
684 * then allow scope > link local, too
685 */
686 if (IPV6_ADDR_MC_SCOPE(&ip6hdr->daddr) != IPV6_ADDR_SCOPE_LINKLOCAL)
687 return -EINVAL;
688
689 /* link-local-all-nodes multicast listeners behind a bridge are
690 * not snoopable (see RFC4541, section 3, paragraph 3)
691 */
692 if (ipv6_addr_is_ll_all_nodes(&ip6hdr->daddr))
Linus Lüssingab498862014-02-15 17:47:53 +0100693 *is_unsnoopable = true;
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100694
695 return 0;
696}
Linus Lüssingbd2a9792016-05-10 18:41:24 +0200697#endif
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100698
699/**
700 * batadv_mcast_forw_mode_check - check for optimized forwarding potential
701 * @bat_priv: the bat priv with all the soft interface information
702 * @skb: the multicast frame to check
Linus Lüssingab498862014-02-15 17:47:53 +0100703 * @is_unsnoopable: stores whether the destination is snoopable
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100704 *
705 * Checks whether the given multicast ethernet frame has the potential to be
706 * forwarded with a mode more optimal than classic flooding.
707 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200708 * Return: If so then 0. Otherwise -EINVAL is or -ENOMEM if we are out of memory
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100709 */
710static int batadv_mcast_forw_mode_check(struct batadv_priv *bat_priv,
Linus Lüssingab498862014-02-15 17:47:53 +0100711 struct sk_buff *skb,
712 bool *is_unsnoopable)
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100713{
714 struct ethhdr *ethhdr = eth_hdr(skb);
715
716 if (!atomic_read(&bat_priv->multicast_mode))
717 return -EINVAL;
718
719 if (atomic_read(&bat_priv->mcast.num_disabled))
720 return -EINVAL;
721
722 switch (ntohs(ethhdr->h_proto)) {
Linus Lüssingab498862014-02-15 17:47:53 +0100723 case ETH_P_IP:
724 return batadv_mcast_forw_mode_check_ipv4(bat_priv, skb,
725 is_unsnoopable);
Linus Lüssingbd2a9792016-05-10 18:41:24 +0200726#if IS_ENABLED(CONFIG_IPV6)
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100727 case ETH_P_IPV6:
Linus Lüssingab498862014-02-15 17:47:53 +0100728 return batadv_mcast_forw_mode_check_ipv6(bat_priv, skb,
729 is_unsnoopable);
Linus Lüssingbd2a9792016-05-10 18:41:24 +0200730#endif
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100731 default:
732 return -EINVAL;
733 }
734}
735
736/**
Antonio Quartulli6d030de2016-03-11 16:36:19 +0100737 * batadv_mcast_forw_want_all_ip_count - count nodes with unspecific mcast
738 * interest
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100739 * @bat_priv: the bat priv with all the soft interface information
740 * @ethhdr: ethernet header of a packet
741 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200742 * Return: the number of nodes which want all IPv4 multicast traffic if the
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100743 * given ethhdr is from an IPv4 packet or the number of nodes which want all
744 * IPv6 traffic if it matches an IPv6 packet.
745 */
746static int batadv_mcast_forw_want_all_ip_count(struct batadv_priv *bat_priv,
747 struct ethhdr *ethhdr)
748{
749 switch (ntohs(ethhdr->h_proto)) {
750 case ETH_P_IP:
751 return atomic_read(&bat_priv->mcast.num_want_all_ipv4);
752 case ETH_P_IPV6:
753 return atomic_read(&bat_priv->mcast.num_want_all_ipv6);
754 default:
755 /* we shouldn't be here... */
756 return 0;
757 }
758}
759
760/**
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100761 * batadv_mcast_forw_tt_node_get - get a multicast tt node
762 * @bat_priv: the bat priv with all the soft interface information
763 * @ethhdr: the ether header containing the multicast destination
764 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200765 * Return: an orig_node matching the multicast address provided by ethhdr
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100766 * via a translation table lookup. This increases the returned nodes refcount.
767 */
768static struct batadv_orig_node *
769batadv_mcast_forw_tt_node_get(struct batadv_priv *bat_priv,
770 struct ethhdr *ethhdr)
771{
Linus Lüssing00a7d832018-03-20 03:13:27 +0100772 return batadv_transtable_search(bat_priv, NULL, ethhdr->h_dest,
773 BATADV_NO_FLAGS);
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100774}
775
776/**
Antonio Quartulli6d030de2016-03-11 16:36:19 +0100777 * batadv_mcast_forw_ipv4_node_get - get a node with an ipv4 flag
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100778 * @bat_priv: the bat priv with all the soft interface information
779 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200780 * Return: an orig_node which has the BATADV_MCAST_WANT_ALL_IPV4 flag set and
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100781 * increases its refcount.
782 */
783static struct batadv_orig_node *
784batadv_mcast_forw_ipv4_node_get(struct batadv_priv *bat_priv)
785{
786 struct batadv_orig_node *tmp_orig_node, *orig_node = NULL;
787
788 rcu_read_lock();
789 hlist_for_each_entry_rcu(tmp_orig_node,
790 &bat_priv->mcast.want_all_ipv4_list,
791 mcast_want_all_ipv4_node) {
Sven Eckelmann7c124392016-01-16 10:29:56 +0100792 if (!kref_get_unless_zero(&tmp_orig_node->refcount))
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100793 continue;
794
795 orig_node = tmp_orig_node;
796 break;
797 }
798 rcu_read_unlock();
799
800 return orig_node;
801}
802
803/**
Antonio Quartulli6d030de2016-03-11 16:36:19 +0100804 * batadv_mcast_forw_ipv6_node_get - get a node with an ipv6 flag
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100805 * @bat_priv: the bat priv with all the soft interface information
806 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200807 * Return: an orig_node which has the BATADV_MCAST_WANT_ALL_IPV6 flag set
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100808 * and increases its refcount.
809 */
810static struct batadv_orig_node *
811batadv_mcast_forw_ipv6_node_get(struct batadv_priv *bat_priv)
812{
813 struct batadv_orig_node *tmp_orig_node, *orig_node = NULL;
814
815 rcu_read_lock();
816 hlist_for_each_entry_rcu(tmp_orig_node,
817 &bat_priv->mcast.want_all_ipv6_list,
818 mcast_want_all_ipv6_node) {
Sven Eckelmann7c124392016-01-16 10:29:56 +0100819 if (!kref_get_unless_zero(&tmp_orig_node->refcount))
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100820 continue;
821
822 orig_node = tmp_orig_node;
823 break;
824 }
825 rcu_read_unlock();
826
827 return orig_node;
828}
829
830/**
Antonio Quartulli6d030de2016-03-11 16:36:19 +0100831 * batadv_mcast_forw_ip_node_get - get a node with an ipv4/ipv6 flag
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100832 * @bat_priv: the bat priv with all the soft interface information
833 * @ethhdr: an ethernet header to determine the protocol family from
834 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200835 * Return: an orig_node which has the BATADV_MCAST_WANT_ALL_IPV4 or
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100836 * BATADV_MCAST_WANT_ALL_IPV6 flag, depending on the provided ethhdr, set and
837 * increases its refcount.
838 */
839static struct batadv_orig_node *
840batadv_mcast_forw_ip_node_get(struct batadv_priv *bat_priv,
841 struct ethhdr *ethhdr)
842{
843 switch (ntohs(ethhdr->h_proto)) {
844 case ETH_P_IP:
845 return batadv_mcast_forw_ipv4_node_get(bat_priv);
846 case ETH_P_IPV6:
847 return batadv_mcast_forw_ipv6_node_get(bat_priv);
848 default:
849 /* we shouldn't be here... */
850 return NULL;
851 }
852}
853
854/**
Antonio Quartulli6d030de2016-03-11 16:36:19 +0100855 * batadv_mcast_forw_unsnoop_node_get - get a node with an unsnoopable flag
Linus Lüssingab498862014-02-15 17:47:53 +0100856 * @bat_priv: the bat priv with all the soft interface information
857 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200858 * Return: an orig_node which has the BATADV_MCAST_WANT_ALL_UNSNOOPABLES flag
Linus Lüssingab498862014-02-15 17:47:53 +0100859 * set and increases its refcount.
860 */
861static struct batadv_orig_node *
862batadv_mcast_forw_unsnoop_node_get(struct batadv_priv *bat_priv)
863{
864 struct batadv_orig_node *tmp_orig_node, *orig_node = NULL;
865
866 rcu_read_lock();
867 hlist_for_each_entry_rcu(tmp_orig_node,
868 &bat_priv->mcast.want_all_unsnoopables_list,
869 mcast_want_all_unsnoopables_node) {
Sven Eckelmann7c124392016-01-16 10:29:56 +0100870 if (!kref_get_unless_zero(&tmp_orig_node->refcount))
Linus Lüssingab498862014-02-15 17:47:53 +0100871 continue;
872
873 orig_node = tmp_orig_node;
874 break;
875 }
876 rcu_read_unlock();
877
878 return orig_node;
879}
880
881/**
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100882 * batadv_mcast_forw_mode - check on how to forward a multicast packet
883 * @bat_priv: the bat priv with all the soft interface information
884 * @skb: The multicast packet to check
885 * @orig: an originator to be set to forward the skb to
886 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200887 * Return: the forwarding mode as enum batadv_forw_mode and in case of
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100888 * BATADV_FORW_SINGLE set the orig to the single originator the skb
889 * should be forwarded to.
890 */
891enum batadv_forw_mode
892batadv_mcast_forw_mode(struct batadv_priv *bat_priv, struct sk_buff *skb,
893 struct batadv_orig_node **orig)
894{
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100895 int ret, tt_count, ip_count, unsnoop_count, total_count;
Linus Lüssingab498862014-02-15 17:47:53 +0100896 bool is_unsnoopable = false;
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100897 struct ethhdr *ethhdr;
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100898
Linus Lüssingab498862014-02-15 17:47:53 +0100899 ret = batadv_mcast_forw_mode_check(bat_priv, skb, &is_unsnoopable);
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100900 if (ret == -ENOMEM)
901 return BATADV_FORW_NONE;
902 else if (ret < 0)
903 return BATADV_FORW_ALL;
904
905 ethhdr = eth_hdr(skb);
906
907 tt_count = batadv_tt_global_hash_count(bat_priv, ethhdr->h_dest,
908 BATADV_NO_FLAGS);
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100909 ip_count = batadv_mcast_forw_want_all_ip_count(bat_priv, ethhdr);
Linus Lüssingab498862014-02-15 17:47:53 +0100910 unsnoop_count = !is_unsnoopable ? 0 :
911 atomic_read(&bat_priv->mcast.num_want_all_unsnoopables);
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100912
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100913 total_count = tt_count + ip_count + unsnoop_count;
Linus Lüssingab498862014-02-15 17:47:53 +0100914
915 switch (total_count) {
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100916 case 1:
Linus Lüssingab498862014-02-15 17:47:53 +0100917 if (tt_count)
918 *orig = batadv_mcast_forw_tt_node_get(bat_priv, ethhdr);
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100919 else if (ip_count)
920 *orig = batadv_mcast_forw_ip_node_get(bat_priv, ethhdr);
Linus Lüssingab498862014-02-15 17:47:53 +0100921 else if (unsnoop_count)
922 *orig = batadv_mcast_forw_unsnoop_node_get(bat_priv);
923
Linus Lüssing1d8ab8d2014-02-15 17:47:52 +0100924 if (*orig)
925 return BATADV_FORW_SINGLE;
926
927 /* fall through */
928 case 0:
929 return BATADV_FORW_NONE;
930 default:
931 return BATADV_FORW_ALL;
932 }
933}
934
935/**
Linus Lüssingab498862014-02-15 17:47:53 +0100936 * batadv_mcast_want_unsnoop_update - update unsnoop counter and list
937 * @bat_priv: the bat priv with all the soft interface information
938 * @orig: the orig_node which multicast state might have changed of
939 * @mcast_flags: flags indicating the new multicast state
940 *
941 * If the BATADV_MCAST_WANT_ALL_UNSNOOPABLES flag of this originator,
942 * orig, has toggled then this method updates counter and list accordingly.
Linus Lüssing8a4023c2015-06-16 17:10:26 +0200943 *
944 * Caller needs to hold orig->mcast_handler_lock.
Linus Lüssingab498862014-02-15 17:47:53 +0100945 */
946static void batadv_mcast_want_unsnoop_update(struct batadv_priv *bat_priv,
947 struct batadv_orig_node *orig,
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200948 u8 mcast_flags)
Linus Lüssingab498862014-02-15 17:47:53 +0100949{
Linus Lüssing8a4023c2015-06-16 17:10:26 +0200950 struct hlist_node *node = &orig->mcast_want_all_unsnoopables_node;
951 struct hlist_head *head = &bat_priv->mcast.want_all_unsnoopables_list;
952
Sven Eckelmann5274cd62015-06-21 14:45:15 +0200953 lockdep_assert_held(&orig->mcast_handler_lock);
954
Linus Lüssingab498862014-02-15 17:47:53 +0100955 /* switched from flag unset to set */
956 if (mcast_flags & BATADV_MCAST_WANT_ALL_UNSNOOPABLES &&
957 !(orig->mcast_flags & BATADV_MCAST_WANT_ALL_UNSNOOPABLES)) {
958 atomic_inc(&bat_priv->mcast.num_want_all_unsnoopables);
959
960 spin_lock_bh(&bat_priv->mcast.want_lists_lock);
Linus Lüssing8a4023c2015-06-16 17:10:26 +0200961 /* flag checks above + mcast_handler_lock prevents this */
962 WARN_ON(!hlist_unhashed(node));
963
964 hlist_add_head_rcu(node, head);
Linus Lüssingab498862014-02-15 17:47:53 +0100965 spin_unlock_bh(&bat_priv->mcast.want_lists_lock);
966 /* switched from flag set to unset */
967 } else if (!(mcast_flags & BATADV_MCAST_WANT_ALL_UNSNOOPABLES) &&
968 orig->mcast_flags & BATADV_MCAST_WANT_ALL_UNSNOOPABLES) {
969 atomic_dec(&bat_priv->mcast.num_want_all_unsnoopables);
970
971 spin_lock_bh(&bat_priv->mcast.want_lists_lock);
Linus Lüssing8a4023c2015-06-16 17:10:26 +0200972 /* flag checks above + mcast_handler_lock prevents this */
973 WARN_ON(hlist_unhashed(node));
974
975 hlist_del_init_rcu(node);
Linus Lüssingab498862014-02-15 17:47:53 +0100976 spin_unlock_bh(&bat_priv->mcast.want_lists_lock);
977 }
978}
979
980/**
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100981 * batadv_mcast_want_ipv4_update - update want-all-ipv4 counter and list
982 * @bat_priv: the bat priv with all the soft interface information
983 * @orig: the orig_node which multicast state might have changed of
984 * @mcast_flags: flags indicating the new multicast state
985 *
986 * If the BATADV_MCAST_WANT_ALL_IPV4 flag of this originator, orig, has
987 * toggled then this method updates counter and list accordingly.
Linus Lüssing8a4023c2015-06-16 17:10:26 +0200988 *
989 * Caller needs to hold orig->mcast_handler_lock.
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100990 */
991static void batadv_mcast_want_ipv4_update(struct batadv_priv *bat_priv,
992 struct batadv_orig_node *orig,
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200993 u8 mcast_flags)
Linus Lüssing4c8755d2014-02-15 17:47:54 +0100994{
Linus Lüssing8a4023c2015-06-16 17:10:26 +0200995 struct hlist_node *node = &orig->mcast_want_all_ipv4_node;
996 struct hlist_head *head = &bat_priv->mcast.want_all_ipv4_list;
997
Sven Eckelmann5274cd62015-06-21 14:45:15 +0200998 lockdep_assert_held(&orig->mcast_handler_lock);
999
Linus Lüssing4c8755d2014-02-15 17:47:54 +01001000 /* switched from flag unset to set */
1001 if (mcast_flags & BATADV_MCAST_WANT_ALL_IPV4 &&
1002 !(orig->mcast_flags & BATADV_MCAST_WANT_ALL_IPV4)) {
1003 atomic_inc(&bat_priv->mcast.num_want_all_ipv4);
1004
1005 spin_lock_bh(&bat_priv->mcast.want_lists_lock);
Linus Lüssing8a4023c2015-06-16 17:10:26 +02001006 /* flag checks above + mcast_handler_lock prevents this */
1007 WARN_ON(!hlist_unhashed(node));
1008
1009 hlist_add_head_rcu(node, head);
Linus Lüssing4c8755d2014-02-15 17:47:54 +01001010 spin_unlock_bh(&bat_priv->mcast.want_lists_lock);
1011 /* switched from flag set to unset */
1012 } else if (!(mcast_flags & BATADV_MCAST_WANT_ALL_IPV4) &&
1013 orig->mcast_flags & BATADV_MCAST_WANT_ALL_IPV4) {
1014 atomic_dec(&bat_priv->mcast.num_want_all_ipv4);
1015
1016 spin_lock_bh(&bat_priv->mcast.want_lists_lock);
Linus Lüssing8a4023c2015-06-16 17:10:26 +02001017 /* flag checks above + mcast_handler_lock prevents this */
1018 WARN_ON(hlist_unhashed(node));
1019
1020 hlist_del_init_rcu(node);
Linus Lüssing4c8755d2014-02-15 17:47:54 +01001021 spin_unlock_bh(&bat_priv->mcast.want_lists_lock);
1022 }
1023}
1024
1025/**
1026 * batadv_mcast_want_ipv6_update - update want-all-ipv6 counter and list
1027 * @bat_priv: the bat priv with all the soft interface information
1028 * @orig: the orig_node which multicast state might have changed of
1029 * @mcast_flags: flags indicating the new multicast state
1030 *
1031 * If the BATADV_MCAST_WANT_ALL_IPV6 flag of this originator, orig, has
1032 * toggled then this method updates counter and list accordingly.
Linus Lüssing8a4023c2015-06-16 17:10:26 +02001033 *
1034 * Caller needs to hold orig->mcast_handler_lock.
Linus Lüssing4c8755d2014-02-15 17:47:54 +01001035 */
1036static void batadv_mcast_want_ipv6_update(struct batadv_priv *bat_priv,
1037 struct batadv_orig_node *orig,
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001038 u8 mcast_flags)
Linus Lüssing4c8755d2014-02-15 17:47:54 +01001039{
Linus Lüssing8a4023c2015-06-16 17:10:26 +02001040 struct hlist_node *node = &orig->mcast_want_all_ipv6_node;
1041 struct hlist_head *head = &bat_priv->mcast.want_all_ipv6_list;
1042
Sven Eckelmann5274cd62015-06-21 14:45:15 +02001043 lockdep_assert_held(&orig->mcast_handler_lock);
1044
Linus Lüssing4c8755d2014-02-15 17:47:54 +01001045 /* switched from flag unset to set */
1046 if (mcast_flags & BATADV_MCAST_WANT_ALL_IPV6 &&
1047 !(orig->mcast_flags & BATADV_MCAST_WANT_ALL_IPV6)) {
1048 atomic_inc(&bat_priv->mcast.num_want_all_ipv6);
1049
1050 spin_lock_bh(&bat_priv->mcast.want_lists_lock);
Linus Lüssing8a4023c2015-06-16 17:10:26 +02001051 /* flag checks above + mcast_handler_lock prevents this */
1052 WARN_ON(!hlist_unhashed(node));
1053
1054 hlist_add_head_rcu(node, head);
Linus Lüssing4c8755d2014-02-15 17:47:54 +01001055 spin_unlock_bh(&bat_priv->mcast.want_lists_lock);
1056 /* switched from flag set to unset */
1057 } else if (!(mcast_flags & BATADV_MCAST_WANT_ALL_IPV6) &&
1058 orig->mcast_flags & BATADV_MCAST_WANT_ALL_IPV6) {
1059 atomic_dec(&bat_priv->mcast.num_want_all_ipv6);
1060
1061 spin_lock_bh(&bat_priv->mcast.want_lists_lock);
Linus Lüssing8a4023c2015-06-16 17:10:26 +02001062 /* flag checks above + mcast_handler_lock prevents this */
1063 WARN_ON(hlist_unhashed(node));
1064
1065 hlist_del_init_rcu(node);
Linus Lüssing4c8755d2014-02-15 17:47:54 +01001066 spin_unlock_bh(&bat_priv->mcast.want_lists_lock);
1067 }
1068}
1069
1070/**
Linus Lüssingbd2a9792016-05-10 18:41:24 +02001071 * batadv_mcast_tvlv_ogm_handler - process incoming multicast tvlv container
Linus Lüssing60432d72014-02-15 17:47:51 +01001072 * @bat_priv: the bat priv with all the soft interface information
1073 * @orig: the orig_node of the ogm
1074 * @flags: flags indicating the tvlv state (see batadv_tvlv_handler_flags)
1075 * @tvlv_value: tvlv buffer containing the multicast data
1076 * @tvlv_value_len: tvlv buffer length
1077 */
Linus Lüssingbd2a9792016-05-10 18:41:24 +02001078static void batadv_mcast_tvlv_ogm_handler(struct batadv_priv *bat_priv,
1079 struct batadv_orig_node *orig,
1080 u8 flags,
1081 void *tvlv_value,
1082 u16 tvlv_value_len)
Linus Lüssing60432d72014-02-15 17:47:51 +01001083{
1084 bool orig_mcast_enabled = !(flags & BATADV_TVLV_HANDLER_OGM_CIFNOTFND);
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001085 u8 mcast_flags = BATADV_NO_FLAGS;
Linus Lüssing60432d72014-02-15 17:47:51 +01001086 bool orig_initialized;
1087
Linus Lüssing8a4023c2015-06-16 17:10:26 +02001088 if (orig_mcast_enabled && tvlv_value &&
1089 (tvlv_value_len >= sizeof(mcast_flags)))
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001090 mcast_flags = *(u8 *)tvlv_value;
Linus Lüssing8a4023c2015-06-16 17:10:26 +02001091
1092 spin_lock_bh(&orig->mcast_handler_lock);
Linus Lüssing9c936e32015-06-16 17:10:25 +02001093 orig_initialized = test_bit(BATADV_ORIG_CAPA_HAS_MCAST,
1094 &orig->capa_initialized);
Linus Lüssing60432d72014-02-15 17:47:51 +01001095
1096 /* If mcast support is turned on decrease the disabled mcast node
1097 * counter only if we had increased it for this node before. If this
1098 * is a completely new orig_node no need to decrease the counter.
1099 */
1100 if (orig_mcast_enabled &&
Linus Lüssing9c936e32015-06-16 17:10:25 +02001101 !test_bit(BATADV_ORIG_CAPA_HAS_MCAST, &orig->capabilities)) {
Linus Lüssing60432d72014-02-15 17:47:51 +01001102 if (orig_initialized)
1103 atomic_dec(&bat_priv->mcast.num_disabled);
Linus Lüssing9c936e32015-06-16 17:10:25 +02001104 set_bit(BATADV_ORIG_CAPA_HAS_MCAST, &orig->capabilities);
Linus Lüssinge8829f02014-10-30 05:40:46 +01001105 /* If mcast support is being switched off or if this is an initial
1106 * OGM without mcast support then increase the disabled mcast
1107 * node counter.
Linus Lüssing60432d72014-02-15 17:47:51 +01001108 */
1109 } else if (!orig_mcast_enabled &&
Linus Lüssing9c936e32015-06-16 17:10:25 +02001110 (test_bit(BATADV_ORIG_CAPA_HAS_MCAST, &orig->capabilities) ||
Linus Lüssinge8829f02014-10-30 05:40:46 +01001111 !orig_initialized)) {
Linus Lüssing60432d72014-02-15 17:47:51 +01001112 atomic_inc(&bat_priv->mcast.num_disabled);
Linus Lüssing9c936e32015-06-16 17:10:25 +02001113 clear_bit(BATADV_ORIG_CAPA_HAS_MCAST, &orig->capabilities);
Linus Lüssing60432d72014-02-15 17:47:51 +01001114 }
1115
Linus Lüssing9c936e32015-06-16 17:10:25 +02001116 set_bit(BATADV_ORIG_CAPA_HAS_MCAST, &orig->capa_initialized);
Linus Lüssing60432d72014-02-15 17:47:51 +01001117
Linus Lüssingab498862014-02-15 17:47:53 +01001118 batadv_mcast_want_unsnoop_update(bat_priv, orig, mcast_flags);
Linus Lüssing4c8755d2014-02-15 17:47:54 +01001119 batadv_mcast_want_ipv4_update(bat_priv, orig, mcast_flags);
1120 batadv_mcast_want_ipv6_update(bat_priv, orig, mcast_flags);
Linus Lüssingab498862014-02-15 17:47:53 +01001121
Linus Lüssing60432d72014-02-15 17:47:51 +01001122 orig->mcast_flags = mcast_flags;
Linus Lüssing8a4023c2015-06-16 17:10:26 +02001123 spin_unlock_bh(&orig->mcast_handler_lock);
Linus Lüssing60432d72014-02-15 17:47:51 +01001124}
1125
1126/**
1127 * batadv_mcast_init - initialize the multicast optimizations structures
1128 * @bat_priv: the bat priv with all the soft interface information
1129 */
1130void batadv_mcast_init(struct batadv_priv *bat_priv)
1131{
Linus Lüssingbd2a9792016-05-10 18:41:24 +02001132 batadv_tvlv_handler_register(bat_priv, batadv_mcast_tvlv_ogm_handler,
1133 NULL, BATADV_TVLV_MCAST, 2,
Linus Lüssing60432d72014-02-15 17:47:51 +01001134 BATADV_TVLV_HANDLER_OGM_CIFNOTFND);
1135}
1136
Sven Eckelmanndc1cbd12016-07-16 09:31:20 +02001137#ifdef CONFIG_BATMAN_ADV_DEBUGFS
Linus Lüssing60432d72014-02-15 17:47:51 +01001138/**
Linus Lüssing4e3e8232016-05-10 18:41:27 +02001139 * batadv_mcast_flags_print_header - print own mcast flags to debugfs table
1140 * @bat_priv: the bat priv with all the soft interface information
1141 * @seq: debugfs table seq_file struct
1142 *
1143 * Prints our own multicast flags including a more specific reason why
1144 * they are set, that is prints the bridge and querier state too, to
1145 * the debugfs table specified via @seq.
1146 */
1147static void batadv_mcast_flags_print_header(struct batadv_priv *bat_priv,
1148 struct seq_file *seq)
1149{
1150 u8 flags = bat_priv->mcast.flags;
1151 char querier4, querier6, shadowing4, shadowing6;
1152 bool bridged = bat_priv->mcast.bridged;
1153
1154 if (bridged) {
1155 querier4 = bat_priv->mcast.querier_ipv4.exists ? '.' : '4';
1156 querier6 = bat_priv->mcast.querier_ipv6.exists ? '.' : '6';
1157 shadowing4 = bat_priv->mcast.querier_ipv4.shadowing ? '4' : '.';
1158 shadowing6 = bat_priv->mcast.querier_ipv6.shadowing ? '6' : '.';
1159 } else {
1160 querier4 = '?';
1161 querier6 = '?';
1162 shadowing4 = '?';
1163 shadowing6 = '?';
1164 }
1165
1166 seq_printf(seq, "Multicast flags (own flags: [%c%c%c])\n",
1167 (flags & BATADV_MCAST_WANT_ALL_UNSNOOPABLES) ? 'U' : '.',
1168 (flags & BATADV_MCAST_WANT_ALL_IPV4) ? '4' : '.',
1169 (flags & BATADV_MCAST_WANT_ALL_IPV6) ? '6' : '.');
1170 seq_printf(seq, "* Bridged [U]\t\t\t\t%c\n", bridged ? 'U' : '.');
1171 seq_printf(seq, "* No IGMP/MLD Querier [4/6]:\t\t%c/%c\n",
1172 querier4, querier6);
1173 seq_printf(seq, "* Shadowing IGMP/MLD Querier [4/6]:\t%c/%c\n",
1174 shadowing4, shadowing6);
1175 seq_puts(seq, "-------------------------------------------\n");
1176 seq_printf(seq, " %-10s %s\n", "Originator", "Flags");
1177}
1178
1179/**
1180 * batadv_mcast_flags_seq_print_text - print the mcast flags of other nodes
1181 * @seq: seq file to print on
1182 * @offset: not used
1183 *
1184 * This prints a table of (primary) originators and their according
1185 * multicast flags, including (in the header) our own.
1186 *
1187 * Return: always 0
1188 */
1189int batadv_mcast_flags_seq_print_text(struct seq_file *seq, void *offset)
1190{
1191 struct net_device *net_dev = (struct net_device *)seq->private;
1192 struct batadv_priv *bat_priv = netdev_priv(net_dev);
1193 struct batadv_hard_iface *primary_if;
1194 struct batadv_hashtable *hash = bat_priv->orig_hash;
1195 struct batadv_orig_node *orig_node;
1196 struct hlist_head *head;
1197 u8 flags;
1198 u32 i;
1199
1200 primary_if = batadv_seq_print_text_primary_if_get(seq);
1201 if (!primary_if)
1202 return 0;
1203
1204 batadv_mcast_flags_print_header(bat_priv, seq);
1205
1206 for (i = 0; i < hash->size; i++) {
1207 head = &hash->table[i];
1208
1209 rcu_read_lock();
1210 hlist_for_each_entry_rcu(orig_node, head, hash_entry) {
1211 if (!test_bit(BATADV_ORIG_CAPA_HAS_MCAST,
1212 &orig_node->capa_initialized))
1213 continue;
1214
1215 if (!test_bit(BATADV_ORIG_CAPA_HAS_MCAST,
1216 &orig_node->capabilities)) {
1217 seq_printf(seq, "%pM -\n", orig_node->orig);
1218 continue;
1219 }
1220
1221 flags = orig_node->mcast_flags;
1222
1223 seq_printf(seq, "%pM [%c%c%c]\n", orig_node->orig,
1224 (flags & BATADV_MCAST_WANT_ALL_UNSNOOPABLES)
1225 ? 'U' : '.',
1226 (flags & BATADV_MCAST_WANT_ALL_IPV4)
1227 ? '4' : '.',
1228 (flags & BATADV_MCAST_WANT_ALL_IPV6)
1229 ? '6' : '.');
1230 }
1231 rcu_read_unlock();
1232 }
1233
1234 batadv_hardif_put(primary_if);
1235
1236 return 0;
1237}
Sven Eckelmanndc1cbd12016-07-16 09:31:20 +02001238#endif
Linus Lüssing4e3e8232016-05-10 18:41:27 +02001239
1240/**
Linus Lüssingc5caf4e2014-02-15 17:47:49 +01001241 * batadv_mcast_free - free the multicast optimizations structures
1242 * @bat_priv: the bat priv with all the soft interface information
1243 */
1244void batadv_mcast_free(struct batadv_priv *bat_priv)
1245{
Linus Lüssingbd2a9792016-05-10 18:41:24 +02001246 batadv_tvlv_container_unregister(bat_priv, BATADV_TVLV_MCAST, 2);
1247 batadv_tvlv_handler_unregister(bat_priv, BATADV_TVLV_MCAST, 2);
Linus Lüssing60432d72014-02-15 17:47:51 +01001248
Simon Wunderlichaf63cf52015-11-30 17:34:01 +01001249 spin_lock_bh(&bat_priv->tt.commit_lock);
Linus Lüssingc5caf4e2014-02-15 17:47:49 +01001250 batadv_mcast_mla_tt_retract(bat_priv, NULL);
Simon Wunderlichaf63cf52015-11-30 17:34:01 +01001251 spin_unlock_bh(&bat_priv->tt.commit_lock);
Linus Lüssingc5caf4e2014-02-15 17:47:49 +01001252}
Linus Lüssing60432d72014-02-15 17:47:51 +01001253
1254/**
1255 * batadv_mcast_purge_orig - reset originator global mcast state modifications
1256 * @orig: the originator which is going to get purged
1257 */
1258void batadv_mcast_purge_orig(struct batadv_orig_node *orig)
1259{
1260 struct batadv_priv *bat_priv = orig->bat_priv;
1261
Linus Lüssing8a4023c2015-06-16 17:10:26 +02001262 spin_lock_bh(&orig->mcast_handler_lock);
1263
Linus Lüssing9c936e32015-06-16 17:10:25 +02001264 if (!test_bit(BATADV_ORIG_CAPA_HAS_MCAST, &orig->capabilities) &&
1265 test_bit(BATADV_ORIG_CAPA_HAS_MCAST, &orig->capa_initialized))
Linus Lüssing60432d72014-02-15 17:47:51 +01001266 atomic_dec(&bat_priv->mcast.num_disabled);
Linus Lüssingab498862014-02-15 17:47:53 +01001267
1268 batadv_mcast_want_unsnoop_update(bat_priv, orig, BATADV_NO_FLAGS);
Linus Lüssing4c8755d2014-02-15 17:47:54 +01001269 batadv_mcast_want_ipv4_update(bat_priv, orig, BATADV_NO_FLAGS);
1270 batadv_mcast_want_ipv6_update(bat_priv, orig, BATADV_NO_FLAGS);
Linus Lüssing8a4023c2015-06-16 17:10:26 +02001271
1272 spin_unlock_bh(&orig->mcast_handler_lock);
Linus Lüssing60432d72014-02-15 17:47:51 +01001273}