12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 2eb1d1641SHerbert Xu /* 3eb1d1641SHerbert Xu * Bridge multicast support. 4eb1d1641SHerbert Xu * 5eb1d1641SHerbert Xu * Copyright (c) 2010 Herbert Xu <herbert@gondor.apana.org.au> 6eb1d1641SHerbert Xu */ 7eb1d1641SHerbert Xu 8eb1d1641SHerbert Xu #include <linux/err.h> 907f8ac4aSLinus Lüssing #include <linux/export.h> 10eb1d1641SHerbert Xu #include <linux/if_ether.h> 11eb1d1641SHerbert Xu #include <linux/igmp.h> 124b3087c7SLinus Lüssing #include <linux/in.h> 13eb1d1641SHerbert Xu #include <linux/jhash.h> 14eb1d1641SHerbert Xu #include <linux/kernel.h> 15b195167fSHerbert Xu #include <linux/log2.h> 16eb1d1641SHerbert Xu #include <linux/netdevice.h> 17eb1d1641SHerbert Xu #include <linux/netfilter_bridge.h> 18eb1d1641SHerbert Xu #include <linux/random.h> 19eb1d1641SHerbert Xu #include <linux/rculist.h> 20eb1d1641SHerbert Xu #include <linux/skbuff.h> 21eb1d1641SHerbert Xu #include <linux/slab.h> 22eb1d1641SHerbert Xu #include <linux/timer.h> 231c8ad5bfSCong Wang #include <linux/inetdevice.h> 2491b02d3dSNikolay Aleksandrov #include <linux/mroute.h> 25eb1d1641SHerbert Xu #include <net/ip.h> 26147c1e9bSNogah Frankel #include <net/switchdev.h> 27dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 284b3087c7SLinus Lüssing #include <linux/icmpv6.h> 2908b202b6SYOSHIFUJI Hideaki #include <net/ipv6.h> 3008b202b6SYOSHIFUJI Hideaki #include <net/mld.h> 31d4c4f07dSDavid S. Miller #include <net/ip6_checksum.h> 323c3769e6SLinus Lüssing #include <net/addrconf.h> 3308b202b6SYOSHIFUJI Hideaki #endif 34eb1d1641SHerbert Xu 35eb1d1641SHerbert Xu #include "br_private.h" 36*8f07b831SNikolay Aleksandrov #include "br_private_mcast_eht.h" 37eb1d1641SHerbert Xu 3819e3a9c9SNikolay Aleksandrov static const struct rhashtable_params br_mdb_rht_params = { 3919e3a9c9SNikolay Aleksandrov .head_offset = offsetof(struct net_bridge_mdb_entry, rhnode), 4019e3a9c9SNikolay Aleksandrov .key_offset = offsetof(struct net_bridge_mdb_entry, addr), 4119e3a9c9SNikolay Aleksandrov .key_len = sizeof(struct br_ip), 4219e3a9c9SNikolay Aleksandrov .automatic_shrinking = true, 4319e3a9c9SNikolay Aleksandrov }; 4419e3a9c9SNikolay Aleksandrov 45085b53c8SNikolay Aleksandrov static const struct rhashtable_params br_sg_port_rht_params = { 46085b53c8SNikolay Aleksandrov .head_offset = offsetof(struct net_bridge_port_group, rhnode), 47085b53c8SNikolay Aleksandrov .key_offset = offsetof(struct net_bridge_port_group, key), 48085b53c8SNikolay Aleksandrov .key_len = sizeof(struct net_bridge_port_group_sg_key), 49085b53c8SNikolay Aleksandrov .automatic_shrinking = true, 50085b53c8SNikolay Aleksandrov }; 51085b53c8SNikolay Aleksandrov 52cc0fdd80SLinus Lüssing static void br_multicast_start_querier(struct net_bridge *br, 5390010b36SLinus Lüssing struct bridge_mcast_own_query *query); 54754bc547SSatish Ashok static void br_multicast_add_router(struct net_bridge *br, 55754bc547SSatish Ashok struct net_bridge_port *port); 56bc8c20acSSatish Ashok static void br_ip4_multicast_leave_group(struct net_bridge *br, 57bc8c20acSSatish Ashok struct net_bridge_port *port, 58bc8c20acSSatish Ashok __be32 group, 596db6f0eaSFelix Fietkau __u16 vid, 606db6f0eaSFelix Fietkau const unsigned char *src); 6142c11ccfSNikolay Aleksandrov static void br_multicast_port_group_rexmit(struct timer_list *t); 626db6f0eaSFelix Fietkau 63f12e7d95SNogah Frankel static void __del_port_router(struct net_bridge_port *p); 64bc8c20acSSatish Ashok #if IS_ENABLED(CONFIG_IPV6) 65bc8c20acSSatish Ashok static void br_ip6_multicast_leave_group(struct net_bridge *br, 66bc8c20acSSatish Ashok struct net_bridge_port *port, 67bc8c20acSSatish Ashok const struct in6_addr *group, 686db6f0eaSFelix Fietkau __u16 vid, const unsigned char *src); 69bc8c20acSSatish Ashok #endif 70b0812368SNikolay Aleksandrov static struct net_bridge_port_group * 71b0812368SNikolay Aleksandrov __br_multicast_add_group(struct net_bridge *br, 72b0812368SNikolay Aleksandrov struct net_bridge_port *port, 73b0812368SNikolay Aleksandrov struct br_ip *group, 74b0812368SNikolay Aleksandrov const unsigned char *src, 75b0812368SNikolay Aleksandrov u8 filter_mode, 769116ffbfSNikolay Aleksandrov bool igmpv2_mldv1, 779116ffbfSNikolay Aleksandrov bool blocked); 788266a049SNikolay Aleksandrov static void br_multicast_find_del_pg(struct net_bridge *br, 798266a049SNikolay Aleksandrov struct net_bridge_port_group *pg); 80c83b8fabSHerbert Xu 81085b53c8SNikolay Aleksandrov static struct net_bridge_port_group * 82085b53c8SNikolay Aleksandrov br_sg_port_find(struct net_bridge *br, 83085b53c8SNikolay Aleksandrov struct net_bridge_port_group_sg_key *sg_p) 84085b53c8SNikolay Aleksandrov { 85085b53c8SNikolay Aleksandrov lockdep_assert_held_once(&br->multicast_lock); 86085b53c8SNikolay Aleksandrov 87085b53c8SNikolay Aleksandrov return rhashtable_lookup_fast(&br->sg_port_tbl, sg_p, 88085b53c8SNikolay Aleksandrov br_sg_port_rht_params); 89085b53c8SNikolay Aleksandrov } 90085b53c8SNikolay Aleksandrov 9119e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip_get_rcu(struct net_bridge *br, 92cfd56754SCong Wang struct br_ip *dst) 937f285fa7SHerbert Xu { 9419e3a9c9SNikolay Aleksandrov return rhashtable_lookup(&br->mdb_hash_tbl, dst, br_mdb_rht_params); 957f285fa7SHerbert Xu } 967f285fa7SHerbert Xu 9719e3a9c9SNikolay Aleksandrov struct net_bridge_mdb_entry *br_mdb_ip_get(struct net_bridge *br, 9819e3a9c9SNikolay Aleksandrov struct br_ip *dst) 9919e3a9c9SNikolay Aleksandrov { 10019e3a9c9SNikolay Aleksandrov struct net_bridge_mdb_entry *ent; 10119e3a9c9SNikolay Aleksandrov 10219e3a9c9SNikolay Aleksandrov lockdep_assert_held_once(&br->multicast_lock); 10319e3a9c9SNikolay Aleksandrov 10419e3a9c9SNikolay Aleksandrov rcu_read_lock(); 10519e3a9c9SNikolay Aleksandrov ent = rhashtable_lookup(&br->mdb_hash_tbl, dst, br_mdb_rht_params); 10619e3a9c9SNikolay Aleksandrov rcu_read_unlock(); 10719e3a9c9SNikolay Aleksandrov 10819e3a9c9SNikolay Aleksandrov return ent; 10919e3a9c9SNikolay Aleksandrov } 11019e3a9c9SNikolay Aleksandrov 11119e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip4_get(struct net_bridge *br, 11219e3a9c9SNikolay Aleksandrov __be32 dst, __u16 vid) 113eb1d1641SHerbert Xu { 1148ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_dst; 1150821ec55SHerbert Xu 11619e3a9c9SNikolay Aleksandrov memset(&br_dst, 0, sizeof(br_dst)); 117eab3227bSNikolay Aleksandrov br_dst.dst.ip4 = dst; 1188ef2a9a5SYOSHIFUJI Hideaki br_dst.proto = htons(ETH_P_IP); 119b0e9a30dSVlad Yasevich br_dst.vid = vid; 1208ef2a9a5SYOSHIFUJI Hideaki 12119e3a9c9SNikolay Aleksandrov return br_mdb_ip_get(br, &br_dst); 1228ef2a9a5SYOSHIFUJI Hideaki } 1238ef2a9a5SYOSHIFUJI Hideaki 124dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 12519e3a9c9SNikolay Aleksandrov static struct net_bridge_mdb_entry *br_mdb_ip6_get(struct net_bridge *br, 12619e3a9c9SNikolay Aleksandrov const struct in6_addr *dst, 127b0e9a30dSVlad Yasevich __u16 vid) 12808b202b6SYOSHIFUJI Hideaki { 12908b202b6SYOSHIFUJI Hideaki struct br_ip br_dst; 13008b202b6SYOSHIFUJI Hideaki 13119e3a9c9SNikolay Aleksandrov memset(&br_dst, 0, sizeof(br_dst)); 132eab3227bSNikolay Aleksandrov br_dst.dst.ip6 = *dst; 13308b202b6SYOSHIFUJI Hideaki br_dst.proto = htons(ETH_P_IPV6); 134b0e9a30dSVlad Yasevich br_dst.vid = vid; 13508b202b6SYOSHIFUJI Hideaki 13619e3a9c9SNikolay Aleksandrov return br_mdb_ip_get(br, &br_dst); 13708b202b6SYOSHIFUJI Hideaki } 13808b202b6SYOSHIFUJI Hideaki #endif 13908b202b6SYOSHIFUJI Hideaki 140eb1d1641SHerbert Xu struct net_bridge_mdb_entry *br_mdb_get(struct net_bridge *br, 141fbca58a2SCong Wang struct sk_buff *skb, u16 vid) 142eb1d1641SHerbert Xu { 1438ef2a9a5SYOSHIFUJI Hideaki struct br_ip ip; 1448ef2a9a5SYOSHIFUJI Hideaki 14513cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) 146eb1d1641SHerbert Xu return NULL; 147eb1d1641SHerbert Xu 1488ef2a9a5SYOSHIFUJI Hideaki if (BR_INPUT_SKB_CB(skb)->igmp) 1498ef2a9a5SYOSHIFUJI Hideaki return NULL; 1508ef2a9a5SYOSHIFUJI Hideaki 15119e3a9c9SNikolay Aleksandrov memset(&ip, 0, sizeof(ip)); 1528ef2a9a5SYOSHIFUJI Hideaki ip.proto = skb->protocol; 153fbca58a2SCong Wang ip.vid = vid; 1548ef2a9a5SYOSHIFUJI Hideaki 155eb1d1641SHerbert Xu switch (skb->protocol) { 156eb1d1641SHerbert Xu case htons(ETH_P_IP): 157eab3227bSNikolay Aleksandrov ip.dst.ip4 = ip_hdr(skb)->daddr; 1587d07a68cSNikolay Aleksandrov if (br->multicast_igmp_version == 3) { 1597d07a68cSNikolay Aleksandrov struct net_bridge_mdb_entry *mdb; 1607d07a68cSNikolay Aleksandrov 1617d07a68cSNikolay Aleksandrov ip.src.ip4 = ip_hdr(skb)->saddr; 1627d07a68cSNikolay Aleksandrov mdb = br_mdb_ip_get_rcu(br, &ip); 1637d07a68cSNikolay Aleksandrov if (mdb) 1647d07a68cSNikolay Aleksandrov return mdb; 1657d07a68cSNikolay Aleksandrov ip.src.ip4 = 0; 1667d07a68cSNikolay Aleksandrov } 167eb1d1641SHerbert Xu break; 168dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 16908b202b6SYOSHIFUJI Hideaki case htons(ETH_P_IPV6): 170eab3227bSNikolay Aleksandrov ip.dst.ip6 = ipv6_hdr(skb)->daddr; 1717d07a68cSNikolay Aleksandrov if (br->multicast_mld_version == 2) { 1727d07a68cSNikolay Aleksandrov struct net_bridge_mdb_entry *mdb; 1737d07a68cSNikolay Aleksandrov 1747d07a68cSNikolay Aleksandrov ip.src.ip6 = ipv6_hdr(skb)->saddr; 1757d07a68cSNikolay Aleksandrov mdb = br_mdb_ip_get_rcu(br, &ip); 1767d07a68cSNikolay Aleksandrov if (mdb) 1777d07a68cSNikolay Aleksandrov return mdb; 1787d07a68cSNikolay Aleksandrov memset(&ip.src.ip6, 0, sizeof(ip.src.ip6)); 1797d07a68cSNikolay Aleksandrov } 18008b202b6SYOSHIFUJI Hideaki break; 18108b202b6SYOSHIFUJI Hideaki #endif 1828ef2a9a5SYOSHIFUJI Hideaki default: 183955062b0SNikolay Aleksandrov ip.proto = 0; 184955062b0SNikolay Aleksandrov ether_addr_copy(ip.dst.mac_addr, eth_hdr(skb)->h_dest); 185eb1d1641SHerbert Xu } 186eb1d1641SHerbert Xu 18719e3a9c9SNikolay Aleksandrov return br_mdb_ip_get_rcu(br, &ip); 188eb1d1641SHerbert Xu } 189eb1d1641SHerbert Xu 190b0812368SNikolay Aleksandrov static bool br_port_group_equal(struct net_bridge_port_group *p, 191b0812368SNikolay Aleksandrov struct net_bridge_port *port, 192b0812368SNikolay Aleksandrov const unsigned char *src) 193b0812368SNikolay Aleksandrov { 194b0812368SNikolay Aleksandrov if (p->key.port != port) 195b0812368SNikolay Aleksandrov return false; 196b0812368SNikolay Aleksandrov 197b0812368SNikolay Aleksandrov if (!(port->flags & BR_MULTICAST_TO_UNICAST)) 198b0812368SNikolay Aleksandrov return true; 199b0812368SNikolay Aleksandrov 200b0812368SNikolay Aleksandrov return ether_addr_equal(src, p->eth_addr); 201b0812368SNikolay Aleksandrov } 202b0812368SNikolay Aleksandrov 2038266a049SNikolay Aleksandrov static void __fwd_add_star_excl(struct net_bridge_port_group *pg, 2048266a049SNikolay Aleksandrov struct br_ip *sg_ip) 2058266a049SNikolay Aleksandrov { 2068266a049SNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 2078266a049SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 2088266a049SNikolay Aleksandrov struct net_bridge_port_group *src_pg; 2098266a049SNikolay Aleksandrov 2108266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 2118266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 2128266a049SNikolay Aleksandrov sg_key.addr = *sg_ip; 2138266a049SNikolay Aleksandrov if (br_sg_port_find(br, &sg_key)) 2148266a049SNikolay Aleksandrov return; 2158266a049SNikolay Aleksandrov 2168266a049SNikolay Aleksandrov src_pg = __br_multicast_add_group(br, pg->key.port, sg_ip, pg->eth_addr, 2179116ffbfSNikolay Aleksandrov MCAST_INCLUDE, false, false); 2188266a049SNikolay Aleksandrov if (IS_ERR_OR_NULL(src_pg) || 2198266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 2208266a049SNikolay Aleksandrov return; 2218266a049SNikolay Aleksandrov 2228266a049SNikolay Aleksandrov src_pg->flags |= MDB_PG_FLAGS_STAR_EXCL; 2238266a049SNikolay Aleksandrov } 2248266a049SNikolay Aleksandrov 2258266a049SNikolay Aleksandrov static void __fwd_del_star_excl(struct net_bridge_port_group *pg, 2268266a049SNikolay Aleksandrov struct br_ip *sg_ip) 2278266a049SNikolay Aleksandrov { 2288266a049SNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 2298266a049SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 2308266a049SNikolay Aleksandrov struct net_bridge_port_group *src_pg; 2318266a049SNikolay Aleksandrov 2328266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 2338266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 2348266a049SNikolay Aleksandrov sg_key.addr = *sg_ip; 2358266a049SNikolay Aleksandrov src_pg = br_sg_port_find(br, &sg_key); 2368266a049SNikolay Aleksandrov if (!src_pg || !(src_pg->flags & MDB_PG_FLAGS_STAR_EXCL) || 2378266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 2388266a049SNikolay Aleksandrov return; 2398266a049SNikolay Aleksandrov 2408266a049SNikolay Aleksandrov br_multicast_find_del_pg(br, src_pg); 2418266a049SNikolay Aleksandrov } 2428266a049SNikolay Aleksandrov 2438266a049SNikolay Aleksandrov /* When a port group transitions to (or is added as) EXCLUDE we need to add it 2448266a049SNikolay Aleksandrov * to all other ports' S,G entries which are not blocked by the current group 2458266a049SNikolay Aleksandrov * for proper replication, the assumption is that any S,G blocked entries 2468266a049SNikolay Aleksandrov * are already added so the S,G,port lookup should skip them. 2478266a049SNikolay Aleksandrov * When a port group transitions from EXCLUDE -> INCLUDE mode or is being 2488266a049SNikolay Aleksandrov * deleted we need to remove it from all ports' S,G entries where it was 2498266a049SNikolay Aleksandrov * automatically installed before (i.e. where it's MDB_PG_FLAGS_STAR_EXCL). 2508266a049SNikolay Aleksandrov */ 2518266a049SNikolay Aleksandrov void br_multicast_star_g_handle_mode(struct net_bridge_port_group *pg, 2528266a049SNikolay Aleksandrov u8 filter_mode) 2538266a049SNikolay Aleksandrov { 2548266a049SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 2558266a049SNikolay Aleksandrov struct net_bridge_port_group *pg_lst; 2568266a049SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 2578266a049SNikolay Aleksandrov struct br_ip sg_ip; 2588266a049SNikolay Aleksandrov 2598266a049SNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&pg->key.addr))) 2608266a049SNikolay Aleksandrov return; 2618266a049SNikolay Aleksandrov 2628266a049SNikolay Aleksandrov mp = br_mdb_ip_get(br, &pg->key.addr); 2638266a049SNikolay Aleksandrov if (!mp) 2648266a049SNikolay Aleksandrov return; 2658266a049SNikolay Aleksandrov 2668266a049SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 2678266a049SNikolay Aleksandrov sg_ip = pg->key.addr; 2688266a049SNikolay Aleksandrov for (pg_lst = mlock_dereference(mp->ports, br); 2698266a049SNikolay Aleksandrov pg_lst; 2708266a049SNikolay Aleksandrov pg_lst = mlock_dereference(pg_lst->next, br)) { 2718266a049SNikolay Aleksandrov struct net_bridge_group_src *src_ent; 2728266a049SNikolay Aleksandrov 2738266a049SNikolay Aleksandrov if (pg_lst == pg) 2748266a049SNikolay Aleksandrov continue; 2758266a049SNikolay Aleksandrov hlist_for_each_entry(src_ent, &pg_lst->src_list, node) { 2768266a049SNikolay Aleksandrov if (!(src_ent->flags & BR_SGRP_F_INSTALLED)) 2778266a049SNikolay Aleksandrov continue; 2788266a049SNikolay Aleksandrov sg_ip.src = src_ent->addr.src; 2798266a049SNikolay Aleksandrov switch (filter_mode) { 2808266a049SNikolay Aleksandrov case MCAST_INCLUDE: 2818266a049SNikolay Aleksandrov __fwd_del_star_excl(pg, &sg_ip); 2828266a049SNikolay Aleksandrov break; 2838266a049SNikolay Aleksandrov case MCAST_EXCLUDE: 2848266a049SNikolay Aleksandrov __fwd_add_star_excl(pg, &sg_ip); 2858266a049SNikolay Aleksandrov break; 2868266a049SNikolay Aleksandrov } 2878266a049SNikolay Aleksandrov } 2888266a049SNikolay Aleksandrov } 2898266a049SNikolay Aleksandrov } 2908266a049SNikolay Aleksandrov 291094b82fdSNikolay Aleksandrov /* called when adding a new S,G with host_joined == false by default */ 292094b82fdSNikolay Aleksandrov static void br_multicast_sg_host_state(struct net_bridge_mdb_entry *star_mp, 293094b82fdSNikolay Aleksandrov struct net_bridge_port_group *sg) 294094b82fdSNikolay Aleksandrov { 295094b82fdSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 296094b82fdSNikolay Aleksandrov 297094b82fdSNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 298094b82fdSNikolay Aleksandrov return; 299094b82fdSNikolay Aleksandrov if (!star_mp->host_joined) 300094b82fdSNikolay Aleksandrov return; 301094b82fdSNikolay Aleksandrov 302094b82fdSNikolay Aleksandrov sg_mp = br_mdb_ip_get(star_mp->br, &sg->key.addr); 303094b82fdSNikolay Aleksandrov if (!sg_mp) 304094b82fdSNikolay Aleksandrov return; 305094b82fdSNikolay Aleksandrov sg_mp->host_joined = true; 306094b82fdSNikolay Aleksandrov } 307094b82fdSNikolay Aleksandrov 308094b82fdSNikolay Aleksandrov /* set the host_joined state of all of *,G's S,G entries */ 309094b82fdSNikolay Aleksandrov static void br_multicast_star_g_host_state(struct net_bridge_mdb_entry *star_mp) 310094b82fdSNikolay Aleksandrov { 311094b82fdSNikolay Aleksandrov struct net_bridge *br = star_mp->br; 312094b82fdSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 313094b82fdSNikolay Aleksandrov struct net_bridge_port_group *pg; 314094b82fdSNikolay Aleksandrov struct br_ip sg_ip; 315094b82fdSNikolay Aleksandrov 316094b82fdSNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 317094b82fdSNikolay Aleksandrov return; 318094b82fdSNikolay Aleksandrov 319094b82fdSNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 320094b82fdSNikolay Aleksandrov sg_ip = star_mp->addr; 321094b82fdSNikolay Aleksandrov for (pg = mlock_dereference(star_mp->ports, br); 322094b82fdSNikolay Aleksandrov pg; 323094b82fdSNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) { 324094b82fdSNikolay Aleksandrov struct net_bridge_group_src *src_ent; 325094b82fdSNikolay Aleksandrov 326094b82fdSNikolay Aleksandrov hlist_for_each_entry(src_ent, &pg->src_list, node) { 327094b82fdSNikolay Aleksandrov if (!(src_ent->flags & BR_SGRP_F_INSTALLED)) 328094b82fdSNikolay Aleksandrov continue; 329094b82fdSNikolay Aleksandrov sg_ip.src = src_ent->addr.src; 330094b82fdSNikolay Aleksandrov sg_mp = br_mdb_ip_get(br, &sg_ip); 331094b82fdSNikolay Aleksandrov if (!sg_mp) 332094b82fdSNikolay Aleksandrov continue; 333094b82fdSNikolay Aleksandrov sg_mp->host_joined = star_mp->host_joined; 334094b82fdSNikolay Aleksandrov } 335094b82fdSNikolay Aleksandrov } 336094b82fdSNikolay Aleksandrov } 337094b82fdSNikolay Aleksandrov 3388266a049SNikolay Aleksandrov static void br_multicast_sg_del_exclude_ports(struct net_bridge_mdb_entry *sgmp) 3398266a049SNikolay Aleksandrov { 3408266a049SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 3418266a049SNikolay Aleksandrov struct net_bridge_port_group *p; 3428266a049SNikolay Aleksandrov 3438266a049SNikolay Aleksandrov /* *,G exclude ports are only added to S,G entries */ 3448266a049SNikolay Aleksandrov if (WARN_ON(br_multicast_is_star_g(&sgmp->addr))) 3458266a049SNikolay Aleksandrov return; 3468266a049SNikolay Aleksandrov 3478266a049SNikolay Aleksandrov /* we need the STAR_EXCLUDE ports if there are non-STAR_EXCLUDE ports 3488266a049SNikolay Aleksandrov * we should ignore perm entries since they're managed by user-space 3498266a049SNikolay Aleksandrov */ 3508266a049SNikolay Aleksandrov for (pp = &sgmp->ports; 3518266a049SNikolay Aleksandrov (p = mlock_dereference(*pp, sgmp->br)) != NULL; 3528266a049SNikolay Aleksandrov pp = &p->next) 3538266a049SNikolay Aleksandrov if (!(p->flags & (MDB_PG_FLAGS_STAR_EXCL | 3548266a049SNikolay Aleksandrov MDB_PG_FLAGS_PERMANENT))) 3558266a049SNikolay Aleksandrov return; 3568266a049SNikolay Aleksandrov 357094b82fdSNikolay Aleksandrov /* currently the host can only have joined the *,G which means 358094b82fdSNikolay Aleksandrov * we treat it as EXCLUDE {}, so for an S,G it's considered a 359094b82fdSNikolay Aleksandrov * STAR_EXCLUDE entry and we can safely leave it 360094b82fdSNikolay Aleksandrov */ 361094b82fdSNikolay Aleksandrov sgmp->host_joined = false; 362094b82fdSNikolay Aleksandrov 3638266a049SNikolay Aleksandrov for (pp = &sgmp->ports; 3648266a049SNikolay Aleksandrov (p = mlock_dereference(*pp, sgmp->br)) != NULL;) { 3658266a049SNikolay Aleksandrov if (!(p->flags & MDB_PG_FLAGS_PERMANENT)) 3668266a049SNikolay Aleksandrov br_multicast_del_pg(sgmp, p, pp); 3678266a049SNikolay Aleksandrov else 3688266a049SNikolay Aleksandrov pp = &p->next; 3698266a049SNikolay Aleksandrov } 3708266a049SNikolay Aleksandrov } 3718266a049SNikolay Aleksandrov 3728266a049SNikolay Aleksandrov void br_multicast_sg_add_exclude_ports(struct net_bridge_mdb_entry *star_mp, 3738266a049SNikolay Aleksandrov struct net_bridge_port_group *sg) 3748266a049SNikolay Aleksandrov { 3758266a049SNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 3768266a049SNikolay Aleksandrov struct net_bridge *br = star_mp->br; 3778266a049SNikolay Aleksandrov struct net_bridge_port_group *pg; 3788266a049SNikolay Aleksandrov 3798266a049SNikolay Aleksandrov if (WARN_ON(br_multicast_is_star_g(&sg->key.addr))) 3808266a049SNikolay Aleksandrov return; 3818266a049SNikolay Aleksandrov if (WARN_ON(!br_multicast_is_star_g(&star_mp->addr))) 3828266a049SNikolay Aleksandrov return; 3838266a049SNikolay Aleksandrov 384094b82fdSNikolay Aleksandrov br_multicast_sg_host_state(star_mp, sg); 3858266a049SNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 3868266a049SNikolay Aleksandrov sg_key.addr = sg->key.addr; 3878266a049SNikolay Aleksandrov /* we need to add all exclude ports to the S,G */ 3888266a049SNikolay Aleksandrov for (pg = mlock_dereference(star_mp->ports, br); 3898266a049SNikolay Aleksandrov pg; 3908266a049SNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) { 3918266a049SNikolay Aleksandrov struct net_bridge_port_group *src_pg; 3928266a049SNikolay Aleksandrov 3938266a049SNikolay Aleksandrov if (pg == sg || pg->filter_mode == MCAST_INCLUDE) 3948266a049SNikolay Aleksandrov continue; 3958266a049SNikolay Aleksandrov 3968266a049SNikolay Aleksandrov sg_key.port = pg->key.port; 3978266a049SNikolay Aleksandrov if (br_sg_port_find(br, &sg_key)) 3988266a049SNikolay Aleksandrov continue; 3998266a049SNikolay Aleksandrov 4008266a049SNikolay Aleksandrov src_pg = __br_multicast_add_group(br, pg->key.port, 4018266a049SNikolay Aleksandrov &sg->key.addr, 4028266a049SNikolay Aleksandrov sg->eth_addr, 4039116ffbfSNikolay Aleksandrov MCAST_INCLUDE, false, false); 4048266a049SNikolay Aleksandrov if (IS_ERR_OR_NULL(src_pg) || 4058266a049SNikolay Aleksandrov src_pg->rt_protocol != RTPROT_KERNEL) 4068266a049SNikolay Aleksandrov continue; 4078266a049SNikolay Aleksandrov src_pg->flags |= MDB_PG_FLAGS_STAR_EXCL; 4088266a049SNikolay Aleksandrov } 4098266a049SNikolay Aleksandrov } 4108266a049SNikolay Aleksandrov 411b0812368SNikolay Aleksandrov static void br_multicast_fwd_src_add(struct net_bridge_group_src *src) 412b0812368SNikolay Aleksandrov { 4138266a049SNikolay Aleksandrov struct net_bridge_mdb_entry *star_mp; 414b0812368SNikolay Aleksandrov struct net_bridge_port_group *sg; 415b0812368SNikolay Aleksandrov struct br_ip sg_ip; 416b0812368SNikolay Aleksandrov 417b0812368SNikolay Aleksandrov if (src->flags & BR_SGRP_F_INSTALLED) 418b0812368SNikolay Aleksandrov return; 419b0812368SNikolay Aleksandrov 420b0812368SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 421b0812368SNikolay Aleksandrov sg_ip = src->pg->key.addr; 422b0812368SNikolay Aleksandrov sg_ip.src = src->addr.src; 423b0812368SNikolay Aleksandrov sg = __br_multicast_add_group(src->br, src->pg->key.port, &sg_ip, 4249116ffbfSNikolay Aleksandrov src->pg->eth_addr, MCAST_INCLUDE, false, 4259116ffbfSNikolay Aleksandrov !timer_pending(&src->timer)); 426b0812368SNikolay Aleksandrov if (IS_ERR_OR_NULL(sg)) 427b0812368SNikolay Aleksandrov return; 428b0812368SNikolay Aleksandrov src->flags |= BR_SGRP_F_INSTALLED; 4298266a049SNikolay Aleksandrov sg->flags &= ~MDB_PG_FLAGS_STAR_EXCL; 430b0812368SNikolay Aleksandrov 431b0812368SNikolay Aleksandrov /* if it was added by user-space as perm we can skip next steps */ 432b0812368SNikolay Aleksandrov if (sg->rt_protocol != RTPROT_KERNEL && 433b0812368SNikolay Aleksandrov (sg->flags & MDB_PG_FLAGS_PERMANENT)) 434b0812368SNikolay Aleksandrov return; 435b0812368SNikolay Aleksandrov 436b0812368SNikolay Aleksandrov /* the kernel is now responsible for removing this S,G */ 437b0812368SNikolay Aleksandrov del_timer(&sg->timer); 4388266a049SNikolay Aleksandrov star_mp = br_mdb_ip_get(src->br, &src->pg->key.addr); 4398266a049SNikolay Aleksandrov if (!star_mp) 4408266a049SNikolay Aleksandrov return; 4418266a049SNikolay Aleksandrov 4428266a049SNikolay Aleksandrov br_multicast_sg_add_exclude_ports(star_mp, sg); 443b0812368SNikolay Aleksandrov } 444b0812368SNikolay Aleksandrov 445b0812368SNikolay Aleksandrov static void br_multicast_fwd_src_remove(struct net_bridge_group_src *src) 446b0812368SNikolay Aleksandrov { 447b0812368SNikolay Aleksandrov struct net_bridge_port_group *p, *pg = src->pg; 448b0812368SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 449b0812368SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 450b0812368SNikolay Aleksandrov struct br_ip sg_ip; 451b0812368SNikolay Aleksandrov 452b0812368SNikolay Aleksandrov memset(&sg_ip, 0, sizeof(sg_ip)); 453b0812368SNikolay Aleksandrov sg_ip = pg->key.addr; 454b0812368SNikolay Aleksandrov sg_ip.src = src->addr.src; 455b0812368SNikolay Aleksandrov 456b0812368SNikolay Aleksandrov mp = br_mdb_ip_get(src->br, &sg_ip); 457b0812368SNikolay Aleksandrov if (!mp) 458b0812368SNikolay Aleksandrov return; 459b0812368SNikolay Aleksandrov 460b0812368SNikolay Aleksandrov for (pp = &mp->ports; 461b0812368SNikolay Aleksandrov (p = mlock_dereference(*pp, src->br)) != NULL; 462b0812368SNikolay Aleksandrov pp = &p->next) { 463b0812368SNikolay Aleksandrov if (!br_port_group_equal(p, pg->key.port, pg->eth_addr)) 464b0812368SNikolay Aleksandrov continue; 465b0812368SNikolay Aleksandrov 466b0812368SNikolay Aleksandrov if (p->rt_protocol != RTPROT_KERNEL && 467b0812368SNikolay Aleksandrov (p->flags & MDB_PG_FLAGS_PERMANENT)) 468b0812368SNikolay Aleksandrov break; 469b0812368SNikolay Aleksandrov 470b0812368SNikolay Aleksandrov br_multicast_del_pg(mp, p, pp); 471b0812368SNikolay Aleksandrov break; 472b0812368SNikolay Aleksandrov } 473b0812368SNikolay Aleksandrov src->flags &= ~BR_SGRP_F_INSTALLED; 474b0812368SNikolay Aleksandrov } 475b0812368SNikolay Aleksandrov 4769116ffbfSNikolay Aleksandrov /* install S,G and based on src's timer enable or disable forwarding */ 477b0812368SNikolay Aleksandrov static void br_multicast_fwd_src_handle(struct net_bridge_group_src *src) 478b0812368SNikolay Aleksandrov { 4799116ffbfSNikolay Aleksandrov struct net_bridge_port_group_sg_key sg_key; 4809116ffbfSNikolay Aleksandrov struct net_bridge_port_group *sg; 4819116ffbfSNikolay Aleksandrov u8 old_flags; 4829116ffbfSNikolay Aleksandrov 483b0812368SNikolay Aleksandrov br_multicast_fwd_src_add(src); 4849116ffbfSNikolay Aleksandrov 4859116ffbfSNikolay Aleksandrov memset(&sg_key, 0, sizeof(sg_key)); 4869116ffbfSNikolay Aleksandrov sg_key.addr = src->pg->key.addr; 4879116ffbfSNikolay Aleksandrov sg_key.addr.src = src->addr.src; 4889116ffbfSNikolay Aleksandrov sg_key.port = src->pg->key.port; 4899116ffbfSNikolay Aleksandrov 4909116ffbfSNikolay Aleksandrov sg = br_sg_port_find(src->br, &sg_key); 4919116ffbfSNikolay Aleksandrov if (!sg || (sg->flags & MDB_PG_FLAGS_PERMANENT)) 4929116ffbfSNikolay Aleksandrov return; 4939116ffbfSNikolay Aleksandrov 4949116ffbfSNikolay Aleksandrov old_flags = sg->flags; 4959116ffbfSNikolay Aleksandrov if (timer_pending(&src->timer)) 4969116ffbfSNikolay Aleksandrov sg->flags &= ~MDB_PG_FLAGS_BLOCKED; 4979116ffbfSNikolay Aleksandrov else 4989116ffbfSNikolay Aleksandrov sg->flags |= MDB_PG_FLAGS_BLOCKED; 4999116ffbfSNikolay Aleksandrov 5009116ffbfSNikolay Aleksandrov if (old_flags != sg->flags) { 5019116ffbfSNikolay Aleksandrov struct net_bridge_mdb_entry *sg_mp; 5029116ffbfSNikolay Aleksandrov 5039116ffbfSNikolay Aleksandrov sg_mp = br_mdb_ip_get(src->br, &sg_key.addr); 5049116ffbfSNikolay Aleksandrov if (!sg_mp) 5059116ffbfSNikolay Aleksandrov return; 5069116ffbfSNikolay Aleksandrov br_mdb_notify(src->br->dev, sg_mp, sg, RTM_NEWMDB); 5079116ffbfSNikolay Aleksandrov } 508b0812368SNikolay Aleksandrov } 509b0812368SNikolay Aleksandrov 510e12cec65SNikolay Aleksandrov static void br_multicast_destroy_mdb_entry(struct net_bridge_mcast_gc *gc) 511e12cec65SNikolay Aleksandrov { 512e12cec65SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 513e12cec65SNikolay Aleksandrov 514e12cec65SNikolay Aleksandrov mp = container_of(gc, struct net_bridge_mdb_entry, mcast_gc); 515e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&mp->mdb_node)); 516e12cec65SNikolay Aleksandrov WARN_ON(mp->ports); 517e12cec65SNikolay Aleksandrov 518e12cec65SNikolay Aleksandrov del_timer_sync(&mp->timer); 519e12cec65SNikolay Aleksandrov kfree_rcu(mp, rcu); 520e12cec65SNikolay Aleksandrov } 521e12cec65SNikolay Aleksandrov 522e12cec65SNikolay Aleksandrov static void br_multicast_del_mdb_entry(struct net_bridge_mdb_entry *mp) 523e12cec65SNikolay Aleksandrov { 524e12cec65SNikolay Aleksandrov struct net_bridge *br = mp->br; 525e12cec65SNikolay Aleksandrov 526e12cec65SNikolay Aleksandrov rhashtable_remove_fast(&br->mdb_hash_tbl, &mp->rhnode, 527e12cec65SNikolay Aleksandrov br_mdb_rht_params); 528e12cec65SNikolay Aleksandrov hlist_del_init_rcu(&mp->mdb_node); 529e12cec65SNikolay Aleksandrov hlist_add_head(&mp->mcast_gc.gc_node, &br->mcast_gc_list); 530e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 531e12cec65SNikolay Aleksandrov } 532e12cec65SNikolay Aleksandrov 53388c1f37fSAllen Pais static void br_multicast_group_expired(struct timer_list *t) 534eb1d1641SHerbert Xu { 53588c1f37fSAllen Pais struct net_bridge_mdb_entry *mp = from_timer(mp, t, timer); 536eb1d1641SHerbert Xu struct net_bridge *br = mp->br; 537eb1d1641SHerbert Xu 538eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 539b0812368SNikolay Aleksandrov if (hlist_unhashed(&mp->mdb_node) || !netif_running(br->dev) || 540b0812368SNikolay Aleksandrov timer_pending(&mp->timer)) 541eb1d1641SHerbert Xu goto out; 542eb1d1641SHerbert Xu 5431bc844eeSNikolay Aleksandrov br_multicast_host_leave(mp, true); 544eb1d1641SHerbert Xu 545eb1d1641SHerbert Xu if (mp->ports) 546eb1d1641SHerbert Xu goto out; 547e12cec65SNikolay Aleksandrov br_multicast_del_mdb_entry(mp); 548eb1d1641SHerbert Xu out: 549eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 550eb1d1641SHerbert Xu } 551eb1d1641SHerbert Xu 552e12cec65SNikolay Aleksandrov static void br_multicast_destroy_group_src(struct net_bridge_mcast_gc *gc) 553e12cec65SNikolay Aleksandrov { 554e12cec65SNikolay Aleksandrov struct net_bridge_group_src *src; 555e12cec65SNikolay Aleksandrov 556e12cec65SNikolay Aleksandrov src = container_of(gc, struct net_bridge_group_src, mcast_gc); 557e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&src->node)); 558e12cec65SNikolay Aleksandrov 559e12cec65SNikolay Aleksandrov del_timer_sync(&src->timer); 560e12cec65SNikolay Aleksandrov kfree_rcu(src, rcu); 561e12cec65SNikolay Aleksandrov } 562e12cec65SNikolay Aleksandrov 5638b671779SNikolay Aleksandrov static void br_multicast_del_group_src(struct net_bridge_group_src *src) 5648b671779SNikolay Aleksandrov { 565085b53c8SNikolay Aleksandrov struct net_bridge *br = src->pg->key.port->br; 5668b671779SNikolay Aleksandrov 567b0812368SNikolay Aleksandrov br_multicast_fwd_src_remove(src); 5688b671779SNikolay Aleksandrov hlist_del_init_rcu(&src->node); 5698b671779SNikolay Aleksandrov src->pg->src_ents--; 570e12cec65SNikolay Aleksandrov hlist_add_head(&src->mcast_gc.gc_node, &br->mcast_gc_list); 571e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 572e12cec65SNikolay Aleksandrov } 573e12cec65SNikolay Aleksandrov 574e12cec65SNikolay Aleksandrov static void br_multicast_destroy_port_group(struct net_bridge_mcast_gc *gc) 575e12cec65SNikolay Aleksandrov { 576e12cec65SNikolay Aleksandrov struct net_bridge_port_group *pg; 577e12cec65SNikolay Aleksandrov 578e12cec65SNikolay Aleksandrov pg = container_of(gc, struct net_bridge_port_group, mcast_gc); 579e12cec65SNikolay Aleksandrov WARN_ON(!hlist_unhashed(&pg->mglist)); 580e12cec65SNikolay Aleksandrov WARN_ON(!hlist_empty(&pg->src_list)); 581e12cec65SNikolay Aleksandrov 582e12cec65SNikolay Aleksandrov del_timer_sync(&pg->rexmit_timer); 583e12cec65SNikolay Aleksandrov del_timer_sync(&pg->timer); 584e12cec65SNikolay Aleksandrov kfree_rcu(pg, rcu); 5858b671779SNikolay Aleksandrov } 5868b671779SNikolay Aleksandrov 587681590bdSNikolay Aleksandrov void br_multicast_del_pg(struct net_bridge_mdb_entry *mp, 588681590bdSNikolay Aleksandrov struct net_bridge_port_group *pg, 589681590bdSNikolay Aleksandrov struct net_bridge_port_group __rcu **pp) 590681590bdSNikolay Aleksandrov { 591085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 5928b671779SNikolay Aleksandrov struct net_bridge_group_src *ent; 5938b671779SNikolay Aleksandrov struct hlist_node *tmp; 594681590bdSNikolay Aleksandrov 595681590bdSNikolay Aleksandrov rcu_assign_pointer(*pp, pg->next); 596681590bdSNikolay Aleksandrov hlist_del_init(&pg->mglist); 5978b671779SNikolay Aleksandrov hlist_for_each_entry_safe(ent, tmp, &pg->src_list, node) 5988b671779SNikolay Aleksandrov br_multicast_del_group_src(ent); 59981f19838SNikolay Aleksandrov br_mdb_notify(br->dev, mp, pg, RTM_DELMDB); 60074705582SNikolay Aleksandrov if (!br_multicast_is_star_g(&mp->addr)) { 60174705582SNikolay Aleksandrov rhashtable_remove_fast(&br->sg_port_tbl, &pg->rhnode, 60274705582SNikolay Aleksandrov br_sg_port_rht_params); 6038266a049SNikolay Aleksandrov br_multicast_sg_del_exclude_ports(mp); 60474705582SNikolay Aleksandrov } else { 6058266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_INCLUDE); 60674705582SNikolay Aleksandrov } 607e12cec65SNikolay Aleksandrov hlist_add_head(&pg->mcast_gc.gc_node, &br->mcast_gc_list); 608e12cec65SNikolay Aleksandrov queue_work(system_long_wq, &br->mcast_gc_work); 609681590bdSNikolay Aleksandrov 610681590bdSNikolay Aleksandrov if (!mp->ports && !mp->host_joined && netif_running(br->dev)) 611681590bdSNikolay Aleksandrov mod_timer(&mp->timer, jiffies); 612681590bdSNikolay Aleksandrov } 613681590bdSNikolay Aleksandrov 614681590bdSNikolay Aleksandrov static void br_multicast_find_del_pg(struct net_bridge *br, 615eb1d1641SHerbert Xu struct net_bridge_port_group *pg) 616eb1d1641SHerbert Xu { 6178b671779SNikolay Aleksandrov struct net_bridge_port_group __rcu **pp; 618eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 619eb1d1641SHerbert Xu struct net_bridge_port_group *p; 620e8051688SEric Dumazet 621085b53c8SNikolay Aleksandrov mp = br_mdb_ip_get(br, &pg->key.addr); 622eb1d1641SHerbert Xu if (WARN_ON(!mp)) 623eb1d1641SHerbert Xu return; 624eb1d1641SHerbert Xu 625e8051688SEric Dumazet for (pp = &mp->ports; 626e8051688SEric Dumazet (p = mlock_dereference(*pp, br)) != NULL; 627e8051688SEric Dumazet pp = &p->next) { 628eb1d1641SHerbert Xu if (p != pg) 629eb1d1641SHerbert Xu continue; 630eb1d1641SHerbert Xu 631681590bdSNikolay Aleksandrov br_multicast_del_pg(mp, pg, pp); 632eb1d1641SHerbert Xu return; 633eb1d1641SHerbert Xu } 634eb1d1641SHerbert Xu 635eb1d1641SHerbert Xu WARN_ON(1); 636eb1d1641SHerbert Xu } 637eb1d1641SHerbert Xu 63888c1f37fSAllen Pais static void br_multicast_port_group_expired(struct timer_list *t) 639eb1d1641SHerbert Xu { 64088c1f37fSAllen Pais struct net_bridge_port_group *pg = from_timer(pg, t, timer); 641d6c33d67SNikolay Aleksandrov struct net_bridge_group_src *src_ent; 642085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 643d6c33d67SNikolay Aleksandrov struct hlist_node *tmp; 644d6c33d67SNikolay Aleksandrov bool changed; 645eb1d1641SHerbert Xu 646eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 647eb1d1641SHerbert Xu if (!netif_running(br->dev) || timer_pending(&pg->timer) || 6489d06b6d8SElad Raz hlist_unhashed(&pg->mglist) || pg->flags & MDB_PG_FLAGS_PERMANENT) 649eb1d1641SHerbert Xu goto out; 650eb1d1641SHerbert Xu 651d6c33d67SNikolay Aleksandrov changed = !!(pg->filter_mode == MCAST_EXCLUDE); 652d6c33d67SNikolay Aleksandrov pg->filter_mode = MCAST_INCLUDE; 653d6c33d67SNikolay Aleksandrov hlist_for_each_entry_safe(src_ent, tmp, &pg->src_list, node) { 654d6c33d67SNikolay Aleksandrov if (!timer_pending(&src_ent->timer)) { 655d6c33d67SNikolay Aleksandrov br_multicast_del_group_src(src_ent); 656d6c33d67SNikolay Aleksandrov changed = true; 657d6c33d67SNikolay Aleksandrov } 658d6c33d67SNikolay Aleksandrov } 659eb1d1641SHerbert Xu 660d6c33d67SNikolay Aleksandrov if (hlist_empty(&pg->src_list)) { 661d6c33d67SNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 662d6c33d67SNikolay Aleksandrov } else if (changed) { 663085b53c8SNikolay Aleksandrov struct net_bridge_mdb_entry *mp = br_mdb_ip_get(br, &pg->key.addr); 664d6c33d67SNikolay Aleksandrov 6658266a049SNikolay Aleksandrov if (changed && br_multicast_is_star_g(&pg->key.addr)) 6668266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_INCLUDE); 6678266a049SNikolay Aleksandrov 668d6c33d67SNikolay Aleksandrov if (WARN_ON(!mp)) 669d6c33d67SNikolay Aleksandrov goto out; 670d6c33d67SNikolay Aleksandrov br_mdb_notify(br->dev, mp, pg, RTM_NEWMDB); 671d6c33d67SNikolay Aleksandrov } 672eb1d1641SHerbert Xu out: 673eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 674eb1d1641SHerbert Xu } 675eb1d1641SHerbert Xu 676e12cec65SNikolay Aleksandrov static void br_multicast_gc(struct hlist_head *head) 677e12cec65SNikolay Aleksandrov { 678e12cec65SNikolay Aleksandrov struct net_bridge_mcast_gc *gcent; 679e12cec65SNikolay Aleksandrov struct hlist_node *tmp; 680e12cec65SNikolay Aleksandrov 681e12cec65SNikolay Aleksandrov hlist_for_each_entry_safe(gcent, tmp, head, gc_node) { 682e12cec65SNikolay Aleksandrov hlist_del_init(&gcent->gc_node); 683e12cec65SNikolay Aleksandrov gcent->destroy(gcent); 684e12cec65SNikolay Aleksandrov } 685e12cec65SNikolay Aleksandrov } 686e12cec65SNikolay Aleksandrov 6878ef2a9a5SYOSHIFUJI Hideaki static struct sk_buff *br_ip4_multicast_alloc_query(struct net_bridge *br, 688438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 689438ef2d0SNikolay Aleksandrov __be32 ip_dst, __be32 group, 690438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_lmqt, 69142c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 69242c11ccfSNikolay Aleksandrov bool *need_rexmit) 693eb1d1641SHerbert Xu { 694085b53c8SNikolay Aleksandrov struct net_bridge_port *p = pg ? pg->key.port : NULL; 695438ef2d0SNikolay Aleksandrov struct net_bridge_group_src *ent; 696438ef2d0SNikolay Aleksandrov size_t pkt_size, igmp_hdr_size; 697438ef2d0SNikolay Aleksandrov unsigned long now = jiffies; 6985e923585SNikolay Aleksandrov struct igmpv3_query *ihv3; 699438ef2d0SNikolay Aleksandrov void *csum_start = NULL; 700438ef2d0SNikolay Aleksandrov __sum16 *csum = NULL; 701eb1d1641SHerbert Xu struct sk_buff *skb; 702eb1d1641SHerbert Xu struct igmphdr *ih; 703eb1d1641SHerbert Xu struct ethhdr *eth; 704438ef2d0SNikolay Aleksandrov unsigned long lmqt; 705eb1d1641SHerbert Xu struct iphdr *iph; 706438ef2d0SNikolay Aleksandrov u16 lmqt_srcs = 0; 707eb1d1641SHerbert Xu 7085e923585SNikolay Aleksandrov igmp_hdr_size = sizeof(*ih); 709438ef2d0SNikolay Aleksandrov if (br->multicast_igmp_version == 3) { 7105e923585SNikolay Aleksandrov igmp_hdr_size = sizeof(*ihv3); 711438ef2d0SNikolay Aleksandrov if (pg && with_srcs) { 712438ef2d0SNikolay Aleksandrov lmqt = now + (br->multicast_last_member_interval * 713438ef2d0SNikolay Aleksandrov br->multicast_last_member_count); 714438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 715438ef2d0SNikolay Aleksandrov if (over_lmqt == time_after(ent->timer.expires, 716438ef2d0SNikolay Aleksandrov lmqt) && 717438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) 718438ef2d0SNikolay Aleksandrov lmqt_srcs++; 719438ef2d0SNikolay Aleksandrov } 720438ef2d0SNikolay Aleksandrov 721438ef2d0SNikolay Aleksandrov if (!lmqt_srcs) 722438ef2d0SNikolay Aleksandrov return NULL; 723438ef2d0SNikolay Aleksandrov igmp_hdr_size += lmqt_srcs * sizeof(__be32); 724438ef2d0SNikolay Aleksandrov } 725438ef2d0SNikolay Aleksandrov } 726438ef2d0SNikolay Aleksandrov 727438ef2d0SNikolay Aleksandrov pkt_size = sizeof(*eth) + sizeof(*iph) + 4 + igmp_hdr_size; 728438ef2d0SNikolay Aleksandrov if ((p && pkt_size > p->dev->mtu) || 729438ef2d0SNikolay Aleksandrov pkt_size > br->dev->mtu) 730438ef2d0SNikolay Aleksandrov return NULL; 731438ef2d0SNikolay Aleksandrov 732438ef2d0SNikolay Aleksandrov skb = netdev_alloc_skb_ip_align(br->dev, pkt_size); 733eb1d1641SHerbert Xu if (!skb) 734eb1d1641SHerbert Xu goto out; 735eb1d1641SHerbert Xu 736eb1d1641SHerbert Xu skb->protocol = htons(ETH_P_IP); 737eb1d1641SHerbert Xu 738eb1d1641SHerbert Xu skb_reset_mac_header(skb); 739eb1d1641SHerbert Xu eth = eth_hdr(skb); 740eb1d1641SHerbert Xu 741e5a727f6SJoe Perches ether_addr_copy(eth->h_source, br->dev->dev_addr); 742438ef2d0SNikolay Aleksandrov ip_eth_mc_map(ip_dst, eth->h_dest); 743eb1d1641SHerbert Xu eth->h_proto = htons(ETH_P_IP); 744eb1d1641SHerbert Xu skb_put(skb, sizeof(*eth)); 745eb1d1641SHerbert Xu 746eb1d1641SHerbert Xu skb_set_network_header(skb, skb->len); 747eb1d1641SHerbert Xu iph = ip_hdr(skb); 748438ef2d0SNikolay Aleksandrov iph->tot_len = htons(pkt_size - sizeof(*eth)); 749eb1d1641SHerbert Xu 750eb1d1641SHerbert Xu iph->version = 4; 751eb1d1641SHerbert Xu iph->ihl = 6; 752eb1d1641SHerbert Xu iph->tos = 0xc0; 753eb1d1641SHerbert Xu iph->id = 0; 754eb1d1641SHerbert Xu iph->frag_off = htons(IP_DF); 755eb1d1641SHerbert Xu iph->ttl = 1; 756eb1d1641SHerbert Xu iph->protocol = IPPROTO_IGMP; 757675779adSNikolay Aleksandrov iph->saddr = br_opt_get(br, BROPT_MULTICAST_QUERY_USE_IFADDR) ? 7581c8ad5bfSCong Wang inet_select_addr(br->dev, 0, RT_SCOPE_LINK) : 0; 759438ef2d0SNikolay Aleksandrov iph->daddr = ip_dst; 760eb1d1641SHerbert Xu ((u8 *)&iph[1])[0] = IPOPT_RA; 761eb1d1641SHerbert Xu ((u8 *)&iph[1])[1] = 4; 762eb1d1641SHerbert Xu ((u8 *)&iph[1])[2] = 0; 763eb1d1641SHerbert Xu ((u8 *)&iph[1])[3] = 0; 764eb1d1641SHerbert Xu ip_send_check(iph); 765eb1d1641SHerbert Xu skb_put(skb, 24); 766eb1d1641SHerbert Xu 767eb1d1641SHerbert Xu skb_set_transport_header(skb, skb->len); 7681080ab95SNikolay Aleksandrov *igmp_type = IGMP_HOST_MEMBERSHIP_QUERY; 7695e923585SNikolay Aleksandrov 7705e923585SNikolay Aleksandrov switch (br->multicast_igmp_version) { 7715e923585SNikolay Aleksandrov case 2: 7725e923585SNikolay Aleksandrov ih = igmp_hdr(skb); 773eb1d1641SHerbert Xu ih->type = IGMP_HOST_MEMBERSHIP_QUERY; 774eb1d1641SHerbert Xu ih->code = (group ? br->multicast_last_member_interval : 775eb1d1641SHerbert Xu br->multicast_query_response_interval) / 776eb1d1641SHerbert Xu (HZ / IGMP_TIMER_SCALE); 777eb1d1641SHerbert Xu ih->group = group; 778eb1d1641SHerbert Xu ih->csum = 0; 779438ef2d0SNikolay Aleksandrov csum = &ih->csum; 780438ef2d0SNikolay Aleksandrov csum_start = (void *)ih; 7815e923585SNikolay Aleksandrov break; 7825e923585SNikolay Aleksandrov case 3: 7835e923585SNikolay Aleksandrov ihv3 = igmpv3_query_hdr(skb); 7845e923585SNikolay Aleksandrov ihv3->type = IGMP_HOST_MEMBERSHIP_QUERY; 7855e923585SNikolay Aleksandrov ihv3->code = (group ? br->multicast_last_member_interval : 7865e923585SNikolay Aleksandrov br->multicast_query_response_interval) / 7875e923585SNikolay Aleksandrov (HZ / IGMP_TIMER_SCALE); 7885e923585SNikolay Aleksandrov ihv3->group = group; 7895e923585SNikolay Aleksandrov ihv3->qqic = br->multicast_query_interval / HZ; 790438ef2d0SNikolay Aleksandrov ihv3->nsrcs = htons(lmqt_srcs); 7915e923585SNikolay Aleksandrov ihv3->resv = 0; 792438ef2d0SNikolay Aleksandrov ihv3->suppress = sflag; 7935e923585SNikolay Aleksandrov ihv3->qrv = 2; 7945e923585SNikolay Aleksandrov ihv3->csum = 0; 795438ef2d0SNikolay Aleksandrov csum = &ihv3->csum; 796438ef2d0SNikolay Aleksandrov csum_start = (void *)ihv3; 797438ef2d0SNikolay Aleksandrov if (!pg || !with_srcs) 798438ef2d0SNikolay Aleksandrov break; 799438ef2d0SNikolay Aleksandrov 800438ef2d0SNikolay Aleksandrov lmqt_srcs = 0; 801438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 802438ef2d0SNikolay Aleksandrov if (over_lmqt == time_after(ent->timer.expires, 803438ef2d0SNikolay Aleksandrov lmqt) && 804438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) { 805deb96566SNikolay Aleksandrov ihv3->srcs[lmqt_srcs++] = ent->addr.src.ip4; 806438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt--; 80742c11ccfSNikolay Aleksandrov if (need_rexmit && ent->src_query_rexmit_cnt) 80842c11ccfSNikolay Aleksandrov *need_rexmit = true; 809438ef2d0SNikolay Aleksandrov } 810438ef2d0SNikolay Aleksandrov } 811438ef2d0SNikolay Aleksandrov if (WARN_ON(lmqt_srcs != ntohs(ihv3->nsrcs))) { 812438ef2d0SNikolay Aleksandrov kfree_skb(skb); 813438ef2d0SNikolay Aleksandrov return NULL; 814438ef2d0SNikolay Aleksandrov } 8155e923585SNikolay Aleksandrov break; 8165e923585SNikolay Aleksandrov } 817eb1d1641SHerbert Xu 818438ef2d0SNikolay Aleksandrov if (WARN_ON(!csum || !csum_start)) { 819438ef2d0SNikolay Aleksandrov kfree_skb(skb); 820438ef2d0SNikolay Aleksandrov return NULL; 821438ef2d0SNikolay Aleksandrov } 822438ef2d0SNikolay Aleksandrov 823438ef2d0SNikolay Aleksandrov *csum = ip_compute_csum(csum_start, igmp_hdr_size); 8245e923585SNikolay Aleksandrov skb_put(skb, igmp_hdr_size); 825eb1d1641SHerbert Xu __skb_pull(skb, sizeof(*eth)); 826eb1d1641SHerbert Xu 827eb1d1641SHerbert Xu out: 828eb1d1641SHerbert Xu return skb; 829eb1d1641SHerbert Xu } 830eb1d1641SHerbert Xu 831dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 83208b202b6SYOSHIFUJI Hideaki static struct sk_buff *br_ip6_multicast_alloc_query(struct net_bridge *br, 833438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 834438ef2d0SNikolay Aleksandrov const struct in6_addr *ip6_dst, 835438ef2d0SNikolay Aleksandrov const struct in6_addr *group, 836438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_llqt, 83742c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 83842c11ccfSNikolay Aleksandrov bool *need_rexmit) 83908b202b6SYOSHIFUJI Hideaki { 840085b53c8SNikolay Aleksandrov struct net_bridge_port *p = pg ? pg->key.port : NULL; 841438ef2d0SNikolay Aleksandrov struct net_bridge_group_src *ent; 842438ef2d0SNikolay Aleksandrov size_t pkt_size, mld_hdr_size; 843438ef2d0SNikolay Aleksandrov unsigned long now = jiffies; 844aa2ae3e7SNikolay Aleksandrov struct mld2_query *mld2q; 845438ef2d0SNikolay Aleksandrov void *csum_start = NULL; 846aa2ae3e7SNikolay Aleksandrov unsigned long interval; 847438ef2d0SNikolay Aleksandrov __sum16 *csum = NULL; 84808b202b6SYOSHIFUJI Hideaki struct ipv6hdr *ip6h; 84908b202b6SYOSHIFUJI Hideaki struct mld_msg *mldq; 850aa2ae3e7SNikolay Aleksandrov struct sk_buff *skb; 851438ef2d0SNikolay Aleksandrov unsigned long llqt; 85208b202b6SYOSHIFUJI Hideaki struct ethhdr *eth; 853438ef2d0SNikolay Aleksandrov u16 llqt_srcs = 0; 85408b202b6SYOSHIFUJI Hideaki u8 *hopopt; 85508b202b6SYOSHIFUJI Hideaki 856aa2ae3e7SNikolay Aleksandrov mld_hdr_size = sizeof(*mldq); 857438ef2d0SNikolay Aleksandrov if (br->multicast_mld_version == 2) { 858aa2ae3e7SNikolay Aleksandrov mld_hdr_size = sizeof(*mld2q); 859438ef2d0SNikolay Aleksandrov if (pg && with_srcs) { 860438ef2d0SNikolay Aleksandrov llqt = now + (br->multicast_last_member_interval * 861438ef2d0SNikolay Aleksandrov br->multicast_last_member_count); 862438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 863438ef2d0SNikolay Aleksandrov if (over_llqt == time_after(ent->timer.expires, 864438ef2d0SNikolay Aleksandrov llqt) && 865438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) 866438ef2d0SNikolay Aleksandrov llqt_srcs++; 867438ef2d0SNikolay Aleksandrov } 868438ef2d0SNikolay Aleksandrov 869438ef2d0SNikolay Aleksandrov if (!llqt_srcs) 870438ef2d0SNikolay Aleksandrov return NULL; 871438ef2d0SNikolay Aleksandrov mld_hdr_size += llqt_srcs * sizeof(struct in6_addr); 872438ef2d0SNikolay Aleksandrov } 873438ef2d0SNikolay Aleksandrov } 874438ef2d0SNikolay Aleksandrov 875438ef2d0SNikolay Aleksandrov pkt_size = sizeof(*eth) + sizeof(*ip6h) + 8 + mld_hdr_size; 876438ef2d0SNikolay Aleksandrov if ((p && pkt_size > p->dev->mtu) || 877438ef2d0SNikolay Aleksandrov pkt_size > br->dev->mtu) 878438ef2d0SNikolay Aleksandrov return NULL; 879438ef2d0SNikolay Aleksandrov 880438ef2d0SNikolay Aleksandrov skb = netdev_alloc_skb_ip_align(br->dev, pkt_size); 88108b202b6SYOSHIFUJI Hideaki if (!skb) 88208b202b6SYOSHIFUJI Hideaki goto out; 88308b202b6SYOSHIFUJI Hideaki 88408b202b6SYOSHIFUJI Hideaki skb->protocol = htons(ETH_P_IPV6); 88508b202b6SYOSHIFUJI Hideaki 88608b202b6SYOSHIFUJI Hideaki /* Ethernet header */ 88708b202b6SYOSHIFUJI Hideaki skb_reset_mac_header(skb); 88808b202b6SYOSHIFUJI Hideaki eth = eth_hdr(skb); 88908b202b6SYOSHIFUJI Hideaki 890e5a727f6SJoe Perches ether_addr_copy(eth->h_source, br->dev->dev_addr); 89108b202b6SYOSHIFUJI Hideaki eth->h_proto = htons(ETH_P_IPV6); 89208b202b6SYOSHIFUJI Hideaki skb_put(skb, sizeof(*eth)); 89308b202b6SYOSHIFUJI Hideaki 89408b202b6SYOSHIFUJI Hideaki /* IPv6 header + HbH option */ 89508b202b6SYOSHIFUJI Hideaki skb_set_network_header(skb, skb->len); 89608b202b6SYOSHIFUJI Hideaki ip6h = ipv6_hdr(skb); 89708b202b6SYOSHIFUJI Hideaki 89808b202b6SYOSHIFUJI Hideaki *(__force __be32 *)ip6h = htonl(0x60000000); 899aa2ae3e7SNikolay Aleksandrov ip6h->payload_len = htons(8 + mld_hdr_size); 90008b202b6SYOSHIFUJI Hideaki ip6h->nexthdr = IPPROTO_HOPOPTS; 90108b202b6SYOSHIFUJI Hideaki ip6h->hop_limit = 1; 902438ef2d0SNikolay Aleksandrov ip6h->daddr = *ip6_dst; 903d1d81d4cSUlrich Weber if (ipv6_dev_get_saddr(dev_net(br->dev), br->dev, &ip6h->daddr, 0, 904d1d81d4cSUlrich Weber &ip6h->saddr)) { 905d1d81d4cSUlrich Weber kfree_skb(skb); 906675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_HAS_IPV6_ADDR, false); 907d1d81d4cSUlrich Weber return NULL; 908d1d81d4cSUlrich Weber } 9090888d5f3Sdaniel 910675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_HAS_IPV6_ADDR, true); 91136cff5a1SLinus Lüssing ipv6_eth_mc_map(&ip6h->daddr, eth->h_dest); 91208b202b6SYOSHIFUJI Hideaki 91308b202b6SYOSHIFUJI Hideaki hopopt = (u8 *)(ip6h + 1); 91408b202b6SYOSHIFUJI Hideaki hopopt[0] = IPPROTO_ICMPV6; /* next hdr */ 91508b202b6SYOSHIFUJI Hideaki hopopt[1] = 0; /* length of HbH */ 91608b202b6SYOSHIFUJI Hideaki hopopt[2] = IPV6_TLV_ROUTERALERT; /* Router Alert */ 91708b202b6SYOSHIFUJI Hideaki hopopt[3] = 2; /* Length of RA Option */ 91808b202b6SYOSHIFUJI Hideaki hopopt[4] = 0; /* Type = 0x0000 (MLD) */ 91908b202b6SYOSHIFUJI Hideaki hopopt[5] = 0; 9201de5a71cSEldad Zack hopopt[6] = IPV6_TLV_PAD1; /* Pad1 */ 9211de5a71cSEldad Zack hopopt[7] = IPV6_TLV_PAD1; /* Pad1 */ 92208b202b6SYOSHIFUJI Hideaki 92308b202b6SYOSHIFUJI Hideaki skb_put(skb, sizeof(*ip6h) + 8); 92408b202b6SYOSHIFUJI Hideaki 92508b202b6SYOSHIFUJI Hideaki /* ICMPv6 */ 92608b202b6SYOSHIFUJI Hideaki skb_set_transport_header(skb, skb->len); 927438ef2d0SNikolay Aleksandrov interval = ipv6_addr_any(group) ? 92832de868cSLinus Lüssing br->multicast_query_response_interval : 92932de868cSLinus Lüssing br->multicast_last_member_interval; 9301080ab95SNikolay Aleksandrov *igmp_type = ICMPV6_MGM_QUERY; 931aa2ae3e7SNikolay Aleksandrov switch (br->multicast_mld_version) { 932aa2ae3e7SNikolay Aleksandrov case 1: 933aa2ae3e7SNikolay Aleksandrov mldq = (struct mld_msg *)icmp6_hdr(skb); 93408b202b6SYOSHIFUJI Hideaki mldq->mld_type = ICMPV6_MGM_QUERY; 93508b202b6SYOSHIFUJI Hideaki mldq->mld_code = 0; 93608b202b6SYOSHIFUJI Hideaki mldq->mld_cksum = 0; 93708b202b6SYOSHIFUJI Hideaki mldq->mld_maxdelay = htons((u16)jiffies_to_msecs(interval)); 93808b202b6SYOSHIFUJI Hideaki mldq->mld_reserved = 0; 939438ef2d0SNikolay Aleksandrov mldq->mld_mca = *group; 940438ef2d0SNikolay Aleksandrov csum = &mldq->mld_cksum; 941438ef2d0SNikolay Aleksandrov csum_start = (void *)mldq; 942aa2ae3e7SNikolay Aleksandrov break; 943aa2ae3e7SNikolay Aleksandrov case 2: 944aa2ae3e7SNikolay Aleksandrov mld2q = (struct mld2_query *)icmp6_hdr(skb); 94553631a5fSLance Richardson mld2q->mld2q_mrc = htons((u16)jiffies_to_msecs(interval)); 946aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_type = ICMPV6_MGM_QUERY; 947aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_code = 0; 948aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_cksum = 0; 949aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_resv1 = 0; 950aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_resv2 = 0; 951438ef2d0SNikolay Aleksandrov mld2q->mld2q_suppress = sflag; 952aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_qrv = 2; 953438ef2d0SNikolay Aleksandrov mld2q->mld2q_nsrcs = htons(llqt_srcs); 954aa2ae3e7SNikolay Aleksandrov mld2q->mld2q_qqic = br->multicast_query_interval / HZ; 955438ef2d0SNikolay Aleksandrov mld2q->mld2q_mca = *group; 956438ef2d0SNikolay Aleksandrov csum = &mld2q->mld2q_cksum; 957438ef2d0SNikolay Aleksandrov csum_start = (void *)mld2q; 958438ef2d0SNikolay Aleksandrov if (!pg || !with_srcs) 959438ef2d0SNikolay Aleksandrov break; 960438ef2d0SNikolay Aleksandrov 961438ef2d0SNikolay Aleksandrov llqt_srcs = 0; 962438ef2d0SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 963438ef2d0SNikolay Aleksandrov if (over_llqt == time_after(ent->timer.expires, 964438ef2d0SNikolay Aleksandrov llqt) && 965438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt > 0) { 966deb96566SNikolay Aleksandrov mld2q->mld2q_srcs[llqt_srcs++] = ent->addr.src.ip6; 967438ef2d0SNikolay Aleksandrov ent->src_query_rexmit_cnt--; 96842c11ccfSNikolay Aleksandrov if (need_rexmit && ent->src_query_rexmit_cnt) 96942c11ccfSNikolay Aleksandrov *need_rexmit = true; 970438ef2d0SNikolay Aleksandrov } 971438ef2d0SNikolay Aleksandrov } 972438ef2d0SNikolay Aleksandrov if (WARN_ON(llqt_srcs != ntohs(mld2q->mld2q_nsrcs))) { 973438ef2d0SNikolay Aleksandrov kfree_skb(skb); 974438ef2d0SNikolay Aleksandrov return NULL; 975438ef2d0SNikolay Aleksandrov } 976aa2ae3e7SNikolay Aleksandrov break; 977aa2ae3e7SNikolay Aleksandrov } 97808b202b6SYOSHIFUJI Hideaki 979438ef2d0SNikolay Aleksandrov if (WARN_ON(!csum || !csum_start)) { 980438ef2d0SNikolay Aleksandrov kfree_skb(skb); 981438ef2d0SNikolay Aleksandrov return NULL; 982438ef2d0SNikolay Aleksandrov } 983438ef2d0SNikolay Aleksandrov 984438ef2d0SNikolay Aleksandrov *csum = csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr, mld_hdr_size, 985438ef2d0SNikolay Aleksandrov IPPROTO_ICMPV6, 986438ef2d0SNikolay Aleksandrov csum_partial(csum_start, mld_hdr_size, 0)); 987438ef2d0SNikolay Aleksandrov skb_put(skb, mld_hdr_size); 98808b202b6SYOSHIFUJI Hideaki __skb_pull(skb, sizeof(*eth)); 98908b202b6SYOSHIFUJI Hideaki 99008b202b6SYOSHIFUJI Hideaki out: 99108b202b6SYOSHIFUJI Hideaki return skb; 99208b202b6SYOSHIFUJI Hideaki } 99308b202b6SYOSHIFUJI Hideaki #endif 99408b202b6SYOSHIFUJI Hideaki 9958ef2a9a5SYOSHIFUJI Hideaki static struct sk_buff *br_multicast_alloc_query(struct net_bridge *br, 996438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 997438ef2d0SNikolay Aleksandrov struct br_ip *ip_dst, 998438ef2d0SNikolay Aleksandrov struct br_ip *group, 999438ef2d0SNikolay Aleksandrov bool with_srcs, bool over_lmqt, 100042c11ccfSNikolay Aleksandrov u8 sflag, u8 *igmp_type, 100142c11ccfSNikolay Aleksandrov bool *need_rexmit) 10028ef2a9a5SYOSHIFUJI Hideaki { 1003438ef2d0SNikolay Aleksandrov __be32 ip4_dst; 1004438ef2d0SNikolay Aleksandrov 1005438ef2d0SNikolay Aleksandrov switch (group->proto) { 10068ef2a9a5SYOSHIFUJI Hideaki case htons(ETH_P_IP): 1007eab3227bSNikolay Aleksandrov ip4_dst = ip_dst ? ip_dst->dst.ip4 : htonl(INADDR_ALLHOSTS_GROUP); 1008438ef2d0SNikolay Aleksandrov return br_ip4_multicast_alloc_query(br, pg, 1009eab3227bSNikolay Aleksandrov ip4_dst, group->dst.ip4, 1010438ef2d0SNikolay Aleksandrov with_srcs, over_lmqt, 101142c11ccfSNikolay Aleksandrov sflag, igmp_type, 101242c11ccfSNikolay Aleksandrov need_rexmit); 1013dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1014438ef2d0SNikolay Aleksandrov case htons(ETH_P_IPV6): { 1015438ef2d0SNikolay Aleksandrov struct in6_addr ip6_dst; 1016438ef2d0SNikolay Aleksandrov 1017438ef2d0SNikolay Aleksandrov if (ip_dst) 1018eab3227bSNikolay Aleksandrov ip6_dst = ip_dst->dst.ip6; 1019438ef2d0SNikolay Aleksandrov else 1020438ef2d0SNikolay Aleksandrov ipv6_addr_set(&ip6_dst, htonl(0xff020000), 0, 0, 1021438ef2d0SNikolay Aleksandrov htonl(1)); 1022438ef2d0SNikolay Aleksandrov 1023438ef2d0SNikolay Aleksandrov return br_ip6_multicast_alloc_query(br, pg, 1024eab3227bSNikolay Aleksandrov &ip6_dst, &group->dst.ip6, 1025438ef2d0SNikolay Aleksandrov with_srcs, over_lmqt, 102642c11ccfSNikolay Aleksandrov sflag, igmp_type, 102742c11ccfSNikolay Aleksandrov need_rexmit); 1028438ef2d0SNikolay Aleksandrov } 102908b202b6SYOSHIFUJI Hideaki #endif 10308ef2a9a5SYOSHIFUJI Hideaki } 10318ef2a9a5SYOSHIFUJI Hideaki return NULL; 10328ef2a9a5SYOSHIFUJI Hideaki } 10338ef2a9a5SYOSHIFUJI Hideaki 1034cfd56754SCong Wang struct net_bridge_mdb_entry *br_multicast_new_group(struct net_bridge *br, 10355e923585SNikolay Aleksandrov struct br_ip *group) 1036eb1d1641SHerbert Xu { 1037eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 10384c0833bcSTobias Klauser int err; 1039eb1d1641SHerbert Xu 104019e3a9c9SNikolay Aleksandrov mp = br_mdb_ip_get(br, group); 104119e3a9c9SNikolay Aleksandrov if (mp) 104219e3a9c9SNikolay Aleksandrov return mp; 1043eb1d1641SHerbert Xu 104419e3a9c9SNikolay Aleksandrov if (atomic_read(&br->mdb_hash_tbl.nelems) >= br->hash_max) { 104519e3a9c9SNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_ENABLED, false); 104619e3a9c9SNikolay Aleksandrov return ERR_PTR(-E2BIG); 1047eb1d1641SHerbert Xu } 1048eb1d1641SHerbert Xu 1049eb1d1641SHerbert Xu mp = kzalloc(sizeof(*mp), GFP_ATOMIC); 1050eb1d1641SHerbert Xu if (unlikely(!mp)) 10514c0833bcSTobias Klauser return ERR_PTR(-ENOMEM); 1052eb1d1641SHerbert Xu 1053eb1d1641SHerbert Xu mp->br = br; 10548ef2a9a5SYOSHIFUJI Hideaki mp->addr = *group; 1055e12cec65SNikolay Aleksandrov mp->mcast_gc.destroy = br_multicast_destroy_mdb_entry; 105688c1f37fSAllen Pais timer_setup(&mp->timer, br_multicast_group_expired, 0); 105719e3a9c9SNikolay Aleksandrov err = rhashtable_lookup_insert_fast(&br->mdb_hash_tbl, &mp->rhnode, 105819e3a9c9SNikolay Aleksandrov br_mdb_rht_params); 105919e3a9c9SNikolay Aleksandrov if (err) { 106019e3a9c9SNikolay Aleksandrov kfree(mp); 106119e3a9c9SNikolay Aleksandrov mp = ERR_PTR(err); 106219e3a9c9SNikolay Aleksandrov } else { 106319e3a9c9SNikolay Aleksandrov hlist_add_head_rcu(&mp->mdb_node, &br->mdb_list); 106419e3a9c9SNikolay Aleksandrov } 10651faabf2aSEric Dumazet 1066eb1d1641SHerbert Xu return mp; 1067eb1d1641SHerbert Xu } 1068eb1d1641SHerbert Xu 10698b671779SNikolay Aleksandrov static void br_multicast_group_src_expired(struct timer_list *t) 10708b671779SNikolay Aleksandrov { 10718b671779SNikolay Aleksandrov struct net_bridge_group_src *src = from_timer(src, t, timer); 10728b671779SNikolay Aleksandrov struct net_bridge_port_group *pg; 10738b671779SNikolay Aleksandrov struct net_bridge *br = src->br; 10748b671779SNikolay Aleksandrov 10758b671779SNikolay Aleksandrov spin_lock(&br->multicast_lock); 10768b671779SNikolay Aleksandrov if (hlist_unhashed(&src->node) || !netif_running(br->dev) || 10778b671779SNikolay Aleksandrov timer_pending(&src->timer)) 10788b671779SNikolay Aleksandrov goto out; 10798b671779SNikolay Aleksandrov 10808b671779SNikolay Aleksandrov pg = src->pg; 10818b671779SNikolay Aleksandrov if (pg->filter_mode == MCAST_INCLUDE) { 10828b671779SNikolay Aleksandrov br_multicast_del_group_src(src); 10838b671779SNikolay Aleksandrov if (!hlist_empty(&pg->src_list)) 10848b671779SNikolay Aleksandrov goto out; 10858b671779SNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 10869116ffbfSNikolay Aleksandrov } else { 10879116ffbfSNikolay Aleksandrov br_multicast_fwd_src_handle(src); 10888b671779SNikolay Aleksandrov } 10899116ffbfSNikolay Aleksandrov 10908b671779SNikolay Aleksandrov out: 10918b671779SNikolay Aleksandrov spin_unlock(&br->multicast_lock); 10928b671779SNikolay Aleksandrov } 10938b671779SNikolay Aleksandrov 10948b671779SNikolay Aleksandrov static struct net_bridge_group_src * 10958b671779SNikolay Aleksandrov br_multicast_find_group_src(struct net_bridge_port_group *pg, struct br_ip *ip) 10968b671779SNikolay Aleksandrov { 10978b671779SNikolay Aleksandrov struct net_bridge_group_src *ent; 10988b671779SNikolay Aleksandrov 10998b671779SNikolay Aleksandrov switch (ip->proto) { 11008b671779SNikolay Aleksandrov case htons(ETH_P_IP): 11018b671779SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1102deb96566SNikolay Aleksandrov if (ip->src.ip4 == ent->addr.src.ip4) 11038b671779SNikolay Aleksandrov return ent; 11048b671779SNikolay Aleksandrov break; 11058b671779SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 11068b671779SNikolay Aleksandrov case htons(ETH_P_IPV6): 11078b671779SNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1108deb96566SNikolay Aleksandrov if (!ipv6_addr_cmp(&ent->addr.src.ip6, &ip->src.ip6)) 11098b671779SNikolay Aleksandrov return ent; 11108b671779SNikolay Aleksandrov break; 11118b671779SNikolay Aleksandrov #endif 11128b671779SNikolay Aleksandrov } 11138b671779SNikolay Aleksandrov 11148b671779SNikolay Aleksandrov return NULL; 11158b671779SNikolay Aleksandrov } 11168b671779SNikolay Aleksandrov 11178b671779SNikolay Aleksandrov static struct net_bridge_group_src * 11188b671779SNikolay Aleksandrov br_multicast_new_group_src(struct net_bridge_port_group *pg, struct br_ip *src_ip) 11198b671779SNikolay Aleksandrov { 11208b671779SNikolay Aleksandrov struct net_bridge_group_src *grp_src; 11218b671779SNikolay Aleksandrov 11228b671779SNikolay Aleksandrov if (unlikely(pg->src_ents >= PG_SRC_ENT_LIMIT)) 11238b671779SNikolay Aleksandrov return NULL; 11248b671779SNikolay Aleksandrov 11258b671779SNikolay Aleksandrov switch (src_ip->proto) { 11268b671779SNikolay Aleksandrov case htons(ETH_P_IP): 1127deb96566SNikolay Aleksandrov if (ipv4_is_zeronet(src_ip->src.ip4) || 1128deb96566SNikolay Aleksandrov ipv4_is_multicast(src_ip->src.ip4)) 11298b671779SNikolay Aleksandrov return NULL; 11308b671779SNikolay Aleksandrov break; 11318b671779SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 11328b671779SNikolay Aleksandrov case htons(ETH_P_IPV6): 1133deb96566SNikolay Aleksandrov if (ipv6_addr_any(&src_ip->src.ip6) || 1134deb96566SNikolay Aleksandrov ipv6_addr_is_multicast(&src_ip->src.ip6)) 11358b671779SNikolay Aleksandrov return NULL; 11368b671779SNikolay Aleksandrov break; 11378b671779SNikolay Aleksandrov #endif 11388b671779SNikolay Aleksandrov } 11398b671779SNikolay Aleksandrov 11408b671779SNikolay Aleksandrov grp_src = kzalloc(sizeof(*grp_src), GFP_ATOMIC); 11418b671779SNikolay Aleksandrov if (unlikely(!grp_src)) 11428b671779SNikolay Aleksandrov return NULL; 11438b671779SNikolay Aleksandrov 11448b671779SNikolay Aleksandrov grp_src->pg = pg; 1145085b53c8SNikolay Aleksandrov grp_src->br = pg->key.port->br; 11468b671779SNikolay Aleksandrov grp_src->addr = *src_ip; 1147e12cec65SNikolay Aleksandrov grp_src->mcast_gc.destroy = br_multicast_destroy_group_src; 11488b671779SNikolay Aleksandrov timer_setup(&grp_src->timer, br_multicast_group_src_expired, 0); 11498b671779SNikolay Aleksandrov 11508b671779SNikolay Aleksandrov hlist_add_head_rcu(&grp_src->node, &pg->src_list); 11518b671779SNikolay Aleksandrov pg->src_ents++; 11528b671779SNikolay Aleksandrov 11538b671779SNikolay Aleksandrov return grp_src; 11548b671779SNikolay Aleksandrov } 11558b671779SNikolay Aleksandrov 1156cfd56754SCong Wang struct net_bridge_port_group *br_multicast_new_port_group( 1157cfd56754SCong Wang struct net_bridge_port *port, 1158cfd56754SCong Wang struct br_ip *group, 1159ccb1c31aSAmerigo Wang struct net_bridge_port_group __rcu *next, 11606db6f0eaSFelix Fietkau unsigned char flags, 11618b671779SNikolay Aleksandrov const unsigned char *src, 11628f8cb77eSNikolay Aleksandrov u8 filter_mode, 11638f8cb77eSNikolay Aleksandrov u8 rt_protocol) 1164cfd56754SCong Wang { 1165cfd56754SCong Wang struct net_bridge_port_group *p; 1166cfd56754SCong Wang 1167cfd56754SCong Wang p = kzalloc(sizeof(*p), GFP_ATOMIC); 1168cfd56754SCong Wang if (unlikely(!p)) 1169cfd56754SCong Wang return NULL; 1170cfd56754SCong Wang 1171085b53c8SNikolay Aleksandrov p->key.addr = *group; 1172085b53c8SNikolay Aleksandrov p->key.port = port; 11739d06b6d8SElad Raz p->flags = flags; 11748b671779SNikolay Aleksandrov p->filter_mode = filter_mode; 11758f8cb77eSNikolay Aleksandrov p->rt_protocol = rt_protocol; 1176e12cec65SNikolay Aleksandrov p->mcast_gc.destroy = br_multicast_destroy_port_group; 11778b671779SNikolay Aleksandrov INIT_HLIST_HEAD(&p->src_list); 1178085b53c8SNikolay Aleksandrov 1179085b53c8SNikolay Aleksandrov if (!br_multicast_is_star_g(group) && 1180085b53c8SNikolay Aleksandrov rhashtable_lookup_insert_fast(&port->br->sg_port_tbl, &p->rhnode, 1181085b53c8SNikolay Aleksandrov br_sg_port_rht_params)) { 1182085b53c8SNikolay Aleksandrov kfree(p); 1183085b53c8SNikolay Aleksandrov return NULL; 1184085b53c8SNikolay Aleksandrov } 1185085b53c8SNikolay Aleksandrov 1186eca2a43bSstephen hemminger rcu_assign_pointer(p->next, next); 118788c1f37fSAllen Pais timer_setup(&p->timer, br_multicast_port_group_expired, 0); 118842c11ccfSNikolay Aleksandrov timer_setup(&p->rexmit_timer, br_multicast_port_group_rexmit, 0); 118942c11ccfSNikolay Aleksandrov hlist_add_head(&p->mglist, &port->mglist); 11906db6f0eaSFelix Fietkau 11916db6f0eaSFelix Fietkau if (src) 11926db6f0eaSFelix Fietkau memcpy(p->eth_addr, src, ETH_ALEN); 11936db6f0eaSFelix Fietkau else 11941bfe45f4SMao Wenan eth_broadcast_addr(p->eth_addr); 11956db6f0eaSFelix Fietkau 1196cfd56754SCong Wang return p; 1197cfd56754SCong Wang } 1198cfd56754SCong Wang 11991bc844eeSNikolay Aleksandrov void br_multicast_host_join(struct net_bridge_mdb_entry *mp, bool notify) 12001bc844eeSNikolay Aleksandrov { 12011bc844eeSNikolay Aleksandrov if (!mp->host_joined) { 12021bc844eeSNikolay Aleksandrov mp->host_joined = true; 1203094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1204094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 12051bc844eeSNikolay Aleksandrov if (notify) 120681f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_NEWMDB); 12071bc844eeSNikolay Aleksandrov } 1208955062b0SNikolay Aleksandrov 1209955062b0SNikolay Aleksandrov if (br_group_is_l2(&mp->addr)) 1210955062b0SNikolay Aleksandrov return; 1211955062b0SNikolay Aleksandrov 12121bc844eeSNikolay Aleksandrov mod_timer(&mp->timer, jiffies + mp->br->multicast_membership_interval); 12131bc844eeSNikolay Aleksandrov } 12141bc844eeSNikolay Aleksandrov 12151bc844eeSNikolay Aleksandrov void br_multicast_host_leave(struct net_bridge_mdb_entry *mp, bool notify) 12161bc844eeSNikolay Aleksandrov { 12171bc844eeSNikolay Aleksandrov if (!mp->host_joined) 12181bc844eeSNikolay Aleksandrov return; 12191bc844eeSNikolay Aleksandrov 12201bc844eeSNikolay Aleksandrov mp->host_joined = false; 1221094b82fdSNikolay Aleksandrov if (br_multicast_is_star_g(&mp->addr)) 1222094b82fdSNikolay Aleksandrov br_multicast_star_g_host_state(mp); 12231bc844eeSNikolay Aleksandrov if (notify) 122481f19838SNikolay Aleksandrov br_mdb_notify(mp->br->dev, mp, NULL, RTM_DELMDB); 12251bc844eeSNikolay Aleksandrov } 12261bc844eeSNikolay Aleksandrov 1227b0812368SNikolay Aleksandrov static struct net_bridge_port_group * 1228b0812368SNikolay Aleksandrov __br_multicast_add_group(struct net_bridge *br, 12298ef2a9a5SYOSHIFUJI Hideaki struct net_bridge_port *port, 12306db6f0eaSFelix Fietkau struct br_ip *group, 12318b671779SNikolay Aleksandrov const unsigned char *src, 12320436862eSNikolay Aleksandrov u8 filter_mode, 12339116ffbfSNikolay Aleksandrov bool igmpv2_mldv1, 12349116ffbfSNikolay Aleksandrov bool blocked) 1235eb1d1641SHerbert Xu { 1236e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 1237b0812368SNikolay Aleksandrov struct net_bridge_port_group *p = NULL; 12385e923585SNikolay Aleksandrov struct net_bridge_mdb_entry *mp; 1239454594f3SLinus Lüssing unsigned long now = jiffies; 1240eb1d1641SHerbert Xu 1241eb1d1641SHerbert Xu if (!netif_running(br->dev) || 1242eb1d1641SHerbert Xu (port && port->state == BR_STATE_DISABLED)) 1243eb1d1641SHerbert Xu goto out; 1244eb1d1641SHerbert Xu 124519e3a9c9SNikolay Aleksandrov mp = br_multicast_new_group(br, group); 12464c0833bcSTobias Klauser if (IS_ERR(mp)) 1247b0812368SNikolay Aleksandrov return ERR_PTR(PTR_ERR(mp)); 1248eb1d1641SHerbert Xu 1249eb1d1641SHerbert Xu if (!port) { 12501bc844eeSNikolay Aleksandrov br_multicast_host_join(mp, true); 1251eb1d1641SHerbert Xu goto out; 1252eb1d1641SHerbert Xu } 1253eb1d1641SHerbert Xu 1254e8051688SEric Dumazet for (pp = &mp->ports; 1255e8051688SEric Dumazet (p = mlock_dereference(*pp, br)) != NULL; 1256e8051688SEric Dumazet pp = &p->next) { 12576db6f0eaSFelix Fietkau if (br_port_group_equal(p, port, src)) 1258454594f3SLinus Lüssing goto found; 1259085b53c8SNikolay Aleksandrov if ((unsigned long)p->key.port < (unsigned long)port) 1260eb1d1641SHerbert Xu break; 1261eb1d1641SHerbert Xu } 1262eb1d1641SHerbert Xu 1263955062b0SNikolay Aleksandrov p = br_multicast_new_port_group(port, group, *pp, 0, src, 1264955062b0SNikolay Aleksandrov filter_mode, RTPROT_KERNEL); 1265b0812368SNikolay Aleksandrov if (unlikely(!p)) { 1266b0812368SNikolay Aleksandrov p = ERR_PTR(-ENOMEM); 1267b0812368SNikolay Aleksandrov goto out; 1268b0812368SNikolay Aleksandrov } 1269eb1d1641SHerbert Xu rcu_assign_pointer(*pp, p); 12709116ffbfSNikolay Aleksandrov if (blocked) 12719116ffbfSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_BLOCKED; 127281f19838SNikolay Aleksandrov br_mdb_notify(br->dev, mp, p, RTM_NEWMDB); 1273eb1d1641SHerbert Xu 1274454594f3SLinus Lüssing found: 12750436862eSNikolay Aleksandrov if (igmpv2_mldv1) 1276454594f3SLinus Lüssing mod_timer(&p->timer, now + br->multicast_membership_interval); 127781f19838SNikolay Aleksandrov 1278eb1d1641SHerbert Xu out: 1279b0812368SNikolay Aleksandrov return p; 1280b0812368SNikolay Aleksandrov } 1281eb1d1641SHerbert Xu 1282b0812368SNikolay Aleksandrov static int br_multicast_add_group(struct net_bridge *br, 1283b0812368SNikolay Aleksandrov struct net_bridge_port *port, 1284b0812368SNikolay Aleksandrov struct br_ip *group, 1285b0812368SNikolay Aleksandrov const unsigned char *src, 1286b0812368SNikolay Aleksandrov u8 filter_mode, 1287b0812368SNikolay Aleksandrov bool igmpv2_mldv1) 1288b0812368SNikolay Aleksandrov { 1289b0812368SNikolay Aleksandrov struct net_bridge_port_group *pg; 1290b0812368SNikolay Aleksandrov int err; 1291b0812368SNikolay Aleksandrov 1292b0812368SNikolay Aleksandrov spin_lock(&br->multicast_lock); 1293b0812368SNikolay Aleksandrov pg = __br_multicast_add_group(br, port, group, src, filter_mode, 12949116ffbfSNikolay Aleksandrov igmpv2_mldv1, false); 1295b0812368SNikolay Aleksandrov /* NULL is considered valid for host joined groups */ 1296b0812368SNikolay Aleksandrov err = IS_ERR(pg) ? PTR_ERR(pg) : 0; 1297eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1298b0812368SNikolay Aleksandrov 1299eb1d1641SHerbert Xu return err; 1300eb1d1641SHerbert Xu } 1301eb1d1641SHerbert Xu 13028ef2a9a5SYOSHIFUJI Hideaki static int br_ip4_multicast_add_group(struct net_bridge *br, 13038ef2a9a5SYOSHIFUJI Hideaki struct net_bridge_port *port, 1304b0e9a30dSVlad Yasevich __be32 group, 13056db6f0eaSFelix Fietkau __u16 vid, 13068b671779SNikolay Aleksandrov const unsigned char *src, 13078b671779SNikolay Aleksandrov bool igmpv2) 13088ef2a9a5SYOSHIFUJI Hideaki { 13098ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 13108b671779SNikolay Aleksandrov u8 filter_mode; 13118ef2a9a5SYOSHIFUJI Hideaki 13128ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 13138ef2a9a5SYOSHIFUJI Hideaki return 0; 13148ef2a9a5SYOSHIFUJI Hideaki 13151515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1316eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 13178ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1318b0e9a30dSVlad Yasevich br_group.vid = vid; 13198b671779SNikolay Aleksandrov filter_mode = igmpv2 ? MCAST_EXCLUDE : MCAST_INCLUDE; 13208ef2a9a5SYOSHIFUJI Hideaki 13210436862eSNikolay Aleksandrov return br_multicast_add_group(br, port, &br_group, src, filter_mode, 13220436862eSNikolay Aleksandrov igmpv2); 13238ef2a9a5SYOSHIFUJI Hideaki } 13248ef2a9a5SYOSHIFUJI Hideaki 1325dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 132608b202b6SYOSHIFUJI Hideaki static int br_ip6_multicast_add_group(struct net_bridge *br, 132708b202b6SYOSHIFUJI Hideaki struct net_bridge_port *port, 1328b0e9a30dSVlad Yasevich const struct in6_addr *group, 13296db6f0eaSFelix Fietkau __u16 vid, 13308b671779SNikolay Aleksandrov const unsigned char *src, 13318b671779SNikolay Aleksandrov bool mldv1) 133208b202b6SYOSHIFUJI Hideaki { 133308b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 13348b671779SNikolay Aleksandrov u8 filter_mode; 133508b202b6SYOSHIFUJI Hideaki 13363c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 133708b202b6SYOSHIFUJI Hideaki return 0; 133808b202b6SYOSHIFUJI Hideaki 133919e3a9c9SNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 1340eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 13419cc6e0c4SLinus Lüssing br_group.proto = htons(ETH_P_IPV6); 1342b0e9a30dSVlad Yasevich br_group.vid = vid; 13438b671779SNikolay Aleksandrov filter_mode = mldv1 ? MCAST_EXCLUDE : MCAST_INCLUDE; 134408b202b6SYOSHIFUJI Hideaki 13450436862eSNikolay Aleksandrov return br_multicast_add_group(br, port, &br_group, src, filter_mode, 13460436862eSNikolay Aleksandrov mldv1); 134708b202b6SYOSHIFUJI Hideaki } 134808b202b6SYOSHIFUJI Hideaki #endif 134908b202b6SYOSHIFUJI Hideaki 135088c1f37fSAllen Pais static void br_multicast_router_expired(struct timer_list *t) 1351eb1d1641SHerbert Xu { 135288c1f37fSAllen Pais struct net_bridge_port *port = 135388c1f37fSAllen Pais from_timer(port, t, multicast_router_timer); 1354eb1d1641SHerbert Xu struct net_bridge *br = port->br; 1355eb1d1641SHerbert Xu 1356eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 1357a55d8246SNikolay Aleksandrov if (port->multicast_router == MDB_RTR_TYPE_DISABLED || 1358a55d8246SNikolay Aleksandrov port->multicast_router == MDB_RTR_TYPE_PERM || 1359f12e7d95SNogah Frankel timer_pending(&port->multicast_router_timer)) 1360eb1d1641SHerbert Xu goto out; 1361eb1d1641SHerbert Xu 1362f12e7d95SNogah Frankel __del_port_router(port); 1363eb1d1641SHerbert Xu out: 1364eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1365eb1d1641SHerbert Xu } 1366eb1d1641SHerbert Xu 136777041420SYotam Gigi static void br_mc_router_state_change(struct net_bridge *p, 136877041420SYotam Gigi bool is_mc_router) 136977041420SYotam Gigi { 137077041420SYotam Gigi struct switchdev_attr attr = { 137177041420SYotam Gigi .orig_dev = p->dev, 137277041420SYotam Gigi .id = SWITCHDEV_ATTR_ID_BRIDGE_MROUTER, 137377041420SYotam Gigi .flags = SWITCHDEV_F_DEFER, 137477041420SYotam Gigi .u.mrouter = is_mc_router, 137577041420SYotam Gigi }; 137677041420SYotam Gigi 137777041420SYotam Gigi switchdev_port_attr_set(p->dev, &attr); 137877041420SYotam Gigi } 137977041420SYotam Gigi 138088c1f37fSAllen Pais static void br_multicast_local_router_expired(struct timer_list *t) 1381eb1d1641SHerbert Xu { 138288c1f37fSAllen Pais struct net_bridge *br = from_timer(br, t, multicast_router_timer); 138377041420SYotam Gigi 138477041420SYotam Gigi spin_lock(&br->multicast_lock); 138577041420SYotam Gigi if (br->multicast_router == MDB_RTR_TYPE_DISABLED || 138677041420SYotam Gigi br->multicast_router == MDB_RTR_TYPE_PERM || 138777041420SYotam Gigi timer_pending(&br->multicast_router_timer)) 138877041420SYotam Gigi goto out; 138977041420SYotam Gigi 139077041420SYotam Gigi br_mc_router_state_change(br, false); 139177041420SYotam Gigi out: 139277041420SYotam Gigi spin_unlock(&br->multicast_lock); 1393eb1d1641SHerbert Xu } 1394eb1d1641SHerbert Xu 1395cc0fdd80SLinus Lüssing static void br_multicast_querier_expired(struct net_bridge *br, 139690010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1397c83b8fabSHerbert Xu { 1398c83b8fabSHerbert Xu spin_lock(&br->multicast_lock); 139913cefad2SNikolay Aleksandrov if (!netif_running(br->dev) || !br_opt_get(br, BROPT_MULTICAST_ENABLED)) 1400c83b8fabSHerbert Xu goto out; 1401c83b8fabSHerbert Xu 1402cc0fdd80SLinus Lüssing br_multicast_start_querier(br, query); 1403c83b8fabSHerbert Xu 1404c83b8fabSHerbert Xu out: 1405c83b8fabSHerbert Xu spin_unlock(&br->multicast_lock); 1406c83b8fabSHerbert Xu } 1407c83b8fabSHerbert Xu 140888c1f37fSAllen Pais static void br_ip4_multicast_querier_expired(struct timer_list *t) 1409cc0fdd80SLinus Lüssing { 141088c1f37fSAllen Pais struct net_bridge *br = from_timer(br, t, ip4_other_query.timer); 1411cc0fdd80SLinus Lüssing 141290010b36SLinus Lüssing br_multicast_querier_expired(br, &br->ip4_own_query); 1413cc0fdd80SLinus Lüssing } 1414cc0fdd80SLinus Lüssing 1415cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 141688c1f37fSAllen Pais static void br_ip6_multicast_querier_expired(struct timer_list *t) 1417cc0fdd80SLinus Lüssing { 141888c1f37fSAllen Pais struct net_bridge *br = from_timer(br, t, ip6_other_query.timer); 1419cc0fdd80SLinus Lüssing 142090010b36SLinus Lüssing br_multicast_querier_expired(br, &br->ip6_own_query); 1421cc0fdd80SLinus Lüssing } 1422cc0fdd80SLinus Lüssing #endif 1423cc0fdd80SLinus Lüssing 1424dc4eb53aSLinus Lüssing static void br_multicast_select_own_querier(struct net_bridge *br, 1425dc4eb53aSLinus Lüssing struct br_ip *ip, 1426dc4eb53aSLinus Lüssing struct sk_buff *skb) 1427dc4eb53aSLinus Lüssing { 1428dc4eb53aSLinus Lüssing if (ip->proto == htons(ETH_P_IP)) 1429deb96566SNikolay Aleksandrov br->ip4_querier.addr.src.ip4 = ip_hdr(skb)->saddr; 1430dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 1431dc4eb53aSLinus Lüssing else 1432deb96566SNikolay Aleksandrov br->ip6_querier.addr.src.ip6 = ipv6_hdr(skb)->saddr; 1433dc4eb53aSLinus Lüssing #endif 1434dc4eb53aSLinus Lüssing } 1435dc4eb53aSLinus Lüssing 14368ef2a9a5SYOSHIFUJI Hideaki static void __br_multicast_send_query(struct net_bridge *br, 14378ef2a9a5SYOSHIFUJI Hideaki struct net_bridge_port *port, 1438438ef2d0SNikolay Aleksandrov struct net_bridge_port_group *pg, 1439438ef2d0SNikolay Aleksandrov struct br_ip *ip_dst, 1440438ef2d0SNikolay Aleksandrov struct br_ip *group, 1441438ef2d0SNikolay Aleksandrov bool with_srcs, 144242c11ccfSNikolay Aleksandrov u8 sflag, 144342c11ccfSNikolay Aleksandrov bool *need_rexmit) 1444eb1d1641SHerbert Xu { 1445438ef2d0SNikolay Aleksandrov bool over_lmqt = !!sflag; 1446eb1d1641SHerbert Xu struct sk_buff *skb; 14471080ab95SNikolay Aleksandrov u8 igmp_type; 1448eb1d1641SHerbert Xu 1449438ef2d0SNikolay Aleksandrov again_under_lmqt: 1450438ef2d0SNikolay Aleksandrov skb = br_multicast_alloc_query(br, pg, ip_dst, group, with_srcs, 145142c11ccfSNikolay Aleksandrov over_lmqt, sflag, &igmp_type, 145242c11ccfSNikolay Aleksandrov need_rexmit); 1453eb1d1641SHerbert Xu if (!skb) 14548ef2a9a5SYOSHIFUJI Hideaki return; 1455eb1d1641SHerbert Xu 1456eb1d1641SHerbert Xu if (port) { 1457eb1d1641SHerbert Xu skb->dev = port->dev; 1458a65056ecSNikolay Aleksandrov br_multicast_count(br, port, skb, igmp_type, 14591080ab95SNikolay Aleksandrov BR_MCAST_DIR_TX); 146029a26a56SEric W. Biederman NF_HOOK(NFPROTO_BRIDGE, NF_BR_LOCAL_OUT, 146129a26a56SEric W. Biederman dev_net(port->dev), NULL, skb, NULL, skb->dev, 1462f0b4eeceSLinus Lüssing br_dev_queue_push_xmit); 1463438ef2d0SNikolay Aleksandrov 1464438ef2d0SNikolay Aleksandrov if (over_lmqt && with_srcs && sflag) { 1465438ef2d0SNikolay Aleksandrov over_lmqt = false; 1466438ef2d0SNikolay Aleksandrov goto again_under_lmqt; 1467438ef2d0SNikolay Aleksandrov } 1468dc4eb53aSLinus Lüssing } else { 1469438ef2d0SNikolay Aleksandrov br_multicast_select_own_querier(br, group, skb); 1470a65056ecSNikolay Aleksandrov br_multicast_count(br, port, skb, igmp_type, 14711080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 1472eb1d1641SHerbert Xu netif_rx(skb); 14738ef2a9a5SYOSHIFUJI Hideaki } 1474dc4eb53aSLinus Lüssing } 1475eb1d1641SHerbert Xu 14768ef2a9a5SYOSHIFUJI Hideaki static void br_multicast_send_query(struct net_bridge *br, 1477cc0fdd80SLinus Lüssing struct net_bridge_port *port, 147890010b36SLinus Lüssing struct bridge_mcast_own_query *own_query) 14798ef2a9a5SYOSHIFUJI Hideaki { 148090010b36SLinus Lüssing struct bridge_mcast_other_query *other_query = NULL; 14815e923585SNikolay Aleksandrov struct br_ip br_group; 14825e923585SNikolay Aleksandrov unsigned long time; 14838ef2a9a5SYOSHIFUJI Hideaki 148413cefad2SNikolay Aleksandrov if (!netif_running(br->dev) || 148513cefad2SNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED) || 1486675779adSNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_QUERIER)) 14878ef2a9a5SYOSHIFUJI Hideaki return; 14888ef2a9a5SYOSHIFUJI Hideaki 1489eab3227bSNikolay Aleksandrov memset(&br_group.dst, 0, sizeof(br_group.dst)); 14908ef2a9a5SYOSHIFUJI Hideaki 149190010b36SLinus Lüssing if (port ? (own_query == &port->ip4_own_query) : 149290010b36SLinus Lüssing (own_query == &br->ip4_own_query)) { 149390010b36SLinus Lüssing other_query = &br->ip4_other_query; 149408b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 1495dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 1496cc0fdd80SLinus Lüssing } else { 149790010b36SLinus Lüssing other_query = &br->ip6_other_query; 149808b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 149908b202b6SYOSHIFUJI Hideaki #endif 1500eb1d1641SHerbert Xu } 1501eb1d1641SHerbert Xu 150290010b36SLinus Lüssing if (!other_query || timer_pending(&other_query->timer)) 1503cc0fdd80SLinus Lüssing return; 1504cc0fdd80SLinus Lüssing 150542c11ccfSNikolay Aleksandrov __br_multicast_send_query(br, port, NULL, NULL, &br_group, false, 0, 150642c11ccfSNikolay Aleksandrov NULL); 1507cc0fdd80SLinus Lüssing 1508cc0fdd80SLinus Lüssing time = jiffies; 150990010b36SLinus Lüssing time += own_query->startup_sent < br->multicast_startup_query_count ? 1510cc0fdd80SLinus Lüssing br->multicast_startup_query_interval : 1511cc0fdd80SLinus Lüssing br->multicast_query_interval; 151290010b36SLinus Lüssing mod_timer(&own_query->timer, time); 1513cc0fdd80SLinus Lüssing } 1514cc0fdd80SLinus Lüssing 151590010b36SLinus Lüssing static void 151690010b36SLinus Lüssing br_multicast_port_query_expired(struct net_bridge_port *port, 151790010b36SLinus Lüssing struct bridge_mcast_own_query *query) 1518eb1d1641SHerbert Xu { 1519eb1d1641SHerbert Xu struct net_bridge *br = port->br; 1520eb1d1641SHerbert Xu 1521eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 152202a780c0SDan Carpenter if (port->state == BR_STATE_DISABLED || 152302a780c0SDan Carpenter port->state == BR_STATE_BLOCKING) 1524eb1d1641SHerbert Xu goto out; 1525eb1d1641SHerbert Xu 1526cc0fdd80SLinus Lüssing if (query->startup_sent < br->multicast_startup_query_count) 1527cc0fdd80SLinus Lüssing query->startup_sent++; 1528eb1d1641SHerbert Xu 1529cc0fdd80SLinus Lüssing br_multicast_send_query(port->br, port, query); 1530eb1d1641SHerbert Xu 1531eb1d1641SHerbert Xu out: 1532eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1533eb1d1641SHerbert Xu } 1534eb1d1641SHerbert Xu 153588c1f37fSAllen Pais static void br_ip4_multicast_port_query_expired(struct timer_list *t) 1536cc0fdd80SLinus Lüssing { 153788c1f37fSAllen Pais struct net_bridge_port *port = from_timer(port, t, ip4_own_query.timer); 1538cc0fdd80SLinus Lüssing 153990010b36SLinus Lüssing br_multicast_port_query_expired(port, &port->ip4_own_query); 1540cc0fdd80SLinus Lüssing } 1541cc0fdd80SLinus Lüssing 1542cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 154388c1f37fSAllen Pais static void br_ip6_multicast_port_query_expired(struct timer_list *t) 1544cc0fdd80SLinus Lüssing { 154588c1f37fSAllen Pais struct net_bridge_port *port = from_timer(port, t, ip6_own_query.timer); 1546cc0fdd80SLinus Lüssing 154790010b36SLinus Lüssing br_multicast_port_query_expired(port, &port->ip6_own_query); 1548cc0fdd80SLinus Lüssing } 1549cc0fdd80SLinus Lüssing #endif 1550cc0fdd80SLinus Lüssing 155142c11ccfSNikolay Aleksandrov static void br_multicast_port_group_rexmit(struct timer_list *t) 155242c11ccfSNikolay Aleksandrov { 155342c11ccfSNikolay Aleksandrov struct net_bridge_port_group *pg = from_timer(pg, t, rexmit_timer); 155442c11ccfSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 1555085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 155642c11ccfSNikolay Aleksandrov bool need_rexmit = false; 155742c11ccfSNikolay Aleksandrov 155842c11ccfSNikolay Aleksandrov spin_lock(&br->multicast_lock); 155942c11ccfSNikolay Aleksandrov if (!netif_running(br->dev) || hlist_unhashed(&pg->mglist) || 156042c11ccfSNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED) || 156142c11ccfSNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_QUERIER)) 156242c11ccfSNikolay Aleksandrov goto out; 156342c11ccfSNikolay Aleksandrov 1564085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 156542c11ccfSNikolay Aleksandrov other_query = &br->ip4_other_query; 156642c11ccfSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 156742c11ccfSNikolay Aleksandrov else 156842c11ccfSNikolay Aleksandrov other_query = &br->ip6_other_query; 156942c11ccfSNikolay Aleksandrov #endif 157042c11ccfSNikolay Aleksandrov 157142c11ccfSNikolay Aleksandrov if (!other_query || timer_pending(&other_query->timer)) 157242c11ccfSNikolay Aleksandrov goto out; 157342c11ccfSNikolay Aleksandrov 157442c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt) { 157542c11ccfSNikolay Aleksandrov pg->grp_query_rexmit_cnt--; 1576085b53c8SNikolay Aleksandrov __br_multicast_send_query(br, pg->key.port, pg, &pg->key.addr, 1577085b53c8SNikolay Aleksandrov &pg->key.addr, false, 1, NULL); 157842c11ccfSNikolay Aleksandrov } 1579085b53c8SNikolay Aleksandrov __br_multicast_send_query(br, pg->key.port, pg, &pg->key.addr, 1580085b53c8SNikolay Aleksandrov &pg->key.addr, true, 0, &need_rexmit); 158142c11ccfSNikolay Aleksandrov 158242c11ccfSNikolay Aleksandrov if (pg->grp_query_rexmit_cnt || need_rexmit) 158342c11ccfSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, jiffies + 158442c11ccfSNikolay Aleksandrov br->multicast_last_member_interval); 158542c11ccfSNikolay Aleksandrov out: 158642c11ccfSNikolay Aleksandrov spin_unlock(&br->multicast_lock); 158742c11ccfSNikolay Aleksandrov } 158842c11ccfSNikolay Aleksandrov 1589147c1e9bSNogah Frankel static void br_mc_disabled_update(struct net_device *dev, bool value) 1590147c1e9bSNogah Frankel { 1591147c1e9bSNogah Frankel struct switchdev_attr attr = { 1592147c1e9bSNogah Frankel .orig_dev = dev, 1593147c1e9bSNogah Frankel .id = SWITCHDEV_ATTR_ID_BRIDGE_MC_DISABLED, 1594147c1e9bSNogah Frankel .flags = SWITCHDEV_F_DEFER, 159513cefad2SNikolay Aleksandrov .u.mc_disabled = !value, 1596147c1e9bSNogah Frankel }; 1597147c1e9bSNogah Frankel 1598147c1e9bSNogah Frankel switchdev_port_attr_set(dev, &attr); 1599147c1e9bSNogah Frankel } 1600147c1e9bSNogah Frankel 16011080ab95SNikolay Aleksandrov int br_multicast_add_port(struct net_bridge_port *port) 1602eb1d1641SHerbert Xu { 16037f0aec7aSNikolay Aleksandrov port->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 1604eb1d1641SHerbert Xu 160588c1f37fSAllen Pais timer_setup(&port->multicast_router_timer, 160688c1f37fSAllen Pais br_multicast_router_expired, 0); 160788c1f37fSAllen Pais timer_setup(&port->ip4_own_query.timer, 160888c1f37fSAllen Pais br_ip4_multicast_port_query_expired, 0); 1609cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 161088c1f37fSAllen Pais timer_setup(&port->ip6_own_query.timer, 161188c1f37fSAllen Pais br_ip6_multicast_port_query_expired, 0); 1612cc0fdd80SLinus Lüssing #endif 161313cefad2SNikolay Aleksandrov br_mc_disabled_update(port->dev, 161413cefad2SNikolay Aleksandrov br_opt_get(port->br, BROPT_MULTICAST_ENABLED)); 1615147c1e9bSNogah Frankel 16161080ab95SNikolay Aleksandrov port->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 16171080ab95SNikolay Aleksandrov if (!port->mcast_stats) 16181080ab95SNikolay Aleksandrov return -ENOMEM; 16191080ab95SNikolay Aleksandrov 16201080ab95SNikolay Aleksandrov return 0; 1621eb1d1641SHerbert Xu } 1622eb1d1641SHerbert Xu 1623eb1d1641SHerbert Xu void br_multicast_del_port(struct net_bridge_port *port) 1624eb1d1641SHerbert Xu { 1625e10177abSSatish Ashok struct net_bridge *br = port->br; 1626e10177abSSatish Ashok struct net_bridge_port_group *pg; 1627e12cec65SNikolay Aleksandrov HLIST_HEAD(deleted_head); 1628e10177abSSatish Ashok struct hlist_node *n; 1629e10177abSSatish Ashok 1630e10177abSSatish Ashok /* Take care of the remaining groups, only perm ones should be left */ 1631e10177abSSatish Ashok spin_lock_bh(&br->multicast_lock); 1632e10177abSSatish Ashok hlist_for_each_entry_safe(pg, n, &port->mglist, mglist) 1633681590bdSNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 1634e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 1635e10177abSSatish Ashok spin_unlock_bh(&br->multicast_lock); 1636e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 1637eb1d1641SHerbert Xu del_timer_sync(&port->multicast_router_timer); 16381080ab95SNikolay Aleksandrov free_percpu(port->mcast_stats); 1639eb1d1641SHerbert Xu } 1640eb1d1641SHerbert Xu 164190010b36SLinus Lüssing static void br_multicast_enable(struct bridge_mcast_own_query *query) 1642561f1103SHerbert Xu { 1643cc0fdd80SLinus Lüssing query->startup_sent = 0; 1644561f1103SHerbert Xu 1645cc0fdd80SLinus Lüssing if (try_to_del_timer_sync(&query->timer) >= 0 || 1646cc0fdd80SLinus Lüssing del_timer(&query->timer)) 1647cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 1648561f1103SHerbert Xu } 1649561f1103SHerbert Xu 16507cb3f921SNikolay Aleksandrov static void __br_multicast_enable_port(struct net_bridge_port *port) 1651eb1d1641SHerbert Xu { 1652eb1d1641SHerbert Xu struct net_bridge *br = port->br; 1653eb1d1641SHerbert Xu 165413cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED) || !netif_running(br->dev)) 16557cb3f921SNikolay Aleksandrov return; 1656eb1d1641SHerbert Xu 165790010b36SLinus Lüssing br_multicast_enable(&port->ip4_own_query); 1658cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 165990010b36SLinus Lüssing br_multicast_enable(&port->ip6_own_query); 1660cc0fdd80SLinus Lüssing #endif 16617f0aec7aSNikolay Aleksandrov if (port->multicast_router == MDB_RTR_TYPE_PERM && 16627f0aec7aSNikolay Aleksandrov hlist_unhashed(&port->rlist)) 1663754bc547SSatish Ashok br_multicast_add_router(br, port); 16647cb3f921SNikolay Aleksandrov } 1665eb1d1641SHerbert Xu 16667cb3f921SNikolay Aleksandrov void br_multicast_enable_port(struct net_bridge_port *port) 16677cb3f921SNikolay Aleksandrov { 16687cb3f921SNikolay Aleksandrov struct net_bridge *br = port->br; 16697cb3f921SNikolay Aleksandrov 16707cb3f921SNikolay Aleksandrov spin_lock(&br->multicast_lock); 16717cb3f921SNikolay Aleksandrov __br_multicast_enable_port(port); 1672eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1673eb1d1641SHerbert Xu } 1674eb1d1641SHerbert Xu 1675eb1d1641SHerbert Xu void br_multicast_disable_port(struct net_bridge_port *port) 1676eb1d1641SHerbert Xu { 1677eb1d1641SHerbert Xu struct net_bridge *br = port->br; 1678eb1d1641SHerbert Xu struct net_bridge_port_group *pg; 1679b67bfe0dSSasha Levin struct hlist_node *n; 1680eb1d1641SHerbert Xu 1681eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 1682b67bfe0dSSasha Levin hlist_for_each_entry_safe(pg, n, &port->mglist, mglist) 16839d06b6d8SElad Raz if (!(pg->flags & MDB_PG_FLAGS_PERMANENT)) 1684681590bdSNikolay Aleksandrov br_multicast_find_del_pg(br, pg); 1685eb1d1641SHerbert Xu 1686f12e7d95SNogah Frankel __del_port_router(port); 1687f12e7d95SNogah Frankel 1688eb1d1641SHerbert Xu del_timer(&port->multicast_router_timer); 168990010b36SLinus Lüssing del_timer(&port->ip4_own_query.timer); 1690cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 169190010b36SLinus Lüssing del_timer(&port->ip6_own_query.timer); 1692cc0fdd80SLinus Lüssing #endif 1693eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 1694eb1d1641SHerbert Xu } 1695eb1d1641SHerbert Xu 1696e6231bcaSNikolay Aleksandrov static int __grp_src_delete_marked(struct net_bridge_port_group *pg) 1697e6231bcaSNikolay Aleksandrov { 1698e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 1699e6231bcaSNikolay Aleksandrov struct hlist_node *tmp; 1700e6231bcaSNikolay Aleksandrov int deleted = 0; 1701e6231bcaSNikolay Aleksandrov 1702e6231bcaSNikolay Aleksandrov hlist_for_each_entry_safe(ent, tmp, &pg->src_list, node) 1703e6231bcaSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_DELETE) { 1704e6231bcaSNikolay Aleksandrov br_multicast_del_group_src(ent); 1705e6231bcaSNikolay Aleksandrov deleted++; 1706e6231bcaSNikolay Aleksandrov } 1707e6231bcaSNikolay Aleksandrov 1708e6231bcaSNikolay Aleksandrov return deleted; 1709e6231bcaSNikolay Aleksandrov } 1710e6231bcaSNikolay Aleksandrov 1711b0812368SNikolay Aleksandrov static void __grp_src_mod_timer(struct net_bridge_group_src *src, 1712b0812368SNikolay Aleksandrov unsigned long expires) 1713b0812368SNikolay Aleksandrov { 1714b0812368SNikolay Aleksandrov mod_timer(&src->timer, expires); 1715b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(src); 1716b0812368SNikolay Aleksandrov } 1717b0812368SNikolay Aleksandrov 17185bf1e00bSNikolay Aleksandrov static void __grp_src_query_marked_and_rexmit(struct net_bridge_port_group *pg) 17195bf1e00bSNikolay Aleksandrov { 17205bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 1721085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 17225bf1e00bSNikolay Aleksandrov u32 lmqc = br->multicast_last_member_count; 17235bf1e00bSNikolay Aleksandrov unsigned long lmqt, lmi, now = jiffies; 17245bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 17255bf1e00bSNikolay Aleksandrov 17265bf1e00bSNikolay Aleksandrov if (!netif_running(br->dev) || 17275bf1e00bSNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED)) 17285bf1e00bSNikolay Aleksandrov return; 17295bf1e00bSNikolay Aleksandrov 1730085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 17315bf1e00bSNikolay Aleksandrov other_query = &br->ip4_other_query; 17325bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 17335bf1e00bSNikolay Aleksandrov else 17345bf1e00bSNikolay Aleksandrov other_query = &br->ip6_other_query; 17355bf1e00bSNikolay Aleksandrov #endif 17365bf1e00bSNikolay Aleksandrov 17375bf1e00bSNikolay Aleksandrov lmqt = now + br_multicast_lmqt(br); 17385bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) { 17395bf1e00bSNikolay Aleksandrov if (ent->flags & BR_SGRP_F_SEND) { 17405bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 17415bf1e00bSNikolay Aleksandrov if (ent->timer.expires > lmqt) { 17425bf1e00bSNikolay Aleksandrov if (br_opt_get(br, BROPT_MULTICAST_QUERIER) && 17435bf1e00bSNikolay Aleksandrov other_query && 17445bf1e00bSNikolay Aleksandrov !timer_pending(&other_query->timer)) 17455bf1e00bSNikolay Aleksandrov ent->src_query_rexmit_cnt = lmqc; 1746b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, lmqt); 17475bf1e00bSNikolay Aleksandrov } 17485bf1e00bSNikolay Aleksandrov } 17495bf1e00bSNikolay Aleksandrov } 17505bf1e00bSNikolay Aleksandrov 17515bf1e00bSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_QUERIER) || 17525bf1e00bSNikolay Aleksandrov !other_query || timer_pending(&other_query->timer)) 17535bf1e00bSNikolay Aleksandrov return; 17545bf1e00bSNikolay Aleksandrov 1755085b53c8SNikolay Aleksandrov __br_multicast_send_query(br, pg->key.port, pg, &pg->key.addr, 1756085b53c8SNikolay Aleksandrov &pg->key.addr, true, 1, NULL); 17575bf1e00bSNikolay Aleksandrov 17585bf1e00bSNikolay Aleksandrov lmi = now + br->multicast_last_member_interval; 17595bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 17605bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 17615bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 17625bf1e00bSNikolay Aleksandrov } 17635bf1e00bSNikolay Aleksandrov 17645bf1e00bSNikolay Aleksandrov static void __grp_send_query_and_rexmit(struct net_bridge_port_group *pg) 17655bf1e00bSNikolay Aleksandrov { 17665bf1e00bSNikolay Aleksandrov struct bridge_mcast_other_query *other_query = NULL; 1767085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 17685bf1e00bSNikolay Aleksandrov unsigned long now = jiffies, lmi; 17695bf1e00bSNikolay Aleksandrov 17705bf1e00bSNikolay Aleksandrov if (!netif_running(br->dev) || 17715bf1e00bSNikolay Aleksandrov !br_opt_get(br, BROPT_MULTICAST_ENABLED)) 17725bf1e00bSNikolay Aleksandrov return; 17735bf1e00bSNikolay Aleksandrov 1774085b53c8SNikolay Aleksandrov if (pg->key.addr.proto == htons(ETH_P_IP)) 17755bf1e00bSNikolay Aleksandrov other_query = &br->ip4_other_query; 17765bf1e00bSNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 17775bf1e00bSNikolay Aleksandrov else 17785bf1e00bSNikolay Aleksandrov other_query = &br->ip6_other_query; 17795bf1e00bSNikolay Aleksandrov #endif 17805bf1e00bSNikolay Aleksandrov 17815bf1e00bSNikolay Aleksandrov if (br_opt_get(br, BROPT_MULTICAST_QUERIER) && 17825bf1e00bSNikolay Aleksandrov other_query && !timer_pending(&other_query->timer)) { 17835bf1e00bSNikolay Aleksandrov lmi = now + br->multicast_last_member_interval; 17845bf1e00bSNikolay Aleksandrov pg->grp_query_rexmit_cnt = br->multicast_last_member_count - 1; 1785085b53c8SNikolay Aleksandrov __br_multicast_send_query(br, pg->key.port, pg, &pg->key.addr, 1786085b53c8SNikolay Aleksandrov &pg->key.addr, false, 0, NULL); 17875bf1e00bSNikolay Aleksandrov if (!timer_pending(&pg->rexmit_timer) || 17885bf1e00bSNikolay Aleksandrov time_after(pg->rexmit_timer.expires, lmi)) 17895bf1e00bSNikolay Aleksandrov mod_timer(&pg->rexmit_timer, lmi); 17905bf1e00bSNikolay Aleksandrov } 17915bf1e00bSNikolay Aleksandrov 17925bf1e00bSNikolay Aleksandrov if (pg->filter_mode == MCAST_EXCLUDE && 17935bf1e00bSNikolay Aleksandrov (!timer_pending(&pg->timer) || 17945bf1e00bSNikolay Aleksandrov time_after(pg->timer.expires, now + br_multicast_lmqt(br)))) 17955bf1e00bSNikolay Aleksandrov mod_timer(&pg->timer, now + br_multicast_lmqt(br)); 17965bf1e00bSNikolay Aleksandrov } 17975bf1e00bSNikolay Aleksandrov 17980436862eSNikolay Aleksandrov /* State Msg type New state Actions 17990436862eSNikolay Aleksandrov * INCLUDE (A) IS_IN (B) INCLUDE (A+B) (B)=GMI 18000436862eSNikolay Aleksandrov * INCLUDE (A) ALLOW (B) INCLUDE (A+B) (B)=GMI 18010436862eSNikolay Aleksandrov * EXCLUDE (X,Y) ALLOW (A) EXCLUDE (X+A,Y-A) (A)=GMI 18020436862eSNikolay Aleksandrov */ 180354bea721SNikolay Aleksandrov static bool br_multicast_isinc_allow(struct net_bridge_port_group *pg, void *h_addr, 18049e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 18050436862eSNikolay Aleksandrov { 1806085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 18070436862eSNikolay Aleksandrov struct net_bridge_group_src *ent; 18080436862eSNikolay Aleksandrov unsigned long now = jiffies; 18090436862eSNikolay Aleksandrov bool changed = false; 18100436862eSNikolay Aleksandrov struct br_ip src_ip; 18110436862eSNikolay Aleksandrov u32 src_idx; 18120436862eSNikolay Aleksandrov 18130436862eSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 1814085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 18150436862eSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 1816e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 18170436862eSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 18180436862eSNikolay Aleksandrov if (!ent) { 18190436862eSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 18200436862eSNikolay Aleksandrov if (ent) 18210436862eSNikolay Aleksandrov changed = true; 18220436862eSNikolay Aleksandrov } 18230436862eSNikolay Aleksandrov 18240436862eSNikolay Aleksandrov if (ent) 1825b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(br)); 18260436862eSNikolay Aleksandrov } 18270436862eSNikolay Aleksandrov 18280436862eSNikolay Aleksandrov return changed; 18290436862eSNikolay Aleksandrov } 18300436862eSNikolay Aleksandrov 1831e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 1832e6231bcaSNikolay Aleksandrov * INCLUDE (A) IS_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 1833e6231bcaSNikolay Aleksandrov * Delete (A-B) 1834e6231bcaSNikolay Aleksandrov * Group Timer=GMI 1835e6231bcaSNikolay Aleksandrov */ 183654bea721SNikolay Aleksandrov static void __grp_src_isexc_incl(struct net_bridge_port_group *pg, void *h_addr, 18379e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 1838e6231bcaSNikolay Aleksandrov { 1839e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 1840e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 1841e6231bcaSNikolay Aleksandrov u32 src_idx; 1842e6231bcaSNikolay Aleksandrov 1843e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1844e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 1845e6231bcaSNikolay Aleksandrov 1846e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 1847085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 1848e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 1849e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 1850e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 1851e6231bcaSNikolay Aleksandrov if (ent) 1852e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 1853e6231bcaSNikolay Aleksandrov else 1854b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 1855b0812368SNikolay Aleksandrov if (ent) 1856b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 1857e6231bcaSNikolay Aleksandrov } 1858e6231bcaSNikolay Aleksandrov 1859e6231bcaSNikolay Aleksandrov __grp_src_delete_marked(pg); 1860e6231bcaSNikolay Aleksandrov } 1861e6231bcaSNikolay Aleksandrov 1862e6231bcaSNikolay Aleksandrov /* State Msg type New state Actions 1863e6231bcaSNikolay Aleksandrov * EXCLUDE (X,Y) IS_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=GMI 1864e6231bcaSNikolay Aleksandrov * Delete (X-A) 1865e6231bcaSNikolay Aleksandrov * Delete (Y-A) 1866e6231bcaSNikolay Aleksandrov * Group Timer=GMI 1867e6231bcaSNikolay Aleksandrov */ 186854bea721SNikolay Aleksandrov static bool __grp_src_isexc_excl(struct net_bridge_port_group *pg, void *h_addr, 18699e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 1870e6231bcaSNikolay Aleksandrov { 1871085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 1872e6231bcaSNikolay Aleksandrov struct net_bridge_group_src *ent; 1873e6231bcaSNikolay Aleksandrov unsigned long now = jiffies; 1874e6231bcaSNikolay Aleksandrov bool changed = false; 1875e6231bcaSNikolay Aleksandrov struct br_ip src_ip; 1876e6231bcaSNikolay Aleksandrov u32 src_idx; 1877e6231bcaSNikolay Aleksandrov 1878e6231bcaSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 1879e6231bcaSNikolay Aleksandrov ent->flags |= BR_SGRP_F_DELETE; 1880e6231bcaSNikolay Aleksandrov 1881e6231bcaSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 1882085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 1883e6231bcaSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 1884e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 1885e6231bcaSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 1886e6231bcaSNikolay Aleksandrov if (ent) { 1887e6231bcaSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 1888e6231bcaSNikolay Aleksandrov } else { 1889e6231bcaSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 1890e6231bcaSNikolay Aleksandrov if (ent) { 1891b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, 1892e6231bcaSNikolay Aleksandrov now + br_multicast_gmi(br)); 1893e6231bcaSNikolay Aleksandrov changed = true; 1894e6231bcaSNikolay Aleksandrov } 1895e6231bcaSNikolay Aleksandrov } 1896e6231bcaSNikolay Aleksandrov } 1897e6231bcaSNikolay Aleksandrov 1898e6231bcaSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 1899e6231bcaSNikolay Aleksandrov changed = true; 1900e6231bcaSNikolay Aleksandrov 1901e6231bcaSNikolay Aleksandrov return changed; 1902e6231bcaSNikolay Aleksandrov } 1903e6231bcaSNikolay Aleksandrov 190454bea721SNikolay Aleksandrov static bool br_multicast_isexc(struct net_bridge_port_group *pg, void *h_addr, 19059e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 1906e6231bcaSNikolay Aleksandrov { 1907085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 1908e6231bcaSNikolay Aleksandrov bool changed = false; 1909e6231bcaSNikolay Aleksandrov 1910e6231bcaSNikolay Aleksandrov switch (pg->filter_mode) { 1911e6231bcaSNikolay Aleksandrov case MCAST_INCLUDE: 191254bea721SNikolay Aleksandrov __grp_src_isexc_incl(pg, h_addr, srcs, nsrcs, addr_size); 19138266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 1914e6231bcaSNikolay Aleksandrov changed = true; 1915e6231bcaSNikolay Aleksandrov break; 1916e6231bcaSNikolay Aleksandrov case MCAST_EXCLUDE: 191754bea721SNikolay Aleksandrov changed = __grp_src_isexc_excl(pg, h_addr, srcs, nsrcs, addr_size); 1918e6231bcaSNikolay Aleksandrov break; 1919e6231bcaSNikolay Aleksandrov } 1920e6231bcaSNikolay Aleksandrov 1921e6231bcaSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 1922e6231bcaSNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(br)); 1923e6231bcaSNikolay Aleksandrov 1924e6231bcaSNikolay Aleksandrov return changed; 1925e6231bcaSNikolay Aleksandrov } 1926e6231bcaSNikolay Aleksandrov 19275bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 19285bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_IN (B) INCLUDE (A+B) (B)=GMI 19295bf1e00bSNikolay Aleksandrov * Send Q(G,A-B) 19305bf1e00bSNikolay Aleksandrov */ 193154bea721SNikolay Aleksandrov static bool __grp_src_toin_incl(struct net_bridge_port_group *pg, void *h_addr, 19329e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 19335bf1e00bSNikolay Aleksandrov { 1934085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 19355bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 19365bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 19375bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 19385bf1e00bSNikolay Aleksandrov bool changed = false; 19395bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 19405bf1e00bSNikolay Aleksandrov 19415bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 19425bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 19435bf1e00bSNikolay Aleksandrov 19445bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 1945085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 19465bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 1947e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 19485bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 19495bf1e00bSNikolay Aleksandrov if (ent) { 19505bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 19515bf1e00bSNikolay Aleksandrov to_send--; 19525bf1e00bSNikolay Aleksandrov } else { 19535bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 19545bf1e00bSNikolay Aleksandrov if (ent) 19555bf1e00bSNikolay Aleksandrov changed = true; 19565bf1e00bSNikolay Aleksandrov } 19575bf1e00bSNikolay Aleksandrov if (ent) 1958b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(br)); 19595bf1e00bSNikolay Aleksandrov } 19605bf1e00bSNikolay Aleksandrov 19615bf1e00bSNikolay Aleksandrov if (to_send) 19625bf1e00bSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 19635bf1e00bSNikolay Aleksandrov 19645bf1e00bSNikolay Aleksandrov return changed; 19655bf1e00bSNikolay Aleksandrov } 19665bf1e00bSNikolay Aleksandrov 19675bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 19685bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_IN (A) EXCLUDE (X+A,Y-A) (A)=GMI 19695bf1e00bSNikolay Aleksandrov * Send Q(G,X-A) 19705bf1e00bSNikolay Aleksandrov * Send Q(G) 19715bf1e00bSNikolay Aleksandrov */ 197254bea721SNikolay Aleksandrov static bool __grp_src_toin_excl(struct net_bridge_port_group *pg, void *h_addr, 19739e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 19745bf1e00bSNikolay Aleksandrov { 1975085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 19765bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = pg->src_ents; 19775bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 19785bf1e00bSNikolay Aleksandrov unsigned long now = jiffies; 19795bf1e00bSNikolay Aleksandrov bool changed = false; 19805bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 19815bf1e00bSNikolay Aleksandrov 19825bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 19835bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) 19845bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 19855bf1e00bSNikolay Aleksandrov 19865bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 1987085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 19885bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 1989e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 19905bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 19915bf1e00bSNikolay Aleksandrov if (ent) { 19925bf1e00bSNikolay Aleksandrov if (timer_pending(&ent->timer)) { 19935bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 19945bf1e00bSNikolay Aleksandrov to_send--; 19955bf1e00bSNikolay Aleksandrov } 19965bf1e00bSNikolay Aleksandrov } else { 19975bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 19985bf1e00bSNikolay Aleksandrov if (ent) 19995bf1e00bSNikolay Aleksandrov changed = true; 20005bf1e00bSNikolay Aleksandrov } 20015bf1e00bSNikolay Aleksandrov if (ent) 2002b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, now + br_multicast_gmi(br)); 20035bf1e00bSNikolay Aleksandrov } 20045bf1e00bSNikolay Aleksandrov 20055bf1e00bSNikolay Aleksandrov if (to_send) 20065bf1e00bSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 20075bf1e00bSNikolay Aleksandrov 20085bf1e00bSNikolay Aleksandrov __grp_send_query_and_rexmit(pg); 20095bf1e00bSNikolay Aleksandrov 20105bf1e00bSNikolay Aleksandrov return changed; 20115bf1e00bSNikolay Aleksandrov } 20125bf1e00bSNikolay Aleksandrov 201354bea721SNikolay Aleksandrov static bool br_multicast_toin(struct net_bridge_port_group *pg, void *h_addr, 20149e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 20155bf1e00bSNikolay Aleksandrov { 20165bf1e00bSNikolay Aleksandrov bool changed = false; 20175bf1e00bSNikolay Aleksandrov 20185bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 20195bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 202054bea721SNikolay Aleksandrov changed = __grp_src_toin_incl(pg, h_addr, srcs, nsrcs, addr_size); 20215bf1e00bSNikolay Aleksandrov break; 20225bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 202354bea721SNikolay Aleksandrov changed = __grp_src_toin_excl(pg, h_addr, srcs, nsrcs, addr_size); 20245bf1e00bSNikolay Aleksandrov break; 20255bf1e00bSNikolay Aleksandrov } 20265bf1e00bSNikolay Aleksandrov 20275bf1e00bSNikolay Aleksandrov return changed; 20285bf1e00bSNikolay Aleksandrov } 20295bf1e00bSNikolay Aleksandrov 20305bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 20315bf1e00bSNikolay Aleksandrov * INCLUDE (A) TO_EX (B) EXCLUDE (A*B,B-A) (B-A)=0 20325bf1e00bSNikolay Aleksandrov * Delete (A-B) 20335bf1e00bSNikolay Aleksandrov * Send Q(G,A*B) 20345bf1e00bSNikolay Aleksandrov * Group Timer=GMI 20355bf1e00bSNikolay Aleksandrov */ 203654bea721SNikolay Aleksandrov static void __grp_src_toex_incl(struct net_bridge_port_group *pg, void *h_addr, 20379e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 20385bf1e00bSNikolay Aleksandrov { 20395bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 20405bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 20415bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 20425bf1e00bSNikolay Aleksandrov 20435bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 20445bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 20455bf1e00bSNikolay Aleksandrov 20465bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2047085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 20485bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2049e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 20505bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 20515bf1e00bSNikolay Aleksandrov if (ent) { 20525bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_DELETE) | 20535bf1e00bSNikolay Aleksandrov BR_SGRP_F_SEND; 20545bf1e00bSNikolay Aleksandrov to_send++; 20555bf1e00bSNikolay Aleksandrov } else { 2056b0812368SNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 20575bf1e00bSNikolay Aleksandrov } 2058b0812368SNikolay Aleksandrov if (ent) 2059b0812368SNikolay Aleksandrov br_multicast_fwd_src_handle(ent); 20605bf1e00bSNikolay Aleksandrov } 20615bf1e00bSNikolay Aleksandrov 20625bf1e00bSNikolay Aleksandrov __grp_src_delete_marked(pg); 20635bf1e00bSNikolay Aleksandrov if (to_send) 20645bf1e00bSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 20655bf1e00bSNikolay Aleksandrov } 20665bf1e00bSNikolay Aleksandrov 20675bf1e00bSNikolay Aleksandrov /* State Msg type New state Actions 20685bf1e00bSNikolay Aleksandrov * EXCLUDE (X,Y) TO_EX (A) EXCLUDE (A-Y,Y*A) (A-X-Y)=Group Timer 20695bf1e00bSNikolay Aleksandrov * Delete (X-A) 20705bf1e00bSNikolay Aleksandrov * Delete (Y-A) 20715bf1e00bSNikolay Aleksandrov * Send Q(G,A-Y) 20725bf1e00bSNikolay Aleksandrov * Group Timer=GMI 20735bf1e00bSNikolay Aleksandrov */ 207454bea721SNikolay Aleksandrov static bool __grp_src_toex_excl(struct net_bridge_port_group *pg, void *h_addr, 20759e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 20765bf1e00bSNikolay Aleksandrov { 20775bf1e00bSNikolay Aleksandrov struct net_bridge_group_src *ent; 20785bf1e00bSNikolay Aleksandrov u32 src_idx, to_send = 0; 20795bf1e00bSNikolay Aleksandrov bool changed = false; 20805bf1e00bSNikolay Aleksandrov struct br_ip src_ip; 20815bf1e00bSNikolay Aleksandrov 20825bf1e00bSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 20835bf1e00bSNikolay Aleksandrov ent->flags = (ent->flags & ~BR_SGRP_F_SEND) | BR_SGRP_F_DELETE; 20845bf1e00bSNikolay Aleksandrov 20855bf1e00bSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2086085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 20875bf1e00bSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2088e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 20895bf1e00bSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 20905bf1e00bSNikolay Aleksandrov if (ent) { 20915bf1e00bSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_DELETE; 20925bf1e00bSNikolay Aleksandrov } else { 20935bf1e00bSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 20945bf1e00bSNikolay Aleksandrov if (ent) { 2095b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 20965bf1e00bSNikolay Aleksandrov changed = true; 20975bf1e00bSNikolay Aleksandrov } 20985bf1e00bSNikolay Aleksandrov } 20995bf1e00bSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 21005bf1e00bSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 21015bf1e00bSNikolay Aleksandrov to_send++; 21025bf1e00bSNikolay Aleksandrov } 21035bf1e00bSNikolay Aleksandrov } 21045bf1e00bSNikolay Aleksandrov 21055bf1e00bSNikolay Aleksandrov if (__grp_src_delete_marked(pg)) 21065bf1e00bSNikolay Aleksandrov changed = true; 21075bf1e00bSNikolay Aleksandrov if (to_send) 21085bf1e00bSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 21095bf1e00bSNikolay Aleksandrov 21105bf1e00bSNikolay Aleksandrov return changed; 21115bf1e00bSNikolay Aleksandrov } 21125bf1e00bSNikolay Aleksandrov 211354bea721SNikolay Aleksandrov static bool br_multicast_toex(struct net_bridge_port_group *pg, void *h_addr, 21149e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 21155bf1e00bSNikolay Aleksandrov { 2116085b53c8SNikolay Aleksandrov struct net_bridge *br = pg->key.port->br; 21175bf1e00bSNikolay Aleksandrov bool changed = false; 21185bf1e00bSNikolay Aleksandrov 21195bf1e00bSNikolay Aleksandrov switch (pg->filter_mode) { 21205bf1e00bSNikolay Aleksandrov case MCAST_INCLUDE: 212154bea721SNikolay Aleksandrov __grp_src_toex_incl(pg, h_addr, srcs, nsrcs, addr_size); 21228266a049SNikolay Aleksandrov br_multicast_star_g_handle_mode(pg, MCAST_EXCLUDE); 21235bf1e00bSNikolay Aleksandrov changed = true; 21245bf1e00bSNikolay Aleksandrov break; 21255bf1e00bSNikolay Aleksandrov case MCAST_EXCLUDE: 212654bea721SNikolay Aleksandrov changed = __grp_src_toex_excl(pg, h_addr, srcs, nsrcs, addr_size); 21275bf1e00bSNikolay Aleksandrov break; 21285bf1e00bSNikolay Aleksandrov } 21295bf1e00bSNikolay Aleksandrov 21305bf1e00bSNikolay Aleksandrov pg->filter_mode = MCAST_EXCLUDE; 21315bf1e00bSNikolay Aleksandrov mod_timer(&pg->timer, jiffies + br_multicast_gmi(br)); 21325bf1e00bSNikolay Aleksandrov 21335bf1e00bSNikolay Aleksandrov return changed; 21345bf1e00bSNikolay Aleksandrov } 21355bf1e00bSNikolay Aleksandrov 2136109865feSNikolay Aleksandrov /* State Msg type New state Actions 2137109865feSNikolay Aleksandrov * INCLUDE (A) BLOCK (B) INCLUDE (A) Send Q(G,A*B) 2138109865feSNikolay Aleksandrov */ 21390ad57c99SNikolay Aleksandrov static bool __grp_src_block_incl(struct net_bridge_port_group *pg, void *h_addr, 21409e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 2141109865feSNikolay Aleksandrov { 2142109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2143109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 21440ad57c99SNikolay Aleksandrov bool changed = false; 2145109865feSNikolay Aleksandrov struct br_ip src_ip; 2146109865feSNikolay Aleksandrov 2147109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2148109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2149109865feSNikolay Aleksandrov 2150109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2151085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2152109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2153e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2154109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2155109865feSNikolay Aleksandrov if (ent) { 2156109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2157109865feSNikolay Aleksandrov to_send++; 2158109865feSNikolay Aleksandrov } 2159109865feSNikolay Aleksandrov } 2160109865feSNikolay Aleksandrov 2161109865feSNikolay Aleksandrov if (to_send) 2162109865feSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 2163109865feSNikolay Aleksandrov 21640ad57c99SNikolay Aleksandrov if (pg->filter_mode == MCAST_INCLUDE && hlist_empty(&pg->src_list)) { 2165085b53c8SNikolay Aleksandrov br_multicast_find_del_pg(pg->key.port->br, pg); 21660ad57c99SNikolay Aleksandrov /* a notification has already been sent and we shouldn't access 21670ad57c99SNikolay Aleksandrov * pg after the delete thus we have to return false 21680ad57c99SNikolay Aleksandrov */ 21690ad57c99SNikolay Aleksandrov changed = false; 21700ad57c99SNikolay Aleksandrov } 21710ad57c99SNikolay Aleksandrov 21720ad57c99SNikolay Aleksandrov return changed; 2173109865feSNikolay Aleksandrov } 2174109865feSNikolay Aleksandrov 2175109865feSNikolay Aleksandrov /* State Msg type New state Actions 2176109865feSNikolay Aleksandrov * EXCLUDE (X,Y) BLOCK (A) EXCLUDE (X+(A-Y),Y) (A-X-Y)=Group Timer 2177109865feSNikolay Aleksandrov * Send Q(G,A-Y) 2178109865feSNikolay Aleksandrov */ 217954bea721SNikolay Aleksandrov static bool __grp_src_block_excl(struct net_bridge_port_group *pg, void *h_addr, 21809e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 2181109865feSNikolay Aleksandrov { 2182109865feSNikolay Aleksandrov struct net_bridge_group_src *ent; 2183109865feSNikolay Aleksandrov u32 src_idx, to_send = 0; 2184109865feSNikolay Aleksandrov bool changed = false; 2185109865feSNikolay Aleksandrov struct br_ip src_ip; 2186109865feSNikolay Aleksandrov 2187109865feSNikolay Aleksandrov hlist_for_each_entry(ent, &pg->src_list, node) 2188109865feSNikolay Aleksandrov ent->flags &= ~BR_SGRP_F_SEND; 2189109865feSNikolay Aleksandrov 2190109865feSNikolay Aleksandrov memset(&src_ip, 0, sizeof(src_ip)); 2191085b53c8SNikolay Aleksandrov src_ip.proto = pg->key.addr.proto; 2192109865feSNikolay Aleksandrov for (src_idx = 0; src_idx < nsrcs; src_idx++) { 2193e7cfcf2cSNikolay Aleksandrov memcpy(&src_ip.src, srcs + (src_idx * addr_size), addr_size); 2194109865feSNikolay Aleksandrov ent = br_multicast_find_group_src(pg, &src_ip); 2195109865feSNikolay Aleksandrov if (!ent) { 2196109865feSNikolay Aleksandrov ent = br_multicast_new_group_src(pg, &src_ip); 2197109865feSNikolay Aleksandrov if (ent) { 2198b0812368SNikolay Aleksandrov __grp_src_mod_timer(ent, pg->timer.expires); 2199109865feSNikolay Aleksandrov changed = true; 2200109865feSNikolay Aleksandrov } 2201109865feSNikolay Aleksandrov } 2202109865feSNikolay Aleksandrov if (ent && timer_pending(&ent->timer)) { 2203109865feSNikolay Aleksandrov ent->flags |= BR_SGRP_F_SEND; 2204109865feSNikolay Aleksandrov to_send++; 2205109865feSNikolay Aleksandrov } 2206109865feSNikolay Aleksandrov } 2207109865feSNikolay Aleksandrov 2208109865feSNikolay Aleksandrov if (to_send) 2209109865feSNikolay Aleksandrov __grp_src_query_marked_and_rexmit(pg); 2210109865feSNikolay Aleksandrov 2211109865feSNikolay Aleksandrov return changed; 2212109865feSNikolay Aleksandrov } 2213109865feSNikolay Aleksandrov 221454bea721SNikolay Aleksandrov static bool br_multicast_block(struct net_bridge_port_group *pg, void *h_addr, 22159e10b9e6SNikolay Aleksandrov void *srcs, u32 nsrcs, size_t addr_size) 2216109865feSNikolay Aleksandrov { 2217109865feSNikolay Aleksandrov bool changed = false; 2218109865feSNikolay Aleksandrov 2219109865feSNikolay Aleksandrov switch (pg->filter_mode) { 2220109865feSNikolay Aleksandrov case MCAST_INCLUDE: 22210ad57c99SNikolay Aleksandrov changed = __grp_src_block_incl(pg, h_addr, srcs, nsrcs, addr_size); 2222109865feSNikolay Aleksandrov break; 2223109865feSNikolay Aleksandrov case MCAST_EXCLUDE: 222454bea721SNikolay Aleksandrov changed = __grp_src_block_excl(pg, h_addr, srcs, nsrcs, addr_size); 2225109865feSNikolay Aleksandrov break; 2226109865feSNikolay Aleksandrov } 2227109865feSNikolay Aleksandrov 2228109865feSNikolay Aleksandrov return changed; 2229109865feSNikolay Aleksandrov } 2230109865feSNikolay Aleksandrov 22310436862eSNikolay Aleksandrov static struct net_bridge_port_group * 22320436862eSNikolay Aleksandrov br_multicast_find_port(struct net_bridge_mdb_entry *mp, 22330436862eSNikolay Aleksandrov struct net_bridge_port *p, 22340436862eSNikolay Aleksandrov const unsigned char *src) 22350436862eSNikolay Aleksandrov { 2236071445c6SNikolay Aleksandrov struct net_bridge *br __maybe_unused = mp->br; 22370436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 22380436862eSNikolay Aleksandrov 22390436862eSNikolay Aleksandrov for (pg = mlock_dereference(mp->ports, br); 22400436862eSNikolay Aleksandrov pg; 22410436862eSNikolay Aleksandrov pg = mlock_dereference(pg->next, br)) 22420436862eSNikolay Aleksandrov if (br_port_group_equal(pg, p, src)) 22430436862eSNikolay Aleksandrov return pg; 22440436862eSNikolay Aleksandrov 22450436862eSNikolay Aleksandrov return NULL; 22460436862eSNikolay Aleksandrov } 22470436862eSNikolay Aleksandrov 22488ef2a9a5SYOSHIFUJI Hideaki static int br_ip4_multicast_igmp3_report(struct net_bridge *br, 2249eb1d1641SHerbert Xu struct net_bridge_port *port, 225006499098SVlad Yasevich struct sk_buff *skb, 225106499098SVlad Yasevich u16 vid) 2252eb1d1641SHerbert Xu { 22530436862eSNikolay Aleksandrov bool igmpv2 = br->multicast_igmp_version == 2; 22540436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 22550436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 22566db6f0eaSFelix Fietkau const unsigned char *src; 2257eb1d1641SHerbert Xu struct igmpv3_report *ih; 2258eb1d1641SHerbert Xu struct igmpv3_grec *grec; 22590436862eSNikolay Aleksandrov int i, len, num, type; 226054bea721SNikolay Aleksandrov __be32 group, *h_addr; 22610436862eSNikolay Aleksandrov bool changed = false; 22620436862eSNikolay Aleksandrov int err = 0; 2263e57f6185SNikolay Aleksandrov u16 nsrcs; 2264eb1d1641SHerbert Xu 2265eb1d1641SHerbert Xu ih = igmpv3_report_hdr(skb); 2266eb1d1641SHerbert Xu num = ntohs(ih->ngrec); 2267c2d4fbd2SLinus Lüssing len = skb_transport_offset(skb) + sizeof(*ih); 2268eb1d1641SHerbert Xu 2269eb1d1641SHerbert Xu for (i = 0; i < num; i++) { 2270eb1d1641SHerbert Xu len += sizeof(*grec); 2271ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2272eb1d1641SHerbert Xu return -EINVAL; 2273eb1d1641SHerbert Xu 2274fd218cf9SHerbert Xu grec = (void *)(skb->data + len - sizeof(*grec)); 2275eb1d1641SHerbert Xu group = grec->grec_mca; 2276eb1d1641SHerbert Xu type = grec->grec_type; 2277e57f6185SNikolay Aleksandrov nsrcs = ntohs(grec->grec_nsrcs); 2278eb1d1641SHerbert Xu 2279e57f6185SNikolay Aleksandrov len += nsrcs * 4; 2280ba5ea614SLinus Lüssing if (!ip_mc_may_pull(skb, len)) 2281eb1d1641SHerbert Xu return -EINVAL; 2282eb1d1641SHerbert Xu 2283eb1d1641SHerbert Xu switch (type) { 2284eb1d1641SHerbert Xu case IGMPV3_MODE_IS_INCLUDE: 2285eb1d1641SHerbert Xu case IGMPV3_MODE_IS_EXCLUDE: 2286eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_INCLUDE: 2287eb1d1641SHerbert Xu case IGMPV3_CHANGE_TO_EXCLUDE: 2288eb1d1641SHerbert Xu case IGMPV3_ALLOW_NEW_SOURCES: 2289eb1d1641SHerbert Xu case IGMPV3_BLOCK_OLD_SOURCES: 2290eb1d1641SHerbert Xu break; 2291eb1d1641SHerbert Xu 2292eb1d1641SHerbert Xu default: 2293eb1d1641SHerbert Xu continue; 2294eb1d1641SHerbert Xu } 2295eb1d1641SHerbert Xu 22966db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 22970436862eSNikolay Aleksandrov if (nsrcs == 0 && 22980436862eSNikolay Aleksandrov (type == IGMPV3_CHANGE_TO_INCLUDE || 22990436862eSNikolay Aleksandrov type == IGMPV3_MODE_IS_INCLUDE)) { 23000436862eSNikolay Aleksandrov if (!port || igmpv2) { 23016db6f0eaSFelix Fietkau br_ip4_multicast_leave_group(br, port, group, vid, src); 23020436862eSNikolay Aleksandrov continue; 23030436862eSNikolay Aleksandrov } 2304bc8c20acSSatish Ashok } else { 23056db6f0eaSFelix Fietkau err = br_ip4_multicast_add_group(br, port, group, vid, 23060436862eSNikolay Aleksandrov src, igmpv2); 2307eb1d1641SHerbert Xu if (err) 2308eb1d1641SHerbert Xu break; 2309eb1d1641SHerbert Xu } 23100436862eSNikolay Aleksandrov 23110436862eSNikolay Aleksandrov if (!port || igmpv2) 23120436862eSNikolay Aleksandrov continue; 23130436862eSNikolay Aleksandrov 23140436862eSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 23150436862eSNikolay Aleksandrov mdst = br_mdb_ip4_get(br, group, vid); 23160436862eSNikolay Aleksandrov if (!mdst) 23170436862eSNikolay Aleksandrov goto unlock_continue; 23180436862eSNikolay Aleksandrov pg = br_multicast_find_port(mdst, port, src); 23190436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 23200436862eSNikolay Aleksandrov goto unlock_continue; 232154bea721SNikolay Aleksandrov /* reload grec and host addr */ 23220436862eSNikolay Aleksandrov grec = (void *)(skb->data + len - sizeof(*grec) - (nsrcs * 4)); 232354bea721SNikolay Aleksandrov h_addr = &ip_hdr(skb)->saddr; 23240436862eSNikolay Aleksandrov switch (type) { 23250436862eSNikolay Aleksandrov case IGMPV3_ALLOW_NEW_SOURCES: 232654bea721SNikolay Aleksandrov changed = br_multicast_isinc_allow(pg, h_addr, grec->grec_src, 23270436862eSNikolay Aleksandrov nsrcs, sizeof(__be32)); 23280436862eSNikolay Aleksandrov break; 2329e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_INCLUDE: 233054bea721SNikolay Aleksandrov changed = br_multicast_isinc_allow(pg, h_addr, grec->grec_src, 233154bea721SNikolay Aleksandrov nsrcs, sizeof(__be32)); 2332e6231bcaSNikolay Aleksandrov break; 2333e6231bcaSNikolay Aleksandrov case IGMPV3_MODE_IS_EXCLUDE: 233454bea721SNikolay Aleksandrov changed = br_multicast_isexc(pg, h_addr, grec->grec_src, 233554bea721SNikolay Aleksandrov nsrcs, sizeof(__be32)); 2336e6231bcaSNikolay Aleksandrov break; 23375bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_INCLUDE: 233854bea721SNikolay Aleksandrov changed = br_multicast_toin(pg, h_addr, grec->grec_src, 233954bea721SNikolay Aleksandrov nsrcs, sizeof(__be32)); 23405bf1e00bSNikolay Aleksandrov break; 23415bf1e00bSNikolay Aleksandrov case IGMPV3_CHANGE_TO_EXCLUDE: 234254bea721SNikolay Aleksandrov changed = br_multicast_toex(pg, h_addr, grec->grec_src, 234354bea721SNikolay Aleksandrov nsrcs, sizeof(__be32)); 23445bf1e00bSNikolay Aleksandrov break; 2345109865feSNikolay Aleksandrov case IGMPV3_BLOCK_OLD_SOURCES: 234654bea721SNikolay Aleksandrov changed = br_multicast_block(pg, h_addr, grec->grec_src, 234754bea721SNikolay Aleksandrov nsrcs, sizeof(__be32)); 2348109865feSNikolay Aleksandrov break; 23490436862eSNikolay Aleksandrov } 23500436862eSNikolay Aleksandrov if (changed) 23510436862eSNikolay Aleksandrov br_mdb_notify(br->dev, mdst, pg, RTM_NEWMDB); 23520436862eSNikolay Aleksandrov unlock_continue: 23530436862eSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 2354bc8c20acSSatish Ashok } 2355eb1d1641SHerbert Xu 2356eb1d1641SHerbert Xu return err; 2357eb1d1641SHerbert Xu } 2358eb1d1641SHerbert Xu 2359dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 236008b202b6SYOSHIFUJI Hideaki static int br_ip6_multicast_mld2_report(struct net_bridge *br, 236108b202b6SYOSHIFUJI Hideaki struct net_bridge_port *port, 236206499098SVlad Yasevich struct sk_buff *skb, 236306499098SVlad Yasevich u16 vid) 236408b202b6SYOSHIFUJI Hideaki { 23650436862eSNikolay Aleksandrov bool mldv1 = br->multicast_mld_version == 1; 23660436862eSNikolay Aleksandrov struct net_bridge_mdb_entry *mdst; 23670436862eSNikolay Aleksandrov struct net_bridge_port_group *pg; 2368ba5ea614SLinus Lüssing unsigned int nsrcs_offset; 23696db6f0eaSFelix Fietkau const unsigned char *src; 237008b202b6SYOSHIFUJI Hideaki struct icmp6hdr *icmp6h; 237154bea721SNikolay Aleksandrov struct in6_addr *h_addr; 237208b202b6SYOSHIFUJI Hideaki struct mld2_grec *grec; 2373ba5ea614SLinus Lüssing unsigned int grec_len; 23740436862eSNikolay Aleksandrov bool changed = false; 23750436862eSNikolay Aleksandrov int i, len, num; 237608b202b6SYOSHIFUJI Hideaki int err = 0; 237708b202b6SYOSHIFUJI Hideaki 2378ba5ea614SLinus Lüssing if (!ipv6_mc_may_pull(skb, sizeof(*icmp6h))) 237908b202b6SYOSHIFUJI Hideaki return -EINVAL; 238008b202b6SYOSHIFUJI Hideaki 238108b202b6SYOSHIFUJI Hideaki icmp6h = icmp6_hdr(skb); 238208b202b6SYOSHIFUJI Hideaki num = ntohs(icmp6h->icmp6_dataun.un_data16[1]); 2383c2d4fbd2SLinus Lüssing len = skb_transport_offset(skb) + sizeof(*icmp6h); 238408b202b6SYOSHIFUJI Hideaki 238508b202b6SYOSHIFUJI Hideaki for (i = 0; i < num; i++) { 2386e57f6185SNikolay Aleksandrov __be16 *_nsrcs, __nsrcs; 2387e57f6185SNikolay Aleksandrov u16 nsrcs; 238808b202b6SYOSHIFUJI Hideaki 2389ba5ea614SLinus Lüssing nsrcs_offset = len + offsetof(struct mld2_grec, grec_nsrcs); 2390ba5ea614SLinus Lüssing 2391ba5ea614SLinus Lüssing if (skb_transport_offset(skb) + ipv6_transport_len(skb) < 23925fc6266aSLinus Lüssing nsrcs_offset + sizeof(__nsrcs)) 2393ba5ea614SLinus Lüssing return -EINVAL; 2394ba5ea614SLinus Lüssing 2395e57f6185SNikolay Aleksandrov _nsrcs = skb_header_pointer(skb, nsrcs_offset, 2396e57f6185SNikolay Aleksandrov sizeof(__nsrcs), &__nsrcs); 2397e57f6185SNikolay Aleksandrov if (!_nsrcs) 239808b202b6SYOSHIFUJI Hideaki return -EINVAL; 239908b202b6SYOSHIFUJI Hideaki 2400e57f6185SNikolay Aleksandrov nsrcs = ntohs(*_nsrcs); 2401e57f6185SNikolay Aleksandrov grec_len = struct_size(grec, grec_src, nsrcs); 2402ba5ea614SLinus Lüssing 2403ba5ea614SLinus Lüssing if (!ipv6_mc_may_pull(skb, len + grec_len)) 240408b202b6SYOSHIFUJI Hideaki return -EINVAL; 240508b202b6SYOSHIFUJI Hideaki 240608b202b6SYOSHIFUJI Hideaki grec = (struct mld2_grec *)(skb->data + len); 2407ba5ea614SLinus Lüssing len += grec_len; 240808b202b6SYOSHIFUJI Hideaki 240908b202b6SYOSHIFUJI Hideaki switch (grec->grec_type) { 241008b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_INCLUDE: 241108b202b6SYOSHIFUJI Hideaki case MLD2_MODE_IS_EXCLUDE: 241208b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_INCLUDE: 241308b202b6SYOSHIFUJI Hideaki case MLD2_CHANGE_TO_EXCLUDE: 241408b202b6SYOSHIFUJI Hideaki case MLD2_ALLOW_NEW_SOURCES: 241508b202b6SYOSHIFUJI Hideaki case MLD2_BLOCK_OLD_SOURCES: 241608b202b6SYOSHIFUJI Hideaki break; 241708b202b6SYOSHIFUJI Hideaki 241808b202b6SYOSHIFUJI Hideaki default: 241908b202b6SYOSHIFUJI Hideaki continue; 242008b202b6SYOSHIFUJI Hideaki } 242108b202b6SYOSHIFUJI Hideaki 24226db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 2423bc8c20acSSatish Ashok if ((grec->grec_type == MLD2_CHANGE_TO_INCLUDE || 2424bc8c20acSSatish Ashok grec->grec_type == MLD2_MODE_IS_INCLUDE) && 2425e57f6185SNikolay Aleksandrov nsrcs == 0) { 24260436862eSNikolay Aleksandrov if (!port || mldv1) { 24270436862eSNikolay Aleksandrov br_ip6_multicast_leave_group(br, port, 24280436862eSNikolay Aleksandrov &grec->grec_mca, 24296db6f0eaSFelix Fietkau vid, src); 24300436862eSNikolay Aleksandrov continue; 24310436862eSNikolay Aleksandrov } 2432bc8c20acSSatish Ashok } else { 2433bc8c20acSSatish Ashok err = br_ip6_multicast_add_group(br, port, 24346db6f0eaSFelix Fietkau &grec->grec_mca, vid, 24350436862eSNikolay Aleksandrov src, mldv1); 24369264251eSDavide Caratti if (err) 243708b202b6SYOSHIFUJI Hideaki break; 243808b202b6SYOSHIFUJI Hideaki } 24390436862eSNikolay Aleksandrov 24400436862eSNikolay Aleksandrov if (!port || mldv1) 24410436862eSNikolay Aleksandrov continue; 24420436862eSNikolay Aleksandrov 24430436862eSNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 24440436862eSNikolay Aleksandrov mdst = br_mdb_ip6_get(br, &grec->grec_mca, vid); 24450436862eSNikolay Aleksandrov if (!mdst) 24460436862eSNikolay Aleksandrov goto unlock_continue; 24470436862eSNikolay Aleksandrov pg = br_multicast_find_port(mdst, port, src); 24480436862eSNikolay Aleksandrov if (!pg || (pg->flags & MDB_PG_FLAGS_PERMANENT)) 24490436862eSNikolay Aleksandrov goto unlock_continue; 245054bea721SNikolay Aleksandrov h_addr = &ipv6_hdr(skb)->saddr; 24510436862eSNikolay Aleksandrov switch (grec->grec_type) { 24520436862eSNikolay Aleksandrov case MLD2_ALLOW_NEW_SOURCES: 245354bea721SNikolay Aleksandrov changed = br_multicast_isinc_allow(pg, h_addr, 245454bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 24550436862eSNikolay Aleksandrov sizeof(struct in6_addr)); 24560436862eSNikolay Aleksandrov break; 2457e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_INCLUDE: 245854bea721SNikolay Aleksandrov changed = br_multicast_isinc_allow(pg, h_addr, 245954bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2460e6231bcaSNikolay Aleksandrov sizeof(struct in6_addr)); 2461e6231bcaSNikolay Aleksandrov break; 2462e6231bcaSNikolay Aleksandrov case MLD2_MODE_IS_EXCLUDE: 246354bea721SNikolay Aleksandrov changed = br_multicast_isexc(pg, h_addr, 246454bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2465e6231bcaSNikolay Aleksandrov sizeof(struct in6_addr)); 2466e6231bcaSNikolay Aleksandrov break; 24675bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_INCLUDE: 246854bea721SNikolay Aleksandrov changed = br_multicast_toin(pg, h_addr, 246954bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 24705bf1e00bSNikolay Aleksandrov sizeof(struct in6_addr)); 24715bf1e00bSNikolay Aleksandrov break; 24725bf1e00bSNikolay Aleksandrov case MLD2_CHANGE_TO_EXCLUDE: 247354bea721SNikolay Aleksandrov changed = br_multicast_toex(pg, h_addr, 247454bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 24755bf1e00bSNikolay Aleksandrov sizeof(struct in6_addr)); 24765bf1e00bSNikolay Aleksandrov break; 2477109865feSNikolay Aleksandrov case MLD2_BLOCK_OLD_SOURCES: 247854bea721SNikolay Aleksandrov changed = br_multicast_block(pg, h_addr, 247954bea721SNikolay Aleksandrov grec->grec_src, nsrcs, 2480109865feSNikolay Aleksandrov sizeof(struct in6_addr)); 2481109865feSNikolay Aleksandrov break; 24820436862eSNikolay Aleksandrov } 24830436862eSNikolay Aleksandrov if (changed) 24840436862eSNikolay Aleksandrov br_mdb_notify(br->dev, mdst, pg, RTM_NEWMDB); 24850436862eSNikolay Aleksandrov unlock_continue: 24860436862eSNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 2487bc8c20acSSatish Ashok } 248808b202b6SYOSHIFUJI Hideaki 248908b202b6SYOSHIFUJI Hideaki return err; 249008b202b6SYOSHIFUJI Hideaki } 249108b202b6SYOSHIFUJI Hideaki #endif 249208b202b6SYOSHIFUJI Hideaki 2493dc4eb53aSLinus Lüssing static bool br_ip4_multicast_select_querier(struct net_bridge *br, 24942cd41431SLinus Lüssing struct net_bridge_port *port, 2495dc4eb53aSLinus Lüssing __be32 saddr) 2496dc4eb53aSLinus Lüssing { 2497dc4eb53aSLinus Lüssing if (!timer_pending(&br->ip4_own_query.timer) && 2498dc4eb53aSLinus Lüssing !timer_pending(&br->ip4_other_query.timer)) 2499dc4eb53aSLinus Lüssing goto update; 2500dc4eb53aSLinus Lüssing 2501deb96566SNikolay Aleksandrov if (!br->ip4_querier.addr.src.ip4) 2502dc4eb53aSLinus Lüssing goto update; 2503dc4eb53aSLinus Lüssing 2504deb96566SNikolay Aleksandrov if (ntohl(saddr) <= ntohl(br->ip4_querier.addr.src.ip4)) 2505dc4eb53aSLinus Lüssing goto update; 2506dc4eb53aSLinus Lüssing 2507dc4eb53aSLinus Lüssing return false; 2508dc4eb53aSLinus Lüssing 2509dc4eb53aSLinus Lüssing update: 2510deb96566SNikolay Aleksandrov br->ip4_querier.addr.src.ip4 = saddr; 2511dc4eb53aSLinus Lüssing 25122cd41431SLinus Lüssing /* update protected by general multicast_lock by caller */ 25132cd41431SLinus Lüssing rcu_assign_pointer(br->ip4_querier.port, port); 25142cd41431SLinus Lüssing 2515dc4eb53aSLinus Lüssing return true; 2516dc4eb53aSLinus Lüssing } 2517dc4eb53aSLinus Lüssing 2518dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 2519dc4eb53aSLinus Lüssing static bool br_ip6_multicast_select_querier(struct net_bridge *br, 25202cd41431SLinus Lüssing struct net_bridge_port *port, 2521dc4eb53aSLinus Lüssing struct in6_addr *saddr) 2522dc4eb53aSLinus Lüssing { 2523dc4eb53aSLinus Lüssing if (!timer_pending(&br->ip6_own_query.timer) && 2524dc4eb53aSLinus Lüssing !timer_pending(&br->ip6_other_query.timer)) 2525dc4eb53aSLinus Lüssing goto update; 2526dc4eb53aSLinus Lüssing 2527deb96566SNikolay Aleksandrov if (ipv6_addr_cmp(saddr, &br->ip6_querier.addr.src.ip6) <= 0) 2528dc4eb53aSLinus Lüssing goto update; 2529dc4eb53aSLinus Lüssing 2530dc4eb53aSLinus Lüssing return false; 2531dc4eb53aSLinus Lüssing 2532dc4eb53aSLinus Lüssing update: 2533deb96566SNikolay Aleksandrov br->ip6_querier.addr.src.ip6 = *saddr; 2534dc4eb53aSLinus Lüssing 25352cd41431SLinus Lüssing /* update protected by general multicast_lock by caller */ 25362cd41431SLinus Lüssing rcu_assign_pointer(br->ip6_querier.port, port); 25372cd41431SLinus Lüssing 2538dc4eb53aSLinus Lüssing return true; 2539dc4eb53aSLinus Lüssing } 2540dc4eb53aSLinus Lüssing #endif 2541dc4eb53aSLinus Lüssing 2542dc4eb53aSLinus Lüssing static bool br_multicast_select_querier(struct net_bridge *br, 25432cd41431SLinus Lüssing struct net_bridge_port *port, 2544dc4eb53aSLinus Lüssing struct br_ip *saddr) 2545dc4eb53aSLinus Lüssing { 2546dc4eb53aSLinus Lüssing switch (saddr->proto) { 2547dc4eb53aSLinus Lüssing case htons(ETH_P_IP): 2548deb96566SNikolay Aleksandrov return br_ip4_multicast_select_querier(br, port, saddr->src.ip4); 2549dc4eb53aSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 2550dc4eb53aSLinus Lüssing case htons(ETH_P_IPV6): 2551deb96566SNikolay Aleksandrov return br_ip6_multicast_select_querier(br, port, &saddr->src.ip6); 2552dc4eb53aSLinus Lüssing #endif 2553dc4eb53aSLinus Lüssing } 2554dc4eb53aSLinus Lüssing 2555dc4eb53aSLinus Lüssing return false; 2556dc4eb53aSLinus Lüssing } 2557dc4eb53aSLinus Lüssing 2558cc0fdd80SLinus Lüssing static void 255990010b36SLinus Lüssing br_multicast_update_query_timer(struct net_bridge *br, 256090010b36SLinus Lüssing struct bridge_mcast_other_query *query, 2561b00589afSLinus Lüssing unsigned long max_delay) 2562b00589afSLinus Lüssing { 256390010b36SLinus Lüssing if (!timer_pending(&query->timer)) 256490010b36SLinus Lüssing query->delay_time = jiffies + max_delay; 2565b00589afSLinus Lüssing 256690010b36SLinus Lüssing mod_timer(&query->timer, jiffies + br->multicast_querier_interval); 2567b00589afSLinus Lüssing } 2568b00589afSLinus Lüssing 25696d549648SNogah Frankel static void br_port_mc_router_state_change(struct net_bridge_port *p, 25706d549648SNogah Frankel bool is_mc_router) 25716d549648SNogah Frankel { 25726d549648SNogah Frankel struct switchdev_attr attr = { 25736d549648SNogah Frankel .orig_dev = p->dev, 25746d549648SNogah Frankel .id = SWITCHDEV_ATTR_ID_PORT_MROUTER, 25756d549648SNogah Frankel .flags = SWITCHDEV_F_DEFER, 25766d549648SNogah Frankel .u.mrouter = is_mc_router, 25776d549648SNogah Frankel }; 25786d549648SNogah Frankel 25796d549648SNogah Frankel switchdev_port_attr_set(p->dev, &attr); 25806d549648SNogah Frankel } 25816d549648SNogah Frankel 25827e80c124Sstephen hemminger /* 25837c77602fSCong Wang * Add port to router_list 25847e80c124Sstephen hemminger * list is maintained ordered by pointer value 25857e80c124Sstephen hemminger * and locked by br->multicast_lock and RCU 25867e80c124Sstephen hemminger */ 25870909e117SHerbert Xu static void br_multicast_add_router(struct net_bridge *br, 25880909e117SHerbert Xu struct net_bridge_port *port) 25890909e117SHerbert Xu { 2590dcdca2c4Sstephen hemminger struct net_bridge_port *p; 2591b67bfe0dSSasha Levin struct hlist_node *slot = NULL; 25920909e117SHerbert Xu 25931a040eacSNikolay Aleksandrov if (!hlist_unhashed(&port->rlist)) 25941a040eacSNikolay Aleksandrov return; 25951a040eacSNikolay Aleksandrov 2596b67bfe0dSSasha Levin hlist_for_each_entry(p, &br->router_list, rlist) { 25977e80c124Sstephen hemminger if ((unsigned long) port >= (unsigned long) p) 25987e80c124Sstephen hemminger break; 2599b67bfe0dSSasha Levin slot = &p->rlist; 2600dcdca2c4Sstephen hemminger } 26010909e117SHerbert Xu 26027e80c124Sstephen hemminger if (slot) 26031d023284SKen Helias hlist_add_behind_rcu(&port->rlist, slot); 2604dcdca2c4Sstephen hemminger else 2605dcdca2c4Sstephen hemminger hlist_add_head_rcu(&port->rlist, &br->router_list); 2606949f1e39SSatish Ashok br_rtr_notify(br->dev, port, RTM_NEWMDB); 26076d549648SNogah Frankel br_port_mc_router_state_change(port, true); 26080909e117SHerbert Xu } 26090909e117SHerbert Xu 2610eb1d1641SHerbert Xu static void br_multicast_mark_router(struct net_bridge *br, 2611eb1d1641SHerbert Xu struct net_bridge_port *port) 2612eb1d1641SHerbert Xu { 2613eb1d1641SHerbert Xu unsigned long now = jiffies; 2614eb1d1641SHerbert Xu 2615eb1d1641SHerbert Xu if (!port) { 261677041420SYotam Gigi if (br->multicast_router == MDB_RTR_TYPE_TEMP_QUERY) { 261777041420SYotam Gigi if (!timer_pending(&br->multicast_router_timer)) 261877041420SYotam Gigi br_mc_router_state_change(br, true); 2619eb1d1641SHerbert Xu mod_timer(&br->multicast_router_timer, 2620eb1d1641SHerbert Xu now + br->multicast_querier_interval); 262177041420SYotam Gigi } 2622eb1d1641SHerbert Xu return; 2623eb1d1641SHerbert Xu } 2624eb1d1641SHerbert Xu 2625a55d8246SNikolay Aleksandrov if (port->multicast_router == MDB_RTR_TYPE_DISABLED || 2626a55d8246SNikolay Aleksandrov port->multicast_router == MDB_RTR_TYPE_PERM) 2627eb1d1641SHerbert Xu return; 2628eb1d1641SHerbert Xu 26290909e117SHerbert Xu br_multicast_add_router(br, port); 2630eb1d1641SHerbert Xu 2631eb1d1641SHerbert Xu mod_timer(&port->multicast_router_timer, 2632eb1d1641SHerbert Xu now + br->multicast_querier_interval); 2633eb1d1641SHerbert Xu } 2634eb1d1641SHerbert Xu 2635eb1d1641SHerbert Xu static void br_multicast_query_received(struct net_bridge *br, 2636eb1d1641SHerbert Xu struct net_bridge_port *port, 263790010b36SLinus Lüssing struct bridge_mcast_other_query *query, 2638dc4eb53aSLinus Lüssing struct br_ip *saddr, 2639b00589afSLinus Lüssing unsigned long max_delay) 2640eb1d1641SHerbert Xu { 26412cd41431SLinus Lüssing if (!br_multicast_select_querier(br, port, saddr)) 2642eb1d1641SHerbert Xu return; 2643eb1d1641SHerbert Xu 2644dc4eb53aSLinus Lüssing br_multicast_update_query_timer(br, query, max_delay); 2645eb1d1641SHerbert Xu br_multicast_mark_router(br, port); 2646eb1d1641SHerbert Xu } 2647eb1d1641SHerbert Xu 26489c2e955cSzhong jiang static void br_ip4_multicast_query(struct net_bridge *br, 2649eb1d1641SHerbert Xu struct net_bridge_port *port, 265006499098SVlad Yasevich struct sk_buff *skb, 265106499098SVlad Yasevich u16 vid) 2652eb1d1641SHerbert Xu { 2653ba5ea614SLinus Lüssing unsigned int transport_len = ip_transport_len(skb); 2654b71d1d42SEric Dumazet const struct iphdr *iph = ip_hdr(skb); 2655eb1d1641SHerbert Xu struct igmphdr *ih = igmp_hdr(skb); 2656eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 2657eb1d1641SHerbert Xu struct igmpv3_query *ih3; 2658eb1d1641SHerbert Xu struct net_bridge_port_group *p; 2659e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 2660dc4eb53aSLinus Lüssing struct br_ip saddr; 2661eb1d1641SHerbert Xu unsigned long max_delay; 2662eb1d1641SHerbert Xu unsigned long now = jiffies; 2663eb1d1641SHerbert Xu __be32 group; 2664eb1d1641SHerbert Xu 2665eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 2666eb1d1641SHerbert Xu if (!netif_running(br->dev) || 2667eb1d1641SHerbert Xu (port && port->state == BR_STATE_DISABLED)) 2668eb1d1641SHerbert Xu goto out; 2669eb1d1641SHerbert Xu 2670eb1d1641SHerbert Xu group = ih->group; 2671eb1d1641SHerbert Xu 2672ba5ea614SLinus Lüssing if (transport_len == sizeof(*ih)) { 2673eb1d1641SHerbert Xu max_delay = ih->code * (HZ / IGMP_TIMER_SCALE); 2674eb1d1641SHerbert Xu 2675eb1d1641SHerbert Xu if (!max_delay) { 2676eb1d1641SHerbert Xu max_delay = 10 * HZ; 2677eb1d1641SHerbert Xu group = 0; 2678eb1d1641SHerbert Xu } 2679ba5ea614SLinus Lüssing } else if (transport_len >= sizeof(*ih3)) { 2680eb1d1641SHerbert Xu ih3 = igmpv3_query_hdr(skb); 268123550b83SNikolay Aleksandrov if (ih3->nsrcs || 268223550b83SNikolay Aleksandrov (br->multicast_igmp_version == 3 && group && ih3->suppress)) 2683bec68ff1SYOSHIFUJI Hideaki goto out; 2684eb1d1641SHerbert Xu 26850ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 max_delay = ih3->code ? 26860ba8c9ecSYOSHIFUJI Hideaki / 吉藤英明 IGMPV3_MRC(ih3->code) * (HZ / IGMP_TIMER_SCALE) : 1; 26879afd85c9SLinus Lüssing } else { 26889ed973ccSLinus Lüssing goto out; 26899ed973ccSLinus Lüssing } 26909ed973ccSLinus Lüssing 2691dc4eb53aSLinus Lüssing if (!group) { 2692dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IP); 2693deb96566SNikolay Aleksandrov saddr.src.ip4 = iph->saddr; 2694b00589afSLinus Lüssing 2695dc4eb53aSLinus Lüssing br_multicast_query_received(br, port, &br->ip4_other_query, 2696dc4eb53aSLinus Lüssing &saddr, max_delay); 2697eb1d1641SHerbert Xu goto out; 2698dc4eb53aSLinus Lüssing } 2699eb1d1641SHerbert Xu 270019e3a9c9SNikolay Aleksandrov mp = br_mdb_ip4_get(br, group, vid); 2701eb1d1641SHerbert Xu if (!mp) 2702eb1d1641SHerbert Xu goto out; 2703eb1d1641SHerbert Xu 2704eb1d1641SHerbert Xu max_delay *= br->multicast_last_member_count; 2705eb1d1641SHerbert Xu 2706ff0fd34eSAndrew Lunn if (mp->host_joined && 2707eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 2708eb1d1641SHerbert Xu time_after(mp->timer.expires, now + max_delay) : 2709eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) 2710eb1d1641SHerbert Xu mod_timer(&mp->timer, now + max_delay); 2711eb1d1641SHerbert Xu 2712e8051688SEric Dumazet for (pp = &mp->ports; 2713e8051688SEric Dumazet (p = mlock_dereference(*pp, br)) != NULL; 2714e8051688SEric Dumazet pp = &p->next) { 2715eb1d1641SHerbert Xu if (timer_pending(&p->timer) ? 2716eb1d1641SHerbert Xu time_after(p->timer.expires, now + max_delay) : 271723550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 271823550b83SNikolay Aleksandrov (br->multicast_igmp_version == 2 || 271923550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 272024f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 2721eb1d1641SHerbert Xu } 2722eb1d1641SHerbert Xu 2723eb1d1641SHerbert Xu out: 2724eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 2725eb1d1641SHerbert Xu } 2726eb1d1641SHerbert Xu 2727dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 272808b202b6SYOSHIFUJI Hideaki static int br_ip6_multicast_query(struct net_bridge *br, 272908b202b6SYOSHIFUJI Hideaki struct net_bridge_port *port, 273006499098SVlad Yasevich struct sk_buff *skb, 273106499098SVlad Yasevich u16 vid) 273208b202b6SYOSHIFUJI Hideaki { 2733ba5ea614SLinus Lüssing unsigned int transport_len = ipv6_transport_len(skb); 2734eca2a43bSstephen hemminger struct mld_msg *mld; 273508b202b6SYOSHIFUJI Hideaki struct net_bridge_mdb_entry *mp; 273608b202b6SYOSHIFUJI Hideaki struct mld2_query *mld2q; 2737e8051688SEric Dumazet struct net_bridge_port_group *p; 2738e8051688SEric Dumazet struct net_bridge_port_group __rcu **pp; 2739dc4eb53aSLinus Lüssing struct br_ip saddr; 274008b202b6SYOSHIFUJI Hideaki unsigned long max_delay; 274108b202b6SYOSHIFUJI Hideaki unsigned long now = jiffies; 2742856ce5d0SLinus Lüssing unsigned int offset = skb_transport_offset(skb); 2743b71d1d42SEric Dumazet const struct in6_addr *group = NULL; 27449ed973ccSLinus Lüssing bool is_general_query; 274508b202b6SYOSHIFUJI Hideaki int err = 0; 274608b202b6SYOSHIFUJI Hideaki 274708b202b6SYOSHIFUJI Hideaki spin_lock(&br->multicast_lock); 274808b202b6SYOSHIFUJI Hideaki if (!netif_running(br->dev) || 274908b202b6SYOSHIFUJI Hideaki (port && port->state == BR_STATE_DISABLED)) 275008b202b6SYOSHIFUJI Hideaki goto out; 275108b202b6SYOSHIFUJI Hideaki 2752ba5ea614SLinus Lüssing if (transport_len == sizeof(*mld)) { 2753856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld))) { 275408b202b6SYOSHIFUJI Hideaki err = -EINVAL; 275508b202b6SYOSHIFUJI Hideaki goto out; 275608b202b6SYOSHIFUJI Hideaki } 275708b202b6SYOSHIFUJI Hideaki mld = (struct mld_msg *) icmp6_hdr(skb); 27584715213dSLi RongQing max_delay = msecs_to_jiffies(ntohs(mld->mld_maxdelay)); 275908b202b6SYOSHIFUJI Hideaki if (max_delay) 276008b202b6SYOSHIFUJI Hideaki group = &mld->mld_mca; 2761248ba8ecSLinus Lüssing } else { 2762856ce5d0SLinus Lüssing if (!pskb_may_pull(skb, offset + sizeof(*mld2q))) { 276308b202b6SYOSHIFUJI Hideaki err = -EINVAL; 276408b202b6SYOSHIFUJI Hideaki goto out; 276508b202b6SYOSHIFUJI Hideaki } 276608b202b6SYOSHIFUJI Hideaki mld2q = (struct mld2_query *)icmp6_hdr(skb); 276708b202b6SYOSHIFUJI Hideaki if (!mld2q->mld2q_nsrcs) 276808b202b6SYOSHIFUJI Hideaki group = &mld2q->mld2q_mca; 276923550b83SNikolay Aleksandrov if (br->multicast_mld_version == 2 && 277023550b83SNikolay Aleksandrov !ipv6_addr_any(&mld2q->mld2q_mca) && 277123550b83SNikolay Aleksandrov mld2q->mld2q_suppress) 277223550b83SNikolay Aleksandrov goto out; 2773e3f5b170SDaniel Borkmann 2774e3f5b170SDaniel Borkmann max_delay = max(msecs_to_jiffies(mldv2_mrc(mld2q)), 1UL); 277508b202b6SYOSHIFUJI Hideaki } 277608b202b6SYOSHIFUJI Hideaki 27779ed973ccSLinus Lüssing is_general_query = group && ipv6_addr_any(group); 27789ed973ccSLinus Lüssing 2779dc4eb53aSLinus Lüssing if (is_general_query) { 2780dc4eb53aSLinus Lüssing saddr.proto = htons(ETH_P_IPV6); 2781deb96566SNikolay Aleksandrov saddr.src.ip6 = ipv6_hdr(skb)->saddr; 2782b00589afSLinus Lüssing 2783dc4eb53aSLinus Lüssing br_multicast_query_received(br, port, &br->ip6_other_query, 2784dc4eb53aSLinus Lüssing &saddr, max_delay); 278508b202b6SYOSHIFUJI Hideaki goto out; 27866c03ee8bSLinus Lüssing } else if (!group) { 27876c03ee8bSLinus Lüssing goto out; 2788dc4eb53aSLinus Lüssing } 278908b202b6SYOSHIFUJI Hideaki 279019e3a9c9SNikolay Aleksandrov mp = br_mdb_ip6_get(br, group, vid); 279108b202b6SYOSHIFUJI Hideaki if (!mp) 279208b202b6SYOSHIFUJI Hideaki goto out; 279308b202b6SYOSHIFUJI Hideaki 279408b202b6SYOSHIFUJI Hideaki max_delay *= br->multicast_last_member_count; 2795ff0fd34eSAndrew Lunn if (mp->host_joined && 279608b202b6SYOSHIFUJI Hideaki (timer_pending(&mp->timer) ? 279708b202b6SYOSHIFUJI Hideaki time_after(mp->timer.expires, now + max_delay) : 279808b202b6SYOSHIFUJI Hideaki try_to_del_timer_sync(&mp->timer) >= 0)) 279908b202b6SYOSHIFUJI Hideaki mod_timer(&mp->timer, now + max_delay); 280008b202b6SYOSHIFUJI Hideaki 2801e8051688SEric Dumazet for (pp = &mp->ports; 2802e8051688SEric Dumazet (p = mlock_dereference(*pp, br)) != NULL; 2803e8051688SEric Dumazet pp = &p->next) { 280408b202b6SYOSHIFUJI Hideaki if (timer_pending(&p->timer) ? 280508b202b6SYOSHIFUJI Hideaki time_after(p->timer.expires, now + max_delay) : 280623550b83SNikolay Aleksandrov try_to_del_timer_sync(&p->timer) >= 0 && 280723550b83SNikolay Aleksandrov (br->multicast_mld_version == 1 || 280823550b83SNikolay Aleksandrov p->filter_mode == MCAST_EXCLUDE)) 280924f9cdcbSHerbert Xu mod_timer(&p->timer, now + max_delay); 281008b202b6SYOSHIFUJI Hideaki } 281108b202b6SYOSHIFUJI Hideaki 281208b202b6SYOSHIFUJI Hideaki out: 281308b202b6SYOSHIFUJI Hideaki spin_unlock(&br->multicast_lock); 281408b202b6SYOSHIFUJI Hideaki return err; 281508b202b6SYOSHIFUJI Hideaki } 281608b202b6SYOSHIFUJI Hideaki #endif 281708b202b6SYOSHIFUJI Hideaki 281890010b36SLinus Lüssing static void 281990010b36SLinus Lüssing br_multicast_leave_group(struct net_bridge *br, 2820eb1d1641SHerbert Xu struct net_bridge_port *port, 2821cc0fdd80SLinus Lüssing struct br_ip *group, 282290010b36SLinus Lüssing struct bridge_mcast_other_query *other_query, 28236db6f0eaSFelix Fietkau struct bridge_mcast_own_query *own_query, 28246db6f0eaSFelix Fietkau const unsigned char *src) 2825eb1d1641SHerbert Xu { 2826eb1d1641SHerbert Xu struct net_bridge_mdb_entry *mp; 2827eb1d1641SHerbert Xu struct net_bridge_port_group *p; 2828eb1d1641SHerbert Xu unsigned long now; 2829eb1d1641SHerbert Xu unsigned long time; 2830eb1d1641SHerbert Xu 2831eb1d1641SHerbert Xu spin_lock(&br->multicast_lock); 2832eb1d1641SHerbert Xu if (!netif_running(br->dev) || 2833544586f7SSatish Ashok (port && port->state == BR_STATE_DISABLED)) 2834eb1d1641SHerbert Xu goto out; 2835eb1d1641SHerbert Xu 283619e3a9c9SNikolay Aleksandrov mp = br_mdb_ip_get(br, group); 2837eb1d1641SHerbert Xu if (!mp) 2838eb1d1641SHerbert Xu goto out; 2839eb1d1641SHerbert Xu 2840544586f7SSatish Ashok if (port && (port->flags & BR_MULTICAST_FAST_LEAVE)) { 2841544586f7SSatish Ashok struct net_bridge_port_group __rcu **pp; 2842544586f7SSatish Ashok 2843544586f7SSatish Ashok for (pp = &mp->ports; 2844544586f7SSatish Ashok (p = mlock_dereference(*pp, br)) != NULL; 2845544586f7SSatish Ashok pp = &p->next) { 28466db6f0eaSFelix Fietkau if (!br_port_group_equal(p, port, src)) 2847544586f7SSatish Ashok continue; 2848544586f7SSatish Ashok 28495c725b6bSNikolay Aleksandrov if (p->flags & MDB_PG_FLAGS_PERMANENT) 28505c725b6bSNikolay Aleksandrov break; 28515c725b6bSNikolay Aleksandrov 2852681590bdSNikolay Aleksandrov p->flags |= MDB_PG_FLAGS_FAST_LEAVE; 2853681590bdSNikolay Aleksandrov br_multicast_del_pg(mp, p, pp); 2854544586f7SSatish Ashok } 2855544586f7SSatish Ashok goto out; 2856544586f7SSatish Ashok } 2857544586f7SSatish Ashok 2858544586f7SSatish Ashok if (timer_pending(&other_query->timer)) 2859544586f7SSatish Ashok goto out; 2860544586f7SSatish Ashok 2861675779adSNikolay Aleksandrov if (br_opt_get(br, BROPT_MULTICAST_QUERIER)) { 2862438ef2d0SNikolay Aleksandrov __br_multicast_send_query(br, port, NULL, NULL, &mp->addr, 286342c11ccfSNikolay Aleksandrov false, 0, NULL); 28646b7df111SCong Wang 28656b7df111SCong Wang time = jiffies + br->multicast_last_member_count * 28666b7df111SCong Wang br->multicast_last_member_interval; 2867cc0fdd80SLinus Lüssing 286890010b36SLinus Lüssing mod_timer(&own_query->timer, time); 28696b7df111SCong Wang 28706b7df111SCong Wang for (p = mlock_dereference(mp->ports, br); 28716b7df111SCong Wang p != NULL; 28726b7df111SCong Wang p = mlock_dereference(p->next, br)) { 28736db6f0eaSFelix Fietkau if (!br_port_group_equal(p, port, src)) 28746b7df111SCong Wang continue; 28756b7df111SCong Wang 28766b7df111SCong Wang if (!hlist_unhashed(&p->mglist) && 28776b7df111SCong Wang (timer_pending(&p->timer) ? 28786b7df111SCong Wang time_after(p->timer.expires, time) : 28796b7df111SCong Wang try_to_del_timer_sync(&p->timer) >= 0)) { 28806b7df111SCong Wang mod_timer(&p->timer, time); 28816b7df111SCong Wang } 28826b7df111SCong Wang 28836b7df111SCong Wang break; 28846b7df111SCong Wang } 28856b7df111SCong Wang } 28866b7df111SCong Wang 2887eb1d1641SHerbert Xu now = jiffies; 2888eb1d1641SHerbert Xu time = now + br->multicast_last_member_count * 2889eb1d1641SHerbert Xu br->multicast_last_member_interval; 2890eb1d1641SHerbert Xu 2891eb1d1641SHerbert Xu if (!port) { 2892ff0fd34eSAndrew Lunn if (mp->host_joined && 2893eb1d1641SHerbert Xu (timer_pending(&mp->timer) ? 2894eb1d1641SHerbert Xu time_after(mp->timer.expires, time) : 2895eb1d1641SHerbert Xu try_to_del_timer_sync(&mp->timer) >= 0)) { 2896eb1d1641SHerbert Xu mod_timer(&mp->timer, time); 2897eb1d1641SHerbert Xu } 2898454594f3SLinus Lüssing 2899454594f3SLinus Lüssing goto out; 2900454594f3SLinus Lüssing } 2901454594f3SLinus Lüssing 2902454594f3SLinus Lüssing for (p = mlock_dereference(mp->ports, br); 2903454594f3SLinus Lüssing p != NULL; 2904454594f3SLinus Lüssing p = mlock_dereference(p->next, br)) { 2905085b53c8SNikolay Aleksandrov if (p->key.port != port) 2906454594f3SLinus Lüssing continue; 2907454594f3SLinus Lüssing 2908454594f3SLinus Lüssing if (!hlist_unhashed(&p->mglist) && 2909454594f3SLinus Lüssing (timer_pending(&p->timer) ? 2910454594f3SLinus Lüssing time_after(p->timer.expires, time) : 2911454594f3SLinus Lüssing try_to_del_timer_sync(&p->timer) >= 0)) { 2912454594f3SLinus Lüssing mod_timer(&p->timer, time); 2913454594f3SLinus Lüssing } 2914454594f3SLinus Lüssing 2915454594f3SLinus Lüssing break; 2916eb1d1641SHerbert Xu } 2917eb1d1641SHerbert Xu out: 2918eb1d1641SHerbert Xu spin_unlock(&br->multicast_lock); 2919eb1d1641SHerbert Xu } 2920eb1d1641SHerbert Xu 29218ef2a9a5SYOSHIFUJI Hideaki static void br_ip4_multicast_leave_group(struct net_bridge *br, 29228ef2a9a5SYOSHIFUJI Hideaki struct net_bridge_port *port, 2923b0e9a30dSVlad Yasevich __be32 group, 29246db6f0eaSFelix Fietkau __u16 vid, 29256db6f0eaSFelix Fietkau const unsigned char *src) 29268ef2a9a5SYOSHIFUJI Hideaki { 29278ef2a9a5SYOSHIFUJI Hideaki struct br_ip br_group; 292890010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 29298ef2a9a5SYOSHIFUJI Hideaki 29308ef2a9a5SYOSHIFUJI Hideaki if (ipv4_is_local_multicast(group)) 29318ef2a9a5SYOSHIFUJI Hideaki return; 29328ef2a9a5SYOSHIFUJI Hideaki 293390010b36SLinus Lüssing own_query = port ? &port->ip4_own_query : &br->ip4_own_query; 293490010b36SLinus Lüssing 29351515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 2936eab3227bSNikolay Aleksandrov br_group.dst.ip4 = group; 29378ef2a9a5SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IP); 2938b0e9a30dSVlad Yasevich br_group.vid = vid; 29398ef2a9a5SYOSHIFUJI Hideaki 294090010b36SLinus Lüssing br_multicast_leave_group(br, port, &br_group, &br->ip4_other_query, 29416db6f0eaSFelix Fietkau own_query, src); 29428ef2a9a5SYOSHIFUJI Hideaki } 29438ef2a9a5SYOSHIFUJI Hideaki 2944dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 294508b202b6SYOSHIFUJI Hideaki static void br_ip6_multicast_leave_group(struct net_bridge *br, 294608b202b6SYOSHIFUJI Hideaki struct net_bridge_port *port, 2947b0e9a30dSVlad Yasevich const struct in6_addr *group, 29486db6f0eaSFelix Fietkau __u16 vid, 29496db6f0eaSFelix Fietkau const unsigned char *src) 295008b202b6SYOSHIFUJI Hideaki { 295108b202b6SYOSHIFUJI Hideaki struct br_ip br_group; 295290010b36SLinus Lüssing struct bridge_mcast_own_query *own_query; 295308b202b6SYOSHIFUJI Hideaki 29543c3769e6SLinus Lüssing if (ipv6_addr_is_ll_all_nodes(group)) 295508b202b6SYOSHIFUJI Hideaki return; 295608b202b6SYOSHIFUJI Hideaki 295790010b36SLinus Lüssing own_query = port ? &port->ip6_own_query : &br->ip6_own_query; 295890010b36SLinus Lüssing 29591515a63fSNikolay Aleksandrov memset(&br_group, 0, sizeof(br_group)); 2960eab3227bSNikolay Aleksandrov br_group.dst.ip6 = *group; 296108b202b6SYOSHIFUJI Hideaki br_group.proto = htons(ETH_P_IPV6); 2962b0e9a30dSVlad Yasevich br_group.vid = vid; 296308b202b6SYOSHIFUJI Hideaki 296490010b36SLinus Lüssing br_multicast_leave_group(br, port, &br_group, &br->ip6_other_query, 29656db6f0eaSFelix Fietkau own_query, src); 296608b202b6SYOSHIFUJI Hideaki } 296708b202b6SYOSHIFUJI Hideaki #endif 29688ef2a9a5SYOSHIFUJI Hideaki 29691080ab95SNikolay Aleksandrov static void br_multicast_err_count(const struct net_bridge *br, 29701080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 29711080ab95SNikolay Aleksandrov __be16 proto) 29721080ab95SNikolay Aleksandrov { 29731080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 29741080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats; 29751080ab95SNikolay Aleksandrov 2976675779adSNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 29771080ab95SNikolay Aleksandrov return; 29781080ab95SNikolay Aleksandrov 29791080ab95SNikolay Aleksandrov if (p) 29801080ab95SNikolay Aleksandrov stats = p->mcast_stats; 29811080ab95SNikolay Aleksandrov else 29821080ab95SNikolay Aleksandrov stats = br->mcast_stats; 29831080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 29841080ab95SNikolay Aleksandrov return; 29851080ab95SNikolay Aleksandrov 29861080ab95SNikolay Aleksandrov pstats = this_cpu_ptr(stats); 29871080ab95SNikolay Aleksandrov 29881080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 29891080ab95SNikolay Aleksandrov switch (proto) { 29901080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 29911080ab95SNikolay Aleksandrov pstats->mstats.igmp_parse_errors++; 29921080ab95SNikolay Aleksandrov break; 29931080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 29941080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 29951080ab95SNikolay Aleksandrov pstats->mstats.mld_parse_errors++; 29961080ab95SNikolay Aleksandrov break; 29971080ab95SNikolay Aleksandrov #endif 29981080ab95SNikolay Aleksandrov } 29991080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 30001080ab95SNikolay Aleksandrov } 30011080ab95SNikolay Aleksandrov 300291b02d3dSNikolay Aleksandrov static void br_multicast_pim(struct net_bridge *br, 300391b02d3dSNikolay Aleksandrov struct net_bridge_port *port, 300491b02d3dSNikolay Aleksandrov const struct sk_buff *skb) 300591b02d3dSNikolay Aleksandrov { 300691b02d3dSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 300791b02d3dSNikolay Aleksandrov struct pimhdr *pimhdr, _pimhdr; 300891b02d3dSNikolay Aleksandrov 300991b02d3dSNikolay Aleksandrov pimhdr = skb_header_pointer(skb, offset, sizeof(_pimhdr), &_pimhdr); 301091b02d3dSNikolay Aleksandrov if (!pimhdr || pim_hdr_version(pimhdr) != PIM_VERSION || 301191b02d3dSNikolay Aleksandrov pim_hdr_type(pimhdr) != PIM_TYPE_HELLO) 301291b02d3dSNikolay Aleksandrov return; 301391b02d3dSNikolay Aleksandrov 301491b02d3dSNikolay Aleksandrov br_multicast_mark_router(br, port); 301591b02d3dSNikolay Aleksandrov } 301691b02d3dSNikolay Aleksandrov 30174b3087c7SLinus Lüssing static int br_ip4_multicast_mrd_rcv(struct net_bridge *br, 30184b3087c7SLinus Lüssing struct net_bridge_port *port, 30194b3087c7SLinus Lüssing struct sk_buff *skb) 30204b3087c7SLinus Lüssing { 30214b3087c7SLinus Lüssing if (ip_hdr(skb)->protocol != IPPROTO_IGMP || 30224b3087c7SLinus Lüssing igmp_hdr(skb)->type != IGMP_MRDISC_ADV) 30234b3087c7SLinus Lüssing return -ENOMSG; 30244b3087c7SLinus Lüssing 30254b3087c7SLinus Lüssing br_multicast_mark_router(br, port); 30264b3087c7SLinus Lüssing 30274b3087c7SLinus Lüssing return 0; 30284b3087c7SLinus Lüssing } 30294b3087c7SLinus Lüssing 3030eb1d1641SHerbert Xu static int br_multicast_ipv4_rcv(struct net_bridge *br, 3031eb1d1641SHerbert Xu struct net_bridge_port *port, 303206499098SVlad Yasevich struct sk_buff *skb, 303306499098SVlad Yasevich u16 vid) 3034eb1d1641SHerbert Xu { 30356db6f0eaSFelix Fietkau const unsigned char *src; 3036eb1d1641SHerbert Xu struct igmphdr *ih; 3037eb1d1641SHerbert Xu int err; 3038eb1d1641SHerbert Xu 3039ba5ea614SLinus Lüssing err = ip_mc_check_igmp(skb); 3040eb1d1641SHerbert Xu 30419afd85c9SLinus Lüssing if (err == -ENOMSG) { 304291b02d3dSNikolay Aleksandrov if (!ipv4_is_local_multicast(ip_hdr(skb)->daddr)) { 3043bd4265feSHerbert Xu BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 304491b02d3dSNikolay Aleksandrov } else if (pim_ipv4_all_pim_routers(ip_hdr(skb)->daddr)) { 304591b02d3dSNikolay Aleksandrov if (ip_hdr(skb)->protocol == IPPROTO_PIM) 304691b02d3dSNikolay Aleksandrov br_multicast_pim(br, port, skb); 30474b3087c7SLinus Lüssing } else if (ipv4_is_all_snoopers(ip_hdr(skb)->daddr)) { 304808e71623SLi RongQing br_ip4_multicast_mrd_rcv(br, port, skb); 30494b3087c7SLinus Lüssing } 30504b3087c7SLinus Lüssing 3051eb1d1641SHerbert Xu return 0; 30529afd85c9SLinus Lüssing } else if (err < 0) { 30531080ab95SNikolay Aleksandrov br_multicast_err_count(br, port, skb->protocol); 30549afd85c9SLinus Lüssing return err; 3055bd4265feSHerbert Xu } 3056eb1d1641SHerbert Xu 30579afd85c9SLinus Lüssing ih = igmp_hdr(skb); 30586db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 30591080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = ih->type; 3060eb1d1641SHerbert Xu 3061eb1d1641SHerbert Xu switch (ih->type) { 3062eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_REPORT: 3063eb1d1641SHerbert Xu case IGMPV2_HOST_MEMBERSHIP_REPORT: 306462b2bcb4SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 30658b671779SNikolay Aleksandrov err = br_ip4_multicast_add_group(br, port, ih->group, vid, src, 30668b671779SNikolay Aleksandrov true); 3067eb1d1641SHerbert Xu break; 3068eb1d1641SHerbert Xu case IGMPV3_HOST_MEMBERSHIP_REPORT: 3069ba5ea614SLinus Lüssing err = br_ip4_multicast_igmp3_report(br, port, skb, vid); 3070eb1d1641SHerbert Xu break; 3071eb1d1641SHerbert Xu case IGMP_HOST_MEMBERSHIP_QUERY: 3072ba5ea614SLinus Lüssing br_ip4_multicast_query(br, port, skb, vid); 3073eb1d1641SHerbert Xu break; 3074eb1d1641SHerbert Xu case IGMP_HOST_LEAVE_MESSAGE: 30756db6f0eaSFelix Fietkau br_ip4_multicast_leave_group(br, port, ih->group, vid, src); 3076eb1d1641SHerbert Xu break; 3077eb1d1641SHerbert Xu } 3078eb1d1641SHerbert Xu 3079a65056ecSNikolay Aleksandrov br_multicast_count(br, port, skb, BR_INPUT_SKB_CB(skb)->igmp, 30801080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 30811080ab95SNikolay Aleksandrov 3082eb1d1641SHerbert Xu return err; 3083eb1d1641SHerbert Xu } 3084eb1d1641SHerbert Xu 3085dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 30864b3087c7SLinus Lüssing static int br_ip6_multicast_mrd_rcv(struct net_bridge *br, 30874b3087c7SLinus Lüssing struct net_bridge_port *port, 30884b3087c7SLinus Lüssing struct sk_buff *skb) 30894b3087c7SLinus Lüssing { 30904b3087c7SLinus Lüssing int ret; 30914b3087c7SLinus Lüssing 30924b3087c7SLinus Lüssing if (ipv6_hdr(skb)->nexthdr != IPPROTO_ICMPV6) 30934b3087c7SLinus Lüssing return -ENOMSG; 30944b3087c7SLinus Lüssing 30954b3087c7SLinus Lüssing ret = ipv6_mc_check_icmpv6(skb); 30964b3087c7SLinus Lüssing if (ret < 0) 30974b3087c7SLinus Lüssing return ret; 30984b3087c7SLinus Lüssing 30994b3087c7SLinus Lüssing if (icmp6_hdr(skb)->icmp6_type != ICMPV6_MRDISC_ADV) 31004b3087c7SLinus Lüssing return -ENOMSG; 31014b3087c7SLinus Lüssing 31024b3087c7SLinus Lüssing br_multicast_mark_router(br, port); 31034b3087c7SLinus Lüssing 31044b3087c7SLinus Lüssing return 0; 31054b3087c7SLinus Lüssing } 31064b3087c7SLinus Lüssing 310708b202b6SYOSHIFUJI Hideaki static int br_multicast_ipv6_rcv(struct net_bridge *br, 310808b202b6SYOSHIFUJI Hideaki struct net_bridge_port *port, 310906499098SVlad Yasevich struct sk_buff *skb, 311006499098SVlad Yasevich u16 vid) 311108b202b6SYOSHIFUJI Hideaki { 31126db6f0eaSFelix Fietkau const unsigned char *src; 31139afd85c9SLinus Lüssing struct mld_msg *mld; 311408b202b6SYOSHIFUJI Hideaki int err; 311508b202b6SYOSHIFUJI Hideaki 3116ba5ea614SLinus Lüssing err = ipv6_mc_check_mld(skb); 311708b202b6SYOSHIFUJI Hideaki 31189afd85c9SLinus Lüssing if (err == -ENOMSG) { 31199afd85c9SLinus Lüssing if (!ipv6_addr_is_ll_all_nodes(&ipv6_hdr(skb)->daddr)) 31208fad9c39SLinus Lüssing BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 31214b3087c7SLinus Lüssing 31224b3087c7SLinus Lüssing if (ipv6_addr_is_all_snoopers(&ipv6_hdr(skb)->daddr)) { 31234b3087c7SLinus Lüssing err = br_ip6_multicast_mrd_rcv(br, port, skb); 31244b3087c7SLinus Lüssing 31254b3087c7SLinus Lüssing if (err < 0 && err != -ENOMSG) { 31264b3087c7SLinus Lüssing br_multicast_err_count(br, port, skb->protocol); 31274b3087c7SLinus Lüssing return err; 31284b3087c7SLinus Lüssing } 31294b3087c7SLinus Lüssing } 31304b3087c7SLinus Lüssing 313108b202b6SYOSHIFUJI Hideaki return 0; 31329afd85c9SLinus Lüssing } else if (err < 0) { 31331080ab95SNikolay Aleksandrov br_multicast_err_count(br, port, skb->protocol); 31349afd85c9SLinus Lüssing return err; 313508b202b6SYOSHIFUJI Hideaki } 313608b202b6SYOSHIFUJI Hideaki 31379afd85c9SLinus Lüssing mld = (struct mld_msg *)skb_transport_header(skb); 31381080ab95SNikolay Aleksandrov BR_INPUT_SKB_CB(skb)->igmp = mld->mld_type; 313908b202b6SYOSHIFUJI Hideaki 31409afd85c9SLinus Lüssing switch (mld->mld_type) { 314108b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REPORT: 31426db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 3143fc2af6c7SFernando Luis Vázquez Cao BR_INPUT_SKB_CB(skb)->mrouters_only = 1; 31446db6f0eaSFelix Fietkau err = br_ip6_multicast_add_group(br, port, &mld->mld_mca, vid, 31458b671779SNikolay Aleksandrov src, true); 314608b202b6SYOSHIFUJI Hideaki break; 314708b202b6SYOSHIFUJI Hideaki case ICMPV6_MLD2_REPORT: 3148ba5ea614SLinus Lüssing err = br_ip6_multicast_mld2_report(br, port, skb, vid); 314908b202b6SYOSHIFUJI Hideaki break; 315008b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_QUERY: 3151ba5ea614SLinus Lüssing err = br_ip6_multicast_query(br, port, skb, vid); 315208b202b6SYOSHIFUJI Hideaki break; 315308b202b6SYOSHIFUJI Hideaki case ICMPV6_MGM_REDUCTION: 31546db6f0eaSFelix Fietkau src = eth_hdr(skb)->h_source; 31556db6f0eaSFelix Fietkau br_ip6_multicast_leave_group(br, port, &mld->mld_mca, vid, src); 31569afd85c9SLinus Lüssing break; 315708b202b6SYOSHIFUJI Hideaki } 315808b202b6SYOSHIFUJI Hideaki 3159a65056ecSNikolay Aleksandrov br_multicast_count(br, port, skb, BR_INPUT_SKB_CB(skb)->igmp, 31601080ab95SNikolay Aleksandrov BR_MCAST_DIR_RX); 31611080ab95SNikolay Aleksandrov 316208b202b6SYOSHIFUJI Hideaki return err; 316308b202b6SYOSHIFUJI Hideaki } 316408b202b6SYOSHIFUJI Hideaki #endif 316508b202b6SYOSHIFUJI Hideaki 3166eb1d1641SHerbert Xu int br_multicast_rcv(struct net_bridge *br, struct net_bridge_port *port, 316706499098SVlad Yasevich struct sk_buff *skb, u16 vid) 3168eb1d1641SHerbert Xu { 31691080ab95SNikolay Aleksandrov int ret = 0; 31701080ab95SNikolay Aleksandrov 31711fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->igmp = 0; 31721fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 BR_INPUT_SKB_CB(skb)->mrouters_only = 0; 31731fafc7a9SYOSHIFUJI Hideaki / 吉藤英明 317413cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) 3175eb1d1641SHerbert Xu return 0; 3176eb1d1641SHerbert Xu 3177eb1d1641SHerbert Xu switch (skb->protocol) { 3178eb1d1641SHerbert Xu case htons(ETH_P_IP): 31791080ab95SNikolay Aleksandrov ret = br_multicast_ipv4_rcv(br, port, skb, vid); 31801080ab95SNikolay Aleksandrov break; 3181dfd56b8bSEric Dumazet #if IS_ENABLED(CONFIG_IPV6) 318208b202b6SYOSHIFUJI Hideaki case htons(ETH_P_IPV6): 31831080ab95SNikolay Aleksandrov ret = br_multicast_ipv6_rcv(br, port, skb, vid); 31841080ab95SNikolay Aleksandrov break; 318508b202b6SYOSHIFUJI Hideaki #endif 3186eb1d1641SHerbert Xu } 3187eb1d1641SHerbert Xu 31881080ab95SNikolay Aleksandrov return ret; 3189eb1d1641SHerbert Xu } 3190eb1d1641SHerbert Xu 3191cc0fdd80SLinus Lüssing static void br_multicast_query_expired(struct net_bridge *br, 31922cd41431SLinus Lüssing struct bridge_mcast_own_query *query, 31932cd41431SLinus Lüssing struct bridge_mcast_querier *querier) 3194cc0fdd80SLinus Lüssing { 3195cc0fdd80SLinus Lüssing spin_lock(&br->multicast_lock); 3196cc0fdd80SLinus Lüssing if (query->startup_sent < br->multicast_startup_query_count) 3197cc0fdd80SLinus Lüssing query->startup_sent++; 3198cc0fdd80SLinus Lüssing 319971d9f614SEric Dumazet RCU_INIT_POINTER(querier->port, NULL); 3200cc0fdd80SLinus Lüssing br_multicast_send_query(br, NULL, query); 3201cc0fdd80SLinus Lüssing spin_unlock(&br->multicast_lock); 3202cc0fdd80SLinus Lüssing } 3203cc0fdd80SLinus Lüssing 320488c1f37fSAllen Pais static void br_ip4_multicast_query_expired(struct timer_list *t) 3205eb1d1641SHerbert Xu { 320688c1f37fSAllen Pais struct net_bridge *br = from_timer(br, t, ip4_own_query.timer); 3207eb1d1641SHerbert Xu 32082cd41431SLinus Lüssing br_multicast_query_expired(br, &br->ip4_own_query, &br->ip4_querier); 3209eb1d1641SHerbert Xu } 3210eb1d1641SHerbert Xu 3211cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 321288c1f37fSAllen Pais static void br_ip6_multicast_query_expired(struct timer_list *t) 3213cc0fdd80SLinus Lüssing { 321488c1f37fSAllen Pais struct net_bridge *br = from_timer(br, t, ip6_own_query.timer); 3215cc0fdd80SLinus Lüssing 32162cd41431SLinus Lüssing br_multicast_query_expired(br, &br->ip6_own_query, &br->ip6_querier); 3217cc0fdd80SLinus Lüssing } 3218cc0fdd80SLinus Lüssing #endif 3219cc0fdd80SLinus Lüssing 3220e12cec65SNikolay Aleksandrov static void br_multicast_gc_work(struct work_struct *work) 32218b671779SNikolay Aleksandrov { 32228b671779SNikolay Aleksandrov struct net_bridge *br = container_of(work, struct net_bridge, 3223e12cec65SNikolay Aleksandrov mcast_gc_work); 32248b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 32258b671779SNikolay Aleksandrov 32268b671779SNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 3227e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 32288b671779SNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 32298b671779SNikolay Aleksandrov 3230e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 32318b671779SNikolay Aleksandrov } 32328b671779SNikolay Aleksandrov 3233eb1d1641SHerbert Xu void br_multicast_init(struct net_bridge *br) 3234eb1d1641SHerbert Xu { 3235d08c6bc0SNikolay Aleksandrov br->hash_max = BR_MULTICAST_DEFAULT_HASH_MAX; 3236eb1d1641SHerbert Xu 32377f0aec7aSNikolay Aleksandrov br->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 3238eb1d1641SHerbert Xu br->multicast_last_member_count = 2; 3239eb1d1641SHerbert Xu br->multicast_startup_query_count = 2; 3240eb1d1641SHerbert Xu 3241eb1d1641SHerbert Xu br->multicast_last_member_interval = HZ; 3242eb1d1641SHerbert Xu br->multicast_query_response_interval = 10 * HZ; 3243eb1d1641SHerbert Xu br->multicast_startup_query_interval = 125 * HZ / 4; 3244eb1d1641SHerbert Xu br->multicast_query_interval = 125 * HZ; 3245eb1d1641SHerbert Xu br->multicast_querier_interval = 255 * HZ; 3246eb1d1641SHerbert Xu br->multicast_membership_interval = 260 * HZ; 3247eb1d1641SHerbert Xu 324890010b36SLinus Lüssing br->ip4_other_query.delay_time = 0; 32492cd41431SLinus Lüssing br->ip4_querier.port = NULL; 3250aa2ae3e7SNikolay Aleksandrov br->multicast_igmp_version = 2; 3251cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3252aa2ae3e7SNikolay Aleksandrov br->multicast_mld_version = 1; 325390010b36SLinus Lüssing br->ip6_other_query.delay_time = 0; 32542cd41431SLinus Lüssing br->ip6_querier.port = NULL; 3255cc0fdd80SLinus Lüssing #endif 32566919622aSIdo Schimmel br_opt_toggle(br, BROPT_MULTICAST_ENABLED, true); 3257675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_HAS_IPV6_ADDR, true); 3258b00589afSLinus Lüssing 3259eb1d1641SHerbert Xu spin_lock_init(&br->multicast_lock); 326088c1f37fSAllen Pais timer_setup(&br->multicast_router_timer, 326188c1f37fSAllen Pais br_multicast_local_router_expired, 0); 326288c1f37fSAllen Pais timer_setup(&br->ip4_other_query.timer, 326388c1f37fSAllen Pais br_ip4_multicast_querier_expired, 0); 326488c1f37fSAllen Pais timer_setup(&br->ip4_own_query.timer, 326588c1f37fSAllen Pais br_ip4_multicast_query_expired, 0); 3266cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 326788c1f37fSAllen Pais timer_setup(&br->ip6_other_query.timer, 326888c1f37fSAllen Pais br_ip6_multicast_querier_expired, 0); 326988c1f37fSAllen Pais timer_setup(&br->ip6_own_query.timer, 327088c1f37fSAllen Pais br_ip6_multicast_query_expired, 0); 3271cc0fdd80SLinus Lüssing #endif 327219e3a9c9SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mdb_list); 3273e12cec65SNikolay Aleksandrov INIT_HLIST_HEAD(&br->mcast_gc_list); 3274e12cec65SNikolay Aleksandrov INIT_WORK(&br->mcast_gc_work, br_multicast_gc_work); 3275eb1d1641SHerbert Xu } 3276eb1d1641SHerbert Xu 32774effd28cSLinus Lüssing static void br_ip4_multicast_join_snoopers(struct net_bridge *br) 32784effd28cSLinus Lüssing { 32794effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 32804effd28cSLinus Lüssing 32814effd28cSLinus Lüssing if (!in_dev) 32824effd28cSLinus Lüssing return; 32834effd28cSLinus Lüssing 32849fb20801SFlorian Fainelli __ip_mc_inc_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 32854effd28cSLinus Lüssing in_dev_put(in_dev); 32864effd28cSLinus Lüssing } 32874effd28cSLinus Lüssing 32884effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 32894effd28cSLinus Lüssing static void br_ip6_multicast_join_snoopers(struct net_bridge *br) 32904effd28cSLinus Lüssing { 32914effd28cSLinus Lüssing struct in6_addr addr; 32924effd28cSLinus Lüssing 32934effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 32944effd28cSLinus Lüssing ipv6_dev_mc_inc(br->dev, &addr); 32954effd28cSLinus Lüssing } 32964effd28cSLinus Lüssing #else 32974effd28cSLinus Lüssing static inline void br_ip6_multicast_join_snoopers(struct net_bridge *br) 32984effd28cSLinus Lüssing { 32994effd28cSLinus Lüssing } 33004effd28cSLinus Lüssing #endif 33014effd28cSLinus Lüssing 3302851d0a73SJoseph Huang void br_multicast_join_snoopers(struct net_bridge *br) 33034effd28cSLinus Lüssing { 33044effd28cSLinus Lüssing br_ip4_multicast_join_snoopers(br); 33054effd28cSLinus Lüssing br_ip6_multicast_join_snoopers(br); 33064effd28cSLinus Lüssing } 33074effd28cSLinus Lüssing 33084effd28cSLinus Lüssing static void br_ip4_multicast_leave_snoopers(struct net_bridge *br) 33094effd28cSLinus Lüssing { 33104effd28cSLinus Lüssing struct in_device *in_dev = in_dev_get(br->dev); 33114effd28cSLinus Lüssing 33124effd28cSLinus Lüssing if (WARN_ON(!in_dev)) 33134effd28cSLinus Lüssing return; 33144effd28cSLinus Lüssing 33159fb20801SFlorian Fainelli __ip_mc_dec_group(in_dev, htonl(INADDR_ALLSNOOPERS_GROUP), GFP_ATOMIC); 33164effd28cSLinus Lüssing in_dev_put(in_dev); 33174effd28cSLinus Lüssing } 33184effd28cSLinus Lüssing 33194effd28cSLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 33204effd28cSLinus Lüssing static void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 33214effd28cSLinus Lüssing { 33224effd28cSLinus Lüssing struct in6_addr addr; 33234effd28cSLinus Lüssing 33244effd28cSLinus Lüssing ipv6_addr_set(&addr, htonl(0xff020000), 0, 0, htonl(0x6a)); 33254effd28cSLinus Lüssing ipv6_dev_mc_dec(br->dev, &addr); 33264effd28cSLinus Lüssing } 33274effd28cSLinus Lüssing #else 33284effd28cSLinus Lüssing static inline void br_ip6_multicast_leave_snoopers(struct net_bridge *br) 33294effd28cSLinus Lüssing { 33304effd28cSLinus Lüssing } 33314effd28cSLinus Lüssing #endif 33324effd28cSLinus Lüssing 3333851d0a73SJoseph Huang void br_multicast_leave_snoopers(struct net_bridge *br) 33344effd28cSLinus Lüssing { 33354effd28cSLinus Lüssing br_ip4_multicast_leave_snoopers(br); 33364effd28cSLinus Lüssing br_ip6_multicast_leave_snoopers(br); 33374effd28cSLinus Lüssing } 33384effd28cSLinus Lüssing 3339cc0fdd80SLinus Lüssing static void __br_multicast_open(struct net_bridge *br, 334090010b36SLinus Lüssing struct bridge_mcast_own_query *query) 3341eb1d1641SHerbert Xu { 3342cc0fdd80SLinus Lüssing query->startup_sent = 0; 3343eb1d1641SHerbert Xu 334413cefad2SNikolay Aleksandrov if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) 3345eb1d1641SHerbert Xu return; 3346eb1d1641SHerbert Xu 3347cc0fdd80SLinus Lüssing mod_timer(&query->timer, jiffies); 3348cc0fdd80SLinus Lüssing } 3349cc0fdd80SLinus Lüssing 3350cc0fdd80SLinus Lüssing void br_multicast_open(struct net_bridge *br) 3351cc0fdd80SLinus Lüssing { 335290010b36SLinus Lüssing __br_multicast_open(br, &br->ip4_own_query); 3353cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 335490010b36SLinus Lüssing __br_multicast_open(br, &br->ip6_own_query); 3355cc0fdd80SLinus Lüssing #endif 3356eb1d1641SHerbert Xu } 3357eb1d1641SHerbert Xu 3358eb1d1641SHerbert Xu void br_multicast_stop(struct net_bridge *br) 3359eb1d1641SHerbert Xu { 3360eb1d1641SHerbert Xu del_timer_sync(&br->multicast_router_timer); 336190010b36SLinus Lüssing del_timer_sync(&br->ip4_other_query.timer); 336290010b36SLinus Lüssing del_timer_sync(&br->ip4_own_query.timer); 3363cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 336490010b36SLinus Lüssing del_timer_sync(&br->ip6_other_query.timer); 336590010b36SLinus Lüssing del_timer_sync(&br->ip6_own_query.timer); 3366cc0fdd80SLinus Lüssing #endif 3367e10177abSSatish Ashok } 3368e10177abSSatish Ashok 3369e10177abSSatish Ashok void br_multicast_dev_del(struct net_bridge *br) 3370e10177abSSatish Ashok { 3371e10177abSSatish Ashok struct net_bridge_mdb_entry *mp; 33728b671779SNikolay Aleksandrov HLIST_HEAD(deleted_head); 337319e3a9c9SNikolay Aleksandrov struct hlist_node *tmp; 3374eb1d1641SHerbert Xu 3375eb1d1641SHerbert Xu spin_lock_bh(&br->multicast_lock); 3376e12cec65SNikolay Aleksandrov hlist_for_each_entry_safe(mp, tmp, &br->mdb_list, mdb_node) 3377e12cec65SNikolay Aleksandrov br_multicast_del_mdb_entry(mp); 3378e12cec65SNikolay Aleksandrov hlist_move_list(&br->mcast_gc_list, &deleted_head); 3379eb1d1641SHerbert Xu spin_unlock_bh(&br->multicast_lock); 338019e3a9c9SNikolay Aleksandrov 3381e12cec65SNikolay Aleksandrov br_multicast_gc(&deleted_head); 3382e12cec65SNikolay Aleksandrov cancel_work_sync(&br->mcast_gc_work); 33838b671779SNikolay Aleksandrov 33844329596cSNikolay Aleksandrov rcu_barrier(); 3385eb1d1641SHerbert Xu } 33860909e117SHerbert Xu 33870909e117SHerbert Xu int br_multicast_set_router(struct net_bridge *br, unsigned long val) 33880909e117SHerbert Xu { 33896ae4ae8eSLinus Lüssing int err = -EINVAL; 33900909e117SHerbert Xu 33910909e117SHerbert Xu spin_lock_bh(&br->multicast_lock); 33920909e117SHerbert Xu 33930909e117SHerbert Xu switch (val) { 33947f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 33957f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 339677041420SYotam Gigi br_mc_router_state_change(br, val == MDB_RTR_TYPE_PERM); 33970909e117SHerbert Xu del_timer(&br->multicast_router_timer); 339877041420SYotam Gigi br->multicast_router = val; 339977041420SYotam Gigi err = 0; 340077041420SYotam Gigi break; 34017f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 340277041420SYotam Gigi if (br->multicast_router != MDB_RTR_TYPE_TEMP_QUERY) 340377041420SYotam Gigi br_mc_router_state_change(br, false); 34040909e117SHerbert Xu br->multicast_router = val; 34050909e117SHerbert Xu err = 0; 34060909e117SHerbert Xu break; 34070909e117SHerbert Xu } 34080909e117SHerbert Xu 34090909e117SHerbert Xu spin_unlock_bh(&br->multicast_lock); 34100909e117SHerbert Xu 34110909e117SHerbert Xu return err; 34120909e117SHerbert Xu } 34130909e117SHerbert Xu 34147f0aec7aSNikolay Aleksandrov static void __del_port_router(struct net_bridge_port *p) 34157f0aec7aSNikolay Aleksandrov { 34167f0aec7aSNikolay Aleksandrov if (hlist_unhashed(&p->rlist)) 34177f0aec7aSNikolay Aleksandrov return; 34187f0aec7aSNikolay Aleksandrov hlist_del_init_rcu(&p->rlist); 34197f0aec7aSNikolay Aleksandrov br_rtr_notify(p->br->dev, p, RTM_DELMDB); 34206d549648SNogah Frankel br_port_mc_router_state_change(p, false); 3421f12e7d95SNogah Frankel 3422f12e7d95SNogah Frankel /* don't allow timer refresh */ 3423f12e7d95SNogah Frankel if (p->multicast_router == MDB_RTR_TYPE_TEMP) 3424f12e7d95SNogah Frankel p->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 34257f0aec7aSNikolay Aleksandrov } 34267f0aec7aSNikolay Aleksandrov 34270909e117SHerbert Xu int br_multicast_set_port_router(struct net_bridge_port *p, unsigned long val) 34280909e117SHerbert Xu { 34290909e117SHerbert Xu struct net_bridge *br = p->br; 3430a55d8246SNikolay Aleksandrov unsigned long now = jiffies; 34316ae4ae8eSLinus Lüssing int err = -EINVAL; 34320909e117SHerbert Xu 34330909e117SHerbert Xu spin_lock(&br->multicast_lock); 34344950cfd1SNikolay Aleksandrov if (p->multicast_router == val) { 3435a55d8246SNikolay Aleksandrov /* Refresh the temp router port timer */ 3436a55d8246SNikolay Aleksandrov if (p->multicast_router == MDB_RTR_TYPE_TEMP) 3437a55d8246SNikolay Aleksandrov mod_timer(&p->multicast_router_timer, 3438a55d8246SNikolay Aleksandrov now + br->multicast_querier_interval); 34394950cfd1SNikolay Aleksandrov err = 0; 34404950cfd1SNikolay Aleksandrov goto unlock; 34414950cfd1SNikolay Aleksandrov } 34420909e117SHerbert Xu switch (val) { 34437f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_DISABLED: 34447f0aec7aSNikolay Aleksandrov p->multicast_router = MDB_RTR_TYPE_DISABLED; 34457f0aec7aSNikolay Aleksandrov __del_port_router(p); 34460909e117SHerbert Xu del_timer(&p->multicast_router_timer); 34470909e117SHerbert Xu break; 34487f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_TEMP_QUERY: 34497f0aec7aSNikolay Aleksandrov p->multicast_router = MDB_RTR_TYPE_TEMP_QUERY; 34507f0aec7aSNikolay Aleksandrov __del_port_router(p); 34517f0aec7aSNikolay Aleksandrov break; 34527f0aec7aSNikolay Aleksandrov case MDB_RTR_TYPE_PERM: 34537f0aec7aSNikolay Aleksandrov p->multicast_router = MDB_RTR_TYPE_PERM; 34547f0aec7aSNikolay Aleksandrov del_timer(&p->multicast_router_timer); 34550909e117SHerbert Xu br_multicast_add_router(br, p); 34560909e117SHerbert Xu break; 3457a55d8246SNikolay Aleksandrov case MDB_RTR_TYPE_TEMP: 3458a55d8246SNikolay Aleksandrov p->multicast_router = MDB_RTR_TYPE_TEMP; 3459a55d8246SNikolay Aleksandrov br_multicast_mark_router(br, p); 3460a55d8246SNikolay Aleksandrov break; 34617f0aec7aSNikolay Aleksandrov default: 34627f0aec7aSNikolay Aleksandrov goto unlock; 34630909e117SHerbert Xu } 34647f0aec7aSNikolay Aleksandrov err = 0; 34657f0aec7aSNikolay Aleksandrov unlock: 34660909e117SHerbert Xu spin_unlock(&br->multicast_lock); 34670909e117SHerbert Xu 34680909e117SHerbert Xu return err; 34690909e117SHerbert Xu } 3470561f1103SHerbert Xu 3471cc0fdd80SLinus Lüssing static void br_multicast_start_querier(struct net_bridge *br, 347290010b36SLinus Lüssing struct bridge_mcast_own_query *query) 3473561f1103SHerbert Xu { 3474561f1103SHerbert Xu struct net_bridge_port *port; 347574857216SHerbert Xu 3476cc0fdd80SLinus Lüssing __br_multicast_open(br, query); 347774857216SHerbert Xu 3478c5b493ceSNikolay Aleksandrov rcu_read_lock(); 3479c5b493ceSNikolay Aleksandrov list_for_each_entry_rcu(port, &br->port_list, list) { 348074857216SHerbert Xu if (port->state == BR_STATE_DISABLED || 348174857216SHerbert Xu port->state == BR_STATE_BLOCKING) 348274857216SHerbert Xu continue; 348374857216SHerbert Xu 348490010b36SLinus Lüssing if (query == &br->ip4_own_query) 348590010b36SLinus Lüssing br_multicast_enable(&port->ip4_own_query); 3486cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 3487cc0fdd80SLinus Lüssing else 348890010b36SLinus Lüssing br_multicast_enable(&port->ip6_own_query); 3489cc0fdd80SLinus Lüssing #endif 349074857216SHerbert Xu } 3491c5b493ceSNikolay Aleksandrov rcu_read_unlock(); 349274857216SHerbert Xu } 349374857216SHerbert Xu 349474857216SHerbert Xu int br_multicast_toggle(struct net_bridge *br, unsigned long val) 349574857216SHerbert Xu { 34967cb3f921SNikolay Aleksandrov struct net_bridge_port *port; 3497851d0a73SJoseph Huang bool change_snoopers = false; 3498561f1103SHerbert Xu 3499ef5e0d82SAndrey Vagin spin_lock_bh(&br->multicast_lock); 350013cefad2SNikolay Aleksandrov if (!!br_opt_get(br, BROPT_MULTICAST_ENABLED) == !!val) 3501561f1103SHerbert Xu goto unlock; 3502561f1103SHerbert Xu 350313cefad2SNikolay Aleksandrov br_mc_disabled_update(br->dev, val); 350413cefad2SNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_ENABLED, !!val); 35054effd28cSLinus Lüssing if (!br_opt_get(br, BROPT_MULTICAST_ENABLED)) { 3506851d0a73SJoseph Huang change_snoopers = true; 3507561f1103SHerbert Xu goto unlock; 35084effd28cSLinus Lüssing } 3509561f1103SHerbert Xu 35103a7fda06SHerbert Xu if (!netif_running(br->dev)) 35113a7fda06SHerbert Xu goto unlock; 35123a7fda06SHerbert Xu 35137cb3f921SNikolay Aleksandrov br_multicast_open(br); 35147cb3f921SNikolay Aleksandrov list_for_each_entry(port, &br->port_list, list) 35157cb3f921SNikolay Aleksandrov __br_multicast_enable_port(port); 3516561f1103SHerbert Xu 3517851d0a73SJoseph Huang change_snoopers = true; 3518851d0a73SJoseph Huang 3519561f1103SHerbert Xu unlock: 3520ef5e0d82SAndrey Vagin spin_unlock_bh(&br->multicast_lock); 3521561f1103SHerbert Xu 3522851d0a73SJoseph Huang /* br_multicast_join_snoopers has the potential to cause 3523851d0a73SJoseph Huang * an MLD Report/Leave to be delivered to br_multicast_rcv, 3524851d0a73SJoseph Huang * which would in turn call br_multicast_add_group, which would 3525851d0a73SJoseph Huang * attempt to acquire multicast_lock. This function should be 3526851d0a73SJoseph Huang * called after the lock has been released to avoid deadlocks on 3527851d0a73SJoseph Huang * multicast_lock. 3528851d0a73SJoseph Huang * 3529851d0a73SJoseph Huang * br_multicast_leave_snoopers does not have the problem since 3530851d0a73SJoseph Huang * br_multicast_rcv first checks BROPT_MULTICAST_ENABLED, and 3531851d0a73SJoseph Huang * returns without calling br_multicast_ipv4/6_rcv if it's not 3532851d0a73SJoseph Huang * enabled. Moved both functions out just for symmetry. 3533851d0a73SJoseph Huang */ 3534851d0a73SJoseph Huang if (change_snoopers) { 3535851d0a73SJoseph Huang if (br_opt_get(br, BROPT_MULTICAST_ENABLED)) 3536851d0a73SJoseph Huang br_multicast_join_snoopers(br); 3537851d0a73SJoseph Huang else 3538851d0a73SJoseph Huang br_multicast_leave_snoopers(br); 3539851d0a73SJoseph Huang } 3540851d0a73SJoseph Huang 3541a26d94bfSYueHaibing return 0; 3542561f1103SHerbert Xu } 3543b195167fSHerbert Xu 35449341b988SIdo Schimmel bool br_multicast_enabled(const struct net_device *dev) 35459341b988SIdo Schimmel { 35469341b988SIdo Schimmel struct net_bridge *br = netdev_priv(dev); 35479341b988SIdo Schimmel 354813cefad2SNikolay Aleksandrov return !!br_opt_get(br, BROPT_MULTICAST_ENABLED); 35499341b988SIdo Schimmel } 35509341b988SIdo Schimmel EXPORT_SYMBOL_GPL(br_multicast_enabled); 35519341b988SIdo Schimmel 35520912bda4SYotam Gigi bool br_multicast_router(const struct net_device *dev) 35530912bda4SYotam Gigi { 35540912bda4SYotam Gigi struct net_bridge *br = netdev_priv(dev); 35550912bda4SYotam Gigi bool is_router; 35560912bda4SYotam Gigi 35570912bda4SYotam Gigi spin_lock_bh(&br->multicast_lock); 35580912bda4SYotam Gigi is_router = br_multicast_is_router(br); 35590912bda4SYotam Gigi spin_unlock_bh(&br->multicast_lock); 35600912bda4SYotam Gigi return is_router; 35610912bda4SYotam Gigi } 35620912bda4SYotam Gigi EXPORT_SYMBOL_GPL(br_multicast_router); 35630912bda4SYotam Gigi 3564c5c23260SHerbert Xu int br_multicast_set_querier(struct net_bridge *br, unsigned long val) 3565c5c23260SHerbert Xu { 3566b00589afSLinus Lüssing unsigned long max_delay; 3567b00589afSLinus Lüssing 3568c5c23260SHerbert Xu val = !!val; 3569c5c23260SHerbert Xu 3570c5c23260SHerbert Xu spin_lock_bh(&br->multicast_lock); 3571675779adSNikolay Aleksandrov if (br_opt_get(br, BROPT_MULTICAST_QUERIER) == val) 3572c5c23260SHerbert Xu goto unlock; 3573c5c23260SHerbert Xu 3574675779adSNikolay Aleksandrov br_opt_toggle(br, BROPT_MULTICAST_QUERIER, !!val); 3575b00589afSLinus Lüssing if (!val) 3576b00589afSLinus Lüssing goto unlock; 3577b00589afSLinus Lüssing 3578b00589afSLinus Lüssing max_delay = br->multicast_query_response_interval; 3579b00589afSLinus Lüssing 358090010b36SLinus Lüssing if (!timer_pending(&br->ip4_other_query.timer)) 358190010b36SLinus Lüssing br->ip4_other_query.delay_time = jiffies + max_delay; 3582cc0fdd80SLinus Lüssing 358390010b36SLinus Lüssing br_multicast_start_querier(br, &br->ip4_own_query); 3584cc0fdd80SLinus Lüssing 3585cc0fdd80SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 358690010b36SLinus Lüssing if (!timer_pending(&br->ip6_other_query.timer)) 358790010b36SLinus Lüssing br->ip6_other_query.delay_time = jiffies + max_delay; 3588cc0fdd80SLinus Lüssing 358990010b36SLinus Lüssing br_multicast_start_querier(br, &br->ip6_own_query); 3590cc0fdd80SLinus Lüssing #endif 3591c5c23260SHerbert Xu 3592c5c23260SHerbert Xu unlock: 3593c5c23260SHerbert Xu spin_unlock_bh(&br->multicast_lock); 3594c5c23260SHerbert Xu 3595c5c23260SHerbert Xu return 0; 3596c5c23260SHerbert Xu } 3597c5c23260SHerbert Xu 35985e923585SNikolay Aleksandrov int br_multicast_set_igmp_version(struct net_bridge *br, unsigned long val) 35995e923585SNikolay Aleksandrov { 36005e923585SNikolay Aleksandrov /* Currently we support only version 2 and 3 */ 36015e923585SNikolay Aleksandrov switch (val) { 36025e923585SNikolay Aleksandrov case 2: 36035e923585SNikolay Aleksandrov case 3: 36045e923585SNikolay Aleksandrov break; 36055e923585SNikolay Aleksandrov default: 36065e923585SNikolay Aleksandrov return -EINVAL; 36075e923585SNikolay Aleksandrov } 36085e923585SNikolay Aleksandrov 36095e923585SNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 36105e923585SNikolay Aleksandrov br->multicast_igmp_version = val; 36115e923585SNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 36125e923585SNikolay Aleksandrov 36135e923585SNikolay Aleksandrov return 0; 36145e923585SNikolay Aleksandrov } 36155e923585SNikolay Aleksandrov 3616aa2ae3e7SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 3617aa2ae3e7SNikolay Aleksandrov int br_multicast_set_mld_version(struct net_bridge *br, unsigned long val) 3618aa2ae3e7SNikolay Aleksandrov { 3619aa2ae3e7SNikolay Aleksandrov /* Currently we support version 1 and 2 */ 3620aa2ae3e7SNikolay Aleksandrov switch (val) { 3621aa2ae3e7SNikolay Aleksandrov case 1: 3622aa2ae3e7SNikolay Aleksandrov case 2: 3623aa2ae3e7SNikolay Aleksandrov break; 3624aa2ae3e7SNikolay Aleksandrov default: 3625aa2ae3e7SNikolay Aleksandrov return -EINVAL; 3626aa2ae3e7SNikolay Aleksandrov } 3627aa2ae3e7SNikolay Aleksandrov 3628aa2ae3e7SNikolay Aleksandrov spin_lock_bh(&br->multicast_lock); 3629aa2ae3e7SNikolay Aleksandrov br->multicast_mld_version = val; 3630aa2ae3e7SNikolay Aleksandrov spin_unlock_bh(&br->multicast_lock); 3631aa2ae3e7SNikolay Aleksandrov 3632aa2ae3e7SNikolay Aleksandrov return 0; 3633aa2ae3e7SNikolay Aleksandrov } 3634aa2ae3e7SNikolay Aleksandrov #endif 3635aa2ae3e7SNikolay Aleksandrov 363607f8ac4aSLinus Lüssing /** 363707f8ac4aSLinus Lüssing * br_multicast_list_adjacent - Returns snooped multicast addresses 363807f8ac4aSLinus Lüssing * @dev: The bridge port adjacent to which to retrieve addresses 363907f8ac4aSLinus Lüssing * @br_ip_list: The list to store found, snooped multicast IP addresses in 364007f8ac4aSLinus Lüssing * 364107f8ac4aSLinus Lüssing * Creates a list of IP addresses (struct br_ip_list) sensed by the multicast 364207f8ac4aSLinus Lüssing * snooping feature on all bridge ports of dev's bridge device, excluding 364307f8ac4aSLinus Lüssing * the addresses from dev itself. 364407f8ac4aSLinus Lüssing * 364507f8ac4aSLinus Lüssing * Returns the number of items added to br_ip_list. 364607f8ac4aSLinus Lüssing * 364707f8ac4aSLinus Lüssing * Notes: 364807f8ac4aSLinus Lüssing * - br_ip_list needs to be initialized by caller 364907f8ac4aSLinus Lüssing * - br_ip_list might contain duplicates in the end 365007f8ac4aSLinus Lüssing * (needs to be taken care of by caller) 365107f8ac4aSLinus Lüssing * - br_ip_list needs to be freed by caller 365207f8ac4aSLinus Lüssing */ 365307f8ac4aSLinus Lüssing int br_multicast_list_adjacent(struct net_device *dev, 365407f8ac4aSLinus Lüssing struct list_head *br_ip_list) 365507f8ac4aSLinus Lüssing { 365607f8ac4aSLinus Lüssing struct net_bridge *br; 365707f8ac4aSLinus Lüssing struct net_bridge_port *port; 365807f8ac4aSLinus Lüssing struct net_bridge_port_group *group; 365907f8ac4aSLinus Lüssing struct br_ip_list *entry; 366007f8ac4aSLinus Lüssing int count = 0; 366107f8ac4aSLinus Lüssing 366207f8ac4aSLinus Lüssing rcu_read_lock(); 366335f861e3SJulian Wiedmann if (!br_ip_list || !netif_is_bridge_port(dev)) 366407f8ac4aSLinus Lüssing goto unlock; 366507f8ac4aSLinus Lüssing 366607f8ac4aSLinus Lüssing port = br_port_get_rcu(dev); 366707f8ac4aSLinus Lüssing if (!port || !port->br) 366807f8ac4aSLinus Lüssing goto unlock; 366907f8ac4aSLinus Lüssing 367007f8ac4aSLinus Lüssing br = port->br; 367107f8ac4aSLinus Lüssing 367207f8ac4aSLinus Lüssing list_for_each_entry_rcu(port, &br->port_list, list) { 367307f8ac4aSLinus Lüssing if (!port->dev || port->dev == dev) 367407f8ac4aSLinus Lüssing continue; 367507f8ac4aSLinus Lüssing 367607f8ac4aSLinus Lüssing hlist_for_each_entry_rcu(group, &port->mglist, mglist) { 367707f8ac4aSLinus Lüssing entry = kmalloc(sizeof(*entry), GFP_ATOMIC); 367807f8ac4aSLinus Lüssing if (!entry) 367907f8ac4aSLinus Lüssing goto unlock; 368007f8ac4aSLinus Lüssing 3681085b53c8SNikolay Aleksandrov entry->addr = group->key.addr; 368207f8ac4aSLinus Lüssing list_add(&entry->list, br_ip_list); 368307f8ac4aSLinus Lüssing count++; 368407f8ac4aSLinus Lüssing } 368507f8ac4aSLinus Lüssing } 368607f8ac4aSLinus Lüssing 368707f8ac4aSLinus Lüssing unlock: 368807f8ac4aSLinus Lüssing rcu_read_unlock(); 368907f8ac4aSLinus Lüssing return count; 369007f8ac4aSLinus Lüssing } 369107f8ac4aSLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_list_adjacent); 36922cd41431SLinus Lüssing 36932cd41431SLinus Lüssing /** 3694c34963e2SLinus Lüssing * br_multicast_has_querier_anywhere - Checks for a querier on a bridge 3695c34963e2SLinus Lüssing * @dev: The bridge port providing the bridge on which to check for a querier 3696c34963e2SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 3697c34963e2SLinus Lüssing * 3698c34963e2SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 3699c34963e2SLinus Lüssing * true if a valid querier exists anywhere on the bridged link layer. 3700c34963e2SLinus Lüssing * Otherwise returns false. 3701c34963e2SLinus Lüssing */ 3702c34963e2SLinus Lüssing bool br_multicast_has_querier_anywhere(struct net_device *dev, int proto) 3703c34963e2SLinus Lüssing { 3704c34963e2SLinus Lüssing struct net_bridge *br; 3705c34963e2SLinus Lüssing struct net_bridge_port *port; 3706c34963e2SLinus Lüssing struct ethhdr eth; 3707c34963e2SLinus Lüssing bool ret = false; 3708c34963e2SLinus Lüssing 3709c34963e2SLinus Lüssing rcu_read_lock(); 371035f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 3711c34963e2SLinus Lüssing goto unlock; 3712c34963e2SLinus Lüssing 3713c34963e2SLinus Lüssing port = br_port_get_rcu(dev); 3714c34963e2SLinus Lüssing if (!port || !port->br) 3715c34963e2SLinus Lüssing goto unlock; 3716c34963e2SLinus Lüssing 3717c34963e2SLinus Lüssing br = port->br; 3718c34963e2SLinus Lüssing 3719c34963e2SLinus Lüssing memset(ð, 0, sizeof(eth)); 3720c34963e2SLinus Lüssing eth.h_proto = htons(proto); 3721c34963e2SLinus Lüssing 3722955062b0SNikolay Aleksandrov ret = br_multicast_querier_exists(br, ð, NULL); 3723c34963e2SLinus Lüssing 3724c34963e2SLinus Lüssing unlock: 3725c34963e2SLinus Lüssing rcu_read_unlock(); 3726c34963e2SLinus Lüssing return ret; 3727c34963e2SLinus Lüssing } 3728c34963e2SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_anywhere); 3729c34963e2SLinus Lüssing 3730c34963e2SLinus Lüssing /** 37312cd41431SLinus Lüssing * br_multicast_has_querier_adjacent - Checks for a querier behind a bridge port 37322cd41431SLinus Lüssing * @dev: The bridge port adjacent to which to check for a querier 37332cd41431SLinus Lüssing * @proto: The protocol family to check for: IGMP -> ETH_P_IP, MLD -> ETH_P_IPV6 37342cd41431SLinus Lüssing * 37352cd41431SLinus Lüssing * Checks whether the given interface has a bridge on top and if so returns 37362cd41431SLinus Lüssing * true if a selected querier is behind one of the other ports of this 37372cd41431SLinus Lüssing * bridge. Otherwise returns false. 37382cd41431SLinus Lüssing */ 37392cd41431SLinus Lüssing bool br_multicast_has_querier_adjacent(struct net_device *dev, int proto) 37402cd41431SLinus Lüssing { 37412cd41431SLinus Lüssing struct net_bridge *br; 37422cd41431SLinus Lüssing struct net_bridge_port *port; 37432cd41431SLinus Lüssing bool ret = false; 37442cd41431SLinus Lüssing 37452cd41431SLinus Lüssing rcu_read_lock(); 374635f861e3SJulian Wiedmann if (!netif_is_bridge_port(dev)) 37472cd41431SLinus Lüssing goto unlock; 37482cd41431SLinus Lüssing 37492cd41431SLinus Lüssing port = br_port_get_rcu(dev); 37502cd41431SLinus Lüssing if (!port || !port->br) 37512cd41431SLinus Lüssing goto unlock; 37522cd41431SLinus Lüssing 37532cd41431SLinus Lüssing br = port->br; 37542cd41431SLinus Lüssing 37552cd41431SLinus Lüssing switch (proto) { 37562cd41431SLinus Lüssing case ETH_P_IP: 37572cd41431SLinus Lüssing if (!timer_pending(&br->ip4_other_query.timer) || 37582cd41431SLinus Lüssing rcu_dereference(br->ip4_querier.port) == port) 37592cd41431SLinus Lüssing goto unlock; 37602cd41431SLinus Lüssing break; 37613993c4e1SLinus Lüssing #if IS_ENABLED(CONFIG_IPV6) 37622cd41431SLinus Lüssing case ETH_P_IPV6: 37632cd41431SLinus Lüssing if (!timer_pending(&br->ip6_other_query.timer) || 37642cd41431SLinus Lüssing rcu_dereference(br->ip6_querier.port) == port) 37652cd41431SLinus Lüssing goto unlock; 37662cd41431SLinus Lüssing break; 37673993c4e1SLinus Lüssing #endif 37682cd41431SLinus Lüssing default: 37692cd41431SLinus Lüssing goto unlock; 37702cd41431SLinus Lüssing } 37712cd41431SLinus Lüssing 37722cd41431SLinus Lüssing ret = true; 37732cd41431SLinus Lüssing unlock: 37742cd41431SLinus Lüssing rcu_read_unlock(); 37752cd41431SLinus Lüssing return ret; 37762cd41431SLinus Lüssing } 37772cd41431SLinus Lüssing EXPORT_SYMBOL_GPL(br_multicast_has_querier_adjacent); 37781080ab95SNikolay Aleksandrov 37791080ab95SNikolay Aleksandrov static void br_mcast_stats_add(struct bridge_mcast_stats __percpu *stats, 3780a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 37811080ab95SNikolay Aleksandrov { 37821080ab95SNikolay Aleksandrov struct bridge_mcast_stats *pstats = this_cpu_ptr(stats); 3783a65056ecSNikolay Aleksandrov __be16 proto = skb->protocol; 3784a65056ecSNikolay Aleksandrov unsigned int t_len; 37851080ab95SNikolay Aleksandrov 37861080ab95SNikolay Aleksandrov u64_stats_update_begin(&pstats->syncp); 37871080ab95SNikolay Aleksandrov switch (proto) { 37881080ab95SNikolay Aleksandrov case htons(ETH_P_IP): 3789a65056ecSNikolay Aleksandrov t_len = ntohs(ip_hdr(skb)->tot_len) - ip_hdrlen(skb); 37901080ab95SNikolay Aleksandrov switch (type) { 37911080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_REPORT: 37921080ab95SNikolay Aleksandrov pstats->mstats.igmp_v1reports[dir]++; 37931080ab95SNikolay Aleksandrov break; 37941080ab95SNikolay Aleksandrov case IGMPV2_HOST_MEMBERSHIP_REPORT: 37951080ab95SNikolay Aleksandrov pstats->mstats.igmp_v2reports[dir]++; 37961080ab95SNikolay Aleksandrov break; 37971080ab95SNikolay Aleksandrov case IGMPV3_HOST_MEMBERSHIP_REPORT: 37981080ab95SNikolay Aleksandrov pstats->mstats.igmp_v3reports[dir]++; 37991080ab95SNikolay Aleksandrov break; 38001080ab95SNikolay Aleksandrov case IGMP_HOST_MEMBERSHIP_QUERY: 3801a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct igmphdr)) { 3802a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v3queries[dir]++; 3803a65056ecSNikolay Aleksandrov } else { 3804a65056ecSNikolay Aleksandrov unsigned int offset = skb_transport_offset(skb); 3805a65056ecSNikolay Aleksandrov struct igmphdr *ih, _ihdr; 3806a65056ecSNikolay Aleksandrov 3807a65056ecSNikolay Aleksandrov ih = skb_header_pointer(skb, offset, 3808a65056ecSNikolay Aleksandrov sizeof(_ihdr), &_ihdr); 3809a65056ecSNikolay Aleksandrov if (!ih) 3810a65056ecSNikolay Aleksandrov break; 3811a65056ecSNikolay Aleksandrov if (!ih->code) 3812a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v1queries[dir]++; 3813a65056ecSNikolay Aleksandrov else 3814a65056ecSNikolay Aleksandrov pstats->mstats.igmp_v2queries[dir]++; 3815a65056ecSNikolay Aleksandrov } 38161080ab95SNikolay Aleksandrov break; 38171080ab95SNikolay Aleksandrov case IGMP_HOST_LEAVE_MESSAGE: 38181080ab95SNikolay Aleksandrov pstats->mstats.igmp_leaves[dir]++; 38191080ab95SNikolay Aleksandrov break; 38201080ab95SNikolay Aleksandrov } 38211080ab95SNikolay Aleksandrov break; 38221080ab95SNikolay Aleksandrov #if IS_ENABLED(CONFIG_IPV6) 38231080ab95SNikolay Aleksandrov case htons(ETH_P_IPV6): 3824a65056ecSNikolay Aleksandrov t_len = ntohs(ipv6_hdr(skb)->payload_len) + 3825a65056ecSNikolay Aleksandrov sizeof(struct ipv6hdr); 3826a65056ecSNikolay Aleksandrov t_len -= skb_network_header_len(skb); 38271080ab95SNikolay Aleksandrov switch (type) { 38281080ab95SNikolay Aleksandrov case ICMPV6_MGM_REPORT: 38291080ab95SNikolay Aleksandrov pstats->mstats.mld_v1reports[dir]++; 38301080ab95SNikolay Aleksandrov break; 38311080ab95SNikolay Aleksandrov case ICMPV6_MLD2_REPORT: 38321080ab95SNikolay Aleksandrov pstats->mstats.mld_v2reports[dir]++; 38331080ab95SNikolay Aleksandrov break; 38341080ab95SNikolay Aleksandrov case ICMPV6_MGM_QUERY: 3835a65056ecSNikolay Aleksandrov if (t_len != sizeof(struct mld_msg)) 3836a65056ecSNikolay Aleksandrov pstats->mstats.mld_v2queries[dir]++; 3837a65056ecSNikolay Aleksandrov else 3838a65056ecSNikolay Aleksandrov pstats->mstats.mld_v1queries[dir]++; 38391080ab95SNikolay Aleksandrov break; 38401080ab95SNikolay Aleksandrov case ICMPV6_MGM_REDUCTION: 38411080ab95SNikolay Aleksandrov pstats->mstats.mld_leaves[dir]++; 38421080ab95SNikolay Aleksandrov break; 38431080ab95SNikolay Aleksandrov } 38441080ab95SNikolay Aleksandrov break; 38451080ab95SNikolay Aleksandrov #endif /* CONFIG_IPV6 */ 38461080ab95SNikolay Aleksandrov } 38471080ab95SNikolay Aleksandrov u64_stats_update_end(&pstats->syncp); 38481080ab95SNikolay Aleksandrov } 38491080ab95SNikolay Aleksandrov 38501080ab95SNikolay Aleksandrov void br_multicast_count(struct net_bridge *br, const struct net_bridge_port *p, 3851a65056ecSNikolay Aleksandrov const struct sk_buff *skb, u8 type, u8 dir) 38521080ab95SNikolay Aleksandrov { 38531080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 38541080ab95SNikolay Aleksandrov 38551080ab95SNikolay Aleksandrov /* if multicast_disabled is true then igmp type can't be set */ 3856675779adSNikolay Aleksandrov if (!type || !br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) 38571080ab95SNikolay Aleksandrov return; 38581080ab95SNikolay Aleksandrov 38591080ab95SNikolay Aleksandrov if (p) 38601080ab95SNikolay Aleksandrov stats = p->mcast_stats; 38611080ab95SNikolay Aleksandrov else 38621080ab95SNikolay Aleksandrov stats = br->mcast_stats; 38631080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 38641080ab95SNikolay Aleksandrov return; 38651080ab95SNikolay Aleksandrov 3866a65056ecSNikolay Aleksandrov br_mcast_stats_add(stats, skb, type, dir); 38671080ab95SNikolay Aleksandrov } 38681080ab95SNikolay Aleksandrov 38691080ab95SNikolay Aleksandrov int br_multicast_init_stats(struct net_bridge *br) 38701080ab95SNikolay Aleksandrov { 38711080ab95SNikolay Aleksandrov br->mcast_stats = netdev_alloc_pcpu_stats(struct bridge_mcast_stats); 38721080ab95SNikolay Aleksandrov if (!br->mcast_stats) 38731080ab95SNikolay Aleksandrov return -ENOMEM; 38741080ab95SNikolay Aleksandrov 38751080ab95SNikolay Aleksandrov return 0; 38761080ab95SNikolay Aleksandrov } 38771080ab95SNikolay Aleksandrov 3878b6fe0440SIdo Schimmel void br_multicast_uninit_stats(struct net_bridge *br) 3879b6fe0440SIdo Schimmel { 3880b6fe0440SIdo Schimmel free_percpu(br->mcast_stats); 3881b6fe0440SIdo Schimmel } 3882b6fe0440SIdo Schimmel 3883b3b6a84cSArnd Bergmann /* noinline for https://bugs.llvm.org/show_bug.cgi?id=45802#c9 */ 3884b3b6a84cSArnd Bergmann static noinline_for_stack void mcast_stats_add_dir(u64 *dst, u64 *src) 38851080ab95SNikolay Aleksandrov { 38861080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_RX] += src[BR_MCAST_DIR_RX]; 38871080ab95SNikolay Aleksandrov dst[BR_MCAST_DIR_TX] += src[BR_MCAST_DIR_TX]; 38881080ab95SNikolay Aleksandrov } 38891080ab95SNikolay Aleksandrov 38901080ab95SNikolay Aleksandrov void br_multicast_get_stats(const struct net_bridge *br, 38911080ab95SNikolay Aleksandrov const struct net_bridge_port *p, 38921080ab95SNikolay Aleksandrov struct br_mcast_stats *dest) 38931080ab95SNikolay Aleksandrov { 38941080ab95SNikolay Aleksandrov struct bridge_mcast_stats __percpu *stats; 38951080ab95SNikolay Aleksandrov struct br_mcast_stats tdst; 38961080ab95SNikolay Aleksandrov int i; 38971080ab95SNikolay Aleksandrov 38981080ab95SNikolay Aleksandrov memset(dest, 0, sizeof(*dest)); 38991080ab95SNikolay Aleksandrov if (p) 39001080ab95SNikolay Aleksandrov stats = p->mcast_stats; 39011080ab95SNikolay Aleksandrov else 39021080ab95SNikolay Aleksandrov stats = br->mcast_stats; 39031080ab95SNikolay Aleksandrov if (WARN_ON(!stats)) 39041080ab95SNikolay Aleksandrov return; 39051080ab95SNikolay Aleksandrov 39061080ab95SNikolay Aleksandrov memset(&tdst, 0, sizeof(tdst)); 39071080ab95SNikolay Aleksandrov for_each_possible_cpu(i) { 39081080ab95SNikolay Aleksandrov struct bridge_mcast_stats *cpu_stats = per_cpu_ptr(stats, i); 39091080ab95SNikolay Aleksandrov struct br_mcast_stats temp; 39101080ab95SNikolay Aleksandrov unsigned int start; 39111080ab95SNikolay Aleksandrov 39121080ab95SNikolay Aleksandrov do { 39131080ab95SNikolay Aleksandrov start = u64_stats_fetch_begin_irq(&cpu_stats->syncp); 39141080ab95SNikolay Aleksandrov memcpy(&temp, &cpu_stats->mstats, sizeof(temp)); 39151080ab95SNikolay Aleksandrov } while (u64_stats_fetch_retry_irq(&cpu_stats->syncp, start)); 39161080ab95SNikolay Aleksandrov 3917a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1queries, temp.igmp_v1queries); 3918a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2queries, temp.igmp_v2queries); 3919a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3queries, temp.igmp_v3queries); 39201080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_leaves, temp.igmp_leaves); 39211080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v1reports, temp.igmp_v1reports); 39221080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v2reports, temp.igmp_v2reports); 39231080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.igmp_v3reports, temp.igmp_v3reports); 39241080ab95SNikolay Aleksandrov tdst.igmp_parse_errors += temp.igmp_parse_errors; 39251080ab95SNikolay Aleksandrov 3926a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1queries, temp.mld_v1queries); 3927a65056ecSNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2queries, temp.mld_v2queries); 39281080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_leaves, temp.mld_leaves); 39291080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v1reports, temp.mld_v1reports); 39301080ab95SNikolay Aleksandrov mcast_stats_add_dir(tdst.mld_v2reports, temp.mld_v2reports); 39311080ab95SNikolay Aleksandrov tdst.mld_parse_errors += temp.mld_parse_errors; 39321080ab95SNikolay Aleksandrov } 39331080ab95SNikolay Aleksandrov memcpy(dest, &tdst, sizeof(*dest)); 39341080ab95SNikolay Aleksandrov } 393519e3a9c9SNikolay Aleksandrov 393619e3a9c9SNikolay Aleksandrov int br_mdb_hash_init(struct net_bridge *br) 393719e3a9c9SNikolay Aleksandrov { 3938085b53c8SNikolay Aleksandrov int err; 3939085b53c8SNikolay Aleksandrov 3940085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->sg_port_tbl, &br_sg_port_rht_params); 3941085b53c8SNikolay Aleksandrov if (err) 3942085b53c8SNikolay Aleksandrov return err; 3943085b53c8SNikolay Aleksandrov 3944085b53c8SNikolay Aleksandrov err = rhashtable_init(&br->mdb_hash_tbl, &br_mdb_rht_params); 3945085b53c8SNikolay Aleksandrov if (err) { 3946085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 3947085b53c8SNikolay Aleksandrov return err; 3948085b53c8SNikolay Aleksandrov } 3949085b53c8SNikolay Aleksandrov 3950085b53c8SNikolay Aleksandrov return 0; 395119e3a9c9SNikolay Aleksandrov } 395219e3a9c9SNikolay Aleksandrov 395319e3a9c9SNikolay Aleksandrov void br_mdb_hash_fini(struct net_bridge *br) 395419e3a9c9SNikolay Aleksandrov { 3955085b53c8SNikolay Aleksandrov rhashtable_destroy(&br->sg_port_tbl); 395619e3a9c9SNikolay Aleksandrov rhashtable_destroy(&br->mdb_hash_tbl); 395719e3a9c9SNikolay Aleksandrov } 3958