12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 2eb1d1641SHerbert Xu /* 3eb1d1641SHerbert Xu * Bridge multicast support. 4eb1d1641SHerbert Xu * 5eb1d1641SHerbert Xu * Copyright (c) 2010 Herbert Xu <herbert@gondor.apana.org.au> 6eb1d1641SHerbert Xu */ 7eb1d1641SHerbert Xu 8eb1d1641SHerbert Xu #include <linux/err.h> 907f8ac4aSLinus Lüssing #include <linux/export.h> 10eb1d1641SHerbert Xu #include <linux/if_ether.h> 11eb1d1641SHerbert Xu #include <linux/igmp.h> 124b3087c7SLinus Lüssing #include <linux/in.h> 13eb1d1641SHerbert Xu #include <linux/jhash.h> 14eb1d1641SHerbert Xu #include <linux/kernel.h> 15b195167fSHerbert Xu #include <linux/log2.h> 16eb1d1641SHerbert Xu #include <linux/netdevice.h> 17eb1d1641SHerbert Xu #include <linux/netfilter_bridge.h> 18eb1d1641SHerbert Xu #include <linux/random.h> 19eb1d1641SHerbert Xu #include <linux/rculist.h> 20eb1d1641SHerbert Xu #include <linux/skbuff.h> 21eb1d1641SHerbert Xu #include <linux/slab.h> 22eb1d1641SHerbert Xu #include <linux/timer.h> 231c8ad5bfSCong Wang #include <linux/inetdevice.h> 2491b02d3dSNikolay Aleksandrov #include <linux/mroute.h> 25eb1d1641SHerbert Xu #include <net/ip.h> 26147c1e9bSNogah Frankel #include <net/switchdev.h> 27dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 284b3087c7SLinus Lüssing #include <linux/icmpv6.h> 2908b202b6SYOSHIFUJI Hideaki #include <net/ipv6.h> 3008b202b6SYOSHIFUJI Hideaki #include <net/mld.h> 31d4c4f07dSDavid S. Miller #include <net/ip6_checksum.h> 323c3769e6SLinus Lüssing #include <net/addrconf.h> 3308b202b6SYOSHIFUJI Hideaki #endif 34eb1d1641SHerbert Xu 35eb1d1641SHerbert Xu #include "br_private.h" 36eb1d1641SHerbert Xu 3719e3a9c9SNikolay Aleksandrov static const struct rhashtable_params br_mdb_rht_params = { 3819e3a9c9SNikolay Aleksandrov .head_offset = offsetof(struct net_bridge_mdb_entry, rhnode), 3919e3a9c9SNikolay Aleksandrov .key_offset = offsetof(struct net_bridge_mdb_entry, addr), 4019e3a9c9SNikolay Aleksandrov .key_len = sizeof(struct br_ip), 4119e3a9c9SNikolay Aleksandrov .automatic_shrinking = true, 4219e3a9c9SNikolay Aleksandrov }; 4319e3a9c9SNikolay Aleksandrov 44085b53c8SNikolay Aleksandrov static const struct rhashtable_params br_sg_port_rht_params = { 45085b53c8SNikolay Aleksandrov .head_offset = offsetof(struct net_bridge_port_group, rhnode), 46085b53c8SNikolay Aleksandrov .key_offset = offsetof(struct net_bridge_port_group, key), 47085b53c8SNikolay Aleksandrov .key_len = sizeof(struct net_bridge_port_group_sg_key), 48085b53c8SNikolay Aleksandrov .automatic_shrinking = true, 49085b53c8SNikolay Aleksandrov }; 50085b53c8SNikolay Aleksandrov 51cc0fdd80SLinus Lüssing static void br_multicast_start_querier(struct net_bridge *br, 5290010b36SLinus Lüssing struct bridge_mcast_own_query *query); 53754bc547SSatish Ashok static void br_multicast_add_router(struct net_bridge *br, 54754bc547SSatish Ashok struct net_bridge_port *port); 55bc8c20acSSatish Ashok static void br_ip4_multicast_leave_group(struct net_bridge *br, 56bc8c20acSSatish Ashok struct net_bridge_port *port, 57bc8c20acSSatish Ashok __be32 group, 586db6f0eaSFelix Fietkau __u16 vid, 596db6f0eaSFelix Fietkau const unsigned char *src); 6042c11ccfSNikolay Aleksandrov static void br_multicast_port_group_rexmit(struct timer_list *t); 616db6f0eaSFelix Fietkau 62f12e7d95SNogah Frankel static void __del_port_router(struct net_bridge_port *p); 63bc8c20acSSatish Ashok #if IS_ENABLED(CONFIG_IPV6) 64bc8c20acSSatish Ashok static void br_ip6_multicast_leave_group(struct net_bridge *br, 65bc8c20acSSatish Ashok struct net_bridge_port *port, 66bc8c20acSSatish Ashok const struct in6_addr *group, 676db6f0eaSFelix Fietkau __u16 vid, const unsigned char *src); 68bc8c20acSSatish Ashok #endif 69b0812368SNikolay Aleksandrov static struct net_bridge_port_group * 70b0812368SNikolay Aleksandrov __br_multicast_add_group(struct net_bridge *br, 71b0812368SNikolay Aleksandrov struct net_bridge_port *port, 72b0812368SNikolay Aleksandrov struct br_ip *group, 73b0812368SNikolay Aleksandrov const unsigned char *src, 74b0812368SNikolay Aleksandrov u8 filter_mode, 759116ffbfSNikolay Aleksandrov bool igmpv2_mldv1, 769116ffbfSNikolay Aleksandrov bool blocked); 778266a049SNikolay Aleksandrov static void br_multicast_find_del_pg(struct net_bridge *br, 788266a049SNikolay Aleksandrov struct net_bridge_port_group *pg); 79c83b8fabSHerbert Xu 80085b53c8SNikolay Aleksandrov static struct net_bridge_port_group * 81085b53c8SNikolay Aleksandrov br_sg_port_find(struct net_bridge *br, 82085b53c8SNikolay Aleksandrov struct net_bridge_port_group_sg_key *sg_p) 83085b53c8SNikolay Aleksandrov { 84085b53c8SNikolay Aleksandrov lockdep_assert_held_once(&br->multicast_lock); 85085b53c8SNikolay Aleksandrov 86085b53c8SNikolay Aleksandrov return rhashtable_lookup_fast(&br->sg_port_tbl, sg_p, 87085b53c8SNikolay Aleksandrov br_sg_port_rht_params); 88085b53c8SNikolay Aleksandrov } 89085b53c8SNikolay Aleksandrov 9019e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip_get_rcu(struct net_bridge *br, 91cfd56754SCong Wang struct br_ip *dst) 927f285fa7SHerbert Xu { 9319e3a9c9SNikolay Aleksandrov return rhashtable_lookup(&br->mdb_hash_tbl, dst, br_mdb_rht_params); 947f285fa7SHerbert Xu } 957f285fa7SHerbert Xu 9619e3a9c9SNikolay Aleksandrov struct net_bridge_mdb_entry *br_mdb_ip_get(struct net_bridge *br, 9719e3a9c9SNikolay Aleksandrov struct br_ip *dst) 9819e3a9c9SNikolay Aleksandrov { 9919e3a9c9SNikolay Aleksandrov struct net_bridge_mdb_entry *ent; 10019e3a9c9SNikolay Aleksandrov 10119e3a9c9SNikolay Aleksandrov lockdep_assert_held_once(&br->multicast_lock); 10219e3a9c9SNikolay Aleksandrov 10319e3a9c9SNikolay Aleksandrov rcu_read_lock(); 10419e3a9c9SNikolay Aleksandrov ent = rhashtable_lookup(&br->mdb_hash_tbl, dst, br_mdb_rht_params); 10519e3a9c9SNikolay Aleksandrov rcu_read_unlock(); 10619e3a9c9SNikolay Aleksandrov 10719e3a9c9SNikolay Aleksandrov return ent; 10819e3a9c9SNikolay Aleksandrov } 10919e3a9c9SNikolay Aleksandrov 11019e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip4_get(struct net_bridge *br, 11119e3a9c9SNikolay Aleksandrov __be32 dst, __u16 vid) 112eb1d1641SHerbert Xu { 1138ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_dst; 1140821ec55SHerbert Xu 11519e3a9c9SNikolay Aleksandrov memset(&br_dst, 0, sizeof(br_dst)); 116eab3227bSNikolay Aleksandrov br_dst.dst.ip4 = dst; 1178ef2a9a5SYOSHIFUJI Hideaki br_dst.proto = htons(ETH_P_IP); 118b0e9a30dSVlad Yasevich br_dst.vid = vid; 1198ef2a9a5SYOSHIFUJI Hideaki 12019e3a9c9SNikolay Aleksandrov return br_mdb_ip_get(br, &br_dst); 1218ef2a9a5SYOSHIFUJI Hideaki } 1228ef2a9a5SYOSHIFUJI Hideaki 123dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 12419e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip6_get(struct net_bridge *br, 12519e3a9c9SNikolay Aleksandrov const struct in6_addr *dst, 126b0e9a30dSVlad Yasevich __u16 vid) 12708b202b6SYOSHIFUJI Hideaki { 12808b202b6SYOSHIFUJI Hideaki struct br_ip br_dst; 12908b202b6SYOSHIFUJI Hideaki 13019e3a9c9SNikolay Aleksandrov memset(&br_dst, 0, sizeof(br_dst)); 131eab3227bSNikolay Aleksandrov br_dst.dst.ip6 = *dst; 13208b202b6SYOSHIFUJI Hideaki br_dst.proto = htons(ETH_P_IPV6); 133b0e9a30dSVlad Yasevich br_dst.vid = vid; 13408b202b6SYOSHIFUJI Hideaki 13519e3a9c9SNikolay Aleksandrov return br_mdb_ip_get(br, &br_dst); 13608b202b6SYOSHIFUJI Hideaki } 13708b202b6SYOSHIFUJI Hideaki #endif 13808b202b6SYOSHIFUJI Hideaki 139eb1d1641SHerbert Xu struct net_bridge_mdb_entry *br_mdb_get(struct net_bridge *br, 140fbca58a2SCong Wang struct sk_buff *skb, u16 vid) 141eb1d1641SHerbert Xu { 1428ef2a9a5SYOSHIFUJI Hideaki struct br_ip ip; 1438ef2a9a5SYOSHIFUJI Hideaki 14413cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) 145eb1d1641SHerbert Xu return NULL; 146eb1d1641SHerbert Xu 1478ef2a9a5SYOSHIFUJI Hideaki if (BR_INPUT_SKB_CB(skb)->igmp) 1488ef2a9a5SYOSHIFUJI Hideaki return NULL; 1498ef2a9a5SYOSHIFUJI Hideaki 15019e3a9c9SNikolay Aleksandrov memset(&ip, 0, sizeof(ip)); 1518ef2a9a5SYOSHIFUJI Hideaki ip.proto = skb->protocol; 152fbca58a2SCong Wang ip.vid = vid; 1538ef2a9a5SYOSHIFUJI Hideaki 154eb1d1641SHerbert Xu switch (skb->protocol) { 155eb1d1641SHerbert Xu case htons(ETH_P_IP): 156eab3227bSNikolay Aleksandrov ip.dst.ip4 = ip_hdr(skb)->daddr; 1577d07a68cSNikolay Aleksandrov if (br->multicast_igmp_version == 3) { 1587d07a68cSNikolay Aleksandrov struct net_bridge_mdb_entry *mdb; 1597d07a68cSNikolay Aleksandrov 1607d07a68cSNikolay Aleksandrov ip.src.ip4 = ip_hdr(skb)->saddr; 1617d07a68cSNikolay Aleksandrov mdb = br_mdb_ip_get_rcu(br, &ip); 1627d07a68cSNikolay Aleksandrov if (mdb) 1637d07a68cSNikolay Aleksandrov return mdb; 1647d07a68cSNikolay Aleksandrov ip.src.ip4 = 0; 1657d07a68cSNikolay Aleksandrov } 166eb1d1641SHerbert Xu break; 167dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 16808b202b6SYOSHIFUJI Hideaki case htons(ETH_P_IPV6): 169eab3227bSNikolay Aleksandrov ip.dst.ip6 = ipv6_hdr(skb)->daddr; 1707d07a68cSNikolay Aleksandrov if (br->multicast_mld_version == 2) { 1717d07a68cSNikolay Aleksandrov struct net_bridge_mdb_entry *mdb; 1727d07a68cSNikolay Aleksandrov 1737d07a68cSNikolay Aleksandrov ip.src.ip6 = ipv6_hdr(skb)->saddr; 1747d07a68cSNikolay Aleksandrov mdb = br_mdb_ip_get_rcu(br, &ip); 1757d07a68cSNikolay Aleksandrov if (mdb) 1767d07a68cSNikolay Aleksandrov return mdb; 1777d07a68cSNikolay Aleksandrov memset(&ip.src.ip6, 0, sizeof(ip.src.ip6)); 1787d07a68cSNikolay Aleksandrov } 17908b202b6SYOSHIFUJI Hideaki break; 18008b202b6SYOSHIFUJI Hideaki #endif 1818ef2a9a5SYOSHIFUJI Hideaki default: 182955062b0SNikolay Aleksandrov ip.proto = 0; 183955062b0SNikolay Aleksandrov ether_addr_copy(ip.dst.mac_addr, eth_hdr(skb)->h_dest); 184eb1d1641SHerbert Xu } 185eb1d1641SHerbert Xu 18619e3a9c9SNikolay Aleksandrov return br_mdb_ip_get_rcu(br, &ip); 187eb1d1641SHerbert Xu } 188eb1d1641SHerbert Xu 189b0812368SNikolay Aleksandrov static bool br_port_group_equal(struct net_bridge_port_group *p, 190b0812368SNikolay Aleksandrov struct net_bridge_port *port, 191b0812368SNikolay Aleksandrov const unsigned char *src) 192b0812368SNikolay Aleksandrov { 193b0812368SNikolay Aleksandrov if (p->key.port != port) 194b0812368SNikolay Aleksandrov return false; 195b0812368SNikolay Aleksandrov 196b0812368SNikolay Aleksandrov if (!(port->flags & BR_MULTICAST_TO_UNICAST)) 197b0812368SNikolay Aleksandrov return true; 198b0812368SNikolay Aleksandrov 199b0812368SNikolay Aleksandrov return ether_addr_equal(src, p->eth_addr); 200b0812368SNikolay Aleksandrov } 201b0812368SNikolay Aleksandrov 2028266a049SNikolay Aleksandrov static void __fwd_add_star_excl(struct net_bridge_port_group *pg, 2038266a049SNikolay Aleksandrov struct br_ip *sg_ip) 2048266a049SNikolay Aleksandrov { 2058266a049SNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 2068266a049SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 2078266a049SNikolay Aleksandrov struct net_bridge_port_group *src_pg; 2088266a049SNikolay Aleksandrov 2098266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 2108266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 2118266a049SNikolay Aleksandrov sg_key.addr = *sg_ip; 2128266a049SNikolay Aleksandrov if (br_sg_port_find(br, &sg_key)) 2138266a049SNikolay Aleksandrov return; 2148266a049SNikolay Aleksandrov 2158266a049SNikolay Aleksandrov src_pg = __br_multicast_add_group(br, pg->key.port, sg_ip, pg->eth_addr, 2169116ffbfSNikolay Aleksandrov MCAST_INCLUDE, false, false); 2178266a049SNikolay Aleksandrov if (IS_ERR_OR_NULL(src_pg) || 2188266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 2198266a049SNikolay Aleksandrov return; 2208266a049SNikolay Aleksandrov 2218266a049SNikolay Aleksandrov src_pg->flags |= MDB_PG_FLAGS_STAR_EXCL; 2228266a049SNikolay Aleksandrov } 2238266a049SNikolay Aleksandrov 2248266a049SNikolay Aleksandrov static void __fwd_del_star_excl(struct net_bridge_port_group *pg, 2258266a049SNikolay Aleksandrov struct br_ip *sg_ip) 2268266a049SNikolay Aleksandrov { 2278266a049SNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 2288266a049SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 2298266a049SNikolay Aleksandrov struct net_bridge_port_group *src_pg; 2308266a049SNikolay Aleksandrov 2318266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 2328266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 2338266a049SNikolay Aleksandrov sg_key.addr = *sg_ip; 2348266a049SNikolay Aleksandrov src_pg = br_sg_port_find(br, &sg_key); 2358266a049SNikolay Aleksandrov if (!src_pg || !(src_pg->flags & MDB_PG_FLAGS_STAR_EXCL) || 2368266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 2378266a049SNikolay Aleksandrov return; 2388266a049SNikolay Aleksandrov 2398266a049SNikolay Aleksandrov br_multicast_find_del_pg(br, src_pg); 2408266a049SNikolay Aleksandrov } 2418266a049SNikolay Aleksandrov 2428266a049SNikolay Aleksandrov /* When a port group transitions to (or is added as) EXCLUDE we need to add it 2438266a049SNikolay Aleksandrov * to all other ports' S,G entries which are not blocked by the current group 2448266a049SNikolay Aleksandrov * for proper replication, the assumption is that any S,G blocked entries 2458266a049SNikolay Aleksandrov * are already added so the S,G,port lookup should skip them. 2468266a049SNikolay Aleksandrov * When a port group transitions from EXCLUDE -> INCLUDE mode or is being 2478266a049SNikolay Aleksandrov * deleted we need to remove it from all ports' S,G entries where it was 2488266a049SNikolay Aleksandrov * automatically installed before (i.e. where it's MDB_PG_FLAGS_STAR_EXCL). 2498266a049SNikolay Aleksandrov */ 2508266a049SNikolay Aleksandrov void br_multicast_star_g_handle_mode(struct net_bridge_port_group *pg, 2518266a049SNikolay Aleksandrov u8 filter_mode) 2528266a049SNikolay Aleksandrov { 2538266a049SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 2548266a049SNikolay Aleksandrov struct net_bridge_port_group *pg_lst; 2558266a049SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 2568266a049SNikolay Aleksandrov struct br_ip sg_ip; 2578266a049SNikolay Aleksandrov 2588266a049SNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&pg->key.addr))) 2598266a049SNikolay Aleksandrov return; 2608266a049SNikolay Aleksandrov 2618266a049SNikolay Aleksandrov mp = br_mdb_ip_get(br, &pg->key.addr); 2628266a049SNikolay Aleksandrov if (!mp) 2638266a049SNikolay Aleksandrov return; 2648266a049SNikolay Aleksandrov 2658266a049SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 2668266a049SNikolay Aleksandrov sg_ip = pg->key.addr; 2678266a049SNikolay Aleksandrov for (pg_lst = mlock_dereference(mp->ports, br); 2688266a049SNikolay Aleksandrov pg_lst; 2698266a049SNikolay Aleksandrov pg_lst = mlock_dereference(pg_lst->next, br)) { 2708266a049SNikolay Aleksandrov struct net_bridge_group_src *src_ent; 2718266a049SNikolay Aleksandrov 2728266a049SNikolay Aleksandrov if (pg_lst == pg) 2738266a049SNikolay Aleksandrov continue; 2748266a049SNikolay Aleksandrov hlist_for_each_entry(src_ent, &pg_lst->src_list, node) { 2758266a049SNikolay Aleksandrov if (!(src_ent->flags & BR_SGRP_F_INSTALLED)) 2768266a049SNikolay Aleksandrov continue; 2778266a049SNikolay Aleksandrov sg_ip.src = src_ent->addr.src; 2788266a049SNikolay Aleksandrov switch (filter_mode) { 2798266a049SNikolay Aleksandrov case MCAST_INCLUDE: 2808266a049SNikolay Aleksandrov __fwd_del_star_excl(pg, &sg_ip); 2818266a049SNikolay Aleksandrov break; 2828266a049SNikolay Aleksandrov case MCAST_EXCLUDE: 2838266a049SNikolay Aleksandrov __fwd_add_star_excl(pg, &sg_ip); 2848266a049SNikolay Aleksandrov break; 2858266a049SNikolay Aleksandrov } 2868266a049SNikolay Aleksandrov } 2878266a049SNikolay Aleksandrov } 2888266a049SNikolay Aleksandrov } 2898266a049SNikolay Aleksandrov 290094b82fdSNikolay Aleksandrov /* called when adding a new S,G with host_joined == false by default */ 291094b82fdSNikolay Aleksandrov static void br_multicast_sg_host_state(struct net_bridge_mdb_entry *star_mp, 292094b82fdSNikolay Aleksandrov struct net_bridge_port_group *sg) 293094b82fdSNikolay Aleksandrov { 294094b82fdSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 295094b82fdSNikolay Aleksandrov 296094b82fdSNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 297094b82fdSNikolay Aleksandrov return; 298094b82fdSNikolay Aleksandrov if (!star_mp->host_joined) 299094b82fdSNikolay Aleksandrov return; 300094b82fdSNikolay Aleksandrov 301094b82fdSNikolay Aleksandrov sg_mp = br_mdb_ip_get(star_mp->br, &sg->key.addr); 302094b82fdSNikolay Aleksandrov if (!sg_mp) 303094b82fdSNikolay Aleksandrov return; 304094b82fdSNikolay Aleksandrov sg_mp->host_joined = true; 305094b82fdSNikolay Aleksandrov } 306094b82fdSNikolay Aleksandrov 307094b82fdSNikolay Aleksandrov /* set the host_joined state of all of *,G's S,G entries */ 308094b82fdSNikolay Aleksandrov static void br_multicast_star_g_host_state(struct net_bridge_mdb_entry *star_mp) 309094b82fdSNikolay Aleksandrov { 310094b82fdSNikolay Aleksandrov struct net_bridge *br = star_mp->br; 311094b82fdSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 312094b82fdSNikolay Aleksandrov struct net_bridge_port_group *pg; 313094b82fdSNikolay Aleksandrov struct br_ip sg_ip; 314094b82fdSNikolay Aleksandrov 315094b82fdSNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 316094b82fdSNikolay Aleksandrov return; 317094b82fdSNikolay Aleksandrov 318094b82fdSNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 319094b82fdSNikolay Aleksandrov sg_ip = star_mp->addr; 320094b82fdSNikolay Aleksandrov for (pg = mlock_dereference(star_mp->ports, br); 321094b82fdSNikolay Aleksandrov pg; 322094b82fdSNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) { 323094b82fdSNikolay Aleksandrov struct net_bridge_group_src *src_ent; 324094b82fdSNikolay Aleksandrov 325094b82fdSNikolay Aleksandrov hlist_for_each_entry(src_ent, &pg->src_list, node) { 326094b82fdSNikolay Aleksandrov if (!(src_ent->flags & BR_SGRP_F_INSTALLED)) 327094b82fdSNikolay Aleksandrov continue; 328094b82fdSNikolay Aleksandrov sg_ip.src = src_ent->addr.src; 329094b82fdSNikolay Aleksandrov sg_mp = br_mdb_ip_get(br, &sg_ip); 330094b82fdSNikolay Aleksandrov if (!sg_mp) 331094b82fdSNikolay Aleksandrov continue; 332094b82fdSNikolay Aleksandrov sg_mp->host_joined = star_mp->host_joined; 333094b82fdSNikolay Aleksandrov } 334094b82fdSNikolay Aleksandrov } 335094b82fdSNikolay Aleksandrov } 336094b82fdSNikolay Aleksandrov 3378266a049SNikolay Aleksandrov static void br_multicast_sg_del_exclude_ports(struct net_bridge_mdb_entry *sgmp) 3388266a049SNikolay Aleksandrov { 3398266a049SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 3408266a049SNikolay Aleksandrov struct net_bridge_port_group *p; 3418266a049SNikolay Aleksandrov 3428266a049SNikolay Aleksandrov /* *,G exclude ports are only added to S,G entries */ 3438266a049SNikolay Aleksandrov if (WARN_ON(br_multicast_is_star_g(&sgmp->addr))) 3448266a049SNikolay Aleksandrov return; 3458266a049SNikolay Aleksandrov 3468266a049SNikolay Aleksandrov /* we need the STAR_EXCLUDE ports if there are non-STAR_EXCLUDE ports 3478266a049SNikolay Aleksandrov * we should ignore perm entries since they're managed by user-space 3488266a049SNikolay Aleksandrov */ 3498266a049SNikolay Aleksandrov for (pp = &sgmp->ports; 3508266a049SNikolay Aleksandrov (p = mlock_dereference(*pp, sgmp->br)) != NULL; 3518266a049SNikolay Aleksandrov pp = &p->next) 3528266a049SNikolay Aleksandrov if (!(p->flags & (MDB_PG_FLAGS_STAR_EXCL | 3538266a049SNikolay Aleksandrov MDB_PG_FLAGS_PERMANENT))) 3548266a049SNikolay Aleksandrov return; 3558266a049SNikolay Aleksandrov 356094b82fdSNikolay Aleksandrov /* currently the host can only have joined the *,G which means 357094b82fdSNikolay Aleksandrov * we treat it as EXCLUDE {}, so for an S,G it's considered a 358094b82fdSNikolay Aleksandrov * STAR_EXCLUDE entry and we can safely leave it 359094b82fdSNikolay Aleksandrov */ 360094b82fdSNikolay Aleksandrov sgmp->host_joined = false; 361094b82fdSNikolay Aleksandrov 3628266a049SNikolay Aleksandrov for (pp = &sgmp->ports; 3638266a049SNikolay Aleksandrov (p = mlock_dereference(*pp, sgmp->br)) != NULL;) { 3648266a049SNikolay Aleksandrov if (!(p->flags & MDB_PG_FLAGS_PERMANENT)) 3658266a049SNikolay Aleksandrov br_multicast_del_pg(sgmp, p, pp); 3668266a049SNikolay Aleksandrov else 3678266a049SNikolay Aleksandrov pp = &p->next; 3688266a049SNikolay Aleksandrov } 3698266a049SNikolay Aleksandrov } 3708266a049SNikolay Aleksandrov 3718266a049SNikolay Aleksandrov void br_multicast_sg_add_exclude_ports(struct net_bridge_mdb_entry *star_mp, 3728266a049SNikolay Aleksandrov struct net_bridge_port_group *sg) 3738266a049SNikolay Aleksandrov { 3748266a049SNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 3758266a049SNikolay Aleksandrov struct net_bridge *br = star_mp->br; 3768266a049SNikolay Aleksandrov struct net_bridge_port_group *pg; 3778266a049SNikolay Aleksandrov 3788266a049SNikolay Aleksandrov if (WARN_ON(br_multicast_is_star_g(&sg->key.addr))) 3798266a049SNikolay Aleksandrov return; 3808266a049SNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 3818266a049SNikolay Aleksandrov return; 3828266a049SNikolay Aleksandrov 383094b82fdSNikolay Aleksandrov br_multicast_sg_host_state(star_mp, sg); 3848266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 3858266a049SNikolay Aleksandrov sg_key.addr = sg->key.addr; 3868266a049SNikolay Aleksandrov /* we need to add all exclude ports to the S,G */ 3878266a049SNikolay Aleksandrov for (pg = mlock_dereference(star_mp->ports, br); 3888266a049SNikolay Aleksandrov pg; 3898266a049SNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) { 3908266a049SNikolay Aleksandrov struct net_bridge_port_group *src_pg; 3918266a049SNikolay Aleksandrov 3928266a049SNikolay Aleksandrov if (pg == sg || pg->filter_mode == MCAST_INCLUDE) 3938266a049SNikolay Aleksandrov continue; 3948266a049SNikolay Aleksandrov 3958266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 3968266a049SNikolay Aleksandrov if (br_sg_port_find(br, &sg_key)) 3978266a049SNikolay Aleksandrov continue; 3988266a049SNikolay Aleksandrov 3998266a049SNikolay Aleksandrov src_pg = __br_multicast_add_group(br, pg->key.port, 4008266a049SNikolay Aleksandrov &sg->key.addr, 4018266a049SNikolay Aleksandrov sg->eth_addr, 4029116ffbfSNikolay Aleksandrov MCAST_INCLUDE, false, false); 4038266a049SNikolay Aleksandrov if (IS_ERR_OR_NULL(src_pg) || 4048266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 4058266a049SNikolay Aleksandrov continue; 4068266a049SNikolay Aleksandrov src_pg->flags |= MDB_PG_FLAGS_STAR_EXCL; 4078266a049SNikolay Aleksandrov } 4088266a049SNikolay Aleksandrov } 4098266a049SNikolay Aleksandrov 410b0812368SNikolay Aleksandrov static void br_multicast_fwd_src_add(struct net_bridge_group_src *src) 411b0812368SNikolay Aleksandrov { 4128266a049SNikolay Aleksandrov struct net_bridge_mdb_entry *star_mp; 413b0812368SNikolay Aleksandrov struct net_bridge_port_group *sg; 414b0812368SNikolay Aleksandrov struct br_ip sg_ip; 415b0812368SNikolay Aleksandrov 416b0812368SNikolay Aleksandrov if (src->flags & BR_SGRP_F_INSTALLED) 417b0812368SNikolay Aleksandrov return; 418b0812368SNikolay Aleksandrov 419b0812368SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 420b0812368SNikolay Aleksandrov sg_ip = src->pg->key.addr; 421b0812368SNikolay Aleksandrov sg_ip.src = src->addr.src; 422b0812368SNikolay Aleksandrov sg = __br_multicast_add_group(src->br, src->pg->key.port, &sg_ip, 4239116ffbfSNikolay Aleksandrov src->pg->eth_addr, MCAST_INCLUDE, false, 4249116ffbfSNikolay Aleksandrov !timer_pending(&src->timer)); 425b0812368SNikolay Aleksandrov if (IS_ERR_OR_NULL(sg)) 426b0812368SNikolay Aleksandrov return; 427b0812368SNikolay Aleksandrov src->flags |= BR_SGRP_F_INSTALLED; 4288266a049SNikolay Aleksandrov sg->flags &= ~MDB_PG_FLAGS_STAR_EXCL; 429b0812368SNikolay Aleksandrov 430b0812368SNikolay Aleksandrov /* if it was added by user-space as perm we can skip next steps */ 431b0812368SNikolay Aleksandrov if (sg->rt_protocol != RTPROT_KERNEL && 432b0812368SNikolay Aleksandrov (sg->flags & MDB_PG_FLAGS_PERMANENT)) 433b0812368SNikolay Aleksandrov return; 434b0812368SNikolay Aleksandrov 435b0812368SNikolay Aleksandrov /* the kernel is now responsible for removing this S,G */ 436b0812368SNikolay Aleksandrov del_timer(&sg->timer); 4378266a049SNikolay Aleksandrov star_mp = br_mdb_ip_get(src->br, &src->pg->key.addr); 4388266a049SNikolay Aleksandrov if (!star_mp) 4398266a049SNikolay Aleksandrov return; 4408266a049SNikolay Aleksandrov 4418266a049SNikolay Aleksandrov br_multicast_sg_add_exclude_ports(star_mp, sg); 442b0812368SNikolay Aleksandrov } 443b0812368SNikolay Aleksandrov 444b0812368SNikolay Aleksandrov static void br_multicast_fwd_src_remove(struct net_bridge_group_src *src) 445b0812368SNikolay Aleksandrov { 446b0812368SNikolay Aleksandrov struct net_bridge_port_group *p, *pg = src->pg; 447b0812368SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 448b0812368SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 449b0812368SNikolay Aleksandrov struct br_ip sg_ip; 450b0812368SNikolay Aleksandrov 451b0812368SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 452b0812368SNikolay Aleksandrov sg_ip = pg->key.addr; 453b0812368SNikolay Aleksandrov sg_ip.src = src->addr.src; 454b0812368SNikolay Aleksandrov 455b0812368SNikolay Aleksandrov mp = br_mdb_ip_get(src->br, &sg_ip); 456b0812368SNikolay Aleksandrov if (!mp) 457b0812368SNikolay Aleksandrov return; 458b0812368SNikolay Aleksandrov 459b0812368SNikolay Aleksandrov for (pp = &mp->ports; 460b0812368SNikolay Aleksandrov (p = mlock_dereference(*pp, src->br)) != NULL; 461b0812368SNikolay Aleksandrov pp = &p->next) { 462b0812368SNikolay Aleksandrov if (!br_port_group_equal(p, pg->key.port, pg->eth_addr)) 463b0812368SNikolay Aleksandrov continue; 464b0812368SNikolay Aleksandrov 465b0812368SNikolay Aleksandrov if (p->rt_protocol != RTPROT_KERNEL && 466b0812368SNikolay Aleksandrov (p->flags & MDB_PG_FLAGS_PERMANENT)) 467b0812368SNikolay Aleksandrov break; 468b0812368SNikolay Aleksandrov 469b0812368SNikolay Aleksandrov br_multicast_del_pg(mp, p, pp); 470b0812368SNikolay Aleksandrov break; 471b0812368SNikolay Aleksandrov } 472b0812368SNikolay Aleksandrov src->flags &= ~BR_SGRP_F_INSTALLED; 473b0812368SNikolay Aleksandrov } 474b0812368SNikolay Aleksandrov 4759116ffbfSNikolay Aleksandrov /* install S,G and based on src's timer enable or disable forwarding */ 476b0812368SNikolay Aleksandrov static void br_multicast_fwd_src_handle(struct net_bridge_group_src *src) 477b0812368SNikolay Aleksandrov { 4789116ffbfSNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 4799116ffbfSNikolay Aleksandrov struct net_bridge_port_group *sg; 4809116ffbfSNikolay Aleksandrov u8 old_flags; 4819116ffbfSNikolay Aleksandrov 482b0812368SNikolay Aleksandrov br_multicast_fwd_src_add(src); 4839116ffbfSNikolay Aleksandrov 4849116ffbfSNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 4859116ffbfSNikolay Aleksandrov sg_key.addr = src->pg->key.addr; 4869116ffbfSNikolay Aleksandrov sg_key.addr.src = src->addr.src; 4879116ffbfSNikolay Aleksandrov sg_key.port = src->pg->key.port; 4889116ffbfSNikolay Aleksandrov 4899116ffbfSNikolay Aleksandrov sg = br_sg_port_find(src->br, &sg_key); 4909116ffbfSNikolay Aleksandrov if (!sg || (sg->flags & MDB_PG_FLAGS_PERMANENT)) 4919116ffbfSNikolay Aleksandrov return; 4929116ffbfSNikolay Aleksandrov 4939116ffbfSNikolay Aleksandrov old_flags = sg->flags; 4949116ffbfSNikolay Aleksandrov if (timer_pending(&src->timer)) 4959116ffbfSNikolay Aleksandrov sg->flags &= ~MDB_PG_FLAGS_BLOCKED; 4969116ffbfSNikolay Aleksandrov else 4979116ffbfSNikolay Aleksandrov sg->flags |= MDB_PG_FLAGS_BLOCKED; 4989116ffbfSNikolay Aleksandrov 4999116ffbfSNikolay Aleksandrov if (old_flags != sg->flags) { 5009116ffbfSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 5019116ffbfSNikolay Aleksandrov 5029116ffbfSNikolay Aleksandrov sg_mp = br_mdb_ip_get(src->br, &sg_key.addr); 5039116ffbfSNikolay Aleksandrov if (!sg_mp) 5049116ffbfSNikolay Aleksandrov return; 5059116ffbfSNikolay Aleksandrov br_mdb_notify(src->br->dev, sg_mp, sg, RTM_NEWMDB); 5069116ffbfSNikolay Aleksandrov } 507b0812368SNikolay Aleksandrov } 508b0812368SNikolay Aleksandrov 509e12cec65SNikolay Aleksandrov static void br_multicast_destroy_mdb_entry(struct net_bridge_mcast_gc *gc) 510e12cec65SNikolay Aleksandrov { 511e12cec65SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 512e12cec65SNikolay Aleksandrov 513e12cec65SNikolay Aleksandrov mp = container_of(gc, struct net_bridge_mdb_entry, mcast_gc); 514e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&mp->mdb_node)); 515e12cec65SNikolay Aleksandrov WARN_ON(mp->ports); 516e12cec65SNikolay Aleksandrov 517e12cec65SNikolay Aleksandrov del_timer_sync(&mp->timer); 518e12cec65SNikolay Aleksandrov kfree_rcu(mp, rcu); 519e12cec65SNikolay Aleksandrov } 520e12cec65SNikolay Aleksandrov 521e12cec65SNikolay Aleksandrov static void br_multicast_del_mdb_entry(struct net_bridge_mdb_entry *mp) 522e12cec65SNikolay Aleksandrov { 523e12cec65SNikolay Aleksandrov struct net_bridge *br = mp->br; 524e12cec65SNikolay Aleksandrov 525e12cec65SNikolay Aleksandrov rhashtable_remove_fast(&br->mdb_hash_tbl, &mp->rhnode, 526e12cec65SNikolay Aleksandrov br_mdb_rht_params); 527e12cec65SNikolay Aleksandrov hlist_del_init_rcu(&mp->mdb_node); 528e12cec65SNikolay Aleksandrov hlist_add_head(&mp->mcast_gc.gc_node, &br->mcast_gc_list); 529e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 530e12cec65SNikolay Aleksandrov } 531e12cec65SNikolay Aleksandrov 53288c1f37fSAllen Pais static void br_multicast_group_expired(struct timer_list *t) 533eb1d1641SHerbert Xu { 53488c1f37fSAllen Pais struct net_bridge_mdb_entry *mp = from_timer(mp, t, timer); 535eb1d1641SHerbert Xu struct net_bridge *br = mp->br; 536eb1d1641SHerbert Xu 537eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 538b0812368SNikolay Aleksandrov if (hlist_unhashed(&mp->mdb_node) || !netif_running(br->dev) || 539b0812368SNikolay Aleksandrov timer_pending(&mp->timer)) 540eb1d1641SHerbert Xu goto out; 541eb1d1641SHerbert Xu 5421bc844eeSNikolay Aleksandrov br_multicast_host_leave(mp, true); 543eb1d1641SHerbert Xu 544eb1d1641SHerbert Xu if (mp->ports) 545eb1d1641SHerbert Xu goto out; 546e12cec65SNikolay Aleksandrov br_multicast_del_mdb_entry(mp); 547eb1d1641SHerbert Xu out: 548eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 549eb1d1641SHerbert Xu } 550eb1d1641SHerbert Xu 551e12cec65SNikolay Aleksandrov static void br_multicast_destroy_group_src(struct net_bridge_mcast_gc *gc) 552e12cec65SNikolay Aleksandrov { 553e12cec65SNikolay Aleksandrov struct net_bridge_group_src *src; 554e12cec65SNikolay Aleksandrov 555e12cec65SNikolay Aleksandrov src = container_of(gc, struct net_bridge_group_src, mcast_gc); 556e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&src->node)); 557e12cec65SNikolay Aleksandrov 558e12cec65SNikolay Aleksandrov del_timer_sync(&src->timer); 559e12cec65SNikolay Aleksandrov kfree_rcu(src, rcu); 560e12cec65SNikolay Aleksandrov } 561e12cec65SNikolay Aleksandrov 5628b671779SNikolay Aleksandrov static void br_multicast_del_group_src(struct net_bridge_group_src *src) 5638b671779SNikolay Aleksandrov { 564085b53c8SNikolay Aleksandrov struct net_bridge *br = src->pg->key.port->br; 5658b671779SNikolay Aleksandrov 566b0812368SNikolay Aleksandrov br_multicast_fwd_src_remove(src); 5678b671779SNikolay Aleksandrov hlist_del_init_rcu(&src->node); 5688b671779SNikolay Aleksandrov src->pg->src_ents--; 569e12cec65SNikolay Aleksandrov hlist_add_head(&src->mcast_gc.gc_node, &br->mcast_gc_list); 570e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 571e12cec65SNikolay Aleksandrov } 572e12cec65SNikolay Aleksandrov 573e12cec65SNikolay Aleksandrov static void br_multicast_destroy_port_group(struct net_bridge_mcast_gc *gc) 574e12cec65SNikolay Aleksandrov { 575e12cec65SNikolay Aleksandrov struct net_bridge_port_group *pg; 576e12cec65SNikolay Aleksandrov 577e12cec65SNikolay Aleksandrov pg = container_of(gc, struct net_bridge_port_group, mcast_gc); 578e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&pg->mglist)); 579e12cec65SNikolay Aleksandrov WARN_ON(!hlist_empty(&pg->src_list)); 580e12cec65SNikolay Aleksandrov 581e12cec65SNikolay Aleksandrov del_timer_sync(&pg->rexmit_timer); 582e12cec65SNikolay Aleksandrov del_timer_sync(&pg->timer); 583e12cec65SNikolay Aleksandrov kfree_rcu(pg, rcu); 5848b671779SNikolay Aleksandrov } 5858b671779SNikolay Aleksandrov 586681590bdSNikolay Aleksandrov void br_multicast_del_pg(struct net_bridge_mdb_entry *mp, 587681590bdSNikolay Aleksandrov struct net_bridge_port_group *pg, 588681590bdSNikolay Aleksandrov struct net_bridge_port_group __rcu **pp) 589681590bdSNikolay Aleksandrov { 590085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 5918b671779SNikolay Aleksandrov struct net_bridge_group_src *ent; 5928b671779SNikolay Aleksandrov struct hlist_node *tmp; 593681590bdSNikolay Aleksandrov 594681590bdSNikolay Aleksandrov rcu_assign_pointer(*pp, pg->next); 595681590bdSNikolay Aleksandrov hlist_del_init(&pg->mglist); 5968b671779SNikolay Aleksandrov hlist_for_each_entry_safe(ent, tmp, &pg->src_list, node) 5978b671779SNikolay Aleksandrov br_multicast_del_group_src(ent); 59881f19838SNikolay Aleksandrov br_mdb_notify(br->dev, mp, pg, RTM_DELMDB); 59974705582SNikolay Aleksandrov if (!br_multicast_is_star_g(&mp->addr)) { 60074705582SNikolay Aleksandrov rhashtable_remove_fast(&br->sg_port_tbl, &pg->rhnode, 60174705582SNikolay Aleksandrov br_sg_port_rht_params); 6028266a049SNikolay Aleksandrov br_multicast_sg_del_exclude_ports(mp); 60374705582SNikolay Aleksandrov } else { 6048266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_INCLUDE); 60574705582SNikolay Aleksandrov } 606e12cec65SNikolay Aleksandrov hlist_add_head(&pg->mcast_gc.gc_node, &br->mcast_gc_list); 607e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 608681590bdSNikolay Aleksandrov 609681590bdSNikolay Aleksandrov if (!mp->ports && !mp->host_joined && netif_running(br->dev)) 610681590bdSNikolay Aleksandrov mod_timer(&mp->timer, jiffies); 611681590bdSNikolay Aleksandrov } 612681590bdSNikolay Aleksandrov 613681590bdSNikolay Aleksandrov static void br_multicast_find_del_pg(struct net_bridge *br, 614eb1d1641SHerbert Xu struct net_bridge_port_group *pg) 615eb1d1641SHerbert Xu { 6168b671779SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 617eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 618eb1d1641SHerbert Xu struct net_bridge_port_group *p; 619e8051688SEric Dumazet 620085b53c8SNikolay Aleksandrov mp = br_mdb_ip_get(br, &pg->key.addr); 621eb1d1641SHerbert Xu if (WARN_ON(!mp)) 622eb1d1641SHerbert Xu return; 623eb1d1641SHerbert Xu 624e8051688SEric Dumazet for (pp = &mp->ports; 625e8051688SEric Dumazet (p = mlock_dereference(*pp, br)) != NULL; 626e8051688SEric Dumazet pp = &p->next) { 627eb1d1641SHerbert Xu if (p != pg) 628eb1d1641SHerbert Xu continue; 629eb1d1641SHerbert Xu 630681590bdSNikolay Aleksandrov br_multicast_del_pg(mp, pg, pp); 631eb1d1641SHerbert Xu return; 632eb1d1641SHerbert Xu } 633eb1d1641SHerbert Xu 634eb1d1641SHerbert Xu WARN_ON(1); 635eb1d1641SHerbert Xu } 636eb1d1641SHerbert Xu 63788c1f37fSAllen Pais static void br_multicast_port_group_expired(struct timer_list *t) 638eb1d1641SHerbert Xu { 63988c1f37fSAllen Pais struct net_bridge_port_group *pg = from_timer(pg, t, timer); 640d6c33d67SNikolay Aleksandrov struct net_bridge_group_src *src_ent; 641085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 642d6c33d67SNikolay Aleksandrov struct hlist_node *tmp; 643d6c33d67SNikolay Aleksandrov bool changed; 644eb1d1641SHerbert Xu 645eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 646eb1d1641SHerbert Xu if (!netif_running(br->dev) || timer_pending(&pg->timer) || 6479d06b6d8SElad Raz hlist_unhashed(&pg->mglist) || pg->flags & MDB_PG_FLAGS_PERMANENT) 648eb1d1641SHerbert Xu goto out; 649eb1d1641SHerbert Xu 650d6c33d67SNikolay Aleksandrov changed = !!(pg->filter_mode == MCAST_EXCLUDE); 651d6c33d67SNikolay Aleksandrov pg->filter_mode = MCAST_INCLUDE; 652d6c33d67SNikolay Aleksandrov hlist_for_each_entry_safe(src_ent, tmp, &pg->src_list, node) { 653d6c33d67SNikolay Aleksandrov if (!timer_pending(&src_ent->timer)) { 654d6c33d67SNikolay Aleksandrov br_multicast_del_group_src(src_ent); 655d6c33d67SNikolay Aleksandrov changed = true; 656d6c33d67SNikolay Aleksandrov } 657d6c33d67SNikolay Aleksandrov } 658eb1d1641SHerbert Xu 659d6c33d67SNikolay Aleksandrov if (hlist_empty(&pg->src_list)) { 660d6c33d67SNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 661d6c33d67SNikolay Aleksandrov } else if (changed) { 662085b53c8SNikolay Aleksandrov struct net_bridge_mdb_entry *mp = br_mdb_ip_get(br, &pg->key.addr); 663d6c33d67SNikolay Aleksandrov 6648266a049SNikolay Aleksandrov if (changed && br_multicast_is_star_g(&pg->key.addr)) 6658266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_INCLUDE); 6668266a049SNikolay Aleksandrov 667d6c33d67SNikolay Aleksandrov if (WARN_ON(!mp)) 668d6c33d67SNikolay Aleksandrov goto out; 669d6c33d67SNikolay Aleksandrov br_mdb_notify(br->dev, mp, pg, RTM_NEWMDB); 670d6c33d67SNikolay Aleksandrov } 671eb1d1641SHerbert Xu out: 672eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 673eb1d1641SHerbert Xu } 674eb1d1641SHerbert Xu 675e12cec65SNikolay Aleksandrov static void br_multicast_gc(struct hlist_head *head) 676e12cec65SNikolay Aleksandrov { 677e12cec65SNikolay Aleksandrov struct net_bridge_mcast_gc *gcent; 678e12cec65SNikolay Aleksandrov struct hlist_node *tmp; 679e12cec65SNikolay Aleksandrov 680e12cec65SNikolay Aleksandrov hlist_for_each_entry_safe(gcent, tmp, head, gc_node) { 681e12cec65SNikolay Aleksandrov hlist_del_init(&gcent->gc_node); 682e12cec65SNikolay Aleksandrov gcent->destroy(gcent); 683e12cec65SNikolay Aleksandrov } 684e12cec65SNikolay Aleksandrov } 685e12cec65SNikolay Aleksandrov 6868ef2a9a5SYOSHIFUJI Hideaki static struct sk_buff *br_ip4_multicast_alloc_query(struct net_bridge *br, 687438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 688438ef2d0SNikolay Aleksandrov __be32 ip_dst, __be32 group, 689438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_lmqt, 69042c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 69142c11ccfSNikolay Aleksandrov bool *need_rexmit) 692eb1d1641SHerbert Xu { 693085b53c8SNikolay Aleksandrov struct net_bridge_port *p = pg ? pg->key.port : NULL; 694438ef2d0SNikolay Aleksandrov struct net_bridge_group_src *ent; 695438ef2d0SNikolay Aleksandrov size_t pkt_size, igmp_hdr_size; 696438ef2d0SNikolay Aleksandrov unsigned long now = jiffies; 6975e923585SNikolay Aleksandrov struct igmpv3_query *ihv3; 698438ef2d0SNikolay Aleksandrov void *csum_start = NULL; 699438ef2d0SNikolay Aleksandrov __sum16 *csum = NULL; 700eb1d1641SHerbert Xu struct sk_buff *skb; 701eb1d1641SHerbert Xu struct igmphdr *ih; 702eb1d1641SHerbert Xu struct ethhdr *eth; 703438ef2d0SNikolay Aleksandrov unsigned long lmqt; 704eb1d1641SHerbert Xu struct iphdr *iph; 705438ef2d0SNikolay Aleksandrov u16 lmqt_srcs = 0; 706eb1d1641SHerbert Xu 7075e923585SNikolay Aleksandrov igmp_hdr_size = sizeof(*ih); 708438ef2d0SNikolay Aleksandrov if (br->multicast_igmp_version == 3) { 7095e923585SNikolay Aleksandrov igmp_hdr_size = sizeof(*ihv3); 710438ef2d0SNikolay Aleksandrov if (pg && with_srcs) { 711438ef2d0SNikolay Aleksandrov lmqt = now + (br->multicast_last_member_interval * 712438ef2d0SNikolay Aleksandrov br->multicast_last_member_count); 713438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 714438ef2d0SNikolay Aleksandrov if (over_lmqt == time_after(ent->timer.expires, 715438ef2d0SNikolay Aleksandrov lmqt) && 716438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) 717438ef2d0SNikolay Aleksandrov lmqt_srcs++; 718438ef2d0SNikolay Aleksandrov } 719438ef2d0SNikolay Aleksandrov 720438ef2d0SNikolay Aleksandrov if (!lmqt_srcs) 721438ef2d0SNikolay Aleksandrov return NULL; 722438ef2d0SNikolay Aleksandrov igmp_hdr_size += lmqt_srcs * sizeof(__be32); 723438ef2d0SNikolay Aleksandrov } 724438ef2d0SNikolay Aleksandrov } 725438ef2d0SNikolay Aleksandrov 726438ef2d0SNikolay Aleksandrov pkt_size = sizeof(*eth) + sizeof(*iph) + 4 + igmp_hdr_size; 727438ef2d0SNikolay Aleksandrov if ((p && pkt_size > p->dev->mtu) || 728438ef2d0SNikolay Aleksandrov pkt_size > br->dev->mtu) 729438ef2d0SNikolay Aleksandrov return NULL; 730438ef2d0SNikolay Aleksandrov 731438ef2d0SNikolay Aleksandrov skb = netdev_alloc_skb_ip_align(br->dev, pkt_size); 732eb1d1641SHerbert Xu if (!skb) 733eb1d1641SHerbert Xu goto out; 734eb1d1641SHerbert Xu 735eb1d1641SHerbert Xu skb->protocol = htons(ETH_P_IP); 736eb1d1641SHerbert Xu 737eb1d1641SHerbert Xu skb_reset_mac_header(skb); 738eb1d1641SHerbert Xu eth = eth_hdr(skb); 739eb1d1641SHerbert Xu 740e5a727f6SJoe Perches ether_addr_copy(eth->h_source, br->dev->dev_addr); 741438ef2d0SNikolay Aleksandrov ip_eth_mc_map(ip_dst, eth->h_dest); 742eb1d1641SHerbert Xu eth->h_proto = htons(ETH_P_IP); 743eb1d1641SHerbert Xu skb_put(skb, sizeof(*eth)); 744eb1d1641SHerbert Xu 745eb1d1641SHerbert Xu skb_set_network_header(skb, skb->len); 746eb1d1641SHerbert Xu iph = ip_hdr(skb); 747438ef2d0SNikolay Aleksandrov iph->tot_len = htons(pkt_size - sizeof(*eth)); 748eb1d1641SHerbert Xu 749eb1d1641SHerbert Xu iph->version = 4; 750eb1d1641SHerbert Xu iph->ihl = 6; 751eb1d1641SHerbert Xu iph->tos = 0xc0; 752eb1d1641SHerbert Xu iph->id = 0; 753eb1d1641SHerbert Xu iph->frag_off = htons(IP_DF); 754eb1d1641SHerbert Xu iph->ttl = 1; 755eb1d1641SHerbert Xu iph->protocol = IPPROTO_IGMP; 756675779adSNikolay Aleksandrov iph->saddr = br_opt_get(br, BROPT_MULTICAST_QUERY_USE_IFADDR) ? 7571c8ad5bfSCong Wang inet_select_addr(br->dev, 0, RT_SCOPE_LINK) : 0; 758438ef2d0SNikolay Aleksandrov iph->daddr = ip_dst; 759eb1d1641SHerbert Xu ((u8 *)&iph[1])[0] = IPOPT_RA; 760eb1d1641SHerbert Xu ((u8 *)&iph[1])[1] = 4; 761eb1d1641SHerbert Xu ((u8 *)&iph[1])[2] = 0; 762eb1d1641SHerbert Xu ((u8 *)&iph[1])[3] = 0; 763eb1d1641SHerbert Xu ip_send_check(iph); 764eb1d1641SHerbert Xu skb_put(skb, 24); 765eb1d1641SHerbert Xu 766eb1d1641SHerbert Xu skb_set_transport_header(skb, skb->len); 7671080ab95SNikolay Aleksandrov *igmp_type = IGMP_HOST_MEMBERSHIP_QUERY; 7685e923585SNikolay Aleksandrov 7695e923585SNikolay Aleksandrov switch (br->multicast_igmp_version) { 7705e923585SNikolay Aleksandrov case 2: 7715e923585SNikolay Aleksandrov ih = igmp_hdr(skb); 772eb1d1641SHerbert Xu ih->type = IGMP_HOST_MEMBERSHIP_QUERY; 773eb1d1641SHerbert Xu ih->code = (group ? br->multicast_last_member_interval : 774eb1d1641SHerbert Xu br->multicast_query_response_interval) / 775eb1d1641SHerbert Xu (HZ / IGMP_TIMER_SCALE); 776eb1d1641SHerbert Xu ih->group = group; 777eb1d1641SHerbert Xu ih->csum = 0; 778438ef2d0SNikolay Aleksandrov csum = &ih->csum; 779438ef2d0SNikolay Aleksandrov csum_start = (void *)ih; 7805e923585SNikolay Aleksandrov break; 7815e923585SNikolay Aleksandrov case 3: 7825e923585SNikolay Aleksandrov ihv3 = igmpv3_query_hdr(skb); 7835e923585SNikolay Aleksandrov ihv3->type = IGMP_HOST_MEMBERSHIP_QUERY; 7845e923585SNikolay Aleksandrov ihv3->code = (group ? br->multicast_last_member_interval : 7855e923585SNikolay Aleksandrov br->multicast_query_response_interval) / 7865e923585SNikolay Aleksandrov (HZ / IGMP_TIMER_SCALE); 7875e923585SNikolay Aleksandrov ihv3->group = group; 7885e923585SNikolay Aleksandrov ihv3->qqic = br->multicast_query_interval / HZ; 789438ef2d0SNikolay Aleksandrov ihv3->nsrcs = htons(lmqt_srcs); 7905e923585SNikolay Aleksandrov ihv3->resv = 0; 791438ef2d0SNikolay Aleksandrov ihv3->suppress = sflag; 7925e923585SNikolay Aleksandrov ihv3->qrv = 2; 7935e923585SNikolay Aleksandrov ihv3->csum = 0; 794438ef2d0SNikolay Aleksandrov csum = &ihv3->csum; 795438ef2d0SNikolay Aleksandrov csum_start = (void *)ihv3; 796438ef2d0SNikolay Aleksandrov if (!pg || !with_srcs) 797438ef2d0SNikolay Aleksandrov break; 798438ef2d0SNikolay Aleksandrov 799438ef2d0SNikolay Aleksandrov lmqt_srcs = 0; 800438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 801438ef2d0SNikolay Aleksandrov if (over_lmqt == time_after(ent->timer.expires, 802438ef2d0SNikolay Aleksandrov lmqt) && 803438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) { 804deb96566SNikolay Aleksandrov ihv3->srcs[lmqt_srcs++] = ent->addr.src.ip4; 805438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt--; 80642c11ccfSNikolay Aleksandrov if (need_rexmit && ent->src_query_rexmit_cnt) 80742c11ccfSNikolay Aleksandrov *need_rexmit = true; 808438ef2d0SNikolay Aleksandrov } 809438ef2d0SNikolay Aleksandrov } 810438ef2d0SNikolay Aleksandrov if (WARN_ON(lmqt_srcs != ntohs(ihv3->nsrcs))) { 811438ef2d0SNikolay Aleksandrov kfree_skb(skb); 812438ef2d0SNikolay Aleksandrov return NULL; 813438ef2d0SNikolay Aleksandrov } 8145e923585SNikolay Aleksandrov break; 8155e923585SNikolay Aleksandrov } 816eb1d1641SHerbert Xu 817438ef2d0SNikolay Aleksandrov if (WARN_ON(!csum || !csum_start)) { 818438ef2d0SNikolay Aleksandrov kfree_skb(skb); 819438ef2d0SNikolay Aleksandrov return NULL; 820438ef2d0SNikolay Aleksandrov } 821438ef2d0SNikolay Aleksandrov 822438ef2d0SNikolay Aleksandrov *csum = ip_compute_csum(csum_start, igmp_hdr_size); 8235e923585SNikolay Aleksandrov skb_put(skb, igmp_hdr_size); 824eb1d1641SHerbert Xu __skb_pull(skb, sizeof(*eth)); 825eb1d1641SHerbert Xu 826eb1d1641SHerbert Xu out: 827eb1d1641SHerbert Xu return skb; 828eb1d1641SHerbert Xu } 829eb1d1641SHerbert Xu 830dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 83108b202b6SYOSHIFUJI Hideaki static struct sk_buff *br_ip6_multicast_alloc_query(struct net_bridge *br, 832438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 833438ef2d0SNikolay Aleksandrov const struct in6_addr *ip6_dst, 834438ef2d0SNikolay Aleksandrov const struct in6_addr *group, 835438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_llqt, 83642c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 83742c11ccfSNikolay Aleksandrov bool *need_rexmit) 83808b202b6SYOSHIFUJI Hideaki { 839085b53c8SNikolay Aleksandrov struct net_bridge_port *p = pg ? pg->key.port : NULL; 840438ef2d0SNikolay Aleksandrov struct net_bridge_group_src *ent; 841438ef2d0SNikolay Aleksandrov size_t pkt_size, mld_hdr_size; 842438ef2d0SNikolay Aleksandrov unsigned long now = jiffies; 843aa2ae3e7SNikolay Aleksandrov struct mld2_query *mld2q; 844438ef2d0SNikolay Aleksandrov void *csum_start = NULL; 845aa2ae3e7SNikolay Aleksandrov unsigned long interval; 846438ef2d0SNikolay Aleksandrov __sum16 *csum = NULL; 84708b202b6SYOSHIFUJI Hideaki struct ipv6hdr *ip6h; 84808b202b6SYOSHIFUJI Hideaki struct mld_msg *mldq; 849aa2ae3e7SNikolay Aleksandrov struct sk_buff *skb; 850438ef2d0SNikolay Aleksandrov unsigned long llqt; 85108b202b6SYOSHIFUJI Hideaki struct ethhdr *eth; 852438ef2d0SNikolay Aleksandrov u16 llqt_srcs = 0; 85308b202b6SYOSHIFUJI Hideaki u8 *hopopt; 85408b202b6SYOSHIFUJI Hideaki 855aa2ae3e7SNikolay Aleksandrov mld_hdr_size = sizeof(*mldq); 856438ef2d0SNikolay Aleksandrov if (br->multicast_mld_version == 2) { 857aa2ae3e7SNikolay Aleksandrov mld_hdr_size = sizeof(*mld2q); 858438ef2d0SNikolay Aleksandrov if (pg && with_srcs) { 859438ef2d0SNikolay Aleksandrov llqt = now + (br->multicast_last_member_interval * 860438ef2d0SNikolay Aleksandrov br->multicast_last_member_count); 861438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 862438ef2d0SNikolay Aleksandrov if (over_llqt == time_after(ent->timer.expires, 863438ef2d0SNikolay Aleksandrov llqt) && 864438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) 865438ef2d0SNikolay Aleksandrov llqt_srcs++; 866438ef2d0SNikolay Aleksandrov } 867438ef2d0SNikolay Aleksandrov 868438ef2d0SNikolay Aleksandrov if (!llqt_srcs) 869438ef2d0SNikolay Aleksandrov return NULL; 870438ef2d0SNikolay Aleksandrov mld_hdr_size += llqt_srcs * sizeof(struct in6_addr); 871438ef2d0SNikolay Aleksandrov } 872438ef2d0SNikolay Aleksandrov } 873438ef2d0SNikolay Aleksandrov 874438ef2d0SNikolay Aleksandrov pkt_size = sizeof(*eth) + sizeof(*ip6h) + 8 + mld_hdr_size; 875438ef2d0SNikolay Aleksandrov if ((p && pkt_size > p->dev->mtu) || 876438ef2d0SNikolay Aleksandrov pkt_size > br->dev->mtu) 877438ef2d0SNikolay Aleksandrov return NULL; 878438ef2d0SNikolay Aleksandrov 879438ef2d0SNikolay Aleksandrov skb = netdev_alloc_skb_ip_align(br->dev, pkt_size); 88008b202b6SYOSHIFUJI Hideaki if (!skb) 88108b202b6SYOSHIFUJI Hideaki goto out; 88208b202b6SYOSHIFUJI Hideaki 88308b202b6SYOSHIFUJI Hideaki skb->protocol = htons(ETH_P_IPV6); 88408b202b6SYOSHIFUJI Hideaki 88508b202b6SYOSHIFUJI Hideaki /* Ethernet header */ 88608b202b6SYOSHIFUJI Hideaki skb_reset_mac_header(skb); 88708b202b6SYOSHIFUJI Hideaki eth = eth_hdr(skb); 88808b202b6SYOSHIFUJI Hideaki 889e5a727f6SJoe Perches ether_addr_copy(eth->h_source, br->dev->dev_addr); 89008b202b6SYOSHIFUJI Hideaki eth->h_proto = htons(ETH_P_IPV6); 89108b202b6SYOSHIFUJI Hideaki skb_put(skb, sizeof(*eth)); 89208b202b6SYOSHIFUJI Hideaki 89308b202b6SYOSHIFUJI Hideaki /* IPv6 header + HbH option */ 89408b202b6SYOSHIFUJI Hideaki skb_set_network_header(skb, skb->len); 89508b202b6SYOSHIFUJI Hideaki ip6h = ipv6_hdr(skb); 89608b202b6SYOSHIFUJI Hideaki 89708b202b6SYOSHIFUJI Hideaki *(__force __be32 *)ip6h = htonl(0x60000000); 898aa2ae3e7SNikolay Aleksandrov ip6h->payload_len = htons(8 + mld_hdr_size); 89908b202b6SYOSHIFUJI Hideaki ip6h->nexthdr = IPPROTO_HOPOPTS; 90008b202b6SYOSHIFUJI Hideaki ip6h->hop_limit = 1; 901438ef2d0SNikolay Aleksandrov ip6h->daddr = *ip6_dst; 902d1d81d4cSUlrich Weber if (ipv6_dev_get_saddr(dev_net(br->dev), br->dev, &ip6h->daddr, 0, 903d1d81d4cSUlrich Weber &ip6h->saddr)) { 904d1d81d4cSUlrich Weber kfree_skb(skb); 905675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_HAS_IPV6_ADDR, false); 906d1d81d4cSUlrich Weber return NULL; 907d1d81d4cSUlrich Weber } 9080888d5f3Sdaniel 909675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_HAS_IPV6_ADDR, true); 91036cff5a1SLinus Lüssing ipv6_eth_mc_map(&ip6h->daddr, eth->h_dest); 91108b202b6SYOSHIFUJI Hideaki 91208b202b6SYOSHIFUJI Hideaki hopopt = (u8 *)(ip6h + 1); 91308b202b6SYOSHIFUJI Hideaki hopopt[0] = IPPROTO_ICMPV6; /* next hdr */ 91408b202b6SYOSHIFUJI Hideaki hopopt[1] = 0; /* length of HbH */ 91508b202b6SYOSHIFUJI Hideaki hopopt[2] = IPV6_TLV_ROUTERALERT; /* Router Alert */ 91608b202b6SYOSHIFUJI Hideaki hopopt[3] = 2; /* Length of RA Option */ 91708b202b6SYOSHIFUJI Hideaki hopopt[4] = 0; /* Type = 0x0000 (MLD) */ 91808b202b6SYOSHIFUJI Hideaki hopopt[5] = 0; 9191de5a71cSEldad Zack hopopt[6] = IPV6_TLV_PAD1; /* Pad1 */ 9201de5a71cSEldad Zack hopopt[7] = IPV6_TLV_PAD1; /* Pad1 */ 92108b202b6SYOSHIFUJI Hideaki 92208b202b6SYOSHIFUJI Hideaki skb_put(skb, sizeof(*ip6h) + 8); 92308b202b6SYOSHIFUJI Hideaki 92408b202b6SYOSHIFUJI Hideaki /* ICMPv6 */ 92508b202b6SYOSHIFUJI Hideaki skb_set_transport_header(skb, skb->len); 926438ef2d0SNikolay Aleksandrov interval = ipv6_addr_any(group) ? 92732de868cSLinus Lüssing br->multicast_query_response_interval : 92832de868cSLinus Lüssing br->multicast_last_member_interval; 9291080ab95SNikolay Aleksandrov *igmp_type = ICMPV6_MGM_QUERY; 930aa2ae3e7SNikolay Aleksandrov switch (br->multicast_mld_version) { 931aa2ae3e7SNikolay Aleksandrov case 1: 932aa2ae3e7SNikolay Aleksandrov mldq = (struct mld_msg *)icmp6_hdr(skb); 93308b202b6SYOSHIFUJI Hideaki mldq->mld_type = ICMPV6_MGM_QUERY; 93408b202b6SYOSHIFUJI Hideaki mldq->mld_code = 0; 93508b202b6SYOSHIFUJI Hideaki mldq->mld_cksum = 0; 93608b202b6SYOSHIFUJI Hideaki mldq->mld_maxdelay = htons((u16)jiffies_to_msecs(interval)); 93708b202b6SYOSHIFUJI Hideaki mldq->mld_reserved = 0; 938438ef2d0SNikolay Aleksandrov mldq->mld_mca = *group; 939438ef2d0SNikolay Aleksandrov csum = &mldq->mld_cksum; 940438ef2d0SNikolay Aleksandrov csum_start = (void *)mldq; 941aa2ae3e7SNikolay Aleksandrov break; 942aa2ae3e7SNikolay Aleksandrov case 2: 943aa2ae3e7SNikolay Aleksandrov mld2q = (struct mld2_query *)icmp6_hdr(skb); 94453631a5fSLance Richardson mld2q->mld2q_mrc = htons((u16)jiffies_to_msecs(interval)); 945aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_type = ICMPV6_MGM_QUERY; 946aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_code = 0; 947aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_cksum = 0; 948aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_resv1 = 0; 949aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_resv2 = 0; 950438ef2d0SNikolay Aleksandrov mld2q->mld2q_suppress = sflag; 951aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_qrv = 2; 952438ef2d0SNikolay Aleksandrov mld2q->mld2q_nsrcs = htons(llqt_srcs); 953aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_qqic = br->multicast_query_interval / HZ; 954438ef2d0SNikolay Aleksandrov mld2q->mld2q_mca = *group; 955438ef2d0SNikolay Aleksandrov csum = &mld2q->mld2q_cksum; 956438ef2d0SNikolay Aleksandrov csum_start = (void *)mld2q; 957438ef2d0SNikolay Aleksandrov if (!pg || !with_srcs) 958438ef2d0SNikolay Aleksandrov break; 959438ef2d0SNikolay Aleksandrov 960438ef2d0SNikolay Aleksandrov llqt_srcs = 0; 961438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 962438ef2d0SNikolay Aleksandrov if (over_llqt == time_after(ent->timer.expires, 963438ef2d0SNikolay Aleksandrov llqt) && 964438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) { 965deb96566SNikolay Aleksandrov mld2q->mld2q_srcs[llqt_srcs++] = ent->addr.src.ip6; 966438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt--; 96742c11ccfSNikolay Aleksandrov if (need_rexmit && ent->src_query_rexmit_cnt) 96842c11ccfSNikolay Aleksandrov *need_rexmit = true; 969438ef2d0SNikolay Aleksandrov } 970438ef2d0SNikolay Aleksandrov } 971438ef2d0SNikolay Aleksandrov if (WARN_ON(llqt_srcs != ntohs(mld2q->mld2q_nsrcs))) { 972438ef2d0SNikolay Aleksandrov kfree_skb(skb); 973438ef2d0SNikolay Aleksandrov return NULL; 974438ef2d0SNikolay Aleksandrov } 975aa2ae3e7SNikolay Aleksandrov break; 976aa2ae3e7SNikolay Aleksandrov } 97708b202b6SYOSHIFUJI Hideaki 978438ef2d0SNikolay Aleksandrov if (WARN_ON(!csum || !csum_start)) { 979438ef2d0SNikolay Aleksandrov kfree_skb(skb); 980438ef2d0SNikolay Aleksandrov return NULL; 981438ef2d0SNikolay Aleksandrov } 982438ef2d0SNikolay Aleksandrov 983438ef2d0SNikolay Aleksandrov *csum = csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr, mld_hdr_size, 984438ef2d0SNikolay Aleksandrov IPPROTO_ICMPV6, 985438ef2d0SNikolay Aleksandrov csum_partial(csum_start, mld_hdr_size, 0)); 986438ef2d0SNikolay Aleksandrov skb_put(skb, mld_hdr_size); 98708b202b6SYOSHIFUJI Hideaki __skb_pull(skb, sizeof(*eth)); 98808b202b6SYOSHIFUJI Hideaki 98908b202b6SYOSHIFUJI Hideaki out: 99008b202b6SYOSHIFUJI Hideaki return skb; 99108b202b6SYOSHIFUJI Hideaki } 99208b202b6SYOSHIFUJI Hideaki #endif 99308b202b6SYOSHIFUJI Hideaki 9948ef2a9a5SYOSHIFUJI Hideaki static struct sk_buff *br_multicast_alloc_query(struct net_bridge *br, 995438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 996438ef2d0SNikolay Aleksandrov struct br_ip *ip_dst, 997438ef2d0SNikolay Aleksandrov struct br_ip *group, 998438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_lmqt, 99942c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 100042c11ccfSNikolay Aleksandrov bool *need_rexmit) 10018ef2a9a5SYOSHIFUJI Hideaki { 1002438ef2d0SNikolay Aleksandrov __be32 ip4_dst; 1003438ef2d0SNikolay Aleksandrov 1004438ef2d0SNikolay Aleksandrov switch (group->proto) { 10058ef2a9a5SYOSHIFUJI Hideaki case htons(ETH_P_IP): 1006eab3227bSNikolay Aleksandrov ip4_dst = ip_dst ? ip_dst->dst.ip4 : htonl(INADDR_ALLHOSTS_GROUP); 1007438ef2d0SNikolay Aleksandrov return br_ip4_multicast_alloc_query(br, pg, 1008eab3227bSNikolay Aleksandrov ip4_dst, group->dst.ip4, 1009438ef2d0SNikolay Aleksandrov with_srcs, over_lmqt, 101042c11ccfSNikolay Aleksandrov sflag, igmp_type, 101142c11ccfSNikolay Aleksandrov need_rexmit); 1012dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1013438ef2d0SNikolay Aleksandrov case htons(ETH_P_IPV6): { 1014438ef2d0SNikolay Aleksandrov struct in6_addr ip6_dst; 1015438ef2d0SNikolay Aleksandrov 1016438ef2d0SNikolay Aleksandrov if (ip_dst) 1017eab3227bSNikolay Aleksandrov ip6_dst = ip_dst->dst.ip6; 1018438ef2d0SNikolay Aleksandrov else 1019438ef2d0SNikolay Aleksandrov ipv6_addr_set(&ip6_dst, htonl(0xff020000), 0, 0, 1020438ef2d0SNikolay Aleksandrov htonl(1)); 1021438ef2d0SNikolay Aleksandrov 1022438ef2d0SNikolay Aleksandrov return br_ip6_multicast_alloc_query(br, pg, 1023eab3227bSNikolay Aleksandrov &ip6_dst, &group->dst.ip6, 1024438ef2d0SNikolay Aleksandrov with_srcs, over_lmqt, 102542c11ccfSNikolay Aleksandrov sflag, igmp_type, 102642c11ccfSNikolay Aleksandrov need_rexmit); 1027438ef2d0SNikolay Aleksandrov } 102808b202b6SYOSHIFUJI Hideaki #endif 10298ef2a9a5SYOSHIFUJI Hideaki } 10308ef2a9a5SYOSHIFUJI Hideaki return NULL; 10318ef2a9a5SYOSHIFUJI Hideaki } 10328ef2a9a5SYOSHIFUJI Hideaki 1033cfd56754SCong Wang struct net_bridge_mdb_entry *br_multicast_new_group(struct net_bridge *br, 10345e923585SNikolay Aleksandrov struct br_ip *group) 1035eb1d1641SHerbert Xu { 1036eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 10374c0833bcSTobias Klauser int err; 1038eb1d1641SHerbert Xu 103919e3a9c9SNikolay Aleksandrov mp = br_mdb_ip_get(br, group); 104019e3a9c9SNikolay Aleksandrov if (mp) 104119e3a9c9SNikolay Aleksandrov return mp; 1042eb1d1641SHerbert Xu 104319e3a9c9SNikolay Aleksandrov if (atomic_read(&br->mdb_hash_tbl.nelems) >= br->hash_max) { 104419e3a9c9SNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_ENABLED, false); 104519e3a9c9SNikolay Aleksandrov return ERR_PTR(-E2BIG); 1046eb1d1641SHerbert Xu } 1047eb1d1641SHerbert Xu 1048eb1d1641SHerbert Xu mp = kzalloc(sizeof(*mp), GFP_ATOMIC); 1049eb1d1641SHerbert Xu if (unlikely(!mp)) 10504c0833bcSTobias Klauser return ERR_PTR(-ENOMEM); 1051eb1d1641SHerbert Xu 1052eb1d1641SHerbert Xu mp->br = br; 10538ef2a9a5SYOSHIFUJI Hideaki mp->addr = *group; 1054e12cec65SNikolay Aleksandrov mp->mcast_gc.destroy = br_multicast_destroy_mdb_entry; 105588c1f37fSAllen Pais timer_setup(&mp->timer, br_multicast_group_expired, 0); 105619e3a9c9SNikolay Aleksandrov err = rhashtable_lookup_insert_fast(&br->mdb_hash_tbl, &mp->rhnode, 105719e3a9c9SNikolay Aleksandrov br_mdb_rht_params); 105819e3a9c9SNikolay Aleksandrov if (err) { 105919e3a9c9SNikolay Aleksandrov kfree(mp); 106019e3a9c9SNikolay Aleksandrov mp = ERR_PTR(err); 106119e3a9c9SNikolay Aleksandrov } else { 106219e3a9c9SNikolay Aleksandrov hlist_add_head_rcu(&mp->mdb_node, &br->mdb_list); 106319e3a9c9SNikolay Aleksandrov } 10641faabf2aSEric Dumazet 1065eb1d1641SHerbert Xu return mp; 1066eb1d1641SHerbert Xu } 1067eb1d1641SHerbert Xu 10688b671779SNikolay Aleksandrov static void br_multicast_group_src_expired(struct timer_list *t) 10698b671779SNikolay Aleksandrov { 10708b671779SNikolay Aleksandrov struct net_bridge_group_src *src = from_timer(src, t, timer); 10718b671779SNikolay Aleksandrov struct net_bridge_port_group *pg; 10728b671779SNikolay Aleksandrov struct net_bridge *br = src->br; 10738b671779SNikolay Aleksandrov 10748b671779SNikolay Aleksandrov spin_lock(&br->multicast_lock); 10758b671779SNikolay Aleksandrov if (hlist_unhashed(&src->node) || !netif_running(br->dev) || 10768b671779SNikolay Aleksandrov timer_pending(&src->timer)) 10778b671779SNikolay Aleksandrov goto out; 10788b671779SNikolay Aleksandrov 10798b671779SNikolay Aleksandrov pg = src->pg; 10808b671779SNikolay Aleksandrov if (pg->filter_mode == MCAST_INCLUDE) { 10818b671779SNikolay Aleksandrov br_multicast_del_group_src(src); 10828b671779SNikolay Aleksandrov if (!hlist_empty(&pg->src_list)) 10838b671779SNikolay Aleksandrov goto out; 10848b671779SNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 10859116ffbfSNikolay Aleksandrov } else { 10869116ffbfSNikolay Aleksandrov br_multicast_fwd_src_handle(src); 10878b671779SNikolay Aleksandrov } 10889116ffbfSNikolay Aleksandrov 10898b671779SNikolay Aleksandrov out: 10908b671779SNikolay Aleksandrov spin_unlock(&br->multicast_lock); 10918b671779SNikolay Aleksandrov } 10928b671779SNikolay Aleksandrov 10938b671779SNikolay Aleksandrov static struct net_bridge_group_src * 10948b671779SNikolay Aleksandrov br_multicast_find_group_src(struct net_bridge_port_group *pg, struct br_ip *ip) 10958b671779SNikolay Aleksandrov { 10968b671779SNikolay Aleksandrov struct net_bridge_group_src *ent; 10978b671779SNikolay Aleksandrov 10988b671779SNikolay Aleksandrov switch (ip->proto) { 10998b671779SNikolay Aleksandrov case htons(ETH_P_IP): 11008b671779SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1101deb96566SNikolay Aleksandrov if (ip->src.ip4 == ent->addr.src.ip4) 11028b671779SNikolay Aleksandrov return ent; 11038b671779SNikolay Aleksandrov break; 11048b671779SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 11058b671779SNikolay Aleksandrov case htons(ETH_P_IPV6): 11068b671779SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1107deb96566SNikolay Aleksandrov if (!ipv6_addr_cmp(&ent->addr.src.ip6, &ip->src.ip6)) 11088b671779SNikolay Aleksandrov return ent; 11098b671779SNikolay Aleksandrov break; 11108b671779SNikolay Aleksandrov #endif 11118b671779SNikolay Aleksandrov } 11128b671779SNikolay Aleksandrov 11138b671779SNikolay Aleksandrov return NULL; 11148b671779SNikolay Aleksandrov } 11158b671779SNikolay Aleksandrov 11168b671779SNikolay Aleksandrov static struct net_bridge_group_src * 11178b671779SNikolay Aleksandrov br_multicast_new_group_src(struct net_bridge_port_group *pg, struct br_ip *src_ip) 11188b671779SNikolay Aleksandrov { 11198b671779SNikolay Aleksandrov struct net_bridge_group_src *grp_src; 11208b671779SNikolay Aleksandrov 11218b671779SNikolay Aleksandrov if (unlikely(pg->src_ents >= PG_SRC_ENT_LIMIT)) 11228b671779SNikolay Aleksandrov return NULL; 11238b671779SNikolay Aleksandrov 11248b671779SNikolay Aleksandrov switch (src_ip->proto) { 11258b671779SNikolay Aleksandrov case htons(ETH_P_IP): 1126deb96566SNikolay Aleksandrov if (ipv4_is_zeronet(src_ip->src.ip4) || 1127deb96566SNikolay Aleksandrov ipv4_is_multicast(src_ip->src.ip4)) 11288b671779SNikolay Aleksandrov return NULL; 11298b671779SNikolay Aleksandrov break; 11308b671779SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 11318b671779SNikolay Aleksandrov case htons(ETH_P_IPV6): 1132deb96566SNikolay Aleksandrov if (ipv6_addr_any(&src_ip->src.ip6) || 1133deb96566SNikolay Aleksandrov ipv6_addr_is_multicast(&src_ip->src.ip6)) 11348b671779SNikolay Aleksandrov return NULL; 11358b671779SNikolay Aleksandrov break; 11368b671779SNikolay Aleksandrov #endif 11378b671779SNikolay Aleksandrov } 11388b671779SNikolay Aleksandrov 11398b671779SNikolay Aleksandrov grp_src = kzalloc(sizeof(*grp_src), GFP_ATOMIC); 11408b671779SNikolay Aleksandrov if (unlikely(!grp_src)) 11418b671779SNikolay Aleksandrov return NULL; 11428b671779SNikolay Aleksandrov 11438b671779SNikolay Aleksandrov grp_src->pg = pg; 1144085b53c8SNikolay Aleksandrov grp_src->br = pg->key.port->br; 11458b671779SNikolay Aleksandrov grp_src->addr = *src_ip; 1146e12cec65SNikolay Aleksandrov grp_src->mcast_gc.destroy = br_multicast_destroy_group_src; 11478b671779SNikolay Aleksandrov timer_setup(&grp_src->timer, br_multicast_group_src_expired, 0); 11488b671779SNikolay Aleksandrov 11498b671779SNikolay Aleksandrov hlist_add_head_rcu(&grp_src->node, &pg->src_list); 11508b671779SNikolay Aleksandrov pg->src_ents++; 11518b671779SNikolay Aleksandrov 11528b671779SNikolay Aleksandrov return grp_src; 11538b671779SNikolay Aleksandrov } 11548b671779SNikolay Aleksandrov 1155cfd56754SCong Wang struct net_bridge_port_group *br_multicast_new_port_group( 1156cfd56754SCong Wang struct net_bridge_port *port, 1157cfd56754SCong Wang struct br_ip *group, 1158ccb1c31aSAmerigo Wang struct net_bridge_port_group __rcu *next, 11596db6f0eaSFelix Fietkau unsigned char flags, 11608b671779SNikolay Aleksandrov const unsigned char *src, 11618f8cb77eSNikolay Aleksandrov u8 filter_mode, 11628f8cb77eSNikolay Aleksandrov u8 rt_protocol) 1163cfd56754SCong Wang { 1164cfd56754SCong Wang struct net_bridge_port_group *p; 1165cfd56754SCong Wang 1166cfd56754SCong Wang p = kzalloc(sizeof(*p), GFP_ATOMIC); 1167cfd56754SCong Wang if (unlikely(!p)) 1168cfd56754SCong Wang return NULL; 1169cfd56754SCong Wang 1170085b53c8SNikolay Aleksandrov p->key.addr = *group; 1171085b53c8SNikolay Aleksandrov p->key.port = port; 11729d06b6d8SElad Raz p->flags = flags; 11738b671779SNikolay Aleksandrov p->filter_mode = filter_mode; 11748f8cb77eSNikolay Aleksandrov p->rt_protocol = rt_protocol; 1175e12cec65SNikolay Aleksandrov p->mcast_gc.destroy = br_multicast_destroy_port_group; 11768b671779SNikolay Aleksandrov INIT_HLIST_HEAD(&p->src_list); 1177085b53c8SNikolay Aleksandrov 1178085b53c8SNikolay Aleksandrov if (!br_multicast_is_star_g(group) && 1179085b53c8SNikolay Aleksandrov rhashtable_lookup_insert_fast(&port->br->sg_port_tbl, &p->rhnode, 1180085b53c8SNikolay Aleksandrov br_sg_port_rht_params)) { 1181085b53c8SNikolay Aleksandrov kfree(p); 1182085b53c8SNikolay Aleksandrov return NULL; 1183085b53c8SNikolay Aleksandrov } 1184085b53c8SNikolay Aleksandrov 1185eca2a43bSstephen hemminger rcu_assign_pointer(p->next, next); 118688c1f37fSAllen Pais timer_setup(&p->timer, br_multicast_port_group_expired, 0); 118742c11ccfSNikolay Aleksandrov timer_setup(&p->rexmit_timer, br_multicast_port_group_rexmit, 0); 118842c11ccfSNikolay Aleksandrov hlist_add_head(&p->mglist, &port->mglist); 11896db6f0eaSFelix Fietkau 11906db6f0eaSFelix Fietkau if (src) 11916db6f0eaSFelix Fietkau memcpy(p->eth_addr, src, ETH_ALEN); 11926db6f0eaSFelix Fietkau else 11931bfe45f4SMao Wenan eth_broadcast_addr(p->eth_addr); 11946db6f0eaSFelix Fietkau 1195cfd56754SCong Wang return p; 1196cfd56754SCong Wang } 1197cfd56754SCong Wang 11981bc844eeSNikolay Aleksandrov void br_multicast_host_join(struct net_bridge_mdb_entry *mp, bool notify) 11991bc844eeSNikolay Aleksandrov { 12001bc844eeSNikolay Aleksandrov if (!mp->host_joined) { 12011bc844eeSNikolay Aleksandrov mp->host_joined = true; 1202094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1203094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 12041bc844eeSNikolay Aleksandrov if (notify) 120581f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_NEWMDB); 12061bc844eeSNikolay Aleksandrov } 1207955062b0SNikolay Aleksandrov 1208955062b0SNikolay Aleksandrov if (br_group_is_l2(&mp->addr)) 1209955062b0SNikolay Aleksandrov return; 1210955062b0SNikolay Aleksandrov 12111bc844eeSNikolay Aleksandrov mod_timer(&mp->timer, jiffies + mp->br->multicast_membership_interval); 12121bc844eeSNikolay Aleksandrov } 12131bc844eeSNikolay Aleksandrov 12141bc844eeSNikolay Aleksandrov void br_multicast_host_leave(struct net_bridge_mdb_entry *mp, bool notify) 12151bc844eeSNikolay Aleksandrov { 12161bc844eeSNikolay Aleksandrov if (!mp->host_joined) 12171bc844eeSNikolay Aleksandrov return; 12181bc844eeSNikolay Aleksandrov 12191bc844eeSNikolay Aleksandrov mp->host_joined = false; 1220094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1221094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 12221bc844eeSNikolay Aleksandrov if (notify) 122381f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_DELMDB); 12241bc844eeSNikolay Aleksandrov } 12251bc844eeSNikolay Aleksandrov 1226b0812368SNikolay Aleksandrov static struct net_bridge_port_group * 1227b0812368SNikolay Aleksandrov __br_multicast_add_group(struct net_bridge *br, 12288ef2a9a5SYOSHIFUJI Hideaki struct net_bridge_port *port, 12296db6f0eaSFelix Fietkau struct br_ip *group, 12308b671779SNikolay Aleksandrov const unsigned char *src, 12310436862eSNikolay Aleksandrov u8 filter_mode, 12329116ffbfSNikolay Aleksandrov bool igmpv2_mldv1, 12339116ffbfSNikolay Aleksandrov bool blocked) 1234eb1d1641SHerbert Xu { 1235e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 1236b0812368SNikolay Aleksandrov struct net_bridge_port_group *p = NULL; 12375e923585SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 1238454594f3SLinus Lüssing unsigned long now = jiffies; 1239eb1d1641SHerbert Xu 1240eb1d1641SHerbert Xu if (!netif_running(br->dev) || 1241eb1d1641SHerbert Xu (port && port->state == BR_STATE_DISABLED)) 1242eb1d1641SHerbert Xu goto out; 1243eb1d1641SHerbert Xu 124419e3a9c9SNikolay Aleksandrov mp = br_multicast_new_group(br, group); 12454c0833bcSTobias Klauser if (IS_ERR(mp)) 1246b0812368SNikolay Aleksandrov return ERR_PTR(PTR_ERR(mp)); 1247eb1d1641SHerbert Xu 1248eb1d1641SHerbert Xu if (!port) { 12491bc844eeSNikolay Aleksandrov br_multicast_host_join(mp, true); 1250eb1d1641SHerbert Xu goto out; 1251eb1d1641SHerbert Xu } 1252eb1d1641SHerbert Xu 1253e8051688SEric Dumazet for (pp = &mp->ports; 1254e8051688SEric Dumazet (p = mlock_dereference(*pp, br)) != NULL; 1255e8051688SEric Dumazet pp = &p->next) { 12566db6f0eaSFelix Fietkau if (br_port_group_equal(p, port, src)) 1257454594f3SLinus Lüssing goto found; 1258085b53c8SNikolay Aleksandrov if ((unsigned long)p->key.port < (unsigned long)port) 1259eb1d1641SHerbert Xu break; 1260eb1d1641SHerbert Xu } 1261eb1d1641SHerbert Xu 1262955062b0SNikolay Aleksandrov p = br_multicast_new_port_group(port, group, *pp, 0, src, 1263955062b0SNikolay Aleksandrov filter_mode, RTPROT_KERNEL); 1264b0812368SNikolay Aleksandrov if (unlikely(!p)) { 1265b0812368SNikolay Aleksandrov p = ERR_PTR(-ENOMEM); 1266b0812368SNikolay Aleksandrov goto out; 1267b0812368SNikolay Aleksandrov } 1268eb1d1641SHerbert Xu rcu_assign_pointer(*pp, p); 12699116ffbfSNikolay Aleksandrov if (blocked) 12709116ffbfSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_BLOCKED; 127181f19838SNikolay Aleksandrov br_mdb_notify(br->dev, mp, p, RTM_NEWMDB); 1272eb1d1641SHerbert Xu 1273454594f3SLinus Lüssing found: 12740436862eSNikolay Aleksandrov if (igmpv2_mldv1) 1275454594f3SLinus Lüssing mod_timer(&p->timer, now + br->multicast_membership_interval); 127681f19838SNikolay Aleksandrov 1277eb1d1641SHerbert Xu out: 1278b0812368SNikolay Aleksandrov return p; 1279b0812368SNikolay Aleksandrov } 1280eb1d1641SHerbert Xu 1281b0812368SNikolay Aleksandrov static int br_multicast_add_group(struct net_bridge *br, 1282b0812368SNikolay Aleksandrov struct net_bridge_port *port, 1283b0812368SNikolay Aleksandrov struct br_ip *group, 1284b0812368SNikolay Aleksandrov const unsigned char *src, 1285b0812368SNikolay Aleksandrov u8 filter_mode, 1286b0812368SNikolay Aleksandrov bool igmpv2_mldv1) 1287b0812368SNikolay Aleksandrov { 1288b0812368SNikolay Aleksandrov struct net_bridge_port_group *pg; 1289b0812368SNikolay Aleksandrov int err; 1290b0812368SNikolay Aleksandrov 1291b0812368SNikolay Aleksandrov spin_lock(&br->multicast_lock); 1292b0812368SNikolay Aleksandrov pg = __br_multicast_add_group(br, port, group, src, filter_mode, 12939116ffbfSNikolay Aleksandrov igmpv2_mldv1, false); 1294b0812368SNikolay Aleksandrov /* NULL is considered valid for host joined groups */ 1295b0812368SNikolay Aleksandrov err = IS_ERR(pg) ? PTR_ERR(pg) : 0; 1296eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1297b0812368SNikolay Aleksandrov 1298eb1d1641SHerbert Xu return err; 1299eb1d1641SHerbert Xu } 1300eb1d1641SHerbert Xu 13018ef2a9a5SYOSHIFUJI Hideaki static int br_ip4_multicast_add_group(struct net_bridge *br, 13028ef2a9a5SYOSHIFUJI Hideaki struct net_bridge_port *port, 1303b0e9a30dSVlad Yasevich __be32 group, 13046db6f0eaSFelix Fietkau __u16 vid, 13058b671779SNikolay Aleksandrov const unsigned char *src, 13068b671779SNikolay Aleksandrov bool igmpv2) 13078ef2a9a5SYOSHIFUJI Hideaki { 13088ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 13098b671779SNikolay Aleksandrov u8 filter_mode; 13108ef2a9a5SYOSHIFUJI Hideaki 13118ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 13128ef2a9a5SYOSHIFUJI Hideaki return 0; 13138ef2a9a5SYOSHIFUJI Hideaki 13141515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1315eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 13168ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1317b0e9a30dSVlad Yasevich br_group.vid = vid; 13188b671779SNikolay Aleksandrov filter_mode = igmpv2 ? MCAST_EXCLUDE : MCAST_INCLUDE; 13198ef2a9a5SYOSHIFUJI Hideaki 13200436862eSNikolay Aleksandrov return br_multicast_add_group(br, port, &br_group, src, filter_mode, 13210436862eSNikolay Aleksandrov igmpv2); 13228ef2a9a5SYOSHIFUJI Hideaki } 13238ef2a9a5SYOSHIFUJI Hideaki 1324dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 132508b202b6SYOSHIFUJI Hideaki static int br_ip6_multicast_add_group(struct net_bridge *br, 132608b202b6SYOSHIFUJI Hideaki struct net_bridge_port *port, 1327b0e9a30dSVlad Yasevich const struct in6_addr *group, 13286db6f0eaSFelix Fietkau __u16 vid, 13298b671779SNikolay Aleksandrov const unsigned char *src, 13308b671779SNikolay Aleksandrov bool mldv1) 133108b202b6SYOSHIFUJI Hideaki { 133208b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 13338b671779SNikolay Aleksandrov u8 filter_mode; 133408b202b6SYOSHIFUJI Hideaki 13353c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 133608b202b6SYOSHIFUJI Hideaki return 0; 133708b202b6SYOSHIFUJI Hideaki 133819e3a9c9SNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1339eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 13409cc6e0c4SLinus Lüssing br_group.proto = htons(ETH_P_IPV6); 1341b0e9a30dSVlad Yasevich br_group.vid = vid; 13428b671779SNikolay Aleksandrov filter_mode = mldv1 ? MCAST_EXCLUDE : MCAST_INCLUDE; 134308b202b6SYOSHIFUJI Hideaki 13440436862eSNikolay Aleksandrov return br_multicast_add_group(br, port, &br_group, src, filter_mode, 13450436862eSNikolay Aleksandrov mldv1); 134608b202b6SYOSHIFUJI Hideaki } 134708b202b6SYOSHIFUJI Hideaki #endif 134808b202b6SYOSHIFUJI Hideaki 134988c1f37fSAllen Pais static void br_multicast_router_expired(struct timer_list *t) 1350eb1d1641SHerbert Xu { 135188c1f37fSAllen Pais struct net_bridge_port *port = 135288c1f37fSAllen Pais from_timer(port, t, multicast_router_timer); 1353eb1d1641SHerbert Xu struct net_bridge *br = port->br; 1354eb1d1641SHerbert Xu 1355eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 1356a55d8246SNikolay Aleksandrov if (port->multicast_router == MDB_RTR_TYPE_DISABLED || 1357a55d8246SNikolay Aleksandrov port->multicast_router == MDB_RTR_TYPE_PERM || 1358f12e7d95SNogah Frankel timer_pending(&port->multicast_router_timer)) 1359eb1d1641SHerbert Xu goto out; 1360eb1d1641SHerbert Xu 1361f12e7d95SNogah Frankel __del_port_router(port); 1362eb1d1641SHerbert Xu out: 1363eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1364eb1d1641SHerbert Xu } 1365eb1d1641SHerbert Xu 136677041420SYotam Gigi static void br_mc_router_state_change(struct net_bridge *p, 136777041420SYotam Gigi bool is_mc_router) 136877041420SYotam Gigi { 136977041420SYotam Gigi struct switchdev_attr attr = { 137077041420SYotam Gigi .orig_dev = p->dev, 137177041420SYotam Gigi .id = SWITCHDEV_ATTR_ID_BRIDGE_MROUTER, 137277041420SYotam Gigi .flags = SWITCHDEV_F_DEFER, 137377041420SYotam Gigi .u.mrouter = is_mc_router, 137477041420SYotam Gigi }; 137577041420SYotam Gigi 137677041420SYotam Gigi switchdev_port_attr_set(p->dev, &attr); 137777041420SYotam Gigi } 137877041420SYotam Gigi 137988c1f37fSAllen Pais static void br_multicast_local_router_expired(struct timer_list *t) 1380eb1d1641SHerbert Xu { 138188c1f37fSAllen Pais struct net_bridge *br = from_timer(br, t, multicast_router_timer); 138277041420SYotam Gigi 138377041420SYotam Gigi spin_lock(&br->multicast_lock); 138477041420SYotam Gigi if (br->multicast_router == MDB_RTR_TYPE_DISABLED || 138577041420SYotam Gigi br->multicast_router == MDB_RTR_TYPE_PERM || 138677041420SYotam Gigi timer_pending(&br->multicast_router_timer)) 138777041420SYotam Gigi goto out; 138877041420SYotam Gigi 138977041420SYotam Gigi br_mc_router_state_change(br, false); 139077041420SYotam Gigi out: 139177041420SYotam Gigi spin_unlock(&br->multicast_lock); 1392eb1d1641SHerbert Xu } 1393eb1d1641SHerbert Xu 1394cc0fdd80SLinus Lüssing static void br_multicast_querier_expired(struct net_bridge *br, 139590010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1396c83b8fabSHerbert Xu { 1397c83b8fabSHerbert Xu spin_lock(&br->multicast_lock); 139813cefad2SNikolay Aleksandrov if (!netif_running(br->dev) || !br_opt_get(br, BROPT_MULTICAST_ENABLED)) 1399c83b8fabSHerbert Xu goto out; 1400c83b8fabSHerbert Xu 1401cc0fdd80SLinus Lüssing br_multicast_start_querier(br, query); 1402c83b8fabSHerbert Xu 1403c83b8fabSHerbert Xu out: 1404c83b8fabSHerbert Xu spin_unlock(&br->multicast_lock); 1405c83b8fabSHerbert Xu } 1406c83b8fabSHerbert Xu 140788c1f37fSAllen Pais static void br_ip4_multicast_querier_expired(struct timer_list *t) 1408cc0fdd80SLinus Lüssing { 140988c1f37fSAllen Pais struct net_bridge *br = from_timer(br, t, ip4_other_query.timer); 1410cc0fdd80SLinus Lüssing 141190010b36SLinus Lüssing br_multicast_querier_expired(br, &br->ip4_own_query); 1412cc0fdd80SLinus Lüssing } 1413cc0fdd80SLinus Lüssing 1414cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 141588c1f37fSAllen Pais static void br_ip6_multicast_querier_expired(struct timer_list *t) 1416cc0fdd80SLinus Lüssing { 141788c1f37fSAllen Pais struct net_bridge *br = from_timer(br, t, ip6_other_query.timer); 1418cc0fdd80SLinus Lüssing 141990010b36SLinus Lüssing br_multicast_querier_expired(br, &br->ip6_own_query); 1420cc0fdd80SLinus Lüssing } 1421cc0fdd80SLinus Lüssing #endif 1422cc0fdd80SLinus Lüssing 1423dc4eb53aSLinus Lüssing static void br_multicast_select_own_querier(struct net_bridge *br, 1424dc4eb53aSLinus Lüssing struct br_ip *ip, 1425dc4eb53aSLinus Lüssing struct sk_buff *skb) 1426dc4eb53aSLinus Lüssing { 1427dc4eb53aSLinus Lüssing if (ip->proto == htons(ETH_P_IP)) 1428deb96566SNikolay Aleksandrov br->ip4_querier.addr.src.ip4 = ip_hdr(skb)->saddr; 1429dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1430dc4eb53aSLinus Lüssing else 1431deb96566SNikolay Aleksandrov br->ip6_querier.addr.src.ip6 = ipv6_hdr(skb)->saddr; 1432dc4eb53aSLinus Lüssing #endif 1433dc4eb53aSLinus Lüssing } 1434dc4eb53aSLinus Lüssing 14358ef2a9a5SYOSHIFUJI Hideaki static void __br_multicast_send_query(struct net_bridge *br, 14368ef2a9a5SYOSHIFUJI Hideaki struct net_bridge_port *port, 1437438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 1438438ef2d0SNikolay Aleksandrov struct br_ip *ip_dst, 1439438ef2d0SNikolay Aleksandrov struct br_ip *group, 1440438ef2d0SNikolay Aleksandrov bool with_srcs, 144142c11ccfSNikolay Aleksandrov u8 sflag, 144242c11ccfSNikolay Aleksandrov bool *need_rexmit) 1443eb1d1641SHerbert Xu { 1444438ef2d0SNikolay Aleksandrov bool over_lmqt = !!sflag; 1445eb1d1641SHerbert Xu struct sk_buff *skb; 14461080ab95SNikolay Aleksandrov u8 igmp_type; 1447eb1d1641SHerbert Xu 1448438ef2d0SNikolay Aleksandrov again_under_lmqt: 1449438ef2d0SNikolay Aleksandrov skb = br_multicast_alloc_query(br, pg, ip_dst, group, with_srcs, 145042c11ccfSNikolay Aleksandrov over_lmqt, sflag, &igmp_type, 145142c11ccfSNikolay Aleksandrov need_rexmit); 1452eb1d1641SHerbert Xu if (!skb) 14538ef2a9a5SYOSHIFUJI Hideaki return; 1454eb1d1641SHerbert Xu 1455eb1d1641SHerbert Xu if (port) { 1456eb1d1641SHerbert Xu skb->dev = port->dev; 1457a65056ecSNikolay Aleksandrov br_multicast_count(br, port, skb, igmp_type, 14581080ab95SNikolay Aleksandrov BR_MCAST_DIR_TX); 145929a26a56SEric W. Biederman NF_HOOK(NFPROTO_BRIDGE, NF_BR_LOCAL_OUT, 146029a26a56SEric W. Biederman dev_net(port->dev), NULL, skb, NULL, skb->dev, 1461f0b4eeceSLinus Lüssing br_dev_queue_push_xmit); 1462438ef2d0SNikolay Aleksandrov 1463438ef2d0SNikolay Aleksandrov if (over_lmqt && with_srcs && sflag) { 1464438ef2d0SNikolay Aleksandrov over_lmqt = false; 1465438ef2d0SNikolay Aleksandrov goto again_under_lmqt; 1466438ef2d0SNikolay Aleksandrov } 1467dc4eb53aSLinus Lüssing } else { 1468438ef2d0SNikolay Aleksandrov br_multicast_select_own_querier(br, group, skb); 1469a65056ecSNikolay Aleksandrov br_multicast_count(br, port, skb, igmp_type, 14701080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 1471eb1d1641SHerbert Xu netif_rx(skb); 14728ef2a9a5SYOSHIFUJI Hideaki } 1473dc4eb53aSLinus Lüssing } 1474eb1d1641SHerbert Xu 14758ef2a9a5SYOSHIFUJI Hideaki static void br_multicast_send_query(struct net_bridge *br, 1476cc0fdd80SLinus Lüssing struct net_bridge_port *port, 147790010b36SLinus Lüssing struct bridge_mcast_own_query *own_query) 14788ef2a9a5SYOSHIFUJI Hideaki { 147990010b36SLinus Lüssing struct bridge_mcast_other_query *other_query = NULL; 14805e923585SNikolay Aleksandrov struct br_ip br_group; 14815e923585SNikolay Aleksandrov unsigned long time; 14828ef2a9a5SYOSHIFUJI Hideaki 148313cefad2SNikolay Aleksandrov if (!netif_running(br->dev) || 148413cefad2SNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED) || 1485675779adSNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_QUERIER)) 14868ef2a9a5SYOSHIFUJI Hideaki return; 14878ef2a9a5SYOSHIFUJI Hideaki 1488eab3227bSNikolay Aleksandrov memset(&br_group.dst, 0, sizeof(br_group.dst)); 14898ef2a9a5SYOSHIFUJI Hideaki 149090010b36SLinus Lüssing if (port ? (own_query == &port->ip4_own_query) : 149190010b36SLinus Lüssing (own_query == &br->ip4_own_query)) { 149290010b36SLinus Lüssing other_query = &br->ip4_other_query; 149308b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1494dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1495cc0fdd80SLinus Lüssing } else { 149690010b36SLinus Lüssing other_query = &br->ip6_other_query; 149708b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 149808b202b6SYOSHIFUJI Hideaki #endif 1499eb1d1641SHerbert Xu } 1500eb1d1641SHerbert Xu 150190010b36SLinus Lüssing if (!other_query || timer_pending(&other_query->timer)) 1502cc0fdd80SLinus Lüssing return; 1503cc0fdd80SLinus Lüssing 150442c11ccfSNikolay Aleksandrov __br_multicast_send_query(br, port, NULL, NULL, &br_group, false, 0, 150542c11ccfSNikolay Aleksandrov NULL); 1506cc0fdd80SLinus Lüssing 1507cc0fdd80SLinus Lüssing time = jiffies; 150890010b36SLinus Lüssing time += own_query->startup_sent < br->multicast_startup_query_count ? 1509cc0fdd80SLinus Lüssing br->multicast_startup_query_interval : 1510cc0fdd80SLinus Lüssing br->multicast_query_interval; 151190010b36SLinus Lüssing mod_timer(&own_query->timer, time); 1512cc0fdd80SLinus Lüssing } 1513cc0fdd80SLinus Lüssing 151490010b36SLinus Lüssing static void 151590010b36SLinus Lüssing br_multicast_port_query_expired(struct net_bridge_port *port, 151690010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1517eb1d1641SHerbert Xu { 1518eb1d1641SHerbert Xu struct net_bridge *br = port->br; 1519eb1d1641SHerbert Xu 1520eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 152102a780c0SDan Carpenter if (port->state == BR_STATE_DISABLED || 152202a780c0SDan Carpenter port->state == BR_STATE_BLOCKING) 1523eb1d1641SHerbert Xu goto out; 1524eb1d1641SHerbert Xu 1525cc0fdd80SLinus Lüssing if (query->startup_sent < br->multicast_startup_query_count) 1526cc0fdd80SLinus Lüssing query->startup_sent++; 1527eb1d1641SHerbert Xu 1528cc0fdd80SLinus Lüssing br_multicast_send_query(port->br, port, query); 1529eb1d1641SHerbert Xu 1530eb1d1641SHerbert Xu out: 1531eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1532eb1d1641SHerbert Xu } 1533eb1d1641SHerbert Xu 153488c1f37fSAllen Pais static void br_ip4_multicast_port_query_expired(struct timer_list *t) 1535cc0fdd80SLinus Lüssing { 153688c1f37fSAllen Pais struct net_bridge_port *port = from_timer(port, t, ip4_own_query.timer); 1537cc0fdd80SLinus Lüssing 153890010b36SLinus Lüssing br_multicast_port_query_expired(port, &port->ip4_own_query); 1539cc0fdd80SLinus Lüssing } 1540cc0fdd80SLinus Lüssing 1541cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 154288c1f37fSAllen Pais static void br_ip6_multicast_port_query_expired(struct timer_list *t) 1543cc0fdd80SLinus Lüssing { 154488c1f37fSAllen Pais struct net_bridge_port *port = from_timer(port, t, ip6_own_query.timer); 1545cc0fdd80SLinus Lüssing 154690010b36SLinus Lüssing br_multicast_port_query_expired(port, &port->ip6_own_query); 1547cc0fdd80SLinus Lüssing } 1548cc0fdd80SLinus Lüssing #endif 1549cc0fdd80SLinus Lüssing 155042c11ccfSNikolay Aleksandrov static void br_multicast_port_group_rexmit(struct timer_list *t) 155142c11ccfSNikolay Aleksandrov { 155242c11ccfSNikolay Aleksandrov struct net_bridge_port_group *pg = from_timer(pg, t, rexmit_timer); 155342c11ccfSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 1554085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 155542c11ccfSNikolay Aleksandrov bool need_rexmit = false; 155642c11ccfSNikolay Aleksandrov 155742c11ccfSNikolay Aleksandrov spin_lock(&br->multicast_lock); 155842c11ccfSNikolay Aleksandrov if (!netif_running(br->dev) || hlist_unhashed(&pg->mglist) || 155942c11ccfSNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED) || 156042c11ccfSNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_QUERIER)) 156142c11ccfSNikolay Aleksandrov goto out; 156242c11ccfSNikolay Aleksandrov 1563085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 156442c11ccfSNikolay Aleksandrov other_query = &br->ip4_other_query; 156542c11ccfSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 156642c11ccfSNikolay Aleksandrov else 156742c11ccfSNikolay Aleksandrov other_query = &br->ip6_other_query; 156842c11ccfSNikolay Aleksandrov #endif 156942c11ccfSNikolay Aleksandrov 157042c11ccfSNikolay Aleksandrov if (!other_query || timer_pending(&other_query->timer)) 157142c11ccfSNikolay Aleksandrov goto out; 157242c11ccfSNikolay Aleksandrov 157342c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt) { 157442c11ccfSNikolay Aleksandrov pg->grp_query_rexmit_cnt--; 1575085b53c8SNikolay Aleksandrov __br_multicast_send_query(br, pg->key.port, pg, &pg->key.addr, 1576085b53c8SNikolay Aleksandrov &pg->key.addr, false, 1, NULL); 157742c11ccfSNikolay Aleksandrov } 1578085b53c8SNikolay Aleksandrov __br_multicast_send_query(br, pg->key.port, pg, &pg->key.addr, 1579085b53c8SNikolay Aleksandrov &pg->key.addr, true, 0, &need_rexmit); 158042c11ccfSNikolay Aleksandrov 158142c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt || need_rexmit) 158242c11ccfSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, jiffies + 158342c11ccfSNikolay Aleksandrov br->multicast_last_member_interval); 158442c11ccfSNikolay Aleksandrov out: 158542c11ccfSNikolay Aleksandrov spin_unlock(&br->multicast_lock); 158642c11ccfSNikolay Aleksandrov } 158742c11ccfSNikolay Aleksandrov 1588147c1e9bSNogah Frankel static void br_mc_disabled_update(struct net_device *dev, bool value) 1589147c1e9bSNogah Frankel { 1590147c1e9bSNogah Frankel struct switchdev_attr attr = { 1591147c1e9bSNogah Frankel .orig_dev = dev, 1592147c1e9bSNogah Frankel .id = SWITCHDEV_ATTR_ID_BRIDGE_MC_DISABLED, 1593147c1e9bSNogah Frankel .flags = SWITCHDEV_F_DEFER, 159413cefad2SNikolay Aleksandrov .u.mc_disabled = !value, 1595147c1e9bSNogah Frankel }; 1596147c1e9bSNogah Frankel 1597147c1e9bSNogah Frankel switchdev_port_attr_set(dev, &attr); 1598147c1e9bSNogah Frankel } 1599147c1e9bSNogah Frankel 16001080ab95SNikolay Aleksandrov int br_multicast_add_port(struct net_bridge_port *port) 1601eb1d1641SHerbert Xu { 16027f0aec7aSNikolay Aleksandrov port->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 1603eb1d1641SHerbert Xu 160488c1f37fSAllen Pais timer_setup(&port->multicast_router_timer, 160588c1f37fSAllen Pais br_multicast_router_expired, 0); 160688c1f37fSAllen Pais timer_setup(&port->ip4_own_query.timer, 160788c1f37fSAllen Pais br_ip4_multicast_port_query_expired, 0); 1608cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 160988c1f37fSAllen Pais timer_setup(&port->ip6_own_query.timer, 161088c1f37fSAllen Pais br_ip6_multicast_port_query_expired, 0); 1611cc0fdd80SLinus Lüssing #endif 161213cefad2SNikolay Aleksandrov br_mc_disabled_update(port->dev, 161313cefad2SNikolay Aleksandrov br_opt_get(port->br, BROPT_MULTICAST_ENABLED)); 1614147c1e9bSNogah Frankel 16151080ab95SNikolay Aleksandrov port->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 16161080ab95SNikolay Aleksandrov if (!port->mcast_stats) 16171080ab95SNikolay Aleksandrov return -ENOMEM; 16181080ab95SNikolay Aleksandrov 16191080ab95SNikolay Aleksandrov return 0; 1620eb1d1641SHerbert Xu } 1621eb1d1641SHerbert Xu 1622eb1d1641SHerbert Xu void br_multicast_del_port(struct net_bridge_port *port) 1623eb1d1641SHerbert Xu { 1624e10177abSSatish Ashok struct net_bridge *br = port->br; 1625e10177abSSatish Ashok struct net_bridge_port_group *pg; 1626e12cec65SNikolay Aleksandrov HLIST_HEAD(deleted_head); 1627e10177abSSatish Ashok struct hlist_node *n; 1628e10177abSSatish Ashok 1629e10177abSSatish Ashok /* Take care of the remaining groups, only perm ones should be left */ 1630e10177abSSatish Ashok spin_lock_bh(&br->multicast_lock); 1631e10177abSSatish Ashok hlist_for_each_entry_safe(pg, n, &port->mglist, mglist) 1632681590bdSNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 1633e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 1634e10177abSSatish Ashok spin_unlock_bh(&br->multicast_lock); 1635e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 1636eb1d1641SHerbert Xu del_timer_sync(&port->multicast_router_timer); 16371080ab95SNikolay Aleksandrov free_percpu(port->mcast_stats); 1638eb1d1641SHerbert Xu } 1639eb1d1641SHerbert Xu 164090010b36SLinus Lüssing static void br_multicast_enable(struct bridge_mcast_own_query *query) 1641561f1103SHerbert Xu { 1642cc0fdd80SLinus Lüssing query->startup_sent = 0; 1643561f1103SHerbert Xu 1644cc0fdd80SLinus Lüssing if (try_to_del_timer_sync(&query->timer) >= 0 || 1645cc0fdd80SLinus Lüssing del_timer(&query->timer)) 1646cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 1647561f1103SHerbert Xu } 1648561f1103SHerbert Xu 16497cb3f921SNikolay Aleksandrov static void __br_multicast_enable_port(struct net_bridge_port *port) 1650eb1d1641SHerbert Xu { 1651eb1d1641SHerbert Xu struct net_bridge *br = port->br; 1652eb1d1641SHerbert Xu 165313cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED) || !netif_running(br->dev)) 16547cb3f921SNikolay Aleksandrov return; 1655eb1d1641SHerbert Xu 165690010b36SLinus Lüssing br_multicast_enable(&port->ip4_own_query); 1657cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 165890010b36SLinus Lüssing br_multicast_enable(&port->ip6_own_query); 1659cc0fdd80SLinus Lüssing #endif 16607f0aec7aSNikolay Aleksandrov if (port->multicast_router == MDB_RTR_TYPE_PERM && 16617f0aec7aSNikolay Aleksandrov hlist_unhashed(&port->rlist)) 1662754bc547SSatish Ashok br_multicast_add_router(br, port); 16637cb3f921SNikolay Aleksandrov } 1664eb1d1641SHerbert Xu 16657cb3f921SNikolay Aleksandrov void br_multicast_enable_port(struct net_bridge_port *port) 16667cb3f921SNikolay Aleksandrov { 16677cb3f921SNikolay Aleksandrov struct net_bridge *br = port->br; 16687cb3f921SNikolay Aleksandrov 16697cb3f921SNikolay Aleksandrov spin_lock(&br->multicast_lock); 16707cb3f921SNikolay Aleksandrov __br_multicast_enable_port(port); 1671eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1672eb1d1641SHerbert Xu } 1673eb1d1641SHerbert Xu 1674eb1d1641SHerbert Xu void br_multicast_disable_port(struct net_bridge_port *port) 1675eb1d1641SHerbert Xu { 1676eb1d1641SHerbert Xu struct net_bridge *br = port->br; 1677eb1d1641SHerbert Xu struct net_bridge_port_group *pg; 1678b67bfe0dSSasha Levin struct hlist_node *n; 1679eb1d1641SHerbert Xu 1680eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 1681b67bfe0dSSasha Levin hlist_for_each_entry_safe(pg, n, &port->mglist, mglist) 16829d06b6d8SElad Raz if (!(pg->flags & MDB_PG_FLAGS_PERMANENT)) 1683681590bdSNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 1684eb1d1641SHerbert Xu 1685f12e7d95SNogah Frankel __del_port_router(port); 1686f12e7d95SNogah Frankel 1687eb1d1641SHerbert Xu del_timer(&port->multicast_router_timer); 168890010b36SLinus Lüssing del_timer(&port->ip4_own_query.timer); 1689cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 169090010b36SLinus Lüssing del_timer(&port->ip6_own_query.timer); 1691cc0fdd80SLinus Lüssing #endif 1692eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1693eb1d1641SHerbert Xu } 1694eb1d1641SHerbert Xu 1695e6231bcaSNikolay Aleksandrov static int __grp_src_delete_marked(struct net_bridge_port_group *pg) 1696e6231bcaSNikolay Aleksandrov { 1697e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 1698e6231bcaSNikolay Aleksandrov struct hlist_node *tmp; 1699e6231bcaSNikolay Aleksandrov int deleted = 0; 1700e6231bcaSNikolay Aleksandrov 1701e6231bcaSNikolay Aleksandrov hlist_for_each_entry_safe(ent, tmp, &pg->src_list, node) 1702e6231bcaSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_DELETE) { 1703e6231bcaSNikolay Aleksandrov br_multicast_del_group_src(ent); 1704e6231bcaSNikolay Aleksandrov deleted++; 1705e6231bcaSNikolay Aleksandrov } 1706e6231bcaSNikolay Aleksandrov 1707e6231bcaSNikolay Aleksandrov return deleted; 1708e6231bcaSNikolay Aleksandrov } 1709e6231bcaSNikolay Aleksandrov 1710b0812368SNikolay Aleksandrov static void __grp_src_mod_timer(struct net_bridge_group_src *src, 1711b0812368SNikolay Aleksandrov unsigned long expires) 1712b0812368SNikolay Aleksandrov { 1713b0812368SNikolay Aleksandrov mod_timer(&src->timer, expires); 1714b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(src); 1715b0812368SNikolay Aleksandrov } 1716b0812368SNikolay Aleksandrov 17175bf1e00bSNikolay Aleksandrov static void __grp_src_query_marked_and_rexmit(struct net_bridge_port_group *pg) 17185bf1e00bSNikolay Aleksandrov { 17195bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 1720085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 17215bf1e00bSNikolay Aleksandrov u32 lmqc = br->multicast_last_member_count; 17225bf1e00bSNikolay Aleksandrov unsigned long lmqt, lmi, now = jiffies; 17235bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 17245bf1e00bSNikolay Aleksandrov 17255bf1e00bSNikolay Aleksandrov if (!netif_running(br->dev) || 17265bf1e00bSNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED)) 17275bf1e00bSNikolay Aleksandrov return; 17285bf1e00bSNikolay Aleksandrov 1729085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 17305bf1e00bSNikolay Aleksandrov other_query = &br->ip4_other_query; 17315bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 17325bf1e00bSNikolay Aleksandrov else 17335bf1e00bSNikolay Aleksandrov other_query = &br->ip6_other_query; 17345bf1e00bSNikolay Aleksandrov #endif 17355bf1e00bSNikolay Aleksandrov 17365bf1e00bSNikolay Aleksandrov lmqt = now + br_multicast_lmqt(br); 17375bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 17385bf1e00bSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_SEND) { 17395bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 17405bf1e00bSNikolay Aleksandrov if (ent->timer.expires > lmqt) { 17415bf1e00bSNikolay Aleksandrov if (br_opt_get(br, BROPT_MULTICAST_QUERIER) && 17425bf1e00bSNikolay Aleksandrov other_query && 17435bf1e00bSNikolay Aleksandrov !timer_pending(&other_query->timer)) 17445bf1e00bSNikolay Aleksandrov ent->src_query_rexmit_cnt = lmqc; 1745b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, lmqt); 17465bf1e00bSNikolay Aleksandrov } 17475bf1e00bSNikolay Aleksandrov } 17485bf1e00bSNikolay Aleksandrov } 17495bf1e00bSNikolay Aleksandrov 17505bf1e00bSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_QUERIER) || 17515bf1e00bSNikolay Aleksandrov !other_query || timer_pending(&other_query->timer)) 17525bf1e00bSNikolay Aleksandrov return; 17535bf1e00bSNikolay Aleksandrov 1754085b53c8SNikolay Aleksandrov __br_multicast_send_query(br, pg->key.port, pg, &pg->key.addr, 1755085b53c8SNikolay Aleksandrov &pg->key.addr, true, 1, NULL); 17565bf1e00bSNikolay Aleksandrov 17575bf1e00bSNikolay Aleksandrov lmi = now + br->multicast_last_member_interval; 17585bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 17595bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 17605bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 17615bf1e00bSNikolay Aleksandrov } 17625bf1e00bSNikolay Aleksandrov 17635bf1e00bSNikolay Aleksandrov static void __grp_send_query_and_rexmit(struct net_bridge_port_group *pg) 17645bf1e00bSNikolay Aleksandrov { 17655bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 1766085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 17675bf1e00bSNikolay Aleksandrov unsigned long now = jiffies, lmi; 17685bf1e00bSNikolay Aleksandrov 17695bf1e00bSNikolay Aleksandrov if (!netif_running(br->dev) || 17705bf1e00bSNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED)) 17715bf1e00bSNikolay Aleksandrov return; 17725bf1e00bSNikolay Aleksandrov 1773085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 17745bf1e00bSNikolay Aleksandrov other_query = &br->ip4_other_query; 17755bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 17765bf1e00bSNikolay Aleksandrov else 17775bf1e00bSNikolay Aleksandrov other_query = &br->ip6_other_query; 17785bf1e00bSNikolay Aleksandrov #endif 17795bf1e00bSNikolay Aleksandrov 17805bf1e00bSNikolay Aleksandrov if (br_opt_get(br, BROPT_MULTICAST_QUERIER) && 17815bf1e00bSNikolay Aleksandrov other_query && !timer_pending(&other_query->timer)) { 17825bf1e00bSNikolay Aleksandrov lmi = now + br->multicast_last_member_interval; 17835bf1e00bSNikolay Aleksandrov pg->grp_query_rexmit_cnt = br->multicast_last_member_count - 1; 1784085b53c8SNikolay Aleksandrov __br_multicast_send_query(br, pg->key.port, pg, &pg->key.addr, 1785085b53c8SNikolay Aleksandrov &pg->key.addr, false, 0, NULL); 17865bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 17875bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 17885bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 17895bf1e00bSNikolay Aleksandrov } 17905bf1e00bSNikolay Aleksandrov 17915bf1e00bSNikolay Aleksandrov if (pg->filter_mode == MCAST_EXCLUDE && 17925bf1e00bSNikolay Aleksandrov (!timer_pending(&pg->timer) || 17935bf1e00bSNikolay Aleksandrov time_after(pg->timer.expires, now + br_multicast_lmqt(br)))) 17945bf1e00bSNikolay Aleksandrov mod_timer(&pg->timer, now + br_multicast_lmqt(br)); 17955bf1e00bSNikolay Aleksandrov } 17965bf1e00bSNikolay Aleksandrov 17970436862eSNikolay Aleksandrov /* State Msg type New state Actions 17980436862eSNikolay Aleksandrov * INCLUDE (A) IS_IN (B) INCLUDE (A+B) (B)=GMI 17990436862eSNikolay Aleksandrov * INCLUDE (A) ALLOW (B) INCLUDE (A+B) (B)=GMI 18000436862eSNikolay Aleksandrov * EXCLUDE (X,Y) ALLOW (A) EXCLUDE (X+A,Y-A) (A)=GMI 18010436862eSNikolay Aleksandrov */ 18020436862eSNikolay Aleksandrov static bool br_multicast_isinc_allow(struct net_bridge_port_group *pg, 1803*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 18040436862eSNikolay Aleksandrov { 1805085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 18060436862eSNikolay Aleksandrov struct net_bridge_group_src *ent; 18070436862eSNikolay Aleksandrov unsigned long now = jiffies; 18080436862eSNikolay Aleksandrov bool changed = false; 18090436862eSNikolay Aleksandrov struct br_ip src_ip; 18100436862eSNikolay Aleksandrov u32 src_idx; 18110436862eSNikolay Aleksandrov 18120436862eSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 1813085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 18140436862eSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 1815*9e10b9e6SNikolay Aleksandrov memcpy(&src_ip.src, srcs, addr_size); 18160436862eSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 18170436862eSNikolay Aleksandrov if (!ent) { 18180436862eSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 18190436862eSNikolay Aleksandrov if (ent) 18200436862eSNikolay Aleksandrov changed = true; 18210436862eSNikolay Aleksandrov } 18220436862eSNikolay Aleksandrov 18230436862eSNikolay Aleksandrov if (ent) 1824b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(br)); 1825*9e10b9e6SNikolay Aleksandrov srcs += addr_size; 18260436862eSNikolay Aleksandrov } 18270436862eSNikolay Aleksandrov 18280436862eSNikolay Aleksandrov return changed; 18290436862eSNikolay Aleksandrov } 18300436862eSNikolay Aleksandrov 1831e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 1832e6231bcaSNikolay Aleksandrov * INCLUDE (A) IS_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 1833e6231bcaSNikolay Aleksandrov * Delete (A-B) 1834e6231bcaSNikolay Aleksandrov * Group Timer=GMI 1835e6231bcaSNikolay Aleksandrov */ 1836e6231bcaSNikolay Aleksandrov static void __grp_src_isexc_incl(struct net_bridge_port_group *pg, 1837*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 1838e6231bcaSNikolay Aleksandrov { 1839e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 1840e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 1841e6231bcaSNikolay Aleksandrov u32 src_idx; 1842e6231bcaSNikolay Aleksandrov 1843e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1844e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 1845e6231bcaSNikolay Aleksandrov 1846e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 1847085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 1848e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 1849*9e10b9e6SNikolay Aleksandrov memcpy(&src_ip.src, srcs, addr_size); 1850e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 1851e6231bcaSNikolay Aleksandrov if (ent) 1852e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 1853e6231bcaSNikolay Aleksandrov else 1854b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 1855b0812368SNikolay Aleksandrov if (ent) 1856b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 1857*9e10b9e6SNikolay Aleksandrov srcs += addr_size; 1858e6231bcaSNikolay Aleksandrov } 1859e6231bcaSNikolay Aleksandrov 1860e6231bcaSNikolay Aleksandrov __grp_src_delete_marked(pg); 1861e6231bcaSNikolay Aleksandrov } 1862e6231bcaSNikolay Aleksandrov 1863e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 1864e6231bcaSNikolay Aleksandrov * EXCLUDE (X,Y) IS_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=GMI 1865e6231bcaSNikolay Aleksandrov * Delete (X-A) 1866e6231bcaSNikolay Aleksandrov * Delete (Y-A) 1867e6231bcaSNikolay Aleksandrov * Group Timer=GMI 1868e6231bcaSNikolay Aleksandrov */ 1869e6231bcaSNikolay Aleksandrov static bool __grp_src_isexc_excl(struct net_bridge_port_group *pg, 1870*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 1871e6231bcaSNikolay Aleksandrov { 1872085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 1873e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 1874e6231bcaSNikolay Aleksandrov unsigned long now = jiffies; 1875e6231bcaSNikolay Aleksandrov bool changed = false; 1876e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 1877e6231bcaSNikolay Aleksandrov u32 src_idx; 1878e6231bcaSNikolay Aleksandrov 1879e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1880e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 1881e6231bcaSNikolay Aleksandrov 1882e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 1883085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 1884e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 1885*9e10b9e6SNikolay Aleksandrov memcpy(&src_ip.src, srcs, addr_size); 1886e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 1887e6231bcaSNikolay Aleksandrov if (ent) { 1888e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 1889e6231bcaSNikolay Aleksandrov } else { 1890e6231bcaSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 1891e6231bcaSNikolay Aleksandrov if (ent) { 1892b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, 1893e6231bcaSNikolay Aleksandrov now + br_multicast_gmi(br)); 1894e6231bcaSNikolay Aleksandrov changed = true; 1895e6231bcaSNikolay Aleksandrov } 1896e6231bcaSNikolay Aleksandrov } 1897*9e10b9e6SNikolay Aleksandrov srcs += addr_size; 1898e6231bcaSNikolay Aleksandrov } 1899e6231bcaSNikolay Aleksandrov 1900e6231bcaSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 1901e6231bcaSNikolay Aleksandrov changed = true; 1902e6231bcaSNikolay Aleksandrov 1903e6231bcaSNikolay Aleksandrov return changed; 1904e6231bcaSNikolay Aleksandrov } 1905e6231bcaSNikolay Aleksandrov 1906e6231bcaSNikolay Aleksandrov static bool br_multicast_isexc(struct net_bridge_port_group *pg, 1907*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 1908e6231bcaSNikolay Aleksandrov { 1909085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 1910e6231bcaSNikolay Aleksandrov bool changed = false; 1911e6231bcaSNikolay Aleksandrov 1912e6231bcaSNikolay Aleksandrov switch (pg->filter_mode) { 1913e6231bcaSNikolay Aleksandrov case MCAST_INCLUDE: 1914*9e10b9e6SNikolay Aleksandrov __grp_src_isexc_incl(pg, srcs, nsrcs, addr_size); 19158266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 1916e6231bcaSNikolay Aleksandrov changed = true; 1917e6231bcaSNikolay Aleksandrov break; 1918e6231bcaSNikolay Aleksandrov case MCAST_EXCLUDE: 1919*9e10b9e6SNikolay Aleksandrov changed = __grp_src_isexc_excl(pg, srcs, nsrcs, addr_size); 1920e6231bcaSNikolay Aleksandrov break; 1921e6231bcaSNikolay Aleksandrov } 1922e6231bcaSNikolay Aleksandrov 1923e6231bcaSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 1924e6231bcaSNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(br)); 1925e6231bcaSNikolay Aleksandrov 1926e6231bcaSNikolay Aleksandrov return changed; 1927e6231bcaSNikolay Aleksandrov } 1928e6231bcaSNikolay Aleksandrov 19295bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 19305bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_IN (B) INCLUDE (A+B) (B)=GMI 19315bf1e00bSNikolay Aleksandrov * Send Q(G,A-B) 19325bf1e00bSNikolay Aleksandrov */ 19335bf1e00bSNikolay Aleksandrov static bool __grp_src_toin_incl(struct net_bridge_port_group *pg, 1934*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 19355bf1e00bSNikolay Aleksandrov { 1936085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 19375bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 19385bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 19395bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 19405bf1e00bSNikolay Aleksandrov bool changed = false; 19415bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 19425bf1e00bSNikolay Aleksandrov 19435bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 19445bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 19455bf1e00bSNikolay Aleksandrov 19465bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 1947085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 19485bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 1949*9e10b9e6SNikolay Aleksandrov memcpy(&src_ip.src, srcs, addr_size); 19505bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 19515bf1e00bSNikolay Aleksandrov if (ent) { 19525bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 19535bf1e00bSNikolay Aleksandrov to_send--; 19545bf1e00bSNikolay Aleksandrov } else { 19555bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 19565bf1e00bSNikolay Aleksandrov if (ent) 19575bf1e00bSNikolay Aleksandrov changed = true; 19585bf1e00bSNikolay Aleksandrov } 19595bf1e00bSNikolay Aleksandrov if (ent) 1960b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(br)); 1961*9e10b9e6SNikolay Aleksandrov srcs += addr_size; 19625bf1e00bSNikolay Aleksandrov } 19635bf1e00bSNikolay Aleksandrov 19645bf1e00bSNikolay Aleksandrov if (to_send) 19655bf1e00bSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 19665bf1e00bSNikolay Aleksandrov 19675bf1e00bSNikolay Aleksandrov return changed; 19685bf1e00bSNikolay Aleksandrov } 19695bf1e00bSNikolay Aleksandrov 19705bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 19715bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_IN (A) EXCLUDE (X+A,Y-A) (A)=GMI 19725bf1e00bSNikolay Aleksandrov * Send Q(G,X-A) 19735bf1e00bSNikolay Aleksandrov * Send Q(G) 19745bf1e00bSNikolay Aleksandrov */ 19755bf1e00bSNikolay Aleksandrov static bool __grp_src_toin_excl(struct net_bridge_port_group *pg, 1976*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 19775bf1e00bSNikolay Aleksandrov { 1978085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 19795bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 19805bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 19815bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 19825bf1e00bSNikolay Aleksandrov bool changed = false; 19835bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 19845bf1e00bSNikolay Aleksandrov 19855bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 19865bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) 19875bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 19885bf1e00bSNikolay Aleksandrov 19895bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 1990085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 19915bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 1992*9e10b9e6SNikolay Aleksandrov memcpy(&src_ip.src, srcs, addr_size); 19935bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 19945bf1e00bSNikolay Aleksandrov if (ent) { 19955bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) { 19965bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 19975bf1e00bSNikolay Aleksandrov to_send--; 19985bf1e00bSNikolay Aleksandrov } 19995bf1e00bSNikolay Aleksandrov } else { 20005bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 20015bf1e00bSNikolay Aleksandrov if (ent) 20025bf1e00bSNikolay Aleksandrov changed = true; 20035bf1e00bSNikolay Aleksandrov } 20045bf1e00bSNikolay Aleksandrov if (ent) 2005b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(br)); 2006*9e10b9e6SNikolay Aleksandrov srcs += addr_size; 20075bf1e00bSNikolay Aleksandrov } 20085bf1e00bSNikolay Aleksandrov 20095bf1e00bSNikolay Aleksandrov if (to_send) 20105bf1e00bSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 20115bf1e00bSNikolay Aleksandrov 20125bf1e00bSNikolay Aleksandrov __grp_send_query_and_rexmit(pg); 20135bf1e00bSNikolay Aleksandrov 20145bf1e00bSNikolay Aleksandrov return changed; 20155bf1e00bSNikolay Aleksandrov } 20165bf1e00bSNikolay Aleksandrov 20175bf1e00bSNikolay Aleksandrov static bool br_multicast_toin(struct net_bridge_port_group *pg, 2018*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 20195bf1e00bSNikolay Aleksandrov { 20205bf1e00bSNikolay Aleksandrov bool changed = false; 20215bf1e00bSNikolay Aleksandrov 20225bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 20235bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 2024*9e10b9e6SNikolay Aleksandrov changed = __grp_src_toin_incl(pg, srcs, nsrcs, addr_size); 20255bf1e00bSNikolay Aleksandrov break; 20265bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 2027*9e10b9e6SNikolay Aleksandrov changed = __grp_src_toin_excl(pg, srcs, nsrcs, addr_size); 20285bf1e00bSNikolay Aleksandrov break; 20295bf1e00bSNikolay Aleksandrov } 20305bf1e00bSNikolay Aleksandrov 20315bf1e00bSNikolay Aleksandrov return changed; 20325bf1e00bSNikolay Aleksandrov } 20335bf1e00bSNikolay Aleksandrov 20345bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 20355bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 20365bf1e00bSNikolay Aleksandrov * Delete (A-B) 20375bf1e00bSNikolay Aleksandrov * Send Q(G,A*B) 20385bf1e00bSNikolay Aleksandrov * Group Timer=GMI 20395bf1e00bSNikolay Aleksandrov */ 20405bf1e00bSNikolay Aleksandrov static void __grp_src_toex_incl(struct net_bridge_port_group *pg, 2041*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 20425bf1e00bSNikolay Aleksandrov { 20435bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 20445bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 20455bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 20465bf1e00bSNikolay Aleksandrov 20475bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 20485bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 20495bf1e00bSNikolay Aleksandrov 20505bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2051085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 20525bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2053*9e10b9e6SNikolay Aleksandrov memcpy(&src_ip.src, srcs, addr_size); 20545bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 20555bf1e00bSNikolay Aleksandrov if (ent) { 20565bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_DELETE) | 20575bf1e00bSNikolay Aleksandrov BR_SGRP_F_SEND; 20585bf1e00bSNikolay Aleksandrov to_send++; 20595bf1e00bSNikolay Aleksandrov } else { 2060b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 20615bf1e00bSNikolay Aleksandrov } 2062b0812368SNikolay Aleksandrov if (ent) 2063b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 2064*9e10b9e6SNikolay Aleksandrov srcs += addr_size; 20655bf1e00bSNikolay Aleksandrov } 20665bf1e00bSNikolay Aleksandrov 20675bf1e00bSNikolay Aleksandrov __grp_src_delete_marked(pg); 20685bf1e00bSNikolay Aleksandrov if (to_send) 20695bf1e00bSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 20705bf1e00bSNikolay Aleksandrov } 20715bf1e00bSNikolay Aleksandrov 20725bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 20735bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=Group Timer 20745bf1e00bSNikolay Aleksandrov * Delete (X-A) 20755bf1e00bSNikolay Aleksandrov * Delete (Y-A) 20765bf1e00bSNikolay Aleksandrov * Send Q(G,A-Y) 20775bf1e00bSNikolay Aleksandrov * Group Timer=GMI 20785bf1e00bSNikolay Aleksandrov */ 20795bf1e00bSNikolay Aleksandrov static bool __grp_src_toex_excl(struct net_bridge_port_group *pg, 2080*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 20815bf1e00bSNikolay Aleksandrov { 20825bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 20835bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 20845bf1e00bSNikolay Aleksandrov bool changed = false; 20855bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 20865bf1e00bSNikolay Aleksandrov 20875bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 20885bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 20895bf1e00bSNikolay Aleksandrov 20905bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2091085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 20925bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2093*9e10b9e6SNikolay Aleksandrov memcpy(&src_ip.src, srcs, addr_size); 20945bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 20955bf1e00bSNikolay Aleksandrov if (ent) { 20965bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 20975bf1e00bSNikolay Aleksandrov } else { 20985bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 20995bf1e00bSNikolay Aleksandrov if (ent) { 2100b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 21015bf1e00bSNikolay Aleksandrov changed = true; 21025bf1e00bSNikolay Aleksandrov } 21035bf1e00bSNikolay Aleksandrov } 21045bf1e00bSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 21055bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 21065bf1e00bSNikolay Aleksandrov to_send++; 21075bf1e00bSNikolay Aleksandrov } 2108*9e10b9e6SNikolay Aleksandrov srcs += addr_size; 21095bf1e00bSNikolay Aleksandrov } 21105bf1e00bSNikolay Aleksandrov 21115bf1e00bSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 21125bf1e00bSNikolay Aleksandrov changed = true; 21135bf1e00bSNikolay Aleksandrov if (to_send) 21145bf1e00bSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 21155bf1e00bSNikolay Aleksandrov 21165bf1e00bSNikolay Aleksandrov return changed; 21175bf1e00bSNikolay Aleksandrov } 21185bf1e00bSNikolay Aleksandrov 21195bf1e00bSNikolay Aleksandrov static bool br_multicast_toex(struct net_bridge_port_group *pg, 2120*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 21215bf1e00bSNikolay Aleksandrov { 2122085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 21235bf1e00bSNikolay Aleksandrov bool changed = false; 21245bf1e00bSNikolay Aleksandrov 21255bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 21265bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 2127*9e10b9e6SNikolay Aleksandrov __grp_src_toex_incl(pg, srcs, nsrcs, addr_size); 21288266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 21295bf1e00bSNikolay Aleksandrov changed = true; 21305bf1e00bSNikolay Aleksandrov break; 21315bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 2132*9e10b9e6SNikolay Aleksandrov changed = __grp_src_toex_excl(pg, srcs, nsrcs, addr_size); 21335bf1e00bSNikolay Aleksandrov break; 21345bf1e00bSNikolay Aleksandrov } 21355bf1e00bSNikolay Aleksandrov 21365bf1e00bSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 21375bf1e00bSNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(br)); 21385bf1e00bSNikolay Aleksandrov 21395bf1e00bSNikolay Aleksandrov return changed; 21405bf1e00bSNikolay Aleksandrov } 21415bf1e00bSNikolay Aleksandrov 2142109865feSNikolay Aleksandrov /* State Msg type New state Actions 2143109865feSNikolay Aleksandrov * INCLUDE (A) BLOCK (B) INCLUDE (A) Send Q(G,A*B) 2144109865feSNikolay Aleksandrov */ 2145109865feSNikolay Aleksandrov static void __grp_src_block_incl(struct net_bridge_port_group *pg, 2146*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 2147109865feSNikolay Aleksandrov { 2148109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2149109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 2150109865feSNikolay Aleksandrov struct br_ip src_ip; 2151109865feSNikolay Aleksandrov 2152109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2153109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2154109865feSNikolay Aleksandrov 2155109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2156085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2157109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2158*9e10b9e6SNikolay Aleksandrov memcpy(&src_ip.src, srcs, addr_size); 2159109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2160109865feSNikolay Aleksandrov if (ent) { 2161109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2162109865feSNikolay Aleksandrov to_send++; 2163109865feSNikolay Aleksandrov } 2164*9e10b9e6SNikolay Aleksandrov srcs += addr_size; 2165109865feSNikolay Aleksandrov } 2166109865feSNikolay Aleksandrov 2167109865feSNikolay Aleksandrov if (to_send) 2168109865feSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 2169109865feSNikolay Aleksandrov 2170109865feSNikolay Aleksandrov if (pg->filter_mode == MCAST_INCLUDE && hlist_empty(&pg->src_list)) 2171085b53c8SNikolay Aleksandrov br_multicast_find_del_pg(pg->key.port->br, pg); 2172109865feSNikolay Aleksandrov } 2173109865feSNikolay Aleksandrov 2174109865feSNikolay Aleksandrov /* State Msg type New state Actions 2175109865feSNikolay Aleksandrov * EXCLUDE (X,Y) BLOCK (A) EXCLUDE (X+(A-Y),Y) (A-X-Y)=Group Timer 2176109865feSNikolay Aleksandrov * Send Q(G,A-Y) 2177109865feSNikolay Aleksandrov */ 2178109865feSNikolay Aleksandrov static bool __grp_src_block_excl(struct net_bridge_port_group *pg, 2179*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 2180109865feSNikolay Aleksandrov { 2181109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2182109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 2183109865feSNikolay Aleksandrov bool changed = false; 2184109865feSNikolay Aleksandrov struct br_ip src_ip; 2185109865feSNikolay Aleksandrov 2186109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2187109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2188109865feSNikolay Aleksandrov 2189109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2190085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2191109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2192*9e10b9e6SNikolay Aleksandrov memcpy(&src_ip.src, srcs, addr_size); 2193109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2194109865feSNikolay Aleksandrov if (!ent) { 2195109865feSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2196109865feSNikolay Aleksandrov if (ent) { 2197b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 2198109865feSNikolay Aleksandrov changed = true; 2199109865feSNikolay Aleksandrov } 2200109865feSNikolay Aleksandrov } 2201109865feSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 2202109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2203109865feSNikolay Aleksandrov to_send++; 2204109865feSNikolay Aleksandrov } 2205*9e10b9e6SNikolay Aleksandrov srcs += addr_size; 2206109865feSNikolay Aleksandrov } 2207109865feSNikolay Aleksandrov 2208109865feSNikolay Aleksandrov if (to_send) 2209109865feSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 2210109865feSNikolay Aleksandrov 2211109865feSNikolay Aleksandrov return changed; 2212109865feSNikolay Aleksandrov } 2213109865feSNikolay Aleksandrov 2214109865feSNikolay Aleksandrov static bool br_multicast_block(struct net_bridge_port_group *pg, 2215*9e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 2216109865feSNikolay Aleksandrov { 2217109865feSNikolay Aleksandrov bool changed = false; 2218109865feSNikolay Aleksandrov 2219109865feSNikolay Aleksandrov switch (pg->filter_mode) { 2220109865feSNikolay Aleksandrov case MCAST_INCLUDE: 2221*9e10b9e6SNikolay Aleksandrov __grp_src_block_incl(pg, srcs, nsrcs, addr_size); 2222109865feSNikolay Aleksandrov break; 2223109865feSNikolay Aleksandrov case MCAST_EXCLUDE: 2224*9e10b9e6SNikolay Aleksandrov changed = __grp_src_block_excl(pg, srcs, nsrcs, addr_size); 2225109865feSNikolay Aleksandrov break; 2226109865feSNikolay Aleksandrov } 2227109865feSNikolay Aleksandrov 2228109865feSNikolay Aleksandrov return changed; 2229109865feSNikolay Aleksandrov } 2230109865feSNikolay Aleksandrov 22310436862eSNikolay Aleksandrov static struct net_bridge_port_group * 22320436862eSNikolay Aleksandrov br_multicast_find_port(struct net_bridge_mdb_entry *mp, 22330436862eSNikolay Aleksandrov struct net_bridge_port *p, 22340436862eSNikolay Aleksandrov const unsigned char *src) 22350436862eSNikolay Aleksandrov { 2236071445c6SNikolay Aleksandrov struct net_bridge *br __maybe_unused = mp->br; 22370436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 22380436862eSNikolay Aleksandrov 22390436862eSNikolay Aleksandrov for (pg = mlock_dereference(mp->ports, br); 22400436862eSNikolay Aleksandrov pg; 22410436862eSNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) 22420436862eSNikolay Aleksandrov if (br_port_group_equal(pg, p, src)) 22430436862eSNikolay Aleksandrov return pg; 22440436862eSNikolay Aleksandrov 22450436862eSNikolay Aleksandrov return NULL; 22460436862eSNikolay Aleksandrov } 22470436862eSNikolay Aleksandrov 22488ef2a9a5SYOSHIFUJI Hideaki static int br_ip4_multicast_igmp3_report(struct net_bridge *br, 2249eb1d1641SHerbert Xu struct net_bridge_port *port, 225006499098SVlad Yasevich struct sk_buff *skb, 225106499098SVlad Yasevich u16 vid) 2252eb1d1641SHerbert Xu { 22530436862eSNikolay Aleksandrov bool igmpv2 = br->multicast_igmp_version == 2; 22540436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 22550436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 22566db6f0eaSFelix Fietkau const unsigned char *src; 2257eb1d1641SHerbert Xu struct igmpv3_report *ih; 2258eb1d1641SHerbert Xu struct igmpv3_grec *grec; 22590436862eSNikolay Aleksandrov int i, len, num, type; 22600436862eSNikolay Aleksandrov bool changed = false; 2261eb1d1641SHerbert Xu __be32 group; 22620436862eSNikolay Aleksandrov int err = 0; 2263e57f6185SNikolay Aleksandrov u16 nsrcs; 2264eb1d1641SHerbert Xu 2265eb1d1641SHerbert Xu ih = igmpv3_report_hdr(skb); 2266eb1d1641SHerbert Xu num = ntohs(ih->ngrec); 2267c2d4fbd2SLinus Lüssing len = skb_transport_offset(skb) + sizeof(*ih); 2268eb1d1641SHerbert Xu 2269eb1d1641SHerbert Xu for (i = 0; i < num; i++) { 2270eb1d1641SHerbert Xu len += sizeof(*grec); 2271ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2272eb1d1641SHerbert Xu return -EINVAL; 2273eb1d1641SHerbert Xu 2274fd218cf9SHerbert Xu grec = (void *)(skb->data + len - sizeof(*grec)); 2275eb1d1641SHerbert Xu group = grec->grec_mca; 2276eb1d1641SHerbert Xu type = grec->grec_type; 2277e57f6185SNikolay Aleksandrov nsrcs = ntohs(grec->grec_nsrcs); 2278eb1d1641SHerbert Xu 2279e57f6185SNikolay Aleksandrov len += nsrcs * 4; 2280ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2281eb1d1641SHerbert Xu return -EINVAL; 2282eb1d1641SHerbert Xu 2283eb1d1641SHerbert Xu switch (type) { 2284eb1d1641SHerbert Xu case IGMPV3_MODE_IS_INCLUDE: 2285eb1d1641SHerbert Xu case IGMPV3_MODE_IS_EXCLUDE: 2286eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_INCLUDE: 2287eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_EXCLUDE: 2288eb1d1641SHerbert Xu case IGMPV3_ALLOW_NEW_SOURCES: 2289eb1d1641SHerbert Xu case IGMPV3_BLOCK_OLD_SOURCES: 2290eb1d1641SHerbert Xu break; 2291eb1d1641SHerbert Xu 2292eb1d1641SHerbert Xu default: 2293eb1d1641SHerbert Xu continue; 2294eb1d1641SHerbert Xu } 2295eb1d1641SHerbert Xu 22966db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 22970436862eSNikolay Aleksandrov if (nsrcs == 0 && 22980436862eSNikolay Aleksandrov (type == IGMPV3_CHANGE_TO_INCLUDE || 22990436862eSNikolay Aleksandrov type == IGMPV3_MODE_IS_INCLUDE)) { 23000436862eSNikolay Aleksandrov if (!port || igmpv2) { 23016db6f0eaSFelix Fietkau br_ip4_multicast_leave_group(br, port, group, vid, src); 23020436862eSNikolay Aleksandrov continue; 23030436862eSNikolay Aleksandrov } 2304bc8c20acSSatish Ashok } else { 23056db6f0eaSFelix Fietkau err = br_ip4_multicast_add_group(br, port, group, vid, 23060436862eSNikolay Aleksandrov src, igmpv2); 2307eb1d1641SHerbert Xu if (err) 2308eb1d1641SHerbert Xu break; 2309eb1d1641SHerbert Xu } 23100436862eSNikolay Aleksandrov 23110436862eSNikolay Aleksandrov if (!port || igmpv2) 23120436862eSNikolay Aleksandrov continue; 23130436862eSNikolay Aleksandrov 23140436862eSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 23150436862eSNikolay Aleksandrov mdst = br_mdb_ip4_get(br, group, vid); 23160436862eSNikolay Aleksandrov if (!mdst) 23170436862eSNikolay Aleksandrov goto unlock_continue; 23180436862eSNikolay Aleksandrov pg = br_multicast_find_port(mdst, port, src); 23190436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 23200436862eSNikolay Aleksandrov goto unlock_continue; 23210436862eSNikolay Aleksandrov /* reload grec */ 23220436862eSNikolay Aleksandrov grec = (void *)(skb->data + len - sizeof(*grec) - (nsrcs * 4)); 23230436862eSNikolay Aleksandrov switch (type) { 23240436862eSNikolay Aleksandrov case IGMPV3_ALLOW_NEW_SOURCES: 23250436862eSNikolay Aleksandrov changed = br_multicast_isinc_allow(pg, grec->grec_src, 23260436862eSNikolay Aleksandrov nsrcs, sizeof(__be32)); 23270436862eSNikolay Aleksandrov break; 2328e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_INCLUDE: 2329e6231bcaSNikolay Aleksandrov changed = br_multicast_isinc_allow(pg, grec->grec_src, nsrcs, 2330e6231bcaSNikolay Aleksandrov sizeof(__be32)); 2331e6231bcaSNikolay Aleksandrov break; 2332e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_EXCLUDE: 2333e6231bcaSNikolay Aleksandrov changed = br_multicast_isexc(pg, grec->grec_src, nsrcs, 2334e6231bcaSNikolay Aleksandrov sizeof(__be32)); 2335e6231bcaSNikolay Aleksandrov break; 23365bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_INCLUDE: 23375bf1e00bSNikolay Aleksandrov changed = br_multicast_toin(pg, grec->grec_src, nsrcs, 23385bf1e00bSNikolay Aleksandrov sizeof(__be32)); 23395bf1e00bSNikolay Aleksandrov break; 23405bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_EXCLUDE: 23415bf1e00bSNikolay Aleksandrov changed = br_multicast_toex(pg, grec->grec_src, nsrcs, 23425bf1e00bSNikolay Aleksandrov sizeof(__be32)); 23435bf1e00bSNikolay Aleksandrov break; 2344109865feSNikolay Aleksandrov case IGMPV3_BLOCK_OLD_SOURCES: 2345109865feSNikolay Aleksandrov changed = br_multicast_block(pg, grec->grec_src, nsrcs, 2346109865feSNikolay Aleksandrov sizeof(__be32)); 2347109865feSNikolay Aleksandrov break; 23480436862eSNikolay Aleksandrov } 23490436862eSNikolay Aleksandrov if (changed) 23500436862eSNikolay Aleksandrov br_mdb_notify(br->dev, mdst, pg, RTM_NEWMDB); 23510436862eSNikolay Aleksandrov unlock_continue: 23520436862eSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 2353bc8c20acSSatish Ashok } 2354eb1d1641SHerbert Xu 2355eb1d1641SHerbert Xu return err; 2356eb1d1641SHerbert Xu } 2357eb1d1641SHerbert Xu 2358dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 235908b202b6SYOSHIFUJI Hideaki static int br_ip6_multicast_mld2_report(struct net_bridge *br, 236008b202b6SYOSHIFUJI Hideaki struct net_bridge_port *port, 236106499098SVlad Yasevich struct sk_buff *skb, 236206499098SVlad Yasevich u16 vid) 236308b202b6SYOSHIFUJI Hideaki { 23640436862eSNikolay Aleksandrov bool mldv1 = br->multicast_mld_version == 1; 23650436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 23660436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 2367ba5ea614SLinus Lüssing unsigned int nsrcs_offset; 23686db6f0eaSFelix Fietkau const unsigned char *src; 236908b202b6SYOSHIFUJI Hideaki struct icmp6hdr *icmp6h; 237008b202b6SYOSHIFUJI Hideaki struct mld2_grec *grec; 2371ba5ea614SLinus Lüssing unsigned int grec_len; 23720436862eSNikolay Aleksandrov bool changed = false; 23730436862eSNikolay Aleksandrov int i, len, num; 237408b202b6SYOSHIFUJI Hideaki int err = 0; 237508b202b6SYOSHIFUJI Hideaki 2376ba5ea614SLinus Lüssing if (!ipv6_mc_may_pull(skb, sizeof(*icmp6h))) 237708b202b6SYOSHIFUJI Hideaki return -EINVAL; 237808b202b6SYOSHIFUJI Hideaki 237908b202b6SYOSHIFUJI Hideaki icmp6h = icmp6_hdr(skb); 238008b202b6SYOSHIFUJI Hideaki num = ntohs(icmp6h->icmp6_dataun.un_data16[1]); 2381c2d4fbd2SLinus Lüssing len = skb_transport_offset(skb) + sizeof(*icmp6h); 238208b202b6SYOSHIFUJI Hideaki 238308b202b6SYOSHIFUJI Hideaki for (i = 0; i < num; i++) { 2384e57f6185SNikolay Aleksandrov __be16 *_nsrcs, __nsrcs; 2385e57f6185SNikolay Aleksandrov u16 nsrcs; 238608b202b6SYOSHIFUJI Hideaki 2387ba5ea614SLinus Lüssing nsrcs_offset = len + offsetof(struct mld2_grec, grec_nsrcs); 2388ba5ea614SLinus Lüssing 2389ba5ea614SLinus Lüssing if (skb_transport_offset(skb) + ipv6_transport_len(skb) < 23905fc6266aSLinus Lüssing nsrcs_offset + sizeof(__nsrcs)) 2391ba5ea614SLinus Lüssing return -EINVAL; 2392ba5ea614SLinus Lüssing 2393e57f6185SNikolay Aleksandrov _nsrcs = skb_header_pointer(skb, nsrcs_offset, 2394e57f6185SNikolay Aleksandrov sizeof(__nsrcs), &__nsrcs); 2395e57f6185SNikolay Aleksandrov if (!_nsrcs) 239608b202b6SYOSHIFUJI Hideaki return -EINVAL; 239708b202b6SYOSHIFUJI Hideaki 2398e57f6185SNikolay Aleksandrov nsrcs = ntohs(*_nsrcs); 2399e57f6185SNikolay Aleksandrov grec_len = struct_size(grec, grec_src, nsrcs); 2400ba5ea614SLinus Lüssing 2401ba5ea614SLinus Lüssing if (!ipv6_mc_may_pull(skb, len + grec_len)) 240208b202b6SYOSHIFUJI Hideaki return -EINVAL; 240308b202b6SYOSHIFUJI Hideaki 240408b202b6SYOSHIFUJI Hideaki grec = (struct mld2_grec *)(skb->data + len); 2405ba5ea614SLinus Lüssing len += grec_len; 240608b202b6SYOSHIFUJI Hideaki 240708b202b6SYOSHIFUJI Hideaki switch (grec->grec_type) { 240808b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_INCLUDE: 240908b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_EXCLUDE: 241008b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_INCLUDE: 241108b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_EXCLUDE: 241208b202b6SYOSHIFUJI Hideaki case MLD2_ALLOW_NEW_SOURCES: 241308b202b6SYOSHIFUJI Hideaki case MLD2_BLOCK_OLD_SOURCES: 241408b202b6SYOSHIFUJI Hideaki break; 241508b202b6SYOSHIFUJI Hideaki 241608b202b6SYOSHIFUJI Hideaki default: 241708b202b6SYOSHIFUJI Hideaki continue; 241808b202b6SYOSHIFUJI Hideaki } 241908b202b6SYOSHIFUJI Hideaki 24206db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 2421bc8c20acSSatish Ashok if ((grec->grec_type == MLD2_CHANGE_TO_INCLUDE || 2422bc8c20acSSatish Ashok grec->grec_type == MLD2_MODE_IS_INCLUDE) && 2423e57f6185SNikolay Aleksandrov nsrcs == 0) { 24240436862eSNikolay Aleksandrov if (!port || mldv1) { 24250436862eSNikolay Aleksandrov br_ip6_multicast_leave_group(br, port, 24260436862eSNikolay Aleksandrov &grec->grec_mca, 24276db6f0eaSFelix Fietkau vid, src); 24280436862eSNikolay Aleksandrov continue; 24290436862eSNikolay Aleksandrov } 2430bc8c20acSSatish Ashok } else { 2431bc8c20acSSatish Ashok err = br_ip6_multicast_add_group(br, port, 24326db6f0eaSFelix Fietkau &grec->grec_mca, vid, 24330436862eSNikolay Aleksandrov src, mldv1); 24349264251eSDavide Caratti if (err) 243508b202b6SYOSHIFUJI Hideaki break; 243608b202b6SYOSHIFUJI Hideaki } 24370436862eSNikolay Aleksandrov 24380436862eSNikolay Aleksandrov if (!port || mldv1) 24390436862eSNikolay Aleksandrov continue; 24400436862eSNikolay Aleksandrov 24410436862eSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 24420436862eSNikolay Aleksandrov mdst = br_mdb_ip6_get(br, &grec->grec_mca, vid); 24430436862eSNikolay Aleksandrov if (!mdst) 24440436862eSNikolay Aleksandrov goto unlock_continue; 24450436862eSNikolay Aleksandrov pg = br_multicast_find_port(mdst, port, src); 24460436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 24470436862eSNikolay Aleksandrov goto unlock_continue; 24480436862eSNikolay Aleksandrov switch (grec->grec_type) { 24490436862eSNikolay Aleksandrov case MLD2_ALLOW_NEW_SOURCES: 24500436862eSNikolay Aleksandrov changed = br_multicast_isinc_allow(pg, grec->grec_src, 24510436862eSNikolay Aleksandrov nsrcs, 24520436862eSNikolay Aleksandrov sizeof(struct in6_addr)); 24530436862eSNikolay Aleksandrov break; 2454e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_INCLUDE: 2455e6231bcaSNikolay Aleksandrov changed = br_multicast_isinc_allow(pg, grec->grec_src, nsrcs, 2456e6231bcaSNikolay Aleksandrov sizeof(struct in6_addr)); 2457e6231bcaSNikolay Aleksandrov break; 2458e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_EXCLUDE: 2459e6231bcaSNikolay Aleksandrov changed = br_multicast_isexc(pg, grec->grec_src, nsrcs, 2460e6231bcaSNikolay Aleksandrov sizeof(struct in6_addr)); 2461e6231bcaSNikolay Aleksandrov break; 24625bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_INCLUDE: 24635bf1e00bSNikolay Aleksandrov changed = br_multicast_toin(pg, grec->grec_src, nsrcs, 24645bf1e00bSNikolay Aleksandrov sizeof(struct in6_addr)); 24655bf1e00bSNikolay Aleksandrov break; 24665bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_EXCLUDE: 24675bf1e00bSNikolay Aleksandrov changed = br_multicast_toex(pg, grec->grec_src, nsrcs, 24685bf1e00bSNikolay Aleksandrov sizeof(struct in6_addr)); 24695bf1e00bSNikolay Aleksandrov break; 2470109865feSNikolay Aleksandrov case MLD2_BLOCK_OLD_SOURCES: 2471109865feSNikolay Aleksandrov changed = br_multicast_block(pg, grec->grec_src, nsrcs, 2472109865feSNikolay Aleksandrov sizeof(struct in6_addr)); 2473109865feSNikolay Aleksandrov break; 24740436862eSNikolay Aleksandrov } 24750436862eSNikolay Aleksandrov if (changed) 24760436862eSNikolay Aleksandrov br_mdb_notify(br->dev, mdst, pg, RTM_NEWMDB); 24770436862eSNikolay Aleksandrov unlock_continue: 24780436862eSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 2479bc8c20acSSatish Ashok } 248008b202b6SYOSHIFUJI Hideaki 248108b202b6SYOSHIFUJI Hideaki return err; 248208b202b6SYOSHIFUJI Hideaki } 248308b202b6SYOSHIFUJI Hideaki #endif 248408b202b6SYOSHIFUJI Hideaki 2485dc4eb53aSLinus Lüssing static bool br_ip4_multicast_select_querier(struct net_bridge *br, 24862cd41431SLinus Lüssing struct net_bridge_port *port, 2487dc4eb53aSLinus Lüssing __be32 saddr) 2488dc4eb53aSLinus Lüssing { 2489dc4eb53aSLinus Lüssing if (!timer_pending(&br->ip4_own_query.timer) && 2490dc4eb53aSLinus Lüssing !timer_pending(&br->ip4_other_query.timer)) 2491dc4eb53aSLinus Lüssing goto update; 2492dc4eb53aSLinus Lüssing 2493deb96566SNikolay Aleksandrov if (!br->ip4_querier.addr.src.ip4) 2494dc4eb53aSLinus Lüssing goto update; 2495dc4eb53aSLinus Lüssing 2496deb96566SNikolay Aleksandrov if (ntohl(saddr) <= ntohl(br->ip4_querier.addr.src.ip4)) 2497dc4eb53aSLinus Lüssing goto update; 2498dc4eb53aSLinus Lüssing 2499dc4eb53aSLinus Lüssing return false; 2500dc4eb53aSLinus Lüssing 2501dc4eb53aSLinus Lüssing update: 2502deb96566SNikolay Aleksandrov br->ip4_querier.addr.src.ip4 = saddr; 2503dc4eb53aSLinus Lüssing 25042cd41431SLinus Lüssing /* update protected by general multicast_lock by caller */ 25052cd41431SLinus Lüssing rcu_assign_pointer(br->ip4_querier.port, port); 25062cd41431SLinus Lüssing 2507dc4eb53aSLinus Lüssing return true; 2508dc4eb53aSLinus Lüssing } 2509dc4eb53aSLinus Lüssing 2510dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 2511dc4eb53aSLinus Lüssing static bool br_ip6_multicast_select_querier(struct net_bridge *br, 25122cd41431SLinus Lüssing struct net_bridge_port *port, 2513dc4eb53aSLinus Lüssing struct in6_addr *saddr) 2514dc4eb53aSLinus Lüssing { 2515dc4eb53aSLinus Lüssing if (!timer_pending(&br->ip6_own_query.timer) && 2516dc4eb53aSLinus Lüssing !timer_pending(&br->ip6_other_query.timer)) 2517dc4eb53aSLinus Lüssing goto update; 2518dc4eb53aSLinus Lüssing 2519deb96566SNikolay Aleksandrov if (ipv6_addr_cmp(saddr, &br->ip6_querier.addr.src.ip6) <= 0) 2520dc4eb53aSLinus Lüssing goto update; 2521dc4eb53aSLinus Lüssing 2522dc4eb53aSLinus Lüssing return false; 2523dc4eb53aSLinus Lüssing 2524dc4eb53aSLinus Lüssing update: 2525deb96566SNikolay Aleksandrov br->ip6_querier.addr.src.ip6 = *saddr; 2526dc4eb53aSLinus Lüssing 25272cd41431SLinus Lüssing /* update protected by general multicast_lock by caller */ 25282cd41431SLinus Lüssing rcu_assign_pointer(br->ip6_querier.port, port); 25292cd41431SLinus Lüssing 2530dc4eb53aSLinus Lüssing return true; 2531dc4eb53aSLinus Lüssing } 2532dc4eb53aSLinus Lüssing #endif 2533dc4eb53aSLinus Lüssing 2534dc4eb53aSLinus Lüssing static bool br_multicast_select_querier(struct net_bridge *br, 25352cd41431SLinus Lüssing struct net_bridge_port *port, 2536dc4eb53aSLinus Lüssing struct br_ip *saddr) 2537dc4eb53aSLinus Lüssing { 2538dc4eb53aSLinus Lüssing switch (saddr->proto) { 2539dc4eb53aSLinus Lüssing case htons(ETH_P_IP): 2540deb96566SNikolay Aleksandrov return br_ip4_multicast_select_querier(br, port, saddr->src.ip4); 2541dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 2542dc4eb53aSLinus Lüssing case htons(ETH_P_IPV6): 2543deb96566SNikolay Aleksandrov return br_ip6_multicast_select_querier(br, port, &saddr->src.ip6); 2544dc4eb53aSLinus Lüssing #endif 2545dc4eb53aSLinus Lüssing } 2546dc4eb53aSLinus Lüssing 2547dc4eb53aSLinus Lüssing return false; 2548dc4eb53aSLinus Lüssing } 2549dc4eb53aSLinus Lüssing 2550cc0fdd80SLinus Lüssing static void 255190010b36SLinus Lüssing br_multicast_update_query_timer(struct net_bridge *br, 255290010b36SLinus Lüssing struct bridge_mcast_other_query *query, 2553b00589afSLinus Lüssing unsigned long max_delay) 2554b00589afSLinus Lüssing { 255590010b36SLinus Lüssing if (!timer_pending(&query->timer)) 255690010b36SLinus Lüssing query->delay_time = jiffies + max_delay; 2557b00589afSLinus Lüssing 255890010b36SLinus Lüssing mod_timer(&query->timer, jiffies + br->multicast_querier_interval); 2559b00589afSLinus Lüssing } 2560b00589afSLinus Lüssing 25616d549648SNogah Frankel static void br_port_mc_router_state_change(struct net_bridge_port *p, 25626d549648SNogah Frankel bool is_mc_router) 25636d549648SNogah Frankel { 25646d549648SNogah Frankel struct switchdev_attr attr = { 25656d549648SNogah Frankel .orig_dev = p->dev, 25666d549648SNogah Frankel .id = SWITCHDEV_ATTR_ID_PORT_MROUTER, 25676d549648SNogah Frankel .flags = SWITCHDEV_F_DEFER, 25686d549648SNogah Frankel .u.mrouter = is_mc_router, 25696d549648SNogah Frankel }; 25706d549648SNogah Frankel 25716d549648SNogah Frankel switchdev_port_attr_set(p->dev, &attr); 25726d549648SNogah Frankel } 25736d549648SNogah Frankel 25747e80c124Sstephen hemminger /* 25757c77602fSCong Wang * Add port to router_list 25767e80c124Sstephen hemminger * list is maintained ordered by pointer value 25777e80c124Sstephen hemminger * and locked by br->multicast_lock and RCU 25787e80c124Sstephen hemminger */ 25790909e117SHerbert Xu static void br_multicast_add_router(struct net_bridge *br, 25800909e117SHerbert Xu struct net_bridge_port *port) 25810909e117SHerbert Xu { 2582dcdca2c4Sstephen hemminger struct net_bridge_port *p; 2583b67bfe0dSSasha Levin struct hlist_node *slot = NULL; 25840909e117SHerbert Xu 25851a040eacSNikolay Aleksandrov if (!hlist_unhashed(&port->rlist)) 25861a040eacSNikolay Aleksandrov return; 25871a040eacSNikolay Aleksandrov 2588b67bfe0dSSasha Levin hlist_for_each_entry(p, &br->router_list, rlist) { 25897e80c124Sstephen hemminger if ((unsigned long) port >= (unsigned long) p) 25907e80c124Sstephen hemminger break; 2591b67bfe0dSSasha Levin slot = &p->rlist; 2592dcdca2c4Sstephen hemminger } 25930909e117SHerbert Xu 25947e80c124Sstephen hemminger if (slot) 25951d023284SKen Helias hlist_add_behind_rcu(&port->rlist, slot); 2596dcdca2c4Sstephen hemminger else 2597dcdca2c4Sstephen hemminger hlist_add_head_rcu(&port->rlist, &br->router_list); 2598949f1e39SSatish Ashok br_rtr_notify(br->dev, port, RTM_NEWMDB); 25996d549648SNogah Frankel br_port_mc_router_state_change(port, true); 26000909e117SHerbert Xu } 26010909e117SHerbert Xu 2602eb1d1641SHerbert Xu static void br_multicast_mark_router(struct net_bridge *br, 2603eb1d1641SHerbert Xu struct net_bridge_port *port) 2604eb1d1641SHerbert Xu { 2605eb1d1641SHerbert Xu unsigned long now = jiffies; 2606eb1d1641SHerbert Xu 2607eb1d1641SHerbert Xu if (!port) { 260877041420SYotam Gigi if (br->multicast_router == MDB_RTR_TYPE_TEMP_QUERY) { 260977041420SYotam Gigi if (!timer_pending(&br->multicast_router_timer)) 261077041420SYotam Gigi br_mc_router_state_change(br, true); 2611eb1d1641SHerbert Xu mod_timer(&br->multicast_router_timer, 2612eb1d1641SHerbert Xu now + br->multicast_querier_interval); 261377041420SYotam Gigi } 2614eb1d1641SHerbert Xu return; 2615eb1d1641SHerbert Xu } 2616eb1d1641SHerbert Xu 2617a55d8246SNikolay Aleksandrov if (port->multicast_router == MDB_RTR_TYPE_DISABLED || 2618a55d8246SNikolay Aleksandrov port->multicast_router == MDB_RTR_TYPE_PERM) 2619eb1d1641SHerbert Xu return; 2620eb1d1641SHerbert Xu 26210909e117SHerbert Xu br_multicast_add_router(br, port); 2622eb1d1641SHerbert Xu 2623eb1d1641SHerbert Xu mod_timer(&port->multicast_router_timer, 2624eb1d1641SHerbert Xu now + br->multicast_querier_interval); 2625eb1d1641SHerbert Xu } 2626eb1d1641SHerbert Xu 2627eb1d1641SHerbert Xu static void br_multicast_query_received(struct net_bridge *br, 2628eb1d1641SHerbert Xu struct net_bridge_port *port, 262990010b36SLinus Lüssing struct bridge_mcast_other_query *query, 2630dc4eb53aSLinus Lüssing struct br_ip *saddr, 2631b00589afSLinus Lüssing unsigned long max_delay) 2632eb1d1641SHerbert Xu { 26332cd41431SLinus Lüssing if (!br_multicast_select_querier(br, port, saddr)) 2634eb1d1641SHerbert Xu return; 2635eb1d1641SHerbert Xu 2636dc4eb53aSLinus Lüssing br_multicast_update_query_timer(br, query, max_delay); 2637eb1d1641SHerbert Xu br_multicast_mark_router(br, port); 2638eb1d1641SHerbert Xu } 2639eb1d1641SHerbert Xu 26409c2e955cSzhong jiang static void br_ip4_multicast_query(struct net_bridge *br, 2641eb1d1641SHerbert Xu struct net_bridge_port *port, 264206499098SVlad Yasevich struct sk_buff *skb, 264306499098SVlad Yasevich u16 vid) 2644eb1d1641SHerbert Xu { 2645ba5ea614SLinus Lüssing unsigned int transport_len = ip_transport_len(skb); 2646b71d1d42SEric Dumazet const struct iphdr *iph = ip_hdr(skb); 2647eb1d1641SHerbert Xu struct igmphdr *ih = igmp_hdr(skb); 2648eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 2649eb1d1641SHerbert Xu struct igmpv3_query *ih3; 2650eb1d1641SHerbert Xu struct net_bridge_port_group *p; 2651e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 2652dc4eb53aSLinus Lüssing struct br_ip saddr; 2653eb1d1641SHerbert Xu unsigned long max_delay; 2654eb1d1641SHerbert Xu unsigned long now = jiffies; 2655eb1d1641SHerbert Xu __be32 group; 2656eb1d1641SHerbert Xu 2657eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 2658eb1d1641SHerbert Xu if (!netif_running(br->dev) || 2659eb1d1641SHerbert Xu (port && port->state == BR_STATE_DISABLED)) 2660eb1d1641SHerbert Xu goto out; 2661eb1d1641SHerbert Xu 2662eb1d1641SHerbert Xu group = ih->group; 2663eb1d1641SHerbert Xu 2664ba5ea614SLinus Lüssing if (transport_len == sizeof(*ih)) { 2665eb1d1641SHerbert Xu max_delay = ih->code * (HZ / IGMP_TIMER_SCALE); 2666eb1d1641SHerbert Xu 2667eb1d1641SHerbert Xu if (!max_delay) { 2668eb1d1641SHerbert Xu max_delay = 10 * HZ; 2669eb1d1641SHerbert Xu group = 0; 2670eb1d1641SHerbert Xu } 2671ba5ea614SLinus Lüssing } else if (transport_len >= sizeof(*ih3)) { 2672eb1d1641SHerbert Xu ih3 = igmpv3_query_hdr(skb); 267323550b83SNikolay Aleksandrov if (ih3->nsrcs || 267423550b83SNikolay Aleksandrov (br->multicast_igmp_version == 3 && group && ih3->suppress)) 2675bec68ff1SYOSHIFUJI Hideaki goto out; 2676eb1d1641SHerbert Xu 26770ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 max_delay = ih3->code ? 26780ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 IGMPV3_MRC(ih3->code) * (HZ / IGMP_TIMER_SCALE) : 1; 26799afd85c9SLinus Lüssing } else { 26809ed973ccSLinus Lüssing goto out; 26819ed973ccSLinus Lüssing } 26829ed973ccSLinus Lüssing 2683dc4eb53aSLinus Lüssing if (!group) { 2684dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IP); 2685deb96566SNikolay Aleksandrov saddr.src.ip4 = iph->saddr; 2686b00589afSLinus Lüssing 2687dc4eb53aSLinus Lüssing br_multicast_query_received(br, port, &br->ip4_other_query, 2688dc4eb53aSLinus Lüssing &saddr, max_delay); 2689eb1d1641SHerbert Xu goto out; 2690dc4eb53aSLinus Lüssing } 2691eb1d1641SHerbert Xu 269219e3a9c9SNikolay Aleksandrov mp = br_mdb_ip4_get(br, group, vid); 2693eb1d1641SHerbert Xu if (!mp) 2694eb1d1641SHerbert Xu goto out; 2695eb1d1641SHerbert Xu 2696eb1d1641SHerbert Xu max_delay *= br->multicast_last_member_count; 2697eb1d1641SHerbert Xu 2698ff0fd34eSAndrew Lunn if (mp->host_joined && 2699eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 2700eb1d1641SHerbert Xu time_after(mp->timer.expires, now + max_delay) : 2701eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) 2702eb1d1641SHerbert Xu mod_timer(&mp->timer, now + max_delay); 2703eb1d1641SHerbert Xu 2704e8051688SEric Dumazet for (pp = &mp->ports; 2705e8051688SEric Dumazet (p = mlock_dereference(*pp, br)) != NULL; 2706e8051688SEric Dumazet pp = &p->next) { 2707eb1d1641SHerbert Xu if (timer_pending(&p->timer) ? 2708eb1d1641SHerbert Xu time_after(p->timer.expires, now + max_delay) : 270923550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 271023550b83SNikolay Aleksandrov (br->multicast_igmp_version == 2 || 271123550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 271224f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 2713eb1d1641SHerbert Xu } 2714eb1d1641SHerbert Xu 2715eb1d1641SHerbert Xu out: 2716eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 2717eb1d1641SHerbert Xu } 2718eb1d1641SHerbert Xu 2719dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 272008b202b6SYOSHIFUJI Hideaki static int br_ip6_multicast_query(struct net_bridge *br, 272108b202b6SYOSHIFUJI Hideaki struct net_bridge_port *port, 272206499098SVlad Yasevich struct sk_buff *skb, 272306499098SVlad Yasevich u16 vid) 272408b202b6SYOSHIFUJI Hideaki { 2725ba5ea614SLinus Lüssing unsigned int transport_len = ipv6_transport_len(skb); 2726eca2a43bSstephen hemminger struct mld_msg *mld; 272708b202b6SYOSHIFUJI Hideaki struct net_bridge_mdb_entry *mp; 272808b202b6SYOSHIFUJI Hideaki struct mld2_query *mld2q; 2729e8051688SEric Dumazet struct net_bridge_port_group *p; 2730e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 2731dc4eb53aSLinus Lüssing struct br_ip saddr; 273208b202b6SYOSHIFUJI Hideaki unsigned long max_delay; 273308b202b6SYOSHIFUJI Hideaki unsigned long now = jiffies; 2734856ce5d0SLinus Lüssing unsigned int offset = skb_transport_offset(skb); 2735b71d1d42SEric Dumazet const struct in6_addr *group = NULL; 27369ed973ccSLinus Lüssing bool is_general_query; 273708b202b6SYOSHIFUJI Hideaki int err = 0; 273808b202b6SYOSHIFUJI Hideaki 273908b202b6SYOSHIFUJI Hideaki spin_lock(&br->multicast_lock); 274008b202b6SYOSHIFUJI Hideaki if (!netif_running(br->dev) || 274108b202b6SYOSHIFUJI Hideaki (port && port->state == BR_STATE_DISABLED)) 274208b202b6SYOSHIFUJI Hideaki goto out; 274308b202b6SYOSHIFUJI Hideaki 2744ba5ea614SLinus Lüssing if (transport_len == sizeof(*mld)) { 2745856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld))) { 274608b202b6SYOSHIFUJI Hideaki err = -EINVAL; 274708b202b6SYOSHIFUJI Hideaki goto out; 274808b202b6SYOSHIFUJI Hideaki } 274908b202b6SYOSHIFUJI Hideaki mld = (struct mld_msg *) icmp6_hdr(skb); 27504715213dSLi RongQing max_delay = msecs_to_jiffies(ntohs(mld->mld_maxdelay)); 275108b202b6SYOSHIFUJI Hideaki if (max_delay) 275208b202b6SYOSHIFUJI Hideaki group = &mld->mld_mca; 2753248ba8ecSLinus Lüssing } else { 2754856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld2q))) { 275508b202b6SYOSHIFUJI Hideaki err = -EINVAL; 275608b202b6SYOSHIFUJI Hideaki goto out; 275708b202b6SYOSHIFUJI Hideaki } 275808b202b6SYOSHIFUJI Hideaki mld2q = (struct mld2_query *)icmp6_hdr(skb); 275908b202b6SYOSHIFUJI Hideaki if (!mld2q->mld2q_nsrcs) 276008b202b6SYOSHIFUJI Hideaki group = &mld2q->mld2q_mca; 276123550b83SNikolay Aleksandrov if (br->multicast_mld_version == 2 && 276223550b83SNikolay Aleksandrov !ipv6_addr_any(&mld2q->mld2q_mca) && 276323550b83SNikolay Aleksandrov mld2q->mld2q_suppress) 276423550b83SNikolay Aleksandrov goto out; 2765e3f5b170SDaniel Borkmann 2766e3f5b170SDaniel Borkmann max_delay = max(msecs_to_jiffies(mldv2_mrc(mld2q)), 1UL); 276708b202b6SYOSHIFUJI Hideaki } 276808b202b6SYOSHIFUJI Hideaki 27699ed973ccSLinus Lüssing is_general_query = group && ipv6_addr_any(group); 27709ed973ccSLinus Lüssing 2771dc4eb53aSLinus Lüssing if (is_general_query) { 2772dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IPV6); 2773deb96566SNikolay Aleksandrov saddr.src.ip6 = ipv6_hdr(skb)->saddr; 2774b00589afSLinus Lüssing 2775dc4eb53aSLinus Lüssing br_multicast_query_received(br, port, &br->ip6_other_query, 2776dc4eb53aSLinus Lüssing &saddr, max_delay); 277708b202b6SYOSHIFUJI Hideaki goto out; 27786c03ee8bSLinus Lüssing } else if (!group) { 27796c03ee8bSLinus Lüssing goto out; 2780dc4eb53aSLinus Lüssing } 278108b202b6SYOSHIFUJI Hideaki 278219e3a9c9SNikolay Aleksandrov mp = br_mdb_ip6_get(br, group, vid); 278308b202b6SYOSHIFUJI Hideaki if (!mp) 278408b202b6SYOSHIFUJI Hideaki goto out; 278508b202b6SYOSHIFUJI Hideaki 278608b202b6SYOSHIFUJI Hideaki max_delay *= br->multicast_last_member_count; 2787ff0fd34eSAndrew Lunn if (mp->host_joined && 278808b202b6SYOSHIFUJI Hideaki (timer_pending(&mp->timer) ? 278908b202b6SYOSHIFUJI Hideaki time_after(mp->timer.expires, now + max_delay) : 279008b202b6SYOSHIFUJI Hideaki try_to_del_timer_sync(&mp->timer) >= 0)) 279108b202b6SYOSHIFUJI Hideaki mod_timer(&mp->timer, now + max_delay); 279208b202b6SYOSHIFUJI Hideaki 2793e8051688SEric Dumazet for (pp = &mp->ports; 2794e8051688SEric Dumazet (p = mlock_dereference(*pp, br)) != NULL; 2795e8051688SEric Dumazet pp = &p->next) { 279608b202b6SYOSHIFUJI Hideaki if (timer_pending(&p->timer) ? 279708b202b6SYOSHIFUJI Hideaki time_after(p->timer.expires, now + max_delay) : 279823550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 279923550b83SNikolay Aleksandrov (br->multicast_mld_version == 1 || 280023550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 280124f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 280208b202b6SYOSHIFUJI Hideaki } 280308b202b6SYOSHIFUJI Hideaki 280408b202b6SYOSHIFUJI Hideaki out: 280508b202b6SYOSHIFUJI Hideaki spin_unlock(&br->multicast_lock); 280608b202b6SYOSHIFUJI Hideaki return err; 280708b202b6SYOSHIFUJI Hideaki } 280808b202b6SYOSHIFUJI Hideaki #endif 280908b202b6SYOSHIFUJI Hideaki 281090010b36SLinus Lüssing static void 281190010b36SLinus Lüssing br_multicast_leave_group(struct net_bridge *br, 2812eb1d1641SHerbert Xu struct net_bridge_port *port, 2813cc0fdd80SLinus Lüssing struct br_ip *group, 281490010b36SLinus Lüssing struct bridge_mcast_other_query *other_query, 28156db6f0eaSFelix Fietkau struct bridge_mcast_own_query *own_query, 28166db6f0eaSFelix Fietkau const unsigned char *src) 2817eb1d1641SHerbert Xu { 2818eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 2819eb1d1641SHerbert Xu struct net_bridge_port_group *p; 2820eb1d1641SHerbert Xu unsigned long now; 2821eb1d1641SHerbert Xu unsigned long time; 2822eb1d1641SHerbert Xu 2823eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 2824eb1d1641SHerbert Xu if (!netif_running(br->dev) || 2825544586f7SSatish Ashok (port && port->state == BR_STATE_DISABLED)) 2826eb1d1641SHerbert Xu goto out; 2827eb1d1641SHerbert Xu 282819e3a9c9SNikolay Aleksandrov mp = br_mdb_ip_get(br, group); 2829eb1d1641SHerbert Xu if (!mp) 2830eb1d1641SHerbert Xu goto out; 2831eb1d1641SHerbert Xu 2832544586f7SSatish Ashok if (port && (port->flags & BR_MULTICAST_FAST_LEAVE)) { 2833544586f7SSatish Ashok struct net_bridge_port_group __rcu **pp; 2834544586f7SSatish Ashok 2835544586f7SSatish Ashok for (pp = &mp->ports; 2836544586f7SSatish Ashok (p = mlock_dereference(*pp, br)) != NULL; 2837544586f7SSatish Ashok pp = &p->next) { 28386db6f0eaSFelix Fietkau if (!br_port_group_equal(p, port, src)) 2839544586f7SSatish Ashok continue; 2840544586f7SSatish Ashok 28415c725b6bSNikolay Aleksandrov if (p->flags & MDB_PG_FLAGS_PERMANENT) 28425c725b6bSNikolay Aleksandrov break; 28435c725b6bSNikolay Aleksandrov 2844681590bdSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_FAST_LEAVE; 2845681590bdSNikolay Aleksandrov br_multicast_del_pg(mp, p, pp); 2846544586f7SSatish Ashok } 2847544586f7SSatish Ashok goto out; 2848544586f7SSatish Ashok } 2849544586f7SSatish Ashok 2850544586f7SSatish Ashok if (timer_pending(&other_query->timer)) 2851544586f7SSatish Ashok goto out; 2852544586f7SSatish Ashok 2853675779adSNikolay Aleksandrov if (br_opt_get(br, BROPT_MULTICAST_QUERIER)) { 2854438ef2d0SNikolay Aleksandrov __br_multicast_send_query(br, port, NULL, NULL, &mp->addr, 285542c11ccfSNikolay Aleksandrov false, 0, NULL); 28566b7df111SCong Wang 28576b7df111SCong Wang time = jiffies + br->multicast_last_member_count * 28586b7df111SCong Wang br->multicast_last_member_interval; 2859cc0fdd80SLinus Lüssing 286090010b36SLinus Lüssing mod_timer(&own_query->timer, time); 28616b7df111SCong Wang 28626b7df111SCong Wang for (p = mlock_dereference(mp->ports, br); 28636b7df111SCong Wang p != NULL; 28646b7df111SCong Wang p = mlock_dereference(p->next, br)) { 28656db6f0eaSFelix Fietkau if (!br_port_group_equal(p, port, src)) 28666b7df111SCong Wang continue; 28676b7df111SCong Wang 28686b7df111SCong Wang if (!hlist_unhashed(&p->mglist) && 28696b7df111SCong Wang (timer_pending(&p->timer) ? 28706b7df111SCong Wang time_after(p->timer.expires, time) : 28716b7df111SCong Wang try_to_del_timer_sync(&p->timer) >= 0)) { 28726b7df111SCong Wang mod_timer(&p->timer, time); 28736b7df111SCong Wang } 28746b7df111SCong Wang 28756b7df111SCong Wang break; 28766b7df111SCong Wang } 28776b7df111SCong Wang } 28786b7df111SCong Wang 2879eb1d1641SHerbert Xu now = jiffies; 2880eb1d1641SHerbert Xu time = now + br->multicast_last_member_count * 2881eb1d1641SHerbert Xu br->multicast_last_member_interval; 2882eb1d1641SHerbert Xu 2883eb1d1641SHerbert Xu if (!port) { 2884ff0fd34eSAndrew Lunn if (mp->host_joined && 2885eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 2886eb1d1641SHerbert Xu time_after(mp->timer.expires, time) : 2887eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) { 2888eb1d1641SHerbert Xu mod_timer(&mp->timer, time); 2889eb1d1641SHerbert Xu } 2890454594f3SLinus Lüssing 2891454594f3SLinus Lüssing goto out; 2892454594f3SLinus Lüssing } 2893454594f3SLinus Lüssing 2894454594f3SLinus Lüssing for (p = mlock_dereference(mp->ports, br); 2895454594f3SLinus Lüssing p != NULL; 2896454594f3SLinus Lüssing p = mlock_dereference(p->next, br)) { 2897085b53c8SNikolay Aleksandrov if (p->key.port != port) 2898454594f3SLinus Lüssing continue; 2899454594f3SLinus Lüssing 2900454594f3SLinus Lüssing if (!hlist_unhashed(&p->mglist) && 2901454594f3SLinus Lüssing (timer_pending(&p->timer) ? 2902454594f3SLinus Lüssing time_after(p->timer.expires, time) : 2903454594f3SLinus Lüssing try_to_del_timer_sync(&p->timer) >= 0)) { 2904454594f3SLinus Lüssing mod_timer(&p->timer, time); 2905454594f3SLinus Lüssing } 2906454594f3SLinus Lüssing 2907454594f3SLinus Lüssing break; 2908eb1d1641SHerbert Xu } 2909eb1d1641SHerbert Xu out: 2910eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 2911eb1d1641SHerbert Xu } 2912eb1d1641SHerbert Xu 29138ef2a9a5SYOSHIFUJI Hideaki static void br_ip4_multicast_leave_group(struct net_bridge *br, 29148ef2a9a5SYOSHIFUJI Hideaki struct net_bridge_port *port, 2915b0e9a30dSVlad Yasevich __be32 group, 29166db6f0eaSFelix Fietkau __u16 vid, 29176db6f0eaSFelix Fietkau const unsigned char *src) 29188ef2a9a5SYOSHIFUJI Hideaki { 29198ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 292090010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 29218ef2a9a5SYOSHIFUJI Hideaki 29228ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 29238ef2a9a5SYOSHIFUJI Hideaki return; 29248ef2a9a5SYOSHIFUJI Hideaki 292590010b36SLinus Lüssing own_query = port ? &port->ip4_own_query : &br->ip4_own_query; 292690010b36SLinus Lüssing 29271515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 2928eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 29298ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 2930b0e9a30dSVlad Yasevich br_group.vid = vid; 29318ef2a9a5SYOSHIFUJI Hideaki 293290010b36SLinus Lüssing br_multicast_leave_group(br, port, &br_group, &br->ip4_other_query, 29336db6f0eaSFelix Fietkau own_query, src); 29348ef2a9a5SYOSHIFUJI Hideaki } 29358ef2a9a5SYOSHIFUJI Hideaki 2936dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 293708b202b6SYOSHIFUJI Hideaki static void br_ip6_multicast_leave_group(struct net_bridge *br, 293808b202b6SYOSHIFUJI Hideaki struct net_bridge_port *port, 2939b0e9a30dSVlad Yasevich const struct in6_addr *group, 29406db6f0eaSFelix Fietkau __u16 vid, 29416db6f0eaSFelix Fietkau const unsigned char *src) 294208b202b6SYOSHIFUJI Hideaki { 294308b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 294490010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 294508b202b6SYOSHIFUJI Hideaki 29463c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 294708b202b6SYOSHIFUJI Hideaki return; 294808b202b6SYOSHIFUJI Hideaki 294990010b36SLinus Lüssing own_query = port ? &port->ip6_own_query : &br->ip6_own_query; 295090010b36SLinus Lüssing 29511515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 2952eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 295308b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 2954b0e9a30dSVlad Yasevich br_group.vid = vid; 295508b202b6SYOSHIFUJI Hideaki 295690010b36SLinus Lüssing br_multicast_leave_group(br, port, &br_group, &br->ip6_other_query, 29576db6f0eaSFelix Fietkau own_query, src); 295808b202b6SYOSHIFUJI Hideaki } 295908b202b6SYOSHIFUJI Hideaki #endif 29608ef2a9a5SYOSHIFUJI Hideaki 29611080ab95SNikolay Aleksandrov static void br_multicast_err_count(const struct net_bridge *br, 29621080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 29631080ab95SNikolay Aleksandrov __be16 proto) 29641080ab95SNikolay Aleksandrov { 29651080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 29661080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats; 29671080ab95SNikolay Aleksandrov 2968675779adSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 29691080ab95SNikolay Aleksandrov return; 29701080ab95SNikolay Aleksandrov 29711080ab95SNikolay Aleksandrov if (p) 29721080ab95SNikolay Aleksandrov stats = p->mcast_stats; 29731080ab95SNikolay Aleksandrov else 29741080ab95SNikolay Aleksandrov stats = br->mcast_stats; 29751080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 29761080ab95SNikolay Aleksandrov return; 29771080ab95SNikolay Aleksandrov 29781080ab95SNikolay Aleksandrov pstats = this_cpu_ptr(stats); 29791080ab95SNikolay Aleksandrov 29801080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 29811080ab95SNikolay Aleksandrov switch (proto) { 29821080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 29831080ab95SNikolay Aleksandrov pstats->mstats.igmp_parse_errors++; 29841080ab95SNikolay Aleksandrov break; 29851080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 29861080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 29871080ab95SNikolay Aleksandrov pstats->mstats.mld_parse_errors++; 29881080ab95SNikolay Aleksandrov break; 29891080ab95SNikolay Aleksandrov #endif 29901080ab95SNikolay Aleksandrov } 29911080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 29921080ab95SNikolay Aleksandrov } 29931080ab95SNikolay Aleksandrov 299491b02d3dSNikolay Aleksandrov static void br_multicast_pim(struct net_bridge *br, 299591b02d3dSNikolay Aleksandrov struct net_bridge_port *port, 299691b02d3dSNikolay Aleksandrov const struct sk_buff *skb) 299791b02d3dSNikolay Aleksandrov { 299891b02d3dSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 299991b02d3dSNikolay Aleksandrov struct pimhdr *pimhdr, _pimhdr; 300091b02d3dSNikolay Aleksandrov 300191b02d3dSNikolay Aleksandrov pimhdr = skb_header_pointer(skb, offset, sizeof(_pimhdr), &_pimhdr); 300291b02d3dSNikolay Aleksandrov if (!pimhdr || pim_hdr_version(pimhdr) != PIM_VERSION || 300391b02d3dSNikolay Aleksandrov pim_hdr_type(pimhdr) != PIM_TYPE_HELLO) 300491b02d3dSNikolay Aleksandrov return; 300591b02d3dSNikolay Aleksandrov 300691b02d3dSNikolay Aleksandrov br_multicast_mark_router(br, port); 300791b02d3dSNikolay Aleksandrov } 300891b02d3dSNikolay Aleksandrov 30094b3087c7SLinus Lüssing static int br_ip4_multicast_mrd_rcv(struct net_bridge *br, 30104b3087c7SLinus Lüssing struct net_bridge_port *port, 30114b3087c7SLinus Lüssing struct sk_buff *skb) 30124b3087c7SLinus Lüssing { 30134b3087c7SLinus Lüssing if (ip_hdr(skb)->protocol != IPPROTO_IGMP || 30144b3087c7SLinus Lüssing igmp_hdr(skb)->type != IGMP_MRDISC_ADV) 30154b3087c7SLinus Lüssing return -ENOMSG; 30164b3087c7SLinus Lüssing 30174b3087c7SLinus Lüssing br_multicast_mark_router(br, port); 30184b3087c7SLinus Lüssing 30194b3087c7SLinus Lüssing return 0; 30204b3087c7SLinus Lüssing } 30214b3087c7SLinus Lüssing 3022eb1d1641SHerbert Xu static int br_multicast_ipv4_rcv(struct net_bridge *br, 3023eb1d1641SHerbert Xu struct net_bridge_port *port, 302406499098SVlad Yasevich struct sk_buff *skb, 302506499098SVlad Yasevich u16 vid) 3026eb1d1641SHerbert Xu { 30276db6f0eaSFelix Fietkau const unsigned char *src; 3028eb1d1641SHerbert Xu struct igmphdr *ih; 3029eb1d1641SHerbert Xu int err; 3030eb1d1641SHerbert Xu 3031ba5ea614SLinus Lüssing err = ip_mc_check_igmp(skb); 3032eb1d1641SHerbert Xu 30339afd85c9SLinus Lüssing if (err == -ENOMSG) { 303491b02d3dSNikolay Aleksandrov if (!ipv4_is_local_multicast(ip_hdr(skb)->daddr)) { 3035bd4265feSHerbert Xu BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 303691b02d3dSNikolay Aleksandrov } else if (pim_ipv4_all_pim_routers(ip_hdr(skb)->daddr)) { 303791b02d3dSNikolay Aleksandrov if (ip_hdr(skb)->protocol == IPPROTO_PIM) 303891b02d3dSNikolay Aleksandrov br_multicast_pim(br, port, skb); 30394b3087c7SLinus Lüssing } else if (ipv4_is_all_snoopers(ip_hdr(skb)->daddr)) { 304008e71623SLi RongQing br_ip4_multicast_mrd_rcv(br, port, skb); 30414b3087c7SLinus Lüssing } 30424b3087c7SLinus Lüssing 3043eb1d1641SHerbert Xu return 0; 30449afd85c9SLinus Lüssing } else if (err < 0) { 30451080ab95SNikolay Aleksandrov br_multicast_err_count(br, port, skb->protocol); 30469afd85c9SLinus Lüssing return err; 3047bd4265feSHerbert Xu } 3048eb1d1641SHerbert Xu 30499afd85c9SLinus Lüssing ih = igmp_hdr(skb); 30506db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 30511080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = ih->type; 3052eb1d1641SHerbert Xu 3053eb1d1641SHerbert Xu switch (ih->type) { 3054eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_REPORT: 3055eb1d1641SHerbert Xu case IGMPV2_HOST_MEMBERSHIP_REPORT: 305662b2bcb4SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 30578b671779SNikolay Aleksandrov err = br_ip4_multicast_add_group(br, port, ih->group, vid, src, 30588b671779SNikolay Aleksandrov true); 3059eb1d1641SHerbert Xu break; 3060eb1d1641SHerbert Xu case IGMPV3_HOST_MEMBERSHIP_REPORT: 3061ba5ea614SLinus Lüssing err = br_ip4_multicast_igmp3_report(br, port, skb, vid); 3062eb1d1641SHerbert Xu break; 3063eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_QUERY: 3064ba5ea614SLinus Lüssing br_ip4_multicast_query(br, port, skb, vid); 3065eb1d1641SHerbert Xu break; 3066eb1d1641SHerbert Xu case IGMP_HOST_LEAVE_MESSAGE: 30676db6f0eaSFelix Fietkau br_ip4_multicast_leave_group(br, port, ih->group, vid, src); 3068eb1d1641SHerbert Xu break; 3069eb1d1641SHerbert Xu } 3070eb1d1641SHerbert Xu 3071a65056ecSNikolay Aleksandrov br_multicast_count(br, port, skb, BR_INPUT_SKB_CB(skb)->igmp, 30721080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 30731080ab95SNikolay Aleksandrov 3074eb1d1641SHerbert Xu return err; 3075eb1d1641SHerbert Xu } 3076eb1d1641SHerbert Xu 3077dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 30784b3087c7SLinus Lüssing static int br_ip6_multicast_mrd_rcv(struct net_bridge *br, 30794b3087c7SLinus Lüssing struct net_bridge_port *port, 30804b3087c7SLinus Lüssing struct sk_buff *skb) 30814b3087c7SLinus Lüssing { 30824b3087c7SLinus Lüssing int ret; 30834b3087c7SLinus Lüssing 30844b3087c7SLinus Lüssing if (ipv6_hdr(skb)->nexthdr != IPPROTO_ICMPV6) 30854b3087c7SLinus Lüssing return -ENOMSG; 30864b3087c7SLinus Lüssing 30874b3087c7SLinus Lüssing ret = ipv6_mc_check_icmpv6(skb); 30884b3087c7SLinus Lüssing if (ret < 0) 30894b3087c7SLinus Lüssing return ret; 30904b3087c7SLinus Lüssing 30914b3087c7SLinus Lüssing if (icmp6_hdr(skb)->icmp6_type != ICMPV6_MRDISC_ADV) 30924b3087c7SLinus Lüssing return -ENOMSG; 30934b3087c7SLinus Lüssing 30944b3087c7SLinus Lüssing br_multicast_mark_router(br, port); 30954b3087c7SLinus Lüssing 30964b3087c7SLinus Lüssing return 0; 30974b3087c7SLinus Lüssing } 30984b3087c7SLinus Lüssing 309908b202b6SYOSHIFUJI Hideaki static int br_multicast_ipv6_rcv(struct net_bridge *br, 310008b202b6SYOSHIFUJI Hideaki struct net_bridge_port *port, 310106499098SVlad Yasevich struct sk_buff *skb, 310206499098SVlad Yasevich u16 vid) 310308b202b6SYOSHIFUJI Hideaki { 31046db6f0eaSFelix Fietkau const unsigned char *src; 31059afd85c9SLinus Lüssing struct mld_msg *mld; 310608b202b6SYOSHIFUJI Hideaki int err; 310708b202b6SYOSHIFUJI Hideaki 3108ba5ea614SLinus Lüssing err = ipv6_mc_check_mld(skb); 310908b202b6SYOSHIFUJI Hideaki 31109afd85c9SLinus Lüssing if (err == -ENOMSG) { 31119afd85c9SLinus Lüssing if (!ipv6_addr_is_ll_all_nodes(&ipv6_hdr(skb)->daddr)) 31128fad9c39SLinus Lüssing BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 31134b3087c7SLinus Lüssing 31144b3087c7SLinus Lüssing if (ipv6_addr_is_all_snoopers(&ipv6_hdr(skb)->daddr)) { 31154b3087c7SLinus Lüssing err = br_ip6_multicast_mrd_rcv(br, port, skb); 31164b3087c7SLinus Lüssing 31174b3087c7SLinus Lüssing if (err < 0 && err != -ENOMSG) { 31184b3087c7SLinus Lüssing br_multicast_err_count(br, port, skb->protocol); 31194b3087c7SLinus Lüssing return err; 31204b3087c7SLinus Lüssing } 31214b3087c7SLinus Lüssing } 31224b3087c7SLinus Lüssing 312308b202b6SYOSHIFUJI Hideaki return 0; 31249afd85c9SLinus Lüssing } else if (err < 0) { 31251080ab95SNikolay Aleksandrov br_multicast_err_count(br, port, skb->protocol); 31269afd85c9SLinus Lüssing return err; 312708b202b6SYOSHIFUJI Hideaki } 312808b202b6SYOSHIFUJI Hideaki 31299afd85c9SLinus Lüssing mld = (struct mld_msg *)skb_transport_header(skb); 31301080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = mld->mld_type; 313108b202b6SYOSHIFUJI Hideaki 31329afd85c9SLinus Lüssing switch (mld->mld_type) { 313308b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REPORT: 31346db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 3135fc2af6c7SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 31366db6f0eaSFelix Fietkau err = br_ip6_multicast_add_group(br, port, &mld->mld_mca, vid, 31378b671779SNikolay Aleksandrov src, true); 313808b202b6SYOSHIFUJI Hideaki break; 313908b202b6SYOSHIFUJI Hideaki case ICMPV6_MLD2_REPORT: 3140ba5ea614SLinus Lüssing err = br_ip6_multicast_mld2_report(br, port, skb, vid); 314108b202b6SYOSHIFUJI Hideaki break; 314208b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_QUERY: 3143ba5ea614SLinus Lüssing err = br_ip6_multicast_query(br, port, skb, vid); 314408b202b6SYOSHIFUJI Hideaki break; 314508b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REDUCTION: 31466db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 31476db6f0eaSFelix Fietkau br_ip6_multicast_leave_group(br, port, &mld->mld_mca, vid, src); 31489afd85c9SLinus Lüssing break; 314908b202b6SYOSHIFUJI Hideaki } 315008b202b6SYOSHIFUJI Hideaki 3151a65056ecSNikolay Aleksandrov br_multicast_count(br, port, skb, BR_INPUT_SKB_CB(skb)->igmp, 31521080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 31531080ab95SNikolay Aleksandrov 315408b202b6SYOSHIFUJI Hideaki return err; 315508b202b6SYOSHIFUJI Hideaki } 315608b202b6SYOSHIFUJI Hideaki #endif 315708b202b6SYOSHIFUJI Hideaki 3158eb1d1641SHerbert Xu int br_multicast_rcv(struct net_bridge *br, struct net_bridge_port *port, 315906499098SVlad Yasevich struct sk_buff *skb, u16 vid) 3160eb1d1641SHerbert Xu { 31611080ab95SNikolay Aleksandrov int ret = 0; 31621080ab95SNikolay Aleksandrov 31631fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->igmp = 0; 31641fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->mrouters_only = 0; 31651fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 316613cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) 3167eb1d1641SHerbert Xu return 0; 3168eb1d1641SHerbert Xu 3169eb1d1641SHerbert Xu switch (skb->protocol) { 3170eb1d1641SHerbert Xu case htons(ETH_P_IP): 31711080ab95SNikolay Aleksandrov ret = br_multicast_ipv4_rcv(br, port, skb, vid); 31721080ab95SNikolay Aleksandrov break; 3173dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 317408b202b6SYOSHIFUJI Hideaki case htons(ETH_P_IPV6): 31751080ab95SNikolay Aleksandrov ret = br_multicast_ipv6_rcv(br, port, skb, vid); 31761080ab95SNikolay Aleksandrov break; 317708b202b6SYOSHIFUJI Hideaki #endif 3178eb1d1641SHerbert Xu } 3179eb1d1641SHerbert Xu 31801080ab95SNikolay Aleksandrov return ret; 3181eb1d1641SHerbert Xu } 3182eb1d1641SHerbert Xu 3183cc0fdd80SLinus Lüssing static void br_multicast_query_expired(struct net_bridge *br, 31842cd41431SLinus Lüssing struct bridge_mcast_own_query *query, 31852cd41431SLinus Lüssing struct bridge_mcast_querier *querier) 3186cc0fdd80SLinus Lüssing { 3187cc0fdd80SLinus Lüssing spin_lock(&br->multicast_lock); 3188cc0fdd80SLinus Lüssing if (query->startup_sent < br->multicast_startup_query_count) 3189cc0fdd80SLinus Lüssing query->startup_sent++; 3190cc0fdd80SLinus Lüssing 319171d9f614SEric Dumazet RCU_INIT_POINTER(querier->port, NULL); 3192cc0fdd80SLinus Lüssing br_multicast_send_query(br, NULL, query); 3193cc0fdd80SLinus Lüssing spin_unlock(&br->multicast_lock); 3194cc0fdd80SLinus Lüssing } 3195cc0fdd80SLinus Lüssing 319688c1f37fSAllen Pais static void br_ip4_multicast_query_expired(struct timer_list *t) 3197eb1d1641SHerbert Xu { 319888c1f37fSAllen Pais struct net_bridge *br = from_timer(br, t, ip4_own_query.timer); 3199eb1d1641SHerbert Xu 32002cd41431SLinus Lüssing br_multicast_query_expired(br, &br->ip4_own_query, &br->ip4_querier); 3201eb1d1641SHerbert Xu } 3202eb1d1641SHerbert Xu 3203cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 320488c1f37fSAllen Pais static void br_ip6_multicast_query_expired(struct timer_list *t) 3205cc0fdd80SLinus Lüssing { 320688c1f37fSAllen Pais struct net_bridge *br = from_timer(br, t, ip6_own_query.timer); 3207cc0fdd80SLinus Lüssing 32082cd41431SLinus Lüssing br_multicast_query_expired(br, &br->ip6_own_query, &br->ip6_querier); 3209cc0fdd80SLinus Lüssing } 3210cc0fdd80SLinus Lüssing #endif 3211cc0fdd80SLinus Lüssing 3212e12cec65SNikolay Aleksandrov static void br_multicast_gc_work(struct work_struct *work) 32138b671779SNikolay Aleksandrov { 32148b671779SNikolay Aleksandrov struct net_bridge *br = container_of(work, struct net_bridge, 3215e12cec65SNikolay Aleksandrov mcast_gc_work); 32168b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 32178b671779SNikolay Aleksandrov 32188b671779SNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 3219e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 32208b671779SNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 32218b671779SNikolay Aleksandrov 3222e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 32238b671779SNikolay Aleksandrov } 32248b671779SNikolay Aleksandrov 3225eb1d1641SHerbert Xu void br_multicast_init(struct net_bridge *br) 3226eb1d1641SHerbert Xu { 3227d08c6bc0SNikolay Aleksandrov br->hash_max = BR_MULTICAST_DEFAULT_HASH_MAX; 3228eb1d1641SHerbert Xu 32297f0aec7aSNikolay Aleksandrov br->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 3230eb1d1641SHerbert Xu br->multicast_last_member_count = 2; 3231eb1d1641SHerbert Xu br->multicast_startup_query_count = 2; 3232eb1d1641SHerbert Xu 3233eb1d1641SHerbert Xu br->multicast_last_member_interval = HZ; 3234eb1d1641SHerbert Xu br->multicast_query_response_interval = 10 * HZ; 3235eb1d1641SHerbert Xu br->multicast_startup_query_interval = 125 * HZ / 4; 3236eb1d1641SHerbert Xu br->multicast_query_interval = 125 * HZ; 3237eb1d1641SHerbert Xu br->multicast_querier_interval = 255 * HZ; 3238eb1d1641SHerbert Xu br->multicast_membership_interval = 260 * HZ; 3239eb1d1641SHerbert Xu 324090010b36SLinus Lüssing br->ip4_other_query.delay_time = 0; 32412cd41431SLinus Lüssing br->ip4_querier.port = NULL; 3242aa2ae3e7SNikolay Aleksandrov br->multicast_igmp_version = 2; 3243cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3244aa2ae3e7SNikolay Aleksandrov br->multicast_mld_version = 1; 324590010b36SLinus Lüssing br->ip6_other_query.delay_time = 0; 32462cd41431SLinus Lüssing br->ip6_querier.port = NULL; 3247cc0fdd80SLinus Lüssing #endif 32486919622aSIdo Schimmel br_opt_toggle(br, BROPT_MULTICAST_ENABLED, true); 3249675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_HAS_IPV6_ADDR, true); 3250b00589afSLinus Lüssing 3251eb1d1641SHerbert Xu spin_lock_init(&br->multicast_lock); 325288c1f37fSAllen Pais timer_setup(&br->multicast_router_timer, 325388c1f37fSAllen Pais br_multicast_local_router_expired, 0); 325488c1f37fSAllen Pais timer_setup(&br->ip4_other_query.timer, 325588c1f37fSAllen Pais br_ip4_multicast_querier_expired, 0); 325688c1f37fSAllen Pais timer_setup(&br->ip4_own_query.timer, 325788c1f37fSAllen Pais br_ip4_multicast_query_expired, 0); 3258cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 325988c1f37fSAllen Pais timer_setup(&br->ip6_other_query.timer, 326088c1f37fSAllen Pais br_ip6_multicast_querier_expired, 0); 326188c1f37fSAllen Pais timer_setup(&br->ip6_own_query.timer, 326288c1f37fSAllen Pais br_ip6_multicast_query_expired, 0); 3263cc0fdd80SLinus Lüssing #endif 326419e3a9c9SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mdb_list); 3265e12cec65SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mcast_gc_list); 3266e12cec65SNikolay Aleksandrov INIT_WORK(&br->mcast_gc_work, br_multicast_gc_work); 3267eb1d1641SHerbert Xu } 3268eb1d1641SHerbert Xu 32694effd28cSLinus Lüssing static void br_ip4_multicast_join_snoopers(struct net_bridge *br) 32704effd28cSLinus Lüssing { 32714effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 32724effd28cSLinus Lüssing 32734effd28cSLinus Lüssing if (!in_dev) 32744effd28cSLinus Lüssing return; 32754effd28cSLinus Lüssing 32769fb20801SFlorian Fainelli __ip_mc_inc_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 32774effd28cSLinus Lüssing in_dev_put(in_dev); 32784effd28cSLinus Lüssing } 32794effd28cSLinus Lüssing 32804effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 32814effd28cSLinus Lüssing static void br_ip6_multicast_join_snoopers(struct net_bridge *br) 32824effd28cSLinus Lüssing { 32834effd28cSLinus Lüssing struct in6_addr addr; 32844effd28cSLinus Lüssing 32854effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 32864effd28cSLinus Lüssing ipv6_dev_mc_inc(br->dev, &addr); 32874effd28cSLinus Lüssing } 32884effd28cSLinus Lüssing #else 32894effd28cSLinus Lüssing static inline void br_ip6_multicast_join_snoopers(struct net_bridge *br) 32904effd28cSLinus Lüssing { 32914effd28cSLinus Lüssing } 32924effd28cSLinus Lüssing #endif 32934effd28cSLinus Lüssing 3294851d0a73SJoseph Huang void br_multicast_join_snoopers(struct net_bridge *br) 32954effd28cSLinus Lüssing { 32964effd28cSLinus Lüssing br_ip4_multicast_join_snoopers(br); 32974effd28cSLinus Lüssing br_ip6_multicast_join_snoopers(br); 32984effd28cSLinus Lüssing } 32994effd28cSLinus Lüssing 33004effd28cSLinus Lüssing static void br_ip4_multicast_leave_snoopers(struct net_bridge *br) 33014effd28cSLinus Lüssing { 33024effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 33034effd28cSLinus Lüssing 33044effd28cSLinus Lüssing if (WARN_ON(!in_dev)) 33054effd28cSLinus Lüssing return; 33064effd28cSLinus Lüssing 33079fb20801SFlorian Fainelli __ip_mc_dec_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 33084effd28cSLinus Lüssing in_dev_put(in_dev); 33094effd28cSLinus Lüssing } 33104effd28cSLinus Lüssing 33114effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 33124effd28cSLinus Lüssing static void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 33134effd28cSLinus Lüssing { 33144effd28cSLinus Lüssing struct in6_addr addr; 33154effd28cSLinus Lüssing 33164effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 33174effd28cSLinus Lüssing ipv6_dev_mc_dec(br->dev, &addr); 33184effd28cSLinus Lüssing } 33194effd28cSLinus Lüssing #else 33204effd28cSLinus Lüssing static inline void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 33214effd28cSLinus Lüssing { 33224effd28cSLinus Lüssing } 33234effd28cSLinus Lüssing #endif 33244effd28cSLinus Lüssing 3325851d0a73SJoseph Huang void br_multicast_leave_snoopers(struct net_bridge *br) 33264effd28cSLinus Lüssing { 33274effd28cSLinus Lüssing br_ip4_multicast_leave_snoopers(br); 33284effd28cSLinus Lüssing br_ip6_multicast_leave_snoopers(br); 33294effd28cSLinus Lüssing } 33304effd28cSLinus Lüssing 3331cc0fdd80SLinus Lüssing static void __br_multicast_open(struct net_bridge *br, 333290010b36SLinus Lüssing struct bridge_mcast_own_query *query) 3333eb1d1641SHerbert Xu { 3334cc0fdd80SLinus Lüssing query->startup_sent = 0; 3335eb1d1641SHerbert Xu 333613cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) 3337eb1d1641SHerbert Xu return; 3338eb1d1641SHerbert Xu 3339cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 3340cc0fdd80SLinus Lüssing } 3341cc0fdd80SLinus Lüssing 3342cc0fdd80SLinus Lüssing void br_multicast_open(struct net_bridge *br) 3343cc0fdd80SLinus Lüssing { 334490010b36SLinus Lüssing __br_multicast_open(br, &br->ip4_own_query); 3345cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 334690010b36SLinus Lüssing __br_multicast_open(br, &br->ip6_own_query); 3347cc0fdd80SLinus Lüssing #endif 3348eb1d1641SHerbert Xu } 3349eb1d1641SHerbert Xu 3350eb1d1641SHerbert Xu void br_multicast_stop(struct net_bridge *br) 3351eb1d1641SHerbert Xu { 3352eb1d1641SHerbert Xu del_timer_sync(&br->multicast_router_timer); 335390010b36SLinus Lüssing del_timer_sync(&br->ip4_other_query.timer); 335490010b36SLinus Lüssing del_timer_sync(&br->ip4_own_query.timer); 3355cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 335690010b36SLinus Lüssing del_timer_sync(&br->ip6_other_query.timer); 335790010b36SLinus Lüssing del_timer_sync(&br->ip6_own_query.timer); 3358cc0fdd80SLinus Lüssing #endif 3359e10177abSSatish Ashok } 3360e10177abSSatish Ashok 3361e10177abSSatish Ashok void br_multicast_dev_del(struct net_bridge *br) 3362e10177abSSatish Ashok { 3363e10177abSSatish Ashok struct net_bridge_mdb_entry *mp; 33648b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 336519e3a9c9SNikolay Aleksandrov struct hlist_node *tmp; 3366eb1d1641SHerbert Xu 3367eb1d1641SHerbert Xu spin_lock_bh(&br->multicast_lock); 3368e12cec65SNikolay Aleksandrov hlist_for_each_entry_safe(mp, tmp, &br->mdb_list, mdb_node) 3369e12cec65SNikolay Aleksandrov br_multicast_del_mdb_entry(mp); 3370e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 3371eb1d1641SHerbert Xu spin_unlock_bh(&br->multicast_lock); 337219e3a9c9SNikolay Aleksandrov 3373e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 3374e12cec65SNikolay Aleksandrov cancel_work_sync(&br->mcast_gc_work); 33758b671779SNikolay Aleksandrov 33764329596cSNikolay Aleksandrov rcu_barrier(); 3377eb1d1641SHerbert Xu } 33780909e117SHerbert Xu 33790909e117SHerbert Xu int br_multicast_set_router(struct net_bridge *br, unsigned long val) 33800909e117SHerbert Xu { 33816ae4ae8eSLinus Lüssing int err = -EINVAL; 33820909e117SHerbert Xu 33830909e117SHerbert Xu spin_lock_bh(&br->multicast_lock); 33840909e117SHerbert Xu 33850909e117SHerbert Xu switch (val) { 33867f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 33877f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 338877041420SYotam Gigi br_mc_router_state_change(br, val == MDB_RTR_TYPE_PERM); 33890909e117SHerbert Xu del_timer(&br->multicast_router_timer); 339077041420SYotam Gigi br->multicast_router = val; 339177041420SYotam Gigi err = 0; 339277041420SYotam Gigi break; 33937f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 339477041420SYotam Gigi if (br->multicast_router != MDB_RTR_TYPE_TEMP_QUERY) 339577041420SYotam Gigi br_mc_router_state_change(br, false); 33960909e117SHerbert Xu br->multicast_router = val; 33970909e117SHerbert Xu err = 0; 33980909e117SHerbert Xu break; 33990909e117SHerbert Xu } 34000909e117SHerbert Xu 34010909e117SHerbert Xu spin_unlock_bh(&br->multicast_lock); 34020909e117SHerbert Xu 34030909e117SHerbert Xu return err; 34040909e117SHerbert Xu } 34050909e117SHerbert Xu 34067f0aec7aSNikolay Aleksandrov static void __del_port_router(struct net_bridge_port *p) 34077f0aec7aSNikolay Aleksandrov { 34087f0aec7aSNikolay Aleksandrov if (hlist_unhashed(&p->rlist)) 34097f0aec7aSNikolay Aleksandrov return; 34107f0aec7aSNikolay Aleksandrov hlist_del_init_rcu(&p->rlist); 34117f0aec7aSNikolay Aleksandrov br_rtr_notify(p->br->dev, p, RTM_DELMDB); 34126d549648SNogah Frankel br_port_mc_router_state_change(p, false); 3413f12e7d95SNogah Frankel 3414f12e7d95SNogah Frankel /* don't allow timer refresh */ 3415f12e7d95SNogah Frankel if (p->multicast_router == MDB_RTR_TYPE_TEMP) 3416f12e7d95SNogah Frankel p->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 34177f0aec7aSNikolay Aleksandrov } 34187f0aec7aSNikolay Aleksandrov 34190909e117SHerbert Xu int br_multicast_set_port_router(struct net_bridge_port *p, unsigned long val) 34200909e117SHerbert Xu { 34210909e117SHerbert Xu struct net_bridge *br = p->br; 3422a55d8246SNikolay Aleksandrov unsigned long now = jiffies; 34236ae4ae8eSLinus Lüssing int err = -EINVAL; 34240909e117SHerbert Xu 34250909e117SHerbert Xu spin_lock(&br->multicast_lock); 34264950cfd1SNikolay Aleksandrov if (p->multicast_router == val) { 3427a55d8246SNikolay Aleksandrov /* Refresh the temp router port timer */ 3428a55d8246SNikolay Aleksandrov if (p->multicast_router == MDB_RTR_TYPE_TEMP) 3429a55d8246SNikolay Aleksandrov mod_timer(&p->multicast_router_timer, 3430a55d8246SNikolay Aleksandrov now + br->multicast_querier_interval); 34314950cfd1SNikolay Aleksandrov err = 0; 34324950cfd1SNikolay Aleksandrov goto unlock; 34334950cfd1SNikolay Aleksandrov } 34340909e117SHerbert Xu switch (val) { 34357f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 34367f0aec7aSNikolay Aleksandrov p->multicast_router = MDB_RTR_TYPE_DISABLED; 34377f0aec7aSNikolay Aleksandrov __del_port_router(p); 34380909e117SHerbert Xu del_timer(&p->multicast_router_timer); 34390909e117SHerbert Xu break; 34407f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 34417f0aec7aSNikolay Aleksandrov p->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 34427f0aec7aSNikolay Aleksandrov __del_port_router(p); 34437f0aec7aSNikolay Aleksandrov break; 34447f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 34457f0aec7aSNikolay Aleksandrov p->multicast_router = MDB_RTR_TYPE_PERM; 34467f0aec7aSNikolay Aleksandrov del_timer(&p->multicast_router_timer); 34470909e117SHerbert Xu br_multicast_add_router(br, p); 34480909e117SHerbert Xu break; 3449a55d8246SNikolay Aleksandrov case MDB_RTR_TYPE_TEMP: 3450a55d8246SNikolay Aleksandrov p->multicast_router = MDB_RTR_TYPE_TEMP; 3451a55d8246SNikolay Aleksandrov br_multicast_mark_router(br, p); 3452a55d8246SNikolay Aleksandrov break; 34537f0aec7aSNikolay Aleksandrov default: 34547f0aec7aSNikolay Aleksandrov goto unlock; 34550909e117SHerbert Xu } 34567f0aec7aSNikolay Aleksandrov err = 0; 34577f0aec7aSNikolay Aleksandrov unlock: 34580909e117SHerbert Xu spin_unlock(&br->multicast_lock); 34590909e117SHerbert Xu 34600909e117SHerbert Xu return err; 34610909e117SHerbert Xu } 3462561f1103SHerbert Xu 3463cc0fdd80SLinus Lüssing static void br_multicast_start_querier(struct net_bridge *br, 346490010b36SLinus Lüssing struct bridge_mcast_own_query *query) 3465561f1103SHerbert Xu { 3466561f1103SHerbert Xu struct net_bridge_port *port; 346774857216SHerbert Xu 3468cc0fdd80SLinus Lüssing __br_multicast_open(br, query); 346974857216SHerbert Xu 3470c5b493ceSNikolay Aleksandrov rcu_read_lock(); 3471c5b493ceSNikolay Aleksandrov list_for_each_entry_rcu(port, &br->port_list, list) { 347274857216SHerbert Xu if (port->state == BR_STATE_DISABLED || 347374857216SHerbert Xu port->state == BR_STATE_BLOCKING) 347474857216SHerbert Xu continue; 347574857216SHerbert Xu 347690010b36SLinus Lüssing if (query == &br->ip4_own_query) 347790010b36SLinus Lüssing br_multicast_enable(&port->ip4_own_query); 3478cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3479cc0fdd80SLinus Lüssing else 348090010b36SLinus Lüssing br_multicast_enable(&port->ip6_own_query); 3481cc0fdd80SLinus Lüssing #endif 348274857216SHerbert Xu } 3483c5b493ceSNikolay Aleksandrov rcu_read_unlock(); 348474857216SHerbert Xu } 348574857216SHerbert Xu 348674857216SHerbert Xu int br_multicast_toggle(struct net_bridge *br, unsigned long val) 348774857216SHerbert Xu { 34887cb3f921SNikolay Aleksandrov struct net_bridge_port *port; 3489851d0a73SJoseph Huang bool change_snoopers = false; 3490561f1103SHerbert Xu 3491ef5e0d82SAndrey Vagin spin_lock_bh(&br->multicast_lock); 349213cefad2SNikolay Aleksandrov if (!!br_opt_get(br, BROPT_MULTICAST_ENABLED) == !!val) 3493561f1103SHerbert Xu goto unlock; 3494561f1103SHerbert Xu 349513cefad2SNikolay Aleksandrov br_mc_disabled_update(br->dev, val); 349613cefad2SNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_ENABLED, !!val); 34974effd28cSLinus Lüssing if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) { 3498851d0a73SJoseph Huang change_snoopers = true; 3499561f1103SHerbert Xu goto unlock; 35004effd28cSLinus Lüssing } 3501561f1103SHerbert Xu 35023a7fda06SHerbert Xu if (!netif_running(br->dev)) 35033a7fda06SHerbert Xu goto unlock; 35043a7fda06SHerbert Xu 35057cb3f921SNikolay Aleksandrov br_multicast_open(br); 35067cb3f921SNikolay Aleksandrov list_for_each_entry(port, &br->port_list, list) 35077cb3f921SNikolay Aleksandrov __br_multicast_enable_port(port); 3508561f1103SHerbert Xu 3509851d0a73SJoseph Huang change_snoopers = true; 3510851d0a73SJoseph Huang 3511561f1103SHerbert Xu unlock: 3512ef5e0d82SAndrey Vagin spin_unlock_bh(&br->multicast_lock); 3513561f1103SHerbert Xu 3514851d0a73SJoseph Huang /* br_multicast_join_snoopers has the potential to cause 3515851d0a73SJoseph Huang * an MLD Report/Leave to be delivered to br_multicast_rcv, 3516851d0a73SJoseph Huang * which would in turn call br_multicast_add_group, which would 3517851d0a73SJoseph Huang * attempt to acquire multicast_lock. This function should be 3518851d0a73SJoseph Huang * called after the lock has been released to avoid deadlocks on 3519851d0a73SJoseph Huang * multicast_lock. 3520851d0a73SJoseph Huang * 3521851d0a73SJoseph Huang * br_multicast_leave_snoopers does not have the problem since 3522851d0a73SJoseph Huang * br_multicast_rcv first checks BROPT_MULTICAST_ENABLED, and 3523851d0a73SJoseph Huang * returns without calling br_multicast_ipv4/6_rcv if it's not 3524851d0a73SJoseph Huang * enabled. Moved both functions out just for symmetry. 3525851d0a73SJoseph Huang */ 3526851d0a73SJoseph Huang if (change_snoopers) { 3527851d0a73SJoseph Huang if (br_opt_get(br, BROPT_MULTICAST_ENABLED)) 3528851d0a73SJoseph Huang br_multicast_join_snoopers(br); 3529851d0a73SJoseph Huang else 3530851d0a73SJoseph Huang br_multicast_leave_snoopers(br); 3531851d0a73SJoseph Huang } 3532851d0a73SJoseph Huang 3533a26d94bfSYueHaibing return 0; 3534561f1103SHerbert Xu } 3535b195167fSHerbert Xu 35369341b988SIdo Schimmel bool br_multicast_enabled(const struct net_device *dev) 35379341b988SIdo Schimmel { 35389341b988SIdo Schimmel struct net_bridge *br = netdev_priv(dev); 35399341b988SIdo Schimmel 354013cefad2SNikolay Aleksandrov return !!br_opt_get(br, BROPT_MULTICAST_ENABLED); 35419341b988SIdo Schimmel } 35429341b988SIdo Schimmel EXPORT_SYMBOL_GPL(br_multicast_enabled); 35439341b988SIdo Schimmel 35440912bda4SYotam Gigi bool br_multicast_router(const struct net_device *dev) 35450912bda4SYotam Gigi { 35460912bda4SYotam Gigi struct net_bridge *br = netdev_priv(dev); 35470912bda4SYotam Gigi bool is_router; 35480912bda4SYotam Gigi 35490912bda4SYotam Gigi spin_lock_bh(&br->multicast_lock); 35500912bda4SYotam Gigi is_router = br_multicast_is_router(br); 35510912bda4SYotam Gigi spin_unlock_bh(&br->multicast_lock); 35520912bda4SYotam Gigi return is_router; 35530912bda4SYotam Gigi } 35540912bda4SYotam Gigi EXPORT_SYMBOL_GPL(br_multicast_router); 35550912bda4SYotam Gigi 3556c5c23260SHerbert Xu int br_multicast_set_querier(struct net_bridge *br, unsigned long val) 3557c5c23260SHerbert Xu { 3558b00589afSLinus Lüssing unsigned long max_delay; 3559b00589afSLinus Lüssing 3560c5c23260SHerbert Xu val = !!val; 3561c5c23260SHerbert Xu 3562c5c23260SHerbert Xu spin_lock_bh(&br->multicast_lock); 3563675779adSNikolay Aleksandrov if (br_opt_get(br, BROPT_MULTICAST_QUERIER) == val) 3564c5c23260SHerbert Xu goto unlock; 3565c5c23260SHerbert Xu 3566675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_QUERIER, !!val); 3567b00589afSLinus Lüssing if (!val) 3568b00589afSLinus Lüssing goto unlock; 3569b00589afSLinus Lüssing 3570b00589afSLinus Lüssing max_delay = br->multicast_query_response_interval; 3571b00589afSLinus Lüssing 357290010b36SLinus Lüssing if (!timer_pending(&br->ip4_other_query.timer)) 357390010b36SLinus Lüssing br->ip4_other_query.delay_time = jiffies + max_delay; 3574cc0fdd80SLinus Lüssing 357590010b36SLinus Lüssing br_multicast_start_querier(br, &br->ip4_own_query); 3576cc0fdd80SLinus Lüssing 3577cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 357890010b36SLinus Lüssing if (!timer_pending(&br->ip6_other_query.timer)) 357990010b36SLinus Lüssing br->ip6_other_query.delay_time = jiffies + max_delay; 3580cc0fdd80SLinus Lüssing 358190010b36SLinus Lüssing br_multicast_start_querier(br, &br->ip6_own_query); 3582cc0fdd80SLinus Lüssing #endif 3583c5c23260SHerbert Xu 3584c5c23260SHerbert Xu unlock: 3585c5c23260SHerbert Xu spin_unlock_bh(&br->multicast_lock); 3586c5c23260SHerbert Xu 3587c5c23260SHerbert Xu return 0; 3588c5c23260SHerbert Xu } 3589c5c23260SHerbert Xu 35905e923585SNikolay Aleksandrov int br_multicast_set_igmp_version(struct net_bridge *br, unsigned long val) 35915e923585SNikolay Aleksandrov { 35925e923585SNikolay Aleksandrov /* Currently we support only version 2 and 3 */ 35935e923585SNikolay Aleksandrov switch (val) { 35945e923585SNikolay Aleksandrov case 2: 35955e923585SNikolay Aleksandrov case 3: 35965e923585SNikolay Aleksandrov break; 35975e923585SNikolay Aleksandrov default: 35985e923585SNikolay Aleksandrov return -EINVAL; 35995e923585SNikolay Aleksandrov } 36005e923585SNikolay Aleksandrov 36015e923585SNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 36025e923585SNikolay Aleksandrov br->multicast_igmp_version = val; 36035e923585SNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 36045e923585SNikolay Aleksandrov 36055e923585SNikolay Aleksandrov return 0; 36065e923585SNikolay Aleksandrov } 36075e923585SNikolay Aleksandrov 3608aa2ae3e7SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 3609aa2ae3e7SNikolay Aleksandrov int br_multicast_set_mld_version(struct net_bridge *br, unsigned long val) 3610aa2ae3e7SNikolay Aleksandrov { 3611aa2ae3e7SNikolay Aleksandrov /* Currently we support version 1 and 2 */ 3612aa2ae3e7SNikolay Aleksandrov switch (val) { 3613aa2ae3e7SNikolay Aleksandrov case 1: 3614aa2ae3e7SNikolay Aleksandrov case 2: 3615aa2ae3e7SNikolay Aleksandrov break; 3616aa2ae3e7SNikolay Aleksandrov default: 3617aa2ae3e7SNikolay Aleksandrov return -EINVAL; 3618aa2ae3e7SNikolay Aleksandrov } 3619aa2ae3e7SNikolay Aleksandrov 3620aa2ae3e7SNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 3621aa2ae3e7SNikolay Aleksandrov br->multicast_mld_version = val; 3622aa2ae3e7SNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 3623aa2ae3e7SNikolay Aleksandrov 3624aa2ae3e7SNikolay Aleksandrov return 0; 3625aa2ae3e7SNikolay Aleksandrov } 3626aa2ae3e7SNikolay Aleksandrov #endif 3627aa2ae3e7SNikolay Aleksandrov 362807f8ac4aSLinus Lüssing /** 362907f8ac4aSLinus Lüssing * br_multicast_list_adjacent - Returns snooped multicast addresses 363007f8ac4aSLinus Lüssing * @dev: The bridge port adjacent to which to retrieve addresses 363107f8ac4aSLinus Lüssing * @br_ip_list: The list to store found, snooped multicast IP addresses in 363207f8ac4aSLinus Lüssing * 363307f8ac4aSLinus Lüssing * Creates a list of IP addresses (struct br_ip_list) sensed by the multicast 363407f8ac4aSLinus Lüssing * snooping feature on all bridge ports of dev's bridge device, excluding 363507f8ac4aSLinus Lüssing * the addresses from dev itself. 363607f8ac4aSLinus Lüssing * 363707f8ac4aSLinus Lüssing * Returns the number of items added to br_ip_list. 363807f8ac4aSLinus Lüssing * 363907f8ac4aSLinus Lüssing * Notes: 364007f8ac4aSLinus Lüssing * - br_ip_list needs to be initialized by caller 364107f8ac4aSLinus Lüssing * - br_ip_list might contain duplicates in the end 364207f8ac4aSLinus Lüssing * (needs to be taken care of by caller) 364307f8ac4aSLinus Lüssing * - br_ip_list needs to be freed by caller 364407f8ac4aSLinus Lüssing */ 364507f8ac4aSLinus Lüssing int br_multicast_list_adjacent(struct net_device *dev, 364607f8ac4aSLinus Lüssing struct list_head *br_ip_list) 364707f8ac4aSLinus Lüssing { 364807f8ac4aSLinus Lüssing struct net_bridge *br; 364907f8ac4aSLinus Lüssing struct net_bridge_port *port; 365007f8ac4aSLinus Lüssing struct net_bridge_port_group *group; 365107f8ac4aSLinus Lüssing struct br_ip_list *entry; 365207f8ac4aSLinus Lüssing int count = 0; 365307f8ac4aSLinus Lüssing 365407f8ac4aSLinus Lüssing rcu_read_lock(); 365535f861e3SJulian Wiedmann if (!br_ip_list || !netif_is_bridge_port(dev)) 365607f8ac4aSLinus Lüssing goto unlock; 365707f8ac4aSLinus Lüssing 365807f8ac4aSLinus Lüssing port = br_port_get_rcu(dev); 365907f8ac4aSLinus Lüssing if (!port || !port->br) 366007f8ac4aSLinus Lüssing goto unlock; 366107f8ac4aSLinus Lüssing 366207f8ac4aSLinus Lüssing br = port->br; 366307f8ac4aSLinus Lüssing 366407f8ac4aSLinus Lüssing list_for_each_entry_rcu(port, &br->port_list, list) { 366507f8ac4aSLinus Lüssing if (!port->dev || port->dev == dev) 366607f8ac4aSLinus Lüssing continue; 366707f8ac4aSLinus Lüssing 366807f8ac4aSLinus Lüssing hlist_for_each_entry_rcu(group, &port->mglist, mglist) { 366907f8ac4aSLinus Lüssing entry = kmalloc(sizeof(*entry), GFP_ATOMIC); 367007f8ac4aSLinus Lüssing if (!entry) 367107f8ac4aSLinus Lüssing goto unlock; 367207f8ac4aSLinus Lüssing 3673085b53c8SNikolay Aleksandrov entry->addr = group->key.addr; 367407f8ac4aSLinus Lüssing list_add(&entry->list, br_ip_list); 367507f8ac4aSLinus Lüssing count++; 367607f8ac4aSLinus Lüssing } 367707f8ac4aSLinus Lüssing } 367807f8ac4aSLinus Lüssing 367907f8ac4aSLinus Lüssing unlock: 368007f8ac4aSLinus Lüssing rcu_read_unlock(); 368107f8ac4aSLinus Lüssing return count; 368207f8ac4aSLinus Lüssing } 368307f8ac4aSLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_list_adjacent); 36842cd41431SLinus Lüssing 36852cd41431SLinus Lüssing /** 3686c34963e2SLinus Lüssing * br_multicast_has_querier_anywhere - Checks for a querier on a bridge 3687c34963e2SLinus Lüssing * @dev: The bridge port providing the bridge on which to check for a querier 3688c34963e2SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 3689c34963e2SLinus Lüssing * 3690c34963e2SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 3691c34963e2SLinus Lüssing * true if a valid querier exists anywhere on the bridged link layer. 3692c34963e2SLinus Lüssing * Otherwise returns false. 3693c34963e2SLinus Lüssing */ 3694c34963e2SLinus Lüssing bool br_multicast_has_querier_anywhere(struct net_device *dev, int proto) 3695c34963e2SLinus Lüssing { 3696c34963e2SLinus Lüssing struct net_bridge *br; 3697c34963e2SLinus Lüssing struct net_bridge_port *port; 3698c34963e2SLinus Lüssing struct ethhdr eth; 3699c34963e2SLinus Lüssing bool ret = false; 3700c34963e2SLinus Lüssing 3701c34963e2SLinus Lüssing rcu_read_lock(); 370235f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 3703c34963e2SLinus Lüssing goto unlock; 3704c34963e2SLinus Lüssing 3705c34963e2SLinus Lüssing port = br_port_get_rcu(dev); 3706c34963e2SLinus Lüssing if (!port || !port->br) 3707c34963e2SLinus Lüssing goto unlock; 3708c34963e2SLinus Lüssing 3709c34963e2SLinus Lüssing br = port->br; 3710c34963e2SLinus Lüssing 3711c34963e2SLinus Lüssing memset(ð, 0, sizeof(eth)); 3712c34963e2SLinus Lüssing eth.h_proto = htons(proto); 3713c34963e2SLinus Lüssing 3714955062b0SNikolay Aleksandrov ret = br_multicast_querier_exists(br, ð, NULL); 3715c34963e2SLinus Lüssing 3716c34963e2SLinus Lüssing unlock: 3717c34963e2SLinus Lüssing rcu_read_unlock(); 3718c34963e2SLinus Lüssing return ret; 3719c34963e2SLinus Lüssing } 3720c34963e2SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_anywhere); 3721c34963e2SLinus Lüssing 3722c34963e2SLinus Lüssing /** 37232cd41431SLinus Lüssing * br_multicast_has_querier_adjacent - Checks for a querier behind a bridge port 37242cd41431SLinus Lüssing * @dev: The bridge port adjacent to which to check for a querier 37252cd41431SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 37262cd41431SLinus Lüssing * 37272cd41431SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 37282cd41431SLinus Lüssing * true if a selected querier is behind one of the other ports of this 37292cd41431SLinus Lüssing * bridge. Otherwise returns false. 37302cd41431SLinus Lüssing */ 37312cd41431SLinus Lüssing bool br_multicast_has_querier_adjacent(struct net_device *dev, int proto) 37322cd41431SLinus Lüssing { 37332cd41431SLinus Lüssing struct net_bridge *br; 37342cd41431SLinus Lüssing struct net_bridge_port *port; 37352cd41431SLinus Lüssing bool ret = false; 37362cd41431SLinus Lüssing 37372cd41431SLinus Lüssing rcu_read_lock(); 373835f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 37392cd41431SLinus Lüssing goto unlock; 37402cd41431SLinus Lüssing 37412cd41431SLinus Lüssing port = br_port_get_rcu(dev); 37422cd41431SLinus Lüssing if (!port || !port->br) 37432cd41431SLinus Lüssing goto unlock; 37442cd41431SLinus Lüssing 37452cd41431SLinus Lüssing br = port->br; 37462cd41431SLinus Lüssing 37472cd41431SLinus Lüssing switch (proto) { 37482cd41431SLinus Lüssing case ETH_P_IP: 37492cd41431SLinus Lüssing if (!timer_pending(&br->ip4_other_query.timer) || 37502cd41431SLinus Lüssing rcu_dereference(br->ip4_querier.port) == port) 37512cd41431SLinus Lüssing goto unlock; 37522cd41431SLinus Lüssing break; 37533993c4e1SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 37542cd41431SLinus Lüssing case ETH_P_IPV6: 37552cd41431SLinus Lüssing if (!timer_pending(&br->ip6_other_query.timer) || 37562cd41431SLinus Lüssing rcu_dereference(br->ip6_querier.port) == port) 37572cd41431SLinus Lüssing goto unlock; 37582cd41431SLinus Lüssing break; 37593993c4e1SLinus Lüssing #endif 37602cd41431SLinus Lüssing default: 37612cd41431SLinus Lüssing goto unlock; 37622cd41431SLinus Lüssing } 37632cd41431SLinus Lüssing 37642cd41431SLinus Lüssing ret = true; 37652cd41431SLinus Lüssing unlock: 37662cd41431SLinus Lüssing rcu_read_unlock(); 37672cd41431SLinus Lüssing return ret; 37682cd41431SLinus Lüssing } 37692cd41431SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_adjacent); 37701080ab95SNikolay Aleksandrov 37711080ab95SNikolay Aleksandrov static void br_mcast_stats_add(struct bridge_mcast_stats __percpu *stats, 3772a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 37731080ab95SNikolay Aleksandrov { 37741080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats = this_cpu_ptr(stats); 3775a65056ecSNikolay Aleksandrov __be16 proto = skb->protocol; 3776a65056ecSNikolay Aleksandrov unsigned int t_len; 37771080ab95SNikolay Aleksandrov 37781080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 37791080ab95SNikolay Aleksandrov switch (proto) { 37801080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 3781a65056ecSNikolay Aleksandrov t_len = ntohs(ip_hdr(skb)->tot_len) - ip_hdrlen(skb); 37821080ab95SNikolay Aleksandrov switch (type) { 37831080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_REPORT: 37841080ab95SNikolay Aleksandrov pstats->mstats.igmp_v1reports[dir]++; 37851080ab95SNikolay Aleksandrov break; 37861080ab95SNikolay Aleksandrov case IGMPV2_HOST_MEMBERSHIP_REPORT: 37871080ab95SNikolay Aleksandrov pstats->mstats.igmp_v2reports[dir]++; 37881080ab95SNikolay Aleksandrov break; 37891080ab95SNikolay Aleksandrov case IGMPV3_HOST_MEMBERSHIP_REPORT: 37901080ab95SNikolay Aleksandrov pstats->mstats.igmp_v3reports[dir]++; 37911080ab95SNikolay Aleksandrov break; 37921080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_QUERY: 3793a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct igmphdr)) { 3794a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v3queries[dir]++; 3795a65056ecSNikolay Aleksandrov } else { 3796a65056ecSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 3797a65056ecSNikolay Aleksandrov struct igmphdr *ih, _ihdr; 3798a65056ecSNikolay Aleksandrov 3799a65056ecSNikolay Aleksandrov ih = skb_header_pointer(skb, offset, 3800a65056ecSNikolay Aleksandrov sizeof(_ihdr), &_ihdr); 3801a65056ecSNikolay Aleksandrov if (!ih) 3802a65056ecSNikolay Aleksandrov break; 3803a65056ecSNikolay Aleksandrov if (!ih->code) 3804a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v1queries[dir]++; 3805a65056ecSNikolay Aleksandrov else 3806a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v2queries[dir]++; 3807a65056ecSNikolay Aleksandrov } 38081080ab95SNikolay Aleksandrov break; 38091080ab95SNikolay Aleksandrov case IGMP_HOST_LEAVE_MESSAGE: 38101080ab95SNikolay Aleksandrov pstats->mstats.igmp_leaves[dir]++; 38111080ab95SNikolay Aleksandrov break; 38121080ab95SNikolay Aleksandrov } 38131080ab95SNikolay Aleksandrov break; 38141080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 38151080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 3816a65056ecSNikolay Aleksandrov t_len = ntohs(ipv6_hdr(skb)->payload_len) + 3817a65056ecSNikolay Aleksandrov sizeof(struct ipv6hdr); 3818a65056ecSNikolay Aleksandrov t_len -= skb_network_header_len(skb); 38191080ab95SNikolay Aleksandrov switch (type) { 38201080ab95SNikolay Aleksandrov case ICMPV6_MGM_REPORT: 38211080ab95SNikolay Aleksandrov pstats->mstats.mld_v1reports[dir]++; 38221080ab95SNikolay Aleksandrov break; 38231080ab95SNikolay Aleksandrov case ICMPV6_MLD2_REPORT: 38241080ab95SNikolay Aleksandrov pstats->mstats.mld_v2reports[dir]++; 38251080ab95SNikolay Aleksandrov break; 38261080ab95SNikolay Aleksandrov case ICMPV6_MGM_QUERY: 3827a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct mld_msg)) 3828a65056ecSNikolay Aleksandrov pstats->mstats.mld_v2queries[dir]++; 3829a65056ecSNikolay Aleksandrov else 3830a65056ecSNikolay Aleksandrov pstats->mstats.mld_v1queries[dir]++; 38311080ab95SNikolay Aleksandrov break; 38321080ab95SNikolay Aleksandrov case ICMPV6_MGM_REDUCTION: 38331080ab95SNikolay Aleksandrov pstats->mstats.mld_leaves[dir]++; 38341080ab95SNikolay Aleksandrov break; 38351080ab95SNikolay Aleksandrov } 38361080ab95SNikolay Aleksandrov break; 38371080ab95SNikolay Aleksandrov #endif /* CONFIG_IPV6 */ 38381080ab95SNikolay Aleksandrov } 38391080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 38401080ab95SNikolay Aleksandrov } 38411080ab95SNikolay Aleksandrov 38421080ab95SNikolay Aleksandrov void br_multicast_count(struct net_bridge *br, const struct net_bridge_port *p, 3843a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 38441080ab95SNikolay Aleksandrov { 38451080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 38461080ab95SNikolay Aleksandrov 38471080ab95SNikolay Aleksandrov /* if multicast_disabled is true then igmp type can't be set */ 3848675779adSNikolay Aleksandrov if (!type || !br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 38491080ab95SNikolay Aleksandrov return; 38501080ab95SNikolay Aleksandrov 38511080ab95SNikolay Aleksandrov if (p) 38521080ab95SNikolay Aleksandrov stats = p->mcast_stats; 38531080ab95SNikolay Aleksandrov else 38541080ab95SNikolay Aleksandrov stats = br->mcast_stats; 38551080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 38561080ab95SNikolay Aleksandrov return; 38571080ab95SNikolay Aleksandrov 3858a65056ecSNikolay Aleksandrov br_mcast_stats_add(stats, skb, type, dir); 38591080ab95SNikolay Aleksandrov } 38601080ab95SNikolay Aleksandrov 38611080ab95SNikolay Aleksandrov int br_multicast_init_stats(struct net_bridge *br) 38621080ab95SNikolay Aleksandrov { 38631080ab95SNikolay Aleksandrov br->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 38641080ab95SNikolay Aleksandrov if (!br->mcast_stats) 38651080ab95SNikolay Aleksandrov return -ENOMEM; 38661080ab95SNikolay Aleksandrov 38671080ab95SNikolay Aleksandrov return 0; 38681080ab95SNikolay Aleksandrov } 38691080ab95SNikolay Aleksandrov 3870b6fe0440SIdo Schimmel void br_multicast_uninit_stats(struct net_bridge *br) 3871b6fe0440SIdo Schimmel { 3872b6fe0440SIdo Schimmel free_percpu(br->mcast_stats); 3873b6fe0440SIdo Schimmel } 3874b6fe0440SIdo Schimmel 3875b3b6a84cSArnd Bergmann /* noinline for https://bugs.llvm.org/show_bug.cgi?id=45802#c9 */ 3876b3b6a84cSArnd Bergmann static noinline_for_stack void mcast_stats_add_dir(u64 *dst, u64 *src) 38771080ab95SNikolay Aleksandrov { 38781080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_RX] += src[BR_MCAST_DIR_RX]; 38791080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_TX] += src[BR_MCAST_DIR_TX]; 38801080ab95SNikolay Aleksandrov } 38811080ab95SNikolay Aleksandrov 38821080ab95SNikolay Aleksandrov void br_multicast_get_stats(const struct net_bridge *br, 38831080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 38841080ab95SNikolay Aleksandrov struct br_mcast_stats *dest) 38851080ab95SNikolay Aleksandrov { 38861080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 38871080ab95SNikolay Aleksandrov struct br_mcast_stats tdst; 38881080ab95SNikolay Aleksandrov int i; 38891080ab95SNikolay Aleksandrov 38901080ab95SNikolay Aleksandrov memset(dest, 0, sizeof(*dest)); 38911080ab95SNikolay Aleksandrov if (p) 38921080ab95SNikolay Aleksandrov stats = p->mcast_stats; 38931080ab95SNikolay Aleksandrov else 38941080ab95SNikolay Aleksandrov stats = br->mcast_stats; 38951080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 38961080ab95SNikolay Aleksandrov return; 38971080ab95SNikolay Aleksandrov 38981080ab95SNikolay Aleksandrov memset(&tdst, 0, sizeof(tdst)); 38991080ab95SNikolay Aleksandrov for_each_possible_cpu(i) { 39001080ab95SNikolay Aleksandrov struct bridge_mcast_stats *cpu_stats = per_cpu_ptr(stats, i); 39011080ab95SNikolay Aleksandrov struct br_mcast_stats temp; 39021080ab95SNikolay Aleksandrov unsigned int start; 39031080ab95SNikolay Aleksandrov 39041080ab95SNikolay Aleksandrov do { 39051080ab95SNikolay Aleksandrov start = u64_stats_fetch_begin_irq(&cpu_stats->syncp); 39061080ab95SNikolay Aleksandrov memcpy(&temp, &cpu_stats->mstats, sizeof(temp)); 39071080ab95SNikolay Aleksandrov } while (u64_stats_fetch_retry_irq(&cpu_stats->syncp, start)); 39081080ab95SNikolay Aleksandrov 3909a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1queries, temp.igmp_v1queries); 3910a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2queries, temp.igmp_v2queries); 3911a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3queries, temp.igmp_v3queries); 39121080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_leaves, temp.igmp_leaves); 39131080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1reports, temp.igmp_v1reports); 39141080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2reports, temp.igmp_v2reports); 39151080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3reports, temp.igmp_v3reports); 39161080ab95SNikolay Aleksandrov tdst.igmp_parse_errors += temp.igmp_parse_errors; 39171080ab95SNikolay Aleksandrov 3918a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1queries, temp.mld_v1queries); 3919a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2queries, temp.mld_v2queries); 39201080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_leaves, temp.mld_leaves); 39211080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1reports, temp.mld_v1reports); 39221080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2reports, temp.mld_v2reports); 39231080ab95SNikolay Aleksandrov tdst.mld_parse_errors += temp.mld_parse_errors; 39241080ab95SNikolay Aleksandrov } 39251080ab95SNikolay Aleksandrov memcpy(dest, &tdst, sizeof(*dest)); 39261080ab95SNikolay Aleksandrov } 392719e3a9c9SNikolay Aleksandrov 392819e3a9c9SNikolay Aleksandrov int br_mdb_hash_init(struct net_bridge *br) 392919e3a9c9SNikolay Aleksandrov { 3930085b53c8SNikolay Aleksandrov int err; 3931085b53c8SNikolay Aleksandrov 3932085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->sg_port_tbl, &br_sg_port_rht_params); 3933085b53c8SNikolay Aleksandrov if (err) 3934085b53c8SNikolay Aleksandrov return err; 3935085b53c8SNikolay Aleksandrov 3936085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->mdb_hash_tbl, &br_mdb_rht_params); 3937085b53c8SNikolay Aleksandrov if (err) { 3938085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 3939085b53c8SNikolay Aleksandrov return err; 3940085b53c8SNikolay Aleksandrov } 3941085b53c8SNikolay Aleksandrov 3942085b53c8SNikolay Aleksandrov return 0; 394319e3a9c9SNikolay Aleksandrov } 394419e3a9c9SNikolay Aleksandrov 394519e3a9c9SNikolay Aleksandrov void br_mdb_hash_fini(struct net_bridge *br) 394619e3a9c9SNikolay Aleksandrov { 3947085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 394819e3a9c9SNikolay Aleksandrov rhashtable_destroy(&br->mdb_hash_tbl); 394919e3a9c9SNikolay Aleksandrov } 3950