11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * Linux NET3: Internet Group Management Protocol [IGMP] 31da177e4SLinus Torvalds * 41da177e4SLinus Torvalds * This code implements the IGMP protocol as defined in RFC1112. There has 51da177e4SLinus Torvalds * been a further revision of this protocol since which is now supported. 61da177e4SLinus Torvalds * 71da177e4SLinus Torvalds * If you have trouble with this module be careful what gcc you have used, 81da177e4SLinus Torvalds * the older version didn't come out right using gcc 2.5.8, the newer one 91da177e4SLinus Torvalds * seems to fall out with gcc 2.6.2. 101da177e4SLinus Torvalds * 111da177e4SLinus Torvalds * Authors: 12113aa838SAlan Cox * Alan Cox <alan@lxorguk.ukuu.org.uk> 131da177e4SLinus Torvalds * 141da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or 151da177e4SLinus Torvalds * modify it under the terms of the GNU General Public License 161da177e4SLinus Torvalds * as published by the Free Software Foundation; either version 171da177e4SLinus Torvalds * 2 of the License, or (at your option) any later version. 181da177e4SLinus Torvalds * 191da177e4SLinus Torvalds * Fixes: 201da177e4SLinus Torvalds * 211da177e4SLinus Torvalds * Alan Cox : Added lots of __inline__ to optimise 221da177e4SLinus Torvalds * the memory usage of all the tiny little 231da177e4SLinus Torvalds * functions. 241da177e4SLinus Torvalds * Alan Cox : Dumped the header building experiment. 251da177e4SLinus Torvalds * Alan Cox : Minor tweaks ready for multicast routing 261da177e4SLinus Torvalds * and extended IGMP protocol. 271da177e4SLinus Torvalds * Alan Cox : Removed a load of inline directives. Gcc 2.5.8 281da177e4SLinus Torvalds * writes utterly bogus code otherwise (sigh) 291da177e4SLinus Torvalds * fixed IGMP loopback to behave in the manner 301da177e4SLinus Torvalds * desired by mrouted, fixed the fact it has been 311da177e4SLinus Torvalds * broken since 1.3.6 and cleaned up a few minor 321da177e4SLinus Torvalds * points. 331da177e4SLinus Torvalds * 341da177e4SLinus Torvalds * Chih-Jen Chang : Tried to revise IGMP to Version 2 351da177e4SLinus Torvalds * Tsu-Sheng Tsao E-mail: chihjenc@scf.usc.edu and tsusheng@scf.usc.edu 361da177e4SLinus Torvalds * The enhancements are mainly based on Steve Deering's 371da177e4SLinus Torvalds * ipmulti-3.5 source code. 381da177e4SLinus Torvalds * Chih-Jen Chang : Added the igmp_get_mrouter_info and 391da177e4SLinus Torvalds * Tsu-Sheng Tsao igmp_set_mrouter_info to keep track of 401da177e4SLinus Torvalds * the mrouted version on that device. 411da177e4SLinus Torvalds * Chih-Jen Chang : Added the max_resp_time parameter to 421da177e4SLinus Torvalds * Tsu-Sheng Tsao igmp_heard_query(). Using this parameter 431da177e4SLinus Torvalds * to identify the multicast router version 441da177e4SLinus Torvalds * and do what the IGMP version 2 specified. 451da177e4SLinus Torvalds * Chih-Jen Chang : Added a timer to revert to IGMP V2 router 461da177e4SLinus Torvalds * Tsu-Sheng Tsao if the specified time expired. 471da177e4SLinus Torvalds * Alan Cox : Stop IGMP from 0.0.0.0 being accepted. 481da177e4SLinus Torvalds * Alan Cox : Use GFP_ATOMIC in the right places. 491da177e4SLinus Torvalds * Christian Daudt : igmp timer wasn't set for local group 501da177e4SLinus Torvalds * memberships but was being deleted, 511da177e4SLinus Torvalds * which caused a "del_timer() called 521da177e4SLinus Torvalds * from %p with timer not initialized\n" 531da177e4SLinus Torvalds * message (960131). 541da177e4SLinus Torvalds * Christian Daudt : removed del_timer from 551da177e4SLinus Torvalds * igmp_timer_expire function (960205). 561da177e4SLinus Torvalds * Christian Daudt : igmp_heard_report now only calls 571da177e4SLinus Torvalds * igmp_timer_expire if tm->running is 581da177e4SLinus Torvalds * true (960216). 591da177e4SLinus Torvalds * Malcolm Beattie : ttl comparison wrong in igmp_rcv made 601da177e4SLinus Torvalds * igmp_heard_query never trigger. Expiry 611da177e4SLinus Torvalds * miscalculation fixed in igmp_heard_query 621da177e4SLinus Torvalds * and random() made to return unsigned to 631da177e4SLinus Torvalds * prevent negative expiry times. 641da177e4SLinus Torvalds * Alexey Kuznetsov: Wrong group leaving behaviour, backport 651da177e4SLinus Torvalds * fix from pending 2.1.x patches. 661da177e4SLinus Torvalds * Alan Cox: Forget to enable FDDI support earlier. 671da177e4SLinus Torvalds * Alexey Kuznetsov: Fixed leaving groups on device down. 681da177e4SLinus Torvalds * Alexey Kuznetsov: Accordance to igmp-v2-06 draft. 691da177e4SLinus Torvalds * David L Stevens: IGMPv3 support, with help from 701da177e4SLinus Torvalds * Vinay Kulkarni 711da177e4SLinus Torvalds */ 721da177e4SLinus Torvalds 731da177e4SLinus Torvalds #include <linux/module.h> 745a0e3ad6STejun Heo #include <linux/slab.h> 751da177e4SLinus Torvalds #include <asm/uaccess.h> 761da177e4SLinus Torvalds #include <linux/types.h> 771da177e4SLinus Torvalds #include <linux/kernel.h> 781da177e4SLinus Torvalds #include <linux/jiffies.h> 791da177e4SLinus Torvalds #include <linux/string.h> 801da177e4SLinus Torvalds #include <linux/socket.h> 811da177e4SLinus Torvalds #include <linux/sockios.h> 821da177e4SLinus Torvalds #include <linux/in.h> 831da177e4SLinus Torvalds #include <linux/inet.h> 841da177e4SLinus Torvalds #include <linux/netdevice.h> 851da177e4SLinus Torvalds #include <linux/skbuff.h> 861da177e4SLinus Torvalds #include <linux/inetdevice.h> 871da177e4SLinus Torvalds #include <linux/igmp.h> 881da177e4SLinus Torvalds #include <linux/if_arp.h> 891da177e4SLinus Torvalds #include <linux/rtnetlink.h> 901da177e4SLinus Torvalds #include <linux/times.h> 919d4a0314SHannes Frederic Sowa #include <linux/pkt_sched.h> 9214c85021SArnaldo Carvalho de Melo 93457c4cbcSEric W. Biederman #include <net/net_namespace.h> 9414c85021SArnaldo Carvalho de Melo #include <net/arp.h> 951da177e4SLinus Torvalds #include <net/ip.h> 961da177e4SLinus Torvalds #include <net/protocol.h> 971da177e4SLinus Torvalds #include <net/route.h> 981da177e4SLinus Torvalds #include <net/sock.h> 991da177e4SLinus Torvalds #include <net/checksum.h> 10093a714d6SMadhu Challa #include <net/inet_common.h> 1011da177e4SLinus Torvalds #include <linux/netfilter_ipv4.h> 1021da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE 1031da177e4SLinus Torvalds #include <linux/mroute.h> 1041da177e4SLinus Torvalds #endif 1051da177e4SLinus Torvalds #ifdef CONFIG_PROC_FS 1061da177e4SLinus Torvalds #include <linux/proc_fs.h> 1071da177e4SLinus Torvalds #include <linux/seq_file.h> 1081da177e4SLinus Torvalds #endif 1091da177e4SLinus Torvalds 1101da177e4SLinus Torvalds #define IP_MAX_MEMBERSHIPS 20 1111da177e4SLinus Torvalds #define IP_MAX_MSF 10 1121da177e4SLinus Torvalds 113df2cf4a7SPhilip Downey /* IGMP reports for link-local multicast groups are enabled by default */ 114df2cf4a7SPhilip Downey int sysctl_igmp_llm_reports __read_mostly = 1; 115df2cf4a7SPhilip Downey 1161da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 1171da177e4SLinus Torvalds /* Parameter names and values are taken from igmp-v2-06 draft */ 1181da177e4SLinus Torvalds 119436f7c20SFabian Frederick #define IGMP_V1_ROUTER_PRESENT_TIMEOUT (400*HZ) 120436f7c20SFabian Frederick #define IGMP_V2_ROUTER_PRESENT_TIMEOUT (400*HZ) 121436f7c20SFabian Frederick #define IGMP_V2_UNSOLICITED_REPORT_INTERVAL (10*HZ) 122436f7c20SFabian Frederick #define IGMP_V3_UNSOLICITED_REPORT_INTERVAL (1*HZ) 123436f7c20SFabian Frederick #define IGMP_QUERY_RESPONSE_INTERVAL (10*HZ) 124436f7c20SFabian Frederick #define IGMP_QUERY_ROBUSTNESS_VARIABLE 2 1251da177e4SLinus Torvalds 1261da177e4SLinus Torvalds 127436f7c20SFabian Frederick #define IGMP_INITIAL_REPORT_DELAY (1) 1281da177e4SLinus Torvalds 129436f7c20SFabian Frederick /* IGMP_INITIAL_REPORT_DELAY is not from IGMP specs! 1301da177e4SLinus Torvalds * IGMP specs require to report membership immediately after 1311da177e4SLinus Torvalds * joining a group, but we delay the first report by a 1321da177e4SLinus Torvalds * small interval. It seems more natural and still does not 1331da177e4SLinus Torvalds * contradict to specs provided this delay is small enough. 1341da177e4SLinus Torvalds */ 1351da177e4SLinus Torvalds 13642f811b8SHerbert Xu #define IGMP_V1_SEEN(in_dev) \ 137c346dca1SYOSHIFUJI Hideaki (IPV4_DEVCONF_ALL(dev_net(in_dev->dev), FORCE_IGMP_VERSION) == 1 || \ 13842f811b8SHerbert Xu IN_DEV_CONF_GET((in_dev), FORCE_IGMP_VERSION) == 1 || \ 1391da177e4SLinus Torvalds ((in_dev)->mr_v1_seen && \ 1401da177e4SLinus Torvalds time_before(jiffies, (in_dev)->mr_v1_seen))) 14142f811b8SHerbert Xu #define IGMP_V2_SEEN(in_dev) \ 142c346dca1SYOSHIFUJI Hideaki (IPV4_DEVCONF_ALL(dev_net(in_dev->dev), FORCE_IGMP_VERSION) == 2 || \ 14342f811b8SHerbert Xu IN_DEV_CONF_GET((in_dev), FORCE_IGMP_VERSION) == 2 || \ 1441da177e4SLinus Torvalds ((in_dev)->mr_v2_seen && \ 1451da177e4SLinus Torvalds time_before(jiffies, (in_dev)->mr_v2_seen))) 1461da177e4SLinus Torvalds 147cab70040SWilliam Manley static int unsolicited_report_interval(struct in_device *in_dev) 148cab70040SWilliam Manley { 1492690048cSWilliam Manley int interval_ms, interval_jiffies; 1502690048cSWilliam Manley 151cab70040SWilliam Manley if (IGMP_V1_SEEN(in_dev) || IGMP_V2_SEEN(in_dev)) 1522690048cSWilliam Manley interval_ms = IN_DEV_CONF_GET( 1532690048cSWilliam Manley in_dev, 1542690048cSWilliam Manley IGMPV2_UNSOLICITED_REPORT_INTERVAL); 155cab70040SWilliam Manley else /* v3 */ 1562690048cSWilliam Manley interval_ms = IN_DEV_CONF_GET( 1572690048cSWilliam Manley in_dev, 1582690048cSWilliam Manley IGMPV3_UNSOLICITED_REPORT_INTERVAL); 1592690048cSWilliam Manley 1602690048cSWilliam Manley interval_jiffies = msecs_to_jiffies(interval_ms); 1612690048cSWilliam Manley 1622690048cSWilliam Manley /* _timer functions can't handle a delay of 0 jiffies so ensure 1632690048cSWilliam Manley * we always return a positive value. 1642690048cSWilliam Manley */ 1652690048cSWilliam Manley if (interval_jiffies <= 0) 1662690048cSWilliam Manley interval_jiffies = 1; 1672690048cSWilliam Manley return interval_jiffies; 168cab70040SWilliam Manley } 169cab70040SWilliam Manley 1701da177e4SLinus Torvalds static void igmpv3_add_delrec(struct in_device *in_dev, struct ip_mc_list *im); 17163007727SAl Viro static void igmpv3_del_delrec(struct in_device *in_dev, __be32 multiaddr); 1721da177e4SLinus Torvalds static void igmpv3_clear_delrec(struct in_device *in_dev); 1731da177e4SLinus Torvalds static int sf_setstate(struct ip_mc_list *pmc); 1741da177e4SLinus Torvalds static void sf_markstate(struct ip_mc_list *pmc); 1751da177e4SLinus Torvalds #endif 1761da177e4SLinus Torvalds static void ip_mc_clear_src(struct ip_mc_list *pmc); 1778f935bbdSAl Viro static int ip_mc_add_src(struct in_device *in_dev, __be32 *pmca, int sfmode, 1788f935bbdSAl Viro int sfcount, __be32 *psfsrc, int delta); 1791da177e4SLinus Torvalds 1801da177e4SLinus Torvalds static void ip_ma_put(struct ip_mc_list *im) 1811da177e4SLinus Torvalds { 1821da177e4SLinus Torvalds if (atomic_dec_and_test(&im->refcnt)) { 1831da177e4SLinus Torvalds in_dev_put(im->interface); 18442ea299dSLai Jiangshan kfree_rcu(im, rcu); 1851da177e4SLinus Torvalds } 1861da177e4SLinus Torvalds } 1871da177e4SLinus Torvalds 188d9aa9380SDavid S. Miller #define for_each_pmc_rcu(in_dev, pmc) \ 189d9aa9380SDavid S. Miller for (pmc = rcu_dereference(in_dev->mc_list); \ 190d9aa9380SDavid S. Miller pmc != NULL; \ 191d9aa9380SDavid S. Miller pmc = rcu_dereference(pmc->next_rcu)) 192d9aa9380SDavid S. Miller 193d9aa9380SDavid S. Miller #define for_each_pmc_rtnl(in_dev, pmc) \ 194d9aa9380SDavid S. Miller for (pmc = rtnl_dereference(in_dev->mc_list); \ 195d9aa9380SDavid S. Miller pmc != NULL; \ 196d9aa9380SDavid S. Miller pmc = rtnl_dereference(pmc->next_rcu)) 197d9aa9380SDavid S. Miller 1981da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 1991da177e4SLinus Torvalds 2001da177e4SLinus Torvalds /* 2011da177e4SLinus Torvalds * Timer management 2021da177e4SLinus Torvalds */ 2031da177e4SLinus Torvalds 2041d7138deSEric Dumazet static void igmp_stop_timer(struct ip_mc_list *im) 2051da177e4SLinus Torvalds { 2061da177e4SLinus Torvalds spin_lock_bh(&im->lock); 2071da177e4SLinus Torvalds if (del_timer(&im->timer)) 2081da177e4SLinus Torvalds atomic_dec(&im->refcnt); 2091da177e4SLinus Torvalds im->tm_running = 0; 2101da177e4SLinus Torvalds im->reporter = 0; 2111da177e4SLinus Torvalds im->unsolicit_count = 0; 2121da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 2131da177e4SLinus Torvalds } 2141da177e4SLinus Torvalds 2151da177e4SLinus Torvalds /* It must be called with locked im->lock */ 2161da177e4SLinus Torvalds static void igmp_start_timer(struct ip_mc_list *im, int max_delay) 2171da177e4SLinus Torvalds { 21863862b5bSAruna-Hewapathirane int tv = prandom_u32() % max_delay; 2191da177e4SLinus Torvalds 2201da177e4SLinus Torvalds im->tm_running = 1; 2211da177e4SLinus Torvalds if (!mod_timer(&im->timer, jiffies+tv+2)) 2221da177e4SLinus Torvalds atomic_inc(&im->refcnt); 2231da177e4SLinus Torvalds } 2241da177e4SLinus Torvalds 2251da177e4SLinus Torvalds static void igmp_gq_start_timer(struct in_device *in_dev) 2261da177e4SLinus Torvalds { 22763862b5bSAruna-Hewapathirane int tv = prandom_u32() % in_dev->mr_maxdelay; 2281da177e4SLinus Torvalds 2291da177e4SLinus Torvalds in_dev->mr_gq_running = 1; 2301da177e4SLinus Torvalds if (!mod_timer(&in_dev->mr_gq_timer, jiffies+tv+2)) 2311da177e4SLinus Torvalds in_dev_hold(in_dev); 2321da177e4SLinus Torvalds } 2331da177e4SLinus Torvalds 2341da177e4SLinus Torvalds static void igmp_ifc_start_timer(struct in_device *in_dev, int delay) 2351da177e4SLinus Torvalds { 23663862b5bSAruna-Hewapathirane int tv = prandom_u32() % delay; 2371da177e4SLinus Torvalds 2381da177e4SLinus Torvalds if (!mod_timer(&in_dev->mr_ifc_timer, jiffies+tv+2)) 2391da177e4SLinus Torvalds in_dev_hold(in_dev); 2401da177e4SLinus Torvalds } 2411da177e4SLinus Torvalds 2421da177e4SLinus Torvalds static void igmp_mod_timer(struct ip_mc_list *im, int max_delay) 2431da177e4SLinus Torvalds { 2441da177e4SLinus Torvalds spin_lock_bh(&im->lock); 2451da177e4SLinus Torvalds im->unsolicit_count = 0; 2461da177e4SLinus Torvalds if (del_timer(&im->timer)) { 2471da177e4SLinus Torvalds if ((long)(im->timer.expires-jiffies) < max_delay) { 2481da177e4SLinus Torvalds add_timer(&im->timer); 2491da177e4SLinus Torvalds im->tm_running = 1; 2501da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 2511da177e4SLinus Torvalds return; 2521da177e4SLinus Torvalds } 2531da177e4SLinus Torvalds atomic_dec(&im->refcnt); 2541da177e4SLinus Torvalds } 2551da177e4SLinus Torvalds igmp_start_timer(im, max_delay); 2561da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 2571da177e4SLinus Torvalds } 2581da177e4SLinus Torvalds 2591da177e4SLinus Torvalds 2601da177e4SLinus Torvalds /* 2611da177e4SLinus Torvalds * Send an IGMP report. 2621da177e4SLinus Torvalds */ 2631da177e4SLinus Torvalds 2641da177e4SLinus Torvalds #define IGMP_SIZE (sizeof(struct igmphdr)+sizeof(struct iphdr)+4) 2651da177e4SLinus Torvalds 2661da177e4SLinus Torvalds 2671da177e4SLinus Torvalds static int is_in(struct ip_mc_list *pmc, struct ip_sf_list *psf, int type, 2681da177e4SLinus Torvalds int gdeleted, int sdeleted) 2691da177e4SLinus Torvalds { 2701da177e4SLinus Torvalds switch (type) { 2711da177e4SLinus Torvalds case IGMPV3_MODE_IS_INCLUDE: 2721da177e4SLinus Torvalds case IGMPV3_MODE_IS_EXCLUDE: 2731da177e4SLinus Torvalds if (gdeleted || sdeleted) 2741da177e4SLinus Torvalds return 0; 275ad12583fSDavid L Stevens if (!(pmc->gsquery && !psf->sf_gsresp)) { 276ad12583fSDavid L Stevens if (pmc->sfmode == MCAST_INCLUDE) 277ad12583fSDavid L Stevens return 1; 278ad12583fSDavid L Stevens /* don't include if this source is excluded 279ad12583fSDavid L Stevens * in all filters 280ad12583fSDavid L Stevens */ 281ad12583fSDavid L Stevens if (psf->sf_count[MCAST_INCLUDE]) 282ad12583fSDavid L Stevens return type == IGMPV3_MODE_IS_INCLUDE; 283ad12583fSDavid L Stevens return pmc->sfcount[MCAST_EXCLUDE] == 284ad12583fSDavid L Stevens psf->sf_count[MCAST_EXCLUDE]; 285ad12583fSDavid L Stevens } 286ad12583fSDavid L Stevens return 0; 2871da177e4SLinus Torvalds case IGMPV3_CHANGE_TO_INCLUDE: 2881da177e4SLinus Torvalds if (gdeleted || sdeleted) 2891da177e4SLinus Torvalds return 0; 2901da177e4SLinus Torvalds return psf->sf_count[MCAST_INCLUDE] != 0; 2911da177e4SLinus Torvalds case IGMPV3_CHANGE_TO_EXCLUDE: 2921da177e4SLinus Torvalds if (gdeleted || sdeleted) 2931da177e4SLinus Torvalds return 0; 2941da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE] == 0 || 2951da177e4SLinus Torvalds psf->sf_count[MCAST_INCLUDE]) 2961da177e4SLinus Torvalds return 0; 2971da177e4SLinus Torvalds return pmc->sfcount[MCAST_EXCLUDE] == 2981da177e4SLinus Torvalds psf->sf_count[MCAST_EXCLUDE]; 2991da177e4SLinus Torvalds case IGMPV3_ALLOW_NEW_SOURCES: 3001da177e4SLinus Torvalds if (gdeleted || !psf->sf_crcount) 3011da177e4SLinus Torvalds return 0; 3021da177e4SLinus Torvalds return (pmc->sfmode == MCAST_INCLUDE) ^ sdeleted; 3031da177e4SLinus Torvalds case IGMPV3_BLOCK_OLD_SOURCES: 3041da177e4SLinus Torvalds if (pmc->sfmode == MCAST_INCLUDE) 3051da177e4SLinus Torvalds return gdeleted || (psf->sf_crcount && sdeleted); 3061da177e4SLinus Torvalds return psf->sf_crcount && !gdeleted && !sdeleted; 3071da177e4SLinus Torvalds } 3081da177e4SLinus Torvalds return 0; 3091da177e4SLinus Torvalds } 3101da177e4SLinus Torvalds 3111da177e4SLinus Torvalds static int 3121da177e4SLinus Torvalds igmp_scount(struct ip_mc_list *pmc, int type, int gdeleted, int sdeleted) 3131da177e4SLinus Torvalds { 3141da177e4SLinus Torvalds struct ip_sf_list *psf; 3151da177e4SLinus Torvalds int scount = 0; 3161da177e4SLinus Torvalds 3171da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) { 3181da177e4SLinus Torvalds if (!is_in(pmc, psf, type, gdeleted, sdeleted)) 3191da177e4SLinus Torvalds continue; 3201da177e4SLinus Torvalds scount++; 3211da177e4SLinus Torvalds } 3221da177e4SLinus Torvalds return scount; 3231da177e4SLinus Torvalds } 3241da177e4SLinus Torvalds 3254c672e4bSDaniel Borkmann static struct sk_buff *igmpv3_newpack(struct net_device *dev, unsigned int mtu) 3261da177e4SLinus Torvalds { 3271da177e4SLinus Torvalds struct sk_buff *skb; 3281da177e4SLinus Torvalds struct rtable *rt; 3291da177e4SLinus Torvalds struct iphdr *pip; 3301da177e4SLinus Torvalds struct igmpv3_report *pig; 331877acedcSDaniel Lezcano struct net *net = dev_net(dev); 33231e4543dSDavid S. Miller struct flowi4 fl4; 33366088243SHerbert Xu int hlen = LL_RESERVED_SPACE(dev); 33466088243SHerbert Xu int tlen = dev->needed_tailroom; 3354c672e4bSDaniel Borkmann unsigned int size = mtu; 3361da177e4SLinus Torvalds 33757e1ab6eSEric Dumazet while (1) { 33866088243SHerbert Xu skb = alloc_skb(size + hlen + tlen, 33957e1ab6eSEric Dumazet GFP_ATOMIC | __GFP_NOWARN); 34057e1ab6eSEric Dumazet if (skb) 34157e1ab6eSEric Dumazet break; 34257e1ab6eSEric Dumazet size >>= 1; 34357e1ab6eSEric Dumazet if (size < 256) 3441da177e4SLinus Torvalds return NULL; 34557e1ab6eSEric Dumazet } 3469d4a0314SHannes Frederic Sowa skb->priority = TC_PRIO_CONTROL; 3471da177e4SLinus Torvalds 34831e4543dSDavid S. Miller rt = ip_route_output_ports(net, &fl4, NULL, IGMPV3_ALL_MCR, 0, 34978fbfd8aSDavid S. Miller 0, 0, 35078fbfd8aSDavid S. Miller IPPROTO_IGMP, 0, dev->ifindex); 351b23dd4feSDavid S. Miller if (IS_ERR(rt)) { 3521da177e4SLinus Torvalds kfree_skb(skb); 3531da177e4SLinus Torvalds return NULL; 3541da177e4SLinus Torvalds } 3551da177e4SLinus Torvalds 356d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 3571da177e4SLinus Torvalds skb->dev = dev; 3581da177e4SLinus Torvalds 3594c672e4bSDaniel Borkmann skb->reserved_tailroom = skb_end_offset(skb) - 3604c672e4bSDaniel Borkmann min(mtu, skb_end_offset(skb)); 36166088243SHerbert Xu skb_reserve(skb, hlen); 3621da177e4SLinus Torvalds 3637e28ecc2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 364eddc9ec5SArnaldo Carvalho de Melo pip = ip_hdr(skb); 3657e28ecc2SArnaldo Carvalho de Melo skb_put(skb, sizeof(struct iphdr) + 4); 3661da177e4SLinus Torvalds 3671da177e4SLinus Torvalds pip->version = 4; 3681da177e4SLinus Torvalds pip->ihl = (sizeof(struct iphdr)+4)>>2; 3691da177e4SLinus Torvalds pip->tos = 0xc0; 3701da177e4SLinus Torvalds pip->frag_off = htons(IP_DF); 3711da177e4SLinus Torvalds pip->ttl = 1; 372492f64ceSDavid S. Miller pip->daddr = fl4.daddr; 373492f64ceSDavid S. Miller pip->saddr = fl4.saddr; 3741da177e4SLinus Torvalds pip->protocol = IPPROTO_IGMP; 3751da177e4SLinus Torvalds pip->tot_len = 0; /* filled in later */ 376b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, NULL); 3771da177e4SLinus Torvalds ((u8 *)&pip[1])[0] = IPOPT_RA; 3781da177e4SLinus Torvalds ((u8 *)&pip[1])[1] = 4; 3791da177e4SLinus Torvalds ((u8 *)&pip[1])[2] = 0; 3801da177e4SLinus Torvalds ((u8 *)&pip[1])[3] = 0; 3811da177e4SLinus Torvalds 382b0e380b1SArnaldo Carvalho de Melo skb->transport_header = skb->network_header + sizeof(struct iphdr) + 4; 383d10ba34bSArnaldo Carvalho de Melo skb_put(skb, sizeof(*pig)); 384d9edf9e2SArnaldo Carvalho de Melo pig = igmpv3_report_hdr(skb); 3851da177e4SLinus Torvalds pig->type = IGMPV3_HOST_MEMBERSHIP_REPORT; 3861da177e4SLinus Torvalds pig->resv1 = 0; 3871da177e4SLinus Torvalds pig->csum = 0; 3881da177e4SLinus Torvalds pig->resv2 = 0; 3891da177e4SLinus Torvalds pig->ngrec = 0; 3901da177e4SLinus Torvalds return skb; 3911da177e4SLinus Torvalds } 3921da177e4SLinus Torvalds 3931da177e4SLinus Torvalds static int igmpv3_sendpack(struct sk_buff *skb) 3941da177e4SLinus Torvalds { 395d9edf9e2SArnaldo Carvalho de Melo struct igmphdr *pig = igmp_hdr(skb); 396f7c0c2aeSSimon Horman const int igmplen = skb_tail_pointer(skb) - skb_transport_header(skb); 3971da177e4SLinus Torvalds 398d9edf9e2SArnaldo Carvalho de Melo pig->csum = ip_compute_csum(igmp_hdr(skb), igmplen); 3991da177e4SLinus Torvalds 40033224b16SEric W. Biederman return ip_local_out(dev_net(skb_dst(skb)->dev), skb->sk, skb); 4011da177e4SLinus Torvalds } 4021da177e4SLinus Torvalds 4031da177e4SLinus Torvalds static int grec_size(struct ip_mc_list *pmc, int type, int gdel, int sdel) 4041da177e4SLinus Torvalds { 4051da177e4SLinus Torvalds return sizeof(struct igmpv3_grec) + 4*igmp_scount(pmc, type, gdel, sdel); 4061da177e4SLinus Torvalds } 4071da177e4SLinus Torvalds 4081da177e4SLinus Torvalds static struct sk_buff *add_grhead(struct sk_buff *skb, struct ip_mc_list *pmc, 4091da177e4SLinus Torvalds int type, struct igmpv3_grec **ppgr) 4101da177e4SLinus Torvalds { 4111da177e4SLinus Torvalds struct net_device *dev = pmc->interface->dev; 4121da177e4SLinus Torvalds struct igmpv3_report *pih; 4131da177e4SLinus Torvalds struct igmpv3_grec *pgr; 4141da177e4SLinus Torvalds 4151da177e4SLinus Torvalds if (!skb) 4161da177e4SLinus Torvalds skb = igmpv3_newpack(dev, dev->mtu); 4171da177e4SLinus Torvalds if (!skb) 4181da177e4SLinus Torvalds return NULL; 4191da177e4SLinus Torvalds pgr = (struct igmpv3_grec *)skb_put(skb, sizeof(struct igmpv3_grec)); 4201da177e4SLinus Torvalds pgr->grec_type = type; 4211da177e4SLinus Torvalds pgr->grec_auxwords = 0; 4221da177e4SLinus Torvalds pgr->grec_nsrcs = 0; 4231da177e4SLinus Torvalds pgr->grec_mca = pmc->multiaddr; 424d9edf9e2SArnaldo Carvalho de Melo pih = igmpv3_report_hdr(skb); 4251da177e4SLinus Torvalds pih->ngrec = htons(ntohs(pih->ngrec)+1); 4261da177e4SLinus Torvalds *ppgr = pgr; 4271da177e4SLinus Torvalds return skb; 4281da177e4SLinus Torvalds } 4291da177e4SLinus Torvalds 4304c672e4bSDaniel Borkmann #define AVAILABLE(skb) ((skb) ? skb_availroom(skb) : 0) 4311da177e4SLinus Torvalds 4321da177e4SLinus Torvalds static struct sk_buff *add_grec(struct sk_buff *skb, struct ip_mc_list *pmc, 4331da177e4SLinus Torvalds int type, int gdeleted, int sdeleted) 4341da177e4SLinus Torvalds { 4351da177e4SLinus Torvalds struct net_device *dev = pmc->interface->dev; 4361da177e4SLinus Torvalds struct igmpv3_report *pih; 4371da177e4SLinus Torvalds struct igmpv3_grec *pgr = NULL; 4381da177e4SLinus Torvalds struct ip_sf_list *psf, *psf_next, *psf_prev, **psf_list; 439ad12583fSDavid L Stevens int scount, stotal, first, isquery, truncate; 4401da177e4SLinus Torvalds 4411da177e4SLinus Torvalds if (pmc->multiaddr == IGMP_ALL_HOSTS) 4421da177e4SLinus Torvalds return skb; 443df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(pmc->multiaddr) && !sysctl_igmp_llm_reports) 444df2cf4a7SPhilip Downey return skb; 4451da177e4SLinus Torvalds 4461da177e4SLinus Torvalds isquery = type == IGMPV3_MODE_IS_INCLUDE || 4471da177e4SLinus Torvalds type == IGMPV3_MODE_IS_EXCLUDE; 4481da177e4SLinus Torvalds truncate = type == IGMPV3_MODE_IS_EXCLUDE || 4491da177e4SLinus Torvalds type == IGMPV3_CHANGE_TO_EXCLUDE; 4501da177e4SLinus Torvalds 451ad12583fSDavid L Stevens stotal = scount = 0; 452ad12583fSDavid L Stevens 4531da177e4SLinus Torvalds psf_list = sdeleted ? &pmc->tomb : &pmc->sources; 4541da177e4SLinus Torvalds 455ad12583fSDavid L Stevens if (!*psf_list) 456ad12583fSDavid L Stevens goto empty_source; 457ad12583fSDavid L Stevens 458d9edf9e2SArnaldo Carvalho de Melo pih = skb ? igmpv3_report_hdr(skb) : NULL; 4591da177e4SLinus Torvalds 4601da177e4SLinus Torvalds /* EX and TO_EX get a fresh packet, if needed */ 4611da177e4SLinus Torvalds if (truncate) { 4621da177e4SLinus Torvalds if (pih && pih->ngrec && 4631da177e4SLinus Torvalds AVAILABLE(skb) < grec_size(pmc, type, gdeleted, sdeleted)) { 4641da177e4SLinus Torvalds if (skb) 4651da177e4SLinus Torvalds igmpv3_sendpack(skb); 4661da177e4SLinus Torvalds skb = igmpv3_newpack(dev, dev->mtu); 4671da177e4SLinus Torvalds } 4681da177e4SLinus Torvalds } 4691da177e4SLinus Torvalds first = 1; 4701da177e4SLinus Torvalds psf_prev = NULL; 4711da177e4SLinus Torvalds for (psf = *psf_list; psf; psf = psf_next) { 472ea4d9e72SAl Viro __be32 *psrc; 4731da177e4SLinus Torvalds 4741da177e4SLinus Torvalds psf_next = psf->sf_next; 4751da177e4SLinus Torvalds 4761da177e4SLinus Torvalds if (!is_in(pmc, psf, type, gdeleted, sdeleted)) { 4771da177e4SLinus Torvalds psf_prev = psf; 4781da177e4SLinus Torvalds continue; 4791da177e4SLinus Torvalds } 4801da177e4SLinus Torvalds 4811da177e4SLinus Torvalds /* clear marks on query responses */ 4821da177e4SLinus Torvalds if (isquery) 4831da177e4SLinus Torvalds psf->sf_gsresp = 0; 4841da177e4SLinus Torvalds 48563007727SAl Viro if (AVAILABLE(skb) < sizeof(__be32) + 4861da177e4SLinus Torvalds first*sizeof(struct igmpv3_grec)) { 4871da177e4SLinus Torvalds if (truncate && !first) 4881da177e4SLinus Torvalds break; /* truncate these */ 4891da177e4SLinus Torvalds if (pgr) 4901da177e4SLinus Torvalds pgr->grec_nsrcs = htons(scount); 4911da177e4SLinus Torvalds if (skb) 4921da177e4SLinus Torvalds igmpv3_sendpack(skb); 4931da177e4SLinus Torvalds skb = igmpv3_newpack(dev, dev->mtu); 4941da177e4SLinus Torvalds first = 1; 4951da177e4SLinus Torvalds scount = 0; 4961da177e4SLinus Torvalds } 4971da177e4SLinus Torvalds if (first) { 4981da177e4SLinus Torvalds skb = add_grhead(skb, pmc, type, &pgr); 4991da177e4SLinus Torvalds first = 0; 5001da177e4SLinus Torvalds } 501cc63f70bSAlexey Dobriyan if (!skb) 502cc63f70bSAlexey Dobriyan return NULL; 50363007727SAl Viro psrc = (__be32 *)skb_put(skb, sizeof(__be32)); 5041da177e4SLinus Torvalds *psrc = psf->sf_inaddr; 505ad12583fSDavid L Stevens scount++; stotal++; 5061da177e4SLinus Torvalds if ((type == IGMPV3_ALLOW_NEW_SOURCES || 5071da177e4SLinus Torvalds type == IGMPV3_BLOCK_OLD_SOURCES) && psf->sf_crcount) { 5081da177e4SLinus Torvalds psf->sf_crcount--; 5091da177e4SLinus Torvalds if ((sdeleted || gdeleted) && psf->sf_crcount == 0) { 5101da177e4SLinus Torvalds if (psf_prev) 5111da177e4SLinus Torvalds psf_prev->sf_next = psf->sf_next; 5121da177e4SLinus Torvalds else 5131da177e4SLinus Torvalds *psf_list = psf->sf_next; 5141da177e4SLinus Torvalds kfree(psf); 5151da177e4SLinus Torvalds continue; 5161da177e4SLinus Torvalds } 5171da177e4SLinus Torvalds } 5181da177e4SLinus Torvalds psf_prev = psf; 5191da177e4SLinus Torvalds } 520ad12583fSDavid L Stevens 521ad12583fSDavid L Stevens empty_source: 522ad12583fSDavid L Stevens if (!stotal) { 523ad12583fSDavid L Stevens if (type == IGMPV3_ALLOW_NEW_SOURCES || 524ad12583fSDavid L Stevens type == IGMPV3_BLOCK_OLD_SOURCES) 525ad12583fSDavid L Stevens return skb; 526ad12583fSDavid L Stevens if (pmc->crcount || isquery) { 527ad12583fSDavid L Stevens /* make sure we have room for group header */ 528ad12583fSDavid L Stevens if (skb && AVAILABLE(skb) < sizeof(struct igmpv3_grec)) { 529ad12583fSDavid L Stevens igmpv3_sendpack(skb); 530ad12583fSDavid L Stevens skb = NULL; /* add_grhead will get a new one */ 531ad12583fSDavid L Stevens } 532ad12583fSDavid L Stevens skb = add_grhead(skb, pmc, type, &pgr); 533ad12583fSDavid L Stevens } 534ad12583fSDavid L Stevens } 5351da177e4SLinus Torvalds if (pgr) 5361da177e4SLinus Torvalds pgr->grec_nsrcs = htons(scount); 5371da177e4SLinus Torvalds 5381da177e4SLinus Torvalds if (isquery) 5391da177e4SLinus Torvalds pmc->gsquery = 0; /* clear query state on report */ 5401da177e4SLinus Torvalds return skb; 5411da177e4SLinus Torvalds } 5421da177e4SLinus Torvalds 5431da177e4SLinus Torvalds static int igmpv3_send_report(struct in_device *in_dev, struct ip_mc_list *pmc) 5441da177e4SLinus Torvalds { 5451da177e4SLinus Torvalds struct sk_buff *skb = NULL; 5461da177e4SLinus Torvalds int type; 5471da177e4SLinus Torvalds 5481da177e4SLinus Torvalds if (!pmc) { 5491d7138deSEric Dumazet rcu_read_lock(); 5501d7138deSEric Dumazet for_each_pmc_rcu(in_dev, pmc) { 5511da177e4SLinus Torvalds if (pmc->multiaddr == IGMP_ALL_HOSTS) 5521da177e4SLinus Torvalds continue; 553df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(pmc->multiaddr) && 554df2cf4a7SPhilip Downey !sysctl_igmp_llm_reports) 555df2cf4a7SPhilip Downey continue; 5561da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 5571da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) 5581da177e4SLinus Torvalds type = IGMPV3_MODE_IS_EXCLUDE; 5591da177e4SLinus Torvalds else 5601da177e4SLinus Torvalds type = IGMPV3_MODE_IS_INCLUDE; 5611da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 0, 0); 5621da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 5631da177e4SLinus Torvalds } 5641d7138deSEric Dumazet rcu_read_unlock(); 5651da177e4SLinus Torvalds } else { 5661da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 5671da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) 5681da177e4SLinus Torvalds type = IGMPV3_MODE_IS_EXCLUDE; 5691da177e4SLinus Torvalds else 5701da177e4SLinus Torvalds type = IGMPV3_MODE_IS_INCLUDE; 5711da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 0, 0); 5721da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 5731da177e4SLinus Torvalds } 5741da177e4SLinus Torvalds if (!skb) 5751da177e4SLinus Torvalds return 0; 5761da177e4SLinus Torvalds return igmpv3_sendpack(skb); 5771da177e4SLinus Torvalds } 5781da177e4SLinus Torvalds 5791da177e4SLinus Torvalds /* 5801da177e4SLinus Torvalds * remove zero-count source records from a source filter list 5811da177e4SLinus Torvalds */ 5821da177e4SLinus Torvalds static void igmpv3_clear_zeros(struct ip_sf_list **ppsf) 5831da177e4SLinus Torvalds { 5841da177e4SLinus Torvalds struct ip_sf_list *psf_prev, *psf_next, *psf; 5851da177e4SLinus Torvalds 5861da177e4SLinus Torvalds psf_prev = NULL; 5871da177e4SLinus Torvalds for (psf = *ppsf; psf; psf = psf_next) { 5881da177e4SLinus Torvalds psf_next = psf->sf_next; 5891da177e4SLinus Torvalds if (psf->sf_crcount == 0) { 5901da177e4SLinus Torvalds if (psf_prev) 5911da177e4SLinus Torvalds psf_prev->sf_next = psf->sf_next; 5921da177e4SLinus Torvalds else 5931da177e4SLinus Torvalds *ppsf = psf->sf_next; 5941da177e4SLinus Torvalds kfree(psf); 5951da177e4SLinus Torvalds } else 5961da177e4SLinus Torvalds psf_prev = psf; 5971da177e4SLinus Torvalds } 5981da177e4SLinus Torvalds } 5991da177e4SLinus Torvalds 6001da177e4SLinus Torvalds static void igmpv3_send_cr(struct in_device *in_dev) 6011da177e4SLinus Torvalds { 6021da177e4SLinus Torvalds struct ip_mc_list *pmc, *pmc_prev, *pmc_next; 6031da177e4SLinus Torvalds struct sk_buff *skb = NULL; 6041da177e4SLinus Torvalds int type, dtype; 6051da177e4SLinus Torvalds 6061d7138deSEric Dumazet rcu_read_lock(); 6071da177e4SLinus Torvalds spin_lock_bh(&in_dev->mc_tomb_lock); 6081da177e4SLinus Torvalds 6091da177e4SLinus Torvalds /* deleted MCA's */ 6101da177e4SLinus Torvalds pmc_prev = NULL; 6111da177e4SLinus Torvalds for (pmc = in_dev->mc_tomb; pmc; pmc = pmc_next) { 6121da177e4SLinus Torvalds pmc_next = pmc->next; 6131da177e4SLinus Torvalds if (pmc->sfmode == MCAST_INCLUDE) { 6141da177e4SLinus Torvalds type = IGMPV3_BLOCK_OLD_SOURCES; 6151da177e4SLinus Torvalds dtype = IGMPV3_BLOCK_OLD_SOURCES; 6161da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 1, 0); 6171da177e4SLinus Torvalds skb = add_grec(skb, pmc, dtype, 1, 1); 6181da177e4SLinus Torvalds } 6191da177e4SLinus Torvalds if (pmc->crcount) { 6201da177e4SLinus Torvalds if (pmc->sfmode == MCAST_EXCLUDE) { 6211da177e4SLinus Torvalds type = IGMPV3_CHANGE_TO_INCLUDE; 6221da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 1, 0); 6231da177e4SLinus Torvalds } 624ad12583fSDavid L Stevens pmc->crcount--; 6251da177e4SLinus Torvalds if (pmc->crcount == 0) { 6261da177e4SLinus Torvalds igmpv3_clear_zeros(&pmc->tomb); 6271da177e4SLinus Torvalds igmpv3_clear_zeros(&pmc->sources); 6281da177e4SLinus Torvalds } 6291da177e4SLinus Torvalds } 6301da177e4SLinus Torvalds if (pmc->crcount == 0 && !pmc->tomb && !pmc->sources) { 6311da177e4SLinus Torvalds if (pmc_prev) 6321da177e4SLinus Torvalds pmc_prev->next = pmc_next; 6331da177e4SLinus Torvalds else 6341da177e4SLinus Torvalds in_dev->mc_tomb = pmc_next; 6351da177e4SLinus Torvalds in_dev_put(pmc->interface); 6361da177e4SLinus Torvalds kfree(pmc); 6371da177e4SLinus Torvalds } else 6381da177e4SLinus Torvalds pmc_prev = pmc; 6391da177e4SLinus Torvalds } 6401da177e4SLinus Torvalds spin_unlock_bh(&in_dev->mc_tomb_lock); 6411da177e4SLinus Torvalds 6421da177e4SLinus Torvalds /* change recs */ 6431d7138deSEric Dumazet for_each_pmc_rcu(in_dev, pmc) { 6441da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 6451da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) { 6461da177e4SLinus Torvalds type = IGMPV3_BLOCK_OLD_SOURCES; 6471da177e4SLinus Torvalds dtype = IGMPV3_ALLOW_NEW_SOURCES; 6481da177e4SLinus Torvalds } else { 6491da177e4SLinus Torvalds type = IGMPV3_ALLOW_NEW_SOURCES; 6501da177e4SLinus Torvalds dtype = IGMPV3_BLOCK_OLD_SOURCES; 6511da177e4SLinus Torvalds } 6521da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 0, 0); 6531da177e4SLinus Torvalds skb = add_grec(skb, pmc, dtype, 0, 1); /* deleted sources */ 6541da177e4SLinus Torvalds 6551da177e4SLinus Torvalds /* filter mode changes */ 6561da177e4SLinus Torvalds if (pmc->crcount) { 6571da177e4SLinus Torvalds if (pmc->sfmode == MCAST_EXCLUDE) 6581da177e4SLinus Torvalds type = IGMPV3_CHANGE_TO_EXCLUDE; 6591da177e4SLinus Torvalds else 6601da177e4SLinus Torvalds type = IGMPV3_CHANGE_TO_INCLUDE; 6611da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 0, 0); 662ad12583fSDavid L Stevens pmc->crcount--; 6631da177e4SLinus Torvalds } 6641da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 6651da177e4SLinus Torvalds } 6661d7138deSEric Dumazet rcu_read_unlock(); 6671da177e4SLinus Torvalds 6681da177e4SLinus Torvalds if (!skb) 6691da177e4SLinus Torvalds return; 6701da177e4SLinus Torvalds (void) igmpv3_sendpack(skb); 6711da177e4SLinus Torvalds } 6721da177e4SLinus Torvalds 6731da177e4SLinus Torvalds static int igmp_send_report(struct in_device *in_dev, struct ip_mc_list *pmc, 6741da177e4SLinus Torvalds int type) 6751da177e4SLinus Torvalds { 6761da177e4SLinus Torvalds struct sk_buff *skb; 6771da177e4SLinus Torvalds struct iphdr *iph; 6781da177e4SLinus Torvalds struct igmphdr *ih; 6791da177e4SLinus Torvalds struct rtable *rt; 6801da177e4SLinus Torvalds struct net_device *dev = in_dev->dev; 681877acedcSDaniel Lezcano struct net *net = dev_net(dev); 68263007727SAl Viro __be32 group = pmc ? pmc->multiaddr : 0; 68331e4543dSDavid S. Miller struct flowi4 fl4; 68463007727SAl Viro __be32 dst; 68566088243SHerbert Xu int hlen, tlen; 6861da177e4SLinus Torvalds 6871da177e4SLinus Torvalds if (type == IGMPV3_HOST_MEMBERSHIP_REPORT) 6881da177e4SLinus Torvalds return igmpv3_send_report(in_dev, pmc); 689df2cf4a7SPhilip Downey 690df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(group) && !sysctl_igmp_llm_reports) 691df2cf4a7SPhilip Downey return 0; 692df2cf4a7SPhilip Downey 693df2cf4a7SPhilip Downey if (type == IGMP_HOST_LEAVE_MESSAGE) 6941da177e4SLinus Torvalds dst = IGMP_ALL_ROUTER; 6951da177e4SLinus Torvalds else 6961da177e4SLinus Torvalds dst = group; 6971da177e4SLinus Torvalds 69831e4543dSDavid S. Miller rt = ip_route_output_ports(net, &fl4, NULL, dst, 0, 69978fbfd8aSDavid S. Miller 0, 0, 70078fbfd8aSDavid S. Miller IPPROTO_IGMP, 0, dev->ifindex); 701b23dd4feSDavid S. Miller if (IS_ERR(rt)) 7021da177e4SLinus Torvalds return -1; 70378fbfd8aSDavid S. Miller 70466088243SHerbert Xu hlen = LL_RESERVED_SPACE(dev); 70566088243SHerbert Xu tlen = dev->needed_tailroom; 70666088243SHerbert Xu skb = alloc_skb(IGMP_SIZE + hlen + tlen, GFP_ATOMIC); 70751456b29SIan Morris if (!skb) { 7081da177e4SLinus Torvalds ip_rt_put(rt); 7091da177e4SLinus Torvalds return -1; 7101da177e4SLinus Torvalds } 7119d4a0314SHannes Frederic Sowa skb->priority = TC_PRIO_CONTROL; 7121da177e4SLinus Torvalds 713d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 7141da177e4SLinus Torvalds 71566088243SHerbert Xu skb_reserve(skb, hlen); 7161da177e4SLinus Torvalds 7177e28ecc2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 718eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 7197e28ecc2SArnaldo Carvalho de Melo skb_put(skb, sizeof(struct iphdr) + 4); 7201da177e4SLinus Torvalds 7211da177e4SLinus Torvalds iph->version = 4; 7221da177e4SLinus Torvalds iph->ihl = (sizeof(struct iphdr)+4)>>2; 7231da177e4SLinus Torvalds iph->tos = 0xc0; 7241da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 7251da177e4SLinus Torvalds iph->ttl = 1; 7261da177e4SLinus Torvalds iph->daddr = dst; 727492f64ceSDavid S. Miller iph->saddr = fl4.saddr; 7281da177e4SLinus Torvalds iph->protocol = IPPROTO_IGMP; 729b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, NULL); 7301da177e4SLinus Torvalds ((u8 *)&iph[1])[0] = IPOPT_RA; 7311da177e4SLinus Torvalds ((u8 *)&iph[1])[1] = 4; 7321da177e4SLinus Torvalds ((u8 *)&iph[1])[2] = 0; 7331da177e4SLinus Torvalds ((u8 *)&iph[1])[3] = 0; 7341da177e4SLinus Torvalds 7351da177e4SLinus Torvalds ih = (struct igmphdr *)skb_put(skb, sizeof(struct igmphdr)); 7361da177e4SLinus Torvalds ih->type = type; 7371da177e4SLinus Torvalds ih->code = 0; 7381da177e4SLinus Torvalds ih->csum = 0; 7391da177e4SLinus Torvalds ih->group = group; 7401da177e4SLinus Torvalds ih->csum = ip_compute_csum((void *)ih, sizeof(struct igmphdr)); 7411da177e4SLinus Torvalds 74233224b16SEric W. Biederman return ip_local_out(net, skb->sk, skb); 7431da177e4SLinus Torvalds } 7441da177e4SLinus Torvalds 7451da177e4SLinus Torvalds static void igmp_gq_timer_expire(unsigned long data) 7461da177e4SLinus Torvalds { 7471da177e4SLinus Torvalds struct in_device *in_dev = (struct in_device *)data; 7481da177e4SLinus Torvalds 7491da177e4SLinus Torvalds in_dev->mr_gq_running = 0; 7501da177e4SLinus Torvalds igmpv3_send_report(in_dev, NULL); 751e2401654SSalam Noureddine in_dev_put(in_dev); 7521da177e4SLinus Torvalds } 7531da177e4SLinus Torvalds 7541da177e4SLinus Torvalds static void igmp_ifc_timer_expire(unsigned long data) 7551da177e4SLinus Torvalds { 7561da177e4SLinus Torvalds struct in_device *in_dev = (struct in_device *)data; 7571da177e4SLinus Torvalds 7581da177e4SLinus Torvalds igmpv3_send_cr(in_dev); 7591da177e4SLinus Torvalds if (in_dev->mr_ifc_count) { 7601da177e4SLinus Torvalds in_dev->mr_ifc_count--; 761cab70040SWilliam Manley igmp_ifc_start_timer(in_dev, 762cab70040SWilliam Manley unsolicited_report_interval(in_dev)); 7631da177e4SLinus Torvalds } 764e2401654SSalam Noureddine in_dev_put(in_dev); 7651da177e4SLinus Torvalds } 7661da177e4SLinus Torvalds 7671da177e4SLinus Torvalds static void igmp_ifc_event(struct in_device *in_dev) 7681da177e4SLinus Torvalds { 7691da177e4SLinus Torvalds if (IGMP_V1_SEEN(in_dev) || IGMP_V2_SEEN(in_dev)) 7701da177e4SLinus Torvalds return; 771a9fe8e29SHannes Frederic Sowa in_dev->mr_ifc_count = in_dev->mr_qrv ?: sysctl_igmp_qrv; 7721da177e4SLinus Torvalds igmp_ifc_start_timer(in_dev, 1); 7731da177e4SLinus Torvalds } 7741da177e4SLinus Torvalds 7751da177e4SLinus Torvalds 7761da177e4SLinus Torvalds static void igmp_timer_expire(unsigned long data) 7771da177e4SLinus Torvalds { 7781da177e4SLinus Torvalds struct ip_mc_list *im = (struct ip_mc_list *)data; 7791da177e4SLinus Torvalds struct in_device *in_dev = im->interface; 7801da177e4SLinus Torvalds 7811da177e4SLinus Torvalds spin_lock(&im->lock); 7821da177e4SLinus Torvalds im->tm_running = 0; 7831da177e4SLinus Torvalds 7841da177e4SLinus Torvalds if (im->unsolicit_count) { 7851da177e4SLinus Torvalds im->unsolicit_count--; 786cab70040SWilliam Manley igmp_start_timer(im, unsolicited_report_interval(in_dev)); 7871da177e4SLinus Torvalds } 7881da177e4SLinus Torvalds im->reporter = 1; 7891da177e4SLinus Torvalds spin_unlock(&im->lock); 7901da177e4SLinus Torvalds 7911da177e4SLinus Torvalds if (IGMP_V1_SEEN(in_dev)) 7921da177e4SLinus Torvalds igmp_send_report(in_dev, im, IGMP_HOST_MEMBERSHIP_REPORT); 7931da177e4SLinus Torvalds else if (IGMP_V2_SEEN(in_dev)) 7941da177e4SLinus Torvalds igmp_send_report(in_dev, im, IGMPV2_HOST_MEMBERSHIP_REPORT); 7951da177e4SLinus Torvalds else 7961da177e4SLinus Torvalds igmp_send_report(in_dev, im, IGMPV3_HOST_MEMBERSHIP_REPORT); 7971da177e4SLinus Torvalds 7981da177e4SLinus Torvalds ip_ma_put(im); 7991da177e4SLinus Torvalds } 8001da177e4SLinus Torvalds 801ad12583fSDavid L Stevens /* mark EXCLUDE-mode sources */ 802ea4d9e72SAl Viro static int igmp_xmarksources(struct ip_mc_list *pmc, int nsrcs, __be32 *srcs) 8031da177e4SLinus Torvalds { 8041da177e4SLinus Torvalds struct ip_sf_list *psf; 8051da177e4SLinus Torvalds int i, scount; 8061da177e4SLinus Torvalds 8071da177e4SLinus Torvalds scount = 0; 8081da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) { 8091da177e4SLinus Torvalds if (scount == nsrcs) 8101da177e4SLinus Torvalds break; 811ad12583fSDavid L Stevens for (i = 0; i < nsrcs; i++) { 812ad12583fSDavid L Stevens /* skip inactive filters */ 813e05c4ad3SYan, Zheng if (psf->sf_count[MCAST_INCLUDE] || 814ad12583fSDavid L Stevens pmc->sfcount[MCAST_EXCLUDE] != 815ad12583fSDavid L Stevens psf->sf_count[MCAST_EXCLUDE]) 816ce713ee5SRongQing.Li break; 817ad12583fSDavid L Stevens if (srcs[i] == psf->sf_inaddr) { 818ad12583fSDavid L Stevens scount++; 819ad12583fSDavid L Stevens break; 820ad12583fSDavid L Stevens } 821ad12583fSDavid L Stevens } 822ad12583fSDavid L Stevens } 823ad12583fSDavid L Stevens pmc->gsquery = 0; 824ad12583fSDavid L Stevens if (scount == nsrcs) /* all sources excluded */ 825ad12583fSDavid L Stevens return 0; 826ad12583fSDavid L Stevens return 1; 827ad12583fSDavid L Stevens } 828ad12583fSDavid L Stevens 829ea4d9e72SAl Viro static int igmp_marksources(struct ip_mc_list *pmc, int nsrcs, __be32 *srcs) 830ad12583fSDavid L Stevens { 831ad12583fSDavid L Stevens struct ip_sf_list *psf; 832ad12583fSDavid L Stevens int i, scount; 833ad12583fSDavid L Stevens 834ad12583fSDavid L Stevens if (pmc->sfmode == MCAST_EXCLUDE) 835ad12583fSDavid L Stevens return igmp_xmarksources(pmc, nsrcs, srcs); 836ad12583fSDavid L Stevens 837ad12583fSDavid L Stevens /* mark INCLUDE-mode sources */ 838ad12583fSDavid L Stevens scount = 0; 839ad12583fSDavid L Stevens for (psf = pmc->sources; psf; psf = psf->sf_next) { 840ad12583fSDavid L Stevens if (scount == nsrcs) 841ad12583fSDavid L Stevens break; 8421da177e4SLinus Torvalds for (i = 0; i < nsrcs; i++) 8431da177e4SLinus Torvalds if (srcs[i] == psf->sf_inaddr) { 8441da177e4SLinus Torvalds psf->sf_gsresp = 1; 8451da177e4SLinus Torvalds scount++; 8461da177e4SLinus Torvalds break; 8471da177e4SLinus Torvalds } 8481da177e4SLinus Torvalds } 849ad12583fSDavid L Stevens if (!scount) { 850ad12583fSDavid L Stevens pmc->gsquery = 0; 851ad12583fSDavid L Stevens return 0; 852ad12583fSDavid L Stevens } 853ad12583fSDavid L Stevens pmc->gsquery = 1; 854ad12583fSDavid L Stevens return 1; 8551da177e4SLinus Torvalds } 8561da177e4SLinus Torvalds 857d679c532SEric Dumazet /* return true if packet was dropped */ 858d679c532SEric Dumazet static bool igmp_heard_report(struct in_device *in_dev, __be32 group) 8591da177e4SLinus Torvalds { 8601da177e4SLinus Torvalds struct ip_mc_list *im; 8611da177e4SLinus Torvalds 8621da177e4SLinus Torvalds /* Timers are only set for non-local groups */ 8631da177e4SLinus Torvalds 8641da177e4SLinus Torvalds if (group == IGMP_ALL_HOSTS) 865d679c532SEric Dumazet return false; 866df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(group) && !sysctl_igmp_llm_reports) 867df2cf4a7SPhilip Downey return false; 8681da177e4SLinus Torvalds 8691d7138deSEric Dumazet rcu_read_lock(); 8701d7138deSEric Dumazet for_each_pmc_rcu(in_dev, im) { 8711da177e4SLinus Torvalds if (im->multiaddr == group) { 8721da177e4SLinus Torvalds igmp_stop_timer(im); 8731da177e4SLinus Torvalds break; 8741da177e4SLinus Torvalds } 8751da177e4SLinus Torvalds } 8761d7138deSEric Dumazet rcu_read_unlock(); 877d679c532SEric Dumazet return false; 8781da177e4SLinus Torvalds } 8791da177e4SLinus Torvalds 880d679c532SEric Dumazet /* return true if packet was dropped */ 881d679c532SEric Dumazet static bool igmp_heard_query(struct in_device *in_dev, struct sk_buff *skb, 8821da177e4SLinus Torvalds int len) 8831da177e4SLinus Torvalds { 884d9edf9e2SArnaldo Carvalho de Melo struct igmphdr *ih = igmp_hdr(skb); 885d9edf9e2SArnaldo Carvalho de Melo struct igmpv3_query *ih3 = igmpv3_query_hdr(skb); 8861da177e4SLinus Torvalds struct ip_mc_list *im; 88763007727SAl Viro __be32 group = ih->group; 8881da177e4SLinus Torvalds int max_delay; 8891da177e4SLinus Torvalds int mark = 0; 8901da177e4SLinus Torvalds 8911da177e4SLinus Torvalds 8925b7c8406SDavid Stevens if (len == 8) { 8931da177e4SLinus Torvalds if (ih->code == 0) { 8941da177e4SLinus Torvalds /* Alas, old v1 router presents here. */ 8951da177e4SLinus Torvalds 896436f7c20SFabian Frederick max_delay = IGMP_QUERY_RESPONSE_INTERVAL; 8971da177e4SLinus Torvalds in_dev->mr_v1_seen = jiffies + 898436f7c20SFabian Frederick IGMP_V1_ROUTER_PRESENT_TIMEOUT; 8991da177e4SLinus Torvalds group = 0; 9001da177e4SLinus Torvalds } else { 9011da177e4SLinus Torvalds /* v2 router present */ 9021da177e4SLinus Torvalds max_delay = ih->code*(HZ/IGMP_TIMER_SCALE); 9031da177e4SLinus Torvalds in_dev->mr_v2_seen = jiffies + 904436f7c20SFabian Frederick IGMP_V2_ROUTER_PRESENT_TIMEOUT; 9051da177e4SLinus Torvalds } 9061da177e4SLinus Torvalds /* cancel the interface change timer */ 9071da177e4SLinus Torvalds in_dev->mr_ifc_count = 0; 9081da177e4SLinus Torvalds if (del_timer(&in_dev->mr_ifc_timer)) 9091da177e4SLinus Torvalds __in_dev_put(in_dev); 9101da177e4SLinus Torvalds /* clear deleted report items */ 9111da177e4SLinus Torvalds igmpv3_clear_delrec(in_dev); 9121da177e4SLinus Torvalds } else if (len < 12) { 913d679c532SEric Dumazet return true; /* ignore bogus packet; freed by caller */ 9145b7c8406SDavid Stevens } else if (IGMP_V1_SEEN(in_dev)) { 9155b7c8406SDavid Stevens /* This is a v3 query with v1 queriers present */ 916436f7c20SFabian Frederick max_delay = IGMP_QUERY_RESPONSE_INTERVAL; 9175b7c8406SDavid Stevens group = 0; 9185b7c8406SDavid Stevens } else if (IGMP_V2_SEEN(in_dev)) { 9195b7c8406SDavid Stevens /* this is a v3 query with v2 queriers present; 9205b7c8406SDavid Stevens * Interpretation of the max_delay code is problematic here. 9215b7c8406SDavid Stevens * A real v2 host would use ih_code directly, while v3 has a 9225b7c8406SDavid Stevens * different encoding. We use the v3 encoding as more likely 9235b7c8406SDavid Stevens * to be intended in a v3 query. 9245b7c8406SDavid Stevens */ 9255b7c8406SDavid Stevens max_delay = IGMPV3_MRC(ih3->code)*(HZ/IGMP_TIMER_SCALE); 926a8c1f65cSBen Hutchings if (!max_delay) 927a8c1f65cSBen Hutchings max_delay = 1; /* can't mod w/ 0 */ 9281da177e4SLinus Torvalds } else { /* v3 */ 9291da177e4SLinus Torvalds if (!pskb_may_pull(skb, sizeof(struct igmpv3_query))) 930d679c532SEric Dumazet return true; 9311da177e4SLinus Torvalds 932d9edf9e2SArnaldo Carvalho de Melo ih3 = igmpv3_query_hdr(skb); 9331da177e4SLinus Torvalds if (ih3->nsrcs) { 9341da177e4SLinus Torvalds if (!pskb_may_pull(skb, sizeof(struct igmpv3_query) 93563007727SAl Viro + ntohs(ih3->nsrcs)*sizeof(__be32))) 936d679c532SEric Dumazet return true; 937d9edf9e2SArnaldo Carvalho de Melo ih3 = igmpv3_query_hdr(skb); 9381da177e4SLinus Torvalds } 9391da177e4SLinus Torvalds 9401da177e4SLinus Torvalds max_delay = IGMPV3_MRC(ih3->code)*(HZ/IGMP_TIMER_SCALE); 9411da177e4SLinus Torvalds if (!max_delay) 9421da177e4SLinus Torvalds max_delay = 1; /* can't mod w/ 0 */ 9431da177e4SLinus Torvalds in_dev->mr_maxdelay = max_delay; 9441da177e4SLinus Torvalds if (ih3->qrv) 9451da177e4SLinus Torvalds in_dev->mr_qrv = ih3->qrv; 9461da177e4SLinus Torvalds if (!group) { /* general query */ 9471da177e4SLinus Torvalds if (ih3->nsrcs) 948b47bd8d2SDaniel Borkmann return true; /* no sources allowed */ 9491da177e4SLinus Torvalds igmp_gq_start_timer(in_dev); 950d679c532SEric Dumazet return false; 9511da177e4SLinus Torvalds } 9521da177e4SLinus Torvalds /* mark sources to include, if group & source-specific */ 9531da177e4SLinus Torvalds mark = ih3->nsrcs != 0; 9541da177e4SLinus Torvalds } 9551da177e4SLinus Torvalds 9561da177e4SLinus Torvalds /* 9571da177e4SLinus Torvalds * - Start the timers in all of our membership records 9581da177e4SLinus Torvalds * that the query applies to for the interface on 9591da177e4SLinus Torvalds * which the query arrived excl. those that belong 9601da177e4SLinus Torvalds * to a "local" group (224.0.0.X) 9611da177e4SLinus Torvalds * - For timers already running check if they need to 9621da177e4SLinus Torvalds * be reset. 9631da177e4SLinus Torvalds * - Use the igmp->igmp_code field as the maximum 9641da177e4SLinus Torvalds * delay possible 9651da177e4SLinus Torvalds */ 9661d7138deSEric Dumazet rcu_read_lock(); 9671d7138deSEric Dumazet for_each_pmc_rcu(in_dev, im) { 968ad12583fSDavid L Stevens int changed; 969ad12583fSDavid L Stevens 9701da177e4SLinus Torvalds if (group && group != im->multiaddr) 9711da177e4SLinus Torvalds continue; 9721da177e4SLinus Torvalds if (im->multiaddr == IGMP_ALL_HOSTS) 9731da177e4SLinus Torvalds continue; 974df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(im->multiaddr) && 975df2cf4a7SPhilip Downey !sysctl_igmp_llm_reports) 976df2cf4a7SPhilip Downey continue; 9771da177e4SLinus Torvalds spin_lock_bh(&im->lock); 9781da177e4SLinus Torvalds if (im->tm_running) 9791da177e4SLinus Torvalds im->gsquery = im->gsquery && mark; 9801da177e4SLinus Torvalds else 9811da177e4SLinus Torvalds im->gsquery = mark; 982ad12583fSDavid L Stevens changed = !im->gsquery || 9831da177e4SLinus Torvalds igmp_marksources(im, ntohs(ih3->nsrcs), ih3->srcs); 9841da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 985ad12583fSDavid L Stevens if (changed) 9861da177e4SLinus Torvalds igmp_mod_timer(im, max_delay); 9871da177e4SLinus Torvalds } 9881d7138deSEric Dumazet rcu_read_unlock(); 989d679c532SEric Dumazet return false; 9901da177e4SLinus Torvalds } 9911da177e4SLinus Torvalds 9929a57a9d2SEric Dumazet /* called in rcu_read_lock() section */ 9931da177e4SLinus Torvalds int igmp_rcv(struct sk_buff *skb) 9941da177e4SLinus Torvalds { 9951da177e4SLinus Torvalds /* This basically follows the spec line by line -- see RFC1112 */ 9961da177e4SLinus Torvalds struct igmphdr *ih; 9979a57a9d2SEric Dumazet struct in_device *in_dev = __in_dev_get_rcu(skb->dev); 9981da177e4SLinus Torvalds int len = skb->len; 999d679c532SEric Dumazet bool dropped = true; 10001da177e4SLinus Torvalds 100151456b29SIan Morris if (!in_dev) 1002cd557bc1SDenis V. Lunev goto drop; 10031da177e4SLinus Torvalds 1004fb286bb2SHerbert Xu if (!pskb_may_pull(skb, sizeof(struct igmphdr))) 10059a57a9d2SEric Dumazet goto drop; 1006fb286bb2SHerbert Xu 1007de08dc1aSTom Herbert if (skb_checksum_simple_validate(skb)) 10089a57a9d2SEric Dumazet goto drop; 10091da177e4SLinus Torvalds 1010d9edf9e2SArnaldo Carvalho de Melo ih = igmp_hdr(skb); 10111da177e4SLinus Torvalds switch (ih->type) { 10121da177e4SLinus Torvalds case IGMP_HOST_MEMBERSHIP_QUERY: 1013d679c532SEric Dumazet dropped = igmp_heard_query(in_dev, skb, len); 10141da177e4SLinus Torvalds break; 10151da177e4SLinus Torvalds case IGMP_HOST_MEMBERSHIP_REPORT: 10161da177e4SLinus Torvalds case IGMPV2_HOST_MEMBERSHIP_REPORT: 10171da177e4SLinus Torvalds /* Is it our report looped back? */ 1018c7537967SDavid S. Miller if (rt_is_output_route(skb_rtable(skb))) 10191da177e4SLinus Torvalds break; 102024c69275SDavid Stevens /* don't rely on MC router hearing unicast reports */ 102124c69275SDavid Stevens if (skb->pkt_type == PACKET_MULTICAST || 102224c69275SDavid Stevens skb->pkt_type == PACKET_BROADCAST) 1023d679c532SEric Dumazet dropped = igmp_heard_report(in_dev, ih->group); 10241da177e4SLinus Torvalds break; 10251da177e4SLinus Torvalds case IGMP_PIM: 10261da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM_V1 10271da177e4SLinus Torvalds return pim_rcv_v1(skb); 10281da177e4SLinus Torvalds #endif 1029c6b471e6SHerbert Xu case IGMPV3_HOST_MEMBERSHIP_REPORT: 10301da177e4SLinus Torvalds case IGMP_DVMRP: 10311da177e4SLinus Torvalds case IGMP_TRACE: 10321da177e4SLinus Torvalds case IGMP_HOST_LEAVE_MESSAGE: 10331da177e4SLinus Torvalds case IGMP_MTRACE: 10341da177e4SLinus Torvalds case IGMP_MTRACE_RESP: 10351da177e4SLinus Torvalds break; 10361da177e4SLinus Torvalds default: 1037dd1c1853SLinus Torvalds break; 10381da177e4SLinus Torvalds } 1039fb286bb2SHerbert Xu 1040cd557bc1SDenis V. Lunev drop: 1041d679c532SEric Dumazet if (dropped) 10421da177e4SLinus Torvalds kfree_skb(skb); 1043d679c532SEric Dumazet else 1044d679c532SEric Dumazet consume_skb(skb); 10451da177e4SLinus Torvalds return 0; 10461da177e4SLinus Torvalds } 10471da177e4SLinus Torvalds 10481da177e4SLinus Torvalds #endif 10491da177e4SLinus Torvalds 10501da177e4SLinus Torvalds 10511da177e4SLinus Torvalds /* 10521da177e4SLinus Torvalds * Add a filter to a device 10531da177e4SLinus Torvalds */ 10541da177e4SLinus Torvalds 105563007727SAl Viro static void ip_mc_filter_add(struct in_device *in_dev, __be32 addr) 10561da177e4SLinus Torvalds { 10571da177e4SLinus Torvalds char buf[MAX_ADDR_LEN]; 10581da177e4SLinus Torvalds struct net_device *dev = in_dev->dev; 10591da177e4SLinus Torvalds 10601da177e4SLinus Torvalds /* Checking for IFF_MULTICAST here is WRONG-WRONG-WRONG. 10611da177e4SLinus Torvalds We will get multicast token leakage, when IFF_MULTICAST 1062b81693d9SJiri Pirko is changed. This check should be done in ndo_set_rx_mode 10631da177e4SLinus Torvalds routine. Something sort of: 10641da177e4SLinus Torvalds if (dev->mc_list && dev->flags&IFF_MULTICAST) { do it; } 10651da177e4SLinus Torvalds --ANK 10661da177e4SLinus Torvalds */ 10671da177e4SLinus Torvalds if (arp_mc_map(addr, buf, dev, 0) == 0) 106822bedad3SJiri Pirko dev_mc_add(dev, buf); 10691da177e4SLinus Torvalds } 10701da177e4SLinus Torvalds 10711da177e4SLinus Torvalds /* 10721da177e4SLinus Torvalds * Remove a filter from a device 10731da177e4SLinus Torvalds */ 10741da177e4SLinus Torvalds 107563007727SAl Viro static void ip_mc_filter_del(struct in_device *in_dev, __be32 addr) 10761da177e4SLinus Torvalds { 10771da177e4SLinus Torvalds char buf[MAX_ADDR_LEN]; 10781da177e4SLinus Torvalds struct net_device *dev = in_dev->dev; 10791da177e4SLinus Torvalds 10801da177e4SLinus Torvalds if (arp_mc_map(addr, buf, dev, 0) == 0) 108122bedad3SJiri Pirko dev_mc_del(dev, buf); 10821da177e4SLinus Torvalds } 10831da177e4SLinus Torvalds 10841da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 10851da177e4SLinus Torvalds /* 10861da177e4SLinus Torvalds * deleted ip_mc_list manipulation 10871da177e4SLinus Torvalds */ 10881da177e4SLinus Torvalds static void igmpv3_add_delrec(struct in_device *in_dev, struct ip_mc_list *im) 10891da177e4SLinus Torvalds { 10901da177e4SLinus Torvalds struct ip_mc_list *pmc; 10911da177e4SLinus Torvalds 10921da177e4SLinus Torvalds /* this is an "ip_mc_list" for convenience; only the fields below 10931da177e4SLinus Torvalds * are actually used. In particular, the refcnt and users are not 10941da177e4SLinus Torvalds * used for management of the delete list. Using the same structure 10951da177e4SLinus Torvalds * for deleted items allows change reports to use common code with 10961da177e4SLinus Torvalds * non-deleted or query-response MCA's. 10971da177e4SLinus Torvalds */ 10980da974f4SPanagiotis Issaris pmc = kzalloc(sizeof(*pmc), GFP_KERNEL); 10991da177e4SLinus Torvalds if (!pmc) 11001da177e4SLinus Torvalds return; 11011da177e4SLinus Torvalds spin_lock_bh(&im->lock); 11021da177e4SLinus Torvalds pmc->interface = im->interface; 11031da177e4SLinus Torvalds in_dev_hold(in_dev); 11041da177e4SLinus Torvalds pmc->multiaddr = im->multiaddr; 1105a9fe8e29SHannes Frederic Sowa pmc->crcount = in_dev->mr_qrv ?: sysctl_igmp_qrv; 11061da177e4SLinus Torvalds pmc->sfmode = im->sfmode; 11071da177e4SLinus Torvalds if (pmc->sfmode == MCAST_INCLUDE) { 11081da177e4SLinus Torvalds struct ip_sf_list *psf; 11091da177e4SLinus Torvalds 11101da177e4SLinus Torvalds pmc->tomb = im->tomb; 11111da177e4SLinus Torvalds pmc->sources = im->sources; 11121da177e4SLinus Torvalds im->tomb = im->sources = NULL; 11131da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) 11141da177e4SLinus Torvalds psf->sf_crcount = pmc->crcount; 11151da177e4SLinus Torvalds } 11161da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 11171da177e4SLinus Torvalds 11181da177e4SLinus Torvalds spin_lock_bh(&in_dev->mc_tomb_lock); 11191da177e4SLinus Torvalds pmc->next = in_dev->mc_tomb; 11201da177e4SLinus Torvalds in_dev->mc_tomb = pmc; 11211da177e4SLinus Torvalds spin_unlock_bh(&in_dev->mc_tomb_lock); 11221da177e4SLinus Torvalds } 11231da177e4SLinus Torvalds 112463007727SAl Viro static void igmpv3_del_delrec(struct in_device *in_dev, __be32 multiaddr) 11251da177e4SLinus Torvalds { 11261da177e4SLinus Torvalds struct ip_mc_list *pmc, *pmc_prev; 11271da177e4SLinus Torvalds struct ip_sf_list *psf, *psf_next; 11281da177e4SLinus Torvalds 11291da177e4SLinus Torvalds spin_lock_bh(&in_dev->mc_tomb_lock); 11301da177e4SLinus Torvalds pmc_prev = NULL; 11311da177e4SLinus Torvalds for (pmc = in_dev->mc_tomb; pmc; pmc = pmc->next) { 11321da177e4SLinus Torvalds if (pmc->multiaddr == multiaddr) 11331da177e4SLinus Torvalds break; 11341da177e4SLinus Torvalds pmc_prev = pmc; 11351da177e4SLinus Torvalds } 11361da177e4SLinus Torvalds if (pmc) { 11371da177e4SLinus Torvalds if (pmc_prev) 11381da177e4SLinus Torvalds pmc_prev->next = pmc->next; 11391da177e4SLinus Torvalds else 11401da177e4SLinus Torvalds in_dev->mc_tomb = pmc->next; 11411da177e4SLinus Torvalds } 11421da177e4SLinus Torvalds spin_unlock_bh(&in_dev->mc_tomb_lock); 11431da177e4SLinus Torvalds if (pmc) { 11441da177e4SLinus Torvalds for (psf = pmc->tomb; psf; psf = psf_next) { 11451da177e4SLinus Torvalds psf_next = psf->sf_next; 11461da177e4SLinus Torvalds kfree(psf); 11471da177e4SLinus Torvalds } 11481da177e4SLinus Torvalds in_dev_put(pmc->interface); 11491da177e4SLinus Torvalds kfree(pmc); 11501da177e4SLinus Torvalds } 11511da177e4SLinus Torvalds } 11521da177e4SLinus Torvalds 11531da177e4SLinus Torvalds static void igmpv3_clear_delrec(struct in_device *in_dev) 11541da177e4SLinus Torvalds { 11551da177e4SLinus Torvalds struct ip_mc_list *pmc, *nextpmc; 11561da177e4SLinus Torvalds 11571da177e4SLinus Torvalds spin_lock_bh(&in_dev->mc_tomb_lock); 11581da177e4SLinus Torvalds pmc = in_dev->mc_tomb; 11591da177e4SLinus Torvalds in_dev->mc_tomb = NULL; 11601da177e4SLinus Torvalds spin_unlock_bh(&in_dev->mc_tomb_lock); 11611da177e4SLinus Torvalds 11621da177e4SLinus Torvalds for (; pmc; pmc = nextpmc) { 11631da177e4SLinus Torvalds nextpmc = pmc->next; 11641da177e4SLinus Torvalds ip_mc_clear_src(pmc); 11651da177e4SLinus Torvalds in_dev_put(pmc->interface); 11661da177e4SLinus Torvalds kfree(pmc); 11671da177e4SLinus Torvalds } 11681da177e4SLinus Torvalds /* clear dead sources, too */ 11691d7138deSEric Dumazet rcu_read_lock(); 11701d7138deSEric Dumazet for_each_pmc_rcu(in_dev, pmc) { 11711da177e4SLinus Torvalds struct ip_sf_list *psf, *psf_next; 11721da177e4SLinus Torvalds 11731da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 11741da177e4SLinus Torvalds psf = pmc->tomb; 11751da177e4SLinus Torvalds pmc->tomb = NULL; 11761da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 11771da177e4SLinus Torvalds for (; psf; psf = psf_next) { 11781da177e4SLinus Torvalds psf_next = psf->sf_next; 11791da177e4SLinus Torvalds kfree(psf); 11801da177e4SLinus Torvalds } 11811da177e4SLinus Torvalds } 11821d7138deSEric Dumazet rcu_read_unlock(); 11831da177e4SLinus Torvalds } 11841da177e4SLinus Torvalds #endif 11851da177e4SLinus Torvalds 11861da177e4SLinus Torvalds static void igmp_group_dropped(struct ip_mc_list *im) 11871da177e4SLinus Torvalds { 11881da177e4SLinus Torvalds struct in_device *in_dev = im->interface; 11891da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 11901da177e4SLinus Torvalds int reporter; 11911da177e4SLinus Torvalds #endif 11921da177e4SLinus Torvalds 11931da177e4SLinus Torvalds if (im->loaded) { 11941da177e4SLinus Torvalds im->loaded = 0; 11951da177e4SLinus Torvalds ip_mc_filter_del(in_dev, im->multiaddr); 11961da177e4SLinus Torvalds } 11971da177e4SLinus Torvalds 11981da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 11991da177e4SLinus Torvalds if (im->multiaddr == IGMP_ALL_HOSTS) 12001da177e4SLinus Torvalds return; 1201df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(im->multiaddr) && !sysctl_igmp_llm_reports) 1202df2cf4a7SPhilip Downey return; 12031da177e4SLinus Torvalds 12041da177e4SLinus Torvalds reporter = im->reporter; 12051da177e4SLinus Torvalds igmp_stop_timer(im); 12061da177e4SLinus Torvalds 12071da177e4SLinus Torvalds if (!in_dev->dead) { 12081da177e4SLinus Torvalds if (IGMP_V1_SEEN(in_dev)) 120924cf3af3SVeaceslav Falico return; 12101da177e4SLinus Torvalds if (IGMP_V2_SEEN(in_dev)) { 12111da177e4SLinus Torvalds if (reporter) 12121da177e4SLinus Torvalds igmp_send_report(in_dev, im, IGMP_HOST_LEAVE_MESSAGE); 121324cf3af3SVeaceslav Falico return; 12141da177e4SLinus Torvalds } 12151da177e4SLinus Torvalds /* IGMPv3 */ 12161da177e4SLinus Torvalds igmpv3_add_delrec(in_dev, im); 12171da177e4SLinus Torvalds 12181da177e4SLinus Torvalds igmp_ifc_event(in_dev); 12191da177e4SLinus Torvalds } 12201da177e4SLinus Torvalds #endif 12211da177e4SLinus Torvalds } 12221da177e4SLinus Torvalds 12231da177e4SLinus Torvalds static void igmp_group_added(struct ip_mc_list *im) 12241da177e4SLinus Torvalds { 12251da177e4SLinus Torvalds struct in_device *in_dev = im->interface; 12261da177e4SLinus Torvalds 12271da177e4SLinus Torvalds if (im->loaded == 0) { 12281da177e4SLinus Torvalds im->loaded = 1; 12291da177e4SLinus Torvalds ip_mc_filter_add(in_dev, im->multiaddr); 12301da177e4SLinus Torvalds } 12311da177e4SLinus Torvalds 12321da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 12331da177e4SLinus Torvalds if (im->multiaddr == IGMP_ALL_HOSTS) 12341da177e4SLinus Torvalds return; 1235df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(im->multiaddr) && !sysctl_igmp_llm_reports) 1236df2cf4a7SPhilip Downey return; 12371da177e4SLinus Torvalds 12381da177e4SLinus Torvalds if (in_dev->dead) 12391da177e4SLinus Torvalds return; 12401da177e4SLinus Torvalds if (IGMP_V1_SEEN(in_dev) || IGMP_V2_SEEN(in_dev)) { 12411da177e4SLinus Torvalds spin_lock_bh(&im->lock); 1242436f7c20SFabian Frederick igmp_start_timer(im, IGMP_INITIAL_REPORT_DELAY); 12431da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 12441da177e4SLinus Torvalds return; 12451da177e4SLinus Torvalds } 12461da177e4SLinus Torvalds /* else, v3 */ 12471da177e4SLinus Torvalds 1248a9fe8e29SHannes Frederic Sowa im->crcount = in_dev->mr_qrv ?: sysctl_igmp_qrv; 12491da177e4SLinus Torvalds igmp_ifc_event(in_dev); 12501da177e4SLinus Torvalds #endif 12511da177e4SLinus Torvalds } 12521da177e4SLinus Torvalds 12531da177e4SLinus Torvalds 12541da177e4SLinus Torvalds /* 12551da177e4SLinus Torvalds * Multicast list managers 12561da177e4SLinus Torvalds */ 12571da177e4SLinus Torvalds 1258e9897071SEric Dumazet static u32 ip_mc_hash(const struct ip_mc_list *im) 1259e9897071SEric Dumazet { 1260c70eba74SEric Dumazet return hash_32((__force u32)im->multiaddr, MC_HASH_SZ_LOG); 1261e9897071SEric Dumazet } 1262e9897071SEric Dumazet 1263e9897071SEric Dumazet static void ip_mc_hash_add(struct in_device *in_dev, 1264e9897071SEric Dumazet struct ip_mc_list *im) 1265e9897071SEric Dumazet { 1266e9897071SEric Dumazet struct ip_mc_list __rcu **mc_hash; 1267e9897071SEric Dumazet u32 hash; 1268e9897071SEric Dumazet 1269e9897071SEric Dumazet mc_hash = rtnl_dereference(in_dev->mc_hash); 1270e9897071SEric Dumazet if (mc_hash) { 1271e9897071SEric Dumazet hash = ip_mc_hash(im); 1272c70eba74SEric Dumazet im->next_hash = mc_hash[hash]; 1273e9897071SEric Dumazet rcu_assign_pointer(mc_hash[hash], im); 1274e9897071SEric Dumazet return; 1275e9897071SEric Dumazet } 1276e9897071SEric Dumazet 1277e9897071SEric Dumazet /* do not use a hash table for small number of items */ 1278e9897071SEric Dumazet if (in_dev->mc_count < 4) 1279e9897071SEric Dumazet return; 1280e9897071SEric Dumazet 1281e9897071SEric Dumazet mc_hash = kzalloc(sizeof(struct ip_mc_list *) << MC_HASH_SZ_LOG, 1282e9897071SEric Dumazet GFP_KERNEL); 1283e9897071SEric Dumazet if (!mc_hash) 1284e9897071SEric Dumazet return; 1285e9897071SEric Dumazet 1286e9897071SEric Dumazet for_each_pmc_rtnl(in_dev, im) { 1287e9897071SEric Dumazet hash = ip_mc_hash(im); 1288c70eba74SEric Dumazet im->next_hash = mc_hash[hash]; 1289e9897071SEric Dumazet RCU_INIT_POINTER(mc_hash[hash], im); 1290e9897071SEric Dumazet } 1291e9897071SEric Dumazet 1292e9897071SEric Dumazet rcu_assign_pointer(in_dev->mc_hash, mc_hash); 1293e9897071SEric Dumazet } 1294e9897071SEric Dumazet 1295e9897071SEric Dumazet static void ip_mc_hash_remove(struct in_device *in_dev, 1296e9897071SEric Dumazet struct ip_mc_list *im) 1297e9897071SEric Dumazet { 1298e9897071SEric Dumazet struct ip_mc_list __rcu **mc_hash = rtnl_dereference(in_dev->mc_hash); 1299e9897071SEric Dumazet struct ip_mc_list *aux; 1300e9897071SEric Dumazet 1301e9897071SEric Dumazet if (!mc_hash) 1302e9897071SEric Dumazet return; 1303e9897071SEric Dumazet mc_hash += ip_mc_hash(im); 1304e9897071SEric Dumazet while ((aux = rtnl_dereference(*mc_hash)) != im) 1305e9897071SEric Dumazet mc_hash = &aux->next_hash; 1306e9897071SEric Dumazet *mc_hash = im->next_hash; 1307e9897071SEric Dumazet } 1308e9897071SEric Dumazet 13091da177e4SLinus Torvalds 13101da177e4SLinus Torvalds /* 13111da177e4SLinus Torvalds * A socket has joined a multicast group on device dev. 13121da177e4SLinus Torvalds */ 13131da177e4SLinus Torvalds 13148f935bbdSAl Viro void ip_mc_inc_group(struct in_device *in_dev, __be32 addr) 13151da177e4SLinus Torvalds { 13161da177e4SLinus Torvalds struct ip_mc_list *im; 13171da177e4SLinus Torvalds 13181da177e4SLinus Torvalds ASSERT_RTNL(); 13191da177e4SLinus Torvalds 13201d7138deSEric Dumazet for_each_pmc_rtnl(in_dev, im) { 13211da177e4SLinus Torvalds if (im->multiaddr == addr) { 13221da177e4SLinus Torvalds im->users++; 13231da177e4SLinus Torvalds ip_mc_add_src(in_dev, &addr, MCAST_EXCLUDE, 0, NULL, 0); 13241da177e4SLinus Torvalds goto out; 13251da177e4SLinus Torvalds } 13261da177e4SLinus Torvalds } 13271da177e4SLinus Torvalds 13281d7138deSEric Dumazet im = kzalloc(sizeof(*im), GFP_KERNEL); 13291da177e4SLinus Torvalds if (!im) 13301da177e4SLinus Torvalds goto out; 13311da177e4SLinus Torvalds 13321da177e4SLinus Torvalds im->users = 1; 13331da177e4SLinus Torvalds im->interface = in_dev; 13341da177e4SLinus Torvalds in_dev_hold(in_dev); 13351da177e4SLinus Torvalds im->multiaddr = addr; 13361da177e4SLinus Torvalds /* initial mode is (EX, empty) */ 13371da177e4SLinus Torvalds im->sfmode = MCAST_EXCLUDE; 13381da177e4SLinus Torvalds im->sfcount[MCAST_EXCLUDE] = 1; 13391da177e4SLinus Torvalds atomic_set(&im->refcnt, 1); 13401da177e4SLinus Torvalds spin_lock_init(&im->lock); 13411da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 1342179542a5SHimangi Saraogi setup_timer(&im->timer, igmp_timer_expire, (unsigned long)im); 1343a9fe8e29SHannes Frederic Sowa im->unsolicit_count = sysctl_igmp_qrv; 13441da177e4SLinus Torvalds #endif 13451d7138deSEric Dumazet 13461d7138deSEric Dumazet im->next_rcu = in_dev->mc_list; 1347b8bae41eSRami Rosen in_dev->mc_count++; 1348cf778b00SEric Dumazet rcu_assign_pointer(in_dev->mc_list, im); 13491d7138deSEric Dumazet 1350e9897071SEric Dumazet ip_mc_hash_add(in_dev, im); 1351e9897071SEric Dumazet 13521da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 13531da177e4SLinus Torvalds igmpv3_del_delrec(in_dev, im->multiaddr); 13541da177e4SLinus Torvalds #endif 13551da177e4SLinus Torvalds igmp_group_added(im); 13561da177e4SLinus Torvalds if (!in_dev->dead) 13571da177e4SLinus Torvalds ip_rt_multicast_event(in_dev); 13581da177e4SLinus Torvalds out: 13591da177e4SLinus Torvalds return; 13601da177e4SLinus Torvalds } 13614bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_mc_inc_group); 13621da177e4SLinus Torvalds 13639afd85c9SLinus Lüssing static int ip_mc_check_iphdr(struct sk_buff *skb) 13649afd85c9SLinus Lüssing { 13659afd85c9SLinus Lüssing const struct iphdr *iph; 13669afd85c9SLinus Lüssing unsigned int len; 13679afd85c9SLinus Lüssing unsigned int offset = skb_network_offset(skb) + sizeof(*iph); 13689afd85c9SLinus Lüssing 13699afd85c9SLinus Lüssing if (!pskb_may_pull(skb, offset)) 13709afd85c9SLinus Lüssing return -EINVAL; 13719afd85c9SLinus Lüssing 13729afd85c9SLinus Lüssing iph = ip_hdr(skb); 13739afd85c9SLinus Lüssing 13749afd85c9SLinus Lüssing if (iph->version != 4 || ip_hdrlen(skb) < sizeof(*iph)) 13759afd85c9SLinus Lüssing return -EINVAL; 13769afd85c9SLinus Lüssing 13779afd85c9SLinus Lüssing offset += ip_hdrlen(skb) - sizeof(*iph); 13789afd85c9SLinus Lüssing 13799afd85c9SLinus Lüssing if (!pskb_may_pull(skb, offset)) 13809afd85c9SLinus Lüssing return -EINVAL; 13819afd85c9SLinus Lüssing 13829afd85c9SLinus Lüssing iph = ip_hdr(skb); 13839afd85c9SLinus Lüssing 13849afd85c9SLinus Lüssing if (unlikely(ip_fast_csum((u8 *)iph, iph->ihl))) 13859afd85c9SLinus Lüssing return -EINVAL; 13869afd85c9SLinus Lüssing 13879afd85c9SLinus Lüssing len = skb_network_offset(skb) + ntohs(iph->tot_len); 13889afd85c9SLinus Lüssing if (skb->len < len || len < offset) 13899afd85c9SLinus Lüssing return -EINVAL; 13909afd85c9SLinus Lüssing 13919afd85c9SLinus Lüssing skb_set_transport_header(skb, offset); 13929afd85c9SLinus Lüssing 13939afd85c9SLinus Lüssing return 0; 13949afd85c9SLinus Lüssing } 13959afd85c9SLinus Lüssing 13969afd85c9SLinus Lüssing static int ip_mc_check_igmp_reportv3(struct sk_buff *skb) 13979afd85c9SLinus Lüssing { 13989afd85c9SLinus Lüssing unsigned int len = skb_transport_offset(skb); 13999afd85c9SLinus Lüssing 14009afd85c9SLinus Lüssing len += sizeof(struct igmpv3_report); 14019afd85c9SLinus Lüssing 14029afd85c9SLinus Lüssing return pskb_may_pull(skb, len) ? 0 : -EINVAL; 14039afd85c9SLinus Lüssing } 14049afd85c9SLinus Lüssing 14059afd85c9SLinus Lüssing static int ip_mc_check_igmp_query(struct sk_buff *skb) 14069afd85c9SLinus Lüssing { 14079afd85c9SLinus Lüssing unsigned int len = skb_transport_offset(skb); 14089afd85c9SLinus Lüssing 14099afd85c9SLinus Lüssing len += sizeof(struct igmphdr); 14109afd85c9SLinus Lüssing if (skb->len < len) 14119afd85c9SLinus Lüssing return -EINVAL; 14129afd85c9SLinus Lüssing 14139afd85c9SLinus Lüssing /* IGMPv{1,2}? */ 14149afd85c9SLinus Lüssing if (skb->len != len) { 14159afd85c9SLinus Lüssing /* or IGMPv3? */ 14169afd85c9SLinus Lüssing len += sizeof(struct igmpv3_query) - sizeof(struct igmphdr); 14179afd85c9SLinus Lüssing if (skb->len < len || !pskb_may_pull(skb, len)) 14189afd85c9SLinus Lüssing return -EINVAL; 14199afd85c9SLinus Lüssing } 14209afd85c9SLinus Lüssing 14219afd85c9SLinus Lüssing /* RFC2236+RFC3376 (IGMPv2+IGMPv3) require the multicast link layer 14229afd85c9SLinus Lüssing * all-systems destination addresses (224.0.0.1) for general queries 14239afd85c9SLinus Lüssing */ 14249afd85c9SLinus Lüssing if (!igmp_hdr(skb)->group && 14259afd85c9SLinus Lüssing ip_hdr(skb)->daddr != htonl(INADDR_ALLHOSTS_GROUP)) 14269afd85c9SLinus Lüssing return -EINVAL; 14279afd85c9SLinus Lüssing 14289afd85c9SLinus Lüssing return 0; 14299afd85c9SLinus Lüssing } 14309afd85c9SLinus Lüssing 14319afd85c9SLinus Lüssing static int ip_mc_check_igmp_msg(struct sk_buff *skb) 14329afd85c9SLinus Lüssing { 14339afd85c9SLinus Lüssing switch (igmp_hdr(skb)->type) { 14349afd85c9SLinus Lüssing case IGMP_HOST_LEAVE_MESSAGE: 14359afd85c9SLinus Lüssing case IGMP_HOST_MEMBERSHIP_REPORT: 14369afd85c9SLinus Lüssing case IGMPV2_HOST_MEMBERSHIP_REPORT: 14379afd85c9SLinus Lüssing /* fall through */ 14389afd85c9SLinus Lüssing return 0; 14399afd85c9SLinus Lüssing case IGMPV3_HOST_MEMBERSHIP_REPORT: 14409afd85c9SLinus Lüssing return ip_mc_check_igmp_reportv3(skb); 14419afd85c9SLinus Lüssing case IGMP_HOST_MEMBERSHIP_QUERY: 14429afd85c9SLinus Lüssing return ip_mc_check_igmp_query(skb); 14439afd85c9SLinus Lüssing default: 14449afd85c9SLinus Lüssing return -ENOMSG; 14459afd85c9SLinus Lüssing } 14469afd85c9SLinus Lüssing } 14479afd85c9SLinus Lüssing 14489afd85c9SLinus Lüssing static inline __sum16 ip_mc_validate_checksum(struct sk_buff *skb) 14499afd85c9SLinus Lüssing { 14509afd85c9SLinus Lüssing return skb_checksum_simple_validate(skb); 14519afd85c9SLinus Lüssing } 14529afd85c9SLinus Lüssing 14539afd85c9SLinus Lüssing static int __ip_mc_check_igmp(struct sk_buff *skb, struct sk_buff **skb_trimmed) 14549afd85c9SLinus Lüssing 14559afd85c9SLinus Lüssing { 14569afd85c9SLinus Lüssing struct sk_buff *skb_chk; 14579afd85c9SLinus Lüssing unsigned int transport_len; 14589afd85c9SLinus Lüssing unsigned int len = skb_transport_offset(skb) + sizeof(struct igmphdr); 1459a516993fSLinus Lüssing int ret = -EINVAL; 14609afd85c9SLinus Lüssing 14619afd85c9SLinus Lüssing transport_len = ntohs(ip_hdr(skb)->tot_len) - ip_hdrlen(skb); 14629afd85c9SLinus Lüssing 14639afd85c9SLinus Lüssing skb_chk = skb_checksum_trimmed(skb, transport_len, 14649afd85c9SLinus Lüssing ip_mc_validate_checksum); 14659afd85c9SLinus Lüssing if (!skb_chk) 1466a516993fSLinus Lüssing goto err; 14679afd85c9SLinus Lüssing 1468a516993fSLinus Lüssing if (!pskb_may_pull(skb_chk, len)) 1469a516993fSLinus Lüssing goto err; 14709afd85c9SLinus Lüssing 14719afd85c9SLinus Lüssing ret = ip_mc_check_igmp_msg(skb_chk); 1472a516993fSLinus Lüssing if (ret) 1473a516993fSLinus Lüssing goto err; 14749afd85c9SLinus Lüssing 14759afd85c9SLinus Lüssing if (skb_trimmed) 14769afd85c9SLinus Lüssing *skb_trimmed = skb_chk; 1477a516993fSLinus Lüssing /* free now unneeded clone */ 1478a516993fSLinus Lüssing else if (skb_chk != skb) 14799afd85c9SLinus Lüssing kfree_skb(skb_chk); 14809afd85c9SLinus Lüssing 1481a516993fSLinus Lüssing ret = 0; 1482a516993fSLinus Lüssing 1483a516993fSLinus Lüssing err: 1484a516993fSLinus Lüssing if (ret && skb_chk && skb_chk != skb) 1485a516993fSLinus Lüssing kfree_skb(skb_chk); 1486a516993fSLinus Lüssing 1487a516993fSLinus Lüssing return ret; 14889afd85c9SLinus Lüssing } 14899afd85c9SLinus Lüssing 14909afd85c9SLinus Lüssing /** 14919afd85c9SLinus Lüssing * ip_mc_check_igmp - checks whether this is a sane IGMP packet 14929afd85c9SLinus Lüssing * @skb: the skb to validate 14939afd85c9SLinus Lüssing * @skb_trimmed: to store an skb pointer trimmed to IPv4 packet tail (optional) 14949afd85c9SLinus Lüssing * 14959afd85c9SLinus Lüssing * Checks whether an IPv4 packet is a valid IGMP packet. If so sets 1496a516993fSLinus Lüssing * skb transport header accordingly and returns zero. 14979afd85c9SLinus Lüssing * 14989afd85c9SLinus Lüssing * -EINVAL: A broken packet was detected, i.e. it violates some internet 14999afd85c9SLinus Lüssing * standard 15009afd85c9SLinus Lüssing * -ENOMSG: IP header validation succeeded but it is not an IGMP packet. 15019afd85c9SLinus Lüssing * -ENOMEM: A memory allocation failure happened. 15029afd85c9SLinus Lüssing * 15039afd85c9SLinus Lüssing * Optionally, an skb pointer might be provided via skb_trimmed (or set it 15049afd85c9SLinus Lüssing * to NULL): After parsing an IGMP packet successfully it will point to 15059afd85c9SLinus Lüssing * an skb which has its tail aligned to the IP packet end. This might 15069afd85c9SLinus Lüssing * either be the originally provided skb or a trimmed, cloned version if 15079afd85c9SLinus Lüssing * the skb frame had data beyond the IP packet. A cloned skb allows us 15089afd85c9SLinus Lüssing * to leave the original skb and its full frame unchanged (which might be 15099afd85c9SLinus Lüssing * desirable for layer 2 frame jugglers). 15109afd85c9SLinus Lüssing * 1511a516993fSLinus Lüssing * Caller needs to set the skb network header and free any returned skb if it 1512a516993fSLinus Lüssing * differs from the provided skb. 15139afd85c9SLinus Lüssing */ 15149afd85c9SLinus Lüssing int ip_mc_check_igmp(struct sk_buff *skb, struct sk_buff **skb_trimmed) 15159afd85c9SLinus Lüssing { 15169afd85c9SLinus Lüssing int ret = ip_mc_check_iphdr(skb); 15179afd85c9SLinus Lüssing 15189afd85c9SLinus Lüssing if (ret < 0) 15199afd85c9SLinus Lüssing return ret; 15209afd85c9SLinus Lüssing 15219afd85c9SLinus Lüssing if (ip_hdr(skb)->protocol != IPPROTO_IGMP) 15229afd85c9SLinus Lüssing return -ENOMSG; 15239afd85c9SLinus Lüssing 15249afd85c9SLinus Lüssing return __ip_mc_check_igmp(skb, skb_trimmed); 15259afd85c9SLinus Lüssing } 15269afd85c9SLinus Lüssing EXPORT_SYMBOL(ip_mc_check_igmp); 15279afd85c9SLinus Lüssing 15281da177e4SLinus Torvalds /* 15294aa5dee4SJiri Pirko * Resend IGMP JOIN report; used by netdev notifier. 1530a816c7c7SJay Vosburgh */ 15314aa5dee4SJiri Pirko static void ip_mc_rejoin_groups(struct in_device *in_dev) 1532a816c7c7SJay Vosburgh { 153308882669SGeert Uytterhoeven #ifdef CONFIG_IP_MULTICAST 1534866f3b25SEric Dumazet struct ip_mc_list *im; 1535866f3b25SEric Dumazet int type; 1536a816c7c7SJay Vosburgh 15374aa5dee4SJiri Pirko ASSERT_RTNL(); 15384aa5dee4SJiri Pirko 15394aa5dee4SJiri Pirko for_each_pmc_rtnl(in_dev, im) { 1540a816c7c7SJay Vosburgh if (im->multiaddr == IGMP_ALL_HOSTS) 1541866f3b25SEric Dumazet continue; 1542df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(im->multiaddr) && 1543df2cf4a7SPhilip Downey !sysctl_igmp_llm_reports) 1544df2cf4a7SPhilip Downey continue; 1545a816c7c7SJay Vosburgh 1546e12b4539SFlavio Leitner /* a failover is happening and switches 1547866f3b25SEric Dumazet * must be notified immediately 1548866f3b25SEric Dumazet */ 1549e12b4539SFlavio Leitner if (IGMP_V1_SEEN(in_dev)) 1550866f3b25SEric Dumazet type = IGMP_HOST_MEMBERSHIP_REPORT; 1551e12b4539SFlavio Leitner else if (IGMP_V2_SEEN(in_dev)) 1552866f3b25SEric Dumazet type = IGMPV2_HOST_MEMBERSHIP_REPORT; 1553e12b4539SFlavio Leitner else 1554866f3b25SEric Dumazet type = IGMPV3_HOST_MEMBERSHIP_REPORT; 1555866f3b25SEric Dumazet igmp_send_report(in_dev, im, type); 1556866f3b25SEric Dumazet } 1557a816c7c7SJay Vosburgh #endif 1558a816c7c7SJay Vosburgh } 1559a816c7c7SJay Vosburgh 1560a816c7c7SJay Vosburgh /* 15611da177e4SLinus Torvalds * A socket has left a multicast group on device dev 15621da177e4SLinus Torvalds */ 15631da177e4SLinus Torvalds 15648f935bbdSAl Viro void ip_mc_dec_group(struct in_device *in_dev, __be32 addr) 15651da177e4SLinus Torvalds { 15661d7138deSEric Dumazet struct ip_mc_list *i; 15671d7138deSEric Dumazet struct ip_mc_list __rcu **ip; 15681da177e4SLinus Torvalds 15691da177e4SLinus Torvalds ASSERT_RTNL(); 15701da177e4SLinus Torvalds 15711d7138deSEric Dumazet for (ip = &in_dev->mc_list; 15721d7138deSEric Dumazet (i = rtnl_dereference(*ip)) != NULL; 15731d7138deSEric Dumazet ip = &i->next_rcu) { 15741da177e4SLinus Torvalds if (i->multiaddr == addr) { 15751da177e4SLinus Torvalds if (--i->users == 0) { 1576e9897071SEric Dumazet ip_mc_hash_remove(in_dev, i); 15771d7138deSEric Dumazet *ip = i->next_rcu; 1578b8bae41eSRami Rosen in_dev->mc_count--; 15791da177e4SLinus Torvalds igmp_group_dropped(i); 158024cf3af3SVeaceslav Falico ip_mc_clear_src(i); 15811da177e4SLinus Torvalds 15821da177e4SLinus Torvalds if (!in_dev->dead) 15831da177e4SLinus Torvalds ip_rt_multicast_event(in_dev); 15841da177e4SLinus Torvalds 15851da177e4SLinus Torvalds ip_ma_put(i); 15861da177e4SLinus Torvalds return; 15871da177e4SLinus Torvalds } 15881da177e4SLinus Torvalds break; 15891da177e4SLinus Torvalds } 15901da177e4SLinus Torvalds } 15911da177e4SLinus Torvalds } 15924bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_mc_dec_group); 15931da177e4SLinus Torvalds 159475c78500SMoni Shoua /* Device changing type */ 159575c78500SMoni Shoua 159675c78500SMoni Shoua void ip_mc_unmap(struct in_device *in_dev) 159775c78500SMoni Shoua { 15981d7138deSEric Dumazet struct ip_mc_list *pmc; 159975c78500SMoni Shoua 160075c78500SMoni Shoua ASSERT_RTNL(); 160175c78500SMoni Shoua 16021d7138deSEric Dumazet for_each_pmc_rtnl(in_dev, pmc) 16031d7138deSEric Dumazet igmp_group_dropped(pmc); 160475c78500SMoni Shoua } 160575c78500SMoni Shoua 160675c78500SMoni Shoua void ip_mc_remap(struct in_device *in_dev) 160775c78500SMoni Shoua { 16081d7138deSEric Dumazet struct ip_mc_list *pmc; 160975c78500SMoni Shoua 161075c78500SMoni Shoua ASSERT_RTNL(); 161175c78500SMoni Shoua 16121d7138deSEric Dumazet for_each_pmc_rtnl(in_dev, pmc) 16131d7138deSEric Dumazet igmp_group_added(pmc); 161475c78500SMoni Shoua } 161575c78500SMoni Shoua 16161da177e4SLinus Torvalds /* Device going down */ 16171da177e4SLinus Torvalds 16181da177e4SLinus Torvalds void ip_mc_down(struct in_device *in_dev) 16191da177e4SLinus Torvalds { 16201d7138deSEric Dumazet struct ip_mc_list *pmc; 16211da177e4SLinus Torvalds 16221da177e4SLinus Torvalds ASSERT_RTNL(); 16231da177e4SLinus Torvalds 16241d7138deSEric Dumazet for_each_pmc_rtnl(in_dev, pmc) 16251d7138deSEric Dumazet igmp_group_dropped(pmc); 16261da177e4SLinus Torvalds 16271da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 16281da177e4SLinus Torvalds in_dev->mr_ifc_count = 0; 16291da177e4SLinus Torvalds if (del_timer(&in_dev->mr_ifc_timer)) 16301da177e4SLinus Torvalds __in_dev_put(in_dev); 16311da177e4SLinus Torvalds in_dev->mr_gq_running = 0; 16321da177e4SLinus Torvalds if (del_timer(&in_dev->mr_gq_timer)) 16331da177e4SLinus Torvalds __in_dev_put(in_dev); 16341da177e4SLinus Torvalds igmpv3_clear_delrec(in_dev); 16351da177e4SLinus Torvalds #endif 16361da177e4SLinus Torvalds 16371da177e4SLinus Torvalds ip_mc_dec_group(in_dev, IGMP_ALL_HOSTS); 16381da177e4SLinus Torvalds } 16391da177e4SLinus Torvalds 16401da177e4SLinus Torvalds void ip_mc_init_dev(struct in_device *in_dev) 16411da177e4SLinus Torvalds { 16421da177e4SLinus Torvalds ASSERT_RTNL(); 16431da177e4SLinus Torvalds 16441da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 1645b24b8a24SPavel Emelyanov setup_timer(&in_dev->mr_gq_timer, igmp_gq_timer_expire, 1646b24b8a24SPavel Emelyanov (unsigned long)in_dev); 1647b24b8a24SPavel Emelyanov setup_timer(&in_dev->mr_ifc_timer, igmp_ifc_timer_expire, 1648b24b8a24SPavel Emelyanov (unsigned long)in_dev); 1649a9fe8e29SHannes Frederic Sowa in_dev->mr_qrv = sysctl_igmp_qrv; 16501da177e4SLinus Torvalds #endif 16511da177e4SLinus Torvalds 16521da177e4SLinus Torvalds spin_lock_init(&in_dev->mc_tomb_lock); 16531da177e4SLinus Torvalds } 16541da177e4SLinus Torvalds 16551da177e4SLinus Torvalds /* Device going up */ 16561da177e4SLinus Torvalds 16571da177e4SLinus Torvalds void ip_mc_up(struct in_device *in_dev) 16581da177e4SLinus Torvalds { 16591d7138deSEric Dumazet struct ip_mc_list *pmc; 16601da177e4SLinus Torvalds 16611da177e4SLinus Torvalds ASSERT_RTNL(); 16621da177e4SLinus Torvalds 1663a9fe8e29SHannes Frederic Sowa #ifdef CONFIG_IP_MULTICAST 1664a9fe8e29SHannes Frederic Sowa in_dev->mr_qrv = sysctl_igmp_qrv; 1665a9fe8e29SHannes Frederic Sowa #endif 16661da177e4SLinus Torvalds ip_mc_inc_group(in_dev, IGMP_ALL_HOSTS); 16671da177e4SLinus Torvalds 16681d7138deSEric Dumazet for_each_pmc_rtnl(in_dev, pmc) 16691d7138deSEric Dumazet igmp_group_added(pmc); 16701da177e4SLinus Torvalds } 16711da177e4SLinus Torvalds 16721da177e4SLinus Torvalds /* 16731da177e4SLinus Torvalds * Device is about to be destroyed: clean up. 16741da177e4SLinus Torvalds */ 16751da177e4SLinus Torvalds 16761da177e4SLinus Torvalds void ip_mc_destroy_dev(struct in_device *in_dev) 16771da177e4SLinus Torvalds { 16781da177e4SLinus Torvalds struct ip_mc_list *i; 16791da177e4SLinus Torvalds 16801da177e4SLinus Torvalds ASSERT_RTNL(); 16811da177e4SLinus Torvalds 16821da177e4SLinus Torvalds /* Deactivate timers */ 16831da177e4SLinus Torvalds ip_mc_down(in_dev); 16841da177e4SLinus Torvalds 16851d7138deSEric Dumazet while ((i = rtnl_dereference(in_dev->mc_list)) != NULL) { 16861d7138deSEric Dumazet in_dev->mc_list = i->next_rcu; 1687b8bae41eSRami Rosen in_dev->mc_count--; 16881d7138deSEric Dumazet 168924cf3af3SVeaceslav Falico /* We've dropped the groups in ip_mc_down already */ 169024cf3af3SVeaceslav Falico ip_mc_clear_src(i); 16911da177e4SLinus Torvalds ip_ma_put(i); 16921da177e4SLinus Torvalds } 16931da177e4SLinus Torvalds } 16941da177e4SLinus Torvalds 16959e917dcaSEric Dumazet /* RTNL is locked */ 1696877acedcSDaniel Lezcano static struct in_device *ip_mc_find_dev(struct net *net, struct ip_mreqn *imr) 16971da177e4SLinus Torvalds { 16981da177e4SLinus Torvalds struct net_device *dev = NULL; 16991da177e4SLinus Torvalds struct in_device *idev = NULL; 17001da177e4SLinus Torvalds 17011da177e4SLinus Torvalds if (imr->imr_ifindex) { 1702877acedcSDaniel Lezcano idev = inetdev_by_index(net, imr->imr_ifindex); 17031da177e4SLinus Torvalds return idev; 17041da177e4SLinus Torvalds } 17051da177e4SLinus Torvalds if (imr->imr_address.s_addr) { 17069e917dcaSEric Dumazet dev = __ip_dev_find(net, imr->imr_address.s_addr, false); 17071da177e4SLinus Torvalds if (!dev) 17081da177e4SLinus Torvalds return NULL; 17091da177e4SLinus Torvalds } 17101da177e4SLinus Torvalds 1711b23dd4feSDavid S. Miller if (!dev) { 171278fbfd8aSDavid S. Miller struct rtable *rt = ip_route_output(net, 171378fbfd8aSDavid S. Miller imr->imr_multiaddr.s_addr, 171478fbfd8aSDavid S. Miller 0, 0, 0); 1715b23dd4feSDavid S. Miller if (!IS_ERR(rt)) { 1716d8d1f30bSChangli Gao dev = rt->dst.dev; 17171da177e4SLinus Torvalds ip_rt_put(rt); 17181da177e4SLinus Torvalds } 1719b23dd4feSDavid S. Miller } 17201da177e4SLinus Torvalds if (dev) { 17211da177e4SLinus Torvalds imr->imr_ifindex = dev->ifindex; 1722e5ed6399SHerbert Xu idev = __in_dev_get_rtnl(dev); 17231da177e4SLinus Torvalds } 17241da177e4SLinus Torvalds return idev; 17251da177e4SLinus Torvalds } 17261da177e4SLinus Torvalds 17271da177e4SLinus Torvalds /* 17281da177e4SLinus Torvalds * Join a socket to a group 17291da177e4SLinus Torvalds */ 1730ab32ea5dSBrian Haley int sysctl_igmp_max_memberships __read_mostly = IP_MAX_MEMBERSHIPS; 1731ab32ea5dSBrian Haley int sysctl_igmp_max_msf __read_mostly = IP_MAX_MSF; 1732a9fe8e29SHannes Frederic Sowa #ifdef CONFIG_IP_MULTICAST 1733436f7c20SFabian Frederick int sysctl_igmp_qrv __read_mostly = IGMP_QUERY_ROBUSTNESS_VARIABLE; 1734a9fe8e29SHannes Frederic Sowa #endif 17351da177e4SLinus Torvalds 17361da177e4SLinus Torvalds static int ip_mc_del1_src(struct ip_mc_list *pmc, int sfmode, 17378f935bbdSAl Viro __be32 *psfsrc) 17381da177e4SLinus Torvalds { 17391da177e4SLinus Torvalds struct ip_sf_list *psf, *psf_prev; 17401da177e4SLinus Torvalds int rv = 0; 17411da177e4SLinus Torvalds 17421da177e4SLinus Torvalds psf_prev = NULL; 17431da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) { 17441da177e4SLinus Torvalds if (psf->sf_inaddr == *psfsrc) 17451da177e4SLinus Torvalds break; 17461da177e4SLinus Torvalds psf_prev = psf; 17471da177e4SLinus Torvalds } 17481da177e4SLinus Torvalds if (!psf || psf->sf_count[sfmode] == 0) { 17491da177e4SLinus Torvalds /* source filter not found, or count wrong => bug */ 17501da177e4SLinus Torvalds return -ESRCH; 17511da177e4SLinus Torvalds } 17521da177e4SLinus Torvalds psf->sf_count[sfmode]--; 17531da177e4SLinus Torvalds if (psf->sf_count[sfmode] == 0) { 17541da177e4SLinus Torvalds ip_rt_multicast_event(pmc->interface); 17551da177e4SLinus Torvalds } 17561da177e4SLinus Torvalds if (!psf->sf_count[MCAST_INCLUDE] && !psf->sf_count[MCAST_EXCLUDE]) { 17571da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 17581da177e4SLinus Torvalds struct in_device *in_dev = pmc->interface; 17591da177e4SLinus Torvalds #endif 17601da177e4SLinus Torvalds 17611da177e4SLinus Torvalds /* no more filters for this source */ 17621da177e4SLinus Torvalds if (psf_prev) 17631da177e4SLinus Torvalds psf_prev->sf_next = psf->sf_next; 17641da177e4SLinus Torvalds else 17651da177e4SLinus Torvalds pmc->sources = psf->sf_next; 17661da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 17671da177e4SLinus Torvalds if (psf->sf_oldin && 17681da177e4SLinus Torvalds !IGMP_V1_SEEN(in_dev) && !IGMP_V2_SEEN(in_dev)) { 1769a9fe8e29SHannes Frederic Sowa psf->sf_crcount = in_dev->mr_qrv ?: sysctl_igmp_qrv; 17701da177e4SLinus Torvalds psf->sf_next = pmc->tomb; 17711da177e4SLinus Torvalds pmc->tomb = psf; 17721da177e4SLinus Torvalds rv = 1; 17731da177e4SLinus Torvalds } else 17741da177e4SLinus Torvalds #endif 17751da177e4SLinus Torvalds kfree(psf); 17761da177e4SLinus Torvalds } 17771da177e4SLinus Torvalds return rv; 17781da177e4SLinus Torvalds } 17791da177e4SLinus Torvalds 17801da177e4SLinus Torvalds #ifndef CONFIG_IP_MULTICAST 17811da177e4SLinus Torvalds #define igmp_ifc_event(x) do { } while (0) 17821da177e4SLinus Torvalds #endif 17831da177e4SLinus Torvalds 17848f935bbdSAl Viro static int ip_mc_del_src(struct in_device *in_dev, __be32 *pmca, int sfmode, 17858f935bbdSAl Viro int sfcount, __be32 *psfsrc, int delta) 17861da177e4SLinus Torvalds { 17871da177e4SLinus Torvalds struct ip_mc_list *pmc; 17881da177e4SLinus Torvalds int changerec = 0; 17891da177e4SLinus Torvalds int i, err; 17901da177e4SLinus Torvalds 17911da177e4SLinus Torvalds if (!in_dev) 17921da177e4SLinus Torvalds return -ENODEV; 17931d7138deSEric Dumazet rcu_read_lock(); 17941d7138deSEric Dumazet for_each_pmc_rcu(in_dev, pmc) { 17951da177e4SLinus Torvalds if (*pmca == pmc->multiaddr) 17961da177e4SLinus Torvalds break; 17971da177e4SLinus Torvalds } 17981da177e4SLinus Torvalds if (!pmc) { 17991da177e4SLinus Torvalds /* MCA not found?? bug */ 18001d7138deSEric Dumazet rcu_read_unlock(); 18011da177e4SLinus Torvalds return -ESRCH; 18021da177e4SLinus Torvalds } 18031da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 18041d7138deSEric Dumazet rcu_read_unlock(); 18051da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 18061da177e4SLinus Torvalds sf_markstate(pmc); 18071da177e4SLinus Torvalds #endif 18081da177e4SLinus Torvalds if (!delta) { 18091da177e4SLinus Torvalds err = -EINVAL; 18101da177e4SLinus Torvalds if (!pmc->sfcount[sfmode]) 18111da177e4SLinus Torvalds goto out_unlock; 18121da177e4SLinus Torvalds pmc->sfcount[sfmode]--; 18131da177e4SLinus Torvalds } 18141da177e4SLinus Torvalds err = 0; 18151da177e4SLinus Torvalds for (i = 0; i < sfcount; i++) { 18161da177e4SLinus Torvalds int rv = ip_mc_del1_src(pmc, sfmode, &psfsrc[i]); 18171da177e4SLinus Torvalds 18181da177e4SLinus Torvalds changerec |= rv > 0; 18191da177e4SLinus Torvalds if (!err && rv < 0) 18201da177e4SLinus Torvalds err = rv; 18211da177e4SLinus Torvalds } 18221da177e4SLinus Torvalds if (pmc->sfmode == MCAST_EXCLUDE && 18231da177e4SLinus Torvalds pmc->sfcount[MCAST_EXCLUDE] == 0 && 18241da177e4SLinus Torvalds pmc->sfcount[MCAST_INCLUDE]) { 18251da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 18261da177e4SLinus Torvalds struct ip_sf_list *psf; 18271da177e4SLinus Torvalds #endif 18281da177e4SLinus Torvalds 18291da177e4SLinus Torvalds /* filter mode change */ 18301da177e4SLinus Torvalds pmc->sfmode = MCAST_INCLUDE; 18311da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 1832a9fe8e29SHannes Frederic Sowa pmc->crcount = in_dev->mr_qrv ?: sysctl_igmp_qrv; 18331da177e4SLinus Torvalds in_dev->mr_ifc_count = pmc->crcount; 18341da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) 18351da177e4SLinus Torvalds psf->sf_crcount = 0; 18361da177e4SLinus Torvalds igmp_ifc_event(pmc->interface); 18371da177e4SLinus Torvalds } else if (sf_setstate(pmc) || changerec) { 18381da177e4SLinus Torvalds igmp_ifc_event(pmc->interface); 18391da177e4SLinus Torvalds #endif 18401da177e4SLinus Torvalds } 18411da177e4SLinus Torvalds out_unlock: 18421da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 18431da177e4SLinus Torvalds return err; 18441da177e4SLinus Torvalds } 18451da177e4SLinus Torvalds 18461da177e4SLinus Torvalds /* 18471da177e4SLinus Torvalds * Add multicast single-source filter to the interface list 18481da177e4SLinus Torvalds */ 18491da177e4SLinus Torvalds static int ip_mc_add1_src(struct ip_mc_list *pmc, int sfmode, 18505eb81e89SJun Zhao __be32 *psfsrc) 18511da177e4SLinus Torvalds { 18521da177e4SLinus Torvalds struct ip_sf_list *psf, *psf_prev; 18531da177e4SLinus Torvalds 18541da177e4SLinus Torvalds psf_prev = NULL; 18551da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) { 18561da177e4SLinus Torvalds if (psf->sf_inaddr == *psfsrc) 18571da177e4SLinus Torvalds break; 18581da177e4SLinus Torvalds psf_prev = psf; 18591da177e4SLinus Torvalds } 18601da177e4SLinus Torvalds if (!psf) { 18610da974f4SPanagiotis Issaris psf = kzalloc(sizeof(*psf), GFP_ATOMIC); 18621da177e4SLinus Torvalds if (!psf) 18631da177e4SLinus Torvalds return -ENOBUFS; 18641da177e4SLinus Torvalds psf->sf_inaddr = *psfsrc; 18651da177e4SLinus Torvalds if (psf_prev) { 18661da177e4SLinus Torvalds psf_prev->sf_next = psf; 18671da177e4SLinus Torvalds } else 18681da177e4SLinus Torvalds pmc->sources = psf; 18691da177e4SLinus Torvalds } 18701da177e4SLinus Torvalds psf->sf_count[sfmode]++; 18711da177e4SLinus Torvalds if (psf->sf_count[sfmode] == 1) { 18721da177e4SLinus Torvalds ip_rt_multicast_event(pmc->interface); 18731da177e4SLinus Torvalds } 18741da177e4SLinus Torvalds return 0; 18751da177e4SLinus Torvalds } 18761da177e4SLinus Torvalds 18771da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 18781da177e4SLinus Torvalds static void sf_markstate(struct ip_mc_list *pmc) 18791da177e4SLinus Torvalds { 18801da177e4SLinus Torvalds struct ip_sf_list *psf; 18811da177e4SLinus Torvalds int mca_xcount = pmc->sfcount[MCAST_EXCLUDE]; 18821da177e4SLinus Torvalds 18831da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) 18841da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) { 18851da177e4SLinus Torvalds psf->sf_oldin = mca_xcount == 18861da177e4SLinus Torvalds psf->sf_count[MCAST_EXCLUDE] && 18871da177e4SLinus Torvalds !psf->sf_count[MCAST_INCLUDE]; 18881da177e4SLinus Torvalds } else 18891da177e4SLinus Torvalds psf->sf_oldin = psf->sf_count[MCAST_INCLUDE] != 0; 18901da177e4SLinus Torvalds } 18911da177e4SLinus Torvalds 18921da177e4SLinus Torvalds static int sf_setstate(struct ip_mc_list *pmc) 18931da177e4SLinus Torvalds { 1894ad12583fSDavid L Stevens struct ip_sf_list *psf, *dpsf; 18951da177e4SLinus Torvalds int mca_xcount = pmc->sfcount[MCAST_EXCLUDE]; 18961da177e4SLinus Torvalds int qrv = pmc->interface->mr_qrv; 18971da177e4SLinus Torvalds int new_in, rv; 18981da177e4SLinus Torvalds 18991da177e4SLinus Torvalds rv = 0; 19001da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) { 19011da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) { 19021da177e4SLinus Torvalds new_in = mca_xcount == psf->sf_count[MCAST_EXCLUDE] && 19031da177e4SLinus Torvalds !psf->sf_count[MCAST_INCLUDE]; 19041da177e4SLinus Torvalds } else 19051da177e4SLinus Torvalds new_in = psf->sf_count[MCAST_INCLUDE] != 0; 1906ad12583fSDavid L Stevens if (new_in) { 1907ad12583fSDavid L Stevens if (!psf->sf_oldin) { 190876edc605SAl Viro struct ip_sf_list *prev = NULL; 1909ad12583fSDavid L Stevens 1910ad12583fSDavid L Stevens for (dpsf = pmc->tomb; dpsf; dpsf = dpsf->sf_next) { 1911ad12583fSDavid L Stevens if (dpsf->sf_inaddr == psf->sf_inaddr) 1912ad12583fSDavid L Stevens break; 1913ad12583fSDavid L Stevens prev = dpsf; 1914ad12583fSDavid L Stevens } 1915ad12583fSDavid L Stevens if (dpsf) { 1916ad12583fSDavid L Stevens if (prev) 1917ad12583fSDavid L Stevens prev->sf_next = dpsf->sf_next; 1918ad12583fSDavid L Stevens else 1919ad12583fSDavid L Stevens pmc->tomb = dpsf->sf_next; 1920ad12583fSDavid L Stevens kfree(dpsf); 1921ad12583fSDavid L Stevens } 19221da177e4SLinus Torvalds psf->sf_crcount = qrv; 19231da177e4SLinus Torvalds rv++; 19241da177e4SLinus Torvalds } 1925ad12583fSDavid L Stevens } else if (psf->sf_oldin) { 1926ad12583fSDavid L Stevens 1927ad12583fSDavid L Stevens psf->sf_crcount = 0; 1928ad12583fSDavid L Stevens /* 1929ad12583fSDavid L Stevens * add or update "delete" records if an active filter 1930ad12583fSDavid L Stevens * is now inactive 1931ad12583fSDavid L Stevens */ 1932ad12583fSDavid L Stevens for (dpsf = pmc->tomb; dpsf; dpsf = dpsf->sf_next) 1933ad12583fSDavid L Stevens if (dpsf->sf_inaddr == psf->sf_inaddr) 1934ad12583fSDavid L Stevens break; 1935ad12583fSDavid L Stevens if (!dpsf) { 19363ed37a6fSJoe Perches dpsf = kmalloc(sizeof(*dpsf), GFP_ATOMIC); 1937ad12583fSDavid L Stevens if (!dpsf) 1938ad12583fSDavid L Stevens continue; 1939ad12583fSDavid L Stevens *dpsf = *psf; 1940ad12583fSDavid L Stevens /* pmc->lock held by callers */ 1941ad12583fSDavid L Stevens dpsf->sf_next = pmc->tomb; 1942ad12583fSDavid L Stevens pmc->tomb = dpsf; 1943ad12583fSDavid L Stevens } 1944ad12583fSDavid L Stevens dpsf->sf_crcount = qrv; 1945ad12583fSDavid L Stevens rv++; 1946ad12583fSDavid L Stevens } 19471da177e4SLinus Torvalds } 19481da177e4SLinus Torvalds return rv; 19491da177e4SLinus Torvalds } 19501da177e4SLinus Torvalds #endif 19511da177e4SLinus Torvalds 19521da177e4SLinus Torvalds /* 19531da177e4SLinus Torvalds * Add multicast source filter list to the interface list 19541da177e4SLinus Torvalds */ 19558f935bbdSAl Viro static int ip_mc_add_src(struct in_device *in_dev, __be32 *pmca, int sfmode, 19568f935bbdSAl Viro int sfcount, __be32 *psfsrc, int delta) 19571da177e4SLinus Torvalds { 19581da177e4SLinus Torvalds struct ip_mc_list *pmc; 19591da177e4SLinus Torvalds int isexclude; 19601da177e4SLinus Torvalds int i, err; 19611da177e4SLinus Torvalds 19621da177e4SLinus Torvalds if (!in_dev) 19631da177e4SLinus Torvalds return -ENODEV; 19641d7138deSEric Dumazet rcu_read_lock(); 19651d7138deSEric Dumazet for_each_pmc_rcu(in_dev, pmc) { 19661da177e4SLinus Torvalds if (*pmca == pmc->multiaddr) 19671da177e4SLinus Torvalds break; 19681da177e4SLinus Torvalds } 19691da177e4SLinus Torvalds if (!pmc) { 19701da177e4SLinus Torvalds /* MCA not found?? bug */ 19711d7138deSEric Dumazet rcu_read_unlock(); 19721da177e4SLinus Torvalds return -ESRCH; 19731da177e4SLinus Torvalds } 19741da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 19751d7138deSEric Dumazet rcu_read_unlock(); 19761da177e4SLinus Torvalds 19771da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 19781da177e4SLinus Torvalds sf_markstate(pmc); 19791da177e4SLinus Torvalds #endif 19801da177e4SLinus Torvalds isexclude = pmc->sfmode == MCAST_EXCLUDE; 19811da177e4SLinus Torvalds if (!delta) 19821da177e4SLinus Torvalds pmc->sfcount[sfmode]++; 19831da177e4SLinus Torvalds err = 0; 19841da177e4SLinus Torvalds for (i = 0; i < sfcount; i++) { 19855eb81e89SJun Zhao err = ip_mc_add1_src(pmc, sfmode, &psfsrc[i]); 19861da177e4SLinus Torvalds if (err) 19871da177e4SLinus Torvalds break; 19881da177e4SLinus Torvalds } 19891da177e4SLinus Torvalds if (err) { 19901da177e4SLinus Torvalds int j; 19911da177e4SLinus Torvalds 1992685f94e6SJun Zhao if (!delta) 19931da177e4SLinus Torvalds pmc->sfcount[sfmode]--; 19941da177e4SLinus Torvalds for (j = 0; j < i; j++) 1995a1889c0dSJulia Lawall (void) ip_mc_del1_src(pmc, sfmode, &psfsrc[j]); 19961da177e4SLinus Torvalds } else if (isexclude != (pmc->sfcount[MCAST_EXCLUDE] != 0)) { 19971da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 19981da177e4SLinus Torvalds struct ip_sf_list *psf; 1999cfcabdccSStephen Hemminger in_dev = pmc->interface; 20001da177e4SLinus Torvalds #endif 20011da177e4SLinus Torvalds 20021da177e4SLinus Torvalds /* filter mode change */ 20031da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) 20041da177e4SLinus Torvalds pmc->sfmode = MCAST_EXCLUDE; 20051da177e4SLinus Torvalds else if (pmc->sfcount[MCAST_INCLUDE]) 20061da177e4SLinus Torvalds pmc->sfmode = MCAST_INCLUDE; 20071da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 20081da177e4SLinus Torvalds /* else no filters; keep old mode for reports */ 20091da177e4SLinus Torvalds 2010a9fe8e29SHannes Frederic Sowa pmc->crcount = in_dev->mr_qrv ?: sysctl_igmp_qrv; 20111da177e4SLinus Torvalds in_dev->mr_ifc_count = pmc->crcount; 20121da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) 20131da177e4SLinus Torvalds psf->sf_crcount = 0; 20141da177e4SLinus Torvalds igmp_ifc_event(in_dev); 20151da177e4SLinus Torvalds } else if (sf_setstate(pmc)) { 20161da177e4SLinus Torvalds igmp_ifc_event(in_dev); 20171da177e4SLinus Torvalds #endif 20181da177e4SLinus Torvalds } 20191da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 20201da177e4SLinus Torvalds return err; 20211da177e4SLinus Torvalds } 20221da177e4SLinus Torvalds 20231da177e4SLinus Torvalds static void ip_mc_clear_src(struct ip_mc_list *pmc) 20241da177e4SLinus Torvalds { 20251da177e4SLinus Torvalds struct ip_sf_list *psf, *nextpsf; 20261da177e4SLinus Torvalds 20271da177e4SLinus Torvalds for (psf = pmc->tomb; psf; psf = nextpsf) { 20281da177e4SLinus Torvalds nextpsf = psf->sf_next; 20291da177e4SLinus Torvalds kfree(psf); 20301da177e4SLinus Torvalds } 20311da177e4SLinus Torvalds pmc->tomb = NULL; 20321da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = nextpsf) { 20331da177e4SLinus Torvalds nextpsf = psf->sf_next; 20341da177e4SLinus Torvalds kfree(psf); 20351da177e4SLinus Torvalds } 20361da177e4SLinus Torvalds pmc->sources = NULL; 20371da177e4SLinus Torvalds pmc->sfmode = MCAST_EXCLUDE; 2038de9daad9SDenis Lukianov pmc->sfcount[MCAST_INCLUDE] = 0; 20391da177e4SLinus Torvalds pmc->sfcount[MCAST_EXCLUDE] = 1; 20401da177e4SLinus Torvalds } 20411da177e4SLinus Torvalds 204254ff9ef3SMarcelo Ricardo Leitner /* Join a multicast group 204354ff9ef3SMarcelo Ricardo Leitner */ 204454ff9ef3SMarcelo Ricardo Leitner 204554ff9ef3SMarcelo Ricardo Leitner int ip_mc_join_group(struct sock *sk, struct ip_mreqn *imr) 20461da177e4SLinus Torvalds { 20478f935bbdSAl Viro __be32 addr = imr->imr_multiaddr.s_addr; 2048959d10f6SEric Dumazet struct ip_mc_socklist *iml, *i; 20491da177e4SLinus Torvalds struct in_device *in_dev; 20501da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 2051877acedcSDaniel Lezcano struct net *net = sock_net(sk); 2052ca9b907dSDavid L Stevens int ifindex; 20531da177e4SLinus Torvalds int count = 0; 2054959d10f6SEric Dumazet int err; 2055959d10f6SEric Dumazet 2056959d10f6SEric Dumazet ASSERT_RTNL(); 20571da177e4SLinus Torvalds 2058f97c1e0cSJoe Perches if (!ipv4_is_multicast(addr)) 20591da177e4SLinus Torvalds return -EINVAL; 20601da177e4SLinus Torvalds 2061877acedcSDaniel Lezcano in_dev = ip_mc_find_dev(net, imr); 20621da177e4SLinus Torvalds 20631da177e4SLinus Torvalds if (!in_dev) { 20641da177e4SLinus Torvalds err = -ENODEV; 20651da177e4SLinus Torvalds goto done; 20661da177e4SLinus Torvalds } 20671da177e4SLinus Torvalds 20681da177e4SLinus Torvalds err = -EADDRINUSE; 2069ca9b907dSDavid L Stevens ifindex = imr->imr_ifindex; 20701d7138deSEric Dumazet for_each_pmc_rtnl(inet, i) { 2071ca9b907dSDavid L Stevens if (i->multi.imr_multiaddr.s_addr == addr && 2072ca9b907dSDavid L Stevens i->multi.imr_ifindex == ifindex) 20731da177e4SLinus Torvalds goto done; 20741da177e4SLinus Torvalds count++; 20751da177e4SLinus Torvalds } 20761da177e4SLinus Torvalds err = -ENOBUFS; 2077ca9b907dSDavid L Stevens if (count >= sysctl_igmp_max_memberships) 20781da177e4SLinus Torvalds goto done; 20798b3a7005SKris Katterjohn iml = sock_kmalloc(sk, sizeof(*iml), GFP_KERNEL); 208051456b29SIan Morris if (!iml) 2081ca9b907dSDavid L Stevens goto done; 2082ca9b907dSDavid L Stevens 20831da177e4SLinus Torvalds memcpy(&iml->multi, imr, sizeof(*imr)); 20841d7138deSEric Dumazet iml->next_rcu = inet->mc_list; 20851da177e4SLinus Torvalds iml->sflist = NULL; 20861da177e4SLinus Torvalds iml->sfmode = MCAST_EXCLUDE; 2087cf778b00SEric Dumazet rcu_assign_pointer(inet->mc_list, iml); 20881da177e4SLinus Torvalds ip_mc_inc_group(in_dev, addr); 20891da177e4SLinus Torvalds err = 0; 20901da177e4SLinus Torvalds done: 20911da177e4SLinus Torvalds return err; 20921da177e4SLinus Torvalds } 20934bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_mc_join_group); 20941da177e4SLinus Torvalds 20951da177e4SLinus Torvalds static int ip_mc_leave_src(struct sock *sk, struct ip_mc_socklist *iml, 20961da177e4SLinus Torvalds struct in_device *in_dev) 20971da177e4SLinus Torvalds { 20981d7138deSEric Dumazet struct ip_sf_socklist *psf = rtnl_dereference(iml->sflist); 20991da177e4SLinus Torvalds int err; 21001da177e4SLinus Torvalds 210151456b29SIan Morris if (!psf) { 21021da177e4SLinus Torvalds /* any-source empty exclude case */ 21031da177e4SLinus Torvalds return ip_mc_del_src(in_dev, &iml->multi.imr_multiaddr.s_addr, 21041da177e4SLinus Torvalds iml->sfmode, 0, NULL, 0); 21051da177e4SLinus Torvalds } 21061da177e4SLinus Torvalds err = ip_mc_del_src(in_dev, &iml->multi.imr_multiaddr.s_addr, 2107c85bb41eSFlavio Leitner iml->sfmode, psf->sl_count, psf->sl_addr, 0); 2108a9b3cd7fSStephen Hemminger RCU_INIT_POINTER(iml->sflist, NULL); 2109c85bb41eSFlavio Leitner /* decrease mem now to avoid the memleak warning */ 2110c85bb41eSFlavio Leitner atomic_sub(IP_SFLSIZE(psf->sl_max), &sk->sk_omem_alloc); 21117519cce4SLai Jiangshan kfree_rcu(psf, rcu); 21121da177e4SLinus Torvalds return err; 21131da177e4SLinus Torvalds } 21141da177e4SLinus Torvalds 211554ff9ef3SMarcelo Ricardo Leitner int ip_mc_leave_group(struct sock *sk, struct ip_mreqn *imr) 21161da177e4SLinus Torvalds { 21171da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 21181d7138deSEric Dumazet struct ip_mc_socklist *iml; 21191d7138deSEric Dumazet struct ip_mc_socklist __rcu **imlp; 212084b42baeSDavid L Stevens struct in_device *in_dev; 2121877acedcSDaniel Lezcano struct net *net = sock_net(sk); 21228f935bbdSAl Viro __be32 group = imr->imr_multiaddr.s_addr; 212384b42baeSDavid L Stevens u32 ifindex; 2124acd6e00bSDavid L Stevens int ret = -EADDRNOTAVAIL; 21251da177e4SLinus Torvalds 2126959d10f6SEric Dumazet ASSERT_RTNL(); 2127959d10f6SEric Dumazet 2128877acedcSDaniel Lezcano in_dev = ip_mc_find_dev(net, imr); 212952ad353aSdingtianhong if (!in_dev) { 213052ad353aSdingtianhong ret = -ENODEV; 213152ad353aSdingtianhong goto out; 213252ad353aSdingtianhong } 213384b42baeSDavid L Stevens ifindex = imr->imr_ifindex; 21341d7138deSEric Dumazet for (imlp = &inet->mc_list; 21351d7138deSEric Dumazet (iml = rtnl_dereference(*imlp)) != NULL; 21361d7138deSEric Dumazet imlp = &iml->next_rcu) { 2137acd6e00bSDavid L Stevens if (iml->multi.imr_multiaddr.s_addr != group) 2138acd6e00bSDavid L Stevens continue; 2139acd6e00bSDavid L Stevens if (ifindex) { 2140acd6e00bSDavid L Stevens if (iml->multi.imr_ifindex != ifindex) 2141acd6e00bSDavid L Stevens continue; 2142acd6e00bSDavid L Stevens } else if (imr->imr_address.s_addr && imr->imr_address.s_addr != 2143acd6e00bSDavid L Stevens iml->multi.imr_address.s_addr) 2144acd6e00bSDavid L Stevens continue; 2145acd6e00bSDavid L Stevens 21461da177e4SLinus Torvalds (void) ip_mc_leave_src(sk, iml, in_dev); 21471da177e4SLinus Torvalds 21481d7138deSEric Dumazet *imlp = iml->next_rcu; 21491da177e4SLinus Torvalds 215084b42baeSDavid L Stevens ip_mc_dec_group(in_dev, group); 2151959d10f6SEric Dumazet 2152c85bb41eSFlavio Leitner /* decrease mem now to avoid the memleak warning */ 2153c85bb41eSFlavio Leitner atomic_sub(sizeof(*iml), &sk->sk_omem_alloc); 215410d50e74SLai Jiangshan kfree_rcu(iml, rcu); 21551da177e4SLinus Torvalds return 0; 21561da177e4SLinus Torvalds } 215752ad353aSdingtianhong out: 2158959d10f6SEric Dumazet return ret; 2159959d10f6SEric Dumazet } 2160193ba924Sstephen hemminger EXPORT_SYMBOL(ip_mc_leave_group); 21611da177e4SLinus Torvalds 21621da177e4SLinus Torvalds int ip_mc_source(int add, int omode, struct sock *sk, struct 21631da177e4SLinus Torvalds ip_mreq_source *mreqs, int ifindex) 21641da177e4SLinus Torvalds { 21651da177e4SLinus Torvalds int err; 21661da177e4SLinus Torvalds struct ip_mreqn imr; 216763007727SAl Viro __be32 addr = mreqs->imr_multiaddr; 21681da177e4SLinus Torvalds struct ip_mc_socklist *pmc; 21691da177e4SLinus Torvalds struct in_device *in_dev = NULL; 21701da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 21711da177e4SLinus Torvalds struct ip_sf_socklist *psl; 2172877acedcSDaniel Lezcano struct net *net = sock_net(sk); 21738cdaaa15SDavid L Stevens int leavegroup = 0; 21741da177e4SLinus Torvalds int i, j, rv; 21751da177e4SLinus Torvalds 2176f97c1e0cSJoe Perches if (!ipv4_is_multicast(addr)) 21771da177e4SLinus Torvalds return -EINVAL; 21781da177e4SLinus Torvalds 217954ff9ef3SMarcelo Ricardo Leitner ASSERT_RTNL(); 21801da177e4SLinus Torvalds 21811da177e4SLinus Torvalds imr.imr_multiaddr.s_addr = mreqs->imr_multiaddr; 21821da177e4SLinus Torvalds imr.imr_address.s_addr = mreqs->imr_interface; 21831da177e4SLinus Torvalds imr.imr_ifindex = ifindex; 2184877acedcSDaniel Lezcano in_dev = ip_mc_find_dev(net, &imr); 21851da177e4SLinus Torvalds 21861da177e4SLinus Torvalds if (!in_dev) { 21871da177e4SLinus Torvalds err = -ENODEV; 21881da177e4SLinus Torvalds goto done; 21891da177e4SLinus Torvalds } 21901da177e4SLinus Torvalds err = -EADDRNOTAVAIL; 21911da177e4SLinus Torvalds 21921d7138deSEric Dumazet for_each_pmc_rtnl(inet, pmc) { 2193f64f9e71SJoe Perches if ((pmc->multi.imr_multiaddr.s_addr == 2194f64f9e71SJoe Perches imr.imr_multiaddr.s_addr) && 2195f64f9e71SJoe Perches (pmc->multi.imr_ifindex == imr.imr_ifindex)) 21961da177e4SLinus Torvalds break; 21971da177e4SLinus Torvalds } 2198917f2f10SDavid L Stevens if (!pmc) { /* must have a prior join */ 2199917f2f10SDavid L Stevens err = -EINVAL; 22001da177e4SLinus Torvalds goto done; 2201917f2f10SDavid L Stevens } 22021da177e4SLinus Torvalds /* if a source filter was set, must be the same mode as before */ 22031da177e4SLinus Torvalds if (pmc->sflist) { 2204917f2f10SDavid L Stevens if (pmc->sfmode != omode) { 2205917f2f10SDavid L Stevens err = -EINVAL; 22061da177e4SLinus Torvalds goto done; 2207917f2f10SDavid L Stevens } 22081da177e4SLinus Torvalds } else if (pmc->sfmode != omode) { 22091da177e4SLinus Torvalds /* allow mode switches for empty-set filters */ 22101da177e4SLinus Torvalds ip_mc_add_src(in_dev, &mreqs->imr_multiaddr, omode, 0, NULL, 0); 22111da177e4SLinus Torvalds ip_mc_del_src(in_dev, &mreqs->imr_multiaddr, pmc->sfmode, 0, 22121da177e4SLinus Torvalds NULL, 0); 22131da177e4SLinus Torvalds pmc->sfmode = omode; 22141da177e4SLinus Torvalds } 22151da177e4SLinus Torvalds 22161d7138deSEric Dumazet psl = rtnl_dereference(pmc->sflist); 22171da177e4SLinus Torvalds if (!add) { 22181da177e4SLinus Torvalds if (!psl) 2219917f2f10SDavid L Stevens goto done; /* err = -EADDRNOTAVAIL */ 22201da177e4SLinus Torvalds rv = !0; 22211da177e4SLinus Torvalds for (i = 0; i < psl->sl_count; i++) { 22221da177e4SLinus Torvalds rv = memcmp(&psl->sl_addr[i], &mreqs->imr_sourceaddr, 222363007727SAl Viro sizeof(__be32)); 22241da177e4SLinus Torvalds if (rv == 0) 22251da177e4SLinus Torvalds break; 22261da177e4SLinus Torvalds } 22271da177e4SLinus Torvalds if (rv) /* source not found */ 2228917f2f10SDavid L Stevens goto done; /* err = -EADDRNOTAVAIL */ 22291da177e4SLinus Torvalds 22308cdaaa15SDavid L Stevens /* special case - (INCLUDE, empty) == LEAVE_GROUP */ 22318cdaaa15SDavid L Stevens if (psl->sl_count == 1 && omode == MCAST_INCLUDE) { 22328cdaaa15SDavid L Stevens leavegroup = 1; 22338cdaaa15SDavid L Stevens goto done; 22348cdaaa15SDavid L Stevens } 22358cdaaa15SDavid L Stevens 22361da177e4SLinus Torvalds /* update the interface filter */ 22371da177e4SLinus Torvalds ip_mc_del_src(in_dev, &mreqs->imr_multiaddr, omode, 1, 22381da177e4SLinus Torvalds &mreqs->imr_sourceaddr, 1); 22391da177e4SLinus Torvalds 22401da177e4SLinus Torvalds for (j = i+1; j < psl->sl_count; j++) 22411da177e4SLinus Torvalds psl->sl_addr[j-1] = psl->sl_addr[j]; 22421da177e4SLinus Torvalds psl->sl_count--; 22431da177e4SLinus Torvalds err = 0; 22441da177e4SLinus Torvalds goto done; 22451da177e4SLinus Torvalds } 22461da177e4SLinus Torvalds /* else, add a new source to the filter */ 22471da177e4SLinus Torvalds 22481da177e4SLinus Torvalds if (psl && psl->sl_count >= sysctl_igmp_max_msf) { 22491da177e4SLinus Torvalds err = -ENOBUFS; 22501da177e4SLinus Torvalds goto done; 22511da177e4SLinus Torvalds } 22521da177e4SLinus Torvalds if (!psl || psl->sl_count == psl->sl_max) { 22531da177e4SLinus Torvalds struct ip_sf_socklist *newpsl; 22541da177e4SLinus Torvalds int count = IP_SFBLOCK; 22551da177e4SLinus Torvalds 22561da177e4SLinus Torvalds if (psl) 22571da177e4SLinus Torvalds count += psl->sl_max; 22588b3a7005SKris Katterjohn newpsl = sock_kmalloc(sk, IP_SFLSIZE(count), GFP_KERNEL); 22591da177e4SLinus Torvalds if (!newpsl) { 22601da177e4SLinus Torvalds err = -ENOBUFS; 22611da177e4SLinus Torvalds goto done; 22621da177e4SLinus Torvalds } 22631da177e4SLinus Torvalds newpsl->sl_max = count; 22641da177e4SLinus Torvalds newpsl->sl_count = count - IP_SFBLOCK; 22651da177e4SLinus Torvalds if (psl) { 22661da177e4SLinus Torvalds for (i = 0; i < psl->sl_count; i++) 22671da177e4SLinus Torvalds newpsl->sl_addr[i] = psl->sl_addr[i]; 2268c85bb41eSFlavio Leitner /* decrease mem now to avoid the memleak warning */ 2269c85bb41eSFlavio Leitner atomic_sub(IP_SFLSIZE(psl->sl_max), &sk->sk_omem_alloc); 22707519cce4SLai Jiangshan kfree_rcu(psl, rcu); 22711da177e4SLinus Torvalds } 2272cf778b00SEric Dumazet rcu_assign_pointer(pmc->sflist, newpsl); 2273c85bb41eSFlavio Leitner psl = newpsl; 22741da177e4SLinus Torvalds } 22751da177e4SLinus Torvalds rv = 1; /* > 0 for insert logic below if sl_count is 0 */ 22761da177e4SLinus Torvalds for (i = 0; i < psl->sl_count; i++) { 22771da177e4SLinus Torvalds rv = memcmp(&psl->sl_addr[i], &mreqs->imr_sourceaddr, 227863007727SAl Viro sizeof(__be32)); 22791da177e4SLinus Torvalds if (rv == 0) 22801da177e4SLinus Torvalds break; 22811da177e4SLinus Torvalds } 22821da177e4SLinus Torvalds if (rv == 0) /* address already there is an error */ 22831da177e4SLinus Torvalds goto done; 22841da177e4SLinus Torvalds for (j = psl->sl_count-1; j >= i; j--) 22851da177e4SLinus Torvalds psl->sl_addr[j+1] = psl->sl_addr[j]; 22861da177e4SLinus Torvalds psl->sl_addr[i] = mreqs->imr_sourceaddr; 22871da177e4SLinus Torvalds psl->sl_count++; 22881da177e4SLinus Torvalds err = 0; 22891da177e4SLinus Torvalds /* update the interface list */ 22901da177e4SLinus Torvalds ip_mc_add_src(in_dev, &mreqs->imr_multiaddr, omode, 1, 22911da177e4SLinus Torvalds &mreqs->imr_sourceaddr, 1); 22921da177e4SLinus Torvalds done: 22938cdaaa15SDavid L Stevens if (leavegroup) 229454ff9ef3SMarcelo Ricardo Leitner err = ip_mc_leave_group(sk, &imr); 22951da177e4SLinus Torvalds return err; 22961da177e4SLinus Torvalds } 22971da177e4SLinus Torvalds 22981da177e4SLinus Torvalds int ip_mc_msfilter(struct sock *sk, struct ip_msfilter *msf, int ifindex) 22991da177e4SLinus Torvalds { 23009951f036SDavid L Stevens int err = 0; 23011da177e4SLinus Torvalds struct ip_mreqn imr; 230263007727SAl Viro __be32 addr = msf->imsf_multiaddr; 23031da177e4SLinus Torvalds struct ip_mc_socklist *pmc; 23041da177e4SLinus Torvalds struct in_device *in_dev; 23051da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 23061da177e4SLinus Torvalds struct ip_sf_socklist *newpsl, *psl; 2307877acedcSDaniel Lezcano struct net *net = sock_net(sk); 23089951f036SDavid L Stevens int leavegroup = 0; 23091da177e4SLinus Torvalds 2310f97c1e0cSJoe Perches if (!ipv4_is_multicast(addr)) 23111da177e4SLinus Torvalds return -EINVAL; 23121da177e4SLinus Torvalds if (msf->imsf_fmode != MCAST_INCLUDE && 23131da177e4SLinus Torvalds msf->imsf_fmode != MCAST_EXCLUDE) 23141da177e4SLinus Torvalds return -EINVAL; 23151da177e4SLinus Torvalds 231654ff9ef3SMarcelo Ricardo Leitner ASSERT_RTNL(); 23171da177e4SLinus Torvalds 23181da177e4SLinus Torvalds imr.imr_multiaddr.s_addr = msf->imsf_multiaddr; 23191da177e4SLinus Torvalds imr.imr_address.s_addr = msf->imsf_interface; 23201da177e4SLinus Torvalds imr.imr_ifindex = ifindex; 2321877acedcSDaniel Lezcano in_dev = ip_mc_find_dev(net, &imr); 23221da177e4SLinus Torvalds 23231da177e4SLinus Torvalds if (!in_dev) { 23241da177e4SLinus Torvalds err = -ENODEV; 23251da177e4SLinus Torvalds goto done; 23261da177e4SLinus Torvalds } 23271da177e4SLinus Torvalds 23289951f036SDavid L Stevens /* special case - (INCLUDE, empty) == LEAVE_GROUP */ 23299951f036SDavid L Stevens if (msf->imsf_fmode == MCAST_INCLUDE && msf->imsf_numsrc == 0) { 23309951f036SDavid L Stevens leavegroup = 1; 23319951f036SDavid L Stevens goto done; 23329951f036SDavid L Stevens } 23339951f036SDavid L Stevens 23341d7138deSEric Dumazet for_each_pmc_rtnl(inet, pmc) { 23351da177e4SLinus Torvalds if (pmc->multi.imr_multiaddr.s_addr == msf->imsf_multiaddr && 23361da177e4SLinus Torvalds pmc->multi.imr_ifindex == imr.imr_ifindex) 23371da177e4SLinus Torvalds break; 23381da177e4SLinus Torvalds } 2339917f2f10SDavid L Stevens if (!pmc) { /* must have a prior join */ 2340917f2f10SDavid L Stevens err = -EINVAL; 23411da177e4SLinus Torvalds goto done; 2342917f2f10SDavid L Stevens } 23431da177e4SLinus Torvalds if (msf->imsf_numsrc) { 23448b3a7005SKris Katterjohn newpsl = sock_kmalloc(sk, IP_SFLSIZE(msf->imsf_numsrc), 23458b3a7005SKris Katterjohn GFP_KERNEL); 23461da177e4SLinus Torvalds if (!newpsl) { 23471da177e4SLinus Torvalds err = -ENOBUFS; 23481da177e4SLinus Torvalds goto done; 23491da177e4SLinus Torvalds } 23501da177e4SLinus Torvalds newpsl->sl_max = newpsl->sl_count = msf->imsf_numsrc; 23511da177e4SLinus Torvalds memcpy(newpsl->sl_addr, msf->imsf_slist, 23521da177e4SLinus Torvalds msf->imsf_numsrc * sizeof(msf->imsf_slist[0])); 23531da177e4SLinus Torvalds err = ip_mc_add_src(in_dev, &msf->imsf_multiaddr, 23541da177e4SLinus Torvalds msf->imsf_fmode, newpsl->sl_count, newpsl->sl_addr, 0); 23551da177e4SLinus Torvalds if (err) { 23561da177e4SLinus Torvalds sock_kfree_s(sk, newpsl, IP_SFLSIZE(newpsl->sl_max)); 23571da177e4SLinus Torvalds goto done; 23581da177e4SLinus Torvalds } 23598713dbf0SYan Zheng } else { 23601da177e4SLinus Torvalds newpsl = NULL; 23618713dbf0SYan Zheng (void) ip_mc_add_src(in_dev, &msf->imsf_multiaddr, 23628713dbf0SYan Zheng msf->imsf_fmode, 0, NULL, 0); 23638713dbf0SYan Zheng } 23641d7138deSEric Dumazet psl = rtnl_dereference(pmc->sflist); 23651da177e4SLinus Torvalds if (psl) { 23661da177e4SLinus Torvalds (void) ip_mc_del_src(in_dev, &msf->imsf_multiaddr, pmc->sfmode, 23671da177e4SLinus Torvalds psl->sl_count, psl->sl_addr, 0); 2368c85bb41eSFlavio Leitner /* decrease mem now to avoid the memleak warning */ 2369c85bb41eSFlavio Leitner atomic_sub(IP_SFLSIZE(psl->sl_max), &sk->sk_omem_alloc); 23707519cce4SLai Jiangshan kfree_rcu(psl, rcu); 23711da177e4SLinus Torvalds } else 23721da177e4SLinus Torvalds (void) ip_mc_del_src(in_dev, &msf->imsf_multiaddr, pmc->sfmode, 23731da177e4SLinus Torvalds 0, NULL, 0); 2374cf778b00SEric Dumazet rcu_assign_pointer(pmc->sflist, newpsl); 23751da177e4SLinus Torvalds pmc->sfmode = msf->imsf_fmode; 2376917f2f10SDavid L Stevens err = 0; 23771da177e4SLinus Torvalds done: 23789951f036SDavid L Stevens if (leavegroup) 23799951f036SDavid L Stevens err = ip_mc_leave_group(sk, &imr); 23801da177e4SLinus Torvalds return err; 23811da177e4SLinus Torvalds } 23821da177e4SLinus Torvalds 23831da177e4SLinus Torvalds int ip_mc_msfget(struct sock *sk, struct ip_msfilter *msf, 23841da177e4SLinus Torvalds struct ip_msfilter __user *optval, int __user *optlen) 23851da177e4SLinus Torvalds { 23861da177e4SLinus Torvalds int err, len, count, copycount; 23871da177e4SLinus Torvalds struct ip_mreqn imr; 238863007727SAl Viro __be32 addr = msf->imsf_multiaddr; 23891da177e4SLinus Torvalds struct ip_mc_socklist *pmc; 23901da177e4SLinus Torvalds struct in_device *in_dev; 23911da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 23921da177e4SLinus Torvalds struct ip_sf_socklist *psl; 2393877acedcSDaniel Lezcano struct net *net = sock_net(sk); 23941da177e4SLinus Torvalds 2395*87e9f031SWANG Cong ASSERT_RTNL(); 2396*87e9f031SWANG Cong 2397f97c1e0cSJoe Perches if (!ipv4_is_multicast(addr)) 23981da177e4SLinus Torvalds return -EINVAL; 23991da177e4SLinus Torvalds 24001da177e4SLinus Torvalds imr.imr_multiaddr.s_addr = msf->imsf_multiaddr; 24011da177e4SLinus Torvalds imr.imr_address.s_addr = msf->imsf_interface; 24021da177e4SLinus Torvalds imr.imr_ifindex = 0; 2403877acedcSDaniel Lezcano in_dev = ip_mc_find_dev(net, &imr); 24041da177e4SLinus Torvalds 24051da177e4SLinus Torvalds if (!in_dev) { 24061da177e4SLinus Torvalds err = -ENODEV; 24071da177e4SLinus Torvalds goto done; 24081da177e4SLinus Torvalds } 24091da177e4SLinus Torvalds err = -EADDRNOTAVAIL; 24101da177e4SLinus Torvalds 24111d7138deSEric Dumazet for_each_pmc_rtnl(inet, pmc) { 24121da177e4SLinus Torvalds if (pmc->multi.imr_multiaddr.s_addr == msf->imsf_multiaddr && 24131da177e4SLinus Torvalds pmc->multi.imr_ifindex == imr.imr_ifindex) 24141da177e4SLinus Torvalds break; 24151da177e4SLinus Torvalds } 24161da177e4SLinus Torvalds if (!pmc) /* must have a prior join */ 24171da177e4SLinus Torvalds goto done; 24181da177e4SLinus Torvalds msf->imsf_fmode = pmc->sfmode; 24191d7138deSEric Dumazet psl = rtnl_dereference(pmc->sflist); 24201da177e4SLinus Torvalds if (!psl) { 24211da177e4SLinus Torvalds len = 0; 24221da177e4SLinus Torvalds count = 0; 24231da177e4SLinus Torvalds } else { 24241da177e4SLinus Torvalds count = psl->sl_count; 24251da177e4SLinus Torvalds } 24261da177e4SLinus Torvalds copycount = count < msf->imsf_numsrc ? count : msf->imsf_numsrc; 24271da177e4SLinus Torvalds len = copycount * sizeof(psl->sl_addr[0]); 24281da177e4SLinus Torvalds msf->imsf_numsrc = count; 24291da177e4SLinus Torvalds if (put_user(IP_MSFILTER_SIZE(copycount), optlen) || 24301da177e4SLinus Torvalds copy_to_user(optval, msf, IP_MSFILTER_SIZE(0))) { 24311da177e4SLinus Torvalds return -EFAULT; 24321da177e4SLinus Torvalds } 24331da177e4SLinus Torvalds if (len && 24341da177e4SLinus Torvalds copy_to_user(&optval->imsf_slist[0], psl->sl_addr, len)) 24351da177e4SLinus Torvalds return -EFAULT; 24361da177e4SLinus Torvalds return 0; 24371da177e4SLinus Torvalds done: 24381da177e4SLinus Torvalds return err; 24391da177e4SLinus Torvalds } 24401da177e4SLinus Torvalds 24411da177e4SLinus Torvalds int ip_mc_gsfget(struct sock *sk, struct group_filter *gsf, 24421da177e4SLinus Torvalds struct group_filter __user *optval, int __user *optlen) 24431da177e4SLinus Torvalds { 24441da177e4SLinus Torvalds int err, i, count, copycount; 24451da177e4SLinus Torvalds struct sockaddr_in *psin; 244663007727SAl Viro __be32 addr; 24471da177e4SLinus Torvalds struct ip_mc_socklist *pmc; 24481da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 24491da177e4SLinus Torvalds struct ip_sf_socklist *psl; 24501da177e4SLinus Torvalds 2451*87e9f031SWANG Cong ASSERT_RTNL(); 2452*87e9f031SWANG Cong 24531da177e4SLinus Torvalds psin = (struct sockaddr_in *)&gsf->gf_group; 24541da177e4SLinus Torvalds if (psin->sin_family != AF_INET) 24551da177e4SLinus Torvalds return -EINVAL; 24561da177e4SLinus Torvalds addr = psin->sin_addr.s_addr; 2457f97c1e0cSJoe Perches if (!ipv4_is_multicast(addr)) 24581da177e4SLinus Torvalds return -EINVAL; 24591da177e4SLinus Torvalds 24601da177e4SLinus Torvalds err = -EADDRNOTAVAIL; 24611da177e4SLinus Torvalds 24621d7138deSEric Dumazet for_each_pmc_rtnl(inet, pmc) { 24631da177e4SLinus Torvalds if (pmc->multi.imr_multiaddr.s_addr == addr && 24641da177e4SLinus Torvalds pmc->multi.imr_ifindex == gsf->gf_interface) 24651da177e4SLinus Torvalds break; 24661da177e4SLinus Torvalds } 24671da177e4SLinus Torvalds if (!pmc) /* must have a prior join */ 24681da177e4SLinus Torvalds goto done; 24691da177e4SLinus Torvalds gsf->gf_fmode = pmc->sfmode; 24701d7138deSEric Dumazet psl = rtnl_dereference(pmc->sflist); 24711da177e4SLinus Torvalds count = psl ? psl->sl_count : 0; 24721da177e4SLinus Torvalds copycount = count < gsf->gf_numsrc ? count : gsf->gf_numsrc; 24731da177e4SLinus Torvalds gsf->gf_numsrc = count; 24741da177e4SLinus Torvalds if (put_user(GROUP_FILTER_SIZE(copycount), optlen) || 24751da177e4SLinus Torvalds copy_to_user(optval, gsf, GROUP_FILTER_SIZE(0))) { 24761da177e4SLinus Torvalds return -EFAULT; 24771da177e4SLinus Torvalds } 24781da177e4SLinus Torvalds for (i = 0; i < copycount; i++) { 24791da177e4SLinus Torvalds struct sockaddr_storage ss; 24801da177e4SLinus Torvalds 24811da177e4SLinus Torvalds psin = (struct sockaddr_in *)&ss; 24821da177e4SLinus Torvalds memset(&ss, 0, sizeof(ss)); 24831da177e4SLinus Torvalds psin->sin_family = AF_INET; 24841da177e4SLinus Torvalds psin->sin_addr.s_addr = psl->sl_addr[i]; 24851da177e4SLinus Torvalds if (copy_to_user(&optval->gf_slist[i], &ss, sizeof(ss))) 24861da177e4SLinus Torvalds return -EFAULT; 24871da177e4SLinus Torvalds } 24881da177e4SLinus Torvalds return 0; 24891da177e4SLinus Torvalds done: 24901da177e4SLinus Torvalds return err; 24911da177e4SLinus Torvalds } 24921da177e4SLinus Torvalds 24931da177e4SLinus Torvalds /* 24941da177e4SLinus Torvalds * check if a multicast source filter allows delivery for a given <src,dst,intf> 24951da177e4SLinus Torvalds */ 2496c0cda068SAl Viro int ip_mc_sf_allow(struct sock *sk, __be32 loc_addr, __be32 rmt_addr, int dif) 24971da177e4SLinus Torvalds { 24981da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 24991da177e4SLinus Torvalds struct ip_mc_socklist *pmc; 25001da177e4SLinus Torvalds struct ip_sf_socklist *psl; 25011da177e4SLinus Torvalds int i; 2502c85bb41eSFlavio Leitner int ret; 25031da177e4SLinus Torvalds 2504c85bb41eSFlavio Leitner ret = 1; 2505f97c1e0cSJoe Perches if (!ipv4_is_multicast(loc_addr)) 2506c85bb41eSFlavio Leitner goto out; 25071da177e4SLinus Torvalds 2508c85bb41eSFlavio Leitner rcu_read_lock(); 25091d7138deSEric Dumazet for_each_pmc_rcu(inet, pmc) { 25101da177e4SLinus Torvalds if (pmc->multi.imr_multiaddr.s_addr == loc_addr && 25111da177e4SLinus Torvalds pmc->multi.imr_ifindex == dif) 25121da177e4SLinus Torvalds break; 25131da177e4SLinus Torvalds } 2514c85bb41eSFlavio Leitner ret = inet->mc_all; 25151da177e4SLinus Torvalds if (!pmc) 2516c85bb41eSFlavio Leitner goto unlock; 25171d7138deSEric Dumazet psl = rcu_dereference(pmc->sflist); 2518c85bb41eSFlavio Leitner ret = (pmc->sfmode == MCAST_EXCLUDE); 25191da177e4SLinus Torvalds if (!psl) 2520c85bb41eSFlavio Leitner goto unlock; 25211da177e4SLinus Torvalds 25221da177e4SLinus Torvalds for (i = 0; i < psl->sl_count; i++) { 25231da177e4SLinus Torvalds if (psl->sl_addr[i] == rmt_addr) 25241da177e4SLinus Torvalds break; 25251da177e4SLinus Torvalds } 2526c85bb41eSFlavio Leitner ret = 0; 25271da177e4SLinus Torvalds if (pmc->sfmode == MCAST_INCLUDE && i >= psl->sl_count) 2528c85bb41eSFlavio Leitner goto unlock; 25291da177e4SLinus Torvalds if (pmc->sfmode == MCAST_EXCLUDE && i < psl->sl_count) 2530c85bb41eSFlavio Leitner goto unlock; 2531c85bb41eSFlavio Leitner ret = 1; 2532c85bb41eSFlavio Leitner unlock: 2533c85bb41eSFlavio Leitner rcu_read_unlock(); 2534c85bb41eSFlavio Leitner out: 2535c85bb41eSFlavio Leitner return ret; 25361da177e4SLinus Torvalds } 25371da177e4SLinus Torvalds 25381da177e4SLinus Torvalds /* 25391da177e4SLinus Torvalds * A socket is closing. 25401da177e4SLinus Torvalds */ 25411da177e4SLinus Torvalds 25421da177e4SLinus Torvalds void ip_mc_drop_socket(struct sock *sk) 25431da177e4SLinus Torvalds { 25441da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 25451da177e4SLinus Torvalds struct ip_mc_socklist *iml; 2546877acedcSDaniel Lezcano struct net *net = sock_net(sk); 25471da177e4SLinus Torvalds 254851456b29SIan Morris if (!inet->mc_list) 25491da177e4SLinus Torvalds return; 25501da177e4SLinus Torvalds 25511da177e4SLinus Torvalds rtnl_lock(); 25521d7138deSEric Dumazet while ((iml = rtnl_dereference(inet->mc_list)) != NULL) { 25531da177e4SLinus Torvalds struct in_device *in_dev; 25541da177e4SLinus Torvalds 25551d7138deSEric Dumazet inet->mc_list = iml->next_rcu; 2556877acedcSDaniel Lezcano in_dev = inetdev_by_index(net, iml->multi.imr_ifindex); 25571da177e4SLinus Torvalds (void) ip_mc_leave_src(sk, iml, in_dev); 255800db4124SIan Morris if (in_dev) 25591da177e4SLinus Torvalds ip_mc_dec_group(in_dev, iml->multi.imr_multiaddr.s_addr); 2560c85bb41eSFlavio Leitner /* decrease mem now to avoid the memleak warning */ 2561c85bb41eSFlavio Leitner atomic_sub(sizeof(*iml), &sk->sk_omem_alloc); 256210d50e74SLai Jiangshan kfree_rcu(iml, rcu); 25631da177e4SLinus Torvalds } 25641da177e4SLinus Torvalds rtnl_unlock(); 25651da177e4SLinus Torvalds } 25661da177e4SLinus Torvalds 2567dbdd9a52SDavid S. Miller /* called with rcu_read_lock() */ 25682094acbbSAlexander Duyck int ip_check_mc_rcu(struct in_device *in_dev, __be32 mc_addr, __be32 src_addr, u8 proto) 25691da177e4SLinus Torvalds { 25701da177e4SLinus Torvalds struct ip_mc_list *im; 2571e9897071SEric Dumazet struct ip_mc_list __rcu **mc_hash; 25721da177e4SLinus Torvalds struct ip_sf_list *psf; 25731da177e4SLinus Torvalds int rv = 0; 25741da177e4SLinus Torvalds 2575e9897071SEric Dumazet mc_hash = rcu_dereference(in_dev->mc_hash); 2576e9897071SEric Dumazet if (mc_hash) { 2577c70eba74SEric Dumazet u32 hash = hash_32((__force u32)mc_addr, MC_HASH_SZ_LOG); 2578e9897071SEric Dumazet 2579e9897071SEric Dumazet for (im = rcu_dereference(mc_hash[hash]); 2580e9897071SEric Dumazet im != NULL; 2581e9897071SEric Dumazet im = rcu_dereference(im->next_hash)) { 2582e9897071SEric Dumazet if (im->multiaddr == mc_addr) 2583e9897071SEric Dumazet break; 2584e9897071SEric Dumazet } 2585e9897071SEric Dumazet } else { 25861d7138deSEric Dumazet for_each_pmc_rcu(in_dev, im) { 25871da177e4SLinus Torvalds if (im->multiaddr == mc_addr) 25881da177e4SLinus Torvalds break; 25891da177e4SLinus Torvalds } 2590e9897071SEric Dumazet } 25911da177e4SLinus Torvalds if (im && proto == IPPROTO_IGMP) { 25921da177e4SLinus Torvalds rv = 1; 25931da177e4SLinus Torvalds } else if (im) { 25941da177e4SLinus Torvalds if (src_addr) { 25951da177e4SLinus Torvalds for (psf = im->sources; psf; psf = psf->sf_next) { 25961da177e4SLinus Torvalds if (psf->sf_inaddr == src_addr) 25971da177e4SLinus Torvalds break; 25981da177e4SLinus Torvalds } 25991da177e4SLinus Torvalds if (psf) 26001da177e4SLinus Torvalds rv = psf->sf_count[MCAST_INCLUDE] || 26011da177e4SLinus Torvalds psf->sf_count[MCAST_EXCLUDE] != 26021da177e4SLinus Torvalds im->sfcount[MCAST_EXCLUDE]; 26031da177e4SLinus Torvalds else 26041da177e4SLinus Torvalds rv = im->sfcount[MCAST_EXCLUDE] != 0; 26051da177e4SLinus Torvalds } else 26061da177e4SLinus Torvalds rv = 1; /* unspecified source; tentatively allow */ 26071da177e4SLinus Torvalds } 26081da177e4SLinus Torvalds return rv; 26091da177e4SLinus Torvalds } 26101da177e4SLinus Torvalds 26111da177e4SLinus Torvalds #if defined(CONFIG_PROC_FS) 26121da177e4SLinus Torvalds struct igmp_mc_iter_state { 26137091e728SAlexey Dobriyan struct seq_net_private p; 26141da177e4SLinus Torvalds struct net_device *dev; 26151da177e4SLinus Torvalds struct in_device *in_dev; 26161da177e4SLinus Torvalds }; 26171da177e4SLinus Torvalds 26181da177e4SLinus Torvalds #define igmp_mc_seq_private(seq) ((struct igmp_mc_iter_state *)(seq)->private) 26191da177e4SLinus Torvalds 26201da177e4SLinus Torvalds static inline struct ip_mc_list *igmp_mc_get_first(struct seq_file *seq) 26211da177e4SLinus Torvalds { 26227091e728SAlexey Dobriyan struct net *net = seq_file_net(seq); 26231da177e4SLinus Torvalds struct ip_mc_list *im = NULL; 26241da177e4SLinus Torvalds struct igmp_mc_iter_state *state = igmp_mc_seq_private(seq); 26251da177e4SLinus Torvalds 26267562f876SPavel Emelianov state->in_dev = NULL; 262761fbab77Sstephen hemminger for_each_netdev_rcu(net, state->dev) { 26281da177e4SLinus Torvalds struct in_device *in_dev; 26296baff150SEric Dumazet 26306baff150SEric Dumazet in_dev = __in_dev_get_rcu(state->dev); 26311da177e4SLinus Torvalds if (!in_dev) 26321da177e4SLinus Torvalds continue; 26331d7138deSEric Dumazet im = rcu_dereference(in_dev->mc_list); 26341da177e4SLinus Torvalds if (im) { 26351da177e4SLinus Torvalds state->in_dev = in_dev; 26361da177e4SLinus Torvalds break; 26371da177e4SLinus Torvalds } 26381da177e4SLinus Torvalds } 26391da177e4SLinus Torvalds return im; 26401da177e4SLinus Torvalds } 26411da177e4SLinus Torvalds 26421da177e4SLinus Torvalds static struct ip_mc_list *igmp_mc_get_next(struct seq_file *seq, struct ip_mc_list *im) 26431da177e4SLinus Torvalds { 26441da177e4SLinus Torvalds struct igmp_mc_iter_state *state = igmp_mc_seq_private(seq); 26456baff150SEric Dumazet 26461d7138deSEric Dumazet im = rcu_dereference(im->next_rcu); 26471d7138deSEric Dumazet while (!im) { 26486baff150SEric Dumazet state->dev = next_net_device_rcu(state->dev); 26491da177e4SLinus Torvalds if (!state->dev) { 26501da177e4SLinus Torvalds state->in_dev = NULL; 26511da177e4SLinus Torvalds break; 26521da177e4SLinus Torvalds } 26536baff150SEric Dumazet state->in_dev = __in_dev_get_rcu(state->dev); 26541da177e4SLinus Torvalds if (!state->in_dev) 26551da177e4SLinus Torvalds continue; 26561d7138deSEric Dumazet im = rcu_dereference(state->in_dev->mc_list); 26571da177e4SLinus Torvalds } 26581da177e4SLinus Torvalds return im; 26591da177e4SLinus Torvalds } 26601da177e4SLinus Torvalds 26611da177e4SLinus Torvalds static struct ip_mc_list *igmp_mc_get_idx(struct seq_file *seq, loff_t pos) 26621da177e4SLinus Torvalds { 26631da177e4SLinus Torvalds struct ip_mc_list *im = igmp_mc_get_first(seq); 26641da177e4SLinus Torvalds if (im) 26651da177e4SLinus Torvalds while (pos && (im = igmp_mc_get_next(seq, im)) != NULL) 26661da177e4SLinus Torvalds --pos; 26671da177e4SLinus Torvalds return pos ? NULL : im; 26681da177e4SLinus Torvalds } 26691da177e4SLinus Torvalds 26701da177e4SLinus Torvalds static void *igmp_mc_seq_start(struct seq_file *seq, loff_t *pos) 267161fbab77Sstephen hemminger __acquires(rcu) 26721da177e4SLinus Torvalds { 267361fbab77Sstephen hemminger rcu_read_lock(); 26741da177e4SLinus Torvalds return *pos ? igmp_mc_get_idx(seq, *pos - 1) : SEQ_START_TOKEN; 26751da177e4SLinus Torvalds } 26761da177e4SLinus Torvalds 26771da177e4SLinus Torvalds static void *igmp_mc_seq_next(struct seq_file *seq, void *v, loff_t *pos) 26781da177e4SLinus Torvalds { 26791da177e4SLinus Torvalds struct ip_mc_list *im; 26801da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) 26811da177e4SLinus Torvalds im = igmp_mc_get_first(seq); 26821da177e4SLinus Torvalds else 26831da177e4SLinus Torvalds im = igmp_mc_get_next(seq, v); 26841da177e4SLinus Torvalds ++*pos; 26851da177e4SLinus Torvalds return im; 26861da177e4SLinus Torvalds } 26871da177e4SLinus Torvalds 26881da177e4SLinus Torvalds static void igmp_mc_seq_stop(struct seq_file *seq, void *v) 268961fbab77Sstephen hemminger __releases(rcu) 26901da177e4SLinus Torvalds { 26911da177e4SLinus Torvalds struct igmp_mc_iter_state *state = igmp_mc_seq_private(seq); 26921d7138deSEric Dumazet 26931da177e4SLinus Torvalds state->in_dev = NULL; 26941da177e4SLinus Torvalds state->dev = NULL; 269561fbab77Sstephen hemminger rcu_read_unlock(); 26961da177e4SLinus Torvalds } 26971da177e4SLinus Torvalds 26981da177e4SLinus Torvalds static int igmp_mc_seq_show(struct seq_file *seq, void *v) 26991da177e4SLinus Torvalds { 27001da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) 27011da177e4SLinus Torvalds seq_puts(seq, 27021da177e4SLinus Torvalds "Idx\tDevice : Count Querier\tGroup Users Timer\tReporter\n"); 27031da177e4SLinus Torvalds else { 27041da177e4SLinus Torvalds struct ip_mc_list *im = (struct ip_mc_list *)v; 27051da177e4SLinus Torvalds struct igmp_mc_iter_state *state = igmp_mc_seq_private(seq); 27061da177e4SLinus Torvalds char *querier; 2707a399a805SEric Dumazet long delta; 2708a399a805SEric Dumazet 27091da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 27101da177e4SLinus Torvalds querier = IGMP_V1_SEEN(state->in_dev) ? "V1" : 27111da177e4SLinus Torvalds IGMP_V2_SEEN(state->in_dev) ? "V2" : 27121da177e4SLinus Torvalds "V3"; 27131da177e4SLinus Torvalds #else 27141da177e4SLinus Torvalds querier = "NONE"; 27151da177e4SLinus Torvalds #endif 27161da177e4SLinus Torvalds 2717e6b68883SAndreea-Cristina Bernat if (rcu_access_pointer(state->in_dev->mc_list) == im) { 27181da177e4SLinus Torvalds seq_printf(seq, "%d\t%-10s: %5d %7s\n", 2719b8bae41eSRami Rosen state->dev->ifindex, state->dev->name, state->in_dev->mc_count, querier); 27201da177e4SLinus Torvalds } 27211da177e4SLinus Torvalds 2722a399a805SEric Dumazet delta = im->timer.expires - jiffies; 27231da177e4SLinus Torvalds seq_printf(seq, 2724338fcf98SAlexey Dobriyan "\t\t\t\t%08X %5d %d:%08lX\t\t%d\n", 27251da177e4SLinus Torvalds im->multiaddr, im->users, 2726a399a805SEric Dumazet im->tm_running, 2727a399a805SEric Dumazet im->tm_running ? jiffies_delta_to_clock_t(delta) : 0, 27281da177e4SLinus Torvalds im->reporter); 27291da177e4SLinus Torvalds } 27301da177e4SLinus Torvalds return 0; 27311da177e4SLinus Torvalds } 27321da177e4SLinus Torvalds 2733f690808eSStephen Hemminger static const struct seq_operations igmp_mc_seq_ops = { 27341da177e4SLinus Torvalds .start = igmp_mc_seq_start, 27351da177e4SLinus Torvalds .next = igmp_mc_seq_next, 27361da177e4SLinus Torvalds .stop = igmp_mc_seq_stop, 27371da177e4SLinus Torvalds .show = igmp_mc_seq_show, 27381da177e4SLinus Torvalds }; 27391da177e4SLinus Torvalds 27401da177e4SLinus Torvalds static int igmp_mc_seq_open(struct inode *inode, struct file *file) 27411da177e4SLinus Torvalds { 27427091e728SAlexey Dobriyan return seq_open_net(inode, file, &igmp_mc_seq_ops, 2743cf7732e4SPavel Emelyanov sizeof(struct igmp_mc_iter_state)); 27441da177e4SLinus Torvalds } 27451da177e4SLinus Torvalds 27469a32144eSArjan van de Ven static const struct file_operations igmp_mc_seq_fops = { 27471da177e4SLinus Torvalds .owner = THIS_MODULE, 27481da177e4SLinus Torvalds .open = igmp_mc_seq_open, 27491da177e4SLinus Torvalds .read = seq_read, 27501da177e4SLinus Torvalds .llseek = seq_lseek, 27517091e728SAlexey Dobriyan .release = seq_release_net, 27521da177e4SLinus Torvalds }; 27531da177e4SLinus Torvalds 27541da177e4SLinus Torvalds struct igmp_mcf_iter_state { 27557091e728SAlexey Dobriyan struct seq_net_private p; 27561da177e4SLinus Torvalds struct net_device *dev; 27571da177e4SLinus Torvalds struct in_device *idev; 27581da177e4SLinus Torvalds struct ip_mc_list *im; 27591da177e4SLinus Torvalds }; 27601da177e4SLinus Torvalds 27611da177e4SLinus Torvalds #define igmp_mcf_seq_private(seq) ((struct igmp_mcf_iter_state *)(seq)->private) 27621da177e4SLinus Torvalds 27631da177e4SLinus Torvalds static inline struct ip_sf_list *igmp_mcf_get_first(struct seq_file *seq) 27641da177e4SLinus Torvalds { 27657091e728SAlexey Dobriyan struct net *net = seq_file_net(seq); 27661da177e4SLinus Torvalds struct ip_sf_list *psf = NULL; 27671da177e4SLinus Torvalds struct ip_mc_list *im = NULL; 27681da177e4SLinus Torvalds struct igmp_mcf_iter_state *state = igmp_mcf_seq_private(seq); 27691da177e4SLinus Torvalds 27707562f876SPavel Emelianov state->idev = NULL; 27717562f876SPavel Emelianov state->im = NULL; 277261fbab77Sstephen hemminger for_each_netdev_rcu(net, state->dev) { 27731da177e4SLinus Torvalds struct in_device *idev; 27746baff150SEric Dumazet idev = __in_dev_get_rcu(state->dev); 277551456b29SIan Morris if (unlikely(!idev)) 27761da177e4SLinus Torvalds continue; 27771d7138deSEric Dumazet im = rcu_dereference(idev->mc_list); 277800db4124SIan Morris if (likely(im)) { 27791da177e4SLinus Torvalds spin_lock_bh(&im->lock); 27801da177e4SLinus Torvalds psf = im->sources; 278100db4124SIan Morris if (likely(psf)) { 27821da177e4SLinus Torvalds state->im = im; 27831da177e4SLinus Torvalds state->idev = idev; 27841da177e4SLinus Torvalds break; 27851da177e4SLinus Torvalds } 27861da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 27871da177e4SLinus Torvalds } 27881da177e4SLinus Torvalds } 27891da177e4SLinus Torvalds return psf; 27901da177e4SLinus Torvalds } 27911da177e4SLinus Torvalds 27921da177e4SLinus Torvalds static struct ip_sf_list *igmp_mcf_get_next(struct seq_file *seq, struct ip_sf_list *psf) 27931da177e4SLinus Torvalds { 27941da177e4SLinus Torvalds struct igmp_mcf_iter_state *state = igmp_mcf_seq_private(seq); 27951da177e4SLinus Torvalds 27961da177e4SLinus Torvalds psf = psf->sf_next; 27971da177e4SLinus Torvalds while (!psf) { 27981da177e4SLinus Torvalds spin_unlock_bh(&state->im->lock); 27991da177e4SLinus Torvalds state->im = state->im->next; 28001da177e4SLinus Torvalds while (!state->im) { 28016baff150SEric Dumazet state->dev = next_net_device_rcu(state->dev); 28021da177e4SLinus Torvalds if (!state->dev) { 28031da177e4SLinus Torvalds state->idev = NULL; 28041da177e4SLinus Torvalds goto out; 28051da177e4SLinus Torvalds } 28066baff150SEric Dumazet state->idev = __in_dev_get_rcu(state->dev); 28071da177e4SLinus Torvalds if (!state->idev) 28081da177e4SLinus Torvalds continue; 28091d7138deSEric Dumazet state->im = rcu_dereference(state->idev->mc_list); 28101da177e4SLinus Torvalds } 28111da177e4SLinus Torvalds if (!state->im) 28121da177e4SLinus Torvalds break; 28131da177e4SLinus Torvalds spin_lock_bh(&state->im->lock); 28141da177e4SLinus Torvalds psf = state->im->sources; 28151da177e4SLinus Torvalds } 28161da177e4SLinus Torvalds out: 28171da177e4SLinus Torvalds return psf; 28181da177e4SLinus Torvalds } 28191da177e4SLinus Torvalds 28201da177e4SLinus Torvalds static struct ip_sf_list *igmp_mcf_get_idx(struct seq_file *seq, loff_t pos) 28211da177e4SLinus Torvalds { 28221da177e4SLinus Torvalds struct ip_sf_list *psf = igmp_mcf_get_first(seq); 28231da177e4SLinus Torvalds if (psf) 28241da177e4SLinus Torvalds while (pos && (psf = igmp_mcf_get_next(seq, psf)) != NULL) 28251da177e4SLinus Torvalds --pos; 28261da177e4SLinus Torvalds return pos ? NULL : psf; 28271da177e4SLinus Torvalds } 28281da177e4SLinus Torvalds 28291da177e4SLinus Torvalds static void *igmp_mcf_seq_start(struct seq_file *seq, loff_t *pos) 283061fbab77Sstephen hemminger __acquires(rcu) 28311da177e4SLinus Torvalds { 283261fbab77Sstephen hemminger rcu_read_lock(); 28331da177e4SLinus Torvalds return *pos ? igmp_mcf_get_idx(seq, *pos - 1) : SEQ_START_TOKEN; 28341da177e4SLinus Torvalds } 28351da177e4SLinus Torvalds 28361da177e4SLinus Torvalds static void *igmp_mcf_seq_next(struct seq_file *seq, void *v, loff_t *pos) 28371da177e4SLinus Torvalds { 28381da177e4SLinus Torvalds struct ip_sf_list *psf; 28391da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) 28401da177e4SLinus Torvalds psf = igmp_mcf_get_first(seq); 28411da177e4SLinus Torvalds else 28421da177e4SLinus Torvalds psf = igmp_mcf_get_next(seq, v); 28431da177e4SLinus Torvalds ++*pos; 28441da177e4SLinus Torvalds return psf; 28451da177e4SLinus Torvalds } 28461da177e4SLinus Torvalds 28471da177e4SLinus Torvalds static void igmp_mcf_seq_stop(struct seq_file *seq, void *v) 284861fbab77Sstephen hemminger __releases(rcu) 28491da177e4SLinus Torvalds { 28501da177e4SLinus Torvalds struct igmp_mcf_iter_state *state = igmp_mcf_seq_private(seq); 285100db4124SIan Morris if (likely(state->im)) { 28521da177e4SLinus Torvalds spin_unlock_bh(&state->im->lock); 28531da177e4SLinus Torvalds state->im = NULL; 28541da177e4SLinus Torvalds } 28551da177e4SLinus Torvalds state->idev = NULL; 28561da177e4SLinus Torvalds state->dev = NULL; 285761fbab77Sstephen hemminger rcu_read_unlock(); 28581da177e4SLinus Torvalds } 28591da177e4SLinus Torvalds 28601da177e4SLinus Torvalds static int igmp_mcf_seq_show(struct seq_file *seq, void *v) 28611da177e4SLinus Torvalds { 28621da177e4SLinus Torvalds struct ip_sf_list *psf = (struct ip_sf_list *)v; 28631da177e4SLinus Torvalds struct igmp_mcf_iter_state *state = igmp_mcf_seq_private(seq); 28641da177e4SLinus Torvalds 28651da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) { 28661744bea1SJoe Perches seq_puts(seq, "Idx Device MCA SRC INC EXC\n"); 28671da177e4SLinus Torvalds } else { 28681da177e4SLinus Torvalds seq_printf(seq, 28691da177e4SLinus Torvalds "%3d %6.6s 0x%08x " 28701da177e4SLinus Torvalds "0x%08x %6lu %6lu\n", 28711da177e4SLinus Torvalds state->dev->ifindex, state->dev->name, 28721da177e4SLinus Torvalds ntohl(state->im->multiaddr), 28731da177e4SLinus Torvalds ntohl(psf->sf_inaddr), 28741da177e4SLinus Torvalds psf->sf_count[MCAST_INCLUDE], 28751da177e4SLinus Torvalds psf->sf_count[MCAST_EXCLUDE]); 28761da177e4SLinus Torvalds } 28771da177e4SLinus Torvalds return 0; 28781da177e4SLinus Torvalds } 28791da177e4SLinus Torvalds 2880f690808eSStephen Hemminger static const struct seq_operations igmp_mcf_seq_ops = { 28811da177e4SLinus Torvalds .start = igmp_mcf_seq_start, 28821da177e4SLinus Torvalds .next = igmp_mcf_seq_next, 28831da177e4SLinus Torvalds .stop = igmp_mcf_seq_stop, 28841da177e4SLinus Torvalds .show = igmp_mcf_seq_show, 28851da177e4SLinus Torvalds }; 28861da177e4SLinus Torvalds 28871da177e4SLinus Torvalds static int igmp_mcf_seq_open(struct inode *inode, struct file *file) 28881da177e4SLinus Torvalds { 28897091e728SAlexey Dobriyan return seq_open_net(inode, file, &igmp_mcf_seq_ops, 2890cf7732e4SPavel Emelyanov sizeof(struct igmp_mcf_iter_state)); 28911da177e4SLinus Torvalds } 28921da177e4SLinus Torvalds 28939a32144eSArjan van de Ven static const struct file_operations igmp_mcf_seq_fops = { 28941da177e4SLinus Torvalds .owner = THIS_MODULE, 28951da177e4SLinus Torvalds .open = igmp_mcf_seq_open, 28961da177e4SLinus Torvalds .read = seq_read, 28971da177e4SLinus Torvalds .llseek = seq_lseek, 28987091e728SAlexey Dobriyan .release = seq_release_net, 28997091e728SAlexey Dobriyan }; 29007091e728SAlexey Dobriyan 29012c8c1e72SAlexey Dobriyan static int __net_init igmp_net_init(struct net *net) 29027091e728SAlexey Dobriyan { 29037091e728SAlexey Dobriyan struct proc_dir_entry *pde; 290493a714d6SMadhu Challa int err; 29057091e728SAlexey Dobriyan 2906d4beaa66SGao feng pde = proc_create("igmp", S_IRUGO, net->proc_net, &igmp_mc_seq_fops); 29077091e728SAlexey Dobriyan if (!pde) 29087091e728SAlexey Dobriyan goto out_igmp; 2909d4beaa66SGao feng pde = proc_create("mcfilter", S_IRUGO, net->proc_net, 2910d4beaa66SGao feng &igmp_mcf_seq_fops); 29117091e728SAlexey Dobriyan if (!pde) 29127091e728SAlexey Dobriyan goto out_mcfilter; 291393a714d6SMadhu Challa err = inet_ctl_sock_create(&net->ipv4.mc_autojoin_sk, AF_INET, 291493a714d6SMadhu Challa SOCK_DGRAM, 0, net); 291593a714d6SMadhu Challa if (err < 0) { 291693a714d6SMadhu Challa pr_err("Failed to initialize the IGMP autojoin socket (err %d)\n", 291793a714d6SMadhu Challa err); 291893a714d6SMadhu Challa goto out_sock; 291993a714d6SMadhu Challa } 292093a714d6SMadhu Challa 29217091e728SAlexey Dobriyan return 0; 29227091e728SAlexey Dobriyan 292393a714d6SMadhu Challa out_sock: 292493a714d6SMadhu Challa remove_proc_entry("mcfilter", net->proc_net); 29257091e728SAlexey Dobriyan out_mcfilter: 2926ece31ffdSGao feng remove_proc_entry("igmp", net->proc_net); 29277091e728SAlexey Dobriyan out_igmp: 29287091e728SAlexey Dobriyan return -ENOMEM; 29297091e728SAlexey Dobriyan } 29307091e728SAlexey Dobriyan 29312c8c1e72SAlexey Dobriyan static void __net_exit igmp_net_exit(struct net *net) 29327091e728SAlexey Dobriyan { 2933ece31ffdSGao feng remove_proc_entry("mcfilter", net->proc_net); 2934ece31ffdSGao feng remove_proc_entry("igmp", net->proc_net); 293593a714d6SMadhu Challa inet_ctl_sock_destroy(net->ipv4.mc_autojoin_sk); 29367091e728SAlexey Dobriyan } 29377091e728SAlexey Dobriyan 29387091e728SAlexey Dobriyan static struct pernet_operations igmp_net_ops = { 29397091e728SAlexey Dobriyan .init = igmp_net_init, 29407091e728SAlexey Dobriyan .exit = igmp_net_exit, 29411da177e4SLinus Torvalds }; 294272c1d3bdSWANG Cong #endif 29431da177e4SLinus Torvalds 29444aa5dee4SJiri Pirko static int igmp_netdev_event(struct notifier_block *this, 29454aa5dee4SJiri Pirko unsigned long event, void *ptr) 29464aa5dee4SJiri Pirko { 29474aa5dee4SJiri Pirko struct net_device *dev = netdev_notifier_info_to_dev(ptr); 29484aa5dee4SJiri Pirko struct in_device *in_dev; 29494aa5dee4SJiri Pirko 29504aa5dee4SJiri Pirko switch (event) { 29514aa5dee4SJiri Pirko case NETDEV_RESEND_IGMP: 29524aa5dee4SJiri Pirko in_dev = __in_dev_get_rtnl(dev); 29534aa5dee4SJiri Pirko if (in_dev) 29544aa5dee4SJiri Pirko ip_mc_rejoin_groups(in_dev); 29554aa5dee4SJiri Pirko break; 29564aa5dee4SJiri Pirko default: 29574aa5dee4SJiri Pirko break; 29584aa5dee4SJiri Pirko } 29594aa5dee4SJiri Pirko return NOTIFY_DONE; 29604aa5dee4SJiri Pirko } 29614aa5dee4SJiri Pirko 29624aa5dee4SJiri Pirko static struct notifier_block igmp_notifier = { 29634aa5dee4SJiri Pirko .notifier_call = igmp_netdev_event, 29644aa5dee4SJiri Pirko }; 29654aa5dee4SJiri Pirko 296672c1d3bdSWANG Cong int __init igmp_mc_init(void) 29671da177e4SLinus Torvalds { 296872c1d3bdSWANG Cong #if defined(CONFIG_PROC_FS) 29694aa5dee4SJiri Pirko int err; 29704aa5dee4SJiri Pirko 29714aa5dee4SJiri Pirko err = register_pernet_subsys(&igmp_net_ops); 29724aa5dee4SJiri Pirko if (err) 29734aa5dee4SJiri Pirko return err; 29744aa5dee4SJiri Pirko err = register_netdevice_notifier(&igmp_notifier); 29754aa5dee4SJiri Pirko if (err) 29764aa5dee4SJiri Pirko goto reg_notif_fail; 29774aa5dee4SJiri Pirko return 0; 29784aa5dee4SJiri Pirko 29794aa5dee4SJiri Pirko reg_notif_fail: 29804aa5dee4SJiri Pirko unregister_pernet_subsys(&igmp_net_ops); 29814aa5dee4SJiri Pirko return err; 298272c1d3bdSWANG Cong #else 298372c1d3bdSWANG Cong return register_netdevice_notifier(&igmp_notifier); 29841da177e4SLinus Torvalds #endif 298572c1d3bdSWANG Cong } 2986