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 && 555a01ecb17SIdo Schimmel (p->flags & MDB_PG_FLAGS_PERMANENT) && 556a01ecb17SIdo Schimmel !(src->flags & BR_SGRP_F_USER_ADDED)) 557b0812368SNikolay Aleksandrov break; 558b0812368SNikolay Aleksandrov 559d5a10222SNikolay Aleksandrov if (fastleave) 560d5a10222SNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_FAST_LEAVE; 561b0812368SNikolay Aleksandrov br_multicast_del_pg(mp, p, pp); 562b0812368SNikolay Aleksandrov break; 563b0812368SNikolay Aleksandrov } 564b0812368SNikolay Aleksandrov src->flags &= ~BR_SGRP_F_INSTALLED; 565b0812368SNikolay Aleksandrov } 566b0812368SNikolay Aleksandrov 5679116ffbfSNikolay Aleksandrov /* install S,G and based on src's timer enable or disable forwarding */ 568b0812368SNikolay Aleksandrov static void br_multicast_fwd_src_handle(struct net_bridge_group_src *src) 569b0812368SNikolay Aleksandrov { 5709116ffbfSNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 5719116ffbfSNikolay Aleksandrov struct net_bridge_port_group *sg; 5729116ffbfSNikolay Aleksandrov u8 old_flags; 5739116ffbfSNikolay Aleksandrov 574b0812368SNikolay Aleksandrov br_multicast_fwd_src_add(src); 5759116ffbfSNikolay Aleksandrov 5769116ffbfSNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 5779116ffbfSNikolay Aleksandrov sg_key.addr = src->pg->key.addr; 5789116ffbfSNikolay Aleksandrov sg_key.addr.src = src->addr.src; 5799116ffbfSNikolay Aleksandrov sg_key.port = src->pg->key.port; 5809116ffbfSNikolay Aleksandrov 5819116ffbfSNikolay Aleksandrov sg = br_sg_port_find(src->br, &sg_key); 5829116ffbfSNikolay Aleksandrov if (!sg || (sg->flags & MDB_PG_FLAGS_PERMANENT)) 5839116ffbfSNikolay Aleksandrov return; 5849116ffbfSNikolay Aleksandrov 5859116ffbfSNikolay Aleksandrov old_flags = sg->flags; 5869116ffbfSNikolay Aleksandrov if (timer_pending(&src->timer)) 5879116ffbfSNikolay Aleksandrov sg->flags &= ~MDB_PG_FLAGS_BLOCKED; 5889116ffbfSNikolay Aleksandrov else 5899116ffbfSNikolay Aleksandrov sg->flags |= MDB_PG_FLAGS_BLOCKED; 5909116ffbfSNikolay Aleksandrov 5919116ffbfSNikolay Aleksandrov if (old_flags != sg->flags) { 5929116ffbfSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 5939116ffbfSNikolay Aleksandrov 5949116ffbfSNikolay Aleksandrov sg_mp = br_mdb_ip_get(src->br, &sg_key.addr); 5959116ffbfSNikolay Aleksandrov if (!sg_mp) 5969116ffbfSNikolay Aleksandrov return; 5979116ffbfSNikolay Aleksandrov br_mdb_notify(src->br->dev, sg_mp, sg, RTM_NEWMDB); 5989116ffbfSNikolay Aleksandrov } 599b0812368SNikolay Aleksandrov } 600b0812368SNikolay Aleksandrov 601e12cec65SNikolay Aleksandrov static void br_multicast_destroy_mdb_entry(struct net_bridge_mcast_gc *gc) 602e12cec65SNikolay Aleksandrov { 603e12cec65SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 604e12cec65SNikolay Aleksandrov 605e12cec65SNikolay Aleksandrov mp = container_of(gc, struct net_bridge_mdb_entry, mcast_gc); 606e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&mp->mdb_node)); 607e12cec65SNikolay Aleksandrov WARN_ON(mp->ports); 608e12cec65SNikolay Aleksandrov 609292a089dSSteven Rostedt (Google) timer_shutdown_sync(&mp->timer); 610e12cec65SNikolay Aleksandrov kfree_rcu(mp, rcu); 611e12cec65SNikolay Aleksandrov } 612e12cec65SNikolay Aleksandrov 613e12cec65SNikolay Aleksandrov static void br_multicast_del_mdb_entry(struct net_bridge_mdb_entry *mp) 614e12cec65SNikolay Aleksandrov { 615e12cec65SNikolay Aleksandrov struct net_bridge *br = mp->br; 616e12cec65SNikolay Aleksandrov 617e12cec65SNikolay Aleksandrov rhashtable_remove_fast(&br->mdb_hash_tbl, &mp->rhnode, 618e12cec65SNikolay Aleksandrov br_mdb_rht_params); 619e12cec65SNikolay Aleksandrov hlist_del_init_rcu(&mp->mdb_node); 620e12cec65SNikolay Aleksandrov hlist_add_head(&mp->mcast_gc.gc_node, &br->mcast_gc_list); 621e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 622e12cec65SNikolay Aleksandrov } 623e12cec65SNikolay Aleksandrov 62488c1f37fSAllen Pais static void br_multicast_group_expired(struct timer_list *t) 625eb1d1641SHerbert Xu { 62688c1f37fSAllen Pais struct net_bridge_mdb_entry *mp = from_timer(mp, t, timer); 627eb1d1641SHerbert Xu struct net_bridge *br = mp->br; 628eb1d1641SHerbert Xu 629eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 630b0812368SNikolay Aleksandrov if (hlist_unhashed(&mp->mdb_node) || !netif_running(br->dev) || 631b0812368SNikolay Aleksandrov timer_pending(&mp->timer)) 632eb1d1641SHerbert Xu goto out; 633eb1d1641SHerbert Xu 6341bc844eeSNikolay Aleksandrov br_multicast_host_leave(mp, true); 635eb1d1641SHerbert Xu 636eb1d1641SHerbert Xu if (mp->ports) 637eb1d1641SHerbert Xu goto out; 638e12cec65SNikolay Aleksandrov br_multicast_del_mdb_entry(mp); 639eb1d1641SHerbert Xu out: 640eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 641eb1d1641SHerbert Xu } 642eb1d1641SHerbert Xu 643e12cec65SNikolay Aleksandrov static void br_multicast_destroy_group_src(struct net_bridge_mcast_gc *gc) 644e12cec65SNikolay Aleksandrov { 645e12cec65SNikolay Aleksandrov struct net_bridge_group_src *src; 646e12cec65SNikolay Aleksandrov 647e12cec65SNikolay Aleksandrov src = container_of(gc, struct net_bridge_group_src, mcast_gc); 648e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&src->node)); 649e12cec65SNikolay Aleksandrov 650292a089dSSteven Rostedt (Google) timer_shutdown_sync(&src->timer); 651e12cec65SNikolay Aleksandrov kfree_rcu(src, rcu); 652e12cec65SNikolay Aleksandrov } 653e12cec65SNikolay Aleksandrov 654083e3534SIdo Schimmel void __br_multicast_del_group_src(struct net_bridge_group_src *src) 6558b671779SNikolay Aleksandrov { 656085b53c8SNikolay Aleksandrov struct net_bridge *br = src->pg->key.port->br; 6578b671779SNikolay Aleksandrov 6588b671779SNikolay Aleksandrov hlist_del_init_rcu(&src->node); 6598b671779SNikolay Aleksandrov src->pg->src_ents--; 660e12cec65SNikolay Aleksandrov hlist_add_head(&src->mcast_gc.gc_node, &br->mcast_gc_list); 661e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 662e12cec65SNikolay Aleksandrov } 663e12cec65SNikolay Aleksandrov 664083e3534SIdo Schimmel void br_multicast_del_group_src(struct net_bridge_group_src *src, 665083e3534SIdo Schimmel bool fastleave) 666083e3534SIdo Schimmel { 667083e3534SIdo Schimmel br_multicast_fwd_src_remove(src, fastleave); 668083e3534SIdo Schimmel __br_multicast_del_group_src(src); 669083e3534SIdo Schimmel } 670083e3534SIdo Schimmel 671e12cec65SNikolay Aleksandrov static void br_multicast_destroy_port_group(struct net_bridge_mcast_gc *gc) 672e12cec65SNikolay Aleksandrov { 673e12cec65SNikolay Aleksandrov struct net_bridge_port_group *pg; 674e12cec65SNikolay Aleksandrov 675e12cec65SNikolay Aleksandrov pg = container_of(gc, struct net_bridge_port_group, mcast_gc); 676e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&pg->mglist)); 677e12cec65SNikolay Aleksandrov WARN_ON(!hlist_empty(&pg->src_list)); 678e12cec65SNikolay Aleksandrov 679292a089dSSteven Rostedt (Google) timer_shutdown_sync(&pg->rexmit_timer); 680292a089dSSteven Rostedt (Google) timer_shutdown_sync(&pg->timer); 681e12cec65SNikolay Aleksandrov kfree_rcu(pg, rcu); 6828b671779SNikolay Aleksandrov } 6838b671779SNikolay Aleksandrov 684681590bdSNikolay Aleksandrov void br_multicast_del_pg(struct net_bridge_mdb_entry *mp, 685681590bdSNikolay Aleksandrov struct net_bridge_port_group *pg, 686681590bdSNikolay Aleksandrov struct net_bridge_port_group __rcu **pp) 687681590bdSNikolay Aleksandrov { 688085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 6898b671779SNikolay Aleksandrov struct net_bridge_group_src *ent; 6908b671779SNikolay Aleksandrov struct hlist_node *tmp; 691681590bdSNikolay Aleksandrov 692681590bdSNikolay Aleksandrov rcu_assign_pointer(*pp, pg->next); 693681590bdSNikolay Aleksandrov hlist_del_init(&pg->mglist); 694baa74d39SNikolay Aleksandrov br_multicast_eht_clean_sets(pg); 6958b671779SNikolay Aleksandrov hlist_for_each_entry_safe(ent, tmp, &pg->src_list, node) 696d5a10222SNikolay Aleksandrov br_multicast_del_group_src(ent, false); 69781f19838SNikolay Aleksandrov br_mdb_notify(br->dev, mp, pg, RTM_DELMDB); 69874705582SNikolay Aleksandrov if (!br_multicast_is_star_g(&mp->addr)) { 69974705582SNikolay Aleksandrov rhashtable_remove_fast(&br->sg_port_tbl, &pg->rhnode, 70074705582SNikolay Aleksandrov br_sg_port_rht_params); 7018266a049SNikolay Aleksandrov br_multicast_sg_del_exclude_ports(mp); 70274705582SNikolay Aleksandrov } else { 7038266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_INCLUDE); 70474705582SNikolay Aleksandrov } 705e12cec65SNikolay Aleksandrov hlist_add_head(&pg->mcast_gc.gc_node, &br->mcast_gc_list); 706e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 707681590bdSNikolay Aleksandrov 708681590bdSNikolay Aleksandrov if (!mp->ports && !mp->host_joined && netif_running(br->dev)) 709681590bdSNikolay Aleksandrov mod_timer(&mp->timer, jiffies); 710681590bdSNikolay Aleksandrov } 711681590bdSNikolay Aleksandrov 712681590bdSNikolay Aleksandrov static void br_multicast_find_del_pg(struct net_bridge *br, 713eb1d1641SHerbert Xu struct net_bridge_port_group *pg) 714eb1d1641SHerbert Xu { 7158b671779SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 716eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 717eb1d1641SHerbert Xu struct net_bridge_port_group *p; 718e8051688SEric Dumazet 719085b53c8SNikolay Aleksandrov mp = br_mdb_ip_get(br, &pg->key.addr); 720eb1d1641SHerbert Xu if (WARN_ON(!mp)) 721eb1d1641SHerbert Xu return; 722eb1d1641SHerbert Xu 723e8051688SEric Dumazet for (pp = &mp->ports; 724e8051688SEric Dumazet (p = mlock_dereference(*pp, br)) != NULL; 725e8051688SEric Dumazet pp = &p->next) { 726eb1d1641SHerbert Xu if (p != pg) 727eb1d1641SHerbert Xu continue; 728eb1d1641SHerbert Xu 729681590bdSNikolay Aleksandrov br_multicast_del_pg(mp, pg, pp); 730eb1d1641SHerbert Xu return; 731eb1d1641SHerbert Xu } 732eb1d1641SHerbert Xu 733eb1d1641SHerbert Xu WARN_ON(1); 734eb1d1641SHerbert Xu } 735eb1d1641SHerbert Xu 73688c1f37fSAllen Pais static void br_multicast_port_group_expired(struct timer_list *t) 737eb1d1641SHerbert Xu { 73888c1f37fSAllen Pais struct net_bridge_port_group *pg = from_timer(pg, t, timer); 739d6c33d67SNikolay Aleksandrov struct net_bridge_group_src *src_ent; 740085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 741d6c33d67SNikolay Aleksandrov struct hlist_node *tmp; 742d6c33d67SNikolay Aleksandrov bool changed; 743eb1d1641SHerbert Xu 744eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 745eb1d1641SHerbert Xu if (!netif_running(br->dev) || timer_pending(&pg->timer) || 7469d06b6d8SElad Raz hlist_unhashed(&pg->mglist) || pg->flags & MDB_PG_FLAGS_PERMANENT) 747eb1d1641SHerbert Xu goto out; 748eb1d1641SHerbert Xu 749d6c33d67SNikolay Aleksandrov changed = !!(pg->filter_mode == MCAST_EXCLUDE); 750d6c33d67SNikolay Aleksandrov pg->filter_mode = MCAST_INCLUDE; 751d6c33d67SNikolay Aleksandrov hlist_for_each_entry_safe(src_ent, tmp, &pg->src_list, node) { 752d6c33d67SNikolay Aleksandrov if (!timer_pending(&src_ent->timer)) { 753d5a10222SNikolay Aleksandrov br_multicast_del_group_src(src_ent, false); 754d6c33d67SNikolay Aleksandrov changed = true; 755d6c33d67SNikolay Aleksandrov } 756d6c33d67SNikolay Aleksandrov } 757eb1d1641SHerbert Xu 758d6c33d67SNikolay Aleksandrov if (hlist_empty(&pg->src_list)) { 759d6c33d67SNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 760d6c33d67SNikolay Aleksandrov } else if (changed) { 761085b53c8SNikolay Aleksandrov struct net_bridge_mdb_entry *mp = br_mdb_ip_get(br, &pg->key.addr); 762d6c33d67SNikolay Aleksandrov 7638266a049SNikolay Aleksandrov if (changed && br_multicast_is_star_g(&pg->key.addr)) 7648266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_INCLUDE); 7658266a049SNikolay Aleksandrov 766d6c33d67SNikolay Aleksandrov if (WARN_ON(!mp)) 767d6c33d67SNikolay Aleksandrov goto out; 768d6c33d67SNikolay Aleksandrov br_mdb_notify(br->dev, mp, pg, RTM_NEWMDB); 769d6c33d67SNikolay Aleksandrov } 770eb1d1641SHerbert Xu out: 771eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 772eb1d1641SHerbert Xu } 773eb1d1641SHerbert Xu 774e12cec65SNikolay Aleksandrov static void br_multicast_gc(struct hlist_head *head) 775e12cec65SNikolay Aleksandrov { 776e12cec65SNikolay Aleksandrov struct net_bridge_mcast_gc *gcent; 777e12cec65SNikolay Aleksandrov struct hlist_node *tmp; 778e12cec65SNikolay Aleksandrov 779e12cec65SNikolay Aleksandrov hlist_for_each_entry_safe(gcent, tmp, head, gc_node) { 780e12cec65SNikolay Aleksandrov hlist_del_init(&gcent->gc_node); 781e12cec65SNikolay Aleksandrov gcent->destroy(gcent); 782e12cec65SNikolay Aleksandrov } 783e12cec65SNikolay Aleksandrov } 784e12cec65SNikolay Aleksandrov 785615cc23eSNikolay Aleksandrov static void __br_multicast_query_handle_vlan(struct net_bridge_mcast *brmctx, 786615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 787615cc23eSNikolay Aleksandrov struct sk_buff *skb) 788615cc23eSNikolay Aleksandrov { 789615cc23eSNikolay Aleksandrov struct net_bridge_vlan *vlan = NULL; 790615cc23eSNikolay Aleksandrov 791615cc23eSNikolay Aleksandrov if (pmctx && br_multicast_port_ctx_is_vlan(pmctx)) 792615cc23eSNikolay Aleksandrov vlan = pmctx->vlan; 793615cc23eSNikolay Aleksandrov else if (br_multicast_ctx_is_vlan(brmctx)) 794615cc23eSNikolay Aleksandrov vlan = brmctx->vlan; 795615cc23eSNikolay Aleksandrov 796615cc23eSNikolay Aleksandrov if (vlan && !(vlan->flags & BRIDGE_VLAN_INFO_UNTAGGED)) { 797615cc23eSNikolay Aleksandrov u16 vlan_proto; 798615cc23eSNikolay Aleksandrov 799615cc23eSNikolay Aleksandrov if (br_vlan_get_proto(brmctx->br->dev, &vlan_proto) != 0) 800615cc23eSNikolay Aleksandrov return; 801615cc23eSNikolay Aleksandrov __vlan_hwaccel_put_tag(skb, htons(vlan_proto), vlan->vid); 802615cc23eSNikolay Aleksandrov } 803615cc23eSNikolay Aleksandrov } 804615cc23eSNikolay Aleksandrov 805adc47037SNikolay Aleksandrov static struct sk_buff *br_ip4_multicast_alloc_query(struct net_bridge_mcast *brmctx, 806615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 807438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 808438ef2d0SNikolay Aleksandrov __be32 ip_dst, __be32 group, 809438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_lmqt, 81042c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 81142c11ccfSNikolay Aleksandrov bool *need_rexmit) 812eb1d1641SHerbert Xu { 813085b53c8SNikolay Aleksandrov struct net_bridge_port *p = pg ? pg->key.port : NULL; 814438ef2d0SNikolay Aleksandrov struct net_bridge_group_src *ent; 815438ef2d0SNikolay Aleksandrov size_t pkt_size, igmp_hdr_size; 816438ef2d0SNikolay Aleksandrov unsigned long now = jiffies; 8175e923585SNikolay Aleksandrov struct igmpv3_query *ihv3; 818438ef2d0SNikolay Aleksandrov void *csum_start = NULL; 819438ef2d0SNikolay Aleksandrov __sum16 *csum = NULL; 820eb1d1641SHerbert Xu struct sk_buff *skb; 821eb1d1641SHerbert Xu struct igmphdr *ih; 822eb1d1641SHerbert Xu struct ethhdr *eth; 823438ef2d0SNikolay Aleksandrov unsigned long lmqt; 824eb1d1641SHerbert Xu struct iphdr *iph; 825438ef2d0SNikolay Aleksandrov u16 lmqt_srcs = 0; 826eb1d1641SHerbert Xu 8275e923585SNikolay Aleksandrov igmp_hdr_size = sizeof(*ih); 828d3d065c0SNikolay Aleksandrov if (brmctx->multicast_igmp_version == 3) { 8295e923585SNikolay Aleksandrov igmp_hdr_size = sizeof(*ihv3); 830438ef2d0SNikolay Aleksandrov if (pg && with_srcs) { 831d3d065c0SNikolay Aleksandrov lmqt = now + (brmctx->multicast_last_member_interval * 832d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_count); 833438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 834438ef2d0SNikolay Aleksandrov if (over_lmqt == time_after(ent->timer.expires, 835438ef2d0SNikolay Aleksandrov lmqt) && 836438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) 837438ef2d0SNikolay Aleksandrov lmqt_srcs++; 838438ef2d0SNikolay Aleksandrov } 839438ef2d0SNikolay Aleksandrov 840438ef2d0SNikolay Aleksandrov if (!lmqt_srcs) 841438ef2d0SNikolay Aleksandrov return NULL; 842438ef2d0SNikolay Aleksandrov igmp_hdr_size += lmqt_srcs * sizeof(__be32); 843438ef2d0SNikolay Aleksandrov } 844438ef2d0SNikolay Aleksandrov } 845438ef2d0SNikolay Aleksandrov 846438ef2d0SNikolay Aleksandrov pkt_size = sizeof(*eth) + sizeof(*iph) + 4 + igmp_hdr_size; 847438ef2d0SNikolay Aleksandrov if ((p && pkt_size > p->dev->mtu) || 848adc47037SNikolay Aleksandrov pkt_size > brmctx->br->dev->mtu) 849438ef2d0SNikolay Aleksandrov return NULL; 850438ef2d0SNikolay Aleksandrov 851adc47037SNikolay Aleksandrov skb = netdev_alloc_skb_ip_align(brmctx->br->dev, pkt_size); 852eb1d1641SHerbert Xu if (!skb) 853eb1d1641SHerbert Xu goto out; 854eb1d1641SHerbert Xu 855615cc23eSNikolay Aleksandrov __br_multicast_query_handle_vlan(brmctx, pmctx, skb); 856eb1d1641SHerbert Xu skb->protocol = htons(ETH_P_IP); 857eb1d1641SHerbert Xu 858eb1d1641SHerbert Xu skb_reset_mac_header(skb); 859eb1d1641SHerbert Xu eth = eth_hdr(skb); 860eb1d1641SHerbert Xu 861adc47037SNikolay Aleksandrov ether_addr_copy(eth->h_source, brmctx->br->dev->dev_addr); 862438ef2d0SNikolay Aleksandrov ip_eth_mc_map(ip_dst, eth->h_dest); 863eb1d1641SHerbert Xu eth->h_proto = htons(ETH_P_IP); 864eb1d1641SHerbert Xu skb_put(skb, sizeof(*eth)); 865eb1d1641SHerbert Xu 866eb1d1641SHerbert Xu skb_set_network_header(skb, skb->len); 867eb1d1641SHerbert Xu iph = ip_hdr(skb); 868438ef2d0SNikolay Aleksandrov iph->tot_len = htons(pkt_size - sizeof(*eth)); 869eb1d1641SHerbert Xu 870eb1d1641SHerbert Xu iph->version = 4; 871eb1d1641SHerbert Xu iph->ihl = 6; 872eb1d1641SHerbert Xu iph->tos = 0xc0; 873eb1d1641SHerbert Xu iph->id = 0; 874eb1d1641SHerbert Xu iph->frag_off = htons(IP_DF); 875eb1d1641SHerbert Xu iph->ttl = 1; 876eb1d1641SHerbert Xu iph->protocol = IPPROTO_IGMP; 877adc47037SNikolay Aleksandrov iph->saddr = br_opt_get(brmctx->br, BROPT_MULTICAST_QUERY_USE_IFADDR) ? 878adc47037SNikolay Aleksandrov inet_select_addr(brmctx->br->dev, 0, RT_SCOPE_LINK) : 0; 879438ef2d0SNikolay Aleksandrov iph->daddr = ip_dst; 880eb1d1641SHerbert Xu ((u8 *)&iph[1])[0] = IPOPT_RA; 881eb1d1641SHerbert Xu ((u8 *)&iph[1])[1] = 4; 882eb1d1641SHerbert Xu ((u8 *)&iph[1])[2] = 0; 883eb1d1641SHerbert Xu ((u8 *)&iph[1])[3] = 0; 884eb1d1641SHerbert Xu ip_send_check(iph); 885eb1d1641SHerbert Xu skb_put(skb, 24); 886eb1d1641SHerbert Xu 887eb1d1641SHerbert Xu skb_set_transport_header(skb, skb->len); 8881080ab95SNikolay Aleksandrov *igmp_type = IGMP_HOST_MEMBERSHIP_QUERY; 8895e923585SNikolay Aleksandrov 890d3d065c0SNikolay Aleksandrov switch (brmctx->multicast_igmp_version) { 8915e923585SNikolay Aleksandrov case 2: 8925e923585SNikolay Aleksandrov ih = igmp_hdr(skb); 893eb1d1641SHerbert Xu ih->type = IGMP_HOST_MEMBERSHIP_QUERY; 894d3d065c0SNikolay Aleksandrov ih->code = (group ? brmctx->multicast_last_member_interval : 895d3d065c0SNikolay Aleksandrov brmctx->multicast_query_response_interval) / 896eb1d1641SHerbert Xu (HZ / IGMP_TIMER_SCALE); 897eb1d1641SHerbert Xu ih->group = group; 898eb1d1641SHerbert Xu ih->csum = 0; 899438ef2d0SNikolay Aleksandrov csum = &ih->csum; 900438ef2d0SNikolay Aleksandrov csum_start = (void *)ih; 9015e923585SNikolay Aleksandrov break; 9025e923585SNikolay Aleksandrov case 3: 9035e923585SNikolay Aleksandrov ihv3 = igmpv3_query_hdr(skb); 9045e923585SNikolay Aleksandrov ihv3->type = IGMP_HOST_MEMBERSHIP_QUERY; 905d3d065c0SNikolay Aleksandrov ihv3->code = (group ? brmctx->multicast_last_member_interval : 906d3d065c0SNikolay Aleksandrov brmctx->multicast_query_response_interval) / 9075e923585SNikolay Aleksandrov (HZ / IGMP_TIMER_SCALE); 9085e923585SNikolay Aleksandrov ihv3->group = group; 909d3d065c0SNikolay Aleksandrov ihv3->qqic = brmctx->multicast_query_interval / HZ; 910438ef2d0SNikolay Aleksandrov ihv3->nsrcs = htons(lmqt_srcs); 9115e923585SNikolay Aleksandrov ihv3->resv = 0; 912438ef2d0SNikolay Aleksandrov ihv3->suppress = sflag; 9135e923585SNikolay Aleksandrov ihv3->qrv = 2; 9145e923585SNikolay Aleksandrov ihv3->csum = 0; 915438ef2d0SNikolay Aleksandrov csum = &ihv3->csum; 916438ef2d0SNikolay Aleksandrov csum_start = (void *)ihv3; 917438ef2d0SNikolay Aleksandrov if (!pg || !with_srcs) 918438ef2d0SNikolay Aleksandrov break; 919438ef2d0SNikolay Aleksandrov 920438ef2d0SNikolay Aleksandrov lmqt_srcs = 0; 921438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 922438ef2d0SNikolay Aleksandrov if (over_lmqt == time_after(ent->timer.expires, 923438ef2d0SNikolay Aleksandrov lmqt) && 924438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) { 925deb96566SNikolay Aleksandrov ihv3->srcs[lmqt_srcs++] = ent->addr.src.ip4; 926438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt--; 92742c11ccfSNikolay Aleksandrov if (need_rexmit && ent->src_query_rexmit_cnt) 92842c11ccfSNikolay Aleksandrov *need_rexmit = true; 929438ef2d0SNikolay Aleksandrov } 930438ef2d0SNikolay Aleksandrov } 931438ef2d0SNikolay Aleksandrov if (WARN_ON(lmqt_srcs != ntohs(ihv3->nsrcs))) { 932438ef2d0SNikolay Aleksandrov kfree_skb(skb); 933438ef2d0SNikolay Aleksandrov return NULL; 934438ef2d0SNikolay Aleksandrov } 9355e923585SNikolay Aleksandrov break; 9365e923585SNikolay Aleksandrov } 937eb1d1641SHerbert Xu 938438ef2d0SNikolay Aleksandrov if (WARN_ON(!csum || !csum_start)) { 939438ef2d0SNikolay Aleksandrov kfree_skb(skb); 940438ef2d0SNikolay Aleksandrov return NULL; 941438ef2d0SNikolay Aleksandrov } 942438ef2d0SNikolay Aleksandrov 943438ef2d0SNikolay Aleksandrov *csum = ip_compute_csum(csum_start, igmp_hdr_size); 9445e923585SNikolay Aleksandrov skb_put(skb, igmp_hdr_size); 945eb1d1641SHerbert Xu __skb_pull(skb, sizeof(*eth)); 946eb1d1641SHerbert Xu 947eb1d1641SHerbert Xu out: 948eb1d1641SHerbert Xu return skb; 949eb1d1641SHerbert Xu } 950eb1d1641SHerbert Xu 951dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 952adc47037SNikolay Aleksandrov static struct sk_buff *br_ip6_multicast_alloc_query(struct net_bridge_mcast *brmctx, 953615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 954438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 955438ef2d0SNikolay Aleksandrov const struct in6_addr *ip6_dst, 956438ef2d0SNikolay Aleksandrov const struct in6_addr *group, 957438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_llqt, 95842c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 95942c11ccfSNikolay Aleksandrov bool *need_rexmit) 96008b202b6SYOSHIFUJI Hideaki { 961085b53c8SNikolay Aleksandrov struct net_bridge_port *p = pg ? pg->key.port : NULL; 962438ef2d0SNikolay Aleksandrov struct net_bridge_group_src *ent; 963438ef2d0SNikolay Aleksandrov size_t pkt_size, mld_hdr_size; 964438ef2d0SNikolay Aleksandrov unsigned long now = jiffies; 965aa2ae3e7SNikolay Aleksandrov struct mld2_query *mld2q; 966438ef2d0SNikolay Aleksandrov void *csum_start = NULL; 967aa2ae3e7SNikolay Aleksandrov unsigned long interval; 968438ef2d0SNikolay Aleksandrov __sum16 *csum = NULL; 96908b202b6SYOSHIFUJI Hideaki struct ipv6hdr *ip6h; 97008b202b6SYOSHIFUJI Hideaki struct mld_msg *mldq; 971aa2ae3e7SNikolay Aleksandrov struct sk_buff *skb; 972438ef2d0SNikolay Aleksandrov unsigned long llqt; 97308b202b6SYOSHIFUJI Hideaki struct ethhdr *eth; 974438ef2d0SNikolay Aleksandrov u16 llqt_srcs = 0; 97508b202b6SYOSHIFUJI Hideaki u8 *hopopt; 97608b202b6SYOSHIFUJI Hideaki 977aa2ae3e7SNikolay Aleksandrov mld_hdr_size = sizeof(*mldq); 978d3d065c0SNikolay Aleksandrov if (brmctx->multicast_mld_version == 2) { 979aa2ae3e7SNikolay Aleksandrov mld_hdr_size = sizeof(*mld2q); 980438ef2d0SNikolay Aleksandrov if (pg && with_srcs) { 981d3d065c0SNikolay Aleksandrov llqt = now + (brmctx->multicast_last_member_interval * 982d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_count); 983438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 984438ef2d0SNikolay Aleksandrov if (over_llqt == time_after(ent->timer.expires, 985438ef2d0SNikolay Aleksandrov llqt) && 986438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) 987438ef2d0SNikolay Aleksandrov llqt_srcs++; 988438ef2d0SNikolay Aleksandrov } 989438ef2d0SNikolay Aleksandrov 990438ef2d0SNikolay Aleksandrov if (!llqt_srcs) 991438ef2d0SNikolay Aleksandrov return NULL; 992438ef2d0SNikolay Aleksandrov mld_hdr_size += llqt_srcs * sizeof(struct in6_addr); 993438ef2d0SNikolay Aleksandrov } 994438ef2d0SNikolay Aleksandrov } 995438ef2d0SNikolay Aleksandrov 996438ef2d0SNikolay Aleksandrov pkt_size = sizeof(*eth) + sizeof(*ip6h) + 8 + mld_hdr_size; 997438ef2d0SNikolay Aleksandrov if ((p && pkt_size > p->dev->mtu) || 998adc47037SNikolay Aleksandrov pkt_size > brmctx->br->dev->mtu) 999438ef2d0SNikolay Aleksandrov return NULL; 1000438ef2d0SNikolay Aleksandrov 1001adc47037SNikolay Aleksandrov skb = netdev_alloc_skb_ip_align(brmctx->br->dev, pkt_size); 100208b202b6SYOSHIFUJI Hideaki if (!skb) 100308b202b6SYOSHIFUJI Hideaki goto out; 100408b202b6SYOSHIFUJI Hideaki 1005615cc23eSNikolay Aleksandrov __br_multicast_query_handle_vlan(brmctx, pmctx, skb); 100608b202b6SYOSHIFUJI Hideaki skb->protocol = htons(ETH_P_IPV6); 100708b202b6SYOSHIFUJI Hideaki 100808b202b6SYOSHIFUJI Hideaki /* Ethernet header */ 100908b202b6SYOSHIFUJI Hideaki skb_reset_mac_header(skb); 101008b202b6SYOSHIFUJI Hideaki eth = eth_hdr(skb); 101108b202b6SYOSHIFUJI Hideaki 1012adc47037SNikolay Aleksandrov ether_addr_copy(eth->h_source, brmctx->br->dev->dev_addr); 101308b202b6SYOSHIFUJI Hideaki eth->h_proto = htons(ETH_P_IPV6); 101408b202b6SYOSHIFUJI Hideaki skb_put(skb, sizeof(*eth)); 101508b202b6SYOSHIFUJI Hideaki 101608b202b6SYOSHIFUJI Hideaki /* IPv6 header + HbH option */ 101708b202b6SYOSHIFUJI Hideaki skb_set_network_header(skb, skb->len); 101808b202b6SYOSHIFUJI Hideaki ip6h = ipv6_hdr(skb); 101908b202b6SYOSHIFUJI Hideaki 102008b202b6SYOSHIFUJI Hideaki *(__force __be32 *)ip6h = htonl(0x60000000); 1021aa2ae3e7SNikolay Aleksandrov ip6h->payload_len = htons(8 + mld_hdr_size); 102208b202b6SYOSHIFUJI Hideaki ip6h->nexthdr = IPPROTO_HOPOPTS; 102308b202b6SYOSHIFUJI Hideaki ip6h->hop_limit = 1; 1024438ef2d0SNikolay Aleksandrov ip6h->daddr = *ip6_dst; 1025adc47037SNikolay Aleksandrov if (ipv6_dev_get_saddr(dev_net(brmctx->br->dev), brmctx->br->dev, 1026adc47037SNikolay Aleksandrov &ip6h->daddr, 0, &ip6h->saddr)) { 1027d1d81d4cSUlrich Weber kfree_skb(skb); 1028adc47037SNikolay Aleksandrov br_opt_toggle(brmctx->br, BROPT_HAS_IPV6_ADDR, false); 1029d1d81d4cSUlrich Weber return NULL; 1030d1d81d4cSUlrich Weber } 10310888d5f3Sdaniel 1032adc47037SNikolay Aleksandrov br_opt_toggle(brmctx->br, BROPT_HAS_IPV6_ADDR, true); 103336cff5a1SLinus Lüssing ipv6_eth_mc_map(&ip6h->daddr, eth->h_dest); 103408b202b6SYOSHIFUJI Hideaki 103508b202b6SYOSHIFUJI Hideaki hopopt = (u8 *)(ip6h + 1); 103608b202b6SYOSHIFUJI Hideaki hopopt[0] = IPPROTO_ICMPV6; /* next hdr */ 103708b202b6SYOSHIFUJI Hideaki hopopt[1] = 0; /* length of HbH */ 103808b202b6SYOSHIFUJI Hideaki hopopt[2] = IPV6_TLV_ROUTERALERT; /* Router Alert */ 103908b202b6SYOSHIFUJI Hideaki hopopt[3] = 2; /* Length of RA Option */ 104008b202b6SYOSHIFUJI Hideaki hopopt[4] = 0; /* Type = 0x0000 (MLD) */ 104108b202b6SYOSHIFUJI Hideaki hopopt[5] = 0; 10421de5a71cSEldad Zack hopopt[6] = IPV6_TLV_PAD1; /* Pad1 */ 10431de5a71cSEldad Zack hopopt[7] = IPV6_TLV_PAD1; /* Pad1 */ 104408b202b6SYOSHIFUJI Hideaki 104508b202b6SYOSHIFUJI Hideaki skb_put(skb, sizeof(*ip6h) + 8); 104608b202b6SYOSHIFUJI Hideaki 104708b202b6SYOSHIFUJI Hideaki /* ICMPv6 */ 104808b202b6SYOSHIFUJI Hideaki skb_set_transport_header(skb, skb->len); 1049438ef2d0SNikolay Aleksandrov interval = ipv6_addr_any(group) ? 1050d3d065c0SNikolay Aleksandrov brmctx->multicast_query_response_interval : 1051d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval; 10521080ab95SNikolay Aleksandrov *igmp_type = ICMPV6_MGM_QUERY; 1053d3d065c0SNikolay Aleksandrov switch (brmctx->multicast_mld_version) { 1054aa2ae3e7SNikolay Aleksandrov case 1: 1055aa2ae3e7SNikolay Aleksandrov mldq = (struct mld_msg *)icmp6_hdr(skb); 105608b202b6SYOSHIFUJI Hideaki mldq->mld_type = ICMPV6_MGM_QUERY; 105708b202b6SYOSHIFUJI Hideaki mldq->mld_code = 0; 105808b202b6SYOSHIFUJI Hideaki mldq->mld_cksum = 0; 105908b202b6SYOSHIFUJI Hideaki mldq->mld_maxdelay = htons((u16)jiffies_to_msecs(interval)); 106008b202b6SYOSHIFUJI Hideaki mldq->mld_reserved = 0; 1061438ef2d0SNikolay Aleksandrov mldq->mld_mca = *group; 1062438ef2d0SNikolay Aleksandrov csum = &mldq->mld_cksum; 1063438ef2d0SNikolay Aleksandrov csum_start = (void *)mldq; 1064aa2ae3e7SNikolay Aleksandrov break; 1065aa2ae3e7SNikolay Aleksandrov case 2: 1066aa2ae3e7SNikolay Aleksandrov mld2q = (struct mld2_query *)icmp6_hdr(skb); 106753631a5fSLance Richardson mld2q->mld2q_mrc = htons((u16)jiffies_to_msecs(interval)); 1068aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_type = ICMPV6_MGM_QUERY; 1069aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_code = 0; 1070aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_cksum = 0; 1071aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_resv1 = 0; 1072aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_resv2 = 0; 1073438ef2d0SNikolay Aleksandrov mld2q->mld2q_suppress = sflag; 1074aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_qrv = 2; 1075438ef2d0SNikolay Aleksandrov mld2q->mld2q_nsrcs = htons(llqt_srcs); 1076d3d065c0SNikolay Aleksandrov mld2q->mld2q_qqic = brmctx->multicast_query_interval / HZ; 1077438ef2d0SNikolay Aleksandrov mld2q->mld2q_mca = *group; 1078438ef2d0SNikolay Aleksandrov csum = &mld2q->mld2q_cksum; 1079438ef2d0SNikolay Aleksandrov csum_start = (void *)mld2q; 1080438ef2d0SNikolay Aleksandrov if (!pg || !with_srcs) 1081438ef2d0SNikolay Aleksandrov break; 1082438ef2d0SNikolay Aleksandrov 1083438ef2d0SNikolay Aleksandrov llqt_srcs = 0; 1084438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 1085438ef2d0SNikolay Aleksandrov if (over_llqt == time_after(ent->timer.expires, 1086438ef2d0SNikolay Aleksandrov llqt) && 1087438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) { 1088deb96566SNikolay Aleksandrov mld2q->mld2q_srcs[llqt_srcs++] = ent->addr.src.ip6; 1089438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt--; 109042c11ccfSNikolay Aleksandrov if (need_rexmit && ent->src_query_rexmit_cnt) 109142c11ccfSNikolay Aleksandrov *need_rexmit = true; 1092438ef2d0SNikolay Aleksandrov } 1093438ef2d0SNikolay Aleksandrov } 1094438ef2d0SNikolay Aleksandrov if (WARN_ON(llqt_srcs != ntohs(mld2q->mld2q_nsrcs))) { 1095438ef2d0SNikolay Aleksandrov kfree_skb(skb); 1096438ef2d0SNikolay Aleksandrov return NULL; 1097438ef2d0SNikolay Aleksandrov } 1098aa2ae3e7SNikolay Aleksandrov break; 1099aa2ae3e7SNikolay Aleksandrov } 110008b202b6SYOSHIFUJI Hideaki 1101438ef2d0SNikolay Aleksandrov if (WARN_ON(!csum || !csum_start)) { 1102438ef2d0SNikolay Aleksandrov kfree_skb(skb); 1103438ef2d0SNikolay Aleksandrov return NULL; 1104438ef2d0SNikolay Aleksandrov } 1105438ef2d0SNikolay Aleksandrov 1106438ef2d0SNikolay Aleksandrov *csum = csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr, mld_hdr_size, 1107438ef2d0SNikolay Aleksandrov IPPROTO_ICMPV6, 1108438ef2d0SNikolay Aleksandrov csum_partial(csum_start, mld_hdr_size, 0)); 1109438ef2d0SNikolay Aleksandrov skb_put(skb, mld_hdr_size); 111008b202b6SYOSHIFUJI Hideaki __skb_pull(skb, sizeof(*eth)); 111108b202b6SYOSHIFUJI Hideaki 111208b202b6SYOSHIFUJI Hideaki out: 111308b202b6SYOSHIFUJI Hideaki return skb; 111408b202b6SYOSHIFUJI Hideaki } 111508b202b6SYOSHIFUJI Hideaki #endif 111608b202b6SYOSHIFUJI Hideaki 1117adc47037SNikolay Aleksandrov static struct sk_buff *br_multicast_alloc_query(struct net_bridge_mcast *brmctx, 1118615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1119438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 1120438ef2d0SNikolay Aleksandrov struct br_ip *ip_dst, 1121438ef2d0SNikolay Aleksandrov struct br_ip *group, 1122438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_lmqt, 112342c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 112442c11ccfSNikolay Aleksandrov bool *need_rexmit) 11258ef2a9a5SYOSHIFUJI Hideaki { 1126438ef2d0SNikolay Aleksandrov __be32 ip4_dst; 1127438ef2d0SNikolay Aleksandrov 1128438ef2d0SNikolay Aleksandrov switch (group->proto) { 11298ef2a9a5SYOSHIFUJI Hideaki case htons(ETH_P_IP): 1130eab3227bSNikolay Aleksandrov ip4_dst = ip_dst ? ip_dst->dst.ip4 : htonl(INADDR_ALLHOSTS_GROUP); 1131615cc23eSNikolay Aleksandrov return br_ip4_multicast_alloc_query(brmctx, pmctx, pg, 1132eab3227bSNikolay Aleksandrov ip4_dst, group->dst.ip4, 1133438ef2d0SNikolay Aleksandrov with_srcs, over_lmqt, 113442c11ccfSNikolay Aleksandrov sflag, igmp_type, 113542c11ccfSNikolay Aleksandrov need_rexmit); 1136dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1137438ef2d0SNikolay Aleksandrov case htons(ETH_P_IPV6): { 1138438ef2d0SNikolay Aleksandrov struct in6_addr ip6_dst; 1139438ef2d0SNikolay Aleksandrov 1140438ef2d0SNikolay Aleksandrov if (ip_dst) 1141eab3227bSNikolay Aleksandrov ip6_dst = ip_dst->dst.ip6; 1142438ef2d0SNikolay Aleksandrov else 1143438ef2d0SNikolay Aleksandrov ipv6_addr_set(&ip6_dst, htonl(0xff020000), 0, 0, 1144438ef2d0SNikolay Aleksandrov htonl(1)); 1145438ef2d0SNikolay Aleksandrov 1146615cc23eSNikolay Aleksandrov return br_ip6_multicast_alloc_query(brmctx, pmctx, pg, 1147eab3227bSNikolay Aleksandrov &ip6_dst, &group->dst.ip6, 1148438ef2d0SNikolay Aleksandrov with_srcs, over_lmqt, 114942c11ccfSNikolay Aleksandrov sflag, igmp_type, 115042c11ccfSNikolay Aleksandrov need_rexmit); 1151438ef2d0SNikolay Aleksandrov } 115208b202b6SYOSHIFUJI Hideaki #endif 11538ef2a9a5SYOSHIFUJI Hideaki } 11548ef2a9a5SYOSHIFUJI Hideaki return NULL; 11558ef2a9a5SYOSHIFUJI Hideaki } 11568ef2a9a5SYOSHIFUJI Hideaki 1157cfd56754SCong Wang struct net_bridge_mdb_entry *br_multicast_new_group(struct net_bridge *br, 11585e923585SNikolay Aleksandrov struct br_ip *group) 1159eb1d1641SHerbert Xu { 1160eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 11614c0833bcSTobias Klauser int err; 1162eb1d1641SHerbert Xu 116319e3a9c9SNikolay Aleksandrov mp = br_mdb_ip_get(br, group); 116419e3a9c9SNikolay Aleksandrov if (mp) 116519e3a9c9SNikolay Aleksandrov return mp; 1166eb1d1641SHerbert Xu 116719e3a9c9SNikolay Aleksandrov if (atomic_read(&br->mdb_hash_tbl.nelems) >= br->hash_max) { 1168c832962aSOleksandr Mazur br_mc_disabled_update(br->dev, false, NULL); 116919e3a9c9SNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_ENABLED, false); 117019e3a9c9SNikolay Aleksandrov return ERR_PTR(-E2BIG); 1171eb1d1641SHerbert Xu } 1172eb1d1641SHerbert Xu 1173eb1d1641SHerbert Xu mp = kzalloc(sizeof(*mp), GFP_ATOMIC); 1174eb1d1641SHerbert Xu if (unlikely(!mp)) 11754c0833bcSTobias Klauser return ERR_PTR(-ENOMEM); 1176eb1d1641SHerbert Xu 1177eb1d1641SHerbert Xu mp->br = br; 11788ef2a9a5SYOSHIFUJI Hideaki mp->addr = *group; 1179e12cec65SNikolay Aleksandrov mp->mcast_gc.destroy = br_multicast_destroy_mdb_entry; 118088c1f37fSAllen Pais timer_setup(&mp->timer, br_multicast_group_expired, 0); 118119e3a9c9SNikolay Aleksandrov err = rhashtable_lookup_insert_fast(&br->mdb_hash_tbl, &mp->rhnode, 118219e3a9c9SNikolay Aleksandrov br_mdb_rht_params); 118319e3a9c9SNikolay Aleksandrov if (err) { 118419e3a9c9SNikolay Aleksandrov kfree(mp); 118519e3a9c9SNikolay Aleksandrov mp = ERR_PTR(err); 118619e3a9c9SNikolay Aleksandrov } else { 118719e3a9c9SNikolay Aleksandrov hlist_add_head_rcu(&mp->mdb_node, &br->mdb_list); 118819e3a9c9SNikolay Aleksandrov } 11891faabf2aSEric Dumazet 1190eb1d1641SHerbert Xu return mp; 1191eb1d1641SHerbert Xu } 1192eb1d1641SHerbert Xu 11938b671779SNikolay Aleksandrov static void br_multicast_group_src_expired(struct timer_list *t) 11948b671779SNikolay Aleksandrov { 11958b671779SNikolay Aleksandrov struct net_bridge_group_src *src = from_timer(src, t, timer); 11968b671779SNikolay Aleksandrov struct net_bridge_port_group *pg; 11978b671779SNikolay Aleksandrov struct net_bridge *br = src->br; 11988b671779SNikolay Aleksandrov 11998b671779SNikolay Aleksandrov spin_lock(&br->multicast_lock); 12008b671779SNikolay Aleksandrov if (hlist_unhashed(&src->node) || !netif_running(br->dev) || 12018b671779SNikolay Aleksandrov timer_pending(&src->timer)) 12028b671779SNikolay Aleksandrov goto out; 12038b671779SNikolay Aleksandrov 12048b671779SNikolay Aleksandrov pg = src->pg; 12058b671779SNikolay Aleksandrov if (pg->filter_mode == MCAST_INCLUDE) { 1206d5a10222SNikolay Aleksandrov br_multicast_del_group_src(src, false); 12078b671779SNikolay Aleksandrov if (!hlist_empty(&pg->src_list)) 12088b671779SNikolay Aleksandrov goto out; 12098b671779SNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 12109116ffbfSNikolay Aleksandrov } else { 12119116ffbfSNikolay Aleksandrov br_multicast_fwd_src_handle(src); 12128b671779SNikolay Aleksandrov } 12139116ffbfSNikolay Aleksandrov 12148b671779SNikolay Aleksandrov out: 12158b671779SNikolay Aleksandrov spin_unlock(&br->multicast_lock); 12168b671779SNikolay Aleksandrov } 12178b671779SNikolay Aleksandrov 1218474ddb37SNikolay Aleksandrov struct net_bridge_group_src * 12198b671779SNikolay Aleksandrov br_multicast_find_group_src(struct net_bridge_port_group *pg, struct br_ip *ip) 12208b671779SNikolay Aleksandrov { 12218b671779SNikolay Aleksandrov struct net_bridge_group_src *ent; 12228b671779SNikolay Aleksandrov 12238b671779SNikolay Aleksandrov switch (ip->proto) { 12248b671779SNikolay Aleksandrov case htons(ETH_P_IP): 12258b671779SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1226deb96566SNikolay Aleksandrov if (ip->src.ip4 == ent->addr.src.ip4) 12278b671779SNikolay Aleksandrov return ent; 12288b671779SNikolay Aleksandrov break; 12298b671779SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 12308b671779SNikolay Aleksandrov case htons(ETH_P_IPV6): 12318b671779SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1232deb96566SNikolay Aleksandrov if (!ipv6_addr_cmp(&ent->addr.src.ip6, &ip->src.ip6)) 12338b671779SNikolay Aleksandrov return ent; 12348b671779SNikolay Aleksandrov break; 12358b671779SNikolay Aleksandrov #endif 12368b671779SNikolay Aleksandrov } 12378b671779SNikolay Aleksandrov 12388b671779SNikolay Aleksandrov return NULL; 12398b671779SNikolay Aleksandrov } 12408b671779SNikolay Aleksandrov 1241fd0c6961SIdo Schimmel struct net_bridge_group_src * 12428b671779SNikolay Aleksandrov br_multicast_new_group_src(struct net_bridge_port_group *pg, struct br_ip *src_ip) 12438b671779SNikolay Aleksandrov { 12448b671779SNikolay Aleksandrov struct net_bridge_group_src *grp_src; 12458b671779SNikolay Aleksandrov 12468b671779SNikolay Aleksandrov if (unlikely(pg->src_ents >= PG_SRC_ENT_LIMIT)) 12478b671779SNikolay Aleksandrov return NULL; 12488b671779SNikolay Aleksandrov 12498b671779SNikolay Aleksandrov switch (src_ip->proto) { 12508b671779SNikolay Aleksandrov case htons(ETH_P_IP): 1251deb96566SNikolay Aleksandrov if (ipv4_is_zeronet(src_ip->src.ip4) || 1252deb96566SNikolay Aleksandrov ipv4_is_multicast(src_ip->src.ip4)) 12538b671779SNikolay Aleksandrov return NULL; 12548b671779SNikolay Aleksandrov break; 12558b671779SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 12568b671779SNikolay Aleksandrov case htons(ETH_P_IPV6): 1257deb96566SNikolay Aleksandrov if (ipv6_addr_any(&src_ip->src.ip6) || 1258deb96566SNikolay Aleksandrov ipv6_addr_is_multicast(&src_ip->src.ip6)) 12598b671779SNikolay Aleksandrov return NULL; 12608b671779SNikolay Aleksandrov break; 12618b671779SNikolay Aleksandrov #endif 12628b671779SNikolay Aleksandrov } 12638b671779SNikolay Aleksandrov 12648b671779SNikolay Aleksandrov grp_src = kzalloc(sizeof(*grp_src), GFP_ATOMIC); 12658b671779SNikolay Aleksandrov if (unlikely(!grp_src)) 12668b671779SNikolay Aleksandrov return NULL; 12678b671779SNikolay Aleksandrov 12688b671779SNikolay Aleksandrov grp_src->pg = pg; 1269085b53c8SNikolay Aleksandrov grp_src->br = pg->key.port->br; 12708b671779SNikolay Aleksandrov grp_src->addr = *src_ip; 1271e12cec65SNikolay Aleksandrov grp_src->mcast_gc.destroy = br_multicast_destroy_group_src; 12728b671779SNikolay Aleksandrov timer_setup(&grp_src->timer, br_multicast_group_src_expired, 0); 12738b671779SNikolay Aleksandrov 12748b671779SNikolay Aleksandrov hlist_add_head_rcu(&grp_src->node, &pg->src_list); 12758b671779SNikolay Aleksandrov pg->src_ents++; 12768b671779SNikolay Aleksandrov 12778b671779SNikolay Aleksandrov return grp_src; 12788b671779SNikolay Aleksandrov } 12798b671779SNikolay Aleksandrov 1280cfd56754SCong Wang struct net_bridge_port_group *br_multicast_new_port_group( 1281cfd56754SCong Wang struct net_bridge_port *port, 1282f86c3e2cSIdo Schimmel const struct br_ip *group, 1283ccb1c31aSAmerigo Wang struct net_bridge_port_group __rcu *next, 12846db6f0eaSFelix Fietkau unsigned char flags, 12858b671779SNikolay Aleksandrov const unsigned char *src, 12868f8cb77eSNikolay Aleksandrov u8 filter_mode, 1287*60977a0cSPetr Machata u8 rt_protocol, 1288*60977a0cSPetr Machata struct netlink_ext_ack *extack) 1289cfd56754SCong Wang { 1290cfd56754SCong Wang struct net_bridge_port_group *p; 1291cfd56754SCong Wang 1292cfd56754SCong Wang p = kzalloc(sizeof(*p), GFP_ATOMIC); 1293cfd56754SCong Wang if (unlikely(!p)) 1294cfd56754SCong Wang return NULL; 1295cfd56754SCong Wang 1296085b53c8SNikolay Aleksandrov p->key.addr = *group; 1297085b53c8SNikolay Aleksandrov p->key.port = port; 12989d06b6d8SElad Raz p->flags = flags; 12998b671779SNikolay Aleksandrov p->filter_mode = filter_mode; 13008f8cb77eSNikolay Aleksandrov p->rt_protocol = rt_protocol; 13015b163288SNikolay Aleksandrov p->eht_host_tree = RB_ROOT; 1302baa74d39SNikolay Aleksandrov p->eht_set_tree = RB_ROOT; 1303e12cec65SNikolay Aleksandrov p->mcast_gc.destroy = br_multicast_destroy_port_group; 13048b671779SNikolay Aleksandrov INIT_HLIST_HEAD(&p->src_list); 1305085b53c8SNikolay Aleksandrov 1306085b53c8SNikolay Aleksandrov if (!br_multicast_is_star_g(group) && 1307085b53c8SNikolay Aleksandrov rhashtable_lookup_insert_fast(&port->br->sg_port_tbl, &p->rhnode, 1308085b53c8SNikolay Aleksandrov br_sg_port_rht_params)) { 1309085b53c8SNikolay Aleksandrov kfree(p); 1310085b53c8SNikolay Aleksandrov return NULL; 1311085b53c8SNikolay Aleksandrov } 1312085b53c8SNikolay Aleksandrov 1313eca2a43bSstephen hemminger rcu_assign_pointer(p->next, next); 131488c1f37fSAllen Pais timer_setup(&p->timer, br_multicast_port_group_expired, 0); 131542c11ccfSNikolay Aleksandrov timer_setup(&p->rexmit_timer, br_multicast_port_group_rexmit, 0); 131642c11ccfSNikolay Aleksandrov hlist_add_head(&p->mglist, &port->mglist); 13176db6f0eaSFelix Fietkau 13186db6f0eaSFelix Fietkau if (src) 13196db6f0eaSFelix Fietkau memcpy(p->eth_addr, src, ETH_ALEN); 13206db6f0eaSFelix Fietkau else 13211bfe45f4SMao Wenan eth_broadcast_addr(p->eth_addr); 13226db6f0eaSFelix Fietkau 1323cfd56754SCong Wang return p; 1324cfd56754SCong Wang } 1325cfd56754SCong Wang 132658d913a3SNikolay Aleksandrov void br_multicast_host_join(const struct net_bridge_mcast *brmctx, 132758d913a3SNikolay Aleksandrov struct net_bridge_mdb_entry *mp, bool notify) 13281bc844eeSNikolay Aleksandrov { 13291bc844eeSNikolay Aleksandrov if (!mp->host_joined) { 13301bc844eeSNikolay Aleksandrov mp->host_joined = true; 1331094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1332094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 13331bc844eeSNikolay Aleksandrov if (notify) 133481f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_NEWMDB); 13351bc844eeSNikolay Aleksandrov } 1336955062b0SNikolay Aleksandrov 1337955062b0SNikolay Aleksandrov if (br_group_is_l2(&mp->addr)) 1338955062b0SNikolay Aleksandrov return; 1339955062b0SNikolay Aleksandrov 134058d913a3SNikolay Aleksandrov mod_timer(&mp->timer, jiffies + brmctx->multicast_membership_interval); 13411bc844eeSNikolay Aleksandrov } 13421bc844eeSNikolay Aleksandrov 13431bc844eeSNikolay Aleksandrov void br_multicast_host_leave(struct net_bridge_mdb_entry *mp, bool notify) 13441bc844eeSNikolay Aleksandrov { 13451bc844eeSNikolay Aleksandrov if (!mp->host_joined) 13461bc844eeSNikolay Aleksandrov return; 13471bc844eeSNikolay Aleksandrov 13481bc844eeSNikolay Aleksandrov mp->host_joined = false; 1349094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1350094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 13511bc844eeSNikolay Aleksandrov if (notify) 135281f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_DELMDB); 13531bc844eeSNikolay Aleksandrov } 13541bc844eeSNikolay Aleksandrov 1355b0812368SNikolay Aleksandrov static struct net_bridge_port_group * 1356adc47037SNikolay Aleksandrov __br_multicast_add_group(struct net_bridge_mcast *brmctx, 1357adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 13586db6f0eaSFelix Fietkau struct br_ip *group, 13598b671779SNikolay Aleksandrov const unsigned char *src, 13600436862eSNikolay Aleksandrov u8 filter_mode, 13619116ffbfSNikolay Aleksandrov bool igmpv2_mldv1, 13629116ffbfSNikolay Aleksandrov bool blocked) 1363eb1d1641SHerbert Xu { 1364e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 1365b0812368SNikolay Aleksandrov struct net_bridge_port_group *p = NULL; 13665e923585SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 1367454594f3SLinus Lüssing unsigned long now = jiffies; 1368eb1d1641SHerbert Xu 13694cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 1370eb1d1641SHerbert Xu goto out; 1371eb1d1641SHerbert Xu 1372adc47037SNikolay Aleksandrov mp = br_multicast_new_group(brmctx->br, group); 13734c0833bcSTobias Klauser if (IS_ERR(mp)) 13741697291dSXu Wang return ERR_CAST(mp); 1375eb1d1641SHerbert Xu 1376adc47037SNikolay Aleksandrov if (!pmctx) { 137758d913a3SNikolay Aleksandrov br_multicast_host_join(brmctx, mp, true); 1378eb1d1641SHerbert Xu goto out; 1379eb1d1641SHerbert Xu } 1380eb1d1641SHerbert Xu 1381e8051688SEric Dumazet for (pp = &mp->ports; 1382adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 1383e8051688SEric Dumazet pp = &p->next) { 1384adc47037SNikolay Aleksandrov if (br_port_group_equal(p, pmctx->port, src)) 1385454594f3SLinus Lüssing goto found; 1386adc47037SNikolay Aleksandrov if ((unsigned long)p->key.port < (unsigned long)pmctx->port) 1387eb1d1641SHerbert Xu break; 1388eb1d1641SHerbert Xu } 1389eb1d1641SHerbert Xu 1390adc47037SNikolay Aleksandrov p = br_multicast_new_port_group(pmctx->port, group, *pp, 0, src, 1391*60977a0cSPetr Machata filter_mode, RTPROT_KERNEL, NULL); 1392b0812368SNikolay Aleksandrov if (unlikely(!p)) { 1393b0812368SNikolay Aleksandrov p = ERR_PTR(-ENOMEM); 1394b0812368SNikolay Aleksandrov goto out; 1395b0812368SNikolay Aleksandrov } 1396eb1d1641SHerbert Xu rcu_assign_pointer(*pp, p); 13979116ffbfSNikolay Aleksandrov if (blocked) 13989116ffbfSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_BLOCKED; 1399adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mp, p, RTM_NEWMDB); 1400eb1d1641SHerbert Xu 1401454594f3SLinus Lüssing found: 14020436862eSNikolay Aleksandrov if (igmpv2_mldv1) 1403d3d065c0SNikolay Aleksandrov mod_timer(&p->timer, 1404adc47037SNikolay Aleksandrov now + brmctx->multicast_membership_interval); 140581f19838SNikolay Aleksandrov 1406eb1d1641SHerbert Xu out: 1407b0812368SNikolay Aleksandrov return p; 1408b0812368SNikolay Aleksandrov } 1409eb1d1641SHerbert Xu 1410adc47037SNikolay Aleksandrov static int br_multicast_add_group(struct net_bridge_mcast *brmctx, 1411adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1412b0812368SNikolay Aleksandrov struct br_ip *group, 1413b0812368SNikolay Aleksandrov const unsigned char *src, 1414b0812368SNikolay Aleksandrov u8 filter_mode, 1415b0812368SNikolay Aleksandrov bool igmpv2_mldv1) 1416b0812368SNikolay Aleksandrov { 1417b0812368SNikolay Aleksandrov struct net_bridge_port_group *pg; 1418b0812368SNikolay Aleksandrov int err; 1419b0812368SNikolay Aleksandrov 1420adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1421adc47037SNikolay Aleksandrov pg = __br_multicast_add_group(brmctx, pmctx, group, src, filter_mode, 14229116ffbfSNikolay Aleksandrov igmpv2_mldv1, false); 1423b0812368SNikolay Aleksandrov /* NULL is considered valid for host joined groups */ 14248d21c882SJiapeng Zhong err = PTR_ERR_OR_ZERO(pg); 1425adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1426b0812368SNikolay Aleksandrov 1427eb1d1641SHerbert Xu return err; 1428eb1d1641SHerbert Xu } 1429eb1d1641SHerbert Xu 1430adc47037SNikolay Aleksandrov static int br_ip4_multicast_add_group(struct net_bridge_mcast *brmctx, 1431adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1432b0e9a30dSVlad Yasevich __be32 group, 14336db6f0eaSFelix Fietkau __u16 vid, 14348b671779SNikolay Aleksandrov const unsigned char *src, 14358b671779SNikolay Aleksandrov bool igmpv2) 14368ef2a9a5SYOSHIFUJI Hideaki { 14378ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 14388b671779SNikolay Aleksandrov u8 filter_mode; 14398ef2a9a5SYOSHIFUJI Hideaki 14408ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 14418ef2a9a5SYOSHIFUJI Hideaki return 0; 14428ef2a9a5SYOSHIFUJI Hideaki 14431515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1444eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 14458ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1446b0e9a30dSVlad Yasevich br_group.vid = vid; 14478b671779SNikolay Aleksandrov filter_mode = igmpv2 ? MCAST_EXCLUDE : MCAST_INCLUDE; 14488ef2a9a5SYOSHIFUJI Hideaki 1449adc47037SNikolay Aleksandrov return br_multicast_add_group(brmctx, pmctx, &br_group, src, 1450adc47037SNikolay Aleksandrov filter_mode, igmpv2); 14518ef2a9a5SYOSHIFUJI Hideaki } 14528ef2a9a5SYOSHIFUJI Hideaki 1453dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1454adc47037SNikolay Aleksandrov static int br_ip6_multicast_add_group(struct net_bridge_mcast *brmctx, 1455adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1456b0e9a30dSVlad Yasevich const struct in6_addr *group, 14576db6f0eaSFelix Fietkau __u16 vid, 14588b671779SNikolay Aleksandrov const unsigned char *src, 14598b671779SNikolay Aleksandrov bool mldv1) 146008b202b6SYOSHIFUJI Hideaki { 146108b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 14628b671779SNikolay Aleksandrov u8 filter_mode; 146308b202b6SYOSHIFUJI Hideaki 14643c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 146508b202b6SYOSHIFUJI Hideaki return 0; 146608b202b6SYOSHIFUJI Hideaki 146719e3a9c9SNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1468eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 14699cc6e0c4SLinus Lüssing br_group.proto = htons(ETH_P_IPV6); 1470b0e9a30dSVlad Yasevich br_group.vid = vid; 14718b671779SNikolay Aleksandrov filter_mode = mldv1 ? MCAST_EXCLUDE : MCAST_INCLUDE; 147208b202b6SYOSHIFUJI Hideaki 1473adc47037SNikolay Aleksandrov return br_multicast_add_group(brmctx, pmctx, &br_group, src, 1474adc47037SNikolay Aleksandrov filter_mode, mldv1); 147508b202b6SYOSHIFUJI Hideaki } 147608b202b6SYOSHIFUJI Hideaki #endif 147708b202b6SYOSHIFUJI Hideaki 1478ed2d3597SLinus Lüssing static bool br_multicast_rport_del(struct hlist_node *rlist) 1479ed2d3597SLinus Lüssing { 1480ed2d3597SLinus Lüssing if (hlist_unhashed(rlist)) 1481ed2d3597SLinus Lüssing return false; 1482ed2d3597SLinus Lüssing 1483ed2d3597SLinus Lüssing hlist_del_init_rcu(rlist); 1484ed2d3597SLinus Lüssing return true; 1485ed2d3597SLinus Lüssing } 1486ed2d3597SLinus Lüssing 1487adc47037SNikolay Aleksandrov static bool br_ip4_multicast_rport_del(struct net_bridge_mcast_port *pmctx) 1488ed2d3597SLinus Lüssing { 1489adc47037SNikolay Aleksandrov return br_multicast_rport_del(&pmctx->ip4_rlist); 1490ed2d3597SLinus Lüssing } 1491ed2d3597SLinus Lüssing 1492adc47037SNikolay Aleksandrov static bool br_ip6_multicast_rport_del(struct net_bridge_mcast_port *pmctx) 1493a3c02e76SLinus Lüssing { 1494a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1495adc47037SNikolay Aleksandrov return br_multicast_rport_del(&pmctx->ip6_rlist); 1496a3c02e76SLinus Lüssing #else 1497a3c02e76SLinus Lüssing return false; 1498a3c02e76SLinus Lüssing #endif 1499a3c02e76SLinus Lüssing } 1500a3c02e76SLinus Lüssing 15019632233eSNikolay Aleksandrov static void br_multicast_router_expired(struct net_bridge_mcast_port *pmctx, 1502ee5fb222SLinus Lüssing struct timer_list *t, 1503ee5fb222SLinus Lüssing struct hlist_node *rlist) 1504eb1d1641SHerbert Xu { 15059632233eSNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 1506ed2d3597SLinus Lüssing bool del; 1507eb1d1641SHerbert Xu 1508eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 15099632233eSNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 15109632233eSNikolay Aleksandrov pmctx->multicast_router == MDB_RTR_TYPE_PERM || 1511ee5fb222SLinus Lüssing timer_pending(t)) 1512eb1d1641SHerbert Xu goto out; 1513eb1d1641SHerbert Xu 1514ed2d3597SLinus Lüssing del = br_multicast_rport_del(rlist); 1515adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 1516eb1d1641SHerbert Xu out: 1517eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1518eb1d1641SHerbert Xu } 1519eb1d1641SHerbert Xu 1520ee5fb222SLinus Lüssing static void br_ip4_multicast_router_expired(struct timer_list *t) 1521ee5fb222SLinus Lüssing { 15229632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 15239632233eSNikolay Aleksandrov ip4_mc_router_timer); 1524ee5fb222SLinus Lüssing 15259632233eSNikolay Aleksandrov br_multicast_router_expired(pmctx, t, &pmctx->ip4_rlist); 1526ee5fb222SLinus Lüssing } 1527ee5fb222SLinus Lüssing 1528a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1529a3c02e76SLinus Lüssing static void br_ip6_multicast_router_expired(struct timer_list *t) 1530a3c02e76SLinus Lüssing { 15319632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 15329632233eSNikolay Aleksandrov ip6_mc_router_timer); 1533a3c02e76SLinus Lüssing 15349632233eSNikolay Aleksandrov br_multicast_router_expired(pmctx, t, &pmctx->ip6_rlist); 1535a3c02e76SLinus Lüssing } 1536a3c02e76SLinus Lüssing #endif 1537a3c02e76SLinus Lüssing 153877041420SYotam Gigi static void br_mc_router_state_change(struct net_bridge *p, 153977041420SYotam Gigi bool is_mc_router) 154077041420SYotam Gigi { 154177041420SYotam Gigi struct switchdev_attr attr = { 154277041420SYotam Gigi .orig_dev = p->dev, 154377041420SYotam Gigi .id = SWITCHDEV_ATTR_ID_BRIDGE_MROUTER, 154477041420SYotam Gigi .flags = SWITCHDEV_F_DEFER, 154577041420SYotam Gigi .u.mrouter = is_mc_router, 154677041420SYotam Gigi }; 154777041420SYotam Gigi 1548dcbdf135SVladimir Oltean switchdev_port_attr_set(p->dev, &attr, NULL); 154977041420SYotam Gigi } 155077041420SYotam Gigi 1551d3d065c0SNikolay Aleksandrov static void br_multicast_local_router_expired(struct net_bridge_mcast *brmctx, 1552ee5fb222SLinus Lüssing struct timer_list *timer) 1553eb1d1641SHerbert Xu { 1554d3d065c0SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1555d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 1556d3d065c0SNikolay Aleksandrov brmctx->multicast_router == MDB_RTR_TYPE_PERM || 1557d3d065c0SNikolay Aleksandrov br_ip4_multicast_is_router(brmctx) || 1558d3d065c0SNikolay Aleksandrov br_ip6_multicast_is_router(brmctx)) 155977041420SYotam Gigi goto out; 156077041420SYotam Gigi 1561d3d065c0SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, false); 156277041420SYotam Gigi out: 1563d3d065c0SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1564eb1d1641SHerbert Xu } 1565eb1d1641SHerbert Xu 1566ee5fb222SLinus Lüssing static void br_ip4_multicast_local_router_expired(struct timer_list *t) 1567ee5fb222SLinus Lüssing { 1568d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1569d3d065c0SNikolay Aleksandrov ip4_mc_router_timer); 1570ee5fb222SLinus Lüssing 1571d3d065c0SNikolay Aleksandrov br_multicast_local_router_expired(brmctx, t); 1572ee5fb222SLinus Lüssing } 1573ee5fb222SLinus Lüssing 1574a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1575a3c02e76SLinus Lüssing static void br_ip6_multicast_local_router_expired(struct timer_list *t) 1576a3c02e76SLinus Lüssing { 1577d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1578d3d065c0SNikolay Aleksandrov ip6_mc_router_timer); 1579a3c02e76SLinus Lüssing 1580d3d065c0SNikolay Aleksandrov br_multicast_local_router_expired(brmctx, t); 1581a3c02e76SLinus Lüssing } 1582a3c02e76SLinus Lüssing #endif 1583a3c02e76SLinus Lüssing 1584d3d065c0SNikolay Aleksandrov static void br_multicast_querier_expired(struct net_bridge_mcast *brmctx, 158590010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1586c83b8fabSHerbert Xu { 1587d3d065c0SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1588d3d065c0SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 15894cdd0d10SNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(brmctx) || 1590d3d065c0SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 1591c83b8fabSHerbert Xu goto out; 1592c83b8fabSHerbert Xu 1593adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, query); 1594c83b8fabSHerbert Xu 1595c83b8fabSHerbert Xu out: 1596d3d065c0SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1597c83b8fabSHerbert Xu } 1598c83b8fabSHerbert Xu 159988c1f37fSAllen Pais static void br_ip4_multicast_querier_expired(struct timer_list *t) 1600cc0fdd80SLinus Lüssing { 1601d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1602d3d065c0SNikolay Aleksandrov ip4_other_query.timer); 1603cc0fdd80SLinus Lüssing 1604d3d065c0SNikolay Aleksandrov br_multicast_querier_expired(brmctx, &brmctx->ip4_own_query); 1605cc0fdd80SLinus Lüssing } 1606cc0fdd80SLinus Lüssing 1607cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 160888c1f37fSAllen Pais static void br_ip6_multicast_querier_expired(struct timer_list *t) 1609cc0fdd80SLinus Lüssing { 1610d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1611d3d065c0SNikolay Aleksandrov ip6_other_query.timer); 1612cc0fdd80SLinus Lüssing 1613d3d065c0SNikolay Aleksandrov br_multicast_querier_expired(brmctx, &brmctx->ip6_own_query); 1614cc0fdd80SLinus Lüssing } 1615cc0fdd80SLinus Lüssing #endif 1616cc0fdd80SLinus Lüssing 1617adc47037SNikolay Aleksandrov static void br_multicast_select_own_querier(struct net_bridge_mcast *brmctx, 1618dc4eb53aSLinus Lüssing struct br_ip *ip, 1619dc4eb53aSLinus Lüssing struct sk_buff *skb) 1620dc4eb53aSLinus Lüssing { 1621dc4eb53aSLinus Lüssing if (ip->proto == htons(ETH_P_IP)) 1622d3d065c0SNikolay Aleksandrov brmctx->ip4_querier.addr.src.ip4 = ip_hdr(skb)->saddr; 1623dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1624dc4eb53aSLinus Lüssing else 1625d3d065c0SNikolay Aleksandrov brmctx->ip6_querier.addr.src.ip6 = ipv6_hdr(skb)->saddr; 1626dc4eb53aSLinus Lüssing #endif 1627dc4eb53aSLinus Lüssing } 1628dc4eb53aSLinus Lüssing 1629adc47037SNikolay Aleksandrov static void __br_multicast_send_query(struct net_bridge_mcast *brmctx, 1630adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1631438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 1632438ef2d0SNikolay Aleksandrov struct br_ip *ip_dst, 1633438ef2d0SNikolay Aleksandrov struct br_ip *group, 1634438ef2d0SNikolay Aleksandrov bool with_srcs, 163542c11ccfSNikolay Aleksandrov u8 sflag, 163642c11ccfSNikolay Aleksandrov bool *need_rexmit) 1637eb1d1641SHerbert Xu { 1638438ef2d0SNikolay Aleksandrov bool over_lmqt = !!sflag; 1639eb1d1641SHerbert Xu struct sk_buff *skb; 16401080ab95SNikolay Aleksandrov u8 igmp_type; 1641eb1d1641SHerbert Xu 1642cb486ce9SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx) || 1643cb486ce9SNikolay Aleksandrov !br_multicast_ctx_matches_vlan_snooping(brmctx)) 1644615cc23eSNikolay Aleksandrov return; 1645615cc23eSNikolay Aleksandrov 1646438ef2d0SNikolay Aleksandrov again_under_lmqt: 1647615cc23eSNikolay Aleksandrov skb = br_multicast_alloc_query(brmctx, pmctx, pg, ip_dst, group, 1648615cc23eSNikolay Aleksandrov with_srcs, over_lmqt, sflag, &igmp_type, 164942c11ccfSNikolay Aleksandrov need_rexmit); 1650eb1d1641SHerbert Xu if (!skb) 16518ef2a9a5SYOSHIFUJI Hideaki return; 1652eb1d1641SHerbert Xu 1653adc47037SNikolay Aleksandrov if (pmctx) { 1654adc47037SNikolay Aleksandrov skb->dev = pmctx->port->dev; 1655adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, pmctx->port, skb, igmp_type, 16561080ab95SNikolay Aleksandrov BR_MCAST_DIR_TX); 165729a26a56SEric W. Biederman NF_HOOK(NFPROTO_BRIDGE, NF_BR_LOCAL_OUT, 1658adc47037SNikolay Aleksandrov dev_net(pmctx->port->dev), NULL, skb, NULL, skb->dev, 1659f0b4eeceSLinus Lüssing br_dev_queue_push_xmit); 1660438ef2d0SNikolay Aleksandrov 1661438ef2d0SNikolay Aleksandrov if (over_lmqt && with_srcs && sflag) { 1662438ef2d0SNikolay Aleksandrov over_lmqt = false; 1663438ef2d0SNikolay Aleksandrov goto again_under_lmqt; 1664438ef2d0SNikolay Aleksandrov } 1665dc4eb53aSLinus Lüssing } else { 1666adc47037SNikolay Aleksandrov br_multicast_select_own_querier(brmctx, group, skb); 1667adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, NULL, skb, igmp_type, 16681080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 1669eb1d1641SHerbert Xu netif_rx(skb); 16708ef2a9a5SYOSHIFUJI Hideaki } 1671dc4eb53aSLinus Lüssing } 1672eb1d1641SHerbert Xu 167367b746f9SNikolay Aleksandrov static void br_multicast_read_querier(const struct bridge_mcast_querier *querier, 167467b746f9SNikolay Aleksandrov struct bridge_mcast_querier *dest) 167567b746f9SNikolay Aleksandrov { 167667b746f9SNikolay Aleksandrov unsigned int seq; 167767b746f9SNikolay Aleksandrov 167867b746f9SNikolay Aleksandrov memset(dest, 0, sizeof(*dest)); 167967b746f9SNikolay Aleksandrov do { 168067b746f9SNikolay Aleksandrov seq = read_seqcount_begin(&querier->seq); 168167b746f9SNikolay Aleksandrov dest->port_ifidx = querier->port_ifidx; 168267b746f9SNikolay Aleksandrov memcpy(&dest->addr, &querier->addr, sizeof(struct br_ip)); 168367b746f9SNikolay Aleksandrov } while (read_seqcount_retry(&querier->seq, seq)); 168467b746f9SNikolay Aleksandrov } 168567b746f9SNikolay Aleksandrov 168667b746f9SNikolay Aleksandrov static void br_multicast_update_querier(struct net_bridge_mcast *brmctx, 168767b746f9SNikolay Aleksandrov struct bridge_mcast_querier *querier, 168867b746f9SNikolay Aleksandrov int ifindex, 168967b746f9SNikolay Aleksandrov struct br_ip *saddr) 169067b746f9SNikolay Aleksandrov { 169167b746f9SNikolay Aleksandrov write_seqcount_begin(&querier->seq); 169267b746f9SNikolay Aleksandrov querier->port_ifidx = ifindex; 169367b746f9SNikolay Aleksandrov memcpy(&querier->addr, saddr, sizeof(*saddr)); 169467b746f9SNikolay Aleksandrov write_seqcount_end(&querier->seq); 169567b746f9SNikolay Aleksandrov } 169667b746f9SNikolay Aleksandrov 1697adc47037SNikolay Aleksandrov static void br_multicast_send_query(struct net_bridge_mcast *brmctx, 1698adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 169990010b36SLinus Lüssing struct bridge_mcast_own_query *own_query) 17008ef2a9a5SYOSHIFUJI Hideaki { 170190010b36SLinus Lüssing struct bridge_mcast_other_query *other_query = NULL; 170267b746f9SNikolay Aleksandrov struct bridge_mcast_querier *querier; 17035e923585SNikolay Aleksandrov struct br_ip br_group; 17045e923585SNikolay Aleksandrov unsigned long time; 17058ef2a9a5SYOSHIFUJI Hideaki 17064cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx) || 1707adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED) || 17084d5b4e84SNikolay Aleksandrov !brmctx->multicast_querier) 17098ef2a9a5SYOSHIFUJI Hideaki return; 17108ef2a9a5SYOSHIFUJI Hideaki 1711eab3227bSNikolay Aleksandrov memset(&br_group.dst, 0, sizeof(br_group.dst)); 17128ef2a9a5SYOSHIFUJI Hideaki 1713adc47037SNikolay Aleksandrov if (pmctx ? (own_query == &pmctx->ip4_own_query) : 1714d3d065c0SNikolay Aleksandrov (own_query == &brmctx->ip4_own_query)) { 171567b746f9SNikolay Aleksandrov querier = &brmctx->ip4_querier; 1716d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 171708b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1718dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1719cc0fdd80SLinus Lüssing } else { 172067b746f9SNikolay Aleksandrov querier = &brmctx->ip6_querier; 1721d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 172208b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 172308b202b6SYOSHIFUJI Hideaki #endif 1724eb1d1641SHerbert Xu } 1725eb1d1641SHerbert Xu 172690010b36SLinus Lüssing if (!other_query || timer_pending(&other_query->timer)) 1727cc0fdd80SLinus Lüssing return; 1728cc0fdd80SLinus Lüssing 172967b746f9SNikolay Aleksandrov /* we're about to select ourselves as querier */ 173067b746f9SNikolay Aleksandrov if (!pmctx && querier->port_ifidx) { 173167b746f9SNikolay Aleksandrov struct br_ip zeroip = {}; 173267b746f9SNikolay Aleksandrov 173367b746f9SNikolay Aleksandrov br_multicast_update_querier(brmctx, querier, 0, &zeroip); 173467b746f9SNikolay Aleksandrov } 173567b746f9SNikolay Aleksandrov 1736adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, NULL, NULL, &br_group, false, 1737adc47037SNikolay Aleksandrov 0, NULL); 1738cc0fdd80SLinus Lüssing 1739cc0fdd80SLinus Lüssing time = jiffies; 1740d3d065c0SNikolay Aleksandrov time += own_query->startup_sent < brmctx->multicast_startup_query_count ? 1741d3d065c0SNikolay Aleksandrov brmctx->multicast_startup_query_interval : 1742d3d065c0SNikolay Aleksandrov brmctx->multicast_query_interval; 174390010b36SLinus Lüssing mod_timer(&own_query->timer, time); 1744cc0fdd80SLinus Lüssing } 1745cc0fdd80SLinus Lüssing 174690010b36SLinus Lüssing static void 17479632233eSNikolay Aleksandrov br_multicast_port_query_expired(struct net_bridge_mcast_port *pmctx, 174890010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1749eb1d1641SHerbert Xu { 17509632233eSNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 17514cdd0d10SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 1752eb1d1641SHerbert Xu 1753eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 17544cdd0d10SNikolay Aleksandrov if (br_multicast_port_ctx_state_stopped(pmctx)) 1755eb1d1641SHerbert Xu goto out; 1756615cc23eSNikolay Aleksandrov 17574cdd0d10SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 17584cdd0d10SNikolay Aleksandrov if (query->startup_sent < brmctx->multicast_startup_query_count) 1759cc0fdd80SLinus Lüssing query->startup_sent++; 1760eb1d1641SHerbert Xu 17614cdd0d10SNikolay Aleksandrov br_multicast_send_query(brmctx, pmctx, query); 1762eb1d1641SHerbert Xu 1763eb1d1641SHerbert Xu out: 1764eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1765eb1d1641SHerbert Xu } 1766eb1d1641SHerbert Xu 176788c1f37fSAllen Pais static void br_ip4_multicast_port_query_expired(struct timer_list *t) 1768cc0fdd80SLinus Lüssing { 17699632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 17709632233eSNikolay Aleksandrov ip4_own_query.timer); 1771cc0fdd80SLinus Lüssing 17729632233eSNikolay Aleksandrov br_multicast_port_query_expired(pmctx, &pmctx->ip4_own_query); 1773cc0fdd80SLinus Lüssing } 1774cc0fdd80SLinus Lüssing 1775cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 177688c1f37fSAllen Pais static void br_ip6_multicast_port_query_expired(struct timer_list *t) 1777cc0fdd80SLinus Lüssing { 17789632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 17799632233eSNikolay Aleksandrov ip6_own_query.timer); 1780cc0fdd80SLinus Lüssing 17819632233eSNikolay Aleksandrov br_multicast_port_query_expired(pmctx, &pmctx->ip6_own_query); 1782cc0fdd80SLinus Lüssing } 1783cc0fdd80SLinus Lüssing #endif 1784cc0fdd80SLinus Lüssing 178542c11ccfSNikolay Aleksandrov static void br_multicast_port_group_rexmit(struct timer_list *t) 178642c11ccfSNikolay Aleksandrov { 178742c11ccfSNikolay Aleksandrov struct net_bridge_port_group *pg = from_timer(pg, t, rexmit_timer); 178842c11ccfSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 1789085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 1790adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 1791adc47037SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 179242c11ccfSNikolay Aleksandrov bool need_rexmit = false; 179342c11ccfSNikolay Aleksandrov 179442c11ccfSNikolay Aleksandrov spin_lock(&br->multicast_lock); 179542c11ccfSNikolay Aleksandrov if (!netif_running(br->dev) || hlist_unhashed(&pg->mglist) || 17964d5b4e84SNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED)) 179742c11ccfSNikolay Aleksandrov goto out; 179842c11ccfSNikolay Aleksandrov 1799eb1593a0SNikolay Aleksandrov pmctx = br_multicast_pg_to_port_ctx(pg); 1800eb1593a0SNikolay Aleksandrov if (!pmctx) 1801eb1593a0SNikolay Aleksandrov goto out; 1802eb1593a0SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 18034d5b4e84SNikolay Aleksandrov if (!brmctx->multicast_querier) 18044d5b4e84SNikolay Aleksandrov goto out; 18054d5b4e84SNikolay Aleksandrov 1806085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 1807d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 180842c11ccfSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 180942c11ccfSNikolay Aleksandrov else 1810d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 181142c11ccfSNikolay Aleksandrov #endif 181242c11ccfSNikolay Aleksandrov 181342c11ccfSNikolay Aleksandrov if (!other_query || timer_pending(&other_query->timer)) 181442c11ccfSNikolay Aleksandrov goto out; 181542c11ccfSNikolay Aleksandrov 181642c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt) { 181742c11ccfSNikolay Aleksandrov pg->grp_query_rexmit_cnt--; 1818adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 1819085b53c8SNikolay Aleksandrov &pg->key.addr, false, 1, NULL); 182042c11ccfSNikolay Aleksandrov } 1821adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 1822085b53c8SNikolay Aleksandrov &pg->key.addr, true, 0, &need_rexmit); 182342c11ccfSNikolay Aleksandrov 182442c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt || need_rexmit) 182542c11ccfSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, jiffies + 1826d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval); 182742c11ccfSNikolay Aleksandrov out: 182842c11ccfSNikolay Aleksandrov spin_unlock(&br->multicast_lock); 182942c11ccfSNikolay Aleksandrov } 183042c11ccfSNikolay Aleksandrov 1831ae1ea84bSFlorian Fainelli static int br_mc_disabled_update(struct net_device *dev, bool value, 1832ae1ea84bSFlorian Fainelli struct netlink_ext_ack *extack) 1833147c1e9bSNogah Frankel { 1834147c1e9bSNogah Frankel struct switchdev_attr attr = { 1835147c1e9bSNogah Frankel .orig_dev = dev, 1836147c1e9bSNogah Frankel .id = SWITCHDEV_ATTR_ID_BRIDGE_MC_DISABLED, 1837147c1e9bSNogah Frankel .flags = SWITCHDEV_F_DEFER, 183813cefad2SNikolay Aleksandrov .u.mc_disabled = !value, 1839147c1e9bSNogah Frankel }; 1840147c1e9bSNogah Frankel 1841ae1ea84bSFlorian Fainelli return switchdev_port_attr_set(dev, &attr, extack); 1842147c1e9bSNogah Frankel } 1843147c1e9bSNogah Frankel 1844613d61dbSNikolay Aleksandrov void br_multicast_port_ctx_init(struct net_bridge_port *port, 1845613d61dbSNikolay Aleksandrov struct net_bridge_vlan *vlan, 18469632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 18479632233eSNikolay Aleksandrov { 18489632233eSNikolay Aleksandrov pmctx->port = port; 1849613d61dbSNikolay Aleksandrov pmctx->vlan = vlan; 18509632233eSNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 18519632233eSNikolay Aleksandrov timer_setup(&pmctx->ip4_mc_router_timer, 18529632233eSNikolay Aleksandrov br_ip4_multicast_router_expired, 0); 18539632233eSNikolay Aleksandrov timer_setup(&pmctx->ip4_own_query.timer, 18549632233eSNikolay Aleksandrov br_ip4_multicast_port_query_expired, 0); 18559632233eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 18569632233eSNikolay Aleksandrov timer_setup(&pmctx->ip6_mc_router_timer, 18579632233eSNikolay Aleksandrov br_ip6_multicast_router_expired, 0); 18589632233eSNikolay Aleksandrov timer_setup(&pmctx->ip6_own_query.timer, 18599632233eSNikolay Aleksandrov br_ip6_multicast_port_query_expired, 0); 18609632233eSNikolay Aleksandrov #endif 18619632233eSNikolay Aleksandrov } 18629632233eSNikolay Aleksandrov 1863613d61dbSNikolay Aleksandrov void br_multicast_port_ctx_deinit(struct net_bridge_mcast_port *pmctx) 18649632233eSNikolay Aleksandrov { 18659632233eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 18669632233eSNikolay Aleksandrov del_timer_sync(&pmctx->ip6_mc_router_timer); 18679632233eSNikolay Aleksandrov #endif 18689632233eSNikolay Aleksandrov del_timer_sync(&pmctx->ip4_mc_router_timer); 18699632233eSNikolay Aleksandrov } 18709632233eSNikolay Aleksandrov 18711080ab95SNikolay Aleksandrov int br_multicast_add_port(struct net_bridge_port *port) 1872eb1d1641SHerbert Xu { 1873ae1ea84bSFlorian Fainelli int err; 1874ae1ea84bSFlorian Fainelli 187589268b05SNikolay Aleksandrov port->multicast_eht_hosts_limit = BR_MCAST_DEFAULT_EHT_HOSTS_LIMIT; 1876613d61dbSNikolay Aleksandrov br_multicast_port_ctx_init(port, NULL, &port->multicast_ctx); 1877eb1d1641SHerbert Xu 1878ae1ea84bSFlorian Fainelli err = br_mc_disabled_update(port->dev, 1879ae1ea84bSFlorian Fainelli br_opt_get(port->br, 1880ae1ea84bSFlorian Fainelli BROPT_MULTICAST_ENABLED), 1881ae1ea84bSFlorian Fainelli NULL); 188268f5c12aSVladimir Oltean if (err && err != -EOPNOTSUPP) 1883ae1ea84bSFlorian Fainelli return err; 1884147c1e9bSNogah Frankel 18851080ab95SNikolay Aleksandrov port->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 18861080ab95SNikolay Aleksandrov if (!port->mcast_stats) 18871080ab95SNikolay Aleksandrov return -ENOMEM; 18881080ab95SNikolay Aleksandrov 18891080ab95SNikolay Aleksandrov return 0; 1890eb1d1641SHerbert Xu } 1891eb1d1641SHerbert Xu 1892eb1d1641SHerbert Xu void br_multicast_del_port(struct net_bridge_port *port) 1893eb1d1641SHerbert Xu { 1894e10177abSSatish Ashok struct net_bridge *br = port->br; 1895e10177abSSatish Ashok struct net_bridge_port_group *pg; 1896e12cec65SNikolay Aleksandrov HLIST_HEAD(deleted_head); 1897e10177abSSatish Ashok struct hlist_node *n; 1898e10177abSSatish Ashok 1899e10177abSSatish Ashok /* Take care of the remaining groups, only perm ones should be left */ 1900e10177abSSatish Ashok spin_lock_bh(&br->multicast_lock); 1901e10177abSSatish Ashok hlist_for_each_entry_safe(pg, n, &port->mglist, mglist) 1902681590bdSNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 1903e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 1904e10177abSSatish Ashok spin_unlock_bh(&br->multicast_lock); 1905e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 19069632233eSNikolay Aleksandrov br_multicast_port_ctx_deinit(&port->multicast_ctx); 19071080ab95SNikolay Aleksandrov free_percpu(port->mcast_stats); 1908eb1d1641SHerbert Xu } 1909eb1d1641SHerbert Xu 191090010b36SLinus Lüssing static void br_multicast_enable(struct bridge_mcast_own_query *query) 1911561f1103SHerbert Xu { 1912cc0fdd80SLinus Lüssing query->startup_sent = 0; 1913561f1103SHerbert Xu 1914cc0fdd80SLinus Lüssing if (try_to_del_timer_sync(&query->timer) >= 0 || 1915cc0fdd80SLinus Lüssing del_timer(&query->timer)) 1916cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 1917561f1103SHerbert Xu } 1918561f1103SHerbert Xu 1919adc47037SNikolay Aleksandrov static void __br_multicast_enable_port_ctx(struct net_bridge_mcast_port *pmctx) 1920eb1d1641SHerbert Xu { 1921adc47037SNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 19227b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 1923eb1d1641SHerbert Xu 19247b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 19257b54aaafSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED) || 19267b54aaafSNikolay Aleksandrov !netif_running(br->dev)) 19277cb3f921SNikolay Aleksandrov return; 1928eb1d1641SHerbert Xu 1929adc47037SNikolay Aleksandrov br_multicast_enable(&pmctx->ip4_own_query); 1930cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1931adc47037SNikolay Aleksandrov br_multicast_enable(&pmctx->ip6_own_query); 1932cc0fdd80SLinus Lüssing #endif 1933adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_PERM) { 1934adc47037SNikolay Aleksandrov br_ip4_multicast_add_router(brmctx, pmctx); 1935adc47037SNikolay Aleksandrov br_ip6_multicast_add_router(brmctx, pmctx); 1936a3c02e76SLinus Lüssing } 19377cb3f921SNikolay Aleksandrov } 1938eb1d1641SHerbert Xu 19397cb3f921SNikolay Aleksandrov void br_multicast_enable_port(struct net_bridge_port *port) 19407cb3f921SNikolay Aleksandrov { 19417cb3f921SNikolay Aleksandrov struct net_bridge *br = port->br; 19427cb3f921SNikolay Aleksandrov 1943f4b7002aSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 1944adc47037SNikolay Aleksandrov __br_multicast_enable_port_ctx(&port->multicast_ctx); 1945f4b7002aSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 1946eb1d1641SHerbert Xu } 1947eb1d1641SHerbert Xu 19487b54aaafSNikolay Aleksandrov static void __br_multicast_disable_port_ctx(struct net_bridge_mcast_port *pmctx) 1949eb1d1641SHerbert Xu { 1950eb1d1641SHerbert Xu struct net_bridge_port_group *pg; 1951b67bfe0dSSasha Levin struct hlist_node *n; 1952ed2d3597SLinus Lüssing bool del = false; 1953eb1d1641SHerbert Xu 19547b54aaafSNikolay Aleksandrov hlist_for_each_entry_safe(pg, n, &pmctx->port->mglist, mglist) 19557b54aaafSNikolay Aleksandrov if (!(pg->flags & MDB_PG_FLAGS_PERMANENT) && 19567b54aaafSNikolay Aleksandrov (!br_multicast_port_ctx_is_vlan(pmctx) || 19577b54aaafSNikolay Aleksandrov pg->key.addr.vid == pmctx->vlan->vid)) 19587b54aaafSNikolay Aleksandrov br_multicast_find_del_pg(pmctx->port->br, pg); 1959eb1d1641SHerbert Xu 1960adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 1961adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 1962adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_own_query.timer); 1963adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 1964cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1965adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 1966adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_own_query.timer); 1967cc0fdd80SLinus Lüssing #endif 1968adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 19697b54aaafSNikolay Aleksandrov } 19707b54aaafSNikolay Aleksandrov 19717b54aaafSNikolay Aleksandrov void br_multicast_disable_port(struct net_bridge_port *port) 19727b54aaafSNikolay Aleksandrov { 1973f4b7002aSNikolay Aleksandrov spin_lock_bh(&port->br->multicast_lock); 19747b54aaafSNikolay Aleksandrov __br_multicast_disable_port_ctx(&port->multicast_ctx); 1975f4b7002aSNikolay Aleksandrov spin_unlock_bh(&port->br->multicast_lock); 1976eb1d1641SHerbert Xu } 1977eb1d1641SHerbert Xu 1978e6231bcaSNikolay Aleksandrov static int __grp_src_delete_marked(struct net_bridge_port_group *pg) 1979e6231bcaSNikolay Aleksandrov { 1980e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 1981e6231bcaSNikolay Aleksandrov struct hlist_node *tmp; 1982e6231bcaSNikolay Aleksandrov int deleted = 0; 1983e6231bcaSNikolay Aleksandrov 1984e6231bcaSNikolay Aleksandrov hlist_for_each_entry_safe(ent, tmp, &pg->src_list, node) 1985e6231bcaSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_DELETE) { 1986d5a10222SNikolay Aleksandrov br_multicast_del_group_src(ent, false); 1987e6231bcaSNikolay Aleksandrov deleted++; 1988e6231bcaSNikolay Aleksandrov } 1989e6231bcaSNikolay Aleksandrov 1990e6231bcaSNikolay Aleksandrov return deleted; 1991e6231bcaSNikolay Aleksandrov } 1992e6231bcaSNikolay Aleksandrov 1993b0812368SNikolay Aleksandrov static void __grp_src_mod_timer(struct net_bridge_group_src *src, 1994b0812368SNikolay Aleksandrov unsigned long expires) 1995b0812368SNikolay Aleksandrov { 1996b0812368SNikolay Aleksandrov mod_timer(&src->timer, expires); 1997b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(src); 1998b0812368SNikolay Aleksandrov } 1999b0812368SNikolay Aleksandrov 2000adc47037SNikolay Aleksandrov static void __grp_src_query_marked_and_rexmit(struct net_bridge_mcast *brmctx, 2001adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2002adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg) 20035bf1e00bSNikolay Aleksandrov { 20045bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 2005d3d065c0SNikolay Aleksandrov u32 lmqc = brmctx->multicast_last_member_count; 20065bf1e00bSNikolay Aleksandrov unsigned long lmqt, lmi, now = jiffies; 20075bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 20085bf1e00bSNikolay Aleksandrov 2009adc47037SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 2010adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 20115bf1e00bSNikolay Aleksandrov return; 20125bf1e00bSNikolay Aleksandrov 2013085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 2014d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 20155bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 20165bf1e00bSNikolay Aleksandrov else 2017d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 20185bf1e00bSNikolay Aleksandrov #endif 20195bf1e00bSNikolay Aleksandrov 2020adc47037SNikolay Aleksandrov lmqt = now + br_multicast_lmqt(brmctx); 20215bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 20225bf1e00bSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_SEND) { 20235bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 20245bf1e00bSNikolay Aleksandrov if (ent->timer.expires > lmqt) { 20254d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier && 20265bf1e00bSNikolay Aleksandrov other_query && 20275bf1e00bSNikolay Aleksandrov !timer_pending(&other_query->timer)) 20285bf1e00bSNikolay Aleksandrov ent->src_query_rexmit_cnt = lmqc; 2029b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, lmqt); 20305bf1e00bSNikolay Aleksandrov } 20315bf1e00bSNikolay Aleksandrov } 20325bf1e00bSNikolay Aleksandrov } 20335bf1e00bSNikolay Aleksandrov 20344d5b4e84SNikolay Aleksandrov if (!brmctx->multicast_querier || 20355bf1e00bSNikolay Aleksandrov !other_query || timer_pending(&other_query->timer)) 20365bf1e00bSNikolay Aleksandrov return; 20375bf1e00bSNikolay Aleksandrov 2038adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 2039085b53c8SNikolay Aleksandrov &pg->key.addr, true, 1, NULL); 20405bf1e00bSNikolay Aleksandrov 2041d3d065c0SNikolay Aleksandrov lmi = now + brmctx->multicast_last_member_interval; 20425bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 20435bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 20445bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 20455bf1e00bSNikolay Aleksandrov } 20465bf1e00bSNikolay Aleksandrov 2047adc47037SNikolay Aleksandrov static void __grp_send_query_and_rexmit(struct net_bridge_mcast *brmctx, 2048adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2049adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg) 20505bf1e00bSNikolay Aleksandrov { 20515bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 20525bf1e00bSNikolay Aleksandrov unsigned long now = jiffies, lmi; 20535bf1e00bSNikolay Aleksandrov 2054adc47037SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 2055adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 20565bf1e00bSNikolay Aleksandrov return; 20575bf1e00bSNikolay Aleksandrov 2058085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 2059d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 20605bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 20615bf1e00bSNikolay Aleksandrov else 2062d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 20635bf1e00bSNikolay Aleksandrov #endif 20645bf1e00bSNikolay Aleksandrov 20654d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier && 20665bf1e00bSNikolay Aleksandrov other_query && !timer_pending(&other_query->timer)) { 2067d3d065c0SNikolay Aleksandrov lmi = now + brmctx->multicast_last_member_interval; 2068d3d065c0SNikolay Aleksandrov pg->grp_query_rexmit_cnt = brmctx->multicast_last_member_count - 1; 2069adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 2070085b53c8SNikolay Aleksandrov &pg->key.addr, false, 0, NULL); 20715bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 20725bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 20735bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 20745bf1e00bSNikolay Aleksandrov } 20755bf1e00bSNikolay Aleksandrov 20765bf1e00bSNikolay Aleksandrov if (pg->filter_mode == MCAST_EXCLUDE && 20775bf1e00bSNikolay Aleksandrov (!timer_pending(&pg->timer) || 2078adc47037SNikolay Aleksandrov time_after(pg->timer.expires, now + br_multicast_lmqt(brmctx)))) 2079adc47037SNikolay Aleksandrov mod_timer(&pg->timer, now + br_multicast_lmqt(brmctx)); 20805bf1e00bSNikolay Aleksandrov } 20815bf1e00bSNikolay Aleksandrov 20820436862eSNikolay Aleksandrov /* State Msg type New state Actions 20830436862eSNikolay Aleksandrov * INCLUDE (A) IS_IN (B) INCLUDE (A+B) (B)=GMI 20840436862eSNikolay Aleksandrov * INCLUDE (A) ALLOW (B) INCLUDE (A+B) (B)=GMI 20850436862eSNikolay Aleksandrov * EXCLUDE (X,Y) ALLOW (A) EXCLUDE (X+A,Y-A) (A)=GMI 20860436862eSNikolay Aleksandrov */ 2087adc47037SNikolay Aleksandrov static bool br_multicast_isinc_allow(const struct net_bridge_mcast *brmctx, 2088adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2089474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2090474ddb37SNikolay Aleksandrov int grec_type) 20910436862eSNikolay Aleksandrov { 20920436862eSNikolay Aleksandrov struct net_bridge_group_src *ent; 20930436862eSNikolay Aleksandrov unsigned long now = jiffies; 20940436862eSNikolay Aleksandrov bool changed = false; 20950436862eSNikolay Aleksandrov struct br_ip src_ip; 20960436862eSNikolay Aleksandrov u32 src_idx; 20970436862eSNikolay Aleksandrov 20980436862eSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2099085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 21000436862eSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2101e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 21020436862eSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 21030436862eSNikolay Aleksandrov if (!ent) { 21040436862eSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 21050436862eSNikolay Aleksandrov if (ent) 21060436862eSNikolay Aleksandrov changed = true; 21070436862eSNikolay Aleksandrov } 21080436862eSNikolay Aleksandrov 21090436862eSNikolay Aleksandrov if (ent) 2110adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 21110436862eSNikolay Aleksandrov } 21120436862eSNikolay Aleksandrov 2113adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2114adc47037SNikolay Aleksandrov grec_type)) 2115474ddb37SNikolay Aleksandrov changed = true; 2116474ddb37SNikolay Aleksandrov 21170436862eSNikolay Aleksandrov return changed; 21180436862eSNikolay Aleksandrov } 21190436862eSNikolay Aleksandrov 2120e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 2121e6231bcaSNikolay Aleksandrov * INCLUDE (A) IS_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 2122e6231bcaSNikolay Aleksandrov * Delete (A-B) 2123e6231bcaSNikolay Aleksandrov * Group Timer=GMI 2124e6231bcaSNikolay Aleksandrov */ 2125adc47037SNikolay Aleksandrov static void __grp_src_isexc_incl(const struct net_bridge_mcast *brmctx, 2126adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2127ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2128ddc255d9SNikolay Aleksandrov int grec_type) 2129e6231bcaSNikolay Aleksandrov { 2130e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 2131e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 2132e6231bcaSNikolay Aleksandrov u32 src_idx; 2133e6231bcaSNikolay Aleksandrov 2134e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2135e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 2136e6231bcaSNikolay Aleksandrov 2137e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2138085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2139e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2140e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2141e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2142e6231bcaSNikolay Aleksandrov if (ent) 2143e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 2144e6231bcaSNikolay Aleksandrov else 2145b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2146b0812368SNikolay Aleksandrov if (ent) 2147b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 2148e6231bcaSNikolay Aleksandrov } 2149e6231bcaSNikolay Aleksandrov 2150adc47037SNikolay Aleksandrov br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2151adc47037SNikolay Aleksandrov grec_type); 2152ddc255d9SNikolay Aleksandrov 2153e6231bcaSNikolay Aleksandrov __grp_src_delete_marked(pg); 2154e6231bcaSNikolay Aleksandrov } 2155e6231bcaSNikolay Aleksandrov 2156e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 2157e6231bcaSNikolay Aleksandrov * EXCLUDE (X,Y) IS_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=GMI 2158e6231bcaSNikolay Aleksandrov * Delete (X-A) 2159e6231bcaSNikolay Aleksandrov * Delete (Y-A) 2160e6231bcaSNikolay Aleksandrov * Group Timer=GMI 2161e6231bcaSNikolay Aleksandrov */ 2162adc47037SNikolay Aleksandrov static bool __grp_src_isexc_excl(const struct net_bridge_mcast *brmctx, 2163adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2164ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2165ddc255d9SNikolay Aleksandrov int grec_type) 2166e6231bcaSNikolay Aleksandrov { 2167e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 2168e6231bcaSNikolay Aleksandrov unsigned long now = jiffies; 2169e6231bcaSNikolay Aleksandrov bool changed = false; 2170e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 2171e6231bcaSNikolay Aleksandrov u32 src_idx; 2172e6231bcaSNikolay Aleksandrov 2173e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2174e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 2175e6231bcaSNikolay Aleksandrov 2176e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2177085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2178e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2179e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2180e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2181e6231bcaSNikolay Aleksandrov if (ent) { 2182e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 2183e6231bcaSNikolay Aleksandrov } else { 2184e6231bcaSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2185e6231bcaSNikolay Aleksandrov if (ent) { 2186b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, 2187adc47037SNikolay Aleksandrov now + br_multicast_gmi(brmctx)); 2188e6231bcaSNikolay Aleksandrov changed = true; 2189e6231bcaSNikolay Aleksandrov } 2190e6231bcaSNikolay Aleksandrov } 2191e6231bcaSNikolay Aleksandrov } 2192e6231bcaSNikolay Aleksandrov 2193adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2194adc47037SNikolay Aleksandrov grec_type)) 2195ddc255d9SNikolay Aleksandrov changed = true; 2196ddc255d9SNikolay Aleksandrov 2197e6231bcaSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 2198e6231bcaSNikolay Aleksandrov changed = true; 2199e6231bcaSNikolay Aleksandrov 2200e6231bcaSNikolay Aleksandrov return changed; 2201e6231bcaSNikolay Aleksandrov } 2202e6231bcaSNikolay Aleksandrov 2203adc47037SNikolay Aleksandrov static bool br_multicast_isexc(const struct net_bridge_mcast *brmctx, 2204adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2205ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2206ddc255d9SNikolay Aleksandrov int grec_type) 2207e6231bcaSNikolay Aleksandrov { 2208e6231bcaSNikolay Aleksandrov bool changed = false; 2209e6231bcaSNikolay Aleksandrov 2210e6231bcaSNikolay Aleksandrov switch (pg->filter_mode) { 2211e6231bcaSNikolay Aleksandrov case MCAST_INCLUDE: 2212adc47037SNikolay Aleksandrov __grp_src_isexc_incl(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2213ddc255d9SNikolay Aleksandrov grec_type); 22148266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 2215e6231bcaSNikolay Aleksandrov changed = true; 2216e6231bcaSNikolay Aleksandrov break; 2217e6231bcaSNikolay Aleksandrov case MCAST_EXCLUDE: 2218adc47037SNikolay Aleksandrov changed = __grp_src_isexc_excl(brmctx, pg, h_addr, srcs, nsrcs, 2219adc47037SNikolay Aleksandrov addr_size, grec_type); 2220e6231bcaSNikolay Aleksandrov break; 2221e6231bcaSNikolay Aleksandrov } 2222e6231bcaSNikolay Aleksandrov 2223e6231bcaSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 2224adc47037SNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(brmctx)); 2225e6231bcaSNikolay Aleksandrov 2226e6231bcaSNikolay Aleksandrov return changed; 2227e6231bcaSNikolay Aleksandrov } 2228e6231bcaSNikolay Aleksandrov 22295bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 22305bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_IN (B) INCLUDE (A+B) (B)=GMI 22315bf1e00bSNikolay Aleksandrov * Send Q(G,A-B) 22325bf1e00bSNikolay Aleksandrov */ 2233adc47037SNikolay Aleksandrov static bool __grp_src_toin_incl(struct net_bridge_mcast *brmctx, 2234adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2235adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2236ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2237ddc255d9SNikolay Aleksandrov int grec_type) 22385bf1e00bSNikolay Aleksandrov { 22395bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 22405bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 22415bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 22425bf1e00bSNikolay Aleksandrov bool changed = false; 22435bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 22445bf1e00bSNikolay Aleksandrov 22455bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 22465bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 22475bf1e00bSNikolay Aleksandrov 22485bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2249085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 22505bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2251e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 22525bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 22535bf1e00bSNikolay Aleksandrov if (ent) { 22545bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 22555bf1e00bSNikolay Aleksandrov to_send--; 22565bf1e00bSNikolay Aleksandrov } else { 22575bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 22585bf1e00bSNikolay Aleksandrov if (ent) 22595bf1e00bSNikolay Aleksandrov changed = true; 22605bf1e00bSNikolay Aleksandrov } 22615bf1e00bSNikolay Aleksandrov if (ent) 2262adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 22635bf1e00bSNikolay Aleksandrov } 22645bf1e00bSNikolay Aleksandrov 2265adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2266adc47037SNikolay Aleksandrov grec_type)) 2267ddc255d9SNikolay Aleksandrov changed = true; 2268ddc255d9SNikolay Aleksandrov 22695bf1e00bSNikolay Aleksandrov if (to_send) 2270adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 22715bf1e00bSNikolay Aleksandrov 22725bf1e00bSNikolay Aleksandrov return changed; 22735bf1e00bSNikolay Aleksandrov } 22745bf1e00bSNikolay Aleksandrov 22755bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 22765bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_IN (A) EXCLUDE (X+A,Y-A) (A)=GMI 22775bf1e00bSNikolay Aleksandrov * Send Q(G,X-A) 22785bf1e00bSNikolay Aleksandrov * Send Q(G) 22795bf1e00bSNikolay Aleksandrov */ 2280adc47037SNikolay Aleksandrov static bool __grp_src_toin_excl(struct net_bridge_mcast *brmctx, 2281adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2282adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2283ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2284ddc255d9SNikolay Aleksandrov int grec_type) 22855bf1e00bSNikolay Aleksandrov { 22865bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 22875bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 22885bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 22895bf1e00bSNikolay Aleksandrov bool changed = false; 22905bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 22915bf1e00bSNikolay Aleksandrov 22925bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 22935bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) 22945bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 22955bf1e00bSNikolay Aleksandrov 22965bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2297085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 22985bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2299e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 23005bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 23015bf1e00bSNikolay Aleksandrov if (ent) { 23025bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) { 23035bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 23045bf1e00bSNikolay Aleksandrov to_send--; 23055bf1e00bSNikolay Aleksandrov } 23065bf1e00bSNikolay Aleksandrov } else { 23075bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 23085bf1e00bSNikolay Aleksandrov if (ent) 23095bf1e00bSNikolay Aleksandrov changed = true; 23105bf1e00bSNikolay Aleksandrov } 23115bf1e00bSNikolay Aleksandrov if (ent) 2312adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 23135bf1e00bSNikolay Aleksandrov } 23145bf1e00bSNikolay Aleksandrov 2315adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2316adc47037SNikolay Aleksandrov grec_type)) 2317ddc255d9SNikolay Aleksandrov changed = true; 2318ddc255d9SNikolay Aleksandrov 23195bf1e00bSNikolay Aleksandrov if (to_send) 2320adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 23215bf1e00bSNikolay Aleksandrov 2322adc47037SNikolay Aleksandrov __grp_send_query_and_rexmit(brmctx, pmctx, pg); 23235bf1e00bSNikolay Aleksandrov 23245bf1e00bSNikolay Aleksandrov return changed; 23255bf1e00bSNikolay Aleksandrov } 23265bf1e00bSNikolay Aleksandrov 2327adc47037SNikolay Aleksandrov static bool br_multicast_toin(struct net_bridge_mcast *brmctx, 2328adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2329adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2330ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2331ddc255d9SNikolay Aleksandrov int grec_type) 23325bf1e00bSNikolay Aleksandrov { 23335bf1e00bSNikolay Aleksandrov bool changed = false; 23345bf1e00bSNikolay Aleksandrov 23355bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 23365bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 2337adc47037SNikolay Aleksandrov changed = __grp_src_toin_incl(brmctx, pmctx, pg, h_addr, srcs, 2338adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 23395bf1e00bSNikolay Aleksandrov break; 23405bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 2341adc47037SNikolay Aleksandrov changed = __grp_src_toin_excl(brmctx, pmctx, pg, h_addr, srcs, 2342adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 23435bf1e00bSNikolay Aleksandrov break; 23445bf1e00bSNikolay Aleksandrov } 23455bf1e00bSNikolay Aleksandrov 2346ddc255d9SNikolay Aleksandrov if (br_multicast_eht_should_del_pg(pg)) { 2347d5a10222SNikolay Aleksandrov pg->flags |= MDB_PG_FLAGS_FAST_LEAVE; 2348ddc255d9SNikolay Aleksandrov br_multicast_find_del_pg(pg->key.port->br, pg); 2349ddc255d9SNikolay Aleksandrov /* a notification has already been sent and we shouldn't 2350ddc255d9SNikolay Aleksandrov * access pg after the delete so we have to return false 2351ddc255d9SNikolay Aleksandrov */ 2352ddc255d9SNikolay Aleksandrov changed = false; 2353ddc255d9SNikolay Aleksandrov } 2354ddc255d9SNikolay Aleksandrov 23555bf1e00bSNikolay Aleksandrov return changed; 23565bf1e00bSNikolay Aleksandrov } 23575bf1e00bSNikolay Aleksandrov 23585bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 23595bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 23605bf1e00bSNikolay Aleksandrov * Delete (A-B) 23615bf1e00bSNikolay Aleksandrov * Send Q(G,A*B) 23625bf1e00bSNikolay Aleksandrov * Group Timer=GMI 23635bf1e00bSNikolay Aleksandrov */ 2364adc47037SNikolay Aleksandrov static void __grp_src_toex_incl(struct net_bridge_mcast *brmctx, 2365adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2366adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2367ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2368ddc255d9SNikolay Aleksandrov int grec_type) 23695bf1e00bSNikolay Aleksandrov { 23705bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 23715bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 23725bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 23735bf1e00bSNikolay Aleksandrov 23745bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 23755bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 23765bf1e00bSNikolay Aleksandrov 23775bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2378085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 23795bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2380e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 23815bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 23825bf1e00bSNikolay Aleksandrov if (ent) { 23835bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_DELETE) | 23845bf1e00bSNikolay Aleksandrov BR_SGRP_F_SEND; 23855bf1e00bSNikolay Aleksandrov to_send++; 23865bf1e00bSNikolay Aleksandrov } else { 2387b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 23885bf1e00bSNikolay Aleksandrov } 2389b0812368SNikolay Aleksandrov if (ent) 2390b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 23915bf1e00bSNikolay Aleksandrov } 23925bf1e00bSNikolay Aleksandrov 2393adc47037SNikolay Aleksandrov br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2394adc47037SNikolay Aleksandrov grec_type); 2395ddc255d9SNikolay Aleksandrov 23965bf1e00bSNikolay Aleksandrov __grp_src_delete_marked(pg); 23975bf1e00bSNikolay Aleksandrov if (to_send) 2398adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 23995bf1e00bSNikolay Aleksandrov } 24005bf1e00bSNikolay Aleksandrov 24015bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 24025bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=Group Timer 24035bf1e00bSNikolay Aleksandrov * Delete (X-A) 24045bf1e00bSNikolay Aleksandrov * Delete (Y-A) 24055bf1e00bSNikolay Aleksandrov * Send Q(G,A-Y) 24065bf1e00bSNikolay Aleksandrov * Group Timer=GMI 24075bf1e00bSNikolay Aleksandrov */ 2408adc47037SNikolay Aleksandrov static bool __grp_src_toex_excl(struct net_bridge_mcast *brmctx, 2409adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2410adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2411ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2412ddc255d9SNikolay Aleksandrov int grec_type) 24135bf1e00bSNikolay Aleksandrov { 24145bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 24155bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 24165bf1e00bSNikolay Aleksandrov bool changed = false; 24175bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 24185bf1e00bSNikolay Aleksandrov 24195bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 24205bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 24215bf1e00bSNikolay Aleksandrov 24225bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2423085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 24245bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2425e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 24265bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 24275bf1e00bSNikolay Aleksandrov if (ent) { 24285bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 24295bf1e00bSNikolay Aleksandrov } else { 24305bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 24315bf1e00bSNikolay Aleksandrov if (ent) { 2432b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 24335bf1e00bSNikolay Aleksandrov changed = true; 24345bf1e00bSNikolay Aleksandrov } 24355bf1e00bSNikolay Aleksandrov } 24365bf1e00bSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 24375bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 24385bf1e00bSNikolay Aleksandrov to_send++; 24395bf1e00bSNikolay Aleksandrov } 24405bf1e00bSNikolay Aleksandrov } 24415bf1e00bSNikolay Aleksandrov 2442adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2443adc47037SNikolay Aleksandrov grec_type)) 2444ddc255d9SNikolay Aleksandrov changed = true; 2445ddc255d9SNikolay Aleksandrov 24465bf1e00bSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 24475bf1e00bSNikolay Aleksandrov changed = true; 24485bf1e00bSNikolay Aleksandrov if (to_send) 2449adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 24505bf1e00bSNikolay Aleksandrov 24515bf1e00bSNikolay Aleksandrov return changed; 24525bf1e00bSNikolay Aleksandrov } 24535bf1e00bSNikolay Aleksandrov 2454adc47037SNikolay Aleksandrov static bool br_multicast_toex(struct net_bridge_mcast *brmctx, 2455adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2456adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2457ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2458ddc255d9SNikolay Aleksandrov int grec_type) 24595bf1e00bSNikolay Aleksandrov { 24605bf1e00bSNikolay Aleksandrov bool changed = false; 24615bf1e00bSNikolay Aleksandrov 24625bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 24635bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 2464adc47037SNikolay Aleksandrov __grp_src_toex_incl(brmctx, pmctx, pg, h_addr, srcs, nsrcs, 2465adc47037SNikolay Aleksandrov addr_size, grec_type); 24668266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 24675bf1e00bSNikolay Aleksandrov changed = true; 24685bf1e00bSNikolay Aleksandrov break; 24695bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 2470adc47037SNikolay Aleksandrov changed = __grp_src_toex_excl(brmctx, pmctx, pg, h_addr, srcs, 2471adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 24725bf1e00bSNikolay Aleksandrov break; 24735bf1e00bSNikolay Aleksandrov } 24745bf1e00bSNikolay Aleksandrov 24755bf1e00bSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 2476adc47037SNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(brmctx)); 24775bf1e00bSNikolay Aleksandrov 24785bf1e00bSNikolay Aleksandrov return changed; 24795bf1e00bSNikolay Aleksandrov } 24805bf1e00bSNikolay Aleksandrov 2481109865feSNikolay Aleksandrov /* State Msg type New state Actions 2482109865feSNikolay Aleksandrov * INCLUDE (A) BLOCK (B) INCLUDE (A) Send Q(G,A*B) 2483109865feSNikolay Aleksandrov */ 2484adc47037SNikolay Aleksandrov static bool __grp_src_block_incl(struct net_bridge_mcast *brmctx, 2485adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2486adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2487474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2488109865feSNikolay Aleksandrov { 2489109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2490109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 24910ad57c99SNikolay Aleksandrov bool changed = false; 2492109865feSNikolay Aleksandrov struct br_ip src_ip; 2493109865feSNikolay Aleksandrov 2494109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2495109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2496109865feSNikolay Aleksandrov 2497109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2498085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2499109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2500e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2501109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2502109865feSNikolay Aleksandrov if (ent) { 2503109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2504109865feSNikolay Aleksandrov to_send++; 2505109865feSNikolay Aleksandrov } 2506109865feSNikolay Aleksandrov } 2507109865feSNikolay Aleksandrov 2508adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2509adc47037SNikolay Aleksandrov grec_type)) 2510474ddb37SNikolay Aleksandrov changed = true; 2511474ddb37SNikolay Aleksandrov 2512109865feSNikolay Aleksandrov if (to_send) 2513adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 2514109865feSNikolay Aleksandrov 25150ad57c99SNikolay Aleksandrov return changed; 2516109865feSNikolay Aleksandrov } 2517109865feSNikolay Aleksandrov 2518109865feSNikolay Aleksandrov /* State Msg type New state Actions 2519109865feSNikolay Aleksandrov * EXCLUDE (X,Y) BLOCK (A) EXCLUDE (X+(A-Y),Y) (A-X-Y)=Group Timer 2520109865feSNikolay Aleksandrov * Send Q(G,A-Y) 2521109865feSNikolay Aleksandrov */ 2522adc47037SNikolay Aleksandrov static bool __grp_src_block_excl(struct net_bridge_mcast *brmctx, 2523adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2524adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2525474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2526109865feSNikolay Aleksandrov { 2527109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2528109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 2529109865feSNikolay Aleksandrov bool changed = false; 2530109865feSNikolay Aleksandrov struct br_ip src_ip; 2531109865feSNikolay Aleksandrov 2532109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2533109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2534109865feSNikolay Aleksandrov 2535109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2536085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2537109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2538e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2539109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2540109865feSNikolay Aleksandrov if (!ent) { 2541109865feSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2542109865feSNikolay Aleksandrov if (ent) { 2543b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 2544109865feSNikolay Aleksandrov changed = true; 2545109865feSNikolay Aleksandrov } 2546109865feSNikolay Aleksandrov } 2547109865feSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 2548109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2549109865feSNikolay Aleksandrov to_send++; 2550109865feSNikolay Aleksandrov } 2551109865feSNikolay Aleksandrov } 2552109865feSNikolay Aleksandrov 2553adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2554adc47037SNikolay Aleksandrov grec_type)) 2555474ddb37SNikolay Aleksandrov changed = true; 2556474ddb37SNikolay Aleksandrov 2557109865feSNikolay Aleksandrov if (to_send) 2558adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 2559109865feSNikolay Aleksandrov 2560109865feSNikolay Aleksandrov return changed; 2561109865feSNikolay Aleksandrov } 2562109865feSNikolay Aleksandrov 2563adc47037SNikolay Aleksandrov static bool br_multicast_block(struct net_bridge_mcast *brmctx, 2564adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2565adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2566474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2567109865feSNikolay Aleksandrov { 2568109865feSNikolay Aleksandrov bool changed = false; 2569109865feSNikolay Aleksandrov 2570109865feSNikolay Aleksandrov switch (pg->filter_mode) { 2571109865feSNikolay Aleksandrov case MCAST_INCLUDE: 2572adc47037SNikolay Aleksandrov changed = __grp_src_block_incl(brmctx, pmctx, pg, h_addr, srcs, 2573adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 2574109865feSNikolay Aleksandrov break; 2575109865feSNikolay Aleksandrov case MCAST_EXCLUDE: 2576adc47037SNikolay Aleksandrov changed = __grp_src_block_excl(brmctx, pmctx, pg, h_addr, srcs, 2577adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 2578109865feSNikolay Aleksandrov break; 2579109865feSNikolay Aleksandrov } 2580109865feSNikolay Aleksandrov 2581e87e4b5cSNikolay Aleksandrov if ((pg->filter_mode == MCAST_INCLUDE && hlist_empty(&pg->src_list)) || 2582e87e4b5cSNikolay Aleksandrov br_multicast_eht_should_del_pg(pg)) { 2583d5a10222SNikolay Aleksandrov if (br_multicast_eht_should_del_pg(pg)) 2584d5a10222SNikolay Aleksandrov pg->flags |= MDB_PG_FLAGS_FAST_LEAVE; 2585e87e4b5cSNikolay Aleksandrov br_multicast_find_del_pg(pg->key.port->br, pg); 2586e87e4b5cSNikolay Aleksandrov /* a notification has already been sent and we shouldn't 2587e87e4b5cSNikolay Aleksandrov * access pg after the delete so we have to return false 2588e87e4b5cSNikolay Aleksandrov */ 2589e87e4b5cSNikolay Aleksandrov changed = false; 2590e87e4b5cSNikolay Aleksandrov } 2591e87e4b5cSNikolay Aleksandrov 2592109865feSNikolay Aleksandrov return changed; 2593109865feSNikolay Aleksandrov } 2594109865feSNikolay Aleksandrov 25950436862eSNikolay Aleksandrov static struct net_bridge_port_group * 25960436862eSNikolay Aleksandrov br_multicast_find_port(struct net_bridge_mdb_entry *mp, 25970436862eSNikolay Aleksandrov struct net_bridge_port *p, 25980436862eSNikolay Aleksandrov const unsigned char *src) 25990436862eSNikolay Aleksandrov { 2600071445c6SNikolay Aleksandrov struct net_bridge *br __maybe_unused = mp->br; 26010436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 26020436862eSNikolay Aleksandrov 26030436862eSNikolay Aleksandrov for (pg = mlock_dereference(mp->ports, br); 26040436862eSNikolay Aleksandrov pg; 26050436862eSNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) 26060436862eSNikolay Aleksandrov if (br_port_group_equal(pg, p, src)) 26070436862eSNikolay Aleksandrov return pg; 26080436862eSNikolay Aleksandrov 26090436862eSNikolay Aleksandrov return NULL; 26100436862eSNikolay Aleksandrov } 26110436862eSNikolay Aleksandrov 2612adc47037SNikolay Aleksandrov static int br_ip4_multicast_igmp3_report(struct net_bridge_mcast *brmctx, 2613adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 261406499098SVlad Yasevich struct sk_buff *skb, 261506499098SVlad Yasevich u16 vid) 2616eb1d1641SHerbert Xu { 2617adc47037SNikolay Aleksandrov bool igmpv2 = brmctx->multicast_igmp_version == 2; 26180436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 26190436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 26206db6f0eaSFelix Fietkau const unsigned char *src; 2621eb1d1641SHerbert Xu struct igmpv3_report *ih; 2622eb1d1641SHerbert Xu struct igmpv3_grec *grec; 26230436862eSNikolay Aleksandrov int i, len, num, type; 262454bea721SNikolay Aleksandrov __be32 group, *h_addr; 26250436862eSNikolay Aleksandrov bool changed = false; 26260436862eSNikolay Aleksandrov int err = 0; 2627e57f6185SNikolay Aleksandrov u16 nsrcs; 2628eb1d1641SHerbert Xu 2629eb1d1641SHerbert Xu ih = igmpv3_report_hdr(skb); 2630eb1d1641SHerbert Xu num = ntohs(ih->ngrec); 2631c2d4fbd2SLinus Lüssing len = skb_transport_offset(skb) + sizeof(*ih); 2632eb1d1641SHerbert Xu 2633eb1d1641SHerbert Xu for (i = 0; i < num; i++) { 2634eb1d1641SHerbert Xu len += sizeof(*grec); 2635ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2636eb1d1641SHerbert Xu return -EINVAL; 2637eb1d1641SHerbert Xu 2638fd218cf9SHerbert Xu grec = (void *)(skb->data + len - sizeof(*grec)); 2639eb1d1641SHerbert Xu group = grec->grec_mca; 2640eb1d1641SHerbert Xu type = grec->grec_type; 2641e57f6185SNikolay Aleksandrov nsrcs = ntohs(grec->grec_nsrcs); 2642eb1d1641SHerbert Xu 2643e57f6185SNikolay Aleksandrov len += nsrcs * 4; 2644ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2645eb1d1641SHerbert Xu return -EINVAL; 2646eb1d1641SHerbert Xu 2647eb1d1641SHerbert Xu switch (type) { 2648eb1d1641SHerbert Xu case IGMPV3_MODE_IS_INCLUDE: 2649eb1d1641SHerbert Xu case IGMPV3_MODE_IS_EXCLUDE: 2650eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_INCLUDE: 2651eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_EXCLUDE: 2652eb1d1641SHerbert Xu case IGMPV3_ALLOW_NEW_SOURCES: 2653eb1d1641SHerbert Xu case IGMPV3_BLOCK_OLD_SOURCES: 2654eb1d1641SHerbert Xu break; 2655eb1d1641SHerbert Xu 2656eb1d1641SHerbert Xu default: 2657eb1d1641SHerbert Xu continue; 2658eb1d1641SHerbert Xu } 2659eb1d1641SHerbert Xu 26606db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 26610436862eSNikolay Aleksandrov if (nsrcs == 0 && 26620436862eSNikolay Aleksandrov (type == IGMPV3_CHANGE_TO_INCLUDE || 26630436862eSNikolay Aleksandrov type == IGMPV3_MODE_IS_INCLUDE)) { 2664adc47037SNikolay Aleksandrov if (!pmctx || igmpv2) { 2665adc47037SNikolay Aleksandrov br_ip4_multicast_leave_group(brmctx, pmctx, 2666adc47037SNikolay Aleksandrov group, vid, src); 26670436862eSNikolay Aleksandrov continue; 26680436862eSNikolay Aleksandrov } 2669bc8c20acSSatish Ashok } else { 2670adc47037SNikolay Aleksandrov err = br_ip4_multicast_add_group(brmctx, pmctx, group, 2671adc47037SNikolay Aleksandrov vid, src, igmpv2); 2672eb1d1641SHerbert Xu if (err) 2673eb1d1641SHerbert Xu break; 2674eb1d1641SHerbert Xu } 26750436862eSNikolay Aleksandrov 2676adc47037SNikolay Aleksandrov if (!pmctx || igmpv2) 26770436862eSNikolay Aleksandrov continue; 26780436862eSNikolay Aleksandrov 2679262985faSIdo Schimmel spin_lock(&brmctx->br->multicast_lock); 26804cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 26814cdd0d10SNikolay Aleksandrov goto unlock_continue; 26824cdd0d10SNikolay Aleksandrov 2683adc47037SNikolay Aleksandrov mdst = br_mdb_ip4_get(brmctx->br, group, vid); 26840436862eSNikolay Aleksandrov if (!mdst) 26850436862eSNikolay Aleksandrov goto unlock_continue; 2686adc47037SNikolay Aleksandrov pg = br_multicast_find_port(mdst, pmctx->port, src); 26870436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 26880436862eSNikolay Aleksandrov goto unlock_continue; 268954bea721SNikolay Aleksandrov /* reload grec and host addr */ 26900436862eSNikolay Aleksandrov grec = (void *)(skb->data + len - sizeof(*grec) - (nsrcs * 4)); 269154bea721SNikolay Aleksandrov h_addr = &ip_hdr(skb)->saddr; 26920436862eSNikolay Aleksandrov switch (type) { 26930436862eSNikolay Aleksandrov case IGMPV3_ALLOW_NEW_SOURCES: 2694adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 2695adc47037SNikolay Aleksandrov grec->grec_src, 2696474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 26970436862eSNikolay Aleksandrov break; 2698e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_INCLUDE: 2699adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 2700adc47037SNikolay Aleksandrov grec->grec_src, 2701474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2702e6231bcaSNikolay Aleksandrov break; 2703e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_EXCLUDE: 2704adc47037SNikolay Aleksandrov changed = br_multicast_isexc(brmctx, pg, h_addr, 2705adc47037SNikolay Aleksandrov grec->grec_src, 2706ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2707e6231bcaSNikolay Aleksandrov break; 27085bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_INCLUDE: 2709adc47037SNikolay Aleksandrov changed = br_multicast_toin(brmctx, pmctx, pg, h_addr, 2710adc47037SNikolay Aleksandrov grec->grec_src, 2711ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 27125bf1e00bSNikolay Aleksandrov break; 27135bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_EXCLUDE: 2714adc47037SNikolay Aleksandrov changed = br_multicast_toex(brmctx, pmctx, pg, h_addr, 2715adc47037SNikolay Aleksandrov grec->grec_src, 2716ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 27175bf1e00bSNikolay Aleksandrov break; 2718109865feSNikolay Aleksandrov case IGMPV3_BLOCK_OLD_SOURCES: 2719adc47037SNikolay Aleksandrov changed = br_multicast_block(brmctx, pmctx, pg, h_addr, 2720adc47037SNikolay Aleksandrov grec->grec_src, 2721474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2722109865feSNikolay Aleksandrov break; 27230436862eSNikolay Aleksandrov } 27240436862eSNikolay Aleksandrov if (changed) 2725adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mdst, pg, RTM_NEWMDB); 27260436862eSNikolay Aleksandrov unlock_continue: 2727262985faSIdo Schimmel spin_unlock(&brmctx->br->multicast_lock); 2728bc8c20acSSatish Ashok } 2729eb1d1641SHerbert Xu 2730eb1d1641SHerbert Xu return err; 2731eb1d1641SHerbert Xu } 2732eb1d1641SHerbert Xu 2733dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 2734adc47037SNikolay Aleksandrov static int br_ip6_multicast_mld2_report(struct net_bridge_mcast *brmctx, 2735adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 273606499098SVlad Yasevich struct sk_buff *skb, 273706499098SVlad Yasevich u16 vid) 273808b202b6SYOSHIFUJI Hideaki { 2739adc47037SNikolay Aleksandrov bool mldv1 = brmctx->multicast_mld_version == 1; 27400436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 27410436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 2742ba5ea614SLinus Lüssing unsigned int nsrcs_offset; 27436baeb395SMichelleJin struct mld2_report *mld2r; 27446db6f0eaSFelix Fietkau const unsigned char *src; 274554bea721SNikolay Aleksandrov struct in6_addr *h_addr; 274608b202b6SYOSHIFUJI Hideaki struct mld2_grec *grec; 2747ba5ea614SLinus Lüssing unsigned int grec_len; 27480436862eSNikolay Aleksandrov bool changed = false; 27490436862eSNikolay Aleksandrov int i, len, num; 275008b202b6SYOSHIFUJI Hideaki int err = 0; 275108b202b6SYOSHIFUJI Hideaki 27526baeb395SMichelleJin if (!ipv6_mc_may_pull(skb, sizeof(*mld2r))) 275308b202b6SYOSHIFUJI Hideaki return -EINVAL; 275408b202b6SYOSHIFUJI Hideaki 27556baeb395SMichelleJin mld2r = (struct mld2_report *)icmp6_hdr(skb); 27566baeb395SMichelleJin num = ntohs(mld2r->mld2r_ngrec); 27576baeb395SMichelleJin len = skb_transport_offset(skb) + sizeof(*mld2r); 275808b202b6SYOSHIFUJI Hideaki 275908b202b6SYOSHIFUJI Hideaki for (i = 0; i < num; i++) { 2760e57f6185SNikolay Aleksandrov __be16 *_nsrcs, __nsrcs; 2761e57f6185SNikolay Aleksandrov u16 nsrcs; 276208b202b6SYOSHIFUJI Hideaki 2763ba5ea614SLinus Lüssing nsrcs_offset = len + offsetof(struct mld2_grec, grec_nsrcs); 2764ba5ea614SLinus Lüssing 2765ba5ea614SLinus Lüssing if (skb_transport_offset(skb) + ipv6_transport_len(skb) < 27665fc6266aSLinus Lüssing nsrcs_offset + sizeof(__nsrcs)) 2767ba5ea614SLinus Lüssing return -EINVAL; 2768ba5ea614SLinus Lüssing 2769e57f6185SNikolay Aleksandrov _nsrcs = skb_header_pointer(skb, nsrcs_offset, 2770e57f6185SNikolay Aleksandrov sizeof(__nsrcs), &__nsrcs); 2771e57f6185SNikolay Aleksandrov if (!_nsrcs) 277208b202b6SYOSHIFUJI Hideaki return -EINVAL; 277308b202b6SYOSHIFUJI Hideaki 2774e57f6185SNikolay Aleksandrov nsrcs = ntohs(*_nsrcs); 2775e57f6185SNikolay Aleksandrov grec_len = struct_size(grec, grec_src, nsrcs); 2776ba5ea614SLinus Lüssing 2777ba5ea614SLinus Lüssing if (!ipv6_mc_may_pull(skb, len + grec_len)) 277808b202b6SYOSHIFUJI Hideaki return -EINVAL; 277908b202b6SYOSHIFUJI Hideaki 278008b202b6SYOSHIFUJI Hideaki grec = (struct mld2_grec *)(skb->data + len); 2781ba5ea614SLinus Lüssing len += grec_len; 278208b202b6SYOSHIFUJI Hideaki 278308b202b6SYOSHIFUJI Hideaki switch (grec->grec_type) { 278408b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_INCLUDE: 278508b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_EXCLUDE: 278608b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_INCLUDE: 278708b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_EXCLUDE: 278808b202b6SYOSHIFUJI Hideaki case MLD2_ALLOW_NEW_SOURCES: 278908b202b6SYOSHIFUJI Hideaki case MLD2_BLOCK_OLD_SOURCES: 279008b202b6SYOSHIFUJI Hideaki break; 279108b202b6SYOSHIFUJI Hideaki 279208b202b6SYOSHIFUJI Hideaki default: 279308b202b6SYOSHIFUJI Hideaki continue; 279408b202b6SYOSHIFUJI Hideaki } 279508b202b6SYOSHIFUJI Hideaki 27966db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 2797bc8c20acSSatish Ashok if ((grec->grec_type == MLD2_CHANGE_TO_INCLUDE || 2798bc8c20acSSatish Ashok grec->grec_type == MLD2_MODE_IS_INCLUDE) && 2799e57f6185SNikolay Aleksandrov nsrcs == 0) { 2800adc47037SNikolay Aleksandrov if (!pmctx || mldv1) { 2801adc47037SNikolay Aleksandrov br_ip6_multicast_leave_group(brmctx, pmctx, 28020436862eSNikolay Aleksandrov &grec->grec_mca, 28036db6f0eaSFelix Fietkau vid, src); 28040436862eSNikolay Aleksandrov continue; 28050436862eSNikolay Aleksandrov } 2806bc8c20acSSatish Ashok } else { 2807adc47037SNikolay Aleksandrov err = br_ip6_multicast_add_group(brmctx, pmctx, 28086db6f0eaSFelix Fietkau &grec->grec_mca, vid, 28090436862eSNikolay Aleksandrov src, mldv1); 28109264251eSDavide Caratti if (err) 281108b202b6SYOSHIFUJI Hideaki break; 281208b202b6SYOSHIFUJI Hideaki } 28130436862eSNikolay Aleksandrov 2814adc47037SNikolay Aleksandrov if (!pmctx || mldv1) 28150436862eSNikolay Aleksandrov continue; 28160436862eSNikolay Aleksandrov 2817262985faSIdo Schimmel spin_lock(&brmctx->br->multicast_lock); 28184cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 28194cdd0d10SNikolay Aleksandrov goto unlock_continue; 28204cdd0d10SNikolay Aleksandrov 2821adc47037SNikolay Aleksandrov mdst = br_mdb_ip6_get(brmctx->br, &grec->grec_mca, vid); 28220436862eSNikolay Aleksandrov if (!mdst) 28230436862eSNikolay Aleksandrov goto unlock_continue; 2824adc47037SNikolay Aleksandrov pg = br_multicast_find_port(mdst, pmctx->port, src); 28250436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 28260436862eSNikolay Aleksandrov goto unlock_continue; 282754bea721SNikolay Aleksandrov h_addr = &ipv6_hdr(skb)->saddr; 28280436862eSNikolay Aleksandrov switch (grec->grec_type) { 28290436862eSNikolay Aleksandrov case MLD2_ALLOW_NEW_SOURCES: 2830adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 283154bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2832474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 2833474ddb37SNikolay Aleksandrov grec->grec_type); 28340436862eSNikolay Aleksandrov break; 2835e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_INCLUDE: 2836adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 283754bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2838474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 2839474ddb37SNikolay Aleksandrov grec->grec_type); 2840e6231bcaSNikolay Aleksandrov break; 2841e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_EXCLUDE: 2842adc47037SNikolay Aleksandrov changed = br_multicast_isexc(brmctx, pg, h_addr, 284354bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2844ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 2845ddc255d9SNikolay Aleksandrov grec->grec_type); 2846e6231bcaSNikolay Aleksandrov break; 28475bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_INCLUDE: 2848adc47037SNikolay Aleksandrov changed = br_multicast_toin(brmctx, pmctx, pg, h_addr, 284954bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2850ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 2851ddc255d9SNikolay Aleksandrov grec->grec_type); 28525bf1e00bSNikolay Aleksandrov break; 28535bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_EXCLUDE: 2854adc47037SNikolay Aleksandrov changed = br_multicast_toex(brmctx, pmctx, pg, h_addr, 285554bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2856ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 2857ddc255d9SNikolay Aleksandrov grec->grec_type); 28585bf1e00bSNikolay Aleksandrov break; 2859109865feSNikolay Aleksandrov case MLD2_BLOCK_OLD_SOURCES: 2860adc47037SNikolay Aleksandrov changed = br_multicast_block(brmctx, pmctx, pg, h_addr, 286154bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2862474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 2863474ddb37SNikolay Aleksandrov grec->grec_type); 2864109865feSNikolay Aleksandrov break; 28650436862eSNikolay Aleksandrov } 28660436862eSNikolay Aleksandrov if (changed) 2867adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mdst, pg, RTM_NEWMDB); 28680436862eSNikolay Aleksandrov unlock_continue: 2869262985faSIdo Schimmel spin_unlock(&brmctx->br->multicast_lock); 2870bc8c20acSSatish Ashok } 287108b202b6SYOSHIFUJI Hideaki 287208b202b6SYOSHIFUJI Hideaki return err; 287308b202b6SYOSHIFUJI Hideaki } 287408b202b6SYOSHIFUJI Hideaki #endif 287508b202b6SYOSHIFUJI Hideaki 2876c3fb3698SNikolay Aleksandrov static bool br_multicast_select_querier(struct net_bridge_mcast *brmctx, 287754cb4319SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 287867b746f9SNikolay Aleksandrov struct br_ip *saddr) 2879dc4eb53aSLinus Lüssing { 288067b746f9SNikolay Aleksandrov int port_ifidx = pmctx ? pmctx->port->dev->ifindex : 0; 2881c3fb3698SNikolay Aleksandrov struct timer_list *own_timer, *other_timer; 2882c3fb3698SNikolay Aleksandrov struct bridge_mcast_querier *querier; 288354cb4319SNikolay Aleksandrov 2884c3fb3698SNikolay Aleksandrov switch (saddr->proto) { 2885c3fb3698SNikolay Aleksandrov case htons(ETH_P_IP): 2886c3fb3698SNikolay Aleksandrov querier = &brmctx->ip4_querier; 2887c3fb3698SNikolay Aleksandrov own_timer = &brmctx->ip4_own_query.timer; 2888c3fb3698SNikolay Aleksandrov other_timer = &brmctx->ip4_other_query.timer; 2889c3fb3698SNikolay Aleksandrov if (!querier->addr.src.ip4 || 2890c3fb3698SNikolay Aleksandrov ntohl(saddr->src.ip4) <= ntohl(querier->addr.src.ip4)) 2891dc4eb53aSLinus Lüssing goto update; 2892c3fb3698SNikolay Aleksandrov break; 2893dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 2894c3fb3698SNikolay Aleksandrov case htons(ETH_P_IPV6): 2895c3fb3698SNikolay Aleksandrov querier = &brmctx->ip6_querier; 2896c3fb3698SNikolay Aleksandrov own_timer = &brmctx->ip6_own_query.timer; 2897c3fb3698SNikolay Aleksandrov other_timer = &brmctx->ip6_other_query.timer; 2898c3fb3698SNikolay Aleksandrov if (ipv6_addr_cmp(&saddr->src.ip6, &querier->addr.src.ip6) <= 0) 2899dc4eb53aSLinus Lüssing goto update; 2900c3fb3698SNikolay Aleksandrov break; 2901c3fb3698SNikolay Aleksandrov #endif 2902c3fb3698SNikolay Aleksandrov default: 2903c3fb3698SNikolay Aleksandrov return false; 2904c3fb3698SNikolay Aleksandrov } 2905dc4eb53aSLinus Lüssing 2906c3fb3698SNikolay Aleksandrov if (!timer_pending(own_timer) && !timer_pending(other_timer)) 2907dc4eb53aSLinus Lüssing goto update; 2908dc4eb53aSLinus Lüssing 2909dc4eb53aSLinus Lüssing return false; 2910dc4eb53aSLinus Lüssing 2911dc4eb53aSLinus Lüssing update: 2912c3fb3698SNikolay Aleksandrov br_multicast_update_querier(brmctx, querier, port_ifidx, saddr); 29132cd41431SLinus Lüssing 2914dc4eb53aSLinus Lüssing return true; 2915dc4eb53aSLinus Lüssing } 2916dc4eb53aSLinus Lüssing 2917c7fa1d9bSNikolay Aleksandrov static struct net_bridge_port * 2918c7fa1d9bSNikolay Aleksandrov __br_multicast_get_querier_port(struct net_bridge *br, 2919c7fa1d9bSNikolay Aleksandrov const struct bridge_mcast_querier *querier) 2920c7fa1d9bSNikolay Aleksandrov { 2921c7fa1d9bSNikolay Aleksandrov int port_ifidx = READ_ONCE(querier->port_ifidx); 2922c7fa1d9bSNikolay Aleksandrov struct net_bridge_port *p; 2923c7fa1d9bSNikolay Aleksandrov struct net_device *dev; 2924c7fa1d9bSNikolay Aleksandrov 2925c7fa1d9bSNikolay Aleksandrov if (port_ifidx == 0) 2926c7fa1d9bSNikolay Aleksandrov return NULL; 2927c7fa1d9bSNikolay Aleksandrov 2928c7fa1d9bSNikolay Aleksandrov dev = dev_get_by_index_rcu(dev_net(br->dev), port_ifidx); 2929c7fa1d9bSNikolay Aleksandrov if (!dev) 2930c7fa1d9bSNikolay Aleksandrov return NULL; 2931c7fa1d9bSNikolay Aleksandrov p = br_port_get_rtnl_rcu(dev); 2932c7fa1d9bSNikolay Aleksandrov if (!p || p->br != br) 2933c7fa1d9bSNikolay Aleksandrov return NULL; 2934c7fa1d9bSNikolay Aleksandrov 2935c7fa1d9bSNikolay Aleksandrov return p; 2936c7fa1d9bSNikolay Aleksandrov } 2937c7fa1d9bSNikolay Aleksandrov 2938c7fa1d9bSNikolay Aleksandrov size_t br_multicast_querier_state_size(void) 2939c7fa1d9bSNikolay Aleksandrov { 2940cdda378bSNikolay Aleksandrov return nla_total_size(0) + /* nest attribute */ 2941c7fa1d9bSNikolay Aleksandrov nla_total_size(sizeof(__be32)) + /* BRIDGE_QUERIER_IP_ADDRESS */ 2942c7fa1d9bSNikolay Aleksandrov nla_total_size(sizeof(int)) + /* BRIDGE_QUERIER_IP_PORT */ 2943175e6692SNikolay Aleksandrov nla_total_size_64bit(sizeof(u64)) + /* BRIDGE_QUERIER_IP_OTHER_TIMER */ 2944175e6692SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 2945175e6692SNikolay Aleksandrov nla_total_size(sizeof(struct in6_addr)) + /* BRIDGE_QUERIER_IPV6_ADDRESS */ 2946175e6692SNikolay Aleksandrov nla_total_size(sizeof(int)) + /* BRIDGE_QUERIER_IPV6_PORT */ 2947175e6692SNikolay Aleksandrov nla_total_size_64bit(sizeof(u64)) + /* BRIDGE_QUERIER_IPV6_OTHER_TIMER */ 2948175e6692SNikolay Aleksandrov #endif 2949175e6692SNikolay Aleksandrov 0; 2950c7fa1d9bSNikolay Aleksandrov } 2951c7fa1d9bSNikolay Aleksandrov 2952c7fa1d9bSNikolay Aleksandrov /* protected by rtnl or rcu */ 2953c7fa1d9bSNikolay Aleksandrov int br_multicast_dump_querier_state(struct sk_buff *skb, 2954c7fa1d9bSNikolay Aleksandrov const struct net_bridge_mcast *brmctx, 2955c7fa1d9bSNikolay Aleksandrov int nest_attr) 2956c7fa1d9bSNikolay Aleksandrov { 2957c7fa1d9bSNikolay Aleksandrov struct bridge_mcast_querier querier = {}; 2958c7fa1d9bSNikolay Aleksandrov struct net_bridge_port *p; 2959c7fa1d9bSNikolay Aleksandrov struct nlattr *nest; 2960c7fa1d9bSNikolay Aleksandrov 2961f137b7d4SNikolay Aleksandrov if (!br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED) || 2962f137b7d4SNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(brmctx)) 2963f137b7d4SNikolay Aleksandrov return 0; 2964f137b7d4SNikolay Aleksandrov 2965c7fa1d9bSNikolay Aleksandrov nest = nla_nest_start(skb, nest_attr); 2966c7fa1d9bSNikolay Aleksandrov if (!nest) 2967c7fa1d9bSNikolay Aleksandrov return -EMSGSIZE; 2968c7fa1d9bSNikolay Aleksandrov 2969c7fa1d9bSNikolay Aleksandrov rcu_read_lock(); 297085b41082SNikolay Aleksandrov if (!brmctx->multicast_querier && 297185b41082SNikolay Aleksandrov !timer_pending(&brmctx->ip4_other_query.timer)) 297285b41082SNikolay Aleksandrov goto out_v6; 297385b41082SNikolay Aleksandrov 2974c7fa1d9bSNikolay Aleksandrov br_multicast_read_querier(&brmctx->ip4_querier, &querier); 2975c7fa1d9bSNikolay Aleksandrov if (nla_put_in_addr(skb, BRIDGE_QUERIER_IP_ADDRESS, 2976c7fa1d9bSNikolay Aleksandrov querier.addr.src.ip4)) { 2977c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 2978c7fa1d9bSNikolay Aleksandrov goto out_err; 2979c7fa1d9bSNikolay Aleksandrov } 2980c7fa1d9bSNikolay Aleksandrov 2981c7fa1d9bSNikolay Aleksandrov p = __br_multicast_get_querier_port(brmctx->br, &querier); 2982c7fa1d9bSNikolay Aleksandrov if (timer_pending(&brmctx->ip4_other_query.timer) && 2983c7fa1d9bSNikolay Aleksandrov (nla_put_u64_64bit(skb, BRIDGE_QUERIER_IP_OTHER_TIMER, 2984c7fa1d9bSNikolay Aleksandrov br_timer_value(&brmctx->ip4_other_query.timer), 2985c7fa1d9bSNikolay Aleksandrov BRIDGE_QUERIER_PAD) || 2986c7fa1d9bSNikolay Aleksandrov (p && nla_put_u32(skb, BRIDGE_QUERIER_IP_PORT, p->dev->ifindex)))) { 2987c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 2988c7fa1d9bSNikolay Aleksandrov goto out_err; 2989c7fa1d9bSNikolay Aleksandrov } 299085b41082SNikolay Aleksandrov 299185b41082SNikolay Aleksandrov out_v6: 299285b41082SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 299385b41082SNikolay Aleksandrov if (!brmctx->multicast_querier && 299485b41082SNikolay Aleksandrov !timer_pending(&brmctx->ip6_other_query.timer)) 299585b41082SNikolay Aleksandrov goto out; 299685b41082SNikolay Aleksandrov 299785b41082SNikolay Aleksandrov br_multicast_read_querier(&brmctx->ip6_querier, &querier); 299885b41082SNikolay Aleksandrov if (nla_put_in6_addr(skb, BRIDGE_QUERIER_IPV6_ADDRESS, 299985b41082SNikolay Aleksandrov &querier.addr.src.ip6)) { 300085b41082SNikolay Aleksandrov rcu_read_unlock(); 300185b41082SNikolay Aleksandrov goto out_err; 300285b41082SNikolay Aleksandrov } 300385b41082SNikolay Aleksandrov 300485b41082SNikolay Aleksandrov p = __br_multicast_get_querier_port(brmctx->br, &querier); 300585b41082SNikolay Aleksandrov if (timer_pending(&brmctx->ip6_other_query.timer) && 300685b41082SNikolay Aleksandrov (nla_put_u64_64bit(skb, BRIDGE_QUERIER_IPV6_OTHER_TIMER, 300785b41082SNikolay Aleksandrov br_timer_value(&brmctx->ip6_other_query.timer), 300885b41082SNikolay Aleksandrov BRIDGE_QUERIER_PAD) || 300985b41082SNikolay Aleksandrov (p && nla_put_u32(skb, BRIDGE_QUERIER_IPV6_PORT, 301085b41082SNikolay Aleksandrov p->dev->ifindex)))) { 301185b41082SNikolay Aleksandrov rcu_read_unlock(); 301285b41082SNikolay Aleksandrov goto out_err; 301385b41082SNikolay Aleksandrov } 301485b41082SNikolay Aleksandrov out: 301585b41082SNikolay Aleksandrov #endif 3016c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 3017c7fa1d9bSNikolay Aleksandrov nla_nest_end(skb, nest); 301885b41082SNikolay Aleksandrov if (!nla_len(nest)) 301985b41082SNikolay Aleksandrov nla_nest_cancel(skb, nest); 3020c7fa1d9bSNikolay Aleksandrov 3021c7fa1d9bSNikolay Aleksandrov return 0; 3022c7fa1d9bSNikolay Aleksandrov 3023c7fa1d9bSNikolay Aleksandrov out_err: 3024c7fa1d9bSNikolay Aleksandrov nla_nest_cancel(skb, nest); 3025c7fa1d9bSNikolay Aleksandrov return -EMSGSIZE; 3026c7fa1d9bSNikolay Aleksandrov } 3027c7fa1d9bSNikolay Aleksandrov 3028cc0fdd80SLinus Lüssing static void 3029adc47037SNikolay Aleksandrov br_multicast_update_query_timer(struct net_bridge_mcast *brmctx, 303090010b36SLinus Lüssing struct bridge_mcast_other_query *query, 3031b00589afSLinus Lüssing unsigned long max_delay) 3032b00589afSLinus Lüssing { 303390010b36SLinus Lüssing if (!timer_pending(&query->timer)) 303490010b36SLinus Lüssing query->delay_time = jiffies + max_delay; 3035b00589afSLinus Lüssing 3036adc47037SNikolay Aleksandrov mod_timer(&query->timer, jiffies + brmctx->multicast_querier_interval); 3037b00589afSLinus Lüssing } 3038b00589afSLinus Lüssing 30396d549648SNogah Frankel static void br_port_mc_router_state_change(struct net_bridge_port *p, 30406d549648SNogah Frankel bool is_mc_router) 30416d549648SNogah Frankel { 30426d549648SNogah Frankel struct switchdev_attr attr = { 30436d549648SNogah Frankel .orig_dev = p->dev, 30446d549648SNogah Frankel .id = SWITCHDEV_ATTR_ID_PORT_MROUTER, 30456d549648SNogah Frankel .flags = SWITCHDEV_F_DEFER, 30466d549648SNogah Frankel .u.mrouter = is_mc_router, 30476d549648SNogah Frankel }; 30486d549648SNogah Frankel 3049dcbdf135SVladimir Oltean switchdev_port_attr_set(p->dev, &attr, NULL); 30506d549648SNogah Frankel } 30516d549648SNogah Frankel 3052d9b8c4d8SLinus Lüssing static struct net_bridge_port * 3053d3d065c0SNikolay Aleksandrov br_multicast_rport_from_node(struct net_bridge_mcast *brmctx, 3054d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list, 3055d9b8c4d8SLinus Lüssing struct hlist_node *rlist) 3056d9b8c4d8SLinus Lüssing { 30579632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 30589632233eSNikolay Aleksandrov 3059a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3060d3d065c0SNikolay Aleksandrov if (mc_router_list == &brmctx->ip6_mc_router_list) 30619632233eSNikolay Aleksandrov pmctx = hlist_entry(rlist, struct net_bridge_mcast_port, 30629632233eSNikolay Aleksandrov ip6_rlist); 30639632233eSNikolay Aleksandrov else 3064a3c02e76SLinus Lüssing #endif 30659632233eSNikolay Aleksandrov pmctx = hlist_entry(rlist, struct net_bridge_mcast_port, 30669632233eSNikolay Aleksandrov ip4_rlist); 30679632233eSNikolay Aleksandrov 30689632233eSNikolay Aleksandrov return pmctx->port; 3069d9b8c4d8SLinus Lüssing } 3070d9b8c4d8SLinus Lüssing 3071d9b8c4d8SLinus Lüssing static struct hlist_node * 3072d3d065c0SNikolay Aleksandrov br_multicast_get_rport_slot(struct net_bridge_mcast *brmctx, 3073d9b8c4d8SLinus Lüssing struct net_bridge_port *port, 3074d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 3075d9b8c4d8SLinus Lüssing 3076d9b8c4d8SLinus Lüssing { 3077d9b8c4d8SLinus Lüssing struct hlist_node *slot = NULL; 3078d9b8c4d8SLinus Lüssing struct net_bridge_port *p; 3079d9b8c4d8SLinus Lüssing struct hlist_node *rlist; 3080d9b8c4d8SLinus Lüssing 3081d9b8c4d8SLinus Lüssing hlist_for_each(rlist, mc_router_list) { 3082d3d065c0SNikolay Aleksandrov p = br_multicast_rport_from_node(brmctx, mc_router_list, rlist); 3083d9b8c4d8SLinus Lüssing 3084d9b8c4d8SLinus Lüssing if ((unsigned long)port >= (unsigned long)p) 3085d9b8c4d8SLinus Lüssing break; 3086d9b8c4d8SLinus Lüssing 3087d9b8c4d8SLinus Lüssing slot = rlist; 3088d9b8c4d8SLinus Lüssing } 3089d9b8c4d8SLinus Lüssing 3090d9b8c4d8SLinus Lüssing return slot; 3091d9b8c4d8SLinus Lüssing } 3092d9b8c4d8SLinus Lüssing 3093adc47037SNikolay Aleksandrov static bool br_multicast_no_router_otherpf(struct net_bridge_mcast_port *pmctx, 3094a3c02e76SLinus Lüssing struct hlist_node *rnode) 3095a3c02e76SLinus Lüssing { 3096a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3097adc47037SNikolay Aleksandrov if (rnode != &pmctx->ip6_rlist) 3098adc47037SNikolay Aleksandrov return hlist_unhashed(&pmctx->ip6_rlist); 3099a3c02e76SLinus Lüssing else 3100adc47037SNikolay Aleksandrov return hlist_unhashed(&pmctx->ip4_rlist); 3101a3c02e76SLinus Lüssing #else 3102a3c02e76SLinus Lüssing return true; 3103a3c02e76SLinus Lüssing #endif 3104a3c02e76SLinus Lüssing } 3105a3c02e76SLinus Lüssing 3106d9b8c4d8SLinus Lüssing /* Add port to router_list 31077e80c124Sstephen hemminger * list is maintained ordered by pointer value 31087e80c124Sstephen hemminger * and locked by br->multicast_lock and RCU 31097e80c124Sstephen hemminger */ 3110d3d065c0SNikolay Aleksandrov static void br_multicast_add_router(struct net_bridge_mcast *brmctx, 3111adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3112d9b8c4d8SLinus Lüssing struct hlist_node *rlist, 3113d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 31140909e117SHerbert Xu { 3115d9b8c4d8SLinus Lüssing struct hlist_node *slot; 31160909e117SHerbert Xu 3117d9b8c4d8SLinus Lüssing if (!hlist_unhashed(rlist)) 31181a040eacSNikolay Aleksandrov return; 31191a040eacSNikolay Aleksandrov 3120adc47037SNikolay Aleksandrov slot = br_multicast_get_rport_slot(brmctx, pmctx->port, mc_router_list); 31210909e117SHerbert Xu 31227e80c124Sstephen hemminger if (slot) 3123d9b8c4d8SLinus Lüssing hlist_add_behind_rcu(rlist, slot); 3124dcdca2c4Sstephen hemminger else 3125d9b8c4d8SLinus Lüssing hlist_add_head_rcu(rlist, mc_router_list); 3126d9b8c4d8SLinus Lüssing 3127a3c02e76SLinus Lüssing /* For backwards compatibility for now, only notify if we 3128a3c02e76SLinus Lüssing * switched from no IPv4/IPv6 multicast router to a new 3129a3c02e76SLinus Lüssing * IPv4 or IPv6 multicast router. 3130a3c02e76SLinus Lüssing */ 3131adc47037SNikolay Aleksandrov if (br_multicast_no_router_otherpf(pmctx, rlist)) { 31321e9ca456SNikolay Aleksandrov br_rtr_notify(pmctx->port->br->dev, pmctx, RTM_NEWMDB); 3133adc47037SNikolay Aleksandrov br_port_mc_router_state_change(pmctx->port, true); 31340909e117SHerbert Xu } 3135a3c02e76SLinus Lüssing } 31360909e117SHerbert Xu 3137d9b8c4d8SLinus Lüssing /* Add port to router_list 3138d9b8c4d8SLinus Lüssing * list is maintained ordered by pointer value 3139d9b8c4d8SLinus Lüssing * and locked by br->multicast_lock and RCU 3140d9b8c4d8SLinus Lüssing */ 3141adc47037SNikolay Aleksandrov static void br_ip4_multicast_add_router(struct net_bridge_mcast *brmctx, 3142adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3143eb1d1641SHerbert Xu { 3144adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, &pmctx->ip4_rlist, 3145adc47037SNikolay Aleksandrov &brmctx->ip4_mc_router_list); 3146d9b8c4d8SLinus Lüssing } 3147d9b8c4d8SLinus Lüssing 3148a3c02e76SLinus Lüssing /* Add port to router_list 3149a3c02e76SLinus Lüssing * list is maintained ordered by pointer value 3150a3c02e76SLinus Lüssing * and locked by br->multicast_lock and RCU 3151a3c02e76SLinus Lüssing */ 3152adc47037SNikolay Aleksandrov static void br_ip6_multicast_add_router(struct net_bridge_mcast *brmctx, 3153adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3154a3c02e76SLinus Lüssing { 3155a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3156adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, &pmctx->ip6_rlist, 3157adc47037SNikolay Aleksandrov &brmctx->ip6_mc_router_list); 3158a3c02e76SLinus Lüssing #endif 3159a3c02e76SLinus Lüssing } 3160a3c02e76SLinus Lüssing 3161adc47037SNikolay Aleksandrov static void br_multicast_mark_router(struct net_bridge_mcast *brmctx, 3162adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3163d9b8c4d8SLinus Lüssing struct timer_list *timer, 3164d9b8c4d8SLinus Lüssing struct hlist_node *rlist, 3165d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 3166d9b8c4d8SLinus Lüssing { 3167eb1d1641SHerbert Xu unsigned long now = jiffies; 3168eb1d1641SHerbert Xu 31694cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 31704cdd0d10SNikolay Aleksandrov return; 31714cdd0d10SNikolay Aleksandrov 3172adc47037SNikolay Aleksandrov if (!pmctx) { 3173d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router == MDB_RTR_TYPE_TEMP_QUERY) { 3174d3d065c0SNikolay Aleksandrov if (!br_ip4_multicast_is_router(brmctx) && 3175d3d065c0SNikolay Aleksandrov !br_ip6_multicast_is_router(brmctx)) 3176adc47037SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, true); 3177d3d065c0SNikolay Aleksandrov mod_timer(timer, now + brmctx->multicast_querier_interval); 317877041420SYotam Gigi } 3179eb1d1641SHerbert Xu return; 3180eb1d1641SHerbert Xu } 3181eb1d1641SHerbert Xu 3182adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 3183adc47037SNikolay Aleksandrov pmctx->multicast_router == MDB_RTR_TYPE_PERM) 3184eb1d1641SHerbert Xu return; 3185eb1d1641SHerbert Xu 3186adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, rlist, mc_router_list); 3187d3d065c0SNikolay Aleksandrov mod_timer(timer, now + brmctx->multicast_querier_interval); 3188d9b8c4d8SLinus Lüssing } 3189eb1d1641SHerbert Xu 3190adc47037SNikolay Aleksandrov static void br_ip4_multicast_mark_router(struct net_bridge_mcast *brmctx, 3191adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3192d9b8c4d8SLinus Lüssing { 3193adc47037SNikolay Aleksandrov struct timer_list *timer = &brmctx->ip4_mc_router_timer; 3194d9b8c4d8SLinus Lüssing struct hlist_node *rlist = NULL; 3195d9b8c4d8SLinus Lüssing 3196adc47037SNikolay Aleksandrov if (pmctx) { 3197adc47037SNikolay Aleksandrov timer = &pmctx->ip4_mc_router_timer; 3198adc47037SNikolay Aleksandrov rlist = &pmctx->ip4_rlist; 3199d9b8c4d8SLinus Lüssing } 3200d9b8c4d8SLinus Lüssing 3201adc47037SNikolay Aleksandrov br_multicast_mark_router(brmctx, pmctx, timer, rlist, 3202adc47037SNikolay Aleksandrov &brmctx->ip4_mc_router_list); 3203eb1d1641SHerbert Xu } 3204eb1d1641SHerbert Xu 3205adc47037SNikolay Aleksandrov static void br_ip6_multicast_mark_router(struct net_bridge_mcast *brmctx, 3206adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3207a3c02e76SLinus Lüssing { 3208a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3209adc47037SNikolay Aleksandrov struct timer_list *timer = &brmctx->ip6_mc_router_timer; 3210a3c02e76SLinus Lüssing struct hlist_node *rlist = NULL; 3211a3c02e76SLinus Lüssing 3212adc47037SNikolay Aleksandrov if (pmctx) { 3213adc47037SNikolay Aleksandrov timer = &pmctx->ip6_mc_router_timer; 3214adc47037SNikolay Aleksandrov rlist = &pmctx->ip6_rlist; 3215a3c02e76SLinus Lüssing } 3216a3c02e76SLinus Lüssing 3217adc47037SNikolay Aleksandrov br_multicast_mark_router(brmctx, pmctx, timer, rlist, 3218adc47037SNikolay Aleksandrov &brmctx->ip6_mc_router_list); 3219a3c02e76SLinus Lüssing #endif 3220a3c02e76SLinus Lüssing } 3221a3c02e76SLinus Lüssing 3222b19232efSLinus Lüssing static void 3223adc47037SNikolay Aleksandrov br_ip4_multicast_query_received(struct net_bridge_mcast *brmctx, 3224adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 322590010b36SLinus Lüssing struct bridge_mcast_other_query *query, 3226dc4eb53aSLinus Lüssing struct br_ip *saddr, 3227b00589afSLinus Lüssing unsigned long max_delay) 3228eb1d1641SHerbert Xu { 3229c3fb3698SNikolay Aleksandrov if (!br_multicast_select_querier(brmctx, pmctx, saddr)) 3230eb1d1641SHerbert Xu return; 3231eb1d1641SHerbert Xu 3232adc47037SNikolay Aleksandrov br_multicast_update_query_timer(brmctx, query, max_delay); 3233adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3234eb1d1641SHerbert Xu } 3235eb1d1641SHerbert Xu 3236b19232efSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3237b19232efSLinus Lüssing static void 3238adc47037SNikolay Aleksandrov br_ip6_multicast_query_received(struct net_bridge_mcast *brmctx, 3239adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3240b19232efSLinus Lüssing struct bridge_mcast_other_query *query, 3241b19232efSLinus Lüssing struct br_ip *saddr, 3242b19232efSLinus Lüssing unsigned long max_delay) 3243b19232efSLinus Lüssing { 3244c3fb3698SNikolay Aleksandrov if (!br_multicast_select_querier(brmctx, pmctx, saddr)) 3245b19232efSLinus Lüssing return; 3246b19232efSLinus Lüssing 3247adc47037SNikolay Aleksandrov br_multicast_update_query_timer(brmctx, query, max_delay); 3248adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 3249b19232efSLinus Lüssing } 3250b19232efSLinus Lüssing #endif 3251b19232efSLinus Lüssing 3252adc47037SNikolay Aleksandrov static void br_ip4_multicast_query(struct net_bridge_mcast *brmctx, 3253adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 325406499098SVlad Yasevich struct sk_buff *skb, 325506499098SVlad Yasevich u16 vid) 3256eb1d1641SHerbert Xu { 3257ba5ea614SLinus Lüssing unsigned int transport_len = ip_transport_len(skb); 3258b71d1d42SEric Dumazet const struct iphdr *iph = ip_hdr(skb); 3259eb1d1641SHerbert Xu struct igmphdr *ih = igmp_hdr(skb); 3260eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 3261eb1d1641SHerbert Xu struct igmpv3_query *ih3; 3262eb1d1641SHerbert Xu struct net_bridge_port_group *p; 3263e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 326467b746f9SNikolay Aleksandrov struct br_ip saddr = {}; 3265eb1d1641SHerbert Xu unsigned long max_delay; 3266eb1d1641SHerbert Xu unsigned long now = jiffies; 3267eb1d1641SHerbert Xu __be32 group; 3268eb1d1641SHerbert Xu 3269adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 32704cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 3271eb1d1641SHerbert Xu goto out; 3272eb1d1641SHerbert Xu 3273eb1d1641SHerbert Xu group = ih->group; 3274eb1d1641SHerbert Xu 3275ba5ea614SLinus Lüssing if (transport_len == sizeof(*ih)) { 3276eb1d1641SHerbert Xu max_delay = ih->code * (HZ / IGMP_TIMER_SCALE); 3277eb1d1641SHerbert Xu 3278eb1d1641SHerbert Xu if (!max_delay) { 3279eb1d1641SHerbert Xu max_delay = 10 * HZ; 3280eb1d1641SHerbert Xu group = 0; 3281eb1d1641SHerbert Xu } 3282ba5ea614SLinus Lüssing } else if (transport_len >= sizeof(*ih3)) { 3283eb1d1641SHerbert Xu ih3 = igmpv3_query_hdr(skb); 328423550b83SNikolay Aleksandrov if (ih3->nsrcs || 3285d3d065c0SNikolay Aleksandrov (brmctx->multicast_igmp_version == 3 && group && 3286d3d065c0SNikolay Aleksandrov ih3->suppress)) 3287bec68ff1SYOSHIFUJI Hideaki goto out; 3288eb1d1641SHerbert Xu 32890ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 max_delay = ih3->code ? 32900ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 IGMPV3_MRC(ih3->code) * (HZ / IGMP_TIMER_SCALE) : 1; 32919afd85c9SLinus Lüssing } else { 32929ed973ccSLinus Lüssing goto out; 32939ed973ccSLinus Lüssing } 32949ed973ccSLinus Lüssing 3295dc4eb53aSLinus Lüssing if (!group) { 3296dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IP); 3297deb96566SNikolay Aleksandrov saddr.src.ip4 = iph->saddr; 3298b00589afSLinus Lüssing 3299adc47037SNikolay Aleksandrov br_ip4_multicast_query_received(brmctx, pmctx, 3300d3d065c0SNikolay Aleksandrov &brmctx->ip4_other_query, 3301dc4eb53aSLinus Lüssing &saddr, max_delay); 3302eb1d1641SHerbert Xu goto out; 3303dc4eb53aSLinus Lüssing } 3304eb1d1641SHerbert Xu 3305adc47037SNikolay Aleksandrov mp = br_mdb_ip4_get(brmctx->br, group, vid); 3306eb1d1641SHerbert Xu if (!mp) 3307eb1d1641SHerbert Xu goto out; 3308eb1d1641SHerbert Xu 3309d3d065c0SNikolay Aleksandrov max_delay *= brmctx->multicast_last_member_count; 3310eb1d1641SHerbert Xu 3311ff0fd34eSAndrew Lunn if (mp->host_joined && 3312eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 3313eb1d1641SHerbert Xu time_after(mp->timer.expires, now + max_delay) : 3314eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) 3315eb1d1641SHerbert Xu mod_timer(&mp->timer, now + max_delay); 3316eb1d1641SHerbert Xu 3317e8051688SEric Dumazet for (pp = &mp->ports; 3318adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3319e8051688SEric Dumazet pp = &p->next) { 3320eb1d1641SHerbert Xu if (timer_pending(&p->timer) ? 3321eb1d1641SHerbert Xu time_after(p->timer.expires, now + max_delay) : 332223550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 3323d3d065c0SNikolay Aleksandrov (brmctx->multicast_igmp_version == 2 || 332423550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 332524f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 3326eb1d1641SHerbert Xu } 3327eb1d1641SHerbert Xu 3328eb1d1641SHerbert Xu out: 3329adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3330eb1d1641SHerbert Xu } 3331eb1d1641SHerbert Xu 3332dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3333adc47037SNikolay Aleksandrov static int br_ip6_multicast_query(struct net_bridge_mcast *brmctx, 3334adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 333506499098SVlad Yasevich struct sk_buff *skb, 333606499098SVlad Yasevich u16 vid) 333708b202b6SYOSHIFUJI Hideaki { 3338ba5ea614SLinus Lüssing unsigned int transport_len = ipv6_transport_len(skb); 3339eca2a43bSstephen hemminger struct mld_msg *mld; 334008b202b6SYOSHIFUJI Hideaki struct net_bridge_mdb_entry *mp; 334108b202b6SYOSHIFUJI Hideaki struct mld2_query *mld2q; 3342e8051688SEric Dumazet struct net_bridge_port_group *p; 3343e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 334467b746f9SNikolay Aleksandrov struct br_ip saddr = {}; 334508b202b6SYOSHIFUJI Hideaki unsigned long max_delay; 334608b202b6SYOSHIFUJI Hideaki unsigned long now = jiffies; 3347856ce5d0SLinus Lüssing unsigned int offset = skb_transport_offset(skb); 3348b71d1d42SEric Dumazet const struct in6_addr *group = NULL; 33499ed973ccSLinus Lüssing bool is_general_query; 335008b202b6SYOSHIFUJI Hideaki int err = 0; 335108b202b6SYOSHIFUJI Hideaki 3352adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 33534cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 335408b202b6SYOSHIFUJI Hideaki goto out; 335508b202b6SYOSHIFUJI Hideaki 3356ba5ea614SLinus Lüssing if (transport_len == sizeof(*mld)) { 3357856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld))) { 335808b202b6SYOSHIFUJI Hideaki err = -EINVAL; 335908b202b6SYOSHIFUJI Hideaki goto out; 336008b202b6SYOSHIFUJI Hideaki } 336108b202b6SYOSHIFUJI Hideaki mld = (struct mld_msg *) icmp6_hdr(skb); 33624715213dSLi RongQing max_delay = msecs_to_jiffies(ntohs(mld->mld_maxdelay)); 336308b202b6SYOSHIFUJI Hideaki if (max_delay) 336408b202b6SYOSHIFUJI Hideaki group = &mld->mld_mca; 3365248ba8ecSLinus Lüssing } else { 3366856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld2q))) { 336708b202b6SYOSHIFUJI Hideaki err = -EINVAL; 336808b202b6SYOSHIFUJI Hideaki goto out; 336908b202b6SYOSHIFUJI Hideaki } 337008b202b6SYOSHIFUJI Hideaki mld2q = (struct mld2_query *)icmp6_hdr(skb); 337108b202b6SYOSHIFUJI Hideaki if (!mld2q->mld2q_nsrcs) 337208b202b6SYOSHIFUJI Hideaki group = &mld2q->mld2q_mca; 3373d3d065c0SNikolay Aleksandrov if (brmctx->multicast_mld_version == 2 && 337423550b83SNikolay Aleksandrov !ipv6_addr_any(&mld2q->mld2q_mca) && 337523550b83SNikolay Aleksandrov mld2q->mld2q_suppress) 337623550b83SNikolay Aleksandrov goto out; 3377e3f5b170SDaniel Borkmann 3378e3f5b170SDaniel Borkmann max_delay = max(msecs_to_jiffies(mldv2_mrc(mld2q)), 1UL); 337908b202b6SYOSHIFUJI Hideaki } 338008b202b6SYOSHIFUJI Hideaki 33819ed973ccSLinus Lüssing is_general_query = group && ipv6_addr_any(group); 33829ed973ccSLinus Lüssing 3383dc4eb53aSLinus Lüssing if (is_general_query) { 3384dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IPV6); 3385deb96566SNikolay Aleksandrov saddr.src.ip6 = ipv6_hdr(skb)->saddr; 3386b00589afSLinus Lüssing 3387adc47037SNikolay Aleksandrov br_ip6_multicast_query_received(brmctx, pmctx, 3388d3d065c0SNikolay Aleksandrov &brmctx->ip6_other_query, 3389dc4eb53aSLinus Lüssing &saddr, max_delay); 339008b202b6SYOSHIFUJI Hideaki goto out; 33916c03ee8bSLinus Lüssing } else if (!group) { 33926c03ee8bSLinus Lüssing goto out; 3393dc4eb53aSLinus Lüssing } 339408b202b6SYOSHIFUJI Hideaki 3395adc47037SNikolay Aleksandrov mp = br_mdb_ip6_get(brmctx->br, group, vid); 339608b202b6SYOSHIFUJI Hideaki if (!mp) 339708b202b6SYOSHIFUJI Hideaki goto out; 339808b202b6SYOSHIFUJI Hideaki 3399d3d065c0SNikolay Aleksandrov max_delay *= brmctx->multicast_last_member_count; 3400ff0fd34eSAndrew Lunn if (mp->host_joined && 340108b202b6SYOSHIFUJI Hideaki (timer_pending(&mp->timer) ? 340208b202b6SYOSHIFUJI Hideaki time_after(mp->timer.expires, now + max_delay) : 340308b202b6SYOSHIFUJI Hideaki try_to_del_timer_sync(&mp->timer) >= 0)) 340408b202b6SYOSHIFUJI Hideaki mod_timer(&mp->timer, now + max_delay); 340508b202b6SYOSHIFUJI Hideaki 3406e8051688SEric Dumazet for (pp = &mp->ports; 3407adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3408e8051688SEric Dumazet pp = &p->next) { 340908b202b6SYOSHIFUJI Hideaki if (timer_pending(&p->timer) ? 341008b202b6SYOSHIFUJI Hideaki time_after(p->timer.expires, now + max_delay) : 341123550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 3412d3d065c0SNikolay Aleksandrov (brmctx->multicast_mld_version == 1 || 341323550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 341424f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 341508b202b6SYOSHIFUJI Hideaki } 341608b202b6SYOSHIFUJI Hideaki 341708b202b6SYOSHIFUJI Hideaki out: 3418adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 341908b202b6SYOSHIFUJI Hideaki return err; 342008b202b6SYOSHIFUJI Hideaki } 342108b202b6SYOSHIFUJI Hideaki #endif 342208b202b6SYOSHIFUJI Hideaki 342390010b36SLinus Lüssing static void 3424adc47037SNikolay Aleksandrov br_multicast_leave_group(struct net_bridge_mcast *brmctx, 3425adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3426cc0fdd80SLinus Lüssing struct br_ip *group, 342790010b36SLinus Lüssing struct bridge_mcast_other_query *other_query, 34286db6f0eaSFelix Fietkau struct bridge_mcast_own_query *own_query, 34296db6f0eaSFelix Fietkau const unsigned char *src) 3430eb1d1641SHerbert Xu { 3431eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 3432eb1d1641SHerbert Xu struct net_bridge_port_group *p; 3433eb1d1641SHerbert Xu unsigned long now; 3434eb1d1641SHerbert Xu unsigned long time; 3435eb1d1641SHerbert Xu 3436adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 34374cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 3438eb1d1641SHerbert Xu goto out; 3439eb1d1641SHerbert Xu 3440adc47037SNikolay Aleksandrov mp = br_mdb_ip_get(brmctx->br, group); 3441eb1d1641SHerbert Xu if (!mp) 3442eb1d1641SHerbert Xu goto out; 3443eb1d1641SHerbert Xu 3444adc47037SNikolay Aleksandrov if (pmctx && (pmctx->port->flags & BR_MULTICAST_FAST_LEAVE)) { 3445544586f7SSatish Ashok struct net_bridge_port_group __rcu **pp; 3446544586f7SSatish Ashok 3447544586f7SSatish Ashok for (pp = &mp->ports; 3448adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3449544586f7SSatish Ashok pp = &p->next) { 3450adc47037SNikolay Aleksandrov if (!br_port_group_equal(p, pmctx->port, src)) 3451544586f7SSatish Ashok continue; 3452544586f7SSatish Ashok 34535c725b6bSNikolay Aleksandrov if (p->flags & MDB_PG_FLAGS_PERMANENT) 34545c725b6bSNikolay Aleksandrov break; 34555c725b6bSNikolay Aleksandrov 3456681590bdSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_FAST_LEAVE; 3457681590bdSNikolay Aleksandrov br_multicast_del_pg(mp, p, pp); 3458544586f7SSatish Ashok } 3459544586f7SSatish Ashok goto out; 3460544586f7SSatish Ashok } 3461544586f7SSatish Ashok 3462544586f7SSatish Ashok if (timer_pending(&other_query->timer)) 3463544586f7SSatish Ashok goto out; 3464544586f7SSatish Ashok 34654d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier) { 3466adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, NULL, NULL, &mp->addr, 346742c11ccfSNikolay Aleksandrov false, 0, NULL); 34686b7df111SCong Wang 3469d3d065c0SNikolay Aleksandrov time = jiffies + brmctx->multicast_last_member_count * 3470d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval; 3471cc0fdd80SLinus Lüssing 347290010b36SLinus Lüssing mod_timer(&own_query->timer, time); 34736b7df111SCong Wang 3474adc47037SNikolay Aleksandrov for (p = mlock_dereference(mp->ports, brmctx->br); 347554cb4319SNikolay Aleksandrov p != NULL && pmctx != NULL; 3476adc47037SNikolay Aleksandrov p = mlock_dereference(p->next, brmctx->br)) { 3477adc47037SNikolay Aleksandrov if (!br_port_group_equal(p, pmctx->port, src)) 34786b7df111SCong Wang continue; 34796b7df111SCong Wang 34806b7df111SCong Wang if (!hlist_unhashed(&p->mglist) && 34816b7df111SCong Wang (timer_pending(&p->timer) ? 34826b7df111SCong Wang time_after(p->timer.expires, time) : 34836b7df111SCong Wang try_to_del_timer_sync(&p->timer) >= 0)) { 34846b7df111SCong Wang mod_timer(&p->timer, time); 34856b7df111SCong Wang } 34866b7df111SCong Wang 34876b7df111SCong Wang break; 34886b7df111SCong Wang } 34896b7df111SCong Wang } 34906b7df111SCong Wang 3491eb1d1641SHerbert Xu now = jiffies; 3492d3d065c0SNikolay Aleksandrov time = now + brmctx->multicast_last_member_count * 3493d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval; 3494eb1d1641SHerbert Xu 3495adc47037SNikolay Aleksandrov if (!pmctx) { 3496ff0fd34eSAndrew Lunn if (mp->host_joined && 3497eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 3498eb1d1641SHerbert Xu time_after(mp->timer.expires, time) : 3499eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) { 3500eb1d1641SHerbert Xu mod_timer(&mp->timer, time); 3501eb1d1641SHerbert Xu } 3502454594f3SLinus Lüssing 3503454594f3SLinus Lüssing goto out; 3504454594f3SLinus Lüssing } 3505454594f3SLinus Lüssing 3506adc47037SNikolay Aleksandrov for (p = mlock_dereference(mp->ports, brmctx->br); 3507454594f3SLinus Lüssing p != NULL; 3508adc47037SNikolay Aleksandrov p = mlock_dereference(p->next, brmctx->br)) { 3509adc47037SNikolay Aleksandrov if (p->key.port != pmctx->port) 3510454594f3SLinus Lüssing continue; 3511454594f3SLinus Lüssing 3512454594f3SLinus Lüssing if (!hlist_unhashed(&p->mglist) && 3513454594f3SLinus Lüssing (timer_pending(&p->timer) ? 3514454594f3SLinus Lüssing time_after(p->timer.expires, time) : 3515454594f3SLinus Lüssing try_to_del_timer_sync(&p->timer) >= 0)) { 3516454594f3SLinus Lüssing mod_timer(&p->timer, time); 3517454594f3SLinus Lüssing } 3518454594f3SLinus Lüssing 3519454594f3SLinus Lüssing break; 3520eb1d1641SHerbert Xu } 3521eb1d1641SHerbert Xu out: 3522adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3523eb1d1641SHerbert Xu } 3524eb1d1641SHerbert Xu 3525adc47037SNikolay Aleksandrov static void br_ip4_multicast_leave_group(struct net_bridge_mcast *brmctx, 3526adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3527b0e9a30dSVlad Yasevich __be32 group, 35286db6f0eaSFelix Fietkau __u16 vid, 35296db6f0eaSFelix Fietkau const unsigned char *src) 35308ef2a9a5SYOSHIFUJI Hideaki { 35318ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 353290010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 35338ef2a9a5SYOSHIFUJI Hideaki 35348ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 35358ef2a9a5SYOSHIFUJI Hideaki return; 35368ef2a9a5SYOSHIFUJI Hideaki 3537adc47037SNikolay Aleksandrov own_query = pmctx ? &pmctx->ip4_own_query : &brmctx->ip4_own_query; 353890010b36SLinus Lüssing 35391515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 3540eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 35418ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 3542b0e9a30dSVlad Yasevich br_group.vid = vid; 35438ef2a9a5SYOSHIFUJI Hideaki 3544adc47037SNikolay Aleksandrov br_multicast_leave_group(brmctx, pmctx, &br_group, 3545adc47037SNikolay Aleksandrov &brmctx->ip4_other_query, 35466db6f0eaSFelix Fietkau own_query, src); 35478ef2a9a5SYOSHIFUJI Hideaki } 35488ef2a9a5SYOSHIFUJI Hideaki 3549dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3550adc47037SNikolay Aleksandrov static void br_ip6_multicast_leave_group(struct net_bridge_mcast *brmctx, 3551adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3552b0e9a30dSVlad Yasevich const struct in6_addr *group, 35536db6f0eaSFelix Fietkau __u16 vid, 35546db6f0eaSFelix Fietkau const unsigned char *src) 355508b202b6SYOSHIFUJI Hideaki { 355608b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 355790010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 355808b202b6SYOSHIFUJI Hideaki 35593c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 356008b202b6SYOSHIFUJI Hideaki return; 356108b202b6SYOSHIFUJI Hideaki 3562adc47037SNikolay Aleksandrov own_query = pmctx ? &pmctx->ip6_own_query : &brmctx->ip6_own_query; 356390010b36SLinus Lüssing 35641515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 3565eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 356608b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 3567b0e9a30dSVlad Yasevich br_group.vid = vid; 356808b202b6SYOSHIFUJI Hideaki 3569adc47037SNikolay Aleksandrov br_multicast_leave_group(brmctx, pmctx, &br_group, 3570adc47037SNikolay Aleksandrov &brmctx->ip6_other_query, 35716db6f0eaSFelix Fietkau own_query, src); 357208b202b6SYOSHIFUJI Hideaki } 357308b202b6SYOSHIFUJI Hideaki #endif 35748ef2a9a5SYOSHIFUJI Hideaki 35751080ab95SNikolay Aleksandrov static void br_multicast_err_count(const struct net_bridge *br, 35761080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 35771080ab95SNikolay Aleksandrov __be16 proto) 35781080ab95SNikolay Aleksandrov { 35791080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 35801080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats; 35811080ab95SNikolay Aleksandrov 3582675779adSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 35831080ab95SNikolay Aleksandrov return; 35841080ab95SNikolay Aleksandrov 35851080ab95SNikolay Aleksandrov if (p) 35861080ab95SNikolay Aleksandrov stats = p->mcast_stats; 35871080ab95SNikolay Aleksandrov else 35881080ab95SNikolay Aleksandrov stats = br->mcast_stats; 35891080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 35901080ab95SNikolay Aleksandrov return; 35911080ab95SNikolay Aleksandrov 35921080ab95SNikolay Aleksandrov pstats = this_cpu_ptr(stats); 35931080ab95SNikolay Aleksandrov 35941080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 35951080ab95SNikolay Aleksandrov switch (proto) { 35961080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 35971080ab95SNikolay Aleksandrov pstats->mstats.igmp_parse_errors++; 35981080ab95SNikolay Aleksandrov break; 35991080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 36001080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 36011080ab95SNikolay Aleksandrov pstats->mstats.mld_parse_errors++; 36021080ab95SNikolay Aleksandrov break; 36031080ab95SNikolay Aleksandrov #endif 36041080ab95SNikolay Aleksandrov } 36051080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 36061080ab95SNikolay Aleksandrov } 36071080ab95SNikolay Aleksandrov 3608adc47037SNikolay Aleksandrov static void br_multicast_pim(struct net_bridge_mcast *brmctx, 3609adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 361091b02d3dSNikolay Aleksandrov const struct sk_buff *skb) 361191b02d3dSNikolay Aleksandrov { 361291b02d3dSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 361391b02d3dSNikolay Aleksandrov struct pimhdr *pimhdr, _pimhdr; 361491b02d3dSNikolay Aleksandrov 361591b02d3dSNikolay Aleksandrov pimhdr = skb_header_pointer(skb, offset, sizeof(_pimhdr), &_pimhdr); 361691b02d3dSNikolay Aleksandrov if (!pimhdr || pim_hdr_version(pimhdr) != PIM_VERSION || 361791b02d3dSNikolay Aleksandrov pim_hdr_type(pimhdr) != PIM_TYPE_HELLO) 361891b02d3dSNikolay Aleksandrov return; 361991b02d3dSNikolay Aleksandrov 3620adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3621adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3622adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 362391b02d3dSNikolay Aleksandrov } 362491b02d3dSNikolay Aleksandrov 3625adc47037SNikolay Aleksandrov static int br_ip4_multicast_mrd_rcv(struct net_bridge_mcast *brmctx, 3626adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 36274b3087c7SLinus Lüssing struct sk_buff *skb) 36284b3087c7SLinus Lüssing { 36294b3087c7SLinus Lüssing if (ip_hdr(skb)->protocol != IPPROTO_IGMP || 36304b3087c7SLinus Lüssing igmp_hdr(skb)->type != IGMP_MRDISC_ADV) 36314b3087c7SLinus Lüssing return -ENOMSG; 36324b3087c7SLinus Lüssing 3633adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3634adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3635adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 36364b3087c7SLinus Lüssing 36374b3087c7SLinus Lüssing return 0; 36384b3087c7SLinus Lüssing } 36394b3087c7SLinus Lüssing 3640adc47037SNikolay Aleksandrov static int br_multicast_ipv4_rcv(struct net_bridge_mcast *brmctx, 3641adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 364206499098SVlad Yasevich struct sk_buff *skb, 364306499098SVlad Yasevich u16 vid) 3644eb1d1641SHerbert Xu { 3645adc47037SNikolay Aleksandrov struct net_bridge_port *p = pmctx ? pmctx->port : NULL; 36466db6f0eaSFelix Fietkau const unsigned char *src; 3647eb1d1641SHerbert Xu struct igmphdr *ih; 3648eb1d1641SHerbert Xu int err; 3649eb1d1641SHerbert Xu 3650ba5ea614SLinus Lüssing err = ip_mc_check_igmp(skb); 3651eb1d1641SHerbert Xu 36529afd85c9SLinus Lüssing if (err == -ENOMSG) { 365391b02d3dSNikolay Aleksandrov if (!ipv4_is_local_multicast(ip_hdr(skb)->daddr)) { 3654bd4265feSHerbert Xu BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 365591b02d3dSNikolay Aleksandrov } else if (pim_ipv4_all_pim_routers(ip_hdr(skb)->daddr)) { 365691b02d3dSNikolay Aleksandrov if (ip_hdr(skb)->protocol == IPPROTO_PIM) 3657adc47037SNikolay Aleksandrov br_multicast_pim(brmctx, pmctx, skb); 36584b3087c7SLinus Lüssing } else if (ipv4_is_all_snoopers(ip_hdr(skb)->daddr)) { 3659adc47037SNikolay Aleksandrov br_ip4_multicast_mrd_rcv(brmctx, pmctx, skb); 36604b3087c7SLinus Lüssing } 36614b3087c7SLinus Lüssing 3662eb1d1641SHerbert Xu return 0; 36639afd85c9SLinus Lüssing } else if (err < 0) { 3664adc47037SNikolay Aleksandrov br_multicast_err_count(brmctx->br, p, skb->protocol); 36659afd85c9SLinus Lüssing return err; 3666bd4265feSHerbert Xu } 3667eb1d1641SHerbert Xu 36689afd85c9SLinus Lüssing ih = igmp_hdr(skb); 36696db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 36701080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = ih->type; 3671eb1d1641SHerbert Xu 3672eb1d1641SHerbert Xu switch (ih->type) { 3673eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_REPORT: 3674eb1d1641SHerbert Xu case IGMPV2_HOST_MEMBERSHIP_REPORT: 367562b2bcb4SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 3676adc47037SNikolay Aleksandrov err = br_ip4_multicast_add_group(brmctx, pmctx, ih->group, vid, 3677adc47037SNikolay Aleksandrov src, true); 3678eb1d1641SHerbert Xu break; 3679eb1d1641SHerbert Xu case IGMPV3_HOST_MEMBERSHIP_REPORT: 3680adc47037SNikolay Aleksandrov err = br_ip4_multicast_igmp3_report(brmctx, pmctx, skb, vid); 3681eb1d1641SHerbert Xu break; 3682eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_QUERY: 3683adc47037SNikolay Aleksandrov br_ip4_multicast_query(brmctx, pmctx, skb, vid); 3684eb1d1641SHerbert Xu break; 3685eb1d1641SHerbert Xu case IGMP_HOST_LEAVE_MESSAGE: 3686adc47037SNikolay Aleksandrov br_ip4_multicast_leave_group(brmctx, pmctx, ih->group, vid, src); 3687eb1d1641SHerbert Xu break; 3688eb1d1641SHerbert Xu } 3689eb1d1641SHerbert Xu 3690adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, p, skb, BR_INPUT_SKB_CB(skb)->igmp, 36911080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 36921080ab95SNikolay Aleksandrov 3693eb1d1641SHerbert Xu return err; 3694eb1d1641SHerbert Xu } 3695eb1d1641SHerbert Xu 3696dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3697adc47037SNikolay Aleksandrov static void br_ip6_multicast_mrd_rcv(struct net_bridge_mcast *brmctx, 3698adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 36994b3087c7SLinus Lüssing struct sk_buff *skb) 37004b3087c7SLinus Lüssing { 37014b3087c7SLinus Lüssing if (icmp6_hdr(skb)->icmp6_type != ICMPV6_MRDISC_ADV) 370299014088SLinus Lüssing return; 37034b3087c7SLinus Lüssing 3704adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3705adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 3706adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 37074b3087c7SLinus Lüssing } 37084b3087c7SLinus Lüssing 3709adc47037SNikolay Aleksandrov static int br_multicast_ipv6_rcv(struct net_bridge_mcast *brmctx, 3710adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 371106499098SVlad Yasevich struct sk_buff *skb, 371206499098SVlad Yasevich u16 vid) 371308b202b6SYOSHIFUJI Hideaki { 3714adc47037SNikolay Aleksandrov struct net_bridge_port *p = pmctx ? pmctx->port : NULL; 37156db6f0eaSFelix Fietkau const unsigned char *src; 37169afd85c9SLinus Lüssing struct mld_msg *mld; 371708b202b6SYOSHIFUJI Hideaki int err; 371808b202b6SYOSHIFUJI Hideaki 3719ba5ea614SLinus Lüssing err = ipv6_mc_check_mld(skb); 372008b202b6SYOSHIFUJI Hideaki 372199014088SLinus Lüssing if (err == -ENOMSG || err == -ENODATA) { 37229afd85c9SLinus Lüssing if (!ipv6_addr_is_ll_all_nodes(&ipv6_hdr(skb)->daddr)) 37238fad9c39SLinus Lüssing BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 372499014088SLinus Lüssing if (err == -ENODATA && 372599014088SLinus Lüssing ipv6_addr_is_all_snoopers(&ipv6_hdr(skb)->daddr)) 3726adc47037SNikolay Aleksandrov br_ip6_multicast_mrd_rcv(brmctx, pmctx, skb); 37274b3087c7SLinus Lüssing 372808b202b6SYOSHIFUJI Hideaki return 0; 37299afd85c9SLinus Lüssing } else if (err < 0) { 3730adc47037SNikolay Aleksandrov br_multicast_err_count(brmctx->br, p, skb->protocol); 37319afd85c9SLinus Lüssing return err; 373208b202b6SYOSHIFUJI Hideaki } 373308b202b6SYOSHIFUJI Hideaki 37349afd85c9SLinus Lüssing mld = (struct mld_msg *)skb_transport_header(skb); 37351080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = mld->mld_type; 373608b202b6SYOSHIFUJI Hideaki 37379afd85c9SLinus Lüssing switch (mld->mld_type) { 373808b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REPORT: 37396db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 3740fc2af6c7SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 3741adc47037SNikolay Aleksandrov err = br_ip6_multicast_add_group(brmctx, pmctx, &mld->mld_mca, 3742adc47037SNikolay Aleksandrov vid, src, true); 374308b202b6SYOSHIFUJI Hideaki break; 374408b202b6SYOSHIFUJI Hideaki case ICMPV6_MLD2_REPORT: 3745adc47037SNikolay Aleksandrov err = br_ip6_multicast_mld2_report(brmctx, pmctx, skb, vid); 374608b202b6SYOSHIFUJI Hideaki break; 374708b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_QUERY: 3748adc47037SNikolay Aleksandrov err = br_ip6_multicast_query(brmctx, pmctx, skb, vid); 374908b202b6SYOSHIFUJI Hideaki break; 375008b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REDUCTION: 37516db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 3752adc47037SNikolay Aleksandrov br_ip6_multicast_leave_group(brmctx, pmctx, &mld->mld_mca, vid, 3753adc47037SNikolay Aleksandrov src); 37549afd85c9SLinus Lüssing break; 375508b202b6SYOSHIFUJI Hideaki } 375608b202b6SYOSHIFUJI Hideaki 3757adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, p, skb, BR_INPUT_SKB_CB(skb)->igmp, 37581080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 37591080ab95SNikolay Aleksandrov 376008b202b6SYOSHIFUJI Hideaki return err; 376108b202b6SYOSHIFUJI Hideaki } 376208b202b6SYOSHIFUJI Hideaki #endif 376308b202b6SYOSHIFUJI Hideaki 3764f4b7002aSNikolay Aleksandrov int br_multicast_rcv(struct net_bridge_mcast **brmctx, 3765f4b7002aSNikolay Aleksandrov struct net_bridge_mcast_port **pmctx, 3766f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vlan, 376706499098SVlad Yasevich struct sk_buff *skb, u16 vid) 3768eb1d1641SHerbert Xu { 37691080ab95SNikolay Aleksandrov int ret = 0; 37701080ab95SNikolay Aleksandrov 37711fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->igmp = 0; 37721fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->mrouters_only = 0; 37731fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 3774f4b7002aSNikolay Aleksandrov if (!br_opt_get((*brmctx)->br, BROPT_MULTICAST_ENABLED)) 3775eb1d1641SHerbert Xu return 0; 3776eb1d1641SHerbert Xu 3777f4b7002aSNikolay Aleksandrov if (br_opt_get((*brmctx)->br, BROPT_MCAST_VLAN_SNOOPING_ENABLED) && vlan) { 3778f4b7002aSNikolay Aleksandrov const struct net_bridge_vlan *masterv; 3779f4b7002aSNikolay Aleksandrov 3780f4b7002aSNikolay Aleksandrov /* the vlan has the master flag set only when transmitting 3781f4b7002aSNikolay Aleksandrov * through the bridge device 3782f4b7002aSNikolay Aleksandrov */ 3783f4b7002aSNikolay Aleksandrov if (br_vlan_is_master(vlan)) { 3784f4b7002aSNikolay Aleksandrov masterv = vlan; 3785f4b7002aSNikolay Aleksandrov *brmctx = &vlan->br_mcast_ctx; 3786f4b7002aSNikolay Aleksandrov *pmctx = NULL; 3787f4b7002aSNikolay Aleksandrov } else { 3788f4b7002aSNikolay Aleksandrov masterv = vlan->brvlan; 3789f4b7002aSNikolay Aleksandrov *brmctx = &vlan->brvlan->br_mcast_ctx; 3790f4b7002aSNikolay Aleksandrov *pmctx = &vlan->port_mcast_ctx; 3791f4b7002aSNikolay Aleksandrov } 3792f4b7002aSNikolay Aleksandrov 3793f4b7002aSNikolay Aleksandrov if (!(masterv->priv_flags & BR_VLFLAG_GLOBAL_MCAST_ENABLED)) 3794f4b7002aSNikolay Aleksandrov return 0; 3795f4b7002aSNikolay Aleksandrov } 3796f4b7002aSNikolay Aleksandrov 3797eb1d1641SHerbert Xu switch (skb->protocol) { 3798eb1d1641SHerbert Xu case htons(ETH_P_IP): 3799f4b7002aSNikolay Aleksandrov ret = br_multicast_ipv4_rcv(*brmctx, *pmctx, skb, vid); 38001080ab95SNikolay Aleksandrov break; 3801dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 380208b202b6SYOSHIFUJI Hideaki case htons(ETH_P_IPV6): 3803f4b7002aSNikolay Aleksandrov ret = br_multicast_ipv6_rcv(*brmctx, *pmctx, skb, vid); 38041080ab95SNikolay Aleksandrov break; 380508b202b6SYOSHIFUJI Hideaki #endif 3806eb1d1641SHerbert Xu } 3807eb1d1641SHerbert Xu 38081080ab95SNikolay Aleksandrov return ret; 3809eb1d1641SHerbert Xu } 3810eb1d1641SHerbert Xu 3811adc47037SNikolay Aleksandrov static void br_multicast_query_expired(struct net_bridge_mcast *brmctx, 38122cd41431SLinus Lüssing struct bridge_mcast_own_query *query, 38132cd41431SLinus Lüssing struct bridge_mcast_querier *querier) 3814cc0fdd80SLinus Lüssing { 3815adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 38164cdd0d10SNikolay Aleksandrov if (br_multicast_ctx_vlan_disabled(brmctx)) 38174cdd0d10SNikolay Aleksandrov goto out; 38184cdd0d10SNikolay Aleksandrov 3819adc47037SNikolay Aleksandrov if (query->startup_sent < brmctx->multicast_startup_query_count) 3820cc0fdd80SLinus Lüssing query->startup_sent++; 3821cc0fdd80SLinus Lüssing 3822adc47037SNikolay Aleksandrov br_multicast_send_query(brmctx, NULL, query); 38234cdd0d10SNikolay Aleksandrov out: 3824adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3825cc0fdd80SLinus Lüssing } 3826cc0fdd80SLinus Lüssing 382788c1f37fSAllen Pais static void br_ip4_multicast_query_expired(struct timer_list *t) 3828eb1d1641SHerbert Xu { 3829d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 3830d3d065c0SNikolay Aleksandrov ip4_own_query.timer); 3831eb1d1641SHerbert Xu 3832adc47037SNikolay Aleksandrov br_multicast_query_expired(brmctx, &brmctx->ip4_own_query, 3833d3d065c0SNikolay Aleksandrov &brmctx->ip4_querier); 3834eb1d1641SHerbert Xu } 3835eb1d1641SHerbert Xu 3836cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 383788c1f37fSAllen Pais static void br_ip6_multicast_query_expired(struct timer_list *t) 3838cc0fdd80SLinus Lüssing { 3839d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 3840d3d065c0SNikolay Aleksandrov ip6_own_query.timer); 3841cc0fdd80SLinus Lüssing 3842adc47037SNikolay Aleksandrov br_multicast_query_expired(brmctx, &brmctx->ip6_own_query, 3843d3d065c0SNikolay Aleksandrov &brmctx->ip6_querier); 3844cc0fdd80SLinus Lüssing } 3845cc0fdd80SLinus Lüssing #endif 3846cc0fdd80SLinus Lüssing 3847e12cec65SNikolay Aleksandrov static void br_multicast_gc_work(struct work_struct *work) 38488b671779SNikolay Aleksandrov { 38498b671779SNikolay Aleksandrov struct net_bridge *br = container_of(work, struct net_bridge, 3850e12cec65SNikolay Aleksandrov mcast_gc_work); 38518b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 38528b671779SNikolay Aleksandrov 38538b671779SNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 3854e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 38558b671779SNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 38568b671779SNikolay Aleksandrov 3857e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 38588b671779SNikolay Aleksandrov } 38598b671779SNikolay Aleksandrov 3860613d61dbSNikolay Aleksandrov void br_multicast_ctx_init(struct net_bridge *br, 3861613d61dbSNikolay Aleksandrov struct net_bridge_vlan *vlan, 3862613d61dbSNikolay Aleksandrov struct net_bridge_mcast *brmctx) 3863613d61dbSNikolay Aleksandrov { 3864613d61dbSNikolay Aleksandrov brmctx->br = br; 3865613d61dbSNikolay Aleksandrov brmctx->vlan = vlan; 3866613d61dbSNikolay Aleksandrov brmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 3867613d61dbSNikolay Aleksandrov brmctx->multicast_last_member_count = 2; 3868613d61dbSNikolay Aleksandrov brmctx->multicast_startup_query_count = 2; 3869613d61dbSNikolay Aleksandrov 3870613d61dbSNikolay Aleksandrov brmctx->multicast_last_member_interval = HZ; 3871613d61dbSNikolay Aleksandrov brmctx->multicast_query_response_interval = 10 * HZ; 3872613d61dbSNikolay Aleksandrov brmctx->multicast_startup_query_interval = 125 * HZ / 4; 3873613d61dbSNikolay Aleksandrov brmctx->multicast_query_interval = 125 * HZ; 3874613d61dbSNikolay Aleksandrov brmctx->multicast_querier_interval = 255 * HZ; 3875613d61dbSNikolay Aleksandrov brmctx->multicast_membership_interval = 260 * HZ; 3876613d61dbSNikolay Aleksandrov 3877613d61dbSNikolay Aleksandrov brmctx->ip4_other_query.delay_time = 0; 3878bb18ef8eSNikolay Aleksandrov brmctx->ip4_querier.port_ifidx = 0; 3879f936bb42SThomas Gleixner seqcount_spinlock_init(&brmctx->ip4_querier.seq, &br->multicast_lock); 3880613d61dbSNikolay Aleksandrov brmctx->multicast_igmp_version = 2; 3881613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 3882613d61dbSNikolay Aleksandrov brmctx->multicast_mld_version = 1; 3883613d61dbSNikolay Aleksandrov brmctx->ip6_other_query.delay_time = 0; 3884bb18ef8eSNikolay Aleksandrov brmctx->ip6_querier.port_ifidx = 0; 3885f936bb42SThomas Gleixner seqcount_spinlock_init(&brmctx->ip6_querier.seq, &br->multicast_lock); 3886613d61dbSNikolay Aleksandrov #endif 3887613d61dbSNikolay Aleksandrov 3888613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_mc_router_timer, 3889613d61dbSNikolay Aleksandrov br_ip4_multicast_local_router_expired, 0); 3890613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_other_query.timer, 3891613d61dbSNikolay Aleksandrov br_ip4_multicast_querier_expired, 0); 3892613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_own_query.timer, 3893613d61dbSNikolay Aleksandrov br_ip4_multicast_query_expired, 0); 3894613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 3895613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_mc_router_timer, 3896613d61dbSNikolay Aleksandrov br_ip6_multicast_local_router_expired, 0); 3897613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_other_query.timer, 3898613d61dbSNikolay Aleksandrov br_ip6_multicast_querier_expired, 0); 3899613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_own_query.timer, 3900613d61dbSNikolay Aleksandrov br_ip6_multicast_query_expired, 0); 3901613d61dbSNikolay Aleksandrov #endif 3902613d61dbSNikolay Aleksandrov } 3903613d61dbSNikolay Aleksandrov 3904613d61dbSNikolay Aleksandrov void br_multicast_ctx_deinit(struct net_bridge_mcast *brmctx) 3905613d61dbSNikolay Aleksandrov { 3906613d61dbSNikolay Aleksandrov __br_multicast_stop(brmctx); 3907613d61dbSNikolay Aleksandrov } 3908613d61dbSNikolay Aleksandrov 3909eb1d1641SHerbert Xu void br_multicast_init(struct net_bridge *br) 3910eb1d1641SHerbert Xu { 3911d08c6bc0SNikolay Aleksandrov br->hash_max = BR_MULTICAST_DEFAULT_HASH_MAX; 3912eb1d1641SHerbert Xu 3913613d61dbSNikolay Aleksandrov br_multicast_ctx_init(br, NULL, &br->multicast_ctx); 3914eb1d1641SHerbert Xu 39156919622aSIdo Schimmel br_opt_toggle(br, BROPT_MULTICAST_ENABLED, true); 3916675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_HAS_IPV6_ADDR, true); 3917b00589afSLinus Lüssing 3918eb1d1641SHerbert Xu spin_lock_init(&br->multicast_lock); 391919e3a9c9SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mdb_list); 3920e12cec65SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mcast_gc_list); 3921e12cec65SNikolay Aleksandrov INIT_WORK(&br->mcast_gc_work, br_multicast_gc_work); 3922eb1d1641SHerbert Xu } 3923eb1d1641SHerbert Xu 39244effd28cSLinus Lüssing static void br_ip4_multicast_join_snoopers(struct net_bridge *br) 39254effd28cSLinus Lüssing { 39264effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 39274effd28cSLinus Lüssing 39284effd28cSLinus Lüssing if (!in_dev) 39294effd28cSLinus Lüssing return; 39304effd28cSLinus Lüssing 39319fb20801SFlorian Fainelli __ip_mc_inc_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 39324effd28cSLinus Lüssing in_dev_put(in_dev); 39334effd28cSLinus Lüssing } 39344effd28cSLinus Lüssing 39354effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 39364effd28cSLinus Lüssing static void br_ip6_multicast_join_snoopers(struct net_bridge *br) 39374effd28cSLinus Lüssing { 39384effd28cSLinus Lüssing struct in6_addr addr; 39394effd28cSLinus Lüssing 39404effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 39414effd28cSLinus Lüssing ipv6_dev_mc_inc(br->dev, &addr); 39424effd28cSLinus Lüssing } 39434effd28cSLinus Lüssing #else 39444effd28cSLinus Lüssing static inline void br_ip6_multicast_join_snoopers(struct net_bridge *br) 39454effd28cSLinus Lüssing { 39464effd28cSLinus Lüssing } 39474effd28cSLinus Lüssing #endif 39484effd28cSLinus Lüssing 3949851d0a73SJoseph Huang void br_multicast_join_snoopers(struct net_bridge *br) 39504effd28cSLinus Lüssing { 39514effd28cSLinus Lüssing br_ip4_multicast_join_snoopers(br); 39524effd28cSLinus Lüssing br_ip6_multicast_join_snoopers(br); 39534effd28cSLinus Lüssing } 39544effd28cSLinus Lüssing 39554effd28cSLinus Lüssing static void br_ip4_multicast_leave_snoopers(struct net_bridge *br) 39564effd28cSLinus Lüssing { 39574effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 39584effd28cSLinus Lüssing 39594effd28cSLinus Lüssing if (WARN_ON(!in_dev)) 39604effd28cSLinus Lüssing return; 39614effd28cSLinus Lüssing 39629fb20801SFlorian Fainelli __ip_mc_dec_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 39634effd28cSLinus Lüssing in_dev_put(in_dev); 39644effd28cSLinus Lüssing } 39654effd28cSLinus Lüssing 39664effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 39674effd28cSLinus Lüssing static void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 39684effd28cSLinus Lüssing { 39694effd28cSLinus Lüssing struct in6_addr addr; 39704effd28cSLinus Lüssing 39714effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 39724effd28cSLinus Lüssing ipv6_dev_mc_dec(br->dev, &addr); 39734effd28cSLinus Lüssing } 39744effd28cSLinus Lüssing #else 39754effd28cSLinus Lüssing static inline void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 39764effd28cSLinus Lüssing { 39774effd28cSLinus Lüssing } 39784effd28cSLinus Lüssing #endif 39794effd28cSLinus Lüssing 3980851d0a73SJoseph Huang void br_multicast_leave_snoopers(struct net_bridge *br) 39814effd28cSLinus Lüssing { 39824effd28cSLinus Lüssing br_ip4_multicast_leave_snoopers(br); 39834effd28cSLinus Lüssing br_ip6_multicast_leave_snoopers(br); 39844effd28cSLinus Lüssing } 39854effd28cSLinus Lüssing 39867b54aaafSNikolay Aleksandrov static void __br_multicast_open_query(struct net_bridge *br, 398790010b36SLinus Lüssing struct bridge_mcast_own_query *query) 3988eb1d1641SHerbert Xu { 3989cc0fdd80SLinus Lüssing query->startup_sent = 0; 3990eb1d1641SHerbert Xu 399113cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) 3992eb1d1641SHerbert Xu return; 3993eb1d1641SHerbert Xu 3994cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 3995cc0fdd80SLinus Lüssing } 3996cc0fdd80SLinus Lüssing 39977b54aaafSNikolay Aleksandrov static void __br_multicast_open(struct net_bridge_mcast *brmctx) 39987b54aaafSNikolay Aleksandrov { 39997b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, &brmctx->ip4_own_query); 40007b54aaafSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 40017b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, &brmctx->ip6_own_query); 40027b54aaafSNikolay Aleksandrov #endif 40037b54aaafSNikolay Aleksandrov } 40047b54aaafSNikolay Aleksandrov 4005cc0fdd80SLinus Lüssing void br_multicast_open(struct net_bridge *br) 4006cc0fdd80SLinus Lüssing { 4007f4b7002aSNikolay Aleksandrov ASSERT_RTNL(); 4008f4b7002aSNikolay Aleksandrov 4009f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) { 40107b54aaafSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 40117b54aaafSNikolay Aleksandrov struct net_bridge_vlan *vlan; 40127b54aaafSNikolay Aleksandrov 40137b54aaafSNikolay Aleksandrov vg = br_vlan_group(br); 40147b54aaafSNikolay Aleksandrov if (vg) { 40157b54aaafSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) { 40167b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 40177b54aaafSNikolay Aleksandrov 40187b54aaafSNikolay Aleksandrov brmctx = &vlan->br_mcast_ctx; 40197b54aaafSNikolay Aleksandrov if (br_vlan_is_brentry(vlan) && 40207b54aaafSNikolay Aleksandrov !br_multicast_ctx_vlan_disabled(brmctx)) 40217b54aaafSNikolay Aleksandrov __br_multicast_open(&vlan->br_mcast_ctx); 40227b54aaafSNikolay Aleksandrov } 40237b54aaafSNikolay Aleksandrov } 4024cb486ce9SNikolay Aleksandrov } else { 40257b54aaafSNikolay Aleksandrov __br_multicast_open(&br->multicast_ctx); 4026eb1d1641SHerbert Xu } 4027cb486ce9SNikolay Aleksandrov } 4028eb1d1641SHerbert Xu 4029613d61dbSNikolay Aleksandrov static void __br_multicast_stop(struct net_bridge_mcast *brmctx) 4030613d61dbSNikolay Aleksandrov { 4031613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_mc_router_timer); 4032613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_other_query.timer); 4033613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_own_query.timer); 4034613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4035613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_mc_router_timer); 4036613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_other_query.timer); 4037613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_own_query.timer); 4038613d61dbSNikolay Aleksandrov #endif 4039613d61dbSNikolay Aleksandrov } 4040613d61dbSNikolay Aleksandrov 40417b54aaafSNikolay Aleksandrov void br_multicast_toggle_one_vlan(struct net_bridge_vlan *vlan, bool on) 40427b54aaafSNikolay Aleksandrov { 40437b54aaafSNikolay Aleksandrov struct net_bridge *br; 40447b54aaafSNikolay Aleksandrov 40457b54aaafSNikolay Aleksandrov /* it's okay to check for the flag without the multicast lock because it 40467b54aaafSNikolay Aleksandrov * can only change under RTNL -> multicast_lock, we need the latter to 40477b54aaafSNikolay Aleksandrov * sync with timers and packets 40487b54aaafSNikolay Aleksandrov */ 40497b54aaafSNikolay Aleksandrov if (on == !!(vlan->priv_flags & BR_VLFLAG_MCAST_ENABLED)) 40507b54aaafSNikolay Aleksandrov return; 40517b54aaafSNikolay Aleksandrov 40527b54aaafSNikolay Aleksandrov if (br_vlan_is_master(vlan)) { 40537b54aaafSNikolay Aleksandrov br = vlan->br; 40547b54aaafSNikolay Aleksandrov 40557b54aaafSNikolay Aleksandrov if (!br_vlan_is_brentry(vlan) || 40567b54aaafSNikolay Aleksandrov (on && 40577b54aaafSNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(&vlan->br_mcast_ctx))) 40587b54aaafSNikolay Aleksandrov return; 40597b54aaafSNikolay Aleksandrov 40607b54aaafSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 40617b54aaafSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_MCAST_ENABLED; 40627b54aaafSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 40637b54aaafSNikolay Aleksandrov 40647b54aaafSNikolay Aleksandrov if (on) 40657b54aaafSNikolay Aleksandrov __br_multicast_open(&vlan->br_mcast_ctx); 40667b54aaafSNikolay Aleksandrov else 40677b54aaafSNikolay Aleksandrov __br_multicast_stop(&vlan->br_mcast_ctx); 40687b54aaafSNikolay Aleksandrov } else { 40697b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 40707b54aaafSNikolay Aleksandrov 40717b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(&vlan->port_mcast_ctx); 40727b54aaafSNikolay Aleksandrov if (on && br_multicast_ctx_vlan_global_disabled(brmctx)) 40737b54aaafSNikolay Aleksandrov return; 40747b54aaafSNikolay Aleksandrov 40757b54aaafSNikolay Aleksandrov br = vlan->port->br; 40767b54aaafSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 40777b54aaafSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_MCAST_ENABLED; 40787b54aaafSNikolay Aleksandrov if (on) 40797b54aaafSNikolay Aleksandrov __br_multicast_enable_port_ctx(&vlan->port_mcast_ctx); 40807b54aaafSNikolay Aleksandrov else 40817b54aaafSNikolay Aleksandrov __br_multicast_disable_port_ctx(&vlan->port_mcast_ctx); 40827b54aaafSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 40837b54aaafSNikolay Aleksandrov } 40847b54aaafSNikolay Aleksandrov } 40857b54aaafSNikolay Aleksandrov 4086affce9a7SNikolay Aleksandrov static void br_multicast_toggle_vlan(struct net_bridge_vlan *vlan, bool on) 4087f4b7002aSNikolay Aleksandrov { 4088f4b7002aSNikolay Aleksandrov struct net_bridge_port *p; 4089f4b7002aSNikolay Aleksandrov 4090f4b7002aSNikolay Aleksandrov if (WARN_ON_ONCE(!br_vlan_is_master(vlan))) 4091f4b7002aSNikolay Aleksandrov return; 4092f4b7002aSNikolay Aleksandrov 4093f4b7002aSNikolay Aleksandrov list_for_each_entry(p, &vlan->br->port_list, list) { 4094f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vport; 4095f4b7002aSNikolay Aleksandrov 4096f4b7002aSNikolay Aleksandrov vport = br_vlan_find(nbp_vlan_group(p), vlan->vid); 4097f4b7002aSNikolay Aleksandrov if (!vport) 4098f4b7002aSNikolay Aleksandrov continue; 4099f4b7002aSNikolay Aleksandrov br_multicast_toggle_one_vlan(vport, on); 4100f4b7002aSNikolay Aleksandrov } 4101affce9a7SNikolay Aleksandrov 4102affce9a7SNikolay Aleksandrov if (br_vlan_is_brentry(vlan)) 4103affce9a7SNikolay Aleksandrov br_multicast_toggle_one_vlan(vlan, on); 4104f4b7002aSNikolay Aleksandrov } 4105f4b7002aSNikolay Aleksandrov 4106f4b7002aSNikolay Aleksandrov int br_multicast_toggle_vlan_snooping(struct net_bridge *br, bool on, 4107f4b7002aSNikolay Aleksandrov struct netlink_ext_ack *extack) 4108eb1d1641SHerbert Xu { 41097b54aaafSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 41107b54aaafSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4111f4b7002aSNikolay Aleksandrov struct net_bridge_port *p; 41127b54aaafSNikolay Aleksandrov 4113f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED) == on) 4114f4b7002aSNikolay Aleksandrov return 0; 4115f4b7002aSNikolay Aleksandrov 4116f4b7002aSNikolay Aleksandrov if (on && !br_opt_get(br, BROPT_VLAN_ENABLED)) { 4117f4b7002aSNikolay Aleksandrov NL_SET_ERR_MSG_MOD(extack, "Cannot enable multicast vlan snooping with vlan filtering disabled"); 4118f4b7002aSNikolay Aleksandrov return -EINVAL; 4119f4b7002aSNikolay Aleksandrov } 4120f4b7002aSNikolay Aleksandrov 4121f4b7002aSNikolay Aleksandrov vg = br_vlan_group(br); 4122f4b7002aSNikolay Aleksandrov if (!vg) 4123f4b7002aSNikolay Aleksandrov return 0; 4124f4b7002aSNikolay Aleksandrov 4125f4b7002aSNikolay Aleksandrov br_opt_toggle(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED, on); 4126f4b7002aSNikolay Aleksandrov 4127f4b7002aSNikolay Aleksandrov /* disable/enable non-vlan mcast contexts based on vlan snooping */ 4128f4b7002aSNikolay Aleksandrov if (on) 4129f4b7002aSNikolay Aleksandrov __br_multicast_stop(&br->multicast_ctx); 4130f4b7002aSNikolay Aleksandrov else 4131f4b7002aSNikolay Aleksandrov __br_multicast_open(&br->multicast_ctx); 4132f4b7002aSNikolay Aleksandrov list_for_each_entry(p, &br->port_list, list) { 4133f4b7002aSNikolay Aleksandrov if (on) 4134f4b7002aSNikolay Aleksandrov br_multicast_disable_port(p); 4135f4b7002aSNikolay Aleksandrov else 4136f4b7002aSNikolay Aleksandrov br_multicast_enable_port(p); 4137f4b7002aSNikolay Aleksandrov } 4138f4b7002aSNikolay Aleksandrov 4139f4b7002aSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) 4140f4b7002aSNikolay Aleksandrov br_multicast_toggle_vlan(vlan, on); 4141f4b7002aSNikolay Aleksandrov 4142f4b7002aSNikolay Aleksandrov return 0; 4143f4b7002aSNikolay Aleksandrov } 4144f4b7002aSNikolay Aleksandrov 41459dee572cSNikolay Aleksandrov bool br_multicast_toggle_global_vlan(struct net_bridge_vlan *vlan, bool on) 41469dee572cSNikolay Aleksandrov { 41479dee572cSNikolay Aleksandrov ASSERT_RTNL(); 41489dee572cSNikolay Aleksandrov 41499dee572cSNikolay Aleksandrov /* BR_VLFLAG_GLOBAL_MCAST_ENABLED relies on eventual consistency and 41509dee572cSNikolay Aleksandrov * requires only RTNL to change 41519dee572cSNikolay Aleksandrov */ 41529dee572cSNikolay Aleksandrov if (on == !!(vlan->priv_flags & BR_VLFLAG_GLOBAL_MCAST_ENABLED)) 41539dee572cSNikolay Aleksandrov return false; 41549dee572cSNikolay Aleksandrov 41559dee572cSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_GLOBAL_MCAST_ENABLED; 41569dee572cSNikolay Aleksandrov br_multicast_toggle_vlan(vlan, on); 41579dee572cSNikolay Aleksandrov 41589dee572cSNikolay Aleksandrov return true; 41599dee572cSNikolay Aleksandrov } 41609dee572cSNikolay Aleksandrov 4161f4b7002aSNikolay Aleksandrov void br_multicast_stop(struct net_bridge *br) 4162f4b7002aSNikolay Aleksandrov { 41637b54aaafSNikolay Aleksandrov ASSERT_RTNL(); 41647b54aaafSNikolay Aleksandrov 4165f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) { 4166f4b7002aSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 4167f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4168f4b7002aSNikolay Aleksandrov 41697b54aaafSNikolay Aleksandrov vg = br_vlan_group(br); 41707b54aaafSNikolay Aleksandrov if (vg) { 41717b54aaafSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) { 41727b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 41737b54aaafSNikolay Aleksandrov 41747b54aaafSNikolay Aleksandrov brmctx = &vlan->br_mcast_ctx; 41757b54aaafSNikolay Aleksandrov if (br_vlan_is_brentry(vlan) && 41767b54aaafSNikolay Aleksandrov !br_multicast_ctx_vlan_disabled(brmctx)) 41777b54aaafSNikolay Aleksandrov __br_multicast_stop(&vlan->br_mcast_ctx); 41787b54aaafSNikolay Aleksandrov } 41797b54aaafSNikolay Aleksandrov } 4180cb486ce9SNikolay Aleksandrov } else { 4181613d61dbSNikolay Aleksandrov __br_multicast_stop(&br->multicast_ctx); 4182e10177abSSatish Ashok } 4183cb486ce9SNikolay Aleksandrov } 4184e10177abSSatish Ashok 4185e10177abSSatish Ashok void br_multicast_dev_del(struct net_bridge *br) 4186e10177abSSatish Ashok { 4187e10177abSSatish Ashok struct net_bridge_mdb_entry *mp; 41888b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 418919e3a9c9SNikolay Aleksandrov struct hlist_node *tmp; 4190eb1d1641SHerbert Xu 4191eb1d1641SHerbert Xu spin_lock_bh(&br->multicast_lock); 4192e12cec65SNikolay Aleksandrov hlist_for_each_entry_safe(mp, tmp, &br->mdb_list, mdb_node) 4193e12cec65SNikolay Aleksandrov br_multicast_del_mdb_entry(mp); 4194e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 4195eb1d1641SHerbert Xu spin_unlock_bh(&br->multicast_lock); 419619e3a9c9SNikolay Aleksandrov 4197613d61dbSNikolay Aleksandrov br_multicast_ctx_deinit(&br->multicast_ctx); 4198e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 4199e12cec65SNikolay Aleksandrov cancel_work_sync(&br->mcast_gc_work); 42008b671779SNikolay Aleksandrov 42014329596cSNikolay Aleksandrov rcu_barrier(); 4202eb1d1641SHerbert Xu } 42030909e117SHerbert Xu 4204a97df080SNikolay Aleksandrov int br_multicast_set_router(struct net_bridge_mcast *brmctx, unsigned long val) 42050909e117SHerbert Xu { 42066ae4ae8eSLinus Lüssing int err = -EINVAL; 42070909e117SHerbert Xu 4208a97df080SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 42090909e117SHerbert Xu 42100909e117SHerbert Xu switch (val) { 42117f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 42127f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 4213a97df080SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, val == MDB_RTR_TYPE_PERM); 4214d3d065c0SNikolay Aleksandrov del_timer(&brmctx->ip4_mc_router_timer); 4215a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4216d3d065c0SNikolay Aleksandrov del_timer(&brmctx->ip6_mc_router_timer); 4217a3c02e76SLinus Lüssing #endif 4218d3d065c0SNikolay Aleksandrov brmctx->multicast_router = val; 421977041420SYotam Gigi err = 0; 422077041420SYotam Gigi break; 42217f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 4222d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router != MDB_RTR_TYPE_TEMP_QUERY) 4223a97df080SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, false); 4224d3d065c0SNikolay Aleksandrov brmctx->multicast_router = val; 42250909e117SHerbert Xu err = 0; 42260909e117SHerbert Xu break; 42270909e117SHerbert Xu } 42280909e117SHerbert Xu 4229a97df080SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 42300909e117SHerbert Xu 42310909e117SHerbert Xu return err; 42320909e117SHerbert Xu } 42330909e117SHerbert Xu 4234ed2d3597SLinus Lüssing static void 4235adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(struct net_bridge_mcast_port *pmctx, bool deleted) 42367f0aec7aSNikolay Aleksandrov { 4237ed2d3597SLinus Lüssing if (!deleted) 42387f0aec7aSNikolay Aleksandrov return; 4239ed2d3597SLinus Lüssing 4240a3c02e76SLinus Lüssing /* For backwards compatibility for now, only notify if there is 4241a3c02e76SLinus Lüssing * no multicast router anymore for both IPv4 and IPv6. 4242a3c02e76SLinus Lüssing */ 4243adc47037SNikolay Aleksandrov if (!hlist_unhashed(&pmctx->ip4_rlist)) 4244a3c02e76SLinus Lüssing return; 4245a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4246adc47037SNikolay Aleksandrov if (!hlist_unhashed(&pmctx->ip6_rlist)) 4247a3c02e76SLinus Lüssing return; 4248a3c02e76SLinus Lüssing #endif 4249a3c02e76SLinus Lüssing 42501e9ca456SNikolay Aleksandrov br_rtr_notify(pmctx->port->br->dev, pmctx, RTM_DELMDB); 4251adc47037SNikolay Aleksandrov br_port_mc_router_state_change(pmctx->port, false); 4252f12e7d95SNogah Frankel 4253f12e7d95SNogah Frankel /* don't allow timer refresh */ 4254adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_TEMP) 4255adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 42567f0aec7aSNikolay Aleksandrov } 42577f0aec7aSNikolay Aleksandrov 4258a53581d5SNikolay Aleksandrov int br_multicast_set_port_router(struct net_bridge_mcast_port *pmctx, 4259a53581d5SNikolay Aleksandrov unsigned long val) 42600909e117SHerbert Xu { 4261a53581d5SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 4262a55d8246SNikolay Aleksandrov unsigned long now = jiffies; 42636ae4ae8eSLinus Lüssing int err = -EINVAL; 4264ed2d3597SLinus Lüssing bool del = false; 42650909e117SHerbert Xu 4266a53581d5SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 4267ddd0d529SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4268adc47037SNikolay Aleksandrov if (pmctx->multicast_router == val) { 4269a55d8246SNikolay Aleksandrov /* Refresh the temp router port timer */ 4270adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_TEMP) { 4271adc47037SNikolay Aleksandrov mod_timer(&pmctx->ip4_mc_router_timer, 4272d3d065c0SNikolay Aleksandrov now + brmctx->multicast_querier_interval); 4273a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4274adc47037SNikolay Aleksandrov mod_timer(&pmctx->ip6_mc_router_timer, 4275d3d065c0SNikolay Aleksandrov now + brmctx->multicast_querier_interval); 4276a3c02e76SLinus Lüssing #endif 4277a3c02e76SLinus Lüssing } 42784950cfd1SNikolay Aleksandrov err = 0; 42794950cfd1SNikolay Aleksandrov goto unlock; 42804950cfd1SNikolay Aleksandrov } 42810909e117SHerbert Xu switch (val) { 42827f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 4283adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_DISABLED; 4284adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 4285adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 4286adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 4287a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4288adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 4289a3c02e76SLinus Lüssing #endif 4290adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 42910909e117SHerbert Xu break; 42927f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 4293adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 4294adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 4295adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 4296adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 42977f0aec7aSNikolay Aleksandrov break; 42987f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 4299adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_PERM; 4300adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 4301adc47037SNikolay Aleksandrov br_ip4_multicast_add_router(brmctx, pmctx); 4302a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4303adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 4304a3c02e76SLinus Lüssing #endif 4305adc47037SNikolay Aleksandrov br_ip6_multicast_add_router(brmctx, pmctx); 43060909e117SHerbert Xu break; 4307a55d8246SNikolay Aleksandrov case MDB_RTR_TYPE_TEMP: 4308adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP; 4309adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 4310adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 4311a55d8246SNikolay Aleksandrov break; 43127f0aec7aSNikolay Aleksandrov default: 43137f0aec7aSNikolay Aleksandrov goto unlock; 43140909e117SHerbert Xu } 43157f0aec7aSNikolay Aleksandrov err = 0; 43167f0aec7aSNikolay Aleksandrov unlock: 4317ddd0d529SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 43180909e117SHerbert Xu 43190909e117SHerbert Xu return err; 43200909e117SHerbert Xu } 4321561f1103SHerbert Xu 43222796d846SNikolay Aleksandrov int br_multicast_set_vlan_router(struct net_bridge_vlan *v, u8 mcast_router) 43232796d846SNikolay Aleksandrov { 43242796d846SNikolay Aleksandrov int err; 43252796d846SNikolay Aleksandrov 43262796d846SNikolay Aleksandrov if (br_vlan_is_master(v)) 43272796d846SNikolay Aleksandrov err = br_multicast_set_router(&v->br_mcast_ctx, mcast_router); 43282796d846SNikolay Aleksandrov else 43292796d846SNikolay Aleksandrov err = br_multicast_set_port_router(&v->port_mcast_ctx, 43302796d846SNikolay Aleksandrov mcast_router); 43312796d846SNikolay Aleksandrov 43322796d846SNikolay Aleksandrov return err; 43332796d846SNikolay Aleksandrov } 43342796d846SNikolay Aleksandrov 4335adc47037SNikolay Aleksandrov static void br_multicast_start_querier(struct net_bridge_mcast *brmctx, 433690010b36SLinus Lüssing struct bridge_mcast_own_query *query) 4337561f1103SHerbert Xu { 4338561f1103SHerbert Xu struct net_bridge_port *port; 433974857216SHerbert Xu 4340cb486ce9SNikolay Aleksandrov if (!br_multicast_ctx_matches_vlan_snooping(brmctx)) 4341cb486ce9SNikolay Aleksandrov return; 4342cb486ce9SNikolay Aleksandrov 43437b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, query); 434474857216SHerbert Xu 4345c5b493ceSNikolay Aleksandrov rcu_read_lock(); 4346adc47037SNikolay Aleksandrov list_for_each_entry_rcu(port, &brmctx->br->port_list, list) { 4347615cc23eSNikolay Aleksandrov struct bridge_mcast_own_query *ip4_own_query; 4348615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4349615cc23eSNikolay Aleksandrov struct bridge_mcast_own_query *ip6_own_query; 4350615cc23eSNikolay Aleksandrov #endif 4351615cc23eSNikolay Aleksandrov 4352615cc23eSNikolay Aleksandrov if (br_multicast_port_ctx_state_stopped(&port->multicast_ctx)) 435374857216SHerbert Xu continue; 435474857216SHerbert Xu 4355615cc23eSNikolay Aleksandrov if (br_multicast_ctx_is_vlan(brmctx)) { 4356615cc23eSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4357615cc23eSNikolay Aleksandrov 43583f0d14efSNikolay Aleksandrov vlan = br_vlan_find(nbp_vlan_group_rcu(port), 43593f0d14efSNikolay Aleksandrov brmctx->vlan->vid); 4360615cc23eSNikolay Aleksandrov if (!vlan || 4361615cc23eSNikolay Aleksandrov br_multicast_port_ctx_state_stopped(&vlan->port_mcast_ctx)) 4362615cc23eSNikolay Aleksandrov continue; 4363615cc23eSNikolay Aleksandrov 4364615cc23eSNikolay Aleksandrov ip4_own_query = &vlan->port_mcast_ctx.ip4_own_query; 4365615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4366615cc23eSNikolay Aleksandrov ip6_own_query = &vlan->port_mcast_ctx.ip6_own_query; 4367615cc23eSNikolay Aleksandrov #endif 4368615cc23eSNikolay Aleksandrov } else { 4369615cc23eSNikolay Aleksandrov ip4_own_query = &port->multicast_ctx.ip4_own_query; 4370615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4371615cc23eSNikolay Aleksandrov ip6_own_query = &port->multicast_ctx.ip6_own_query; 4372615cc23eSNikolay Aleksandrov #endif 4373615cc23eSNikolay Aleksandrov } 4374615cc23eSNikolay Aleksandrov 4375adc47037SNikolay Aleksandrov if (query == &brmctx->ip4_own_query) 4376615cc23eSNikolay Aleksandrov br_multicast_enable(ip4_own_query); 4377cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4378cc0fdd80SLinus Lüssing else 4379615cc23eSNikolay Aleksandrov br_multicast_enable(ip6_own_query); 4380cc0fdd80SLinus Lüssing #endif 438174857216SHerbert Xu } 4382c5b493ceSNikolay Aleksandrov rcu_read_unlock(); 438374857216SHerbert Xu } 438474857216SHerbert Xu 4385ae1ea84bSFlorian Fainelli int br_multicast_toggle(struct net_bridge *br, unsigned long val, 4386ae1ea84bSFlorian Fainelli struct netlink_ext_ack *extack) 438774857216SHerbert Xu { 43887cb3f921SNikolay Aleksandrov struct net_bridge_port *port; 4389851d0a73SJoseph Huang bool change_snoopers = false; 4390ae1ea84bSFlorian Fainelli int err = 0; 4391561f1103SHerbert Xu 4392ef5e0d82SAndrey Vagin spin_lock_bh(&br->multicast_lock); 439313cefad2SNikolay Aleksandrov if (!!br_opt_get(br, BROPT_MULTICAST_ENABLED) == !!val) 4394561f1103SHerbert Xu goto unlock; 4395561f1103SHerbert Xu 4396ae1ea84bSFlorian Fainelli err = br_mc_disabled_update(br->dev, val, extack); 4397ae1ea84bSFlorian Fainelli if (err == -EOPNOTSUPP) 4398ae1ea84bSFlorian Fainelli err = 0; 4399ae1ea84bSFlorian Fainelli if (err) 4400ae1ea84bSFlorian Fainelli goto unlock; 4401ae1ea84bSFlorian Fainelli 440213cefad2SNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_ENABLED, !!val); 44034effd28cSLinus Lüssing if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) { 4404851d0a73SJoseph Huang change_snoopers = true; 4405561f1103SHerbert Xu goto unlock; 44064effd28cSLinus Lüssing } 4407561f1103SHerbert Xu 44083a7fda06SHerbert Xu if (!netif_running(br->dev)) 44093a7fda06SHerbert Xu goto unlock; 44103a7fda06SHerbert Xu 44117cb3f921SNikolay Aleksandrov br_multicast_open(br); 44127cb3f921SNikolay Aleksandrov list_for_each_entry(port, &br->port_list, list) 4413adc47037SNikolay Aleksandrov __br_multicast_enable_port_ctx(&port->multicast_ctx); 4414561f1103SHerbert Xu 4415851d0a73SJoseph Huang change_snoopers = true; 4416851d0a73SJoseph Huang 4417561f1103SHerbert Xu unlock: 4418ef5e0d82SAndrey Vagin spin_unlock_bh(&br->multicast_lock); 4419561f1103SHerbert Xu 4420851d0a73SJoseph Huang /* br_multicast_join_snoopers has the potential to cause 4421851d0a73SJoseph Huang * an MLD Report/Leave to be delivered to br_multicast_rcv, 4422851d0a73SJoseph Huang * which would in turn call br_multicast_add_group, which would 4423851d0a73SJoseph Huang * attempt to acquire multicast_lock. This function should be 4424851d0a73SJoseph Huang * called after the lock has been released to avoid deadlocks on 4425851d0a73SJoseph Huang * multicast_lock. 4426851d0a73SJoseph Huang * 4427851d0a73SJoseph Huang * br_multicast_leave_snoopers does not have the problem since 4428851d0a73SJoseph Huang * br_multicast_rcv first checks BROPT_MULTICAST_ENABLED, and 4429851d0a73SJoseph Huang * returns without calling br_multicast_ipv4/6_rcv if it's not 4430851d0a73SJoseph Huang * enabled. Moved both functions out just for symmetry. 4431851d0a73SJoseph Huang */ 4432851d0a73SJoseph Huang if (change_snoopers) { 4433851d0a73SJoseph Huang if (br_opt_get(br, BROPT_MULTICAST_ENABLED)) 4434851d0a73SJoseph Huang br_multicast_join_snoopers(br); 4435851d0a73SJoseph Huang else 4436851d0a73SJoseph Huang br_multicast_leave_snoopers(br); 4437851d0a73SJoseph Huang } 4438851d0a73SJoseph Huang 4439ae1ea84bSFlorian Fainelli return err; 4440561f1103SHerbert Xu } 4441b195167fSHerbert Xu 44429341b988SIdo Schimmel bool br_multicast_enabled(const struct net_device *dev) 44439341b988SIdo Schimmel { 44449341b988SIdo Schimmel struct net_bridge *br = netdev_priv(dev); 44459341b988SIdo Schimmel 444613cefad2SNikolay Aleksandrov return !!br_opt_get(br, BROPT_MULTICAST_ENABLED); 44479341b988SIdo Schimmel } 44489341b988SIdo Schimmel EXPORT_SYMBOL_GPL(br_multicast_enabled); 44499341b988SIdo Schimmel 44500912bda4SYotam Gigi bool br_multicast_router(const struct net_device *dev) 44510912bda4SYotam Gigi { 44520912bda4SYotam Gigi struct net_bridge *br = netdev_priv(dev); 44530912bda4SYotam Gigi bool is_router; 44540912bda4SYotam Gigi 44550912bda4SYotam Gigi spin_lock_bh(&br->multicast_lock); 4456adc47037SNikolay Aleksandrov is_router = br_multicast_is_router(&br->multicast_ctx, NULL); 44570912bda4SYotam Gigi spin_unlock_bh(&br->multicast_lock); 44580912bda4SYotam Gigi return is_router; 44590912bda4SYotam Gigi } 44600912bda4SYotam Gigi EXPORT_SYMBOL_GPL(br_multicast_router); 44610912bda4SYotam Gigi 446262938182SNikolay Aleksandrov int br_multicast_set_querier(struct net_bridge_mcast *brmctx, unsigned long val) 4463c5c23260SHerbert Xu { 4464b00589afSLinus Lüssing unsigned long max_delay; 4465b00589afSLinus Lüssing 4466c5c23260SHerbert Xu val = !!val; 4467c5c23260SHerbert Xu 446862938182SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 44694d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier == val) 4470c5c23260SHerbert Xu goto unlock; 4471c5c23260SHerbert Xu 44724d5b4e84SNikolay Aleksandrov WRITE_ONCE(brmctx->multicast_querier, val); 4473b00589afSLinus Lüssing if (!val) 4474b00589afSLinus Lüssing goto unlock; 4475b00589afSLinus Lüssing 4476d3d065c0SNikolay Aleksandrov max_delay = brmctx->multicast_query_response_interval; 4477b00589afSLinus Lüssing 4478d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip4_other_query.timer)) 4479d3d065c0SNikolay Aleksandrov brmctx->ip4_other_query.delay_time = jiffies + max_delay; 4480cc0fdd80SLinus Lüssing 4481adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, &brmctx->ip4_own_query); 4482cc0fdd80SLinus Lüssing 4483cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4484d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip6_other_query.timer)) 4485d3d065c0SNikolay Aleksandrov brmctx->ip6_other_query.delay_time = jiffies + max_delay; 4486cc0fdd80SLinus Lüssing 4487adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, &brmctx->ip6_own_query); 4488cc0fdd80SLinus Lüssing #endif 4489c5c23260SHerbert Xu 4490c5c23260SHerbert Xu unlock: 449162938182SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 4492c5c23260SHerbert Xu 4493c5c23260SHerbert Xu return 0; 4494c5c23260SHerbert Xu } 4495c5c23260SHerbert Xu 4496df271cd6SNikolay Aleksandrov int br_multicast_set_igmp_version(struct net_bridge_mcast *brmctx, 4497df271cd6SNikolay Aleksandrov unsigned long val) 44985e923585SNikolay Aleksandrov { 44995e923585SNikolay Aleksandrov /* Currently we support only version 2 and 3 */ 45005e923585SNikolay Aleksandrov switch (val) { 45015e923585SNikolay Aleksandrov case 2: 45025e923585SNikolay Aleksandrov case 3: 45035e923585SNikolay Aleksandrov break; 45045e923585SNikolay Aleksandrov default: 45055e923585SNikolay Aleksandrov return -EINVAL; 45065e923585SNikolay Aleksandrov } 45075e923585SNikolay Aleksandrov 4508df271cd6SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4509df271cd6SNikolay Aleksandrov brmctx->multicast_igmp_version = val; 4510df271cd6SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 45115e923585SNikolay Aleksandrov 45125e923585SNikolay Aleksandrov return 0; 45135e923585SNikolay Aleksandrov } 45145e923585SNikolay Aleksandrov 4515aa2ae3e7SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4516df271cd6SNikolay Aleksandrov int br_multicast_set_mld_version(struct net_bridge_mcast *brmctx, 4517df271cd6SNikolay Aleksandrov unsigned long val) 4518aa2ae3e7SNikolay Aleksandrov { 4519aa2ae3e7SNikolay Aleksandrov /* Currently we support version 1 and 2 */ 4520aa2ae3e7SNikolay Aleksandrov switch (val) { 4521aa2ae3e7SNikolay Aleksandrov case 1: 4522aa2ae3e7SNikolay Aleksandrov case 2: 4523aa2ae3e7SNikolay Aleksandrov break; 4524aa2ae3e7SNikolay Aleksandrov default: 4525aa2ae3e7SNikolay Aleksandrov return -EINVAL; 4526aa2ae3e7SNikolay Aleksandrov } 4527aa2ae3e7SNikolay Aleksandrov 4528df271cd6SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4529df271cd6SNikolay Aleksandrov brmctx->multicast_mld_version = val; 4530df271cd6SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 4531aa2ae3e7SNikolay Aleksandrov 4532aa2ae3e7SNikolay Aleksandrov return 0; 4533aa2ae3e7SNikolay Aleksandrov } 4534aa2ae3e7SNikolay Aleksandrov #endif 4535aa2ae3e7SNikolay Aleksandrov 453699b40610SNikolay Aleksandrov void br_multicast_set_query_intvl(struct net_bridge_mcast *brmctx, 453799b40610SNikolay Aleksandrov unsigned long val) 453899b40610SNikolay Aleksandrov { 453999b40610SNikolay Aleksandrov unsigned long intvl_jiffies = clock_t_to_jiffies(val); 454099b40610SNikolay Aleksandrov 454199b40610SNikolay Aleksandrov if (intvl_jiffies < BR_MULTICAST_QUERY_INTVL_MIN) { 454299b40610SNikolay Aleksandrov br_info(brmctx->br, 454399b40610SNikolay Aleksandrov "trying to set multicast query interval below minimum, setting to %lu (%ums)\n", 454499b40610SNikolay Aleksandrov jiffies_to_clock_t(BR_MULTICAST_QUERY_INTVL_MIN), 454599b40610SNikolay Aleksandrov jiffies_to_msecs(BR_MULTICAST_QUERY_INTVL_MIN)); 454699b40610SNikolay Aleksandrov intvl_jiffies = BR_MULTICAST_QUERY_INTVL_MIN; 454799b40610SNikolay Aleksandrov } 454899b40610SNikolay Aleksandrov 454999b40610SNikolay Aleksandrov brmctx->multicast_query_interval = intvl_jiffies; 455099b40610SNikolay Aleksandrov } 455199b40610SNikolay Aleksandrov 4552f83a112bSNikolay Aleksandrov void br_multicast_set_startup_query_intvl(struct net_bridge_mcast *brmctx, 4553f83a112bSNikolay Aleksandrov unsigned long val) 4554f83a112bSNikolay Aleksandrov { 4555f83a112bSNikolay Aleksandrov unsigned long intvl_jiffies = clock_t_to_jiffies(val); 4556f83a112bSNikolay Aleksandrov 4557f83a112bSNikolay Aleksandrov if (intvl_jiffies < BR_MULTICAST_STARTUP_QUERY_INTVL_MIN) { 4558f83a112bSNikolay Aleksandrov br_info(brmctx->br, 4559f83a112bSNikolay Aleksandrov "trying to set multicast startup query interval below minimum, setting to %lu (%ums)\n", 4560f83a112bSNikolay Aleksandrov jiffies_to_clock_t(BR_MULTICAST_STARTUP_QUERY_INTVL_MIN), 4561f83a112bSNikolay Aleksandrov jiffies_to_msecs(BR_MULTICAST_STARTUP_QUERY_INTVL_MIN)); 4562f83a112bSNikolay Aleksandrov intvl_jiffies = BR_MULTICAST_STARTUP_QUERY_INTVL_MIN; 4563f83a112bSNikolay Aleksandrov } 4564f83a112bSNikolay Aleksandrov 4565f83a112bSNikolay Aleksandrov brmctx->multicast_startup_query_interval = intvl_jiffies; 4566f83a112bSNikolay Aleksandrov } 4567f83a112bSNikolay Aleksandrov 456807f8ac4aSLinus Lüssing /** 456907f8ac4aSLinus Lüssing * br_multicast_list_adjacent - Returns snooped multicast addresses 457007f8ac4aSLinus Lüssing * @dev: The bridge port adjacent to which to retrieve addresses 457107f8ac4aSLinus Lüssing * @br_ip_list: The list to store found, snooped multicast IP addresses in 457207f8ac4aSLinus Lüssing * 457307f8ac4aSLinus Lüssing * Creates a list of IP addresses (struct br_ip_list) sensed by the multicast 457407f8ac4aSLinus Lüssing * snooping feature on all bridge ports of dev's bridge device, excluding 457507f8ac4aSLinus Lüssing * the addresses from dev itself. 457607f8ac4aSLinus Lüssing * 457707f8ac4aSLinus Lüssing * Returns the number of items added to br_ip_list. 457807f8ac4aSLinus Lüssing * 457907f8ac4aSLinus Lüssing * Notes: 458007f8ac4aSLinus Lüssing * - br_ip_list needs to be initialized by caller 458107f8ac4aSLinus Lüssing * - br_ip_list might contain duplicates in the end 458207f8ac4aSLinus Lüssing * (needs to be taken care of by caller) 458307f8ac4aSLinus Lüssing * - br_ip_list needs to be freed by caller 458407f8ac4aSLinus Lüssing */ 458507f8ac4aSLinus Lüssing int br_multicast_list_adjacent(struct net_device *dev, 458607f8ac4aSLinus Lüssing struct list_head *br_ip_list) 458707f8ac4aSLinus Lüssing { 458807f8ac4aSLinus Lüssing struct net_bridge *br; 458907f8ac4aSLinus Lüssing struct net_bridge_port *port; 459007f8ac4aSLinus Lüssing struct net_bridge_port_group *group; 459107f8ac4aSLinus Lüssing struct br_ip_list *entry; 459207f8ac4aSLinus Lüssing int count = 0; 459307f8ac4aSLinus Lüssing 459407f8ac4aSLinus Lüssing rcu_read_lock(); 459535f861e3SJulian Wiedmann if (!br_ip_list || !netif_is_bridge_port(dev)) 459607f8ac4aSLinus Lüssing goto unlock; 459707f8ac4aSLinus Lüssing 459807f8ac4aSLinus Lüssing port = br_port_get_rcu(dev); 459907f8ac4aSLinus Lüssing if (!port || !port->br) 460007f8ac4aSLinus Lüssing goto unlock; 460107f8ac4aSLinus Lüssing 460207f8ac4aSLinus Lüssing br = port->br; 460307f8ac4aSLinus Lüssing 460407f8ac4aSLinus Lüssing list_for_each_entry_rcu(port, &br->port_list, list) { 460507f8ac4aSLinus Lüssing if (!port->dev || port->dev == dev) 460607f8ac4aSLinus Lüssing continue; 460707f8ac4aSLinus Lüssing 460807f8ac4aSLinus Lüssing hlist_for_each_entry_rcu(group, &port->mglist, mglist) { 460907f8ac4aSLinus Lüssing entry = kmalloc(sizeof(*entry), GFP_ATOMIC); 461007f8ac4aSLinus Lüssing if (!entry) 461107f8ac4aSLinus Lüssing goto unlock; 461207f8ac4aSLinus Lüssing 4613085b53c8SNikolay Aleksandrov entry->addr = group->key.addr; 461407f8ac4aSLinus Lüssing list_add(&entry->list, br_ip_list); 461507f8ac4aSLinus Lüssing count++; 461607f8ac4aSLinus Lüssing } 461707f8ac4aSLinus Lüssing } 461807f8ac4aSLinus Lüssing 461907f8ac4aSLinus Lüssing unlock: 462007f8ac4aSLinus Lüssing rcu_read_unlock(); 462107f8ac4aSLinus Lüssing return count; 462207f8ac4aSLinus Lüssing } 462307f8ac4aSLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_list_adjacent); 46242cd41431SLinus Lüssing 46252cd41431SLinus Lüssing /** 4626c34963e2SLinus Lüssing * br_multicast_has_querier_anywhere - Checks for a querier on a bridge 4627c34963e2SLinus Lüssing * @dev: The bridge port providing the bridge on which to check for a querier 4628c34963e2SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 4629c34963e2SLinus Lüssing * 4630c34963e2SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 4631c34963e2SLinus Lüssing * true if a valid querier exists anywhere on the bridged link layer. 4632c34963e2SLinus Lüssing * Otherwise returns false. 4633c34963e2SLinus Lüssing */ 4634c34963e2SLinus Lüssing bool br_multicast_has_querier_anywhere(struct net_device *dev, int proto) 4635c34963e2SLinus Lüssing { 4636c34963e2SLinus Lüssing struct net_bridge *br; 4637c34963e2SLinus Lüssing struct net_bridge_port *port; 4638c34963e2SLinus Lüssing struct ethhdr eth; 4639c34963e2SLinus Lüssing bool ret = false; 4640c34963e2SLinus Lüssing 4641c34963e2SLinus Lüssing rcu_read_lock(); 464235f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 4643c34963e2SLinus Lüssing goto unlock; 4644c34963e2SLinus Lüssing 4645c34963e2SLinus Lüssing port = br_port_get_rcu(dev); 4646c34963e2SLinus Lüssing if (!port || !port->br) 4647c34963e2SLinus Lüssing goto unlock; 4648c34963e2SLinus Lüssing 4649c34963e2SLinus Lüssing br = port->br; 4650c34963e2SLinus Lüssing 4651c34963e2SLinus Lüssing memset(ð, 0, sizeof(eth)); 4652c34963e2SLinus Lüssing eth.h_proto = htons(proto); 4653c34963e2SLinus Lüssing 4654adc47037SNikolay Aleksandrov ret = br_multicast_querier_exists(&br->multicast_ctx, ð, NULL); 4655c34963e2SLinus Lüssing 4656c34963e2SLinus Lüssing unlock: 4657c34963e2SLinus Lüssing rcu_read_unlock(); 4658c34963e2SLinus Lüssing return ret; 4659c34963e2SLinus Lüssing } 4660c34963e2SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_anywhere); 4661c34963e2SLinus Lüssing 4662c34963e2SLinus Lüssing /** 46632cd41431SLinus Lüssing * br_multicast_has_querier_adjacent - Checks for a querier behind a bridge port 46642cd41431SLinus Lüssing * @dev: The bridge port adjacent to which to check for a querier 46652cd41431SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 46662cd41431SLinus Lüssing * 46672cd41431SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 46682cd41431SLinus Lüssing * true if a selected querier is behind one of the other ports of this 46692cd41431SLinus Lüssing * bridge. Otherwise returns false. 46702cd41431SLinus Lüssing */ 46712cd41431SLinus Lüssing bool br_multicast_has_querier_adjacent(struct net_device *dev, int proto) 46722cd41431SLinus Lüssing { 4673d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 46742cd41431SLinus Lüssing struct net_bridge *br; 46752cd41431SLinus Lüssing struct net_bridge_port *port; 46762cd41431SLinus Lüssing bool ret = false; 4677bb18ef8eSNikolay Aleksandrov int port_ifidx; 46782cd41431SLinus Lüssing 46792cd41431SLinus Lüssing rcu_read_lock(); 468035f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 46812cd41431SLinus Lüssing goto unlock; 46822cd41431SLinus Lüssing 46832cd41431SLinus Lüssing port = br_port_get_rcu(dev); 46842cd41431SLinus Lüssing if (!port || !port->br) 46852cd41431SLinus Lüssing goto unlock; 46862cd41431SLinus Lüssing 46872cd41431SLinus Lüssing br = port->br; 4688d3d065c0SNikolay Aleksandrov brmctx = &br->multicast_ctx; 46892cd41431SLinus Lüssing 46902cd41431SLinus Lüssing switch (proto) { 46912cd41431SLinus Lüssing case ETH_P_IP: 4692bb18ef8eSNikolay Aleksandrov port_ifidx = brmctx->ip4_querier.port_ifidx; 4693d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip4_other_query.timer) || 4694bb18ef8eSNikolay Aleksandrov port_ifidx == port->dev->ifindex) 46952cd41431SLinus Lüssing goto unlock; 46962cd41431SLinus Lüssing break; 46973993c4e1SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 46982cd41431SLinus Lüssing case ETH_P_IPV6: 4699bb18ef8eSNikolay Aleksandrov port_ifidx = brmctx->ip6_querier.port_ifidx; 4700d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip6_other_query.timer) || 4701bb18ef8eSNikolay Aleksandrov port_ifidx == port->dev->ifindex) 47022cd41431SLinus Lüssing goto unlock; 47032cd41431SLinus Lüssing break; 47043993c4e1SLinus Lüssing #endif 47052cd41431SLinus Lüssing default: 47062cd41431SLinus Lüssing goto unlock; 47072cd41431SLinus Lüssing } 47082cd41431SLinus Lüssing 47092cd41431SLinus Lüssing ret = true; 47102cd41431SLinus Lüssing unlock: 47112cd41431SLinus Lüssing rcu_read_unlock(); 47122cd41431SLinus Lüssing return ret; 47132cd41431SLinus Lüssing } 47142cd41431SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_adjacent); 47151080ab95SNikolay Aleksandrov 47163b85f9baSLinus Lüssing /** 47173b85f9baSLinus Lüssing * br_multicast_has_router_adjacent - Checks for a router behind a bridge port 47183b85f9baSLinus Lüssing * @dev: The bridge port adjacent to which to check for a multicast router 47193b85f9baSLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 47203b85f9baSLinus Lüssing * 47213b85f9baSLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 47223b85f9baSLinus Lüssing * true if a multicast router is behind one of the other ports of this 47233b85f9baSLinus Lüssing * bridge. Otherwise returns false. 47243b85f9baSLinus Lüssing */ 47253b85f9baSLinus Lüssing bool br_multicast_has_router_adjacent(struct net_device *dev, int proto) 47263b85f9baSLinus Lüssing { 47279632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 4728d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 47299632233eSNikolay Aleksandrov struct net_bridge_port *port; 47303b85f9baSLinus Lüssing bool ret = false; 47313b85f9baSLinus Lüssing 47323b85f9baSLinus Lüssing rcu_read_lock(); 47333b85f9baSLinus Lüssing port = br_port_get_check_rcu(dev); 47343b85f9baSLinus Lüssing if (!port) 47353b85f9baSLinus Lüssing goto unlock; 47363b85f9baSLinus Lüssing 4737d3d065c0SNikolay Aleksandrov brmctx = &port->br->multicast_ctx; 47383b85f9baSLinus Lüssing switch (proto) { 47393b85f9baSLinus Lüssing case ETH_P_IP: 4740d3d065c0SNikolay Aleksandrov hlist_for_each_entry_rcu(pmctx, &brmctx->ip4_mc_router_list, 47413b85f9baSLinus Lüssing ip4_rlist) { 47429632233eSNikolay Aleksandrov if (pmctx->port == port) 47433b85f9baSLinus Lüssing continue; 47443b85f9baSLinus Lüssing 47453b85f9baSLinus Lüssing ret = true; 47463b85f9baSLinus Lüssing goto unlock; 47473b85f9baSLinus Lüssing } 47483b85f9baSLinus Lüssing break; 47493b85f9baSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 47503b85f9baSLinus Lüssing case ETH_P_IPV6: 4751d3d065c0SNikolay Aleksandrov hlist_for_each_entry_rcu(pmctx, &brmctx->ip6_mc_router_list, 47523b85f9baSLinus Lüssing ip6_rlist) { 47539632233eSNikolay Aleksandrov if (pmctx->port == port) 47543b85f9baSLinus Lüssing continue; 47553b85f9baSLinus Lüssing 47563b85f9baSLinus Lüssing ret = true; 47573b85f9baSLinus Lüssing goto unlock; 47583b85f9baSLinus Lüssing } 47593b85f9baSLinus Lüssing break; 47603b85f9baSLinus Lüssing #endif 47613b85f9baSLinus Lüssing default: 47623b85f9baSLinus Lüssing /* when compiled without IPv6 support, be conservative and 47633b85f9baSLinus Lüssing * always assume presence of an IPv6 multicast router 47643b85f9baSLinus Lüssing */ 47653b85f9baSLinus Lüssing ret = true; 47663b85f9baSLinus Lüssing } 47673b85f9baSLinus Lüssing 47683b85f9baSLinus Lüssing unlock: 47693b85f9baSLinus Lüssing rcu_read_unlock(); 47703b85f9baSLinus Lüssing return ret; 47713b85f9baSLinus Lüssing } 47723b85f9baSLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_router_adjacent); 47733b85f9baSLinus Lüssing 47741080ab95SNikolay Aleksandrov static void br_mcast_stats_add(struct bridge_mcast_stats __percpu *stats, 4775a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 47761080ab95SNikolay Aleksandrov { 47771080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats = this_cpu_ptr(stats); 4778a65056ecSNikolay Aleksandrov __be16 proto = skb->protocol; 4779a65056ecSNikolay Aleksandrov unsigned int t_len; 47801080ab95SNikolay Aleksandrov 47811080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 47821080ab95SNikolay Aleksandrov switch (proto) { 47831080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 4784a65056ecSNikolay Aleksandrov t_len = ntohs(ip_hdr(skb)->tot_len) - ip_hdrlen(skb); 47851080ab95SNikolay Aleksandrov switch (type) { 47861080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_REPORT: 47871080ab95SNikolay Aleksandrov pstats->mstats.igmp_v1reports[dir]++; 47881080ab95SNikolay Aleksandrov break; 47891080ab95SNikolay Aleksandrov case IGMPV2_HOST_MEMBERSHIP_REPORT: 47901080ab95SNikolay Aleksandrov pstats->mstats.igmp_v2reports[dir]++; 47911080ab95SNikolay Aleksandrov break; 47921080ab95SNikolay Aleksandrov case IGMPV3_HOST_MEMBERSHIP_REPORT: 47931080ab95SNikolay Aleksandrov pstats->mstats.igmp_v3reports[dir]++; 47941080ab95SNikolay Aleksandrov break; 47951080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_QUERY: 4796a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct igmphdr)) { 4797a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v3queries[dir]++; 4798a65056ecSNikolay Aleksandrov } else { 4799a65056ecSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 4800a65056ecSNikolay Aleksandrov struct igmphdr *ih, _ihdr; 4801a65056ecSNikolay Aleksandrov 4802a65056ecSNikolay Aleksandrov ih = skb_header_pointer(skb, offset, 4803a65056ecSNikolay Aleksandrov sizeof(_ihdr), &_ihdr); 4804a65056ecSNikolay Aleksandrov if (!ih) 4805a65056ecSNikolay Aleksandrov break; 4806a65056ecSNikolay Aleksandrov if (!ih->code) 4807a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v1queries[dir]++; 4808a65056ecSNikolay Aleksandrov else 4809a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v2queries[dir]++; 4810a65056ecSNikolay Aleksandrov } 48111080ab95SNikolay Aleksandrov break; 48121080ab95SNikolay Aleksandrov case IGMP_HOST_LEAVE_MESSAGE: 48131080ab95SNikolay Aleksandrov pstats->mstats.igmp_leaves[dir]++; 48141080ab95SNikolay Aleksandrov break; 48151080ab95SNikolay Aleksandrov } 48161080ab95SNikolay Aleksandrov break; 48171080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 48181080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 4819a65056ecSNikolay Aleksandrov t_len = ntohs(ipv6_hdr(skb)->payload_len) + 4820a65056ecSNikolay Aleksandrov sizeof(struct ipv6hdr); 4821a65056ecSNikolay Aleksandrov t_len -= skb_network_header_len(skb); 48221080ab95SNikolay Aleksandrov switch (type) { 48231080ab95SNikolay Aleksandrov case ICMPV6_MGM_REPORT: 48241080ab95SNikolay Aleksandrov pstats->mstats.mld_v1reports[dir]++; 48251080ab95SNikolay Aleksandrov break; 48261080ab95SNikolay Aleksandrov case ICMPV6_MLD2_REPORT: 48271080ab95SNikolay Aleksandrov pstats->mstats.mld_v2reports[dir]++; 48281080ab95SNikolay Aleksandrov break; 48291080ab95SNikolay Aleksandrov case ICMPV6_MGM_QUERY: 4830a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct mld_msg)) 4831a65056ecSNikolay Aleksandrov pstats->mstats.mld_v2queries[dir]++; 4832a65056ecSNikolay Aleksandrov else 4833a65056ecSNikolay Aleksandrov pstats->mstats.mld_v1queries[dir]++; 48341080ab95SNikolay Aleksandrov break; 48351080ab95SNikolay Aleksandrov case ICMPV6_MGM_REDUCTION: 48361080ab95SNikolay Aleksandrov pstats->mstats.mld_leaves[dir]++; 48371080ab95SNikolay Aleksandrov break; 48381080ab95SNikolay Aleksandrov } 48391080ab95SNikolay Aleksandrov break; 48401080ab95SNikolay Aleksandrov #endif /* CONFIG_IPV6 */ 48411080ab95SNikolay Aleksandrov } 48421080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 48431080ab95SNikolay Aleksandrov } 48441080ab95SNikolay Aleksandrov 4845adc47037SNikolay Aleksandrov void br_multicast_count(struct net_bridge *br, 4846adc47037SNikolay Aleksandrov const struct net_bridge_port *p, 4847a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 48481080ab95SNikolay Aleksandrov { 48491080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 48501080ab95SNikolay Aleksandrov 48511080ab95SNikolay Aleksandrov /* if multicast_disabled is true then igmp type can't be set */ 4852675779adSNikolay Aleksandrov if (!type || !br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 48531080ab95SNikolay Aleksandrov return; 48541080ab95SNikolay Aleksandrov 48551080ab95SNikolay Aleksandrov if (p) 48561080ab95SNikolay Aleksandrov stats = p->mcast_stats; 48571080ab95SNikolay Aleksandrov else 48581080ab95SNikolay Aleksandrov stats = br->mcast_stats; 48591080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 48601080ab95SNikolay Aleksandrov return; 48611080ab95SNikolay Aleksandrov 4862a65056ecSNikolay Aleksandrov br_mcast_stats_add(stats, skb, type, dir); 48631080ab95SNikolay Aleksandrov } 48641080ab95SNikolay Aleksandrov 48651080ab95SNikolay Aleksandrov int br_multicast_init_stats(struct net_bridge *br) 48661080ab95SNikolay Aleksandrov { 48671080ab95SNikolay Aleksandrov br->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 48681080ab95SNikolay Aleksandrov if (!br->mcast_stats) 48691080ab95SNikolay Aleksandrov return -ENOMEM; 48701080ab95SNikolay Aleksandrov 48711080ab95SNikolay Aleksandrov return 0; 48721080ab95SNikolay Aleksandrov } 48731080ab95SNikolay Aleksandrov 4874b6fe0440SIdo Schimmel void br_multicast_uninit_stats(struct net_bridge *br) 4875b6fe0440SIdo Schimmel { 4876b6fe0440SIdo Schimmel free_percpu(br->mcast_stats); 4877b6fe0440SIdo Schimmel } 4878b6fe0440SIdo Schimmel 4879b3b6a84cSArnd Bergmann /* noinline for https://bugs.llvm.org/show_bug.cgi?id=45802#c9 */ 4880b3b6a84cSArnd Bergmann static noinline_for_stack void mcast_stats_add_dir(u64 *dst, u64 *src) 48811080ab95SNikolay Aleksandrov { 48821080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_RX] += src[BR_MCAST_DIR_RX]; 48831080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_TX] += src[BR_MCAST_DIR_TX]; 48841080ab95SNikolay Aleksandrov } 48851080ab95SNikolay Aleksandrov 48861080ab95SNikolay Aleksandrov void br_multicast_get_stats(const struct net_bridge *br, 48871080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 48881080ab95SNikolay Aleksandrov struct br_mcast_stats *dest) 48891080ab95SNikolay Aleksandrov { 48901080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 48911080ab95SNikolay Aleksandrov struct br_mcast_stats tdst; 48921080ab95SNikolay Aleksandrov int i; 48931080ab95SNikolay Aleksandrov 48941080ab95SNikolay Aleksandrov memset(dest, 0, sizeof(*dest)); 48951080ab95SNikolay Aleksandrov if (p) 48961080ab95SNikolay Aleksandrov stats = p->mcast_stats; 48971080ab95SNikolay Aleksandrov else 48981080ab95SNikolay Aleksandrov stats = br->mcast_stats; 48991080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 49001080ab95SNikolay Aleksandrov return; 49011080ab95SNikolay Aleksandrov 49021080ab95SNikolay Aleksandrov memset(&tdst, 0, sizeof(tdst)); 49031080ab95SNikolay Aleksandrov for_each_possible_cpu(i) { 49041080ab95SNikolay Aleksandrov struct bridge_mcast_stats *cpu_stats = per_cpu_ptr(stats, i); 49051080ab95SNikolay Aleksandrov struct br_mcast_stats temp; 49061080ab95SNikolay Aleksandrov unsigned int start; 49071080ab95SNikolay Aleksandrov 49081080ab95SNikolay Aleksandrov do { 4909d120d1a6SThomas Gleixner start = u64_stats_fetch_begin(&cpu_stats->syncp); 49101080ab95SNikolay Aleksandrov memcpy(&temp, &cpu_stats->mstats, sizeof(temp)); 4911d120d1a6SThomas Gleixner } while (u64_stats_fetch_retry(&cpu_stats->syncp, start)); 49121080ab95SNikolay Aleksandrov 4913a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1queries, temp.igmp_v1queries); 4914a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2queries, temp.igmp_v2queries); 4915a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3queries, temp.igmp_v3queries); 49161080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_leaves, temp.igmp_leaves); 49171080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1reports, temp.igmp_v1reports); 49181080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2reports, temp.igmp_v2reports); 49191080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3reports, temp.igmp_v3reports); 49201080ab95SNikolay Aleksandrov tdst.igmp_parse_errors += temp.igmp_parse_errors; 49211080ab95SNikolay Aleksandrov 4922a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1queries, temp.mld_v1queries); 4923a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2queries, temp.mld_v2queries); 49241080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_leaves, temp.mld_leaves); 49251080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1reports, temp.mld_v1reports); 49261080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2reports, temp.mld_v2reports); 49271080ab95SNikolay Aleksandrov tdst.mld_parse_errors += temp.mld_parse_errors; 49281080ab95SNikolay Aleksandrov } 49291080ab95SNikolay Aleksandrov memcpy(dest, &tdst, sizeof(*dest)); 49301080ab95SNikolay Aleksandrov } 493119e3a9c9SNikolay Aleksandrov 493219e3a9c9SNikolay Aleksandrov int br_mdb_hash_init(struct net_bridge *br) 493319e3a9c9SNikolay Aleksandrov { 4934085b53c8SNikolay Aleksandrov int err; 4935085b53c8SNikolay Aleksandrov 4936085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->sg_port_tbl, &br_sg_port_rht_params); 4937085b53c8SNikolay Aleksandrov if (err) 4938085b53c8SNikolay Aleksandrov return err; 4939085b53c8SNikolay Aleksandrov 4940085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->mdb_hash_tbl, &br_mdb_rht_params); 4941085b53c8SNikolay Aleksandrov if (err) { 4942085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 4943085b53c8SNikolay Aleksandrov return err; 4944085b53c8SNikolay Aleksandrov } 4945085b53c8SNikolay Aleksandrov 4946085b53c8SNikolay Aleksandrov return 0; 494719e3a9c9SNikolay Aleksandrov } 494819e3a9c9SNikolay Aleksandrov 494919e3a9c9SNikolay Aleksandrov void br_mdb_hash_fini(struct net_bridge *br) 495019e3a9c9SNikolay Aleksandrov { 4951085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 495219e3a9c9SNikolay Aleksandrov rhashtable_destroy(&br->mdb_hash_tbl); 495319e3a9c9SNikolay Aleksandrov } 4954