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" 368f07b831SNikolay Aleksandrov #include "br_private_mcast_eht.h" 37eb1d1641SHerbert Xu 3819e3a9c9SNikolay Aleksandrov static const struct rhashtable_params br_mdb_rht_params = { 3919e3a9c9SNikolay Aleksandrov .head_offset = offsetof(struct net_bridge_mdb_entry, rhnode), 4019e3a9c9SNikolay Aleksandrov .key_offset = offsetof(struct net_bridge_mdb_entry, addr), 4119e3a9c9SNikolay Aleksandrov .key_len = sizeof(struct br_ip), 4219e3a9c9SNikolay Aleksandrov .automatic_shrinking = true, 4319e3a9c9SNikolay Aleksandrov }; 4419e3a9c9SNikolay Aleksandrov 45085b53c8SNikolay Aleksandrov static const struct rhashtable_params br_sg_port_rht_params = { 46085b53c8SNikolay Aleksandrov .head_offset = offsetof(struct net_bridge_port_group, rhnode), 47085b53c8SNikolay Aleksandrov .key_offset = offsetof(struct net_bridge_port_group, key), 48085b53c8SNikolay Aleksandrov .key_len = sizeof(struct net_bridge_port_group_sg_key), 49085b53c8SNikolay Aleksandrov .automatic_shrinking = true, 50085b53c8SNikolay Aleksandrov }; 51085b53c8SNikolay Aleksandrov 52adc47037SNikolay Aleksandrov static void br_multicast_start_querier(struct net_bridge_mcast *brmctx, 5390010b36SLinus Lüssing struct bridge_mcast_own_query *query); 54adc47037SNikolay Aleksandrov static void br_ip4_multicast_add_router(struct net_bridge_mcast *brmctx, 55adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx); 56adc47037SNikolay Aleksandrov static void br_ip4_multicast_leave_group(struct net_bridge_mcast *brmctx, 57adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 58bc8c20acSSatish Ashok __be32 group, 596db6f0eaSFelix Fietkau __u16 vid, 606db6f0eaSFelix Fietkau const unsigned char *src); 6142c11ccfSNikolay Aleksandrov static void br_multicast_port_group_rexmit(struct timer_list *t); 626db6f0eaSFelix Fietkau 63ed2d3597SLinus Lüssing static void 64adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(struct net_bridge_mcast_port *pmctx, bool deleted); 65adc47037SNikolay Aleksandrov static void br_ip6_multicast_add_router(struct net_bridge_mcast *brmctx, 66adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx); 6730515832SMatteo Croce #if IS_ENABLED(CONFIG_IPV6) 68adc47037SNikolay Aleksandrov static void br_ip6_multicast_leave_group(struct net_bridge_mcast *brmctx, 69adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 70bc8c20acSSatish Ashok const struct in6_addr *group, 716db6f0eaSFelix Fietkau __u16 vid, const unsigned char *src); 72bc8c20acSSatish Ashok #endif 73b0812368SNikolay Aleksandrov static struct net_bridge_port_group * 74adc47037SNikolay Aleksandrov __br_multicast_add_group(struct net_bridge_mcast *brmctx, 75adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 76b0812368SNikolay Aleksandrov struct br_ip *group, 77b0812368SNikolay Aleksandrov const unsigned char *src, 78b0812368SNikolay Aleksandrov u8 filter_mode, 799116ffbfSNikolay Aleksandrov bool igmpv2_mldv1, 809116ffbfSNikolay Aleksandrov bool blocked); 818266a049SNikolay Aleksandrov static void br_multicast_find_del_pg(struct net_bridge *br, 828266a049SNikolay Aleksandrov struct net_bridge_port_group *pg); 83613d61dbSNikolay Aleksandrov static void __br_multicast_stop(struct net_bridge_mcast *brmctx); 84c83b8fabSHerbert Xu 85c832962aSOleksandr Mazur static int br_mc_disabled_update(struct net_device *dev, bool value, 86c832962aSOleksandr Mazur struct netlink_ext_ack *extack); 87c832962aSOleksandr Mazur 88085b53c8SNikolay Aleksandrov static struct net_bridge_port_group * 89085b53c8SNikolay Aleksandrov br_sg_port_find(struct net_bridge *br, 90085b53c8SNikolay Aleksandrov struct net_bridge_port_group_sg_key *sg_p) 91085b53c8SNikolay Aleksandrov { 92085b53c8SNikolay Aleksandrov lockdep_assert_held_once(&br->multicast_lock); 93085b53c8SNikolay Aleksandrov 94085b53c8SNikolay Aleksandrov return rhashtable_lookup_fast(&br->sg_port_tbl, sg_p, 95085b53c8SNikolay Aleksandrov br_sg_port_rht_params); 96085b53c8SNikolay Aleksandrov } 97085b53c8SNikolay Aleksandrov 9819e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip_get_rcu(struct net_bridge *br, 99cfd56754SCong Wang struct br_ip *dst) 1007f285fa7SHerbert Xu { 10119e3a9c9SNikolay Aleksandrov return rhashtable_lookup(&br->mdb_hash_tbl, dst, br_mdb_rht_params); 1027f285fa7SHerbert Xu } 1037f285fa7SHerbert Xu 10419e3a9c9SNikolay Aleksandrov struct net_bridge_mdb_entry *br_mdb_ip_get(struct net_bridge *br, 10519e3a9c9SNikolay Aleksandrov struct br_ip *dst) 10619e3a9c9SNikolay Aleksandrov { 10719e3a9c9SNikolay Aleksandrov struct net_bridge_mdb_entry *ent; 10819e3a9c9SNikolay Aleksandrov 10919e3a9c9SNikolay Aleksandrov lockdep_assert_held_once(&br->multicast_lock); 11019e3a9c9SNikolay Aleksandrov 11119e3a9c9SNikolay Aleksandrov rcu_read_lock(); 11219e3a9c9SNikolay Aleksandrov ent = rhashtable_lookup(&br->mdb_hash_tbl, dst, br_mdb_rht_params); 11319e3a9c9SNikolay Aleksandrov rcu_read_unlock(); 11419e3a9c9SNikolay Aleksandrov 11519e3a9c9SNikolay Aleksandrov return ent; 11619e3a9c9SNikolay Aleksandrov } 11719e3a9c9SNikolay Aleksandrov 11819e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip4_get(struct net_bridge *br, 11919e3a9c9SNikolay Aleksandrov __be32 dst, __u16 vid) 120eb1d1641SHerbert Xu { 1218ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_dst; 1220821ec55SHerbert Xu 12319e3a9c9SNikolay Aleksandrov memset(&br_dst, 0, sizeof(br_dst)); 124eab3227bSNikolay Aleksandrov br_dst.dst.ip4 = dst; 1258ef2a9a5SYOSHIFUJI Hideaki br_dst.proto = htons(ETH_P_IP); 126b0e9a30dSVlad Yasevich br_dst.vid = vid; 1278ef2a9a5SYOSHIFUJI Hideaki 12819e3a9c9SNikolay Aleksandrov return br_mdb_ip_get(br, &br_dst); 1298ef2a9a5SYOSHIFUJI Hideaki } 1308ef2a9a5SYOSHIFUJI Hideaki 131dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 13219e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip6_get(struct net_bridge *br, 13319e3a9c9SNikolay Aleksandrov const struct in6_addr *dst, 134b0e9a30dSVlad Yasevich __u16 vid) 13508b202b6SYOSHIFUJI Hideaki { 13608b202b6SYOSHIFUJI Hideaki struct br_ip br_dst; 13708b202b6SYOSHIFUJI Hideaki 13819e3a9c9SNikolay Aleksandrov memset(&br_dst, 0, sizeof(br_dst)); 139eab3227bSNikolay Aleksandrov br_dst.dst.ip6 = *dst; 14008b202b6SYOSHIFUJI Hideaki br_dst.proto = htons(ETH_P_IPV6); 141b0e9a30dSVlad Yasevich br_dst.vid = vid; 14208b202b6SYOSHIFUJI Hideaki 14319e3a9c9SNikolay Aleksandrov return br_mdb_ip_get(br, &br_dst); 14408b202b6SYOSHIFUJI Hideaki } 14508b202b6SYOSHIFUJI Hideaki #endif 14608b202b6SYOSHIFUJI Hideaki 147adc47037SNikolay Aleksandrov struct net_bridge_mdb_entry *br_mdb_get(struct net_bridge_mcast *brmctx, 148fbca58a2SCong Wang struct sk_buff *skb, u16 vid) 149eb1d1641SHerbert Xu { 150adc47037SNikolay Aleksandrov struct net_bridge *br = brmctx->br; 1518ef2a9a5SYOSHIFUJI Hideaki struct br_ip ip; 1528ef2a9a5SYOSHIFUJI Hideaki 1534cdd0d10SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED) || 1544cdd0d10SNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(brmctx)) 155eb1d1641SHerbert Xu return NULL; 156eb1d1641SHerbert Xu 1578ef2a9a5SYOSHIFUJI Hideaki if (BR_INPUT_SKB_CB(skb)->igmp) 1588ef2a9a5SYOSHIFUJI Hideaki return NULL; 1598ef2a9a5SYOSHIFUJI Hideaki 16019e3a9c9SNikolay Aleksandrov memset(&ip, 0, sizeof(ip)); 1618ef2a9a5SYOSHIFUJI Hideaki ip.proto = skb->protocol; 162fbca58a2SCong Wang ip.vid = vid; 1638ef2a9a5SYOSHIFUJI Hideaki 164eb1d1641SHerbert Xu switch (skb->protocol) { 165eb1d1641SHerbert Xu case htons(ETH_P_IP): 166eab3227bSNikolay Aleksandrov ip.dst.ip4 = ip_hdr(skb)->daddr; 167adc47037SNikolay Aleksandrov if (brmctx->multicast_igmp_version == 3) { 1687d07a68cSNikolay Aleksandrov struct net_bridge_mdb_entry *mdb; 1697d07a68cSNikolay Aleksandrov 1707d07a68cSNikolay Aleksandrov ip.src.ip4 = ip_hdr(skb)->saddr; 1717d07a68cSNikolay Aleksandrov mdb = br_mdb_ip_get_rcu(br, &ip); 1727d07a68cSNikolay Aleksandrov if (mdb) 1737d07a68cSNikolay Aleksandrov return mdb; 1747d07a68cSNikolay Aleksandrov ip.src.ip4 = 0; 1757d07a68cSNikolay Aleksandrov } 176eb1d1641SHerbert Xu break; 177dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 17808b202b6SYOSHIFUJI Hideaki case htons(ETH_P_IPV6): 179eab3227bSNikolay Aleksandrov ip.dst.ip6 = ipv6_hdr(skb)->daddr; 180adc47037SNikolay Aleksandrov if (brmctx->multicast_mld_version == 2) { 1817d07a68cSNikolay Aleksandrov struct net_bridge_mdb_entry *mdb; 1827d07a68cSNikolay Aleksandrov 1837d07a68cSNikolay Aleksandrov ip.src.ip6 = ipv6_hdr(skb)->saddr; 1847d07a68cSNikolay Aleksandrov mdb = br_mdb_ip_get_rcu(br, &ip); 1857d07a68cSNikolay Aleksandrov if (mdb) 1867d07a68cSNikolay Aleksandrov return mdb; 1877d07a68cSNikolay Aleksandrov memset(&ip.src.ip6, 0, sizeof(ip.src.ip6)); 1887d07a68cSNikolay Aleksandrov } 18908b202b6SYOSHIFUJI Hideaki break; 19008b202b6SYOSHIFUJI Hideaki #endif 1918ef2a9a5SYOSHIFUJI Hideaki default: 192955062b0SNikolay Aleksandrov ip.proto = 0; 193955062b0SNikolay Aleksandrov ether_addr_copy(ip.dst.mac_addr, eth_hdr(skb)->h_dest); 194eb1d1641SHerbert Xu } 195eb1d1641SHerbert Xu 19619e3a9c9SNikolay Aleksandrov return br_mdb_ip_get_rcu(br, &ip); 197eb1d1641SHerbert Xu } 198eb1d1641SHerbert Xu 19974edfd48SNikolay Aleksandrov /* IMPORTANT: this function must be used only when the contexts cannot be 20074edfd48SNikolay Aleksandrov * passed down (e.g. timer) and must be used for read-only purposes because 20174edfd48SNikolay Aleksandrov * the vlan snooping option can change, so it can return any context 20274edfd48SNikolay Aleksandrov * (non-vlan or vlan). Its initial intended purpose is to read timer values 20374edfd48SNikolay Aleksandrov * from the *current* context based on the option. At worst that could lead 20474edfd48SNikolay Aleksandrov * to inconsistent timers when the contexts are changed, i.e. src timer 20574edfd48SNikolay Aleksandrov * which needs to re-arm with a specific delay taken from the old context 20674edfd48SNikolay Aleksandrov */ 20774edfd48SNikolay Aleksandrov static struct net_bridge_mcast_port * 20874edfd48SNikolay Aleksandrov br_multicast_pg_to_port_ctx(const struct net_bridge_port_group *pg) 20974edfd48SNikolay Aleksandrov { 21074edfd48SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = &pg->key.port->multicast_ctx; 21174edfd48SNikolay Aleksandrov struct net_bridge_vlan *vlan; 21274edfd48SNikolay Aleksandrov 21374edfd48SNikolay Aleksandrov lockdep_assert_held_once(&pg->key.port->br->multicast_lock); 21474edfd48SNikolay Aleksandrov 21574edfd48SNikolay Aleksandrov /* if vlan snooping is disabled use the port's multicast context */ 21674edfd48SNikolay Aleksandrov if (!pg->key.addr.vid || 21774edfd48SNikolay Aleksandrov !br_opt_get(pg->key.port->br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) 21874edfd48SNikolay Aleksandrov goto out; 21974edfd48SNikolay Aleksandrov 22074edfd48SNikolay Aleksandrov /* locking is tricky here, due to different rules for multicast and 22174edfd48SNikolay Aleksandrov * vlans we need to take rcu to find the vlan and make sure it has 22274edfd48SNikolay Aleksandrov * the BR_VLFLAG_MCAST_ENABLED flag set, it can only change under 22374edfd48SNikolay Aleksandrov * multicast_lock which must be already held here, so the vlan's pmctx 22474edfd48SNikolay Aleksandrov * can safely be used on return 22574edfd48SNikolay Aleksandrov */ 22674edfd48SNikolay Aleksandrov rcu_read_lock(); 2273f0d14efSNikolay Aleksandrov vlan = br_vlan_find(nbp_vlan_group_rcu(pg->key.port), pg->key.addr.vid); 22874edfd48SNikolay Aleksandrov if (vlan && !br_multicast_port_ctx_vlan_disabled(&vlan->port_mcast_ctx)) 22974edfd48SNikolay Aleksandrov pmctx = &vlan->port_mcast_ctx; 23074edfd48SNikolay Aleksandrov else 23174edfd48SNikolay Aleksandrov pmctx = NULL; 23274edfd48SNikolay Aleksandrov rcu_read_unlock(); 23374edfd48SNikolay Aleksandrov out: 23474edfd48SNikolay Aleksandrov return pmctx; 23574edfd48SNikolay Aleksandrov } 23674edfd48SNikolay Aleksandrov 2374cdd0d10SNikolay Aleksandrov /* when snooping we need to check if the contexts should be used 2384cdd0d10SNikolay Aleksandrov * in the following order: 2394cdd0d10SNikolay Aleksandrov * - if pmctx is non-NULL (port), check if it should be used 2404cdd0d10SNikolay Aleksandrov * - if pmctx is NULL (bridge), check if brmctx should be used 2414cdd0d10SNikolay Aleksandrov */ 2424cdd0d10SNikolay Aleksandrov static bool 2434cdd0d10SNikolay Aleksandrov br_multicast_ctx_should_use(const struct net_bridge_mcast *brmctx, 2444cdd0d10SNikolay Aleksandrov const struct net_bridge_mcast_port *pmctx) 2454cdd0d10SNikolay Aleksandrov { 2464cdd0d10SNikolay Aleksandrov if (!netif_running(brmctx->br->dev)) 2474cdd0d10SNikolay Aleksandrov return false; 2484cdd0d10SNikolay Aleksandrov 2494cdd0d10SNikolay Aleksandrov if (pmctx) 2504cdd0d10SNikolay Aleksandrov return !br_multicast_port_ctx_state_disabled(pmctx); 2514cdd0d10SNikolay Aleksandrov else 2524cdd0d10SNikolay Aleksandrov return !br_multicast_ctx_vlan_disabled(brmctx); 2534cdd0d10SNikolay Aleksandrov } 2544cdd0d10SNikolay Aleksandrov 255b0812368SNikolay Aleksandrov static bool br_port_group_equal(struct net_bridge_port_group *p, 256b0812368SNikolay Aleksandrov struct net_bridge_port *port, 257b0812368SNikolay Aleksandrov const unsigned char *src) 258b0812368SNikolay Aleksandrov { 259b0812368SNikolay Aleksandrov if (p->key.port != port) 260b0812368SNikolay Aleksandrov return false; 261b0812368SNikolay Aleksandrov 262b0812368SNikolay Aleksandrov if (!(port->flags & BR_MULTICAST_TO_UNICAST)) 263b0812368SNikolay Aleksandrov return true; 264b0812368SNikolay Aleksandrov 265b0812368SNikolay Aleksandrov return ether_addr_equal(src, p->eth_addr); 266b0812368SNikolay Aleksandrov } 267b0812368SNikolay Aleksandrov 268adc47037SNikolay Aleksandrov static void __fwd_add_star_excl(struct net_bridge_mcast_port *pmctx, 269adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, 2708266a049SNikolay Aleksandrov struct br_ip *sg_ip) 2718266a049SNikolay Aleksandrov { 2728266a049SNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 2738266a049SNikolay Aleksandrov struct net_bridge_port_group *src_pg; 274adc47037SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 2758266a049SNikolay Aleksandrov 2768266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 2777b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 2788266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 2798266a049SNikolay Aleksandrov sg_key.addr = *sg_ip; 280adc47037SNikolay Aleksandrov if (br_sg_port_find(brmctx->br, &sg_key)) 2818266a049SNikolay Aleksandrov return; 2828266a049SNikolay Aleksandrov 283adc47037SNikolay Aleksandrov src_pg = __br_multicast_add_group(brmctx, pmctx, 284adc47037SNikolay Aleksandrov sg_ip, pg->eth_addr, 2859116ffbfSNikolay Aleksandrov MCAST_INCLUDE, false, false); 2868266a049SNikolay Aleksandrov if (IS_ERR_OR_NULL(src_pg) || 2878266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 2888266a049SNikolay Aleksandrov return; 2898266a049SNikolay Aleksandrov 2908266a049SNikolay Aleksandrov src_pg->flags |= MDB_PG_FLAGS_STAR_EXCL; 2918266a049SNikolay Aleksandrov } 2928266a049SNikolay Aleksandrov 2938266a049SNikolay Aleksandrov static void __fwd_del_star_excl(struct net_bridge_port_group *pg, 2948266a049SNikolay Aleksandrov struct br_ip *sg_ip) 2958266a049SNikolay Aleksandrov { 2968266a049SNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 2978266a049SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 2988266a049SNikolay Aleksandrov struct net_bridge_port_group *src_pg; 2998266a049SNikolay Aleksandrov 3008266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 3018266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 3028266a049SNikolay Aleksandrov sg_key.addr = *sg_ip; 3038266a049SNikolay Aleksandrov src_pg = br_sg_port_find(br, &sg_key); 3048266a049SNikolay Aleksandrov if (!src_pg || !(src_pg->flags & MDB_PG_FLAGS_STAR_EXCL) || 3058266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 3068266a049SNikolay Aleksandrov return; 3078266a049SNikolay Aleksandrov 3088266a049SNikolay Aleksandrov br_multicast_find_del_pg(br, src_pg); 3098266a049SNikolay Aleksandrov } 3108266a049SNikolay Aleksandrov 3118266a049SNikolay Aleksandrov /* When a port group transitions to (or is added as) EXCLUDE we need to add it 3128266a049SNikolay Aleksandrov * to all other ports' S,G entries which are not blocked by the current group 3138266a049SNikolay Aleksandrov * for proper replication, the assumption is that any S,G blocked entries 3148266a049SNikolay Aleksandrov * are already added so the S,G,port lookup should skip them. 3158266a049SNikolay Aleksandrov * When a port group transitions from EXCLUDE -> INCLUDE mode or is being 3168266a049SNikolay Aleksandrov * deleted we need to remove it from all ports' S,G entries where it was 3178266a049SNikolay Aleksandrov * automatically installed before (i.e. where it's MDB_PG_FLAGS_STAR_EXCL). 3188266a049SNikolay Aleksandrov */ 3198266a049SNikolay Aleksandrov void br_multicast_star_g_handle_mode(struct net_bridge_port_group *pg, 3208266a049SNikolay Aleksandrov u8 filter_mode) 3218266a049SNikolay Aleksandrov { 3228266a049SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 3238266a049SNikolay Aleksandrov struct net_bridge_port_group *pg_lst; 324adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 3258266a049SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 3268266a049SNikolay Aleksandrov struct br_ip sg_ip; 3278266a049SNikolay Aleksandrov 3288266a049SNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&pg->key.addr))) 3298266a049SNikolay Aleksandrov return; 3308266a049SNikolay Aleksandrov 3318266a049SNikolay Aleksandrov mp = br_mdb_ip_get(br, &pg->key.addr); 3328266a049SNikolay Aleksandrov if (!mp) 3338266a049SNikolay Aleksandrov return; 334eb1593a0SNikolay Aleksandrov pmctx = br_multicast_pg_to_port_ctx(pg); 335eb1593a0SNikolay Aleksandrov if (!pmctx) 336eb1593a0SNikolay Aleksandrov return; 3378266a049SNikolay Aleksandrov 3388266a049SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 3398266a049SNikolay Aleksandrov sg_ip = pg->key.addr; 3407b54aaafSNikolay Aleksandrov 3418266a049SNikolay Aleksandrov for (pg_lst = mlock_dereference(mp->ports, br); 3428266a049SNikolay Aleksandrov pg_lst; 3438266a049SNikolay Aleksandrov pg_lst = mlock_dereference(pg_lst->next, br)) { 3448266a049SNikolay Aleksandrov struct net_bridge_group_src *src_ent; 3458266a049SNikolay Aleksandrov 3468266a049SNikolay Aleksandrov if (pg_lst == pg) 3478266a049SNikolay Aleksandrov continue; 3488266a049SNikolay Aleksandrov hlist_for_each_entry(src_ent, &pg_lst->src_list, node) { 3498266a049SNikolay Aleksandrov if (!(src_ent->flags & BR_SGRP_F_INSTALLED)) 3508266a049SNikolay Aleksandrov continue; 3518266a049SNikolay Aleksandrov sg_ip.src = src_ent->addr.src; 3528266a049SNikolay Aleksandrov switch (filter_mode) { 3538266a049SNikolay Aleksandrov case MCAST_INCLUDE: 3548266a049SNikolay Aleksandrov __fwd_del_star_excl(pg, &sg_ip); 3558266a049SNikolay Aleksandrov break; 3568266a049SNikolay Aleksandrov case MCAST_EXCLUDE: 357adc47037SNikolay Aleksandrov __fwd_add_star_excl(pmctx, pg, &sg_ip); 3588266a049SNikolay Aleksandrov break; 3598266a049SNikolay Aleksandrov } 3608266a049SNikolay Aleksandrov } 3618266a049SNikolay Aleksandrov } 3628266a049SNikolay Aleksandrov } 3638266a049SNikolay Aleksandrov 364094b82fdSNikolay Aleksandrov /* called when adding a new S,G with host_joined == false by default */ 365094b82fdSNikolay Aleksandrov static void br_multicast_sg_host_state(struct net_bridge_mdb_entry *star_mp, 366094b82fdSNikolay Aleksandrov struct net_bridge_port_group *sg) 367094b82fdSNikolay Aleksandrov { 368094b82fdSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 369094b82fdSNikolay Aleksandrov 370094b82fdSNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 371094b82fdSNikolay Aleksandrov return; 372094b82fdSNikolay Aleksandrov if (!star_mp->host_joined) 373094b82fdSNikolay Aleksandrov return; 374094b82fdSNikolay Aleksandrov 375094b82fdSNikolay Aleksandrov sg_mp = br_mdb_ip_get(star_mp->br, &sg->key.addr); 376094b82fdSNikolay Aleksandrov if (!sg_mp) 377094b82fdSNikolay Aleksandrov return; 378094b82fdSNikolay Aleksandrov sg_mp->host_joined = true; 379094b82fdSNikolay Aleksandrov } 380094b82fdSNikolay Aleksandrov 381094b82fdSNikolay Aleksandrov /* set the host_joined state of all of *,G's S,G entries */ 382094b82fdSNikolay Aleksandrov static void br_multicast_star_g_host_state(struct net_bridge_mdb_entry *star_mp) 383094b82fdSNikolay Aleksandrov { 384094b82fdSNikolay Aleksandrov struct net_bridge *br = star_mp->br; 385094b82fdSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 386094b82fdSNikolay Aleksandrov struct net_bridge_port_group *pg; 387094b82fdSNikolay Aleksandrov struct br_ip sg_ip; 388094b82fdSNikolay Aleksandrov 389094b82fdSNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 390094b82fdSNikolay Aleksandrov return; 391094b82fdSNikolay Aleksandrov 392094b82fdSNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 393094b82fdSNikolay Aleksandrov sg_ip = star_mp->addr; 394094b82fdSNikolay Aleksandrov for (pg = mlock_dereference(star_mp->ports, br); 395094b82fdSNikolay Aleksandrov pg; 396094b82fdSNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) { 397094b82fdSNikolay Aleksandrov struct net_bridge_group_src *src_ent; 398094b82fdSNikolay Aleksandrov 399094b82fdSNikolay Aleksandrov hlist_for_each_entry(src_ent, &pg->src_list, node) { 400094b82fdSNikolay Aleksandrov if (!(src_ent->flags & BR_SGRP_F_INSTALLED)) 401094b82fdSNikolay Aleksandrov continue; 402094b82fdSNikolay Aleksandrov sg_ip.src = src_ent->addr.src; 403094b82fdSNikolay Aleksandrov sg_mp = br_mdb_ip_get(br, &sg_ip); 404094b82fdSNikolay Aleksandrov if (!sg_mp) 405094b82fdSNikolay Aleksandrov continue; 406094b82fdSNikolay Aleksandrov sg_mp->host_joined = star_mp->host_joined; 407094b82fdSNikolay Aleksandrov } 408094b82fdSNikolay Aleksandrov } 409094b82fdSNikolay Aleksandrov } 410094b82fdSNikolay Aleksandrov 4118266a049SNikolay Aleksandrov static void br_multicast_sg_del_exclude_ports(struct net_bridge_mdb_entry *sgmp) 4128266a049SNikolay Aleksandrov { 4138266a049SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 4148266a049SNikolay Aleksandrov struct net_bridge_port_group *p; 4158266a049SNikolay Aleksandrov 4168266a049SNikolay Aleksandrov /* *,G exclude ports are only added to S,G entries */ 4178266a049SNikolay Aleksandrov if (WARN_ON(br_multicast_is_star_g(&sgmp->addr))) 4188266a049SNikolay Aleksandrov return; 4198266a049SNikolay Aleksandrov 4208266a049SNikolay Aleksandrov /* we need the STAR_EXCLUDE ports if there are non-STAR_EXCLUDE ports 4218266a049SNikolay Aleksandrov * we should ignore perm entries since they're managed by user-space 4228266a049SNikolay Aleksandrov */ 4238266a049SNikolay Aleksandrov for (pp = &sgmp->ports; 4248266a049SNikolay Aleksandrov (p = mlock_dereference(*pp, sgmp->br)) != NULL; 4258266a049SNikolay Aleksandrov pp = &p->next) 4268266a049SNikolay Aleksandrov if (!(p->flags & (MDB_PG_FLAGS_STAR_EXCL | 4278266a049SNikolay Aleksandrov MDB_PG_FLAGS_PERMANENT))) 4288266a049SNikolay Aleksandrov return; 4298266a049SNikolay Aleksandrov 430094b82fdSNikolay Aleksandrov /* currently the host can only have joined the *,G which means 431094b82fdSNikolay Aleksandrov * we treat it as EXCLUDE {}, so for an S,G it's considered a 432094b82fdSNikolay Aleksandrov * STAR_EXCLUDE entry and we can safely leave it 433094b82fdSNikolay Aleksandrov */ 434094b82fdSNikolay Aleksandrov sgmp->host_joined = false; 435094b82fdSNikolay Aleksandrov 4368266a049SNikolay Aleksandrov for (pp = &sgmp->ports; 4378266a049SNikolay Aleksandrov (p = mlock_dereference(*pp, sgmp->br)) != NULL;) { 4388266a049SNikolay Aleksandrov if (!(p->flags & MDB_PG_FLAGS_PERMANENT)) 4398266a049SNikolay Aleksandrov br_multicast_del_pg(sgmp, p, pp); 4408266a049SNikolay Aleksandrov else 4418266a049SNikolay Aleksandrov pp = &p->next; 4428266a049SNikolay Aleksandrov } 4438266a049SNikolay Aleksandrov } 4448266a049SNikolay Aleksandrov 4458266a049SNikolay Aleksandrov void br_multicast_sg_add_exclude_ports(struct net_bridge_mdb_entry *star_mp, 4468266a049SNikolay Aleksandrov struct net_bridge_port_group *sg) 4478266a049SNikolay Aleksandrov { 4488266a049SNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 4498266a049SNikolay Aleksandrov struct net_bridge *br = star_mp->br; 450adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 4518266a049SNikolay Aleksandrov struct net_bridge_port_group *pg; 452adc47037SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 4538266a049SNikolay Aleksandrov 4548266a049SNikolay Aleksandrov if (WARN_ON(br_multicast_is_star_g(&sg->key.addr))) 4558266a049SNikolay Aleksandrov return; 4568266a049SNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 4578266a049SNikolay Aleksandrov return; 4588266a049SNikolay Aleksandrov 459094b82fdSNikolay Aleksandrov br_multicast_sg_host_state(star_mp, sg); 4608266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 4618266a049SNikolay Aleksandrov sg_key.addr = sg->key.addr; 4628266a049SNikolay Aleksandrov /* we need to add all exclude ports to the S,G */ 4638266a049SNikolay Aleksandrov for (pg = mlock_dereference(star_mp->ports, br); 4648266a049SNikolay Aleksandrov pg; 4658266a049SNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) { 4668266a049SNikolay Aleksandrov struct net_bridge_port_group *src_pg; 4678266a049SNikolay Aleksandrov 4688266a049SNikolay Aleksandrov if (pg == sg || pg->filter_mode == MCAST_INCLUDE) 4698266a049SNikolay Aleksandrov continue; 4708266a049SNikolay Aleksandrov 4718266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 4728266a049SNikolay Aleksandrov if (br_sg_port_find(br, &sg_key)) 4738266a049SNikolay Aleksandrov continue; 4748266a049SNikolay Aleksandrov 475eb1593a0SNikolay Aleksandrov pmctx = br_multicast_pg_to_port_ctx(pg); 476eb1593a0SNikolay Aleksandrov if (!pmctx) 477eb1593a0SNikolay Aleksandrov continue; 478eb1593a0SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 479eb1593a0SNikolay Aleksandrov 480adc47037SNikolay Aleksandrov src_pg = __br_multicast_add_group(brmctx, pmctx, 4818266a049SNikolay Aleksandrov &sg->key.addr, 4828266a049SNikolay Aleksandrov sg->eth_addr, 4839116ffbfSNikolay Aleksandrov MCAST_INCLUDE, false, false); 4848266a049SNikolay Aleksandrov if (IS_ERR_OR_NULL(src_pg) || 4858266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 4868266a049SNikolay Aleksandrov continue; 4878266a049SNikolay Aleksandrov src_pg->flags |= MDB_PG_FLAGS_STAR_EXCL; 4888266a049SNikolay Aleksandrov } 4898266a049SNikolay Aleksandrov } 4908266a049SNikolay Aleksandrov 491b0812368SNikolay Aleksandrov static void br_multicast_fwd_src_add(struct net_bridge_group_src *src) 492b0812368SNikolay Aleksandrov { 4938266a049SNikolay Aleksandrov struct net_bridge_mdb_entry *star_mp; 494adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 495b0812368SNikolay Aleksandrov struct net_bridge_port_group *sg; 496adc47037SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 497b0812368SNikolay Aleksandrov struct br_ip sg_ip; 498b0812368SNikolay Aleksandrov 499b0812368SNikolay Aleksandrov if (src->flags & BR_SGRP_F_INSTALLED) 500b0812368SNikolay Aleksandrov return; 501b0812368SNikolay Aleksandrov 502b0812368SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 503eb1593a0SNikolay Aleksandrov pmctx = br_multicast_pg_to_port_ctx(src->pg); 504eb1593a0SNikolay Aleksandrov if (!pmctx) 505eb1593a0SNikolay Aleksandrov return; 5067b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 507b0812368SNikolay Aleksandrov sg_ip = src->pg->key.addr; 508b0812368SNikolay Aleksandrov sg_ip.src = src->addr.src; 509adc47037SNikolay Aleksandrov 510adc47037SNikolay Aleksandrov sg = __br_multicast_add_group(brmctx, pmctx, &sg_ip, 5119116ffbfSNikolay Aleksandrov src->pg->eth_addr, MCAST_INCLUDE, false, 5129116ffbfSNikolay Aleksandrov !timer_pending(&src->timer)); 513b0812368SNikolay Aleksandrov if (IS_ERR_OR_NULL(sg)) 514b0812368SNikolay Aleksandrov return; 515b0812368SNikolay Aleksandrov src->flags |= BR_SGRP_F_INSTALLED; 5168266a049SNikolay Aleksandrov sg->flags &= ~MDB_PG_FLAGS_STAR_EXCL; 517b0812368SNikolay Aleksandrov 518b0812368SNikolay Aleksandrov /* if it was added by user-space as perm we can skip next steps */ 519b0812368SNikolay Aleksandrov if (sg->rt_protocol != RTPROT_KERNEL && 520b0812368SNikolay Aleksandrov (sg->flags & MDB_PG_FLAGS_PERMANENT)) 521b0812368SNikolay Aleksandrov return; 522b0812368SNikolay Aleksandrov 523b0812368SNikolay Aleksandrov /* the kernel is now responsible for removing this S,G */ 524b0812368SNikolay Aleksandrov del_timer(&sg->timer); 5258266a049SNikolay Aleksandrov star_mp = br_mdb_ip_get(src->br, &src->pg->key.addr); 5268266a049SNikolay Aleksandrov if (!star_mp) 5278266a049SNikolay Aleksandrov return; 5288266a049SNikolay Aleksandrov 5298266a049SNikolay Aleksandrov br_multicast_sg_add_exclude_ports(star_mp, sg); 530b0812368SNikolay Aleksandrov } 531b0812368SNikolay Aleksandrov 532d5a10222SNikolay Aleksandrov static void br_multicast_fwd_src_remove(struct net_bridge_group_src *src, 533d5a10222SNikolay Aleksandrov bool fastleave) 534b0812368SNikolay Aleksandrov { 535b0812368SNikolay Aleksandrov struct net_bridge_port_group *p, *pg = src->pg; 536b0812368SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 537b0812368SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 538b0812368SNikolay Aleksandrov struct br_ip sg_ip; 539b0812368SNikolay Aleksandrov 540b0812368SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 541b0812368SNikolay Aleksandrov sg_ip = pg->key.addr; 542b0812368SNikolay Aleksandrov sg_ip.src = src->addr.src; 543b0812368SNikolay Aleksandrov 544b0812368SNikolay Aleksandrov mp = br_mdb_ip_get(src->br, &sg_ip); 545b0812368SNikolay Aleksandrov if (!mp) 546b0812368SNikolay Aleksandrov return; 547b0812368SNikolay Aleksandrov 548b0812368SNikolay Aleksandrov for (pp = &mp->ports; 549b0812368SNikolay Aleksandrov (p = mlock_dereference(*pp, src->br)) != NULL; 550b0812368SNikolay Aleksandrov pp = &p->next) { 551b0812368SNikolay Aleksandrov if (!br_port_group_equal(p, pg->key.port, pg->eth_addr)) 552b0812368SNikolay Aleksandrov continue; 553b0812368SNikolay Aleksandrov 554b0812368SNikolay Aleksandrov if (p->rt_protocol != RTPROT_KERNEL && 555b0812368SNikolay Aleksandrov (p->flags & MDB_PG_FLAGS_PERMANENT)) 556b0812368SNikolay Aleksandrov break; 557b0812368SNikolay Aleksandrov 558d5a10222SNikolay Aleksandrov if (fastleave) 559d5a10222SNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_FAST_LEAVE; 560b0812368SNikolay Aleksandrov br_multicast_del_pg(mp, p, pp); 561b0812368SNikolay Aleksandrov break; 562b0812368SNikolay Aleksandrov } 563b0812368SNikolay Aleksandrov src->flags &= ~BR_SGRP_F_INSTALLED; 564b0812368SNikolay Aleksandrov } 565b0812368SNikolay Aleksandrov 5669116ffbfSNikolay Aleksandrov /* install S,G and based on src's timer enable or disable forwarding */ 567b0812368SNikolay Aleksandrov static void br_multicast_fwd_src_handle(struct net_bridge_group_src *src) 568b0812368SNikolay Aleksandrov { 5699116ffbfSNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 5709116ffbfSNikolay Aleksandrov struct net_bridge_port_group *sg; 5719116ffbfSNikolay Aleksandrov u8 old_flags; 5729116ffbfSNikolay Aleksandrov 573b0812368SNikolay Aleksandrov br_multicast_fwd_src_add(src); 5749116ffbfSNikolay Aleksandrov 5759116ffbfSNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 5769116ffbfSNikolay Aleksandrov sg_key.addr = src->pg->key.addr; 5779116ffbfSNikolay Aleksandrov sg_key.addr.src = src->addr.src; 5789116ffbfSNikolay Aleksandrov sg_key.port = src->pg->key.port; 5799116ffbfSNikolay Aleksandrov 5809116ffbfSNikolay Aleksandrov sg = br_sg_port_find(src->br, &sg_key); 5819116ffbfSNikolay Aleksandrov if (!sg || (sg->flags & MDB_PG_FLAGS_PERMANENT)) 5829116ffbfSNikolay Aleksandrov return; 5839116ffbfSNikolay Aleksandrov 5849116ffbfSNikolay Aleksandrov old_flags = sg->flags; 5859116ffbfSNikolay Aleksandrov if (timer_pending(&src->timer)) 5869116ffbfSNikolay Aleksandrov sg->flags &= ~MDB_PG_FLAGS_BLOCKED; 5879116ffbfSNikolay Aleksandrov else 5889116ffbfSNikolay Aleksandrov sg->flags |= MDB_PG_FLAGS_BLOCKED; 5899116ffbfSNikolay Aleksandrov 5909116ffbfSNikolay Aleksandrov if (old_flags != sg->flags) { 5919116ffbfSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 5929116ffbfSNikolay Aleksandrov 5939116ffbfSNikolay Aleksandrov sg_mp = br_mdb_ip_get(src->br, &sg_key.addr); 5949116ffbfSNikolay Aleksandrov if (!sg_mp) 5959116ffbfSNikolay Aleksandrov return; 5969116ffbfSNikolay Aleksandrov br_mdb_notify(src->br->dev, sg_mp, sg, RTM_NEWMDB); 5979116ffbfSNikolay Aleksandrov } 598b0812368SNikolay Aleksandrov } 599b0812368SNikolay Aleksandrov 600e12cec65SNikolay Aleksandrov static void br_multicast_destroy_mdb_entry(struct net_bridge_mcast_gc *gc) 601e12cec65SNikolay Aleksandrov { 602e12cec65SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 603e12cec65SNikolay Aleksandrov 604e12cec65SNikolay Aleksandrov mp = container_of(gc, struct net_bridge_mdb_entry, mcast_gc); 605e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&mp->mdb_node)); 606e12cec65SNikolay Aleksandrov WARN_ON(mp->ports); 607e12cec65SNikolay Aleksandrov 608e12cec65SNikolay Aleksandrov del_timer_sync(&mp->timer); 609e12cec65SNikolay Aleksandrov kfree_rcu(mp, rcu); 610e12cec65SNikolay Aleksandrov } 611e12cec65SNikolay Aleksandrov 612e12cec65SNikolay Aleksandrov static void br_multicast_del_mdb_entry(struct net_bridge_mdb_entry *mp) 613e12cec65SNikolay Aleksandrov { 614e12cec65SNikolay Aleksandrov struct net_bridge *br = mp->br; 615e12cec65SNikolay Aleksandrov 616e12cec65SNikolay Aleksandrov rhashtable_remove_fast(&br->mdb_hash_tbl, &mp->rhnode, 617e12cec65SNikolay Aleksandrov br_mdb_rht_params); 618e12cec65SNikolay Aleksandrov hlist_del_init_rcu(&mp->mdb_node); 619e12cec65SNikolay Aleksandrov hlist_add_head(&mp->mcast_gc.gc_node, &br->mcast_gc_list); 620e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 621e12cec65SNikolay Aleksandrov } 622e12cec65SNikolay Aleksandrov 62388c1f37fSAllen Pais static void br_multicast_group_expired(struct timer_list *t) 624eb1d1641SHerbert Xu { 62588c1f37fSAllen Pais struct net_bridge_mdb_entry *mp = from_timer(mp, t, timer); 626eb1d1641SHerbert Xu struct net_bridge *br = mp->br; 627eb1d1641SHerbert Xu 628eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 629b0812368SNikolay Aleksandrov if (hlist_unhashed(&mp->mdb_node) || !netif_running(br->dev) || 630b0812368SNikolay Aleksandrov timer_pending(&mp->timer)) 631eb1d1641SHerbert Xu goto out; 632eb1d1641SHerbert Xu 6331bc844eeSNikolay Aleksandrov br_multicast_host_leave(mp, true); 634eb1d1641SHerbert Xu 635eb1d1641SHerbert Xu if (mp->ports) 636eb1d1641SHerbert Xu goto out; 637e12cec65SNikolay Aleksandrov br_multicast_del_mdb_entry(mp); 638eb1d1641SHerbert Xu out: 639eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 640eb1d1641SHerbert Xu } 641eb1d1641SHerbert Xu 642e12cec65SNikolay Aleksandrov static void br_multicast_destroy_group_src(struct net_bridge_mcast_gc *gc) 643e12cec65SNikolay Aleksandrov { 644e12cec65SNikolay Aleksandrov struct net_bridge_group_src *src; 645e12cec65SNikolay Aleksandrov 646e12cec65SNikolay Aleksandrov src = container_of(gc, struct net_bridge_group_src, mcast_gc); 647e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&src->node)); 648e12cec65SNikolay Aleksandrov 649e12cec65SNikolay Aleksandrov del_timer_sync(&src->timer); 650e12cec65SNikolay Aleksandrov kfree_rcu(src, rcu); 651e12cec65SNikolay Aleksandrov } 652e12cec65SNikolay Aleksandrov 653*083e3534SIdo Schimmel void __br_multicast_del_group_src(struct net_bridge_group_src *src) 6548b671779SNikolay Aleksandrov { 655085b53c8SNikolay Aleksandrov struct net_bridge *br = src->pg->key.port->br; 6568b671779SNikolay Aleksandrov 6578b671779SNikolay Aleksandrov hlist_del_init_rcu(&src->node); 6588b671779SNikolay Aleksandrov src->pg->src_ents--; 659e12cec65SNikolay Aleksandrov hlist_add_head(&src->mcast_gc.gc_node, &br->mcast_gc_list); 660e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 661e12cec65SNikolay Aleksandrov } 662e12cec65SNikolay Aleksandrov 663*083e3534SIdo Schimmel void br_multicast_del_group_src(struct net_bridge_group_src *src, 664*083e3534SIdo Schimmel bool fastleave) 665*083e3534SIdo Schimmel { 666*083e3534SIdo Schimmel br_multicast_fwd_src_remove(src, fastleave); 667*083e3534SIdo Schimmel __br_multicast_del_group_src(src); 668*083e3534SIdo Schimmel } 669*083e3534SIdo Schimmel 670e12cec65SNikolay Aleksandrov static void br_multicast_destroy_port_group(struct net_bridge_mcast_gc *gc) 671e12cec65SNikolay Aleksandrov { 672e12cec65SNikolay Aleksandrov struct net_bridge_port_group *pg; 673e12cec65SNikolay Aleksandrov 674e12cec65SNikolay Aleksandrov pg = container_of(gc, struct net_bridge_port_group, mcast_gc); 675e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&pg->mglist)); 676e12cec65SNikolay Aleksandrov WARN_ON(!hlist_empty(&pg->src_list)); 677e12cec65SNikolay Aleksandrov 678e12cec65SNikolay Aleksandrov del_timer_sync(&pg->rexmit_timer); 679e12cec65SNikolay Aleksandrov del_timer_sync(&pg->timer); 680e12cec65SNikolay Aleksandrov kfree_rcu(pg, rcu); 6818b671779SNikolay Aleksandrov } 6828b671779SNikolay Aleksandrov 683681590bdSNikolay Aleksandrov void br_multicast_del_pg(struct net_bridge_mdb_entry *mp, 684681590bdSNikolay Aleksandrov struct net_bridge_port_group *pg, 685681590bdSNikolay Aleksandrov struct net_bridge_port_group __rcu **pp) 686681590bdSNikolay Aleksandrov { 687085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 6888b671779SNikolay Aleksandrov struct net_bridge_group_src *ent; 6898b671779SNikolay Aleksandrov struct hlist_node *tmp; 690681590bdSNikolay Aleksandrov 691681590bdSNikolay Aleksandrov rcu_assign_pointer(*pp, pg->next); 692681590bdSNikolay Aleksandrov hlist_del_init(&pg->mglist); 693baa74d39SNikolay Aleksandrov br_multicast_eht_clean_sets(pg); 6948b671779SNikolay Aleksandrov hlist_for_each_entry_safe(ent, tmp, &pg->src_list, node) 695d5a10222SNikolay Aleksandrov br_multicast_del_group_src(ent, false); 69681f19838SNikolay Aleksandrov br_mdb_notify(br->dev, mp, pg, RTM_DELMDB); 69774705582SNikolay Aleksandrov if (!br_multicast_is_star_g(&mp->addr)) { 69874705582SNikolay Aleksandrov rhashtable_remove_fast(&br->sg_port_tbl, &pg->rhnode, 69974705582SNikolay Aleksandrov br_sg_port_rht_params); 7008266a049SNikolay Aleksandrov br_multicast_sg_del_exclude_ports(mp); 70174705582SNikolay Aleksandrov } else { 7028266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_INCLUDE); 70374705582SNikolay Aleksandrov } 704e12cec65SNikolay Aleksandrov hlist_add_head(&pg->mcast_gc.gc_node, &br->mcast_gc_list); 705e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 706681590bdSNikolay Aleksandrov 707681590bdSNikolay Aleksandrov if (!mp->ports && !mp->host_joined && netif_running(br->dev)) 708681590bdSNikolay Aleksandrov mod_timer(&mp->timer, jiffies); 709681590bdSNikolay Aleksandrov } 710681590bdSNikolay Aleksandrov 711681590bdSNikolay Aleksandrov static void br_multicast_find_del_pg(struct net_bridge *br, 712eb1d1641SHerbert Xu struct net_bridge_port_group *pg) 713eb1d1641SHerbert Xu { 7148b671779SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 715eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 716eb1d1641SHerbert Xu struct net_bridge_port_group *p; 717e8051688SEric Dumazet 718085b53c8SNikolay Aleksandrov mp = br_mdb_ip_get(br, &pg->key.addr); 719eb1d1641SHerbert Xu if (WARN_ON(!mp)) 720eb1d1641SHerbert Xu return; 721eb1d1641SHerbert Xu 722e8051688SEric Dumazet for (pp = &mp->ports; 723e8051688SEric Dumazet (p = mlock_dereference(*pp, br)) != NULL; 724e8051688SEric Dumazet pp = &p->next) { 725eb1d1641SHerbert Xu if (p != pg) 726eb1d1641SHerbert Xu continue; 727eb1d1641SHerbert Xu 728681590bdSNikolay Aleksandrov br_multicast_del_pg(mp, pg, pp); 729eb1d1641SHerbert Xu return; 730eb1d1641SHerbert Xu } 731eb1d1641SHerbert Xu 732eb1d1641SHerbert Xu WARN_ON(1); 733eb1d1641SHerbert Xu } 734eb1d1641SHerbert Xu 73588c1f37fSAllen Pais static void br_multicast_port_group_expired(struct timer_list *t) 736eb1d1641SHerbert Xu { 73788c1f37fSAllen Pais struct net_bridge_port_group *pg = from_timer(pg, t, timer); 738d6c33d67SNikolay Aleksandrov struct net_bridge_group_src *src_ent; 739085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 740d6c33d67SNikolay Aleksandrov struct hlist_node *tmp; 741d6c33d67SNikolay Aleksandrov bool changed; 742eb1d1641SHerbert Xu 743eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 744eb1d1641SHerbert Xu if (!netif_running(br->dev) || timer_pending(&pg->timer) || 7459d06b6d8SElad Raz hlist_unhashed(&pg->mglist) || pg->flags & MDB_PG_FLAGS_PERMANENT) 746eb1d1641SHerbert Xu goto out; 747eb1d1641SHerbert Xu 748d6c33d67SNikolay Aleksandrov changed = !!(pg->filter_mode == MCAST_EXCLUDE); 749d6c33d67SNikolay Aleksandrov pg->filter_mode = MCAST_INCLUDE; 750d6c33d67SNikolay Aleksandrov hlist_for_each_entry_safe(src_ent, tmp, &pg->src_list, node) { 751d6c33d67SNikolay Aleksandrov if (!timer_pending(&src_ent->timer)) { 752d5a10222SNikolay Aleksandrov br_multicast_del_group_src(src_ent, false); 753d6c33d67SNikolay Aleksandrov changed = true; 754d6c33d67SNikolay Aleksandrov } 755d6c33d67SNikolay Aleksandrov } 756eb1d1641SHerbert Xu 757d6c33d67SNikolay Aleksandrov if (hlist_empty(&pg->src_list)) { 758d6c33d67SNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 759d6c33d67SNikolay Aleksandrov } else if (changed) { 760085b53c8SNikolay Aleksandrov struct net_bridge_mdb_entry *mp = br_mdb_ip_get(br, &pg->key.addr); 761d6c33d67SNikolay Aleksandrov 7628266a049SNikolay Aleksandrov if (changed && br_multicast_is_star_g(&pg->key.addr)) 7638266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_INCLUDE); 7648266a049SNikolay Aleksandrov 765d6c33d67SNikolay Aleksandrov if (WARN_ON(!mp)) 766d6c33d67SNikolay Aleksandrov goto out; 767d6c33d67SNikolay Aleksandrov br_mdb_notify(br->dev, mp, pg, RTM_NEWMDB); 768d6c33d67SNikolay Aleksandrov } 769eb1d1641SHerbert Xu out: 770eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 771eb1d1641SHerbert Xu } 772eb1d1641SHerbert Xu 773e12cec65SNikolay Aleksandrov static void br_multicast_gc(struct hlist_head *head) 774e12cec65SNikolay Aleksandrov { 775e12cec65SNikolay Aleksandrov struct net_bridge_mcast_gc *gcent; 776e12cec65SNikolay Aleksandrov struct hlist_node *tmp; 777e12cec65SNikolay Aleksandrov 778e12cec65SNikolay Aleksandrov hlist_for_each_entry_safe(gcent, tmp, head, gc_node) { 779e12cec65SNikolay Aleksandrov hlist_del_init(&gcent->gc_node); 780e12cec65SNikolay Aleksandrov gcent->destroy(gcent); 781e12cec65SNikolay Aleksandrov } 782e12cec65SNikolay Aleksandrov } 783e12cec65SNikolay Aleksandrov 784615cc23eSNikolay Aleksandrov static void __br_multicast_query_handle_vlan(struct net_bridge_mcast *brmctx, 785615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 786615cc23eSNikolay Aleksandrov struct sk_buff *skb) 787615cc23eSNikolay Aleksandrov { 788615cc23eSNikolay Aleksandrov struct net_bridge_vlan *vlan = NULL; 789615cc23eSNikolay Aleksandrov 790615cc23eSNikolay Aleksandrov if (pmctx && br_multicast_port_ctx_is_vlan(pmctx)) 791615cc23eSNikolay Aleksandrov vlan = pmctx->vlan; 792615cc23eSNikolay Aleksandrov else if (br_multicast_ctx_is_vlan(brmctx)) 793615cc23eSNikolay Aleksandrov vlan = brmctx->vlan; 794615cc23eSNikolay Aleksandrov 795615cc23eSNikolay Aleksandrov if (vlan && !(vlan->flags & BRIDGE_VLAN_INFO_UNTAGGED)) { 796615cc23eSNikolay Aleksandrov u16 vlan_proto; 797615cc23eSNikolay Aleksandrov 798615cc23eSNikolay Aleksandrov if (br_vlan_get_proto(brmctx->br->dev, &vlan_proto) != 0) 799615cc23eSNikolay Aleksandrov return; 800615cc23eSNikolay Aleksandrov __vlan_hwaccel_put_tag(skb, htons(vlan_proto), vlan->vid); 801615cc23eSNikolay Aleksandrov } 802615cc23eSNikolay Aleksandrov } 803615cc23eSNikolay Aleksandrov 804adc47037SNikolay Aleksandrov static struct sk_buff *br_ip4_multicast_alloc_query(struct net_bridge_mcast *brmctx, 805615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 806438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 807438ef2d0SNikolay Aleksandrov __be32 ip_dst, __be32 group, 808438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_lmqt, 80942c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 81042c11ccfSNikolay Aleksandrov bool *need_rexmit) 811eb1d1641SHerbert Xu { 812085b53c8SNikolay Aleksandrov struct net_bridge_port *p = pg ? pg->key.port : NULL; 813438ef2d0SNikolay Aleksandrov struct net_bridge_group_src *ent; 814438ef2d0SNikolay Aleksandrov size_t pkt_size, igmp_hdr_size; 815438ef2d0SNikolay Aleksandrov unsigned long now = jiffies; 8165e923585SNikolay Aleksandrov struct igmpv3_query *ihv3; 817438ef2d0SNikolay Aleksandrov void *csum_start = NULL; 818438ef2d0SNikolay Aleksandrov __sum16 *csum = NULL; 819eb1d1641SHerbert Xu struct sk_buff *skb; 820eb1d1641SHerbert Xu struct igmphdr *ih; 821eb1d1641SHerbert Xu struct ethhdr *eth; 822438ef2d0SNikolay Aleksandrov unsigned long lmqt; 823eb1d1641SHerbert Xu struct iphdr *iph; 824438ef2d0SNikolay Aleksandrov u16 lmqt_srcs = 0; 825eb1d1641SHerbert Xu 8265e923585SNikolay Aleksandrov igmp_hdr_size = sizeof(*ih); 827d3d065c0SNikolay Aleksandrov if (brmctx->multicast_igmp_version == 3) { 8285e923585SNikolay Aleksandrov igmp_hdr_size = sizeof(*ihv3); 829438ef2d0SNikolay Aleksandrov if (pg && with_srcs) { 830d3d065c0SNikolay Aleksandrov lmqt = now + (brmctx->multicast_last_member_interval * 831d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_count); 832438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 833438ef2d0SNikolay Aleksandrov if (over_lmqt == time_after(ent->timer.expires, 834438ef2d0SNikolay Aleksandrov lmqt) && 835438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) 836438ef2d0SNikolay Aleksandrov lmqt_srcs++; 837438ef2d0SNikolay Aleksandrov } 838438ef2d0SNikolay Aleksandrov 839438ef2d0SNikolay Aleksandrov if (!lmqt_srcs) 840438ef2d0SNikolay Aleksandrov return NULL; 841438ef2d0SNikolay Aleksandrov igmp_hdr_size += lmqt_srcs * sizeof(__be32); 842438ef2d0SNikolay Aleksandrov } 843438ef2d0SNikolay Aleksandrov } 844438ef2d0SNikolay Aleksandrov 845438ef2d0SNikolay Aleksandrov pkt_size = sizeof(*eth) + sizeof(*iph) + 4 + igmp_hdr_size; 846438ef2d0SNikolay Aleksandrov if ((p && pkt_size > p->dev->mtu) || 847adc47037SNikolay Aleksandrov pkt_size > brmctx->br->dev->mtu) 848438ef2d0SNikolay Aleksandrov return NULL; 849438ef2d0SNikolay Aleksandrov 850adc47037SNikolay Aleksandrov skb = netdev_alloc_skb_ip_align(brmctx->br->dev, pkt_size); 851eb1d1641SHerbert Xu if (!skb) 852eb1d1641SHerbert Xu goto out; 853eb1d1641SHerbert Xu 854615cc23eSNikolay Aleksandrov __br_multicast_query_handle_vlan(brmctx, pmctx, skb); 855eb1d1641SHerbert Xu skb->protocol = htons(ETH_P_IP); 856eb1d1641SHerbert Xu 857eb1d1641SHerbert Xu skb_reset_mac_header(skb); 858eb1d1641SHerbert Xu eth = eth_hdr(skb); 859eb1d1641SHerbert Xu 860adc47037SNikolay Aleksandrov ether_addr_copy(eth->h_source, brmctx->br->dev->dev_addr); 861438ef2d0SNikolay Aleksandrov ip_eth_mc_map(ip_dst, eth->h_dest); 862eb1d1641SHerbert Xu eth->h_proto = htons(ETH_P_IP); 863eb1d1641SHerbert Xu skb_put(skb, sizeof(*eth)); 864eb1d1641SHerbert Xu 865eb1d1641SHerbert Xu skb_set_network_header(skb, skb->len); 866eb1d1641SHerbert Xu iph = ip_hdr(skb); 867438ef2d0SNikolay Aleksandrov iph->tot_len = htons(pkt_size - sizeof(*eth)); 868eb1d1641SHerbert Xu 869eb1d1641SHerbert Xu iph->version = 4; 870eb1d1641SHerbert Xu iph->ihl = 6; 871eb1d1641SHerbert Xu iph->tos = 0xc0; 872eb1d1641SHerbert Xu iph->id = 0; 873eb1d1641SHerbert Xu iph->frag_off = htons(IP_DF); 874eb1d1641SHerbert Xu iph->ttl = 1; 875eb1d1641SHerbert Xu iph->protocol = IPPROTO_IGMP; 876adc47037SNikolay Aleksandrov iph->saddr = br_opt_get(brmctx->br, BROPT_MULTICAST_QUERY_USE_IFADDR) ? 877adc47037SNikolay Aleksandrov inet_select_addr(brmctx->br->dev, 0, RT_SCOPE_LINK) : 0; 878438ef2d0SNikolay Aleksandrov iph->daddr = ip_dst; 879eb1d1641SHerbert Xu ((u8 *)&iph[1])[0] = IPOPT_RA; 880eb1d1641SHerbert Xu ((u8 *)&iph[1])[1] = 4; 881eb1d1641SHerbert Xu ((u8 *)&iph[1])[2] = 0; 882eb1d1641SHerbert Xu ((u8 *)&iph[1])[3] = 0; 883eb1d1641SHerbert Xu ip_send_check(iph); 884eb1d1641SHerbert Xu skb_put(skb, 24); 885eb1d1641SHerbert Xu 886eb1d1641SHerbert Xu skb_set_transport_header(skb, skb->len); 8871080ab95SNikolay Aleksandrov *igmp_type = IGMP_HOST_MEMBERSHIP_QUERY; 8885e923585SNikolay Aleksandrov 889d3d065c0SNikolay Aleksandrov switch (brmctx->multicast_igmp_version) { 8905e923585SNikolay Aleksandrov case 2: 8915e923585SNikolay Aleksandrov ih = igmp_hdr(skb); 892eb1d1641SHerbert Xu ih->type = IGMP_HOST_MEMBERSHIP_QUERY; 893d3d065c0SNikolay Aleksandrov ih->code = (group ? brmctx->multicast_last_member_interval : 894d3d065c0SNikolay Aleksandrov brmctx->multicast_query_response_interval) / 895eb1d1641SHerbert Xu (HZ / IGMP_TIMER_SCALE); 896eb1d1641SHerbert Xu ih->group = group; 897eb1d1641SHerbert Xu ih->csum = 0; 898438ef2d0SNikolay Aleksandrov csum = &ih->csum; 899438ef2d0SNikolay Aleksandrov csum_start = (void *)ih; 9005e923585SNikolay Aleksandrov break; 9015e923585SNikolay Aleksandrov case 3: 9025e923585SNikolay Aleksandrov ihv3 = igmpv3_query_hdr(skb); 9035e923585SNikolay Aleksandrov ihv3->type = IGMP_HOST_MEMBERSHIP_QUERY; 904d3d065c0SNikolay Aleksandrov ihv3->code = (group ? brmctx->multicast_last_member_interval : 905d3d065c0SNikolay Aleksandrov brmctx->multicast_query_response_interval) / 9065e923585SNikolay Aleksandrov (HZ / IGMP_TIMER_SCALE); 9075e923585SNikolay Aleksandrov ihv3->group = group; 908d3d065c0SNikolay Aleksandrov ihv3->qqic = brmctx->multicast_query_interval / HZ; 909438ef2d0SNikolay Aleksandrov ihv3->nsrcs = htons(lmqt_srcs); 9105e923585SNikolay Aleksandrov ihv3->resv = 0; 911438ef2d0SNikolay Aleksandrov ihv3->suppress = sflag; 9125e923585SNikolay Aleksandrov ihv3->qrv = 2; 9135e923585SNikolay Aleksandrov ihv3->csum = 0; 914438ef2d0SNikolay Aleksandrov csum = &ihv3->csum; 915438ef2d0SNikolay Aleksandrov csum_start = (void *)ihv3; 916438ef2d0SNikolay Aleksandrov if (!pg || !with_srcs) 917438ef2d0SNikolay Aleksandrov break; 918438ef2d0SNikolay Aleksandrov 919438ef2d0SNikolay Aleksandrov lmqt_srcs = 0; 920438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 921438ef2d0SNikolay Aleksandrov if (over_lmqt == time_after(ent->timer.expires, 922438ef2d0SNikolay Aleksandrov lmqt) && 923438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) { 924deb96566SNikolay Aleksandrov ihv3->srcs[lmqt_srcs++] = ent->addr.src.ip4; 925438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt--; 92642c11ccfSNikolay Aleksandrov if (need_rexmit && ent->src_query_rexmit_cnt) 92742c11ccfSNikolay Aleksandrov *need_rexmit = true; 928438ef2d0SNikolay Aleksandrov } 929438ef2d0SNikolay Aleksandrov } 930438ef2d0SNikolay Aleksandrov if (WARN_ON(lmqt_srcs != ntohs(ihv3->nsrcs))) { 931438ef2d0SNikolay Aleksandrov kfree_skb(skb); 932438ef2d0SNikolay Aleksandrov return NULL; 933438ef2d0SNikolay Aleksandrov } 9345e923585SNikolay Aleksandrov break; 9355e923585SNikolay Aleksandrov } 936eb1d1641SHerbert Xu 937438ef2d0SNikolay Aleksandrov if (WARN_ON(!csum || !csum_start)) { 938438ef2d0SNikolay Aleksandrov kfree_skb(skb); 939438ef2d0SNikolay Aleksandrov return NULL; 940438ef2d0SNikolay Aleksandrov } 941438ef2d0SNikolay Aleksandrov 942438ef2d0SNikolay Aleksandrov *csum = ip_compute_csum(csum_start, igmp_hdr_size); 9435e923585SNikolay Aleksandrov skb_put(skb, igmp_hdr_size); 944eb1d1641SHerbert Xu __skb_pull(skb, sizeof(*eth)); 945eb1d1641SHerbert Xu 946eb1d1641SHerbert Xu out: 947eb1d1641SHerbert Xu return skb; 948eb1d1641SHerbert Xu } 949eb1d1641SHerbert Xu 950dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 951adc47037SNikolay Aleksandrov static struct sk_buff *br_ip6_multicast_alloc_query(struct net_bridge_mcast *brmctx, 952615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 953438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 954438ef2d0SNikolay Aleksandrov const struct in6_addr *ip6_dst, 955438ef2d0SNikolay Aleksandrov const struct in6_addr *group, 956438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_llqt, 95742c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 95842c11ccfSNikolay Aleksandrov bool *need_rexmit) 95908b202b6SYOSHIFUJI Hideaki { 960085b53c8SNikolay Aleksandrov struct net_bridge_port *p = pg ? pg->key.port : NULL; 961438ef2d0SNikolay Aleksandrov struct net_bridge_group_src *ent; 962438ef2d0SNikolay Aleksandrov size_t pkt_size, mld_hdr_size; 963438ef2d0SNikolay Aleksandrov unsigned long now = jiffies; 964aa2ae3e7SNikolay Aleksandrov struct mld2_query *mld2q; 965438ef2d0SNikolay Aleksandrov void *csum_start = NULL; 966aa2ae3e7SNikolay Aleksandrov unsigned long interval; 967438ef2d0SNikolay Aleksandrov __sum16 *csum = NULL; 96808b202b6SYOSHIFUJI Hideaki struct ipv6hdr *ip6h; 96908b202b6SYOSHIFUJI Hideaki struct mld_msg *mldq; 970aa2ae3e7SNikolay Aleksandrov struct sk_buff *skb; 971438ef2d0SNikolay Aleksandrov unsigned long llqt; 97208b202b6SYOSHIFUJI Hideaki struct ethhdr *eth; 973438ef2d0SNikolay Aleksandrov u16 llqt_srcs = 0; 97408b202b6SYOSHIFUJI Hideaki u8 *hopopt; 97508b202b6SYOSHIFUJI Hideaki 976aa2ae3e7SNikolay Aleksandrov mld_hdr_size = sizeof(*mldq); 977d3d065c0SNikolay Aleksandrov if (brmctx->multicast_mld_version == 2) { 978aa2ae3e7SNikolay Aleksandrov mld_hdr_size = sizeof(*mld2q); 979438ef2d0SNikolay Aleksandrov if (pg && with_srcs) { 980d3d065c0SNikolay Aleksandrov llqt = now + (brmctx->multicast_last_member_interval * 981d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_count); 982438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 983438ef2d0SNikolay Aleksandrov if (over_llqt == time_after(ent->timer.expires, 984438ef2d0SNikolay Aleksandrov llqt) && 985438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) 986438ef2d0SNikolay Aleksandrov llqt_srcs++; 987438ef2d0SNikolay Aleksandrov } 988438ef2d0SNikolay Aleksandrov 989438ef2d0SNikolay Aleksandrov if (!llqt_srcs) 990438ef2d0SNikolay Aleksandrov return NULL; 991438ef2d0SNikolay Aleksandrov mld_hdr_size += llqt_srcs * sizeof(struct in6_addr); 992438ef2d0SNikolay Aleksandrov } 993438ef2d0SNikolay Aleksandrov } 994438ef2d0SNikolay Aleksandrov 995438ef2d0SNikolay Aleksandrov pkt_size = sizeof(*eth) + sizeof(*ip6h) + 8 + mld_hdr_size; 996438ef2d0SNikolay Aleksandrov if ((p && pkt_size > p->dev->mtu) || 997adc47037SNikolay Aleksandrov pkt_size > brmctx->br->dev->mtu) 998438ef2d0SNikolay Aleksandrov return NULL; 999438ef2d0SNikolay Aleksandrov 1000adc47037SNikolay Aleksandrov skb = netdev_alloc_skb_ip_align(brmctx->br->dev, pkt_size); 100108b202b6SYOSHIFUJI Hideaki if (!skb) 100208b202b6SYOSHIFUJI Hideaki goto out; 100308b202b6SYOSHIFUJI Hideaki 1004615cc23eSNikolay Aleksandrov __br_multicast_query_handle_vlan(brmctx, pmctx, skb); 100508b202b6SYOSHIFUJI Hideaki skb->protocol = htons(ETH_P_IPV6); 100608b202b6SYOSHIFUJI Hideaki 100708b202b6SYOSHIFUJI Hideaki /* Ethernet header */ 100808b202b6SYOSHIFUJI Hideaki skb_reset_mac_header(skb); 100908b202b6SYOSHIFUJI Hideaki eth = eth_hdr(skb); 101008b202b6SYOSHIFUJI Hideaki 1011adc47037SNikolay Aleksandrov ether_addr_copy(eth->h_source, brmctx->br->dev->dev_addr); 101208b202b6SYOSHIFUJI Hideaki eth->h_proto = htons(ETH_P_IPV6); 101308b202b6SYOSHIFUJI Hideaki skb_put(skb, sizeof(*eth)); 101408b202b6SYOSHIFUJI Hideaki 101508b202b6SYOSHIFUJI Hideaki /* IPv6 header + HbH option */ 101608b202b6SYOSHIFUJI Hideaki skb_set_network_header(skb, skb->len); 101708b202b6SYOSHIFUJI Hideaki ip6h = ipv6_hdr(skb); 101808b202b6SYOSHIFUJI Hideaki 101908b202b6SYOSHIFUJI Hideaki *(__force __be32 *)ip6h = htonl(0x60000000); 1020aa2ae3e7SNikolay Aleksandrov ip6h->payload_len = htons(8 + mld_hdr_size); 102108b202b6SYOSHIFUJI Hideaki ip6h->nexthdr = IPPROTO_HOPOPTS; 102208b202b6SYOSHIFUJI Hideaki ip6h->hop_limit = 1; 1023438ef2d0SNikolay Aleksandrov ip6h->daddr = *ip6_dst; 1024adc47037SNikolay Aleksandrov if (ipv6_dev_get_saddr(dev_net(brmctx->br->dev), brmctx->br->dev, 1025adc47037SNikolay Aleksandrov &ip6h->daddr, 0, &ip6h->saddr)) { 1026d1d81d4cSUlrich Weber kfree_skb(skb); 1027adc47037SNikolay Aleksandrov br_opt_toggle(brmctx->br, BROPT_HAS_IPV6_ADDR, false); 1028d1d81d4cSUlrich Weber return NULL; 1029d1d81d4cSUlrich Weber } 10300888d5f3Sdaniel 1031adc47037SNikolay Aleksandrov br_opt_toggle(brmctx->br, BROPT_HAS_IPV6_ADDR, true); 103236cff5a1SLinus Lüssing ipv6_eth_mc_map(&ip6h->daddr, eth->h_dest); 103308b202b6SYOSHIFUJI Hideaki 103408b202b6SYOSHIFUJI Hideaki hopopt = (u8 *)(ip6h + 1); 103508b202b6SYOSHIFUJI Hideaki hopopt[0] = IPPROTO_ICMPV6; /* next hdr */ 103608b202b6SYOSHIFUJI Hideaki hopopt[1] = 0; /* length of HbH */ 103708b202b6SYOSHIFUJI Hideaki hopopt[2] = IPV6_TLV_ROUTERALERT; /* Router Alert */ 103808b202b6SYOSHIFUJI Hideaki hopopt[3] = 2; /* Length of RA Option */ 103908b202b6SYOSHIFUJI Hideaki hopopt[4] = 0; /* Type = 0x0000 (MLD) */ 104008b202b6SYOSHIFUJI Hideaki hopopt[5] = 0; 10411de5a71cSEldad Zack hopopt[6] = IPV6_TLV_PAD1; /* Pad1 */ 10421de5a71cSEldad Zack hopopt[7] = IPV6_TLV_PAD1; /* Pad1 */ 104308b202b6SYOSHIFUJI Hideaki 104408b202b6SYOSHIFUJI Hideaki skb_put(skb, sizeof(*ip6h) + 8); 104508b202b6SYOSHIFUJI Hideaki 104608b202b6SYOSHIFUJI Hideaki /* ICMPv6 */ 104708b202b6SYOSHIFUJI Hideaki skb_set_transport_header(skb, skb->len); 1048438ef2d0SNikolay Aleksandrov interval = ipv6_addr_any(group) ? 1049d3d065c0SNikolay Aleksandrov brmctx->multicast_query_response_interval : 1050d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval; 10511080ab95SNikolay Aleksandrov *igmp_type = ICMPV6_MGM_QUERY; 1052d3d065c0SNikolay Aleksandrov switch (brmctx->multicast_mld_version) { 1053aa2ae3e7SNikolay Aleksandrov case 1: 1054aa2ae3e7SNikolay Aleksandrov mldq = (struct mld_msg *)icmp6_hdr(skb); 105508b202b6SYOSHIFUJI Hideaki mldq->mld_type = ICMPV6_MGM_QUERY; 105608b202b6SYOSHIFUJI Hideaki mldq->mld_code = 0; 105708b202b6SYOSHIFUJI Hideaki mldq->mld_cksum = 0; 105808b202b6SYOSHIFUJI Hideaki mldq->mld_maxdelay = htons((u16)jiffies_to_msecs(interval)); 105908b202b6SYOSHIFUJI Hideaki mldq->mld_reserved = 0; 1060438ef2d0SNikolay Aleksandrov mldq->mld_mca = *group; 1061438ef2d0SNikolay Aleksandrov csum = &mldq->mld_cksum; 1062438ef2d0SNikolay Aleksandrov csum_start = (void *)mldq; 1063aa2ae3e7SNikolay Aleksandrov break; 1064aa2ae3e7SNikolay Aleksandrov case 2: 1065aa2ae3e7SNikolay Aleksandrov mld2q = (struct mld2_query *)icmp6_hdr(skb); 106653631a5fSLance Richardson mld2q->mld2q_mrc = htons((u16)jiffies_to_msecs(interval)); 1067aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_type = ICMPV6_MGM_QUERY; 1068aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_code = 0; 1069aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_cksum = 0; 1070aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_resv1 = 0; 1071aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_resv2 = 0; 1072438ef2d0SNikolay Aleksandrov mld2q->mld2q_suppress = sflag; 1073aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_qrv = 2; 1074438ef2d0SNikolay Aleksandrov mld2q->mld2q_nsrcs = htons(llqt_srcs); 1075d3d065c0SNikolay Aleksandrov mld2q->mld2q_qqic = brmctx->multicast_query_interval / HZ; 1076438ef2d0SNikolay Aleksandrov mld2q->mld2q_mca = *group; 1077438ef2d0SNikolay Aleksandrov csum = &mld2q->mld2q_cksum; 1078438ef2d0SNikolay Aleksandrov csum_start = (void *)mld2q; 1079438ef2d0SNikolay Aleksandrov if (!pg || !with_srcs) 1080438ef2d0SNikolay Aleksandrov break; 1081438ef2d0SNikolay Aleksandrov 1082438ef2d0SNikolay Aleksandrov llqt_srcs = 0; 1083438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 1084438ef2d0SNikolay Aleksandrov if (over_llqt == time_after(ent->timer.expires, 1085438ef2d0SNikolay Aleksandrov llqt) && 1086438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) { 1087deb96566SNikolay Aleksandrov mld2q->mld2q_srcs[llqt_srcs++] = ent->addr.src.ip6; 1088438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt--; 108942c11ccfSNikolay Aleksandrov if (need_rexmit && ent->src_query_rexmit_cnt) 109042c11ccfSNikolay Aleksandrov *need_rexmit = true; 1091438ef2d0SNikolay Aleksandrov } 1092438ef2d0SNikolay Aleksandrov } 1093438ef2d0SNikolay Aleksandrov if (WARN_ON(llqt_srcs != ntohs(mld2q->mld2q_nsrcs))) { 1094438ef2d0SNikolay Aleksandrov kfree_skb(skb); 1095438ef2d0SNikolay Aleksandrov return NULL; 1096438ef2d0SNikolay Aleksandrov } 1097aa2ae3e7SNikolay Aleksandrov break; 1098aa2ae3e7SNikolay Aleksandrov } 109908b202b6SYOSHIFUJI Hideaki 1100438ef2d0SNikolay Aleksandrov if (WARN_ON(!csum || !csum_start)) { 1101438ef2d0SNikolay Aleksandrov kfree_skb(skb); 1102438ef2d0SNikolay Aleksandrov return NULL; 1103438ef2d0SNikolay Aleksandrov } 1104438ef2d0SNikolay Aleksandrov 1105438ef2d0SNikolay Aleksandrov *csum = csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr, mld_hdr_size, 1106438ef2d0SNikolay Aleksandrov IPPROTO_ICMPV6, 1107438ef2d0SNikolay Aleksandrov csum_partial(csum_start, mld_hdr_size, 0)); 1108438ef2d0SNikolay Aleksandrov skb_put(skb, mld_hdr_size); 110908b202b6SYOSHIFUJI Hideaki __skb_pull(skb, sizeof(*eth)); 111008b202b6SYOSHIFUJI Hideaki 111108b202b6SYOSHIFUJI Hideaki out: 111208b202b6SYOSHIFUJI Hideaki return skb; 111308b202b6SYOSHIFUJI Hideaki } 111408b202b6SYOSHIFUJI Hideaki #endif 111508b202b6SYOSHIFUJI Hideaki 1116adc47037SNikolay Aleksandrov static struct sk_buff *br_multicast_alloc_query(struct net_bridge_mcast *brmctx, 1117615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1118438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 1119438ef2d0SNikolay Aleksandrov struct br_ip *ip_dst, 1120438ef2d0SNikolay Aleksandrov struct br_ip *group, 1121438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_lmqt, 112242c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 112342c11ccfSNikolay Aleksandrov bool *need_rexmit) 11248ef2a9a5SYOSHIFUJI Hideaki { 1125438ef2d0SNikolay Aleksandrov __be32 ip4_dst; 1126438ef2d0SNikolay Aleksandrov 1127438ef2d0SNikolay Aleksandrov switch (group->proto) { 11288ef2a9a5SYOSHIFUJI Hideaki case htons(ETH_P_IP): 1129eab3227bSNikolay Aleksandrov ip4_dst = ip_dst ? ip_dst->dst.ip4 : htonl(INADDR_ALLHOSTS_GROUP); 1130615cc23eSNikolay Aleksandrov return br_ip4_multicast_alloc_query(brmctx, pmctx, pg, 1131eab3227bSNikolay Aleksandrov ip4_dst, group->dst.ip4, 1132438ef2d0SNikolay Aleksandrov with_srcs, over_lmqt, 113342c11ccfSNikolay Aleksandrov sflag, igmp_type, 113442c11ccfSNikolay Aleksandrov need_rexmit); 1135dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1136438ef2d0SNikolay Aleksandrov case htons(ETH_P_IPV6): { 1137438ef2d0SNikolay Aleksandrov struct in6_addr ip6_dst; 1138438ef2d0SNikolay Aleksandrov 1139438ef2d0SNikolay Aleksandrov if (ip_dst) 1140eab3227bSNikolay Aleksandrov ip6_dst = ip_dst->dst.ip6; 1141438ef2d0SNikolay Aleksandrov else 1142438ef2d0SNikolay Aleksandrov ipv6_addr_set(&ip6_dst, htonl(0xff020000), 0, 0, 1143438ef2d0SNikolay Aleksandrov htonl(1)); 1144438ef2d0SNikolay Aleksandrov 1145615cc23eSNikolay Aleksandrov return br_ip6_multicast_alloc_query(brmctx, pmctx, pg, 1146eab3227bSNikolay Aleksandrov &ip6_dst, &group->dst.ip6, 1147438ef2d0SNikolay Aleksandrov with_srcs, over_lmqt, 114842c11ccfSNikolay Aleksandrov sflag, igmp_type, 114942c11ccfSNikolay Aleksandrov need_rexmit); 1150438ef2d0SNikolay Aleksandrov } 115108b202b6SYOSHIFUJI Hideaki #endif 11528ef2a9a5SYOSHIFUJI Hideaki } 11538ef2a9a5SYOSHIFUJI Hideaki return NULL; 11548ef2a9a5SYOSHIFUJI Hideaki } 11558ef2a9a5SYOSHIFUJI Hideaki 1156cfd56754SCong Wang struct net_bridge_mdb_entry *br_multicast_new_group(struct net_bridge *br, 11575e923585SNikolay Aleksandrov struct br_ip *group) 1158eb1d1641SHerbert Xu { 1159eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 11604c0833bcSTobias Klauser int err; 1161eb1d1641SHerbert Xu 116219e3a9c9SNikolay Aleksandrov mp = br_mdb_ip_get(br, group); 116319e3a9c9SNikolay Aleksandrov if (mp) 116419e3a9c9SNikolay Aleksandrov return mp; 1165eb1d1641SHerbert Xu 116619e3a9c9SNikolay Aleksandrov if (atomic_read(&br->mdb_hash_tbl.nelems) >= br->hash_max) { 1167c832962aSOleksandr Mazur br_mc_disabled_update(br->dev, false, NULL); 116819e3a9c9SNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_ENABLED, false); 116919e3a9c9SNikolay Aleksandrov return ERR_PTR(-E2BIG); 1170eb1d1641SHerbert Xu } 1171eb1d1641SHerbert Xu 1172eb1d1641SHerbert Xu mp = kzalloc(sizeof(*mp), GFP_ATOMIC); 1173eb1d1641SHerbert Xu if (unlikely(!mp)) 11744c0833bcSTobias Klauser return ERR_PTR(-ENOMEM); 1175eb1d1641SHerbert Xu 1176eb1d1641SHerbert Xu mp->br = br; 11778ef2a9a5SYOSHIFUJI Hideaki mp->addr = *group; 1178e12cec65SNikolay Aleksandrov mp->mcast_gc.destroy = br_multicast_destroy_mdb_entry; 117988c1f37fSAllen Pais timer_setup(&mp->timer, br_multicast_group_expired, 0); 118019e3a9c9SNikolay Aleksandrov err = rhashtable_lookup_insert_fast(&br->mdb_hash_tbl, &mp->rhnode, 118119e3a9c9SNikolay Aleksandrov br_mdb_rht_params); 118219e3a9c9SNikolay Aleksandrov if (err) { 118319e3a9c9SNikolay Aleksandrov kfree(mp); 118419e3a9c9SNikolay Aleksandrov mp = ERR_PTR(err); 118519e3a9c9SNikolay Aleksandrov } else { 118619e3a9c9SNikolay Aleksandrov hlist_add_head_rcu(&mp->mdb_node, &br->mdb_list); 118719e3a9c9SNikolay Aleksandrov } 11881faabf2aSEric Dumazet 1189eb1d1641SHerbert Xu return mp; 1190eb1d1641SHerbert Xu } 1191eb1d1641SHerbert Xu 11928b671779SNikolay Aleksandrov static void br_multicast_group_src_expired(struct timer_list *t) 11938b671779SNikolay Aleksandrov { 11948b671779SNikolay Aleksandrov struct net_bridge_group_src *src = from_timer(src, t, timer); 11958b671779SNikolay Aleksandrov struct net_bridge_port_group *pg; 11968b671779SNikolay Aleksandrov struct net_bridge *br = src->br; 11978b671779SNikolay Aleksandrov 11988b671779SNikolay Aleksandrov spin_lock(&br->multicast_lock); 11998b671779SNikolay Aleksandrov if (hlist_unhashed(&src->node) || !netif_running(br->dev) || 12008b671779SNikolay Aleksandrov timer_pending(&src->timer)) 12018b671779SNikolay Aleksandrov goto out; 12028b671779SNikolay Aleksandrov 12038b671779SNikolay Aleksandrov pg = src->pg; 12048b671779SNikolay Aleksandrov if (pg->filter_mode == MCAST_INCLUDE) { 1205d5a10222SNikolay Aleksandrov br_multicast_del_group_src(src, false); 12068b671779SNikolay Aleksandrov if (!hlist_empty(&pg->src_list)) 12078b671779SNikolay Aleksandrov goto out; 12088b671779SNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 12099116ffbfSNikolay Aleksandrov } else { 12109116ffbfSNikolay Aleksandrov br_multicast_fwd_src_handle(src); 12118b671779SNikolay Aleksandrov } 12129116ffbfSNikolay Aleksandrov 12138b671779SNikolay Aleksandrov out: 12148b671779SNikolay Aleksandrov spin_unlock(&br->multicast_lock); 12158b671779SNikolay Aleksandrov } 12168b671779SNikolay Aleksandrov 1217474ddb37SNikolay Aleksandrov struct net_bridge_group_src * 12188b671779SNikolay Aleksandrov br_multicast_find_group_src(struct net_bridge_port_group *pg, struct br_ip *ip) 12198b671779SNikolay Aleksandrov { 12208b671779SNikolay Aleksandrov struct net_bridge_group_src *ent; 12218b671779SNikolay Aleksandrov 12228b671779SNikolay Aleksandrov switch (ip->proto) { 12238b671779SNikolay Aleksandrov case htons(ETH_P_IP): 12248b671779SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1225deb96566SNikolay Aleksandrov if (ip->src.ip4 == ent->addr.src.ip4) 12268b671779SNikolay Aleksandrov return ent; 12278b671779SNikolay Aleksandrov break; 12288b671779SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 12298b671779SNikolay Aleksandrov case htons(ETH_P_IPV6): 12308b671779SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1231deb96566SNikolay Aleksandrov if (!ipv6_addr_cmp(&ent->addr.src.ip6, &ip->src.ip6)) 12328b671779SNikolay Aleksandrov return ent; 12338b671779SNikolay Aleksandrov break; 12348b671779SNikolay Aleksandrov #endif 12358b671779SNikolay Aleksandrov } 12368b671779SNikolay Aleksandrov 12378b671779SNikolay Aleksandrov return NULL; 12388b671779SNikolay Aleksandrov } 12398b671779SNikolay Aleksandrov 1240fd0c6961SIdo Schimmel struct net_bridge_group_src * 12418b671779SNikolay Aleksandrov br_multicast_new_group_src(struct net_bridge_port_group *pg, struct br_ip *src_ip) 12428b671779SNikolay Aleksandrov { 12438b671779SNikolay Aleksandrov struct net_bridge_group_src *grp_src; 12448b671779SNikolay Aleksandrov 12458b671779SNikolay Aleksandrov if (unlikely(pg->src_ents >= PG_SRC_ENT_LIMIT)) 12468b671779SNikolay Aleksandrov return NULL; 12478b671779SNikolay Aleksandrov 12488b671779SNikolay Aleksandrov switch (src_ip->proto) { 12498b671779SNikolay Aleksandrov case htons(ETH_P_IP): 1250deb96566SNikolay Aleksandrov if (ipv4_is_zeronet(src_ip->src.ip4) || 1251deb96566SNikolay Aleksandrov ipv4_is_multicast(src_ip->src.ip4)) 12528b671779SNikolay Aleksandrov return NULL; 12538b671779SNikolay Aleksandrov break; 12548b671779SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 12558b671779SNikolay Aleksandrov case htons(ETH_P_IPV6): 1256deb96566SNikolay Aleksandrov if (ipv6_addr_any(&src_ip->src.ip6) || 1257deb96566SNikolay Aleksandrov ipv6_addr_is_multicast(&src_ip->src.ip6)) 12588b671779SNikolay Aleksandrov return NULL; 12598b671779SNikolay Aleksandrov break; 12608b671779SNikolay Aleksandrov #endif 12618b671779SNikolay Aleksandrov } 12628b671779SNikolay Aleksandrov 12638b671779SNikolay Aleksandrov grp_src = kzalloc(sizeof(*grp_src), GFP_ATOMIC); 12648b671779SNikolay Aleksandrov if (unlikely(!grp_src)) 12658b671779SNikolay Aleksandrov return NULL; 12668b671779SNikolay Aleksandrov 12678b671779SNikolay Aleksandrov grp_src->pg = pg; 1268085b53c8SNikolay Aleksandrov grp_src->br = pg->key.port->br; 12698b671779SNikolay Aleksandrov grp_src->addr = *src_ip; 1270e12cec65SNikolay Aleksandrov grp_src->mcast_gc.destroy = br_multicast_destroy_group_src; 12718b671779SNikolay Aleksandrov timer_setup(&grp_src->timer, br_multicast_group_src_expired, 0); 12728b671779SNikolay Aleksandrov 12738b671779SNikolay Aleksandrov hlist_add_head_rcu(&grp_src->node, &pg->src_list); 12748b671779SNikolay Aleksandrov pg->src_ents++; 12758b671779SNikolay Aleksandrov 12768b671779SNikolay Aleksandrov return grp_src; 12778b671779SNikolay Aleksandrov } 12788b671779SNikolay Aleksandrov 1279cfd56754SCong Wang struct net_bridge_port_group *br_multicast_new_port_group( 1280cfd56754SCong Wang struct net_bridge_port *port, 1281f86c3e2cSIdo Schimmel const struct br_ip *group, 1282ccb1c31aSAmerigo Wang struct net_bridge_port_group __rcu *next, 12836db6f0eaSFelix Fietkau unsigned char flags, 12848b671779SNikolay Aleksandrov const unsigned char *src, 12858f8cb77eSNikolay Aleksandrov u8 filter_mode, 12868f8cb77eSNikolay Aleksandrov u8 rt_protocol) 1287cfd56754SCong Wang { 1288cfd56754SCong Wang struct net_bridge_port_group *p; 1289cfd56754SCong Wang 1290cfd56754SCong Wang p = kzalloc(sizeof(*p), GFP_ATOMIC); 1291cfd56754SCong Wang if (unlikely(!p)) 1292cfd56754SCong Wang return NULL; 1293cfd56754SCong Wang 1294085b53c8SNikolay Aleksandrov p->key.addr = *group; 1295085b53c8SNikolay Aleksandrov p->key.port = port; 12969d06b6d8SElad Raz p->flags = flags; 12978b671779SNikolay Aleksandrov p->filter_mode = filter_mode; 12988f8cb77eSNikolay Aleksandrov p->rt_protocol = rt_protocol; 12995b163288SNikolay Aleksandrov p->eht_host_tree = RB_ROOT; 1300baa74d39SNikolay Aleksandrov p->eht_set_tree = RB_ROOT; 1301e12cec65SNikolay Aleksandrov p->mcast_gc.destroy = br_multicast_destroy_port_group; 13028b671779SNikolay Aleksandrov INIT_HLIST_HEAD(&p->src_list); 1303085b53c8SNikolay Aleksandrov 1304085b53c8SNikolay Aleksandrov if (!br_multicast_is_star_g(group) && 1305085b53c8SNikolay Aleksandrov rhashtable_lookup_insert_fast(&port->br->sg_port_tbl, &p->rhnode, 1306085b53c8SNikolay Aleksandrov br_sg_port_rht_params)) { 1307085b53c8SNikolay Aleksandrov kfree(p); 1308085b53c8SNikolay Aleksandrov return NULL; 1309085b53c8SNikolay Aleksandrov } 1310085b53c8SNikolay Aleksandrov 1311eca2a43bSstephen hemminger rcu_assign_pointer(p->next, next); 131288c1f37fSAllen Pais timer_setup(&p->timer, br_multicast_port_group_expired, 0); 131342c11ccfSNikolay Aleksandrov timer_setup(&p->rexmit_timer, br_multicast_port_group_rexmit, 0); 131442c11ccfSNikolay Aleksandrov hlist_add_head(&p->mglist, &port->mglist); 13156db6f0eaSFelix Fietkau 13166db6f0eaSFelix Fietkau if (src) 13176db6f0eaSFelix Fietkau memcpy(p->eth_addr, src, ETH_ALEN); 13186db6f0eaSFelix Fietkau else 13191bfe45f4SMao Wenan eth_broadcast_addr(p->eth_addr); 13206db6f0eaSFelix Fietkau 1321cfd56754SCong Wang return p; 1322cfd56754SCong Wang } 1323cfd56754SCong Wang 132458d913a3SNikolay Aleksandrov void br_multicast_host_join(const struct net_bridge_mcast *brmctx, 132558d913a3SNikolay Aleksandrov struct net_bridge_mdb_entry *mp, bool notify) 13261bc844eeSNikolay Aleksandrov { 13271bc844eeSNikolay Aleksandrov if (!mp->host_joined) { 13281bc844eeSNikolay Aleksandrov mp->host_joined = true; 1329094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1330094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 13311bc844eeSNikolay Aleksandrov if (notify) 133281f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_NEWMDB); 13331bc844eeSNikolay Aleksandrov } 1334955062b0SNikolay Aleksandrov 1335955062b0SNikolay Aleksandrov if (br_group_is_l2(&mp->addr)) 1336955062b0SNikolay Aleksandrov return; 1337955062b0SNikolay Aleksandrov 133858d913a3SNikolay Aleksandrov mod_timer(&mp->timer, jiffies + brmctx->multicast_membership_interval); 13391bc844eeSNikolay Aleksandrov } 13401bc844eeSNikolay Aleksandrov 13411bc844eeSNikolay Aleksandrov void br_multicast_host_leave(struct net_bridge_mdb_entry *mp, bool notify) 13421bc844eeSNikolay Aleksandrov { 13431bc844eeSNikolay Aleksandrov if (!mp->host_joined) 13441bc844eeSNikolay Aleksandrov return; 13451bc844eeSNikolay Aleksandrov 13461bc844eeSNikolay Aleksandrov mp->host_joined = false; 1347094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1348094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 13491bc844eeSNikolay Aleksandrov if (notify) 135081f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_DELMDB); 13511bc844eeSNikolay Aleksandrov } 13521bc844eeSNikolay Aleksandrov 1353b0812368SNikolay Aleksandrov static struct net_bridge_port_group * 1354adc47037SNikolay Aleksandrov __br_multicast_add_group(struct net_bridge_mcast *brmctx, 1355adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 13566db6f0eaSFelix Fietkau struct br_ip *group, 13578b671779SNikolay Aleksandrov const unsigned char *src, 13580436862eSNikolay Aleksandrov u8 filter_mode, 13599116ffbfSNikolay Aleksandrov bool igmpv2_mldv1, 13609116ffbfSNikolay Aleksandrov bool blocked) 1361eb1d1641SHerbert Xu { 1362e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 1363b0812368SNikolay Aleksandrov struct net_bridge_port_group *p = NULL; 13645e923585SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 1365454594f3SLinus Lüssing unsigned long now = jiffies; 1366eb1d1641SHerbert Xu 13674cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 1368eb1d1641SHerbert Xu goto out; 1369eb1d1641SHerbert Xu 1370adc47037SNikolay Aleksandrov mp = br_multicast_new_group(brmctx->br, group); 13714c0833bcSTobias Klauser if (IS_ERR(mp)) 13721697291dSXu Wang return ERR_CAST(mp); 1373eb1d1641SHerbert Xu 1374adc47037SNikolay Aleksandrov if (!pmctx) { 137558d913a3SNikolay Aleksandrov br_multicast_host_join(brmctx, mp, true); 1376eb1d1641SHerbert Xu goto out; 1377eb1d1641SHerbert Xu } 1378eb1d1641SHerbert Xu 1379e8051688SEric Dumazet for (pp = &mp->ports; 1380adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 1381e8051688SEric Dumazet pp = &p->next) { 1382adc47037SNikolay Aleksandrov if (br_port_group_equal(p, pmctx->port, src)) 1383454594f3SLinus Lüssing goto found; 1384adc47037SNikolay Aleksandrov if ((unsigned long)p->key.port < (unsigned long)pmctx->port) 1385eb1d1641SHerbert Xu break; 1386eb1d1641SHerbert Xu } 1387eb1d1641SHerbert Xu 1388adc47037SNikolay Aleksandrov p = br_multicast_new_port_group(pmctx->port, group, *pp, 0, src, 1389955062b0SNikolay Aleksandrov filter_mode, RTPROT_KERNEL); 1390b0812368SNikolay Aleksandrov if (unlikely(!p)) { 1391b0812368SNikolay Aleksandrov p = ERR_PTR(-ENOMEM); 1392b0812368SNikolay Aleksandrov goto out; 1393b0812368SNikolay Aleksandrov } 1394eb1d1641SHerbert Xu rcu_assign_pointer(*pp, p); 13959116ffbfSNikolay Aleksandrov if (blocked) 13969116ffbfSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_BLOCKED; 1397adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mp, p, RTM_NEWMDB); 1398eb1d1641SHerbert Xu 1399454594f3SLinus Lüssing found: 14000436862eSNikolay Aleksandrov if (igmpv2_mldv1) 1401d3d065c0SNikolay Aleksandrov mod_timer(&p->timer, 1402adc47037SNikolay Aleksandrov now + brmctx->multicast_membership_interval); 140381f19838SNikolay Aleksandrov 1404eb1d1641SHerbert Xu out: 1405b0812368SNikolay Aleksandrov return p; 1406b0812368SNikolay Aleksandrov } 1407eb1d1641SHerbert Xu 1408adc47037SNikolay Aleksandrov static int br_multicast_add_group(struct net_bridge_mcast *brmctx, 1409adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1410b0812368SNikolay Aleksandrov struct br_ip *group, 1411b0812368SNikolay Aleksandrov const unsigned char *src, 1412b0812368SNikolay Aleksandrov u8 filter_mode, 1413b0812368SNikolay Aleksandrov bool igmpv2_mldv1) 1414b0812368SNikolay Aleksandrov { 1415b0812368SNikolay Aleksandrov struct net_bridge_port_group *pg; 1416b0812368SNikolay Aleksandrov int err; 1417b0812368SNikolay Aleksandrov 1418adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1419adc47037SNikolay Aleksandrov pg = __br_multicast_add_group(brmctx, pmctx, group, src, filter_mode, 14209116ffbfSNikolay Aleksandrov igmpv2_mldv1, false); 1421b0812368SNikolay Aleksandrov /* NULL is considered valid for host joined groups */ 14228d21c882SJiapeng Zhong err = PTR_ERR_OR_ZERO(pg); 1423adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1424b0812368SNikolay Aleksandrov 1425eb1d1641SHerbert Xu return err; 1426eb1d1641SHerbert Xu } 1427eb1d1641SHerbert Xu 1428adc47037SNikolay Aleksandrov static int br_ip4_multicast_add_group(struct net_bridge_mcast *brmctx, 1429adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1430b0e9a30dSVlad Yasevich __be32 group, 14316db6f0eaSFelix Fietkau __u16 vid, 14328b671779SNikolay Aleksandrov const unsigned char *src, 14338b671779SNikolay Aleksandrov bool igmpv2) 14348ef2a9a5SYOSHIFUJI Hideaki { 14358ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 14368b671779SNikolay Aleksandrov u8 filter_mode; 14378ef2a9a5SYOSHIFUJI Hideaki 14388ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 14398ef2a9a5SYOSHIFUJI Hideaki return 0; 14408ef2a9a5SYOSHIFUJI Hideaki 14411515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1442eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 14438ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1444b0e9a30dSVlad Yasevich br_group.vid = vid; 14458b671779SNikolay Aleksandrov filter_mode = igmpv2 ? MCAST_EXCLUDE : MCAST_INCLUDE; 14468ef2a9a5SYOSHIFUJI Hideaki 1447adc47037SNikolay Aleksandrov return br_multicast_add_group(brmctx, pmctx, &br_group, src, 1448adc47037SNikolay Aleksandrov filter_mode, igmpv2); 14498ef2a9a5SYOSHIFUJI Hideaki } 14508ef2a9a5SYOSHIFUJI Hideaki 1451dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1452adc47037SNikolay Aleksandrov static int br_ip6_multicast_add_group(struct net_bridge_mcast *brmctx, 1453adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1454b0e9a30dSVlad Yasevich const struct in6_addr *group, 14556db6f0eaSFelix Fietkau __u16 vid, 14568b671779SNikolay Aleksandrov const unsigned char *src, 14578b671779SNikolay Aleksandrov bool mldv1) 145808b202b6SYOSHIFUJI Hideaki { 145908b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 14608b671779SNikolay Aleksandrov u8 filter_mode; 146108b202b6SYOSHIFUJI Hideaki 14623c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 146308b202b6SYOSHIFUJI Hideaki return 0; 146408b202b6SYOSHIFUJI Hideaki 146519e3a9c9SNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1466eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 14679cc6e0c4SLinus Lüssing br_group.proto = htons(ETH_P_IPV6); 1468b0e9a30dSVlad Yasevich br_group.vid = vid; 14698b671779SNikolay Aleksandrov filter_mode = mldv1 ? MCAST_EXCLUDE : MCAST_INCLUDE; 147008b202b6SYOSHIFUJI Hideaki 1471adc47037SNikolay Aleksandrov return br_multicast_add_group(brmctx, pmctx, &br_group, src, 1472adc47037SNikolay Aleksandrov filter_mode, mldv1); 147308b202b6SYOSHIFUJI Hideaki } 147408b202b6SYOSHIFUJI Hideaki #endif 147508b202b6SYOSHIFUJI Hideaki 1476ed2d3597SLinus Lüssing static bool br_multicast_rport_del(struct hlist_node *rlist) 1477ed2d3597SLinus Lüssing { 1478ed2d3597SLinus Lüssing if (hlist_unhashed(rlist)) 1479ed2d3597SLinus Lüssing return false; 1480ed2d3597SLinus Lüssing 1481ed2d3597SLinus Lüssing hlist_del_init_rcu(rlist); 1482ed2d3597SLinus Lüssing return true; 1483ed2d3597SLinus Lüssing } 1484ed2d3597SLinus Lüssing 1485adc47037SNikolay Aleksandrov static bool br_ip4_multicast_rport_del(struct net_bridge_mcast_port *pmctx) 1486ed2d3597SLinus Lüssing { 1487adc47037SNikolay Aleksandrov return br_multicast_rport_del(&pmctx->ip4_rlist); 1488ed2d3597SLinus Lüssing } 1489ed2d3597SLinus Lüssing 1490adc47037SNikolay Aleksandrov static bool br_ip6_multicast_rport_del(struct net_bridge_mcast_port *pmctx) 1491a3c02e76SLinus Lüssing { 1492a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1493adc47037SNikolay Aleksandrov return br_multicast_rport_del(&pmctx->ip6_rlist); 1494a3c02e76SLinus Lüssing #else 1495a3c02e76SLinus Lüssing return false; 1496a3c02e76SLinus Lüssing #endif 1497a3c02e76SLinus Lüssing } 1498a3c02e76SLinus Lüssing 14999632233eSNikolay Aleksandrov static void br_multicast_router_expired(struct net_bridge_mcast_port *pmctx, 1500ee5fb222SLinus Lüssing struct timer_list *t, 1501ee5fb222SLinus Lüssing struct hlist_node *rlist) 1502eb1d1641SHerbert Xu { 15039632233eSNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 1504ed2d3597SLinus Lüssing bool del; 1505eb1d1641SHerbert Xu 1506eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 15079632233eSNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 15089632233eSNikolay Aleksandrov pmctx->multicast_router == MDB_RTR_TYPE_PERM || 1509ee5fb222SLinus Lüssing timer_pending(t)) 1510eb1d1641SHerbert Xu goto out; 1511eb1d1641SHerbert Xu 1512ed2d3597SLinus Lüssing del = br_multicast_rport_del(rlist); 1513adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 1514eb1d1641SHerbert Xu out: 1515eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1516eb1d1641SHerbert Xu } 1517eb1d1641SHerbert Xu 1518ee5fb222SLinus Lüssing static void br_ip4_multicast_router_expired(struct timer_list *t) 1519ee5fb222SLinus Lüssing { 15209632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 15219632233eSNikolay Aleksandrov ip4_mc_router_timer); 1522ee5fb222SLinus Lüssing 15239632233eSNikolay Aleksandrov br_multicast_router_expired(pmctx, t, &pmctx->ip4_rlist); 1524ee5fb222SLinus Lüssing } 1525ee5fb222SLinus Lüssing 1526a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1527a3c02e76SLinus Lüssing static void br_ip6_multicast_router_expired(struct timer_list *t) 1528a3c02e76SLinus Lüssing { 15299632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 15309632233eSNikolay Aleksandrov ip6_mc_router_timer); 1531a3c02e76SLinus Lüssing 15329632233eSNikolay Aleksandrov br_multicast_router_expired(pmctx, t, &pmctx->ip6_rlist); 1533a3c02e76SLinus Lüssing } 1534a3c02e76SLinus Lüssing #endif 1535a3c02e76SLinus Lüssing 153677041420SYotam Gigi static void br_mc_router_state_change(struct net_bridge *p, 153777041420SYotam Gigi bool is_mc_router) 153877041420SYotam Gigi { 153977041420SYotam Gigi struct switchdev_attr attr = { 154077041420SYotam Gigi .orig_dev = p->dev, 154177041420SYotam Gigi .id = SWITCHDEV_ATTR_ID_BRIDGE_MROUTER, 154277041420SYotam Gigi .flags = SWITCHDEV_F_DEFER, 154377041420SYotam Gigi .u.mrouter = is_mc_router, 154477041420SYotam Gigi }; 154577041420SYotam Gigi 1546dcbdf135SVladimir Oltean switchdev_port_attr_set(p->dev, &attr, NULL); 154777041420SYotam Gigi } 154877041420SYotam Gigi 1549d3d065c0SNikolay Aleksandrov static void br_multicast_local_router_expired(struct net_bridge_mcast *brmctx, 1550ee5fb222SLinus Lüssing struct timer_list *timer) 1551eb1d1641SHerbert Xu { 1552d3d065c0SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1553d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 1554d3d065c0SNikolay Aleksandrov brmctx->multicast_router == MDB_RTR_TYPE_PERM || 1555d3d065c0SNikolay Aleksandrov br_ip4_multicast_is_router(brmctx) || 1556d3d065c0SNikolay Aleksandrov br_ip6_multicast_is_router(brmctx)) 155777041420SYotam Gigi goto out; 155877041420SYotam Gigi 1559d3d065c0SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, false); 156077041420SYotam Gigi out: 1561d3d065c0SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1562eb1d1641SHerbert Xu } 1563eb1d1641SHerbert Xu 1564ee5fb222SLinus Lüssing static void br_ip4_multicast_local_router_expired(struct timer_list *t) 1565ee5fb222SLinus Lüssing { 1566d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1567d3d065c0SNikolay Aleksandrov ip4_mc_router_timer); 1568ee5fb222SLinus Lüssing 1569d3d065c0SNikolay Aleksandrov br_multicast_local_router_expired(brmctx, t); 1570ee5fb222SLinus Lüssing } 1571ee5fb222SLinus Lüssing 1572a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1573a3c02e76SLinus Lüssing static void br_ip6_multicast_local_router_expired(struct timer_list *t) 1574a3c02e76SLinus Lüssing { 1575d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1576d3d065c0SNikolay Aleksandrov ip6_mc_router_timer); 1577a3c02e76SLinus Lüssing 1578d3d065c0SNikolay Aleksandrov br_multicast_local_router_expired(brmctx, t); 1579a3c02e76SLinus Lüssing } 1580a3c02e76SLinus Lüssing #endif 1581a3c02e76SLinus Lüssing 1582d3d065c0SNikolay Aleksandrov static void br_multicast_querier_expired(struct net_bridge_mcast *brmctx, 158390010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1584c83b8fabSHerbert Xu { 1585d3d065c0SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1586d3d065c0SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 15874cdd0d10SNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(brmctx) || 1588d3d065c0SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 1589c83b8fabSHerbert Xu goto out; 1590c83b8fabSHerbert Xu 1591adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, query); 1592c83b8fabSHerbert Xu 1593c83b8fabSHerbert Xu out: 1594d3d065c0SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1595c83b8fabSHerbert Xu } 1596c83b8fabSHerbert Xu 159788c1f37fSAllen Pais static void br_ip4_multicast_querier_expired(struct timer_list *t) 1598cc0fdd80SLinus Lüssing { 1599d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1600d3d065c0SNikolay Aleksandrov ip4_other_query.timer); 1601cc0fdd80SLinus Lüssing 1602d3d065c0SNikolay Aleksandrov br_multicast_querier_expired(brmctx, &brmctx->ip4_own_query); 1603cc0fdd80SLinus Lüssing } 1604cc0fdd80SLinus Lüssing 1605cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 160688c1f37fSAllen Pais static void br_ip6_multicast_querier_expired(struct timer_list *t) 1607cc0fdd80SLinus Lüssing { 1608d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1609d3d065c0SNikolay Aleksandrov ip6_other_query.timer); 1610cc0fdd80SLinus Lüssing 1611d3d065c0SNikolay Aleksandrov br_multicast_querier_expired(brmctx, &brmctx->ip6_own_query); 1612cc0fdd80SLinus Lüssing } 1613cc0fdd80SLinus Lüssing #endif 1614cc0fdd80SLinus Lüssing 1615adc47037SNikolay Aleksandrov static void br_multicast_select_own_querier(struct net_bridge_mcast *brmctx, 1616dc4eb53aSLinus Lüssing struct br_ip *ip, 1617dc4eb53aSLinus Lüssing struct sk_buff *skb) 1618dc4eb53aSLinus Lüssing { 1619dc4eb53aSLinus Lüssing if (ip->proto == htons(ETH_P_IP)) 1620d3d065c0SNikolay Aleksandrov brmctx->ip4_querier.addr.src.ip4 = ip_hdr(skb)->saddr; 1621dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1622dc4eb53aSLinus Lüssing else 1623d3d065c0SNikolay Aleksandrov brmctx->ip6_querier.addr.src.ip6 = ipv6_hdr(skb)->saddr; 1624dc4eb53aSLinus Lüssing #endif 1625dc4eb53aSLinus Lüssing } 1626dc4eb53aSLinus Lüssing 1627adc47037SNikolay Aleksandrov static void __br_multicast_send_query(struct net_bridge_mcast *brmctx, 1628adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1629438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 1630438ef2d0SNikolay Aleksandrov struct br_ip *ip_dst, 1631438ef2d0SNikolay Aleksandrov struct br_ip *group, 1632438ef2d0SNikolay Aleksandrov bool with_srcs, 163342c11ccfSNikolay Aleksandrov u8 sflag, 163442c11ccfSNikolay Aleksandrov bool *need_rexmit) 1635eb1d1641SHerbert Xu { 1636438ef2d0SNikolay Aleksandrov bool over_lmqt = !!sflag; 1637eb1d1641SHerbert Xu struct sk_buff *skb; 16381080ab95SNikolay Aleksandrov u8 igmp_type; 1639eb1d1641SHerbert Xu 1640cb486ce9SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx) || 1641cb486ce9SNikolay Aleksandrov !br_multicast_ctx_matches_vlan_snooping(brmctx)) 1642615cc23eSNikolay Aleksandrov return; 1643615cc23eSNikolay Aleksandrov 1644438ef2d0SNikolay Aleksandrov again_under_lmqt: 1645615cc23eSNikolay Aleksandrov skb = br_multicast_alloc_query(brmctx, pmctx, pg, ip_dst, group, 1646615cc23eSNikolay Aleksandrov with_srcs, over_lmqt, sflag, &igmp_type, 164742c11ccfSNikolay Aleksandrov need_rexmit); 1648eb1d1641SHerbert Xu if (!skb) 16498ef2a9a5SYOSHIFUJI Hideaki return; 1650eb1d1641SHerbert Xu 1651adc47037SNikolay Aleksandrov if (pmctx) { 1652adc47037SNikolay Aleksandrov skb->dev = pmctx->port->dev; 1653adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, pmctx->port, skb, igmp_type, 16541080ab95SNikolay Aleksandrov BR_MCAST_DIR_TX); 165529a26a56SEric W. Biederman NF_HOOK(NFPROTO_BRIDGE, NF_BR_LOCAL_OUT, 1656adc47037SNikolay Aleksandrov dev_net(pmctx->port->dev), NULL, skb, NULL, skb->dev, 1657f0b4eeceSLinus Lüssing br_dev_queue_push_xmit); 1658438ef2d0SNikolay Aleksandrov 1659438ef2d0SNikolay Aleksandrov if (over_lmqt && with_srcs && sflag) { 1660438ef2d0SNikolay Aleksandrov over_lmqt = false; 1661438ef2d0SNikolay Aleksandrov goto again_under_lmqt; 1662438ef2d0SNikolay Aleksandrov } 1663dc4eb53aSLinus Lüssing } else { 1664adc47037SNikolay Aleksandrov br_multicast_select_own_querier(brmctx, group, skb); 1665adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, NULL, skb, igmp_type, 16661080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 1667eb1d1641SHerbert Xu netif_rx(skb); 16688ef2a9a5SYOSHIFUJI Hideaki } 1669dc4eb53aSLinus Lüssing } 1670eb1d1641SHerbert Xu 167167b746f9SNikolay Aleksandrov static void br_multicast_read_querier(const struct bridge_mcast_querier *querier, 167267b746f9SNikolay Aleksandrov struct bridge_mcast_querier *dest) 167367b746f9SNikolay Aleksandrov { 167467b746f9SNikolay Aleksandrov unsigned int seq; 167567b746f9SNikolay Aleksandrov 167667b746f9SNikolay Aleksandrov memset(dest, 0, sizeof(*dest)); 167767b746f9SNikolay Aleksandrov do { 167867b746f9SNikolay Aleksandrov seq = read_seqcount_begin(&querier->seq); 167967b746f9SNikolay Aleksandrov dest->port_ifidx = querier->port_ifidx; 168067b746f9SNikolay Aleksandrov memcpy(&dest->addr, &querier->addr, sizeof(struct br_ip)); 168167b746f9SNikolay Aleksandrov } while (read_seqcount_retry(&querier->seq, seq)); 168267b746f9SNikolay Aleksandrov } 168367b746f9SNikolay Aleksandrov 168467b746f9SNikolay Aleksandrov static void br_multicast_update_querier(struct net_bridge_mcast *brmctx, 168567b746f9SNikolay Aleksandrov struct bridge_mcast_querier *querier, 168667b746f9SNikolay Aleksandrov int ifindex, 168767b746f9SNikolay Aleksandrov struct br_ip *saddr) 168867b746f9SNikolay Aleksandrov { 168967b746f9SNikolay Aleksandrov write_seqcount_begin(&querier->seq); 169067b746f9SNikolay Aleksandrov querier->port_ifidx = ifindex; 169167b746f9SNikolay Aleksandrov memcpy(&querier->addr, saddr, sizeof(*saddr)); 169267b746f9SNikolay Aleksandrov write_seqcount_end(&querier->seq); 169367b746f9SNikolay Aleksandrov } 169467b746f9SNikolay Aleksandrov 1695adc47037SNikolay Aleksandrov static void br_multicast_send_query(struct net_bridge_mcast *brmctx, 1696adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 169790010b36SLinus Lüssing struct bridge_mcast_own_query *own_query) 16988ef2a9a5SYOSHIFUJI Hideaki { 169990010b36SLinus Lüssing struct bridge_mcast_other_query *other_query = NULL; 170067b746f9SNikolay Aleksandrov struct bridge_mcast_querier *querier; 17015e923585SNikolay Aleksandrov struct br_ip br_group; 17025e923585SNikolay Aleksandrov unsigned long time; 17038ef2a9a5SYOSHIFUJI Hideaki 17044cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx) || 1705adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED) || 17064d5b4e84SNikolay Aleksandrov !brmctx->multicast_querier) 17078ef2a9a5SYOSHIFUJI Hideaki return; 17088ef2a9a5SYOSHIFUJI Hideaki 1709eab3227bSNikolay Aleksandrov memset(&br_group.dst, 0, sizeof(br_group.dst)); 17108ef2a9a5SYOSHIFUJI Hideaki 1711adc47037SNikolay Aleksandrov if (pmctx ? (own_query == &pmctx->ip4_own_query) : 1712d3d065c0SNikolay Aleksandrov (own_query == &brmctx->ip4_own_query)) { 171367b746f9SNikolay Aleksandrov querier = &brmctx->ip4_querier; 1714d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 171508b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1716dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1717cc0fdd80SLinus Lüssing } else { 171867b746f9SNikolay Aleksandrov querier = &brmctx->ip6_querier; 1719d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 172008b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 172108b202b6SYOSHIFUJI Hideaki #endif 1722eb1d1641SHerbert Xu } 1723eb1d1641SHerbert Xu 172490010b36SLinus Lüssing if (!other_query || timer_pending(&other_query->timer)) 1725cc0fdd80SLinus Lüssing return; 1726cc0fdd80SLinus Lüssing 172767b746f9SNikolay Aleksandrov /* we're about to select ourselves as querier */ 172867b746f9SNikolay Aleksandrov if (!pmctx && querier->port_ifidx) { 172967b746f9SNikolay Aleksandrov struct br_ip zeroip = {}; 173067b746f9SNikolay Aleksandrov 173167b746f9SNikolay Aleksandrov br_multicast_update_querier(brmctx, querier, 0, &zeroip); 173267b746f9SNikolay Aleksandrov } 173367b746f9SNikolay Aleksandrov 1734adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, NULL, NULL, &br_group, false, 1735adc47037SNikolay Aleksandrov 0, NULL); 1736cc0fdd80SLinus Lüssing 1737cc0fdd80SLinus Lüssing time = jiffies; 1738d3d065c0SNikolay Aleksandrov time += own_query->startup_sent < brmctx->multicast_startup_query_count ? 1739d3d065c0SNikolay Aleksandrov brmctx->multicast_startup_query_interval : 1740d3d065c0SNikolay Aleksandrov brmctx->multicast_query_interval; 174190010b36SLinus Lüssing mod_timer(&own_query->timer, time); 1742cc0fdd80SLinus Lüssing } 1743cc0fdd80SLinus Lüssing 174490010b36SLinus Lüssing static void 17459632233eSNikolay Aleksandrov br_multicast_port_query_expired(struct net_bridge_mcast_port *pmctx, 174690010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1747eb1d1641SHerbert Xu { 17489632233eSNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 17494cdd0d10SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 1750eb1d1641SHerbert Xu 1751eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 17524cdd0d10SNikolay Aleksandrov if (br_multicast_port_ctx_state_stopped(pmctx)) 1753eb1d1641SHerbert Xu goto out; 1754615cc23eSNikolay Aleksandrov 17554cdd0d10SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 17564cdd0d10SNikolay Aleksandrov if (query->startup_sent < brmctx->multicast_startup_query_count) 1757cc0fdd80SLinus Lüssing query->startup_sent++; 1758eb1d1641SHerbert Xu 17594cdd0d10SNikolay Aleksandrov br_multicast_send_query(brmctx, pmctx, query); 1760eb1d1641SHerbert Xu 1761eb1d1641SHerbert Xu out: 1762eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1763eb1d1641SHerbert Xu } 1764eb1d1641SHerbert Xu 176588c1f37fSAllen Pais static void br_ip4_multicast_port_query_expired(struct timer_list *t) 1766cc0fdd80SLinus Lüssing { 17679632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 17689632233eSNikolay Aleksandrov ip4_own_query.timer); 1769cc0fdd80SLinus Lüssing 17709632233eSNikolay Aleksandrov br_multicast_port_query_expired(pmctx, &pmctx->ip4_own_query); 1771cc0fdd80SLinus Lüssing } 1772cc0fdd80SLinus Lüssing 1773cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 177488c1f37fSAllen Pais static void br_ip6_multicast_port_query_expired(struct timer_list *t) 1775cc0fdd80SLinus Lüssing { 17769632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 17779632233eSNikolay Aleksandrov ip6_own_query.timer); 1778cc0fdd80SLinus Lüssing 17799632233eSNikolay Aleksandrov br_multicast_port_query_expired(pmctx, &pmctx->ip6_own_query); 1780cc0fdd80SLinus Lüssing } 1781cc0fdd80SLinus Lüssing #endif 1782cc0fdd80SLinus Lüssing 178342c11ccfSNikolay Aleksandrov static void br_multicast_port_group_rexmit(struct timer_list *t) 178442c11ccfSNikolay Aleksandrov { 178542c11ccfSNikolay Aleksandrov struct net_bridge_port_group *pg = from_timer(pg, t, rexmit_timer); 178642c11ccfSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 1787085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 1788adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 1789adc47037SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 179042c11ccfSNikolay Aleksandrov bool need_rexmit = false; 179142c11ccfSNikolay Aleksandrov 179242c11ccfSNikolay Aleksandrov spin_lock(&br->multicast_lock); 179342c11ccfSNikolay Aleksandrov if (!netif_running(br->dev) || hlist_unhashed(&pg->mglist) || 17944d5b4e84SNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED)) 179542c11ccfSNikolay Aleksandrov goto out; 179642c11ccfSNikolay Aleksandrov 1797eb1593a0SNikolay Aleksandrov pmctx = br_multicast_pg_to_port_ctx(pg); 1798eb1593a0SNikolay Aleksandrov if (!pmctx) 1799eb1593a0SNikolay Aleksandrov goto out; 1800eb1593a0SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 18014d5b4e84SNikolay Aleksandrov if (!brmctx->multicast_querier) 18024d5b4e84SNikolay Aleksandrov goto out; 18034d5b4e84SNikolay Aleksandrov 1804085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 1805d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 180642c11ccfSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 180742c11ccfSNikolay Aleksandrov else 1808d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 180942c11ccfSNikolay Aleksandrov #endif 181042c11ccfSNikolay Aleksandrov 181142c11ccfSNikolay Aleksandrov if (!other_query || timer_pending(&other_query->timer)) 181242c11ccfSNikolay Aleksandrov goto out; 181342c11ccfSNikolay Aleksandrov 181442c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt) { 181542c11ccfSNikolay Aleksandrov pg->grp_query_rexmit_cnt--; 1816adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 1817085b53c8SNikolay Aleksandrov &pg->key.addr, false, 1, NULL); 181842c11ccfSNikolay Aleksandrov } 1819adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 1820085b53c8SNikolay Aleksandrov &pg->key.addr, true, 0, &need_rexmit); 182142c11ccfSNikolay Aleksandrov 182242c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt || need_rexmit) 182342c11ccfSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, jiffies + 1824d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval); 182542c11ccfSNikolay Aleksandrov out: 182642c11ccfSNikolay Aleksandrov spin_unlock(&br->multicast_lock); 182742c11ccfSNikolay Aleksandrov } 182842c11ccfSNikolay Aleksandrov 1829ae1ea84bSFlorian Fainelli static int br_mc_disabled_update(struct net_device *dev, bool value, 1830ae1ea84bSFlorian Fainelli struct netlink_ext_ack *extack) 1831147c1e9bSNogah Frankel { 1832147c1e9bSNogah Frankel struct switchdev_attr attr = { 1833147c1e9bSNogah Frankel .orig_dev = dev, 1834147c1e9bSNogah Frankel .id = SWITCHDEV_ATTR_ID_BRIDGE_MC_DISABLED, 1835147c1e9bSNogah Frankel .flags = SWITCHDEV_F_DEFER, 183613cefad2SNikolay Aleksandrov .u.mc_disabled = !value, 1837147c1e9bSNogah Frankel }; 1838147c1e9bSNogah Frankel 1839ae1ea84bSFlorian Fainelli return switchdev_port_attr_set(dev, &attr, extack); 1840147c1e9bSNogah Frankel } 1841147c1e9bSNogah Frankel 1842613d61dbSNikolay Aleksandrov void br_multicast_port_ctx_init(struct net_bridge_port *port, 1843613d61dbSNikolay Aleksandrov struct net_bridge_vlan *vlan, 18449632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 18459632233eSNikolay Aleksandrov { 18469632233eSNikolay Aleksandrov pmctx->port = port; 1847613d61dbSNikolay Aleksandrov pmctx->vlan = vlan; 18489632233eSNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 18499632233eSNikolay Aleksandrov timer_setup(&pmctx->ip4_mc_router_timer, 18509632233eSNikolay Aleksandrov br_ip4_multicast_router_expired, 0); 18519632233eSNikolay Aleksandrov timer_setup(&pmctx->ip4_own_query.timer, 18529632233eSNikolay Aleksandrov br_ip4_multicast_port_query_expired, 0); 18539632233eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 18549632233eSNikolay Aleksandrov timer_setup(&pmctx->ip6_mc_router_timer, 18559632233eSNikolay Aleksandrov br_ip6_multicast_router_expired, 0); 18569632233eSNikolay Aleksandrov timer_setup(&pmctx->ip6_own_query.timer, 18579632233eSNikolay Aleksandrov br_ip6_multicast_port_query_expired, 0); 18589632233eSNikolay Aleksandrov #endif 18599632233eSNikolay Aleksandrov } 18609632233eSNikolay Aleksandrov 1861613d61dbSNikolay Aleksandrov void br_multicast_port_ctx_deinit(struct net_bridge_mcast_port *pmctx) 18629632233eSNikolay Aleksandrov { 18639632233eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 18649632233eSNikolay Aleksandrov del_timer_sync(&pmctx->ip6_mc_router_timer); 18659632233eSNikolay Aleksandrov #endif 18669632233eSNikolay Aleksandrov del_timer_sync(&pmctx->ip4_mc_router_timer); 18679632233eSNikolay Aleksandrov } 18689632233eSNikolay Aleksandrov 18691080ab95SNikolay Aleksandrov int br_multicast_add_port(struct net_bridge_port *port) 1870eb1d1641SHerbert Xu { 1871ae1ea84bSFlorian Fainelli int err; 1872ae1ea84bSFlorian Fainelli 187389268b05SNikolay Aleksandrov port->multicast_eht_hosts_limit = BR_MCAST_DEFAULT_EHT_HOSTS_LIMIT; 1874613d61dbSNikolay Aleksandrov br_multicast_port_ctx_init(port, NULL, &port->multicast_ctx); 1875eb1d1641SHerbert Xu 1876ae1ea84bSFlorian Fainelli err = br_mc_disabled_update(port->dev, 1877ae1ea84bSFlorian Fainelli br_opt_get(port->br, 1878ae1ea84bSFlorian Fainelli BROPT_MULTICAST_ENABLED), 1879ae1ea84bSFlorian Fainelli NULL); 188068f5c12aSVladimir Oltean if (err && err != -EOPNOTSUPP) 1881ae1ea84bSFlorian Fainelli return err; 1882147c1e9bSNogah Frankel 18831080ab95SNikolay Aleksandrov port->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 18841080ab95SNikolay Aleksandrov if (!port->mcast_stats) 18851080ab95SNikolay Aleksandrov return -ENOMEM; 18861080ab95SNikolay Aleksandrov 18871080ab95SNikolay Aleksandrov return 0; 1888eb1d1641SHerbert Xu } 1889eb1d1641SHerbert Xu 1890eb1d1641SHerbert Xu void br_multicast_del_port(struct net_bridge_port *port) 1891eb1d1641SHerbert Xu { 1892e10177abSSatish Ashok struct net_bridge *br = port->br; 1893e10177abSSatish Ashok struct net_bridge_port_group *pg; 1894e12cec65SNikolay Aleksandrov HLIST_HEAD(deleted_head); 1895e10177abSSatish Ashok struct hlist_node *n; 1896e10177abSSatish Ashok 1897e10177abSSatish Ashok /* Take care of the remaining groups, only perm ones should be left */ 1898e10177abSSatish Ashok spin_lock_bh(&br->multicast_lock); 1899e10177abSSatish Ashok hlist_for_each_entry_safe(pg, n, &port->mglist, mglist) 1900681590bdSNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 1901e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 1902e10177abSSatish Ashok spin_unlock_bh(&br->multicast_lock); 1903e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 19049632233eSNikolay Aleksandrov br_multicast_port_ctx_deinit(&port->multicast_ctx); 19051080ab95SNikolay Aleksandrov free_percpu(port->mcast_stats); 1906eb1d1641SHerbert Xu } 1907eb1d1641SHerbert Xu 190890010b36SLinus Lüssing static void br_multicast_enable(struct bridge_mcast_own_query *query) 1909561f1103SHerbert Xu { 1910cc0fdd80SLinus Lüssing query->startup_sent = 0; 1911561f1103SHerbert Xu 1912cc0fdd80SLinus Lüssing if (try_to_del_timer_sync(&query->timer) >= 0 || 1913cc0fdd80SLinus Lüssing del_timer(&query->timer)) 1914cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 1915561f1103SHerbert Xu } 1916561f1103SHerbert Xu 1917adc47037SNikolay Aleksandrov static void __br_multicast_enable_port_ctx(struct net_bridge_mcast_port *pmctx) 1918eb1d1641SHerbert Xu { 1919adc47037SNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 19207b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 1921eb1d1641SHerbert Xu 19227b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 19237b54aaafSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED) || 19247b54aaafSNikolay Aleksandrov !netif_running(br->dev)) 19257cb3f921SNikolay Aleksandrov return; 1926eb1d1641SHerbert Xu 1927adc47037SNikolay Aleksandrov br_multicast_enable(&pmctx->ip4_own_query); 1928cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1929adc47037SNikolay Aleksandrov br_multicast_enable(&pmctx->ip6_own_query); 1930cc0fdd80SLinus Lüssing #endif 1931adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_PERM) { 1932adc47037SNikolay Aleksandrov br_ip4_multicast_add_router(brmctx, pmctx); 1933adc47037SNikolay Aleksandrov br_ip6_multicast_add_router(brmctx, pmctx); 1934a3c02e76SLinus Lüssing } 19357cb3f921SNikolay Aleksandrov } 1936eb1d1641SHerbert Xu 19377cb3f921SNikolay Aleksandrov void br_multicast_enable_port(struct net_bridge_port *port) 19387cb3f921SNikolay Aleksandrov { 19397cb3f921SNikolay Aleksandrov struct net_bridge *br = port->br; 19407cb3f921SNikolay Aleksandrov 1941f4b7002aSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 1942adc47037SNikolay Aleksandrov __br_multicast_enable_port_ctx(&port->multicast_ctx); 1943f4b7002aSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 1944eb1d1641SHerbert Xu } 1945eb1d1641SHerbert Xu 19467b54aaafSNikolay Aleksandrov static void __br_multicast_disable_port_ctx(struct net_bridge_mcast_port *pmctx) 1947eb1d1641SHerbert Xu { 1948eb1d1641SHerbert Xu struct net_bridge_port_group *pg; 1949b67bfe0dSSasha Levin struct hlist_node *n; 1950ed2d3597SLinus Lüssing bool del = false; 1951eb1d1641SHerbert Xu 19527b54aaafSNikolay Aleksandrov hlist_for_each_entry_safe(pg, n, &pmctx->port->mglist, mglist) 19537b54aaafSNikolay Aleksandrov if (!(pg->flags & MDB_PG_FLAGS_PERMANENT) && 19547b54aaafSNikolay Aleksandrov (!br_multicast_port_ctx_is_vlan(pmctx) || 19557b54aaafSNikolay Aleksandrov pg->key.addr.vid == pmctx->vlan->vid)) 19567b54aaafSNikolay Aleksandrov br_multicast_find_del_pg(pmctx->port->br, pg); 1957eb1d1641SHerbert Xu 1958adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 1959adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 1960adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_own_query.timer); 1961adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 1962cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1963adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 1964adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_own_query.timer); 1965cc0fdd80SLinus Lüssing #endif 1966adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 19677b54aaafSNikolay Aleksandrov } 19687b54aaafSNikolay Aleksandrov 19697b54aaafSNikolay Aleksandrov void br_multicast_disable_port(struct net_bridge_port *port) 19707b54aaafSNikolay Aleksandrov { 1971f4b7002aSNikolay Aleksandrov spin_lock_bh(&port->br->multicast_lock); 19727b54aaafSNikolay Aleksandrov __br_multicast_disable_port_ctx(&port->multicast_ctx); 1973f4b7002aSNikolay Aleksandrov spin_unlock_bh(&port->br->multicast_lock); 1974eb1d1641SHerbert Xu } 1975eb1d1641SHerbert Xu 1976e6231bcaSNikolay Aleksandrov static int __grp_src_delete_marked(struct net_bridge_port_group *pg) 1977e6231bcaSNikolay Aleksandrov { 1978e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 1979e6231bcaSNikolay Aleksandrov struct hlist_node *tmp; 1980e6231bcaSNikolay Aleksandrov int deleted = 0; 1981e6231bcaSNikolay Aleksandrov 1982e6231bcaSNikolay Aleksandrov hlist_for_each_entry_safe(ent, tmp, &pg->src_list, node) 1983e6231bcaSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_DELETE) { 1984d5a10222SNikolay Aleksandrov br_multicast_del_group_src(ent, false); 1985e6231bcaSNikolay Aleksandrov deleted++; 1986e6231bcaSNikolay Aleksandrov } 1987e6231bcaSNikolay Aleksandrov 1988e6231bcaSNikolay Aleksandrov return deleted; 1989e6231bcaSNikolay Aleksandrov } 1990e6231bcaSNikolay Aleksandrov 1991b0812368SNikolay Aleksandrov static void __grp_src_mod_timer(struct net_bridge_group_src *src, 1992b0812368SNikolay Aleksandrov unsigned long expires) 1993b0812368SNikolay Aleksandrov { 1994b0812368SNikolay Aleksandrov mod_timer(&src->timer, expires); 1995b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(src); 1996b0812368SNikolay Aleksandrov } 1997b0812368SNikolay Aleksandrov 1998adc47037SNikolay Aleksandrov static void __grp_src_query_marked_and_rexmit(struct net_bridge_mcast *brmctx, 1999adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2000adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg) 20015bf1e00bSNikolay Aleksandrov { 20025bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 2003d3d065c0SNikolay Aleksandrov u32 lmqc = brmctx->multicast_last_member_count; 20045bf1e00bSNikolay Aleksandrov unsigned long lmqt, lmi, now = jiffies; 20055bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 20065bf1e00bSNikolay Aleksandrov 2007adc47037SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 2008adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 20095bf1e00bSNikolay Aleksandrov return; 20105bf1e00bSNikolay Aleksandrov 2011085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 2012d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 20135bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 20145bf1e00bSNikolay Aleksandrov else 2015d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 20165bf1e00bSNikolay Aleksandrov #endif 20175bf1e00bSNikolay Aleksandrov 2018adc47037SNikolay Aleksandrov lmqt = now + br_multicast_lmqt(brmctx); 20195bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 20205bf1e00bSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_SEND) { 20215bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 20225bf1e00bSNikolay Aleksandrov if (ent->timer.expires > lmqt) { 20234d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier && 20245bf1e00bSNikolay Aleksandrov other_query && 20255bf1e00bSNikolay Aleksandrov !timer_pending(&other_query->timer)) 20265bf1e00bSNikolay Aleksandrov ent->src_query_rexmit_cnt = lmqc; 2027b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, lmqt); 20285bf1e00bSNikolay Aleksandrov } 20295bf1e00bSNikolay Aleksandrov } 20305bf1e00bSNikolay Aleksandrov } 20315bf1e00bSNikolay Aleksandrov 20324d5b4e84SNikolay Aleksandrov if (!brmctx->multicast_querier || 20335bf1e00bSNikolay Aleksandrov !other_query || timer_pending(&other_query->timer)) 20345bf1e00bSNikolay Aleksandrov return; 20355bf1e00bSNikolay Aleksandrov 2036adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 2037085b53c8SNikolay Aleksandrov &pg->key.addr, true, 1, NULL); 20385bf1e00bSNikolay Aleksandrov 2039d3d065c0SNikolay Aleksandrov lmi = now + brmctx->multicast_last_member_interval; 20405bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 20415bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 20425bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 20435bf1e00bSNikolay Aleksandrov } 20445bf1e00bSNikolay Aleksandrov 2045adc47037SNikolay Aleksandrov static void __grp_send_query_and_rexmit(struct net_bridge_mcast *brmctx, 2046adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2047adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg) 20485bf1e00bSNikolay Aleksandrov { 20495bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 20505bf1e00bSNikolay Aleksandrov unsigned long now = jiffies, lmi; 20515bf1e00bSNikolay Aleksandrov 2052adc47037SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 2053adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 20545bf1e00bSNikolay Aleksandrov return; 20555bf1e00bSNikolay Aleksandrov 2056085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 2057d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 20585bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 20595bf1e00bSNikolay Aleksandrov else 2060d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 20615bf1e00bSNikolay Aleksandrov #endif 20625bf1e00bSNikolay Aleksandrov 20634d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier && 20645bf1e00bSNikolay Aleksandrov other_query && !timer_pending(&other_query->timer)) { 2065d3d065c0SNikolay Aleksandrov lmi = now + brmctx->multicast_last_member_interval; 2066d3d065c0SNikolay Aleksandrov pg->grp_query_rexmit_cnt = brmctx->multicast_last_member_count - 1; 2067adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 2068085b53c8SNikolay Aleksandrov &pg->key.addr, false, 0, NULL); 20695bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 20705bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 20715bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 20725bf1e00bSNikolay Aleksandrov } 20735bf1e00bSNikolay Aleksandrov 20745bf1e00bSNikolay Aleksandrov if (pg->filter_mode == MCAST_EXCLUDE && 20755bf1e00bSNikolay Aleksandrov (!timer_pending(&pg->timer) || 2076adc47037SNikolay Aleksandrov time_after(pg->timer.expires, now + br_multicast_lmqt(brmctx)))) 2077adc47037SNikolay Aleksandrov mod_timer(&pg->timer, now + br_multicast_lmqt(brmctx)); 20785bf1e00bSNikolay Aleksandrov } 20795bf1e00bSNikolay Aleksandrov 20800436862eSNikolay Aleksandrov /* State Msg type New state Actions 20810436862eSNikolay Aleksandrov * INCLUDE (A) IS_IN (B) INCLUDE (A+B) (B)=GMI 20820436862eSNikolay Aleksandrov * INCLUDE (A) ALLOW (B) INCLUDE (A+B) (B)=GMI 20830436862eSNikolay Aleksandrov * EXCLUDE (X,Y) ALLOW (A) EXCLUDE (X+A,Y-A) (A)=GMI 20840436862eSNikolay Aleksandrov */ 2085adc47037SNikolay Aleksandrov static bool br_multicast_isinc_allow(const struct net_bridge_mcast *brmctx, 2086adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2087474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2088474ddb37SNikolay Aleksandrov int grec_type) 20890436862eSNikolay Aleksandrov { 20900436862eSNikolay Aleksandrov struct net_bridge_group_src *ent; 20910436862eSNikolay Aleksandrov unsigned long now = jiffies; 20920436862eSNikolay Aleksandrov bool changed = false; 20930436862eSNikolay Aleksandrov struct br_ip src_ip; 20940436862eSNikolay Aleksandrov u32 src_idx; 20950436862eSNikolay Aleksandrov 20960436862eSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2097085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 20980436862eSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2099e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 21000436862eSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 21010436862eSNikolay Aleksandrov if (!ent) { 21020436862eSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 21030436862eSNikolay Aleksandrov if (ent) 21040436862eSNikolay Aleksandrov changed = true; 21050436862eSNikolay Aleksandrov } 21060436862eSNikolay Aleksandrov 21070436862eSNikolay Aleksandrov if (ent) 2108adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 21090436862eSNikolay Aleksandrov } 21100436862eSNikolay Aleksandrov 2111adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2112adc47037SNikolay Aleksandrov grec_type)) 2113474ddb37SNikolay Aleksandrov changed = true; 2114474ddb37SNikolay Aleksandrov 21150436862eSNikolay Aleksandrov return changed; 21160436862eSNikolay Aleksandrov } 21170436862eSNikolay Aleksandrov 2118e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 2119e6231bcaSNikolay Aleksandrov * INCLUDE (A) IS_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 2120e6231bcaSNikolay Aleksandrov * Delete (A-B) 2121e6231bcaSNikolay Aleksandrov * Group Timer=GMI 2122e6231bcaSNikolay Aleksandrov */ 2123adc47037SNikolay Aleksandrov static void __grp_src_isexc_incl(const struct net_bridge_mcast *brmctx, 2124adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2125ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2126ddc255d9SNikolay Aleksandrov int grec_type) 2127e6231bcaSNikolay Aleksandrov { 2128e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 2129e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 2130e6231bcaSNikolay Aleksandrov u32 src_idx; 2131e6231bcaSNikolay Aleksandrov 2132e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2133e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 2134e6231bcaSNikolay Aleksandrov 2135e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2136085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2137e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2138e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2139e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2140e6231bcaSNikolay Aleksandrov if (ent) 2141e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 2142e6231bcaSNikolay Aleksandrov else 2143b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2144b0812368SNikolay Aleksandrov if (ent) 2145b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 2146e6231bcaSNikolay Aleksandrov } 2147e6231bcaSNikolay Aleksandrov 2148adc47037SNikolay Aleksandrov br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2149adc47037SNikolay Aleksandrov grec_type); 2150ddc255d9SNikolay Aleksandrov 2151e6231bcaSNikolay Aleksandrov __grp_src_delete_marked(pg); 2152e6231bcaSNikolay Aleksandrov } 2153e6231bcaSNikolay Aleksandrov 2154e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 2155e6231bcaSNikolay Aleksandrov * EXCLUDE (X,Y) IS_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=GMI 2156e6231bcaSNikolay Aleksandrov * Delete (X-A) 2157e6231bcaSNikolay Aleksandrov * Delete (Y-A) 2158e6231bcaSNikolay Aleksandrov * Group Timer=GMI 2159e6231bcaSNikolay Aleksandrov */ 2160adc47037SNikolay Aleksandrov static bool __grp_src_isexc_excl(const struct net_bridge_mcast *brmctx, 2161adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2162ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2163ddc255d9SNikolay Aleksandrov int grec_type) 2164e6231bcaSNikolay Aleksandrov { 2165e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 2166e6231bcaSNikolay Aleksandrov unsigned long now = jiffies; 2167e6231bcaSNikolay Aleksandrov bool changed = false; 2168e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 2169e6231bcaSNikolay Aleksandrov u32 src_idx; 2170e6231bcaSNikolay Aleksandrov 2171e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2172e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 2173e6231bcaSNikolay Aleksandrov 2174e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2175085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2176e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2177e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2178e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2179e6231bcaSNikolay Aleksandrov if (ent) { 2180e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 2181e6231bcaSNikolay Aleksandrov } else { 2182e6231bcaSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2183e6231bcaSNikolay Aleksandrov if (ent) { 2184b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, 2185adc47037SNikolay Aleksandrov now + br_multicast_gmi(brmctx)); 2186e6231bcaSNikolay Aleksandrov changed = true; 2187e6231bcaSNikolay Aleksandrov } 2188e6231bcaSNikolay Aleksandrov } 2189e6231bcaSNikolay Aleksandrov } 2190e6231bcaSNikolay Aleksandrov 2191adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2192adc47037SNikolay Aleksandrov grec_type)) 2193ddc255d9SNikolay Aleksandrov changed = true; 2194ddc255d9SNikolay Aleksandrov 2195e6231bcaSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 2196e6231bcaSNikolay Aleksandrov changed = true; 2197e6231bcaSNikolay Aleksandrov 2198e6231bcaSNikolay Aleksandrov return changed; 2199e6231bcaSNikolay Aleksandrov } 2200e6231bcaSNikolay Aleksandrov 2201adc47037SNikolay Aleksandrov static bool br_multicast_isexc(const struct net_bridge_mcast *brmctx, 2202adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2203ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2204ddc255d9SNikolay Aleksandrov int grec_type) 2205e6231bcaSNikolay Aleksandrov { 2206e6231bcaSNikolay Aleksandrov bool changed = false; 2207e6231bcaSNikolay Aleksandrov 2208e6231bcaSNikolay Aleksandrov switch (pg->filter_mode) { 2209e6231bcaSNikolay Aleksandrov case MCAST_INCLUDE: 2210adc47037SNikolay Aleksandrov __grp_src_isexc_incl(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2211ddc255d9SNikolay Aleksandrov grec_type); 22128266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 2213e6231bcaSNikolay Aleksandrov changed = true; 2214e6231bcaSNikolay Aleksandrov break; 2215e6231bcaSNikolay Aleksandrov case MCAST_EXCLUDE: 2216adc47037SNikolay Aleksandrov changed = __grp_src_isexc_excl(brmctx, pg, h_addr, srcs, nsrcs, 2217adc47037SNikolay Aleksandrov addr_size, grec_type); 2218e6231bcaSNikolay Aleksandrov break; 2219e6231bcaSNikolay Aleksandrov } 2220e6231bcaSNikolay Aleksandrov 2221e6231bcaSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 2222adc47037SNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(brmctx)); 2223e6231bcaSNikolay Aleksandrov 2224e6231bcaSNikolay Aleksandrov return changed; 2225e6231bcaSNikolay Aleksandrov } 2226e6231bcaSNikolay Aleksandrov 22275bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 22285bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_IN (B) INCLUDE (A+B) (B)=GMI 22295bf1e00bSNikolay Aleksandrov * Send Q(G,A-B) 22305bf1e00bSNikolay Aleksandrov */ 2231adc47037SNikolay Aleksandrov static bool __grp_src_toin_incl(struct net_bridge_mcast *brmctx, 2232adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2233adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2234ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2235ddc255d9SNikolay Aleksandrov int grec_type) 22365bf1e00bSNikolay Aleksandrov { 22375bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 22385bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 22395bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 22405bf1e00bSNikolay Aleksandrov bool changed = false; 22415bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 22425bf1e00bSNikolay Aleksandrov 22435bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 22445bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 22455bf1e00bSNikolay Aleksandrov 22465bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2247085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 22485bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2249e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 22505bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 22515bf1e00bSNikolay Aleksandrov if (ent) { 22525bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 22535bf1e00bSNikolay Aleksandrov to_send--; 22545bf1e00bSNikolay Aleksandrov } else { 22555bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 22565bf1e00bSNikolay Aleksandrov if (ent) 22575bf1e00bSNikolay Aleksandrov changed = true; 22585bf1e00bSNikolay Aleksandrov } 22595bf1e00bSNikolay Aleksandrov if (ent) 2260adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 22615bf1e00bSNikolay Aleksandrov } 22625bf1e00bSNikolay Aleksandrov 2263adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2264adc47037SNikolay Aleksandrov grec_type)) 2265ddc255d9SNikolay Aleksandrov changed = true; 2266ddc255d9SNikolay Aleksandrov 22675bf1e00bSNikolay Aleksandrov if (to_send) 2268adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 22695bf1e00bSNikolay Aleksandrov 22705bf1e00bSNikolay Aleksandrov return changed; 22715bf1e00bSNikolay Aleksandrov } 22725bf1e00bSNikolay Aleksandrov 22735bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 22745bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_IN (A) EXCLUDE (X+A,Y-A) (A)=GMI 22755bf1e00bSNikolay Aleksandrov * Send Q(G,X-A) 22765bf1e00bSNikolay Aleksandrov * Send Q(G) 22775bf1e00bSNikolay Aleksandrov */ 2278adc47037SNikolay Aleksandrov static bool __grp_src_toin_excl(struct net_bridge_mcast *brmctx, 2279adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2280adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2281ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2282ddc255d9SNikolay Aleksandrov int grec_type) 22835bf1e00bSNikolay Aleksandrov { 22845bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 22855bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 22865bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 22875bf1e00bSNikolay Aleksandrov bool changed = false; 22885bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 22895bf1e00bSNikolay Aleksandrov 22905bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 22915bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) 22925bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 22935bf1e00bSNikolay Aleksandrov 22945bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2295085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 22965bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2297e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 22985bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 22995bf1e00bSNikolay Aleksandrov if (ent) { 23005bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) { 23015bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 23025bf1e00bSNikolay Aleksandrov to_send--; 23035bf1e00bSNikolay Aleksandrov } 23045bf1e00bSNikolay Aleksandrov } else { 23055bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 23065bf1e00bSNikolay Aleksandrov if (ent) 23075bf1e00bSNikolay Aleksandrov changed = true; 23085bf1e00bSNikolay Aleksandrov } 23095bf1e00bSNikolay Aleksandrov if (ent) 2310adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 23115bf1e00bSNikolay Aleksandrov } 23125bf1e00bSNikolay Aleksandrov 2313adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2314adc47037SNikolay Aleksandrov grec_type)) 2315ddc255d9SNikolay Aleksandrov changed = true; 2316ddc255d9SNikolay Aleksandrov 23175bf1e00bSNikolay Aleksandrov if (to_send) 2318adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 23195bf1e00bSNikolay Aleksandrov 2320adc47037SNikolay Aleksandrov __grp_send_query_and_rexmit(brmctx, pmctx, pg); 23215bf1e00bSNikolay Aleksandrov 23225bf1e00bSNikolay Aleksandrov return changed; 23235bf1e00bSNikolay Aleksandrov } 23245bf1e00bSNikolay Aleksandrov 2325adc47037SNikolay Aleksandrov static bool br_multicast_toin(struct net_bridge_mcast *brmctx, 2326adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2327adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2328ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2329ddc255d9SNikolay Aleksandrov int grec_type) 23305bf1e00bSNikolay Aleksandrov { 23315bf1e00bSNikolay Aleksandrov bool changed = false; 23325bf1e00bSNikolay Aleksandrov 23335bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 23345bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 2335adc47037SNikolay Aleksandrov changed = __grp_src_toin_incl(brmctx, pmctx, pg, h_addr, srcs, 2336adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 23375bf1e00bSNikolay Aleksandrov break; 23385bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 2339adc47037SNikolay Aleksandrov changed = __grp_src_toin_excl(brmctx, pmctx, pg, h_addr, srcs, 2340adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 23415bf1e00bSNikolay Aleksandrov break; 23425bf1e00bSNikolay Aleksandrov } 23435bf1e00bSNikolay Aleksandrov 2344ddc255d9SNikolay Aleksandrov if (br_multicast_eht_should_del_pg(pg)) { 2345d5a10222SNikolay Aleksandrov pg->flags |= MDB_PG_FLAGS_FAST_LEAVE; 2346ddc255d9SNikolay Aleksandrov br_multicast_find_del_pg(pg->key.port->br, pg); 2347ddc255d9SNikolay Aleksandrov /* a notification has already been sent and we shouldn't 2348ddc255d9SNikolay Aleksandrov * access pg after the delete so we have to return false 2349ddc255d9SNikolay Aleksandrov */ 2350ddc255d9SNikolay Aleksandrov changed = false; 2351ddc255d9SNikolay Aleksandrov } 2352ddc255d9SNikolay Aleksandrov 23535bf1e00bSNikolay Aleksandrov return changed; 23545bf1e00bSNikolay Aleksandrov } 23555bf1e00bSNikolay Aleksandrov 23565bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 23575bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 23585bf1e00bSNikolay Aleksandrov * Delete (A-B) 23595bf1e00bSNikolay Aleksandrov * Send Q(G,A*B) 23605bf1e00bSNikolay Aleksandrov * Group Timer=GMI 23615bf1e00bSNikolay Aleksandrov */ 2362adc47037SNikolay Aleksandrov static void __grp_src_toex_incl(struct net_bridge_mcast *brmctx, 2363adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2364adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2365ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2366ddc255d9SNikolay Aleksandrov int grec_type) 23675bf1e00bSNikolay Aleksandrov { 23685bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 23695bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 23705bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 23715bf1e00bSNikolay Aleksandrov 23725bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 23735bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 23745bf1e00bSNikolay Aleksandrov 23755bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2376085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 23775bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2378e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 23795bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 23805bf1e00bSNikolay Aleksandrov if (ent) { 23815bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_DELETE) | 23825bf1e00bSNikolay Aleksandrov BR_SGRP_F_SEND; 23835bf1e00bSNikolay Aleksandrov to_send++; 23845bf1e00bSNikolay Aleksandrov } else { 2385b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 23865bf1e00bSNikolay Aleksandrov } 2387b0812368SNikolay Aleksandrov if (ent) 2388b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 23895bf1e00bSNikolay Aleksandrov } 23905bf1e00bSNikolay Aleksandrov 2391adc47037SNikolay Aleksandrov br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2392adc47037SNikolay Aleksandrov grec_type); 2393ddc255d9SNikolay Aleksandrov 23945bf1e00bSNikolay Aleksandrov __grp_src_delete_marked(pg); 23955bf1e00bSNikolay Aleksandrov if (to_send) 2396adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 23975bf1e00bSNikolay Aleksandrov } 23985bf1e00bSNikolay Aleksandrov 23995bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 24005bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=Group Timer 24015bf1e00bSNikolay Aleksandrov * Delete (X-A) 24025bf1e00bSNikolay Aleksandrov * Delete (Y-A) 24035bf1e00bSNikolay Aleksandrov * Send Q(G,A-Y) 24045bf1e00bSNikolay Aleksandrov * Group Timer=GMI 24055bf1e00bSNikolay Aleksandrov */ 2406adc47037SNikolay Aleksandrov static bool __grp_src_toex_excl(struct net_bridge_mcast *brmctx, 2407adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2408adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2409ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2410ddc255d9SNikolay Aleksandrov int grec_type) 24115bf1e00bSNikolay Aleksandrov { 24125bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 24135bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 24145bf1e00bSNikolay Aleksandrov bool changed = false; 24155bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 24165bf1e00bSNikolay Aleksandrov 24175bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 24185bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 24195bf1e00bSNikolay Aleksandrov 24205bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2421085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 24225bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2423e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 24245bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 24255bf1e00bSNikolay Aleksandrov if (ent) { 24265bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 24275bf1e00bSNikolay Aleksandrov } else { 24285bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 24295bf1e00bSNikolay Aleksandrov if (ent) { 2430b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 24315bf1e00bSNikolay Aleksandrov changed = true; 24325bf1e00bSNikolay Aleksandrov } 24335bf1e00bSNikolay Aleksandrov } 24345bf1e00bSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 24355bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 24365bf1e00bSNikolay Aleksandrov to_send++; 24375bf1e00bSNikolay Aleksandrov } 24385bf1e00bSNikolay Aleksandrov } 24395bf1e00bSNikolay Aleksandrov 2440adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2441adc47037SNikolay Aleksandrov grec_type)) 2442ddc255d9SNikolay Aleksandrov changed = true; 2443ddc255d9SNikolay Aleksandrov 24445bf1e00bSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 24455bf1e00bSNikolay Aleksandrov changed = true; 24465bf1e00bSNikolay Aleksandrov if (to_send) 2447adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 24485bf1e00bSNikolay Aleksandrov 24495bf1e00bSNikolay Aleksandrov return changed; 24505bf1e00bSNikolay Aleksandrov } 24515bf1e00bSNikolay Aleksandrov 2452adc47037SNikolay Aleksandrov static bool br_multicast_toex(struct net_bridge_mcast *brmctx, 2453adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2454adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2455ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2456ddc255d9SNikolay Aleksandrov int grec_type) 24575bf1e00bSNikolay Aleksandrov { 24585bf1e00bSNikolay Aleksandrov bool changed = false; 24595bf1e00bSNikolay Aleksandrov 24605bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 24615bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 2462adc47037SNikolay Aleksandrov __grp_src_toex_incl(brmctx, pmctx, pg, h_addr, srcs, nsrcs, 2463adc47037SNikolay Aleksandrov addr_size, grec_type); 24648266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 24655bf1e00bSNikolay Aleksandrov changed = true; 24665bf1e00bSNikolay Aleksandrov break; 24675bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 2468adc47037SNikolay Aleksandrov changed = __grp_src_toex_excl(brmctx, pmctx, pg, h_addr, srcs, 2469adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 24705bf1e00bSNikolay Aleksandrov break; 24715bf1e00bSNikolay Aleksandrov } 24725bf1e00bSNikolay Aleksandrov 24735bf1e00bSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 2474adc47037SNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(brmctx)); 24755bf1e00bSNikolay Aleksandrov 24765bf1e00bSNikolay Aleksandrov return changed; 24775bf1e00bSNikolay Aleksandrov } 24785bf1e00bSNikolay Aleksandrov 2479109865feSNikolay Aleksandrov /* State Msg type New state Actions 2480109865feSNikolay Aleksandrov * INCLUDE (A) BLOCK (B) INCLUDE (A) Send Q(G,A*B) 2481109865feSNikolay Aleksandrov */ 2482adc47037SNikolay Aleksandrov static bool __grp_src_block_incl(struct net_bridge_mcast *brmctx, 2483adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2484adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2485474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2486109865feSNikolay Aleksandrov { 2487109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2488109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 24890ad57c99SNikolay Aleksandrov bool changed = false; 2490109865feSNikolay Aleksandrov struct br_ip src_ip; 2491109865feSNikolay Aleksandrov 2492109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2493109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2494109865feSNikolay Aleksandrov 2495109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2496085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2497109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2498e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2499109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2500109865feSNikolay Aleksandrov if (ent) { 2501109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2502109865feSNikolay Aleksandrov to_send++; 2503109865feSNikolay Aleksandrov } 2504109865feSNikolay Aleksandrov } 2505109865feSNikolay Aleksandrov 2506adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2507adc47037SNikolay Aleksandrov grec_type)) 2508474ddb37SNikolay Aleksandrov changed = true; 2509474ddb37SNikolay Aleksandrov 2510109865feSNikolay Aleksandrov if (to_send) 2511adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 2512109865feSNikolay Aleksandrov 25130ad57c99SNikolay Aleksandrov return changed; 2514109865feSNikolay Aleksandrov } 2515109865feSNikolay Aleksandrov 2516109865feSNikolay Aleksandrov /* State Msg type New state Actions 2517109865feSNikolay Aleksandrov * EXCLUDE (X,Y) BLOCK (A) EXCLUDE (X+(A-Y),Y) (A-X-Y)=Group Timer 2518109865feSNikolay Aleksandrov * Send Q(G,A-Y) 2519109865feSNikolay Aleksandrov */ 2520adc47037SNikolay Aleksandrov static bool __grp_src_block_excl(struct net_bridge_mcast *brmctx, 2521adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2522adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2523474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2524109865feSNikolay Aleksandrov { 2525109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2526109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 2527109865feSNikolay Aleksandrov bool changed = false; 2528109865feSNikolay Aleksandrov struct br_ip src_ip; 2529109865feSNikolay Aleksandrov 2530109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2531109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2532109865feSNikolay Aleksandrov 2533109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2534085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2535109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2536e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2537109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2538109865feSNikolay Aleksandrov if (!ent) { 2539109865feSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2540109865feSNikolay Aleksandrov if (ent) { 2541b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 2542109865feSNikolay Aleksandrov changed = true; 2543109865feSNikolay Aleksandrov } 2544109865feSNikolay Aleksandrov } 2545109865feSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 2546109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2547109865feSNikolay Aleksandrov to_send++; 2548109865feSNikolay Aleksandrov } 2549109865feSNikolay Aleksandrov } 2550109865feSNikolay Aleksandrov 2551adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2552adc47037SNikolay Aleksandrov grec_type)) 2553474ddb37SNikolay Aleksandrov changed = true; 2554474ddb37SNikolay Aleksandrov 2555109865feSNikolay Aleksandrov if (to_send) 2556adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 2557109865feSNikolay Aleksandrov 2558109865feSNikolay Aleksandrov return changed; 2559109865feSNikolay Aleksandrov } 2560109865feSNikolay Aleksandrov 2561adc47037SNikolay Aleksandrov static bool br_multicast_block(struct net_bridge_mcast *brmctx, 2562adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2563adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2564474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2565109865feSNikolay Aleksandrov { 2566109865feSNikolay Aleksandrov bool changed = false; 2567109865feSNikolay Aleksandrov 2568109865feSNikolay Aleksandrov switch (pg->filter_mode) { 2569109865feSNikolay Aleksandrov case MCAST_INCLUDE: 2570adc47037SNikolay Aleksandrov changed = __grp_src_block_incl(brmctx, pmctx, pg, h_addr, srcs, 2571adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 2572109865feSNikolay Aleksandrov break; 2573109865feSNikolay Aleksandrov case MCAST_EXCLUDE: 2574adc47037SNikolay Aleksandrov changed = __grp_src_block_excl(brmctx, pmctx, pg, h_addr, srcs, 2575adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 2576109865feSNikolay Aleksandrov break; 2577109865feSNikolay Aleksandrov } 2578109865feSNikolay Aleksandrov 2579e87e4b5cSNikolay Aleksandrov if ((pg->filter_mode == MCAST_INCLUDE && hlist_empty(&pg->src_list)) || 2580e87e4b5cSNikolay Aleksandrov br_multicast_eht_should_del_pg(pg)) { 2581d5a10222SNikolay Aleksandrov if (br_multicast_eht_should_del_pg(pg)) 2582d5a10222SNikolay Aleksandrov pg->flags |= MDB_PG_FLAGS_FAST_LEAVE; 2583e87e4b5cSNikolay Aleksandrov br_multicast_find_del_pg(pg->key.port->br, pg); 2584e87e4b5cSNikolay Aleksandrov /* a notification has already been sent and we shouldn't 2585e87e4b5cSNikolay Aleksandrov * access pg after the delete so we have to return false 2586e87e4b5cSNikolay Aleksandrov */ 2587e87e4b5cSNikolay Aleksandrov changed = false; 2588e87e4b5cSNikolay Aleksandrov } 2589e87e4b5cSNikolay Aleksandrov 2590109865feSNikolay Aleksandrov return changed; 2591109865feSNikolay Aleksandrov } 2592109865feSNikolay Aleksandrov 25930436862eSNikolay Aleksandrov static struct net_bridge_port_group * 25940436862eSNikolay Aleksandrov br_multicast_find_port(struct net_bridge_mdb_entry *mp, 25950436862eSNikolay Aleksandrov struct net_bridge_port *p, 25960436862eSNikolay Aleksandrov const unsigned char *src) 25970436862eSNikolay Aleksandrov { 2598071445c6SNikolay Aleksandrov struct net_bridge *br __maybe_unused = mp->br; 25990436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 26000436862eSNikolay Aleksandrov 26010436862eSNikolay Aleksandrov for (pg = mlock_dereference(mp->ports, br); 26020436862eSNikolay Aleksandrov pg; 26030436862eSNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) 26040436862eSNikolay Aleksandrov if (br_port_group_equal(pg, p, src)) 26050436862eSNikolay Aleksandrov return pg; 26060436862eSNikolay Aleksandrov 26070436862eSNikolay Aleksandrov return NULL; 26080436862eSNikolay Aleksandrov } 26090436862eSNikolay Aleksandrov 2610adc47037SNikolay Aleksandrov static int br_ip4_multicast_igmp3_report(struct net_bridge_mcast *brmctx, 2611adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 261206499098SVlad Yasevich struct sk_buff *skb, 261306499098SVlad Yasevich u16 vid) 2614eb1d1641SHerbert Xu { 2615adc47037SNikolay Aleksandrov bool igmpv2 = brmctx->multicast_igmp_version == 2; 26160436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 26170436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 26186db6f0eaSFelix Fietkau const unsigned char *src; 2619eb1d1641SHerbert Xu struct igmpv3_report *ih; 2620eb1d1641SHerbert Xu struct igmpv3_grec *grec; 26210436862eSNikolay Aleksandrov int i, len, num, type; 262254bea721SNikolay Aleksandrov __be32 group, *h_addr; 26230436862eSNikolay Aleksandrov bool changed = false; 26240436862eSNikolay Aleksandrov int err = 0; 2625e57f6185SNikolay Aleksandrov u16 nsrcs; 2626eb1d1641SHerbert Xu 2627eb1d1641SHerbert Xu ih = igmpv3_report_hdr(skb); 2628eb1d1641SHerbert Xu num = ntohs(ih->ngrec); 2629c2d4fbd2SLinus Lüssing len = skb_transport_offset(skb) + sizeof(*ih); 2630eb1d1641SHerbert Xu 2631eb1d1641SHerbert Xu for (i = 0; i < num; i++) { 2632eb1d1641SHerbert Xu len += sizeof(*grec); 2633ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2634eb1d1641SHerbert Xu return -EINVAL; 2635eb1d1641SHerbert Xu 2636fd218cf9SHerbert Xu grec = (void *)(skb->data + len - sizeof(*grec)); 2637eb1d1641SHerbert Xu group = grec->grec_mca; 2638eb1d1641SHerbert Xu type = grec->grec_type; 2639e57f6185SNikolay Aleksandrov nsrcs = ntohs(grec->grec_nsrcs); 2640eb1d1641SHerbert Xu 2641e57f6185SNikolay Aleksandrov len += nsrcs * 4; 2642ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2643eb1d1641SHerbert Xu return -EINVAL; 2644eb1d1641SHerbert Xu 2645eb1d1641SHerbert Xu switch (type) { 2646eb1d1641SHerbert Xu case IGMPV3_MODE_IS_INCLUDE: 2647eb1d1641SHerbert Xu case IGMPV3_MODE_IS_EXCLUDE: 2648eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_INCLUDE: 2649eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_EXCLUDE: 2650eb1d1641SHerbert Xu case IGMPV3_ALLOW_NEW_SOURCES: 2651eb1d1641SHerbert Xu case IGMPV3_BLOCK_OLD_SOURCES: 2652eb1d1641SHerbert Xu break; 2653eb1d1641SHerbert Xu 2654eb1d1641SHerbert Xu default: 2655eb1d1641SHerbert Xu continue; 2656eb1d1641SHerbert Xu } 2657eb1d1641SHerbert Xu 26586db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 26590436862eSNikolay Aleksandrov if (nsrcs == 0 && 26600436862eSNikolay Aleksandrov (type == IGMPV3_CHANGE_TO_INCLUDE || 26610436862eSNikolay Aleksandrov type == IGMPV3_MODE_IS_INCLUDE)) { 2662adc47037SNikolay Aleksandrov if (!pmctx || igmpv2) { 2663adc47037SNikolay Aleksandrov br_ip4_multicast_leave_group(brmctx, pmctx, 2664adc47037SNikolay Aleksandrov group, vid, src); 26650436862eSNikolay Aleksandrov continue; 26660436862eSNikolay Aleksandrov } 2667bc8c20acSSatish Ashok } else { 2668adc47037SNikolay Aleksandrov err = br_ip4_multicast_add_group(brmctx, pmctx, group, 2669adc47037SNikolay Aleksandrov vid, src, igmpv2); 2670eb1d1641SHerbert Xu if (err) 2671eb1d1641SHerbert Xu break; 2672eb1d1641SHerbert Xu } 26730436862eSNikolay Aleksandrov 2674adc47037SNikolay Aleksandrov if (!pmctx || igmpv2) 26750436862eSNikolay Aleksandrov continue; 26760436862eSNikolay Aleksandrov 2677262985faSIdo Schimmel spin_lock(&brmctx->br->multicast_lock); 26784cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 26794cdd0d10SNikolay Aleksandrov goto unlock_continue; 26804cdd0d10SNikolay Aleksandrov 2681adc47037SNikolay Aleksandrov mdst = br_mdb_ip4_get(brmctx->br, group, vid); 26820436862eSNikolay Aleksandrov if (!mdst) 26830436862eSNikolay Aleksandrov goto unlock_continue; 2684adc47037SNikolay Aleksandrov pg = br_multicast_find_port(mdst, pmctx->port, src); 26850436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 26860436862eSNikolay Aleksandrov goto unlock_continue; 268754bea721SNikolay Aleksandrov /* reload grec and host addr */ 26880436862eSNikolay Aleksandrov grec = (void *)(skb->data + len - sizeof(*grec) - (nsrcs * 4)); 268954bea721SNikolay Aleksandrov h_addr = &ip_hdr(skb)->saddr; 26900436862eSNikolay Aleksandrov switch (type) { 26910436862eSNikolay Aleksandrov case IGMPV3_ALLOW_NEW_SOURCES: 2692adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 2693adc47037SNikolay Aleksandrov grec->grec_src, 2694474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 26950436862eSNikolay Aleksandrov break; 2696e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_INCLUDE: 2697adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 2698adc47037SNikolay Aleksandrov grec->grec_src, 2699474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2700e6231bcaSNikolay Aleksandrov break; 2701e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_EXCLUDE: 2702adc47037SNikolay Aleksandrov changed = br_multicast_isexc(brmctx, pg, h_addr, 2703adc47037SNikolay Aleksandrov grec->grec_src, 2704ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2705e6231bcaSNikolay Aleksandrov break; 27065bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_INCLUDE: 2707adc47037SNikolay Aleksandrov changed = br_multicast_toin(brmctx, pmctx, pg, h_addr, 2708adc47037SNikolay Aleksandrov grec->grec_src, 2709ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 27105bf1e00bSNikolay Aleksandrov break; 27115bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_EXCLUDE: 2712adc47037SNikolay Aleksandrov changed = br_multicast_toex(brmctx, pmctx, pg, h_addr, 2713adc47037SNikolay Aleksandrov grec->grec_src, 2714ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 27155bf1e00bSNikolay Aleksandrov break; 2716109865feSNikolay Aleksandrov case IGMPV3_BLOCK_OLD_SOURCES: 2717adc47037SNikolay Aleksandrov changed = br_multicast_block(brmctx, pmctx, pg, h_addr, 2718adc47037SNikolay Aleksandrov grec->grec_src, 2719474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2720109865feSNikolay Aleksandrov break; 27210436862eSNikolay Aleksandrov } 27220436862eSNikolay Aleksandrov if (changed) 2723adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mdst, pg, RTM_NEWMDB); 27240436862eSNikolay Aleksandrov unlock_continue: 2725262985faSIdo Schimmel spin_unlock(&brmctx->br->multicast_lock); 2726bc8c20acSSatish Ashok } 2727eb1d1641SHerbert Xu 2728eb1d1641SHerbert Xu return err; 2729eb1d1641SHerbert Xu } 2730eb1d1641SHerbert Xu 2731dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 2732adc47037SNikolay Aleksandrov static int br_ip6_multicast_mld2_report(struct net_bridge_mcast *brmctx, 2733adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 273406499098SVlad Yasevich struct sk_buff *skb, 273506499098SVlad Yasevich u16 vid) 273608b202b6SYOSHIFUJI Hideaki { 2737adc47037SNikolay Aleksandrov bool mldv1 = brmctx->multicast_mld_version == 1; 27380436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 27390436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 2740ba5ea614SLinus Lüssing unsigned int nsrcs_offset; 27416baeb395SMichelleJin struct mld2_report *mld2r; 27426db6f0eaSFelix Fietkau const unsigned char *src; 274354bea721SNikolay Aleksandrov struct in6_addr *h_addr; 274408b202b6SYOSHIFUJI Hideaki struct mld2_grec *grec; 2745ba5ea614SLinus Lüssing unsigned int grec_len; 27460436862eSNikolay Aleksandrov bool changed = false; 27470436862eSNikolay Aleksandrov int i, len, num; 274808b202b6SYOSHIFUJI Hideaki int err = 0; 274908b202b6SYOSHIFUJI Hideaki 27506baeb395SMichelleJin if (!ipv6_mc_may_pull(skb, sizeof(*mld2r))) 275108b202b6SYOSHIFUJI Hideaki return -EINVAL; 275208b202b6SYOSHIFUJI Hideaki 27536baeb395SMichelleJin mld2r = (struct mld2_report *)icmp6_hdr(skb); 27546baeb395SMichelleJin num = ntohs(mld2r->mld2r_ngrec); 27556baeb395SMichelleJin len = skb_transport_offset(skb) + sizeof(*mld2r); 275608b202b6SYOSHIFUJI Hideaki 275708b202b6SYOSHIFUJI Hideaki for (i = 0; i < num; i++) { 2758e57f6185SNikolay Aleksandrov __be16 *_nsrcs, __nsrcs; 2759e57f6185SNikolay Aleksandrov u16 nsrcs; 276008b202b6SYOSHIFUJI Hideaki 2761ba5ea614SLinus Lüssing nsrcs_offset = len + offsetof(struct mld2_grec, grec_nsrcs); 2762ba5ea614SLinus Lüssing 2763ba5ea614SLinus Lüssing if (skb_transport_offset(skb) + ipv6_transport_len(skb) < 27645fc6266aSLinus Lüssing nsrcs_offset + sizeof(__nsrcs)) 2765ba5ea614SLinus Lüssing return -EINVAL; 2766ba5ea614SLinus Lüssing 2767e57f6185SNikolay Aleksandrov _nsrcs = skb_header_pointer(skb, nsrcs_offset, 2768e57f6185SNikolay Aleksandrov sizeof(__nsrcs), &__nsrcs); 2769e57f6185SNikolay Aleksandrov if (!_nsrcs) 277008b202b6SYOSHIFUJI Hideaki return -EINVAL; 277108b202b6SYOSHIFUJI Hideaki 2772e57f6185SNikolay Aleksandrov nsrcs = ntohs(*_nsrcs); 2773e57f6185SNikolay Aleksandrov grec_len = struct_size(grec, grec_src, nsrcs); 2774ba5ea614SLinus Lüssing 2775ba5ea614SLinus Lüssing if (!ipv6_mc_may_pull(skb, len + grec_len)) 277608b202b6SYOSHIFUJI Hideaki return -EINVAL; 277708b202b6SYOSHIFUJI Hideaki 277808b202b6SYOSHIFUJI Hideaki grec = (struct mld2_grec *)(skb->data + len); 2779ba5ea614SLinus Lüssing len += grec_len; 278008b202b6SYOSHIFUJI Hideaki 278108b202b6SYOSHIFUJI Hideaki switch (grec->grec_type) { 278208b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_INCLUDE: 278308b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_EXCLUDE: 278408b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_INCLUDE: 278508b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_EXCLUDE: 278608b202b6SYOSHIFUJI Hideaki case MLD2_ALLOW_NEW_SOURCES: 278708b202b6SYOSHIFUJI Hideaki case MLD2_BLOCK_OLD_SOURCES: 278808b202b6SYOSHIFUJI Hideaki break; 278908b202b6SYOSHIFUJI Hideaki 279008b202b6SYOSHIFUJI Hideaki default: 279108b202b6SYOSHIFUJI Hideaki continue; 279208b202b6SYOSHIFUJI Hideaki } 279308b202b6SYOSHIFUJI Hideaki 27946db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 2795bc8c20acSSatish Ashok if ((grec->grec_type == MLD2_CHANGE_TO_INCLUDE || 2796bc8c20acSSatish Ashok grec->grec_type == MLD2_MODE_IS_INCLUDE) && 2797e57f6185SNikolay Aleksandrov nsrcs == 0) { 2798adc47037SNikolay Aleksandrov if (!pmctx || mldv1) { 2799adc47037SNikolay Aleksandrov br_ip6_multicast_leave_group(brmctx, pmctx, 28000436862eSNikolay Aleksandrov &grec->grec_mca, 28016db6f0eaSFelix Fietkau vid, src); 28020436862eSNikolay Aleksandrov continue; 28030436862eSNikolay Aleksandrov } 2804bc8c20acSSatish Ashok } else { 2805adc47037SNikolay Aleksandrov err = br_ip6_multicast_add_group(brmctx, pmctx, 28066db6f0eaSFelix Fietkau &grec->grec_mca, vid, 28070436862eSNikolay Aleksandrov src, mldv1); 28089264251eSDavide Caratti if (err) 280908b202b6SYOSHIFUJI Hideaki break; 281008b202b6SYOSHIFUJI Hideaki } 28110436862eSNikolay Aleksandrov 2812adc47037SNikolay Aleksandrov if (!pmctx || mldv1) 28130436862eSNikolay Aleksandrov continue; 28140436862eSNikolay Aleksandrov 2815262985faSIdo Schimmel spin_lock(&brmctx->br->multicast_lock); 28164cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 28174cdd0d10SNikolay Aleksandrov goto unlock_continue; 28184cdd0d10SNikolay Aleksandrov 2819adc47037SNikolay Aleksandrov mdst = br_mdb_ip6_get(brmctx->br, &grec->grec_mca, vid); 28200436862eSNikolay Aleksandrov if (!mdst) 28210436862eSNikolay Aleksandrov goto unlock_continue; 2822adc47037SNikolay Aleksandrov pg = br_multicast_find_port(mdst, pmctx->port, src); 28230436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 28240436862eSNikolay Aleksandrov goto unlock_continue; 282554bea721SNikolay Aleksandrov h_addr = &ipv6_hdr(skb)->saddr; 28260436862eSNikolay Aleksandrov switch (grec->grec_type) { 28270436862eSNikolay Aleksandrov case MLD2_ALLOW_NEW_SOURCES: 2828adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 282954bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2830474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 2831474ddb37SNikolay Aleksandrov grec->grec_type); 28320436862eSNikolay Aleksandrov break; 2833e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_INCLUDE: 2834adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 283554bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2836474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 2837474ddb37SNikolay Aleksandrov grec->grec_type); 2838e6231bcaSNikolay Aleksandrov break; 2839e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_EXCLUDE: 2840adc47037SNikolay Aleksandrov changed = br_multicast_isexc(brmctx, pg, h_addr, 284154bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2842ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 2843ddc255d9SNikolay Aleksandrov grec->grec_type); 2844e6231bcaSNikolay Aleksandrov break; 28455bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_INCLUDE: 2846adc47037SNikolay Aleksandrov changed = br_multicast_toin(brmctx, pmctx, pg, h_addr, 284754bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2848ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 2849ddc255d9SNikolay Aleksandrov grec->grec_type); 28505bf1e00bSNikolay Aleksandrov break; 28515bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_EXCLUDE: 2852adc47037SNikolay Aleksandrov changed = br_multicast_toex(brmctx, pmctx, pg, h_addr, 285354bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2854ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 2855ddc255d9SNikolay Aleksandrov grec->grec_type); 28565bf1e00bSNikolay Aleksandrov break; 2857109865feSNikolay Aleksandrov case MLD2_BLOCK_OLD_SOURCES: 2858adc47037SNikolay Aleksandrov changed = br_multicast_block(brmctx, pmctx, pg, h_addr, 285954bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2860474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 2861474ddb37SNikolay Aleksandrov grec->grec_type); 2862109865feSNikolay Aleksandrov break; 28630436862eSNikolay Aleksandrov } 28640436862eSNikolay Aleksandrov if (changed) 2865adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mdst, pg, RTM_NEWMDB); 28660436862eSNikolay Aleksandrov unlock_continue: 2867262985faSIdo Schimmel spin_unlock(&brmctx->br->multicast_lock); 2868bc8c20acSSatish Ashok } 286908b202b6SYOSHIFUJI Hideaki 287008b202b6SYOSHIFUJI Hideaki return err; 287108b202b6SYOSHIFUJI Hideaki } 287208b202b6SYOSHIFUJI Hideaki #endif 287308b202b6SYOSHIFUJI Hideaki 2874c3fb3698SNikolay Aleksandrov static bool br_multicast_select_querier(struct net_bridge_mcast *brmctx, 287554cb4319SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 287667b746f9SNikolay Aleksandrov struct br_ip *saddr) 2877dc4eb53aSLinus Lüssing { 287867b746f9SNikolay Aleksandrov int port_ifidx = pmctx ? pmctx->port->dev->ifindex : 0; 2879c3fb3698SNikolay Aleksandrov struct timer_list *own_timer, *other_timer; 2880c3fb3698SNikolay Aleksandrov struct bridge_mcast_querier *querier; 288154cb4319SNikolay Aleksandrov 2882c3fb3698SNikolay Aleksandrov switch (saddr->proto) { 2883c3fb3698SNikolay Aleksandrov case htons(ETH_P_IP): 2884c3fb3698SNikolay Aleksandrov querier = &brmctx->ip4_querier; 2885c3fb3698SNikolay Aleksandrov own_timer = &brmctx->ip4_own_query.timer; 2886c3fb3698SNikolay Aleksandrov other_timer = &brmctx->ip4_other_query.timer; 2887c3fb3698SNikolay Aleksandrov if (!querier->addr.src.ip4 || 2888c3fb3698SNikolay Aleksandrov ntohl(saddr->src.ip4) <= ntohl(querier->addr.src.ip4)) 2889dc4eb53aSLinus Lüssing goto update; 2890c3fb3698SNikolay Aleksandrov break; 2891dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 2892c3fb3698SNikolay Aleksandrov case htons(ETH_P_IPV6): 2893c3fb3698SNikolay Aleksandrov querier = &brmctx->ip6_querier; 2894c3fb3698SNikolay Aleksandrov own_timer = &brmctx->ip6_own_query.timer; 2895c3fb3698SNikolay Aleksandrov other_timer = &brmctx->ip6_other_query.timer; 2896c3fb3698SNikolay Aleksandrov if (ipv6_addr_cmp(&saddr->src.ip6, &querier->addr.src.ip6) <= 0) 2897dc4eb53aSLinus Lüssing goto update; 2898c3fb3698SNikolay Aleksandrov break; 2899c3fb3698SNikolay Aleksandrov #endif 2900c3fb3698SNikolay Aleksandrov default: 2901c3fb3698SNikolay Aleksandrov return false; 2902c3fb3698SNikolay Aleksandrov } 2903dc4eb53aSLinus Lüssing 2904c3fb3698SNikolay Aleksandrov if (!timer_pending(own_timer) && !timer_pending(other_timer)) 2905dc4eb53aSLinus Lüssing goto update; 2906dc4eb53aSLinus Lüssing 2907dc4eb53aSLinus Lüssing return false; 2908dc4eb53aSLinus Lüssing 2909dc4eb53aSLinus Lüssing update: 2910c3fb3698SNikolay Aleksandrov br_multicast_update_querier(brmctx, querier, port_ifidx, saddr); 29112cd41431SLinus Lüssing 2912dc4eb53aSLinus Lüssing return true; 2913dc4eb53aSLinus Lüssing } 2914dc4eb53aSLinus Lüssing 2915c7fa1d9bSNikolay Aleksandrov static struct net_bridge_port * 2916c7fa1d9bSNikolay Aleksandrov __br_multicast_get_querier_port(struct net_bridge *br, 2917c7fa1d9bSNikolay Aleksandrov const struct bridge_mcast_querier *querier) 2918c7fa1d9bSNikolay Aleksandrov { 2919c7fa1d9bSNikolay Aleksandrov int port_ifidx = READ_ONCE(querier->port_ifidx); 2920c7fa1d9bSNikolay Aleksandrov struct net_bridge_port *p; 2921c7fa1d9bSNikolay Aleksandrov struct net_device *dev; 2922c7fa1d9bSNikolay Aleksandrov 2923c7fa1d9bSNikolay Aleksandrov if (port_ifidx == 0) 2924c7fa1d9bSNikolay Aleksandrov return NULL; 2925c7fa1d9bSNikolay Aleksandrov 2926c7fa1d9bSNikolay Aleksandrov dev = dev_get_by_index_rcu(dev_net(br->dev), port_ifidx); 2927c7fa1d9bSNikolay Aleksandrov if (!dev) 2928c7fa1d9bSNikolay Aleksandrov return NULL; 2929c7fa1d9bSNikolay Aleksandrov p = br_port_get_rtnl_rcu(dev); 2930c7fa1d9bSNikolay Aleksandrov if (!p || p->br != br) 2931c7fa1d9bSNikolay Aleksandrov return NULL; 2932c7fa1d9bSNikolay Aleksandrov 2933c7fa1d9bSNikolay Aleksandrov return p; 2934c7fa1d9bSNikolay Aleksandrov } 2935c7fa1d9bSNikolay Aleksandrov 2936c7fa1d9bSNikolay Aleksandrov size_t br_multicast_querier_state_size(void) 2937c7fa1d9bSNikolay Aleksandrov { 2938cdda378bSNikolay Aleksandrov return nla_total_size(0) + /* nest attribute */ 2939c7fa1d9bSNikolay Aleksandrov nla_total_size(sizeof(__be32)) + /* BRIDGE_QUERIER_IP_ADDRESS */ 2940c7fa1d9bSNikolay Aleksandrov nla_total_size(sizeof(int)) + /* BRIDGE_QUERIER_IP_PORT */ 2941175e6692SNikolay Aleksandrov nla_total_size_64bit(sizeof(u64)) + /* BRIDGE_QUERIER_IP_OTHER_TIMER */ 2942175e6692SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 2943175e6692SNikolay Aleksandrov nla_total_size(sizeof(struct in6_addr)) + /* BRIDGE_QUERIER_IPV6_ADDRESS */ 2944175e6692SNikolay Aleksandrov nla_total_size(sizeof(int)) + /* BRIDGE_QUERIER_IPV6_PORT */ 2945175e6692SNikolay Aleksandrov nla_total_size_64bit(sizeof(u64)) + /* BRIDGE_QUERIER_IPV6_OTHER_TIMER */ 2946175e6692SNikolay Aleksandrov #endif 2947175e6692SNikolay Aleksandrov 0; 2948c7fa1d9bSNikolay Aleksandrov } 2949c7fa1d9bSNikolay Aleksandrov 2950c7fa1d9bSNikolay Aleksandrov /* protected by rtnl or rcu */ 2951c7fa1d9bSNikolay Aleksandrov int br_multicast_dump_querier_state(struct sk_buff *skb, 2952c7fa1d9bSNikolay Aleksandrov const struct net_bridge_mcast *brmctx, 2953c7fa1d9bSNikolay Aleksandrov int nest_attr) 2954c7fa1d9bSNikolay Aleksandrov { 2955c7fa1d9bSNikolay Aleksandrov struct bridge_mcast_querier querier = {}; 2956c7fa1d9bSNikolay Aleksandrov struct net_bridge_port *p; 2957c7fa1d9bSNikolay Aleksandrov struct nlattr *nest; 2958c7fa1d9bSNikolay Aleksandrov 2959f137b7d4SNikolay Aleksandrov if (!br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED) || 2960f137b7d4SNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(brmctx)) 2961f137b7d4SNikolay Aleksandrov return 0; 2962f137b7d4SNikolay Aleksandrov 2963c7fa1d9bSNikolay Aleksandrov nest = nla_nest_start(skb, nest_attr); 2964c7fa1d9bSNikolay Aleksandrov if (!nest) 2965c7fa1d9bSNikolay Aleksandrov return -EMSGSIZE; 2966c7fa1d9bSNikolay Aleksandrov 2967c7fa1d9bSNikolay Aleksandrov rcu_read_lock(); 296885b41082SNikolay Aleksandrov if (!brmctx->multicast_querier && 296985b41082SNikolay Aleksandrov !timer_pending(&brmctx->ip4_other_query.timer)) 297085b41082SNikolay Aleksandrov goto out_v6; 297185b41082SNikolay Aleksandrov 2972c7fa1d9bSNikolay Aleksandrov br_multicast_read_querier(&brmctx->ip4_querier, &querier); 2973c7fa1d9bSNikolay Aleksandrov if (nla_put_in_addr(skb, BRIDGE_QUERIER_IP_ADDRESS, 2974c7fa1d9bSNikolay Aleksandrov querier.addr.src.ip4)) { 2975c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 2976c7fa1d9bSNikolay Aleksandrov goto out_err; 2977c7fa1d9bSNikolay Aleksandrov } 2978c7fa1d9bSNikolay Aleksandrov 2979c7fa1d9bSNikolay Aleksandrov p = __br_multicast_get_querier_port(brmctx->br, &querier); 2980c7fa1d9bSNikolay Aleksandrov if (timer_pending(&brmctx->ip4_other_query.timer) && 2981c7fa1d9bSNikolay Aleksandrov (nla_put_u64_64bit(skb, BRIDGE_QUERIER_IP_OTHER_TIMER, 2982c7fa1d9bSNikolay Aleksandrov br_timer_value(&brmctx->ip4_other_query.timer), 2983c7fa1d9bSNikolay Aleksandrov BRIDGE_QUERIER_PAD) || 2984c7fa1d9bSNikolay Aleksandrov (p && nla_put_u32(skb, BRIDGE_QUERIER_IP_PORT, p->dev->ifindex)))) { 2985c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 2986c7fa1d9bSNikolay Aleksandrov goto out_err; 2987c7fa1d9bSNikolay Aleksandrov } 298885b41082SNikolay Aleksandrov 298985b41082SNikolay Aleksandrov out_v6: 299085b41082SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 299185b41082SNikolay Aleksandrov if (!brmctx->multicast_querier && 299285b41082SNikolay Aleksandrov !timer_pending(&brmctx->ip6_other_query.timer)) 299385b41082SNikolay Aleksandrov goto out; 299485b41082SNikolay Aleksandrov 299585b41082SNikolay Aleksandrov br_multicast_read_querier(&brmctx->ip6_querier, &querier); 299685b41082SNikolay Aleksandrov if (nla_put_in6_addr(skb, BRIDGE_QUERIER_IPV6_ADDRESS, 299785b41082SNikolay Aleksandrov &querier.addr.src.ip6)) { 299885b41082SNikolay Aleksandrov rcu_read_unlock(); 299985b41082SNikolay Aleksandrov goto out_err; 300085b41082SNikolay Aleksandrov } 300185b41082SNikolay Aleksandrov 300285b41082SNikolay Aleksandrov p = __br_multicast_get_querier_port(brmctx->br, &querier); 300385b41082SNikolay Aleksandrov if (timer_pending(&brmctx->ip6_other_query.timer) && 300485b41082SNikolay Aleksandrov (nla_put_u64_64bit(skb, BRIDGE_QUERIER_IPV6_OTHER_TIMER, 300585b41082SNikolay Aleksandrov br_timer_value(&brmctx->ip6_other_query.timer), 300685b41082SNikolay Aleksandrov BRIDGE_QUERIER_PAD) || 300785b41082SNikolay Aleksandrov (p && nla_put_u32(skb, BRIDGE_QUERIER_IPV6_PORT, 300885b41082SNikolay Aleksandrov p->dev->ifindex)))) { 300985b41082SNikolay Aleksandrov rcu_read_unlock(); 301085b41082SNikolay Aleksandrov goto out_err; 301185b41082SNikolay Aleksandrov } 301285b41082SNikolay Aleksandrov out: 301385b41082SNikolay Aleksandrov #endif 3014c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 3015c7fa1d9bSNikolay Aleksandrov nla_nest_end(skb, nest); 301685b41082SNikolay Aleksandrov if (!nla_len(nest)) 301785b41082SNikolay Aleksandrov nla_nest_cancel(skb, nest); 3018c7fa1d9bSNikolay Aleksandrov 3019c7fa1d9bSNikolay Aleksandrov return 0; 3020c7fa1d9bSNikolay Aleksandrov 3021c7fa1d9bSNikolay Aleksandrov out_err: 3022c7fa1d9bSNikolay Aleksandrov nla_nest_cancel(skb, nest); 3023c7fa1d9bSNikolay Aleksandrov return -EMSGSIZE; 3024c7fa1d9bSNikolay Aleksandrov } 3025c7fa1d9bSNikolay Aleksandrov 3026cc0fdd80SLinus Lüssing static void 3027adc47037SNikolay Aleksandrov br_multicast_update_query_timer(struct net_bridge_mcast *brmctx, 302890010b36SLinus Lüssing struct bridge_mcast_other_query *query, 3029b00589afSLinus Lüssing unsigned long max_delay) 3030b00589afSLinus Lüssing { 303190010b36SLinus Lüssing if (!timer_pending(&query->timer)) 303290010b36SLinus Lüssing query->delay_time = jiffies + max_delay; 3033b00589afSLinus Lüssing 3034adc47037SNikolay Aleksandrov mod_timer(&query->timer, jiffies + brmctx->multicast_querier_interval); 3035b00589afSLinus Lüssing } 3036b00589afSLinus Lüssing 30376d549648SNogah Frankel static void br_port_mc_router_state_change(struct net_bridge_port *p, 30386d549648SNogah Frankel bool is_mc_router) 30396d549648SNogah Frankel { 30406d549648SNogah Frankel struct switchdev_attr attr = { 30416d549648SNogah Frankel .orig_dev = p->dev, 30426d549648SNogah Frankel .id = SWITCHDEV_ATTR_ID_PORT_MROUTER, 30436d549648SNogah Frankel .flags = SWITCHDEV_F_DEFER, 30446d549648SNogah Frankel .u.mrouter = is_mc_router, 30456d549648SNogah Frankel }; 30466d549648SNogah Frankel 3047dcbdf135SVladimir Oltean switchdev_port_attr_set(p->dev, &attr, NULL); 30486d549648SNogah Frankel } 30496d549648SNogah Frankel 3050d9b8c4d8SLinus Lüssing static struct net_bridge_port * 3051d3d065c0SNikolay Aleksandrov br_multicast_rport_from_node(struct net_bridge_mcast *brmctx, 3052d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list, 3053d9b8c4d8SLinus Lüssing struct hlist_node *rlist) 3054d9b8c4d8SLinus Lüssing { 30559632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 30569632233eSNikolay Aleksandrov 3057a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3058d3d065c0SNikolay Aleksandrov if (mc_router_list == &brmctx->ip6_mc_router_list) 30599632233eSNikolay Aleksandrov pmctx = hlist_entry(rlist, struct net_bridge_mcast_port, 30609632233eSNikolay Aleksandrov ip6_rlist); 30619632233eSNikolay Aleksandrov else 3062a3c02e76SLinus Lüssing #endif 30639632233eSNikolay Aleksandrov pmctx = hlist_entry(rlist, struct net_bridge_mcast_port, 30649632233eSNikolay Aleksandrov ip4_rlist); 30659632233eSNikolay Aleksandrov 30669632233eSNikolay Aleksandrov return pmctx->port; 3067d9b8c4d8SLinus Lüssing } 3068d9b8c4d8SLinus Lüssing 3069d9b8c4d8SLinus Lüssing static struct hlist_node * 3070d3d065c0SNikolay Aleksandrov br_multicast_get_rport_slot(struct net_bridge_mcast *brmctx, 3071d9b8c4d8SLinus Lüssing struct net_bridge_port *port, 3072d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 3073d9b8c4d8SLinus Lüssing 3074d9b8c4d8SLinus Lüssing { 3075d9b8c4d8SLinus Lüssing struct hlist_node *slot = NULL; 3076d9b8c4d8SLinus Lüssing struct net_bridge_port *p; 3077d9b8c4d8SLinus Lüssing struct hlist_node *rlist; 3078d9b8c4d8SLinus Lüssing 3079d9b8c4d8SLinus Lüssing hlist_for_each(rlist, mc_router_list) { 3080d3d065c0SNikolay Aleksandrov p = br_multicast_rport_from_node(brmctx, mc_router_list, rlist); 3081d9b8c4d8SLinus Lüssing 3082d9b8c4d8SLinus Lüssing if ((unsigned long)port >= (unsigned long)p) 3083d9b8c4d8SLinus Lüssing break; 3084d9b8c4d8SLinus Lüssing 3085d9b8c4d8SLinus Lüssing slot = rlist; 3086d9b8c4d8SLinus Lüssing } 3087d9b8c4d8SLinus Lüssing 3088d9b8c4d8SLinus Lüssing return slot; 3089d9b8c4d8SLinus Lüssing } 3090d9b8c4d8SLinus Lüssing 3091adc47037SNikolay Aleksandrov static bool br_multicast_no_router_otherpf(struct net_bridge_mcast_port *pmctx, 3092a3c02e76SLinus Lüssing struct hlist_node *rnode) 3093a3c02e76SLinus Lüssing { 3094a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3095adc47037SNikolay Aleksandrov if (rnode != &pmctx->ip6_rlist) 3096adc47037SNikolay Aleksandrov return hlist_unhashed(&pmctx->ip6_rlist); 3097a3c02e76SLinus Lüssing else 3098adc47037SNikolay Aleksandrov return hlist_unhashed(&pmctx->ip4_rlist); 3099a3c02e76SLinus Lüssing #else 3100a3c02e76SLinus Lüssing return true; 3101a3c02e76SLinus Lüssing #endif 3102a3c02e76SLinus Lüssing } 3103a3c02e76SLinus Lüssing 3104d9b8c4d8SLinus Lüssing /* Add port to router_list 31057e80c124Sstephen hemminger * list is maintained ordered by pointer value 31067e80c124Sstephen hemminger * and locked by br->multicast_lock and RCU 31077e80c124Sstephen hemminger */ 3108d3d065c0SNikolay Aleksandrov static void br_multicast_add_router(struct net_bridge_mcast *brmctx, 3109adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3110d9b8c4d8SLinus Lüssing struct hlist_node *rlist, 3111d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 31120909e117SHerbert Xu { 3113d9b8c4d8SLinus Lüssing struct hlist_node *slot; 31140909e117SHerbert Xu 3115d9b8c4d8SLinus Lüssing if (!hlist_unhashed(rlist)) 31161a040eacSNikolay Aleksandrov return; 31171a040eacSNikolay Aleksandrov 3118adc47037SNikolay Aleksandrov slot = br_multicast_get_rport_slot(brmctx, pmctx->port, mc_router_list); 31190909e117SHerbert Xu 31207e80c124Sstephen hemminger if (slot) 3121d9b8c4d8SLinus Lüssing hlist_add_behind_rcu(rlist, slot); 3122dcdca2c4Sstephen hemminger else 3123d9b8c4d8SLinus Lüssing hlist_add_head_rcu(rlist, mc_router_list); 3124d9b8c4d8SLinus Lüssing 3125a3c02e76SLinus Lüssing /* For backwards compatibility for now, only notify if we 3126a3c02e76SLinus Lüssing * switched from no IPv4/IPv6 multicast router to a new 3127a3c02e76SLinus Lüssing * IPv4 or IPv6 multicast router. 3128a3c02e76SLinus Lüssing */ 3129adc47037SNikolay Aleksandrov if (br_multicast_no_router_otherpf(pmctx, rlist)) { 31301e9ca456SNikolay Aleksandrov br_rtr_notify(pmctx->port->br->dev, pmctx, RTM_NEWMDB); 3131adc47037SNikolay Aleksandrov br_port_mc_router_state_change(pmctx->port, true); 31320909e117SHerbert Xu } 3133a3c02e76SLinus Lüssing } 31340909e117SHerbert Xu 3135d9b8c4d8SLinus Lüssing /* Add port to router_list 3136d9b8c4d8SLinus Lüssing * list is maintained ordered by pointer value 3137d9b8c4d8SLinus Lüssing * and locked by br->multicast_lock and RCU 3138d9b8c4d8SLinus Lüssing */ 3139adc47037SNikolay Aleksandrov static void br_ip4_multicast_add_router(struct net_bridge_mcast *brmctx, 3140adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3141eb1d1641SHerbert Xu { 3142adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, &pmctx->ip4_rlist, 3143adc47037SNikolay Aleksandrov &brmctx->ip4_mc_router_list); 3144d9b8c4d8SLinus Lüssing } 3145d9b8c4d8SLinus Lüssing 3146a3c02e76SLinus Lüssing /* Add port to router_list 3147a3c02e76SLinus Lüssing * list is maintained ordered by pointer value 3148a3c02e76SLinus Lüssing * and locked by br->multicast_lock and RCU 3149a3c02e76SLinus Lüssing */ 3150adc47037SNikolay Aleksandrov static void br_ip6_multicast_add_router(struct net_bridge_mcast *brmctx, 3151adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3152a3c02e76SLinus Lüssing { 3153a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3154adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, &pmctx->ip6_rlist, 3155adc47037SNikolay Aleksandrov &brmctx->ip6_mc_router_list); 3156a3c02e76SLinus Lüssing #endif 3157a3c02e76SLinus Lüssing } 3158a3c02e76SLinus Lüssing 3159adc47037SNikolay Aleksandrov static void br_multicast_mark_router(struct net_bridge_mcast *brmctx, 3160adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3161d9b8c4d8SLinus Lüssing struct timer_list *timer, 3162d9b8c4d8SLinus Lüssing struct hlist_node *rlist, 3163d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 3164d9b8c4d8SLinus Lüssing { 3165eb1d1641SHerbert Xu unsigned long now = jiffies; 3166eb1d1641SHerbert Xu 31674cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 31684cdd0d10SNikolay Aleksandrov return; 31694cdd0d10SNikolay Aleksandrov 3170adc47037SNikolay Aleksandrov if (!pmctx) { 3171d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router == MDB_RTR_TYPE_TEMP_QUERY) { 3172d3d065c0SNikolay Aleksandrov if (!br_ip4_multicast_is_router(brmctx) && 3173d3d065c0SNikolay Aleksandrov !br_ip6_multicast_is_router(brmctx)) 3174adc47037SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, true); 3175d3d065c0SNikolay Aleksandrov mod_timer(timer, now + brmctx->multicast_querier_interval); 317677041420SYotam Gigi } 3177eb1d1641SHerbert Xu return; 3178eb1d1641SHerbert Xu } 3179eb1d1641SHerbert Xu 3180adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 3181adc47037SNikolay Aleksandrov pmctx->multicast_router == MDB_RTR_TYPE_PERM) 3182eb1d1641SHerbert Xu return; 3183eb1d1641SHerbert Xu 3184adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, rlist, mc_router_list); 3185d3d065c0SNikolay Aleksandrov mod_timer(timer, now + brmctx->multicast_querier_interval); 3186d9b8c4d8SLinus Lüssing } 3187eb1d1641SHerbert Xu 3188adc47037SNikolay Aleksandrov static void br_ip4_multicast_mark_router(struct net_bridge_mcast *brmctx, 3189adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3190d9b8c4d8SLinus Lüssing { 3191adc47037SNikolay Aleksandrov struct timer_list *timer = &brmctx->ip4_mc_router_timer; 3192d9b8c4d8SLinus Lüssing struct hlist_node *rlist = NULL; 3193d9b8c4d8SLinus Lüssing 3194adc47037SNikolay Aleksandrov if (pmctx) { 3195adc47037SNikolay Aleksandrov timer = &pmctx->ip4_mc_router_timer; 3196adc47037SNikolay Aleksandrov rlist = &pmctx->ip4_rlist; 3197d9b8c4d8SLinus Lüssing } 3198d9b8c4d8SLinus Lüssing 3199adc47037SNikolay Aleksandrov br_multicast_mark_router(brmctx, pmctx, timer, rlist, 3200adc47037SNikolay Aleksandrov &brmctx->ip4_mc_router_list); 3201eb1d1641SHerbert Xu } 3202eb1d1641SHerbert Xu 3203adc47037SNikolay Aleksandrov static void br_ip6_multicast_mark_router(struct net_bridge_mcast *brmctx, 3204adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3205a3c02e76SLinus Lüssing { 3206a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3207adc47037SNikolay Aleksandrov struct timer_list *timer = &brmctx->ip6_mc_router_timer; 3208a3c02e76SLinus Lüssing struct hlist_node *rlist = NULL; 3209a3c02e76SLinus Lüssing 3210adc47037SNikolay Aleksandrov if (pmctx) { 3211adc47037SNikolay Aleksandrov timer = &pmctx->ip6_mc_router_timer; 3212adc47037SNikolay Aleksandrov rlist = &pmctx->ip6_rlist; 3213a3c02e76SLinus Lüssing } 3214a3c02e76SLinus Lüssing 3215adc47037SNikolay Aleksandrov br_multicast_mark_router(brmctx, pmctx, timer, rlist, 3216adc47037SNikolay Aleksandrov &brmctx->ip6_mc_router_list); 3217a3c02e76SLinus Lüssing #endif 3218a3c02e76SLinus Lüssing } 3219a3c02e76SLinus Lüssing 3220b19232efSLinus Lüssing static void 3221adc47037SNikolay Aleksandrov br_ip4_multicast_query_received(struct net_bridge_mcast *brmctx, 3222adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 322390010b36SLinus Lüssing struct bridge_mcast_other_query *query, 3224dc4eb53aSLinus Lüssing struct br_ip *saddr, 3225b00589afSLinus Lüssing unsigned long max_delay) 3226eb1d1641SHerbert Xu { 3227c3fb3698SNikolay Aleksandrov if (!br_multicast_select_querier(brmctx, pmctx, saddr)) 3228eb1d1641SHerbert Xu return; 3229eb1d1641SHerbert Xu 3230adc47037SNikolay Aleksandrov br_multicast_update_query_timer(brmctx, query, max_delay); 3231adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3232eb1d1641SHerbert Xu } 3233eb1d1641SHerbert Xu 3234b19232efSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3235b19232efSLinus Lüssing static void 3236adc47037SNikolay Aleksandrov br_ip6_multicast_query_received(struct net_bridge_mcast *brmctx, 3237adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3238b19232efSLinus Lüssing struct bridge_mcast_other_query *query, 3239b19232efSLinus Lüssing struct br_ip *saddr, 3240b19232efSLinus Lüssing unsigned long max_delay) 3241b19232efSLinus Lüssing { 3242c3fb3698SNikolay Aleksandrov if (!br_multicast_select_querier(brmctx, pmctx, saddr)) 3243b19232efSLinus Lüssing return; 3244b19232efSLinus Lüssing 3245adc47037SNikolay Aleksandrov br_multicast_update_query_timer(brmctx, query, max_delay); 3246adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 3247b19232efSLinus Lüssing } 3248b19232efSLinus Lüssing #endif 3249b19232efSLinus Lüssing 3250adc47037SNikolay Aleksandrov static void br_ip4_multicast_query(struct net_bridge_mcast *brmctx, 3251adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 325206499098SVlad Yasevich struct sk_buff *skb, 325306499098SVlad Yasevich u16 vid) 3254eb1d1641SHerbert Xu { 3255ba5ea614SLinus Lüssing unsigned int transport_len = ip_transport_len(skb); 3256b71d1d42SEric Dumazet const struct iphdr *iph = ip_hdr(skb); 3257eb1d1641SHerbert Xu struct igmphdr *ih = igmp_hdr(skb); 3258eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 3259eb1d1641SHerbert Xu struct igmpv3_query *ih3; 3260eb1d1641SHerbert Xu struct net_bridge_port_group *p; 3261e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 326267b746f9SNikolay Aleksandrov struct br_ip saddr = {}; 3263eb1d1641SHerbert Xu unsigned long max_delay; 3264eb1d1641SHerbert Xu unsigned long now = jiffies; 3265eb1d1641SHerbert Xu __be32 group; 3266eb1d1641SHerbert Xu 3267adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 32684cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 3269eb1d1641SHerbert Xu goto out; 3270eb1d1641SHerbert Xu 3271eb1d1641SHerbert Xu group = ih->group; 3272eb1d1641SHerbert Xu 3273ba5ea614SLinus Lüssing if (transport_len == sizeof(*ih)) { 3274eb1d1641SHerbert Xu max_delay = ih->code * (HZ / IGMP_TIMER_SCALE); 3275eb1d1641SHerbert Xu 3276eb1d1641SHerbert Xu if (!max_delay) { 3277eb1d1641SHerbert Xu max_delay = 10 * HZ; 3278eb1d1641SHerbert Xu group = 0; 3279eb1d1641SHerbert Xu } 3280ba5ea614SLinus Lüssing } else if (transport_len >= sizeof(*ih3)) { 3281eb1d1641SHerbert Xu ih3 = igmpv3_query_hdr(skb); 328223550b83SNikolay Aleksandrov if (ih3->nsrcs || 3283d3d065c0SNikolay Aleksandrov (brmctx->multicast_igmp_version == 3 && group && 3284d3d065c0SNikolay Aleksandrov ih3->suppress)) 3285bec68ff1SYOSHIFUJI Hideaki goto out; 3286eb1d1641SHerbert Xu 32870ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 max_delay = ih3->code ? 32880ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 IGMPV3_MRC(ih3->code) * (HZ / IGMP_TIMER_SCALE) : 1; 32899afd85c9SLinus Lüssing } else { 32909ed973ccSLinus Lüssing goto out; 32919ed973ccSLinus Lüssing } 32929ed973ccSLinus Lüssing 3293dc4eb53aSLinus Lüssing if (!group) { 3294dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IP); 3295deb96566SNikolay Aleksandrov saddr.src.ip4 = iph->saddr; 3296b00589afSLinus Lüssing 3297adc47037SNikolay Aleksandrov br_ip4_multicast_query_received(brmctx, pmctx, 3298d3d065c0SNikolay Aleksandrov &brmctx->ip4_other_query, 3299dc4eb53aSLinus Lüssing &saddr, max_delay); 3300eb1d1641SHerbert Xu goto out; 3301dc4eb53aSLinus Lüssing } 3302eb1d1641SHerbert Xu 3303adc47037SNikolay Aleksandrov mp = br_mdb_ip4_get(brmctx->br, group, vid); 3304eb1d1641SHerbert Xu if (!mp) 3305eb1d1641SHerbert Xu goto out; 3306eb1d1641SHerbert Xu 3307d3d065c0SNikolay Aleksandrov max_delay *= brmctx->multicast_last_member_count; 3308eb1d1641SHerbert Xu 3309ff0fd34eSAndrew Lunn if (mp->host_joined && 3310eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 3311eb1d1641SHerbert Xu time_after(mp->timer.expires, now + max_delay) : 3312eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) 3313eb1d1641SHerbert Xu mod_timer(&mp->timer, now + max_delay); 3314eb1d1641SHerbert Xu 3315e8051688SEric Dumazet for (pp = &mp->ports; 3316adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3317e8051688SEric Dumazet pp = &p->next) { 3318eb1d1641SHerbert Xu if (timer_pending(&p->timer) ? 3319eb1d1641SHerbert Xu time_after(p->timer.expires, now + max_delay) : 332023550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 3321d3d065c0SNikolay Aleksandrov (brmctx->multicast_igmp_version == 2 || 332223550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 332324f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 3324eb1d1641SHerbert Xu } 3325eb1d1641SHerbert Xu 3326eb1d1641SHerbert Xu out: 3327adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3328eb1d1641SHerbert Xu } 3329eb1d1641SHerbert Xu 3330dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3331adc47037SNikolay Aleksandrov static int br_ip6_multicast_query(struct net_bridge_mcast *brmctx, 3332adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 333306499098SVlad Yasevich struct sk_buff *skb, 333406499098SVlad Yasevich u16 vid) 333508b202b6SYOSHIFUJI Hideaki { 3336ba5ea614SLinus Lüssing unsigned int transport_len = ipv6_transport_len(skb); 3337eca2a43bSstephen hemminger struct mld_msg *mld; 333808b202b6SYOSHIFUJI Hideaki struct net_bridge_mdb_entry *mp; 333908b202b6SYOSHIFUJI Hideaki struct mld2_query *mld2q; 3340e8051688SEric Dumazet struct net_bridge_port_group *p; 3341e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 334267b746f9SNikolay Aleksandrov struct br_ip saddr = {}; 334308b202b6SYOSHIFUJI Hideaki unsigned long max_delay; 334408b202b6SYOSHIFUJI Hideaki unsigned long now = jiffies; 3345856ce5d0SLinus Lüssing unsigned int offset = skb_transport_offset(skb); 3346b71d1d42SEric Dumazet const struct in6_addr *group = NULL; 33479ed973ccSLinus Lüssing bool is_general_query; 334808b202b6SYOSHIFUJI Hideaki int err = 0; 334908b202b6SYOSHIFUJI Hideaki 3350adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 33514cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 335208b202b6SYOSHIFUJI Hideaki goto out; 335308b202b6SYOSHIFUJI Hideaki 3354ba5ea614SLinus Lüssing if (transport_len == sizeof(*mld)) { 3355856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld))) { 335608b202b6SYOSHIFUJI Hideaki err = -EINVAL; 335708b202b6SYOSHIFUJI Hideaki goto out; 335808b202b6SYOSHIFUJI Hideaki } 335908b202b6SYOSHIFUJI Hideaki mld = (struct mld_msg *) icmp6_hdr(skb); 33604715213dSLi RongQing max_delay = msecs_to_jiffies(ntohs(mld->mld_maxdelay)); 336108b202b6SYOSHIFUJI Hideaki if (max_delay) 336208b202b6SYOSHIFUJI Hideaki group = &mld->mld_mca; 3363248ba8ecSLinus Lüssing } else { 3364856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld2q))) { 336508b202b6SYOSHIFUJI Hideaki err = -EINVAL; 336608b202b6SYOSHIFUJI Hideaki goto out; 336708b202b6SYOSHIFUJI Hideaki } 336808b202b6SYOSHIFUJI Hideaki mld2q = (struct mld2_query *)icmp6_hdr(skb); 336908b202b6SYOSHIFUJI Hideaki if (!mld2q->mld2q_nsrcs) 337008b202b6SYOSHIFUJI Hideaki group = &mld2q->mld2q_mca; 3371d3d065c0SNikolay Aleksandrov if (brmctx->multicast_mld_version == 2 && 337223550b83SNikolay Aleksandrov !ipv6_addr_any(&mld2q->mld2q_mca) && 337323550b83SNikolay Aleksandrov mld2q->mld2q_suppress) 337423550b83SNikolay Aleksandrov goto out; 3375e3f5b170SDaniel Borkmann 3376e3f5b170SDaniel Borkmann max_delay = max(msecs_to_jiffies(mldv2_mrc(mld2q)), 1UL); 337708b202b6SYOSHIFUJI Hideaki } 337808b202b6SYOSHIFUJI Hideaki 33799ed973ccSLinus Lüssing is_general_query = group && ipv6_addr_any(group); 33809ed973ccSLinus Lüssing 3381dc4eb53aSLinus Lüssing if (is_general_query) { 3382dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IPV6); 3383deb96566SNikolay Aleksandrov saddr.src.ip6 = ipv6_hdr(skb)->saddr; 3384b00589afSLinus Lüssing 3385adc47037SNikolay Aleksandrov br_ip6_multicast_query_received(brmctx, pmctx, 3386d3d065c0SNikolay Aleksandrov &brmctx->ip6_other_query, 3387dc4eb53aSLinus Lüssing &saddr, max_delay); 338808b202b6SYOSHIFUJI Hideaki goto out; 33896c03ee8bSLinus Lüssing } else if (!group) { 33906c03ee8bSLinus Lüssing goto out; 3391dc4eb53aSLinus Lüssing } 339208b202b6SYOSHIFUJI Hideaki 3393adc47037SNikolay Aleksandrov mp = br_mdb_ip6_get(brmctx->br, group, vid); 339408b202b6SYOSHIFUJI Hideaki if (!mp) 339508b202b6SYOSHIFUJI Hideaki goto out; 339608b202b6SYOSHIFUJI Hideaki 3397d3d065c0SNikolay Aleksandrov max_delay *= brmctx->multicast_last_member_count; 3398ff0fd34eSAndrew Lunn if (mp->host_joined && 339908b202b6SYOSHIFUJI Hideaki (timer_pending(&mp->timer) ? 340008b202b6SYOSHIFUJI Hideaki time_after(mp->timer.expires, now + max_delay) : 340108b202b6SYOSHIFUJI Hideaki try_to_del_timer_sync(&mp->timer) >= 0)) 340208b202b6SYOSHIFUJI Hideaki mod_timer(&mp->timer, now + max_delay); 340308b202b6SYOSHIFUJI Hideaki 3404e8051688SEric Dumazet for (pp = &mp->ports; 3405adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3406e8051688SEric Dumazet pp = &p->next) { 340708b202b6SYOSHIFUJI Hideaki if (timer_pending(&p->timer) ? 340808b202b6SYOSHIFUJI Hideaki time_after(p->timer.expires, now + max_delay) : 340923550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 3410d3d065c0SNikolay Aleksandrov (brmctx->multicast_mld_version == 1 || 341123550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 341224f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 341308b202b6SYOSHIFUJI Hideaki } 341408b202b6SYOSHIFUJI Hideaki 341508b202b6SYOSHIFUJI Hideaki out: 3416adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 341708b202b6SYOSHIFUJI Hideaki return err; 341808b202b6SYOSHIFUJI Hideaki } 341908b202b6SYOSHIFUJI Hideaki #endif 342008b202b6SYOSHIFUJI Hideaki 342190010b36SLinus Lüssing static void 3422adc47037SNikolay Aleksandrov br_multicast_leave_group(struct net_bridge_mcast *brmctx, 3423adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3424cc0fdd80SLinus Lüssing struct br_ip *group, 342590010b36SLinus Lüssing struct bridge_mcast_other_query *other_query, 34266db6f0eaSFelix Fietkau struct bridge_mcast_own_query *own_query, 34276db6f0eaSFelix Fietkau const unsigned char *src) 3428eb1d1641SHerbert Xu { 3429eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 3430eb1d1641SHerbert Xu struct net_bridge_port_group *p; 3431eb1d1641SHerbert Xu unsigned long now; 3432eb1d1641SHerbert Xu unsigned long time; 3433eb1d1641SHerbert Xu 3434adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 34354cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 3436eb1d1641SHerbert Xu goto out; 3437eb1d1641SHerbert Xu 3438adc47037SNikolay Aleksandrov mp = br_mdb_ip_get(brmctx->br, group); 3439eb1d1641SHerbert Xu if (!mp) 3440eb1d1641SHerbert Xu goto out; 3441eb1d1641SHerbert Xu 3442adc47037SNikolay Aleksandrov if (pmctx && (pmctx->port->flags & BR_MULTICAST_FAST_LEAVE)) { 3443544586f7SSatish Ashok struct net_bridge_port_group __rcu **pp; 3444544586f7SSatish Ashok 3445544586f7SSatish Ashok for (pp = &mp->ports; 3446adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3447544586f7SSatish Ashok pp = &p->next) { 3448adc47037SNikolay Aleksandrov if (!br_port_group_equal(p, pmctx->port, src)) 3449544586f7SSatish Ashok continue; 3450544586f7SSatish Ashok 34515c725b6bSNikolay Aleksandrov if (p->flags & MDB_PG_FLAGS_PERMANENT) 34525c725b6bSNikolay Aleksandrov break; 34535c725b6bSNikolay Aleksandrov 3454681590bdSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_FAST_LEAVE; 3455681590bdSNikolay Aleksandrov br_multicast_del_pg(mp, p, pp); 3456544586f7SSatish Ashok } 3457544586f7SSatish Ashok goto out; 3458544586f7SSatish Ashok } 3459544586f7SSatish Ashok 3460544586f7SSatish Ashok if (timer_pending(&other_query->timer)) 3461544586f7SSatish Ashok goto out; 3462544586f7SSatish Ashok 34634d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier) { 3464adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, NULL, NULL, &mp->addr, 346542c11ccfSNikolay Aleksandrov false, 0, NULL); 34666b7df111SCong Wang 3467d3d065c0SNikolay Aleksandrov time = jiffies + brmctx->multicast_last_member_count * 3468d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval; 3469cc0fdd80SLinus Lüssing 347090010b36SLinus Lüssing mod_timer(&own_query->timer, time); 34716b7df111SCong Wang 3472adc47037SNikolay Aleksandrov for (p = mlock_dereference(mp->ports, brmctx->br); 347354cb4319SNikolay Aleksandrov p != NULL && pmctx != NULL; 3474adc47037SNikolay Aleksandrov p = mlock_dereference(p->next, brmctx->br)) { 3475adc47037SNikolay Aleksandrov if (!br_port_group_equal(p, pmctx->port, src)) 34766b7df111SCong Wang continue; 34776b7df111SCong Wang 34786b7df111SCong Wang if (!hlist_unhashed(&p->mglist) && 34796b7df111SCong Wang (timer_pending(&p->timer) ? 34806b7df111SCong Wang time_after(p->timer.expires, time) : 34816b7df111SCong Wang try_to_del_timer_sync(&p->timer) >= 0)) { 34826b7df111SCong Wang mod_timer(&p->timer, time); 34836b7df111SCong Wang } 34846b7df111SCong Wang 34856b7df111SCong Wang break; 34866b7df111SCong Wang } 34876b7df111SCong Wang } 34886b7df111SCong Wang 3489eb1d1641SHerbert Xu now = jiffies; 3490d3d065c0SNikolay Aleksandrov time = now + brmctx->multicast_last_member_count * 3491d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval; 3492eb1d1641SHerbert Xu 3493adc47037SNikolay Aleksandrov if (!pmctx) { 3494ff0fd34eSAndrew Lunn if (mp->host_joined && 3495eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 3496eb1d1641SHerbert Xu time_after(mp->timer.expires, time) : 3497eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) { 3498eb1d1641SHerbert Xu mod_timer(&mp->timer, time); 3499eb1d1641SHerbert Xu } 3500454594f3SLinus Lüssing 3501454594f3SLinus Lüssing goto out; 3502454594f3SLinus Lüssing } 3503454594f3SLinus Lüssing 3504adc47037SNikolay Aleksandrov for (p = mlock_dereference(mp->ports, brmctx->br); 3505454594f3SLinus Lüssing p != NULL; 3506adc47037SNikolay Aleksandrov p = mlock_dereference(p->next, brmctx->br)) { 3507adc47037SNikolay Aleksandrov if (p->key.port != pmctx->port) 3508454594f3SLinus Lüssing continue; 3509454594f3SLinus Lüssing 3510454594f3SLinus Lüssing if (!hlist_unhashed(&p->mglist) && 3511454594f3SLinus Lüssing (timer_pending(&p->timer) ? 3512454594f3SLinus Lüssing time_after(p->timer.expires, time) : 3513454594f3SLinus Lüssing try_to_del_timer_sync(&p->timer) >= 0)) { 3514454594f3SLinus Lüssing mod_timer(&p->timer, time); 3515454594f3SLinus Lüssing } 3516454594f3SLinus Lüssing 3517454594f3SLinus Lüssing break; 3518eb1d1641SHerbert Xu } 3519eb1d1641SHerbert Xu out: 3520adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3521eb1d1641SHerbert Xu } 3522eb1d1641SHerbert Xu 3523adc47037SNikolay Aleksandrov static void br_ip4_multicast_leave_group(struct net_bridge_mcast *brmctx, 3524adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3525b0e9a30dSVlad Yasevich __be32 group, 35266db6f0eaSFelix Fietkau __u16 vid, 35276db6f0eaSFelix Fietkau const unsigned char *src) 35288ef2a9a5SYOSHIFUJI Hideaki { 35298ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 353090010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 35318ef2a9a5SYOSHIFUJI Hideaki 35328ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 35338ef2a9a5SYOSHIFUJI Hideaki return; 35348ef2a9a5SYOSHIFUJI Hideaki 3535adc47037SNikolay Aleksandrov own_query = pmctx ? &pmctx->ip4_own_query : &brmctx->ip4_own_query; 353690010b36SLinus Lüssing 35371515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 3538eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 35398ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 3540b0e9a30dSVlad Yasevich br_group.vid = vid; 35418ef2a9a5SYOSHIFUJI Hideaki 3542adc47037SNikolay Aleksandrov br_multicast_leave_group(brmctx, pmctx, &br_group, 3543adc47037SNikolay Aleksandrov &brmctx->ip4_other_query, 35446db6f0eaSFelix Fietkau own_query, src); 35458ef2a9a5SYOSHIFUJI Hideaki } 35468ef2a9a5SYOSHIFUJI Hideaki 3547dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3548adc47037SNikolay Aleksandrov static void br_ip6_multicast_leave_group(struct net_bridge_mcast *brmctx, 3549adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3550b0e9a30dSVlad Yasevich const struct in6_addr *group, 35516db6f0eaSFelix Fietkau __u16 vid, 35526db6f0eaSFelix Fietkau const unsigned char *src) 355308b202b6SYOSHIFUJI Hideaki { 355408b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 355590010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 355608b202b6SYOSHIFUJI Hideaki 35573c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 355808b202b6SYOSHIFUJI Hideaki return; 355908b202b6SYOSHIFUJI Hideaki 3560adc47037SNikolay Aleksandrov own_query = pmctx ? &pmctx->ip6_own_query : &brmctx->ip6_own_query; 356190010b36SLinus Lüssing 35621515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 3563eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 356408b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 3565b0e9a30dSVlad Yasevich br_group.vid = vid; 356608b202b6SYOSHIFUJI Hideaki 3567adc47037SNikolay Aleksandrov br_multicast_leave_group(brmctx, pmctx, &br_group, 3568adc47037SNikolay Aleksandrov &brmctx->ip6_other_query, 35696db6f0eaSFelix Fietkau own_query, src); 357008b202b6SYOSHIFUJI Hideaki } 357108b202b6SYOSHIFUJI Hideaki #endif 35728ef2a9a5SYOSHIFUJI Hideaki 35731080ab95SNikolay Aleksandrov static void br_multicast_err_count(const struct net_bridge *br, 35741080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 35751080ab95SNikolay Aleksandrov __be16 proto) 35761080ab95SNikolay Aleksandrov { 35771080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 35781080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats; 35791080ab95SNikolay Aleksandrov 3580675779adSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 35811080ab95SNikolay Aleksandrov return; 35821080ab95SNikolay Aleksandrov 35831080ab95SNikolay Aleksandrov if (p) 35841080ab95SNikolay Aleksandrov stats = p->mcast_stats; 35851080ab95SNikolay Aleksandrov else 35861080ab95SNikolay Aleksandrov stats = br->mcast_stats; 35871080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 35881080ab95SNikolay Aleksandrov return; 35891080ab95SNikolay Aleksandrov 35901080ab95SNikolay Aleksandrov pstats = this_cpu_ptr(stats); 35911080ab95SNikolay Aleksandrov 35921080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 35931080ab95SNikolay Aleksandrov switch (proto) { 35941080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 35951080ab95SNikolay Aleksandrov pstats->mstats.igmp_parse_errors++; 35961080ab95SNikolay Aleksandrov break; 35971080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 35981080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 35991080ab95SNikolay Aleksandrov pstats->mstats.mld_parse_errors++; 36001080ab95SNikolay Aleksandrov break; 36011080ab95SNikolay Aleksandrov #endif 36021080ab95SNikolay Aleksandrov } 36031080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 36041080ab95SNikolay Aleksandrov } 36051080ab95SNikolay Aleksandrov 3606adc47037SNikolay Aleksandrov static void br_multicast_pim(struct net_bridge_mcast *brmctx, 3607adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 360891b02d3dSNikolay Aleksandrov const struct sk_buff *skb) 360991b02d3dSNikolay Aleksandrov { 361091b02d3dSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 361191b02d3dSNikolay Aleksandrov struct pimhdr *pimhdr, _pimhdr; 361291b02d3dSNikolay Aleksandrov 361391b02d3dSNikolay Aleksandrov pimhdr = skb_header_pointer(skb, offset, sizeof(_pimhdr), &_pimhdr); 361491b02d3dSNikolay Aleksandrov if (!pimhdr || pim_hdr_version(pimhdr) != PIM_VERSION || 361591b02d3dSNikolay Aleksandrov pim_hdr_type(pimhdr) != PIM_TYPE_HELLO) 361691b02d3dSNikolay Aleksandrov return; 361791b02d3dSNikolay Aleksandrov 3618adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3619adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3620adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 362191b02d3dSNikolay Aleksandrov } 362291b02d3dSNikolay Aleksandrov 3623adc47037SNikolay Aleksandrov static int br_ip4_multicast_mrd_rcv(struct net_bridge_mcast *brmctx, 3624adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 36254b3087c7SLinus Lüssing struct sk_buff *skb) 36264b3087c7SLinus Lüssing { 36274b3087c7SLinus Lüssing if (ip_hdr(skb)->protocol != IPPROTO_IGMP || 36284b3087c7SLinus Lüssing igmp_hdr(skb)->type != IGMP_MRDISC_ADV) 36294b3087c7SLinus Lüssing return -ENOMSG; 36304b3087c7SLinus Lüssing 3631adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3632adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3633adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 36344b3087c7SLinus Lüssing 36354b3087c7SLinus Lüssing return 0; 36364b3087c7SLinus Lüssing } 36374b3087c7SLinus Lüssing 3638adc47037SNikolay Aleksandrov static int br_multicast_ipv4_rcv(struct net_bridge_mcast *brmctx, 3639adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 364006499098SVlad Yasevich struct sk_buff *skb, 364106499098SVlad Yasevich u16 vid) 3642eb1d1641SHerbert Xu { 3643adc47037SNikolay Aleksandrov struct net_bridge_port *p = pmctx ? pmctx->port : NULL; 36446db6f0eaSFelix Fietkau const unsigned char *src; 3645eb1d1641SHerbert Xu struct igmphdr *ih; 3646eb1d1641SHerbert Xu int err; 3647eb1d1641SHerbert Xu 3648ba5ea614SLinus Lüssing err = ip_mc_check_igmp(skb); 3649eb1d1641SHerbert Xu 36509afd85c9SLinus Lüssing if (err == -ENOMSG) { 365191b02d3dSNikolay Aleksandrov if (!ipv4_is_local_multicast(ip_hdr(skb)->daddr)) { 3652bd4265feSHerbert Xu BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 365391b02d3dSNikolay Aleksandrov } else if (pim_ipv4_all_pim_routers(ip_hdr(skb)->daddr)) { 365491b02d3dSNikolay Aleksandrov if (ip_hdr(skb)->protocol == IPPROTO_PIM) 3655adc47037SNikolay Aleksandrov br_multicast_pim(brmctx, pmctx, skb); 36564b3087c7SLinus Lüssing } else if (ipv4_is_all_snoopers(ip_hdr(skb)->daddr)) { 3657adc47037SNikolay Aleksandrov br_ip4_multicast_mrd_rcv(brmctx, pmctx, skb); 36584b3087c7SLinus Lüssing } 36594b3087c7SLinus Lüssing 3660eb1d1641SHerbert Xu return 0; 36619afd85c9SLinus Lüssing } else if (err < 0) { 3662adc47037SNikolay Aleksandrov br_multicast_err_count(brmctx->br, p, skb->protocol); 36639afd85c9SLinus Lüssing return err; 3664bd4265feSHerbert Xu } 3665eb1d1641SHerbert Xu 36669afd85c9SLinus Lüssing ih = igmp_hdr(skb); 36676db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 36681080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = ih->type; 3669eb1d1641SHerbert Xu 3670eb1d1641SHerbert Xu switch (ih->type) { 3671eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_REPORT: 3672eb1d1641SHerbert Xu case IGMPV2_HOST_MEMBERSHIP_REPORT: 367362b2bcb4SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 3674adc47037SNikolay Aleksandrov err = br_ip4_multicast_add_group(brmctx, pmctx, ih->group, vid, 3675adc47037SNikolay Aleksandrov src, true); 3676eb1d1641SHerbert Xu break; 3677eb1d1641SHerbert Xu case IGMPV3_HOST_MEMBERSHIP_REPORT: 3678adc47037SNikolay Aleksandrov err = br_ip4_multicast_igmp3_report(brmctx, pmctx, skb, vid); 3679eb1d1641SHerbert Xu break; 3680eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_QUERY: 3681adc47037SNikolay Aleksandrov br_ip4_multicast_query(brmctx, pmctx, skb, vid); 3682eb1d1641SHerbert Xu break; 3683eb1d1641SHerbert Xu case IGMP_HOST_LEAVE_MESSAGE: 3684adc47037SNikolay Aleksandrov br_ip4_multicast_leave_group(brmctx, pmctx, ih->group, vid, src); 3685eb1d1641SHerbert Xu break; 3686eb1d1641SHerbert Xu } 3687eb1d1641SHerbert Xu 3688adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, p, skb, BR_INPUT_SKB_CB(skb)->igmp, 36891080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 36901080ab95SNikolay Aleksandrov 3691eb1d1641SHerbert Xu return err; 3692eb1d1641SHerbert Xu } 3693eb1d1641SHerbert Xu 3694dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3695adc47037SNikolay Aleksandrov static void br_ip6_multicast_mrd_rcv(struct net_bridge_mcast *brmctx, 3696adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 36974b3087c7SLinus Lüssing struct sk_buff *skb) 36984b3087c7SLinus Lüssing { 36994b3087c7SLinus Lüssing if (icmp6_hdr(skb)->icmp6_type != ICMPV6_MRDISC_ADV) 370099014088SLinus Lüssing return; 37014b3087c7SLinus Lüssing 3702adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3703adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 3704adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 37054b3087c7SLinus Lüssing } 37064b3087c7SLinus Lüssing 3707adc47037SNikolay Aleksandrov static int br_multicast_ipv6_rcv(struct net_bridge_mcast *brmctx, 3708adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 370906499098SVlad Yasevich struct sk_buff *skb, 371006499098SVlad Yasevich u16 vid) 371108b202b6SYOSHIFUJI Hideaki { 3712adc47037SNikolay Aleksandrov struct net_bridge_port *p = pmctx ? pmctx->port : NULL; 37136db6f0eaSFelix Fietkau const unsigned char *src; 37149afd85c9SLinus Lüssing struct mld_msg *mld; 371508b202b6SYOSHIFUJI Hideaki int err; 371608b202b6SYOSHIFUJI Hideaki 3717ba5ea614SLinus Lüssing err = ipv6_mc_check_mld(skb); 371808b202b6SYOSHIFUJI Hideaki 371999014088SLinus Lüssing if (err == -ENOMSG || err == -ENODATA) { 37209afd85c9SLinus Lüssing if (!ipv6_addr_is_ll_all_nodes(&ipv6_hdr(skb)->daddr)) 37218fad9c39SLinus Lüssing BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 372299014088SLinus Lüssing if (err == -ENODATA && 372399014088SLinus Lüssing ipv6_addr_is_all_snoopers(&ipv6_hdr(skb)->daddr)) 3724adc47037SNikolay Aleksandrov br_ip6_multicast_mrd_rcv(brmctx, pmctx, skb); 37254b3087c7SLinus Lüssing 372608b202b6SYOSHIFUJI Hideaki return 0; 37279afd85c9SLinus Lüssing } else if (err < 0) { 3728adc47037SNikolay Aleksandrov br_multicast_err_count(brmctx->br, p, skb->protocol); 37299afd85c9SLinus Lüssing return err; 373008b202b6SYOSHIFUJI Hideaki } 373108b202b6SYOSHIFUJI Hideaki 37329afd85c9SLinus Lüssing mld = (struct mld_msg *)skb_transport_header(skb); 37331080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = mld->mld_type; 373408b202b6SYOSHIFUJI Hideaki 37359afd85c9SLinus Lüssing switch (mld->mld_type) { 373608b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REPORT: 37376db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 3738fc2af6c7SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 3739adc47037SNikolay Aleksandrov err = br_ip6_multicast_add_group(brmctx, pmctx, &mld->mld_mca, 3740adc47037SNikolay Aleksandrov vid, src, true); 374108b202b6SYOSHIFUJI Hideaki break; 374208b202b6SYOSHIFUJI Hideaki case ICMPV6_MLD2_REPORT: 3743adc47037SNikolay Aleksandrov err = br_ip6_multicast_mld2_report(brmctx, pmctx, skb, vid); 374408b202b6SYOSHIFUJI Hideaki break; 374508b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_QUERY: 3746adc47037SNikolay Aleksandrov err = br_ip6_multicast_query(brmctx, pmctx, skb, vid); 374708b202b6SYOSHIFUJI Hideaki break; 374808b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REDUCTION: 37496db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 3750adc47037SNikolay Aleksandrov br_ip6_multicast_leave_group(brmctx, pmctx, &mld->mld_mca, vid, 3751adc47037SNikolay Aleksandrov src); 37529afd85c9SLinus Lüssing break; 375308b202b6SYOSHIFUJI Hideaki } 375408b202b6SYOSHIFUJI Hideaki 3755adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, p, skb, BR_INPUT_SKB_CB(skb)->igmp, 37561080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 37571080ab95SNikolay Aleksandrov 375808b202b6SYOSHIFUJI Hideaki return err; 375908b202b6SYOSHIFUJI Hideaki } 376008b202b6SYOSHIFUJI Hideaki #endif 376108b202b6SYOSHIFUJI Hideaki 3762f4b7002aSNikolay Aleksandrov int br_multicast_rcv(struct net_bridge_mcast **brmctx, 3763f4b7002aSNikolay Aleksandrov struct net_bridge_mcast_port **pmctx, 3764f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vlan, 376506499098SVlad Yasevich struct sk_buff *skb, u16 vid) 3766eb1d1641SHerbert Xu { 37671080ab95SNikolay Aleksandrov int ret = 0; 37681080ab95SNikolay Aleksandrov 37691fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->igmp = 0; 37701fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->mrouters_only = 0; 37711fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 3772f4b7002aSNikolay Aleksandrov if (!br_opt_get((*brmctx)->br, BROPT_MULTICAST_ENABLED)) 3773eb1d1641SHerbert Xu return 0; 3774eb1d1641SHerbert Xu 3775f4b7002aSNikolay Aleksandrov if (br_opt_get((*brmctx)->br, BROPT_MCAST_VLAN_SNOOPING_ENABLED) && vlan) { 3776f4b7002aSNikolay Aleksandrov const struct net_bridge_vlan *masterv; 3777f4b7002aSNikolay Aleksandrov 3778f4b7002aSNikolay Aleksandrov /* the vlan has the master flag set only when transmitting 3779f4b7002aSNikolay Aleksandrov * through the bridge device 3780f4b7002aSNikolay Aleksandrov */ 3781f4b7002aSNikolay Aleksandrov if (br_vlan_is_master(vlan)) { 3782f4b7002aSNikolay Aleksandrov masterv = vlan; 3783f4b7002aSNikolay Aleksandrov *brmctx = &vlan->br_mcast_ctx; 3784f4b7002aSNikolay Aleksandrov *pmctx = NULL; 3785f4b7002aSNikolay Aleksandrov } else { 3786f4b7002aSNikolay Aleksandrov masterv = vlan->brvlan; 3787f4b7002aSNikolay Aleksandrov *brmctx = &vlan->brvlan->br_mcast_ctx; 3788f4b7002aSNikolay Aleksandrov *pmctx = &vlan->port_mcast_ctx; 3789f4b7002aSNikolay Aleksandrov } 3790f4b7002aSNikolay Aleksandrov 3791f4b7002aSNikolay Aleksandrov if (!(masterv->priv_flags & BR_VLFLAG_GLOBAL_MCAST_ENABLED)) 3792f4b7002aSNikolay Aleksandrov return 0; 3793f4b7002aSNikolay Aleksandrov } 3794f4b7002aSNikolay Aleksandrov 3795eb1d1641SHerbert Xu switch (skb->protocol) { 3796eb1d1641SHerbert Xu case htons(ETH_P_IP): 3797f4b7002aSNikolay Aleksandrov ret = br_multicast_ipv4_rcv(*brmctx, *pmctx, skb, vid); 37981080ab95SNikolay Aleksandrov break; 3799dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 380008b202b6SYOSHIFUJI Hideaki case htons(ETH_P_IPV6): 3801f4b7002aSNikolay Aleksandrov ret = br_multicast_ipv6_rcv(*brmctx, *pmctx, skb, vid); 38021080ab95SNikolay Aleksandrov break; 380308b202b6SYOSHIFUJI Hideaki #endif 3804eb1d1641SHerbert Xu } 3805eb1d1641SHerbert Xu 38061080ab95SNikolay Aleksandrov return ret; 3807eb1d1641SHerbert Xu } 3808eb1d1641SHerbert Xu 3809adc47037SNikolay Aleksandrov static void br_multicast_query_expired(struct net_bridge_mcast *brmctx, 38102cd41431SLinus Lüssing struct bridge_mcast_own_query *query, 38112cd41431SLinus Lüssing struct bridge_mcast_querier *querier) 3812cc0fdd80SLinus Lüssing { 3813adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 38144cdd0d10SNikolay Aleksandrov if (br_multicast_ctx_vlan_disabled(brmctx)) 38154cdd0d10SNikolay Aleksandrov goto out; 38164cdd0d10SNikolay Aleksandrov 3817adc47037SNikolay Aleksandrov if (query->startup_sent < brmctx->multicast_startup_query_count) 3818cc0fdd80SLinus Lüssing query->startup_sent++; 3819cc0fdd80SLinus Lüssing 3820adc47037SNikolay Aleksandrov br_multicast_send_query(brmctx, NULL, query); 38214cdd0d10SNikolay Aleksandrov out: 3822adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3823cc0fdd80SLinus Lüssing } 3824cc0fdd80SLinus Lüssing 382588c1f37fSAllen Pais static void br_ip4_multicast_query_expired(struct timer_list *t) 3826eb1d1641SHerbert Xu { 3827d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 3828d3d065c0SNikolay Aleksandrov ip4_own_query.timer); 3829eb1d1641SHerbert Xu 3830adc47037SNikolay Aleksandrov br_multicast_query_expired(brmctx, &brmctx->ip4_own_query, 3831d3d065c0SNikolay Aleksandrov &brmctx->ip4_querier); 3832eb1d1641SHerbert Xu } 3833eb1d1641SHerbert Xu 3834cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 383588c1f37fSAllen Pais static void br_ip6_multicast_query_expired(struct timer_list *t) 3836cc0fdd80SLinus Lüssing { 3837d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 3838d3d065c0SNikolay Aleksandrov ip6_own_query.timer); 3839cc0fdd80SLinus Lüssing 3840adc47037SNikolay Aleksandrov br_multicast_query_expired(brmctx, &brmctx->ip6_own_query, 3841d3d065c0SNikolay Aleksandrov &brmctx->ip6_querier); 3842cc0fdd80SLinus Lüssing } 3843cc0fdd80SLinus Lüssing #endif 3844cc0fdd80SLinus Lüssing 3845e12cec65SNikolay Aleksandrov static void br_multicast_gc_work(struct work_struct *work) 38468b671779SNikolay Aleksandrov { 38478b671779SNikolay Aleksandrov struct net_bridge *br = container_of(work, struct net_bridge, 3848e12cec65SNikolay Aleksandrov mcast_gc_work); 38498b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 38508b671779SNikolay Aleksandrov 38518b671779SNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 3852e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 38538b671779SNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 38548b671779SNikolay Aleksandrov 3855e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 38568b671779SNikolay Aleksandrov } 38578b671779SNikolay Aleksandrov 3858613d61dbSNikolay Aleksandrov void br_multicast_ctx_init(struct net_bridge *br, 3859613d61dbSNikolay Aleksandrov struct net_bridge_vlan *vlan, 3860613d61dbSNikolay Aleksandrov struct net_bridge_mcast *brmctx) 3861613d61dbSNikolay Aleksandrov { 3862613d61dbSNikolay Aleksandrov brmctx->br = br; 3863613d61dbSNikolay Aleksandrov brmctx->vlan = vlan; 3864613d61dbSNikolay Aleksandrov brmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 3865613d61dbSNikolay Aleksandrov brmctx->multicast_last_member_count = 2; 3866613d61dbSNikolay Aleksandrov brmctx->multicast_startup_query_count = 2; 3867613d61dbSNikolay Aleksandrov 3868613d61dbSNikolay Aleksandrov brmctx->multicast_last_member_interval = HZ; 3869613d61dbSNikolay Aleksandrov brmctx->multicast_query_response_interval = 10 * HZ; 3870613d61dbSNikolay Aleksandrov brmctx->multicast_startup_query_interval = 125 * HZ / 4; 3871613d61dbSNikolay Aleksandrov brmctx->multicast_query_interval = 125 * HZ; 3872613d61dbSNikolay Aleksandrov brmctx->multicast_querier_interval = 255 * HZ; 3873613d61dbSNikolay Aleksandrov brmctx->multicast_membership_interval = 260 * HZ; 3874613d61dbSNikolay Aleksandrov 3875613d61dbSNikolay Aleksandrov brmctx->ip4_other_query.delay_time = 0; 3876bb18ef8eSNikolay Aleksandrov brmctx->ip4_querier.port_ifidx = 0; 3877f936bb42SThomas Gleixner seqcount_spinlock_init(&brmctx->ip4_querier.seq, &br->multicast_lock); 3878613d61dbSNikolay Aleksandrov brmctx->multicast_igmp_version = 2; 3879613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 3880613d61dbSNikolay Aleksandrov brmctx->multicast_mld_version = 1; 3881613d61dbSNikolay Aleksandrov brmctx->ip6_other_query.delay_time = 0; 3882bb18ef8eSNikolay Aleksandrov brmctx->ip6_querier.port_ifidx = 0; 3883f936bb42SThomas Gleixner seqcount_spinlock_init(&brmctx->ip6_querier.seq, &br->multicast_lock); 3884613d61dbSNikolay Aleksandrov #endif 3885613d61dbSNikolay Aleksandrov 3886613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_mc_router_timer, 3887613d61dbSNikolay Aleksandrov br_ip4_multicast_local_router_expired, 0); 3888613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_other_query.timer, 3889613d61dbSNikolay Aleksandrov br_ip4_multicast_querier_expired, 0); 3890613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_own_query.timer, 3891613d61dbSNikolay Aleksandrov br_ip4_multicast_query_expired, 0); 3892613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 3893613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_mc_router_timer, 3894613d61dbSNikolay Aleksandrov br_ip6_multicast_local_router_expired, 0); 3895613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_other_query.timer, 3896613d61dbSNikolay Aleksandrov br_ip6_multicast_querier_expired, 0); 3897613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_own_query.timer, 3898613d61dbSNikolay Aleksandrov br_ip6_multicast_query_expired, 0); 3899613d61dbSNikolay Aleksandrov #endif 3900613d61dbSNikolay Aleksandrov } 3901613d61dbSNikolay Aleksandrov 3902613d61dbSNikolay Aleksandrov void br_multicast_ctx_deinit(struct net_bridge_mcast *brmctx) 3903613d61dbSNikolay Aleksandrov { 3904613d61dbSNikolay Aleksandrov __br_multicast_stop(brmctx); 3905613d61dbSNikolay Aleksandrov } 3906613d61dbSNikolay Aleksandrov 3907eb1d1641SHerbert Xu void br_multicast_init(struct net_bridge *br) 3908eb1d1641SHerbert Xu { 3909d08c6bc0SNikolay Aleksandrov br->hash_max = BR_MULTICAST_DEFAULT_HASH_MAX; 3910eb1d1641SHerbert Xu 3911613d61dbSNikolay Aleksandrov br_multicast_ctx_init(br, NULL, &br->multicast_ctx); 3912eb1d1641SHerbert Xu 39136919622aSIdo Schimmel br_opt_toggle(br, BROPT_MULTICAST_ENABLED, true); 3914675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_HAS_IPV6_ADDR, true); 3915b00589afSLinus Lüssing 3916eb1d1641SHerbert Xu spin_lock_init(&br->multicast_lock); 391719e3a9c9SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mdb_list); 3918e12cec65SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mcast_gc_list); 3919e12cec65SNikolay Aleksandrov INIT_WORK(&br->mcast_gc_work, br_multicast_gc_work); 3920eb1d1641SHerbert Xu } 3921eb1d1641SHerbert Xu 39224effd28cSLinus Lüssing static void br_ip4_multicast_join_snoopers(struct net_bridge *br) 39234effd28cSLinus Lüssing { 39244effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 39254effd28cSLinus Lüssing 39264effd28cSLinus Lüssing if (!in_dev) 39274effd28cSLinus Lüssing return; 39284effd28cSLinus Lüssing 39299fb20801SFlorian Fainelli __ip_mc_inc_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 39304effd28cSLinus Lüssing in_dev_put(in_dev); 39314effd28cSLinus Lüssing } 39324effd28cSLinus Lüssing 39334effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 39344effd28cSLinus Lüssing static void br_ip6_multicast_join_snoopers(struct net_bridge *br) 39354effd28cSLinus Lüssing { 39364effd28cSLinus Lüssing struct in6_addr addr; 39374effd28cSLinus Lüssing 39384effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 39394effd28cSLinus Lüssing ipv6_dev_mc_inc(br->dev, &addr); 39404effd28cSLinus Lüssing } 39414effd28cSLinus Lüssing #else 39424effd28cSLinus Lüssing static inline void br_ip6_multicast_join_snoopers(struct net_bridge *br) 39434effd28cSLinus Lüssing { 39444effd28cSLinus Lüssing } 39454effd28cSLinus Lüssing #endif 39464effd28cSLinus Lüssing 3947851d0a73SJoseph Huang void br_multicast_join_snoopers(struct net_bridge *br) 39484effd28cSLinus Lüssing { 39494effd28cSLinus Lüssing br_ip4_multicast_join_snoopers(br); 39504effd28cSLinus Lüssing br_ip6_multicast_join_snoopers(br); 39514effd28cSLinus Lüssing } 39524effd28cSLinus Lüssing 39534effd28cSLinus Lüssing static void br_ip4_multicast_leave_snoopers(struct net_bridge *br) 39544effd28cSLinus Lüssing { 39554effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 39564effd28cSLinus Lüssing 39574effd28cSLinus Lüssing if (WARN_ON(!in_dev)) 39584effd28cSLinus Lüssing return; 39594effd28cSLinus Lüssing 39609fb20801SFlorian Fainelli __ip_mc_dec_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 39614effd28cSLinus Lüssing in_dev_put(in_dev); 39624effd28cSLinus Lüssing } 39634effd28cSLinus Lüssing 39644effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 39654effd28cSLinus Lüssing static void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 39664effd28cSLinus Lüssing { 39674effd28cSLinus Lüssing struct in6_addr addr; 39684effd28cSLinus Lüssing 39694effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 39704effd28cSLinus Lüssing ipv6_dev_mc_dec(br->dev, &addr); 39714effd28cSLinus Lüssing } 39724effd28cSLinus Lüssing #else 39734effd28cSLinus Lüssing static inline void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 39744effd28cSLinus Lüssing { 39754effd28cSLinus Lüssing } 39764effd28cSLinus Lüssing #endif 39774effd28cSLinus Lüssing 3978851d0a73SJoseph Huang void br_multicast_leave_snoopers(struct net_bridge *br) 39794effd28cSLinus Lüssing { 39804effd28cSLinus Lüssing br_ip4_multicast_leave_snoopers(br); 39814effd28cSLinus Lüssing br_ip6_multicast_leave_snoopers(br); 39824effd28cSLinus Lüssing } 39834effd28cSLinus Lüssing 39847b54aaafSNikolay Aleksandrov static void __br_multicast_open_query(struct net_bridge *br, 398590010b36SLinus Lüssing struct bridge_mcast_own_query *query) 3986eb1d1641SHerbert Xu { 3987cc0fdd80SLinus Lüssing query->startup_sent = 0; 3988eb1d1641SHerbert Xu 398913cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) 3990eb1d1641SHerbert Xu return; 3991eb1d1641SHerbert Xu 3992cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 3993cc0fdd80SLinus Lüssing } 3994cc0fdd80SLinus Lüssing 39957b54aaafSNikolay Aleksandrov static void __br_multicast_open(struct net_bridge_mcast *brmctx) 39967b54aaafSNikolay Aleksandrov { 39977b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, &brmctx->ip4_own_query); 39987b54aaafSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 39997b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, &brmctx->ip6_own_query); 40007b54aaafSNikolay Aleksandrov #endif 40017b54aaafSNikolay Aleksandrov } 40027b54aaafSNikolay Aleksandrov 4003cc0fdd80SLinus Lüssing void br_multicast_open(struct net_bridge *br) 4004cc0fdd80SLinus Lüssing { 4005f4b7002aSNikolay Aleksandrov ASSERT_RTNL(); 4006f4b7002aSNikolay Aleksandrov 4007f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) { 40087b54aaafSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 40097b54aaafSNikolay Aleksandrov struct net_bridge_vlan *vlan; 40107b54aaafSNikolay Aleksandrov 40117b54aaafSNikolay Aleksandrov vg = br_vlan_group(br); 40127b54aaafSNikolay Aleksandrov if (vg) { 40137b54aaafSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) { 40147b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 40157b54aaafSNikolay Aleksandrov 40167b54aaafSNikolay Aleksandrov brmctx = &vlan->br_mcast_ctx; 40177b54aaafSNikolay Aleksandrov if (br_vlan_is_brentry(vlan) && 40187b54aaafSNikolay Aleksandrov !br_multicast_ctx_vlan_disabled(brmctx)) 40197b54aaafSNikolay Aleksandrov __br_multicast_open(&vlan->br_mcast_ctx); 40207b54aaafSNikolay Aleksandrov } 40217b54aaafSNikolay Aleksandrov } 4022cb486ce9SNikolay Aleksandrov } else { 40237b54aaafSNikolay Aleksandrov __br_multicast_open(&br->multicast_ctx); 4024eb1d1641SHerbert Xu } 4025cb486ce9SNikolay Aleksandrov } 4026eb1d1641SHerbert Xu 4027613d61dbSNikolay Aleksandrov static void __br_multicast_stop(struct net_bridge_mcast *brmctx) 4028613d61dbSNikolay Aleksandrov { 4029613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_mc_router_timer); 4030613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_other_query.timer); 4031613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_own_query.timer); 4032613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4033613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_mc_router_timer); 4034613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_other_query.timer); 4035613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_own_query.timer); 4036613d61dbSNikolay Aleksandrov #endif 4037613d61dbSNikolay Aleksandrov } 4038613d61dbSNikolay Aleksandrov 40397b54aaafSNikolay Aleksandrov void br_multicast_toggle_one_vlan(struct net_bridge_vlan *vlan, bool on) 40407b54aaafSNikolay Aleksandrov { 40417b54aaafSNikolay Aleksandrov struct net_bridge *br; 40427b54aaafSNikolay Aleksandrov 40437b54aaafSNikolay Aleksandrov /* it's okay to check for the flag without the multicast lock because it 40447b54aaafSNikolay Aleksandrov * can only change under RTNL -> multicast_lock, we need the latter to 40457b54aaafSNikolay Aleksandrov * sync with timers and packets 40467b54aaafSNikolay Aleksandrov */ 40477b54aaafSNikolay Aleksandrov if (on == !!(vlan->priv_flags & BR_VLFLAG_MCAST_ENABLED)) 40487b54aaafSNikolay Aleksandrov return; 40497b54aaafSNikolay Aleksandrov 40507b54aaafSNikolay Aleksandrov if (br_vlan_is_master(vlan)) { 40517b54aaafSNikolay Aleksandrov br = vlan->br; 40527b54aaafSNikolay Aleksandrov 40537b54aaafSNikolay Aleksandrov if (!br_vlan_is_brentry(vlan) || 40547b54aaafSNikolay Aleksandrov (on && 40557b54aaafSNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(&vlan->br_mcast_ctx))) 40567b54aaafSNikolay Aleksandrov return; 40577b54aaafSNikolay Aleksandrov 40587b54aaafSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 40597b54aaafSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_MCAST_ENABLED; 40607b54aaafSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 40617b54aaafSNikolay Aleksandrov 40627b54aaafSNikolay Aleksandrov if (on) 40637b54aaafSNikolay Aleksandrov __br_multicast_open(&vlan->br_mcast_ctx); 40647b54aaafSNikolay Aleksandrov else 40657b54aaafSNikolay Aleksandrov __br_multicast_stop(&vlan->br_mcast_ctx); 40667b54aaafSNikolay Aleksandrov } else { 40677b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 40687b54aaafSNikolay Aleksandrov 40697b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(&vlan->port_mcast_ctx); 40707b54aaafSNikolay Aleksandrov if (on && br_multicast_ctx_vlan_global_disabled(brmctx)) 40717b54aaafSNikolay Aleksandrov return; 40727b54aaafSNikolay Aleksandrov 40737b54aaafSNikolay Aleksandrov br = vlan->port->br; 40747b54aaafSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 40757b54aaafSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_MCAST_ENABLED; 40767b54aaafSNikolay Aleksandrov if (on) 40777b54aaafSNikolay Aleksandrov __br_multicast_enable_port_ctx(&vlan->port_mcast_ctx); 40787b54aaafSNikolay Aleksandrov else 40797b54aaafSNikolay Aleksandrov __br_multicast_disable_port_ctx(&vlan->port_mcast_ctx); 40807b54aaafSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 40817b54aaafSNikolay Aleksandrov } 40827b54aaafSNikolay Aleksandrov } 40837b54aaafSNikolay Aleksandrov 4084affce9a7SNikolay Aleksandrov static void br_multicast_toggle_vlan(struct net_bridge_vlan *vlan, bool on) 4085f4b7002aSNikolay Aleksandrov { 4086f4b7002aSNikolay Aleksandrov struct net_bridge_port *p; 4087f4b7002aSNikolay Aleksandrov 4088f4b7002aSNikolay Aleksandrov if (WARN_ON_ONCE(!br_vlan_is_master(vlan))) 4089f4b7002aSNikolay Aleksandrov return; 4090f4b7002aSNikolay Aleksandrov 4091f4b7002aSNikolay Aleksandrov list_for_each_entry(p, &vlan->br->port_list, list) { 4092f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vport; 4093f4b7002aSNikolay Aleksandrov 4094f4b7002aSNikolay Aleksandrov vport = br_vlan_find(nbp_vlan_group(p), vlan->vid); 4095f4b7002aSNikolay Aleksandrov if (!vport) 4096f4b7002aSNikolay Aleksandrov continue; 4097f4b7002aSNikolay Aleksandrov br_multicast_toggle_one_vlan(vport, on); 4098f4b7002aSNikolay Aleksandrov } 4099affce9a7SNikolay Aleksandrov 4100affce9a7SNikolay Aleksandrov if (br_vlan_is_brentry(vlan)) 4101affce9a7SNikolay Aleksandrov br_multicast_toggle_one_vlan(vlan, on); 4102f4b7002aSNikolay Aleksandrov } 4103f4b7002aSNikolay Aleksandrov 4104f4b7002aSNikolay Aleksandrov int br_multicast_toggle_vlan_snooping(struct net_bridge *br, bool on, 4105f4b7002aSNikolay Aleksandrov struct netlink_ext_ack *extack) 4106eb1d1641SHerbert Xu { 41077b54aaafSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 41087b54aaafSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4109f4b7002aSNikolay Aleksandrov struct net_bridge_port *p; 41107b54aaafSNikolay Aleksandrov 4111f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED) == on) 4112f4b7002aSNikolay Aleksandrov return 0; 4113f4b7002aSNikolay Aleksandrov 4114f4b7002aSNikolay Aleksandrov if (on && !br_opt_get(br, BROPT_VLAN_ENABLED)) { 4115f4b7002aSNikolay Aleksandrov NL_SET_ERR_MSG_MOD(extack, "Cannot enable multicast vlan snooping with vlan filtering disabled"); 4116f4b7002aSNikolay Aleksandrov return -EINVAL; 4117f4b7002aSNikolay Aleksandrov } 4118f4b7002aSNikolay Aleksandrov 4119f4b7002aSNikolay Aleksandrov vg = br_vlan_group(br); 4120f4b7002aSNikolay Aleksandrov if (!vg) 4121f4b7002aSNikolay Aleksandrov return 0; 4122f4b7002aSNikolay Aleksandrov 4123f4b7002aSNikolay Aleksandrov br_opt_toggle(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED, on); 4124f4b7002aSNikolay Aleksandrov 4125f4b7002aSNikolay Aleksandrov /* disable/enable non-vlan mcast contexts based on vlan snooping */ 4126f4b7002aSNikolay Aleksandrov if (on) 4127f4b7002aSNikolay Aleksandrov __br_multicast_stop(&br->multicast_ctx); 4128f4b7002aSNikolay Aleksandrov else 4129f4b7002aSNikolay Aleksandrov __br_multicast_open(&br->multicast_ctx); 4130f4b7002aSNikolay Aleksandrov list_for_each_entry(p, &br->port_list, list) { 4131f4b7002aSNikolay Aleksandrov if (on) 4132f4b7002aSNikolay Aleksandrov br_multicast_disable_port(p); 4133f4b7002aSNikolay Aleksandrov else 4134f4b7002aSNikolay Aleksandrov br_multicast_enable_port(p); 4135f4b7002aSNikolay Aleksandrov } 4136f4b7002aSNikolay Aleksandrov 4137f4b7002aSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) 4138f4b7002aSNikolay Aleksandrov br_multicast_toggle_vlan(vlan, on); 4139f4b7002aSNikolay Aleksandrov 4140f4b7002aSNikolay Aleksandrov return 0; 4141f4b7002aSNikolay Aleksandrov } 4142f4b7002aSNikolay Aleksandrov 41439dee572cSNikolay Aleksandrov bool br_multicast_toggle_global_vlan(struct net_bridge_vlan *vlan, bool on) 41449dee572cSNikolay Aleksandrov { 41459dee572cSNikolay Aleksandrov ASSERT_RTNL(); 41469dee572cSNikolay Aleksandrov 41479dee572cSNikolay Aleksandrov /* BR_VLFLAG_GLOBAL_MCAST_ENABLED relies on eventual consistency and 41489dee572cSNikolay Aleksandrov * requires only RTNL to change 41499dee572cSNikolay Aleksandrov */ 41509dee572cSNikolay Aleksandrov if (on == !!(vlan->priv_flags & BR_VLFLAG_GLOBAL_MCAST_ENABLED)) 41519dee572cSNikolay Aleksandrov return false; 41529dee572cSNikolay Aleksandrov 41539dee572cSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_GLOBAL_MCAST_ENABLED; 41549dee572cSNikolay Aleksandrov br_multicast_toggle_vlan(vlan, on); 41559dee572cSNikolay Aleksandrov 41569dee572cSNikolay Aleksandrov return true; 41579dee572cSNikolay Aleksandrov } 41589dee572cSNikolay Aleksandrov 4159f4b7002aSNikolay Aleksandrov void br_multicast_stop(struct net_bridge *br) 4160f4b7002aSNikolay Aleksandrov { 41617b54aaafSNikolay Aleksandrov ASSERT_RTNL(); 41627b54aaafSNikolay Aleksandrov 4163f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) { 4164f4b7002aSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 4165f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4166f4b7002aSNikolay Aleksandrov 41677b54aaafSNikolay Aleksandrov vg = br_vlan_group(br); 41687b54aaafSNikolay Aleksandrov if (vg) { 41697b54aaafSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) { 41707b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 41717b54aaafSNikolay Aleksandrov 41727b54aaafSNikolay Aleksandrov brmctx = &vlan->br_mcast_ctx; 41737b54aaafSNikolay Aleksandrov if (br_vlan_is_brentry(vlan) && 41747b54aaafSNikolay Aleksandrov !br_multicast_ctx_vlan_disabled(brmctx)) 41757b54aaafSNikolay Aleksandrov __br_multicast_stop(&vlan->br_mcast_ctx); 41767b54aaafSNikolay Aleksandrov } 41777b54aaafSNikolay Aleksandrov } 4178cb486ce9SNikolay Aleksandrov } else { 4179613d61dbSNikolay Aleksandrov __br_multicast_stop(&br->multicast_ctx); 4180e10177abSSatish Ashok } 4181cb486ce9SNikolay Aleksandrov } 4182e10177abSSatish Ashok 4183e10177abSSatish Ashok void br_multicast_dev_del(struct net_bridge *br) 4184e10177abSSatish Ashok { 4185e10177abSSatish Ashok struct net_bridge_mdb_entry *mp; 41868b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 418719e3a9c9SNikolay Aleksandrov struct hlist_node *tmp; 4188eb1d1641SHerbert Xu 4189eb1d1641SHerbert Xu spin_lock_bh(&br->multicast_lock); 4190e12cec65SNikolay Aleksandrov hlist_for_each_entry_safe(mp, tmp, &br->mdb_list, mdb_node) 4191e12cec65SNikolay Aleksandrov br_multicast_del_mdb_entry(mp); 4192e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 4193eb1d1641SHerbert Xu spin_unlock_bh(&br->multicast_lock); 419419e3a9c9SNikolay Aleksandrov 4195613d61dbSNikolay Aleksandrov br_multicast_ctx_deinit(&br->multicast_ctx); 4196e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 4197e12cec65SNikolay Aleksandrov cancel_work_sync(&br->mcast_gc_work); 41988b671779SNikolay Aleksandrov 41994329596cSNikolay Aleksandrov rcu_barrier(); 4200eb1d1641SHerbert Xu } 42010909e117SHerbert Xu 4202a97df080SNikolay Aleksandrov int br_multicast_set_router(struct net_bridge_mcast *brmctx, unsigned long val) 42030909e117SHerbert Xu { 42046ae4ae8eSLinus Lüssing int err = -EINVAL; 42050909e117SHerbert Xu 4206a97df080SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 42070909e117SHerbert Xu 42080909e117SHerbert Xu switch (val) { 42097f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 42107f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 4211a97df080SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, val == MDB_RTR_TYPE_PERM); 4212d3d065c0SNikolay Aleksandrov del_timer(&brmctx->ip4_mc_router_timer); 4213a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4214d3d065c0SNikolay Aleksandrov del_timer(&brmctx->ip6_mc_router_timer); 4215a3c02e76SLinus Lüssing #endif 4216d3d065c0SNikolay Aleksandrov brmctx->multicast_router = val; 421777041420SYotam Gigi err = 0; 421877041420SYotam Gigi break; 42197f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 4220d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router != MDB_RTR_TYPE_TEMP_QUERY) 4221a97df080SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, false); 4222d3d065c0SNikolay Aleksandrov brmctx->multicast_router = val; 42230909e117SHerbert Xu err = 0; 42240909e117SHerbert Xu break; 42250909e117SHerbert Xu } 42260909e117SHerbert Xu 4227a97df080SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 42280909e117SHerbert Xu 42290909e117SHerbert Xu return err; 42300909e117SHerbert Xu } 42310909e117SHerbert Xu 4232ed2d3597SLinus Lüssing static void 4233adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(struct net_bridge_mcast_port *pmctx, bool deleted) 42347f0aec7aSNikolay Aleksandrov { 4235ed2d3597SLinus Lüssing if (!deleted) 42367f0aec7aSNikolay Aleksandrov return; 4237ed2d3597SLinus Lüssing 4238a3c02e76SLinus Lüssing /* For backwards compatibility for now, only notify if there is 4239a3c02e76SLinus Lüssing * no multicast router anymore for both IPv4 and IPv6. 4240a3c02e76SLinus Lüssing */ 4241adc47037SNikolay Aleksandrov if (!hlist_unhashed(&pmctx->ip4_rlist)) 4242a3c02e76SLinus Lüssing return; 4243a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4244adc47037SNikolay Aleksandrov if (!hlist_unhashed(&pmctx->ip6_rlist)) 4245a3c02e76SLinus Lüssing return; 4246a3c02e76SLinus Lüssing #endif 4247a3c02e76SLinus Lüssing 42481e9ca456SNikolay Aleksandrov br_rtr_notify(pmctx->port->br->dev, pmctx, RTM_DELMDB); 4249adc47037SNikolay Aleksandrov br_port_mc_router_state_change(pmctx->port, false); 4250f12e7d95SNogah Frankel 4251f12e7d95SNogah Frankel /* don't allow timer refresh */ 4252adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_TEMP) 4253adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 42547f0aec7aSNikolay Aleksandrov } 42557f0aec7aSNikolay Aleksandrov 4256a53581d5SNikolay Aleksandrov int br_multicast_set_port_router(struct net_bridge_mcast_port *pmctx, 4257a53581d5SNikolay Aleksandrov unsigned long val) 42580909e117SHerbert Xu { 4259a53581d5SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 4260a55d8246SNikolay Aleksandrov unsigned long now = jiffies; 42616ae4ae8eSLinus Lüssing int err = -EINVAL; 4262ed2d3597SLinus Lüssing bool del = false; 42630909e117SHerbert Xu 4264a53581d5SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 4265ddd0d529SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4266adc47037SNikolay Aleksandrov if (pmctx->multicast_router == val) { 4267a55d8246SNikolay Aleksandrov /* Refresh the temp router port timer */ 4268adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_TEMP) { 4269adc47037SNikolay Aleksandrov mod_timer(&pmctx->ip4_mc_router_timer, 4270d3d065c0SNikolay Aleksandrov now + brmctx->multicast_querier_interval); 4271a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4272adc47037SNikolay Aleksandrov mod_timer(&pmctx->ip6_mc_router_timer, 4273d3d065c0SNikolay Aleksandrov now + brmctx->multicast_querier_interval); 4274a3c02e76SLinus Lüssing #endif 4275a3c02e76SLinus Lüssing } 42764950cfd1SNikolay Aleksandrov err = 0; 42774950cfd1SNikolay Aleksandrov goto unlock; 42784950cfd1SNikolay Aleksandrov } 42790909e117SHerbert Xu switch (val) { 42807f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 4281adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_DISABLED; 4282adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 4283adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 4284adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 4285a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4286adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 4287a3c02e76SLinus Lüssing #endif 4288adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 42890909e117SHerbert Xu break; 42907f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 4291adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 4292adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 4293adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 4294adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 42957f0aec7aSNikolay Aleksandrov break; 42967f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 4297adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_PERM; 4298adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 4299adc47037SNikolay Aleksandrov br_ip4_multicast_add_router(brmctx, pmctx); 4300a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4301adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 4302a3c02e76SLinus Lüssing #endif 4303adc47037SNikolay Aleksandrov br_ip6_multicast_add_router(brmctx, pmctx); 43040909e117SHerbert Xu break; 4305a55d8246SNikolay Aleksandrov case MDB_RTR_TYPE_TEMP: 4306adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP; 4307adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 4308adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 4309a55d8246SNikolay Aleksandrov break; 43107f0aec7aSNikolay Aleksandrov default: 43117f0aec7aSNikolay Aleksandrov goto unlock; 43120909e117SHerbert Xu } 43137f0aec7aSNikolay Aleksandrov err = 0; 43147f0aec7aSNikolay Aleksandrov unlock: 4315ddd0d529SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 43160909e117SHerbert Xu 43170909e117SHerbert Xu return err; 43180909e117SHerbert Xu } 4319561f1103SHerbert Xu 43202796d846SNikolay Aleksandrov int br_multicast_set_vlan_router(struct net_bridge_vlan *v, u8 mcast_router) 43212796d846SNikolay Aleksandrov { 43222796d846SNikolay Aleksandrov int err; 43232796d846SNikolay Aleksandrov 43242796d846SNikolay Aleksandrov if (br_vlan_is_master(v)) 43252796d846SNikolay Aleksandrov err = br_multicast_set_router(&v->br_mcast_ctx, mcast_router); 43262796d846SNikolay Aleksandrov else 43272796d846SNikolay Aleksandrov err = br_multicast_set_port_router(&v->port_mcast_ctx, 43282796d846SNikolay Aleksandrov mcast_router); 43292796d846SNikolay Aleksandrov 43302796d846SNikolay Aleksandrov return err; 43312796d846SNikolay Aleksandrov } 43322796d846SNikolay Aleksandrov 4333adc47037SNikolay Aleksandrov static void br_multicast_start_querier(struct net_bridge_mcast *brmctx, 433490010b36SLinus Lüssing struct bridge_mcast_own_query *query) 4335561f1103SHerbert Xu { 4336561f1103SHerbert Xu struct net_bridge_port *port; 433774857216SHerbert Xu 4338cb486ce9SNikolay Aleksandrov if (!br_multicast_ctx_matches_vlan_snooping(brmctx)) 4339cb486ce9SNikolay Aleksandrov return; 4340cb486ce9SNikolay Aleksandrov 43417b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, query); 434274857216SHerbert Xu 4343c5b493ceSNikolay Aleksandrov rcu_read_lock(); 4344adc47037SNikolay Aleksandrov list_for_each_entry_rcu(port, &brmctx->br->port_list, list) { 4345615cc23eSNikolay Aleksandrov struct bridge_mcast_own_query *ip4_own_query; 4346615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4347615cc23eSNikolay Aleksandrov struct bridge_mcast_own_query *ip6_own_query; 4348615cc23eSNikolay Aleksandrov #endif 4349615cc23eSNikolay Aleksandrov 4350615cc23eSNikolay Aleksandrov if (br_multicast_port_ctx_state_stopped(&port->multicast_ctx)) 435174857216SHerbert Xu continue; 435274857216SHerbert Xu 4353615cc23eSNikolay Aleksandrov if (br_multicast_ctx_is_vlan(brmctx)) { 4354615cc23eSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4355615cc23eSNikolay Aleksandrov 43563f0d14efSNikolay Aleksandrov vlan = br_vlan_find(nbp_vlan_group_rcu(port), 43573f0d14efSNikolay Aleksandrov brmctx->vlan->vid); 4358615cc23eSNikolay Aleksandrov if (!vlan || 4359615cc23eSNikolay Aleksandrov br_multicast_port_ctx_state_stopped(&vlan->port_mcast_ctx)) 4360615cc23eSNikolay Aleksandrov continue; 4361615cc23eSNikolay Aleksandrov 4362615cc23eSNikolay Aleksandrov ip4_own_query = &vlan->port_mcast_ctx.ip4_own_query; 4363615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4364615cc23eSNikolay Aleksandrov ip6_own_query = &vlan->port_mcast_ctx.ip6_own_query; 4365615cc23eSNikolay Aleksandrov #endif 4366615cc23eSNikolay Aleksandrov } else { 4367615cc23eSNikolay Aleksandrov ip4_own_query = &port->multicast_ctx.ip4_own_query; 4368615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4369615cc23eSNikolay Aleksandrov ip6_own_query = &port->multicast_ctx.ip6_own_query; 4370615cc23eSNikolay Aleksandrov #endif 4371615cc23eSNikolay Aleksandrov } 4372615cc23eSNikolay Aleksandrov 4373adc47037SNikolay Aleksandrov if (query == &brmctx->ip4_own_query) 4374615cc23eSNikolay Aleksandrov br_multicast_enable(ip4_own_query); 4375cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4376cc0fdd80SLinus Lüssing else 4377615cc23eSNikolay Aleksandrov br_multicast_enable(ip6_own_query); 4378cc0fdd80SLinus Lüssing #endif 437974857216SHerbert Xu } 4380c5b493ceSNikolay Aleksandrov rcu_read_unlock(); 438174857216SHerbert Xu } 438274857216SHerbert Xu 4383ae1ea84bSFlorian Fainelli int br_multicast_toggle(struct net_bridge *br, unsigned long val, 4384ae1ea84bSFlorian Fainelli struct netlink_ext_ack *extack) 438574857216SHerbert Xu { 43867cb3f921SNikolay Aleksandrov struct net_bridge_port *port; 4387851d0a73SJoseph Huang bool change_snoopers = false; 4388ae1ea84bSFlorian Fainelli int err = 0; 4389561f1103SHerbert Xu 4390ef5e0d82SAndrey Vagin spin_lock_bh(&br->multicast_lock); 439113cefad2SNikolay Aleksandrov if (!!br_opt_get(br, BROPT_MULTICAST_ENABLED) == !!val) 4392561f1103SHerbert Xu goto unlock; 4393561f1103SHerbert Xu 4394ae1ea84bSFlorian Fainelli err = br_mc_disabled_update(br->dev, val, extack); 4395ae1ea84bSFlorian Fainelli if (err == -EOPNOTSUPP) 4396ae1ea84bSFlorian Fainelli err = 0; 4397ae1ea84bSFlorian Fainelli if (err) 4398ae1ea84bSFlorian Fainelli goto unlock; 4399ae1ea84bSFlorian Fainelli 440013cefad2SNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_ENABLED, !!val); 44014effd28cSLinus Lüssing if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) { 4402851d0a73SJoseph Huang change_snoopers = true; 4403561f1103SHerbert Xu goto unlock; 44044effd28cSLinus Lüssing } 4405561f1103SHerbert Xu 44063a7fda06SHerbert Xu if (!netif_running(br->dev)) 44073a7fda06SHerbert Xu goto unlock; 44083a7fda06SHerbert Xu 44097cb3f921SNikolay Aleksandrov br_multicast_open(br); 44107cb3f921SNikolay Aleksandrov list_for_each_entry(port, &br->port_list, list) 4411adc47037SNikolay Aleksandrov __br_multicast_enable_port_ctx(&port->multicast_ctx); 4412561f1103SHerbert Xu 4413851d0a73SJoseph Huang change_snoopers = true; 4414851d0a73SJoseph Huang 4415561f1103SHerbert Xu unlock: 4416ef5e0d82SAndrey Vagin spin_unlock_bh(&br->multicast_lock); 4417561f1103SHerbert Xu 4418851d0a73SJoseph Huang /* br_multicast_join_snoopers has the potential to cause 4419851d0a73SJoseph Huang * an MLD Report/Leave to be delivered to br_multicast_rcv, 4420851d0a73SJoseph Huang * which would in turn call br_multicast_add_group, which would 4421851d0a73SJoseph Huang * attempt to acquire multicast_lock. This function should be 4422851d0a73SJoseph Huang * called after the lock has been released to avoid deadlocks on 4423851d0a73SJoseph Huang * multicast_lock. 4424851d0a73SJoseph Huang * 4425851d0a73SJoseph Huang * br_multicast_leave_snoopers does not have the problem since 4426851d0a73SJoseph Huang * br_multicast_rcv first checks BROPT_MULTICAST_ENABLED, and 4427851d0a73SJoseph Huang * returns without calling br_multicast_ipv4/6_rcv if it's not 4428851d0a73SJoseph Huang * enabled. Moved both functions out just for symmetry. 4429851d0a73SJoseph Huang */ 4430851d0a73SJoseph Huang if (change_snoopers) { 4431851d0a73SJoseph Huang if (br_opt_get(br, BROPT_MULTICAST_ENABLED)) 4432851d0a73SJoseph Huang br_multicast_join_snoopers(br); 4433851d0a73SJoseph Huang else 4434851d0a73SJoseph Huang br_multicast_leave_snoopers(br); 4435851d0a73SJoseph Huang } 4436851d0a73SJoseph Huang 4437ae1ea84bSFlorian Fainelli return err; 4438561f1103SHerbert Xu } 4439b195167fSHerbert Xu 44409341b988SIdo Schimmel bool br_multicast_enabled(const struct net_device *dev) 44419341b988SIdo Schimmel { 44429341b988SIdo Schimmel struct net_bridge *br = netdev_priv(dev); 44439341b988SIdo Schimmel 444413cefad2SNikolay Aleksandrov return !!br_opt_get(br, BROPT_MULTICAST_ENABLED); 44459341b988SIdo Schimmel } 44469341b988SIdo Schimmel EXPORT_SYMBOL_GPL(br_multicast_enabled); 44479341b988SIdo Schimmel 44480912bda4SYotam Gigi bool br_multicast_router(const struct net_device *dev) 44490912bda4SYotam Gigi { 44500912bda4SYotam Gigi struct net_bridge *br = netdev_priv(dev); 44510912bda4SYotam Gigi bool is_router; 44520912bda4SYotam Gigi 44530912bda4SYotam Gigi spin_lock_bh(&br->multicast_lock); 4454adc47037SNikolay Aleksandrov is_router = br_multicast_is_router(&br->multicast_ctx, NULL); 44550912bda4SYotam Gigi spin_unlock_bh(&br->multicast_lock); 44560912bda4SYotam Gigi return is_router; 44570912bda4SYotam Gigi } 44580912bda4SYotam Gigi EXPORT_SYMBOL_GPL(br_multicast_router); 44590912bda4SYotam Gigi 446062938182SNikolay Aleksandrov int br_multicast_set_querier(struct net_bridge_mcast *brmctx, unsigned long val) 4461c5c23260SHerbert Xu { 4462b00589afSLinus Lüssing unsigned long max_delay; 4463b00589afSLinus Lüssing 4464c5c23260SHerbert Xu val = !!val; 4465c5c23260SHerbert Xu 446662938182SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 44674d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier == val) 4468c5c23260SHerbert Xu goto unlock; 4469c5c23260SHerbert Xu 44704d5b4e84SNikolay Aleksandrov WRITE_ONCE(brmctx->multicast_querier, val); 4471b00589afSLinus Lüssing if (!val) 4472b00589afSLinus Lüssing goto unlock; 4473b00589afSLinus Lüssing 4474d3d065c0SNikolay Aleksandrov max_delay = brmctx->multicast_query_response_interval; 4475b00589afSLinus Lüssing 4476d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip4_other_query.timer)) 4477d3d065c0SNikolay Aleksandrov brmctx->ip4_other_query.delay_time = jiffies + max_delay; 4478cc0fdd80SLinus Lüssing 4479adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, &brmctx->ip4_own_query); 4480cc0fdd80SLinus Lüssing 4481cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4482d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip6_other_query.timer)) 4483d3d065c0SNikolay Aleksandrov brmctx->ip6_other_query.delay_time = jiffies + max_delay; 4484cc0fdd80SLinus Lüssing 4485adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, &brmctx->ip6_own_query); 4486cc0fdd80SLinus Lüssing #endif 4487c5c23260SHerbert Xu 4488c5c23260SHerbert Xu unlock: 448962938182SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 4490c5c23260SHerbert Xu 4491c5c23260SHerbert Xu return 0; 4492c5c23260SHerbert Xu } 4493c5c23260SHerbert Xu 4494df271cd6SNikolay Aleksandrov int br_multicast_set_igmp_version(struct net_bridge_mcast *brmctx, 4495df271cd6SNikolay Aleksandrov unsigned long val) 44965e923585SNikolay Aleksandrov { 44975e923585SNikolay Aleksandrov /* Currently we support only version 2 and 3 */ 44985e923585SNikolay Aleksandrov switch (val) { 44995e923585SNikolay Aleksandrov case 2: 45005e923585SNikolay Aleksandrov case 3: 45015e923585SNikolay Aleksandrov break; 45025e923585SNikolay Aleksandrov default: 45035e923585SNikolay Aleksandrov return -EINVAL; 45045e923585SNikolay Aleksandrov } 45055e923585SNikolay Aleksandrov 4506df271cd6SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4507df271cd6SNikolay Aleksandrov brmctx->multicast_igmp_version = val; 4508df271cd6SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 45095e923585SNikolay Aleksandrov 45105e923585SNikolay Aleksandrov return 0; 45115e923585SNikolay Aleksandrov } 45125e923585SNikolay Aleksandrov 4513aa2ae3e7SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4514df271cd6SNikolay Aleksandrov int br_multicast_set_mld_version(struct net_bridge_mcast *brmctx, 4515df271cd6SNikolay Aleksandrov unsigned long val) 4516aa2ae3e7SNikolay Aleksandrov { 4517aa2ae3e7SNikolay Aleksandrov /* Currently we support version 1 and 2 */ 4518aa2ae3e7SNikolay Aleksandrov switch (val) { 4519aa2ae3e7SNikolay Aleksandrov case 1: 4520aa2ae3e7SNikolay Aleksandrov case 2: 4521aa2ae3e7SNikolay Aleksandrov break; 4522aa2ae3e7SNikolay Aleksandrov default: 4523aa2ae3e7SNikolay Aleksandrov return -EINVAL; 4524aa2ae3e7SNikolay Aleksandrov } 4525aa2ae3e7SNikolay Aleksandrov 4526df271cd6SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4527df271cd6SNikolay Aleksandrov brmctx->multicast_mld_version = val; 4528df271cd6SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 4529aa2ae3e7SNikolay Aleksandrov 4530aa2ae3e7SNikolay Aleksandrov return 0; 4531aa2ae3e7SNikolay Aleksandrov } 4532aa2ae3e7SNikolay Aleksandrov #endif 4533aa2ae3e7SNikolay Aleksandrov 453499b40610SNikolay Aleksandrov void br_multicast_set_query_intvl(struct net_bridge_mcast *brmctx, 453599b40610SNikolay Aleksandrov unsigned long val) 453699b40610SNikolay Aleksandrov { 453799b40610SNikolay Aleksandrov unsigned long intvl_jiffies = clock_t_to_jiffies(val); 453899b40610SNikolay Aleksandrov 453999b40610SNikolay Aleksandrov if (intvl_jiffies < BR_MULTICAST_QUERY_INTVL_MIN) { 454099b40610SNikolay Aleksandrov br_info(brmctx->br, 454199b40610SNikolay Aleksandrov "trying to set multicast query interval below minimum, setting to %lu (%ums)\n", 454299b40610SNikolay Aleksandrov jiffies_to_clock_t(BR_MULTICAST_QUERY_INTVL_MIN), 454399b40610SNikolay Aleksandrov jiffies_to_msecs(BR_MULTICAST_QUERY_INTVL_MIN)); 454499b40610SNikolay Aleksandrov intvl_jiffies = BR_MULTICAST_QUERY_INTVL_MIN; 454599b40610SNikolay Aleksandrov } 454699b40610SNikolay Aleksandrov 454799b40610SNikolay Aleksandrov brmctx->multicast_query_interval = intvl_jiffies; 454899b40610SNikolay Aleksandrov } 454999b40610SNikolay Aleksandrov 4550f83a112bSNikolay Aleksandrov void br_multicast_set_startup_query_intvl(struct net_bridge_mcast *brmctx, 4551f83a112bSNikolay Aleksandrov unsigned long val) 4552f83a112bSNikolay Aleksandrov { 4553f83a112bSNikolay Aleksandrov unsigned long intvl_jiffies = clock_t_to_jiffies(val); 4554f83a112bSNikolay Aleksandrov 4555f83a112bSNikolay Aleksandrov if (intvl_jiffies < BR_MULTICAST_STARTUP_QUERY_INTVL_MIN) { 4556f83a112bSNikolay Aleksandrov br_info(brmctx->br, 4557f83a112bSNikolay Aleksandrov "trying to set multicast startup query interval below minimum, setting to %lu (%ums)\n", 4558f83a112bSNikolay Aleksandrov jiffies_to_clock_t(BR_MULTICAST_STARTUP_QUERY_INTVL_MIN), 4559f83a112bSNikolay Aleksandrov jiffies_to_msecs(BR_MULTICAST_STARTUP_QUERY_INTVL_MIN)); 4560f83a112bSNikolay Aleksandrov intvl_jiffies = BR_MULTICAST_STARTUP_QUERY_INTVL_MIN; 4561f83a112bSNikolay Aleksandrov } 4562f83a112bSNikolay Aleksandrov 4563f83a112bSNikolay Aleksandrov brmctx->multicast_startup_query_interval = intvl_jiffies; 4564f83a112bSNikolay Aleksandrov } 4565f83a112bSNikolay Aleksandrov 456607f8ac4aSLinus Lüssing /** 456707f8ac4aSLinus Lüssing * br_multicast_list_adjacent - Returns snooped multicast addresses 456807f8ac4aSLinus Lüssing * @dev: The bridge port adjacent to which to retrieve addresses 456907f8ac4aSLinus Lüssing * @br_ip_list: The list to store found, snooped multicast IP addresses in 457007f8ac4aSLinus Lüssing * 457107f8ac4aSLinus Lüssing * Creates a list of IP addresses (struct br_ip_list) sensed by the multicast 457207f8ac4aSLinus Lüssing * snooping feature on all bridge ports of dev's bridge device, excluding 457307f8ac4aSLinus Lüssing * the addresses from dev itself. 457407f8ac4aSLinus Lüssing * 457507f8ac4aSLinus Lüssing * Returns the number of items added to br_ip_list. 457607f8ac4aSLinus Lüssing * 457707f8ac4aSLinus Lüssing * Notes: 457807f8ac4aSLinus Lüssing * - br_ip_list needs to be initialized by caller 457907f8ac4aSLinus Lüssing * - br_ip_list might contain duplicates in the end 458007f8ac4aSLinus Lüssing * (needs to be taken care of by caller) 458107f8ac4aSLinus Lüssing * - br_ip_list needs to be freed by caller 458207f8ac4aSLinus Lüssing */ 458307f8ac4aSLinus Lüssing int br_multicast_list_adjacent(struct net_device *dev, 458407f8ac4aSLinus Lüssing struct list_head *br_ip_list) 458507f8ac4aSLinus Lüssing { 458607f8ac4aSLinus Lüssing struct net_bridge *br; 458707f8ac4aSLinus Lüssing struct net_bridge_port *port; 458807f8ac4aSLinus Lüssing struct net_bridge_port_group *group; 458907f8ac4aSLinus Lüssing struct br_ip_list *entry; 459007f8ac4aSLinus Lüssing int count = 0; 459107f8ac4aSLinus Lüssing 459207f8ac4aSLinus Lüssing rcu_read_lock(); 459335f861e3SJulian Wiedmann if (!br_ip_list || !netif_is_bridge_port(dev)) 459407f8ac4aSLinus Lüssing goto unlock; 459507f8ac4aSLinus Lüssing 459607f8ac4aSLinus Lüssing port = br_port_get_rcu(dev); 459707f8ac4aSLinus Lüssing if (!port || !port->br) 459807f8ac4aSLinus Lüssing goto unlock; 459907f8ac4aSLinus Lüssing 460007f8ac4aSLinus Lüssing br = port->br; 460107f8ac4aSLinus Lüssing 460207f8ac4aSLinus Lüssing list_for_each_entry_rcu(port, &br->port_list, list) { 460307f8ac4aSLinus Lüssing if (!port->dev || port->dev == dev) 460407f8ac4aSLinus Lüssing continue; 460507f8ac4aSLinus Lüssing 460607f8ac4aSLinus Lüssing hlist_for_each_entry_rcu(group, &port->mglist, mglist) { 460707f8ac4aSLinus Lüssing entry = kmalloc(sizeof(*entry), GFP_ATOMIC); 460807f8ac4aSLinus Lüssing if (!entry) 460907f8ac4aSLinus Lüssing goto unlock; 461007f8ac4aSLinus Lüssing 4611085b53c8SNikolay Aleksandrov entry->addr = group->key.addr; 461207f8ac4aSLinus Lüssing list_add(&entry->list, br_ip_list); 461307f8ac4aSLinus Lüssing count++; 461407f8ac4aSLinus Lüssing } 461507f8ac4aSLinus Lüssing } 461607f8ac4aSLinus Lüssing 461707f8ac4aSLinus Lüssing unlock: 461807f8ac4aSLinus Lüssing rcu_read_unlock(); 461907f8ac4aSLinus Lüssing return count; 462007f8ac4aSLinus Lüssing } 462107f8ac4aSLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_list_adjacent); 46222cd41431SLinus Lüssing 46232cd41431SLinus Lüssing /** 4624c34963e2SLinus Lüssing * br_multicast_has_querier_anywhere - Checks for a querier on a bridge 4625c34963e2SLinus Lüssing * @dev: The bridge port providing the bridge on which to check for a querier 4626c34963e2SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 4627c34963e2SLinus Lüssing * 4628c34963e2SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 4629c34963e2SLinus Lüssing * true if a valid querier exists anywhere on the bridged link layer. 4630c34963e2SLinus Lüssing * Otherwise returns false. 4631c34963e2SLinus Lüssing */ 4632c34963e2SLinus Lüssing bool br_multicast_has_querier_anywhere(struct net_device *dev, int proto) 4633c34963e2SLinus Lüssing { 4634c34963e2SLinus Lüssing struct net_bridge *br; 4635c34963e2SLinus Lüssing struct net_bridge_port *port; 4636c34963e2SLinus Lüssing struct ethhdr eth; 4637c34963e2SLinus Lüssing bool ret = false; 4638c34963e2SLinus Lüssing 4639c34963e2SLinus Lüssing rcu_read_lock(); 464035f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 4641c34963e2SLinus Lüssing goto unlock; 4642c34963e2SLinus Lüssing 4643c34963e2SLinus Lüssing port = br_port_get_rcu(dev); 4644c34963e2SLinus Lüssing if (!port || !port->br) 4645c34963e2SLinus Lüssing goto unlock; 4646c34963e2SLinus Lüssing 4647c34963e2SLinus Lüssing br = port->br; 4648c34963e2SLinus Lüssing 4649c34963e2SLinus Lüssing memset(ð, 0, sizeof(eth)); 4650c34963e2SLinus Lüssing eth.h_proto = htons(proto); 4651c34963e2SLinus Lüssing 4652adc47037SNikolay Aleksandrov ret = br_multicast_querier_exists(&br->multicast_ctx, ð, NULL); 4653c34963e2SLinus Lüssing 4654c34963e2SLinus Lüssing unlock: 4655c34963e2SLinus Lüssing rcu_read_unlock(); 4656c34963e2SLinus Lüssing return ret; 4657c34963e2SLinus Lüssing } 4658c34963e2SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_anywhere); 4659c34963e2SLinus Lüssing 4660c34963e2SLinus Lüssing /** 46612cd41431SLinus Lüssing * br_multicast_has_querier_adjacent - Checks for a querier behind a bridge port 46622cd41431SLinus Lüssing * @dev: The bridge port adjacent to which to check for a querier 46632cd41431SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 46642cd41431SLinus Lüssing * 46652cd41431SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 46662cd41431SLinus Lüssing * true if a selected querier is behind one of the other ports of this 46672cd41431SLinus Lüssing * bridge. Otherwise returns false. 46682cd41431SLinus Lüssing */ 46692cd41431SLinus Lüssing bool br_multicast_has_querier_adjacent(struct net_device *dev, int proto) 46702cd41431SLinus Lüssing { 4671d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 46722cd41431SLinus Lüssing struct net_bridge *br; 46732cd41431SLinus Lüssing struct net_bridge_port *port; 46742cd41431SLinus Lüssing bool ret = false; 4675bb18ef8eSNikolay Aleksandrov int port_ifidx; 46762cd41431SLinus Lüssing 46772cd41431SLinus Lüssing rcu_read_lock(); 467835f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 46792cd41431SLinus Lüssing goto unlock; 46802cd41431SLinus Lüssing 46812cd41431SLinus Lüssing port = br_port_get_rcu(dev); 46822cd41431SLinus Lüssing if (!port || !port->br) 46832cd41431SLinus Lüssing goto unlock; 46842cd41431SLinus Lüssing 46852cd41431SLinus Lüssing br = port->br; 4686d3d065c0SNikolay Aleksandrov brmctx = &br->multicast_ctx; 46872cd41431SLinus Lüssing 46882cd41431SLinus Lüssing switch (proto) { 46892cd41431SLinus Lüssing case ETH_P_IP: 4690bb18ef8eSNikolay Aleksandrov port_ifidx = brmctx->ip4_querier.port_ifidx; 4691d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip4_other_query.timer) || 4692bb18ef8eSNikolay Aleksandrov port_ifidx == port->dev->ifindex) 46932cd41431SLinus Lüssing goto unlock; 46942cd41431SLinus Lüssing break; 46953993c4e1SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 46962cd41431SLinus Lüssing case ETH_P_IPV6: 4697bb18ef8eSNikolay Aleksandrov port_ifidx = brmctx->ip6_querier.port_ifidx; 4698d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip6_other_query.timer) || 4699bb18ef8eSNikolay Aleksandrov port_ifidx == port->dev->ifindex) 47002cd41431SLinus Lüssing goto unlock; 47012cd41431SLinus Lüssing break; 47023993c4e1SLinus Lüssing #endif 47032cd41431SLinus Lüssing default: 47042cd41431SLinus Lüssing goto unlock; 47052cd41431SLinus Lüssing } 47062cd41431SLinus Lüssing 47072cd41431SLinus Lüssing ret = true; 47082cd41431SLinus Lüssing unlock: 47092cd41431SLinus Lüssing rcu_read_unlock(); 47102cd41431SLinus Lüssing return ret; 47112cd41431SLinus Lüssing } 47122cd41431SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_adjacent); 47131080ab95SNikolay Aleksandrov 47143b85f9baSLinus Lüssing /** 47153b85f9baSLinus Lüssing * br_multicast_has_router_adjacent - Checks for a router behind a bridge port 47163b85f9baSLinus Lüssing * @dev: The bridge port adjacent to which to check for a multicast router 47173b85f9baSLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 47183b85f9baSLinus Lüssing * 47193b85f9baSLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 47203b85f9baSLinus Lüssing * true if a multicast router is behind one of the other ports of this 47213b85f9baSLinus Lüssing * bridge. Otherwise returns false. 47223b85f9baSLinus Lüssing */ 47233b85f9baSLinus Lüssing bool br_multicast_has_router_adjacent(struct net_device *dev, int proto) 47243b85f9baSLinus Lüssing { 47259632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 4726d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 47279632233eSNikolay Aleksandrov struct net_bridge_port *port; 47283b85f9baSLinus Lüssing bool ret = false; 47293b85f9baSLinus Lüssing 47303b85f9baSLinus Lüssing rcu_read_lock(); 47313b85f9baSLinus Lüssing port = br_port_get_check_rcu(dev); 47323b85f9baSLinus Lüssing if (!port) 47333b85f9baSLinus Lüssing goto unlock; 47343b85f9baSLinus Lüssing 4735d3d065c0SNikolay Aleksandrov brmctx = &port->br->multicast_ctx; 47363b85f9baSLinus Lüssing switch (proto) { 47373b85f9baSLinus Lüssing case ETH_P_IP: 4738d3d065c0SNikolay Aleksandrov hlist_for_each_entry_rcu(pmctx, &brmctx->ip4_mc_router_list, 47393b85f9baSLinus Lüssing ip4_rlist) { 47409632233eSNikolay Aleksandrov if (pmctx->port == port) 47413b85f9baSLinus Lüssing continue; 47423b85f9baSLinus Lüssing 47433b85f9baSLinus Lüssing ret = true; 47443b85f9baSLinus Lüssing goto unlock; 47453b85f9baSLinus Lüssing } 47463b85f9baSLinus Lüssing break; 47473b85f9baSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 47483b85f9baSLinus Lüssing case ETH_P_IPV6: 4749d3d065c0SNikolay Aleksandrov hlist_for_each_entry_rcu(pmctx, &brmctx->ip6_mc_router_list, 47503b85f9baSLinus Lüssing ip6_rlist) { 47519632233eSNikolay Aleksandrov if (pmctx->port == port) 47523b85f9baSLinus Lüssing continue; 47533b85f9baSLinus Lüssing 47543b85f9baSLinus Lüssing ret = true; 47553b85f9baSLinus Lüssing goto unlock; 47563b85f9baSLinus Lüssing } 47573b85f9baSLinus Lüssing break; 47583b85f9baSLinus Lüssing #endif 47593b85f9baSLinus Lüssing default: 47603b85f9baSLinus Lüssing /* when compiled without IPv6 support, be conservative and 47613b85f9baSLinus Lüssing * always assume presence of an IPv6 multicast router 47623b85f9baSLinus Lüssing */ 47633b85f9baSLinus Lüssing ret = true; 47643b85f9baSLinus Lüssing } 47653b85f9baSLinus Lüssing 47663b85f9baSLinus Lüssing unlock: 47673b85f9baSLinus Lüssing rcu_read_unlock(); 47683b85f9baSLinus Lüssing return ret; 47693b85f9baSLinus Lüssing } 47703b85f9baSLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_router_adjacent); 47713b85f9baSLinus Lüssing 47721080ab95SNikolay Aleksandrov static void br_mcast_stats_add(struct bridge_mcast_stats __percpu *stats, 4773a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 47741080ab95SNikolay Aleksandrov { 47751080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats = this_cpu_ptr(stats); 4776a65056ecSNikolay Aleksandrov __be16 proto = skb->protocol; 4777a65056ecSNikolay Aleksandrov unsigned int t_len; 47781080ab95SNikolay Aleksandrov 47791080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 47801080ab95SNikolay Aleksandrov switch (proto) { 47811080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 4782a65056ecSNikolay Aleksandrov t_len = ntohs(ip_hdr(skb)->tot_len) - ip_hdrlen(skb); 47831080ab95SNikolay Aleksandrov switch (type) { 47841080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_REPORT: 47851080ab95SNikolay Aleksandrov pstats->mstats.igmp_v1reports[dir]++; 47861080ab95SNikolay Aleksandrov break; 47871080ab95SNikolay Aleksandrov case IGMPV2_HOST_MEMBERSHIP_REPORT: 47881080ab95SNikolay Aleksandrov pstats->mstats.igmp_v2reports[dir]++; 47891080ab95SNikolay Aleksandrov break; 47901080ab95SNikolay Aleksandrov case IGMPV3_HOST_MEMBERSHIP_REPORT: 47911080ab95SNikolay Aleksandrov pstats->mstats.igmp_v3reports[dir]++; 47921080ab95SNikolay Aleksandrov break; 47931080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_QUERY: 4794a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct igmphdr)) { 4795a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v3queries[dir]++; 4796a65056ecSNikolay Aleksandrov } else { 4797a65056ecSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 4798a65056ecSNikolay Aleksandrov struct igmphdr *ih, _ihdr; 4799a65056ecSNikolay Aleksandrov 4800a65056ecSNikolay Aleksandrov ih = skb_header_pointer(skb, offset, 4801a65056ecSNikolay Aleksandrov sizeof(_ihdr), &_ihdr); 4802a65056ecSNikolay Aleksandrov if (!ih) 4803a65056ecSNikolay Aleksandrov break; 4804a65056ecSNikolay Aleksandrov if (!ih->code) 4805a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v1queries[dir]++; 4806a65056ecSNikolay Aleksandrov else 4807a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v2queries[dir]++; 4808a65056ecSNikolay Aleksandrov } 48091080ab95SNikolay Aleksandrov break; 48101080ab95SNikolay Aleksandrov case IGMP_HOST_LEAVE_MESSAGE: 48111080ab95SNikolay Aleksandrov pstats->mstats.igmp_leaves[dir]++; 48121080ab95SNikolay Aleksandrov break; 48131080ab95SNikolay Aleksandrov } 48141080ab95SNikolay Aleksandrov break; 48151080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 48161080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 4817a65056ecSNikolay Aleksandrov t_len = ntohs(ipv6_hdr(skb)->payload_len) + 4818a65056ecSNikolay Aleksandrov sizeof(struct ipv6hdr); 4819a65056ecSNikolay Aleksandrov t_len -= skb_network_header_len(skb); 48201080ab95SNikolay Aleksandrov switch (type) { 48211080ab95SNikolay Aleksandrov case ICMPV6_MGM_REPORT: 48221080ab95SNikolay Aleksandrov pstats->mstats.mld_v1reports[dir]++; 48231080ab95SNikolay Aleksandrov break; 48241080ab95SNikolay Aleksandrov case ICMPV6_MLD2_REPORT: 48251080ab95SNikolay Aleksandrov pstats->mstats.mld_v2reports[dir]++; 48261080ab95SNikolay Aleksandrov break; 48271080ab95SNikolay Aleksandrov case ICMPV6_MGM_QUERY: 4828a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct mld_msg)) 4829a65056ecSNikolay Aleksandrov pstats->mstats.mld_v2queries[dir]++; 4830a65056ecSNikolay Aleksandrov else 4831a65056ecSNikolay Aleksandrov pstats->mstats.mld_v1queries[dir]++; 48321080ab95SNikolay Aleksandrov break; 48331080ab95SNikolay Aleksandrov case ICMPV6_MGM_REDUCTION: 48341080ab95SNikolay Aleksandrov pstats->mstats.mld_leaves[dir]++; 48351080ab95SNikolay Aleksandrov break; 48361080ab95SNikolay Aleksandrov } 48371080ab95SNikolay Aleksandrov break; 48381080ab95SNikolay Aleksandrov #endif /* CONFIG_IPV6 */ 48391080ab95SNikolay Aleksandrov } 48401080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 48411080ab95SNikolay Aleksandrov } 48421080ab95SNikolay Aleksandrov 4843adc47037SNikolay Aleksandrov void br_multicast_count(struct net_bridge *br, 4844adc47037SNikolay Aleksandrov const struct net_bridge_port *p, 4845a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 48461080ab95SNikolay Aleksandrov { 48471080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 48481080ab95SNikolay Aleksandrov 48491080ab95SNikolay Aleksandrov /* if multicast_disabled is true then igmp type can't be set */ 4850675779adSNikolay Aleksandrov if (!type || !br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 48511080ab95SNikolay Aleksandrov return; 48521080ab95SNikolay Aleksandrov 48531080ab95SNikolay Aleksandrov if (p) 48541080ab95SNikolay Aleksandrov stats = p->mcast_stats; 48551080ab95SNikolay Aleksandrov else 48561080ab95SNikolay Aleksandrov stats = br->mcast_stats; 48571080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 48581080ab95SNikolay Aleksandrov return; 48591080ab95SNikolay Aleksandrov 4860a65056ecSNikolay Aleksandrov br_mcast_stats_add(stats, skb, type, dir); 48611080ab95SNikolay Aleksandrov } 48621080ab95SNikolay Aleksandrov 48631080ab95SNikolay Aleksandrov int br_multicast_init_stats(struct net_bridge *br) 48641080ab95SNikolay Aleksandrov { 48651080ab95SNikolay Aleksandrov br->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 48661080ab95SNikolay Aleksandrov if (!br->mcast_stats) 48671080ab95SNikolay Aleksandrov return -ENOMEM; 48681080ab95SNikolay Aleksandrov 48691080ab95SNikolay Aleksandrov return 0; 48701080ab95SNikolay Aleksandrov } 48711080ab95SNikolay Aleksandrov 4872b6fe0440SIdo Schimmel void br_multicast_uninit_stats(struct net_bridge *br) 4873b6fe0440SIdo Schimmel { 4874b6fe0440SIdo Schimmel free_percpu(br->mcast_stats); 4875b6fe0440SIdo Schimmel } 4876b6fe0440SIdo Schimmel 4877b3b6a84cSArnd Bergmann /* noinline for https://bugs.llvm.org/show_bug.cgi?id=45802#c9 */ 4878b3b6a84cSArnd Bergmann static noinline_for_stack void mcast_stats_add_dir(u64 *dst, u64 *src) 48791080ab95SNikolay Aleksandrov { 48801080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_RX] += src[BR_MCAST_DIR_RX]; 48811080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_TX] += src[BR_MCAST_DIR_TX]; 48821080ab95SNikolay Aleksandrov } 48831080ab95SNikolay Aleksandrov 48841080ab95SNikolay Aleksandrov void br_multicast_get_stats(const struct net_bridge *br, 48851080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 48861080ab95SNikolay Aleksandrov struct br_mcast_stats *dest) 48871080ab95SNikolay Aleksandrov { 48881080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 48891080ab95SNikolay Aleksandrov struct br_mcast_stats tdst; 48901080ab95SNikolay Aleksandrov int i; 48911080ab95SNikolay Aleksandrov 48921080ab95SNikolay Aleksandrov memset(dest, 0, sizeof(*dest)); 48931080ab95SNikolay Aleksandrov if (p) 48941080ab95SNikolay Aleksandrov stats = p->mcast_stats; 48951080ab95SNikolay Aleksandrov else 48961080ab95SNikolay Aleksandrov stats = br->mcast_stats; 48971080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 48981080ab95SNikolay Aleksandrov return; 48991080ab95SNikolay Aleksandrov 49001080ab95SNikolay Aleksandrov memset(&tdst, 0, sizeof(tdst)); 49011080ab95SNikolay Aleksandrov for_each_possible_cpu(i) { 49021080ab95SNikolay Aleksandrov struct bridge_mcast_stats *cpu_stats = per_cpu_ptr(stats, i); 49031080ab95SNikolay Aleksandrov struct br_mcast_stats temp; 49041080ab95SNikolay Aleksandrov unsigned int start; 49051080ab95SNikolay Aleksandrov 49061080ab95SNikolay Aleksandrov do { 4907d120d1a6SThomas Gleixner start = u64_stats_fetch_begin(&cpu_stats->syncp); 49081080ab95SNikolay Aleksandrov memcpy(&temp, &cpu_stats->mstats, sizeof(temp)); 4909d120d1a6SThomas Gleixner } while (u64_stats_fetch_retry(&cpu_stats->syncp, start)); 49101080ab95SNikolay Aleksandrov 4911a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1queries, temp.igmp_v1queries); 4912a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2queries, temp.igmp_v2queries); 4913a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3queries, temp.igmp_v3queries); 49141080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_leaves, temp.igmp_leaves); 49151080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1reports, temp.igmp_v1reports); 49161080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2reports, temp.igmp_v2reports); 49171080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3reports, temp.igmp_v3reports); 49181080ab95SNikolay Aleksandrov tdst.igmp_parse_errors += temp.igmp_parse_errors; 49191080ab95SNikolay Aleksandrov 4920a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1queries, temp.mld_v1queries); 4921a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2queries, temp.mld_v2queries); 49221080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_leaves, temp.mld_leaves); 49231080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1reports, temp.mld_v1reports); 49241080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2reports, temp.mld_v2reports); 49251080ab95SNikolay Aleksandrov tdst.mld_parse_errors += temp.mld_parse_errors; 49261080ab95SNikolay Aleksandrov } 49271080ab95SNikolay Aleksandrov memcpy(dest, &tdst, sizeof(*dest)); 49281080ab95SNikolay Aleksandrov } 492919e3a9c9SNikolay Aleksandrov 493019e3a9c9SNikolay Aleksandrov int br_mdb_hash_init(struct net_bridge *br) 493119e3a9c9SNikolay Aleksandrov { 4932085b53c8SNikolay Aleksandrov int err; 4933085b53c8SNikolay Aleksandrov 4934085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->sg_port_tbl, &br_sg_port_rht_params); 4935085b53c8SNikolay Aleksandrov if (err) 4936085b53c8SNikolay Aleksandrov return err; 4937085b53c8SNikolay Aleksandrov 4938085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->mdb_hash_tbl, &br_mdb_rht_params); 4939085b53c8SNikolay Aleksandrov if (err) { 4940085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 4941085b53c8SNikolay Aleksandrov return err; 4942085b53c8SNikolay Aleksandrov } 4943085b53c8SNikolay Aleksandrov 4944085b53c8SNikolay Aleksandrov return 0; 494519e3a9c9SNikolay Aleksandrov } 494619e3a9c9SNikolay Aleksandrov 494719e3a9c9SNikolay Aleksandrov void br_mdb_hash_fini(struct net_bridge *br) 494819e3a9c9SNikolay Aleksandrov { 4949085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 495019e3a9c9SNikolay Aleksandrov rhashtable_destroy(&br->mdb_hash_tbl); 495119e3a9c9SNikolay Aleksandrov } 4952