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 && 555*a01ecb17SIdo Schimmel (p->flags & MDB_PG_FLAGS_PERMANENT) && 556*a01ecb17SIdo 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 609e12cec65SNikolay Aleksandrov del_timer_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 650e12cec65SNikolay Aleksandrov del_timer_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 679e12cec65SNikolay Aleksandrov del_timer_sync(&pg->rexmit_timer); 680e12cec65SNikolay Aleksandrov del_timer_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, 12878f8cb77eSNikolay Aleksandrov u8 rt_protocol) 1288cfd56754SCong Wang { 1289cfd56754SCong Wang struct net_bridge_port_group *p; 1290cfd56754SCong Wang 1291cfd56754SCong Wang p = kzalloc(sizeof(*p), GFP_ATOMIC); 1292cfd56754SCong Wang if (unlikely(!p)) 1293cfd56754SCong Wang return NULL; 1294cfd56754SCong Wang 1295085b53c8SNikolay Aleksandrov p->key.addr = *group; 1296085b53c8SNikolay Aleksandrov p->key.port = port; 12979d06b6d8SElad Raz p->flags = flags; 12988b671779SNikolay Aleksandrov p->filter_mode = filter_mode; 12998f8cb77eSNikolay Aleksandrov p->rt_protocol = rt_protocol; 13005b163288SNikolay Aleksandrov p->eht_host_tree = RB_ROOT; 1301baa74d39SNikolay Aleksandrov p->eht_set_tree = RB_ROOT; 1302e12cec65SNikolay Aleksandrov p->mcast_gc.destroy = br_multicast_destroy_port_group; 13038b671779SNikolay Aleksandrov INIT_HLIST_HEAD(&p->src_list); 1304085b53c8SNikolay Aleksandrov 1305085b53c8SNikolay Aleksandrov if (!br_multicast_is_star_g(group) && 1306085b53c8SNikolay Aleksandrov rhashtable_lookup_insert_fast(&port->br->sg_port_tbl, &p->rhnode, 1307085b53c8SNikolay Aleksandrov br_sg_port_rht_params)) { 1308085b53c8SNikolay Aleksandrov kfree(p); 1309085b53c8SNikolay Aleksandrov return NULL; 1310085b53c8SNikolay Aleksandrov } 1311085b53c8SNikolay Aleksandrov 1312eca2a43bSstephen hemminger rcu_assign_pointer(p->next, next); 131388c1f37fSAllen Pais timer_setup(&p->timer, br_multicast_port_group_expired, 0); 131442c11ccfSNikolay Aleksandrov timer_setup(&p->rexmit_timer, br_multicast_port_group_rexmit, 0); 131542c11ccfSNikolay Aleksandrov hlist_add_head(&p->mglist, &port->mglist); 13166db6f0eaSFelix Fietkau 13176db6f0eaSFelix Fietkau if (src) 13186db6f0eaSFelix Fietkau memcpy(p->eth_addr, src, ETH_ALEN); 13196db6f0eaSFelix Fietkau else 13201bfe45f4SMao Wenan eth_broadcast_addr(p->eth_addr); 13216db6f0eaSFelix Fietkau 1322cfd56754SCong Wang return p; 1323cfd56754SCong Wang } 1324cfd56754SCong Wang 132558d913a3SNikolay Aleksandrov void br_multicast_host_join(const struct net_bridge_mcast *brmctx, 132658d913a3SNikolay Aleksandrov struct net_bridge_mdb_entry *mp, bool notify) 13271bc844eeSNikolay Aleksandrov { 13281bc844eeSNikolay Aleksandrov if (!mp->host_joined) { 13291bc844eeSNikolay Aleksandrov mp->host_joined = true; 1330094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1331094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 13321bc844eeSNikolay Aleksandrov if (notify) 133381f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_NEWMDB); 13341bc844eeSNikolay Aleksandrov } 1335955062b0SNikolay Aleksandrov 1336955062b0SNikolay Aleksandrov if (br_group_is_l2(&mp->addr)) 1337955062b0SNikolay Aleksandrov return; 1338955062b0SNikolay Aleksandrov 133958d913a3SNikolay Aleksandrov mod_timer(&mp->timer, jiffies + brmctx->multicast_membership_interval); 13401bc844eeSNikolay Aleksandrov } 13411bc844eeSNikolay Aleksandrov 13421bc844eeSNikolay Aleksandrov void br_multicast_host_leave(struct net_bridge_mdb_entry *mp, bool notify) 13431bc844eeSNikolay Aleksandrov { 13441bc844eeSNikolay Aleksandrov if (!mp->host_joined) 13451bc844eeSNikolay Aleksandrov return; 13461bc844eeSNikolay Aleksandrov 13471bc844eeSNikolay Aleksandrov mp->host_joined = false; 1348094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1349094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 13501bc844eeSNikolay Aleksandrov if (notify) 135181f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_DELMDB); 13521bc844eeSNikolay Aleksandrov } 13531bc844eeSNikolay Aleksandrov 1354b0812368SNikolay Aleksandrov static struct net_bridge_port_group * 1355adc47037SNikolay Aleksandrov __br_multicast_add_group(struct net_bridge_mcast *brmctx, 1356adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 13576db6f0eaSFelix Fietkau struct br_ip *group, 13588b671779SNikolay Aleksandrov const unsigned char *src, 13590436862eSNikolay Aleksandrov u8 filter_mode, 13609116ffbfSNikolay Aleksandrov bool igmpv2_mldv1, 13619116ffbfSNikolay Aleksandrov bool blocked) 1362eb1d1641SHerbert Xu { 1363e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 1364b0812368SNikolay Aleksandrov struct net_bridge_port_group *p = NULL; 13655e923585SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 1366454594f3SLinus Lüssing unsigned long now = jiffies; 1367eb1d1641SHerbert Xu 13684cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 1369eb1d1641SHerbert Xu goto out; 1370eb1d1641SHerbert Xu 1371adc47037SNikolay Aleksandrov mp = br_multicast_new_group(brmctx->br, group); 13724c0833bcSTobias Klauser if (IS_ERR(mp)) 13731697291dSXu Wang return ERR_CAST(mp); 1374eb1d1641SHerbert Xu 1375adc47037SNikolay Aleksandrov if (!pmctx) { 137658d913a3SNikolay Aleksandrov br_multicast_host_join(brmctx, mp, true); 1377eb1d1641SHerbert Xu goto out; 1378eb1d1641SHerbert Xu } 1379eb1d1641SHerbert Xu 1380e8051688SEric Dumazet for (pp = &mp->ports; 1381adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 1382e8051688SEric Dumazet pp = &p->next) { 1383adc47037SNikolay Aleksandrov if (br_port_group_equal(p, pmctx->port, src)) 1384454594f3SLinus Lüssing goto found; 1385adc47037SNikolay Aleksandrov if ((unsigned long)p->key.port < (unsigned long)pmctx->port) 1386eb1d1641SHerbert Xu break; 1387eb1d1641SHerbert Xu } 1388eb1d1641SHerbert Xu 1389adc47037SNikolay Aleksandrov p = br_multicast_new_port_group(pmctx->port, group, *pp, 0, src, 1390955062b0SNikolay Aleksandrov filter_mode, RTPROT_KERNEL); 1391b0812368SNikolay Aleksandrov if (unlikely(!p)) { 1392b0812368SNikolay Aleksandrov p = ERR_PTR(-ENOMEM); 1393b0812368SNikolay Aleksandrov goto out; 1394b0812368SNikolay Aleksandrov } 1395eb1d1641SHerbert Xu rcu_assign_pointer(*pp, p); 13969116ffbfSNikolay Aleksandrov if (blocked) 13979116ffbfSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_BLOCKED; 1398adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mp, p, RTM_NEWMDB); 1399eb1d1641SHerbert Xu 1400454594f3SLinus Lüssing found: 14010436862eSNikolay Aleksandrov if (igmpv2_mldv1) 1402d3d065c0SNikolay Aleksandrov mod_timer(&p->timer, 1403adc47037SNikolay Aleksandrov now + brmctx->multicast_membership_interval); 140481f19838SNikolay Aleksandrov 1405eb1d1641SHerbert Xu out: 1406b0812368SNikolay Aleksandrov return p; 1407b0812368SNikolay Aleksandrov } 1408eb1d1641SHerbert Xu 1409adc47037SNikolay Aleksandrov static int br_multicast_add_group(struct net_bridge_mcast *brmctx, 1410adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1411b0812368SNikolay Aleksandrov struct br_ip *group, 1412b0812368SNikolay Aleksandrov const unsigned char *src, 1413b0812368SNikolay Aleksandrov u8 filter_mode, 1414b0812368SNikolay Aleksandrov bool igmpv2_mldv1) 1415b0812368SNikolay Aleksandrov { 1416b0812368SNikolay Aleksandrov struct net_bridge_port_group *pg; 1417b0812368SNikolay Aleksandrov int err; 1418b0812368SNikolay Aleksandrov 1419adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1420adc47037SNikolay Aleksandrov pg = __br_multicast_add_group(brmctx, pmctx, group, src, filter_mode, 14219116ffbfSNikolay Aleksandrov igmpv2_mldv1, false); 1422b0812368SNikolay Aleksandrov /* NULL is considered valid for host joined groups */ 14238d21c882SJiapeng Zhong err = PTR_ERR_OR_ZERO(pg); 1424adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1425b0812368SNikolay Aleksandrov 1426eb1d1641SHerbert Xu return err; 1427eb1d1641SHerbert Xu } 1428eb1d1641SHerbert Xu 1429adc47037SNikolay Aleksandrov static int br_ip4_multicast_add_group(struct net_bridge_mcast *brmctx, 1430adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1431b0e9a30dSVlad Yasevich __be32 group, 14326db6f0eaSFelix Fietkau __u16 vid, 14338b671779SNikolay Aleksandrov const unsigned char *src, 14348b671779SNikolay Aleksandrov bool igmpv2) 14358ef2a9a5SYOSHIFUJI Hideaki { 14368ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 14378b671779SNikolay Aleksandrov u8 filter_mode; 14388ef2a9a5SYOSHIFUJI Hideaki 14398ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 14408ef2a9a5SYOSHIFUJI Hideaki return 0; 14418ef2a9a5SYOSHIFUJI Hideaki 14421515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1443eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 14448ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1445b0e9a30dSVlad Yasevich br_group.vid = vid; 14468b671779SNikolay Aleksandrov filter_mode = igmpv2 ? MCAST_EXCLUDE : MCAST_INCLUDE; 14478ef2a9a5SYOSHIFUJI Hideaki 1448adc47037SNikolay Aleksandrov return br_multicast_add_group(brmctx, pmctx, &br_group, src, 1449adc47037SNikolay Aleksandrov filter_mode, igmpv2); 14508ef2a9a5SYOSHIFUJI Hideaki } 14518ef2a9a5SYOSHIFUJI Hideaki 1452dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1453adc47037SNikolay Aleksandrov static int br_ip6_multicast_add_group(struct net_bridge_mcast *brmctx, 1454adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1455b0e9a30dSVlad Yasevich const struct in6_addr *group, 14566db6f0eaSFelix Fietkau __u16 vid, 14578b671779SNikolay Aleksandrov const unsigned char *src, 14588b671779SNikolay Aleksandrov bool mldv1) 145908b202b6SYOSHIFUJI Hideaki { 146008b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 14618b671779SNikolay Aleksandrov u8 filter_mode; 146208b202b6SYOSHIFUJI Hideaki 14633c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 146408b202b6SYOSHIFUJI Hideaki return 0; 146508b202b6SYOSHIFUJI Hideaki 146619e3a9c9SNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1467eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 14689cc6e0c4SLinus Lüssing br_group.proto = htons(ETH_P_IPV6); 1469b0e9a30dSVlad Yasevich br_group.vid = vid; 14708b671779SNikolay Aleksandrov filter_mode = mldv1 ? MCAST_EXCLUDE : MCAST_INCLUDE; 147108b202b6SYOSHIFUJI Hideaki 1472adc47037SNikolay Aleksandrov return br_multicast_add_group(brmctx, pmctx, &br_group, src, 1473adc47037SNikolay Aleksandrov filter_mode, mldv1); 147408b202b6SYOSHIFUJI Hideaki } 147508b202b6SYOSHIFUJI Hideaki #endif 147608b202b6SYOSHIFUJI Hideaki 1477ed2d3597SLinus Lüssing static bool br_multicast_rport_del(struct hlist_node *rlist) 1478ed2d3597SLinus Lüssing { 1479ed2d3597SLinus Lüssing if (hlist_unhashed(rlist)) 1480ed2d3597SLinus Lüssing return false; 1481ed2d3597SLinus Lüssing 1482ed2d3597SLinus Lüssing hlist_del_init_rcu(rlist); 1483ed2d3597SLinus Lüssing return true; 1484ed2d3597SLinus Lüssing } 1485ed2d3597SLinus Lüssing 1486adc47037SNikolay Aleksandrov static bool br_ip4_multicast_rport_del(struct net_bridge_mcast_port *pmctx) 1487ed2d3597SLinus Lüssing { 1488adc47037SNikolay Aleksandrov return br_multicast_rport_del(&pmctx->ip4_rlist); 1489ed2d3597SLinus Lüssing } 1490ed2d3597SLinus Lüssing 1491adc47037SNikolay Aleksandrov static bool br_ip6_multicast_rport_del(struct net_bridge_mcast_port *pmctx) 1492a3c02e76SLinus Lüssing { 1493a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1494adc47037SNikolay Aleksandrov return br_multicast_rport_del(&pmctx->ip6_rlist); 1495a3c02e76SLinus Lüssing #else 1496a3c02e76SLinus Lüssing return false; 1497a3c02e76SLinus Lüssing #endif 1498a3c02e76SLinus Lüssing } 1499a3c02e76SLinus Lüssing 15009632233eSNikolay Aleksandrov static void br_multicast_router_expired(struct net_bridge_mcast_port *pmctx, 1501ee5fb222SLinus Lüssing struct timer_list *t, 1502ee5fb222SLinus Lüssing struct hlist_node *rlist) 1503eb1d1641SHerbert Xu { 15049632233eSNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 1505ed2d3597SLinus Lüssing bool del; 1506eb1d1641SHerbert Xu 1507eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 15089632233eSNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 15099632233eSNikolay Aleksandrov pmctx->multicast_router == MDB_RTR_TYPE_PERM || 1510ee5fb222SLinus Lüssing timer_pending(t)) 1511eb1d1641SHerbert Xu goto out; 1512eb1d1641SHerbert Xu 1513ed2d3597SLinus Lüssing del = br_multicast_rport_del(rlist); 1514adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 1515eb1d1641SHerbert Xu out: 1516eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1517eb1d1641SHerbert Xu } 1518eb1d1641SHerbert Xu 1519ee5fb222SLinus Lüssing static void br_ip4_multicast_router_expired(struct timer_list *t) 1520ee5fb222SLinus Lüssing { 15219632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 15229632233eSNikolay Aleksandrov ip4_mc_router_timer); 1523ee5fb222SLinus Lüssing 15249632233eSNikolay Aleksandrov br_multicast_router_expired(pmctx, t, &pmctx->ip4_rlist); 1525ee5fb222SLinus Lüssing } 1526ee5fb222SLinus Lüssing 1527a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1528a3c02e76SLinus Lüssing static void br_ip6_multicast_router_expired(struct timer_list *t) 1529a3c02e76SLinus Lüssing { 15309632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 15319632233eSNikolay Aleksandrov ip6_mc_router_timer); 1532a3c02e76SLinus Lüssing 15339632233eSNikolay Aleksandrov br_multicast_router_expired(pmctx, t, &pmctx->ip6_rlist); 1534a3c02e76SLinus Lüssing } 1535a3c02e76SLinus Lüssing #endif 1536a3c02e76SLinus Lüssing 153777041420SYotam Gigi static void br_mc_router_state_change(struct net_bridge *p, 153877041420SYotam Gigi bool is_mc_router) 153977041420SYotam Gigi { 154077041420SYotam Gigi struct switchdev_attr attr = { 154177041420SYotam Gigi .orig_dev = p->dev, 154277041420SYotam Gigi .id = SWITCHDEV_ATTR_ID_BRIDGE_MROUTER, 154377041420SYotam Gigi .flags = SWITCHDEV_F_DEFER, 154477041420SYotam Gigi .u.mrouter = is_mc_router, 154577041420SYotam Gigi }; 154677041420SYotam Gigi 1547dcbdf135SVladimir Oltean switchdev_port_attr_set(p->dev, &attr, NULL); 154877041420SYotam Gigi } 154977041420SYotam Gigi 1550d3d065c0SNikolay Aleksandrov static void br_multicast_local_router_expired(struct net_bridge_mcast *brmctx, 1551ee5fb222SLinus Lüssing struct timer_list *timer) 1552eb1d1641SHerbert Xu { 1553d3d065c0SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1554d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 1555d3d065c0SNikolay Aleksandrov brmctx->multicast_router == MDB_RTR_TYPE_PERM || 1556d3d065c0SNikolay Aleksandrov br_ip4_multicast_is_router(brmctx) || 1557d3d065c0SNikolay Aleksandrov br_ip6_multicast_is_router(brmctx)) 155877041420SYotam Gigi goto out; 155977041420SYotam Gigi 1560d3d065c0SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, false); 156177041420SYotam Gigi out: 1562d3d065c0SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1563eb1d1641SHerbert Xu } 1564eb1d1641SHerbert Xu 1565ee5fb222SLinus Lüssing static void br_ip4_multicast_local_router_expired(struct timer_list *t) 1566ee5fb222SLinus Lüssing { 1567d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1568d3d065c0SNikolay Aleksandrov ip4_mc_router_timer); 1569ee5fb222SLinus Lüssing 1570d3d065c0SNikolay Aleksandrov br_multicast_local_router_expired(brmctx, t); 1571ee5fb222SLinus Lüssing } 1572ee5fb222SLinus Lüssing 1573a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1574a3c02e76SLinus Lüssing static void br_ip6_multicast_local_router_expired(struct timer_list *t) 1575a3c02e76SLinus Lüssing { 1576d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1577d3d065c0SNikolay Aleksandrov ip6_mc_router_timer); 1578a3c02e76SLinus Lüssing 1579d3d065c0SNikolay Aleksandrov br_multicast_local_router_expired(brmctx, t); 1580a3c02e76SLinus Lüssing } 1581a3c02e76SLinus Lüssing #endif 1582a3c02e76SLinus Lüssing 1583d3d065c0SNikolay Aleksandrov static void br_multicast_querier_expired(struct net_bridge_mcast *brmctx, 158490010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1585c83b8fabSHerbert Xu { 1586d3d065c0SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1587d3d065c0SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 15884cdd0d10SNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(brmctx) || 1589d3d065c0SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 1590c83b8fabSHerbert Xu goto out; 1591c83b8fabSHerbert Xu 1592adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, query); 1593c83b8fabSHerbert Xu 1594c83b8fabSHerbert Xu out: 1595d3d065c0SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1596c83b8fabSHerbert Xu } 1597c83b8fabSHerbert Xu 159888c1f37fSAllen Pais static void br_ip4_multicast_querier_expired(struct timer_list *t) 1599cc0fdd80SLinus Lüssing { 1600d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1601d3d065c0SNikolay Aleksandrov ip4_other_query.timer); 1602cc0fdd80SLinus Lüssing 1603d3d065c0SNikolay Aleksandrov br_multicast_querier_expired(brmctx, &brmctx->ip4_own_query); 1604cc0fdd80SLinus Lüssing } 1605cc0fdd80SLinus Lüssing 1606cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 160788c1f37fSAllen Pais static void br_ip6_multicast_querier_expired(struct timer_list *t) 1608cc0fdd80SLinus Lüssing { 1609d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1610d3d065c0SNikolay Aleksandrov ip6_other_query.timer); 1611cc0fdd80SLinus Lüssing 1612d3d065c0SNikolay Aleksandrov br_multicast_querier_expired(brmctx, &brmctx->ip6_own_query); 1613cc0fdd80SLinus Lüssing } 1614cc0fdd80SLinus Lüssing #endif 1615cc0fdd80SLinus Lüssing 1616adc47037SNikolay Aleksandrov static void br_multicast_select_own_querier(struct net_bridge_mcast *brmctx, 1617dc4eb53aSLinus Lüssing struct br_ip *ip, 1618dc4eb53aSLinus Lüssing struct sk_buff *skb) 1619dc4eb53aSLinus Lüssing { 1620dc4eb53aSLinus Lüssing if (ip->proto == htons(ETH_P_IP)) 1621d3d065c0SNikolay Aleksandrov brmctx->ip4_querier.addr.src.ip4 = ip_hdr(skb)->saddr; 1622dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1623dc4eb53aSLinus Lüssing else 1624d3d065c0SNikolay Aleksandrov brmctx->ip6_querier.addr.src.ip6 = ipv6_hdr(skb)->saddr; 1625dc4eb53aSLinus Lüssing #endif 1626dc4eb53aSLinus Lüssing } 1627dc4eb53aSLinus Lüssing 1628adc47037SNikolay Aleksandrov static void __br_multicast_send_query(struct net_bridge_mcast *brmctx, 1629adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1630438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 1631438ef2d0SNikolay Aleksandrov struct br_ip *ip_dst, 1632438ef2d0SNikolay Aleksandrov struct br_ip *group, 1633438ef2d0SNikolay Aleksandrov bool with_srcs, 163442c11ccfSNikolay Aleksandrov u8 sflag, 163542c11ccfSNikolay Aleksandrov bool *need_rexmit) 1636eb1d1641SHerbert Xu { 1637438ef2d0SNikolay Aleksandrov bool over_lmqt = !!sflag; 1638eb1d1641SHerbert Xu struct sk_buff *skb; 16391080ab95SNikolay Aleksandrov u8 igmp_type; 1640eb1d1641SHerbert Xu 1641cb486ce9SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx) || 1642cb486ce9SNikolay Aleksandrov !br_multicast_ctx_matches_vlan_snooping(brmctx)) 1643615cc23eSNikolay Aleksandrov return; 1644615cc23eSNikolay Aleksandrov 1645438ef2d0SNikolay Aleksandrov again_under_lmqt: 1646615cc23eSNikolay Aleksandrov skb = br_multicast_alloc_query(brmctx, pmctx, pg, ip_dst, group, 1647615cc23eSNikolay Aleksandrov with_srcs, over_lmqt, sflag, &igmp_type, 164842c11ccfSNikolay Aleksandrov need_rexmit); 1649eb1d1641SHerbert Xu if (!skb) 16508ef2a9a5SYOSHIFUJI Hideaki return; 1651eb1d1641SHerbert Xu 1652adc47037SNikolay Aleksandrov if (pmctx) { 1653adc47037SNikolay Aleksandrov skb->dev = pmctx->port->dev; 1654adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, pmctx->port, skb, igmp_type, 16551080ab95SNikolay Aleksandrov BR_MCAST_DIR_TX); 165629a26a56SEric W. Biederman NF_HOOK(NFPROTO_BRIDGE, NF_BR_LOCAL_OUT, 1657adc47037SNikolay Aleksandrov dev_net(pmctx->port->dev), NULL, skb, NULL, skb->dev, 1658f0b4eeceSLinus Lüssing br_dev_queue_push_xmit); 1659438ef2d0SNikolay Aleksandrov 1660438ef2d0SNikolay Aleksandrov if (over_lmqt && with_srcs && sflag) { 1661438ef2d0SNikolay Aleksandrov over_lmqt = false; 1662438ef2d0SNikolay Aleksandrov goto again_under_lmqt; 1663438ef2d0SNikolay Aleksandrov } 1664dc4eb53aSLinus Lüssing } else { 1665adc47037SNikolay Aleksandrov br_multicast_select_own_querier(brmctx, group, skb); 1666adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, NULL, skb, igmp_type, 16671080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 1668eb1d1641SHerbert Xu netif_rx(skb); 16698ef2a9a5SYOSHIFUJI Hideaki } 1670dc4eb53aSLinus Lüssing } 1671eb1d1641SHerbert Xu 167267b746f9SNikolay Aleksandrov static void br_multicast_read_querier(const struct bridge_mcast_querier *querier, 167367b746f9SNikolay Aleksandrov struct bridge_mcast_querier *dest) 167467b746f9SNikolay Aleksandrov { 167567b746f9SNikolay Aleksandrov unsigned int seq; 167667b746f9SNikolay Aleksandrov 167767b746f9SNikolay Aleksandrov memset(dest, 0, sizeof(*dest)); 167867b746f9SNikolay Aleksandrov do { 167967b746f9SNikolay Aleksandrov seq = read_seqcount_begin(&querier->seq); 168067b746f9SNikolay Aleksandrov dest->port_ifidx = querier->port_ifidx; 168167b746f9SNikolay Aleksandrov memcpy(&dest->addr, &querier->addr, sizeof(struct br_ip)); 168267b746f9SNikolay Aleksandrov } while (read_seqcount_retry(&querier->seq, seq)); 168367b746f9SNikolay Aleksandrov } 168467b746f9SNikolay Aleksandrov 168567b746f9SNikolay Aleksandrov static void br_multicast_update_querier(struct net_bridge_mcast *brmctx, 168667b746f9SNikolay Aleksandrov struct bridge_mcast_querier *querier, 168767b746f9SNikolay Aleksandrov int ifindex, 168867b746f9SNikolay Aleksandrov struct br_ip *saddr) 168967b746f9SNikolay Aleksandrov { 169067b746f9SNikolay Aleksandrov write_seqcount_begin(&querier->seq); 169167b746f9SNikolay Aleksandrov querier->port_ifidx = ifindex; 169267b746f9SNikolay Aleksandrov memcpy(&querier->addr, saddr, sizeof(*saddr)); 169367b746f9SNikolay Aleksandrov write_seqcount_end(&querier->seq); 169467b746f9SNikolay Aleksandrov } 169567b746f9SNikolay Aleksandrov 1696adc47037SNikolay Aleksandrov static void br_multicast_send_query(struct net_bridge_mcast *brmctx, 1697adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 169890010b36SLinus Lüssing struct bridge_mcast_own_query *own_query) 16998ef2a9a5SYOSHIFUJI Hideaki { 170090010b36SLinus Lüssing struct bridge_mcast_other_query *other_query = NULL; 170167b746f9SNikolay Aleksandrov struct bridge_mcast_querier *querier; 17025e923585SNikolay Aleksandrov struct br_ip br_group; 17035e923585SNikolay Aleksandrov unsigned long time; 17048ef2a9a5SYOSHIFUJI Hideaki 17054cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx) || 1706adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED) || 17074d5b4e84SNikolay Aleksandrov !brmctx->multicast_querier) 17088ef2a9a5SYOSHIFUJI Hideaki return; 17098ef2a9a5SYOSHIFUJI Hideaki 1710eab3227bSNikolay Aleksandrov memset(&br_group.dst, 0, sizeof(br_group.dst)); 17118ef2a9a5SYOSHIFUJI Hideaki 1712adc47037SNikolay Aleksandrov if (pmctx ? (own_query == &pmctx->ip4_own_query) : 1713d3d065c0SNikolay Aleksandrov (own_query == &brmctx->ip4_own_query)) { 171467b746f9SNikolay Aleksandrov querier = &brmctx->ip4_querier; 1715d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 171608b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1717dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1718cc0fdd80SLinus Lüssing } else { 171967b746f9SNikolay Aleksandrov querier = &brmctx->ip6_querier; 1720d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 172108b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 172208b202b6SYOSHIFUJI Hideaki #endif 1723eb1d1641SHerbert Xu } 1724eb1d1641SHerbert Xu 172590010b36SLinus Lüssing if (!other_query || timer_pending(&other_query->timer)) 1726cc0fdd80SLinus Lüssing return; 1727cc0fdd80SLinus Lüssing 172867b746f9SNikolay Aleksandrov /* we're about to select ourselves as querier */ 172967b746f9SNikolay Aleksandrov if (!pmctx && querier->port_ifidx) { 173067b746f9SNikolay Aleksandrov struct br_ip zeroip = {}; 173167b746f9SNikolay Aleksandrov 173267b746f9SNikolay Aleksandrov br_multicast_update_querier(brmctx, querier, 0, &zeroip); 173367b746f9SNikolay Aleksandrov } 173467b746f9SNikolay Aleksandrov 1735adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, NULL, NULL, &br_group, false, 1736adc47037SNikolay Aleksandrov 0, NULL); 1737cc0fdd80SLinus Lüssing 1738cc0fdd80SLinus Lüssing time = jiffies; 1739d3d065c0SNikolay Aleksandrov time += own_query->startup_sent < brmctx->multicast_startup_query_count ? 1740d3d065c0SNikolay Aleksandrov brmctx->multicast_startup_query_interval : 1741d3d065c0SNikolay Aleksandrov brmctx->multicast_query_interval; 174290010b36SLinus Lüssing mod_timer(&own_query->timer, time); 1743cc0fdd80SLinus Lüssing } 1744cc0fdd80SLinus Lüssing 174590010b36SLinus Lüssing static void 17469632233eSNikolay Aleksandrov br_multicast_port_query_expired(struct net_bridge_mcast_port *pmctx, 174790010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1748eb1d1641SHerbert Xu { 17499632233eSNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 17504cdd0d10SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 1751eb1d1641SHerbert Xu 1752eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 17534cdd0d10SNikolay Aleksandrov if (br_multicast_port_ctx_state_stopped(pmctx)) 1754eb1d1641SHerbert Xu goto out; 1755615cc23eSNikolay Aleksandrov 17564cdd0d10SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 17574cdd0d10SNikolay Aleksandrov if (query->startup_sent < brmctx->multicast_startup_query_count) 1758cc0fdd80SLinus Lüssing query->startup_sent++; 1759eb1d1641SHerbert Xu 17604cdd0d10SNikolay Aleksandrov br_multicast_send_query(brmctx, pmctx, query); 1761eb1d1641SHerbert Xu 1762eb1d1641SHerbert Xu out: 1763eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1764eb1d1641SHerbert Xu } 1765eb1d1641SHerbert Xu 176688c1f37fSAllen Pais static void br_ip4_multicast_port_query_expired(struct timer_list *t) 1767cc0fdd80SLinus Lüssing { 17689632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 17699632233eSNikolay Aleksandrov ip4_own_query.timer); 1770cc0fdd80SLinus Lüssing 17719632233eSNikolay Aleksandrov br_multicast_port_query_expired(pmctx, &pmctx->ip4_own_query); 1772cc0fdd80SLinus Lüssing } 1773cc0fdd80SLinus Lüssing 1774cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 177588c1f37fSAllen Pais static void br_ip6_multicast_port_query_expired(struct timer_list *t) 1776cc0fdd80SLinus Lüssing { 17779632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 17789632233eSNikolay Aleksandrov ip6_own_query.timer); 1779cc0fdd80SLinus Lüssing 17809632233eSNikolay Aleksandrov br_multicast_port_query_expired(pmctx, &pmctx->ip6_own_query); 1781cc0fdd80SLinus Lüssing } 1782cc0fdd80SLinus Lüssing #endif 1783cc0fdd80SLinus Lüssing 178442c11ccfSNikolay Aleksandrov static void br_multicast_port_group_rexmit(struct timer_list *t) 178542c11ccfSNikolay Aleksandrov { 178642c11ccfSNikolay Aleksandrov struct net_bridge_port_group *pg = from_timer(pg, t, rexmit_timer); 178742c11ccfSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 1788085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 1789adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 1790adc47037SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 179142c11ccfSNikolay Aleksandrov bool need_rexmit = false; 179242c11ccfSNikolay Aleksandrov 179342c11ccfSNikolay Aleksandrov spin_lock(&br->multicast_lock); 179442c11ccfSNikolay Aleksandrov if (!netif_running(br->dev) || hlist_unhashed(&pg->mglist) || 17954d5b4e84SNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED)) 179642c11ccfSNikolay Aleksandrov goto out; 179742c11ccfSNikolay Aleksandrov 1798eb1593a0SNikolay Aleksandrov pmctx = br_multicast_pg_to_port_ctx(pg); 1799eb1593a0SNikolay Aleksandrov if (!pmctx) 1800eb1593a0SNikolay Aleksandrov goto out; 1801eb1593a0SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 18024d5b4e84SNikolay Aleksandrov if (!brmctx->multicast_querier) 18034d5b4e84SNikolay Aleksandrov goto out; 18044d5b4e84SNikolay Aleksandrov 1805085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 1806d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 180742c11ccfSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 180842c11ccfSNikolay Aleksandrov else 1809d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 181042c11ccfSNikolay Aleksandrov #endif 181142c11ccfSNikolay Aleksandrov 181242c11ccfSNikolay Aleksandrov if (!other_query || timer_pending(&other_query->timer)) 181342c11ccfSNikolay Aleksandrov goto out; 181442c11ccfSNikolay Aleksandrov 181542c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt) { 181642c11ccfSNikolay Aleksandrov pg->grp_query_rexmit_cnt--; 1817adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 1818085b53c8SNikolay Aleksandrov &pg->key.addr, false, 1, NULL); 181942c11ccfSNikolay Aleksandrov } 1820adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 1821085b53c8SNikolay Aleksandrov &pg->key.addr, true, 0, &need_rexmit); 182242c11ccfSNikolay Aleksandrov 182342c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt || need_rexmit) 182442c11ccfSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, jiffies + 1825d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval); 182642c11ccfSNikolay Aleksandrov out: 182742c11ccfSNikolay Aleksandrov spin_unlock(&br->multicast_lock); 182842c11ccfSNikolay Aleksandrov } 182942c11ccfSNikolay Aleksandrov 1830ae1ea84bSFlorian Fainelli static int br_mc_disabled_update(struct net_device *dev, bool value, 1831ae1ea84bSFlorian Fainelli struct netlink_ext_ack *extack) 1832147c1e9bSNogah Frankel { 1833147c1e9bSNogah Frankel struct switchdev_attr attr = { 1834147c1e9bSNogah Frankel .orig_dev = dev, 1835147c1e9bSNogah Frankel .id = SWITCHDEV_ATTR_ID_BRIDGE_MC_DISABLED, 1836147c1e9bSNogah Frankel .flags = SWITCHDEV_F_DEFER, 183713cefad2SNikolay Aleksandrov .u.mc_disabled = !value, 1838147c1e9bSNogah Frankel }; 1839147c1e9bSNogah Frankel 1840ae1ea84bSFlorian Fainelli return switchdev_port_attr_set(dev, &attr, extack); 1841147c1e9bSNogah Frankel } 1842147c1e9bSNogah Frankel 1843613d61dbSNikolay Aleksandrov void br_multicast_port_ctx_init(struct net_bridge_port *port, 1844613d61dbSNikolay Aleksandrov struct net_bridge_vlan *vlan, 18459632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 18469632233eSNikolay Aleksandrov { 18479632233eSNikolay Aleksandrov pmctx->port = port; 1848613d61dbSNikolay Aleksandrov pmctx->vlan = vlan; 18499632233eSNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 18509632233eSNikolay Aleksandrov timer_setup(&pmctx->ip4_mc_router_timer, 18519632233eSNikolay Aleksandrov br_ip4_multicast_router_expired, 0); 18529632233eSNikolay Aleksandrov timer_setup(&pmctx->ip4_own_query.timer, 18539632233eSNikolay Aleksandrov br_ip4_multicast_port_query_expired, 0); 18549632233eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 18559632233eSNikolay Aleksandrov timer_setup(&pmctx->ip6_mc_router_timer, 18569632233eSNikolay Aleksandrov br_ip6_multicast_router_expired, 0); 18579632233eSNikolay Aleksandrov timer_setup(&pmctx->ip6_own_query.timer, 18589632233eSNikolay Aleksandrov br_ip6_multicast_port_query_expired, 0); 18599632233eSNikolay Aleksandrov #endif 18609632233eSNikolay Aleksandrov } 18619632233eSNikolay Aleksandrov 1862613d61dbSNikolay Aleksandrov void br_multicast_port_ctx_deinit(struct net_bridge_mcast_port *pmctx) 18639632233eSNikolay Aleksandrov { 18649632233eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 18659632233eSNikolay Aleksandrov del_timer_sync(&pmctx->ip6_mc_router_timer); 18669632233eSNikolay Aleksandrov #endif 18679632233eSNikolay Aleksandrov del_timer_sync(&pmctx->ip4_mc_router_timer); 18689632233eSNikolay Aleksandrov } 18699632233eSNikolay Aleksandrov 18701080ab95SNikolay Aleksandrov int br_multicast_add_port(struct net_bridge_port *port) 1871eb1d1641SHerbert Xu { 1872ae1ea84bSFlorian Fainelli int err; 1873ae1ea84bSFlorian Fainelli 187489268b05SNikolay Aleksandrov port->multicast_eht_hosts_limit = BR_MCAST_DEFAULT_EHT_HOSTS_LIMIT; 1875613d61dbSNikolay Aleksandrov br_multicast_port_ctx_init(port, NULL, &port->multicast_ctx); 1876eb1d1641SHerbert Xu 1877ae1ea84bSFlorian Fainelli err = br_mc_disabled_update(port->dev, 1878ae1ea84bSFlorian Fainelli br_opt_get(port->br, 1879ae1ea84bSFlorian Fainelli BROPT_MULTICAST_ENABLED), 1880ae1ea84bSFlorian Fainelli NULL); 188168f5c12aSVladimir Oltean if (err && err != -EOPNOTSUPP) 1882ae1ea84bSFlorian Fainelli return err; 1883147c1e9bSNogah Frankel 18841080ab95SNikolay Aleksandrov port->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 18851080ab95SNikolay Aleksandrov if (!port->mcast_stats) 18861080ab95SNikolay Aleksandrov return -ENOMEM; 18871080ab95SNikolay Aleksandrov 18881080ab95SNikolay Aleksandrov return 0; 1889eb1d1641SHerbert Xu } 1890eb1d1641SHerbert Xu 1891eb1d1641SHerbert Xu void br_multicast_del_port(struct net_bridge_port *port) 1892eb1d1641SHerbert Xu { 1893e10177abSSatish Ashok struct net_bridge *br = port->br; 1894e10177abSSatish Ashok struct net_bridge_port_group *pg; 1895e12cec65SNikolay Aleksandrov HLIST_HEAD(deleted_head); 1896e10177abSSatish Ashok struct hlist_node *n; 1897e10177abSSatish Ashok 1898e10177abSSatish Ashok /* Take care of the remaining groups, only perm ones should be left */ 1899e10177abSSatish Ashok spin_lock_bh(&br->multicast_lock); 1900e10177abSSatish Ashok hlist_for_each_entry_safe(pg, n, &port->mglist, mglist) 1901681590bdSNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 1902e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 1903e10177abSSatish Ashok spin_unlock_bh(&br->multicast_lock); 1904e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 19059632233eSNikolay Aleksandrov br_multicast_port_ctx_deinit(&port->multicast_ctx); 19061080ab95SNikolay Aleksandrov free_percpu(port->mcast_stats); 1907eb1d1641SHerbert Xu } 1908eb1d1641SHerbert Xu 190990010b36SLinus Lüssing static void br_multicast_enable(struct bridge_mcast_own_query *query) 1910561f1103SHerbert Xu { 1911cc0fdd80SLinus Lüssing query->startup_sent = 0; 1912561f1103SHerbert Xu 1913cc0fdd80SLinus Lüssing if (try_to_del_timer_sync(&query->timer) >= 0 || 1914cc0fdd80SLinus Lüssing del_timer(&query->timer)) 1915cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 1916561f1103SHerbert Xu } 1917561f1103SHerbert Xu 1918adc47037SNikolay Aleksandrov static void __br_multicast_enable_port_ctx(struct net_bridge_mcast_port *pmctx) 1919eb1d1641SHerbert Xu { 1920adc47037SNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 19217b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 1922eb1d1641SHerbert Xu 19237b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 19247b54aaafSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED) || 19257b54aaafSNikolay Aleksandrov !netif_running(br->dev)) 19267cb3f921SNikolay Aleksandrov return; 1927eb1d1641SHerbert Xu 1928adc47037SNikolay Aleksandrov br_multicast_enable(&pmctx->ip4_own_query); 1929cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1930adc47037SNikolay Aleksandrov br_multicast_enable(&pmctx->ip6_own_query); 1931cc0fdd80SLinus Lüssing #endif 1932adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_PERM) { 1933adc47037SNikolay Aleksandrov br_ip4_multicast_add_router(brmctx, pmctx); 1934adc47037SNikolay Aleksandrov br_ip6_multicast_add_router(brmctx, pmctx); 1935a3c02e76SLinus Lüssing } 19367cb3f921SNikolay Aleksandrov } 1937eb1d1641SHerbert Xu 19387cb3f921SNikolay Aleksandrov void br_multicast_enable_port(struct net_bridge_port *port) 19397cb3f921SNikolay Aleksandrov { 19407cb3f921SNikolay Aleksandrov struct net_bridge *br = port->br; 19417cb3f921SNikolay Aleksandrov 1942f4b7002aSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 1943adc47037SNikolay Aleksandrov __br_multicast_enable_port_ctx(&port->multicast_ctx); 1944f4b7002aSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 1945eb1d1641SHerbert Xu } 1946eb1d1641SHerbert Xu 19477b54aaafSNikolay Aleksandrov static void __br_multicast_disable_port_ctx(struct net_bridge_mcast_port *pmctx) 1948eb1d1641SHerbert Xu { 1949eb1d1641SHerbert Xu struct net_bridge_port_group *pg; 1950b67bfe0dSSasha Levin struct hlist_node *n; 1951ed2d3597SLinus Lüssing bool del = false; 1952eb1d1641SHerbert Xu 19537b54aaafSNikolay Aleksandrov hlist_for_each_entry_safe(pg, n, &pmctx->port->mglist, mglist) 19547b54aaafSNikolay Aleksandrov if (!(pg->flags & MDB_PG_FLAGS_PERMANENT) && 19557b54aaafSNikolay Aleksandrov (!br_multicast_port_ctx_is_vlan(pmctx) || 19567b54aaafSNikolay Aleksandrov pg->key.addr.vid == pmctx->vlan->vid)) 19577b54aaafSNikolay Aleksandrov br_multicast_find_del_pg(pmctx->port->br, pg); 1958eb1d1641SHerbert Xu 1959adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 1960adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 1961adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_own_query.timer); 1962adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 1963cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1964adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 1965adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_own_query.timer); 1966cc0fdd80SLinus Lüssing #endif 1967adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 19687b54aaafSNikolay Aleksandrov } 19697b54aaafSNikolay Aleksandrov 19707b54aaafSNikolay Aleksandrov void br_multicast_disable_port(struct net_bridge_port *port) 19717b54aaafSNikolay Aleksandrov { 1972f4b7002aSNikolay Aleksandrov spin_lock_bh(&port->br->multicast_lock); 19737b54aaafSNikolay Aleksandrov __br_multicast_disable_port_ctx(&port->multicast_ctx); 1974f4b7002aSNikolay Aleksandrov spin_unlock_bh(&port->br->multicast_lock); 1975eb1d1641SHerbert Xu } 1976eb1d1641SHerbert Xu 1977e6231bcaSNikolay Aleksandrov static int __grp_src_delete_marked(struct net_bridge_port_group *pg) 1978e6231bcaSNikolay Aleksandrov { 1979e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 1980e6231bcaSNikolay Aleksandrov struct hlist_node *tmp; 1981e6231bcaSNikolay Aleksandrov int deleted = 0; 1982e6231bcaSNikolay Aleksandrov 1983e6231bcaSNikolay Aleksandrov hlist_for_each_entry_safe(ent, tmp, &pg->src_list, node) 1984e6231bcaSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_DELETE) { 1985d5a10222SNikolay Aleksandrov br_multicast_del_group_src(ent, false); 1986e6231bcaSNikolay Aleksandrov deleted++; 1987e6231bcaSNikolay Aleksandrov } 1988e6231bcaSNikolay Aleksandrov 1989e6231bcaSNikolay Aleksandrov return deleted; 1990e6231bcaSNikolay Aleksandrov } 1991e6231bcaSNikolay Aleksandrov 1992b0812368SNikolay Aleksandrov static void __grp_src_mod_timer(struct net_bridge_group_src *src, 1993b0812368SNikolay Aleksandrov unsigned long expires) 1994b0812368SNikolay Aleksandrov { 1995b0812368SNikolay Aleksandrov mod_timer(&src->timer, expires); 1996b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(src); 1997b0812368SNikolay Aleksandrov } 1998b0812368SNikolay Aleksandrov 1999adc47037SNikolay Aleksandrov static void __grp_src_query_marked_and_rexmit(struct net_bridge_mcast *brmctx, 2000adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2001adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg) 20025bf1e00bSNikolay Aleksandrov { 20035bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 2004d3d065c0SNikolay Aleksandrov u32 lmqc = brmctx->multicast_last_member_count; 20055bf1e00bSNikolay Aleksandrov unsigned long lmqt, lmi, now = jiffies; 20065bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 20075bf1e00bSNikolay Aleksandrov 2008adc47037SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 2009adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 20105bf1e00bSNikolay Aleksandrov return; 20115bf1e00bSNikolay Aleksandrov 2012085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 2013d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 20145bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 20155bf1e00bSNikolay Aleksandrov else 2016d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 20175bf1e00bSNikolay Aleksandrov #endif 20185bf1e00bSNikolay Aleksandrov 2019adc47037SNikolay Aleksandrov lmqt = now + br_multicast_lmqt(brmctx); 20205bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 20215bf1e00bSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_SEND) { 20225bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 20235bf1e00bSNikolay Aleksandrov if (ent->timer.expires > lmqt) { 20244d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier && 20255bf1e00bSNikolay Aleksandrov other_query && 20265bf1e00bSNikolay Aleksandrov !timer_pending(&other_query->timer)) 20275bf1e00bSNikolay Aleksandrov ent->src_query_rexmit_cnt = lmqc; 2028b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, lmqt); 20295bf1e00bSNikolay Aleksandrov } 20305bf1e00bSNikolay Aleksandrov } 20315bf1e00bSNikolay Aleksandrov } 20325bf1e00bSNikolay Aleksandrov 20334d5b4e84SNikolay Aleksandrov if (!brmctx->multicast_querier || 20345bf1e00bSNikolay Aleksandrov !other_query || timer_pending(&other_query->timer)) 20355bf1e00bSNikolay Aleksandrov return; 20365bf1e00bSNikolay Aleksandrov 2037adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 2038085b53c8SNikolay Aleksandrov &pg->key.addr, true, 1, NULL); 20395bf1e00bSNikolay Aleksandrov 2040d3d065c0SNikolay Aleksandrov lmi = now + brmctx->multicast_last_member_interval; 20415bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 20425bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 20435bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 20445bf1e00bSNikolay Aleksandrov } 20455bf1e00bSNikolay Aleksandrov 2046adc47037SNikolay Aleksandrov static void __grp_send_query_and_rexmit(struct net_bridge_mcast *brmctx, 2047adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2048adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg) 20495bf1e00bSNikolay Aleksandrov { 20505bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 20515bf1e00bSNikolay Aleksandrov unsigned long now = jiffies, lmi; 20525bf1e00bSNikolay Aleksandrov 2053adc47037SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 2054adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 20555bf1e00bSNikolay Aleksandrov return; 20565bf1e00bSNikolay Aleksandrov 2057085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 2058d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 20595bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 20605bf1e00bSNikolay Aleksandrov else 2061d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 20625bf1e00bSNikolay Aleksandrov #endif 20635bf1e00bSNikolay Aleksandrov 20644d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier && 20655bf1e00bSNikolay Aleksandrov other_query && !timer_pending(&other_query->timer)) { 2066d3d065c0SNikolay Aleksandrov lmi = now + brmctx->multicast_last_member_interval; 2067d3d065c0SNikolay Aleksandrov pg->grp_query_rexmit_cnt = brmctx->multicast_last_member_count - 1; 2068adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 2069085b53c8SNikolay Aleksandrov &pg->key.addr, false, 0, NULL); 20705bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 20715bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 20725bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 20735bf1e00bSNikolay Aleksandrov } 20745bf1e00bSNikolay Aleksandrov 20755bf1e00bSNikolay Aleksandrov if (pg->filter_mode == MCAST_EXCLUDE && 20765bf1e00bSNikolay Aleksandrov (!timer_pending(&pg->timer) || 2077adc47037SNikolay Aleksandrov time_after(pg->timer.expires, now + br_multicast_lmqt(brmctx)))) 2078adc47037SNikolay Aleksandrov mod_timer(&pg->timer, now + br_multicast_lmqt(brmctx)); 20795bf1e00bSNikolay Aleksandrov } 20805bf1e00bSNikolay Aleksandrov 20810436862eSNikolay Aleksandrov /* State Msg type New state Actions 20820436862eSNikolay Aleksandrov * INCLUDE (A) IS_IN (B) INCLUDE (A+B) (B)=GMI 20830436862eSNikolay Aleksandrov * INCLUDE (A) ALLOW (B) INCLUDE (A+B) (B)=GMI 20840436862eSNikolay Aleksandrov * EXCLUDE (X,Y) ALLOW (A) EXCLUDE (X+A,Y-A) (A)=GMI 20850436862eSNikolay Aleksandrov */ 2086adc47037SNikolay Aleksandrov static bool br_multicast_isinc_allow(const struct net_bridge_mcast *brmctx, 2087adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2088474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2089474ddb37SNikolay Aleksandrov int grec_type) 20900436862eSNikolay Aleksandrov { 20910436862eSNikolay Aleksandrov struct net_bridge_group_src *ent; 20920436862eSNikolay Aleksandrov unsigned long now = jiffies; 20930436862eSNikolay Aleksandrov bool changed = false; 20940436862eSNikolay Aleksandrov struct br_ip src_ip; 20950436862eSNikolay Aleksandrov u32 src_idx; 20960436862eSNikolay Aleksandrov 20970436862eSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2098085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 20990436862eSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2100e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 21010436862eSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 21020436862eSNikolay Aleksandrov if (!ent) { 21030436862eSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 21040436862eSNikolay Aleksandrov if (ent) 21050436862eSNikolay Aleksandrov changed = true; 21060436862eSNikolay Aleksandrov } 21070436862eSNikolay Aleksandrov 21080436862eSNikolay Aleksandrov if (ent) 2109adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 21100436862eSNikolay Aleksandrov } 21110436862eSNikolay Aleksandrov 2112adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2113adc47037SNikolay Aleksandrov grec_type)) 2114474ddb37SNikolay Aleksandrov changed = true; 2115474ddb37SNikolay Aleksandrov 21160436862eSNikolay Aleksandrov return changed; 21170436862eSNikolay Aleksandrov } 21180436862eSNikolay Aleksandrov 2119e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 2120e6231bcaSNikolay Aleksandrov * INCLUDE (A) IS_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 2121e6231bcaSNikolay Aleksandrov * Delete (A-B) 2122e6231bcaSNikolay Aleksandrov * Group Timer=GMI 2123e6231bcaSNikolay Aleksandrov */ 2124adc47037SNikolay Aleksandrov static void __grp_src_isexc_incl(const struct net_bridge_mcast *brmctx, 2125adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2126ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2127ddc255d9SNikolay Aleksandrov int grec_type) 2128e6231bcaSNikolay Aleksandrov { 2129e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 2130e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 2131e6231bcaSNikolay Aleksandrov u32 src_idx; 2132e6231bcaSNikolay Aleksandrov 2133e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2134e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 2135e6231bcaSNikolay Aleksandrov 2136e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2137085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2138e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2139e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2140e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2141e6231bcaSNikolay Aleksandrov if (ent) 2142e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 2143e6231bcaSNikolay Aleksandrov else 2144b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2145b0812368SNikolay Aleksandrov if (ent) 2146b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 2147e6231bcaSNikolay Aleksandrov } 2148e6231bcaSNikolay Aleksandrov 2149adc47037SNikolay Aleksandrov br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2150adc47037SNikolay Aleksandrov grec_type); 2151ddc255d9SNikolay Aleksandrov 2152e6231bcaSNikolay Aleksandrov __grp_src_delete_marked(pg); 2153e6231bcaSNikolay Aleksandrov } 2154e6231bcaSNikolay Aleksandrov 2155e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 2156e6231bcaSNikolay Aleksandrov * EXCLUDE (X,Y) IS_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=GMI 2157e6231bcaSNikolay Aleksandrov * Delete (X-A) 2158e6231bcaSNikolay Aleksandrov * Delete (Y-A) 2159e6231bcaSNikolay Aleksandrov * Group Timer=GMI 2160e6231bcaSNikolay Aleksandrov */ 2161adc47037SNikolay Aleksandrov static bool __grp_src_isexc_excl(const struct net_bridge_mcast *brmctx, 2162adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2163ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2164ddc255d9SNikolay Aleksandrov int grec_type) 2165e6231bcaSNikolay Aleksandrov { 2166e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 2167e6231bcaSNikolay Aleksandrov unsigned long now = jiffies; 2168e6231bcaSNikolay Aleksandrov bool changed = false; 2169e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 2170e6231bcaSNikolay Aleksandrov u32 src_idx; 2171e6231bcaSNikolay Aleksandrov 2172e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2173e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 2174e6231bcaSNikolay Aleksandrov 2175e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2176085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2177e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2178e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2179e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2180e6231bcaSNikolay Aleksandrov if (ent) { 2181e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 2182e6231bcaSNikolay Aleksandrov } else { 2183e6231bcaSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2184e6231bcaSNikolay Aleksandrov if (ent) { 2185b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, 2186adc47037SNikolay Aleksandrov now + br_multicast_gmi(brmctx)); 2187e6231bcaSNikolay Aleksandrov changed = true; 2188e6231bcaSNikolay Aleksandrov } 2189e6231bcaSNikolay Aleksandrov } 2190e6231bcaSNikolay Aleksandrov } 2191e6231bcaSNikolay Aleksandrov 2192adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2193adc47037SNikolay Aleksandrov grec_type)) 2194ddc255d9SNikolay Aleksandrov changed = true; 2195ddc255d9SNikolay Aleksandrov 2196e6231bcaSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 2197e6231bcaSNikolay Aleksandrov changed = true; 2198e6231bcaSNikolay Aleksandrov 2199e6231bcaSNikolay Aleksandrov return changed; 2200e6231bcaSNikolay Aleksandrov } 2201e6231bcaSNikolay Aleksandrov 2202adc47037SNikolay Aleksandrov static bool br_multicast_isexc(const struct net_bridge_mcast *brmctx, 2203adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2204ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2205ddc255d9SNikolay Aleksandrov int grec_type) 2206e6231bcaSNikolay Aleksandrov { 2207e6231bcaSNikolay Aleksandrov bool changed = false; 2208e6231bcaSNikolay Aleksandrov 2209e6231bcaSNikolay Aleksandrov switch (pg->filter_mode) { 2210e6231bcaSNikolay Aleksandrov case MCAST_INCLUDE: 2211adc47037SNikolay Aleksandrov __grp_src_isexc_incl(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2212ddc255d9SNikolay Aleksandrov grec_type); 22138266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 2214e6231bcaSNikolay Aleksandrov changed = true; 2215e6231bcaSNikolay Aleksandrov break; 2216e6231bcaSNikolay Aleksandrov case MCAST_EXCLUDE: 2217adc47037SNikolay Aleksandrov changed = __grp_src_isexc_excl(brmctx, pg, h_addr, srcs, nsrcs, 2218adc47037SNikolay Aleksandrov addr_size, grec_type); 2219e6231bcaSNikolay Aleksandrov break; 2220e6231bcaSNikolay Aleksandrov } 2221e6231bcaSNikolay Aleksandrov 2222e6231bcaSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 2223adc47037SNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(brmctx)); 2224e6231bcaSNikolay Aleksandrov 2225e6231bcaSNikolay Aleksandrov return changed; 2226e6231bcaSNikolay Aleksandrov } 2227e6231bcaSNikolay Aleksandrov 22285bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 22295bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_IN (B) INCLUDE (A+B) (B)=GMI 22305bf1e00bSNikolay Aleksandrov * Send Q(G,A-B) 22315bf1e00bSNikolay Aleksandrov */ 2232adc47037SNikolay Aleksandrov static bool __grp_src_toin_incl(struct net_bridge_mcast *brmctx, 2233adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2234adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2235ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2236ddc255d9SNikolay Aleksandrov int grec_type) 22375bf1e00bSNikolay Aleksandrov { 22385bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 22395bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 22405bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 22415bf1e00bSNikolay Aleksandrov bool changed = false; 22425bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 22435bf1e00bSNikolay Aleksandrov 22445bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 22455bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 22465bf1e00bSNikolay Aleksandrov 22475bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2248085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 22495bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2250e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 22515bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 22525bf1e00bSNikolay Aleksandrov if (ent) { 22535bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 22545bf1e00bSNikolay Aleksandrov to_send--; 22555bf1e00bSNikolay Aleksandrov } else { 22565bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 22575bf1e00bSNikolay Aleksandrov if (ent) 22585bf1e00bSNikolay Aleksandrov changed = true; 22595bf1e00bSNikolay Aleksandrov } 22605bf1e00bSNikolay Aleksandrov if (ent) 2261adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 22625bf1e00bSNikolay Aleksandrov } 22635bf1e00bSNikolay Aleksandrov 2264adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2265adc47037SNikolay Aleksandrov grec_type)) 2266ddc255d9SNikolay Aleksandrov changed = true; 2267ddc255d9SNikolay Aleksandrov 22685bf1e00bSNikolay Aleksandrov if (to_send) 2269adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 22705bf1e00bSNikolay Aleksandrov 22715bf1e00bSNikolay Aleksandrov return changed; 22725bf1e00bSNikolay Aleksandrov } 22735bf1e00bSNikolay Aleksandrov 22745bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 22755bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_IN (A) EXCLUDE (X+A,Y-A) (A)=GMI 22765bf1e00bSNikolay Aleksandrov * Send Q(G,X-A) 22775bf1e00bSNikolay Aleksandrov * Send Q(G) 22785bf1e00bSNikolay Aleksandrov */ 2279adc47037SNikolay Aleksandrov static bool __grp_src_toin_excl(struct net_bridge_mcast *brmctx, 2280adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2281adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2282ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2283ddc255d9SNikolay Aleksandrov int grec_type) 22845bf1e00bSNikolay Aleksandrov { 22855bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 22865bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 22875bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 22885bf1e00bSNikolay Aleksandrov bool changed = false; 22895bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 22905bf1e00bSNikolay Aleksandrov 22915bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 22925bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) 22935bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 22945bf1e00bSNikolay Aleksandrov 22955bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2296085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 22975bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2298e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 22995bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 23005bf1e00bSNikolay Aleksandrov if (ent) { 23015bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) { 23025bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 23035bf1e00bSNikolay Aleksandrov to_send--; 23045bf1e00bSNikolay Aleksandrov } 23055bf1e00bSNikolay Aleksandrov } else { 23065bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 23075bf1e00bSNikolay Aleksandrov if (ent) 23085bf1e00bSNikolay Aleksandrov changed = true; 23095bf1e00bSNikolay Aleksandrov } 23105bf1e00bSNikolay Aleksandrov if (ent) 2311adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 23125bf1e00bSNikolay Aleksandrov } 23135bf1e00bSNikolay Aleksandrov 2314adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2315adc47037SNikolay Aleksandrov grec_type)) 2316ddc255d9SNikolay Aleksandrov changed = true; 2317ddc255d9SNikolay Aleksandrov 23185bf1e00bSNikolay Aleksandrov if (to_send) 2319adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 23205bf1e00bSNikolay Aleksandrov 2321adc47037SNikolay Aleksandrov __grp_send_query_and_rexmit(brmctx, pmctx, pg); 23225bf1e00bSNikolay Aleksandrov 23235bf1e00bSNikolay Aleksandrov return changed; 23245bf1e00bSNikolay Aleksandrov } 23255bf1e00bSNikolay Aleksandrov 2326adc47037SNikolay Aleksandrov static bool br_multicast_toin(struct net_bridge_mcast *brmctx, 2327adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2328adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2329ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2330ddc255d9SNikolay Aleksandrov int grec_type) 23315bf1e00bSNikolay Aleksandrov { 23325bf1e00bSNikolay Aleksandrov bool changed = false; 23335bf1e00bSNikolay Aleksandrov 23345bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 23355bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 2336adc47037SNikolay Aleksandrov changed = __grp_src_toin_incl(brmctx, pmctx, pg, h_addr, srcs, 2337adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 23385bf1e00bSNikolay Aleksandrov break; 23395bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 2340adc47037SNikolay Aleksandrov changed = __grp_src_toin_excl(brmctx, pmctx, pg, h_addr, srcs, 2341adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 23425bf1e00bSNikolay Aleksandrov break; 23435bf1e00bSNikolay Aleksandrov } 23445bf1e00bSNikolay Aleksandrov 2345ddc255d9SNikolay Aleksandrov if (br_multicast_eht_should_del_pg(pg)) { 2346d5a10222SNikolay Aleksandrov pg->flags |= MDB_PG_FLAGS_FAST_LEAVE; 2347ddc255d9SNikolay Aleksandrov br_multicast_find_del_pg(pg->key.port->br, pg); 2348ddc255d9SNikolay Aleksandrov /* a notification has already been sent and we shouldn't 2349ddc255d9SNikolay Aleksandrov * access pg after the delete so we have to return false 2350ddc255d9SNikolay Aleksandrov */ 2351ddc255d9SNikolay Aleksandrov changed = false; 2352ddc255d9SNikolay Aleksandrov } 2353ddc255d9SNikolay Aleksandrov 23545bf1e00bSNikolay Aleksandrov return changed; 23555bf1e00bSNikolay Aleksandrov } 23565bf1e00bSNikolay Aleksandrov 23575bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 23585bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 23595bf1e00bSNikolay Aleksandrov * Delete (A-B) 23605bf1e00bSNikolay Aleksandrov * Send Q(G,A*B) 23615bf1e00bSNikolay Aleksandrov * Group Timer=GMI 23625bf1e00bSNikolay Aleksandrov */ 2363adc47037SNikolay Aleksandrov static void __grp_src_toex_incl(struct net_bridge_mcast *brmctx, 2364adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2365adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2366ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2367ddc255d9SNikolay Aleksandrov int grec_type) 23685bf1e00bSNikolay Aleksandrov { 23695bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 23705bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 23715bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 23725bf1e00bSNikolay Aleksandrov 23735bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 23745bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 23755bf1e00bSNikolay Aleksandrov 23765bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2377085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 23785bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2379e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 23805bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 23815bf1e00bSNikolay Aleksandrov if (ent) { 23825bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_DELETE) | 23835bf1e00bSNikolay Aleksandrov BR_SGRP_F_SEND; 23845bf1e00bSNikolay Aleksandrov to_send++; 23855bf1e00bSNikolay Aleksandrov } else { 2386b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 23875bf1e00bSNikolay Aleksandrov } 2388b0812368SNikolay Aleksandrov if (ent) 2389b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 23905bf1e00bSNikolay Aleksandrov } 23915bf1e00bSNikolay Aleksandrov 2392adc47037SNikolay Aleksandrov br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2393adc47037SNikolay Aleksandrov grec_type); 2394ddc255d9SNikolay Aleksandrov 23955bf1e00bSNikolay Aleksandrov __grp_src_delete_marked(pg); 23965bf1e00bSNikolay Aleksandrov if (to_send) 2397adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 23985bf1e00bSNikolay Aleksandrov } 23995bf1e00bSNikolay Aleksandrov 24005bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 24015bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=Group Timer 24025bf1e00bSNikolay Aleksandrov * Delete (X-A) 24035bf1e00bSNikolay Aleksandrov * Delete (Y-A) 24045bf1e00bSNikolay Aleksandrov * Send Q(G,A-Y) 24055bf1e00bSNikolay Aleksandrov * Group Timer=GMI 24065bf1e00bSNikolay Aleksandrov */ 2407adc47037SNikolay Aleksandrov static bool __grp_src_toex_excl(struct net_bridge_mcast *brmctx, 2408adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2409adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2410ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2411ddc255d9SNikolay Aleksandrov int grec_type) 24125bf1e00bSNikolay Aleksandrov { 24135bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 24145bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 24155bf1e00bSNikolay Aleksandrov bool changed = false; 24165bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 24175bf1e00bSNikolay Aleksandrov 24185bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 24195bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 24205bf1e00bSNikolay Aleksandrov 24215bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2422085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 24235bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2424e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 24255bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 24265bf1e00bSNikolay Aleksandrov if (ent) { 24275bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 24285bf1e00bSNikolay Aleksandrov } else { 24295bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 24305bf1e00bSNikolay Aleksandrov if (ent) { 2431b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 24325bf1e00bSNikolay Aleksandrov changed = true; 24335bf1e00bSNikolay Aleksandrov } 24345bf1e00bSNikolay Aleksandrov } 24355bf1e00bSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 24365bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 24375bf1e00bSNikolay Aleksandrov to_send++; 24385bf1e00bSNikolay Aleksandrov } 24395bf1e00bSNikolay Aleksandrov } 24405bf1e00bSNikolay Aleksandrov 2441adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2442adc47037SNikolay Aleksandrov grec_type)) 2443ddc255d9SNikolay Aleksandrov changed = true; 2444ddc255d9SNikolay Aleksandrov 24455bf1e00bSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 24465bf1e00bSNikolay Aleksandrov changed = true; 24475bf1e00bSNikolay Aleksandrov if (to_send) 2448adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 24495bf1e00bSNikolay Aleksandrov 24505bf1e00bSNikolay Aleksandrov return changed; 24515bf1e00bSNikolay Aleksandrov } 24525bf1e00bSNikolay Aleksandrov 2453adc47037SNikolay Aleksandrov static bool br_multicast_toex(struct net_bridge_mcast *brmctx, 2454adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2455adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2456ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2457ddc255d9SNikolay Aleksandrov int grec_type) 24585bf1e00bSNikolay Aleksandrov { 24595bf1e00bSNikolay Aleksandrov bool changed = false; 24605bf1e00bSNikolay Aleksandrov 24615bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 24625bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 2463adc47037SNikolay Aleksandrov __grp_src_toex_incl(brmctx, pmctx, pg, h_addr, srcs, nsrcs, 2464adc47037SNikolay Aleksandrov addr_size, grec_type); 24658266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 24665bf1e00bSNikolay Aleksandrov changed = true; 24675bf1e00bSNikolay Aleksandrov break; 24685bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 2469adc47037SNikolay Aleksandrov changed = __grp_src_toex_excl(brmctx, pmctx, pg, h_addr, srcs, 2470adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 24715bf1e00bSNikolay Aleksandrov break; 24725bf1e00bSNikolay Aleksandrov } 24735bf1e00bSNikolay Aleksandrov 24745bf1e00bSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 2475adc47037SNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(brmctx)); 24765bf1e00bSNikolay Aleksandrov 24775bf1e00bSNikolay Aleksandrov return changed; 24785bf1e00bSNikolay Aleksandrov } 24795bf1e00bSNikolay Aleksandrov 2480109865feSNikolay Aleksandrov /* State Msg type New state Actions 2481109865feSNikolay Aleksandrov * INCLUDE (A) BLOCK (B) INCLUDE (A) Send Q(G,A*B) 2482109865feSNikolay Aleksandrov */ 2483adc47037SNikolay Aleksandrov static bool __grp_src_block_incl(struct net_bridge_mcast *brmctx, 2484adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2485adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2486474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2487109865feSNikolay Aleksandrov { 2488109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2489109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 24900ad57c99SNikolay Aleksandrov bool changed = false; 2491109865feSNikolay Aleksandrov struct br_ip src_ip; 2492109865feSNikolay Aleksandrov 2493109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2494109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2495109865feSNikolay Aleksandrov 2496109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2497085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2498109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2499e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2500109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2501109865feSNikolay Aleksandrov if (ent) { 2502109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2503109865feSNikolay Aleksandrov to_send++; 2504109865feSNikolay Aleksandrov } 2505109865feSNikolay Aleksandrov } 2506109865feSNikolay Aleksandrov 2507adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2508adc47037SNikolay Aleksandrov grec_type)) 2509474ddb37SNikolay Aleksandrov changed = true; 2510474ddb37SNikolay Aleksandrov 2511109865feSNikolay Aleksandrov if (to_send) 2512adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 2513109865feSNikolay Aleksandrov 25140ad57c99SNikolay Aleksandrov return changed; 2515109865feSNikolay Aleksandrov } 2516109865feSNikolay Aleksandrov 2517109865feSNikolay Aleksandrov /* State Msg type New state Actions 2518109865feSNikolay Aleksandrov * EXCLUDE (X,Y) BLOCK (A) EXCLUDE (X+(A-Y),Y) (A-X-Y)=Group Timer 2519109865feSNikolay Aleksandrov * Send Q(G,A-Y) 2520109865feSNikolay Aleksandrov */ 2521adc47037SNikolay Aleksandrov static bool __grp_src_block_excl(struct net_bridge_mcast *brmctx, 2522adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2523adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2524474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2525109865feSNikolay Aleksandrov { 2526109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2527109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 2528109865feSNikolay Aleksandrov bool changed = false; 2529109865feSNikolay Aleksandrov struct br_ip src_ip; 2530109865feSNikolay Aleksandrov 2531109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2532109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2533109865feSNikolay Aleksandrov 2534109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2535085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2536109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2537e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2538109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2539109865feSNikolay Aleksandrov if (!ent) { 2540109865feSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2541109865feSNikolay Aleksandrov if (ent) { 2542b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 2543109865feSNikolay Aleksandrov changed = true; 2544109865feSNikolay Aleksandrov } 2545109865feSNikolay Aleksandrov } 2546109865feSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 2547109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2548109865feSNikolay Aleksandrov to_send++; 2549109865feSNikolay Aleksandrov } 2550109865feSNikolay Aleksandrov } 2551109865feSNikolay Aleksandrov 2552adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2553adc47037SNikolay Aleksandrov grec_type)) 2554474ddb37SNikolay Aleksandrov changed = true; 2555474ddb37SNikolay Aleksandrov 2556109865feSNikolay Aleksandrov if (to_send) 2557adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 2558109865feSNikolay Aleksandrov 2559109865feSNikolay Aleksandrov return changed; 2560109865feSNikolay Aleksandrov } 2561109865feSNikolay Aleksandrov 2562adc47037SNikolay Aleksandrov static bool br_multicast_block(struct net_bridge_mcast *brmctx, 2563adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2564adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2565474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2566109865feSNikolay Aleksandrov { 2567109865feSNikolay Aleksandrov bool changed = false; 2568109865feSNikolay Aleksandrov 2569109865feSNikolay Aleksandrov switch (pg->filter_mode) { 2570109865feSNikolay Aleksandrov case MCAST_INCLUDE: 2571adc47037SNikolay Aleksandrov changed = __grp_src_block_incl(brmctx, pmctx, pg, h_addr, srcs, 2572adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 2573109865feSNikolay Aleksandrov break; 2574109865feSNikolay Aleksandrov case MCAST_EXCLUDE: 2575adc47037SNikolay Aleksandrov changed = __grp_src_block_excl(brmctx, pmctx, pg, h_addr, srcs, 2576adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 2577109865feSNikolay Aleksandrov break; 2578109865feSNikolay Aleksandrov } 2579109865feSNikolay Aleksandrov 2580e87e4b5cSNikolay Aleksandrov if ((pg->filter_mode == MCAST_INCLUDE && hlist_empty(&pg->src_list)) || 2581e87e4b5cSNikolay Aleksandrov br_multicast_eht_should_del_pg(pg)) { 2582d5a10222SNikolay Aleksandrov if (br_multicast_eht_should_del_pg(pg)) 2583d5a10222SNikolay Aleksandrov pg->flags |= MDB_PG_FLAGS_FAST_LEAVE; 2584e87e4b5cSNikolay Aleksandrov br_multicast_find_del_pg(pg->key.port->br, pg); 2585e87e4b5cSNikolay Aleksandrov /* a notification has already been sent and we shouldn't 2586e87e4b5cSNikolay Aleksandrov * access pg after the delete so we have to return false 2587e87e4b5cSNikolay Aleksandrov */ 2588e87e4b5cSNikolay Aleksandrov changed = false; 2589e87e4b5cSNikolay Aleksandrov } 2590e87e4b5cSNikolay Aleksandrov 2591109865feSNikolay Aleksandrov return changed; 2592109865feSNikolay Aleksandrov } 2593109865feSNikolay Aleksandrov 25940436862eSNikolay Aleksandrov static struct net_bridge_port_group * 25950436862eSNikolay Aleksandrov br_multicast_find_port(struct net_bridge_mdb_entry *mp, 25960436862eSNikolay Aleksandrov struct net_bridge_port *p, 25970436862eSNikolay Aleksandrov const unsigned char *src) 25980436862eSNikolay Aleksandrov { 2599071445c6SNikolay Aleksandrov struct net_bridge *br __maybe_unused = mp->br; 26000436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 26010436862eSNikolay Aleksandrov 26020436862eSNikolay Aleksandrov for (pg = mlock_dereference(mp->ports, br); 26030436862eSNikolay Aleksandrov pg; 26040436862eSNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) 26050436862eSNikolay Aleksandrov if (br_port_group_equal(pg, p, src)) 26060436862eSNikolay Aleksandrov return pg; 26070436862eSNikolay Aleksandrov 26080436862eSNikolay Aleksandrov return NULL; 26090436862eSNikolay Aleksandrov } 26100436862eSNikolay Aleksandrov 2611adc47037SNikolay Aleksandrov static int br_ip4_multicast_igmp3_report(struct net_bridge_mcast *brmctx, 2612adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 261306499098SVlad Yasevich struct sk_buff *skb, 261406499098SVlad Yasevich u16 vid) 2615eb1d1641SHerbert Xu { 2616adc47037SNikolay Aleksandrov bool igmpv2 = brmctx->multicast_igmp_version == 2; 26170436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 26180436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 26196db6f0eaSFelix Fietkau const unsigned char *src; 2620eb1d1641SHerbert Xu struct igmpv3_report *ih; 2621eb1d1641SHerbert Xu struct igmpv3_grec *grec; 26220436862eSNikolay Aleksandrov int i, len, num, type; 262354bea721SNikolay Aleksandrov __be32 group, *h_addr; 26240436862eSNikolay Aleksandrov bool changed = false; 26250436862eSNikolay Aleksandrov int err = 0; 2626e57f6185SNikolay Aleksandrov u16 nsrcs; 2627eb1d1641SHerbert Xu 2628eb1d1641SHerbert Xu ih = igmpv3_report_hdr(skb); 2629eb1d1641SHerbert Xu num = ntohs(ih->ngrec); 2630c2d4fbd2SLinus Lüssing len = skb_transport_offset(skb) + sizeof(*ih); 2631eb1d1641SHerbert Xu 2632eb1d1641SHerbert Xu for (i = 0; i < num; i++) { 2633eb1d1641SHerbert Xu len += sizeof(*grec); 2634ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2635eb1d1641SHerbert Xu return -EINVAL; 2636eb1d1641SHerbert Xu 2637fd218cf9SHerbert Xu grec = (void *)(skb->data + len - sizeof(*grec)); 2638eb1d1641SHerbert Xu group = grec->grec_mca; 2639eb1d1641SHerbert Xu type = grec->grec_type; 2640e57f6185SNikolay Aleksandrov nsrcs = ntohs(grec->grec_nsrcs); 2641eb1d1641SHerbert Xu 2642e57f6185SNikolay Aleksandrov len += nsrcs * 4; 2643ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2644eb1d1641SHerbert Xu return -EINVAL; 2645eb1d1641SHerbert Xu 2646eb1d1641SHerbert Xu switch (type) { 2647eb1d1641SHerbert Xu case IGMPV3_MODE_IS_INCLUDE: 2648eb1d1641SHerbert Xu case IGMPV3_MODE_IS_EXCLUDE: 2649eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_INCLUDE: 2650eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_EXCLUDE: 2651eb1d1641SHerbert Xu case IGMPV3_ALLOW_NEW_SOURCES: 2652eb1d1641SHerbert Xu case IGMPV3_BLOCK_OLD_SOURCES: 2653eb1d1641SHerbert Xu break; 2654eb1d1641SHerbert Xu 2655eb1d1641SHerbert Xu default: 2656eb1d1641SHerbert Xu continue; 2657eb1d1641SHerbert Xu } 2658eb1d1641SHerbert Xu 26596db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 26600436862eSNikolay Aleksandrov if (nsrcs == 0 && 26610436862eSNikolay Aleksandrov (type == IGMPV3_CHANGE_TO_INCLUDE || 26620436862eSNikolay Aleksandrov type == IGMPV3_MODE_IS_INCLUDE)) { 2663adc47037SNikolay Aleksandrov if (!pmctx || igmpv2) { 2664adc47037SNikolay Aleksandrov br_ip4_multicast_leave_group(brmctx, pmctx, 2665adc47037SNikolay Aleksandrov group, vid, src); 26660436862eSNikolay Aleksandrov continue; 26670436862eSNikolay Aleksandrov } 2668bc8c20acSSatish Ashok } else { 2669adc47037SNikolay Aleksandrov err = br_ip4_multicast_add_group(brmctx, pmctx, group, 2670adc47037SNikolay Aleksandrov vid, src, igmpv2); 2671eb1d1641SHerbert Xu if (err) 2672eb1d1641SHerbert Xu break; 2673eb1d1641SHerbert Xu } 26740436862eSNikolay Aleksandrov 2675adc47037SNikolay Aleksandrov if (!pmctx || igmpv2) 26760436862eSNikolay Aleksandrov continue; 26770436862eSNikolay Aleksandrov 2678262985faSIdo Schimmel spin_lock(&brmctx->br->multicast_lock); 26794cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 26804cdd0d10SNikolay Aleksandrov goto unlock_continue; 26814cdd0d10SNikolay Aleksandrov 2682adc47037SNikolay Aleksandrov mdst = br_mdb_ip4_get(brmctx->br, group, vid); 26830436862eSNikolay Aleksandrov if (!mdst) 26840436862eSNikolay Aleksandrov goto unlock_continue; 2685adc47037SNikolay Aleksandrov pg = br_multicast_find_port(mdst, pmctx->port, src); 26860436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 26870436862eSNikolay Aleksandrov goto unlock_continue; 268854bea721SNikolay Aleksandrov /* reload grec and host addr */ 26890436862eSNikolay Aleksandrov grec = (void *)(skb->data + len - sizeof(*grec) - (nsrcs * 4)); 269054bea721SNikolay Aleksandrov h_addr = &ip_hdr(skb)->saddr; 26910436862eSNikolay Aleksandrov switch (type) { 26920436862eSNikolay Aleksandrov case IGMPV3_ALLOW_NEW_SOURCES: 2693adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 2694adc47037SNikolay Aleksandrov grec->grec_src, 2695474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 26960436862eSNikolay Aleksandrov break; 2697e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_INCLUDE: 2698adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 2699adc47037SNikolay Aleksandrov grec->grec_src, 2700474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2701e6231bcaSNikolay Aleksandrov break; 2702e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_EXCLUDE: 2703adc47037SNikolay Aleksandrov changed = br_multicast_isexc(brmctx, pg, h_addr, 2704adc47037SNikolay Aleksandrov grec->grec_src, 2705ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2706e6231bcaSNikolay Aleksandrov break; 27075bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_INCLUDE: 2708adc47037SNikolay Aleksandrov changed = br_multicast_toin(brmctx, pmctx, pg, h_addr, 2709adc47037SNikolay Aleksandrov grec->grec_src, 2710ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 27115bf1e00bSNikolay Aleksandrov break; 27125bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_EXCLUDE: 2713adc47037SNikolay Aleksandrov changed = br_multicast_toex(brmctx, pmctx, pg, h_addr, 2714adc47037SNikolay Aleksandrov grec->grec_src, 2715ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 27165bf1e00bSNikolay Aleksandrov break; 2717109865feSNikolay Aleksandrov case IGMPV3_BLOCK_OLD_SOURCES: 2718adc47037SNikolay Aleksandrov changed = br_multicast_block(brmctx, pmctx, pg, h_addr, 2719adc47037SNikolay Aleksandrov grec->grec_src, 2720474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2721109865feSNikolay Aleksandrov break; 27220436862eSNikolay Aleksandrov } 27230436862eSNikolay Aleksandrov if (changed) 2724adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mdst, pg, RTM_NEWMDB); 27250436862eSNikolay Aleksandrov unlock_continue: 2726262985faSIdo Schimmel spin_unlock(&brmctx->br->multicast_lock); 2727bc8c20acSSatish Ashok } 2728eb1d1641SHerbert Xu 2729eb1d1641SHerbert Xu return err; 2730eb1d1641SHerbert Xu } 2731eb1d1641SHerbert Xu 2732dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 2733adc47037SNikolay Aleksandrov static int br_ip6_multicast_mld2_report(struct net_bridge_mcast *brmctx, 2734adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 273506499098SVlad Yasevich struct sk_buff *skb, 273606499098SVlad Yasevich u16 vid) 273708b202b6SYOSHIFUJI Hideaki { 2738adc47037SNikolay Aleksandrov bool mldv1 = brmctx->multicast_mld_version == 1; 27390436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 27400436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 2741ba5ea614SLinus Lüssing unsigned int nsrcs_offset; 27426baeb395SMichelleJin struct mld2_report *mld2r; 27436db6f0eaSFelix Fietkau const unsigned char *src; 274454bea721SNikolay Aleksandrov struct in6_addr *h_addr; 274508b202b6SYOSHIFUJI Hideaki struct mld2_grec *grec; 2746ba5ea614SLinus Lüssing unsigned int grec_len; 27470436862eSNikolay Aleksandrov bool changed = false; 27480436862eSNikolay Aleksandrov int i, len, num; 274908b202b6SYOSHIFUJI Hideaki int err = 0; 275008b202b6SYOSHIFUJI Hideaki 27516baeb395SMichelleJin if (!ipv6_mc_may_pull(skb, sizeof(*mld2r))) 275208b202b6SYOSHIFUJI Hideaki return -EINVAL; 275308b202b6SYOSHIFUJI Hideaki 27546baeb395SMichelleJin mld2r = (struct mld2_report *)icmp6_hdr(skb); 27556baeb395SMichelleJin num = ntohs(mld2r->mld2r_ngrec); 27566baeb395SMichelleJin len = skb_transport_offset(skb) + sizeof(*mld2r); 275708b202b6SYOSHIFUJI Hideaki 275808b202b6SYOSHIFUJI Hideaki for (i = 0; i < num; i++) { 2759e57f6185SNikolay Aleksandrov __be16 *_nsrcs, __nsrcs; 2760e57f6185SNikolay Aleksandrov u16 nsrcs; 276108b202b6SYOSHIFUJI Hideaki 2762ba5ea614SLinus Lüssing nsrcs_offset = len + offsetof(struct mld2_grec, grec_nsrcs); 2763ba5ea614SLinus Lüssing 2764ba5ea614SLinus Lüssing if (skb_transport_offset(skb) + ipv6_transport_len(skb) < 27655fc6266aSLinus Lüssing nsrcs_offset + sizeof(__nsrcs)) 2766ba5ea614SLinus Lüssing return -EINVAL; 2767ba5ea614SLinus Lüssing 2768e57f6185SNikolay Aleksandrov _nsrcs = skb_header_pointer(skb, nsrcs_offset, 2769e57f6185SNikolay Aleksandrov sizeof(__nsrcs), &__nsrcs); 2770e57f6185SNikolay Aleksandrov if (!_nsrcs) 277108b202b6SYOSHIFUJI Hideaki return -EINVAL; 277208b202b6SYOSHIFUJI Hideaki 2773e57f6185SNikolay Aleksandrov nsrcs = ntohs(*_nsrcs); 2774e57f6185SNikolay Aleksandrov grec_len = struct_size(grec, grec_src, nsrcs); 2775ba5ea614SLinus Lüssing 2776ba5ea614SLinus Lüssing if (!ipv6_mc_may_pull(skb, len + grec_len)) 277708b202b6SYOSHIFUJI Hideaki return -EINVAL; 277808b202b6SYOSHIFUJI Hideaki 277908b202b6SYOSHIFUJI Hideaki grec = (struct mld2_grec *)(skb->data + len); 2780ba5ea614SLinus Lüssing len += grec_len; 278108b202b6SYOSHIFUJI Hideaki 278208b202b6SYOSHIFUJI Hideaki switch (grec->grec_type) { 278308b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_INCLUDE: 278408b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_EXCLUDE: 278508b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_INCLUDE: 278608b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_EXCLUDE: 278708b202b6SYOSHIFUJI Hideaki case MLD2_ALLOW_NEW_SOURCES: 278808b202b6SYOSHIFUJI Hideaki case MLD2_BLOCK_OLD_SOURCES: 278908b202b6SYOSHIFUJI Hideaki break; 279008b202b6SYOSHIFUJI Hideaki 279108b202b6SYOSHIFUJI Hideaki default: 279208b202b6SYOSHIFUJI Hideaki continue; 279308b202b6SYOSHIFUJI Hideaki } 279408b202b6SYOSHIFUJI Hideaki 27956db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 2796bc8c20acSSatish Ashok if ((grec->grec_type == MLD2_CHANGE_TO_INCLUDE || 2797bc8c20acSSatish Ashok grec->grec_type == MLD2_MODE_IS_INCLUDE) && 2798e57f6185SNikolay Aleksandrov nsrcs == 0) { 2799adc47037SNikolay Aleksandrov if (!pmctx || mldv1) { 2800adc47037SNikolay Aleksandrov br_ip6_multicast_leave_group(brmctx, pmctx, 28010436862eSNikolay Aleksandrov &grec->grec_mca, 28026db6f0eaSFelix Fietkau vid, src); 28030436862eSNikolay Aleksandrov continue; 28040436862eSNikolay Aleksandrov } 2805bc8c20acSSatish Ashok } else { 2806adc47037SNikolay Aleksandrov err = br_ip6_multicast_add_group(brmctx, pmctx, 28076db6f0eaSFelix Fietkau &grec->grec_mca, vid, 28080436862eSNikolay Aleksandrov src, mldv1); 28099264251eSDavide Caratti if (err) 281008b202b6SYOSHIFUJI Hideaki break; 281108b202b6SYOSHIFUJI Hideaki } 28120436862eSNikolay Aleksandrov 2813adc47037SNikolay Aleksandrov if (!pmctx || mldv1) 28140436862eSNikolay Aleksandrov continue; 28150436862eSNikolay Aleksandrov 2816262985faSIdo Schimmel spin_lock(&brmctx->br->multicast_lock); 28174cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 28184cdd0d10SNikolay Aleksandrov goto unlock_continue; 28194cdd0d10SNikolay Aleksandrov 2820adc47037SNikolay Aleksandrov mdst = br_mdb_ip6_get(brmctx->br, &grec->grec_mca, vid); 28210436862eSNikolay Aleksandrov if (!mdst) 28220436862eSNikolay Aleksandrov goto unlock_continue; 2823adc47037SNikolay Aleksandrov pg = br_multicast_find_port(mdst, pmctx->port, src); 28240436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 28250436862eSNikolay Aleksandrov goto unlock_continue; 282654bea721SNikolay Aleksandrov h_addr = &ipv6_hdr(skb)->saddr; 28270436862eSNikolay Aleksandrov switch (grec->grec_type) { 28280436862eSNikolay Aleksandrov case MLD2_ALLOW_NEW_SOURCES: 2829adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 283054bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2831474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 2832474ddb37SNikolay Aleksandrov grec->grec_type); 28330436862eSNikolay Aleksandrov break; 2834e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_INCLUDE: 2835adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 283654bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2837474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 2838474ddb37SNikolay Aleksandrov grec->grec_type); 2839e6231bcaSNikolay Aleksandrov break; 2840e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_EXCLUDE: 2841adc47037SNikolay Aleksandrov changed = br_multicast_isexc(brmctx, pg, h_addr, 284254bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2843ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 2844ddc255d9SNikolay Aleksandrov grec->grec_type); 2845e6231bcaSNikolay Aleksandrov break; 28465bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_INCLUDE: 2847adc47037SNikolay Aleksandrov changed = br_multicast_toin(brmctx, pmctx, pg, h_addr, 284854bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2849ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 2850ddc255d9SNikolay Aleksandrov grec->grec_type); 28515bf1e00bSNikolay Aleksandrov break; 28525bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_EXCLUDE: 2853adc47037SNikolay Aleksandrov changed = br_multicast_toex(brmctx, pmctx, pg, h_addr, 285454bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2855ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 2856ddc255d9SNikolay Aleksandrov grec->grec_type); 28575bf1e00bSNikolay Aleksandrov break; 2858109865feSNikolay Aleksandrov case MLD2_BLOCK_OLD_SOURCES: 2859adc47037SNikolay Aleksandrov changed = br_multicast_block(brmctx, pmctx, pg, h_addr, 286054bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2861474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 2862474ddb37SNikolay Aleksandrov grec->grec_type); 2863109865feSNikolay Aleksandrov break; 28640436862eSNikolay Aleksandrov } 28650436862eSNikolay Aleksandrov if (changed) 2866adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mdst, pg, RTM_NEWMDB); 28670436862eSNikolay Aleksandrov unlock_continue: 2868262985faSIdo Schimmel spin_unlock(&brmctx->br->multicast_lock); 2869bc8c20acSSatish Ashok } 287008b202b6SYOSHIFUJI Hideaki 287108b202b6SYOSHIFUJI Hideaki return err; 287208b202b6SYOSHIFUJI Hideaki } 287308b202b6SYOSHIFUJI Hideaki #endif 287408b202b6SYOSHIFUJI Hideaki 2875c3fb3698SNikolay Aleksandrov static bool br_multicast_select_querier(struct net_bridge_mcast *brmctx, 287654cb4319SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 287767b746f9SNikolay Aleksandrov struct br_ip *saddr) 2878dc4eb53aSLinus Lüssing { 287967b746f9SNikolay Aleksandrov int port_ifidx = pmctx ? pmctx->port->dev->ifindex : 0; 2880c3fb3698SNikolay Aleksandrov struct timer_list *own_timer, *other_timer; 2881c3fb3698SNikolay Aleksandrov struct bridge_mcast_querier *querier; 288254cb4319SNikolay Aleksandrov 2883c3fb3698SNikolay Aleksandrov switch (saddr->proto) { 2884c3fb3698SNikolay Aleksandrov case htons(ETH_P_IP): 2885c3fb3698SNikolay Aleksandrov querier = &brmctx->ip4_querier; 2886c3fb3698SNikolay Aleksandrov own_timer = &brmctx->ip4_own_query.timer; 2887c3fb3698SNikolay Aleksandrov other_timer = &brmctx->ip4_other_query.timer; 2888c3fb3698SNikolay Aleksandrov if (!querier->addr.src.ip4 || 2889c3fb3698SNikolay Aleksandrov ntohl(saddr->src.ip4) <= ntohl(querier->addr.src.ip4)) 2890dc4eb53aSLinus Lüssing goto update; 2891c3fb3698SNikolay Aleksandrov break; 2892dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 2893c3fb3698SNikolay Aleksandrov case htons(ETH_P_IPV6): 2894c3fb3698SNikolay Aleksandrov querier = &brmctx->ip6_querier; 2895c3fb3698SNikolay Aleksandrov own_timer = &brmctx->ip6_own_query.timer; 2896c3fb3698SNikolay Aleksandrov other_timer = &brmctx->ip6_other_query.timer; 2897c3fb3698SNikolay Aleksandrov if (ipv6_addr_cmp(&saddr->src.ip6, &querier->addr.src.ip6) <= 0) 2898dc4eb53aSLinus Lüssing goto update; 2899c3fb3698SNikolay Aleksandrov break; 2900c3fb3698SNikolay Aleksandrov #endif 2901c3fb3698SNikolay Aleksandrov default: 2902c3fb3698SNikolay Aleksandrov return false; 2903c3fb3698SNikolay Aleksandrov } 2904dc4eb53aSLinus Lüssing 2905c3fb3698SNikolay Aleksandrov if (!timer_pending(own_timer) && !timer_pending(other_timer)) 2906dc4eb53aSLinus Lüssing goto update; 2907dc4eb53aSLinus Lüssing 2908dc4eb53aSLinus Lüssing return false; 2909dc4eb53aSLinus Lüssing 2910dc4eb53aSLinus Lüssing update: 2911c3fb3698SNikolay Aleksandrov br_multicast_update_querier(brmctx, querier, port_ifidx, saddr); 29122cd41431SLinus Lüssing 2913dc4eb53aSLinus Lüssing return true; 2914dc4eb53aSLinus Lüssing } 2915dc4eb53aSLinus Lüssing 2916c7fa1d9bSNikolay Aleksandrov static struct net_bridge_port * 2917c7fa1d9bSNikolay Aleksandrov __br_multicast_get_querier_port(struct net_bridge *br, 2918c7fa1d9bSNikolay Aleksandrov const struct bridge_mcast_querier *querier) 2919c7fa1d9bSNikolay Aleksandrov { 2920c7fa1d9bSNikolay Aleksandrov int port_ifidx = READ_ONCE(querier->port_ifidx); 2921c7fa1d9bSNikolay Aleksandrov struct net_bridge_port *p; 2922c7fa1d9bSNikolay Aleksandrov struct net_device *dev; 2923c7fa1d9bSNikolay Aleksandrov 2924c7fa1d9bSNikolay Aleksandrov if (port_ifidx == 0) 2925c7fa1d9bSNikolay Aleksandrov return NULL; 2926c7fa1d9bSNikolay Aleksandrov 2927c7fa1d9bSNikolay Aleksandrov dev = dev_get_by_index_rcu(dev_net(br->dev), port_ifidx); 2928c7fa1d9bSNikolay Aleksandrov if (!dev) 2929c7fa1d9bSNikolay Aleksandrov return NULL; 2930c7fa1d9bSNikolay Aleksandrov p = br_port_get_rtnl_rcu(dev); 2931c7fa1d9bSNikolay Aleksandrov if (!p || p->br != br) 2932c7fa1d9bSNikolay Aleksandrov return NULL; 2933c7fa1d9bSNikolay Aleksandrov 2934c7fa1d9bSNikolay Aleksandrov return p; 2935c7fa1d9bSNikolay Aleksandrov } 2936c7fa1d9bSNikolay Aleksandrov 2937c7fa1d9bSNikolay Aleksandrov size_t br_multicast_querier_state_size(void) 2938c7fa1d9bSNikolay Aleksandrov { 2939cdda378bSNikolay Aleksandrov return nla_total_size(0) + /* nest attribute */ 2940c7fa1d9bSNikolay Aleksandrov nla_total_size(sizeof(__be32)) + /* BRIDGE_QUERIER_IP_ADDRESS */ 2941c7fa1d9bSNikolay Aleksandrov nla_total_size(sizeof(int)) + /* BRIDGE_QUERIER_IP_PORT */ 2942175e6692SNikolay Aleksandrov nla_total_size_64bit(sizeof(u64)) + /* BRIDGE_QUERIER_IP_OTHER_TIMER */ 2943175e6692SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 2944175e6692SNikolay Aleksandrov nla_total_size(sizeof(struct in6_addr)) + /* BRIDGE_QUERIER_IPV6_ADDRESS */ 2945175e6692SNikolay Aleksandrov nla_total_size(sizeof(int)) + /* BRIDGE_QUERIER_IPV6_PORT */ 2946175e6692SNikolay Aleksandrov nla_total_size_64bit(sizeof(u64)) + /* BRIDGE_QUERIER_IPV6_OTHER_TIMER */ 2947175e6692SNikolay Aleksandrov #endif 2948175e6692SNikolay Aleksandrov 0; 2949c7fa1d9bSNikolay Aleksandrov } 2950c7fa1d9bSNikolay Aleksandrov 2951c7fa1d9bSNikolay Aleksandrov /* protected by rtnl or rcu */ 2952c7fa1d9bSNikolay Aleksandrov int br_multicast_dump_querier_state(struct sk_buff *skb, 2953c7fa1d9bSNikolay Aleksandrov const struct net_bridge_mcast *brmctx, 2954c7fa1d9bSNikolay Aleksandrov int nest_attr) 2955c7fa1d9bSNikolay Aleksandrov { 2956c7fa1d9bSNikolay Aleksandrov struct bridge_mcast_querier querier = {}; 2957c7fa1d9bSNikolay Aleksandrov struct net_bridge_port *p; 2958c7fa1d9bSNikolay Aleksandrov struct nlattr *nest; 2959c7fa1d9bSNikolay Aleksandrov 2960f137b7d4SNikolay Aleksandrov if (!br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED) || 2961f137b7d4SNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(brmctx)) 2962f137b7d4SNikolay Aleksandrov return 0; 2963f137b7d4SNikolay Aleksandrov 2964c7fa1d9bSNikolay Aleksandrov nest = nla_nest_start(skb, nest_attr); 2965c7fa1d9bSNikolay Aleksandrov if (!nest) 2966c7fa1d9bSNikolay Aleksandrov return -EMSGSIZE; 2967c7fa1d9bSNikolay Aleksandrov 2968c7fa1d9bSNikolay Aleksandrov rcu_read_lock(); 296985b41082SNikolay Aleksandrov if (!brmctx->multicast_querier && 297085b41082SNikolay Aleksandrov !timer_pending(&brmctx->ip4_other_query.timer)) 297185b41082SNikolay Aleksandrov goto out_v6; 297285b41082SNikolay Aleksandrov 2973c7fa1d9bSNikolay Aleksandrov br_multicast_read_querier(&brmctx->ip4_querier, &querier); 2974c7fa1d9bSNikolay Aleksandrov if (nla_put_in_addr(skb, BRIDGE_QUERIER_IP_ADDRESS, 2975c7fa1d9bSNikolay Aleksandrov querier.addr.src.ip4)) { 2976c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 2977c7fa1d9bSNikolay Aleksandrov goto out_err; 2978c7fa1d9bSNikolay Aleksandrov } 2979c7fa1d9bSNikolay Aleksandrov 2980c7fa1d9bSNikolay Aleksandrov p = __br_multicast_get_querier_port(brmctx->br, &querier); 2981c7fa1d9bSNikolay Aleksandrov if (timer_pending(&brmctx->ip4_other_query.timer) && 2982c7fa1d9bSNikolay Aleksandrov (nla_put_u64_64bit(skb, BRIDGE_QUERIER_IP_OTHER_TIMER, 2983c7fa1d9bSNikolay Aleksandrov br_timer_value(&brmctx->ip4_other_query.timer), 2984c7fa1d9bSNikolay Aleksandrov BRIDGE_QUERIER_PAD) || 2985c7fa1d9bSNikolay Aleksandrov (p && nla_put_u32(skb, BRIDGE_QUERIER_IP_PORT, p->dev->ifindex)))) { 2986c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 2987c7fa1d9bSNikolay Aleksandrov goto out_err; 2988c7fa1d9bSNikolay Aleksandrov } 298985b41082SNikolay Aleksandrov 299085b41082SNikolay Aleksandrov out_v6: 299185b41082SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 299285b41082SNikolay Aleksandrov if (!brmctx->multicast_querier && 299385b41082SNikolay Aleksandrov !timer_pending(&brmctx->ip6_other_query.timer)) 299485b41082SNikolay Aleksandrov goto out; 299585b41082SNikolay Aleksandrov 299685b41082SNikolay Aleksandrov br_multicast_read_querier(&brmctx->ip6_querier, &querier); 299785b41082SNikolay Aleksandrov if (nla_put_in6_addr(skb, BRIDGE_QUERIER_IPV6_ADDRESS, 299885b41082SNikolay Aleksandrov &querier.addr.src.ip6)) { 299985b41082SNikolay Aleksandrov rcu_read_unlock(); 300085b41082SNikolay Aleksandrov goto out_err; 300185b41082SNikolay Aleksandrov } 300285b41082SNikolay Aleksandrov 300385b41082SNikolay Aleksandrov p = __br_multicast_get_querier_port(brmctx->br, &querier); 300485b41082SNikolay Aleksandrov if (timer_pending(&brmctx->ip6_other_query.timer) && 300585b41082SNikolay Aleksandrov (nla_put_u64_64bit(skb, BRIDGE_QUERIER_IPV6_OTHER_TIMER, 300685b41082SNikolay Aleksandrov br_timer_value(&brmctx->ip6_other_query.timer), 300785b41082SNikolay Aleksandrov BRIDGE_QUERIER_PAD) || 300885b41082SNikolay Aleksandrov (p && nla_put_u32(skb, BRIDGE_QUERIER_IPV6_PORT, 300985b41082SNikolay Aleksandrov p->dev->ifindex)))) { 301085b41082SNikolay Aleksandrov rcu_read_unlock(); 301185b41082SNikolay Aleksandrov goto out_err; 301285b41082SNikolay Aleksandrov } 301385b41082SNikolay Aleksandrov out: 301485b41082SNikolay Aleksandrov #endif 3015c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 3016c7fa1d9bSNikolay Aleksandrov nla_nest_end(skb, nest); 301785b41082SNikolay Aleksandrov if (!nla_len(nest)) 301885b41082SNikolay Aleksandrov nla_nest_cancel(skb, nest); 3019c7fa1d9bSNikolay Aleksandrov 3020c7fa1d9bSNikolay Aleksandrov return 0; 3021c7fa1d9bSNikolay Aleksandrov 3022c7fa1d9bSNikolay Aleksandrov out_err: 3023c7fa1d9bSNikolay Aleksandrov nla_nest_cancel(skb, nest); 3024c7fa1d9bSNikolay Aleksandrov return -EMSGSIZE; 3025c7fa1d9bSNikolay Aleksandrov } 3026c7fa1d9bSNikolay Aleksandrov 3027cc0fdd80SLinus Lüssing static void 3028adc47037SNikolay Aleksandrov br_multicast_update_query_timer(struct net_bridge_mcast *brmctx, 302990010b36SLinus Lüssing struct bridge_mcast_other_query *query, 3030b00589afSLinus Lüssing unsigned long max_delay) 3031b00589afSLinus Lüssing { 303290010b36SLinus Lüssing if (!timer_pending(&query->timer)) 303390010b36SLinus Lüssing query->delay_time = jiffies + max_delay; 3034b00589afSLinus Lüssing 3035adc47037SNikolay Aleksandrov mod_timer(&query->timer, jiffies + brmctx->multicast_querier_interval); 3036b00589afSLinus Lüssing } 3037b00589afSLinus Lüssing 30386d549648SNogah Frankel static void br_port_mc_router_state_change(struct net_bridge_port *p, 30396d549648SNogah Frankel bool is_mc_router) 30406d549648SNogah Frankel { 30416d549648SNogah Frankel struct switchdev_attr attr = { 30426d549648SNogah Frankel .orig_dev = p->dev, 30436d549648SNogah Frankel .id = SWITCHDEV_ATTR_ID_PORT_MROUTER, 30446d549648SNogah Frankel .flags = SWITCHDEV_F_DEFER, 30456d549648SNogah Frankel .u.mrouter = is_mc_router, 30466d549648SNogah Frankel }; 30476d549648SNogah Frankel 3048dcbdf135SVladimir Oltean switchdev_port_attr_set(p->dev, &attr, NULL); 30496d549648SNogah Frankel } 30506d549648SNogah Frankel 3051d9b8c4d8SLinus Lüssing static struct net_bridge_port * 3052d3d065c0SNikolay Aleksandrov br_multicast_rport_from_node(struct net_bridge_mcast *brmctx, 3053d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list, 3054d9b8c4d8SLinus Lüssing struct hlist_node *rlist) 3055d9b8c4d8SLinus Lüssing { 30569632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 30579632233eSNikolay Aleksandrov 3058a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3059d3d065c0SNikolay Aleksandrov if (mc_router_list == &brmctx->ip6_mc_router_list) 30609632233eSNikolay Aleksandrov pmctx = hlist_entry(rlist, struct net_bridge_mcast_port, 30619632233eSNikolay Aleksandrov ip6_rlist); 30629632233eSNikolay Aleksandrov else 3063a3c02e76SLinus Lüssing #endif 30649632233eSNikolay Aleksandrov pmctx = hlist_entry(rlist, struct net_bridge_mcast_port, 30659632233eSNikolay Aleksandrov ip4_rlist); 30669632233eSNikolay Aleksandrov 30679632233eSNikolay Aleksandrov return pmctx->port; 3068d9b8c4d8SLinus Lüssing } 3069d9b8c4d8SLinus Lüssing 3070d9b8c4d8SLinus Lüssing static struct hlist_node * 3071d3d065c0SNikolay Aleksandrov br_multicast_get_rport_slot(struct net_bridge_mcast *brmctx, 3072d9b8c4d8SLinus Lüssing struct net_bridge_port *port, 3073d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 3074d9b8c4d8SLinus Lüssing 3075d9b8c4d8SLinus Lüssing { 3076d9b8c4d8SLinus Lüssing struct hlist_node *slot = NULL; 3077d9b8c4d8SLinus Lüssing struct net_bridge_port *p; 3078d9b8c4d8SLinus Lüssing struct hlist_node *rlist; 3079d9b8c4d8SLinus Lüssing 3080d9b8c4d8SLinus Lüssing hlist_for_each(rlist, mc_router_list) { 3081d3d065c0SNikolay Aleksandrov p = br_multicast_rport_from_node(brmctx, mc_router_list, rlist); 3082d9b8c4d8SLinus Lüssing 3083d9b8c4d8SLinus Lüssing if ((unsigned long)port >= (unsigned long)p) 3084d9b8c4d8SLinus Lüssing break; 3085d9b8c4d8SLinus Lüssing 3086d9b8c4d8SLinus Lüssing slot = rlist; 3087d9b8c4d8SLinus Lüssing } 3088d9b8c4d8SLinus Lüssing 3089d9b8c4d8SLinus Lüssing return slot; 3090d9b8c4d8SLinus Lüssing } 3091d9b8c4d8SLinus Lüssing 3092adc47037SNikolay Aleksandrov static bool br_multicast_no_router_otherpf(struct net_bridge_mcast_port *pmctx, 3093a3c02e76SLinus Lüssing struct hlist_node *rnode) 3094a3c02e76SLinus Lüssing { 3095a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3096adc47037SNikolay Aleksandrov if (rnode != &pmctx->ip6_rlist) 3097adc47037SNikolay Aleksandrov return hlist_unhashed(&pmctx->ip6_rlist); 3098a3c02e76SLinus Lüssing else 3099adc47037SNikolay Aleksandrov return hlist_unhashed(&pmctx->ip4_rlist); 3100a3c02e76SLinus Lüssing #else 3101a3c02e76SLinus Lüssing return true; 3102a3c02e76SLinus Lüssing #endif 3103a3c02e76SLinus Lüssing } 3104a3c02e76SLinus Lüssing 3105d9b8c4d8SLinus Lüssing /* Add port to router_list 31067e80c124Sstephen hemminger * list is maintained ordered by pointer value 31077e80c124Sstephen hemminger * and locked by br->multicast_lock and RCU 31087e80c124Sstephen hemminger */ 3109d3d065c0SNikolay Aleksandrov static void br_multicast_add_router(struct net_bridge_mcast *brmctx, 3110adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3111d9b8c4d8SLinus Lüssing struct hlist_node *rlist, 3112d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 31130909e117SHerbert Xu { 3114d9b8c4d8SLinus Lüssing struct hlist_node *slot; 31150909e117SHerbert Xu 3116d9b8c4d8SLinus Lüssing if (!hlist_unhashed(rlist)) 31171a040eacSNikolay Aleksandrov return; 31181a040eacSNikolay Aleksandrov 3119adc47037SNikolay Aleksandrov slot = br_multicast_get_rport_slot(brmctx, pmctx->port, mc_router_list); 31200909e117SHerbert Xu 31217e80c124Sstephen hemminger if (slot) 3122d9b8c4d8SLinus Lüssing hlist_add_behind_rcu(rlist, slot); 3123dcdca2c4Sstephen hemminger else 3124d9b8c4d8SLinus Lüssing hlist_add_head_rcu(rlist, mc_router_list); 3125d9b8c4d8SLinus Lüssing 3126a3c02e76SLinus Lüssing /* For backwards compatibility for now, only notify if we 3127a3c02e76SLinus Lüssing * switched from no IPv4/IPv6 multicast router to a new 3128a3c02e76SLinus Lüssing * IPv4 or IPv6 multicast router. 3129a3c02e76SLinus Lüssing */ 3130adc47037SNikolay Aleksandrov if (br_multicast_no_router_otherpf(pmctx, rlist)) { 31311e9ca456SNikolay Aleksandrov br_rtr_notify(pmctx->port->br->dev, pmctx, RTM_NEWMDB); 3132adc47037SNikolay Aleksandrov br_port_mc_router_state_change(pmctx->port, true); 31330909e117SHerbert Xu } 3134a3c02e76SLinus Lüssing } 31350909e117SHerbert Xu 3136d9b8c4d8SLinus Lüssing /* Add port to router_list 3137d9b8c4d8SLinus Lüssing * list is maintained ordered by pointer value 3138d9b8c4d8SLinus Lüssing * and locked by br->multicast_lock and RCU 3139d9b8c4d8SLinus Lüssing */ 3140adc47037SNikolay Aleksandrov static void br_ip4_multicast_add_router(struct net_bridge_mcast *brmctx, 3141adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3142eb1d1641SHerbert Xu { 3143adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, &pmctx->ip4_rlist, 3144adc47037SNikolay Aleksandrov &brmctx->ip4_mc_router_list); 3145d9b8c4d8SLinus Lüssing } 3146d9b8c4d8SLinus Lüssing 3147a3c02e76SLinus Lüssing /* Add port to router_list 3148a3c02e76SLinus Lüssing * list is maintained ordered by pointer value 3149a3c02e76SLinus Lüssing * and locked by br->multicast_lock and RCU 3150a3c02e76SLinus Lüssing */ 3151adc47037SNikolay Aleksandrov static void br_ip6_multicast_add_router(struct net_bridge_mcast *brmctx, 3152adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3153a3c02e76SLinus Lüssing { 3154a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3155adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, &pmctx->ip6_rlist, 3156adc47037SNikolay Aleksandrov &brmctx->ip6_mc_router_list); 3157a3c02e76SLinus Lüssing #endif 3158a3c02e76SLinus Lüssing } 3159a3c02e76SLinus Lüssing 3160adc47037SNikolay Aleksandrov static void br_multicast_mark_router(struct net_bridge_mcast *brmctx, 3161adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3162d9b8c4d8SLinus Lüssing struct timer_list *timer, 3163d9b8c4d8SLinus Lüssing struct hlist_node *rlist, 3164d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 3165d9b8c4d8SLinus Lüssing { 3166eb1d1641SHerbert Xu unsigned long now = jiffies; 3167eb1d1641SHerbert Xu 31684cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 31694cdd0d10SNikolay Aleksandrov return; 31704cdd0d10SNikolay Aleksandrov 3171adc47037SNikolay Aleksandrov if (!pmctx) { 3172d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router == MDB_RTR_TYPE_TEMP_QUERY) { 3173d3d065c0SNikolay Aleksandrov if (!br_ip4_multicast_is_router(brmctx) && 3174d3d065c0SNikolay Aleksandrov !br_ip6_multicast_is_router(brmctx)) 3175adc47037SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, true); 3176d3d065c0SNikolay Aleksandrov mod_timer(timer, now + brmctx->multicast_querier_interval); 317777041420SYotam Gigi } 3178eb1d1641SHerbert Xu return; 3179eb1d1641SHerbert Xu } 3180eb1d1641SHerbert Xu 3181adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 3182adc47037SNikolay Aleksandrov pmctx->multicast_router == MDB_RTR_TYPE_PERM) 3183eb1d1641SHerbert Xu return; 3184eb1d1641SHerbert Xu 3185adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, rlist, mc_router_list); 3186d3d065c0SNikolay Aleksandrov mod_timer(timer, now + brmctx->multicast_querier_interval); 3187d9b8c4d8SLinus Lüssing } 3188eb1d1641SHerbert Xu 3189adc47037SNikolay Aleksandrov static void br_ip4_multicast_mark_router(struct net_bridge_mcast *brmctx, 3190adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3191d9b8c4d8SLinus Lüssing { 3192adc47037SNikolay Aleksandrov struct timer_list *timer = &brmctx->ip4_mc_router_timer; 3193d9b8c4d8SLinus Lüssing struct hlist_node *rlist = NULL; 3194d9b8c4d8SLinus Lüssing 3195adc47037SNikolay Aleksandrov if (pmctx) { 3196adc47037SNikolay Aleksandrov timer = &pmctx->ip4_mc_router_timer; 3197adc47037SNikolay Aleksandrov rlist = &pmctx->ip4_rlist; 3198d9b8c4d8SLinus Lüssing } 3199d9b8c4d8SLinus Lüssing 3200adc47037SNikolay Aleksandrov br_multicast_mark_router(brmctx, pmctx, timer, rlist, 3201adc47037SNikolay Aleksandrov &brmctx->ip4_mc_router_list); 3202eb1d1641SHerbert Xu } 3203eb1d1641SHerbert Xu 3204adc47037SNikolay Aleksandrov static void br_ip6_multicast_mark_router(struct net_bridge_mcast *brmctx, 3205adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3206a3c02e76SLinus Lüssing { 3207a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3208adc47037SNikolay Aleksandrov struct timer_list *timer = &brmctx->ip6_mc_router_timer; 3209a3c02e76SLinus Lüssing struct hlist_node *rlist = NULL; 3210a3c02e76SLinus Lüssing 3211adc47037SNikolay Aleksandrov if (pmctx) { 3212adc47037SNikolay Aleksandrov timer = &pmctx->ip6_mc_router_timer; 3213adc47037SNikolay Aleksandrov rlist = &pmctx->ip6_rlist; 3214a3c02e76SLinus Lüssing } 3215a3c02e76SLinus Lüssing 3216adc47037SNikolay Aleksandrov br_multicast_mark_router(brmctx, pmctx, timer, rlist, 3217adc47037SNikolay Aleksandrov &brmctx->ip6_mc_router_list); 3218a3c02e76SLinus Lüssing #endif 3219a3c02e76SLinus Lüssing } 3220a3c02e76SLinus Lüssing 3221b19232efSLinus Lüssing static void 3222adc47037SNikolay Aleksandrov br_ip4_multicast_query_received(struct net_bridge_mcast *brmctx, 3223adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 322490010b36SLinus Lüssing struct bridge_mcast_other_query *query, 3225dc4eb53aSLinus Lüssing struct br_ip *saddr, 3226b00589afSLinus Lüssing unsigned long max_delay) 3227eb1d1641SHerbert Xu { 3228c3fb3698SNikolay Aleksandrov if (!br_multicast_select_querier(brmctx, pmctx, saddr)) 3229eb1d1641SHerbert Xu return; 3230eb1d1641SHerbert Xu 3231adc47037SNikolay Aleksandrov br_multicast_update_query_timer(brmctx, query, max_delay); 3232adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3233eb1d1641SHerbert Xu } 3234eb1d1641SHerbert Xu 3235b19232efSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3236b19232efSLinus Lüssing static void 3237adc47037SNikolay Aleksandrov br_ip6_multicast_query_received(struct net_bridge_mcast *brmctx, 3238adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3239b19232efSLinus Lüssing struct bridge_mcast_other_query *query, 3240b19232efSLinus Lüssing struct br_ip *saddr, 3241b19232efSLinus Lüssing unsigned long max_delay) 3242b19232efSLinus Lüssing { 3243c3fb3698SNikolay Aleksandrov if (!br_multicast_select_querier(brmctx, pmctx, saddr)) 3244b19232efSLinus Lüssing return; 3245b19232efSLinus Lüssing 3246adc47037SNikolay Aleksandrov br_multicast_update_query_timer(brmctx, query, max_delay); 3247adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 3248b19232efSLinus Lüssing } 3249b19232efSLinus Lüssing #endif 3250b19232efSLinus Lüssing 3251adc47037SNikolay Aleksandrov static void br_ip4_multicast_query(struct net_bridge_mcast *brmctx, 3252adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 325306499098SVlad Yasevich struct sk_buff *skb, 325406499098SVlad Yasevich u16 vid) 3255eb1d1641SHerbert Xu { 3256ba5ea614SLinus Lüssing unsigned int transport_len = ip_transport_len(skb); 3257b71d1d42SEric Dumazet const struct iphdr *iph = ip_hdr(skb); 3258eb1d1641SHerbert Xu struct igmphdr *ih = igmp_hdr(skb); 3259eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 3260eb1d1641SHerbert Xu struct igmpv3_query *ih3; 3261eb1d1641SHerbert Xu struct net_bridge_port_group *p; 3262e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 326367b746f9SNikolay Aleksandrov struct br_ip saddr = {}; 3264eb1d1641SHerbert Xu unsigned long max_delay; 3265eb1d1641SHerbert Xu unsigned long now = jiffies; 3266eb1d1641SHerbert Xu __be32 group; 3267eb1d1641SHerbert Xu 3268adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 32694cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 3270eb1d1641SHerbert Xu goto out; 3271eb1d1641SHerbert Xu 3272eb1d1641SHerbert Xu group = ih->group; 3273eb1d1641SHerbert Xu 3274ba5ea614SLinus Lüssing if (transport_len == sizeof(*ih)) { 3275eb1d1641SHerbert Xu max_delay = ih->code * (HZ / IGMP_TIMER_SCALE); 3276eb1d1641SHerbert Xu 3277eb1d1641SHerbert Xu if (!max_delay) { 3278eb1d1641SHerbert Xu max_delay = 10 * HZ; 3279eb1d1641SHerbert Xu group = 0; 3280eb1d1641SHerbert Xu } 3281ba5ea614SLinus Lüssing } else if (transport_len >= sizeof(*ih3)) { 3282eb1d1641SHerbert Xu ih3 = igmpv3_query_hdr(skb); 328323550b83SNikolay Aleksandrov if (ih3->nsrcs || 3284d3d065c0SNikolay Aleksandrov (brmctx->multicast_igmp_version == 3 && group && 3285d3d065c0SNikolay Aleksandrov ih3->suppress)) 3286bec68ff1SYOSHIFUJI Hideaki goto out; 3287eb1d1641SHerbert Xu 32880ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 max_delay = ih3->code ? 32890ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 IGMPV3_MRC(ih3->code) * (HZ / IGMP_TIMER_SCALE) : 1; 32909afd85c9SLinus Lüssing } else { 32919ed973ccSLinus Lüssing goto out; 32929ed973ccSLinus Lüssing } 32939ed973ccSLinus Lüssing 3294dc4eb53aSLinus Lüssing if (!group) { 3295dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IP); 3296deb96566SNikolay Aleksandrov saddr.src.ip4 = iph->saddr; 3297b00589afSLinus Lüssing 3298adc47037SNikolay Aleksandrov br_ip4_multicast_query_received(brmctx, pmctx, 3299d3d065c0SNikolay Aleksandrov &brmctx->ip4_other_query, 3300dc4eb53aSLinus Lüssing &saddr, max_delay); 3301eb1d1641SHerbert Xu goto out; 3302dc4eb53aSLinus Lüssing } 3303eb1d1641SHerbert Xu 3304adc47037SNikolay Aleksandrov mp = br_mdb_ip4_get(brmctx->br, group, vid); 3305eb1d1641SHerbert Xu if (!mp) 3306eb1d1641SHerbert Xu goto out; 3307eb1d1641SHerbert Xu 3308d3d065c0SNikolay Aleksandrov max_delay *= brmctx->multicast_last_member_count; 3309eb1d1641SHerbert Xu 3310ff0fd34eSAndrew Lunn if (mp->host_joined && 3311eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 3312eb1d1641SHerbert Xu time_after(mp->timer.expires, now + max_delay) : 3313eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) 3314eb1d1641SHerbert Xu mod_timer(&mp->timer, now + max_delay); 3315eb1d1641SHerbert Xu 3316e8051688SEric Dumazet for (pp = &mp->ports; 3317adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3318e8051688SEric Dumazet pp = &p->next) { 3319eb1d1641SHerbert Xu if (timer_pending(&p->timer) ? 3320eb1d1641SHerbert Xu time_after(p->timer.expires, now + max_delay) : 332123550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 3322d3d065c0SNikolay Aleksandrov (brmctx->multicast_igmp_version == 2 || 332323550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 332424f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 3325eb1d1641SHerbert Xu } 3326eb1d1641SHerbert Xu 3327eb1d1641SHerbert Xu out: 3328adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3329eb1d1641SHerbert Xu } 3330eb1d1641SHerbert Xu 3331dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3332adc47037SNikolay Aleksandrov static int br_ip6_multicast_query(struct net_bridge_mcast *brmctx, 3333adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 333406499098SVlad Yasevich struct sk_buff *skb, 333506499098SVlad Yasevich u16 vid) 333608b202b6SYOSHIFUJI Hideaki { 3337ba5ea614SLinus Lüssing unsigned int transport_len = ipv6_transport_len(skb); 3338eca2a43bSstephen hemminger struct mld_msg *mld; 333908b202b6SYOSHIFUJI Hideaki struct net_bridge_mdb_entry *mp; 334008b202b6SYOSHIFUJI Hideaki struct mld2_query *mld2q; 3341e8051688SEric Dumazet struct net_bridge_port_group *p; 3342e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 334367b746f9SNikolay Aleksandrov struct br_ip saddr = {}; 334408b202b6SYOSHIFUJI Hideaki unsigned long max_delay; 334508b202b6SYOSHIFUJI Hideaki unsigned long now = jiffies; 3346856ce5d0SLinus Lüssing unsigned int offset = skb_transport_offset(skb); 3347b71d1d42SEric Dumazet const struct in6_addr *group = NULL; 33489ed973ccSLinus Lüssing bool is_general_query; 334908b202b6SYOSHIFUJI Hideaki int err = 0; 335008b202b6SYOSHIFUJI Hideaki 3351adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 33524cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 335308b202b6SYOSHIFUJI Hideaki goto out; 335408b202b6SYOSHIFUJI Hideaki 3355ba5ea614SLinus Lüssing if (transport_len == sizeof(*mld)) { 3356856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld))) { 335708b202b6SYOSHIFUJI Hideaki err = -EINVAL; 335808b202b6SYOSHIFUJI Hideaki goto out; 335908b202b6SYOSHIFUJI Hideaki } 336008b202b6SYOSHIFUJI Hideaki mld = (struct mld_msg *) icmp6_hdr(skb); 33614715213dSLi RongQing max_delay = msecs_to_jiffies(ntohs(mld->mld_maxdelay)); 336208b202b6SYOSHIFUJI Hideaki if (max_delay) 336308b202b6SYOSHIFUJI Hideaki group = &mld->mld_mca; 3364248ba8ecSLinus Lüssing } else { 3365856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld2q))) { 336608b202b6SYOSHIFUJI Hideaki err = -EINVAL; 336708b202b6SYOSHIFUJI Hideaki goto out; 336808b202b6SYOSHIFUJI Hideaki } 336908b202b6SYOSHIFUJI Hideaki mld2q = (struct mld2_query *)icmp6_hdr(skb); 337008b202b6SYOSHIFUJI Hideaki if (!mld2q->mld2q_nsrcs) 337108b202b6SYOSHIFUJI Hideaki group = &mld2q->mld2q_mca; 3372d3d065c0SNikolay Aleksandrov if (brmctx->multicast_mld_version == 2 && 337323550b83SNikolay Aleksandrov !ipv6_addr_any(&mld2q->mld2q_mca) && 337423550b83SNikolay Aleksandrov mld2q->mld2q_suppress) 337523550b83SNikolay Aleksandrov goto out; 3376e3f5b170SDaniel Borkmann 3377e3f5b170SDaniel Borkmann max_delay = max(msecs_to_jiffies(mldv2_mrc(mld2q)), 1UL); 337808b202b6SYOSHIFUJI Hideaki } 337908b202b6SYOSHIFUJI Hideaki 33809ed973ccSLinus Lüssing is_general_query = group && ipv6_addr_any(group); 33819ed973ccSLinus Lüssing 3382dc4eb53aSLinus Lüssing if (is_general_query) { 3383dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IPV6); 3384deb96566SNikolay Aleksandrov saddr.src.ip6 = ipv6_hdr(skb)->saddr; 3385b00589afSLinus Lüssing 3386adc47037SNikolay Aleksandrov br_ip6_multicast_query_received(brmctx, pmctx, 3387d3d065c0SNikolay Aleksandrov &brmctx->ip6_other_query, 3388dc4eb53aSLinus Lüssing &saddr, max_delay); 338908b202b6SYOSHIFUJI Hideaki goto out; 33906c03ee8bSLinus Lüssing } else if (!group) { 33916c03ee8bSLinus Lüssing goto out; 3392dc4eb53aSLinus Lüssing } 339308b202b6SYOSHIFUJI Hideaki 3394adc47037SNikolay Aleksandrov mp = br_mdb_ip6_get(brmctx->br, group, vid); 339508b202b6SYOSHIFUJI Hideaki if (!mp) 339608b202b6SYOSHIFUJI Hideaki goto out; 339708b202b6SYOSHIFUJI Hideaki 3398d3d065c0SNikolay Aleksandrov max_delay *= brmctx->multicast_last_member_count; 3399ff0fd34eSAndrew Lunn if (mp->host_joined && 340008b202b6SYOSHIFUJI Hideaki (timer_pending(&mp->timer) ? 340108b202b6SYOSHIFUJI Hideaki time_after(mp->timer.expires, now + max_delay) : 340208b202b6SYOSHIFUJI Hideaki try_to_del_timer_sync(&mp->timer) >= 0)) 340308b202b6SYOSHIFUJI Hideaki mod_timer(&mp->timer, now + max_delay); 340408b202b6SYOSHIFUJI Hideaki 3405e8051688SEric Dumazet for (pp = &mp->ports; 3406adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3407e8051688SEric Dumazet pp = &p->next) { 340808b202b6SYOSHIFUJI Hideaki if (timer_pending(&p->timer) ? 340908b202b6SYOSHIFUJI Hideaki time_after(p->timer.expires, now + max_delay) : 341023550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 3411d3d065c0SNikolay Aleksandrov (brmctx->multicast_mld_version == 1 || 341223550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 341324f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 341408b202b6SYOSHIFUJI Hideaki } 341508b202b6SYOSHIFUJI Hideaki 341608b202b6SYOSHIFUJI Hideaki out: 3417adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 341808b202b6SYOSHIFUJI Hideaki return err; 341908b202b6SYOSHIFUJI Hideaki } 342008b202b6SYOSHIFUJI Hideaki #endif 342108b202b6SYOSHIFUJI Hideaki 342290010b36SLinus Lüssing static void 3423adc47037SNikolay Aleksandrov br_multicast_leave_group(struct net_bridge_mcast *brmctx, 3424adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3425cc0fdd80SLinus Lüssing struct br_ip *group, 342690010b36SLinus Lüssing struct bridge_mcast_other_query *other_query, 34276db6f0eaSFelix Fietkau struct bridge_mcast_own_query *own_query, 34286db6f0eaSFelix Fietkau const unsigned char *src) 3429eb1d1641SHerbert Xu { 3430eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 3431eb1d1641SHerbert Xu struct net_bridge_port_group *p; 3432eb1d1641SHerbert Xu unsigned long now; 3433eb1d1641SHerbert Xu unsigned long time; 3434eb1d1641SHerbert Xu 3435adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 34364cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 3437eb1d1641SHerbert Xu goto out; 3438eb1d1641SHerbert Xu 3439adc47037SNikolay Aleksandrov mp = br_mdb_ip_get(brmctx->br, group); 3440eb1d1641SHerbert Xu if (!mp) 3441eb1d1641SHerbert Xu goto out; 3442eb1d1641SHerbert Xu 3443adc47037SNikolay Aleksandrov if (pmctx && (pmctx->port->flags & BR_MULTICAST_FAST_LEAVE)) { 3444544586f7SSatish Ashok struct net_bridge_port_group __rcu **pp; 3445544586f7SSatish Ashok 3446544586f7SSatish Ashok for (pp = &mp->ports; 3447adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3448544586f7SSatish Ashok pp = &p->next) { 3449adc47037SNikolay Aleksandrov if (!br_port_group_equal(p, pmctx->port, src)) 3450544586f7SSatish Ashok continue; 3451544586f7SSatish Ashok 34525c725b6bSNikolay Aleksandrov if (p->flags & MDB_PG_FLAGS_PERMANENT) 34535c725b6bSNikolay Aleksandrov break; 34545c725b6bSNikolay Aleksandrov 3455681590bdSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_FAST_LEAVE; 3456681590bdSNikolay Aleksandrov br_multicast_del_pg(mp, p, pp); 3457544586f7SSatish Ashok } 3458544586f7SSatish Ashok goto out; 3459544586f7SSatish Ashok } 3460544586f7SSatish Ashok 3461544586f7SSatish Ashok if (timer_pending(&other_query->timer)) 3462544586f7SSatish Ashok goto out; 3463544586f7SSatish Ashok 34644d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier) { 3465adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, NULL, NULL, &mp->addr, 346642c11ccfSNikolay Aleksandrov false, 0, NULL); 34676b7df111SCong Wang 3468d3d065c0SNikolay Aleksandrov time = jiffies + brmctx->multicast_last_member_count * 3469d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval; 3470cc0fdd80SLinus Lüssing 347190010b36SLinus Lüssing mod_timer(&own_query->timer, time); 34726b7df111SCong Wang 3473adc47037SNikolay Aleksandrov for (p = mlock_dereference(mp->ports, brmctx->br); 347454cb4319SNikolay Aleksandrov p != NULL && pmctx != NULL; 3475adc47037SNikolay Aleksandrov p = mlock_dereference(p->next, brmctx->br)) { 3476adc47037SNikolay Aleksandrov if (!br_port_group_equal(p, pmctx->port, src)) 34776b7df111SCong Wang continue; 34786b7df111SCong Wang 34796b7df111SCong Wang if (!hlist_unhashed(&p->mglist) && 34806b7df111SCong Wang (timer_pending(&p->timer) ? 34816b7df111SCong Wang time_after(p->timer.expires, time) : 34826b7df111SCong Wang try_to_del_timer_sync(&p->timer) >= 0)) { 34836b7df111SCong Wang mod_timer(&p->timer, time); 34846b7df111SCong Wang } 34856b7df111SCong Wang 34866b7df111SCong Wang break; 34876b7df111SCong Wang } 34886b7df111SCong Wang } 34896b7df111SCong Wang 3490eb1d1641SHerbert Xu now = jiffies; 3491d3d065c0SNikolay Aleksandrov time = now + brmctx->multicast_last_member_count * 3492d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval; 3493eb1d1641SHerbert Xu 3494adc47037SNikolay Aleksandrov if (!pmctx) { 3495ff0fd34eSAndrew Lunn if (mp->host_joined && 3496eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 3497eb1d1641SHerbert Xu time_after(mp->timer.expires, time) : 3498eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) { 3499eb1d1641SHerbert Xu mod_timer(&mp->timer, time); 3500eb1d1641SHerbert Xu } 3501454594f3SLinus Lüssing 3502454594f3SLinus Lüssing goto out; 3503454594f3SLinus Lüssing } 3504454594f3SLinus Lüssing 3505adc47037SNikolay Aleksandrov for (p = mlock_dereference(mp->ports, brmctx->br); 3506454594f3SLinus Lüssing p != NULL; 3507adc47037SNikolay Aleksandrov p = mlock_dereference(p->next, brmctx->br)) { 3508adc47037SNikolay Aleksandrov if (p->key.port != pmctx->port) 3509454594f3SLinus Lüssing continue; 3510454594f3SLinus Lüssing 3511454594f3SLinus Lüssing if (!hlist_unhashed(&p->mglist) && 3512454594f3SLinus Lüssing (timer_pending(&p->timer) ? 3513454594f3SLinus Lüssing time_after(p->timer.expires, time) : 3514454594f3SLinus Lüssing try_to_del_timer_sync(&p->timer) >= 0)) { 3515454594f3SLinus Lüssing mod_timer(&p->timer, time); 3516454594f3SLinus Lüssing } 3517454594f3SLinus Lüssing 3518454594f3SLinus Lüssing break; 3519eb1d1641SHerbert Xu } 3520eb1d1641SHerbert Xu out: 3521adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3522eb1d1641SHerbert Xu } 3523eb1d1641SHerbert Xu 3524adc47037SNikolay Aleksandrov static void br_ip4_multicast_leave_group(struct net_bridge_mcast *brmctx, 3525adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3526b0e9a30dSVlad Yasevich __be32 group, 35276db6f0eaSFelix Fietkau __u16 vid, 35286db6f0eaSFelix Fietkau const unsigned char *src) 35298ef2a9a5SYOSHIFUJI Hideaki { 35308ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 353190010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 35328ef2a9a5SYOSHIFUJI Hideaki 35338ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 35348ef2a9a5SYOSHIFUJI Hideaki return; 35358ef2a9a5SYOSHIFUJI Hideaki 3536adc47037SNikolay Aleksandrov own_query = pmctx ? &pmctx->ip4_own_query : &brmctx->ip4_own_query; 353790010b36SLinus Lüssing 35381515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 3539eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 35408ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 3541b0e9a30dSVlad Yasevich br_group.vid = vid; 35428ef2a9a5SYOSHIFUJI Hideaki 3543adc47037SNikolay Aleksandrov br_multicast_leave_group(brmctx, pmctx, &br_group, 3544adc47037SNikolay Aleksandrov &brmctx->ip4_other_query, 35456db6f0eaSFelix Fietkau own_query, src); 35468ef2a9a5SYOSHIFUJI Hideaki } 35478ef2a9a5SYOSHIFUJI Hideaki 3548dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3549adc47037SNikolay Aleksandrov static void br_ip6_multicast_leave_group(struct net_bridge_mcast *brmctx, 3550adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3551b0e9a30dSVlad Yasevich const struct in6_addr *group, 35526db6f0eaSFelix Fietkau __u16 vid, 35536db6f0eaSFelix Fietkau const unsigned char *src) 355408b202b6SYOSHIFUJI Hideaki { 355508b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 355690010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 355708b202b6SYOSHIFUJI Hideaki 35583c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 355908b202b6SYOSHIFUJI Hideaki return; 356008b202b6SYOSHIFUJI Hideaki 3561adc47037SNikolay Aleksandrov own_query = pmctx ? &pmctx->ip6_own_query : &brmctx->ip6_own_query; 356290010b36SLinus Lüssing 35631515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 3564eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 356508b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 3566b0e9a30dSVlad Yasevich br_group.vid = vid; 356708b202b6SYOSHIFUJI Hideaki 3568adc47037SNikolay Aleksandrov br_multicast_leave_group(brmctx, pmctx, &br_group, 3569adc47037SNikolay Aleksandrov &brmctx->ip6_other_query, 35706db6f0eaSFelix Fietkau own_query, src); 357108b202b6SYOSHIFUJI Hideaki } 357208b202b6SYOSHIFUJI Hideaki #endif 35738ef2a9a5SYOSHIFUJI Hideaki 35741080ab95SNikolay Aleksandrov static void br_multicast_err_count(const struct net_bridge *br, 35751080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 35761080ab95SNikolay Aleksandrov __be16 proto) 35771080ab95SNikolay Aleksandrov { 35781080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 35791080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats; 35801080ab95SNikolay Aleksandrov 3581675779adSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 35821080ab95SNikolay Aleksandrov return; 35831080ab95SNikolay Aleksandrov 35841080ab95SNikolay Aleksandrov if (p) 35851080ab95SNikolay Aleksandrov stats = p->mcast_stats; 35861080ab95SNikolay Aleksandrov else 35871080ab95SNikolay Aleksandrov stats = br->mcast_stats; 35881080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 35891080ab95SNikolay Aleksandrov return; 35901080ab95SNikolay Aleksandrov 35911080ab95SNikolay Aleksandrov pstats = this_cpu_ptr(stats); 35921080ab95SNikolay Aleksandrov 35931080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 35941080ab95SNikolay Aleksandrov switch (proto) { 35951080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 35961080ab95SNikolay Aleksandrov pstats->mstats.igmp_parse_errors++; 35971080ab95SNikolay Aleksandrov break; 35981080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 35991080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 36001080ab95SNikolay Aleksandrov pstats->mstats.mld_parse_errors++; 36011080ab95SNikolay Aleksandrov break; 36021080ab95SNikolay Aleksandrov #endif 36031080ab95SNikolay Aleksandrov } 36041080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 36051080ab95SNikolay Aleksandrov } 36061080ab95SNikolay Aleksandrov 3607adc47037SNikolay Aleksandrov static void br_multicast_pim(struct net_bridge_mcast *brmctx, 3608adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 360991b02d3dSNikolay Aleksandrov const struct sk_buff *skb) 361091b02d3dSNikolay Aleksandrov { 361191b02d3dSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 361291b02d3dSNikolay Aleksandrov struct pimhdr *pimhdr, _pimhdr; 361391b02d3dSNikolay Aleksandrov 361491b02d3dSNikolay Aleksandrov pimhdr = skb_header_pointer(skb, offset, sizeof(_pimhdr), &_pimhdr); 361591b02d3dSNikolay Aleksandrov if (!pimhdr || pim_hdr_version(pimhdr) != PIM_VERSION || 361691b02d3dSNikolay Aleksandrov pim_hdr_type(pimhdr) != PIM_TYPE_HELLO) 361791b02d3dSNikolay Aleksandrov return; 361891b02d3dSNikolay Aleksandrov 3619adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3620adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3621adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 362291b02d3dSNikolay Aleksandrov } 362391b02d3dSNikolay Aleksandrov 3624adc47037SNikolay Aleksandrov static int br_ip4_multicast_mrd_rcv(struct net_bridge_mcast *brmctx, 3625adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 36264b3087c7SLinus Lüssing struct sk_buff *skb) 36274b3087c7SLinus Lüssing { 36284b3087c7SLinus Lüssing if (ip_hdr(skb)->protocol != IPPROTO_IGMP || 36294b3087c7SLinus Lüssing igmp_hdr(skb)->type != IGMP_MRDISC_ADV) 36304b3087c7SLinus Lüssing return -ENOMSG; 36314b3087c7SLinus Lüssing 3632adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3633adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3634adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 36354b3087c7SLinus Lüssing 36364b3087c7SLinus Lüssing return 0; 36374b3087c7SLinus Lüssing } 36384b3087c7SLinus Lüssing 3639adc47037SNikolay Aleksandrov static int br_multicast_ipv4_rcv(struct net_bridge_mcast *brmctx, 3640adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 364106499098SVlad Yasevich struct sk_buff *skb, 364206499098SVlad Yasevich u16 vid) 3643eb1d1641SHerbert Xu { 3644adc47037SNikolay Aleksandrov struct net_bridge_port *p = pmctx ? pmctx->port : NULL; 36456db6f0eaSFelix Fietkau const unsigned char *src; 3646eb1d1641SHerbert Xu struct igmphdr *ih; 3647eb1d1641SHerbert Xu int err; 3648eb1d1641SHerbert Xu 3649ba5ea614SLinus Lüssing err = ip_mc_check_igmp(skb); 3650eb1d1641SHerbert Xu 36519afd85c9SLinus Lüssing if (err == -ENOMSG) { 365291b02d3dSNikolay Aleksandrov if (!ipv4_is_local_multicast(ip_hdr(skb)->daddr)) { 3653bd4265feSHerbert Xu BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 365491b02d3dSNikolay Aleksandrov } else if (pim_ipv4_all_pim_routers(ip_hdr(skb)->daddr)) { 365591b02d3dSNikolay Aleksandrov if (ip_hdr(skb)->protocol == IPPROTO_PIM) 3656adc47037SNikolay Aleksandrov br_multicast_pim(brmctx, pmctx, skb); 36574b3087c7SLinus Lüssing } else if (ipv4_is_all_snoopers(ip_hdr(skb)->daddr)) { 3658adc47037SNikolay Aleksandrov br_ip4_multicast_mrd_rcv(brmctx, pmctx, skb); 36594b3087c7SLinus Lüssing } 36604b3087c7SLinus Lüssing 3661eb1d1641SHerbert Xu return 0; 36629afd85c9SLinus Lüssing } else if (err < 0) { 3663adc47037SNikolay Aleksandrov br_multicast_err_count(brmctx->br, p, skb->protocol); 36649afd85c9SLinus Lüssing return err; 3665bd4265feSHerbert Xu } 3666eb1d1641SHerbert Xu 36679afd85c9SLinus Lüssing ih = igmp_hdr(skb); 36686db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 36691080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = ih->type; 3670eb1d1641SHerbert Xu 3671eb1d1641SHerbert Xu switch (ih->type) { 3672eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_REPORT: 3673eb1d1641SHerbert Xu case IGMPV2_HOST_MEMBERSHIP_REPORT: 367462b2bcb4SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 3675adc47037SNikolay Aleksandrov err = br_ip4_multicast_add_group(brmctx, pmctx, ih->group, vid, 3676adc47037SNikolay Aleksandrov src, true); 3677eb1d1641SHerbert Xu break; 3678eb1d1641SHerbert Xu case IGMPV3_HOST_MEMBERSHIP_REPORT: 3679adc47037SNikolay Aleksandrov err = br_ip4_multicast_igmp3_report(brmctx, pmctx, skb, vid); 3680eb1d1641SHerbert Xu break; 3681eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_QUERY: 3682adc47037SNikolay Aleksandrov br_ip4_multicast_query(brmctx, pmctx, skb, vid); 3683eb1d1641SHerbert Xu break; 3684eb1d1641SHerbert Xu case IGMP_HOST_LEAVE_MESSAGE: 3685adc47037SNikolay Aleksandrov br_ip4_multicast_leave_group(brmctx, pmctx, ih->group, vid, src); 3686eb1d1641SHerbert Xu break; 3687eb1d1641SHerbert Xu } 3688eb1d1641SHerbert Xu 3689adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, p, skb, BR_INPUT_SKB_CB(skb)->igmp, 36901080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 36911080ab95SNikolay Aleksandrov 3692eb1d1641SHerbert Xu return err; 3693eb1d1641SHerbert Xu } 3694eb1d1641SHerbert Xu 3695dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3696adc47037SNikolay Aleksandrov static void br_ip6_multicast_mrd_rcv(struct net_bridge_mcast *brmctx, 3697adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 36984b3087c7SLinus Lüssing struct sk_buff *skb) 36994b3087c7SLinus Lüssing { 37004b3087c7SLinus Lüssing if (icmp6_hdr(skb)->icmp6_type != ICMPV6_MRDISC_ADV) 370199014088SLinus Lüssing return; 37024b3087c7SLinus Lüssing 3703adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3704adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 3705adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 37064b3087c7SLinus Lüssing } 37074b3087c7SLinus Lüssing 3708adc47037SNikolay Aleksandrov static int br_multicast_ipv6_rcv(struct net_bridge_mcast *brmctx, 3709adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 371006499098SVlad Yasevich struct sk_buff *skb, 371106499098SVlad Yasevich u16 vid) 371208b202b6SYOSHIFUJI Hideaki { 3713adc47037SNikolay Aleksandrov struct net_bridge_port *p = pmctx ? pmctx->port : NULL; 37146db6f0eaSFelix Fietkau const unsigned char *src; 37159afd85c9SLinus Lüssing struct mld_msg *mld; 371608b202b6SYOSHIFUJI Hideaki int err; 371708b202b6SYOSHIFUJI Hideaki 3718ba5ea614SLinus Lüssing err = ipv6_mc_check_mld(skb); 371908b202b6SYOSHIFUJI Hideaki 372099014088SLinus Lüssing if (err == -ENOMSG || err == -ENODATA) { 37219afd85c9SLinus Lüssing if (!ipv6_addr_is_ll_all_nodes(&ipv6_hdr(skb)->daddr)) 37228fad9c39SLinus Lüssing BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 372399014088SLinus Lüssing if (err == -ENODATA && 372499014088SLinus Lüssing ipv6_addr_is_all_snoopers(&ipv6_hdr(skb)->daddr)) 3725adc47037SNikolay Aleksandrov br_ip6_multicast_mrd_rcv(brmctx, pmctx, skb); 37264b3087c7SLinus Lüssing 372708b202b6SYOSHIFUJI Hideaki return 0; 37289afd85c9SLinus Lüssing } else if (err < 0) { 3729adc47037SNikolay Aleksandrov br_multicast_err_count(brmctx->br, p, skb->protocol); 37309afd85c9SLinus Lüssing return err; 373108b202b6SYOSHIFUJI Hideaki } 373208b202b6SYOSHIFUJI Hideaki 37339afd85c9SLinus Lüssing mld = (struct mld_msg *)skb_transport_header(skb); 37341080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = mld->mld_type; 373508b202b6SYOSHIFUJI Hideaki 37369afd85c9SLinus Lüssing switch (mld->mld_type) { 373708b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REPORT: 37386db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 3739fc2af6c7SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 3740adc47037SNikolay Aleksandrov err = br_ip6_multicast_add_group(brmctx, pmctx, &mld->mld_mca, 3741adc47037SNikolay Aleksandrov vid, src, true); 374208b202b6SYOSHIFUJI Hideaki break; 374308b202b6SYOSHIFUJI Hideaki case ICMPV6_MLD2_REPORT: 3744adc47037SNikolay Aleksandrov err = br_ip6_multicast_mld2_report(brmctx, pmctx, skb, vid); 374508b202b6SYOSHIFUJI Hideaki break; 374608b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_QUERY: 3747adc47037SNikolay Aleksandrov err = br_ip6_multicast_query(brmctx, pmctx, skb, vid); 374808b202b6SYOSHIFUJI Hideaki break; 374908b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REDUCTION: 37506db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 3751adc47037SNikolay Aleksandrov br_ip6_multicast_leave_group(brmctx, pmctx, &mld->mld_mca, vid, 3752adc47037SNikolay Aleksandrov src); 37539afd85c9SLinus Lüssing break; 375408b202b6SYOSHIFUJI Hideaki } 375508b202b6SYOSHIFUJI Hideaki 3756adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, p, skb, BR_INPUT_SKB_CB(skb)->igmp, 37571080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 37581080ab95SNikolay Aleksandrov 375908b202b6SYOSHIFUJI Hideaki return err; 376008b202b6SYOSHIFUJI Hideaki } 376108b202b6SYOSHIFUJI Hideaki #endif 376208b202b6SYOSHIFUJI Hideaki 3763f4b7002aSNikolay Aleksandrov int br_multicast_rcv(struct net_bridge_mcast **brmctx, 3764f4b7002aSNikolay Aleksandrov struct net_bridge_mcast_port **pmctx, 3765f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vlan, 376606499098SVlad Yasevich struct sk_buff *skb, u16 vid) 3767eb1d1641SHerbert Xu { 37681080ab95SNikolay Aleksandrov int ret = 0; 37691080ab95SNikolay Aleksandrov 37701fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->igmp = 0; 37711fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->mrouters_only = 0; 37721fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 3773f4b7002aSNikolay Aleksandrov if (!br_opt_get((*brmctx)->br, BROPT_MULTICAST_ENABLED)) 3774eb1d1641SHerbert Xu return 0; 3775eb1d1641SHerbert Xu 3776f4b7002aSNikolay Aleksandrov if (br_opt_get((*brmctx)->br, BROPT_MCAST_VLAN_SNOOPING_ENABLED) && vlan) { 3777f4b7002aSNikolay Aleksandrov const struct net_bridge_vlan *masterv; 3778f4b7002aSNikolay Aleksandrov 3779f4b7002aSNikolay Aleksandrov /* the vlan has the master flag set only when transmitting 3780f4b7002aSNikolay Aleksandrov * through the bridge device 3781f4b7002aSNikolay Aleksandrov */ 3782f4b7002aSNikolay Aleksandrov if (br_vlan_is_master(vlan)) { 3783f4b7002aSNikolay Aleksandrov masterv = vlan; 3784f4b7002aSNikolay Aleksandrov *brmctx = &vlan->br_mcast_ctx; 3785f4b7002aSNikolay Aleksandrov *pmctx = NULL; 3786f4b7002aSNikolay Aleksandrov } else { 3787f4b7002aSNikolay Aleksandrov masterv = vlan->brvlan; 3788f4b7002aSNikolay Aleksandrov *brmctx = &vlan->brvlan->br_mcast_ctx; 3789f4b7002aSNikolay Aleksandrov *pmctx = &vlan->port_mcast_ctx; 3790f4b7002aSNikolay Aleksandrov } 3791f4b7002aSNikolay Aleksandrov 3792f4b7002aSNikolay Aleksandrov if (!(masterv->priv_flags & BR_VLFLAG_GLOBAL_MCAST_ENABLED)) 3793f4b7002aSNikolay Aleksandrov return 0; 3794f4b7002aSNikolay Aleksandrov } 3795f4b7002aSNikolay Aleksandrov 3796eb1d1641SHerbert Xu switch (skb->protocol) { 3797eb1d1641SHerbert Xu case htons(ETH_P_IP): 3798f4b7002aSNikolay Aleksandrov ret = br_multicast_ipv4_rcv(*brmctx, *pmctx, skb, vid); 37991080ab95SNikolay Aleksandrov break; 3800dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 380108b202b6SYOSHIFUJI Hideaki case htons(ETH_P_IPV6): 3802f4b7002aSNikolay Aleksandrov ret = br_multicast_ipv6_rcv(*brmctx, *pmctx, skb, vid); 38031080ab95SNikolay Aleksandrov break; 380408b202b6SYOSHIFUJI Hideaki #endif 3805eb1d1641SHerbert Xu } 3806eb1d1641SHerbert Xu 38071080ab95SNikolay Aleksandrov return ret; 3808eb1d1641SHerbert Xu } 3809eb1d1641SHerbert Xu 3810adc47037SNikolay Aleksandrov static void br_multicast_query_expired(struct net_bridge_mcast *brmctx, 38112cd41431SLinus Lüssing struct bridge_mcast_own_query *query, 38122cd41431SLinus Lüssing struct bridge_mcast_querier *querier) 3813cc0fdd80SLinus Lüssing { 3814adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 38154cdd0d10SNikolay Aleksandrov if (br_multicast_ctx_vlan_disabled(brmctx)) 38164cdd0d10SNikolay Aleksandrov goto out; 38174cdd0d10SNikolay Aleksandrov 3818adc47037SNikolay Aleksandrov if (query->startup_sent < brmctx->multicast_startup_query_count) 3819cc0fdd80SLinus Lüssing query->startup_sent++; 3820cc0fdd80SLinus Lüssing 3821adc47037SNikolay Aleksandrov br_multicast_send_query(brmctx, NULL, query); 38224cdd0d10SNikolay Aleksandrov out: 3823adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3824cc0fdd80SLinus Lüssing } 3825cc0fdd80SLinus Lüssing 382688c1f37fSAllen Pais static void br_ip4_multicast_query_expired(struct timer_list *t) 3827eb1d1641SHerbert Xu { 3828d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 3829d3d065c0SNikolay Aleksandrov ip4_own_query.timer); 3830eb1d1641SHerbert Xu 3831adc47037SNikolay Aleksandrov br_multicast_query_expired(brmctx, &brmctx->ip4_own_query, 3832d3d065c0SNikolay Aleksandrov &brmctx->ip4_querier); 3833eb1d1641SHerbert Xu } 3834eb1d1641SHerbert Xu 3835cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 383688c1f37fSAllen Pais static void br_ip6_multicast_query_expired(struct timer_list *t) 3837cc0fdd80SLinus Lüssing { 3838d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 3839d3d065c0SNikolay Aleksandrov ip6_own_query.timer); 3840cc0fdd80SLinus Lüssing 3841adc47037SNikolay Aleksandrov br_multicast_query_expired(brmctx, &brmctx->ip6_own_query, 3842d3d065c0SNikolay Aleksandrov &brmctx->ip6_querier); 3843cc0fdd80SLinus Lüssing } 3844cc0fdd80SLinus Lüssing #endif 3845cc0fdd80SLinus Lüssing 3846e12cec65SNikolay Aleksandrov static void br_multicast_gc_work(struct work_struct *work) 38478b671779SNikolay Aleksandrov { 38488b671779SNikolay Aleksandrov struct net_bridge *br = container_of(work, struct net_bridge, 3849e12cec65SNikolay Aleksandrov mcast_gc_work); 38508b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 38518b671779SNikolay Aleksandrov 38528b671779SNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 3853e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 38548b671779SNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 38558b671779SNikolay Aleksandrov 3856e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 38578b671779SNikolay Aleksandrov } 38588b671779SNikolay Aleksandrov 3859613d61dbSNikolay Aleksandrov void br_multicast_ctx_init(struct net_bridge *br, 3860613d61dbSNikolay Aleksandrov struct net_bridge_vlan *vlan, 3861613d61dbSNikolay Aleksandrov struct net_bridge_mcast *brmctx) 3862613d61dbSNikolay Aleksandrov { 3863613d61dbSNikolay Aleksandrov brmctx->br = br; 3864613d61dbSNikolay Aleksandrov brmctx->vlan = vlan; 3865613d61dbSNikolay Aleksandrov brmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 3866613d61dbSNikolay Aleksandrov brmctx->multicast_last_member_count = 2; 3867613d61dbSNikolay Aleksandrov brmctx->multicast_startup_query_count = 2; 3868613d61dbSNikolay Aleksandrov 3869613d61dbSNikolay Aleksandrov brmctx->multicast_last_member_interval = HZ; 3870613d61dbSNikolay Aleksandrov brmctx->multicast_query_response_interval = 10 * HZ; 3871613d61dbSNikolay Aleksandrov brmctx->multicast_startup_query_interval = 125 * HZ / 4; 3872613d61dbSNikolay Aleksandrov brmctx->multicast_query_interval = 125 * HZ; 3873613d61dbSNikolay Aleksandrov brmctx->multicast_querier_interval = 255 * HZ; 3874613d61dbSNikolay Aleksandrov brmctx->multicast_membership_interval = 260 * HZ; 3875613d61dbSNikolay Aleksandrov 3876613d61dbSNikolay Aleksandrov brmctx->ip4_other_query.delay_time = 0; 3877bb18ef8eSNikolay Aleksandrov brmctx->ip4_querier.port_ifidx = 0; 3878f936bb42SThomas Gleixner seqcount_spinlock_init(&brmctx->ip4_querier.seq, &br->multicast_lock); 3879613d61dbSNikolay Aleksandrov brmctx->multicast_igmp_version = 2; 3880613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 3881613d61dbSNikolay Aleksandrov brmctx->multicast_mld_version = 1; 3882613d61dbSNikolay Aleksandrov brmctx->ip6_other_query.delay_time = 0; 3883bb18ef8eSNikolay Aleksandrov brmctx->ip6_querier.port_ifidx = 0; 3884f936bb42SThomas Gleixner seqcount_spinlock_init(&brmctx->ip6_querier.seq, &br->multicast_lock); 3885613d61dbSNikolay Aleksandrov #endif 3886613d61dbSNikolay Aleksandrov 3887613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_mc_router_timer, 3888613d61dbSNikolay Aleksandrov br_ip4_multicast_local_router_expired, 0); 3889613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_other_query.timer, 3890613d61dbSNikolay Aleksandrov br_ip4_multicast_querier_expired, 0); 3891613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_own_query.timer, 3892613d61dbSNikolay Aleksandrov br_ip4_multicast_query_expired, 0); 3893613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 3894613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_mc_router_timer, 3895613d61dbSNikolay Aleksandrov br_ip6_multicast_local_router_expired, 0); 3896613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_other_query.timer, 3897613d61dbSNikolay Aleksandrov br_ip6_multicast_querier_expired, 0); 3898613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_own_query.timer, 3899613d61dbSNikolay Aleksandrov br_ip6_multicast_query_expired, 0); 3900613d61dbSNikolay Aleksandrov #endif 3901613d61dbSNikolay Aleksandrov } 3902613d61dbSNikolay Aleksandrov 3903613d61dbSNikolay Aleksandrov void br_multicast_ctx_deinit(struct net_bridge_mcast *brmctx) 3904613d61dbSNikolay Aleksandrov { 3905613d61dbSNikolay Aleksandrov __br_multicast_stop(brmctx); 3906613d61dbSNikolay Aleksandrov } 3907613d61dbSNikolay Aleksandrov 3908eb1d1641SHerbert Xu void br_multicast_init(struct net_bridge *br) 3909eb1d1641SHerbert Xu { 3910d08c6bc0SNikolay Aleksandrov br->hash_max = BR_MULTICAST_DEFAULT_HASH_MAX; 3911eb1d1641SHerbert Xu 3912613d61dbSNikolay Aleksandrov br_multicast_ctx_init(br, NULL, &br->multicast_ctx); 3913eb1d1641SHerbert Xu 39146919622aSIdo Schimmel br_opt_toggle(br, BROPT_MULTICAST_ENABLED, true); 3915675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_HAS_IPV6_ADDR, true); 3916b00589afSLinus Lüssing 3917eb1d1641SHerbert Xu spin_lock_init(&br->multicast_lock); 391819e3a9c9SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mdb_list); 3919e12cec65SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mcast_gc_list); 3920e12cec65SNikolay Aleksandrov INIT_WORK(&br->mcast_gc_work, br_multicast_gc_work); 3921eb1d1641SHerbert Xu } 3922eb1d1641SHerbert Xu 39234effd28cSLinus Lüssing static void br_ip4_multicast_join_snoopers(struct net_bridge *br) 39244effd28cSLinus Lüssing { 39254effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 39264effd28cSLinus Lüssing 39274effd28cSLinus Lüssing if (!in_dev) 39284effd28cSLinus Lüssing return; 39294effd28cSLinus Lüssing 39309fb20801SFlorian Fainelli __ip_mc_inc_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 39314effd28cSLinus Lüssing in_dev_put(in_dev); 39324effd28cSLinus Lüssing } 39334effd28cSLinus Lüssing 39344effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 39354effd28cSLinus Lüssing static void br_ip6_multicast_join_snoopers(struct net_bridge *br) 39364effd28cSLinus Lüssing { 39374effd28cSLinus Lüssing struct in6_addr addr; 39384effd28cSLinus Lüssing 39394effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 39404effd28cSLinus Lüssing ipv6_dev_mc_inc(br->dev, &addr); 39414effd28cSLinus Lüssing } 39424effd28cSLinus Lüssing #else 39434effd28cSLinus Lüssing static inline void br_ip6_multicast_join_snoopers(struct net_bridge *br) 39444effd28cSLinus Lüssing { 39454effd28cSLinus Lüssing } 39464effd28cSLinus Lüssing #endif 39474effd28cSLinus Lüssing 3948851d0a73SJoseph Huang void br_multicast_join_snoopers(struct net_bridge *br) 39494effd28cSLinus Lüssing { 39504effd28cSLinus Lüssing br_ip4_multicast_join_snoopers(br); 39514effd28cSLinus Lüssing br_ip6_multicast_join_snoopers(br); 39524effd28cSLinus Lüssing } 39534effd28cSLinus Lüssing 39544effd28cSLinus Lüssing static void br_ip4_multicast_leave_snoopers(struct net_bridge *br) 39554effd28cSLinus Lüssing { 39564effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 39574effd28cSLinus Lüssing 39584effd28cSLinus Lüssing if (WARN_ON(!in_dev)) 39594effd28cSLinus Lüssing return; 39604effd28cSLinus Lüssing 39619fb20801SFlorian Fainelli __ip_mc_dec_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 39624effd28cSLinus Lüssing in_dev_put(in_dev); 39634effd28cSLinus Lüssing } 39644effd28cSLinus Lüssing 39654effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 39664effd28cSLinus Lüssing static void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 39674effd28cSLinus Lüssing { 39684effd28cSLinus Lüssing struct in6_addr addr; 39694effd28cSLinus Lüssing 39704effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 39714effd28cSLinus Lüssing ipv6_dev_mc_dec(br->dev, &addr); 39724effd28cSLinus Lüssing } 39734effd28cSLinus Lüssing #else 39744effd28cSLinus Lüssing static inline void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 39754effd28cSLinus Lüssing { 39764effd28cSLinus Lüssing } 39774effd28cSLinus Lüssing #endif 39784effd28cSLinus Lüssing 3979851d0a73SJoseph Huang void br_multicast_leave_snoopers(struct net_bridge *br) 39804effd28cSLinus Lüssing { 39814effd28cSLinus Lüssing br_ip4_multicast_leave_snoopers(br); 39824effd28cSLinus Lüssing br_ip6_multicast_leave_snoopers(br); 39834effd28cSLinus Lüssing } 39844effd28cSLinus Lüssing 39857b54aaafSNikolay Aleksandrov static void __br_multicast_open_query(struct net_bridge *br, 398690010b36SLinus Lüssing struct bridge_mcast_own_query *query) 3987eb1d1641SHerbert Xu { 3988cc0fdd80SLinus Lüssing query->startup_sent = 0; 3989eb1d1641SHerbert Xu 399013cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) 3991eb1d1641SHerbert Xu return; 3992eb1d1641SHerbert Xu 3993cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 3994cc0fdd80SLinus Lüssing } 3995cc0fdd80SLinus Lüssing 39967b54aaafSNikolay Aleksandrov static void __br_multicast_open(struct net_bridge_mcast *brmctx) 39977b54aaafSNikolay Aleksandrov { 39987b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, &brmctx->ip4_own_query); 39997b54aaafSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 40007b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, &brmctx->ip6_own_query); 40017b54aaafSNikolay Aleksandrov #endif 40027b54aaafSNikolay Aleksandrov } 40037b54aaafSNikolay Aleksandrov 4004cc0fdd80SLinus Lüssing void br_multicast_open(struct net_bridge *br) 4005cc0fdd80SLinus Lüssing { 4006f4b7002aSNikolay Aleksandrov ASSERT_RTNL(); 4007f4b7002aSNikolay Aleksandrov 4008f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) { 40097b54aaafSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 40107b54aaafSNikolay Aleksandrov struct net_bridge_vlan *vlan; 40117b54aaafSNikolay Aleksandrov 40127b54aaafSNikolay Aleksandrov vg = br_vlan_group(br); 40137b54aaafSNikolay Aleksandrov if (vg) { 40147b54aaafSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) { 40157b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 40167b54aaafSNikolay Aleksandrov 40177b54aaafSNikolay Aleksandrov brmctx = &vlan->br_mcast_ctx; 40187b54aaafSNikolay Aleksandrov if (br_vlan_is_brentry(vlan) && 40197b54aaafSNikolay Aleksandrov !br_multicast_ctx_vlan_disabled(brmctx)) 40207b54aaafSNikolay Aleksandrov __br_multicast_open(&vlan->br_mcast_ctx); 40217b54aaafSNikolay Aleksandrov } 40227b54aaafSNikolay Aleksandrov } 4023cb486ce9SNikolay Aleksandrov } else { 40247b54aaafSNikolay Aleksandrov __br_multicast_open(&br->multicast_ctx); 4025eb1d1641SHerbert Xu } 4026cb486ce9SNikolay Aleksandrov } 4027eb1d1641SHerbert Xu 4028613d61dbSNikolay Aleksandrov static void __br_multicast_stop(struct net_bridge_mcast *brmctx) 4029613d61dbSNikolay Aleksandrov { 4030613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_mc_router_timer); 4031613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_other_query.timer); 4032613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_own_query.timer); 4033613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4034613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_mc_router_timer); 4035613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_other_query.timer); 4036613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_own_query.timer); 4037613d61dbSNikolay Aleksandrov #endif 4038613d61dbSNikolay Aleksandrov } 4039613d61dbSNikolay Aleksandrov 40407b54aaafSNikolay Aleksandrov void br_multicast_toggle_one_vlan(struct net_bridge_vlan *vlan, bool on) 40417b54aaafSNikolay Aleksandrov { 40427b54aaafSNikolay Aleksandrov struct net_bridge *br; 40437b54aaafSNikolay Aleksandrov 40447b54aaafSNikolay Aleksandrov /* it's okay to check for the flag without the multicast lock because it 40457b54aaafSNikolay Aleksandrov * can only change under RTNL -> multicast_lock, we need the latter to 40467b54aaafSNikolay Aleksandrov * sync with timers and packets 40477b54aaafSNikolay Aleksandrov */ 40487b54aaafSNikolay Aleksandrov if (on == !!(vlan->priv_flags & BR_VLFLAG_MCAST_ENABLED)) 40497b54aaafSNikolay Aleksandrov return; 40507b54aaafSNikolay Aleksandrov 40517b54aaafSNikolay Aleksandrov if (br_vlan_is_master(vlan)) { 40527b54aaafSNikolay Aleksandrov br = vlan->br; 40537b54aaafSNikolay Aleksandrov 40547b54aaafSNikolay Aleksandrov if (!br_vlan_is_brentry(vlan) || 40557b54aaafSNikolay Aleksandrov (on && 40567b54aaafSNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(&vlan->br_mcast_ctx))) 40577b54aaafSNikolay Aleksandrov return; 40587b54aaafSNikolay Aleksandrov 40597b54aaafSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 40607b54aaafSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_MCAST_ENABLED; 40617b54aaafSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 40627b54aaafSNikolay Aleksandrov 40637b54aaafSNikolay Aleksandrov if (on) 40647b54aaafSNikolay Aleksandrov __br_multicast_open(&vlan->br_mcast_ctx); 40657b54aaafSNikolay Aleksandrov else 40667b54aaafSNikolay Aleksandrov __br_multicast_stop(&vlan->br_mcast_ctx); 40677b54aaafSNikolay Aleksandrov } else { 40687b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 40697b54aaafSNikolay Aleksandrov 40707b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(&vlan->port_mcast_ctx); 40717b54aaafSNikolay Aleksandrov if (on && br_multicast_ctx_vlan_global_disabled(brmctx)) 40727b54aaafSNikolay Aleksandrov return; 40737b54aaafSNikolay Aleksandrov 40747b54aaafSNikolay Aleksandrov br = vlan->port->br; 40757b54aaafSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 40767b54aaafSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_MCAST_ENABLED; 40777b54aaafSNikolay Aleksandrov if (on) 40787b54aaafSNikolay Aleksandrov __br_multicast_enable_port_ctx(&vlan->port_mcast_ctx); 40797b54aaafSNikolay Aleksandrov else 40807b54aaafSNikolay Aleksandrov __br_multicast_disable_port_ctx(&vlan->port_mcast_ctx); 40817b54aaafSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 40827b54aaafSNikolay Aleksandrov } 40837b54aaafSNikolay Aleksandrov } 40847b54aaafSNikolay Aleksandrov 4085affce9a7SNikolay Aleksandrov static void br_multicast_toggle_vlan(struct net_bridge_vlan *vlan, bool on) 4086f4b7002aSNikolay Aleksandrov { 4087f4b7002aSNikolay Aleksandrov struct net_bridge_port *p; 4088f4b7002aSNikolay Aleksandrov 4089f4b7002aSNikolay Aleksandrov if (WARN_ON_ONCE(!br_vlan_is_master(vlan))) 4090f4b7002aSNikolay Aleksandrov return; 4091f4b7002aSNikolay Aleksandrov 4092f4b7002aSNikolay Aleksandrov list_for_each_entry(p, &vlan->br->port_list, list) { 4093f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vport; 4094f4b7002aSNikolay Aleksandrov 4095f4b7002aSNikolay Aleksandrov vport = br_vlan_find(nbp_vlan_group(p), vlan->vid); 4096f4b7002aSNikolay Aleksandrov if (!vport) 4097f4b7002aSNikolay Aleksandrov continue; 4098f4b7002aSNikolay Aleksandrov br_multicast_toggle_one_vlan(vport, on); 4099f4b7002aSNikolay Aleksandrov } 4100affce9a7SNikolay Aleksandrov 4101affce9a7SNikolay Aleksandrov if (br_vlan_is_brentry(vlan)) 4102affce9a7SNikolay Aleksandrov br_multicast_toggle_one_vlan(vlan, on); 4103f4b7002aSNikolay Aleksandrov } 4104f4b7002aSNikolay Aleksandrov 4105f4b7002aSNikolay Aleksandrov int br_multicast_toggle_vlan_snooping(struct net_bridge *br, bool on, 4106f4b7002aSNikolay Aleksandrov struct netlink_ext_ack *extack) 4107eb1d1641SHerbert Xu { 41087b54aaafSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 41097b54aaafSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4110f4b7002aSNikolay Aleksandrov struct net_bridge_port *p; 41117b54aaafSNikolay Aleksandrov 4112f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED) == on) 4113f4b7002aSNikolay Aleksandrov return 0; 4114f4b7002aSNikolay Aleksandrov 4115f4b7002aSNikolay Aleksandrov if (on && !br_opt_get(br, BROPT_VLAN_ENABLED)) { 4116f4b7002aSNikolay Aleksandrov NL_SET_ERR_MSG_MOD(extack, "Cannot enable multicast vlan snooping with vlan filtering disabled"); 4117f4b7002aSNikolay Aleksandrov return -EINVAL; 4118f4b7002aSNikolay Aleksandrov } 4119f4b7002aSNikolay Aleksandrov 4120f4b7002aSNikolay Aleksandrov vg = br_vlan_group(br); 4121f4b7002aSNikolay Aleksandrov if (!vg) 4122f4b7002aSNikolay Aleksandrov return 0; 4123f4b7002aSNikolay Aleksandrov 4124f4b7002aSNikolay Aleksandrov br_opt_toggle(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED, on); 4125f4b7002aSNikolay Aleksandrov 4126f4b7002aSNikolay Aleksandrov /* disable/enable non-vlan mcast contexts based on vlan snooping */ 4127f4b7002aSNikolay Aleksandrov if (on) 4128f4b7002aSNikolay Aleksandrov __br_multicast_stop(&br->multicast_ctx); 4129f4b7002aSNikolay Aleksandrov else 4130f4b7002aSNikolay Aleksandrov __br_multicast_open(&br->multicast_ctx); 4131f4b7002aSNikolay Aleksandrov list_for_each_entry(p, &br->port_list, list) { 4132f4b7002aSNikolay Aleksandrov if (on) 4133f4b7002aSNikolay Aleksandrov br_multicast_disable_port(p); 4134f4b7002aSNikolay Aleksandrov else 4135f4b7002aSNikolay Aleksandrov br_multicast_enable_port(p); 4136f4b7002aSNikolay Aleksandrov } 4137f4b7002aSNikolay Aleksandrov 4138f4b7002aSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) 4139f4b7002aSNikolay Aleksandrov br_multicast_toggle_vlan(vlan, on); 4140f4b7002aSNikolay Aleksandrov 4141f4b7002aSNikolay Aleksandrov return 0; 4142f4b7002aSNikolay Aleksandrov } 4143f4b7002aSNikolay Aleksandrov 41449dee572cSNikolay Aleksandrov bool br_multicast_toggle_global_vlan(struct net_bridge_vlan *vlan, bool on) 41459dee572cSNikolay Aleksandrov { 41469dee572cSNikolay Aleksandrov ASSERT_RTNL(); 41479dee572cSNikolay Aleksandrov 41489dee572cSNikolay Aleksandrov /* BR_VLFLAG_GLOBAL_MCAST_ENABLED relies on eventual consistency and 41499dee572cSNikolay Aleksandrov * requires only RTNL to change 41509dee572cSNikolay Aleksandrov */ 41519dee572cSNikolay Aleksandrov if (on == !!(vlan->priv_flags & BR_VLFLAG_GLOBAL_MCAST_ENABLED)) 41529dee572cSNikolay Aleksandrov return false; 41539dee572cSNikolay Aleksandrov 41549dee572cSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_GLOBAL_MCAST_ENABLED; 41559dee572cSNikolay Aleksandrov br_multicast_toggle_vlan(vlan, on); 41569dee572cSNikolay Aleksandrov 41579dee572cSNikolay Aleksandrov return true; 41589dee572cSNikolay Aleksandrov } 41599dee572cSNikolay Aleksandrov 4160f4b7002aSNikolay Aleksandrov void br_multicast_stop(struct net_bridge *br) 4161f4b7002aSNikolay Aleksandrov { 41627b54aaafSNikolay Aleksandrov ASSERT_RTNL(); 41637b54aaafSNikolay Aleksandrov 4164f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) { 4165f4b7002aSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 4166f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4167f4b7002aSNikolay Aleksandrov 41687b54aaafSNikolay Aleksandrov vg = br_vlan_group(br); 41697b54aaafSNikolay Aleksandrov if (vg) { 41707b54aaafSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) { 41717b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 41727b54aaafSNikolay Aleksandrov 41737b54aaafSNikolay Aleksandrov brmctx = &vlan->br_mcast_ctx; 41747b54aaafSNikolay Aleksandrov if (br_vlan_is_brentry(vlan) && 41757b54aaafSNikolay Aleksandrov !br_multicast_ctx_vlan_disabled(brmctx)) 41767b54aaafSNikolay Aleksandrov __br_multicast_stop(&vlan->br_mcast_ctx); 41777b54aaafSNikolay Aleksandrov } 41787b54aaafSNikolay Aleksandrov } 4179cb486ce9SNikolay Aleksandrov } else { 4180613d61dbSNikolay Aleksandrov __br_multicast_stop(&br->multicast_ctx); 4181e10177abSSatish Ashok } 4182cb486ce9SNikolay Aleksandrov } 4183e10177abSSatish Ashok 4184e10177abSSatish Ashok void br_multicast_dev_del(struct net_bridge *br) 4185e10177abSSatish Ashok { 4186e10177abSSatish Ashok struct net_bridge_mdb_entry *mp; 41878b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 418819e3a9c9SNikolay Aleksandrov struct hlist_node *tmp; 4189eb1d1641SHerbert Xu 4190eb1d1641SHerbert Xu spin_lock_bh(&br->multicast_lock); 4191e12cec65SNikolay Aleksandrov hlist_for_each_entry_safe(mp, tmp, &br->mdb_list, mdb_node) 4192e12cec65SNikolay Aleksandrov br_multicast_del_mdb_entry(mp); 4193e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 4194eb1d1641SHerbert Xu spin_unlock_bh(&br->multicast_lock); 419519e3a9c9SNikolay Aleksandrov 4196613d61dbSNikolay Aleksandrov br_multicast_ctx_deinit(&br->multicast_ctx); 4197e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 4198e12cec65SNikolay Aleksandrov cancel_work_sync(&br->mcast_gc_work); 41998b671779SNikolay Aleksandrov 42004329596cSNikolay Aleksandrov rcu_barrier(); 4201eb1d1641SHerbert Xu } 42020909e117SHerbert Xu 4203a97df080SNikolay Aleksandrov int br_multicast_set_router(struct net_bridge_mcast *brmctx, unsigned long val) 42040909e117SHerbert Xu { 42056ae4ae8eSLinus Lüssing int err = -EINVAL; 42060909e117SHerbert Xu 4207a97df080SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 42080909e117SHerbert Xu 42090909e117SHerbert Xu switch (val) { 42107f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 42117f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 4212a97df080SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, val == MDB_RTR_TYPE_PERM); 4213d3d065c0SNikolay Aleksandrov del_timer(&brmctx->ip4_mc_router_timer); 4214a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4215d3d065c0SNikolay Aleksandrov del_timer(&brmctx->ip6_mc_router_timer); 4216a3c02e76SLinus Lüssing #endif 4217d3d065c0SNikolay Aleksandrov brmctx->multicast_router = val; 421877041420SYotam Gigi err = 0; 421977041420SYotam Gigi break; 42207f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 4221d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router != MDB_RTR_TYPE_TEMP_QUERY) 4222a97df080SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, false); 4223d3d065c0SNikolay Aleksandrov brmctx->multicast_router = val; 42240909e117SHerbert Xu err = 0; 42250909e117SHerbert Xu break; 42260909e117SHerbert Xu } 42270909e117SHerbert Xu 4228a97df080SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 42290909e117SHerbert Xu 42300909e117SHerbert Xu return err; 42310909e117SHerbert Xu } 42320909e117SHerbert Xu 4233ed2d3597SLinus Lüssing static void 4234adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(struct net_bridge_mcast_port *pmctx, bool deleted) 42357f0aec7aSNikolay Aleksandrov { 4236ed2d3597SLinus Lüssing if (!deleted) 42377f0aec7aSNikolay Aleksandrov return; 4238ed2d3597SLinus Lüssing 4239a3c02e76SLinus Lüssing /* For backwards compatibility for now, only notify if there is 4240a3c02e76SLinus Lüssing * no multicast router anymore for both IPv4 and IPv6. 4241a3c02e76SLinus Lüssing */ 4242adc47037SNikolay Aleksandrov if (!hlist_unhashed(&pmctx->ip4_rlist)) 4243a3c02e76SLinus Lüssing return; 4244a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4245adc47037SNikolay Aleksandrov if (!hlist_unhashed(&pmctx->ip6_rlist)) 4246a3c02e76SLinus Lüssing return; 4247a3c02e76SLinus Lüssing #endif 4248a3c02e76SLinus Lüssing 42491e9ca456SNikolay Aleksandrov br_rtr_notify(pmctx->port->br->dev, pmctx, RTM_DELMDB); 4250adc47037SNikolay Aleksandrov br_port_mc_router_state_change(pmctx->port, false); 4251f12e7d95SNogah Frankel 4252f12e7d95SNogah Frankel /* don't allow timer refresh */ 4253adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_TEMP) 4254adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 42557f0aec7aSNikolay Aleksandrov } 42567f0aec7aSNikolay Aleksandrov 4257a53581d5SNikolay Aleksandrov int br_multicast_set_port_router(struct net_bridge_mcast_port *pmctx, 4258a53581d5SNikolay Aleksandrov unsigned long val) 42590909e117SHerbert Xu { 4260a53581d5SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 4261a55d8246SNikolay Aleksandrov unsigned long now = jiffies; 42626ae4ae8eSLinus Lüssing int err = -EINVAL; 4263ed2d3597SLinus Lüssing bool del = false; 42640909e117SHerbert Xu 4265a53581d5SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 4266ddd0d529SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4267adc47037SNikolay Aleksandrov if (pmctx->multicast_router == val) { 4268a55d8246SNikolay Aleksandrov /* Refresh the temp router port timer */ 4269adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_TEMP) { 4270adc47037SNikolay Aleksandrov mod_timer(&pmctx->ip4_mc_router_timer, 4271d3d065c0SNikolay Aleksandrov now + brmctx->multicast_querier_interval); 4272a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4273adc47037SNikolay Aleksandrov mod_timer(&pmctx->ip6_mc_router_timer, 4274d3d065c0SNikolay Aleksandrov now + brmctx->multicast_querier_interval); 4275a3c02e76SLinus Lüssing #endif 4276a3c02e76SLinus Lüssing } 42774950cfd1SNikolay Aleksandrov err = 0; 42784950cfd1SNikolay Aleksandrov goto unlock; 42794950cfd1SNikolay Aleksandrov } 42800909e117SHerbert Xu switch (val) { 42817f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 4282adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_DISABLED; 4283adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 4284adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 4285adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 4286a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4287adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 4288a3c02e76SLinus Lüssing #endif 4289adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 42900909e117SHerbert Xu break; 42917f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 4292adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 4293adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 4294adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 4295adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 42967f0aec7aSNikolay Aleksandrov break; 42977f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 4298adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_PERM; 4299adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 4300adc47037SNikolay Aleksandrov br_ip4_multicast_add_router(brmctx, pmctx); 4301a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4302adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 4303a3c02e76SLinus Lüssing #endif 4304adc47037SNikolay Aleksandrov br_ip6_multicast_add_router(brmctx, pmctx); 43050909e117SHerbert Xu break; 4306a55d8246SNikolay Aleksandrov case MDB_RTR_TYPE_TEMP: 4307adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP; 4308adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 4309adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 4310a55d8246SNikolay Aleksandrov break; 43117f0aec7aSNikolay Aleksandrov default: 43127f0aec7aSNikolay Aleksandrov goto unlock; 43130909e117SHerbert Xu } 43147f0aec7aSNikolay Aleksandrov err = 0; 43157f0aec7aSNikolay Aleksandrov unlock: 4316ddd0d529SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 43170909e117SHerbert Xu 43180909e117SHerbert Xu return err; 43190909e117SHerbert Xu } 4320561f1103SHerbert Xu 43212796d846SNikolay Aleksandrov int br_multicast_set_vlan_router(struct net_bridge_vlan *v, u8 mcast_router) 43222796d846SNikolay Aleksandrov { 43232796d846SNikolay Aleksandrov int err; 43242796d846SNikolay Aleksandrov 43252796d846SNikolay Aleksandrov if (br_vlan_is_master(v)) 43262796d846SNikolay Aleksandrov err = br_multicast_set_router(&v->br_mcast_ctx, mcast_router); 43272796d846SNikolay Aleksandrov else 43282796d846SNikolay Aleksandrov err = br_multicast_set_port_router(&v->port_mcast_ctx, 43292796d846SNikolay Aleksandrov mcast_router); 43302796d846SNikolay Aleksandrov 43312796d846SNikolay Aleksandrov return err; 43322796d846SNikolay Aleksandrov } 43332796d846SNikolay Aleksandrov 4334adc47037SNikolay Aleksandrov static void br_multicast_start_querier(struct net_bridge_mcast *brmctx, 433590010b36SLinus Lüssing struct bridge_mcast_own_query *query) 4336561f1103SHerbert Xu { 4337561f1103SHerbert Xu struct net_bridge_port *port; 433874857216SHerbert Xu 4339cb486ce9SNikolay Aleksandrov if (!br_multicast_ctx_matches_vlan_snooping(brmctx)) 4340cb486ce9SNikolay Aleksandrov return; 4341cb486ce9SNikolay Aleksandrov 43427b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, query); 434374857216SHerbert Xu 4344c5b493ceSNikolay Aleksandrov rcu_read_lock(); 4345adc47037SNikolay Aleksandrov list_for_each_entry_rcu(port, &brmctx->br->port_list, list) { 4346615cc23eSNikolay Aleksandrov struct bridge_mcast_own_query *ip4_own_query; 4347615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4348615cc23eSNikolay Aleksandrov struct bridge_mcast_own_query *ip6_own_query; 4349615cc23eSNikolay Aleksandrov #endif 4350615cc23eSNikolay Aleksandrov 4351615cc23eSNikolay Aleksandrov if (br_multicast_port_ctx_state_stopped(&port->multicast_ctx)) 435274857216SHerbert Xu continue; 435374857216SHerbert Xu 4354615cc23eSNikolay Aleksandrov if (br_multicast_ctx_is_vlan(brmctx)) { 4355615cc23eSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4356615cc23eSNikolay Aleksandrov 43573f0d14efSNikolay Aleksandrov vlan = br_vlan_find(nbp_vlan_group_rcu(port), 43583f0d14efSNikolay Aleksandrov brmctx->vlan->vid); 4359615cc23eSNikolay Aleksandrov if (!vlan || 4360615cc23eSNikolay Aleksandrov br_multicast_port_ctx_state_stopped(&vlan->port_mcast_ctx)) 4361615cc23eSNikolay Aleksandrov continue; 4362615cc23eSNikolay Aleksandrov 4363615cc23eSNikolay Aleksandrov ip4_own_query = &vlan->port_mcast_ctx.ip4_own_query; 4364615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4365615cc23eSNikolay Aleksandrov ip6_own_query = &vlan->port_mcast_ctx.ip6_own_query; 4366615cc23eSNikolay Aleksandrov #endif 4367615cc23eSNikolay Aleksandrov } else { 4368615cc23eSNikolay Aleksandrov ip4_own_query = &port->multicast_ctx.ip4_own_query; 4369615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4370615cc23eSNikolay Aleksandrov ip6_own_query = &port->multicast_ctx.ip6_own_query; 4371615cc23eSNikolay Aleksandrov #endif 4372615cc23eSNikolay Aleksandrov } 4373615cc23eSNikolay Aleksandrov 4374adc47037SNikolay Aleksandrov if (query == &brmctx->ip4_own_query) 4375615cc23eSNikolay Aleksandrov br_multicast_enable(ip4_own_query); 4376cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4377cc0fdd80SLinus Lüssing else 4378615cc23eSNikolay Aleksandrov br_multicast_enable(ip6_own_query); 4379cc0fdd80SLinus Lüssing #endif 438074857216SHerbert Xu } 4381c5b493ceSNikolay Aleksandrov rcu_read_unlock(); 438274857216SHerbert Xu } 438374857216SHerbert Xu 4384ae1ea84bSFlorian Fainelli int br_multicast_toggle(struct net_bridge *br, unsigned long val, 4385ae1ea84bSFlorian Fainelli struct netlink_ext_ack *extack) 438674857216SHerbert Xu { 43877cb3f921SNikolay Aleksandrov struct net_bridge_port *port; 4388851d0a73SJoseph Huang bool change_snoopers = false; 4389ae1ea84bSFlorian Fainelli int err = 0; 4390561f1103SHerbert Xu 4391ef5e0d82SAndrey Vagin spin_lock_bh(&br->multicast_lock); 439213cefad2SNikolay Aleksandrov if (!!br_opt_get(br, BROPT_MULTICAST_ENABLED) == !!val) 4393561f1103SHerbert Xu goto unlock; 4394561f1103SHerbert Xu 4395ae1ea84bSFlorian Fainelli err = br_mc_disabled_update(br->dev, val, extack); 4396ae1ea84bSFlorian Fainelli if (err == -EOPNOTSUPP) 4397ae1ea84bSFlorian Fainelli err = 0; 4398ae1ea84bSFlorian Fainelli if (err) 4399ae1ea84bSFlorian Fainelli goto unlock; 4400ae1ea84bSFlorian Fainelli 440113cefad2SNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_ENABLED, !!val); 44024effd28cSLinus Lüssing if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) { 4403851d0a73SJoseph Huang change_snoopers = true; 4404561f1103SHerbert Xu goto unlock; 44054effd28cSLinus Lüssing } 4406561f1103SHerbert Xu 44073a7fda06SHerbert Xu if (!netif_running(br->dev)) 44083a7fda06SHerbert Xu goto unlock; 44093a7fda06SHerbert Xu 44107cb3f921SNikolay Aleksandrov br_multicast_open(br); 44117cb3f921SNikolay Aleksandrov list_for_each_entry(port, &br->port_list, list) 4412adc47037SNikolay Aleksandrov __br_multicast_enable_port_ctx(&port->multicast_ctx); 4413561f1103SHerbert Xu 4414851d0a73SJoseph Huang change_snoopers = true; 4415851d0a73SJoseph Huang 4416561f1103SHerbert Xu unlock: 4417ef5e0d82SAndrey Vagin spin_unlock_bh(&br->multicast_lock); 4418561f1103SHerbert Xu 4419851d0a73SJoseph Huang /* br_multicast_join_snoopers has the potential to cause 4420851d0a73SJoseph Huang * an MLD Report/Leave to be delivered to br_multicast_rcv, 4421851d0a73SJoseph Huang * which would in turn call br_multicast_add_group, which would 4422851d0a73SJoseph Huang * attempt to acquire multicast_lock. This function should be 4423851d0a73SJoseph Huang * called after the lock has been released to avoid deadlocks on 4424851d0a73SJoseph Huang * multicast_lock. 4425851d0a73SJoseph Huang * 4426851d0a73SJoseph Huang * br_multicast_leave_snoopers does not have the problem since 4427851d0a73SJoseph Huang * br_multicast_rcv first checks BROPT_MULTICAST_ENABLED, and 4428851d0a73SJoseph Huang * returns without calling br_multicast_ipv4/6_rcv if it's not 4429851d0a73SJoseph Huang * enabled. Moved both functions out just for symmetry. 4430851d0a73SJoseph Huang */ 4431851d0a73SJoseph Huang if (change_snoopers) { 4432851d0a73SJoseph Huang if (br_opt_get(br, BROPT_MULTICAST_ENABLED)) 4433851d0a73SJoseph Huang br_multicast_join_snoopers(br); 4434851d0a73SJoseph Huang else 4435851d0a73SJoseph Huang br_multicast_leave_snoopers(br); 4436851d0a73SJoseph Huang } 4437851d0a73SJoseph Huang 4438ae1ea84bSFlorian Fainelli return err; 4439561f1103SHerbert Xu } 4440b195167fSHerbert Xu 44419341b988SIdo Schimmel bool br_multicast_enabled(const struct net_device *dev) 44429341b988SIdo Schimmel { 44439341b988SIdo Schimmel struct net_bridge *br = netdev_priv(dev); 44449341b988SIdo Schimmel 444513cefad2SNikolay Aleksandrov return !!br_opt_get(br, BROPT_MULTICAST_ENABLED); 44469341b988SIdo Schimmel } 44479341b988SIdo Schimmel EXPORT_SYMBOL_GPL(br_multicast_enabled); 44489341b988SIdo Schimmel 44490912bda4SYotam Gigi bool br_multicast_router(const struct net_device *dev) 44500912bda4SYotam Gigi { 44510912bda4SYotam Gigi struct net_bridge *br = netdev_priv(dev); 44520912bda4SYotam Gigi bool is_router; 44530912bda4SYotam Gigi 44540912bda4SYotam Gigi spin_lock_bh(&br->multicast_lock); 4455adc47037SNikolay Aleksandrov is_router = br_multicast_is_router(&br->multicast_ctx, NULL); 44560912bda4SYotam Gigi spin_unlock_bh(&br->multicast_lock); 44570912bda4SYotam Gigi return is_router; 44580912bda4SYotam Gigi } 44590912bda4SYotam Gigi EXPORT_SYMBOL_GPL(br_multicast_router); 44600912bda4SYotam Gigi 446162938182SNikolay Aleksandrov int br_multicast_set_querier(struct net_bridge_mcast *brmctx, unsigned long val) 4462c5c23260SHerbert Xu { 4463b00589afSLinus Lüssing unsigned long max_delay; 4464b00589afSLinus Lüssing 4465c5c23260SHerbert Xu val = !!val; 4466c5c23260SHerbert Xu 446762938182SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 44684d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier == val) 4469c5c23260SHerbert Xu goto unlock; 4470c5c23260SHerbert Xu 44714d5b4e84SNikolay Aleksandrov WRITE_ONCE(brmctx->multicast_querier, val); 4472b00589afSLinus Lüssing if (!val) 4473b00589afSLinus Lüssing goto unlock; 4474b00589afSLinus Lüssing 4475d3d065c0SNikolay Aleksandrov max_delay = brmctx->multicast_query_response_interval; 4476b00589afSLinus Lüssing 4477d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip4_other_query.timer)) 4478d3d065c0SNikolay Aleksandrov brmctx->ip4_other_query.delay_time = jiffies + max_delay; 4479cc0fdd80SLinus Lüssing 4480adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, &brmctx->ip4_own_query); 4481cc0fdd80SLinus Lüssing 4482cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4483d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip6_other_query.timer)) 4484d3d065c0SNikolay Aleksandrov brmctx->ip6_other_query.delay_time = jiffies + max_delay; 4485cc0fdd80SLinus Lüssing 4486adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, &brmctx->ip6_own_query); 4487cc0fdd80SLinus Lüssing #endif 4488c5c23260SHerbert Xu 4489c5c23260SHerbert Xu unlock: 449062938182SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 4491c5c23260SHerbert Xu 4492c5c23260SHerbert Xu return 0; 4493c5c23260SHerbert Xu } 4494c5c23260SHerbert Xu 4495df271cd6SNikolay Aleksandrov int br_multicast_set_igmp_version(struct net_bridge_mcast *brmctx, 4496df271cd6SNikolay Aleksandrov unsigned long val) 44975e923585SNikolay Aleksandrov { 44985e923585SNikolay Aleksandrov /* Currently we support only version 2 and 3 */ 44995e923585SNikolay Aleksandrov switch (val) { 45005e923585SNikolay Aleksandrov case 2: 45015e923585SNikolay Aleksandrov case 3: 45025e923585SNikolay Aleksandrov break; 45035e923585SNikolay Aleksandrov default: 45045e923585SNikolay Aleksandrov return -EINVAL; 45055e923585SNikolay Aleksandrov } 45065e923585SNikolay Aleksandrov 4507df271cd6SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4508df271cd6SNikolay Aleksandrov brmctx->multicast_igmp_version = val; 4509df271cd6SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 45105e923585SNikolay Aleksandrov 45115e923585SNikolay Aleksandrov return 0; 45125e923585SNikolay Aleksandrov } 45135e923585SNikolay Aleksandrov 4514aa2ae3e7SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4515df271cd6SNikolay Aleksandrov int br_multicast_set_mld_version(struct net_bridge_mcast *brmctx, 4516df271cd6SNikolay Aleksandrov unsigned long val) 4517aa2ae3e7SNikolay Aleksandrov { 4518aa2ae3e7SNikolay Aleksandrov /* Currently we support version 1 and 2 */ 4519aa2ae3e7SNikolay Aleksandrov switch (val) { 4520aa2ae3e7SNikolay Aleksandrov case 1: 4521aa2ae3e7SNikolay Aleksandrov case 2: 4522aa2ae3e7SNikolay Aleksandrov break; 4523aa2ae3e7SNikolay Aleksandrov default: 4524aa2ae3e7SNikolay Aleksandrov return -EINVAL; 4525aa2ae3e7SNikolay Aleksandrov } 4526aa2ae3e7SNikolay Aleksandrov 4527df271cd6SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4528df271cd6SNikolay Aleksandrov brmctx->multicast_mld_version = val; 4529df271cd6SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 4530aa2ae3e7SNikolay Aleksandrov 4531aa2ae3e7SNikolay Aleksandrov return 0; 4532aa2ae3e7SNikolay Aleksandrov } 4533aa2ae3e7SNikolay Aleksandrov #endif 4534aa2ae3e7SNikolay Aleksandrov 453599b40610SNikolay Aleksandrov void br_multicast_set_query_intvl(struct net_bridge_mcast *brmctx, 453699b40610SNikolay Aleksandrov unsigned long val) 453799b40610SNikolay Aleksandrov { 453899b40610SNikolay Aleksandrov unsigned long intvl_jiffies = clock_t_to_jiffies(val); 453999b40610SNikolay Aleksandrov 454099b40610SNikolay Aleksandrov if (intvl_jiffies < BR_MULTICAST_QUERY_INTVL_MIN) { 454199b40610SNikolay Aleksandrov br_info(brmctx->br, 454299b40610SNikolay Aleksandrov "trying to set multicast query interval below minimum, setting to %lu (%ums)\n", 454399b40610SNikolay Aleksandrov jiffies_to_clock_t(BR_MULTICAST_QUERY_INTVL_MIN), 454499b40610SNikolay Aleksandrov jiffies_to_msecs(BR_MULTICAST_QUERY_INTVL_MIN)); 454599b40610SNikolay Aleksandrov intvl_jiffies = BR_MULTICAST_QUERY_INTVL_MIN; 454699b40610SNikolay Aleksandrov } 454799b40610SNikolay Aleksandrov 454899b40610SNikolay Aleksandrov brmctx->multicast_query_interval = intvl_jiffies; 454999b40610SNikolay Aleksandrov } 455099b40610SNikolay Aleksandrov 4551f83a112bSNikolay Aleksandrov void br_multicast_set_startup_query_intvl(struct net_bridge_mcast *brmctx, 4552f83a112bSNikolay Aleksandrov unsigned long val) 4553f83a112bSNikolay Aleksandrov { 4554f83a112bSNikolay Aleksandrov unsigned long intvl_jiffies = clock_t_to_jiffies(val); 4555f83a112bSNikolay Aleksandrov 4556f83a112bSNikolay Aleksandrov if (intvl_jiffies < BR_MULTICAST_STARTUP_QUERY_INTVL_MIN) { 4557f83a112bSNikolay Aleksandrov br_info(brmctx->br, 4558f83a112bSNikolay Aleksandrov "trying to set multicast startup query interval below minimum, setting to %lu (%ums)\n", 4559f83a112bSNikolay Aleksandrov jiffies_to_clock_t(BR_MULTICAST_STARTUP_QUERY_INTVL_MIN), 4560f83a112bSNikolay Aleksandrov jiffies_to_msecs(BR_MULTICAST_STARTUP_QUERY_INTVL_MIN)); 4561f83a112bSNikolay Aleksandrov intvl_jiffies = BR_MULTICAST_STARTUP_QUERY_INTVL_MIN; 4562f83a112bSNikolay Aleksandrov } 4563f83a112bSNikolay Aleksandrov 4564f83a112bSNikolay Aleksandrov brmctx->multicast_startup_query_interval = intvl_jiffies; 4565f83a112bSNikolay Aleksandrov } 4566f83a112bSNikolay Aleksandrov 456707f8ac4aSLinus Lüssing /** 456807f8ac4aSLinus Lüssing * br_multicast_list_adjacent - Returns snooped multicast addresses 456907f8ac4aSLinus Lüssing * @dev: The bridge port adjacent to which to retrieve addresses 457007f8ac4aSLinus Lüssing * @br_ip_list: The list to store found, snooped multicast IP addresses in 457107f8ac4aSLinus Lüssing * 457207f8ac4aSLinus Lüssing * Creates a list of IP addresses (struct br_ip_list) sensed by the multicast 457307f8ac4aSLinus Lüssing * snooping feature on all bridge ports of dev's bridge device, excluding 457407f8ac4aSLinus Lüssing * the addresses from dev itself. 457507f8ac4aSLinus Lüssing * 457607f8ac4aSLinus Lüssing * Returns the number of items added to br_ip_list. 457707f8ac4aSLinus Lüssing * 457807f8ac4aSLinus Lüssing * Notes: 457907f8ac4aSLinus Lüssing * - br_ip_list needs to be initialized by caller 458007f8ac4aSLinus Lüssing * - br_ip_list might contain duplicates in the end 458107f8ac4aSLinus Lüssing * (needs to be taken care of by caller) 458207f8ac4aSLinus Lüssing * - br_ip_list needs to be freed by caller 458307f8ac4aSLinus Lüssing */ 458407f8ac4aSLinus Lüssing int br_multicast_list_adjacent(struct net_device *dev, 458507f8ac4aSLinus Lüssing struct list_head *br_ip_list) 458607f8ac4aSLinus Lüssing { 458707f8ac4aSLinus Lüssing struct net_bridge *br; 458807f8ac4aSLinus Lüssing struct net_bridge_port *port; 458907f8ac4aSLinus Lüssing struct net_bridge_port_group *group; 459007f8ac4aSLinus Lüssing struct br_ip_list *entry; 459107f8ac4aSLinus Lüssing int count = 0; 459207f8ac4aSLinus Lüssing 459307f8ac4aSLinus Lüssing rcu_read_lock(); 459435f861e3SJulian Wiedmann if (!br_ip_list || !netif_is_bridge_port(dev)) 459507f8ac4aSLinus Lüssing goto unlock; 459607f8ac4aSLinus Lüssing 459707f8ac4aSLinus Lüssing port = br_port_get_rcu(dev); 459807f8ac4aSLinus Lüssing if (!port || !port->br) 459907f8ac4aSLinus Lüssing goto unlock; 460007f8ac4aSLinus Lüssing 460107f8ac4aSLinus Lüssing br = port->br; 460207f8ac4aSLinus Lüssing 460307f8ac4aSLinus Lüssing list_for_each_entry_rcu(port, &br->port_list, list) { 460407f8ac4aSLinus Lüssing if (!port->dev || port->dev == dev) 460507f8ac4aSLinus Lüssing continue; 460607f8ac4aSLinus Lüssing 460707f8ac4aSLinus Lüssing hlist_for_each_entry_rcu(group, &port->mglist, mglist) { 460807f8ac4aSLinus Lüssing entry = kmalloc(sizeof(*entry), GFP_ATOMIC); 460907f8ac4aSLinus Lüssing if (!entry) 461007f8ac4aSLinus Lüssing goto unlock; 461107f8ac4aSLinus Lüssing 4612085b53c8SNikolay Aleksandrov entry->addr = group->key.addr; 461307f8ac4aSLinus Lüssing list_add(&entry->list, br_ip_list); 461407f8ac4aSLinus Lüssing count++; 461507f8ac4aSLinus Lüssing } 461607f8ac4aSLinus Lüssing } 461707f8ac4aSLinus Lüssing 461807f8ac4aSLinus Lüssing unlock: 461907f8ac4aSLinus Lüssing rcu_read_unlock(); 462007f8ac4aSLinus Lüssing return count; 462107f8ac4aSLinus Lüssing } 462207f8ac4aSLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_list_adjacent); 46232cd41431SLinus Lüssing 46242cd41431SLinus Lüssing /** 4625c34963e2SLinus Lüssing * br_multicast_has_querier_anywhere - Checks for a querier on a bridge 4626c34963e2SLinus Lüssing * @dev: The bridge port providing the bridge on which to check for a querier 4627c34963e2SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 4628c34963e2SLinus Lüssing * 4629c34963e2SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 4630c34963e2SLinus Lüssing * true if a valid querier exists anywhere on the bridged link layer. 4631c34963e2SLinus Lüssing * Otherwise returns false. 4632c34963e2SLinus Lüssing */ 4633c34963e2SLinus Lüssing bool br_multicast_has_querier_anywhere(struct net_device *dev, int proto) 4634c34963e2SLinus Lüssing { 4635c34963e2SLinus Lüssing struct net_bridge *br; 4636c34963e2SLinus Lüssing struct net_bridge_port *port; 4637c34963e2SLinus Lüssing struct ethhdr eth; 4638c34963e2SLinus Lüssing bool ret = false; 4639c34963e2SLinus Lüssing 4640c34963e2SLinus Lüssing rcu_read_lock(); 464135f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 4642c34963e2SLinus Lüssing goto unlock; 4643c34963e2SLinus Lüssing 4644c34963e2SLinus Lüssing port = br_port_get_rcu(dev); 4645c34963e2SLinus Lüssing if (!port || !port->br) 4646c34963e2SLinus Lüssing goto unlock; 4647c34963e2SLinus Lüssing 4648c34963e2SLinus Lüssing br = port->br; 4649c34963e2SLinus Lüssing 4650c34963e2SLinus Lüssing memset(ð, 0, sizeof(eth)); 4651c34963e2SLinus Lüssing eth.h_proto = htons(proto); 4652c34963e2SLinus Lüssing 4653adc47037SNikolay Aleksandrov ret = br_multicast_querier_exists(&br->multicast_ctx, ð, NULL); 4654c34963e2SLinus Lüssing 4655c34963e2SLinus Lüssing unlock: 4656c34963e2SLinus Lüssing rcu_read_unlock(); 4657c34963e2SLinus Lüssing return ret; 4658c34963e2SLinus Lüssing } 4659c34963e2SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_anywhere); 4660c34963e2SLinus Lüssing 4661c34963e2SLinus Lüssing /** 46622cd41431SLinus Lüssing * br_multicast_has_querier_adjacent - Checks for a querier behind a bridge port 46632cd41431SLinus Lüssing * @dev: The bridge port adjacent to which to check for a querier 46642cd41431SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 46652cd41431SLinus Lüssing * 46662cd41431SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 46672cd41431SLinus Lüssing * true if a selected querier is behind one of the other ports of this 46682cd41431SLinus Lüssing * bridge. Otherwise returns false. 46692cd41431SLinus Lüssing */ 46702cd41431SLinus Lüssing bool br_multicast_has_querier_adjacent(struct net_device *dev, int proto) 46712cd41431SLinus Lüssing { 4672d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 46732cd41431SLinus Lüssing struct net_bridge *br; 46742cd41431SLinus Lüssing struct net_bridge_port *port; 46752cd41431SLinus Lüssing bool ret = false; 4676bb18ef8eSNikolay Aleksandrov int port_ifidx; 46772cd41431SLinus Lüssing 46782cd41431SLinus Lüssing rcu_read_lock(); 467935f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 46802cd41431SLinus Lüssing goto unlock; 46812cd41431SLinus Lüssing 46822cd41431SLinus Lüssing port = br_port_get_rcu(dev); 46832cd41431SLinus Lüssing if (!port || !port->br) 46842cd41431SLinus Lüssing goto unlock; 46852cd41431SLinus Lüssing 46862cd41431SLinus Lüssing br = port->br; 4687d3d065c0SNikolay Aleksandrov brmctx = &br->multicast_ctx; 46882cd41431SLinus Lüssing 46892cd41431SLinus Lüssing switch (proto) { 46902cd41431SLinus Lüssing case ETH_P_IP: 4691bb18ef8eSNikolay Aleksandrov port_ifidx = brmctx->ip4_querier.port_ifidx; 4692d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip4_other_query.timer) || 4693bb18ef8eSNikolay Aleksandrov port_ifidx == port->dev->ifindex) 46942cd41431SLinus Lüssing goto unlock; 46952cd41431SLinus Lüssing break; 46963993c4e1SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 46972cd41431SLinus Lüssing case ETH_P_IPV6: 4698bb18ef8eSNikolay Aleksandrov port_ifidx = brmctx->ip6_querier.port_ifidx; 4699d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip6_other_query.timer) || 4700bb18ef8eSNikolay Aleksandrov port_ifidx == port->dev->ifindex) 47012cd41431SLinus Lüssing goto unlock; 47022cd41431SLinus Lüssing break; 47033993c4e1SLinus Lüssing #endif 47042cd41431SLinus Lüssing default: 47052cd41431SLinus Lüssing goto unlock; 47062cd41431SLinus Lüssing } 47072cd41431SLinus Lüssing 47082cd41431SLinus Lüssing ret = true; 47092cd41431SLinus Lüssing unlock: 47102cd41431SLinus Lüssing rcu_read_unlock(); 47112cd41431SLinus Lüssing return ret; 47122cd41431SLinus Lüssing } 47132cd41431SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_adjacent); 47141080ab95SNikolay Aleksandrov 47153b85f9baSLinus Lüssing /** 47163b85f9baSLinus Lüssing * br_multicast_has_router_adjacent - Checks for a router behind a bridge port 47173b85f9baSLinus Lüssing * @dev: The bridge port adjacent to which to check for a multicast router 47183b85f9baSLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 47193b85f9baSLinus Lüssing * 47203b85f9baSLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 47213b85f9baSLinus Lüssing * true if a multicast router is behind one of the other ports of this 47223b85f9baSLinus Lüssing * bridge. Otherwise returns false. 47233b85f9baSLinus Lüssing */ 47243b85f9baSLinus Lüssing bool br_multicast_has_router_adjacent(struct net_device *dev, int proto) 47253b85f9baSLinus Lüssing { 47269632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 4727d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 47289632233eSNikolay Aleksandrov struct net_bridge_port *port; 47293b85f9baSLinus Lüssing bool ret = false; 47303b85f9baSLinus Lüssing 47313b85f9baSLinus Lüssing rcu_read_lock(); 47323b85f9baSLinus Lüssing port = br_port_get_check_rcu(dev); 47333b85f9baSLinus Lüssing if (!port) 47343b85f9baSLinus Lüssing goto unlock; 47353b85f9baSLinus Lüssing 4736d3d065c0SNikolay Aleksandrov brmctx = &port->br->multicast_ctx; 47373b85f9baSLinus Lüssing switch (proto) { 47383b85f9baSLinus Lüssing case ETH_P_IP: 4739d3d065c0SNikolay Aleksandrov hlist_for_each_entry_rcu(pmctx, &brmctx->ip4_mc_router_list, 47403b85f9baSLinus Lüssing ip4_rlist) { 47419632233eSNikolay Aleksandrov if (pmctx->port == port) 47423b85f9baSLinus Lüssing continue; 47433b85f9baSLinus Lüssing 47443b85f9baSLinus Lüssing ret = true; 47453b85f9baSLinus Lüssing goto unlock; 47463b85f9baSLinus Lüssing } 47473b85f9baSLinus Lüssing break; 47483b85f9baSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 47493b85f9baSLinus Lüssing case ETH_P_IPV6: 4750d3d065c0SNikolay Aleksandrov hlist_for_each_entry_rcu(pmctx, &brmctx->ip6_mc_router_list, 47513b85f9baSLinus Lüssing ip6_rlist) { 47529632233eSNikolay Aleksandrov if (pmctx->port == port) 47533b85f9baSLinus Lüssing continue; 47543b85f9baSLinus Lüssing 47553b85f9baSLinus Lüssing ret = true; 47563b85f9baSLinus Lüssing goto unlock; 47573b85f9baSLinus Lüssing } 47583b85f9baSLinus Lüssing break; 47593b85f9baSLinus Lüssing #endif 47603b85f9baSLinus Lüssing default: 47613b85f9baSLinus Lüssing /* when compiled without IPv6 support, be conservative and 47623b85f9baSLinus Lüssing * always assume presence of an IPv6 multicast router 47633b85f9baSLinus Lüssing */ 47643b85f9baSLinus Lüssing ret = true; 47653b85f9baSLinus Lüssing } 47663b85f9baSLinus Lüssing 47673b85f9baSLinus Lüssing unlock: 47683b85f9baSLinus Lüssing rcu_read_unlock(); 47693b85f9baSLinus Lüssing return ret; 47703b85f9baSLinus Lüssing } 47713b85f9baSLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_router_adjacent); 47723b85f9baSLinus Lüssing 47731080ab95SNikolay Aleksandrov static void br_mcast_stats_add(struct bridge_mcast_stats __percpu *stats, 4774a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 47751080ab95SNikolay Aleksandrov { 47761080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats = this_cpu_ptr(stats); 4777a65056ecSNikolay Aleksandrov __be16 proto = skb->protocol; 4778a65056ecSNikolay Aleksandrov unsigned int t_len; 47791080ab95SNikolay Aleksandrov 47801080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 47811080ab95SNikolay Aleksandrov switch (proto) { 47821080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 4783a65056ecSNikolay Aleksandrov t_len = ntohs(ip_hdr(skb)->tot_len) - ip_hdrlen(skb); 47841080ab95SNikolay Aleksandrov switch (type) { 47851080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_REPORT: 47861080ab95SNikolay Aleksandrov pstats->mstats.igmp_v1reports[dir]++; 47871080ab95SNikolay Aleksandrov break; 47881080ab95SNikolay Aleksandrov case IGMPV2_HOST_MEMBERSHIP_REPORT: 47891080ab95SNikolay Aleksandrov pstats->mstats.igmp_v2reports[dir]++; 47901080ab95SNikolay Aleksandrov break; 47911080ab95SNikolay Aleksandrov case IGMPV3_HOST_MEMBERSHIP_REPORT: 47921080ab95SNikolay Aleksandrov pstats->mstats.igmp_v3reports[dir]++; 47931080ab95SNikolay Aleksandrov break; 47941080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_QUERY: 4795a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct igmphdr)) { 4796a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v3queries[dir]++; 4797a65056ecSNikolay Aleksandrov } else { 4798a65056ecSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 4799a65056ecSNikolay Aleksandrov struct igmphdr *ih, _ihdr; 4800a65056ecSNikolay Aleksandrov 4801a65056ecSNikolay Aleksandrov ih = skb_header_pointer(skb, offset, 4802a65056ecSNikolay Aleksandrov sizeof(_ihdr), &_ihdr); 4803a65056ecSNikolay Aleksandrov if (!ih) 4804a65056ecSNikolay Aleksandrov break; 4805a65056ecSNikolay Aleksandrov if (!ih->code) 4806a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v1queries[dir]++; 4807a65056ecSNikolay Aleksandrov else 4808a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v2queries[dir]++; 4809a65056ecSNikolay Aleksandrov } 48101080ab95SNikolay Aleksandrov break; 48111080ab95SNikolay Aleksandrov case IGMP_HOST_LEAVE_MESSAGE: 48121080ab95SNikolay Aleksandrov pstats->mstats.igmp_leaves[dir]++; 48131080ab95SNikolay Aleksandrov break; 48141080ab95SNikolay Aleksandrov } 48151080ab95SNikolay Aleksandrov break; 48161080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 48171080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 4818a65056ecSNikolay Aleksandrov t_len = ntohs(ipv6_hdr(skb)->payload_len) + 4819a65056ecSNikolay Aleksandrov sizeof(struct ipv6hdr); 4820a65056ecSNikolay Aleksandrov t_len -= skb_network_header_len(skb); 48211080ab95SNikolay Aleksandrov switch (type) { 48221080ab95SNikolay Aleksandrov case ICMPV6_MGM_REPORT: 48231080ab95SNikolay Aleksandrov pstats->mstats.mld_v1reports[dir]++; 48241080ab95SNikolay Aleksandrov break; 48251080ab95SNikolay Aleksandrov case ICMPV6_MLD2_REPORT: 48261080ab95SNikolay Aleksandrov pstats->mstats.mld_v2reports[dir]++; 48271080ab95SNikolay Aleksandrov break; 48281080ab95SNikolay Aleksandrov case ICMPV6_MGM_QUERY: 4829a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct mld_msg)) 4830a65056ecSNikolay Aleksandrov pstats->mstats.mld_v2queries[dir]++; 4831a65056ecSNikolay Aleksandrov else 4832a65056ecSNikolay Aleksandrov pstats->mstats.mld_v1queries[dir]++; 48331080ab95SNikolay Aleksandrov break; 48341080ab95SNikolay Aleksandrov case ICMPV6_MGM_REDUCTION: 48351080ab95SNikolay Aleksandrov pstats->mstats.mld_leaves[dir]++; 48361080ab95SNikolay Aleksandrov break; 48371080ab95SNikolay Aleksandrov } 48381080ab95SNikolay Aleksandrov break; 48391080ab95SNikolay Aleksandrov #endif /* CONFIG_IPV6 */ 48401080ab95SNikolay Aleksandrov } 48411080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 48421080ab95SNikolay Aleksandrov } 48431080ab95SNikolay Aleksandrov 4844adc47037SNikolay Aleksandrov void br_multicast_count(struct net_bridge *br, 4845adc47037SNikolay Aleksandrov const struct net_bridge_port *p, 4846a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 48471080ab95SNikolay Aleksandrov { 48481080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 48491080ab95SNikolay Aleksandrov 48501080ab95SNikolay Aleksandrov /* if multicast_disabled is true then igmp type can't be set */ 4851675779adSNikolay Aleksandrov if (!type || !br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 48521080ab95SNikolay Aleksandrov return; 48531080ab95SNikolay Aleksandrov 48541080ab95SNikolay Aleksandrov if (p) 48551080ab95SNikolay Aleksandrov stats = p->mcast_stats; 48561080ab95SNikolay Aleksandrov else 48571080ab95SNikolay Aleksandrov stats = br->mcast_stats; 48581080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 48591080ab95SNikolay Aleksandrov return; 48601080ab95SNikolay Aleksandrov 4861a65056ecSNikolay Aleksandrov br_mcast_stats_add(stats, skb, type, dir); 48621080ab95SNikolay Aleksandrov } 48631080ab95SNikolay Aleksandrov 48641080ab95SNikolay Aleksandrov int br_multicast_init_stats(struct net_bridge *br) 48651080ab95SNikolay Aleksandrov { 48661080ab95SNikolay Aleksandrov br->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 48671080ab95SNikolay Aleksandrov if (!br->mcast_stats) 48681080ab95SNikolay Aleksandrov return -ENOMEM; 48691080ab95SNikolay Aleksandrov 48701080ab95SNikolay Aleksandrov return 0; 48711080ab95SNikolay Aleksandrov } 48721080ab95SNikolay Aleksandrov 4873b6fe0440SIdo Schimmel void br_multicast_uninit_stats(struct net_bridge *br) 4874b6fe0440SIdo Schimmel { 4875b6fe0440SIdo Schimmel free_percpu(br->mcast_stats); 4876b6fe0440SIdo Schimmel } 4877b6fe0440SIdo Schimmel 4878b3b6a84cSArnd Bergmann /* noinline for https://bugs.llvm.org/show_bug.cgi?id=45802#c9 */ 4879b3b6a84cSArnd Bergmann static noinline_for_stack void mcast_stats_add_dir(u64 *dst, u64 *src) 48801080ab95SNikolay Aleksandrov { 48811080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_RX] += src[BR_MCAST_DIR_RX]; 48821080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_TX] += src[BR_MCAST_DIR_TX]; 48831080ab95SNikolay Aleksandrov } 48841080ab95SNikolay Aleksandrov 48851080ab95SNikolay Aleksandrov void br_multicast_get_stats(const struct net_bridge *br, 48861080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 48871080ab95SNikolay Aleksandrov struct br_mcast_stats *dest) 48881080ab95SNikolay Aleksandrov { 48891080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 48901080ab95SNikolay Aleksandrov struct br_mcast_stats tdst; 48911080ab95SNikolay Aleksandrov int i; 48921080ab95SNikolay Aleksandrov 48931080ab95SNikolay Aleksandrov memset(dest, 0, sizeof(*dest)); 48941080ab95SNikolay Aleksandrov if (p) 48951080ab95SNikolay Aleksandrov stats = p->mcast_stats; 48961080ab95SNikolay Aleksandrov else 48971080ab95SNikolay Aleksandrov stats = br->mcast_stats; 48981080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 48991080ab95SNikolay Aleksandrov return; 49001080ab95SNikolay Aleksandrov 49011080ab95SNikolay Aleksandrov memset(&tdst, 0, sizeof(tdst)); 49021080ab95SNikolay Aleksandrov for_each_possible_cpu(i) { 49031080ab95SNikolay Aleksandrov struct bridge_mcast_stats *cpu_stats = per_cpu_ptr(stats, i); 49041080ab95SNikolay Aleksandrov struct br_mcast_stats temp; 49051080ab95SNikolay Aleksandrov unsigned int start; 49061080ab95SNikolay Aleksandrov 49071080ab95SNikolay Aleksandrov do { 4908d120d1a6SThomas Gleixner start = u64_stats_fetch_begin(&cpu_stats->syncp); 49091080ab95SNikolay Aleksandrov memcpy(&temp, &cpu_stats->mstats, sizeof(temp)); 4910d120d1a6SThomas Gleixner } while (u64_stats_fetch_retry(&cpu_stats->syncp, start)); 49111080ab95SNikolay Aleksandrov 4912a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1queries, temp.igmp_v1queries); 4913a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2queries, temp.igmp_v2queries); 4914a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3queries, temp.igmp_v3queries); 49151080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_leaves, temp.igmp_leaves); 49161080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1reports, temp.igmp_v1reports); 49171080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2reports, temp.igmp_v2reports); 49181080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3reports, temp.igmp_v3reports); 49191080ab95SNikolay Aleksandrov tdst.igmp_parse_errors += temp.igmp_parse_errors; 49201080ab95SNikolay Aleksandrov 4921a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1queries, temp.mld_v1queries); 4922a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2queries, temp.mld_v2queries); 49231080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_leaves, temp.mld_leaves); 49241080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1reports, temp.mld_v1reports); 49251080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2reports, temp.mld_v2reports); 49261080ab95SNikolay Aleksandrov tdst.mld_parse_errors += temp.mld_parse_errors; 49271080ab95SNikolay Aleksandrov } 49281080ab95SNikolay Aleksandrov memcpy(dest, &tdst, sizeof(*dest)); 49291080ab95SNikolay Aleksandrov } 493019e3a9c9SNikolay Aleksandrov 493119e3a9c9SNikolay Aleksandrov int br_mdb_hash_init(struct net_bridge *br) 493219e3a9c9SNikolay Aleksandrov { 4933085b53c8SNikolay Aleksandrov int err; 4934085b53c8SNikolay Aleksandrov 4935085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->sg_port_tbl, &br_sg_port_rht_params); 4936085b53c8SNikolay Aleksandrov if (err) 4937085b53c8SNikolay Aleksandrov return err; 4938085b53c8SNikolay Aleksandrov 4939085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->mdb_hash_tbl, &br_mdb_rht_params); 4940085b53c8SNikolay Aleksandrov if (err) { 4941085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 4942085b53c8SNikolay Aleksandrov return err; 4943085b53c8SNikolay Aleksandrov } 4944085b53c8SNikolay Aleksandrov 4945085b53c8SNikolay Aleksandrov return 0; 494619e3a9c9SNikolay Aleksandrov } 494719e3a9c9SNikolay Aleksandrov 494819e3a9c9SNikolay Aleksandrov void br_mdb_hash_fini(struct net_bridge *br) 494919e3a9c9SNikolay Aleksandrov { 4950085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 495119e3a9c9SNikolay Aleksandrov rhashtable_destroy(&br->mdb_hash_tbl); 495219e3a9c9SNikolay Aleksandrov } 4953