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 34*b57e8d87SPetr Machata #include <trace/events/bridge.h> 35eb1d1641SHerbert Xu 36eb1d1641SHerbert Xu #include "br_private.h" 378f07b831SNikolay Aleksandrov #include "br_private_mcast_eht.h" 38eb1d1641SHerbert Xu 3919e3a9c9SNikolay Aleksandrov static const struct rhashtable_params br_mdb_rht_params = { 4019e3a9c9SNikolay Aleksandrov .head_offset = offsetof(struct net_bridge_mdb_entry, rhnode), 4119e3a9c9SNikolay Aleksandrov .key_offset = offsetof(struct net_bridge_mdb_entry, addr), 4219e3a9c9SNikolay Aleksandrov .key_len = sizeof(struct br_ip), 4319e3a9c9SNikolay Aleksandrov .automatic_shrinking = true, 4419e3a9c9SNikolay Aleksandrov }; 4519e3a9c9SNikolay Aleksandrov 46085b53c8SNikolay Aleksandrov static const struct rhashtable_params br_sg_port_rht_params = { 47085b53c8SNikolay Aleksandrov .head_offset = offsetof(struct net_bridge_port_group, rhnode), 48085b53c8SNikolay Aleksandrov .key_offset = offsetof(struct net_bridge_port_group, key), 49085b53c8SNikolay Aleksandrov .key_len = sizeof(struct net_bridge_port_group_sg_key), 50085b53c8SNikolay Aleksandrov .automatic_shrinking = true, 51085b53c8SNikolay Aleksandrov }; 52085b53c8SNikolay Aleksandrov 53adc47037SNikolay Aleksandrov static void br_multicast_start_querier(struct net_bridge_mcast *brmctx, 5490010b36SLinus Lüssing struct bridge_mcast_own_query *query); 55adc47037SNikolay Aleksandrov static void br_ip4_multicast_add_router(struct net_bridge_mcast *brmctx, 56adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx); 57adc47037SNikolay Aleksandrov static void br_ip4_multicast_leave_group(struct net_bridge_mcast *brmctx, 58adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 59bc8c20acSSatish Ashok __be32 group, 606db6f0eaSFelix Fietkau __u16 vid, 616db6f0eaSFelix Fietkau const unsigned char *src); 6242c11ccfSNikolay Aleksandrov static void br_multicast_port_group_rexmit(struct timer_list *t); 636db6f0eaSFelix Fietkau 64ed2d3597SLinus Lüssing static void 65adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(struct net_bridge_mcast_port *pmctx, bool deleted); 66adc47037SNikolay Aleksandrov static void br_ip6_multicast_add_router(struct net_bridge_mcast *brmctx, 67adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx); 6830515832SMatteo Croce #if IS_ENABLED(CONFIG_IPV6) 69adc47037SNikolay Aleksandrov static void br_ip6_multicast_leave_group(struct net_bridge_mcast *brmctx, 70adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 71bc8c20acSSatish Ashok const struct in6_addr *group, 726db6f0eaSFelix Fietkau __u16 vid, const unsigned char *src); 73bc8c20acSSatish Ashok #endif 74b0812368SNikolay Aleksandrov static struct net_bridge_port_group * 75adc47037SNikolay Aleksandrov __br_multicast_add_group(struct net_bridge_mcast *brmctx, 76adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 77b0812368SNikolay Aleksandrov struct br_ip *group, 78b0812368SNikolay Aleksandrov const unsigned char *src, 79b0812368SNikolay Aleksandrov u8 filter_mode, 809116ffbfSNikolay Aleksandrov bool igmpv2_mldv1, 819116ffbfSNikolay Aleksandrov bool blocked); 828266a049SNikolay Aleksandrov static void br_multicast_find_del_pg(struct net_bridge *br, 838266a049SNikolay Aleksandrov struct net_bridge_port_group *pg); 84613d61dbSNikolay Aleksandrov static void __br_multicast_stop(struct net_bridge_mcast *brmctx); 85c83b8fabSHerbert Xu 86c832962aSOleksandr Mazur static int br_mc_disabled_update(struct net_device *dev, bool value, 87c832962aSOleksandr Mazur struct netlink_ext_ack *extack); 88c832962aSOleksandr Mazur 89085b53c8SNikolay Aleksandrov static struct net_bridge_port_group * 90085b53c8SNikolay Aleksandrov br_sg_port_find(struct net_bridge *br, 91085b53c8SNikolay Aleksandrov struct net_bridge_port_group_sg_key *sg_p) 92085b53c8SNikolay Aleksandrov { 93085b53c8SNikolay Aleksandrov lockdep_assert_held_once(&br->multicast_lock); 94085b53c8SNikolay Aleksandrov 95085b53c8SNikolay Aleksandrov return rhashtable_lookup_fast(&br->sg_port_tbl, sg_p, 96085b53c8SNikolay Aleksandrov br_sg_port_rht_params); 97085b53c8SNikolay Aleksandrov } 98085b53c8SNikolay Aleksandrov 9919e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip_get_rcu(struct net_bridge *br, 100cfd56754SCong Wang struct br_ip *dst) 1017f285fa7SHerbert Xu { 10219e3a9c9SNikolay Aleksandrov return rhashtable_lookup(&br->mdb_hash_tbl, dst, br_mdb_rht_params); 1037f285fa7SHerbert Xu } 1047f285fa7SHerbert Xu 10519e3a9c9SNikolay Aleksandrov struct net_bridge_mdb_entry *br_mdb_ip_get(struct net_bridge *br, 10619e3a9c9SNikolay Aleksandrov struct br_ip *dst) 10719e3a9c9SNikolay Aleksandrov { 10819e3a9c9SNikolay Aleksandrov struct net_bridge_mdb_entry *ent; 10919e3a9c9SNikolay Aleksandrov 11019e3a9c9SNikolay Aleksandrov lockdep_assert_held_once(&br->multicast_lock); 11119e3a9c9SNikolay Aleksandrov 11219e3a9c9SNikolay Aleksandrov rcu_read_lock(); 11319e3a9c9SNikolay Aleksandrov ent = rhashtable_lookup(&br->mdb_hash_tbl, dst, br_mdb_rht_params); 11419e3a9c9SNikolay Aleksandrov rcu_read_unlock(); 11519e3a9c9SNikolay Aleksandrov 11619e3a9c9SNikolay Aleksandrov return ent; 11719e3a9c9SNikolay Aleksandrov } 11819e3a9c9SNikolay Aleksandrov 11919e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip4_get(struct net_bridge *br, 12019e3a9c9SNikolay Aleksandrov __be32 dst, __u16 vid) 121eb1d1641SHerbert Xu { 1228ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_dst; 1230821ec55SHerbert Xu 12419e3a9c9SNikolay Aleksandrov memset(&br_dst, 0, sizeof(br_dst)); 125eab3227bSNikolay Aleksandrov br_dst.dst.ip4 = dst; 1268ef2a9a5SYOSHIFUJI Hideaki br_dst.proto = htons(ETH_P_IP); 127b0e9a30dSVlad Yasevich br_dst.vid = vid; 1288ef2a9a5SYOSHIFUJI Hideaki 12919e3a9c9SNikolay Aleksandrov return br_mdb_ip_get(br, &br_dst); 1308ef2a9a5SYOSHIFUJI Hideaki } 1318ef2a9a5SYOSHIFUJI Hideaki 132dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 13319e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip6_get(struct net_bridge *br, 13419e3a9c9SNikolay Aleksandrov const struct in6_addr *dst, 135b0e9a30dSVlad Yasevich __u16 vid) 13608b202b6SYOSHIFUJI Hideaki { 13708b202b6SYOSHIFUJI Hideaki struct br_ip br_dst; 13808b202b6SYOSHIFUJI Hideaki 13919e3a9c9SNikolay Aleksandrov memset(&br_dst, 0, sizeof(br_dst)); 140eab3227bSNikolay Aleksandrov br_dst.dst.ip6 = *dst; 14108b202b6SYOSHIFUJI Hideaki br_dst.proto = htons(ETH_P_IPV6); 142b0e9a30dSVlad Yasevich br_dst.vid = vid; 14308b202b6SYOSHIFUJI Hideaki 14419e3a9c9SNikolay Aleksandrov return br_mdb_ip_get(br, &br_dst); 14508b202b6SYOSHIFUJI Hideaki } 14608b202b6SYOSHIFUJI Hideaki #endif 14708b202b6SYOSHIFUJI Hideaki 148adc47037SNikolay Aleksandrov struct net_bridge_mdb_entry *br_mdb_get(struct net_bridge_mcast *brmctx, 149fbca58a2SCong Wang struct sk_buff *skb, u16 vid) 150eb1d1641SHerbert Xu { 151adc47037SNikolay Aleksandrov struct net_bridge *br = brmctx->br; 1528ef2a9a5SYOSHIFUJI Hideaki struct br_ip ip; 1538ef2a9a5SYOSHIFUJI Hideaki 1544cdd0d10SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED) || 1554cdd0d10SNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(brmctx)) 156eb1d1641SHerbert Xu return NULL; 157eb1d1641SHerbert Xu 1588ef2a9a5SYOSHIFUJI Hideaki if (BR_INPUT_SKB_CB(skb)->igmp) 1598ef2a9a5SYOSHIFUJI Hideaki return NULL; 1608ef2a9a5SYOSHIFUJI Hideaki 16119e3a9c9SNikolay Aleksandrov memset(&ip, 0, sizeof(ip)); 1628ef2a9a5SYOSHIFUJI Hideaki ip.proto = skb->protocol; 163fbca58a2SCong Wang ip.vid = vid; 1648ef2a9a5SYOSHIFUJI Hideaki 165eb1d1641SHerbert Xu switch (skb->protocol) { 166eb1d1641SHerbert Xu case htons(ETH_P_IP): 167eab3227bSNikolay Aleksandrov ip.dst.ip4 = ip_hdr(skb)->daddr; 168adc47037SNikolay Aleksandrov if (brmctx->multicast_igmp_version == 3) { 1697d07a68cSNikolay Aleksandrov struct net_bridge_mdb_entry *mdb; 1707d07a68cSNikolay Aleksandrov 1717d07a68cSNikolay Aleksandrov ip.src.ip4 = ip_hdr(skb)->saddr; 1727d07a68cSNikolay Aleksandrov mdb = br_mdb_ip_get_rcu(br, &ip); 1737d07a68cSNikolay Aleksandrov if (mdb) 1747d07a68cSNikolay Aleksandrov return mdb; 1757d07a68cSNikolay Aleksandrov ip.src.ip4 = 0; 1767d07a68cSNikolay Aleksandrov } 177eb1d1641SHerbert Xu break; 178dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 17908b202b6SYOSHIFUJI Hideaki case htons(ETH_P_IPV6): 180eab3227bSNikolay Aleksandrov ip.dst.ip6 = ipv6_hdr(skb)->daddr; 181adc47037SNikolay Aleksandrov if (brmctx->multicast_mld_version == 2) { 1827d07a68cSNikolay Aleksandrov struct net_bridge_mdb_entry *mdb; 1837d07a68cSNikolay Aleksandrov 1847d07a68cSNikolay Aleksandrov ip.src.ip6 = ipv6_hdr(skb)->saddr; 1857d07a68cSNikolay Aleksandrov mdb = br_mdb_ip_get_rcu(br, &ip); 1867d07a68cSNikolay Aleksandrov if (mdb) 1877d07a68cSNikolay Aleksandrov return mdb; 1887d07a68cSNikolay Aleksandrov memset(&ip.src.ip6, 0, sizeof(ip.src.ip6)); 1897d07a68cSNikolay Aleksandrov } 19008b202b6SYOSHIFUJI Hideaki break; 19108b202b6SYOSHIFUJI Hideaki #endif 1928ef2a9a5SYOSHIFUJI Hideaki default: 193955062b0SNikolay Aleksandrov ip.proto = 0; 194955062b0SNikolay Aleksandrov ether_addr_copy(ip.dst.mac_addr, eth_hdr(skb)->h_dest); 195eb1d1641SHerbert Xu } 196eb1d1641SHerbert Xu 19719e3a9c9SNikolay Aleksandrov return br_mdb_ip_get_rcu(br, &ip); 198eb1d1641SHerbert Xu } 199eb1d1641SHerbert Xu 20074edfd48SNikolay Aleksandrov /* IMPORTANT: this function must be used only when the contexts cannot be 20174edfd48SNikolay Aleksandrov * passed down (e.g. timer) and must be used for read-only purposes because 20274edfd48SNikolay Aleksandrov * the vlan snooping option can change, so it can return any context 20374edfd48SNikolay Aleksandrov * (non-vlan or vlan). Its initial intended purpose is to read timer values 20474edfd48SNikolay Aleksandrov * from the *current* context based on the option. At worst that could lead 20574edfd48SNikolay Aleksandrov * to inconsistent timers when the contexts are changed, i.e. src timer 20674edfd48SNikolay Aleksandrov * which needs to re-arm with a specific delay taken from the old context 20774edfd48SNikolay Aleksandrov */ 20874edfd48SNikolay Aleksandrov static struct net_bridge_mcast_port * 20974edfd48SNikolay Aleksandrov br_multicast_pg_to_port_ctx(const struct net_bridge_port_group *pg) 21074edfd48SNikolay Aleksandrov { 21174edfd48SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = &pg->key.port->multicast_ctx; 21274edfd48SNikolay Aleksandrov struct net_bridge_vlan *vlan; 21374edfd48SNikolay Aleksandrov 21474edfd48SNikolay Aleksandrov lockdep_assert_held_once(&pg->key.port->br->multicast_lock); 21574edfd48SNikolay Aleksandrov 21674edfd48SNikolay Aleksandrov /* if vlan snooping is disabled use the port's multicast context */ 21774edfd48SNikolay Aleksandrov if (!pg->key.addr.vid || 21874edfd48SNikolay Aleksandrov !br_opt_get(pg->key.port->br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) 21974edfd48SNikolay Aleksandrov goto out; 22074edfd48SNikolay Aleksandrov 22174edfd48SNikolay Aleksandrov /* locking is tricky here, due to different rules for multicast and 22274edfd48SNikolay Aleksandrov * vlans we need to take rcu to find the vlan and make sure it has 22374edfd48SNikolay Aleksandrov * the BR_VLFLAG_MCAST_ENABLED flag set, it can only change under 22474edfd48SNikolay Aleksandrov * multicast_lock which must be already held here, so the vlan's pmctx 22574edfd48SNikolay Aleksandrov * can safely be used on return 22674edfd48SNikolay Aleksandrov */ 22774edfd48SNikolay Aleksandrov rcu_read_lock(); 2283f0d14efSNikolay Aleksandrov vlan = br_vlan_find(nbp_vlan_group_rcu(pg->key.port), pg->key.addr.vid); 22974edfd48SNikolay Aleksandrov if (vlan && !br_multicast_port_ctx_vlan_disabled(&vlan->port_mcast_ctx)) 23074edfd48SNikolay Aleksandrov pmctx = &vlan->port_mcast_ctx; 23174edfd48SNikolay Aleksandrov else 23274edfd48SNikolay Aleksandrov pmctx = NULL; 23374edfd48SNikolay Aleksandrov rcu_read_unlock(); 23474edfd48SNikolay Aleksandrov out: 23574edfd48SNikolay Aleksandrov return pmctx; 23674edfd48SNikolay Aleksandrov } 23774edfd48SNikolay Aleksandrov 238*b57e8d87SPetr Machata static struct net_bridge_mcast_port * 239*b57e8d87SPetr Machata br_multicast_port_vid_to_port_ctx(struct net_bridge_port *port, u16 vid) 240*b57e8d87SPetr Machata { 241*b57e8d87SPetr Machata struct net_bridge_mcast_port *pmctx = NULL; 242*b57e8d87SPetr Machata struct net_bridge_vlan *vlan; 243*b57e8d87SPetr Machata 244*b57e8d87SPetr Machata lockdep_assert_held_once(&port->br->multicast_lock); 245*b57e8d87SPetr Machata 246*b57e8d87SPetr Machata if (!br_opt_get(port->br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) 247*b57e8d87SPetr Machata return NULL; 248*b57e8d87SPetr Machata 249*b57e8d87SPetr Machata /* Take RCU to access the vlan. */ 250*b57e8d87SPetr Machata rcu_read_lock(); 251*b57e8d87SPetr Machata 252*b57e8d87SPetr Machata vlan = br_vlan_find(nbp_vlan_group_rcu(port), vid); 253*b57e8d87SPetr Machata if (vlan && !br_multicast_port_ctx_vlan_disabled(&vlan->port_mcast_ctx)) 254*b57e8d87SPetr Machata pmctx = &vlan->port_mcast_ctx; 255*b57e8d87SPetr Machata 256*b57e8d87SPetr Machata rcu_read_unlock(); 257*b57e8d87SPetr Machata 258*b57e8d87SPetr Machata return pmctx; 259*b57e8d87SPetr Machata } 260*b57e8d87SPetr Machata 2614cdd0d10SNikolay Aleksandrov /* when snooping we need to check if the contexts should be used 2624cdd0d10SNikolay Aleksandrov * in the following order: 2634cdd0d10SNikolay Aleksandrov * - if pmctx is non-NULL (port), check if it should be used 2644cdd0d10SNikolay Aleksandrov * - if pmctx is NULL (bridge), check if brmctx should be used 2654cdd0d10SNikolay Aleksandrov */ 2664cdd0d10SNikolay Aleksandrov static bool 2674cdd0d10SNikolay Aleksandrov br_multicast_ctx_should_use(const struct net_bridge_mcast *brmctx, 2684cdd0d10SNikolay Aleksandrov const struct net_bridge_mcast_port *pmctx) 2694cdd0d10SNikolay Aleksandrov { 2704cdd0d10SNikolay Aleksandrov if (!netif_running(brmctx->br->dev)) 2714cdd0d10SNikolay Aleksandrov return false; 2724cdd0d10SNikolay Aleksandrov 2734cdd0d10SNikolay Aleksandrov if (pmctx) 2744cdd0d10SNikolay Aleksandrov return !br_multicast_port_ctx_state_disabled(pmctx); 2754cdd0d10SNikolay Aleksandrov else 2764cdd0d10SNikolay Aleksandrov return !br_multicast_ctx_vlan_disabled(brmctx); 2774cdd0d10SNikolay Aleksandrov } 2784cdd0d10SNikolay Aleksandrov 279b0812368SNikolay Aleksandrov static bool br_port_group_equal(struct net_bridge_port_group *p, 280b0812368SNikolay Aleksandrov struct net_bridge_port *port, 281b0812368SNikolay Aleksandrov const unsigned char *src) 282b0812368SNikolay Aleksandrov { 283b0812368SNikolay Aleksandrov if (p->key.port != port) 284b0812368SNikolay Aleksandrov return false; 285b0812368SNikolay Aleksandrov 286b0812368SNikolay Aleksandrov if (!(port->flags & BR_MULTICAST_TO_UNICAST)) 287b0812368SNikolay Aleksandrov return true; 288b0812368SNikolay Aleksandrov 289b0812368SNikolay Aleksandrov return ether_addr_equal(src, p->eth_addr); 290b0812368SNikolay Aleksandrov } 291b0812368SNikolay Aleksandrov 292adc47037SNikolay Aleksandrov static void __fwd_add_star_excl(struct net_bridge_mcast_port *pmctx, 293adc47037SNikolay Aleksandrov 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_port_group *src_pg; 298adc47037SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 2998266a049SNikolay Aleksandrov 3008266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 3017b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 3028266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 3038266a049SNikolay Aleksandrov sg_key.addr = *sg_ip; 304adc47037SNikolay Aleksandrov if (br_sg_port_find(brmctx->br, &sg_key)) 3058266a049SNikolay Aleksandrov return; 3068266a049SNikolay Aleksandrov 307adc47037SNikolay Aleksandrov src_pg = __br_multicast_add_group(brmctx, pmctx, 308adc47037SNikolay Aleksandrov sg_ip, pg->eth_addr, 3099116ffbfSNikolay Aleksandrov MCAST_INCLUDE, false, false); 3108266a049SNikolay Aleksandrov if (IS_ERR_OR_NULL(src_pg) || 3118266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 3128266a049SNikolay Aleksandrov return; 3138266a049SNikolay Aleksandrov 3148266a049SNikolay Aleksandrov src_pg->flags |= MDB_PG_FLAGS_STAR_EXCL; 3158266a049SNikolay Aleksandrov } 3168266a049SNikolay Aleksandrov 3178266a049SNikolay Aleksandrov static void __fwd_del_star_excl(struct net_bridge_port_group *pg, 3188266a049SNikolay Aleksandrov struct br_ip *sg_ip) 3198266a049SNikolay Aleksandrov { 3208266a049SNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 3218266a049SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 3228266a049SNikolay Aleksandrov struct net_bridge_port_group *src_pg; 3238266a049SNikolay Aleksandrov 3248266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 3258266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 3268266a049SNikolay Aleksandrov sg_key.addr = *sg_ip; 3278266a049SNikolay Aleksandrov src_pg = br_sg_port_find(br, &sg_key); 3288266a049SNikolay Aleksandrov if (!src_pg || !(src_pg->flags & MDB_PG_FLAGS_STAR_EXCL) || 3298266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 3308266a049SNikolay Aleksandrov return; 3318266a049SNikolay Aleksandrov 3328266a049SNikolay Aleksandrov br_multicast_find_del_pg(br, src_pg); 3338266a049SNikolay Aleksandrov } 3348266a049SNikolay Aleksandrov 3358266a049SNikolay Aleksandrov /* When a port group transitions to (or is added as) EXCLUDE we need to add it 3368266a049SNikolay Aleksandrov * to all other ports' S,G entries which are not blocked by the current group 3378266a049SNikolay Aleksandrov * for proper replication, the assumption is that any S,G blocked entries 3388266a049SNikolay Aleksandrov * are already added so the S,G,port lookup should skip them. 3398266a049SNikolay Aleksandrov * When a port group transitions from EXCLUDE -> INCLUDE mode or is being 3408266a049SNikolay Aleksandrov * deleted we need to remove it from all ports' S,G entries where it was 3418266a049SNikolay Aleksandrov * automatically installed before (i.e. where it's MDB_PG_FLAGS_STAR_EXCL). 3428266a049SNikolay Aleksandrov */ 3438266a049SNikolay Aleksandrov void br_multicast_star_g_handle_mode(struct net_bridge_port_group *pg, 3448266a049SNikolay Aleksandrov u8 filter_mode) 3458266a049SNikolay Aleksandrov { 3468266a049SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 3478266a049SNikolay Aleksandrov struct net_bridge_port_group *pg_lst; 348adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 3498266a049SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 3508266a049SNikolay Aleksandrov struct br_ip sg_ip; 3518266a049SNikolay Aleksandrov 3528266a049SNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&pg->key.addr))) 3538266a049SNikolay Aleksandrov return; 3548266a049SNikolay Aleksandrov 3558266a049SNikolay Aleksandrov mp = br_mdb_ip_get(br, &pg->key.addr); 3568266a049SNikolay Aleksandrov if (!mp) 3578266a049SNikolay Aleksandrov return; 358eb1593a0SNikolay Aleksandrov pmctx = br_multicast_pg_to_port_ctx(pg); 359eb1593a0SNikolay Aleksandrov if (!pmctx) 360eb1593a0SNikolay Aleksandrov return; 3618266a049SNikolay Aleksandrov 3628266a049SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 3638266a049SNikolay Aleksandrov sg_ip = pg->key.addr; 3647b54aaafSNikolay Aleksandrov 3658266a049SNikolay Aleksandrov for (pg_lst = mlock_dereference(mp->ports, br); 3668266a049SNikolay Aleksandrov pg_lst; 3678266a049SNikolay Aleksandrov pg_lst = mlock_dereference(pg_lst->next, br)) { 3688266a049SNikolay Aleksandrov struct net_bridge_group_src *src_ent; 3698266a049SNikolay Aleksandrov 3708266a049SNikolay Aleksandrov if (pg_lst == pg) 3718266a049SNikolay Aleksandrov continue; 3728266a049SNikolay Aleksandrov hlist_for_each_entry(src_ent, &pg_lst->src_list, node) { 3738266a049SNikolay Aleksandrov if (!(src_ent->flags & BR_SGRP_F_INSTALLED)) 3748266a049SNikolay Aleksandrov continue; 3758266a049SNikolay Aleksandrov sg_ip.src = src_ent->addr.src; 3768266a049SNikolay Aleksandrov switch (filter_mode) { 3778266a049SNikolay Aleksandrov case MCAST_INCLUDE: 3788266a049SNikolay Aleksandrov __fwd_del_star_excl(pg, &sg_ip); 3798266a049SNikolay Aleksandrov break; 3808266a049SNikolay Aleksandrov case MCAST_EXCLUDE: 381adc47037SNikolay Aleksandrov __fwd_add_star_excl(pmctx, pg, &sg_ip); 3828266a049SNikolay Aleksandrov break; 3838266a049SNikolay Aleksandrov } 3848266a049SNikolay Aleksandrov } 3858266a049SNikolay Aleksandrov } 3868266a049SNikolay Aleksandrov } 3878266a049SNikolay Aleksandrov 388094b82fdSNikolay Aleksandrov /* called when adding a new S,G with host_joined == false by default */ 389094b82fdSNikolay Aleksandrov static void br_multicast_sg_host_state(struct net_bridge_mdb_entry *star_mp, 390094b82fdSNikolay Aleksandrov struct net_bridge_port_group *sg) 391094b82fdSNikolay Aleksandrov { 392094b82fdSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 393094b82fdSNikolay Aleksandrov 394094b82fdSNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 395094b82fdSNikolay Aleksandrov return; 396094b82fdSNikolay Aleksandrov if (!star_mp->host_joined) 397094b82fdSNikolay Aleksandrov return; 398094b82fdSNikolay Aleksandrov 399094b82fdSNikolay Aleksandrov sg_mp = br_mdb_ip_get(star_mp->br, &sg->key.addr); 400094b82fdSNikolay Aleksandrov if (!sg_mp) 401094b82fdSNikolay Aleksandrov return; 402094b82fdSNikolay Aleksandrov sg_mp->host_joined = true; 403094b82fdSNikolay Aleksandrov } 404094b82fdSNikolay Aleksandrov 405094b82fdSNikolay Aleksandrov /* set the host_joined state of all of *,G's S,G entries */ 406094b82fdSNikolay Aleksandrov static void br_multicast_star_g_host_state(struct net_bridge_mdb_entry *star_mp) 407094b82fdSNikolay Aleksandrov { 408094b82fdSNikolay Aleksandrov struct net_bridge *br = star_mp->br; 409094b82fdSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 410094b82fdSNikolay Aleksandrov struct net_bridge_port_group *pg; 411094b82fdSNikolay Aleksandrov struct br_ip sg_ip; 412094b82fdSNikolay Aleksandrov 413094b82fdSNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 414094b82fdSNikolay Aleksandrov return; 415094b82fdSNikolay Aleksandrov 416094b82fdSNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 417094b82fdSNikolay Aleksandrov sg_ip = star_mp->addr; 418094b82fdSNikolay Aleksandrov for (pg = mlock_dereference(star_mp->ports, br); 419094b82fdSNikolay Aleksandrov pg; 420094b82fdSNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) { 421094b82fdSNikolay Aleksandrov struct net_bridge_group_src *src_ent; 422094b82fdSNikolay Aleksandrov 423094b82fdSNikolay Aleksandrov hlist_for_each_entry(src_ent, &pg->src_list, node) { 424094b82fdSNikolay Aleksandrov if (!(src_ent->flags & BR_SGRP_F_INSTALLED)) 425094b82fdSNikolay Aleksandrov continue; 426094b82fdSNikolay Aleksandrov sg_ip.src = src_ent->addr.src; 427094b82fdSNikolay Aleksandrov sg_mp = br_mdb_ip_get(br, &sg_ip); 428094b82fdSNikolay Aleksandrov if (!sg_mp) 429094b82fdSNikolay Aleksandrov continue; 430094b82fdSNikolay Aleksandrov sg_mp->host_joined = star_mp->host_joined; 431094b82fdSNikolay Aleksandrov } 432094b82fdSNikolay Aleksandrov } 433094b82fdSNikolay Aleksandrov } 434094b82fdSNikolay Aleksandrov 4358266a049SNikolay Aleksandrov static void br_multicast_sg_del_exclude_ports(struct net_bridge_mdb_entry *sgmp) 4368266a049SNikolay Aleksandrov { 4378266a049SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 4388266a049SNikolay Aleksandrov struct net_bridge_port_group *p; 4398266a049SNikolay Aleksandrov 4408266a049SNikolay Aleksandrov /* *,G exclude ports are only added to S,G entries */ 4418266a049SNikolay Aleksandrov if (WARN_ON(br_multicast_is_star_g(&sgmp->addr))) 4428266a049SNikolay Aleksandrov return; 4438266a049SNikolay Aleksandrov 4448266a049SNikolay Aleksandrov /* we need the STAR_EXCLUDE ports if there are non-STAR_EXCLUDE ports 4458266a049SNikolay Aleksandrov * we should ignore perm entries since they're managed by user-space 4468266a049SNikolay Aleksandrov */ 4478266a049SNikolay Aleksandrov for (pp = &sgmp->ports; 4488266a049SNikolay Aleksandrov (p = mlock_dereference(*pp, sgmp->br)) != NULL; 4498266a049SNikolay Aleksandrov pp = &p->next) 4508266a049SNikolay Aleksandrov if (!(p->flags & (MDB_PG_FLAGS_STAR_EXCL | 4518266a049SNikolay Aleksandrov MDB_PG_FLAGS_PERMANENT))) 4528266a049SNikolay Aleksandrov return; 4538266a049SNikolay Aleksandrov 454094b82fdSNikolay Aleksandrov /* currently the host can only have joined the *,G which means 455094b82fdSNikolay Aleksandrov * we treat it as EXCLUDE {}, so for an S,G it's considered a 456094b82fdSNikolay Aleksandrov * STAR_EXCLUDE entry and we can safely leave it 457094b82fdSNikolay Aleksandrov */ 458094b82fdSNikolay Aleksandrov sgmp->host_joined = false; 459094b82fdSNikolay Aleksandrov 4608266a049SNikolay Aleksandrov for (pp = &sgmp->ports; 4618266a049SNikolay Aleksandrov (p = mlock_dereference(*pp, sgmp->br)) != NULL;) { 4628266a049SNikolay Aleksandrov if (!(p->flags & MDB_PG_FLAGS_PERMANENT)) 4638266a049SNikolay Aleksandrov br_multicast_del_pg(sgmp, p, pp); 4648266a049SNikolay Aleksandrov else 4658266a049SNikolay Aleksandrov pp = &p->next; 4668266a049SNikolay Aleksandrov } 4678266a049SNikolay Aleksandrov } 4688266a049SNikolay Aleksandrov 4698266a049SNikolay Aleksandrov void br_multicast_sg_add_exclude_ports(struct net_bridge_mdb_entry *star_mp, 4708266a049SNikolay Aleksandrov struct net_bridge_port_group *sg) 4718266a049SNikolay Aleksandrov { 4728266a049SNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 4738266a049SNikolay Aleksandrov struct net_bridge *br = star_mp->br; 474adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 4758266a049SNikolay Aleksandrov struct net_bridge_port_group *pg; 476adc47037SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 4778266a049SNikolay Aleksandrov 4788266a049SNikolay Aleksandrov if (WARN_ON(br_multicast_is_star_g(&sg->key.addr))) 4798266a049SNikolay Aleksandrov return; 4808266a049SNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 4818266a049SNikolay Aleksandrov return; 4828266a049SNikolay Aleksandrov 483094b82fdSNikolay Aleksandrov br_multicast_sg_host_state(star_mp, sg); 4848266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 4858266a049SNikolay Aleksandrov sg_key.addr = sg->key.addr; 4868266a049SNikolay Aleksandrov /* we need to add all exclude ports to the S,G */ 4878266a049SNikolay Aleksandrov for (pg = mlock_dereference(star_mp->ports, br); 4888266a049SNikolay Aleksandrov pg; 4898266a049SNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) { 4908266a049SNikolay Aleksandrov struct net_bridge_port_group *src_pg; 4918266a049SNikolay Aleksandrov 4928266a049SNikolay Aleksandrov if (pg == sg || pg->filter_mode == MCAST_INCLUDE) 4938266a049SNikolay Aleksandrov continue; 4948266a049SNikolay Aleksandrov 4958266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 4968266a049SNikolay Aleksandrov if (br_sg_port_find(br, &sg_key)) 4978266a049SNikolay Aleksandrov continue; 4988266a049SNikolay Aleksandrov 499eb1593a0SNikolay Aleksandrov pmctx = br_multicast_pg_to_port_ctx(pg); 500eb1593a0SNikolay Aleksandrov if (!pmctx) 501eb1593a0SNikolay Aleksandrov continue; 502eb1593a0SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 503eb1593a0SNikolay Aleksandrov 504adc47037SNikolay Aleksandrov src_pg = __br_multicast_add_group(brmctx, pmctx, 5058266a049SNikolay Aleksandrov &sg->key.addr, 5068266a049SNikolay Aleksandrov sg->eth_addr, 5079116ffbfSNikolay Aleksandrov MCAST_INCLUDE, false, false); 5088266a049SNikolay Aleksandrov if (IS_ERR_OR_NULL(src_pg) || 5098266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 5108266a049SNikolay Aleksandrov continue; 5118266a049SNikolay Aleksandrov src_pg->flags |= MDB_PG_FLAGS_STAR_EXCL; 5128266a049SNikolay Aleksandrov } 5138266a049SNikolay Aleksandrov } 5148266a049SNikolay Aleksandrov 515b0812368SNikolay Aleksandrov static void br_multicast_fwd_src_add(struct net_bridge_group_src *src) 516b0812368SNikolay Aleksandrov { 5178266a049SNikolay Aleksandrov struct net_bridge_mdb_entry *star_mp; 518adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 519b0812368SNikolay Aleksandrov struct net_bridge_port_group *sg; 520adc47037SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 521b0812368SNikolay Aleksandrov struct br_ip sg_ip; 522b0812368SNikolay Aleksandrov 523b0812368SNikolay Aleksandrov if (src->flags & BR_SGRP_F_INSTALLED) 524b0812368SNikolay Aleksandrov return; 525b0812368SNikolay Aleksandrov 526b0812368SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 527eb1593a0SNikolay Aleksandrov pmctx = br_multicast_pg_to_port_ctx(src->pg); 528eb1593a0SNikolay Aleksandrov if (!pmctx) 529eb1593a0SNikolay Aleksandrov return; 5307b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 531b0812368SNikolay Aleksandrov sg_ip = src->pg->key.addr; 532b0812368SNikolay Aleksandrov sg_ip.src = src->addr.src; 533adc47037SNikolay Aleksandrov 534adc47037SNikolay Aleksandrov sg = __br_multicast_add_group(brmctx, pmctx, &sg_ip, 5359116ffbfSNikolay Aleksandrov src->pg->eth_addr, MCAST_INCLUDE, false, 5369116ffbfSNikolay Aleksandrov !timer_pending(&src->timer)); 537b0812368SNikolay Aleksandrov if (IS_ERR_OR_NULL(sg)) 538b0812368SNikolay Aleksandrov return; 539b0812368SNikolay Aleksandrov src->flags |= BR_SGRP_F_INSTALLED; 5408266a049SNikolay Aleksandrov sg->flags &= ~MDB_PG_FLAGS_STAR_EXCL; 541b0812368SNikolay Aleksandrov 542b0812368SNikolay Aleksandrov /* if it was added by user-space as perm we can skip next steps */ 543b0812368SNikolay Aleksandrov if (sg->rt_protocol != RTPROT_KERNEL && 544b0812368SNikolay Aleksandrov (sg->flags & MDB_PG_FLAGS_PERMANENT)) 545b0812368SNikolay Aleksandrov return; 546b0812368SNikolay Aleksandrov 547b0812368SNikolay Aleksandrov /* the kernel is now responsible for removing this S,G */ 548b0812368SNikolay Aleksandrov del_timer(&sg->timer); 5498266a049SNikolay Aleksandrov star_mp = br_mdb_ip_get(src->br, &src->pg->key.addr); 5508266a049SNikolay Aleksandrov if (!star_mp) 5518266a049SNikolay Aleksandrov return; 5528266a049SNikolay Aleksandrov 5538266a049SNikolay Aleksandrov br_multicast_sg_add_exclude_ports(star_mp, sg); 554b0812368SNikolay Aleksandrov } 555b0812368SNikolay Aleksandrov 556d5a10222SNikolay Aleksandrov static void br_multicast_fwd_src_remove(struct net_bridge_group_src *src, 557d5a10222SNikolay Aleksandrov bool fastleave) 558b0812368SNikolay Aleksandrov { 559b0812368SNikolay Aleksandrov struct net_bridge_port_group *p, *pg = src->pg; 560b0812368SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 561b0812368SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 562b0812368SNikolay Aleksandrov struct br_ip sg_ip; 563b0812368SNikolay Aleksandrov 564b0812368SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 565b0812368SNikolay Aleksandrov sg_ip = pg->key.addr; 566b0812368SNikolay Aleksandrov sg_ip.src = src->addr.src; 567b0812368SNikolay Aleksandrov 568b0812368SNikolay Aleksandrov mp = br_mdb_ip_get(src->br, &sg_ip); 569b0812368SNikolay Aleksandrov if (!mp) 570b0812368SNikolay Aleksandrov return; 571b0812368SNikolay Aleksandrov 572b0812368SNikolay Aleksandrov for (pp = &mp->ports; 573b0812368SNikolay Aleksandrov (p = mlock_dereference(*pp, src->br)) != NULL; 574b0812368SNikolay Aleksandrov pp = &p->next) { 575b0812368SNikolay Aleksandrov if (!br_port_group_equal(p, pg->key.port, pg->eth_addr)) 576b0812368SNikolay Aleksandrov continue; 577b0812368SNikolay Aleksandrov 578b0812368SNikolay Aleksandrov if (p->rt_protocol != RTPROT_KERNEL && 579a01ecb17SIdo Schimmel (p->flags & MDB_PG_FLAGS_PERMANENT) && 580a01ecb17SIdo Schimmel !(src->flags & BR_SGRP_F_USER_ADDED)) 581b0812368SNikolay Aleksandrov break; 582b0812368SNikolay Aleksandrov 583d5a10222SNikolay Aleksandrov if (fastleave) 584d5a10222SNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_FAST_LEAVE; 585b0812368SNikolay Aleksandrov br_multicast_del_pg(mp, p, pp); 586b0812368SNikolay Aleksandrov break; 587b0812368SNikolay Aleksandrov } 588b0812368SNikolay Aleksandrov src->flags &= ~BR_SGRP_F_INSTALLED; 589b0812368SNikolay Aleksandrov } 590b0812368SNikolay Aleksandrov 5919116ffbfSNikolay Aleksandrov /* install S,G and based on src's timer enable or disable forwarding */ 592b0812368SNikolay Aleksandrov static void br_multicast_fwd_src_handle(struct net_bridge_group_src *src) 593b0812368SNikolay Aleksandrov { 5949116ffbfSNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 5959116ffbfSNikolay Aleksandrov struct net_bridge_port_group *sg; 5969116ffbfSNikolay Aleksandrov u8 old_flags; 5979116ffbfSNikolay Aleksandrov 598b0812368SNikolay Aleksandrov br_multicast_fwd_src_add(src); 5999116ffbfSNikolay Aleksandrov 6009116ffbfSNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 6019116ffbfSNikolay Aleksandrov sg_key.addr = src->pg->key.addr; 6029116ffbfSNikolay Aleksandrov sg_key.addr.src = src->addr.src; 6039116ffbfSNikolay Aleksandrov sg_key.port = src->pg->key.port; 6049116ffbfSNikolay Aleksandrov 6059116ffbfSNikolay Aleksandrov sg = br_sg_port_find(src->br, &sg_key); 6069116ffbfSNikolay Aleksandrov if (!sg || (sg->flags & MDB_PG_FLAGS_PERMANENT)) 6079116ffbfSNikolay Aleksandrov return; 6089116ffbfSNikolay Aleksandrov 6099116ffbfSNikolay Aleksandrov old_flags = sg->flags; 6109116ffbfSNikolay Aleksandrov if (timer_pending(&src->timer)) 6119116ffbfSNikolay Aleksandrov sg->flags &= ~MDB_PG_FLAGS_BLOCKED; 6129116ffbfSNikolay Aleksandrov else 6139116ffbfSNikolay Aleksandrov sg->flags |= MDB_PG_FLAGS_BLOCKED; 6149116ffbfSNikolay Aleksandrov 6159116ffbfSNikolay Aleksandrov if (old_flags != sg->flags) { 6169116ffbfSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 6179116ffbfSNikolay Aleksandrov 6189116ffbfSNikolay Aleksandrov sg_mp = br_mdb_ip_get(src->br, &sg_key.addr); 6199116ffbfSNikolay Aleksandrov if (!sg_mp) 6209116ffbfSNikolay Aleksandrov return; 6219116ffbfSNikolay Aleksandrov br_mdb_notify(src->br->dev, sg_mp, sg, RTM_NEWMDB); 6229116ffbfSNikolay Aleksandrov } 623b0812368SNikolay Aleksandrov } 624b0812368SNikolay Aleksandrov 625e12cec65SNikolay Aleksandrov static void br_multicast_destroy_mdb_entry(struct net_bridge_mcast_gc *gc) 626e12cec65SNikolay Aleksandrov { 627e12cec65SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 628e12cec65SNikolay Aleksandrov 629e12cec65SNikolay Aleksandrov mp = container_of(gc, struct net_bridge_mdb_entry, mcast_gc); 630e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&mp->mdb_node)); 631e12cec65SNikolay Aleksandrov WARN_ON(mp->ports); 632e12cec65SNikolay Aleksandrov 633292a089dSSteven Rostedt (Google) timer_shutdown_sync(&mp->timer); 634e12cec65SNikolay Aleksandrov kfree_rcu(mp, rcu); 635e12cec65SNikolay Aleksandrov } 636e12cec65SNikolay Aleksandrov 637e12cec65SNikolay Aleksandrov static void br_multicast_del_mdb_entry(struct net_bridge_mdb_entry *mp) 638e12cec65SNikolay Aleksandrov { 639e12cec65SNikolay Aleksandrov struct net_bridge *br = mp->br; 640e12cec65SNikolay Aleksandrov 641e12cec65SNikolay Aleksandrov rhashtable_remove_fast(&br->mdb_hash_tbl, &mp->rhnode, 642e12cec65SNikolay Aleksandrov br_mdb_rht_params); 643e12cec65SNikolay Aleksandrov hlist_del_init_rcu(&mp->mdb_node); 644e12cec65SNikolay Aleksandrov hlist_add_head(&mp->mcast_gc.gc_node, &br->mcast_gc_list); 645e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 646e12cec65SNikolay Aleksandrov } 647e12cec65SNikolay Aleksandrov 64888c1f37fSAllen Pais static void br_multicast_group_expired(struct timer_list *t) 649eb1d1641SHerbert Xu { 65088c1f37fSAllen Pais struct net_bridge_mdb_entry *mp = from_timer(mp, t, timer); 651eb1d1641SHerbert Xu struct net_bridge *br = mp->br; 652eb1d1641SHerbert Xu 653eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 654b0812368SNikolay Aleksandrov if (hlist_unhashed(&mp->mdb_node) || !netif_running(br->dev) || 655b0812368SNikolay Aleksandrov timer_pending(&mp->timer)) 656eb1d1641SHerbert Xu goto out; 657eb1d1641SHerbert Xu 6581bc844eeSNikolay Aleksandrov br_multicast_host_leave(mp, true); 659eb1d1641SHerbert Xu 660eb1d1641SHerbert Xu if (mp->ports) 661eb1d1641SHerbert Xu goto out; 662e12cec65SNikolay Aleksandrov br_multicast_del_mdb_entry(mp); 663eb1d1641SHerbert Xu out: 664eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 665eb1d1641SHerbert Xu } 666eb1d1641SHerbert Xu 667e12cec65SNikolay Aleksandrov static void br_multicast_destroy_group_src(struct net_bridge_mcast_gc *gc) 668e12cec65SNikolay Aleksandrov { 669e12cec65SNikolay Aleksandrov struct net_bridge_group_src *src; 670e12cec65SNikolay Aleksandrov 671e12cec65SNikolay Aleksandrov src = container_of(gc, struct net_bridge_group_src, mcast_gc); 672e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&src->node)); 673e12cec65SNikolay Aleksandrov 674292a089dSSteven Rostedt (Google) timer_shutdown_sync(&src->timer); 675e12cec65SNikolay Aleksandrov kfree_rcu(src, rcu); 676e12cec65SNikolay Aleksandrov } 677e12cec65SNikolay Aleksandrov 678083e3534SIdo Schimmel void __br_multicast_del_group_src(struct net_bridge_group_src *src) 6798b671779SNikolay Aleksandrov { 680085b53c8SNikolay Aleksandrov struct net_bridge *br = src->pg->key.port->br; 6818b671779SNikolay Aleksandrov 6828b671779SNikolay Aleksandrov hlist_del_init_rcu(&src->node); 6838b671779SNikolay Aleksandrov src->pg->src_ents--; 684e12cec65SNikolay Aleksandrov hlist_add_head(&src->mcast_gc.gc_node, &br->mcast_gc_list); 685e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 686e12cec65SNikolay Aleksandrov } 687e12cec65SNikolay Aleksandrov 688083e3534SIdo Schimmel void br_multicast_del_group_src(struct net_bridge_group_src *src, 689083e3534SIdo Schimmel bool fastleave) 690083e3534SIdo Schimmel { 691083e3534SIdo Schimmel br_multicast_fwd_src_remove(src, fastleave); 692083e3534SIdo Schimmel __br_multicast_del_group_src(src); 693083e3534SIdo Schimmel } 694083e3534SIdo Schimmel 695*b57e8d87SPetr Machata static int 696*b57e8d87SPetr Machata br_multicast_port_ngroups_inc_one(struct net_bridge_mcast_port *pmctx, 697*b57e8d87SPetr Machata struct netlink_ext_ack *extack, 698*b57e8d87SPetr Machata const char *what) 699*b57e8d87SPetr Machata { 700*b57e8d87SPetr Machata u32 max = READ_ONCE(pmctx->mdb_max_entries); 701*b57e8d87SPetr Machata u32 n = READ_ONCE(pmctx->mdb_n_entries); 702*b57e8d87SPetr Machata 703*b57e8d87SPetr Machata if (max && n >= max) { 704*b57e8d87SPetr Machata NL_SET_ERR_MSG_FMT_MOD(extack, "%s is already in %u groups, and mcast_max_groups=%u", 705*b57e8d87SPetr Machata what, n, max); 706*b57e8d87SPetr Machata return -E2BIG; 707*b57e8d87SPetr Machata } 708*b57e8d87SPetr Machata 709*b57e8d87SPetr Machata WRITE_ONCE(pmctx->mdb_n_entries, n + 1); 710*b57e8d87SPetr Machata return 0; 711*b57e8d87SPetr Machata } 712*b57e8d87SPetr Machata 713*b57e8d87SPetr Machata static void br_multicast_port_ngroups_dec_one(struct net_bridge_mcast_port *pmctx) 714*b57e8d87SPetr Machata { 715*b57e8d87SPetr Machata u32 n = READ_ONCE(pmctx->mdb_n_entries); 716*b57e8d87SPetr Machata 717*b57e8d87SPetr Machata WARN_ON_ONCE(n == 0); 718*b57e8d87SPetr Machata WRITE_ONCE(pmctx->mdb_n_entries, n - 1); 719*b57e8d87SPetr Machata } 720*b57e8d87SPetr Machata 721*b57e8d87SPetr Machata static int br_multicast_port_ngroups_inc(struct net_bridge_port *port, 722*b57e8d87SPetr Machata const struct br_ip *group, 723*b57e8d87SPetr Machata struct netlink_ext_ack *extack) 724*b57e8d87SPetr Machata { 725*b57e8d87SPetr Machata struct net_bridge_mcast_port *pmctx; 726*b57e8d87SPetr Machata int err; 727*b57e8d87SPetr Machata 728*b57e8d87SPetr Machata lockdep_assert_held_once(&port->br->multicast_lock); 729*b57e8d87SPetr Machata 730*b57e8d87SPetr Machata /* Always count on the port context. */ 731*b57e8d87SPetr Machata err = br_multicast_port_ngroups_inc_one(&port->multicast_ctx, extack, 732*b57e8d87SPetr Machata "Port"); 733*b57e8d87SPetr Machata if (err) { 734*b57e8d87SPetr Machata trace_br_mdb_full(port->dev, group); 735*b57e8d87SPetr Machata return err; 736*b57e8d87SPetr Machata } 737*b57e8d87SPetr Machata 738*b57e8d87SPetr Machata /* Only count on the VLAN context if VID is given, and if snooping on 739*b57e8d87SPetr Machata * that VLAN is enabled. 740*b57e8d87SPetr Machata */ 741*b57e8d87SPetr Machata if (!group->vid) 742*b57e8d87SPetr Machata return 0; 743*b57e8d87SPetr Machata 744*b57e8d87SPetr Machata pmctx = br_multicast_port_vid_to_port_ctx(port, group->vid); 745*b57e8d87SPetr Machata if (!pmctx) 746*b57e8d87SPetr Machata return 0; 747*b57e8d87SPetr Machata 748*b57e8d87SPetr Machata err = br_multicast_port_ngroups_inc_one(pmctx, extack, "Port-VLAN"); 749*b57e8d87SPetr Machata if (err) { 750*b57e8d87SPetr Machata trace_br_mdb_full(port->dev, group); 751*b57e8d87SPetr Machata goto dec_one_out; 752*b57e8d87SPetr Machata } 753*b57e8d87SPetr Machata 754*b57e8d87SPetr Machata return 0; 755*b57e8d87SPetr Machata 756*b57e8d87SPetr Machata dec_one_out: 757*b57e8d87SPetr Machata br_multicast_port_ngroups_dec_one(&port->multicast_ctx); 758*b57e8d87SPetr Machata return err; 759*b57e8d87SPetr Machata } 760*b57e8d87SPetr Machata 761*b57e8d87SPetr Machata static void br_multicast_port_ngroups_dec(struct net_bridge_port *port, u16 vid) 762*b57e8d87SPetr Machata { 763*b57e8d87SPetr Machata struct net_bridge_mcast_port *pmctx; 764*b57e8d87SPetr Machata 765*b57e8d87SPetr Machata lockdep_assert_held_once(&port->br->multicast_lock); 766*b57e8d87SPetr Machata 767*b57e8d87SPetr Machata if (vid) { 768*b57e8d87SPetr Machata pmctx = br_multicast_port_vid_to_port_ctx(port, vid); 769*b57e8d87SPetr Machata if (pmctx) 770*b57e8d87SPetr Machata br_multicast_port_ngroups_dec_one(pmctx); 771*b57e8d87SPetr Machata } 772*b57e8d87SPetr Machata br_multicast_port_ngroups_dec_one(&port->multicast_ctx); 773*b57e8d87SPetr Machata } 774*b57e8d87SPetr Machata 775e12cec65SNikolay Aleksandrov static void br_multicast_destroy_port_group(struct net_bridge_mcast_gc *gc) 776e12cec65SNikolay Aleksandrov { 777e12cec65SNikolay Aleksandrov struct net_bridge_port_group *pg; 778e12cec65SNikolay Aleksandrov 779e12cec65SNikolay Aleksandrov pg = container_of(gc, struct net_bridge_port_group, mcast_gc); 780e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&pg->mglist)); 781e12cec65SNikolay Aleksandrov WARN_ON(!hlist_empty(&pg->src_list)); 782e12cec65SNikolay Aleksandrov 783292a089dSSteven Rostedt (Google) timer_shutdown_sync(&pg->rexmit_timer); 784292a089dSSteven Rostedt (Google) timer_shutdown_sync(&pg->timer); 785e12cec65SNikolay Aleksandrov kfree_rcu(pg, rcu); 7868b671779SNikolay Aleksandrov } 7878b671779SNikolay Aleksandrov 788681590bdSNikolay Aleksandrov void br_multicast_del_pg(struct net_bridge_mdb_entry *mp, 789681590bdSNikolay Aleksandrov struct net_bridge_port_group *pg, 790681590bdSNikolay Aleksandrov struct net_bridge_port_group __rcu **pp) 791681590bdSNikolay Aleksandrov { 792085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 7938b671779SNikolay Aleksandrov struct net_bridge_group_src *ent; 7948b671779SNikolay Aleksandrov struct hlist_node *tmp; 795681590bdSNikolay Aleksandrov 796681590bdSNikolay Aleksandrov rcu_assign_pointer(*pp, pg->next); 797681590bdSNikolay Aleksandrov hlist_del_init(&pg->mglist); 798baa74d39SNikolay Aleksandrov br_multicast_eht_clean_sets(pg); 7998b671779SNikolay Aleksandrov hlist_for_each_entry_safe(ent, tmp, &pg->src_list, node) 800d5a10222SNikolay Aleksandrov br_multicast_del_group_src(ent, false); 80181f19838SNikolay Aleksandrov br_mdb_notify(br->dev, mp, pg, RTM_DELMDB); 80274705582SNikolay Aleksandrov if (!br_multicast_is_star_g(&mp->addr)) { 80374705582SNikolay Aleksandrov rhashtable_remove_fast(&br->sg_port_tbl, &pg->rhnode, 80474705582SNikolay Aleksandrov br_sg_port_rht_params); 8058266a049SNikolay Aleksandrov br_multicast_sg_del_exclude_ports(mp); 80674705582SNikolay Aleksandrov } else { 8078266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_INCLUDE); 80874705582SNikolay Aleksandrov } 809*b57e8d87SPetr Machata br_multicast_port_ngroups_dec(pg->key.port, pg->key.addr.vid); 810e12cec65SNikolay Aleksandrov hlist_add_head(&pg->mcast_gc.gc_node, &br->mcast_gc_list); 811e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 812681590bdSNikolay Aleksandrov 813681590bdSNikolay Aleksandrov if (!mp->ports && !mp->host_joined && netif_running(br->dev)) 814681590bdSNikolay Aleksandrov mod_timer(&mp->timer, jiffies); 815681590bdSNikolay Aleksandrov } 816681590bdSNikolay Aleksandrov 817681590bdSNikolay Aleksandrov static void br_multicast_find_del_pg(struct net_bridge *br, 818eb1d1641SHerbert Xu struct net_bridge_port_group *pg) 819eb1d1641SHerbert Xu { 8208b671779SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 821eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 822eb1d1641SHerbert Xu struct net_bridge_port_group *p; 823e8051688SEric Dumazet 824085b53c8SNikolay Aleksandrov mp = br_mdb_ip_get(br, &pg->key.addr); 825eb1d1641SHerbert Xu if (WARN_ON(!mp)) 826eb1d1641SHerbert Xu return; 827eb1d1641SHerbert Xu 828e8051688SEric Dumazet for (pp = &mp->ports; 829e8051688SEric Dumazet (p = mlock_dereference(*pp, br)) != NULL; 830e8051688SEric Dumazet pp = &p->next) { 831eb1d1641SHerbert Xu if (p != pg) 832eb1d1641SHerbert Xu continue; 833eb1d1641SHerbert Xu 834681590bdSNikolay Aleksandrov br_multicast_del_pg(mp, pg, pp); 835eb1d1641SHerbert Xu return; 836eb1d1641SHerbert Xu } 837eb1d1641SHerbert Xu 838eb1d1641SHerbert Xu WARN_ON(1); 839eb1d1641SHerbert Xu } 840eb1d1641SHerbert Xu 84188c1f37fSAllen Pais static void br_multicast_port_group_expired(struct timer_list *t) 842eb1d1641SHerbert Xu { 84388c1f37fSAllen Pais struct net_bridge_port_group *pg = from_timer(pg, t, timer); 844d6c33d67SNikolay Aleksandrov struct net_bridge_group_src *src_ent; 845085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 846d6c33d67SNikolay Aleksandrov struct hlist_node *tmp; 847d6c33d67SNikolay Aleksandrov bool changed; 848eb1d1641SHerbert Xu 849eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 850eb1d1641SHerbert Xu if (!netif_running(br->dev) || timer_pending(&pg->timer) || 8519d06b6d8SElad Raz hlist_unhashed(&pg->mglist) || pg->flags & MDB_PG_FLAGS_PERMANENT) 852eb1d1641SHerbert Xu goto out; 853eb1d1641SHerbert Xu 854d6c33d67SNikolay Aleksandrov changed = !!(pg->filter_mode == MCAST_EXCLUDE); 855d6c33d67SNikolay Aleksandrov pg->filter_mode = MCAST_INCLUDE; 856d6c33d67SNikolay Aleksandrov hlist_for_each_entry_safe(src_ent, tmp, &pg->src_list, node) { 857d6c33d67SNikolay Aleksandrov if (!timer_pending(&src_ent->timer)) { 858d5a10222SNikolay Aleksandrov br_multicast_del_group_src(src_ent, false); 859d6c33d67SNikolay Aleksandrov changed = true; 860d6c33d67SNikolay Aleksandrov } 861d6c33d67SNikolay Aleksandrov } 862eb1d1641SHerbert Xu 863d6c33d67SNikolay Aleksandrov if (hlist_empty(&pg->src_list)) { 864d6c33d67SNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 865d6c33d67SNikolay Aleksandrov } else if (changed) { 866085b53c8SNikolay Aleksandrov struct net_bridge_mdb_entry *mp = br_mdb_ip_get(br, &pg->key.addr); 867d6c33d67SNikolay Aleksandrov 8688266a049SNikolay Aleksandrov if (changed && br_multicast_is_star_g(&pg->key.addr)) 8698266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_INCLUDE); 8708266a049SNikolay Aleksandrov 871d6c33d67SNikolay Aleksandrov if (WARN_ON(!mp)) 872d6c33d67SNikolay Aleksandrov goto out; 873d6c33d67SNikolay Aleksandrov br_mdb_notify(br->dev, mp, pg, RTM_NEWMDB); 874d6c33d67SNikolay Aleksandrov } 875eb1d1641SHerbert Xu out: 876eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 877eb1d1641SHerbert Xu } 878eb1d1641SHerbert Xu 879e12cec65SNikolay Aleksandrov static void br_multicast_gc(struct hlist_head *head) 880e12cec65SNikolay Aleksandrov { 881e12cec65SNikolay Aleksandrov struct net_bridge_mcast_gc *gcent; 882e12cec65SNikolay Aleksandrov struct hlist_node *tmp; 883e12cec65SNikolay Aleksandrov 884e12cec65SNikolay Aleksandrov hlist_for_each_entry_safe(gcent, tmp, head, gc_node) { 885e12cec65SNikolay Aleksandrov hlist_del_init(&gcent->gc_node); 886e12cec65SNikolay Aleksandrov gcent->destroy(gcent); 887e12cec65SNikolay Aleksandrov } 888e12cec65SNikolay Aleksandrov } 889e12cec65SNikolay Aleksandrov 890615cc23eSNikolay Aleksandrov static void __br_multicast_query_handle_vlan(struct net_bridge_mcast *brmctx, 891615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 892615cc23eSNikolay Aleksandrov struct sk_buff *skb) 893615cc23eSNikolay Aleksandrov { 894615cc23eSNikolay Aleksandrov struct net_bridge_vlan *vlan = NULL; 895615cc23eSNikolay Aleksandrov 896615cc23eSNikolay Aleksandrov if (pmctx && br_multicast_port_ctx_is_vlan(pmctx)) 897615cc23eSNikolay Aleksandrov vlan = pmctx->vlan; 898615cc23eSNikolay Aleksandrov else if (br_multicast_ctx_is_vlan(brmctx)) 899615cc23eSNikolay Aleksandrov vlan = brmctx->vlan; 900615cc23eSNikolay Aleksandrov 901615cc23eSNikolay Aleksandrov if (vlan && !(vlan->flags & BRIDGE_VLAN_INFO_UNTAGGED)) { 902615cc23eSNikolay Aleksandrov u16 vlan_proto; 903615cc23eSNikolay Aleksandrov 904615cc23eSNikolay Aleksandrov if (br_vlan_get_proto(brmctx->br->dev, &vlan_proto) != 0) 905615cc23eSNikolay Aleksandrov return; 906615cc23eSNikolay Aleksandrov __vlan_hwaccel_put_tag(skb, htons(vlan_proto), vlan->vid); 907615cc23eSNikolay Aleksandrov } 908615cc23eSNikolay Aleksandrov } 909615cc23eSNikolay Aleksandrov 910adc47037SNikolay Aleksandrov static struct sk_buff *br_ip4_multicast_alloc_query(struct net_bridge_mcast *brmctx, 911615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 912438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 913438ef2d0SNikolay Aleksandrov __be32 ip_dst, __be32 group, 914438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_lmqt, 91542c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 91642c11ccfSNikolay Aleksandrov bool *need_rexmit) 917eb1d1641SHerbert Xu { 918085b53c8SNikolay Aleksandrov struct net_bridge_port *p = pg ? pg->key.port : NULL; 919438ef2d0SNikolay Aleksandrov struct net_bridge_group_src *ent; 920438ef2d0SNikolay Aleksandrov size_t pkt_size, igmp_hdr_size; 921438ef2d0SNikolay Aleksandrov unsigned long now = jiffies; 9225e923585SNikolay Aleksandrov struct igmpv3_query *ihv3; 923438ef2d0SNikolay Aleksandrov void *csum_start = NULL; 924438ef2d0SNikolay Aleksandrov __sum16 *csum = NULL; 925eb1d1641SHerbert Xu struct sk_buff *skb; 926eb1d1641SHerbert Xu struct igmphdr *ih; 927eb1d1641SHerbert Xu struct ethhdr *eth; 928438ef2d0SNikolay Aleksandrov unsigned long lmqt; 929eb1d1641SHerbert Xu struct iphdr *iph; 930438ef2d0SNikolay Aleksandrov u16 lmqt_srcs = 0; 931eb1d1641SHerbert Xu 9325e923585SNikolay Aleksandrov igmp_hdr_size = sizeof(*ih); 933d3d065c0SNikolay Aleksandrov if (brmctx->multicast_igmp_version == 3) { 9345e923585SNikolay Aleksandrov igmp_hdr_size = sizeof(*ihv3); 935438ef2d0SNikolay Aleksandrov if (pg && with_srcs) { 936d3d065c0SNikolay Aleksandrov lmqt = now + (brmctx->multicast_last_member_interval * 937d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_count); 938438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 939438ef2d0SNikolay Aleksandrov if (over_lmqt == time_after(ent->timer.expires, 940438ef2d0SNikolay Aleksandrov lmqt) && 941438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) 942438ef2d0SNikolay Aleksandrov lmqt_srcs++; 943438ef2d0SNikolay Aleksandrov } 944438ef2d0SNikolay Aleksandrov 945438ef2d0SNikolay Aleksandrov if (!lmqt_srcs) 946438ef2d0SNikolay Aleksandrov return NULL; 947438ef2d0SNikolay Aleksandrov igmp_hdr_size += lmqt_srcs * sizeof(__be32); 948438ef2d0SNikolay Aleksandrov } 949438ef2d0SNikolay Aleksandrov } 950438ef2d0SNikolay Aleksandrov 951438ef2d0SNikolay Aleksandrov pkt_size = sizeof(*eth) + sizeof(*iph) + 4 + igmp_hdr_size; 952438ef2d0SNikolay Aleksandrov if ((p && pkt_size > p->dev->mtu) || 953adc47037SNikolay Aleksandrov pkt_size > brmctx->br->dev->mtu) 954438ef2d0SNikolay Aleksandrov return NULL; 955438ef2d0SNikolay Aleksandrov 956adc47037SNikolay Aleksandrov skb = netdev_alloc_skb_ip_align(brmctx->br->dev, pkt_size); 957eb1d1641SHerbert Xu if (!skb) 958eb1d1641SHerbert Xu goto out; 959eb1d1641SHerbert Xu 960615cc23eSNikolay Aleksandrov __br_multicast_query_handle_vlan(brmctx, pmctx, skb); 961eb1d1641SHerbert Xu skb->protocol = htons(ETH_P_IP); 962eb1d1641SHerbert Xu 963eb1d1641SHerbert Xu skb_reset_mac_header(skb); 964eb1d1641SHerbert Xu eth = eth_hdr(skb); 965eb1d1641SHerbert Xu 966adc47037SNikolay Aleksandrov ether_addr_copy(eth->h_source, brmctx->br->dev->dev_addr); 967438ef2d0SNikolay Aleksandrov ip_eth_mc_map(ip_dst, eth->h_dest); 968eb1d1641SHerbert Xu eth->h_proto = htons(ETH_P_IP); 969eb1d1641SHerbert Xu skb_put(skb, sizeof(*eth)); 970eb1d1641SHerbert Xu 971eb1d1641SHerbert Xu skb_set_network_header(skb, skb->len); 972eb1d1641SHerbert Xu iph = ip_hdr(skb); 973438ef2d0SNikolay Aleksandrov iph->tot_len = htons(pkt_size - sizeof(*eth)); 974eb1d1641SHerbert Xu 975eb1d1641SHerbert Xu iph->version = 4; 976eb1d1641SHerbert Xu iph->ihl = 6; 977eb1d1641SHerbert Xu iph->tos = 0xc0; 978eb1d1641SHerbert Xu iph->id = 0; 979eb1d1641SHerbert Xu iph->frag_off = htons(IP_DF); 980eb1d1641SHerbert Xu iph->ttl = 1; 981eb1d1641SHerbert Xu iph->protocol = IPPROTO_IGMP; 982adc47037SNikolay Aleksandrov iph->saddr = br_opt_get(brmctx->br, BROPT_MULTICAST_QUERY_USE_IFADDR) ? 983adc47037SNikolay Aleksandrov inet_select_addr(brmctx->br->dev, 0, RT_SCOPE_LINK) : 0; 984438ef2d0SNikolay Aleksandrov iph->daddr = ip_dst; 985eb1d1641SHerbert Xu ((u8 *)&iph[1])[0] = IPOPT_RA; 986eb1d1641SHerbert Xu ((u8 *)&iph[1])[1] = 4; 987eb1d1641SHerbert Xu ((u8 *)&iph[1])[2] = 0; 988eb1d1641SHerbert Xu ((u8 *)&iph[1])[3] = 0; 989eb1d1641SHerbert Xu ip_send_check(iph); 990eb1d1641SHerbert Xu skb_put(skb, 24); 991eb1d1641SHerbert Xu 992eb1d1641SHerbert Xu skb_set_transport_header(skb, skb->len); 9931080ab95SNikolay Aleksandrov *igmp_type = IGMP_HOST_MEMBERSHIP_QUERY; 9945e923585SNikolay Aleksandrov 995d3d065c0SNikolay Aleksandrov switch (brmctx->multicast_igmp_version) { 9965e923585SNikolay Aleksandrov case 2: 9975e923585SNikolay Aleksandrov ih = igmp_hdr(skb); 998eb1d1641SHerbert Xu ih->type = IGMP_HOST_MEMBERSHIP_QUERY; 999d3d065c0SNikolay Aleksandrov ih->code = (group ? brmctx->multicast_last_member_interval : 1000d3d065c0SNikolay Aleksandrov brmctx->multicast_query_response_interval) / 1001eb1d1641SHerbert Xu (HZ / IGMP_TIMER_SCALE); 1002eb1d1641SHerbert Xu ih->group = group; 1003eb1d1641SHerbert Xu ih->csum = 0; 1004438ef2d0SNikolay Aleksandrov csum = &ih->csum; 1005438ef2d0SNikolay Aleksandrov csum_start = (void *)ih; 10065e923585SNikolay Aleksandrov break; 10075e923585SNikolay Aleksandrov case 3: 10085e923585SNikolay Aleksandrov ihv3 = igmpv3_query_hdr(skb); 10095e923585SNikolay Aleksandrov ihv3->type = IGMP_HOST_MEMBERSHIP_QUERY; 1010d3d065c0SNikolay Aleksandrov ihv3->code = (group ? brmctx->multicast_last_member_interval : 1011d3d065c0SNikolay Aleksandrov brmctx->multicast_query_response_interval) / 10125e923585SNikolay Aleksandrov (HZ / IGMP_TIMER_SCALE); 10135e923585SNikolay Aleksandrov ihv3->group = group; 1014d3d065c0SNikolay Aleksandrov ihv3->qqic = brmctx->multicast_query_interval / HZ; 1015438ef2d0SNikolay Aleksandrov ihv3->nsrcs = htons(lmqt_srcs); 10165e923585SNikolay Aleksandrov ihv3->resv = 0; 1017438ef2d0SNikolay Aleksandrov ihv3->suppress = sflag; 10185e923585SNikolay Aleksandrov ihv3->qrv = 2; 10195e923585SNikolay Aleksandrov ihv3->csum = 0; 1020438ef2d0SNikolay Aleksandrov csum = &ihv3->csum; 1021438ef2d0SNikolay Aleksandrov csum_start = (void *)ihv3; 1022438ef2d0SNikolay Aleksandrov if (!pg || !with_srcs) 1023438ef2d0SNikolay Aleksandrov break; 1024438ef2d0SNikolay Aleksandrov 1025438ef2d0SNikolay Aleksandrov lmqt_srcs = 0; 1026438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 1027438ef2d0SNikolay Aleksandrov if (over_lmqt == time_after(ent->timer.expires, 1028438ef2d0SNikolay Aleksandrov lmqt) && 1029438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) { 1030deb96566SNikolay Aleksandrov ihv3->srcs[lmqt_srcs++] = ent->addr.src.ip4; 1031438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt--; 103242c11ccfSNikolay Aleksandrov if (need_rexmit && ent->src_query_rexmit_cnt) 103342c11ccfSNikolay Aleksandrov *need_rexmit = true; 1034438ef2d0SNikolay Aleksandrov } 1035438ef2d0SNikolay Aleksandrov } 1036438ef2d0SNikolay Aleksandrov if (WARN_ON(lmqt_srcs != ntohs(ihv3->nsrcs))) { 1037438ef2d0SNikolay Aleksandrov kfree_skb(skb); 1038438ef2d0SNikolay Aleksandrov return NULL; 1039438ef2d0SNikolay Aleksandrov } 10405e923585SNikolay Aleksandrov break; 10415e923585SNikolay Aleksandrov } 1042eb1d1641SHerbert Xu 1043438ef2d0SNikolay Aleksandrov if (WARN_ON(!csum || !csum_start)) { 1044438ef2d0SNikolay Aleksandrov kfree_skb(skb); 1045438ef2d0SNikolay Aleksandrov return NULL; 1046438ef2d0SNikolay Aleksandrov } 1047438ef2d0SNikolay Aleksandrov 1048438ef2d0SNikolay Aleksandrov *csum = ip_compute_csum(csum_start, igmp_hdr_size); 10495e923585SNikolay Aleksandrov skb_put(skb, igmp_hdr_size); 1050eb1d1641SHerbert Xu __skb_pull(skb, sizeof(*eth)); 1051eb1d1641SHerbert Xu 1052eb1d1641SHerbert Xu out: 1053eb1d1641SHerbert Xu return skb; 1054eb1d1641SHerbert Xu } 1055eb1d1641SHerbert Xu 1056dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1057adc47037SNikolay Aleksandrov static struct sk_buff *br_ip6_multicast_alloc_query(struct net_bridge_mcast *brmctx, 1058615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1059438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 1060438ef2d0SNikolay Aleksandrov const struct in6_addr *ip6_dst, 1061438ef2d0SNikolay Aleksandrov const struct in6_addr *group, 1062438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_llqt, 106342c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 106442c11ccfSNikolay Aleksandrov bool *need_rexmit) 106508b202b6SYOSHIFUJI Hideaki { 1066085b53c8SNikolay Aleksandrov struct net_bridge_port *p = pg ? pg->key.port : NULL; 1067438ef2d0SNikolay Aleksandrov struct net_bridge_group_src *ent; 1068438ef2d0SNikolay Aleksandrov size_t pkt_size, mld_hdr_size; 1069438ef2d0SNikolay Aleksandrov unsigned long now = jiffies; 1070aa2ae3e7SNikolay Aleksandrov struct mld2_query *mld2q; 1071438ef2d0SNikolay Aleksandrov void *csum_start = NULL; 1072aa2ae3e7SNikolay Aleksandrov unsigned long interval; 1073438ef2d0SNikolay Aleksandrov __sum16 *csum = NULL; 107408b202b6SYOSHIFUJI Hideaki struct ipv6hdr *ip6h; 107508b202b6SYOSHIFUJI Hideaki struct mld_msg *mldq; 1076aa2ae3e7SNikolay Aleksandrov struct sk_buff *skb; 1077438ef2d0SNikolay Aleksandrov unsigned long llqt; 107808b202b6SYOSHIFUJI Hideaki struct ethhdr *eth; 1079438ef2d0SNikolay Aleksandrov u16 llqt_srcs = 0; 108008b202b6SYOSHIFUJI Hideaki u8 *hopopt; 108108b202b6SYOSHIFUJI Hideaki 1082aa2ae3e7SNikolay Aleksandrov mld_hdr_size = sizeof(*mldq); 1083d3d065c0SNikolay Aleksandrov if (brmctx->multicast_mld_version == 2) { 1084aa2ae3e7SNikolay Aleksandrov mld_hdr_size = sizeof(*mld2q); 1085438ef2d0SNikolay Aleksandrov if (pg && with_srcs) { 1086d3d065c0SNikolay Aleksandrov llqt = now + (brmctx->multicast_last_member_interval * 1087d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_count); 1088438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 1089438ef2d0SNikolay Aleksandrov if (over_llqt == time_after(ent->timer.expires, 1090438ef2d0SNikolay Aleksandrov llqt) && 1091438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) 1092438ef2d0SNikolay Aleksandrov llqt_srcs++; 1093438ef2d0SNikolay Aleksandrov } 1094438ef2d0SNikolay Aleksandrov 1095438ef2d0SNikolay Aleksandrov if (!llqt_srcs) 1096438ef2d0SNikolay Aleksandrov return NULL; 1097438ef2d0SNikolay Aleksandrov mld_hdr_size += llqt_srcs * sizeof(struct in6_addr); 1098438ef2d0SNikolay Aleksandrov } 1099438ef2d0SNikolay Aleksandrov } 1100438ef2d0SNikolay Aleksandrov 1101438ef2d0SNikolay Aleksandrov pkt_size = sizeof(*eth) + sizeof(*ip6h) + 8 + mld_hdr_size; 1102438ef2d0SNikolay Aleksandrov if ((p && pkt_size > p->dev->mtu) || 1103adc47037SNikolay Aleksandrov pkt_size > brmctx->br->dev->mtu) 1104438ef2d0SNikolay Aleksandrov return NULL; 1105438ef2d0SNikolay Aleksandrov 1106adc47037SNikolay Aleksandrov skb = netdev_alloc_skb_ip_align(brmctx->br->dev, pkt_size); 110708b202b6SYOSHIFUJI Hideaki if (!skb) 110808b202b6SYOSHIFUJI Hideaki goto out; 110908b202b6SYOSHIFUJI Hideaki 1110615cc23eSNikolay Aleksandrov __br_multicast_query_handle_vlan(brmctx, pmctx, skb); 111108b202b6SYOSHIFUJI Hideaki skb->protocol = htons(ETH_P_IPV6); 111208b202b6SYOSHIFUJI Hideaki 111308b202b6SYOSHIFUJI Hideaki /* Ethernet header */ 111408b202b6SYOSHIFUJI Hideaki skb_reset_mac_header(skb); 111508b202b6SYOSHIFUJI Hideaki eth = eth_hdr(skb); 111608b202b6SYOSHIFUJI Hideaki 1117adc47037SNikolay Aleksandrov ether_addr_copy(eth->h_source, brmctx->br->dev->dev_addr); 111808b202b6SYOSHIFUJI Hideaki eth->h_proto = htons(ETH_P_IPV6); 111908b202b6SYOSHIFUJI Hideaki skb_put(skb, sizeof(*eth)); 112008b202b6SYOSHIFUJI Hideaki 112108b202b6SYOSHIFUJI Hideaki /* IPv6 header + HbH option */ 112208b202b6SYOSHIFUJI Hideaki skb_set_network_header(skb, skb->len); 112308b202b6SYOSHIFUJI Hideaki ip6h = ipv6_hdr(skb); 112408b202b6SYOSHIFUJI Hideaki 112508b202b6SYOSHIFUJI Hideaki *(__force __be32 *)ip6h = htonl(0x60000000); 1126aa2ae3e7SNikolay Aleksandrov ip6h->payload_len = htons(8 + mld_hdr_size); 112708b202b6SYOSHIFUJI Hideaki ip6h->nexthdr = IPPROTO_HOPOPTS; 112808b202b6SYOSHIFUJI Hideaki ip6h->hop_limit = 1; 1129438ef2d0SNikolay Aleksandrov ip6h->daddr = *ip6_dst; 1130adc47037SNikolay Aleksandrov if (ipv6_dev_get_saddr(dev_net(brmctx->br->dev), brmctx->br->dev, 1131adc47037SNikolay Aleksandrov &ip6h->daddr, 0, &ip6h->saddr)) { 1132d1d81d4cSUlrich Weber kfree_skb(skb); 1133adc47037SNikolay Aleksandrov br_opt_toggle(brmctx->br, BROPT_HAS_IPV6_ADDR, false); 1134d1d81d4cSUlrich Weber return NULL; 1135d1d81d4cSUlrich Weber } 11360888d5f3Sdaniel 1137adc47037SNikolay Aleksandrov br_opt_toggle(brmctx->br, BROPT_HAS_IPV6_ADDR, true); 113836cff5a1SLinus Lüssing ipv6_eth_mc_map(&ip6h->daddr, eth->h_dest); 113908b202b6SYOSHIFUJI Hideaki 114008b202b6SYOSHIFUJI Hideaki hopopt = (u8 *)(ip6h + 1); 114108b202b6SYOSHIFUJI Hideaki hopopt[0] = IPPROTO_ICMPV6; /* next hdr */ 114208b202b6SYOSHIFUJI Hideaki hopopt[1] = 0; /* length of HbH */ 114308b202b6SYOSHIFUJI Hideaki hopopt[2] = IPV6_TLV_ROUTERALERT; /* Router Alert */ 114408b202b6SYOSHIFUJI Hideaki hopopt[3] = 2; /* Length of RA Option */ 114508b202b6SYOSHIFUJI Hideaki hopopt[4] = 0; /* Type = 0x0000 (MLD) */ 114608b202b6SYOSHIFUJI Hideaki hopopt[5] = 0; 11471de5a71cSEldad Zack hopopt[6] = IPV6_TLV_PAD1; /* Pad1 */ 11481de5a71cSEldad Zack hopopt[7] = IPV6_TLV_PAD1; /* Pad1 */ 114908b202b6SYOSHIFUJI Hideaki 115008b202b6SYOSHIFUJI Hideaki skb_put(skb, sizeof(*ip6h) + 8); 115108b202b6SYOSHIFUJI Hideaki 115208b202b6SYOSHIFUJI Hideaki /* ICMPv6 */ 115308b202b6SYOSHIFUJI Hideaki skb_set_transport_header(skb, skb->len); 1154438ef2d0SNikolay Aleksandrov interval = ipv6_addr_any(group) ? 1155d3d065c0SNikolay Aleksandrov brmctx->multicast_query_response_interval : 1156d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval; 11571080ab95SNikolay Aleksandrov *igmp_type = ICMPV6_MGM_QUERY; 1158d3d065c0SNikolay Aleksandrov switch (brmctx->multicast_mld_version) { 1159aa2ae3e7SNikolay Aleksandrov case 1: 1160aa2ae3e7SNikolay Aleksandrov mldq = (struct mld_msg *)icmp6_hdr(skb); 116108b202b6SYOSHIFUJI Hideaki mldq->mld_type = ICMPV6_MGM_QUERY; 116208b202b6SYOSHIFUJI Hideaki mldq->mld_code = 0; 116308b202b6SYOSHIFUJI Hideaki mldq->mld_cksum = 0; 116408b202b6SYOSHIFUJI Hideaki mldq->mld_maxdelay = htons((u16)jiffies_to_msecs(interval)); 116508b202b6SYOSHIFUJI Hideaki mldq->mld_reserved = 0; 1166438ef2d0SNikolay Aleksandrov mldq->mld_mca = *group; 1167438ef2d0SNikolay Aleksandrov csum = &mldq->mld_cksum; 1168438ef2d0SNikolay Aleksandrov csum_start = (void *)mldq; 1169aa2ae3e7SNikolay Aleksandrov break; 1170aa2ae3e7SNikolay Aleksandrov case 2: 1171aa2ae3e7SNikolay Aleksandrov mld2q = (struct mld2_query *)icmp6_hdr(skb); 117253631a5fSLance Richardson mld2q->mld2q_mrc = htons((u16)jiffies_to_msecs(interval)); 1173aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_type = ICMPV6_MGM_QUERY; 1174aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_code = 0; 1175aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_cksum = 0; 1176aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_resv1 = 0; 1177aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_resv2 = 0; 1178438ef2d0SNikolay Aleksandrov mld2q->mld2q_suppress = sflag; 1179aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_qrv = 2; 1180438ef2d0SNikolay Aleksandrov mld2q->mld2q_nsrcs = htons(llqt_srcs); 1181d3d065c0SNikolay Aleksandrov mld2q->mld2q_qqic = brmctx->multicast_query_interval / HZ; 1182438ef2d0SNikolay Aleksandrov mld2q->mld2q_mca = *group; 1183438ef2d0SNikolay Aleksandrov csum = &mld2q->mld2q_cksum; 1184438ef2d0SNikolay Aleksandrov csum_start = (void *)mld2q; 1185438ef2d0SNikolay Aleksandrov if (!pg || !with_srcs) 1186438ef2d0SNikolay Aleksandrov break; 1187438ef2d0SNikolay Aleksandrov 1188438ef2d0SNikolay Aleksandrov llqt_srcs = 0; 1189438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 1190438ef2d0SNikolay Aleksandrov if (over_llqt == time_after(ent->timer.expires, 1191438ef2d0SNikolay Aleksandrov llqt) && 1192438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) { 1193deb96566SNikolay Aleksandrov mld2q->mld2q_srcs[llqt_srcs++] = ent->addr.src.ip6; 1194438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt--; 119542c11ccfSNikolay Aleksandrov if (need_rexmit && ent->src_query_rexmit_cnt) 119642c11ccfSNikolay Aleksandrov *need_rexmit = true; 1197438ef2d0SNikolay Aleksandrov } 1198438ef2d0SNikolay Aleksandrov } 1199438ef2d0SNikolay Aleksandrov if (WARN_ON(llqt_srcs != ntohs(mld2q->mld2q_nsrcs))) { 1200438ef2d0SNikolay Aleksandrov kfree_skb(skb); 1201438ef2d0SNikolay Aleksandrov return NULL; 1202438ef2d0SNikolay Aleksandrov } 1203aa2ae3e7SNikolay Aleksandrov break; 1204aa2ae3e7SNikolay Aleksandrov } 120508b202b6SYOSHIFUJI Hideaki 1206438ef2d0SNikolay Aleksandrov if (WARN_ON(!csum || !csum_start)) { 1207438ef2d0SNikolay Aleksandrov kfree_skb(skb); 1208438ef2d0SNikolay Aleksandrov return NULL; 1209438ef2d0SNikolay Aleksandrov } 1210438ef2d0SNikolay Aleksandrov 1211438ef2d0SNikolay Aleksandrov *csum = csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr, mld_hdr_size, 1212438ef2d0SNikolay Aleksandrov IPPROTO_ICMPV6, 1213438ef2d0SNikolay Aleksandrov csum_partial(csum_start, mld_hdr_size, 0)); 1214438ef2d0SNikolay Aleksandrov skb_put(skb, mld_hdr_size); 121508b202b6SYOSHIFUJI Hideaki __skb_pull(skb, sizeof(*eth)); 121608b202b6SYOSHIFUJI Hideaki 121708b202b6SYOSHIFUJI Hideaki out: 121808b202b6SYOSHIFUJI Hideaki return skb; 121908b202b6SYOSHIFUJI Hideaki } 122008b202b6SYOSHIFUJI Hideaki #endif 122108b202b6SYOSHIFUJI Hideaki 1222adc47037SNikolay Aleksandrov static struct sk_buff *br_multicast_alloc_query(struct net_bridge_mcast *brmctx, 1223615cc23eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1224438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 1225438ef2d0SNikolay Aleksandrov struct br_ip *ip_dst, 1226438ef2d0SNikolay Aleksandrov struct br_ip *group, 1227438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_lmqt, 122842c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 122942c11ccfSNikolay Aleksandrov bool *need_rexmit) 12308ef2a9a5SYOSHIFUJI Hideaki { 1231438ef2d0SNikolay Aleksandrov __be32 ip4_dst; 1232438ef2d0SNikolay Aleksandrov 1233438ef2d0SNikolay Aleksandrov switch (group->proto) { 12348ef2a9a5SYOSHIFUJI Hideaki case htons(ETH_P_IP): 1235eab3227bSNikolay Aleksandrov ip4_dst = ip_dst ? ip_dst->dst.ip4 : htonl(INADDR_ALLHOSTS_GROUP); 1236615cc23eSNikolay Aleksandrov return br_ip4_multicast_alloc_query(brmctx, pmctx, pg, 1237eab3227bSNikolay Aleksandrov ip4_dst, group->dst.ip4, 1238438ef2d0SNikolay Aleksandrov with_srcs, over_lmqt, 123942c11ccfSNikolay Aleksandrov sflag, igmp_type, 124042c11ccfSNikolay Aleksandrov need_rexmit); 1241dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1242438ef2d0SNikolay Aleksandrov case htons(ETH_P_IPV6): { 1243438ef2d0SNikolay Aleksandrov struct in6_addr ip6_dst; 1244438ef2d0SNikolay Aleksandrov 1245438ef2d0SNikolay Aleksandrov if (ip_dst) 1246eab3227bSNikolay Aleksandrov ip6_dst = ip_dst->dst.ip6; 1247438ef2d0SNikolay Aleksandrov else 1248438ef2d0SNikolay Aleksandrov ipv6_addr_set(&ip6_dst, htonl(0xff020000), 0, 0, 1249438ef2d0SNikolay Aleksandrov htonl(1)); 1250438ef2d0SNikolay Aleksandrov 1251615cc23eSNikolay Aleksandrov return br_ip6_multicast_alloc_query(brmctx, pmctx, pg, 1252eab3227bSNikolay Aleksandrov &ip6_dst, &group->dst.ip6, 1253438ef2d0SNikolay Aleksandrov with_srcs, over_lmqt, 125442c11ccfSNikolay Aleksandrov sflag, igmp_type, 125542c11ccfSNikolay Aleksandrov need_rexmit); 1256438ef2d0SNikolay Aleksandrov } 125708b202b6SYOSHIFUJI Hideaki #endif 12588ef2a9a5SYOSHIFUJI Hideaki } 12598ef2a9a5SYOSHIFUJI Hideaki return NULL; 12608ef2a9a5SYOSHIFUJI Hideaki } 12618ef2a9a5SYOSHIFUJI Hideaki 1262cfd56754SCong Wang struct net_bridge_mdb_entry *br_multicast_new_group(struct net_bridge *br, 12635e923585SNikolay Aleksandrov struct br_ip *group) 1264eb1d1641SHerbert Xu { 1265eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 12664c0833bcSTobias Klauser int err; 1267eb1d1641SHerbert Xu 126819e3a9c9SNikolay Aleksandrov mp = br_mdb_ip_get(br, group); 126919e3a9c9SNikolay Aleksandrov if (mp) 127019e3a9c9SNikolay Aleksandrov return mp; 1271eb1d1641SHerbert Xu 127219e3a9c9SNikolay Aleksandrov if (atomic_read(&br->mdb_hash_tbl.nelems) >= br->hash_max) { 1273*b57e8d87SPetr Machata trace_br_mdb_full(br->dev, group); 1274c832962aSOleksandr Mazur br_mc_disabled_update(br->dev, false, NULL); 127519e3a9c9SNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_ENABLED, false); 127619e3a9c9SNikolay Aleksandrov return ERR_PTR(-E2BIG); 1277eb1d1641SHerbert Xu } 1278eb1d1641SHerbert Xu 1279eb1d1641SHerbert Xu mp = kzalloc(sizeof(*mp), GFP_ATOMIC); 1280eb1d1641SHerbert Xu if (unlikely(!mp)) 12814c0833bcSTobias Klauser return ERR_PTR(-ENOMEM); 1282eb1d1641SHerbert Xu 1283eb1d1641SHerbert Xu mp->br = br; 12848ef2a9a5SYOSHIFUJI Hideaki mp->addr = *group; 1285e12cec65SNikolay Aleksandrov mp->mcast_gc.destroy = br_multicast_destroy_mdb_entry; 128688c1f37fSAllen Pais timer_setup(&mp->timer, br_multicast_group_expired, 0); 128719e3a9c9SNikolay Aleksandrov err = rhashtable_lookup_insert_fast(&br->mdb_hash_tbl, &mp->rhnode, 128819e3a9c9SNikolay Aleksandrov br_mdb_rht_params); 128919e3a9c9SNikolay Aleksandrov if (err) { 129019e3a9c9SNikolay Aleksandrov kfree(mp); 129119e3a9c9SNikolay Aleksandrov mp = ERR_PTR(err); 129219e3a9c9SNikolay Aleksandrov } else { 129319e3a9c9SNikolay Aleksandrov hlist_add_head_rcu(&mp->mdb_node, &br->mdb_list); 129419e3a9c9SNikolay Aleksandrov } 12951faabf2aSEric Dumazet 1296eb1d1641SHerbert Xu return mp; 1297eb1d1641SHerbert Xu } 1298eb1d1641SHerbert Xu 12998b671779SNikolay Aleksandrov static void br_multicast_group_src_expired(struct timer_list *t) 13008b671779SNikolay Aleksandrov { 13018b671779SNikolay Aleksandrov struct net_bridge_group_src *src = from_timer(src, t, timer); 13028b671779SNikolay Aleksandrov struct net_bridge_port_group *pg; 13038b671779SNikolay Aleksandrov struct net_bridge *br = src->br; 13048b671779SNikolay Aleksandrov 13058b671779SNikolay Aleksandrov spin_lock(&br->multicast_lock); 13068b671779SNikolay Aleksandrov if (hlist_unhashed(&src->node) || !netif_running(br->dev) || 13078b671779SNikolay Aleksandrov timer_pending(&src->timer)) 13088b671779SNikolay Aleksandrov goto out; 13098b671779SNikolay Aleksandrov 13108b671779SNikolay Aleksandrov pg = src->pg; 13118b671779SNikolay Aleksandrov if (pg->filter_mode == MCAST_INCLUDE) { 1312d5a10222SNikolay Aleksandrov br_multicast_del_group_src(src, false); 13138b671779SNikolay Aleksandrov if (!hlist_empty(&pg->src_list)) 13148b671779SNikolay Aleksandrov goto out; 13158b671779SNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 13169116ffbfSNikolay Aleksandrov } else { 13179116ffbfSNikolay Aleksandrov br_multicast_fwd_src_handle(src); 13188b671779SNikolay Aleksandrov } 13199116ffbfSNikolay Aleksandrov 13208b671779SNikolay Aleksandrov out: 13218b671779SNikolay Aleksandrov spin_unlock(&br->multicast_lock); 13228b671779SNikolay Aleksandrov } 13238b671779SNikolay Aleksandrov 1324474ddb37SNikolay Aleksandrov struct net_bridge_group_src * 13258b671779SNikolay Aleksandrov br_multicast_find_group_src(struct net_bridge_port_group *pg, struct br_ip *ip) 13268b671779SNikolay Aleksandrov { 13278b671779SNikolay Aleksandrov struct net_bridge_group_src *ent; 13288b671779SNikolay Aleksandrov 13298b671779SNikolay Aleksandrov switch (ip->proto) { 13308b671779SNikolay Aleksandrov case htons(ETH_P_IP): 13318b671779SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1332deb96566SNikolay Aleksandrov if (ip->src.ip4 == ent->addr.src.ip4) 13338b671779SNikolay Aleksandrov return ent; 13348b671779SNikolay Aleksandrov break; 13358b671779SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 13368b671779SNikolay Aleksandrov case htons(ETH_P_IPV6): 13378b671779SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1338deb96566SNikolay Aleksandrov if (!ipv6_addr_cmp(&ent->addr.src.ip6, &ip->src.ip6)) 13398b671779SNikolay Aleksandrov return ent; 13408b671779SNikolay Aleksandrov break; 13418b671779SNikolay Aleksandrov #endif 13428b671779SNikolay Aleksandrov } 13438b671779SNikolay Aleksandrov 13448b671779SNikolay Aleksandrov return NULL; 13458b671779SNikolay Aleksandrov } 13468b671779SNikolay Aleksandrov 1347fd0c6961SIdo Schimmel struct net_bridge_group_src * 13488b671779SNikolay Aleksandrov br_multicast_new_group_src(struct net_bridge_port_group *pg, struct br_ip *src_ip) 13498b671779SNikolay Aleksandrov { 13508b671779SNikolay Aleksandrov struct net_bridge_group_src *grp_src; 13518b671779SNikolay Aleksandrov 13528b671779SNikolay Aleksandrov if (unlikely(pg->src_ents >= PG_SRC_ENT_LIMIT)) 13538b671779SNikolay Aleksandrov return NULL; 13548b671779SNikolay Aleksandrov 13558b671779SNikolay Aleksandrov switch (src_ip->proto) { 13568b671779SNikolay Aleksandrov case htons(ETH_P_IP): 1357deb96566SNikolay Aleksandrov if (ipv4_is_zeronet(src_ip->src.ip4) || 1358deb96566SNikolay Aleksandrov ipv4_is_multicast(src_ip->src.ip4)) 13598b671779SNikolay Aleksandrov return NULL; 13608b671779SNikolay Aleksandrov break; 13618b671779SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 13628b671779SNikolay Aleksandrov case htons(ETH_P_IPV6): 1363deb96566SNikolay Aleksandrov if (ipv6_addr_any(&src_ip->src.ip6) || 1364deb96566SNikolay Aleksandrov ipv6_addr_is_multicast(&src_ip->src.ip6)) 13658b671779SNikolay Aleksandrov return NULL; 13668b671779SNikolay Aleksandrov break; 13678b671779SNikolay Aleksandrov #endif 13688b671779SNikolay Aleksandrov } 13698b671779SNikolay Aleksandrov 13708b671779SNikolay Aleksandrov grp_src = kzalloc(sizeof(*grp_src), GFP_ATOMIC); 13718b671779SNikolay Aleksandrov if (unlikely(!grp_src)) 13728b671779SNikolay Aleksandrov return NULL; 13738b671779SNikolay Aleksandrov 13748b671779SNikolay Aleksandrov grp_src->pg = pg; 1375085b53c8SNikolay Aleksandrov grp_src->br = pg->key.port->br; 13768b671779SNikolay Aleksandrov grp_src->addr = *src_ip; 1377e12cec65SNikolay Aleksandrov grp_src->mcast_gc.destroy = br_multicast_destroy_group_src; 13788b671779SNikolay Aleksandrov timer_setup(&grp_src->timer, br_multicast_group_src_expired, 0); 13798b671779SNikolay Aleksandrov 13808b671779SNikolay Aleksandrov hlist_add_head_rcu(&grp_src->node, &pg->src_list); 13818b671779SNikolay Aleksandrov pg->src_ents++; 13828b671779SNikolay Aleksandrov 13838b671779SNikolay Aleksandrov return grp_src; 13848b671779SNikolay Aleksandrov } 13858b671779SNikolay Aleksandrov 1386cfd56754SCong Wang struct net_bridge_port_group *br_multicast_new_port_group( 1387cfd56754SCong Wang struct net_bridge_port *port, 1388f86c3e2cSIdo Schimmel const struct br_ip *group, 1389ccb1c31aSAmerigo Wang struct net_bridge_port_group __rcu *next, 13906db6f0eaSFelix Fietkau unsigned char flags, 13918b671779SNikolay Aleksandrov const unsigned char *src, 13928f8cb77eSNikolay Aleksandrov u8 filter_mode, 139360977a0cSPetr Machata u8 rt_protocol, 139460977a0cSPetr Machata struct netlink_ext_ack *extack) 1395cfd56754SCong Wang { 1396cfd56754SCong Wang struct net_bridge_port_group *p; 1397*b57e8d87SPetr Machata int err; 1398*b57e8d87SPetr Machata 1399*b57e8d87SPetr Machata err = br_multicast_port_ngroups_inc(port, group, extack); 1400*b57e8d87SPetr Machata if (err) 1401*b57e8d87SPetr Machata return NULL; 1402cfd56754SCong Wang 1403cfd56754SCong Wang p = kzalloc(sizeof(*p), GFP_ATOMIC); 14041c85b80bSPetr Machata if (unlikely(!p)) { 14051c85b80bSPetr Machata NL_SET_ERR_MSG_MOD(extack, "Couldn't allocate new port group"); 1406*b57e8d87SPetr Machata goto dec_out; 14071c85b80bSPetr Machata } 1408cfd56754SCong Wang 1409085b53c8SNikolay Aleksandrov p->key.addr = *group; 1410085b53c8SNikolay Aleksandrov p->key.port = port; 14119d06b6d8SElad Raz p->flags = flags; 14128b671779SNikolay Aleksandrov p->filter_mode = filter_mode; 14138f8cb77eSNikolay Aleksandrov p->rt_protocol = rt_protocol; 14145b163288SNikolay Aleksandrov p->eht_host_tree = RB_ROOT; 1415baa74d39SNikolay Aleksandrov p->eht_set_tree = RB_ROOT; 1416e12cec65SNikolay Aleksandrov p->mcast_gc.destroy = br_multicast_destroy_port_group; 14178b671779SNikolay Aleksandrov INIT_HLIST_HEAD(&p->src_list); 1418085b53c8SNikolay Aleksandrov 1419085b53c8SNikolay Aleksandrov if (!br_multicast_is_star_g(group) && 1420085b53c8SNikolay Aleksandrov rhashtable_lookup_insert_fast(&port->br->sg_port_tbl, &p->rhnode, 1421085b53c8SNikolay Aleksandrov br_sg_port_rht_params)) { 14221c85b80bSPetr Machata NL_SET_ERR_MSG_MOD(extack, "Couldn't insert new port group"); 1423eceb3085SPetr Machata goto free_out; 1424085b53c8SNikolay Aleksandrov } 1425085b53c8SNikolay Aleksandrov 1426eca2a43bSstephen hemminger rcu_assign_pointer(p->next, next); 142788c1f37fSAllen Pais timer_setup(&p->timer, br_multicast_port_group_expired, 0); 142842c11ccfSNikolay Aleksandrov timer_setup(&p->rexmit_timer, br_multicast_port_group_rexmit, 0); 142942c11ccfSNikolay Aleksandrov hlist_add_head(&p->mglist, &port->mglist); 14306db6f0eaSFelix Fietkau 14316db6f0eaSFelix Fietkau if (src) 14326db6f0eaSFelix Fietkau memcpy(p->eth_addr, src, ETH_ALEN); 14336db6f0eaSFelix Fietkau else 14341bfe45f4SMao Wenan eth_broadcast_addr(p->eth_addr); 14356db6f0eaSFelix Fietkau 1436cfd56754SCong Wang return p; 1437eceb3085SPetr Machata 1438eceb3085SPetr Machata free_out: 1439eceb3085SPetr Machata kfree(p); 1440*b57e8d87SPetr Machata dec_out: 1441*b57e8d87SPetr Machata br_multicast_port_ngroups_dec(port, group->vid); 1442eceb3085SPetr Machata return NULL; 1443cfd56754SCong Wang } 1444cfd56754SCong Wang 1445976b3858SPetr Machata void br_multicast_del_port_group(struct net_bridge_port_group *p) 1446976b3858SPetr Machata { 1447976b3858SPetr Machata struct net_bridge_port *port = p->key.port; 1448*b57e8d87SPetr Machata __u16 vid = p->key.addr.vid; 1449976b3858SPetr Machata 1450976b3858SPetr Machata hlist_del_init(&p->mglist); 1451976b3858SPetr Machata if (!br_multicast_is_star_g(&p->key.addr)) 1452976b3858SPetr Machata rhashtable_remove_fast(&port->br->sg_port_tbl, &p->rhnode, 1453976b3858SPetr Machata br_sg_port_rht_params); 1454976b3858SPetr Machata kfree(p); 1455*b57e8d87SPetr Machata br_multicast_port_ngroups_dec(port, vid); 1456976b3858SPetr Machata } 1457976b3858SPetr Machata 145858d913a3SNikolay Aleksandrov void br_multicast_host_join(const struct net_bridge_mcast *brmctx, 145958d913a3SNikolay Aleksandrov struct net_bridge_mdb_entry *mp, bool notify) 14601bc844eeSNikolay Aleksandrov { 14611bc844eeSNikolay Aleksandrov if (!mp->host_joined) { 14621bc844eeSNikolay Aleksandrov mp->host_joined = true; 1463094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1464094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 14651bc844eeSNikolay Aleksandrov if (notify) 146681f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_NEWMDB); 14671bc844eeSNikolay Aleksandrov } 1468955062b0SNikolay Aleksandrov 1469955062b0SNikolay Aleksandrov if (br_group_is_l2(&mp->addr)) 1470955062b0SNikolay Aleksandrov return; 1471955062b0SNikolay Aleksandrov 147258d913a3SNikolay Aleksandrov mod_timer(&mp->timer, jiffies + brmctx->multicast_membership_interval); 14731bc844eeSNikolay Aleksandrov } 14741bc844eeSNikolay Aleksandrov 14751bc844eeSNikolay Aleksandrov void br_multicast_host_leave(struct net_bridge_mdb_entry *mp, bool notify) 14761bc844eeSNikolay Aleksandrov { 14771bc844eeSNikolay Aleksandrov if (!mp->host_joined) 14781bc844eeSNikolay Aleksandrov return; 14791bc844eeSNikolay Aleksandrov 14801bc844eeSNikolay Aleksandrov mp->host_joined = false; 1481094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1482094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 14831bc844eeSNikolay Aleksandrov if (notify) 148481f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_DELMDB); 14851bc844eeSNikolay Aleksandrov } 14861bc844eeSNikolay Aleksandrov 1487b0812368SNikolay Aleksandrov static struct net_bridge_port_group * 1488adc47037SNikolay Aleksandrov __br_multicast_add_group(struct net_bridge_mcast *brmctx, 1489adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 14906db6f0eaSFelix Fietkau struct br_ip *group, 14918b671779SNikolay Aleksandrov const unsigned char *src, 14920436862eSNikolay Aleksandrov u8 filter_mode, 14939116ffbfSNikolay Aleksandrov bool igmpv2_mldv1, 14949116ffbfSNikolay Aleksandrov bool blocked) 1495eb1d1641SHerbert Xu { 1496e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 1497b0812368SNikolay Aleksandrov struct net_bridge_port_group *p = NULL; 14985e923585SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 1499454594f3SLinus Lüssing unsigned long now = jiffies; 1500eb1d1641SHerbert Xu 15014cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 1502eb1d1641SHerbert Xu goto out; 1503eb1d1641SHerbert Xu 1504adc47037SNikolay Aleksandrov mp = br_multicast_new_group(brmctx->br, group); 15054c0833bcSTobias Klauser if (IS_ERR(mp)) 15061697291dSXu Wang return ERR_CAST(mp); 1507eb1d1641SHerbert Xu 1508adc47037SNikolay Aleksandrov if (!pmctx) { 150958d913a3SNikolay Aleksandrov br_multicast_host_join(brmctx, mp, true); 1510eb1d1641SHerbert Xu goto out; 1511eb1d1641SHerbert Xu } 1512eb1d1641SHerbert Xu 1513e8051688SEric Dumazet for (pp = &mp->ports; 1514adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 1515e8051688SEric Dumazet pp = &p->next) { 1516adc47037SNikolay Aleksandrov if (br_port_group_equal(p, pmctx->port, src)) 1517454594f3SLinus Lüssing goto found; 1518adc47037SNikolay Aleksandrov if ((unsigned long)p->key.port < (unsigned long)pmctx->port) 1519eb1d1641SHerbert Xu break; 1520eb1d1641SHerbert Xu } 1521eb1d1641SHerbert Xu 1522adc47037SNikolay Aleksandrov p = br_multicast_new_port_group(pmctx->port, group, *pp, 0, src, 152360977a0cSPetr Machata filter_mode, RTPROT_KERNEL, NULL); 1524b0812368SNikolay Aleksandrov if (unlikely(!p)) { 1525b0812368SNikolay Aleksandrov p = ERR_PTR(-ENOMEM); 1526b0812368SNikolay Aleksandrov goto out; 1527b0812368SNikolay Aleksandrov } 1528eb1d1641SHerbert Xu rcu_assign_pointer(*pp, p); 15299116ffbfSNikolay Aleksandrov if (blocked) 15309116ffbfSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_BLOCKED; 1531adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mp, p, RTM_NEWMDB); 1532eb1d1641SHerbert Xu 1533454594f3SLinus Lüssing found: 15340436862eSNikolay Aleksandrov if (igmpv2_mldv1) 1535d3d065c0SNikolay Aleksandrov mod_timer(&p->timer, 1536adc47037SNikolay Aleksandrov now + brmctx->multicast_membership_interval); 153781f19838SNikolay Aleksandrov 1538eb1d1641SHerbert Xu out: 1539b0812368SNikolay Aleksandrov return p; 1540b0812368SNikolay Aleksandrov } 1541eb1d1641SHerbert Xu 1542adc47037SNikolay Aleksandrov static int br_multicast_add_group(struct net_bridge_mcast *brmctx, 1543adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1544b0812368SNikolay Aleksandrov struct br_ip *group, 1545b0812368SNikolay Aleksandrov const unsigned char *src, 1546b0812368SNikolay Aleksandrov u8 filter_mode, 1547b0812368SNikolay Aleksandrov bool igmpv2_mldv1) 1548b0812368SNikolay Aleksandrov { 1549b0812368SNikolay Aleksandrov struct net_bridge_port_group *pg; 1550b0812368SNikolay Aleksandrov int err; 1551b0812368SNikolay Aleksandrov 1552adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1553adc47037SNikolay Aleksandrov pg = __br_multicast_add_group(brmctx, pmctx, group, src, filter_mode, 15549116ffbfSNikolay Aleksandrov igmpv2_mldv1, false); 1555b0812368SNikolay Aleksandrov /* NULL is considered valid for host joined groups */ 15568d21c882SJiapeng Zhong err = PTR_ERR_OR_ZERO(pg); 1557adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1558b0812368SNikolay Aleksandrov 1559eb1d1641SHerbert Xu return err; 1560eb1d1641SHerbert Xu } 1561eb1d1641SHerbert Xu 1562adc47037SNikolay Aleksandrov static int br_ip4_multicast_add_group(struct net_bridge_mcast *brmctx, 1563adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1564b0e9a30dSVlad Yasevich __be32 group, 15656db6f0eaSFelix Fietkau __u16 vid, 15668b671779SNikolay Aleksandrov const unsigned char *src, 15678b671779SNikolay Aleksandrov bool igmpv2) 15688ef2a9a5SYOSHIFUJI Hideaki { 15698ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 15708b671779SNikolay Aleksandrov u8 filter_mode; 15718ef2a9a5SYOSHIFUJI Hideaki 15728ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 15738ef2a9a5SYOSHIFUJI Hideaki return 0; 15748ef2a9a5SYOSHIFUJI Hideaki 15751515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1576eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 15778ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1578b0e9a30dSVlad Yasevich br_group.vid = vid; 15798b671779SNikolay Aleksandrov filter_mode = igmpv2 ? MCAST_EXCLUDE : MCAST_INCLUDE; 15808ef2a9a5SYOSHIFUJI Hideaki 1581adc47037SNikolay Aleksandrov return br_multicast_add_group(brmctx, pmctx, &br_group, src, 1582adc47037SNikolay Aleksandrov filter_mode, igmpv2); 15838ef2a9a5SYOSHIFUJI Hideaki } 15848ef2a9a5SYOSHIFUJI Hideaki 1585dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1586adc47037SNikolay Aleksandrov static int br_ip6_multicast_add_group(struct net_bridge_mcast *brmctx, 1587adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1588b0e9a30dSVlad Yasevich const struct in6_addr *group, 15896db6f0eaSFelix Fietkau __u16 vid, 15908b671779SNikolay Aleksandrov const unsigned char *src, 15918b671779SNikolay Aleksandrov bool mldv1) 159208b202b6SYOSHIFUJI Hideaki { 159308b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 15948b671779SNikolay Aleksandrov u8 filter_mode; 159508b202b6SYOSHIFUJI Hideaki 15963c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 159708b202b6SYOSHIFUJI Hideaki return 0; 159808b202b6SYOSHIFUJI Hideaki 159919e3a9c9SNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1600eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 16019cc6e0c4SLinus Lüssing br_group.proto = htons(ETH_P_IPV6); 1602b0e9a30dSVlad Yasevich br_group.vid = vid; 16038b671779SNikolay Aleksandrov filter_mode = mldv1 ? MCAST_EXCLUDE : MCAST_INCLUDE; 160408b202b6SYOSHIFUJI Hideaki 1605adc47037SNikolay Aleksandrov return br_multicast_add_group(brmctx, pmctx, &br_group, src, 1606adc47037SNikolay Aleksandrov filter_mode, mldv1); 160708b202b6SYOSHIFUJI Hideaki } 160808b202b6SYOSHIFUJI Hideaki #endif 160908b202b6SYOSHIFUJI Hideaki 1610ed2d3597SLinus Lüssing static bool br_multicast_rport_del(struct hlist_node *rlist) 1611ed2d3597SLinus Lüssing { 1612ed2d3597SLinus Lüssing if (hlist_unhashed(rlist)) 1613ed2d3597SLinus Lüssing return false; 1614ed2d3597SLinus Lüssing 1615ed2d3597SLinus Lüssing hlist_del_init_rcu(rlist); 1616ed2d3597SLinus Lüssing return true; 1617ed2d3597SLinus Lüssing } 1618ed2d3597SLinus Lüssing 1619adc47037SNikolay Aleksandrov static bool br_ip4_multicast_rport_del(struct net_bridge_mcast_port *pmctx) 1620ed2d3597SLinus Lüssing { 1621adc47037SNikolay Aleksandrov return br_multicast_rport_del(&pmctx->ip4_rlist); 1622ed2d3597SLinus Lüssing } 1623ed2d3597SLinus Lüssing 1624adc47037SNikolay Aleksandrov static bool br_ip6_multicast_rport_del(struct net_bridge_mcast_port *pmctx) 1625a3c02e76SLinus Lüssing { 1626a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1627adc47037SNikolay Aleksandrov return br_multicast_rport_del(&pmctx->ip6_rlist); 1628a3c02e76SLinus Lüssing #else 1629a3c02e76SLinus Lüssing return false; 1630a3c02e76SLinus Lüssing #endif 1631a3c02e76SLinus Lüssing } 1632a3c02e76SLinus Lüssing 16339632233eSNikolay Aleksandrov static void br_multicast_router_expired(struct net_bridge_mcast_port *pmctx, 1634ee5fb222SLinus Lüssing struct timer_list *t, 1635ee5fb222SLinus Lüssing struct hlist_node *rlist) 1636eb1d1641SHerbert Xu { 16379632233eSNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 1638ed2d3597SLinus Lüssing bool del; 1639eb1d1641SHerbert Xu 1640eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 16419632233eSNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 16429632233eSNikolay Aleksandrov pmctx->multicast_router == MDB_RTR_TYPE_PERM || 1643ee5fb222SLinus Lüssing timer_pending(t)) 1644eb1d1641SHerbert Xu goto out; 1645eb1d1641SHerbert Xu 1646ed2d3597SLinus Lüssing del = br_multicast_rport_del(rlist); 1647adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 1648eb1d1641SHerbert Xu out: 1649eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1650eb1d1641SHerbert Xu } 1651eb1d1641SHerbert Xu 1652ee5fb222SLinus Lüssing static void br_ip4_multicast_router_expired(struct timer_list *t) 1653ee5fb222SLinus Lüssing { 16549632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 16559632233eSNikolay Aleksandrov ip4_mc_router_timer); 1656ee5fb222SLinus Lüssing 16579632233eSNikolay Aleksandrov br_multicast_router_expired(pmctx, t, &pmctx->ip4_rlist); 1658ee5fb222SLinus Lüssing } 1659ee5fb222SLinus Lüssing 1660a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1661a3c02e76SLinus Lüssing static void br_ip6_multicast_router_expired(struct timer_list *t) 1662a3c02e76SLinus Lüssing { 16639632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 16649632233eSNikolay Aleksandrov ip6_mc_router_timer); 1665a3c02e76SLinus Lüssing 16669632233eSNikolay Aleksandrov br_multicast_router_expired(pmctx, t, &pmctx->ip6_rlist); 1667a3c02e76SLinus Lüssing } 1668a3c02e76SLinus Lüssing #endif 1669a3c02e76SLinus Lüssing 167077041420SYotam Gigi static void br_mc_router_state_change(struct net_bridge *p, 167177041420SYotam Gigi bool is_mc_router) 167277041420SYotam Gigi { 167377041420SYotam Gigi struct switchdev_attr attr = { 167477041420SYotam Gigi .orig_dev = p->dev, 167577041420SYotam Gigi .id = SWITCHDEV_ATTR_ID_BRIDGE_MROUTER, 167677041420SYotam Gigi .flags = SWITCHDEV_F_DEFER, 167777041420SYotam Gigi .u.mrouter = is_mc_router, 167877041420SYotam Gigi }; 167977041420SYotam Gigi 1680dcbdf135SVladimir Oltean switchdev_port_attr_set(p->dev, &attr, NULL); 168177041420SYotam Gigi } 168277041420SYotam Gigi 1683d3d065c0SNikolay Aleksandrov static void br_multicast_local_router_expired(struct net_bridge_mcast *brmctx, 1684ee5fb222SLinus Lüssing struct timer_list *timer) 1685eb1d1641SHerbert Xu { 1686d3d065c0SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1687d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 1688d3d065c0SNikolay Aleksandrov brmctx->multicast_router == MDB_RTR_TYPE_PERM || 1689d3d065c0SNikolay Aleksandrov br_ip4_multicast_is_router(brmctx) || 1690d3d065c0SNikolay Aleksandrov br_ip6_multicast_is_router(brmctx)) 169177041420SYotam Gigi goto out; 169277041420SYotam Gigi 1693d3d065c0SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, false); 169477041420SYotam Gigi out: 1695d3d065c0SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1696eb1d1641SHerbert Xu } 1697eb1d1641SHerbert Xu 1698ee5fb222SLinus Lüssing static void br_ip4_multicast_local_router_expired(struct timer_list *t) 1699ee5fb222SLinus Lüssing { 1700d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1701d3d065c0SNikolay Aleksandrov ip4_mc_router_timer); 1702ee5fb222SLinus Lüssing 1703d3d065c0SNikolay Aleksandrov br_multicast_local_router_expired(brmctx, t); 1704ee5fb222SLinus Lüssing } 1705ee5fb222SLinus Lüssing 1706a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1707a3c02e76SLinus Lüssing static void br_ip6_multicast_local_router_expired(struct timer_list *t) 1708a3c02e76SLinus Lüssing { 1709d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1710d3d065c0SNikolay Aleksandrov ip6_mc_router_timer); 1711a3c02e76SLinus Lüssing 1712d3d065c0SNikolay Aleksandrov br_multicast_local_router_expired(brmctx, t); 1713a3c02e76SLinus Lüssing } 1714a3c02e76SLinus Lüssing #endif 1715a3c02e76SLinus Lüssing 1716d3d065c0SNikolay Aleksandrov static void br_multicast_querier_expired(struct net_bridge_mcast *brmctx, 171790010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1718c83b8fabSHerbert Xu { 1719d3d065c0SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 1720d3d065c0SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 17214cdd0d10SNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(brmctx) || 1722d3d065c0SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 1723c83b8fabSHerbert Xu goto out; 1724c83b8fabSHerbert Xu 1725adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, query); 1726c83b8fabSHerbert Xu 1727c83b8fabSHerbert Xu out: 1728d3d065c0SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 1729c83b8fabSHerbert Xu } 1730c83b8fabSHerbert Xu 173188c1f37fSAllen Pais static void br_ip4_multicast_querier_expired(struct timer_list *t) 1732cc0fdd80SLinus Lüssing { 1733d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1734d3d065c0SNikolay Aleksandrov ip4_other_query.timer); 1735cc0fdd80SLinus Lüssing 1736d3d065c0SNikolay Aleksandrov br_multicast_querier_expired(brmctx, &brmctx->ip4_own_query); 1737cc0fdd80SLinus Lüssing } 1738cc0fdd80SLinus Lüssing 1739cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 174088c1f37fSAllen Pais static void br_ip6_multicast_querier_expired(struct timer_list *t) 1741cc0fdd80SLinus Lüssing { 1742d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 1743d3d065c0SNikolay Aleksandrov ip6_other_query.timer); 1744cc0fdd80SLinus Lüssing 1745d3d065c0SNikolay Aleksandrov br_multicast_querier_expired(brmctx, &brmctx->ip6_own_query); 1746cc0fdd80SLinus Lüssing } 1747cc0fdd80SLinus Lüssing #endif 1748cc0fdd80SLinus Lüssing 1749adc47037SNikolay Aleksandrov static void br_multicast_select_own_querier(struct net_bridge_mcast *brmctx, 1750dc4eb53aSLinus Lüssing struct br_ip *ip, 1751dc4eb53aSLinus Lüssing struct sk_buff *skb) 1752dc4eb53aSLinus Lüssing { 1753dc4eb53aSLinus Lüssing if (ip->proto == htons(ETH_P_IP)) 1754d3d065c0SNikolay Aleksandrov brmctx->ip4_querier.addr.src.ip4 = ip_hdr(skb)->saddr; 1755dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1756dc4eb53aSLinus Lüssing else 1757d3d065c0SNikolay Aleksandrov brmctx->ip6_querier.addr.src.ip6 = ipv6_hdr(skb)->saddr; 1758dc4eb53aSLinus Lüssing #endif 1759dc4eb53aSLinus Lüssing } 1760dc4eb53aSLinus Lüssing 1761adc47037SNikolay Aleksandrov static void __br_multicast_send_query(struct net_bridge_mcast *brmctx, 1762adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 1763438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 1764438ef2d0SNikolay Aleksandrov struct br_ip *ip_dst, 1765438ef2d0SNikolay Aleksandrov struct br_ip *group, 1766438ef2d0SNikolay Aleksandrov bool with_srcs, 176742c11ccfSNikolay Aleksandrov u8 sflag, 176842c11ccfSNikolay Aleksandrov bool *need_rexmit) 1769eb1d1641SHerbert Xu { 1770438ef2d0SNikolay Aleksandrov bool over_lmqt = !!sflag; 1771eb1d1641SHerbert Xu struct sk_buff *skb; 17721080ab95SNikolay Aleksandrov u8 igmp_type; 1773eb1d1641SHerbert Xu 1774cb486ce9SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx) || 1775cb486ce9SNikolay Aleksandrov !br_multicast_ctx_matches_vlan_snooping(brmctx)) 1776615cc23eSNikolay Aleksandrov return; 1777615cc23eSNikolay Aleksandrov 1778438ef2d0SNikolay Aleksandrov again_under_lmqt: 1779615cc23eSNikolay Aleksandrov skb = br_multicast_alloc_query(brmctx, pmctx, pg, ip_dst, group, 1780615cc23eSNikolay Aleksandrov with_srcs, over_lmqt, sflag, &igmp_type, 178142c11ccfSNikolay Aleksandrov need_rexmit); 1782eb1d1641SHerbert Xu if (!skb) 17838ef2a9a5SYOSHIFUJI Hideaki return; 1784eb1d1641SHerbert Xu 1785adc47037SNikolay Aleksandrov if (pmctx) { 1786adc47037SNikolay Aleksandrov skb->dev = pmctx->port->dev; 1787adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, pmctx->port, skb, igmp_type, 17881080ab95SNikolay Aleksandrov BR_MCAST_DIR_TX); 178929a26a56SEric W. Biederman NF_HOOK(NFPROTO_BRIDGE, NF_BR_LOCAL_OUT, 1790adc47037SNikolay Aleksandrov dev_net(pmctx->port->dev), NULL, skb, NULL, skb->dev, 1791f0b4eeceSLinus Lüssing br_dev_queue_push_xmit); 1792438ef2d0SNikolay Aleksandrov 1793438ef2d0SNikolay Aleksandrov if (over_lmqt && with_srcs && sflag) { 1794438ef2d0SNikolay Aleksandrov over_lmqt = false; 1795438ef2d0SNikolay Aleksandrov goto again_under_lmqt; 1796438ef2d0SNikolay Aleksandrov } 1797dc4eb53aSLinus Lüssing } else { 1798adc47037SNikolay Aleksandrov br_multicast_select_own_querier(brmctx, group, skb); 1799adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, NULL, skb, igmp_type, 18001080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 1801eb1d1641SHerbert Xu netif_rx(skb); 18028ef2a9a5SYOSHIFUJI Hideaki } 1803dc4eb53aSLinus Lüssing } 1804eb1d1641SHerbert Xu 180567b746f9SNikolay Aleksandrov static void br_multicast_read_querier(const struct bridge_mcast_querier *querier, 180667b746f9SNikolay Aleksandrov struct bridge_mcast_querier *dest) 180767b746f9SNikolay Aleksandrov { 180867b746f9SNikolay Aleksandrov unsigned int seq; 180967b746f9SNikolay Aleksandrov 181067b746f9SNikolay Aleksandrov memset(dest, 0, sizeof(*dest)); 181167b746f9SNikolay Aleksandrov do { 181267b746f9SNikolay Aleksandrov seq = read_seqcount_begin(&querier->seq); 181367b746f9SNikolay Aleksandrov dest->port_ifidx = querier->port_ifidx; 181467b746f9SNikolay Aleksandrov memcpy(&dest->addr, &querier->addr, sizeof(struct br_ip)); 181567b746f9SNikolay Aleksandrov } while (read_seqcount_retry(&querier->seq, seq)); 181667b746f9SNikolay Aleksandrov } 181767b746f9SNikolay Aleksandrov 181867b746f9SNikolay Aleksandrov static void br_multicast_update_querier(struct net_bridge_mcast *brmctx, 181967b746f9SNikolay Aleksandrov struct bridge_mcast_querier *querier, 182067b746f9SNikolay Aleksandrov int ifindex, 182167b746f9SNikolay Aleksandrov struct br_ip *saddr) 182267b746f9SNikolay Aleksandrov { 182367b746f9SNikolay Aleksandrov write_seqcount_begin(&querier->seq); 182467b746f9SNikolay Aleksandrov querier->port_ifidx = ifindex; 182567b746f9SNikolay Aleksandrov memcpy(&querier->addr, saddr, sizeof(*saddr)); 182667b746f9SNikolay Aleksandrov write_seqcount_end(&querier->seq); 182767b746f9SNikolay Aleksandrov } 182867b746f9SNikolay Aleksandrov 1829adc47037SNikolay Aleksandrov static void br_multicast_send_query(struct net_bridge_mcast *brmctx, 1830adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 183190010b36SLinus Lüssing struct bridge_mcast_own_query *own_query) 18328ef2a9a5SYOSHIFUJI Hideaki { 183390010b36SLinus Lüssing struct bridge_mcast_other_query *other_query = NULL; 183467b746f9SNikolay Aleksandrov struct bridge_mcast_querier *querier; 18355e923585SNikolay Aleksandrov struct br_ip br_group; 18365e923585SNikolay Aleksandrov unsigned long time; 18378ef2a9a5SYOSHIFUJI Hideaki 18384cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx) || 1839adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED) || 18404d5b4e84SNikolay Aleksandrov !brmctx->multicast_querier) 18418ef2a9a5SYOSHIFUJI Hideaki return; 18428ef2a9a5SYOSHIFUJI Hideaki 1843eab3227bSNikolay Aleksandrov memset(&br_group.dst, 0, sizeof(br_group.dst)); 18448ef2a9a5SYOSHIFUJI Hideaki 1845adc47037SNikolay Aleksandrov if (pmctx ? (own_query == &pmctx->ip4_own_query) : 1846d3d065c0SNikolay Aleksandrov (own_query == &brmctx->ip4_own_query)) { 184767b746f9SNikolay Aleksandrov querier = &brmctx->ip4_querier; 1848d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 184908b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1850dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1851cc0fdd80SLinus Lüssing } else { 185267b746f9SNikolay Aleksandrov querier = &brmctx->ip6_querier; 1853d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 185408b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 185508b202b6SYOSHIFUJI Hideaki #endif 1856eb1d1641SHerbert Xu } 1857eb1d1641SHerbert Xu 185890010b36SLinus Lüssing if (!other_query || timer_pending(&other_query->timer)) 1859cc0fdd80SLinus Lüssing return; 1860cc0fdd80SLinus Lüssing 186167b746f9SNikolay Aleksandrov /* we're about to select ourselves as querier */ 186267b746f9SNikolay Aleksandrov if (!pmctx && querier->port_ifidx) { 186367b746f9SNikolay Aleksandrov struct br_ip zeroip = {}; 186467b746f9SNikolay Aleksandrov 186567b746f9SNikolay Aleksandrov br_multicast_update_querier(brmctx, querier, 0, &zeroip); 186667b746f9SNikolay Aleksandrov } 186767b746f9SNikolay Aleksandrov 1868adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, NULL, NULL, &br_group, false, 1869adc47037SNikolay Aleksandrov 0, NULL); 1870cc0fdd80SLinus Lüssing 1871cc0fdd80SLinus Lüssing time = jiffies; 1872d3d065c0SNikolay Aleksandrov time += own_query->startup_sent < brmctx->multicast_startup_query_count ? 1873d3d065c0SNikolay Aleksandrov brmctx->multicast_startup_query_interval : 1874d3d065c0SNikolay Aleksandrov brmctx->multicast_query_interval; 187590010b36SLinus Lüssing mod_timer(&own_query->timer, time); 1876cc0fdd80SLinus Lüssing } 1877cc0fdd80SLinus Lüssing 187890010b36SLinus Lüssing static void 18799632233eSNikolay Aleksandrov br_multicast_port_query_expired(struct net_bridge_mcast_port *pmctx, 188090010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1881eb1d1641SHerbert Xu { 18829632233eSNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 18834cdd0d10SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 1884eb1d1641SHerbert Xu 1885eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 18864cdd0d10SNikolay Aleksandrov if (br_multicast_port_ctx_state_stopped(pmctx)) 1887eb1d1641SHerbert Xu goto out; 1888615cc23eSNikolay Aleksandrov 18894cdd0d10SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 18904cdd0d10SNikolay Aleksandrov if (query->startup_sent < brmctx->multicast_startup_query_count) 1891cc0fdd80SLinus Lüssing query->startup_sent++; 1892eb1d1641SHerbert Xu 18934cdd0d10SNikolay Aleksandrov br_multicast_send_query(brmctx, pmctx, query); 1894eb1d1641SHerbert Xu 1895eb1d1641SHerbert Xu out: 1896eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1897eb1d1641SHerbert Xu } 1898eb1d1641SHerbert Xu 189988c1f37fSAllen Pais static void br_ip4_multicast_port_query_expired(struct timer_list *t) 1900cc0fdd80SLinus Lüssing { 19019632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 19029632233eSNikolay Aleksandrov ip4_own_query.timer); 1903cc0fdd80SLinus Lüssing 19049632233eSNikolay Aleksandrov br_multicast_port_query_expired(pmctx, &pmctx->ip4_own_query); 1905cc0fdd80SLinus Lüssing } 1906cc0fdd80SLinus Lüssing 1907cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 190888c1f37fSAllen Pais static void br_ip6_multicast_port_query_expired(struct timer_list *t) 1909cc0fdd80SLinus Lüssing { 19109632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx = from_timer(pmctx, t, 19119632233eSNikolay Aleksandrov ip6_own_query.timer); 1912cc0fdd80SLinus Lüssing 19139632233eSNikolay Aleksandrov br_multicast_port_query_expired(pmctx, &pmctx->ip6_own_query); 1914cc0fdd80SLinus Lüssing } 1915cc0fdd80SLinus Lüssing #endif 1916cc0fdd80SLinus Lüssing 191742c11ccfSNikolay Aleksandrov static void br_multicast_port_group_rexmit(struct timer_list *t) 191842c11ccfSNikolay Aleksandrov { 191942c11ccfSNikolay Aleksandrov struct net_bridge_port_group *pg = from_timer(pg, t, rexmit_timer); 192042c11ccfSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 1921085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 1922adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 1923adc47037SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 192442c11ccfSNikolay Aleksandrov bool need_rexmit = false; 192542c11ccfSNikolay Aleksandrov 192642c11ccfSNikolay Aleksandrov spin_lock(&br->multicast_lock); 192742c11ccfSNikolay Aleksandrov if (!netif_running(br->dev) || hlist_unhashed(&pg->mglist) || 19284d5b4e84SNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED)) 192942c11ccfSNikolay Aleksandrov goto out; 193042c11ccfSNikolay Aleksandrov 1931eb1593a0SNikolay Aleksandrov pmctx = br_multicast_pg_to_port_ctx(pg); 1932eb1593a0SNikolay Aleksandrov if (!pmctx) 1933eb1593a0SNikolay Aleksandrov goto out; 1934eb1593a0SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 19354d5b4e84SNikolay Aleksandrov if (!brmctx->multicast_querier) 19364d5b4e84SNikolay Aleksandrov goto out; 19374d5b4e84SNikolay Aleksandrov 1938085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 1939d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 194042c11ccfSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 194142c11ccfSNikolay Aleksandrov else 1942d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 194342c11ccfSNikolay Aleksandrov #endif 194442c11ccfSNikolay Aleksandrov 194542c11ccfSNikolay Aleksandrov if (!other_query || timer_pending(&other_query->timer)) 194642c11ccfSNikolay Aleksandrov goto out; 194742c11ccfSNikolay Aleksandrov 194842c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt) { 194942c11ccfSNikolay Aleksandrov pg->grp_query_rexmit_cnt--; 1950adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 1951085b53c8SNikolay Aleksandrov &pg->key.addr, false, 1, NULL); 195242c11ccfSNikolay Aleksandrov } 1953adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 1954085b53c8SNikolay Aleksandrov &pg->key.addr, true, 0, &need_rexmit); 195542c11ccfSNikolay Aleksandrov 195642c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt || need_rexmit) 195742c11ccfSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, jiffies + 1958d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval); 195942c11ccfSNikolay Aleksandrov out: 196042c11ccfSNikolay Aleksandrov spin_unlock(&br->multicast_lock); 196142c11ccfSNikolay Aleksandrov } 196242c11ccfSNikolay Aleksandrov 1963ae1ea84bSFlorian Fainelli static int br_mc_disabled_update(struct net_device *dev, bool value, 1964ae1ea84bSFlorian Fainelli struct netlink_ext_ack *extack) 1965147c1e9bSNogah Frankel { 1966147c1e9bSNogah Frankel struct switchdev_attr attr = { 1967147c1e9bSNogah Frankel .orig_dev = dev, 1968147c1e9bSNogah Frankel .id = SWITCHDEV_ATTR_ID_BRIDGE_MC_DISABLED, 1969147c1e9bSNogah Frankel .flags = SWITCHDEV_F_DEFER, 197013cefad2SNikolay Aleksandrov .u.mc_disabled = !value, 1971147c1e9bSNogah Frankel }; 1972147c1e9bSNogah Frankel 1973ae1ea84bSFlorian Fainelli return switchdev_port_attr_set(dev, &attr, extack); 1974147c1e9bSNogah Frankel } 1975147c1e9bSNogah Frankel 1976613d61dbSNikolay Aleksandrov void br_multicast_port_ctx_init(struct net_bridge_port *port, 1977613d61dbSNikolay Aleksandrov struct net_bridge_vlan *vlan, 19789632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 19799632233eSNikolay Aleksandrov { 19809632233eSNikolay Aleksandrov pmctx->port = port; 1981613d61dbSNikolay Aleksandrov pmctx->vlan = vlan; 19829632233eSNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 19839632233eSNikolay Aleksandrov timer_setup(&pmctx->ip4_mc_router_timer, 19849632233eSNikolay Aleksandrov br_ip4_multicast_router_expired, 0); 19859632233eSNikolay Aleksandrov timer_setup(&pmctx->ip4_own_query.timer, 19869632233eSNikolay Aleksandrov br_ip4_multicast_port_query_expired, 0); 19879632233eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 19889632233eSNikolay Aleksandrov timer_setup(&pmctx->ip6_mc_router_timer, 19899632233eSNikolay Aleksandrov br_ip6_multicast_router_expired, 0); 19909632233eSNikolay Aleksandrov timer_setup(&pmctx->ip6_own_query.timer, 19919632233eSNikolay Aleksandrov br_ip6_multicast_port_query_expired, 0); 19929632233eSNikolay Aleksandrov #endif 19939632233eSNikolay Aleksandrov } 19949632233eSNikolay Aleksandrov 1995613d61dbSNikolay Aleksandrov void br_multicast_port_ctx_deinit(struct net_bridge_mcast_port *pmctx) 19969632233eSNikolay Aleksandrov { 19979632233eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 19989632233eSNikolay Aleksandrov del_timer_sync(&pmctx->ip6_mc_router_timer); 19999632233eSNikolay Aleksandrov #endif 20009632233eSNikolay Aleksandrov del_timer_sync(&pmctx->ip4_mc_router_timer); 20019632233eSNikolay Aleksandrov } 20029632233eSNikolay Aleksandrov 20031080ab95SNikolay Aleksandrov int br_multicast_add_port(struct net_bridge_port *port) 2004eb1d1641SHerbert Xu { 2005ae1ea84bSFlorian Fainelli int err; 2006ae1ea84bSFlorian Fainelli 200789268b05SNikolay Aleksandrov port->multicast_eht_hosts_limit = BR_MCAST_DEFAULT_EHT_HOSTS_LIMIT; 2008613d61dbSNikolay Aleksandrov br_multicast_port_ctx_init(port, NULL, &port->multicast_ctx); 2009eb1d1641SHerbert Xu 2010ae1ea84bSFlorian Fainelli err = br_mc_disabled_update(port->dev, 2011ae1ea84bSFlorian Fainelli br_opt_get(port->br, 2012ae1ea84bSFlorian Fainelli BROPT_MULTICAST_ENABLED), 2013ae1ea84bSFlorian Fainelli NULL); 201468f5c12aSVladimir Oltean if (err && err != -EOPNOTSUPP) 2015ae1ea84bSFlorian Fainelli return err; 2016147c1e9bSNogah Frankel 20171080ab95SNikolay Aleksandrov port->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 20181080ab95SNikolay Aleksandrov if (!port->mcast_stats) 20191080ab95SNikolay Aleksandrov return -ENOMEM; 20201080ab95SNikolay Aleksandrov 20211080ab95SNikolay Aleksandrov return 0; 2022eb1d1641SHerbert Xu } 2023eb1d1641SHerbert Xu 2024eb1d1641SHerbert Xu void br_multicast_del_port(struct net_bridge_port *port) 2025eb1d1641SHerbert Xu { 2026e10177abSSatish Ashok struct net_bridge *br = port->br; 2027e10177abSSatish Ashok struct net_bridge_port_group *pg; 2028e12cec65SNikolay Aleksandrov HLIST_HEAD(deleted_head); 2029e10177abSSatish Ashok struct hlist_node *n; 2030e10177abSSatish Ashok 2031e10177abSSatish Ashok /* Take care of the remaining groups, only perm ones should be left */ 2032e10177abSSatish Ashok spin_lock_bh(&br->multicast_lock); 2033e10177abSSatish Ashok hlist_for_each_entry_safe(pg, n, &port->mglist, mglist) 2034681590bdSNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 2035e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 2036e10177abSSatish Ashok spin_unlock_bh(&br->multicast_lock); 2037e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 20389632233eSNikolay Aleksandrov br_multicast_port_ctx_deinit(&port->multicast_ctx); 20391080ab95SNikolay Aleksandrov free_percpu(port->mcast_stats); 2040eb1d1641SHerbert Xu } 2041eb1d1641SHerbert Xu 204290010b36SLinus Lüssing static void br_multicast_enable(struct bridge_mcast_own_query *query) 2043561f1103SHerbert Xu { 2044cc0fdd80SLinus Lüssing query->startup_sent = 0; 2045561f1103SHerbert Xu 2046cc0fdd80SLinus Lüssing if (try_to_del_timer_sync(&query->timer) >= 0 || 2047cc0fdd80SLinus Lüssing del_timer(&query->timer)) 2048cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 2049561f1103SHerbert Xu } 2050561f1103SHerbert Xu 2051adc47037SNikolay Aleksandrov static void __br_multicast_enable_port_ctx(struct net_bridge_mcast_port *pmctx) 2052eb1d1641SHerbert Xu { 2053adc47037SNikolay Aleksandrov struct net_bridge *br = pmctx->port->br; 20547b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 2055eb1d1641SHerbert Xu 20567b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 20577b54aaafSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED) || 20587b54aaafSNikolay Aleksandrov !netif_running(br->dev)) 20597cb3f921SNikolay Aleksandrov return; 2060eb1d1641SHerbert Xu 2061adc47037SNikolay Aleksandrov br_multicast_enable(&pmctx->ip4_own_query); 2062cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 2063adc47037SNikolay Aleksandrov br_multicast_enable(&pmctx->ip6_own_query); 2064cc0fdd80SLinus Lüssing #endif 2065adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_PERM) { 2066adc47037SNikolay Aleksandrov br_ip4_multicast_add_router(brmctx, pmctx); 2067adc47037SNikolay Aleksandrov br_ip6_multicast_add_router(brmctx, pmctx); 2068a3c02e76SLinus Lüssing } 2069*b57e8d87SPetr Machata 2070*b57e8d87SPetr Machata if (br_multicast_port_ctx_is_vlan(pmctx)) { 2071*b57e8d87SPetr Machata struct net_bridge_port_group *pg; 2072*b57e8d87SPetr Machata u32 n = 0; 2073*b57e8d87SPetr Machata 2074*b57e8d87SPetr Machata /* The mcast_n_groups counter might be wrong. First, 2075*b57e8d87SPetr Machata * BR_VLFLAG_MCAST_ENABLED is toggled before temporary entries 2076*b57e8d87SPetr Machata * are flushed, thus mcast_n_groups after the toggle does not 2077*b57e8d87SPetr Machata * reflect the true values. And second, permanent entries added 2078*b57e8d87SPetr Machata * while BR_VLFLAG_MCAST_ENABLED was disabled, are not reflected 2079*b57e8d87SPetr Machata * either. Thus we have to refresh the counter. 2080*b57e8d87SPetr Machata */ 2081*b57e8d87SPetr Machata 2082*b57e8d87SPetr Machata hlist_for_each_entry(pg, &pmctx->port->mglist, mglist) { 2083*b57e8d87SPetr Machata if (pg->key.addr.vid == pmctx->vlan->vid) 2084*b57e8d87SPetr Machata n++; 2085*b57e8d87SPetr Machata } 2086*b57e8d87SPetr Machata WRITE_ONCE(pmctx->mdb_n_entries, n); 2087*b57e8d87SPetr Machata } 20887cb3f921SNikolay Aleksandrov } 2089eb1d1641SHerbert Xu 20907cb3f921SNikolay Aleksandrov void br_multicast_enable_port(struct net_bridge_port *port) 20917cb3f921SNikolay Aleksandrov { 20927cb3f921SNikolay Aleksandrov struct net_bridge *br = port->br; 20937cb3f921SNikolay Aleksandrov 2094f4b7002aSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 2095adc47037SNikolay Aleksandrov __br_multicast_enable_port_ctx(&port->multicast_ctx); 2096f4b7002aSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 2097eb1d1641SHerbert Xu } 2098eb1d1641SHerbert Xu 20997b54aaafSNikolay Aleksandrov static void __br_multicast_disable_port_ctx(struct net_bridge_mcast_port *pmctx) 2100eb1d1641SHerbert Xu { 2101eb1d1641SHerbert Xu struct net_bridge_port_group *pg; 2102b67bfe0dSSasha Levin struct hlist_node *n; 2103ed2d3597SLinus Lüssing bool del = false; 2104eb1d1641SHerbert Xu 21057b54aaafSNikolay Aleksandrov hlist_for_each_entry_safe(pg, n, &pmctx->port->mglist, mglist) 21067b54aaafSNikolay Aleksandrov if (!(pg->flags & MDB_PG_FLAGS_PERMANENT) && 21077b54aaafSNikolay Aleksandrov (!br_multicast_port_ctx_is_vlan(pmctx) || 21087b54aaafSNikolay Aleksandrov pg->key.addr.vid == pmctx->vlan->vid)) 21097b54aaafSNikolay Aleksandrov br_multicast_find_del_pg(pmctx->port->br, pg); 2110eb1d1641SHerbert Xu 2111adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 2112adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 2113adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_own_query.timer); 2114adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 2115cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 2116adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 2117adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_own_query.timer); 2118cc0fdd80SLinus Lüssing #endif 2119adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 21207b54aaafSNikolay Aleksandrov } 21217b54aaafSNikolay Aleksandrov 21227b54aaafSNikolay Aleksandrov void br_multicast_disable_port(struct net_bridge_port *port) 21237b54aaafSNikolay Aleksandrov { 2124f4b7002aSNikolay Aleksandrov spin_lock_bh(&port->br->multicast_lock); 21257b54aaafSNikolay Aleksandrov __br_multicast_disable_port_ctx(&port->multicast_ctx); 2126f4b7002aSNikolay Aleksandrov spin_unlock_bh(&port->br->multicast_lock); 2127eb1d1641SHerbert Xu } 2128eb1d1641SHerbert Xu 2129e6231bcaSNikolay Aleksandrov static int __grp_src_delete_marked(struct net_bridge_port_group *pg) 2130e6231bcaSNikolay Aleksandrov { 2131e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 2132e6231bcaSNikolay Aleksandrov struct hlist_node *tmp; 2133e6231bcaSNikolay Aleksandrov int deleted = 0; 2134e6231bcaSNikolay Aleksandrov 2135e6231bcaSNikolay Aleksandrov hlist_for_each_entry_safe(ent, tmp, &pg->src_list, node) 2136e6231bcaSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_DELETE) { 2137d5a10222SNikolay Aleksandrov br_multicast_del_group_src(ent, false); 2138e6231bcaSNikolay Aleksandrov deleted++; 2139e6231bcaSNikolay Aleksandrov } 2140e6231bcaSNikolay Aleksandrov 2141e6231bcaSNikolay Aleksandrov return deleted; 2142e6231bcaSNikolay Aleksandrov } 2143e6231bcaSNikolay Aleksandrov 2144b0812368SNikolay Aleksandrov static void __grp_src_mod_timer(struct net_bridge_group_src *src, 2145b0812368SNikolay Aleksandrov unsigned long expires) 2146b0812368SNikolay Aleksandrov { 2147b0812368SNikolay Aleksandrov mod_timer(&src->timer, expires); 2148b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(src); 2149b0812368SNikolay Aleksandrov } 2150b0812368SNikolay Aleksandrov 2151adc47037SNikolay Aleksandrov static void __grp_src_query_marked_and_rexmit(struct net_bridge_mcast *brmctx, 2152adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2153adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg) 21545bf1e00bSNikolay Aleksandrov { 21555bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 2156d3d065c0SNikolay Aleksandrov u32 lmqc = brmctx->multicast_last_member_count; 21575bf1e00bSNikolay Aleksandrov unsigned long lmqt, lmi, now = jiffies; 21585bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 21595bf1e00bSNikolay Aleksandrov 2160adc47037SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 2161adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 21625bf1e00bSNikolay Aleksandrov return; 21635bf1e00bSNikolay Aleksandrov 2164085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 2165d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 21665bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 21675bf1e00bSNikolay Aleksandrov else 2168d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 21695bf1e00bSNikolay Aleksandrov #endif 21705bf1e00bSNikolay Aleksandrov 2171adc47037SNikolay Aleksandrov lmqt = now + br_multicast_lmqt(brmctx); 21725bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 21735bf1e00bSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_SEND) { 21745bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 21755bf1e00bSNikolay Aleksandrov if (ent->timer.expires > lmqt) { 21764d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier && 21775bf1e00bSNikolay Aleksandrov other_query && 21785bf1e00bSNikolay Aleksandrov !timer_pending(&other_query->timer)) 21795bf1e00bSNikolay Aleksandrov ent->src_query_rexmit_cnt = lmqc; 2180b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, lmqt); 21815bf1e00bSNikolay Aleksandrov } 21825bf1e00bSNikolay Aleksandrov } 21835bf1e00bSNikolay Aleksandrov } 21845bf1e00bSNikolay Aleksandrov 21854d5b4e84SNikolay Aleksandrov if (!brmctx->multicast_querier || 21865bf1e00bSNikolay Aleksandrov !other_query || timer_pending(&other_query->timer)) 21875bf1e00bSNikolay Aleksandrov return; 21885bf1e00bSNikolay Aleksandrov 2189adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 2190085b53c8SNikolay Aleksandrov &pg->key.addr, true, 1, NULL); 21915bf1e00bSNikolay Aleksandrov 2192d3d065c0SNikolay Aleksandrov lmi = now + brmctx->multicast_last_member_interval; 21935bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 21945bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 21955bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 21965bf1e00bSNikolay Aleksandrov } 21975bf1e00bSNikolay Aleksandrov 2198adc47037SNikolay Aleksandrov static void __grp_send_query_and_rexmit(struct net_bridge_mcast *brmctx, 2199adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2200adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg) 22015bf1e00bSNikolay Aleksandrov { 22025bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 22035bf1e00bSNikolay Aleksandrov unsigned long now = jiffies, lmi; 22045bf1e00bSNikolay Aleksandrov 2205adc47037SNikolay Aleksandrov if (!netif_running(brmctx->br->dev) || 2206adc47037SNikolay Aleksandrov !br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED)) 22075bf1e00bSNikolay Aleksandrov return; 22085bf1e00bSNikolay Aleksandrov 2209085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 2210d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip4_other_query; 22115bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 22125bf1e00bSNikolay Aleksandrov else 2213d3d065c0SNikolay Aleksandrov other_query = &brmctx->ip6_other_query; 22145bf1e00bSNikolay Aleksandrov #endif 22155bf1e00bSNikolay Aleksandrov 22164d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier && 22175bf1e00bSNikolay Aleksandrov other_query && !timer_pending(&other_query->timer)) { 2218d3d065c0SNikolay Aleksandrov lmi = now + brmctx->multicast_last_member_interval; 2219d3d065c0SNikolay Aleksandrov pg->grp_query_rexmit_cnt = brmctx->multicast_last_member_count - 1; 2220adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, pg, &pg->key.addr, 2221085b53c8SNikolay Aleksandrov &pg->key.addr, false, 0, NULL); 22225bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 22235bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 22245bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 22255bf1e00bSNikolay Aleksandrov } 22265bf1e00bSNikolay Aleksandrov 22275bf1e00bSNikolay Aleksandrov if (pg->filter_mode == MCAST_EXCLUDE && 22285bf1e00bSNikolay Aleksandrov (!timer_pending(&pg->timer) || 2229adc47037SNikolay Aleksandrov time_after(pg->timer.expires, now + br_multicast_lmqt(brmctx)))) 2230adc47037SNikolay Aleksandrov mod_timer(&pg->timer, now + br_multicast_lmqt(brmctx)); 22315bf1e00bSNikolay Aleksandrov } 22325bf1e00bSNikolay Aleksandrov 22330436862eSNikolay Aleksandrov /* State Msg type New state Actions 22340436862eSNikolay Aleksandrov * INCLUDE (A) IS_IN (B) INCLUDE (A+B) (B)=GMI 22350436862eSNikolay Aleksandrov * INCLUDE (A) ALLOW (B) INCLUDE (A+B) (B)=GMI 22360436862eSNikolay Aleksandrov * EXCLUDE (X,Y) ALLOW (A) EXCLUDE (X+A,Y-A) (A)=GMI 22370436862eSNikolay Aleksandrov */ 2238adc47037SNikolay Aleksandrov static bool br_multicast_isinc_allow(const struct net_bridge_mcast *brmctx, 2239adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2240474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2241474ddb37SNikolay Aleksandrov int grec_type) 22420436862eSNikolay Aleksandrov { 22430436862eSNikolay Aleksandrov struct net_bridge_group_src *ent; 22440436862eSNikolay Aleksandrov unsigned long now = jiffies; 22450436862eSNikolay Aleksandrov bool changed = false; 22460436862eSNikolay Aleksandrov struct br_ip src_ip; 22470436862eSNikolay Aleksandrov u32 src_idx; 22480436862eSNikolay Aleksandrov 22490436862eSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2250085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 22510436862eSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2252e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 22530436862eSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 22540436862eSNikolay Aleksandrov if (!ent) { 22550436862eSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 22560436862eSNikolay Aleksandrov if (ent) 22570436862eSNikolay Aleksandrov changed = true; 22580436862eSNikolay Aleksandrov } 22590436862eSNikolay Aleksandrov 22600436862eSNikolay Aleksandrov if (ent) 2261adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 22620436862eSNikolay Aleksandrov } 22630436862eSNikolay Aleksandrov 2264adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2265adc47037SNikolay Aleksandrov grec_type)) 2266474ddb37SNikolay Aleksandrov changed = true; 2267474ddb37SNikolay Aleksandrov 22680436862eSNikolay Aleksandrov return changed; 22690436862eSNikolay Aleksandrov } 22700436862eSNikolay Aleksandrov 2271e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 2272e6231bcaSNikolay Aleksandrov * INCLUDE (A) IS_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 2273e6231bcaSNikolay Aleksandrov * Delete (A-B) 2274e6231bcaSNikolay Aleksandrov * Group Timer=GMI 2275e6231bcaSNikolay Aleksandrov */ 2276adc47037SNikolay Aleksandrov static void __grp_src_isexc_incl(const struct net_bridge_mcast *brmctx, 2277adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2278ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2279ddc255d9SNikolay Aleksandrov int grec_type) 2280e6231bcaSNikolay Aleksandrov { 2281e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 2282e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 2283e6231bcaSNikolay Aleksandrov u32 src_idx; 2284e6231bcaSNikolay Aleksandrov 2285e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2286e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 2287e6231bcaSNikolay Aleksandrov 2288e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2289085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2290e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2291e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2292e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2293e6231bcaSNikolay Aleksandrov if (ent) 2294e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 2295e6231bcaSNikolay Aleksandrov else 2296b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2297b0812368SNikolay Aleksandrov if (ent) 2298b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 2299e6231bcaSNikolay Aleksandrov } 2300e6231bcaSNikolay Aleksandrov 2301adc47037SNikolay Aleksandrov br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2302adc47037SNikolay Aleksandrov grec_type); 2303ddc255d9SNikolay Aleksandrov 2304e6231bcaSNikolay Aleksandrov __grp_src_delete_marked(pg); 2305e6231bcaSNikolay Aleksandrov } 2306e6231bcaSNikolay Aleksandrov 2307e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 2308e6231bcaSNikolay Aleksandrov * EXCLUDE (X,Y) IS_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=GMI 2309e6231bcaSNikolay Aleksandrov * Delete (X-A) 2310e6231bcaSNikolay Aleksandrov * Delete (Y-A) 2311e6231bcaSNikolay Aleksandrov * Group Timer=GMI 2312e6231bcaSNikolay Aleksandrov */ 2313adc47037SNikolay Aleksandrov static bool __grp_src_isexc_excl(const struct net_bridge_mcast *brmctx, 2314adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2315ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2316ddc255d9SNikolay Aleksandrov int grec_type) 2317e6231bcaSNikolay Aleksandrov { 2318e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 2319e6231bcaSNikolay Aleksandrov unsigned long now = jiffies; 2320e6231bcaSNikolay Aleksandrov bool changed = false; 2321e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 2322e6231bcaSNikolay Aleksandrov u32 src_idx; 2323e6231bcaSNikolay Aleksandrov 2324e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2325e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 2326e6231bcaSNikolay Aleksandrov 2327e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2328085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2329e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2330e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2331e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2332e6231bcaSNikolay Aleksandrov if (ent) { 2333e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 2334e6231bcaSNikolay Aleksandrov } else { 2335e6231bcaSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2336e6231bcaSNikolay Aleksandrov if (ent) { 2337b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, 2338adc47037SNikolay Aleksandrov now + br_multicast_gmi(brmctx)); 2339e6231bcaSNikolay Aleksandrov changed = true; 2340e6231bcaSNikolay Aleksandrov } 2341e6231bcaSNikolay Aleksandrov } 2342e6231bcaSNikolay Aleksandrov } 2343e6231bcaSNikolay Aleksandrov 2344adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2345adc47037SNikolay Aleksandrov grec_type)) 2346ddc255d9SNikolay Aleksandrov changed = true; 2347ddc255d9SNikolay Aleksandrov 2348e6231bcaSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 2349e6231bcaSNikolay Aleksandrov changed = true; 2350e6231bcaSNikolay Aleksandrov 2351e6231bcaSNikolay Aleksandrov return changed; 2352e6231bcaSNikolay Aleksandrov } 2353e6231bcaSNikolay Aleksandrov 2354adc47037SNikolay Aleksandrov static bool br_multicast_isexc(const struct net_bridge_mcast *brmctx, 2355adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2356ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2357ddc255d9SNikolay Aleksandrov int grec_type) 2358e6231bcaSNikolay Aleksandrov { 2359e6231bcaSNikolay Aleksandrov bool changed = false; 2360e6231bcaSNikolay Aleksandrov 2361e6231bcaSNikolay Aleksandrov switch (pg->filter_mode) { 2362e6231bcaSNikolay Aleksandrov case MCAST_INCLUDE: 2363adc47037SNikolay Aleksandrov __grp_src_isexc_incl(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2364ddc255d9SNikolay Aleksandrov grec_type); 23658266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 2366e6231bcaSNikolay Aleksandrov changed = true; 2367e6231bcaSNikolay Aleksandrov break; 2368e6231bcaSNikolay Aleksandrov case MCAST_EXCLUDE: 2369adc47037SNikolay Aleksandrov changed = __grp_src_isexc_excl(brmctx, pg, h_addr, srcs, nsrcs, 2370adc47037SNikolay Aleksandrov addr_size, grec_type); 2371e6231bcaSNikolay Aleksandrov break; 2372e6231bcaSNikolay Aleksandrov } 2373e6231bcaSNikolay Aleksandrov 2374e6231bcaSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 2375adc47037SNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(brmctx)); 2376e6231bcaSNikolay Aleksandrov 2377e6231bcaSNikolay Aleksandrov return changed; 2378e6231bcaSNikolay Aleksandrov } 2379e6231bcaSNikolay Aleksandrov 23805bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 23815bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_IN (B) INCLUDE (A+B) (B)=GMI 23825bf1e00bSNikolay Aleksandrov * Send Q(G,A-B) 23835bf1e00bSNikolay Aleksandrov */ 2384adc47037SNikolay Aleksandrov static bool __grp_src_toin_incl(struct net_bridge_mcast *brmctx, 2385adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2386adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2387ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2388ddc255d9SNikolay Aleksandrov int grec_type) 23895bf1e00bSNikolay Aleksandrov { 23905bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 23915bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 23925bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 23935bf1e00bSNikolay Aleksandrov bool changed = false; 23945bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 23955bf1e00bSNikolay Aleksandrov 23965bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 23975bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 23985bf1e00bSNikolay Aleksandrov 23995bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2400085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 24015bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2402e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 24035bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 24045bf1e00bSNikolay Aleksandrov if (ent) { 24055bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 24065bf1e00bSNikolay Aleksandrov to_send--; 24075bf1e00bSNikolay Aleksandrov } else { 24085bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 24095bf1e00bSNikolay Aleksandrov if (ent) 24105bf1e00bSNikolay Aleksandrov changed = true; 24115bf1e00bSNikolay Aleksandrov } 24125bf1e00bSNikolay Aleksandrov if (ent) 2413adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 24145bf1e00bSNikolay Aleksandrov } 24155bf1e00bSNikolay Aleksandrov 2416adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2417adc47037SNikolay Aleksandrov grec_type)) 2418ddc255d9SNikolay Aleksandrov changed = true; 2419ddc255d9SNikolay Aleksandrov 24205bf1e00bSNikolay Aleksandrov if (to_send) 2421adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 24225bf1e00bSNikolay Aleksandrov 24235bf1e00bSNikolay Aleksandrov return changed; 24245bf1e00bSNikolay Aleksandrov } 24255bf1e00bSNikolay Aleksandrov 24265bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 24275bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_IN (A) EXCLUDE (X+A,Y-A) (A)=GMI 24285bf1e00bSNikolay Aleksandrov * Send Q(G,X-A) 24295bf1e00bSNikolay Aleksandrov * Send Q(G) 24305bf1e00bSNikolay Aleksandrov */ 2431adc47037SNikolay Aleksandrov static bool __grp_src_toin_excl(struct net_bridge_mcast *brmctx, 2432adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2433adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2434ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2435ddc255d9SNikolay Aleksandrov int grec_type) 24365bf1e00bSNikolay Aleksandrov { 24375bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 24385bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 24395bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 24405bf1e00bSNikolay Aleksandrov bool changed = false; 24415bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 24425bf1e00bSNikolay Aleksandrov 24435bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 24445bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) 24455bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 24465bf1e00bSNikolay Aleksandrov 24475bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2448085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 24495bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2450e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 24515bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 24525bf1e00bSNikolay Aleksandrov if (ent) { 24535bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) { 24545bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 24555bf1e00bSNikolay Aleksandrov to_send--; 24565bf1e00bSNikolay Aleksandrov } 24575bf1e00bSNikolay Aleksandrov } else { 24585bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 24595bf1e00bSNikolay Aleksandrov if (ent) 24605bf1e00bSNikolay Aleksandrov changed = true; 24615bf1e00bSNikolay Aleksandrov } 24625bf1e00bSNikolay Aleksandrov if (ent) 2463adc47037SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(brmctx)); 24645bf1e00bSNikolay Aleksandrov } 24655bf1e00bSNikolay Aleksandrov 2466adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2467adc47037SNikolay Aleksandrov grec_type)) 2468ddc255d9SNikolay Aleksandrov changed = true; 2469ddc255d9SNikolay Aleksandrov 24705bf1e00bSNikolay Aleksandrov if (to_send) 2471adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 24725bf1e00bSNikolay Aleksandrov 2473adc47037SNikolay Aleksandrov __grp_send_query_and_rexmit(brmctx, pmctx, pg); 24745bf1e00bSNikolay Aleksandrov 24755bf1e00bSNikolay Aleksandrov return changed; 24765bf1e00bSNikolay Aleksandrov } 24775bf1e00bSNikolay Aleksandrov 2478adc47037SNikolay Aleksandrov static bool br_multicast_toin(struct net_bridge_mcast *brmctx, 2479adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2480adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2481ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2482ddc255d9SNikolay Aleksandrov int grec_type) 24835bf1e00bSNikolay Aleksandrov { 24845bf1e00bSNikolay Aleksandrov bool changed = false; 24855bf1e00bSNikolay Aleksandrov 24865bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 24875bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 2488adc47037SNikolay Aleksandrov changed = __grp_src_toin_incl(brmctx, pmctx, pg, h_addr, srcs, 2489adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 24905bf1e00bSNikolay Aleksandrov break; 24915bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 2492adc47037SNikolay Aleksandrov changed = __grp_src_toin_excl(brmctx, pmctx, pg, h_addr, srcs, 2493adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 24945bf1e00bSNikolay Aleksandrov break; 24955bf1e00bSNikolay Aleksandrov } 24965bf1e00bSNikolay Aleksandrov 2497ddc255d9SNikolay Aleksandrov if (br_multicast_eht_should_del_pg(pg)) { 2498d5a10222SNikolay Aleksandrov pg->flags |= MDB_PG_FLAGS_FAST_LEAVE; 2499ddc255d9SNikolay Aleksandrov br_multicast_find_del_pg(pg->key.port->br, pg); 2500ddc255d9SNikolay Aleksandrov /* a notification has already been sent and we shouldn't 2501ddc255d9SNikolay Aleksandrov * access pg after the delete so we have to return false 2502ddc255d9SNikolay Aleksandrov */ 2503ddc255d9SNikolay Aleksandrov changed = false; 2504ddc255d9SNikolay Aleksandrov } 2505ddc255d9SNikolay Aleksandrov 25065bf1e00bSNikolay Aleksandrov return changed; 25075bf1e00bSNikolay Aleksandrov } 25085bf1e00bSNikolay Aleksandrov 25095bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 25105bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 25115bf1e00bSNikolay Aleksandrov * Delete (A-B) 25125bf1e00bSNikolay Aleksandrov * Send Q(G,A*B) 25135bf1e00bSNikolay Aleksandrov * Group Timer=GMI 25145bf1e00bSNikolay Aleksandrov */ 2515adc47037SNikolay Aleksandrov static void __grp_src_toex_incl(struct net_bridge_mcast *brmctx, 2516adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2517adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2518ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2519ddc255d9SNikolay Aleksandrov int grec_type) 25205bf1e00bSNikolay Aleksandrov { 25215bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 25225bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 25235bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 25245bf1e00bSNikolay Aleksandrov 25255bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 25265bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 25275bf1e00bSNikolay Aleksandrov 25285bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2529085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 25305bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2531e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 25325bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 25335bf1e00bSNikolay Aleksandrov if (ent) { 25345bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_DELETE) | 25355bf1e00bSNikolay Aleksandrov BR_SGRP_F_SEND; 25365bf1e00bSNikolay Aleksandrov to_send++; 25375bf1e00bSNikolay Aleksandrov } else { 2538b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 25395bf1e00bSNikolay Aleksandrov } 2540b0812368SNikolay Aleksandrov if (ent) 2541b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 25425bf1e00bSNikolay Aleksandrov } 25435bf1e00bSNikolay Aleksandrov 2544adc47037SNikolay Aleksandrov br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2545adc47037SNikolay Aleksandrov grec_type); 2546ddc255d9SNikolay Aleksandrov 25475bf1e00bSNikolay Aleksandrov __grp_src_delete_marked(pg); 25485bf1e00bSNikolay Aleksandrov if (to_send) 2549adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 25505bf1e00bSNikolay Aleksandrov } 25515bf1e00bSNikolay Aleksandrov 25525bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 25535bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=Group Timer 25545bf1e00bSNikolay Aleksandrov * Delete (X-A) 25555bf1e00bSNikolay Aleksandrov * Delete (Y-A) 25565bf1e00bSNikolay Aleksandrov * Send Q(G,A-Y) 25575bf1e00bSNikolay Aleksandrov * Group Timer=GMI 25585bf1e00bSNikolay Aleksandrov */ 2559adc47037SNikolay Aleksandrov static bool __grp_src_toex_excl(struct net_bridge_mcast *brmctx, 2560adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2561adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2562ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2563ddc255d9SNikolay Aleksandrov int grec_type) 25645bf1e00bSNikolay Aleksandrov { 25655bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 25665bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 25675bf1e00bSNikolay Aleksandrov bool changed = false; 25685bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 25695bf1e00bSNikolay Aleksandrov 25705bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 25715bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 25725bf1e00bSNikolay Aleksandrov 25735bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2574085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 25755bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2576e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 25775bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 25785bf1e00bSNikolay Aleksandrov if (ent) { 25795bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 25805bf1e00bSNikolay Aleksandrov } else { 25815bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 25825bf1e00bSNikolay Aleksandrov if (ent) { 2583b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 25845bf1e00bSNikolay Aleksandrov changed = true; 25855bf1e00bSNikolay Aleksandrov } 25865bf1e00bSNikolay Aleksandrov } 25875bf1e00bSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 25885bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 25895bf1e00bSNikolay Aleksandrov to_send++; 25905bf1e00bSNikolay Aleksandrov } 25915bf1e00bSNikolay Aleksandrov } 25925bf1e00bSNikolay Aleksandrov 2593adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2594adc47037SNikolay Aleksandrov grec_type)) 2595ddc255d9SNikolay Aleksandrov changed = true; 2596ddc255d9SNikolay Aleksandrov 25975bf1e00bSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 25985bf1e00bSNikolay Aleksandrov changed = true; 25995bf1e00bSNikolay Aleksandrov if (to_send) 2600adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 26015bf1e00bSNikolay Aleksandrov 26025bf1e00bSNikolay Aleksandrov return changed; 26035bf1e00bSNikolay Aleksandrov } 26045bf1e00bSNikolay Aleksandrov 2605adc47037SNikolay Aleksandrov static bool br_multicast_toex(struct net_bridge_mcast *brmctx, 2606adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2607adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2608ddc255d9SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, 2609ddc255d9SNikolay Aleksandrov int grec_type) 26105bf1e00bSNikolay Aleksandrov { 26115bf1e00bSNikolay Aleksandrov bool changed = false; 26125bf1e00bSNikolay Aleksandrov 26135bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 26145bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 2615adc47037SNikolay Aleksandrov __grp_src_toex_incl(brmctx, pmctx, pg, h_addr, srcs, nsrcs, 2616adc47037SNikolay Aleksandrov addr_size, grec_type); 26178266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 26185bf1e00bSNikolay Aleksandrov changed = true; 26195bf1e00bSNikolay Aleksandrov break; 26205bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 2621adc47037SNikolay Aleksandrov changed = __grp_src_toex_excl(brmctx, pmctx, pg, h_addr, srcs, 2622adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 26235bf1e00bSNikolay Aleksandrov break; 26245bf1e00bSNikolay Aleksandrov } 26255bf1e00bSNikolay Aleksandrov 26265bf1e00bSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 2627adc47037SNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(brmctx)); 26285bf1e00bSNikolay Aleksandrov 26295bf1e00bSNikolay Aleksandrov return changed; 26305bf1e00bSNikolay Aleksandrov } 26315bf1e00bSNikolay Aleksandrov 2632109865feSNikolay Aleksandrov /* State Msg type New state Actions 2633109865feSNikolay Aleksandrov * INCLUDE (A) BLOCK (B) INCLUDE (A) Send Q(G,A*B) 2634109865feSNikolay Aleksandrov */ 2635adc47037SNikolay Aleksandrov static bool __grp_src_block_incl(struct net_bridge_mcast *brmctx, 2636adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2637adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2638474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2639109865feSNikolay Aleksandrov { 2640109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2641109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 26420ad57c99SNikolay Aleksandrov bool changed = false; 2643109865feSNikolay Aleksandrov struct br_ip src_ip; 2644109865feSNikolay Aleksandrov 2645109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2646109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2647109865feSNikolay Aleksandrov 2648109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2649085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2650109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2651e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2652109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2653109865feSNikolay Aleksandrov if (ent) { 2654109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2655109865feSNikolay Aleksandrov to_send++; 2656109865feSNikolay Aleksandrov } 2657109865feSNikolay Aleksandrov } 2658109865feSNikolay Aleksandrov 2659adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2660adc47037SNikolay Aleksandrov grec_type)) 2661474ddb37SNikolay Aleksandrov changed = true; 2662474ddb37SNikolay Aleksandrov 2663109865feSNikolay Aleksandrov if (to_send) 2664adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 2665109865feSNikolay Aleksandrov 26660ad57c99SNikolay Aleksandrov return changed; 2667109865feSNikolay Aleksandrov } 2668109865feSNikolay Aleksandrov 2669109865feSNikolay Aleksandrov /* State Msg type New state Actions 2670109865feSNikolay Aleksandrov * EXCLUDE (X,Y) BLOCK (A) EXCLUDE (X+(A-Y),Y) (A-X-Y)=Group Timer 2671109865feSNikolay Aleksandrov * Send Q(G,A-Y) 2672109865feSNikolay Aleksandrov */ 2673adc47037SNikolay Aleksandrov static bool __grp_src_block_excl(struct net_bridge_mcast *brmctx, 2674adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2675adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2676474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2677109865feSNikolay Aleksandrov { 2678109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2679109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 2680109865feSNikolay Aleksandrov bool changed = false; 2681109865feSNikolay Aleksandrov struct br_ip src_ip; 2682109865feSNikolay Aleksandrov 2683109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2684109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2685109865feSNikolay Aleksandrov 2686109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2687085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2688109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2689e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2690109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2691109865feSNikolay Aleksandrov if (!ent) { 2692109865feSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2693109865feSNikolay Aleksandrov if (ent) { 2694b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 2695109865feSNikolay Aleksandrov changed = true; 2696109865feSNikolay Aleksandrov } 2697109865feSNikolay Aleksandrov } 2698109865feSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 2699109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2700109865feSNikolay Aleksandrov to_send++; 2701109865feSNikolay Aleksandrov } 2702109865feSNikolay Aleksandrov } 2703109865feSNikolay Aleksandrov 2704adc47037SNikolay Aleksandrov if (br_multicast_eht_handle(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 2705adc47037SNikolay Aleksandrov grec_type)) 2706474ddb37SNikolay Aleksandrov changed = true; 2707474ddb37SNikolay Aleksandrov 2708109865feSNikolay Aleksandrov if (to_send) 2709adc47037SNikolay Aleksandrov __grp_src_query_marked_and_rexmit(brmctx, pmctx, pg); 2710109865feSNikolay Aleksandrov 2711109865feSNikolay Aleksandrov return changed; 2712109865feSNikolay Aleksandrov } 2713109865feSNikolay Aleksandrov 2714adc47037SNikolay Aleksandrov static bool br_multicast_block(struct net_bridge_mcast *brmctx, 2715adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 2716adc47037SNikolay Aleksandrov struct net_bridge_port_group *pg, void *h_addr, 2717474ddb37SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size, int grec_type) 2718109865feSNikolay Aleksandrov { 2719109865feSNikolay Aleksandrov bool changed = false; 2720109865feSNikolay Aleksandrov 2721109865feSNikolay Aleksandrov switch (pg->filter_mode) { 2722109865feSNikolay Aleksandrov case MCAST_INCLUDE: 2723adc47037SNikolay Aleksandrov changed = __grp_src_block_incl(brmctx, pmctx, pg, h_addr, srcs, 2724adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 2725109865feSNikolay Aleksandrov break; 2726109865feSNikolay Aleksandrov case MCAST_EXCLUDE: 2727adc47037SNikolay Aleksandrov changed = __grp_src_block_excl(brmctx, pmctx, pg, h_addr, srcs, 2728adc47037SNikolay Aleksandrov nsrcs, addr_size, grec_type); 2729109865feSNikolay Aleksandrov break; 2730109865feSNikolay Aleksandrov } 2731109865feSNikolay Aleksandrov 2732e87e4b5cSNikolay Aleksandrov if ((pg->filter_mode == MCAST_INCLUDE && hlist_empty(&pg->src_list)) || 2733e87e4b5cSNikolay Aleksandrov br_multicast_eht_should_del_pg(pg)) { 2734d5a10222SNikolay Aleksandrov if (br_multicast_eht_should_del_pg(pg)) 2735d5a10222SNikolay Aleksandrov pg->flags |= MDB_PG_FLAGS_FAST_LEAVE; 2736e87e4b5cSNikolay Aleksandrov br_multicast_find_del_pg(pg->key.port->br, pg); 2737e87e4b5cSNikolay Aleksandrov /* a notification has already been sent and we shouldn't 2738e87e4b5cSNikolay Aleksandrov * access pg after the delete so we have to return false 2739e87e4b5cSNikolay Aleksandrov */ 2740e87e4b5cSNikolay Aleksandrov changed = false; 2741e87e4b5cSNikolay Aleksandrov } 2742e87e4b5cSNikolay Aleksandrov 2743109865feSNikolay Aleksandrov return changed; 2744109865feSNikolay Aleksandrov } 2745109865feSNikolay Aleksandrov 27460436862eSNikolay Aleksandrov static struct net_bridge_port_group * 27470436862eSNikolay Aleksandrov br_multicast_find_port(struct net_bridge_mdb_entry *mp, 27480436862eSNikolay Aleksandrov struct net_bridge_port *p, 27490436862eSNikolay Aleksandrov const unsigned char *src) 27500436862eSNikolay Aleksandrov { 2751071445c6SNikolay Aleksandrov struct net_bridge *br __maybe_unused = mp->br; 27520436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 27530436862eSNikolay Aleksandrov 27540436862eSNikolay Aleksandrov for (pg = mlock_dereference(mp->ports, br); 27550436862eSNikolay Aleksandrov pg; 27560436862eSNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) 27570436862eSNikolay Aleksandrov if (br_port_group_equal(pg, p, src)) 27580436862eSNikolay Aleksandrov return pg; 27590436862eSNikolay Aleksandrov 27600436862eSNikolay Aleksandrov return NULL; 27610436862eSNikolay Aleksandrov } 27620436862eSNikolay Aleksandrov 2763adc47037SNikolay Aleksandrov static int br_ip4_multicast_igmp3_report(struct net_bridge_mcast *brmctx, 2764adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 276506499098SVlad Yasevich struct sk_buff *skb, 276606499098SVlad Yasevich u16 vid) 2767eb1d1641SHerbert Xu { 2768adc47037SNikolay Aleksandrov bool igmpv2 = brmctx->multicast_igmp_version == 2; 27690436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 27700436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 27716db6f0eaSFelix Fietkau const unsigned char *src; 2772eb1d1641SHerbert Xu struct igmpv3_report *ih; 2773eb1d1641SHerbert Xu struct igmpv3_grec *grec; 27740436862eSNikolay Aleksandrov int i, len, num, type; 277554bea721SNikolay Aleksandrov __be32 group, *h_addr; 27760436862eSNikolay Aleksandrov bool changed = false; 27770436862eSNikolay Aleksandrov int err = 0; 2778e57f6185SNikolay Aleksandrov u16 nsrcs; 2779eb1d1641SHerbert Xu 2780eb1d1641SHerbert Xu ih = igmpv3_report_hdr(skb); 2781eb1d1641SHerbert Xu num = ntohs(ih->ngrec); 2782c2d4fbd2SLinus Lüssing len = skb_transport_offset(skb) + sizeof(*ih); 2783eb1d1641SHerbert Xu 2784eb1d1641SHerbert Xu for (i = 0; i < num; i++) { 2785eb1d1641SHerbert Xu len += sizeof(*grec); 2786ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2787eb1d1641SHerbert Xu return -EINVAL; 2788eb1d1641SHerbert Xu 2789fd218cf9SHerbert Xu grec = (void *)(skb->data + len - sizeof(*grec)); 2790eb1d1641SHerbert Xu group = grec->grec_mca; 2791eb1d1641SHerbert Xu type = grec->grec_type; 2792e57f6185SNikolay Aleksandrov nsrcs = ntohs(grec->grec_nsrcs); 2793eb1d1641SHerbert Xu 2794e57f6185SNikolay Aleksandrov len += nsrcs * 4; 2795ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2796eb1d1641SHerbert Xu return -EINVAL; 2797eb1d1641SHerbert Xu 2798eb1d1641SHerbert Xu switch (type) { 2799eb1d1641SHerbert Xu case IGMPV3_MODE_IS_INCLUDE: 2800eb1d1641SHerbert Xu case IGMPV3_MODE_IS_EXCLUDE: 2801eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_INCLUDE: 2802eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_EXCLUDE: 2803eb1d1641SHerbert Xu case IGMPV3_ALLOW_NEW_SOURCES: 2804eb1d1641SHerbert Xu case IGMPV3_BLOCK_OLD_SOURCES: 2805eb1d1641SHerbert Xu break; 2806eb1d1641SHerbert Xu 2807eb1d1641SHerbert Xu default: 2808eb1d1641SHerbert Xu continue; 2809eb1d1641SHerbert Xu } 2810eb1d1641SHerbert Xu 28116db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 28120436862eSNikolay Aleksandrov if (nsrcs == 0 && 28130436862eSNikolay Aleksandrov (type == IGMPV3_CHANGE_TO_INCLUDE || 28140436862eSNikolay Aleksandrov type == IGMPV3_MODE_IS_INCLUDE)) { 2815adc47037SNikolay Aleksandrov if (!pmctx || igmpv2) { 2816adc47037SNikolay Aleksandrov br_ip4_multicast_leave_group(brmctx, pmctx, 2817adc47037SNikolay Aleksandrov group, vid, src); 28180436862eSNikolay Aleksandrov continue; 28190436862eSNikolay Aleksandrov } 2820bc8c20acSSatish Ashok } else { 2821adc47037SNikolay Aleksandrov err = br_ip4_multicast_add_group(brmctx, pmctx, group, 2822adc47037SNikolay Aleksandrov vid, src, igmpv2); 2823eb1d1641SHerbert Xu if (err) 2824eb1d1641SHerbert Xu break; 2825eb1d1641SHerbert Xu } 28260436862eSNikolay Aleksandrov 2827adc47037SNikolay Aleksandrov if (!pmctx || igmpv2) 28280436862eSNikolay Aleksandrov continue; 28290436862eSNikolay Aleksandrov 2830262985faSIdo Schimmel spin_lock(&brmctx->br->multicast_lock); 28314cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 28324cdd0d10SNikolay Aleksandrov goto unlock_continue; 28334cdd0d10SNikolay Aleksandrov 2834adc47037SNikolay Aleksandrov mdst = br_mdb_ip4_get(brmctx->br, group, vid); 28350436862eSNikolay Aleksandrov if (!mdst) 28360436862eSNikolay Aleksandrov goto unlock_continue; 2837adc47037SNikolay Aleksandrov pg = br_multicast_find_port(mdst, pmctx->port, src); 28380436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 28390436862eSNikolay Aleksandrov goto unlock_continue; 284054bea721SNikolay Aleksandrov /* reload grec and host addr */ 28410436862eSNikolay Aleksandrov grec = (void *)(skb->data + len - sizeof(*grec) - (nsrcs * 4)); 284254bea721SNikolay Aleksandrov h_addr = &ip_hdr(skb)->saddr; 28430436862eSNikolay Aleksandrov switch (type) { 28440436862eSNikolay Aleksandrov case IGMPV3_ALLOW_NEW_SOURCES: 2845adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 2846adc47037SNikolay Aleksandrov grec->grec_src, 2847474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 28480436862eSNikolay Aleksandrov break; 2849e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_INCLUDE: 2850adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 2851adc47037SNikolay Aleksandrov grec->grec_src, 2852474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2853e6231bcaSNikolay Aleksandrov break; 2854e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_EXCLUDE: 2855adc47037SNikolay Aleksandrov changed = br_multicast_isexc(brmctx, pg, h_addr, 2856adc47037SNikolay Aleksandrov grec->grec_src, 2857ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2858e6231bcaSNikolay Aleksandrov break; 28595bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_INCLUDE: 2860adc47037SNikolay Aleksandrov changed = br_multicast_toin(brmctx, pmctx, pg, h_addr, 2861adc47037SNikolay Aleksandrov grec->grec_src, 2862ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 28635bf1e00bSNikolay Aleksandrov break; 28645bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_EXCLUDE: 2865adc47037SNikolay Aleksandrov changed = br_multicast_toex(brmctx, pmctx, pg, h_addr, 2866adc47037SNikolay Aleksandrov grec->grec_src, 2867ddc255d9SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 28685bf1e00bSNikolay Aleksandrov break; 2869109865feSNikolay Aleksandrov case IGMPV3_BLOCK_OLD_SOURCES: 2870adc47037SNikolay Aleksandrov changed = br_multicast_block(brmctx, pmctx, pg, h_addr, 2871adc47037SNikolay Aleksandrov grec->grec_src, 2872474ddb37SNikolay Aleksandrov nsrcs, sizeof(__be32), type); 2873109865feSNikolay Aleksandrov break; 28740436862eSNikolay Aleksandrov } 28750436862eSNikolay Aleksandrov if (changed) 2876adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mdst, pg, RTM_NEWMDB); 28770436862eSNikolay Aleksandrov unlock_continue: 2878262985faSIdo Schimmel spin_unlock(&brmctx->br->multicast_lock); 2879bc8c20acSSatish Ashok } 2880eb1d1641SHerbert Xu 2881eb1d1641SHerbert Xu return err; 2882eb1d1641SHerbert Xu } 2883eb1d1641SHerbert Xu 2884dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 2885adc47037SNikolay Aleksandrov static int br_ip6_multicast_mld2_report(struct net_bridge_mcast *brmctx, 2886adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 288706499098SVlad Yasevich struct sk_buff *skb, 288806499098SVlad Yasevich u16 vid) 288908b202b6SYOSHIFUJI Hideaki { 2890adc47037SNikolay Aleksandrov bool mldv1 = brmctx->multicast_mld_version == 1; 28910436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 28920436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 2893ba5ea614SLinus Lüssing unsigned int nsrcs_offset; 28946baeb395SMichelleJin struct mld2_report *mld2r; 28956db6f0eaSFelix Fietkau const unsigned char *src; 289654bea721SNikolay Aleksandrov struct in6_addr *h_addr; 289708b202b6SYOSHIFUJI Hideaki struct mld2_grec *grec; 2898ba5ea614SLinus Lüssing unsigned int grec_len; 28990436862eSNikolay Aleksandrov bool changed = false; 29000436862eSNikolay Aleksandrov int i, len, num; 290108b202b6SYOSHIFUJI Hideaki int err = 0; 290208b202b6SYOSHIFUJI Hideaki 29036baeb395SMichelleJin if (!ipv6_mc_may_pull(skb, sizeof(*mld2r))) 290408b202b6SYOSHIFUJI Hideaki return -EINVAL; 290508b202b6SYOSHIFUJI Hideaki 29066baeb395SMichelleJin mld2r = (struct mld2_report *)icmp6_hdr(skb); 29076baeb395SMichelleJin num = ntohs(mld2r->mld2r_ngrec); 29086baeb395SMichelleJin len = skb_transport_offset(skb) + sizeof(*mld2r); 290908b202b6SYOSHIFUJI Hideaki 291008b202b6SYOSHIFUJI Hideaki for (i = 0; i < num; i++) { 2911e57f6185SNikolay Aleksandrov __be16 *_nsrcs, __nsrcs; 2912e57f6185SNikolay Aleksandrov u16 nsrcs; 291308b202b6SYOSHIFUJI Hideaki 2914ba5ea614SLinus Lüssing nsrcs_offset = len + offsetof(struct mld2_grec, grec_nsrcs); 2915ba5ea614SLinus Lüssing 2916ba5ea614SLinus Lüssing if (skb_transport_offset(skb) + ipv6_transport_len(skb) < 29175fc6266aSLinus Lüssing nsrcs_offset + sizeof(__nsrcs)) 2918ba5ea614SLinus Lüssing return -EINVAL; 2919ba5ea614SLinus Lüssing 2920e57f6185SNikolay Aleksandrov _nsrcs = skb_header_pointer(skb, nsrcs_offset, 2921e57f6185SNikolay Aleksandrov sizeof(__nsrcs), &__nsrcs); 2922e57f6185SNikolay Aleksandrov if (!_nsrcs) 292308b202b6SYOSHIFUJI Hideaki return -EINVAL; 292408b202b6SYOSHIFUJI Hideaki 2925e57f6185SNikolay Aleksandrov nsrcs = ntohs(*_nsrcs); 2926e57f6185SNikolay Aleksandrov grec_len = struct_size(grec, grec_src, nsrcs); 2927ba5ea614SLinus Lüssing 2928ba5ea614SLinus Lüssing if (!ipv6_mc_may_pull(skb, len + grec_len)) 292908b202b6SYOSHIFUJI Hideaki return -EINVAL; 293008b202b6SYOSHIFUJI Hideaki 293108b202b6SYOSHIFUJI Hideaki grec = (struct mld2_grec *)(skb->data + len); 2932ba5ea614SLinus Lüssing len += grec_len; 293308b202b6SYOSHIFUJI Hideaki 293408b202b6SYOSHIFUJI Hideaki switch (grec->grec_type) { 293508b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_INCLUDE: 293608b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_EXCLUDE: 293708b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_INCLUDE: 293808b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_EXCLUDE: 293908b202b6SYOSHIFUJI Hideaki case MLD2_ALLOW_NEW_SOURCES: 294008b202b6SYOSHIFUJI Hideaki case MLD2_BLOCK_OLD_SOURCES: 294108b202b6SYOSHIFUJI Hideaki break; 294208b202b6SYOSHIFUJI Hideaki 294308b202b6SYOSHIFUJI Hideaki default: 294408b202b6SYOSHIFUJI Hideaki continue; 294508b202b6SYOSHIFUJI Hideaki } 294608b202b6SYOSHIFUJI Hideaki 29476db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 2948bc8c20acSSatish Ashok if ((grec->grec_type == MLD2_CHANGE_TO_INCLUDE || 2949bc8c20acSSatish Ashok grec->grec_type == MLD2_MODE_IS_INCLUDE) && 2950e57f6185SNikolay Aleksandrov nsrcs == 0) { 2951adc47037SNikolay Aleksandrov if (!pmctx || mldv1) { 2952adc47037SNikolay Aleksandrov br_ip6_multicast_leave_group(brmctx, pmctx, 29530436862eSNikolay Aleksandrov &grec->grec_mca, 29546db6f0eaSFelix Fietkau vid, src); 29550436862eSNikolay Aleksandrov continue; 29560436862eSNikolay Aleksandrov } 2957bc8c20acSSatish Ashok } else { 2958adc47037SNikolay Aleksandrov err = br_ip6_multicast_add_group(brmctx, pmctx, 29596db6f0eaSFelix Fietkau &grec->grec_mca, vid, 29600436862eSNikolay Aleksandrov src, mldv1); 29619264251eSDavide Caratti if (err) 296208b202b6SYOSHIFUJI Hideaki break; 296308b202b6SYOSHIFUJI Hideaki } 29640436862eSNikolay Aleksandrov 2965adc47037SNikolay Aleksandrov if (!pmctx || mldv1) 29660436862eSNikolay Aleksandrov continue; 29670436862eSNikolay Aleksandrov 2968262985faSIdo Schimmel spin_lock(&brmctx->br->multicast_lock); 29694cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 29704cdd0d10SNikolay Aleksandrov goto unlock_continue; 29714cdd0d10SNikolay Aleksandrov 2972adc47037SNikolay Aleksandrov mdst = br_mdb_ip6_get(brmctx->br, &grec->grec_mca, vid); 29730436862eSNikolay Aleksandrov if (!mdst) 29740436862eSNikolay Aleksandrov goto unlock_continue; 2975adc47037SNikolay Aleksandrov pg = br_multicast_find_port(mdst, pmctx->port, src); 29760436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 29770436862eSNikolay Aleksandrov goto unlock_continue; 297854bea721SNikolay Aleksandrov h_addr = &ipv6_hdr(skb)->saddr; 29790436862eSNikolay Aleksandrov switch (grec->grec_type) { 29800436862eSNikolay Aleksandrov case MLD2_ALLOW_NEW_SOURCES: 2981adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 298254bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2983474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 2984474ddb37SNikolay Aleksandrov grec->grec_type); 29850436862eSNikolay Aleksandrov break; 2986e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_INCLUDE: 2987adc47037SNikolay Aleksandrov changed = br_multicast_isinc_allow(brmctx, pg, h_addr, 298854bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2989474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 2990474ddb37SNikolay Aleksandrov grec->grec_type); 2991e6231bcaSNikolay Aleksandrov break; 2992e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_EXCLUDE: 2993adc47037SNikolay Aleksandrov changed = br_multicast_isexc(brmctx, pg, h_addr, 299454bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2995ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 2996ddc255d9SNikolay Aleksandrov grec->grec_type); 2997e6231bcaSNikolay Aleksandrov break; 29985bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_INCLUDE: 2999adc47037SNikolay Aleksandrov changed = br_multicast_toin(brmctx, pmctx, pg, h_addr, 300054bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 3001ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 3002ddc255d9SNikolay Aleksandrov grec->grec_type); 30035bf1e00bSNikolay Aleksandrov break; 30045bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_EXCLUDE: 3005adc47037SNikolay Aleksandrov changed = br_multicast_toex(brmctx, pmctx, pg, h_addr, 300654bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 3007ddc255d9SNikolay Aleksandrov sizeof(struct in6_addr), 3008ddc255d9SNikolay Aleksandrov grec->grec_type); 30095bf1e00bSNikolay Aleksandrov break; 3010109865feSNikolay Aleksandrov case MLD2_BLOCK_OLD_SOURCES: 3011adc47037SNikolay Aleksandrov changed = br_multicast_block(brmctx, pmctx, pg, h_addr, 301254bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 3013474ddb37SNikolay Aleksandrov sizeof(struct in6_addr), 3014474ddb37SNikolay Aleksandrov grec->grec_type); 3015109865feSNikolay Aleksandrov break; 30160436862eSNikolay Aleksandrov } 30170436862eSNikolay Aleksandrov if (changed) 3018adc47037SNikolay Aleksandrov br_mdb_notify(brmctx->br->dev, mdst, pg, RTM_NEWMDB); 30190436862eSNikolay Aleksandrov unlock_continue: 3020262985faSIdo Schimmel spin_unlock(&brmctx->br->multicast_lock); 3021bc8c20acSSatish Ashok } 302208b202b6SYOSHIFUJI Hideaki 302308b202b6SYOSHIFUJI Hideaki return err; 302408b202b6SYOSHIFUJI Hideaki } 302508b202b6SYOSHIFUJI Hideaki #endif 302608b202b6SYOSHIFUJI Hideaki 3027c3fb3698SNikolay Aleksandrov static bool br_multicast_select_querier(struct net_bridge_mcast *brmctx, 302854cb4319SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 302967b746f9SNikolay Aleksandrov struct br_ip *saddr) 3030dc4eb53aSLinus Lüssing { 303167b746f9SNikolay Aleksandrov int port_ifidx = pmctx ? pmctx->port->dev->ifindex : 0; 3032c3fb3698SNikolay Aleksandrov struct timer_list *own_timer, *other_timer; 3033c3fb3698SNikolay Aleksandrov struct bridge_mcast_querier *querier; 303454cb4319SNikolay Aleksandrov 3035c3fb3698SNikolay Aleksandrov switch (saddr->proto) { 3036c3fb3698SNikolay Aleksandrov case htons(ETH_P_IP): 3037c3fb3698SNikolay Aleksandrov querier = &brmctx->ip4_querier; 3038c3fb3698SNikolay Aleksandrov own_timer = &brmctx->ip4_own_query.timer; 3039c3fb3698SNikolay Aleksandrov other_timer = &brmctx->ip4_other_query.timer; 3040c3fb3698SNikolay Aleksandrov if (!querier->addr.src.ip4 || 3041c3fb3698SNikolay Aleksandrov ntohl(saddr->src.ip4) <= ntohl(querier->addr.src.ip4)) 3042dc4eb53aSLinus Lüssing goto update; 3043c3fb3698SNikolay Aleksandrov break; 3044dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3045c3fb3698SNikolay Aleksandrov case htons(ETH_P_IPV6): 3046c3fb3698SNikolay Aleksandrov querier = &brmctx->ip6_querier; 3047c3fb3698SNikolay Aleksandrov own_timer = &brmctx->ip6_own_query.timer; 3048c3fb3698SNikolay Aleksandrov other_timer = &brmctx->ip6_other_query.timer; 3049c3fb3698SNikolay Aleksandrov if (ipv6_addr_cmp(&saddr->src.ip6, &querier->addr.src.ip6) <= 0) 3050dc4eb53aSLinus Lüssing goto update; 3051c3fb3698SNikolay Aleksandrov break; 3052c3fb3698SNikolay Aleksandrov #endif 3053c3fb3698SNikolay Aleksandrov default: 3054c3fb3698SNikolay Aleksandrov return false; 3055c3fb3698SNikolay Aleksandrov } 3056dc4eb53aSLinus Lüssing 3057c3fb3698SNikolay Aleksandrov if (!timer_pending(own_timer) && !timer_pending(other_timer)) 3058dc4eb53aSLinus Lüssing goto update; 3059dc4eb53aSLinus Lüssing 3060dc4eb53aSLinus Lüssing return false; 3061dc4eb53aSLinus Lüssing 3062dc4eb53aSLinus Lüssing update: 3063c3fb3698SNikolay Aleksandrov br_multicast_update_querier(brmctx, querier, port_ifidx, saddr); 30642cd41431SLinus Lüssing 3065dc4eb53aSLinus Lüssing return true; 3066dc4eb53aSLinus Lüssing } 3067dc4eb53aSLinus Lüssing 3068c7fa1d9bSNikolay Aleksandrov static struct net_bridge_port * 3069c7fa1d9bSNikolay Aleksandrov __br_multicast_get_querier_port(struct net_bridge *br, 3070c7fa1d9bSNikolay Aleksandrov const struct bridge_mcast_querier *querier) 3071c7fa1d9bSNikolay Aleksandrov { 3072c7fa1d9bSNikolay Aleksandrov int port_ifidx = READ_ONCE(querier->port_ifidx); 3073c7fa1d9bSNikolay Aleksandrov struct net_bridge_port *p; 3074c7fa1d9bSNikolay Aleksandrov struct net_device *dev; 3075c7fa1d9bSNikolay Aleksandrov 3076c7fa1d9bSNikolay Aleksandrov if (port_ifidx == 0) 3077c7fa1d9bSNikolay Aleksandrov return NULL; 3078c7fa1d9bSNikolay Aleksandrov 3079c7fa1d9bSNikolay Aleksandrov dev = dev_get_by_index_rcu(dev_net(br->dev), port_ifidx); 3080c7fa1d9bSNikolay Aleksandrov if (!dev) 3081c7fa1d9bSNikolay Aleksandrov return NULL; 3082c7fa1d9bSNikolay Aleksandrov p = br_port_get_rtnl_rcu(dev); 3083c7fa1d9bSNikolay Aleksandrov if (!p || p->br != br) 3084c7fa1d9bSNikolay Aleksandrov return NULL; 3085c7fa1d9bSNikolay Aleksandrov 3086c7fa1d9bSNikolay Aleksandrov return p; 3087c7fa1d9bSNikolay Aleksandrov } 3088c7fa1d9bSNikolay Aleksandrov 3089c7fa1d9bSNikolay Aleksandrov size_t br_multicast_querier_state_size(void) 3090c7fa1d9bSNikolay Aleksandrov { 3091cdda378bSNikolay Aleksandrov return nla_total_size(0) + /* nest attribute */ 3092c7fa1d9bSNikolay Aleksandrov nla_total_size(sizeof(__be32)) + /* BRIDGE_QUERIER_IP_ADDRESS */ 3093c7fa1d9bSNikolay Aleksandrov nla_total_size(sizeof(int)) + /* BRIDGE_QUERIER_IP_PORT */ 3094175e6692SNikolay Aleksandrov nla_total_size_64bit(sizeof(u64)) + /* BRIDGE_QUERIER_IP_OTHER_TIMER */ 3095175e6692SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 3096175e6692SNikolay Aleksandrov nla_total_size(sizeof(struct in6_addr)) + /* BRIDGE_QUERIER_IPV6_ADDRESS */ 3097175e6692SNikolay Aleksandrov nla_total_size(sizeof(int)) + /* BRIDGE_QUERIER_IPV6_PORT */ 3098175e6692SNikolay Aleksandrov nla_total_size_64bit(sizeof(u64)) + /* BRIDGE_QUERIER_IPV6_OTHER_TIMER */ 3099175e6692SNikolay Aleksandrov #endif 3100175e6692SNikolay Aleksandrov 0; 3101c7fa1d9bSNikolay Aleksandrov } 3102c7fa1d9bSNikolay Aleksandrov 3103c7fa1d9bSNikolay Aleksandrov /* protected by rtnl or rcu */ 3104c7fa1d9bSNikolay Aleksandrov int br_multicast_dump_querier_state(struct sk_buff *skb, 3105c7fa1d9bSNikolay Aleksandrov const struct net_bridge_mcast *brmctx, 3106c7fa1d9bSNikolay Aleksandrov int nest_attr) 3107c7fa1d9bSNikolay Aleksandrov { 3108c7fa1d9bSNikolay Aleksandrov struct bridge_mcast_querier querier = {}; 3109c7fa1d9bSNikolay Aleksandrov struct net_bridge_port *p; 3110c7fa1d9bSNikolay Aleksandrov struct nlattr *nest; 3111c7fa1d9bSNikolay Aleksandrov 3112f137b7d4SNikolay Aleksandrov if (!br_opt_get(brmctx->br, BROPT_MULTICAST_ENABLED) || 3113f137b7d4SNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(brmctx)) 3114f137b7d4SNikolay Aleksandrov return 0; 3115f137b7d4SNikolay Aleksandrov 3116c7fa1d9bSNikolay Aleksandrov nest = nla_nest_start(skb, nest_attr); 3117c7fa1d9bSNikolay Aleksandrov if (!nest) 3118c7fa1d9bSNikolay Aleksandrov return -EMSGSIZE; 3119c7fa1d9bSNikolay Aleksandrov 3120c7fa1d9bSNikolay Aleksandrov rcu_read_lock(); 312185b41082SNikolay Aleksandrov if (!brmctx->multicast_querier && 312285b41082SNikolay Aleksandrov !timer_pending(&brmctx->ip4_other_query.timer)) 312385b41082SNikolay Aleksandrov goto out_v6; 312485b41082SNikolay Aleksandrov 3125c7fa1d9bSNikolay Aleksandrov br_multicast_read_querier(&brmctx->ip4_querier, &querier); 3126c7fa1d9bSNikolay Aleksandrov if (nla_put_in_addr(skb, BRIDGE_QUERIER_IP_ADDRESS, 3127c7fa1d9bSNikolay Aleksandrov querier.addr.src.ip4)) { 3128c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 3129c7fa1d9bSNikolay Aleksandrov goto out_err; 3130c7fa1d9bSNikolay Aleksandrov } 3131c7fa1d9bSNikolay Aleksandrov 3132c7fa1d9bSNikolay Aleksandrov p = __br_multicast_get_querier_port(brmctx->br, &querier); 3133c7fa1d9bSNikolay Aleksandrov if (timer_pending(&brmctx->ip4_other_query.timer) && 3134c7fa1d9bSNikolay Aleksandrov (nla_put_u64_64bit(skb, BRIDGE_QUERIER_IP_OTHER_TIMER, 3135c7fa1d9bSNikolay Aleksandrov br_timer_value(&brmctx->ip4_other_query.timer), 3136c7fa1d9bSNikolay Aleksandrov BRIDGE_QUERIER_PAD) || 3137c7fa1d9bSNikolay Aleksandrov (p && nla_put_u32(skb, BRIDGE_QUERIER_IP_PORT, p->dev->ifindex)))) { 3138c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 3139c7fa1d9bSNikolay Aleksandrov goto out_err; 3140c7fa1d9bSNikolay Aleksandrov } 314185b41082SNikolay Aleksandrov 314285b41082SNikolay Aleksandrov out_v6: 314385b41082SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 314485b41082SNikolay Aleksandrov if (!brmctx->multicast_querier && 314585b41082SNikolay Aleksandrov !timer_pending(&brmctx->ip6_other_query.timer)) 314685b41082SNikolay Aleksandrov goto out; 314785b41082SNikolay Aleksandrov 314885b41082SNikolay Aleksandrov br_multicast_read_querier(&brmctx->ip6_querier, &querier); 314985b41082SNikolay Aleksandrov if (nla_put_in6_addr(skb, BRIDGE_QUERIER_IPV6_ADDRESS, 315085b41082SNikolay Aleksandrov &querier.addr.src.ip6)) { 315185b41082SNikolay Aleksandrov rcu_read_unlock(); 315285b41082SNikolay Aleksandrov goto out_err; 315385b41082SNikolay Aleksandrov } 315485b41082SNikolay Aleksandrov 315585b41082SNikolay Aleksandrov p = __br_multicast_get_querier_port(brmctx->br, &querier); 315685b41082SNikolay Aleksandrov if (timer_pending(&brmctx->ip6_other_query.timer) && 315785b41082SNikolay Aleksandrov (nla_put_u64_64bit(skb, BRIDGE_QUERIER_IPV6_OTHER_TIMER, 315885b41082SNikolay Aleksandrov br_timer_value(&brmctx->ip6_other_query.timer), 315985b41082SNikolay Aleksandrov BRIDGE_QUERIER_PAD) || 316085b41082SNikolay Aleksandrov (p && nla_put_u32(skb, BRIDGE_QUERIER_IPV6_PORT, 316185b41082SNikolay Aleksandrov p->dev->ifindex)))) { 316285b41082SNikolay Aleksandrov rcu_read_unlock(); 316385b41082SNikolay Aleksandrov goto out_err; 316485b41082SNikolay Aleksandrov } 316585b41082SNikolay Aleksandrov out: 316685b41082SNikolay Aleksandrov #endif 3167c7fa1d9bSNikolay Aleksandrov rcu_read_unlock(); 3168c7fa1d9bSNikolay Aleksandrov nla_nest_end(skb, nest); 316985b41082SNikolay Aleksandrov if (!nla_len(nest)) 317085b41082SNikolay Aleksandrov nla_nest_cancel(skb, nest); 3171c7fa1d9bSNikolay Aleksandrov 3172c7fa1d9bSNikolay Aleksandrov return 0; 3173c7fa1d9bSNikolay Aleksandrov 3174c7fa1d9bSNikolay Aleksandrov out_err: 3175c7fa1d9bSNikolay Aleksandrov nla_nest_cancel(skb, nest); 3176c7fa1d9bSNikolay Aleksandrov return -EMSGSIZE; 3177c7fa1d9bSNikolay Aleksandrov } 3178c7fa1d9bSNikolay Aleksandrov 3179cc0fdd80SLinus Lüssing static void 3180adc47037SNikolay Aleksandrov br_multicast_update_query_timer(struct net_bridge_mcast *brmctx, 318190010b36SLinus Lüssing struct bridge_mcast_other_query *query, 3182b00589afSLinus Lüssing unsigned long max_delay) 3183b00589afSLinus Lüssing { 318490010b36SLinus Lüssing if (!timer_pending(&query->timer)) 318590010b36SLinus Lüssing query->delay_time = jiffies + max_delay; 3186b00589afSLinus Lüssing 3187adc47037SNikolay Aleksandrov mod_timer(&query->timer, jiffies + brmctx->multicast_querier_interval); 3188b00589afSLinus Lüssing } 3189b00589afSLinus Lüssing 31906d549648SNogah Frankel static void br_port_mc_router_state_change(struct net_bridge_port *p, 31916d549648SNogah Frankel bool is_mc_router) 31926d549648SNogah Frankel { 31936d549648SNogah Frankel struct switchdev_attr attr = { 31946d549648SNogah Frankel .orig_dev = p->dev, 31956d549648SNogah Frankel .id = SWITCHDEV_ATTR_ID_PORT_MROUTER, 31966d549648SNogah Frankel .flags = SWITCHDEV_F_DEFER, 31976d549648SNogah Frankel .u.mrouter = is_mc_router, 31986d549648SNogah Frankel }; 31996d549648SNogah Frankel 3200dcbdf135SVladimir Oltean switchdev_port_attr_set(p->dev, &attr, NULL); 32016d549648SNogah Frankel } 32026d549648SNogah Frankel 3203d9b8c4d8SLinus Lüssing static struct net_bridge_port * 3204d3d065c0SNikolay Aleksandrov br_multicast_rport_from_node(struct net_bridge_mcast *brmctx, 3205d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list, 3206d9b8c4d8SLinus Lüssing struct hlist_node *rlist) 3207d9b8c4d8SLinus Lüssing { 32089632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 32099632233eSNikolay Aleksandrov 3210a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3211d3d065c0SNikolay Aleksandrov if (mc_router_list == &brmctx->ip6_mc_router_list) 32129632233eSNikolay Aleksandrov pmctx = hlist_entry(rlist, struct net_bridge_mcast_port, 32139632233eSNikolay Aleksandrov ip6_rlist); 32149632233eSNikolay Aleksandrov else 3215a3c02e76SLinus Lüssing #endif 32169632233eSNikolay Aleksandrov pmctx = hlist_entry(rlist, struct net_bridge_mcast_port, 32179632233eSNikolay Aleksandrov ip4_rlist); 32189632233eSNikolay Aleksandrov 32199632233eSNikolay Aleksandrov return pmctx->port; 3220d9b8c4d8SLinus Lüssing } 3221d9b8c4d8SLinus Lüssing 3222d9b8c4d8SLinus Lüssing static struct hlist_node * 3223d3d065c0SNikolay Aleksandrov br_multicast_get_rport_slot(struct net_bridge_mcast *brmctx, 3224d9b8c4d8SLinus Lüssing struct net_bridge_port *port, 3225d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 3226d9b8c4d8SLinus Lüssing 3227d9b8c4d8SLinus Lüssing { 3228d9b8c4d8SLinus Lüssing struct hlist_node *slot = NULL; 3229d9b8c4d8SLinus Lüssing struct net_bridge_port *p; 3230d9b8c4d8SLinus Lüssing struct hlist_node *rlist; 3231d9b8c4d8SLinus Lüssing 3232d9b8c4d8SLinus Lüssing hlist_for_each(rlist, mc_router_list) { 3233d3d065c0SNikolay Aleksandrov p = br_multicast_rport_from_node(brmctx, mc_router_list, rlist); 3234d9b8c4d8SLinus Lüssing 3235d9b8c4d8SLinus Lüssing if ((unsigned long)port >= (unsigned long)p) 3236d9b8c4d8SLinus Lüssing break; 3237d9b8c4d8SLinus Lüssing 3238d9b8c4d8SLinus Lüssing slot = rlist; 3239d9b8c4d8SLinus Lüssing } 3240d9b8c4d8SLinus Lüssing 3241d9b8c4d8SLinus Lüssing return slot; 3242d9b8c4d8SLinus Lüssing } 3243d9b8c4d8SLinus Lüssing 3244adc47037SNikolay Aleksandrov static bool br_multicast_no_router_otherpf(struct net_bridge_mcast_port *pmctx, 3245a3c02e76SLinus Lüssing struct hlist_node *rnode) 3246a3c02e76SLinus Lüssing { 3247a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3248adc47037SNikolay Aleksandrov if (rnode != &pmctx->ip6_rlist) 3249adc47037SNikolay Aleksandrov return hlist_unhashed(&pmctx->ip6_rlist); 3250a3c02e76SLinus Lüssing else 3251adc47037SNikolay Aleksandrov return hlist_unhashed(&pmctx->ip4_rlist); 3252a3c02e76SLinus Lüssing #else 3253a3c02e76SLinus Lüssing return true; 3254a3c02e76SLinus Lüssing #endif 3255a3c02e76SLinus Lüssing } 3256a3c02e76SLinus Lüssing 3257d9b8c4d8SLinus Lüssing /* Add port to router_list 32587e80c124Sstephen hemminger * list is maintained ordered by pointer value 32597e80c124Sstephen hemminger * and locked by br->multicast_lock and RCU 32607e80c124Sstephen hemminger */ 3261d3d065c0SNikolay Aleksandrov static void br_multicast_add_router(struct net_bridge_mcast *brmctx, 3262adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3263d9b8c4d8SLinus Lüssing struct hlist_node *rlist, 3264d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 32650909e117SHerbert Xu { 3266d9b8c4d8SLinus Lüssing struct hlist_node *slot; 32670909e117SHerbert Xu 3268d9b8c4d8SLinus Lüssing if (!hlist_unhashed(rlist)) 32691a040eacSNikolay Aleksandrov return; 32701a040eacSNikolay Aleksandrov 3271adc47037SNikolay Aleksandrov slot = br_multicast_get_rport_slot(brmctx, pmctx->port, mc_router_list); 32720909e117SHerbert Xu 32737e80c124Sstephen hemminger if (slot) 3274d9b8c4d8SLinus Lüssing hlist_add_behind_rcu(rlist, slot); 3275dcdca2c4Sstephen hemminger else 3276d9b8c4d8SLinus Lüssing hlist_add_head_rcu(rlist, mc_router_list); 3277d9b8c4d8SLinus Lüssing 3278a3c02e76SLinus Lüssing /* For backwards compatibility for now, only notify if we 3279a3c02e76SLinus Lüssing * switched from no IPv4/IPv6 multicast router to a new 3280a3c02e76SLinus Lüssing * IPv4 or IPv6 multicast router. 3281a3c02e76SLinus Lüssing */ 3282adc47037SNikolay Aleksandrov if (br_multicast_no_router_otherpf(pmctx, rlist)) { 32831e9ca456SNikolay Aleksandrov br_rtr_notify(pmctx->port->br->dev, pmctx, RTM_NEWMDB); 3284adc47037SNikolay Aleksandrov br_port_mc_router_state_change(pmctx->port, true); 32850909e117SHerbert Xu } 3286a3c02e76SLinus Lüssing } 32870909e117SHerbert Xu 3288d9b8c4d8SLinus Lüssing /* Add port to router_list 3289d9b8c4d8SLinus Lüssing * list is maintained ordered by pointer value 3290d9b8c4d8SLinus Lüssing * and locked by br->multicast_lock and RCU 3291d9b8c4d8SLinus Lüssing */ 3292adc47037SNikolay Aleksandrov static void br_ip4_multicast_add_router(struct net_bridge_mcast *brmctx, 3293adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3294eb1d1641SHerbert Xu { 3295adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, &pmctx->ip4_rlist, 3296adc47037SNikolay Aleksandrov &brmctx->ip4_mc_router_list); 3297d9b8c4d8SLinus Lüssing } 3298d9b8c4d8SLinus Lüssing 3299a3c02e76SLinus Lüssing /* Add port to router_list 3300a3c02e76SLinus Lüssing * list is maintained ordered by pointer value 3301a3c02e76SLinus Lüssing * and locked by br->multicast_lock and RCU 3302a3c02e76SLinus Lüssing */ 3303adc47037SNikolay Aleksandrov static void br_ip6_multicast_add_router(struct net_bridge_mcast *brmctx, 3304adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3305a3c02e76SLinus Lüssing { 3306a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3307adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, &pmctx->ip6_rlist, 3308adc47037SNikolay Aleksandrov &brmctx->ip6_mc_router_list); 3309a3c02e76SLinus Lüssing #endif 3310a3c02e76SLinus Lüssing } 3311a3c02e76SLinus Lüssing 3312adc47037SNikolay Aleksandrov static void br_multicast_mark_router(struct net_bridge_mcast *brmctx, 3313adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3314d9b8c4d8SLinus Lüssing struct timer_list *timer, 3315d9b8c4d8SLinus Lüssing struct hlist_node *rlist, 3316d9b8c4d8SLinus Lüssing struct hlist_head *mc_router_list) 3317d9b8c4d8SLinus Lüssing { 3318eb1d1641SHerbert Xu unsigned long now = jiffies; 3319eb1d1641SHerbert Xu 33204cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 33214cdd0d10SNikolay Aleksandrov return; 33224cdd0d10SNikolay Aleksandrov 3323adc47037SNikolay Aleksandrov if (!pmctx) { 3324d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router == MDB_RTR_TYPE_TEMP_QUERY) { 3325d3d065c0SNikolay Aleksandrov if (!br_ip4_multicast_is_router(brmctx) && 3326d3d065c0SNikolay Aleksandrov !br_ip6_multicast_is_router(brmctx)) 3327adc47037SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, true); 3328d3d065c0SNikolay Aleksandrov mod_timer(timer, now + brmctx->multicast_querier_interval); 332977041420SYotam Gigi } 3330eb1d1641SHerbert Xu return; 3331eb1d1641SHerbert Xu } 3332eb1d1641SHerbert Xu 3333adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_DISABLED || 3334adc47037SNikolay Aleksandrov pmctx->multicast_router == MDB_RTR_TYPE_PERM) 3335eb1d1641SHerbert Xu return; 3336eb1d1641SHerbert Xu 3337adc47037SNikolay Aleksandrov br_multicast_add_router(brmctx, pmctx, rlist, mc_router_list); 3338d3d065c0SNikolay Aleksandrov mod_timer(timer, now + brmctx->multicast_querier_interval); 3339d9b8c4d8SLinus Lüssing } 3340eb1d1641SHerbert Xu 3341adc47037SNikolay Aleksandrov static void br_ip4_multicast_mark_router(struct net_bridge_mcast *brmctx, 3342adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3343d9b8c4d8SLinus Lüssing { 3344adc47037SNikolay Aleksandrov struct timer_list *timer = &brmctx->ip4_mc_router_timer; 3345d9b8c4d8SLinus Lüssing struct hlist_node *rlist = NULL; 3346d9b8c4d8SLinus Lüssing 3347adc47037SNikolay Aleksandrov if (pmctx) { 3348adc47037SNikolay Aleksandrov timer = &pmctx->ip4_mc_router_timer; 3349adc47037SNikolay Aleksandrov rlist = &pmctx->ip4_rlist; 3350d9b8c4d8SLinus Lüssing } 3351d9b8c4d8SLinus Lüssing 3352adc47037SNikolay Aleksandrov br_multicast_mark_router(brmctx, pmctx, timer, rlist, 3353adc47037SNikolay Aleksandrov &brmctx->ip4_mc_router_list); 3354eb1d1641SHerbert Xu } 3355eb1d1641SHerbert Xu 3356adc47037SNikolay Aleksandrov static void br_ip6_multicast_mark_router(struct net_bridge_mcast *brmctx, 3357adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx) 3358a3c02e76SLinus Lüssing { 3359a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3360adc47037SNikolay Aleksandrov struct timer_list *timer = &brmctx->ip6_mc_router_timer; 3361a3c02e76SLinus Lüssing struct hlist_node *rlist = NULL; 3362a3c02e76SLinus Lüssing 3363adc47037SNikolay Aleksandrov if (pmctx) { 3364adc47037SNikolay Aleksandrov timer = &pmctx->ip6_mc_router_timer; 3365adc47037SNikolay Aleksandrov rlist = &pmctx->ip6_rlist; 3366a3c02e76SLinus Lüssing } 3367a3c02e76SLinus Lüssing 3368adc47037SNikolay Aleksandrov br_multicast_mark_router(brmctx, pmctx, timer, rlist, 3369adc47037SNikolay Aleksandrov &brmctx->ip6_mc_router_list); 3370a3c02e76SLinus Lüssing #endif 3371a3c02e76SLinus Lüssing } 3372a3c02e76SLinus Lüssing 3373b19232efSLinus Lüssing static void 3374adc47037SNikolay Aleksandrov br_ip4_multicast_query_received(struct net_bridge_mcast *brmctx, 3375adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 337690010b36SLinus Lüssing struct bridge_mcast_other_query *query, 3377dc4eb53aSLinus Lüssing struct br_ip *saddr, 3378b00589afSLinus Lüssing unsigned long max_delay) 3379eb1d1641SHerbert Xu { 3380c3fb3698SNikolay Aleksandrov if (!br_multicast_select_querier(brmctx, pmctx, saddr)) 3381eb1d1641SHerbert Xu return; 3382eb1d1641SHerbert Xu 3383adc47037SNikolay Aleksandrov br_multicast_update_query_timer(brmctx, query, max_delay); 3384adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3385eb1d1641SHerbert Xu } 3386eb1d1641SHerbert Xu 3387b19232efSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3388b19232efSLinus Lüssing static void 3389adc47037SNikolay Aleksandrov br_ip6_multicast_query_received(struct net_bridge_mcast *brmctx, 3390adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3391b19232efSLinus Lüssing struct bridge_mcast_other_query *query, 3392b19232efSLinus Lüssing struct br_ip *saddr, 3393b19232efSLinus Lüssing unsigned long max_delay) 3394b19232efSLinus Lüssing { 3395c3fb3698SNikolay Aleksandrov if (!br_multicast_select_querier(brmctx, pmctx, saddr)) 3396b19232efSLinus Lüssing return; 3397b19232efSLinus Lüssing 3398adc47037SNikolay Aleksandrov br_multicast_update_query_timer(brmctx, query, max_delay); 3399adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 3400b19232efSLinus Lüssing } 3401b19232efSLinus Lüssing #endif 3402b19232efSLinus Lüssing 3403adc47037SNikolay Aleksandrov static void br_ip4_multicast_query(struct net_bridge_mcast *brmctx, 3404adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 340506499098SVlad Yasevich struct sk_buff *skb, 340606499098SVlad Yasevich u16 vid) 3407eb1d1641SHerbert Xu { 3408ba5ea614SLinus Lüssing unsigned int transport_len = ip_transport_len(skb); 3409b71d1d42SEric Dumazet const struct iphdr *iph = ip_hdr(skb); 3410eb1d1641SHerbert Xu struct igmphdr *ih = igmp_hdr(skb); 3411eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 3412eb1d1641SHerbert Xu struct igmpv3_query *ih3; 3413eb1d1641SHerbert Xu struct net_bridge_port_group *p; 3414e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 341567b746f9SNikolay Aleksandrov struct br_ip saddr = {}; 3416eb1d1641SHerbert Xu unsigned long max_delay; 3417eb1d1641SHerbert Xu unsigned long now = jiffies; 3418eb1d1641SHerbert Xu __be32 group; 3419eb1d1641SHerbert Xu 3420adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 34214cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 3422eb1d1641SHerbert Xu goto out; 3423eb1d1641SHerbert Xu 3424eb1d1641SHerbert Xu group = ih->group; 3425eb1d1641SHerbert Xu 3426ba5ea614SLinus Lüssing if (transport_len == sizeof(*ih)) { 3427eb1d1641SHerbert Xu max_delay = ih->code * (HZ / IGMP_TIMER_SCALE); 3428eb1d1641SHerbert Xu 3429eb1d1641SHerbert Xu if (!max_delay) { 3430eb1d1641SHerbert Xu max_delay = 10 * HZ; 3431eb1d1641SHerbert Xu group = 0; 3432eb1d1641SHerbert Xu } 3433ba5ea614SLinus Lüssing } else if (transport_len >= sizeof(*ih3)) { 3434eb1d1641SHerbert Xu ih3 = igmpv3_query_hdr(skb); 343523550b83SNikolay Aleksandrov if (ih3->nsrcs || 3436d3d065c0SNikolay Aleksandrov (brmctx->multicast_igmp_version == 3 && group && 3437d3d065c0SNikolay Aleksandrov ih3->suppress)) 3438bec68ff1SYOSHIFUJI Hideaki goto out; 3439eb1d1641SHerbert Xu 34400ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 max_delay = ih3->code ? 34410ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 IGMPV3_MRC(ih3->code) * (HZ / IGMP_TIMER_SCALE) : 1; 34429afd85c9SLinus Lüssing } else { 34439ed973ccSLinus Lüssing goto out; 34449ed973ccSLinus Lüssing } 34459ed973ccSLinus Lüssing 3446dc4eb53aSLinus Lüssing if (!group) { 3447dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IP); 3448deb96566SNikolay Aleksandrov saddr.src.ip4 = iph->saddr; 3449b00589afSLinus Lüssing 3450adc47037SNikolay Aleksandrov br_ip4_multicast_query_received(brmctx, pmctx, 3451d3d065c0SNikolay Aleksandrov &brmctx->ip4_other_query, 3452dc4eb53aSLinus Lüssing &saddr, max_delay); 3453eb1d1641SHerbert Xu goto out; 3454dc4eb53aSLinus Lüssing } 3455eb1d1641SHerbert Xu 3456adc47037SNikolay Aleksandrov mp = br_mdb_ip4_get(brmctx->br, group, vid); 3457eb1d1641SHerbert Xu if (!mp) 3458eb1d1641SHerbert Xu goto out; 3459eb1d1641SHerbert Xu 3460d3d065c0SNikolay Aleksandrov max_delay *= brmctx->multicast_last_member_count; 3461eb1d1641SHerbert Xu 3462ff0fd34eSAndrew Lunn if (mp->host_joined && 3463eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 3464eb1d1641SHerbert Xu time_after(mp->timer.expires, now + max_delay) : 3465eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) 3466eb1d1641SHerbert Xu mod_timer(&mp->timer, now + max_delay); 3467eb1d1641SHerbert Xu 3468e8051688SEric Dumazet for (pp = &mp->ports; 3469adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3470e8051688SEric Dumazet pp = &p->next) { 3471eb1d1641SHerbert Xu if (timer_pending(&p->timer) ? 3472eb1d1641SHerbert Xu time_after(p->timer.expires, now + max_delay) : 347323550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 3474d3d065c0SNikolay Aleksandrov (brmctx->multicast_igmp_version == 2 || 347523550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 347624f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 3477eb1d1641SHerbert Xu } 3478eb1d1641SHerbert Xu 3479eb1d1641SHerbert Xu out: 3480adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3481eb1d1641SHerbert Xu } 3482eb1d1641SHerbert Xu 3483dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3484adc47037SNikolay Aleksandrov static int br_ip6_multicast_query(struct net_bridge_mcast *brmctx, 3485adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 348606499098SVlad Yasevich struct sk_buff *skb, 348706499098SVlad Yasevich u16 vid) 348808b202b6SYOSHIFUJI Hideaki { 3489ba5ea614SLinus Lüssing unsigned int transport_len = ipv6_transport_len(skb); 3490eca2a43bSstephen hemminger struct mld_msg *mld; 349108b202b6SYOSHIFUJI Hideaki struct net_bridge_mdb_entry *mp; 349208b202b6SYOSHIFUJI Hideaki struct mld2_query *mld2q; 3493e8051688SEric Dumazet struct net_bridge_port_group *p; 3494e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 349567b746f9SNikolay Aleksandrov struct br_ip saddr = {}; 349608b202b6SYOSHIFUJI Hideaki unsigned long max_delay; 349708b202b6SYOSHIFUJI Hideaki unsigned long now = jiffies; 3498856ce5d0SLinus Lüssing unsigned int offset = skb_transport_offset(skb); 3499b71d1d42SEric Dumazet const struct in6_addr *group = NULL; 35009ed973ccSLinus Lüssing bool is_general_query; 350108b202b6SYOSHIFUJI Hideaki int err = 0; 350208b202b6SYOSHIFUJI Hideaki 3503adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 35044cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 350508b202b6SYOSHIFUJI Hideaki goto out; 350608b202b6SYOSHIFUJI Hideaki 3507ba5ea614SLinus Lüssing if (transport_len == sizeof(*mld)) { 3508856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld))) { 350908b202b6SYOSHIFUJI Hideaki err = -EINVAL; 351008b202b6SYOSHIFUJI Hideaki goto out; 351108b202b6SYOSHIFUJI Hideaki } 351208b202b6SYOSHIFUJI Hideaki mld = (struct mld_msg *) icmp6_hdr(skb); 35134715213dSLi RongQing max_delay = msecs_to_jiffies(ntohs(mld->mld_maxdelay)); 351408b202b6SYOSHIFUJI Hideaki if (max_delay) 351508b202b6SYOSHIFUJI Hideaki group = &mld->mld_mca; 3516248ba8ecSLinus Lüssing } else { 3517856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld2q))) { 351808b202b6SYOSHIFUJI Hideaki err = -EINVAL; 351908b202b6SYOSHIFUJI Hideaki goto out; 352008b202b6SYOSHIFUJI Hideaki } 352108b202b6SYOSHIFUJI Hideaki mld2q = (struct mld2_query *)icmp6_hdr(skb); 352208b202b6SYOSHIFUJI Hideaki if (!mld2q->mld2q_nsrcs) 352308b202b6SYOSHIFUJI Hideaki group = &mld2q->mld2q_mca; 3524d3d065c0SNikolay Aleksandrov if (brmctx->multicast_mld_version == 2 && 352523550b83SNikolay Aleksandrov !ipv6_addr_any(&mld2q->mld2q_mca) && 352623550b83SNikolay Aleksandrov mld2q->mld2q_suppress) 352723550b83SNikolay Aleksandrov goto out; 3528e3f5b170SDaniel Borkmann 3529e3f5b170SDaniel Borkmann max_delay = max(msecs_to_jiffies(mldv2_mrc(mld2q)), 1UL); 353008b202b6SYOSHIFUJI Hideaki } 353108b202b6SYOSHIFUJI Hideaki 35329ed973ccSLinus Lüssing is_general_query = group && ipv6_addr_any(group); 35339ed973ccSLinus Lüssing 3534dc4eb53aSLinus Lüssing if (is_general_query) { 3535dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IPV6); 3536deb96566SNikolay Aleksandrov saddr.src.ip6 = ipv6_hdr(skb)->saddr; 3537b00589afSLinus Lüssing 3538adc47037SNikolay Aleksandrov br_ip6_multicast_query_received(brmctx, pmctx, 3539d3d065c0SNikolay Aleksandrov &brmctx->ip6_other_query, 3540dc4eb53aSLinus Lüssing &saddr, max_delay); 354108b202b6SYOSHIFUJI Hideaki goto out; 35426c03ee8bSLinus Lüssing } else if (!group) { 35436c03ee8bSLinus Lüssing goto out; 3544dc4eb53aSLinus Lüssing } 354508b202b6SYOSHIFUJI Hideaki 3546adc47037SNikolay Aleksandrov mp = br_mdb_ip6_get(brmctx->br, group, vid); 354708b202b6SYOSHIFUJI Hideaki if (!mp) 354808b202b6SYOSHIFUJI Hideaki goto out; 354908b202b6SYOSHIFUJI Hideaki 3550d3d065c0SNikolay Aleksandrov max_delay *= brmctx->multicast_last_member_count; 3551ff0fd34eSAndrew Lunn if (mp->host_joined && 355208b202b6SYOSHIFUJI Hideaki (timer_pending(&mp->timer) ? 355308b202b6SYOSHIFUJI Hideaki time_after(mp->timer.expires, now + max_delay) : 355408b202b6SYOSHIFUJI Hideaki try_to_del_timer_sync(&mp->timer) >= 0)) 355508b202b6SYOSHIFUJI Hideaki mod_timer(&mp->timer, now + max_delay); 355608b202b6SYOSHIFUJI Hideaki 3557e8051688SEric Dumazet for (pp = &mp->ports; 3558adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3559e8051688SEric Dumazet pp = &p->next) { 356008b202b6SYOSHIFUJI Hideaki if (timer_pending(&p->timer) ? 356108b202b6SYOSHIFUJI Hideaki time_after(p->timer.expires, now + max_delay) : 356223550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 3563d3d065c0SNikolay Aleksandrov (brmctx->multicast_mld_version == 1 || 356423550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 356524f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 356608b202b6SYOSHIFUJI Hideaki } 356708b202b6SYOSHIFUJI Hideaki 356808b202b6SYOSHIFUJI Hideaki out: 3569adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 357008b202b6SYOSHIFUJI Hideaki return err; 357108b202b6SYOSHIFUJI Hideaki } 357208b202b6SYOSHIFUJI Hideaki #endif 357308b202b6SYOSHIFUJI Hideaki 357490010b36SLinus Lüssing static void 3575adc47037SNikolay Aleksandrov br_multicast_leave_group(struct net_bridge_mcast *brmctx, 3576adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3577cc0fdd80SLinus Lüssing struct br_ip *group, 357890010b36SLinus Lüssing struct bridge_mcast_other_query *other_query, 35796db6f0eaSFelix Fietkau struct bridge_mcast_own_query *own_query, 35806db6f0eaSFelix Fietkau const unsigned char *src) 3581eb1d1641SHerbert Xu { 3582eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 3583eb1d1641SHerbert Xu struct net_bridge_port_group *p; 3584eb1d1641SHerbert Xu unsigned long now; 3585eb1d1641SHerbert Xu unsigned long time; 3586eb1d1641SHerbert Xu 3587adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 35884cdd0d10SNikolay Aleksandrov if (!br_multicast_ctx_should_use(brmctx, pmctx)) 3589eb1d1641SHerbert Xu goto out; 3590eb1d1641SHerbert Xu 3591adc47037SNikolay Aleksandrov mp = br_mdb_ip_get(brmctx->br, group); 3592eb1d1641SHerbert Xu if (!mp) 3593eb1d1641SHerbert Xu goto out; 3594eb1d1641SHerbert Xu 3595adc47037SNikolay Aleksandrov if (pmctx && (pmctx->port->flags & BR_MULTICAST_FAST_LEAVE)) { 3596544586f7SSatish Ashok struct net_bridge_port_group __rcu **pp; 3597544586f7SSatish Ashok 3598544586f7SSatish Ashok for (pp = &mp->ports; 3599adc47037SNikolay Aleksandrov (p = mlock_dereference(*pp, brmctx->br)) != NULL; 3600544586f7SSatish Ashok pp = &p->next) { 3601adc47037SNikolay Aleksandrov if (!br_port_group_equal(p, pmctx->port, src)) 3602544586f7SSatish Ashok continue; 3603544586f7SSatish Ashok 36045c725b6bSNikolay Aleksandrov if (p->flags & MDB_PG_FLAGS_PERMANENT) 36055c725b6bSNikolay Aleksandrov break; 36065c725b6bSNikolay Aleksandrov 3607681590bdSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_FAST_LEAVE; 3608681590bdSNikolay Aleksandrov br_multicast_del_pg(mp, p, pp); 3609544586f7SSatish Ashok } 3610544586f7SSatish Ashok goto out; 3611544586f7SSatish Ashok } 3612544586f7SSatish Ashok 3613544586f7SSatish Ashok if (timer_pending(&other_query->timer)) 3614544586f7SSatish Ashok goto out; 3615544586f7SSatish Ashok 36164d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier) { 3617adc47037SNikolay Aleksandrov __br_multicast_send_query(brmctx, pmctx, NULL, NULL, &mp->addr, 361842c11ccfSNikolay Aleksandrov false, 0, NULL); 36196b7df111SCong Wang 3620d3d065c0SNikolay Aleksandrov time = jiffies + brmctx->multicast_last_member_count * 3621d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval; 3622cc0fdd80SLinus Lüssing 362390010b36SLinus Lüssing mod_timer(&own_query->timer, time); 36246b7df111SCong Wang 3625adc47037SNikolay Aleksandrov for (p = mlock_dereference(mp->ports, brmctx->br); 362654cb4319SNikolay Aleksandrov p != NULL && pmctx != NULL; 3627adc47037SNikolay Aleksandrov p = mlock_dereference(p->next, brmctx->br)) { 3628adc47037SNikolay Aleksandrov if (!br_port_group_equal(p, pmctx->port, src)) 36296b7df111SCong Wang continue; 36306b7df111SCong Wang 36316b7df111SCong Wang if (!hlist_unhashed(&p->mglist) && 36326b7df111SCong Wang (timer_pending(&p->timer) ? 36336b7df111SCong Wang time_after(p->timer.expires, time) : 36346b7df111SCong Wang try_to_del_timer_sync(&p->timer) >= 0)) { 36356b7df111SCong Wang mod_timer(&p->timer, time); 36366b7df111SCong Wang } 36376b7df111SCong Wang 36386b7df111SCong Wang break; 36396b7df111SCong Wang } 36406b7df111SCong Wang } 36416b7df111SCong Wang 3642eb1d1641SHerbert Xu now = jiffies; 3643d3d065c0SNikolay Aleksandrov time = now + brmctx->multicast_last_member_count * 3644d3d065c0SNikolay Aleksandrov brmctx->multicast_last_member_interval; 3645eb1d1641SHerbert Xu 3646adc47037SNikolay Aleksandrov if (!pmctx) { 3647ff0fd34eSAndrew Lunn if (mp->host_joined && 3648eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 3649eb1d1641SHerbert Xu time_after(mp->timer.expires, time) : 3650eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) { 3651eb1d1641SHerbert Xu mod_timer(&mp->timer, time); 3652eb1d1641SHerbert Xu } 3653454594f3SLinus Lüssing 3654454594f3SLinus Lüssing goto out; 3655454594f3SLinus Lüssing } 3656454594f3SLinus Lüssing 3657adc47037SNikolay Aleksandrov for (p = mlock_dereference(mp->ports, brmctx->br); 3658454594f3SLinus Lüssing p != NULL; 3659adc47037SNikolay Aleksandrov p = mlock_dereference(p->next, brmctx->br)) { 3660adc47037SNikolay Aleksandrov if (p->key.port != pmctx->port) 3661454594f3SLinus Lüssing continue; 3662454594f3SLinus Lüssing 3663454594f3SLinus Lüssing if (!hlist_unhashed(&p->mglist) && 3664454594f3SLinus Lüssing (timer_pending(&p->timer) ? 3665454594f3SLinus Lüssing time_after(p->timer.expires, time) : 3666454594f3SLinus Lüssing try_to_del_timer_sync(&p->timer) >= 0)) { 3667454594f3SLinus Lüssing mod_timer(&p->timer, time); 3668454594f3SLinus Lüssing } 3669454594f3SLinus Lüssing 3670454594f3SLinus Lüssing break; 3671eb1d1641SHerbert Xu } 3672eb1d1641SHerbert Xu out: 3673adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3674eb1d1641SHerbert Xu } 3675eb1d1641SHerbert Xu 3676adc47037SNikolay Aleksandrov static void br_ip4_multicast_leave_group(struct net_bridge_mcast *brmctx, 3677adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3678b0e9a30dSVlad Yasevich __be32 group, 36796db6f0eaSFelix Fietkau __u16 vid, 36806db6f0eaSFelix Fietkau const unsigned char *src) 36818ef2a9a5SYOSHIFUJI Hideaki { 36828ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 368390010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 36848ef2a9a5SYOSHIFUJI Hideaki 36858ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 36868ef2a9a5SYOSHIFUJI Hideaki return; 36878ef2a9a5SYOSHIFUJI Hideaki 3688adc47037SNikolay Aleksandrov own_query = pmctx ? &pmctx->ip4_own_query : &brmctx->ip4_own_query; 368990010b36SLinus Lüssing 36901515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 3691eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 36928ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 3693b0e9a30dSVlad Yasevich br_group.vid = vid; 36948ef2a9a5SYOSHIFUJI Hideaki 3695adc47037SNikolay Aleksandrov br_multicast_leave_group(brmctx, pmctx, &br_group, 3696adc47037SNikolay Aleksandrov &brmctx->ip4_other_query, 36976db6f0eaSFelix Fietkau own_query, src); 36988ef2a9a5SYOSHIFUJI Hideaki } 36998ef2a9a5SYOSHIFUJI Hideaki 3700dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3701adc47037SNikolay Aleksandrov static void br_ip6_multicast_leave_group(struct net_bridge_mcast *brmctx, 3702adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 3703b0e9a30dSVlad Yasevich const struct in6_addr *group, 37046db6f0eaSFelix Fietkau __u16 vid, 37056db6f0eaSFelix Fietkau const unsigned char *src) 370608b202b6SYOSHIFUJI Hideaki { 370708b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 370890010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 370908b202b6SYOSHIFUJI Hideaki 37103c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 371108b202b6SYOSHIFUJI Hideaki return; 371208b202b6SYOSHIFUJI Hideaki 3713adc47037SNikolay Aleksandrov own_query = pmctx ? &pmctx->ip6_own_query : &brmctx->ip6_own_query; 371490010b36SLinus Lüssing 37151515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 3716eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 371708b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 3718b0e9a30dSVlad Yasevich br_group.vid = vid; 371908b202b6SYOSHIFUJI Hideaki 3720adc47037SNikolay Aleksandrov br_multicast_leave_group(brmctx, pmctx, &br_group, 3721adc47037SNikolay Aleksandrov &brmctx->ip6_other_query, 37226db6f0eaSFelix Fietkau own_query, src); 372308b202b6SYOSHIFUJI Hideaki } 372408b202b6SYOSHIFUJI Hideaki #endif 37258ef2a9a5SYOSHIFUJI Hideaki 37261080ab95SNikolay Aleksandrov static void br_multicast_err_count(const struct net_bridge *br, 37271080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 37281080ab95SNikolay Aleksandrov __be16 proto) 37291080ab95SNikolay Aleksandrov { 37301080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 37311080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats; 37321080ab95SNikolay Aleksandrov 3733675779adSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 37341080ab95SNikolay Aleksandrov return; 37351080ab95SNikolay Aleksandrov 37361080ab95SNikolay Aleksandrov if (p) 37371080ab95SNikolay Aleksandrov stats = p->mcast_stats; 37381080ab95SNikolay Aleksandrov else 37391080ab95SNikolay Aleksandrov stats = br->mcast_stats; 37401080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 37411080ab95SNikolay Aleksandrov return; 37421080ab95SNikolay Aleksandrov 37431080ab95SNikolay Aleksandrov pstats = this_cpu_ptr(stats); 37441080ab95SNikolay Aleksandrov 37451080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 37461080ab95SNikolay Aleksandrov switch (proto) { 37471080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 37481080ab95SNikolay Aleksandrov pstats->mstats.igmp_parse_errors++; 37491080ab95SNikolay Aleksandrov break; 37501080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 37511080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 37521080ab95SNikolay Aleksandrov pstats->mstats.mld_parse_errors++; 37531080ab95SNikolay Aleksandrov break; 37541080ab95SNikolay Aleksandrov #endif 37551080ab95SNikolay Aleksandrov } 37561080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 37571080ab95SNikolay Aleksandrov } 37581080ab95SNikolay Aleksandrov 3759adc47037SNikolay Aleksandrov static void br_multicast_pim(struct net_bridge_mcast *brmctx, 3760adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 376191b02d3dSNikolay Aleksandrov const struct sk_buff *skb) 376291b02d3dSNikolay Aleksandrov { 376391b02d3dSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 376491b02d3dSNikolay Aleksandrov struct pimhdr *pimhdr, _pimhdr; 376591b02d3dSNikolay Aleksandrov 376691b02d3dSNikolay Aleksandrov pimhdr = skb_header_pointer(skb, offset, sizeof(_pimhdr), &_pimhdr); 376791b02d3dSNikolay Aleksandrov if (!pimhdr || pim_hdr_version(pimhdr) != PIM_VERSION || 376891b02d3dSNikolay Aleksandrov pim_hdr_type(pimhdr) != PIM_TYPE_HELLO) 376991b02d3dSNikolay Aleksandrov return; 377091b02d3dSNikolay Aleksandrov 3771adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3772adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3773adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 377491b02d3dSNikolay Aleksandrov } 377591b02d3dSNikolay Aleksandrov 3776adc47037SNikolay Aleksandrov static int br_ip4_multicast_mrd_rcv(struct net_bridge_mcast *brmctx, 3777adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 37784b3087c7SLinus Lüssing struct sk_buff *skb) 37794b3087c7SLinus Lüssing { 37804b3087c7SLinus Lüssing if (ip_hdr(skb)->protocol != IPPROTO_IGMP || 37814b3087c7SLinus Lüssing igmp_hdr(skb)->type != IGMP_MRDISC_ADV) 37824b3087c7SLinus Lüssing return -ENOMSG; 37834b3087c7SLinus Lüssing 3784adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3785adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 3786adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 37874b3087c7SLinus Lüssing 37884b3087c7SLinus Lüssing return 0; 37894b3087c7SLinus Lüssing } 37904b3087c7SLinus Lüssing 3791adc47037SNikolay Aleksandrov static int br_multicast_ipv4_rcv(struct net_bridge_mcast *brmctx, 3792adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 379306499098SVlad Yasevich struct sk_buff *skb, 379406499098SVlad Yasevich u16 vid) 3795eb1d1641SHerbert Xu { 3796adc47037SNikolay Aleksandrov struct net_bridge_port *p = pmctx ? pmctx->port : NULL; 37976db6f0eaSFelix Fietkau const unsigned char *src; 3798eb1d1641SHerbert Xu struct igmphdr *ih; 3799eb1d1641SHerbert Xu int err; 3800eb1d1641SHerbert Xu 3801ba5ea614SLinus Lüssing err = ip_mc_check_igmp(skb); 3802eb1d1641SHerbert Xu 38039afd85c9SLinus Lüssing if (err == -ENOMSG) { 380491b02d3dSNikolay Aleksandrov if (!ipv4_is_local_multicast(ip_hdr(skb)->daddr)) { 3805bd4265feSHerbert Xu BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 380691b02d3dSNikolay Aleksandrov } else if (pim_ipv4_all_pim_routers(ip_hdr(skb)->daddr)) { 380791b02d3dSNikolay Aleksandrov if (ip_hdr(skb)->protocol == IPPROTO_PIM) 3808adc47037SNikolay Aleksandrov br_multicast_pim(brmctx, pmctx, skb); 38094b3087c7SLinus Lüssing } else if (ipv4_is_all_snoopers(ip_hdr(skb)->daddr)) { 3810adc47037SNikolay Aleksandrov br_ip4_multicast_mrd_rcv(brmctx, pmctx, skb); 38114b3087c7SLinus Lüssing } 38124b3087c7SLinus Lüssing 3813eb1d1641SHerbert Xu return 0; 38149afd85c9SLinus Lüssing } else if (err < 0) { 3815adc47037SNikolay Aleksandrov br_multicast_err_count(brmctx->br, p, skb->protocol); 38169afd85c9SLinus Lüssing return err; 3817bd4265feSHerbert Xu } 3818eb1d1641SHerbert Xu 38199afd85c9SLinus Lüssing ih = igmp_hdr(skb); 38206db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 38211080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = ih->type; 3822eb1d1641SHerbert Xu 3823eb1d1641SHerbert Xu switch (ih->type) { 3824eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_REPORT: 3825eb1d1641SHerbert Xu case IGMPV2_HOST_MEMBERSHIP_REPORT: 382662b2bcb4SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 3827adc47037SNikolay Aleksandrov err = br_ip4_multicast_add_group(brmctx, pmctx, ih->group, vid, 3828adc47037SNikolay Aleksandrov src, true); 3829eb1d1641SHerbert Xu break; 3830eb1d1641SHerbert Xu case IGMPV3_HOST_MEMBERSHIP_REPORT: 3831adc47037SNikolay Aleksandrov err = br_ip4_multicast_igmp3_report(brmctx, pmctx, skb, vid); 3832eb1d1641SHerbert Xu break; 3833eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_QUERY: 3834adc47037SNikolay Aleksandrov br_ip4_multicast_query(brmctx, pmctx, skb, vid); 3835eb1d1641SHerbert Xu break; 3836eb1d1641SHerbert Xu case IGMP_HOST_LEAVE_MESSAGE: 3837adc47037SNikolay Aleksandrov br_ip4_multicast_leave_group(brmctx, pmctx, ih->group, vid, src); 3838eb1d1641SHerbert Xu break; 3839eb1d1641SHerbert Xu } 3840eb1d1641SHerbert Xu 3841adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, p, skb, BR_INPUT_SKB_CB(skb)->igmp, 38421080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 38431080ab95SNikolay Aleksandrov 3844eb1d1641SHerbert Xu return err; 3845eb1d1641SHerbert Xu } 3846eb1d1641SHerbert Xu 3847dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 3848adc47037SNikolay Aleksandrov static void br_ip6_multicast_mrd_rcv(struct net_bridge_mcast *brmctx, 3849adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 38504b3087c7SLinus Lüssing struct sk_buff *skb) 38514b3087c7SLinus Lüssing { 38524b3087c7SLinus Lüssing if (icmp6_hdr(skb)->icmp6_type != ICMPV6_MRDISC_ADV) 385399014088SLinus Lüssing return; 38544b3087c7SLinus Lüssing 3855adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 3856adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 3857adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 38584b3087c7SLinus Lüssing } 38594b3087c7SLinus Lüssing 3860adc47037SNikolay Aleksandrov static int br_multicast_ipv6_rcv(struct net_bridge_mcast *brmctx, 3861adc47037SNikolay Aleksandrov struct net_bridge_mcast_port *pmctx, 386206499098SVlad Yasevich struct sk_buff *skb, 386306499098SVlad Yasevich u16 vid) 386408b202b6SYOSHIFUJI Hideaki { 3865adc47037SNikolay Aleksandrov struct net_bridge_port *p = pmctx ? pmctx->port : NULL; 38666db6f0eaSFelix Fietkau const unsigned char *src; 38679afd85c9SLinus Lüssing struct mld_msg *mld; 386808b202b6SYOSHIFUJI Hideaki int err; 386908b202b6SYOSHIFUJI Hideaki 3870ba5ea614SLinus Lüssing err = ipv6_mc_check_mld(skb); 387108b202b6SYOSHIFUJI Hideaki 387299014088SLinus Lüssing if (err == -ENOMSG || err == -ENODATA) { 38739afd85c9SLinus Lüssing if (!ipv6_addr_is_ll_all_nodes(&ipv6_hdr(skb)->daddr)) 38748fad9c39SLinus Lüssing BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 387599014088SLinus Lüssing if (err == -ENODATA && 387699014088SLinus Lüssing ipv6_addr_is_all_snoopers(&ipv6_hdr(skb)->daddr)) 3877adc47037SNikolay Aleksandrov br_ip6_multicast_mrd_rcv(brmctx, pmctx, skb); 38784b3087c7SLinus Lüssing 387908b202b6SYOSHIFUJI Hideaki return 0; 38809afd85c9SLinus Lüssing } else if (err < 0) { 3881adc47037SNikolay Aleksandrov br_multicast_err_count(brmctx->br, p, skb->protocol); 38829afd85c9SLinus Lüssing return err; 388308b202b6SYOSHIFUJI Hideaki } 388408b202b6SYOSHIFUJI Hideaki 38859afd85c9SLinus Lüssing mld = (struct mld_msg *)skb_transport_header(skb); 38861080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = mld->mld_type; 388708b202b6SYOSHIFUJI Hideaki 38889afd85c9SLinus Lüssing switch (mld->mld_type) { 388908b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REPORT: 38906db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 3891fc2af6c7SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 3892adc47037SNikolay Aleksandrov err = br_ip6_multicast_add_group(brmctx, pmctx, &mld->mld_mca, 3893adc47037SNikolay Aleksandrov vid, src, true); 389408b202b6SYOSHIFUJI Hideaki break; 389508b202b6SYOSHIFUJI Hideaki case ICMPV6_MLD2_REPORT: 3896adc47037SNikolay Aleksandrov err = br_ip6_multicast_mld2_report(brmctx, pmctx, skb, vid); 389708b202b6SYOSHIFUJI Hideaki break; 389808b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_QUERY: 3899adc47037SNikolay Aleksandrov err = br_ip6_multicast_query(brmctx, pmctx, skb, vid); 390008b202b6SYOSHIFUJI Hideaki break; 390108b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REDUCTION: 39026db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 3903adc47037SNikolay Aleksandrov br_ip6_multicast_leave_group(brmctx, pmctx, &mld->mld_mca, vid, 3904adc47037SNikolay Aleksandrov src); 39059afd85c9SLinus Lüssing break; 390608b202b6SYOSHIFUJI Hideaki } 390708b202b6SYOSHIFUJI Hideaki 3908adc47037SNikolay Aleksandrov br_multicast_count(brmctx->br, p, skb, BR_INPUT_SKB_CB(skb)->igmp, 39091080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 39101080ab95SNikolay Aleksandrov 391108b202b6SYOSHIFUJI Hideaki return err; 391208b202b6SYOSHIFUJI Hideaki } 391308b202b6SYOSHIFUJI Hideaki #endif 391408b202b6SYOSHIFUJI Hideaki 3915f4b7002aSNikolay Aleksandrov int br_multicast_rcv(struct net_bridge_mcast **brmctx, 3916f4b7002aSNikolay Aleksandrov struct net_bridge_mcast_port **pmctx, 3917f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vlan, 391806499098SVlad Yasevich struct sk_buff *skb, u16 vid) 3919eb1d1641SHerbert Xu { 39201080ab95SNikolay Aleksandrov int ret = 0; 39211080ab95SNikolay Aleksandrov 39221fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->igmp = 0; 39231fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->mrouters_only = 0; 39241fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 3925f4b7002aSNikolay Aleksandrov if (!br_opt_get((*brmctx)->br, BROPT_MULTICAST_ENABLED)) 3926eb1d1641SHerbert Xu return 0; 3927eb1d1641SHerbert Xu 3928f4b7002aSNikolay Aleksandrov if (br_opt_get((*brmctx)->br, BROPT_MCAST_VLAN_SNOOPING_ENABLED) && vlan) { 3929f4b7002aSNikolay Aleksandrov const struct net_bridge_vlan *masterv; 3930f4b7002aSNikolay Aleksandrov 3931f4b7002aSNikolay Aleksandrov /* the vlan has the master flag set only when transmitting 3932f4b7002aSNikolay Aleksandrov * through the bridge device 3933f4b7002aSNikolay Aleksandrov */ 3934f4b7002aSNikolay Aleksandrov if (br_vlan_is_master(vlan)) { 3935f4b7002aSNikolay Aleksandrov masterv = vlan; 3936f4b7002aSNikolay Aleksandrov *brmctx = &vlan->br_mcast_ctx; 3937f4b7002aSNikolay Aleksandrov *pmctx = NULL; 3938f4b7002aSNikolay Aleksandrov } else { 3939f4b7002aSNikolay Aleksandrov masterv = vlan->brvlan; 3940f4b7002aSNikolay Aleksandrov *brmctx = &vlan->brvlan->br_mcast_ctx; 3941f4b7002aSNikolay Aleksandrov *pmctx = &vlan->port_mcast_ctx; 3942f4b7002aSNikolay Aleksandrov } 3943f4b7002aSNikolay Aleksandrov 3944f4b7002aSNikolay Aleksandrov if (!(masterv->priv_flags & BR_VLFLAG_GLOBAL_MCAST_ENABLED)) 3945f4b7002aSNikolay Aleksandrov return 0; 3946f4b7002aSNikolay Aleksandrov } 3947f4b7002aSNikolay Aleksandrov 3948eb1d1641SHerbert Xu switch (skb->protocol) { 3949eb1d1641SHerbert Xu case htons(ETH_P_IP): 3950f4b7002aSNikolay Aleksandrov ret = br_multicast_ipv4_rcv(*brmctx, *pmctx, skb, vid); 39511080ab95SNikolay Aleksandrov break; 3952dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 395308b202b6SYOSHIFUJI Hideaki case htons(ETH_P_IPV6): 3954f4b7002aSNikolay Aleksandrov ret = br_multicast_ipv6_rcv(*brmctx, *pmctx, skb, vid); 39551080ab95SNikolay Aleksandrov break; 395608b202b6SYOSHIFUJI Hideaki #endif 3957eb1d1641SHerbert Xu } 3958eb1d1641SHerbert Xu 39591080ab95SNikolay Aleksandrov return ret; 3960eb1d1641SHerbert Xu } 3961eb1d1641SHerbert Xu 3962adc47037SNikolay Aleksandrov static void br_multicast_query_expired(struct net_bridge_mcast *brmctx, 39632cd41431SLinus Lüssing struct bridge_mcast_own_query *query, 39642cd41431SLinus Lüssing struct bridge_mcast_querier *querier) 3965cc0fdd80SLinus Lüssing { 3966adc47037SNikolay Aleksandrov spin_lock(&brmctx->br->multicast_lock); 39674cdd0d10SNikolay Aleksandrov if (br_multicast_ctx_vlan_disabled(brmctx)) 39684cdd0d10SNikolay Aleksandrov goto out; 39694cdd0d10SNikolay Aleksandrov 3970adc47037SNikolay Aleksandrov if (query->startup_sent < brmctx->multicast_startup_query_count) 3971cc0fdd80SLinus Lüssing query->startup_sent++; 3972cc0fdd80SLinus Lüssing 3973adc47037SNikolay Aleksandrov br_multicast_send_query(brmctx, NULL, query); 39744cdd0d10SNikolay Aleksandrov out: 3975adc47037SNikolay Aleksandrov spin_unlock(&brmctx->br->multicast_lock); 3976cc0fdd80SLinus Lüssing } 3977cc0fdd80SLinus Lüssing 397888c1f37fSAllen Pais static void br_ip4_multicast_query_expired(struct timer_list *t) 3979eb1d1641SHerbert Xu { 3980d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 3981d3d065c0SNikolay Aleksandrov ip4_own_query.timer); 3982eb1d1641SHerbert Xu 3983adc47037SNikolay Aleksandrov br_multicast_query_expired(brmctx, &brmctx->ip4_own_query, 3984d3d065c0SNikolay Aleksandrov &brmctx->ip4_querier); 3985eb1d1641SHerbert Xu } 3986eb1d1641SHerbert Xu 3987cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 398888c1f37fSAllen Pais static void br_ip6_multicast_query_expired(struct timer_list *t) 3989cc0fdd80SLinus Lüssing { 3990d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx = from_timer(brmctx, t, 3991d3d065c0SNikolay Aleksandrov ip6_own_query.timer); 3992cc0fdd80SLinus Lüssing 3993adc47037SNikolay Aleksandrov br_multicast_query_expired(brmctx, &brmctx->ip6_own_query, 3994d3d065c0SNikolay Aleksandrov &brmctx->ip6_querier); 3995cc0fdd80SLinus Lüssing } 3996cc0fdd80SLinus Lüssing #endif 3997cc0fdd80SLinus Lüssing 3998e12cec65SNikolay Aleksandrov static void br_multicast_gc_work(struct work_struct *work) 39998b671779SNikolay Aleksandrov { 40008b671779SNikolay Aleksandrov struct net_bridge *br = container_of(work, struct net_bridge, 4001e12cec65SNikolay Aleksandrov mcast_gc_work); 40028b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 40038b671779SNikolay Aleksandrov 40048b671779SNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 4005e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 40068b671779SNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 40078b671779SNikolay Aleksandrov 4008e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 40098b671779SNikolay Aleksandrov } 40108b671779SNikolay Aleksandrov 4011613d61dbSNikolay Aleksandrov void br_multicast_ctx_init(struct net_bridge *br, 4012613d61dbSNikolay Aleksandrov struct net_bridge_vlan *vlan, 4013613d61dbSNikolay Aleksandrov struct net_bridge_mcast *brmctx) 4014613d61dbSNikolay Aleksandrov { 4015613d61dbSNikolay Aleksandrov brmctx->br = br; 4016613d61dbSNikolay Aleksandrov brmctx->vlan = vlan; 4017613d61dbSNikolay Aleksandrov brmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 4018613d61dbSNikolay Aleksandrov brmctx->multicast_last_member_count = 2; 4019613d61dbSNikolay Aleksandrov brmctx->multicast_startup_query_count = 2; 4020613d61dbSNikolay Aleksandrov 4021613d61dbSNikolay Aleksandrov brmctx->multicast_last_member_interval = HZ; 4022613d61dbSNikolay Aleksandrov brmctx->multicast_query_response_interval = 10 * HZ; 4023613d61dbSNikolay Aleksandrov brmctx->multicast_startup_query_interval = 125 * HZ / 4; 4024613d61dbSNikolay Aleksandrov brmctx->multicast_query_interval = 125 * HZ; 4025613d61dbSNikolay Aleksandrov brmctx->multicast_querier_interval = 255 * HZ; 4026613d61dbSNikolay Aleksandrov brmctx->multicast_membership_interval = 260 * HZ; 4027613d61dbSNikolay Aleksandrov 4028613d61dbSNikolay Aleksandrov brmctx->ip4_other_query.delay_time = 0; 4029bb18ef8eSNikolay Aleksandrov brmctx->ip4_querier.port_ifidx = 0; 4030f936bb42SThomas Gleixner seqcount_spinlock_init(&brmctx->ip4_querier.seq, &br->multicast_lock); 4031613d61dbSNikolay Aleksandrov brmctx->multicast_igmp_version = 2; 4032613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4033613d61dbSNikolay Aleksandrov brmctx->multicast_mld_version = 1; 4034613d61dbSNikolay Aleksandrov brmctx->ip6_other_query.delay_time = 0; 4035bb18ef8eSNikolay Aleksandrov brmctx->ip6_querier.port_ifidx = 0; 4036f936bb42SThomas Gleixner seqcount_spinlock_init(&brmctx->ip6_querier.seq, &br->multicast_lock); 4037613d61dbSNikolay Aleksandrov #endif 4038613d61dbSNikolay Aleksandrov 4039613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_mc_router_timer, 4040613d61dbSNikolay Aleksandrov br_ip4_multicast_local_router_expired, 0); 4041613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_other_query.timer, 4042613d61dbSNikolay Aleksandrov br_ip4_multicast_querier_expired, 0); 4043613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip4_own_query.timer, 4044613d61dbSNikolay Aleksandrov br_ip4_multicast_query_expired, 0); 4045613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4046613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_mc_router_timer, 4047613d61dbSNikolay Aleksandrov br_ip6_multicast_local_router_expired, 0); 4048613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_other_query.timer, 4049613d61dbSNikolay Aleksandrov br_ip6_multicast_querier_expired, 0); 4050613d61dbSNikolay Aleksandrov timer_setup(&brmctx->ip6_own_query.timer, 4051613d61dbSNikolay Aleksandrov br_ip6_multicast_query_expired, 0); 4052613d61dbSNikolay Aleksandrov #endif 4053613d61dbSNikolay Aleksandrov } 4054613d61dbSNikolay Aleksandrov 4055613d61dbSNikolay Aleksandrov void br_multicast_ctx_deinit(struct net_bridge_mcast *brmctx) 4056613d61dbSNikolay Aleksandrov { 4057613d61dbSNikolay Aleksandrov __br_multicast_stop(brmctx); 4058613d61dbSNikolay Aleksandrov } 4059613d61dbSNikolay Aleksandrov 4060eb1d1641SHerbert Xu void br_multicast_init(struct net_bridge *br) 4061eb1d1641SHerbert Xu { 4062d08c6bc0SNikolay Aleksandrov br->hash_max = BR_MULTICAST_DEFAULT_HASH_MAX; 4063eb1d1641SHerbert Xu 4064613d61dbSNikolay Aleksandrov br_multicast_ctx_init(br, NULL, &br->multicast_ctx); 4065eb1d1641SHerbert Xu 40666919622aSIdo Schimmel br_opt_toggle(br, BROPT_MULTICAST_ENABLED, true); 4067675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_HAS_IPV6_ADDR, true); 4068b00589afSLinus Lüssing 4069eb1d1641SHerbert Xu spin_lock_init(&br->multicast_lock); 407019e3a9c9SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mdb_list); 4071e12cec65SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mcast_gc_list); 4072e12cec65SNikolay Aleksandrov INIT_WORK(&br->mcast_gc_work, br_multicast_gc_work); 4073eb1d1641SHerbert Xu } 4074eb1d1641SHerbert Xu 40754effd28cSLinus Lüssing static void br_ip4_multicast_join_snoopers(struct net_bridge *br) 40764effd28cSLinus Lüssing { 40774effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 40784effd28cSLinus Lüssing 40794effd28cSLinus Lüssing if (!in_dev) 40804effd28cSLinus Lüssing return; 40814effd28cSLinus Lüssing 40829fb20801SFlorian Fainelli __ip_mc_inc_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 40834effd28cSLinus Lüssing in_dev_put(in_dev); 40844effd28cSLinus Lüssing } 40854effd28cSLinus Lüssing 40864effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 40874effd28cSLinus Lüssing static void br_ip6_multicast_join_snoopers(struct net_bridge *br) 40884effd28cSLinus Lüssing { 40894effd28cSLinus Lüssing struct in6_addr addr; 40904effd28cSLinus Lüssing 40914effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 40924effd28cSLinus Lüssing ipv6_dev_mc_inc(br->dev, &addr); 40934effd28cSLinus Lüssing } 40944effd28cSLinus Lüssing #else 40954effd28cSLinus Lüssing static inline void br_ip6_multicast_join_snoopers(struct net_bridge *br) 40964effd28cSLinus Lüssing { 40974effd28cSLinus Lüssing } 40984effd28cSLinus Lüssing #endif 40994effd28cSLinus Lüssing 4100851d0a73SJoseph Huang void br_multicast_join_snoopers(struct net_bridge *br) 41014effd28cSLinus Lüssing { 41024effd28cSLinus Lüssing br_ip4_multicast_join_snoopers(br); 41034effd28cSLinus Lüssing br_ip6_multicast_join_snoopers(br); 41044effd28cSLinus Lüssing } 41054effd28cSLinus Lüssing 41064effd28cSLinus Lüssing static void br_ip4_multicast_leave_snoopers(struct net_bridge *br) 41074effd28cSLinus Lüssing { 41084effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 41094effd28cSLinus Lüssing 41104effd28cSLinus Lüssing if (WARN_ON(!in_dev)) 41114effd28cSLinus Lüssing return; 41124effd28cSLinus Lüssing 41139fb20801SFlorian Fainelli __ip_mc_dec_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 41144effd28cSLinus Lüssing in_dev_put(in_dev); 41154effd28cSLinus Lüssing } 41164effd28cSLinus Lüssing 41174effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 41184effd28cSLinus Lüssing static void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 41194effd28cSLinus Lüssing { 41204effd28cSLinus Lüssing struct in6_addr addr; 41214effd28cSLinus Lüssing 41224effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 41234effd28cSLinus Lüssing ipv6_dev_mc_dec(br->dev, &addr); 41244effd28cSLinus Lüssing } 41254effd28cSLinus Lüssing #else 41264effd28cSLinus Lüssing static inline void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 41274effd28cSLinus Lüssing { 41284effd28cSLinus Lüssing } 41294effd28cSLinus Lüssing #endif 41304effd28cSLinus Lüssing 4131851d0a73SJoseph Huang void br_multicast_leave_snoopers(struct net_bridge *br) 41324effd28cSLinus Lüssing { 41334effd28cSLinus Lüssing br_ip4_multicast_leave_snoopers(br); 41344effd28cSLinus Lüssing br_ip6_multicast_leave_snoopers(br); 41354effd28cSLinus Lüssing } 41364effd28cSLinus Lüssing 41377b54aaafSNikolay Aleksandrov static void __br_multicast_open_query(struct net_bridge *br, 413890010b36SLinus Lüssing struct bridge_mcast_own_query *query) 4139eb1d1641SHerbert Xu { 4140cc0fdd80SLinus Lüssing query->startup_sent = 0; 4141eb1d1641SHerbert Xu 414213cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) 4143eb1d1641SHerbert Xu return; 4144eb1d1641SHerbert Xu 4145cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 4146cc0fdd80SLinus Lüssing } 4147cc0fdd80SLinus Lüssing 41487b54aaafSNikolay Aleksandrov static void __br_multicast_open(struct net_bridge_mcast *brmctx) 41497b54aaafSNikolay Aleksandrov { 41507b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, &brmctx->ip4_own_query); 41517b54aaafSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 41527b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, &brmctx->ip6_own_query); 41537b54aaafSNikolay Aleksandrov #endif 41547b54aaafSNikolay Aleksandrov } 41557b54aaafSNikolay Aleksandrov 4156cc0fdd80SLinus Lüssing void br_multicast_open(struct net_bridge *br) 4157cc0fdd80SLinus Lüssing { 4158f4b7002aSNikolay Aleksandrov ASSERT_RTNL(); 4159f4b7002aSNikolay Aleksandrov 4160f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) { 41617b54aaafSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 41627b54aaafSNikolay Aleksandrov struct net_bridge_vlan *vlan; 41637b54aaafSNikolay Aleksandrov 41647b54aaafSNikolay Aleksandrov vg = br_vlan_group(br); 41657b54aaafSNikolay Aleksandrov if (vg) { 41667b54aaafSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) { 41677b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 41687b54aaafSNikolay Aleksandrov 41697b54aaafSNikolay Aleksandrov brmctx = &vlan->br_mcast_ctx; 41707b54aaafSNikolay Aleksandrov if (br_vlan_is_brentry(vlan) && 41717b54aaafSNikolay Aleksandrov !br_multicast_ctx_vlan_disabled(brmctx)) 41727b54aaafSNikolay Aleksandrov __br_multicast_open(&vlan->br_mcast_ctx); 41737b54aaafSNikolay Aleksandrov } 41747b54aaafSNikolay Aleksandrov } 4175cb486ce9SNikolay Aleksandrov } else { 41767b54aaafSNikolay Aleksandrov __br_multicast_open(&br->multicast_ctx); 4177eb1d1641SHerbert Xu } 4178cb486ce9SNikolay Aleksandrov } 4179eb1d1641SHerbert Xu 4180613d61dbSNikolay Aleksandrov static void __br_multicast_stop(struct net_bridge_mcast *brmctx) 4181613d61dbSNikolay Aleksandrov { 4182613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_mc_router_timer); 4183613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_other_query.timer); 4184613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip4_own_query.timer); 4185613d61dbSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4186613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_mc_router_timer); 4187613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_other_query.timer); 4188613d61dbSNikolay Aleksandrov del_timer_sync(&brmctx->ip6_own_query.timer); 4189613d61dbSNikolay Aleksandrov #endif 4190613d61dbSNikolay Aleksandrov } 4191613d61dbSNikolay Aleksandrov 41927b54aaafSNikolay Aleksandrov void br_multicast_toggle_one_vlan(struct net_bridge_vlan *vlan, bool on) 41937b54aaafSNikolay Aleksandrov { 41947b54aaafSNikolay Aleksandrov struct net_bridge *br; 41957b54aaafSNikolay Aleksandrov 41967b54aaafSNikolay Aleksandrov /* it's okay to check for the flag without the multicast lock because it 41977b54aaafSNikolay Aleksandrov * can only change under RTNL -> multicast_lock, we need the latter to 41987b54aaafSNikolay Aleksandrov * sync with timers and packets 41997b54aaafSNikolay Aleksandrov */ 42007b54aaafSNikolay Aleksandrov if (on == !!(vlan->priv_flags & BR_VLFLAG_MCAST_ENABLED)) 42017b54aaafSNikolay Aleksandrov return; 42027b54aaafSNikolay Aleksandrov 42037b54aaafSNikolay Aleksandrov if (br_vlan_is_master(vlan)) { 42047b54aaafSNikolay Aleksandrov br = vlan->br; 42057b54aaafSNikolay Aleksandrov 42067b54aaafSNikolay Aleksandrov if (!br_vlan_is_brentry(vlan) || 42077b54aaafSNikolay Aleksandrov (on && 42087b54aaafSNikolay Aleksandrov br_multicast_ctx_vlan_global_disabled(&vlan->br_mcast_ctx))) 42097b54aaafSNikolay Aleksandrov return; 42107b54aaafSNikolay Aleksandrov 42117b54aaafSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 42127b54aaafSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_MCAST_ENABLED; 42137b54aaafSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 42147b54aaafSNikolay Aleksandrov 42157b54aaafSNikolay Aleksandrov if (on) 42167b54aaafSNikolay Aleksandrov __br_multicast_open(&vlan->br_mcast_ctx); 42177b54aaafSNikolay Aleksandrov else 42187b54aaafSNikolay Aleksandrov __br_multicast_stop(&vlan->br_mcast_ctx); 42197b54aaafSNikolay Aleksandrov } else { 42207b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 42217b54aaafSNikolay Aleksandrov 42227b54aaafSNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(&vlan->port_mcast_ctx); 42237b54aaafSNikolay Aleksandrov if (on && br_multicast_ctx_vlan_global_disabled(brmctx)) 42247b54aaafSNikolay Aleksandrov return; 42257b54aaafSNikolay Aleksandrov 42267b54aaafSNikolay Aleksandrov br = vlan->port->br; 42277b54aaafSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 42287b54aaafSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_MCAST_ENABLED; 42297b54aaafSNikolay Aleksandrov if (on) 42307b54aaafSNikolay Aleksandrov __br_multicast_enable_port_ctx(&vlan->port_mcast_ctx); 42317b54aaafSNikolay Aleksandrov else 42327b54aaafSNikolay Aleksandrov __br_multicast_disable_port_ctx(&vlan->port_mcast_ctx); 42337b54aaafSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 42347b54aaafSNikolay Aleksandrov } 42357b54aaafSNikolay Aleksandrov } 42367b54aaafSNikolay Aleksandrov 4237affce9a7SNikolay Aleksandrov static void br_multicast_toggle_vlan(struct net_bridge_vlan *vlan, bool on) 4238f4b7002aSNikolay Aleksandrov { 4239f4b7002aSNikolay Aleksandrov struct net_bridge_port *p; 4240f4b7002aSNikolay Aleksandrov 4241f4b7002aSNikolay Aleksandrov if (WARN_ON_ONCE(!br_vlan_is_master(vlan))) 4242f4b7002aSNikolay Aleksandrov return; 4243f4b7002aSNikolay Aleksandrov 4244f4b7002aSNikolay Aleksandrov list_for_each_entry(p, &vlan->br->port_list, list) { 4245f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vport; 4246f4b7002aSNikolay Aleksandrov 4247f4b7002aSNikolay Aleksandrov vport = br_vlan_find(nbp_vlan_group(p), vlan->vid); 4248f4b7002aSNikolay Aleksandrov if (!vport) 4249f4b7002aSNikolay Aleksandrov continue; 4250f4b7002aSNikolay Aleksandrov br_multicast_toggle_one_vlan(vport, on); 4251f4b7002aSNikolay Aleksandrov } 4252affce9a7SNikolay Aleksandrov 4253affce9a7SNikolay Aleksandrov if (br_vlan_is_brentry(vlan)) 4254affce9a7SNikolay Aleksandrov br_multicast_toggle_one_vlan(vlan, on); 4255f4b7002aSNikolay Aleksandrov } 4256f4b7002aSNikolay Aleksandrov 4257f4b7002aSNikolay Aleksandrov int br_multicast_toggle_vlan_snooping(struct net_bridge *br, bool on, 4258f4b7002aSNikolay Aleksandrov struct netlink_ext_ack *extack) 4259eb1d1641SHerbert Xu { 42607b54aaafSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 42617b54aaafSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4262f4b7002aSNikolay Aleksandrov struct net_bridge_port *p; 42637b54aaafSNikolay Aleksandrov 4264f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED) == on) 4265f4b7002aSNikolay Aleksandrov return 0; 4266f4b7002aSNikolay Aleksandrov 4267f4b7002aSNikolay Aleksandrov if (on && !br_opt_get(br, BROPT_VLAN_ENABLED)) { 4268f4b7002aSNikolay Aleksandrov NL_SET_ERR_MSG_MOD(extack, "Cannot enable multicast vlan snooping with vlan filtering disabled"); 4269f4b7002aSNikolay Aleksandrov return -EINVAL; 4270f4b7002aSNikolay Aleksandrov } 4271f4b7002aSNikolay Aleksandrov 4272f4b7002aSNikolay Aleksandrov vg = br_vlan_group(br); 4273f4b7002aSNikolay Aleksandrov if (!vg) 4274f4b7002aSNikolay Aleksandrov return 0; 4275f4b7002aSNikolay Aleksandrov 4276f4b7002aSNikolay Aleksandrov br_opt_toggle(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED, on); 4277f4b7002aSNikolay Aleksandrov 4278f4b7002aSNikolay Aleksandrov /* disable/enable non-vlan mcast contexts based on vlan snooping */ 4279f4b7002aSNikolay Aleksandrov if (on) 4280f4b7002aSNikolay Aleksandrov __br_multicast_stop(&br->multicast_ctx); 4281f4b7002aSNikolay Aleksandrov else 4282f4b7002aSNikolay Aleksandrov __br_multicast_open(&br->multicast_ctx); 4283f4b7002aSNikolay Aleksandrov list_for_each_entry(p, &br->port_list, list) { 4284f4b7002aSNikolay Aleksandrov if (on) 4285f4b7002aSNikolay Aleksandrov br_multicast_disable_port(p); 4286f4b7002aSNikolay Aleksandrov else 4287f4b7002aSNikolay Aleksandrov br_multicast_enable_port(p); 4288f4b7002aSNikolay Aleksandrov } 4289f4b7002aSNikolay Aleksandrov 4290f4b7002aSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) 4291f4b7002aSNikolay Aleksandrov br_multicast_toggle_vlan(vlan, on); 4292f4b7002aSNikolay Aleksandrov 4293f4b7002aSNikolay Aleksandrov return 0; 4294f4b7002aSNikolay Aleksandrov } 4295f4b7002aSNikolay Aleksandrov 42969dee572cSNikolay Aleksandrov bool br_multicast_toggle_global_vlan(struct net_bridge_vlan *vlan, bool on) 42979dee572cSNikolay Aleksandrov { 42989dee572cSNikolay Aleksandrov ASSERT_RTNL(); 42999dee572cSNikolay Aleksandrov 43009dee572cSNikolay Aleksandrov /* BR_VLFLAG_GLOBAL_MCAST_ENABLED relies on eventual consistency and 43019dee572cSNikolay Aleksandrov * requires only RTNL to change 43029dee572cSNikolay Aleksandrov */ 43039dee572cSNikolay Aleksandrov if (on == !!(vlan->priv_flags & BR_VLFLAG_GLOBAL_MCAST_ENABLED)) 43049dee572cSNikolay Aleksandrov return false; 43059dee572cSNikolay Aleksandrov 43069dee572cSNikolay Aleksandrov vlan->priv_flags ^= BR_VLFLAG_GLOBAL_MCAST_ENABLED; 43079dee572cSNikolay Aleksandrov br_multicast_toggle_vlan(vlan, on); 43089dee572cSNikolay Aleksandrov 43099dee572cSNikolay Aleksandrov return true; 43109dee572cSNikolay Aleksandrov } 43119dee572cSNikolay Aleksandrov 4312f4b7002aSNikolay Aleksandrov void br_multicast_stop(struct net_bridge *br) 4313f4b7002aSNikolay Aleksandrov { 43147b54aaafSNikolay Aleksandrov ASSERT_RTNL(); 43157b54aaafSNikolay Aleksandrov 4316f4b7002aSNikolay Aleksandrov if (br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) { 4317f4b7002aSNikolay Aleksandrov struct net_bridge_vlan_group *vg; 4318f4b7002aSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4319f4b7002aSNikolay Aleksandrov 43207b54aaafSNikolay Aleksandrov vg = br_vlan_group(br); 43217b54aaafSNikolay Aleksandrov if (vg) { 43227b54aaafSNikolay Aleksandrov list_for_each_entry(vlan, &vg->vlan_list, vlist) { 43237b54aaafSNikolay Aleksandrov struct net_bridge_mcast *brmctx; 43247b54aaafSNikolay Aleksandrov 43257b54aaafSNikolay Aleksandrov brmctx = &vlan->br_mcast_ctx; 43267b54aaafSNikolay Aleksandrov if (br_vlan_is_brentry(vlan) && 43277b54aaafSNikolay Aleksandrov !br_multicast_ctx_vlan_disabled(brmctx)) 43287b54aaafSNikolay Aleksandrov __br_multicast_stop(&vlan->br_mcast_ctx); 43297b54aaafSNikolay Aleksandrov } 43307b54aaafSNikolay Aleksandrov } 4331cb486ce9SNikolay Aleksandrov } else { 4332613d61dbSNikolay Aleksandrov __br_multicast_stop(&br->multicast_ctx); 4333e10177abSSatish Ashok } 4334cb486ce9SNikolay Aleksandrov } 4335e10177abSSatish Ashok 4336e10177abSSatish Ashok void br_multicast_dev_del(struct net_bridge *br) 4337e10177abSSatish Ashok { 4338e10177abSSatish Ashok struct net_bridge_mdb_entry *mp; 43398b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 434019e3a9c9SNikolay Aleksandrov struct hlist_node *tmp; 4341eb1d1641SHerbert Xu 4342eb1d1641SHerbert Xu spin_lock_bh(&br->multicast_lock); 4343e12cec65SNikolay Aleksandrov hlist_for_each_entry_safe(mp, tmp, &br->mdb_list, mdb_node) 4344e12cec65SNikolay Aleksandrov br_multicast_del_mdb_entry(mp); 4345e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 4346eb1d1641SHerbert Xu spin_unlock_bh(&br->multicast_lock); 434719e3a9c9SNikolay Aleksandrov 4348613d61dbSNikolay Aleksandrov br_multicast_ctx_deinit(&br->multicast_ctx); 4349e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 4350e12cec65SNikolay Aleksandrov cancel_work_sync(&br->mcast_gc_work); 43518b671779SNikolay Aleksandrov 43524329596cSNikolay Aleksandrov rcu_barrier(); 4353eb1d1641SHerbert Xu } 43540909e117SHerbert Xu 4355a97df080SNikolay Aleksandrov int br_multicast_set_router(struct net_bridge_mcast *brmctx, unsigned long val) 43560909e117SHerbert Xu { 43576ae4ae8eSLinus Lüssing int err = -EINVAL; 43580909e117SHerbert Xu 4359a97df080SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 43600909e117SHerbert Xu 43610909e117SHerbert Xu switch (val) { 43627f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 43637f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 4364a97df080SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, val == MDB_RTR_TYPE_PERM); 4365d3d065c0SNikolay Aleksandrov del_timer(&brmctx->ip4_mc_router_timer); 4366a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4367d3d065c0SNikolay Aleksandrov del_timer(&brmctx->ip6_mc_router_timer); 4368a3c02e76SLinus Lüssing #endif 4369d3d065c0SNikolay Aleksandrov brmctx->multicast_router = val; 437077041420SYotam Gigi err = 0; 437177041420SYotam Gigi break; 43727f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 4373d3d065c0SNikolay Aleksandrov if (brmctx->multicast_router != MDB_RTR_TYPE_TEMP_QUERY) 4374a97df080SNikolay Aleksandrov br_mc_router_state_change(brmctx->br, false); 4375d3d065c0SNikolay Aleksandrov brmctx->multicast_router = val; 43760909e117SHerbert Xu err = 0; 43770909e117SHerbert Xu break; 43780909e117SHerbert Xu } 43790909e117SHerbert Xu 4380a97df080SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 43810909e117SHerbert Xu 43820909e117SHerbert Xu return err; 43830909e117SHerbert Xu } 43840909e117SHerbert Xu 4385ed2d3597SLinus Lüssing static void 4386adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(struct net_bridge_mcast_port *pmctx, bool deleted) 43877f0aec7aSNikolay Aleksandrov { 4388ed2d3597SLinus Lüssing if (!deleted) 43897f0aec7aSNikolay Aleksandrov return; 4390ed2d3597SLinus Lüssing 4391a3c02e76SLinus Lüssing /* For backwards compatibility for now, only notify if there is 4392a3c02e76SLinus Lüssing * no multicast router anymore for both IPv4 and IPv6. 4393a3c02e76SLinus Lüssing */ 4394adc47037SNikolay Aleksandrov if (!hlist_unhashed(&pmctx->ip4_rlist)) 4395a3c02e76SLinus Lüssing return; 4396a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4397adc47037SNikolay Aleksandrov if (!hlist_unhashed(&pmctx->ip6_rlist)) 4398a3c02e76SLinus Lüssing return; 4399a3c02e76SLinus Lüssing #endif 4400a3c02e76SLinus Lüssing 44011e9ca456SNikolay Aleksandrov br_rtr_notify(pmctx->port->br->dev, pmctx, RTM_DELMDB); 4402adc47037SNikolay Aleksandrov br_port_mc_router_state_change(pmctx->port, false); 4403f12e7d95SNogah Frankel 4404f12e7d95SNogah Frankel /* don't allow timer refresh */ 4405adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_TEMP) 4406adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 44077f0aec7aSNikolay Aleksandrov } 44087f0aec7aSNikolay Aleksandrov 4409a53581d5SNikolay Aleksandrov int br_multicast_set_port_router(struct net_bridge_mcast_port *pmctx, 4410a53581d5SNikolay Aleksandrov unsigned long val) 44110909e117SHerbert Xu { 4412a53581d5SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 4413a55d8246SNikolay Aleksandrov unsigned long now = jiffies; 44146ae4ae8eSLinus Lüssing int err = -EINVAL; 4415ed2d3597SLinus Lüssing bool del = false; 44160909e117SHerbert Xu 4417a53581d5SNikolay Aleksandrov brmctx = br_multicast_port_ctx_get_global(pmctx); 4418ddd0d529SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4419adc47037SNikolay Aleksandrov if (pmctx->multicast_router == val) { 4420a55d8246SNikolay Aleksandrov /* Refresh the temp router port timer */ 4421adc47037SNikolay Aleksandrov if (pmctx->multicast_router == MDB_RTR_TYPE_TEMP) { 4422adc47037SNikolay Aleksandrov mod_timer(&pmctx->ip4_mc_router_timer, 4423d3d065c0SNikolay Aleksandrov now + brmctx->multicast_querier_interval); 4424a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4425adc47037SNikolay Aleksandrov mod_timer(&pmctx->ip6_mc_router_timer, 4426d3d065c0SNikolay Aleksandrov now + brmctx->multicast_querier_interval); 4427a3c02e76SLinus Lüssing #endif 4428a3c02e76SLinus Lüssing } 44294950cfd1SNikolay Aleksandrov err = 0; 44304950cfd1SNikolay Aleksandrov goto unlock; 44314950cfd1SNikolay Aleksandrov } 44320909e117SHerbert Xu switch (val) { 44337f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 4434adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_DISABLED; 4435adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 4436adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 4437adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 4438a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4439adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 4440a3c02e76SLinus Lüssing #endif 4441adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 44420909e117SHerbert Xu break; 44437f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 4444adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 4445adc47037SNikolay Aleksandrov del |= br_ip4_multicast_rport_del(pmctx); 4446adc47037SNikolay Aleksandrov del |= br_ip6_multicast_rport_del(pmctx); 4447adc47037SNikolay Aleksandrov br_multicast_rport_del_notify(pmctx, del); 44487f0aec7aSNikolay Aleksandrov break; 44497f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 4450adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_PERM; 4451adc47037SNikolay Aleksandrov del_timer(&pmctx->ip4_mc_router_timer); 4452adc47037SNikolay Aleksandrov br_ip4_multicast_add_router(brmctx, pmctx); 4453a3c02e76SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4454adc47037SNikolay Aleksandrov del_timer(&pmctx->ip6_mc_router_timer); 4455a3c02e76SLinus Lüssing #endif 4456adc47037SNikolay Aleksandrov br_ip6_multicast_add_router(brmctx, pmctx); 44570909e117SHerbert Xu break; 4458a55d8246SNikolay Aleksandrov case MDB_RTR_TYPE_TEMP: 4459adc47037SNikolay Aleksandrov pmctx->multicast_router = MDB_RTR_TYPE_TEMP; 4460adc47037SNikolay Aleksandrov br_ip4_multicast_mark_router(brmctx, pmctx); 4461adc47037SNikolay Aleksandrov br_ip6_multicast_mark_router(brmctx, pmctx); 4462a55d8246SNikolay Aleksandrov break; 44637f0aec7aSNikolay Aleksandrov default: 44647f0aec7aSNikolay Aleksandrov goto unlock; 44650909e117SHerbert Xu } 44667f0aec7aSNikolay Aleksandrov err = 0; 44677f0aec7aSNikolay Aleksandrov unlock: 4468ddd0d529SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 44690909e117SHerbert Xu 44700909e117SHerbert Xu return err; 44710909e117SHerbert Xu } 4472561f1103SHerbert Xu 44732796d846SNikolay Aleksandrov int br_multicast_set_vlan_router(struct net_bridge_vlan *v, u8 mcast_router) 44742796d846SNikolay Aleksandrov { 44752796d846SNikolay Aleksandrov int err; 44762796d846SNikolay Aleksandrov 44772796d846SNikolay Aleksandrov if (br_vlan_is_master(v)) 44782796d846SNikolay Aleksandrov err = br_multicast_set_router(&v->br_mcast_ctx, mcast_router); 44792796d846SNikolay Aleksandrov else 44802796d846SNikolay Aleksandrov err = br_multicast_set_port_router(&v->port_mcast_ctx, 44812796d846SNikolay Aleksandrov mcast_router); 44822796d846SNikolay Aleksandrov 44832796d846SNikolay Aleksandrov return err; 44842796d846SNikolay Aleksandrov } 44852796d846SNikolay Aleksandrov 4486adc47037SNikolay Aleksandrov static void br_multicast_start_querier(struct net_bridge_mcast *brmctx, 448790010b36SLinus Lüssing struct bridge_mcast_own_query *query) 4488561f1103SHerbert Xu { 4489561f1103SHerbert Xu struct net_bridge_port *port; 449074857216SHerbert Xu 4491cb486ce9SNikolay Aleksandrov if (!br_multicast_ctx_matches_vlan_snooping(brmctx)) 4492cb486ce9SNikolay Aleksandrov return; 4493cb486ce9SNikolay Aleksandrov 44947b54aaafSNikolay Aleksandrov __br_multicast_open_query(brmctx->br, query); 449574857216SHerbert Xu 4496c5b493ceSNikolay Aleksandrov rcu_read_lock(); 4497adc47037SNikolay Aleksandrov list_for_each_entry_rcu(port, &brmctx->br->port_list, list) { 4498615cc23eSNikolay Aleksandrov struct bridge_mcast_own_query *ip4_own_query; 4499615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4500615cc23eSNikolay Aleksandrov struct bridge_mcast_own_query *ip6_own_query; 4501615cc23eSNikolay Aleksandrov #endif 4502615cc23eSNikolay Aleksandrov 4503615cc23eSNikolay Aleksandrov if (br_multicast_port_ctx_state_stopped(&port->multicast_ctx)) 450474857216SHerbert Xu continue; 450574857216SHerbert Xu 4506615cc23eSNikolay Aleksandrov if (br_multicast_ctx_is_vlan(brmctx)) { 4507615cc23eSNikolay Aleksandrov struct net_bridge_vlan *vlan; 4508615cc23eSNikolay Aleksandrov 45093f0d14efSNikolay Aleksandrov vlan = br_vlan_find(nbp_vlan_group_rcu(port), 45103f0d14efSNikolay Aleksandrov brmctx->vlan->vid); 4511615cc23eSNikolay Aleksandrov if (!vlan || 4512615cc23eSNikolay Aleksandrov br_multicast_port_ctx_state_stopped(&vlan->port_mcast_ctx)) 4513615cc23eSNikolay Aleksandrov continue; 4514615cc23eSNikolay Aleksandrov 4515615cc23eSNikolay Aleksandrov ip4_own_query = &vlan->port_mcast_ctx.ip4_own_query; 4516615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4517615cc23eSNikolay Aleksandrov ip6_own_query = &vlan->port_mcast_ctx.ip6_own_query; 4518615cc23eSNikolay Aleksandrov #endif 4519615cc23eSNikolay Aleksandrov } else { 4520615cc23eSNikolay Aleksandrov ip4_own_query = &port->multicast_ctx.ip4_own_query; 4521615cc23eSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4522615cc23eSNikolay Aleksandrov ip6_own_query = &port->multicast_ctx.ip6_own_query; 4523615cc23eSNikolay Aleksandrov #endif 4524615cc23eSNikolay Aleksandrov } 4525615cc23eSNikolay Aleksandrov 4526adc47037SNikolay Aleksandrov if (query == &brmctx->ip4_own_query) 4527615cc23eSNikolay Aleksandrov br_multicast_enable(ip4_own_query); 4528cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4529cc0fdd80SLinus Lüssing else 4530615cc23eSNikolay Aleksandrov br_multicast_enable(ip6_own_query); 4531cc0fdd80SLinus Lüssing #endif 453274857216SHerbert Xu } 4533c5b493ceSNikolay Aleksandrov rcu_read_unlock(); 453474857216SHerbert Xu } 453574857216SHerbert Xu 4536ae1ea84bSFlorian Fainelli int br_multicast_toggle(struct net_bridge *br, unsigned long val, 4537ae1ea84bSFlorian Fainelli struct netlink_ext_ack *extack) 453874857216SHerbert Xu { 45397cb3f921SNikolay Aleksandrov struct net_bridge_port *port; 4540851d0a73SJoseph Huang bool change_snoopers = false; 4541ae1ea84bSFlorian Fainelli int err = 0; 4542561f1103SHerbert Xu 4543ef5e0d82SAndrey Vagin spin_lock_bh(&br->multicast_lock); 454413cefad2SNikolay Aleksandrov if (!!br_opt_get(br, BROPT_MULTICAST_ENABLED) == !!val) 4545561f1103SHerbert Xu goto unlock; 4546561f1103SHerbert Xu 4547ae1ea84bSFlorian Fainelli err = br_mc_disabled_update(br->dev, val, extack); 4548ae1ea84bSFlorian Fainelli if (err == -EOPNOTSUPP) 4549ae1ea84bSFlorian Fainelli err = 0; 4550ae1ea84bSFlorian Fainelli if (err) 4551ae1ea84bSFlorian Fainelli goto unlock; 4552ae1ea84bSFlorian Fainelli 455313cefad2SNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_ENABLED, !!val); 45544effd28cSLinus Lüssing if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) { 4555851d0a73SJoseph Huang change_snoopers = true; 4556561f1103SHerbert Xu goto unlock; 45574effd28cSLinus Lüssing } 4558561f1103SHerbert Xu 45593a7fda06SHerbert Xu if (!netif_running(br->dev)) 45603a7fda06SHerbert Xu goto unlock; 45613a7fda06SHerbert Xu 45627cb3f921SNikolay Aleksandrov br_multicast_open(br); 45637cb3f921SNikolay Aleksandrov list_for_each_entry(port, &br->port_list, list) 4564adc47037SNikolay Aleksandrov __br_multicast_enable_port_ctx(&port->multicast_ctx); 4565561f1103SHerbert Xu 4566851d0a73SJoseph Huang change_snoopers = true; 4567851d0a73SJoseph Huang 4568561f1103SHerbert Xu unlock: 4569ef5e0d82SAndrey Vagin spin_unlock_bh(&br->multicast_lock); 4570561f1103SHerbert Xu 4571851d0a73SJoseph Huang /* br_multicast_join_snoopers has the potential to cause 4572851d0a73SJoseph Huang * an MLD Report/Leave to be delivered to br_multicast_rcv, 4573851d0a73SJoseph Huang * which would in turn call br_multicast_add_group, which would 4574851d0a73SJoseph Huang * attempt to acquire multicast_lock. This function should be 4575851d0a73SJoseph Huang * called after the lock has been released to avoid deadlocks on 4576851d0a73SJoseph Huang * multicast_lock. 4577851d0a73SJoseph Huang * 4578851d0a73SJoseph Huang * br_multicast_leave_snoopers does not have the problem since 4579851d0a73SJoseph Huang * br_multicast_rcv first checks BROPT_MULTICAST_ENABLED, and 4580851d0a73SJoseph Huang * returns without calling br_multicast_ipv4/6_rcv if it's not 4581851d0a73SJoseph Huang * enabled. Moved both functions out just for symmetry. 4582851d0a73SJoseph Huang */ 4583851d0a73SJoseph Huang if (change_snoopers) { 4584851d0a73SJoseph Huang if (br_opt_get(br, BROPT_MULTICAST_ENABLED)) 4585851d0a73SJoseph Huang br_multicast_join_snoopers(br); 4586851d0a73SJoseph Huang else 4587851d0a73SJoseph Huang br_multicast_leave_snoopers(br); 4588851d0a73SJoseph Huang } 4589851d0a73SJoseph Huang 4590ae1ea84bSFlorian Fainelli return err; 4591561f1103SHerbert Xu } 4592b195167fSHerbert Xu 45939341b988SIdo Schimmel bool br_multicast_enabled(const struct net_device *dev) 45949341b988SIdo Schimmel { 45959341b988SIdo Schimmel struct net_bridge *br = netdev_priv(dev); 45969341b988SIdo Schimmel 459713cefad2SNikolay Aleksandrov return !!br_opt_get(br, BROPT_MULTICAST_ENABLED); 45989341b988SIdo Schimmel } 45999341b988SIdo Schimmel EXPORT_SYMBOL_GPL(br_multicast_enabled); 46009341b988SIdo Schimmel 46010912bda4SYotam Gigi bool br_multicast_router(const struct net_device *dev) 46020912bda4SYotam Gigi { 46030912bda4SYotam Gigi struct net_bridge *br = netdev_priv(dev); 46040912bda4SYotam Gigi bool is_router; 46050912bda4SYotam Gigi 46060912bda4SYotam Gigi spin_lock_bh(&br->multicast_lock); 4607adc47037SNikolay Aleksandrov is_router = br_multicast_is_router(&br->multicast_ctx, NULL); 46080912bda4SYotam Gigi spin_unlock_bh(&br->multicast_lock); 46090912bda4SYotam Gigi return is_router; 46100912bda4SYotam Gigi } 46110912bda4SYotam Gigi EXPORT_SYMBOL_GPL(br_multicast_router); 46120912bda4SYotam Gigi 461362938182SNikolay Aleksandrov int br_multicast_set_querier(struct net_bridge_mcast *brmctx, unsigned long val) 4614c5c23260SHerbert Xu { 4615b00589afSLinus Lüssing unsigned long max_delay; 4616b00589afSLinus Lüssing 4617c5c23260SHerbert Xu val = !!val; 4618c5c23260SHerbert Xu 461962938182SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 46204d5b4e84SNikolay Aleksandrov if (brmctx->multicast_querier == val) 4621c5c23260SHerbert Xu goto unlock; 4622c5c23260SHerbert Xu 46234d5b4e84SNikolay Aleksandrov WRITE_ONCE(brmctx->multicast_querier, val); 4624b00589afSLinus Lüssing if (!val) 4625b00589afSLinus Lüssing goto unlock; 4626b00589afSLinus Lüssing 4627d3d065c0SNikolay Aleksandrov max_delay = brmctx->multicast_query_response_interval; 4628b00589afSLinus Lüssing 4629d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip4_other_query.timer)) 4630d3d065c0SNikolay Aleksandrov brmctx->ip4_other_query.delay_time = jiffies + max_delay; 4631cc0fdd80SLinus Lüssing 4632adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, &brmctx->ip4_own_query); 4633cc0fdd80SLinus Lüssing 4634cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 4635d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip6_other_query.timer)) 4636d3d065c0SNikolay Aleksandrov brmctx->ip6_other_query.delay_time = jiffies + max_delay; 4637cc0fdd80SLinus Lüssing 4638adc47037SNikolay Aleksandrov br_multicast_start_querier(brmctx, &brmctx->ip6_own_query); 4639cc0fdd80SLinus Lüssing #endif 4640c5c23260SHerbert Xu 4641c5c23260SHerbert Xu unlock: 464262938182SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 4643c5c23260SHerbert Xu 4644c5c23260SHerbert Xu return 0; 4645c5c23260SHerbert Xu } 4646c5c23260SHerbert Xu 4647df271cd6SNikolay Aleksandrov int br_multicast_set_igmp_version(struct net_bridge_mcast *brmctx, 4648df271cd6SNikolay Aleksandrov unsigned long val) 46495e923585SNikolay Aleksandrov { 46505e923585SNikolay Aleksandrov /* Currently we support only version 2 and 3 */ 46515e923585SNikolay Aleksandrov switch (val) { 46525e923585SNikolay Aleksandrov case 2: 46535e923585SNikolay Aleksandrov case 3: 46545e923585SNikolay Aleksandrov break; 46555e923585SNikolay Aleksandrov default: 46565e923585SNikolay Aleksandrov return -EINVAL; 46575e923585SNikolay Aleksandrov } 46585e923585SNikolay Aleksandrov 4659df271cd6SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4660df271cd6SNikolay Aleksandrov brmctx->multicast_igmp_version = val; 4661df271cd6SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 46625e923585SNikolay Aleksandrov 46635e923585SNikolay Aleksandrov return 0; 46645e923585SNikolay Aleksandrov } 46655e923585SNikolay Aleksandrov 4666aa2ae3e7SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 4667df271cd6SNikolay Aleksandrov int br_multicast_set_mld_version(struct net_bridge_mcast *brmctx, 4668df271cd6SNikolay Aleksandrov unsigned long val) 4669aa2ae3e7SNikolay Aleksandrov { 4670aa2ae3e7SNikolay Aleksandrov /* Currently we support version 1 and 2 */ 4671aa2ae3e7SNikolay Aleksandrov switch (val) { 4672aa2ae3e7SNikolay Aleksandrov case 1: 4673aa2ae3e7SNikolay Aleksandrov case 2: 4674aa2ae3e7SNikolay Aleksandrov break; 4675aa2ae3e7SNikolay Aleksandrov default: 4676aa2ae3e7SNikolay Aleksandrov return -EINVAL; 4677aa2ae3e7SNikolay Aleksandrov } 4678aa2ae3e7SNikolay Aleksandrov 4679df271cd6SNikolay Aleksandrov spin_lock_bh(&brmctx->br->multicast_lock); 4680df271cd6SNikolay Aleksandrov brmctx->multicast_mld_version = val; 4681df271cd6SNikolay Aleksandrov spin_unlock_bh(&brmctx->br->multicast_lock); 4682aa2ae3e7SNikolay Aleksandrov 4683aa2ae3e7SNikolay Aleksandrov return 0; 4684aa2ae3e7SNikolay Aleksandrov } 4685aa2ae3e7SNikolay Aleksandrov #endif 4686aa2ae3e7SNikolay Aleksandrov 468799b40610SNikolay Aleksandrov void br_multicast_set_query_intvl(struct net_bridge_mcast *brmctx, 468899b40610SNikolay Aleksandrov unsigned long val) 468999b40610SNikolay Aleksandrov { 469099b40610SNikolay Aleksandrov unsigned long intvl_jiffies = clock_t_to_jiffies(val); 469199b40610SNikolay Aleksandrov 469299b40610SNikolay Aleksandrov if (intvl_jiffies < BR_MULTICAST_QUERY_INTVL_MIN) { 469399b40610SNikolay Aleksandrov br_info(brmctx->br, 469499b40610SNikolay Aleksandrov "trying to set multicast query interval below minimum, setting to %lu (%ums)\n", 469599b40610SNikolay Aleksandrov jiffies_to_clock_t(BR_MULTICAST_QUERY_INTVL_MIN), 469699b40610SNikolay Aleksandrov jiffies_to_msecs(BR_MULTICAST_QUERY_INTVL_MIN)); 469799b40610SNikolay Aleksandrov intvl_jiffies = BR_MULTICAST_QUERY_INTVL_MIN; 469899b40610SNikolay Aleksandrov } 469999b40610SNikolay Aleksandrov 470099b40610SNikolay Aleksandrov brmctx->multicast_query_interval = intvl_jiffies; 470199b40610SNikolay Aleksandrov } 470299b40610SNikolay Aleksandrov 4703f83a112bSNikolay Aleksandrov void br_multicast_set_startup_query_intvl(struct net_bridge_mcast *brmctx, 4704f83a112bSNikolay Aleksandrov unsigned long val) 4705f83a112bSNikolay Aleksandrov { 4706f83a112bSNikolay Aleksandrov unsigned long intvl_jiffies = clock_t_to_jiffies(val); 4707f83a112bSNikolay Aleksandrov 4708f83a112bSNikolay Aleksandrov if (intvl_jiffies < BR_MULTICAST_STARTUP_QUERY_INTVL_MIN) { 4709f83a112bSNikolay Aleksandrov br_info(brmctx->br, 4710f83a112bSNikolay Aleksandrov "trying to set multicast startup query interval below minimum, setting to %lu (%ums)\n", 4711f83a112bSNikolay Aleksandrov jiffies_to_clock_t(BR_MULTICAST_STARTUP_QUERY_INTVL_MIN), 4712f83a112bSNikolay Aleksandrov jiffies_to_msecs(BR_MULTICAST_STARTUP_QUERY_INTVL_MIN)); 4713f83a112bSNikolay Aleksandrov intvl_jiffies = BR_MULTICAST_STARTUP_QUERY_INTVL_MIN; 4714f83a112bSNikolay Aleksandrov } 4715f83a112bSNikolay Aleksandrov 4716f83a112bSNikolay Aleksandrov brmctx->multicast_startup_query_interval = intvl_jiffies; 4717f83a112bSNikolay Aleksandrov } 4718f83a112bSNikolay Aleksandrov 471907f8ac4aSLinus Lüssing /** 472007f8ac4aSLinus Lüssing * br_multicast_list_adjacent - Returns snooped multicast addresses 472107f8ac4aSLinus Lüssing * @dev: The bridge port adjacent to which to retrieve addresses 472207f8ac4aSLinus Lüssing * @br_ip_list: The list to store found, snooped multicast IP addresses in 472307f8ac4aSLinus Lüssing * 472407f8ac4aSLinus Lüssing * Creates a list of IP addresses (struct br_ip_list) sensed by the multicast 472507f8ac4aSLinus Lüssing * snooping feature on all bridge ports of dev's bridge device, excluding 472607f8ac4aSLinus Lüssing * the addresses from dev itself. 472707f8ac4aSLinus Lüssing * 472807f8ac4aSLinus Lüssing * Returns the number of items added to br_ip_list. 472907f8ac4aSLinus Lüssing * 473007f8ac4aSLinus Lüssing * Notes: 473107f8ac4aSLinus Lüssing * - br_ip_list needs to be initialized by caller 473207f8ac4aSLinus Lüssing * - br_ip_list might contain duplicates in the end 473307f8ac4aSLinus Lüssing * (needs to be taken care of by caller) 473407f8ac4aSLinus Lüssing * - br_ip_list needs to be freed by caller 473507f8ac4aSLinus Lüssing */ 473607f8ac4aSLinus Lüssing int br_multicast_list_adjacent(struct net_device *dev, 473707f8ac4aSLinus Lüssing struct list_head *br_ip_list) 473807f8ac4aSLinus Lüssing { 473907f8ac4aSLinus Lüssing struct net_bridge *br; 474007f8ac4aSLinus Lüssing struct net_bridge_port *port; 474107f8ac4aSLinus Lüssing struct net_bridge_port_group *group; 474207f8ac4aSLinus Lüssing struct br_ip_list *entry; 474307f8ac4aSLinus Lüssing int count = 0; 474407f8ac4aSLinus Lüssing 474507f8ac4aSLinus Lüssing rcu_read_lock(); 474635f861e3SJulian Wiedmann if (!br_ip_list || !netif_is_bridge_port(dev)) 474707f8ac4aSLinus Lüssing goto unlock; 474807f8ac4aSLinus Lüssing 474907f8ac4aSLinus Lüssing port = br_port_get_rcu(dev); 475007f8ac4aSLinus Lüssing if (!port || !port->br) 475107f8ac4aSLinus Lüssing goto unlock; 475207f8ac4aSLinus Lüssing 475307f8ac4aSLinus Lüssing br = port->br; 475407f8ac4aSLinus Lüssing 475507f8ac4aSLinus Lüssing list_for_each_entry_rcu(port, &br->port_list, list) { 475607f8ac4aSLinus Lüssing if (!port->dev || port->dev == dev) 475707f8ac4aSLinus Lüssing continue; 475807f8ac4aSLinus Lüssing 475907f8ac4aSLinus Lüssing hlist_for_each_entry_rcu(group, &port->mglist, mglist) { 476007f8ac4aSLinus Lüssing entry = kmalloc(sizeof(*entry), GFP_ATOMIC); 476107f8ac4aSLinus Lüssing if (!entry) 476207f8ac4aSLinus Lüssing goto unlock; 476307f8ac4aSLinus Lüssing 4764085b53c8SNikolay Aleksandrov entry->addr = group->key.addr; 476507f8ac4aSLinus Lüssing list_add(&entry->list, br_ip_list); 476607f8ac4aSLinus Lüssing count++; 476707f8ac4aSLinus Lüssing } 476807f8ac4aSLinus Lüssing } 476907f8ac4aSLinus Lüssing 477007f8ac4aSLinus Lüssing unlock: 477107f8ac4aSLinus Lüssing rcu_read_unlock(); 477207f8ac4aSLinus Lüssing return count; 477307f8ac4aSLinus Lüssing } 477407f8ac4aSLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_list_adjacent); 47752cd41431SLinus Lüssing 47762cd41431SLinus Lüssing /** 4777c34963e2SLinus Lüssing * br_multicast_has_querier_anywhere - Checks for a querier on a bridge 4778c34963e2SLinus Lüssing * @dev: The bridge port providing the bridge on which to check for a querier 4779c34963e2SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 4780c34963e2SLinus Lüssing * 4781c34963e2SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 4782c34963e2SLinus Lüssing * true if a valid querier exists anywhere on the bridged link layer. 4783c34963e2SLinus Lüssing * Otherwise returns false. 4784c34963e2SLinus Lüssing */ 4785c34963e2SLinus Lüssing bool br_multicast_has_querier_anywhere(struct net_device *dev, int proto) 4786c34963e2SLinus Lüssing { 4787c34963e2SLinus Lüssing struct net_bridge *br; 4788c34963e2SLinus Lüssing struct net_bridge_port *port; 4789c34963e2SLinus Lüssing struct ethhdr eth; 4790c34963e2SLinus Lüssing bool ret = false; 4791c34963e2SLinus Lüssing 4792c34963e2SLinus Lüssing rcu_read_lock(); 479335f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 4794c34963e2SLinus Lüssing goto unlock; 4795c34963e2SLinus Lüssing 4796c34963e2SLinus Lüssing port = br_port_get_rcu(dev); 4797c34963e2SLinus Lüssing if (!port || !port->br) 4798c34963e2SLinus Lüssing goto unlock; 4799c34963e2SLinus Lüssing 4800c34963e2SLinus Lüssing br = port->br; 4801c34963e2SLinus Lüssing 4802c34963e2SLinus Lüssing memset(ð, 0, sizeof(eth)); 4803c34963e2SLinus Lüssing eth.h_proto = htons(proto); 4804c34963e2SLinus Lüssing 4805adc47037SNikolay Aleksandrov ret = br_multicast_querier_exists(&br->multicast_ctx, ð, NULL); 4806c34963e2SLinus Lüssing 4807c34963e2SLinus Lüssing unlock: 4808c34963e2SLinus Lüssing rcu_read_unlock(); 4809c34963e2SLinus Lüssing return ret; 4810c34963e2SLinus Lüssing } 4811c34963e2SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_anywhere); 4812c34963e2SLinus Lüssing 4813c34963e2SLinus Lüssing /** 48142cd41431SLinus Lüssing * br_multicast_has_querier_adjacent - Checks for a querier behind a bridge port 48152cd41431SLinus Lüssing * @dev: The bridge port adjacent to which to check for a querier 48162cd41431SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 48172cd41431SLinus Lüssing * 48182cd41431SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 48192cd41431SLinus Lüssing * true if a selected querier is behind one of the other ports of this 48202cd41431SLinus Lüssing * bridge. Otherwise returns false. 48212cd41431SLinus Lüssing */ 48222cd41431SLinus Lüssing bool br_multicast_has_querier_adjacent(struct net_device *dev, int proto) 48232cd41431SLinus Lüssing { 4824d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 48252cd41431SLinus Lüssing struct net_bridge *br; 48262cd41431SLinus Lüssing struct net_bridge_port *port; 48272cd41431SLinus Lüssing bool ret = false; 4828bb18ef8eSNikolay Aleksandrov int port_ifidx; 48292cd41431SLinus Lüssing 48302cd41431SLinus Lüssing rcu_read_lock(); 483135f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 48322cd41431SLinus Lüssing goto unlock; 48332cd41431SLinus Lüssing 48342cd41431SLinus Lüssing port = br_port_get_rcu(dev); 48352cd41431SLinus Lüssing if (!port || !port->br) 48362cd41431SLinus Lüssing goto unlock; 48372cd41431SLinus Lüssing 48382cd41431SLinus Lüssing br = port->br; 4839d3d065c0SNikolay Aleksandrov brmctx = &br->multicast_ctx; 48402cd41431SLinus Lüssing 48412cd41431SLinus Lüssing switch (proto) { 48422cd41431SLinus Lüssing case ETH_P_IP: 4843bb18ef8eSNikolay Aleksandrov port_ifidx = brmctx->ip4_querier.port_ifidx; 4844d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip4_other_query.timer) || 4845bb18ef8eSNikolay Aleksandrov port_ifidx == port->dev->ifindex) 48462cd41431SLinus Lüssing goto unlock; 48472cd41431SLinus Lüssing break; 48483993c4e1SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 48492cd41431SLinus Lüssing case ETH_P_IPV6: 4850bb18ef8eSNikolay Aleksandrov port_ifidx = brmctx->ip6_querier.port_ifidx; 4851d3d065c0SNikolay Aleksandrov if (!timer_pending(&brmctx->ip6_other_query.timer) || 4852bb18ef8eSNikolay Aleksandrov port_ifidx == port->dev->ifindex) 48532cd41431SLinus Lüssing goto unlock; 48542cd41431SLinus Lüssing break; 48553993c4e1SLinus Lüssing #endif 48562cd41431SLinus Lüssing default: 48572cd41431SLinus Lüssing goto unlock; 48582cd41431SLinus Lüssing } 48592cd41431SLinus Lüssing 48602cd41431SLinus Lüssing ret = true; 48612cd41431SLinus Lüssing unlock: 48622cd41431SLinus Lüssing rcu_read_unlock(); 48632cd41431SLinus Lüssing return ret; 48642cd41431SLinus Lüssing } 48652cd41431SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_adjacent); 48661080ab95SNikolay Aleksandrov 48673b85f9baSLinus Lüssing /** 48683b85f9baSLinus Lüssing * br_multicast_has_router_adjacent - Checks for a router behind a bridge port 48693b85f9baSLinus Lüssing * @dev: The bridge port adjacent to which to check for a multicast router 48703b85f9baSLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 48713b85f9baSLinus Lüssing * 48723b85f9baSLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 48733b85f9baSLinus Lüssing * true if a multicast router is behind one of the other ports of this 48743b85f9baSLinus Lüssing * bridge. Otherwise returns false. 48753b85f9baSLinus Lüssing */ 48763b85f9baSLinus Lüssing bool br_multicast_has_router_adjacent(struct net_device *dev, int proto) 48773b85f9baSLinus Lüssing { 48789632233eSNikolay Aleksandrov struct net_bridge_mcast_port *pmctx; 4879d3d065c0SNikolay Aleksandrov struct net_bridge_mcast *brmctx; 48809632233eSNikolay Aleksandrov struct net_bridge_port *port; 48813b85f9baSLinus Lüssing bool ret = false; 48823b85f9baSLinus Lüssing 48833b85f9baSLinus Lüssing rcu_read_lock(); 48843b85f9baSLinus Lüssing port = br_port_get_check_rcu(dev); 48853b85f9baSLinus Lüssing if (!port) 48863b85f9baSLinus Lüssing goto unlock; 48873b85f9baSLinus Lüssing 4888d3d065c0SNikolay Aleksandrov brmctx = &port->br->multicast_ctx; 48893b85f9baSLinus Lüssing switch (proto) { 48903b85f9baSLinus Lüssing case ETH_P_IP: 4891d3d065c0SNikolay Aleksandrov hlist_for_each_entry_rcu(pmctx, &brmctx->ip4_mc_router_list, 48923b85f9baSLinus Lüssing ip4_rlist) { 48939632233eSNikolay Aleksandrov if (pmctx->port == port) 48943b85f9baSLinus Lüssing continue; 48953b85f9baSLinus Lüssing 48963b85f9baSLinus Lüssing ret = true; 48973b85f9baSLinus Lüssing goto unlock; 48983b85f9baSLinus Lüssing } 48993b85f9baSLinus Lüssing break; 49003b85f9baSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 49013b85f9baSLinus Lüssing case ETH_P_IPV6: 4902d3d065c0SNikolay Aleksandrov hlist_for_each_entry_rcu(pmctx, &brmctx->ip6_mc_router_list, 49033b85f9baSLinus Lüssing ip6_rlist) { 49049632233eSNikolay Aleksandrov if (pmctx->port == port) 49053b85f9baSLinus Lüssing continue; 49063b85f9baSLinus Lüssing 49073b85f9baSLinus Lüssing ret = true; 49083b85f9baSLinus Lüssing goto unlock; 49093b85f9baSLinus Lüssing } 49103b85f9baSLinus Lüssing break; 49113b85f9baSLinus Lüssing #endif 49123b85f9baSLinus Lüssing default: 49133b85f9baSLinus Lüssing /* when compiled without IPv6 support, be conservative and 49143b85f9baSLinus Lüssing * always assume presence of an IPv6 multicast router 49153b85f9baSLinus Lüssing */ 49163b85f9baSLinus Lüssing ret = true; 49173b85f9baSLinus Lüssing } 49183b85f9baSLinus Lüssing 49193b85f9baSLinus Lüssing unlock: 49203b85f9baSLinus Lüssing rcu_read_unlock(); 49213b85f9baSLinus Lüssing return ret; 49223b85f9baSLinus Lüssing } 49233b85f9baSLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_router_adjacent); 49243b85f9baSLinus Lüssing 49251080ab95SNikolay Aleksandrov static void br_mcast_stats_add(struct bridge_mcast_stats __percpu *stats, 4926a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 49271080ab95SNikolay Aleksandrov { 49281080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats = this_cpu_ptr(stats); 4929a65056ecSNikolay Aleksandrov __be16 proto = skb->protocol; 4930a65056ecSNikolay Aleksandrov unsigned int t_len; 49311080ab95SNikolay Aleksandrov 49321080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 49331080ab95SNikolay Aleksandrov switch (proto) { 49341080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 4935a65056ecSNikolay Aleksandrov t_len = ntohs(ip_hdr(skb)->tot_len) - ip_hdrlen(skb); 49361080ab95SNikolay Aleksandrov switch (type) { 49371080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_REPORT: 49381080ab95SNikolay Aleksandrov pstats->mstats.igmp_v1reports[dir]++; 49391080ab95SNikolay Aleksandrov break; 49401080ab95SNikolay Aleksandrov case IGMPV2_HOST_MEMBERSHIP_REPORT: 49411080ab95SNikolay Aleksandrov pstats->mstats.igmp_v2reports[dir]++; 49421080ab95SNikolay Aleksandrov break; 49431080ab95SNikolay Aleksandrov case IGMPV3_HOST_MEMBERSHIP_REPORT: 49441080ab95SNikolay Aleksandrov pstats->mstats.igmp_v3reports[dir]++; 49451080ab95SNikolay Aleksandrov break; 49461080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_QUERY: 4947a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct igmphdr)) { 4948a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v3queries[dir]++; 4949a65056ecSNikolay Aleksandrov } else { 4950a65056ecSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 4951a65056ecSNikolay Aleksandrov struct igmphdr *ih, _ihdr; 4952a65056ecSNikolay Aleksandrov 4953a65056ecSNikolay Aleksandrov ih = skb_header_pointer(skb, offset, 4954a65056ecSNikolay Aleksandrov sizeof(_ihdr), &_ihdr); 4955a65056ecSNikolay Aleksandrov if (!ih) 4956a65056ecSNikolay Aleksandrov break; 4957a65056ecSNikolay Aleksandrov if (!ih->code) 4958a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v1queries[dir]++; 4959a65056ecSNikolay Aleksandrov else 4960a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v2queries[dir]++; 4961a65056ecSNikolay Aleksandrov } 49621080ab95SNikolay Aleksandrov break; 49631080ab95SNikolay Aleksandrov case IGMP_HOST_LEAVE_MESSAGE: 49641080ab95SNikolay Aleksandrov pstats->mstats.igmp_leaves[dir]++; 49651080ab95SNikolay Aleksandrov break; 49661080ab95SNikolay Aleksandrov } 49671080ab95SNikolay Aleksandrov break; 49681080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 49691080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 4970a65056ecSNikolay Aleksandrov t_len = ntohs(ipv6_hdr(skb)->payload_len) + 4971a65056ecSNikolay Aleksandrov sizeof(struct ipv6hdr); 4972a65056ecSNikolay Aleksandrov t_len -= skb_network_header_len(skb); 49731080ab95SNikolay Aleksandrov switch (type) { 49741080ab95SNikolay Aleksandrov case ICMPV6_MGM_REPORT: 49751080ab95SNikolay Aleksandrov pstats->mstats.mld_v1reports[dir]++; 49761080ab95SNikolay Aleksandrov break; 49771080ab95SNikolay Aleksandrov case ICMPV6_MLD2_REPORT: 49781080ab95SNikolay Aleksandrov pstats->mstats.mld_v2reports[dir]++; 49791080ab95SNikolay Aleksandrov break; 49801080ab95SNikolay Aleksandrov case ICMPV6_MGM_QUERY: 4981a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct mld_msg)) 4982a65056ecSNikolay Aleksandrov pstats->mstats.mld_v2queries[dir]++; 4983a65056ecSNikolay Aleksandrov else 4984a65056ecSNikolay Aleksandrov pstats->mstats.mld_v1queries[dir]++; 49851080ab95SNikolay Aleksandrov break; 49861080ab95SNikolay Aleksandrov case ICMPV6_MGM_REDUCTION: 49871080ab95SNikolay Aleksandrov pstats->mstats.mld_leaves[dir]++; 49881080ab95SNikolay Aleksandrov break; 49891080ab95SNikolay Aleksandrov } 49901080ab95SNikolay Aleksandrov break; 49911080ab95SNikolay Aleksandrov #endif /* CONFIG_IPV6 */ 49921080ab95SNikolay Aleksandrov } 49931080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 49941080ab95SNikolay Aleksandrov } 49951080ab95SNikolay Aleksandrov 4996adc47037SNikolay Aleksandrov void br_multicast_count(struct net_bridge *br, 4997adc47037SNikolay Aleksandrov const struct net_bridge_port *p, 4998a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 49991080ab95SNikolay Aleksandrov { 50001080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 50011080ab95SNikolay Aleksandrov 50021080ab95SNikolay Aleksandrov /* if multicast_disabled is true then igmp type can't be set */ 5003675779adSNikolay Aleksandrov if (!type || !br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 50041080ab95SNikolay Aleksandrov return; 50051080ab95SNikolay Aleksandrov 50061080ab95SNikolay Aleksandrov if (p) 50071080ab95SNikolay Aleksandrov stats = p->mcast_stats; 50081080ab95SNikolay Aleksandrov else 50091080ab95SNikolay Aleksandrov stats = br->mcast_stats; 50101080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 50111080ab95SNikolay Aleksandrov return; 50121080ab95SNikolay Aleksandrov 5013a65056ecSNikolay Aleksandrov br_mcast_stats_add(stats, skb, type, dir); 50141080ab95SNikolay Aleksandrov } 50151080ab95SNikolay Aleksandrov 50161080ab95SNikolay Aleksandrov int br_multicast_init_stats(struct net_bridge *br) 50171080ab95SNikolay Aleksandrov { 50181080ab95SNikolay Aleksandrov br->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 50191080ab95SNikolay Aleksandrov if (!br->mcast_stats) 50201080ab95SNikolay Aleksandrov return -ENOMEM; 50211080ab95SNikolay Aleksandrov 50221080ab95SNikolay Aleksandrov return 0; 50231080ab95SNikolay Aleksandrov } 50241080ab95SNikolay Aleksandrov 5025b6fe0440SIdo Schimmel void br_multicast_uninit_stats(struct net_bridge *br) 5026b6fe0440SIdo Schimmel { 5027b6fe0440SIdo Schimmel free_percpu(br->mcast_stats); 5028b6fe0440SIdo Schimmel } 5029b6fe0440SIdo Schimmel 5030b3b6a84cSArnd Bergmann /* noinline for https://bugs.llvm.org/show_bug.cgi?id=45802#c9 */ 5031b3b6a84cSArnd Bergmann static noinline_for_stack void mcast_stats_add_dir(u64 *dst, u64 *src) 50321080ab95SNikolay Aleksandrov { 50331080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_RX] += src[BR_MCAST_DIR_RX]; 50341080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_TX] += src[BR_MCAST_DIR_TX]; 50351080ab95SNikolay Aleksandrov } 50361080ab95SNikolay Aleksandrov 50371080ab95SNikolay Aleksandrov void br_multicast_get_stats(const struct net_bridge *br, 50381080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 50391080ab95SNikolay Aleksandrov struct br_mcast_stats *dest) 50401080ab95SNikolay Aleksandrov { 50411080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 50421080ab95SNikolay Aleksandrov struct br_mcast_stats tdst; 50431080ab95SNikolay Aleksandrov int i; 50441080ab95SNikolay Aleksandrov 50451080ab95SNikolay Aleksandrov memset(dest, 0, sizeof(*dest)); 50461080ab95SNikolay Aleksandrov if (p) 50471080ab95SNikolay Aleksandrov stats = p->mcast_stats; 50481080ab95SNikolay Aleksandrov else 50491080ab95SNikolay Aleksandrov stats = br->mcast_stats; 50501080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 50511080ab95SNikolay Aleksandrov return; 50521080ab95SNikolay Aleksandrov 50531080ab95SNikolay Aleksandrov memset(&tdst, 0, sizeof(tdst)); 50541080ab95SNikolay Aleksandrov for_each_possible_cpu(i) { 50551080ab95SNikolay Aleksandrov struct bridge_mcast_stats *cpu_stats = per_cpu_ptr(stats, i); 50561080ab95SNikolay Aleksandrov struct br_mcast_stats temp; 50571080ab95SNikolay Aleksandrov unsigned int start; 50581080ab95SNikolay Aleksandrov 50591080ab95SNikolay Aleksandrov do { 5060d120d1a6SThomas Gleixner start = u64_stats_fetch_begin(&cpu_stats->syncp); 50611080ab95SNikolay Aleksandrov memcpy(&temp, &cpu_stats->mstats, sizeof(temp)); 5062d120d1a6SThomas Gleixner } while (u64_stats_fetch_retry(&cpu_stats->syncp, start)); 50631080ab95SNikolay Aleksandrov 5064a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1queries, temp.igmp_v1queries); 5065a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2queries, temp.igmp_v2queries); 5066a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3queries, temp.igmp_v3queries); 50671080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_leaves, temp.igmp_leaves); 50681080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1reports, temp.igmp_v1reports); 50691080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2reports, temp.igmp_v2reports); 50701080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3reports, temp.igmp_v3reports); 50711080ab95SNikolay Aleksandrov tdst.igmp_parse_errors += temp.igmp_parse_errors; 50721080ab95SNikolay Aleksandrov 5073a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1queries, temp.mld_v1queries); 5074a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2queries, temp.mld_v2queries); 50751080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_leaves, temp.mld_leaves); 50761080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1reports, temp.mld_v1reports); 50771080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2reports, temp.mld_v2reports); 50781080ab95SNikolay Aleksandrov tdst.mld_parse_errors += temp.mld_parse_errors; 50791080ab95SNikolay Aleksandrov } 50801080ab95SNikolay Aleksandrov memcpy(dest, &tdst, sizeof(*dest)); 50811080ab95SNikolay Aleksandrov } 508219e3a9c9SNikolay Aleksandrov 508319e3a9c9SNikolay Aleksandrov int br_mdb_hash_init(struct net_bridge *br) 508419e3a9c9SNikolay Aleksandrov { 5085085b53c8SNikolay Aleksandrov int err; 5086085b53c8SNikolay Aleksandrov 5087085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->sg_port_tbl, &br_sg_port_rht_params); 5088085b53c8SNikolay Aleksandrov if (err) 5089085b53c8SNikolay Aleksandrov return err; 5090085b53c8SNikolay Aleksandrov 5091085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->mdb_hash_tbl, &br_mdb_rht_params); 5092085b53c8SNikolay Aleksandrov if (err) { 5093085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 5094085b53c8SNikolay Aleksandrov return err; 5095085b53c8SNikolay Aleksandrov } 5096085b53c8SNikolay Aleksandrov 5097085b53c8SNikolay Aleksandrov return 0; 509819e3a9c9SNikolay Aleksandrov } 509919e3a9c9SNikolay Aleksandrov 510019e3a9c9SNikolay Aleksandrov void br_mdb_hash_fini(struct net_bridge *br) 510119e3a9c9SNikolay Aleksandrov { 5102085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 510319e3a9c9SNikolay Aleksandrov rhashtable_destroy(&br->mdb_hash_tbl); 510419e3a9c9SNikolay Aleksandrov } 5105