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 110df2cf4a7SPhilip Downey /* IGMP reports for link-local multicast groups are enabled by default */ 111df2cf4a7SPhilip Downey int sysctl_igmp_llm_reports __read_mostly = 1; 112df2cf4a7SPhilip Downey 1131da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 1141da177e4SLinus Torvalds /* Parameter names and values are taken from igmp-v2-06 draft */ 1151da177e4SLinus Torvalds 116436f7c20SFabian Frederick #define IGMP_V1_ROUTER_PRESENT_TIMEOUT (400*HZ) 117436f7c20SFabian Frederick #define IGMP_V2_ROUTER_PRESENT_TIMEOUT (400*HZ) 118436f7c20SFabian Frederick #define IGMP_V2_UNSOLICITED_REPORT_INTERVAL (10*HZ) 119436f7c20SFabian Frederick #define IGMP_V3_UNSOLICITED_REPORT_INTERVAL (1*HZ) 120436f7c20SFabian Frederick #define IGMP_QUERY_RESPONSE_INTERVAL (10*HZ) 121436f7c20SFabian Frederick #define IGMP_QUERY_ROBUSTNESS_VARIABLE 2 1221da177e4SLinus Torvalds 1231da177e4SLinus Torvalds 124436f7c20SFabian Frederick #define IGMP_INITIAL_REPORT_DELAY (1) 1251da177e4SLinus Torvalds 126436f7c20SFabian Frederick /* IGMP_INITIAL_REPORT_DELAY is not from IGMP specs! 1271da177e4SLinus Torvalds * IGMP specs require to report membership immediately after 1281da177e4SLinus Torvalds * joining a group, but we delay the first report by a 1291da177e4SLinus Torvalds * small interval. It seems more natural and still does not 1301da177e4SLinus Torvalds * contradict to specs provided this delay is small enough. 1311da177e4SLinus Torvalds */ 1321da177e4SLinus Torvalds 13342f811b8SHerbert Xu #define IGMP_V1_SEEN(in_dev) \ 134c346dca1SYOSHIFUJI Hideaki (IPV4_DEVCONF_ALL(dev_net(in_dev->dev), FORCE_IGMP_VERSION) == 1 || \ 13542f811b8SHerbert Xu IN_DEV_CONF_GET((in_dev), FORCE_IGMP_VERSION) == 1 || \ 1361da177e4SLinus Torvalds ((in_dev)->mr_v1_seen && \ 1371da177e4SLinus Torvalds time_before(jiffies, (in_dev)->mr_v1_seen))) 13842f811b8SHerbert Xu #define IGMP_V2_SEEN(in_dev) \ 139c346dca1SYOSHIFUJI Hideaki (IPV4_DEVCONF_ALL(dev_net(in_dev->dev), FORCE_IGMP_VERSION) == 2 || \ 14042f811b8SHerbert Xu IN_DEV_CONF_GET((in_dev), FORCE_IGMP_VERSION) == 2 || \ 1411da177e4SLinus Torvalds ((in_dev)->mr_v2_seen && \ 1421da177e4SLinus Torvalds time_before(jiffies, (in_dev)->mr_v2_seen))) 1431da177e4SLinus Torvalds 144cab70040SWilliam Manley static int unsolicited_report_interval(struct in_device *in_dev) 145cab70040SWilliam Manley { 1462690048cSWilliam Manley int interval_ms, interval_jiffies; 1472690048cSWilliam Manley 148cab70040SWilliam Manley if (IGMP_V1_SEEN(in_dev) || IGMP_V2_SEEN(in_dev)) 1492690048cSWilliam Manley interval_ms = IN_DEV_CONF_GET( 1502690048cSWilliam Manley in_dev, 1512690048cSWilliam Manley IGMPV2_UNSOLICITED_REPORT_INTERVAL); 152cab70040SWilliam Manley else /* v3 */ 1532690048cSWilliam Manley interval_ms = IN_DEV_CONF_GET( 1542690048cSWilliam Manley in_dev, 1552690048cSWilliam Manley IGMPV3_UNSOLICITED_REPORT_INTERVAL); 1562690048cSWilliam Manley 1572690048cSWilliam Manley interval_jiffies = msecs_to_jiffies(interval_ms); 1582690048cSWilliam Manley 1592690048cSWilliam Manley /* _timer functions can't handle a delay of 0 jiffies so ensure 1602690048cSWilliam Manley * we always return a positive value. 1612690048cSWilliam Manley */ 1622690048cSWilliam Manley if (interval_jiffies <= 0) 1632690048cSWilliam Manley interval_jiffies = 1; 1642690048cSWilliam Manley return interval_jiffies; 165cab70040SWilliam Manley } 166cab70040SWilliam Manley 1671da177e4SLinus Torvalds static void igmpv3_add_delrec(struct in_device *in_dev, struct ip_mc_list *im); 16863007727SAl Viro static void igmpv3_del_delrec(struct in_device *in_dev, __be32 multiaddr); 1691da177e4SLinus Torvalds static void igmpv3_clear_delrec(struct in_device *in_dev); 1701da177e4SLinus Torvalds static int sf_setstate(struct ip_mc_list *pmc); 1711da177e4SLinus Torvalds static void sf_markstate(struct ip_mc_list *pmc); 1721da177e4SLinus Torvalds #endif 1731da177e4SLinus Torvalds static void ip_mc_clear_src(struct ip_mc_list *pmc); 1748f935bbdSAl Viro static int ip_mc_add_src(struct in_device *in_dev, __be32 *pmca, int sfmode, 1758f935bbdSAl Viro int sfcount, __be32 *psfsrc, int delta); 1761da177e4SLinus Torvalds 1771da177e4SLinus Torvalds static void ip_ma_put(struct ip_mc_list *im) 1781da177e4SLinus Torvalds { 1791da177e4SLinus Torvalds if (atomic_dec_and_test(&im->refcnt)) { 1801da177e4SLinus Torvalds in_dev_put(im->interface); 18142ea299dSLai Jiangshan kfree_rcu(im, rcu); 1821da177e4SLinus Torvalds } 1831da177e4SLinus Torvalds } 1841da177e4SLinus Torvalds 185d9aa9380SDavid S. Miller #define for_each_pmc_rcu(in_dev, pmc) \ 186d9aa9380SDavid S. Miller for (pmc = rcu_dereference(in_dev->mc_list); \ 187d9aa9380SDavid S. Miller pmc != NULL; \ 188d9aa9380SDavid S. Miller pmc = rcu_dereference(pmc->next_rcu)) 189d9aa9380SDavid S. Miller 190d9aa9380SDavid S. Miller #define for_each_pmc_rtnl(in_dev, pmc) \ 191d9aa9380SDavid S. Miller for (pmc = rtnl_dereference(in_dev->mc_list); \ 192d9aa9380SDavid S. Miller pmc != NULL; \ 193d9aa9380SDavid S. Miller pmc = rtnl_dereference(pmc->next_rcu)) 194d9aa9380SDavid S. Miller 1951da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 1961da177e4SLinus Torvalds 1971da177e4SLinus Torvalds /* 1981da177e4SLinus Torvalds * Timer management 1991da177e4SLinus Torvalds */ 2001da177e4SLinus Torvalds 2011d7138deSEric Dumazet static void igmp_stop_timer(struct ip_mc_list *im) 2021da177e4SLinus Torvalds { 2031da177e4SLinus Torvalds spin_lock_bh(&im->lock); 2041da177e4SLinus Torvalds if (del_timer(&im->timer)) 2051da177e4SLinus Torvalds atomic_dec(&im->refcnt); 2061da177e4SLinus Torvalds im->tm_running = 0; 2071da177e4SLinus Torvalds im->reporter = 0; 2081da177e4SLinus Torvalds im->unsolicit_count = 0; 2091da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 2101da177e4SLinus Torvalds } 2111da177e4SLinus Torvalds 2121da177e4SLinus Torvalds /* It must be called with locked im->lock */ 2131da177e4SLinus Torvalds static void igmp_start_timer(struct ip_mc_list *im, int max_delay) 2141da177e4SLinus Torvalds { 21563862b5bSAruna-Hewapathirane int tv = prandom_u32() % max_delay; 2161da177e4SLinus Torvalds 2171da177e4SLinus Torvalds im->tm_running = 1; 2181da177e4SLinus Torvalds if (!mod_timer(&im->timer, jiffies+tv+2)) 2191da177e4SLinus Torvalds atomic_inc(&im->refcnt); 2201da177e4SLinus Torvalds } 2211da177e4SLinus Torvalds 2221da177e4SLinus Torvalds static void igmp_gq_start_timer(struct in_device *in_dev) 2231da177e4SLinus Torvalds { 22463862b5bSAruna-Hewapathirane int tv = prandom_u32() % in_dev->mr_maxdelay; 2251da177e4SLinus Torvalds 2261da177e4SLinus Torvalds in_dev->mr_gq_running = 1; 2271da177e4SLinus Torvalds if (!mod_timer(&in_dev->mr_gq_timer, jiffies+tv+2)) 2281da177e4SLinus Torvalds in_dev_hold(in_dev); 2291da177e4SLinus Torvalds } 2301da177e4SLinus Torvalds 2311da177e4SLinus Torvalds static void igmp_ifc_start_timer(struct in_device *in_dev, int delay) 2321da177e4SLinus Torvalds { 23363862b5bSAruna-Hewapathirane int tv = prandom_u32() % delay; 2341da177e4SLinus Torvalds 2351da177e4SLinus Torvalds if (!mod_timer(&in_dev->mr_ifc_timer, jiffies+tv+2)) 2361da177e4SLinus Torvalds in_dev_hold(in_dev); 2371da177e4SLinus Torvalds } 2381da177e4SLinus Torvalds 2391da177e4SLinus Torvalds static void igmp_mod_timer(struct ip_mc_list *im, int max_delay) 2401da177e4SLinus Torvalds { 2411da177e4SLinus Torvalds spin_lock_bh(&im->lock); 2421da177e4SLinus Torvalds im->unsolicit_count = 0; 2431da177e4SLinus Torvalds if (del_timer(&im->timer)) { 2441da177e4SLinus Torvalds if ((long)(im->timer.expires-jiffies) < max_delay) { 2451da177e4SLinus Torvalds add_timer(&im->timer); 2461da177e4SLinus Torvalds im->tm_running = 1; 2471da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 2481da177e4SLinus Torvalds return; 2491da177e4SLinus Torvalds } 2501da177e4SLinus Torvalds atomic_dec(&im->refcnt); 2511da177e4SLinus Torvalds } 2521da177e4SLinus Torvalds igmp_start_timer(im, max_delay); 2531da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 2541da177e4SLinus Torvalds } 2551da177e4SLinus Torvalds 2561da177e4SLinus Torvalds 2571da177e4SLinus Torvalds /* 2581da177e4SLinus Torvalds * Send an IGMP report. 2591da177e4SLinus Torvalds */ 2601da177e4SLinus Torvalds 2611da177e4SLinus Torvalds #define IGMP_SIZE (sizeof(struct igmphdr)+sizeof(struct iphdr)+4) 2621da177e4SLinus Torvalds 2631da177e4SLinus Torvalds 2641da177e4SLinus Torvalds static int is_in(struct ip_mc_list *pmc, struct ip_sf_list *psf, int type, 2651da177e4SLinus Torvalds int gdeleted, int sdeleted) 2661da177e4SLinus Torvalds { 2671da177e4SLinus Torvalds switch (type) { 2681da177e4SLinus Torvalds case IGMPV3_MODE_IS_INCLUDE: 2691da177e4SLinus Torvalds case IGMPV3_MODE_IS_EXCLUDE: 2701da177e4SLinus Torvalds if (gdeleted || sdeleted) 2711da177e4SLinus Torvalds return 0; 272ad12583fSDavid L Stevens if (!(pmc->gsquery && !psf->sf_gsresp)) { 273ad12583fSDavid L Stevens if (pmc->sfmode == MCAST_INCLUDE) 274ad12583fSDavid L Stevens return 1; 275ad12583fSDavid L Stevens /* don't include if this source is excluded 276ad12583fSDavid L Stevens * in all filters 277ad12583fSDavid L Stevens */ 278ad12583fSDavid L Stevens if (psf->sf_count[MCAST_INCLUDE]) 279ad12583fSDavid L Stevens return type == IGMPV3_MODE_IS_INCLUDE; 280ad12583fSDavid L Stevens return pmc->sfcount[MCAST_EXCLUDE] == 281ad12583fSDavid L Stevens psf->sf_count[MCAST_EXCLUDE]; 282ad12583fSDavid L Stevens } 283ad12583fSDavid L Stevens return 0; 2841da177e4SLinus Torvalds case IGMPV3_CHANGE_TO_INCLUDE: 2851da177e4SLinus Torvalds if (gdeleted || sdeleted) 2861da177e4SLinus Torvalds return 0; 2871da177e4SLinus Torvalds return psf->sf_count[MCAST_INCLUDE] != 0; 2881da177e4SLinus Torvalds case IGMPV3_CHANGE_TO_EXCLUDE: 2891da177e4SLinus Torvalds if (gdeleted || sdeleted) 2901da177e4SLinus Torvalds return 0; 2911da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE] == 0 || 2921da177e4SLinus Torvalds psf->sf_count[MCAST_INCLUDE]) 2931da177e4SLinus Torvalds return 0; 2941da177e4SLinus Torvalds return pmc->sfcount[MCAST_EXCLUDE] == 2951da177e4SLinus Torvalds psf->sf_count[MCAST_EXCLUDE]; 2961da177e4SLinus Torvalds case IGMPV3_ALLOW_NEW_SOURCES: 2971da177e4SLinus Torvalds if (gdeleted || !psf->sf_crcount) 2981da177e4SLinus Torvalds return 0; 2991da177e4SLinus Torvalds return (pmc->sfmode == MCAST_INCLUDE) ^ sdeleted; 3001da177e4SLinus Torvalds case IGMPV3_BLOCK_OLD_SOURCES: 3011da177e4SLinus Torvalds if (pmc->sfmode == MCAST_INCLUDE) 3021da177e4SLinus Torvalds return gdeleted || (psf->sf_crcount && sdeleted); 3031da177e4SLinus Torvalds return psf->sf_crcount && !gdeleted && !sdeleted; 3041da177e4SLinus Torvalds } 3051da177e4SLinus Torvalds return 0; 3061da177e4SLinus Torvalds } 3071da177e4SLinus Torvalds 3081da177e4SLinus Torvalds static int 3091da177e4SLinus Torvalds igmp_scount(struct ip_mc_list *pmc, int type, int gdeleted, int sdeleted) 3101da177e4SLinus Torvalds { 3111da177e4SLinus Torvalds struct ip_sf_list *psf; 3121da177e4SLinus Torvalds int scount = 0; 3131da177e4SLinus Torvalds 3141da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) { 3151da177e4SLinus Torvalds if (!is_in(pmc, psf, type, gdeleted, sdeleted)) 3161da177e4SLinus Torvalds continue; 3171da177e4SLinus Torvalds scount++; 3181da177e4SLinus Torvalds } 3191da177e4SLinus Torvalds return scount; 3201da177e4SLinus Torvalds } 3211da177e4SLinus Torvalds 3224c672e4bSDaniel Borkmann static struct sk_buff *igmpv3_newpack(struct net_device *dev, unsigned int mtu) 3231da177e4SLinus Torvalds { 3241da177e4SLinus Torvalds struct sk_buff *skb; 3251da177e4SLinus Torvalds struct rtable *rt; 3261da177e4SLinus Torvalds struct iphdr *pip; 3271da177e4SLinus Torvalds struct igmpv3_report *pig; 328877acedcSDaniel Lezcano struct net *net = dev_net(dev); 32931e4543dSDavid S. Miller struct flowi4 fl4; 33066088243SHerbert Xu int hlen = LL_RESERVED_SPACE(dev); 33166088243SHerbert Xu int tlen = dev->needed_tailroom; 3324c672e4bSDaniel Borkmann unsigned int size = mtu; 3331da177e4SLinus Torvalds 33457e1ab6eSEric Dumazet while (1) { 33566088243SHerbert Xu skb = alloc_skb(size + hlen + tlen, 33657e1ab6eSEric Dumazet GFP_ATOMIC | __GFP_NOWARN); 33757e1ab6eSEric Dumazet if (skb) 33857e1ab6eSEric Dumazet break; 33957e1ab6eSEric Dumazet size >>= 1; 34057e1ab6eSEric Dumazet if (size < 256) 3411da177e4SLinus Torvalds return NULL; 34257e1ab6eSEric Dumazet } 3439d4a0314SHannes Frederic Sowa skb->priority = TC_PRIO_CONTROL; 3441da177e4SLinus Torvalds 34531e4543dSDavid S. Miller rt = ip_route_output_ports(net, &fl4, NULL, IGMPV3_ALL_MCR, 0, 34678fbfd8aSDavid S. Miller 0, 0, 34778fbfd8aSDavid S. Miller IPPROTO_IGMP, 0, dev->ifindex); 348b23dd4feSDavid S. Miller if (IS_ERR(rt)) { 3491da177e4SLinus Torvalds kfree_skb(skb); 3501da177e4SLinus Torvalds return NULL; 3511da177e4SLinus Torvalds } 3521da177e4SLinus Torvalds 353d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 3541da177e4SLinus Torvalds skb->dev = dev; 3551da177e4SLinus Torvalds 3564c672e4bSDaniel Borkmann skb->reserved_tailroom = skb_end_offset(skb) - 3574c672e4bSDaniel Borkmann min(mtu, skb_end_offset(skb)); 35866088243SHerbert Xu skb_reserve(skb, hlen); 3591da177e4SLinus Torvalds 3607e28ecc2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 361eddc9ec5SArnaldo Carvalho de Melo pip = ip_hdr(skb); 3627e28ecc2SArnaldo Carvalho de Melo skb_put(skb, sizeof(struct iphdr) + 4); 3631da177e4SLinus Torvalds 3641da177e4SLinus Torvalds pip->version = 4; 3651da177e4SLinus Torvalds pip->ihl = (sizeof(struct iphdr)+4)>>2; 3661da177e4SLinus Torvalds pip->tos = 0xc0; 3671da177e4SLinus Torvalds pip->frag_off = htons(IP_DF); 3681da177e4SLinus Torvalds pip->ttl = 1; 369492f64ceSDavid S. Miller pip->daddr = fl4.daddr; 370492f64ceSDavid S. Miller pip->saddr = fl4.saddr; 3711da177e4SLinus Torvalds pip->protocol = IPPROTO_IGMP; 3721da177e4SLinus Torvalds pip->tot_len = 0; /* filled in later */ 373b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, NULL); 3741da177e4SLinus Torvalds ((u8 *)&pip[1])[0] = IPOPT_RA; 3751da177e4SLinus Torvalds ((u8 *)&pip[1])[1] = 4; 3761da177e4SLinus Torvalds ((u8 *)&pip[1])[2] = 0; 3771da177e4SLinus Torvalds ((u8 *)&pip[1])[3] = 0; 3781da177e4SLinus Torvalds 379b0e380b1SArnaldo Carvalho de Melo skb->transport_header = skb->network_header + sizeof(struct iphdr) + 4; 380d10ba34bSArnaldo Carvalho de Melo skb_put(skb, sizeof(*pig)); 381d9edf9e2SArnaldo Carvalho de Melo pig = igmpv3_report_hdr(skb); 3821da177e4SLinus Torvalds pig->type = IGMPV3_HOST_MEMBERSHIP_REPORT; 3831da177e4SLinus Torvalds pig->resv1 = 0; 3841da177e4SLinus Torvalds pig->csum = 0; 3851da177e4SLinus Torvalds pig->resv2 = 0; 3861da177e4SLinus Torvalds pig->ngrec = 0; 3871da177e4SLinus Torvalds return skb; 3881da177e4SLinus Torvalds } 3891da177e4SLinus Torvalds 3901da177e4SLinus Torvalds static int igmpv3_sendpack(struct sk_buff *skb) 3911da177e4SLinus Torvalds { 392d9edf9e2SArnaldo Carvalho de Melo struct igmphdr *pig = igmp_hdr(skb); 393f7c0c2aeSSimon Horman const int igmplen = skb_tail_pointer(skb) - skb_transport_header(skb); 3941da177e4SLinus Torvalds 395d9edf9e2SArnaldo Carvalho de Melo pig->csum = ip_compute_csum(igmp_hdr(skb), igmplen); 3961da177e4SLinus Torvalds 39733224b16SEric W. Biederman return ip_local_out(dev_net(skb_dst(skb)->dev), skb->sk, skb); 3981da177e4SLinus Torvalds } 3991da177e4SLinus Torvalds 4001da177e4SLinus Torvalds static int grec_size(struct ip_mc_list *pmc, int type, int gdel, int sdel) 4011da177e4SLinus Torvalds { 4021da177e4SLinus Torvalds return sizeof(struct igmpv3_grec) + 4*igmp_scount(pmc, type, gdel, sdel); 4031da177e4SLinus Torvalds } 4041da177e4SLinus Torvalds 4051da177e4SLinus Torvalds static struct sk_buff *add_grhead(struct sk_buff *skb, struct ip_mc_list *pmc, 4061da177e4SLinus Torvalds int type, struct igmpv3_grec **ppgr) 4071da177e4SLinus Torvalds { 4081da177e4SLinus Torvalds struct net_device *dev = pmc->interface->dev; 4091da177e4SLinus Torvalds struct igmpv3_report *pih; 4101da177e4SLinus Torvalds struct igmpv3_grec *pgr; 4111da177e4SLinus Torvalds 4121da177e4SLinus Torvalds if (!skb) 4131da177e4SLinus Torvalds skb = igmpv3_newpack(dev, dev->mtu); 4141da177e4SLinus Torvalds if (!skb) 4151da177e4SLinus Torvalds return NULL; 4161da177e4SLinus Torvalds pgr = (struct igmpv3_grec *)skb_put(skb, sizeof(struct igmpv3_grec)); 4171da177e4SLinus Torvalds pgr->grec_type = type; 4181da177e4SLinus Torvalds pgr->grec_auxwords = 0; 4191da177e4SLinus Torvalds pgr->grec_nsrcs = 0; 4201da177e4SLinus Torvalds pgr->grec_mca = pmc->multiaddr; 421d9edf9e2SArnaldo Carvalho de Melo pih = igmpv3_report_hdr(skb); 4221da177e4SLinus Torvalds pih->ngrec = htons(ntohs(pih->ngrec)+1); 4231da177e4SLinus Torvalds *ppgr = pgr; 4241da177e4SLinus Torvalds return skb; 4251da177e4SLinus Torvalds } 4261da177e4SLinus Torvalds 4274c672e4bSDaniel Borkmann #define AVAILABLE(skb) ((skb) ? skb_availroom(skb) : 0) 4281da177e4SLinus Torvalds 4291da177e4SLinus Torvalds static struct sk_buff *add_grec(struct sk_buff *skb, struct ip_mc_list *pmc, 4301da177e4SLinus Torvalds int type, int gdeleted, int sdeleted) 4311da177e4SLinus Torvalds { 4321da177e4SLinus Torvalds struct net_device *dev = pmc->interface->dev; 4331da177e4SLinus Torvalds struct igmpv3_report *pih; 4341da177e4SLinus Torvalds struct igmpv3_grec *pgr = NULL; 4351da177e4SLinus Torvalds struct ip_sf_list *psf, *psf_next, *psf_prev, **psf_list; 436ad12583fSDavid L Stevens int scount, stotal, first, isquery, truncate; 4371da177e4SLinus Torvalds 4381da177e4SLinus Torvalds if (pmc->multiaddr == IGMP_ALL_HOSTS) 4391da177e4SLinus Torvalds return skb; 440df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(pmc->multiaddr) && !sysctl_igmp_llm_reports) 441df2cf4a7SPhilip Downey return skb; 4421da177e4SLinus Torvalds 4431da177e4SLinus Torvalds isquery = type == IGMPV3_MODE_IS_INCLUDE || 4441da177e4SLinus Torvalds type == IGMPV3_MODE_IS_EXCLUDE; 4451da177e4SLinus Torvalds truncate = type == IGMPV3_MODE_IS_EXCLUDE || 4461da177e4SLinus Torvalds type == IGMPV3_CHANGE_TO_EXCLUDE; 4471da177e4SLinus Torvalds 448ad12583fSDavid L Stevens stotal = scount = 0; 449ad12583fSDavid L Stevens 4501da177e4SLinus Torvalds psf_list = sdeleted ? &pmc->tomb : &pmc->sources; 4511da177e4SLinus Torvalds 452ad12583fSDavid L Stevens if (!*psf_list) 453ad12583fSDavid L Stevens goto empty_source; 454ad12583fSDavid L Stevens 455d9edf9e2SArnaldo Carvalho de Melo pih = skb ? igmpv3_report_hdr(skb) : NULL; 4561da177e4SLinus Torvalds 4571da177e4SLinus Torvalds /* EX and TO_EX get a fresh packet, if needed */ 4581da177e4SLinus Torvalds if (truncate) { 4591da177e4SLinus Torvalds if (pih && pih->ngrec && 4601da177e4SLinus Torvalds AVAILABLE(skb) < grec_size(pmc, type, gdeleted, sdeleted)) { 4611da177e4SLinus Torvalds if (skb) 4621da177e4SLinus Torvalds igmpv3_sendpack(skb); 4631da177e4SLinus Torvalds skb = igmpv3_newpack(dev, dev->mtu); 4641da177e4SLinus Torvalds } 4651da177e4SLinus Torvalds } 4661da177e4SLinus Torvalds first = 1; 4671da177e4SLinus Torvalds psf_prev = NULL; 4681da177e4SLinus Torvalds for (psf = *psf_list; psf; psf = psf_next) { 469ea4d9e72SAl Viro __be32 *psrc; 4701da177e4SLinus Torvalds 4711da177e4SLinus Torvalds psf_next = psf->sf_next; 4721da177e4SLinus Torvalds 4731da177e4SLinus Torvalds if (!is_in(pmc, psf, type, gdeleted, sdeleted)) { 4741da177e4SLinus Torvalds psf_prev = psf; 4751da177e4SLinus Torvalds continue; 4761da177e4SLinus Torvalds } 4771da177e4SLinus Torvalds 4781da177e4SLinus Torvalds /* clear marks on query responses */ 4791da177e4SLinus Torvalds if (isquery) 4801da177e4SLinus Torvalds psf->sf_gsresp = 0; 4811da177e4SLinus Torvalds 48263007727SAl Viro if (AVAILABLE(skb) < sizeof(__be32) + 4831da177e4SLinus Torvalds first*sizeof(struct igmpv3_grec)) { 4841da177e4SLinus Torvalds if (truncate && !first) 4851da177e4SLinus Torvalds break; /* truncate these */ 4861da177e4SLinus Torvalds if (pgr) 4871da177e4SLinus Torvalds pgr->grec_nsrcs = htons(scount); 4881da177e4SLinus Torvalds if (skb) 4891da177e4SLinus Torvalds igmpv3_sendpack(skb); 4901da177e4SLinus Torvalds skb = igmpv3_newpack(dev, dev->mtu); 4911da177e4SLinus Torvalds first = 1; 4921da177e4SLinus Torvalds scount = 0; 4931da177e4SLinus Torvalds } 4941da177e4SLinus Torvalds if (first) { 4951da177e4SLinus Torvalds skb = add_grhead(skb, pmc, type, &pgr); 4961da177e4SLinus Torvalds first = 0; 4971da177e4SLinus Torvalds } 498cc63f70bSAlexey Dobriyan if (!skb) 499cc63f70bSAlexey Dobriyan return NULL; 50063007727SAl Viro psrc = (__be32 *)skb_put(skb, sizeof(__be32)); 5011da177e4SLinus Torvalds *psrc = psf->sf_inaddr; 502ad12583fSDavid L Stevens scount++; stotal++; 5031da177e4SLinus Torvalds if ((type == IGMPV3_ALLOW_NEW_SOURCES || 5041da177e4SLinus Torvalds type == IGMPV3_BLOCK_OLD_SOURCES) && psf->sf_crcount) { 5051da177e4SLinus Torvalds psf->sf_crcount--; 5061da177e4SLinus Torvalds if ((sdeleted || gdeleted) && psf->sf_crcount == 0) { 5071da177e4SLinus Torvalds if (psf_prev) 5081da177e4SLinus Torvalds psf_prev->sf_next = psf->sf_next; 5091da177e4SLinus Torvalds else 5101da177e4SLinus Torvalds *psf_list = psf->sf_next; 5111da177e4SLinus Torvalds kfree(psf); 5121da177e4SLinus Torvalds continue; 5131da177e4SLinus Torvalds } 5141da177e4SLinus Torvalds } 5151da177e4SLinus Torvalds psf_prev = psf; 5161da177e4SLinus Torvalds } 517ad12583fSDavid L Stevens 518ad12583fSDavid L Stevens empty_source: 519ad12583fSDavid L Stevens if (!stotal) { 520ad12583fSDavid L Stevens if (type == IGMPV3_ALLOW_NEW_SOURCES || 521ad12583fSDavid L Stevens type == IGMPV3_BLOCK_OLD_SOURCES) 522ad12583fSDavid L Stevens return skb; 523ad12583fSDavid L Stevens if (pmc->crcount || isquery) { 524ad12583fSDavid L Stevens /* make sure we have room for group header */ 525ad12583fSDavid L Stevens if (skb && AVAILABLE(skb) < sizeof(struct igmpv3_grec)) { 526ad12583fSDavid L Stevens igmpv3_sendpack(skb); 527ad12583fSDavid L Stevens skb = NULL; /* add_grhead will get a new one */ 528ad12583fSDavid L Stevens } 529ad12583fSDavid L Stevens skb = add_grhead(skb, pmc, type, &pgr); 530ad12583fSDavid L Stevens } 531ad12583fSDavid L Stevens } 5321da177e4SLinus Torvalds if (pgr) 5331da177e4SLinus Torvalds pgr->grec_nsrcs = htons(scount); 5341da177e4SLinus Torvalds 5351da177e4SLinus Torvalds if (isquery) 5361da177e4SLinus Torvalds pmc->gsquery = 0; /* clear query state on report */ 5371da177e4SLinus Torvalds return skb; 5381da177e4SLinus Torvalds } 5391da177e4SLinus Torvalds 5401da177e4SLinus Torvalds static int igmpv3_send_report(struct in_device *in_dev, struct ip_mc_list *pmc) 5411da177e4SLinus Torvalds { 5421da177e4SLinus Torvalds struct sk_buff *skb = NULL; 5431da177e4SLinus Torvalds int type; 5441da177e4SLinus Torvalds 5451da177e4SLinus Torvalds if (!pmc) { 5461d7138deSEric Dumazet rcu_read_lock(); 5471d7138deSEric Dumazet for_each_pmc_rcu(in_dev, pmc) { 5481da177e4SLinus Torvalds if (pmc->multiaddr == IGMP_ALL_HOSTS) 5491da177e4SLinus Torvalds continue; 550df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(pmc->multiaddr) && 551df2cf4a7SPhilip Downey !sysctl_igmp_llm_reports) 552df2cf4a7SPhilip Downey continue; 5531da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 5541da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) 5551da177e4SLinus Torvalds type = IGMPV3_MODE_IS_EXCLUDE; 5561da177e4SLinus Torvalds else 5571da177e4SLinus Torvalds type = IGMPV3_MODE_IS_INCLUDE; 5581da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 0, 0); 5591da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 5601da177e4SLinus Torvalds } 5611d7138deSEric Dumazet rcu_read_unlock(); 5621da177e4SLinus Torvalds } else { 5631da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 5641da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) 5651da177e4SLinus Torvalds type = IGMPV3_MODE_IS_EXCLUDE; 5661da177e4SLinus Torvalds else 5671da177e4SLinus Torvalds type = IGMPV3_MODE_IS_INCLUDE; 5681da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 0, 0); 5691da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 5701da177e4SLinus Torvalds } 5711da177e4SLinus Torvalds if (!skb) 5721da177e4SLinus Torvalds return 0; 5731da177e4SLinus Torvalds return igmpv3_sendpack(skb); 5741da177e4SLinus Torvalds } 5751da177e4SLinus Torvalds 5761da177e4SLinus Torvalds /* 5771da177e4SLinus Torvalds * remove zero-count source records from a source filter list 5781da177e4SLinus Torvalds */ 5791da177e4SLinus Torvalds static void igmpv3_clear_zeros(struct ip_sf_list **ppsf) 5801da177e4SLinus Torvalds { 5811da177e4SLinus Torvalds struct ip_sf_list *psf_prev, *psf_next, *psf; 5821da177e4SLinus Torvalds 5831da177e4SLinus Torvalds psf_prev = NULL; 5841da177e4SLinus Torvalds for (psf = *ppsf; psf; psf = psf_next) { 5851da177e4SLinus Torvalds psf_next = psf->sf_next; 5861da177e4SLinus Torvalds if (psf->sf_crcount == 0) { 5871da177e4SLinus Torvalds if (psf_prev) 5881da177e4SLinus Torvalds psf_prev->sf_next = psf->sf_next; 5891da177e4SLinus Torvalds else 5901da177e4SLinus Torvalds *ppsf = psf->sf_next; 5911da177e4SLinus Torvalds kfree(psf); 5921da177e4SLinus Torvalds } else 5931da177e4SLinus Torvalds psf_prev = psf; 5941da177e4SLinus Torvalds } 5951da177e4SLinus Torvalds } 5961da177e4SLinus Torvalds 5971da177e4SLinus Torvalds static void igmpv3_send_cr(struct in_device *in_dev) 5981da177e4SLinus Torvalds { 5991da177e4SLinus Torvalds struct ip_mc_list *pmc, *pmc_prev, *pmc_next; 6001da177e4SLinus Torvalds struct sk_buff *skb = NULL; 6011da177e4SLinus Torvalds int type, dtype; 6021da177e4SLinus Torvalds 6031d7138deSEric Dumazet rcu_read_lock(); 6041da177e4SLinus Torvalds spin_lock_bh(&in_dev->mc_tomb_lock); 6051da177e4SLinus Torvalds 6061da177e4SLinus Torvalds /* deleted MCA's */ 6071da177e4SLinus Torvalds pmc_prev = NULL; 6081da177e4SLinus Torvalds for (pmc = in_dev->mc_tomb; pmc; pmc = pmc_next) { 6091da177e4SLinus Torvalds pmc_next = pmc->next; 6101da177e4SLinus Torvalds if (pmc->sfmode == MCAST_INCLUDE) { 6111da177e4SLinus Torvalds type = IGMPV3_BLOCK_OLD_SOURCES; 6121da177e4SLinus Torvalds dtype = IGMPV3_BLOCK_OLD_SOURCES; 6131da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 1, 0); 6141da177e4SLinus Torvalds skb = add_grec(skb, pmc, dtype, 1, 1); 6151da177e4SLinus Torvalds } 6161da177e4SLinus Torvalds if (pmc->crcount) { 6171da177e4SLinus Torvalds if (pmc->sfmode == MCAST_EXCLUDE) { 6181da177e4SLinus Torvalds type = IGMPV3_CHANGE_TO_INCLUDE; 6191da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 1, 0); 6201da177e4SLinus Torvalds } 621ad12583fSDavid L Stevens pmc->crcount--; 6221da177e4SLinus Torvalds if (pmc->crcount == 0) { 6231da177e4SLinus Torvalds igmpv3_clear_zeros(&pmc->tomb); 6241da177e4SLinus Torvalds igmpv3_clear_zeros(&pmc->sources); 6251da177e4SLinus Torvalds } 6261da177e4SLinus Torvalds } 6271da177e4SLinus Torvalds if (pmc->crcount == 0 && !pmc->tomb && !pmc->sources) { 6281da177e4SLinus Torvalds if (pmc_prev) 6291da177e4SLinus Torvalds pmc_prev->next = pmc_next; 6301da177e4SLinus Torvalds else 6311da177e4SLinus Torvalds in_dev->mc_tomb = pmc_next; 6321da177e4SLinus Torvalds in_dev_put(pmc->interface); 6331da177e4SLinus Torvalds kfree(pmc); 6341da177e4SLinus Torvalds } else 6351da177e4SLinus Torvalds pmc_prev = pmc; 6361da177e4SLinus Torvalds } 6371da177e4SLinus Torvalds spin_unlock_bh(&in_dev->mc_tomb_lock); 6381da177e4SLinus Torvalds 6391da177e4SLinus Torvalds /* change recs */ 6401d7138deSEric Dumazet for_each_pmc_rcu(in_dev, pmc) { 6411da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 6421da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) { 6431da177e4SLinus Torvalds type = IGMPV3_BLOCK_OLD_SOURCES; 6441da177e4SLinus Torvalds dtype = IGMPV3_ALLOW_NEW_SOURCES; 6451da177e4SLinus Torvalds } else { 6461da177e4SLinus Torvalds type = IGMPV3_ALLOW_NEW_SOURCES; 6471da177e4SLinus Torvalds dtype = IGMPV3_BLOCK_OLD_SOURCES; 6481da177e4SLinus Torvalds } 6491da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 0, 0); 6501da177e4SLinus Torvalds skb = add_grec(skb, pmc, dtype, 0, 1); /* deleted sources */ 6511da177e4SLinus Torvalds 6521da177e4SLinus Torvalds /* filter mode changes */ 6531da177e4SLinus Torvalds if (pmc->crcount) { 6541da177e4SLinus Torvalds if (pmc->sfmode == MCAST_EXCLUDE) 6551da177e4SLinus Torvalds type = IGMPV3_CHANGE_TO_EXCLUDE; 6561da177e4SLinus Torvalds else 6571da177e4SLinus Torvalds type = IGMPV3_CHANGE_TO_INCLUDE; 6581da177e4SLinus Torvalds skb = add_grec(skb, pmc, type, 0, 0); 659ad12583fSDavid L Stevens pmc->crcount--; 6601da177e4SLinus Torvalds } 6611da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 6621da177e4SLinus Torvalds } 6631d7138deSEric Dumazet rcu_read_unlock(); 6641da177e4SLinus Torvalds 6651da177e4SLinus Torvalds if (!skb) 6661da177e4SLinus Torvalds return; 6671da177e4SLinus Torvalds (void) igmpv3_sendpack(skb); 6681da177e4SLinus Torvalds } 6691da177e4SLinus Torvalds 6701da177e4SLinus Torvalds static int igmp_send_report(struct in_device *in_dev, struct ip_mc_list *pmc, 6711da177e4SLinus Torvalds int type) 6721da177e4SLinus Torvalds { 6731da177e4SLinus Torvalds struct sk_buff *skb; 6741da177e4SLinus Torvalds struct iphdr *iph; 6751da177e4SLinus Torvalds struct igmphdr *ih; 6761da177e4SLinus Torvalds struct rtable *rt; 6771da177e4SLinus Torvalds struct net_device *dev = in_dev->dev; 678877acedcSDaniel Lezcano struct net *net = dev_net(dev); 67963007727SAl Viro __be32 group = pmc ? pmc->multiaddr : 0; 68031e4543dSDavid S. Miller struct flowi4 fl4; 68163007727SAl Viro __be32 dst; 68266088243SHerbert Xu int hlen, tlen; 6831da177e4SLinus Torvalds 6841da177e4SLinus Torvalds if (type == IGMPV3_HOST_MEMBERSHIP_REPORT) 6851da177e4SLinus Torvalds return igmpv3_send_report(in_dev, pmc); 686df2cf4a7SPhilip Downey 687df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(group) && !sysctl_igmp_llm_reports) 688df2cf4a7SPhilip Downey return 0; 689df2cf4a7SPhilip Downey 690df2cf4a7SPhilip Downey if (type == IGMP_HOST_LEAVE_MESSAGE) 6911da177e4SLinus Torvalds dst = IGMP_ALL_ROUTER; 6921da177e4SLinus Torvalds else 6931da177e4SLinus Torvalds dst = group; 6941da177e4SLinus Torvalds 69531e4543dSDavid S. Miller rt = ip_route_output_ports(net, &fl4, NULL, dst, 0, 69678fbfd8aSDavid S. Miller 0, 0, 69778fbfd8aSDavid S. Miller IPPROTO_IGMP, 0, dev->ifindex); 698b23dd4feSDavid S. Miller if (IS_ERR(rt)) 6991da177e4SLinus Torvalds return -1; 70078fbfd8aSDavid S. Miller 70166088243SHerbert Xu hlen = LL_RESERVED_SPACE(dev); 70266088243SHerbert Xu tlen = dev->needed_tailroom; 70366088243SHerbert Xu skb = alloc_skb(IGMP_SIZE + hlen + tlen, GFP_ATOMIC); 70451456b29SIan Morris if (!skb) { 7051da177e4SLinus Torvalds ip_rt_put(rt); 7061da177e4SLinus Torvalds return -1; 7071da177e4SLinus Torvalds } 7089d4a0314SHannes Frederic Sowa skb->priority = TC_PRIO_CONTROL; 7091da177e4SLinus Torvalds 710d8d1f30bSChangli Gao skb_dst_set(skb, &rt->dst); 7111da177e4SLinus Torvalds 71266088243SHerbert Xu skb_reserve(skb, hlen); 7131da177e4SLinus Torvalds 7147e28ecc2SArnaldo Carvalho de Melo skb_reset_network_header(skb); 715eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 7167e28ecc2SArnaldo Carvalho de Melo skb_put(skb, sizeof(struct iphdr) + 4); 7171da177e4SLinus Torvalds 7181da177e4SLinus Torvalds iph->version = 4; 7191da177e4SLinus Torvalds iph->ihl = (sizeof(struct iphdr)+4)>>2; 7201da177e4SLinus Torvalds iph->tos = 0xc0; 7211da177e4SLinus Torvalds iph->frag_off = htons(IP_DF); 7221da177e4SLinus Torvalds iph->ttl = 1; 7231da177e4SLinus Torvalds iph->daddr = dst; 724492f64ceSDavid S. Miller iph->saddr = fl4.saddr; 7251da177e4SLinus Torvalds iph->protocol = IPPROTO_IGMP; 726b6a7719aSHannes Frederic Sowa ip_select_ident(net, skb, NULL); 7271da177e4SLinus Torvalds ((u8 *)&iph[1])[0] = IPOPT_RA; 7281da177e4SLinus Torvalds ((u8 *)&iph[1])[1] = 4; 7291da177e4SLinus Torvalds ((u8 *)&iph[1])[2] = 0; 7301da177e4SLinus Torvalds ((u8 *)&iph[1])[3] = 0; 7311da177e4SLinus Torvalds 7321da177e4SLinus Torvalds ih = (struct igmphdr *)skb_put(skb, sizeof(struct igmphdr)); 7331da177e4SLinus Torvalds ih->type = type; 7341da177e4SLinus Torvalds ih->code = 0; 7351da177e4SLinus Torvalds ih->csum = 0; 7361da177e4SLinus Torvalds ih->group = group; 7371da177e4SLinus Torvalds ih->csum = ip_compute_csum((void *)ih, sizeof(struct igmphdr)); 7381da177e4SLinus Torvalds 73933224b16SEric W. Biederman return ip_local_out(net, skb->sk, skb); 7401da177e4SLinus Torvalds } 7411da177e4SLinus Torvalds 7421da177e4SLinus Torvalds static void igmp_gq_timer_expire(unsigned long data) 7431da177e4SLinus Torvalds { 7441da177e4SLinus Torvalds struct in_device *in_dev = (struct in_device *)data; 7451da177e4SLinus Torvalds 7461da177e4SLinus Torvalds in_dev->mr_gq_running = 0; 7471da177e4SLinus Torvalds igmpv3_send_report(in_dev, NULL); 748e2401654SSalam Noureddine in_dev_put(in_dev); 7491da177e4SLinus Torvalds } 7501da177e4SLinus Torvalds 7511da177e4SLinus Torvalds static void igmp_ifc_timer_expire(unsigned long data) 7521da177e4SLinus Torvalds { 7531da177e4SLinus Torvalds struct in_device *in_dev = (struct in_device *)data; 7541da177e4SLinus Torvalds 7551da177e4SLinus Torvalds igmpv3_send_cr(in_dev); 7561da177e4SLinus Torvalds if (in_dev->mr_ifc_count) { 7571da177e4SLinus Torvalds in_dev->mr_ifc_count--; 758cab70040SWilliam Manley igmp_ifc_start_timer(in_dev, 759cab70040SWilliam Manley unsolicited_report_interval(in_dev)); 7601da177e4SLinus Torvalds } 761e2401654SSalam Noureddine in_dev_put(in_dev); 7621da177e4SLinus Torvalds } 7631da177e4SLinus Torvalds 7641da177e4SLinus Torvalds static void igmp_ifc_event(struct in_device *in_dev) 7651da177e4SLinus Torvalds { 7661da177e4SLinus Torvalds if (IGMP_V1_SEEN(in_dev) || IGMP_V2_SEEN(in_dev)) 7671da177e4SLinus Torvalds return; 768a9fe8e29SHannes Frederic Sowa in_dev->mr_ifc_count = in_dev->mr_qrv ?: sysctl_igmp_qrv; 7691da177e4SLinus Torvalds igmp_ifc_start_timer(in_dev, 1); 7701da177e4SLinus Torvalds } 7711da177e4SLinus Torvalds 7721da177e4SLinus Torvalds 7731da177e4SLinus Torvalds static void igmp_timer_expire(unsigned long data) 7741da177e4SLinus Torvalds { 7751da177e4SLinus Torvalds struct ip_mc_list *im = (struct ip_mc_list *)data; 7761da177e4SLinus Torvalds struct in_device *in_dev = im->interface; 7771da177e4SLinus Torvalds 7781da177e4SLinus Torvalds spin_lock(&im->lock); 7791da177e4SLinus Torvalds im->tm_running = 0; 7801da177e4SLinus Torvalds 7811da177e4SLinus Torvalds if (im->unsolicit_count) { 7821da177e4SLinus Torvalds im->unsolicit_count--; 783cab70040SWilliam Manley igmp_start_timer(im, unsolicited_report_interval(in_dev)); 7841da177e4SLinus Torvalds } 7851da177e4SLinus Torvalds im->reporter = 1; 7861da177e4SLinus Torvalds spin_unlock(&im->lock); 7871da177e4SLinus Torvalds 7881da177e4SLinus Torvalds if (IGMP_V1_SEEN(in_dev)) 7891da177e4SLinus Torvalds igmp_send_report(in_dev, im, IGMP_HOST_MEMBERSHIP_REPORT); 7901da177e4SLinus Torvalds else if (IGMP_V2_SEEN(in_dev)) 7911da177e4SLinus Torvalds igmp_send_report(in_dev, im, IGMPV2_HOST_MEMBERSHIP_REPORT); 7921da177e4SLinus Torvalds else 7931da177e4SLinus Torvalds igmp_send_report(in_dev, im, IGMPV3_HOST_MEMBERSHIP_REPORT); 7941da177e4SLinus Torvalds 7951da177e4SLinus Torvalds ip_ma_put(im); 7961da177e4SLinus Torvalds } 7971da177e4SLinus Torvalds 798ad12583fSDavid L Stevens /* mark EXCLUDE-mode sources */ 799ea4d9e72SAl Viro static int igmp_xmarksources(struct ip_mc_list *pmc, int nsrcs, __be32 *srcs) 8001da177e4SLinus Torvalds { 8011da177e4SLinus Torvalds struct ip_sf_list *psf; 8021da177e4SLinus Torvalds int i, scount; 8031da177e4SLinus Torvalds 8041da177e4SLinus Torvalds scount = 0; 8051da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) { 8061da177e4SLinus Torvalds if (scount == nsrcs) 8071da177e4SLinus Torvalds break; 808ad12583fSDavid L Stevens for (i = 0; i < nsrcs; i++) { 809ad12583fSDavid L Stevens /* skip inactive filters */ 810e05c4ad3SYan, Zheng if (psf->sf_count[MCAST_INCLUDE] || 811ad12583fSDavid L Stevens pmc->sfcount[MCAST_EXCLUDE] != 812ad12583fSDavid L Stevens psf->sf_count[MCAST_EXCLUDE]) 813ce713ee5SRongQing.Li break; 814ad12583fSDavid L Stevens if (srcs[i] == psf->sf_inaddr) { 815ad12583fSDavid L Stevens scount++; 816ad12583fSDavid L Stevens break; 817ad12583fSDavid L Stevens } 818ad12583fSDavid L Stevens } 819ad12583fSDavid L Stevens } 820ad12583fSDavid L Stevens pmc->gsquery = 0; 821ad12583fSDavid L Stevens if (scount == nsrcs) /* all sources excluded */ 822ad12583fSDavid L Stevens return 0; 823ad12583fSDavid L Stevens return 1; 824ad12583fSDavid L Stevens } 825ad12583fSDavid L Stevens 826ea4d9e72SAl Viro static int igmp_marksources(struct ip_mc_list *pmc, int nsrcs, __be32 *srcs) 827ad12583fSDavid L Stevens { 828ad12583fSDavid L Stevens struct ip_sf_list *psf; 829ad12583fSDavid L Stevens int i, scount; 830ad12583fSDavid L Stevens 831ad12583fSDavid L Stevens if (pmc->sfmode == MCAST_EXCLUDE) 832ad12583fSDavid L Stevens return igmp_xmarksources(pmc, nsrcs, srcs); 833ad12583fSDavid L Stevens 834ad12583fSDavid L Stevens /* mark INCLUDE-mode sources */ 835ad12583fSDavid L Stevens scount = 0; 836ad12583fSDavid L Stevens for (psf = pmc->sources; psf; psf = psf->sf_next) { 837ad12583fSDavid L Stevens if (scount == nsrcs) 838ad12583fSDavid L Stevens break; 8391da177e4SLinus Torvalds for (i = 0; i < nsrcs; i++) 8401da177e4SLinus Torvalds if (srcs[i] == psf->sf_inaddr) { 8411da177e4SLinus Torvalds psf->sf_gsresp = 1; 8421da177e4SLinus Torvalds scount++; 8431da177e4SLinus Torvalds break; 8441da177e4SLinus Torvalds } 8451da177e4SLinus Torvalds } 846ad12583fSDavid L Stevens if (!scount) { 847ad12583fSDavid L Stevens pmc->gsquery = 0; 848ad12583fSDavid L Stevens return 0; 849ad12583fSDavid L Stevens } 850ad12583fSDavid L Stevens pmc->gsquery = 1; 851ad12583fSDavid L Stevens return 1; 8521da177e4SLinus Torvalds } 8531da177e4SLinus Torvalds 854d679c532SEric Dumazet /* return true if packet was dropped */ 855d679c532SEric Dumazet static bool igmp_heard_report(struct in_device *in_dev, __be32 group) 8561da177e4SLinus Torvalds { 8571da177e4SLinus Torvalds struct ip_mc_list *im; 8581da177e4SLinus Torvalds 8591da177e4SLinus Torvalds /* Timers are only set for non-local groups */ 8601da177e4SLinus Torvalds 8611da177e4SLinus Torvalds if (group == IGMP_ALL_HOSTS) 862d679c532SEric Dumazet return false; 863df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(group) && !sysctl_igmp_llm_reports) 864df2cf4a7SPhilip Downey return false; 8651da177e4SLinus Torvalds 8661d7138deSEric Dumazet rcu_read_lock(); 8671d7138deSEric Dumazet for_each_pmc_rcu(in_dev, im) { 8681da177e4SLinus Torvalds if (im->multiaddr == group) { 8691da177e4SLinus Torvalds igmp_stop_timer(im); 8701da177e4SLinus Torvalds break; 8711da177e4SLinus Torvalds } 8721da177e4SLinus Torvalds } 8731d7138deSEric Dumazet rcu_read_unlock(); 874d679c532SEric Dumazet return false; 8751da177e4SLinus Torvalds } 8761da177e4SLinus Torvalds 877d679c532SEric Dumazet /* return true if packet was dropped */ 878d679c532SEric Dumazet static bool igmp_heard_query(struct in_device *in_dev, struct sk_buff *skb, 8791da177e4SLinus Torvalds int len) 8801da177e4SLinus Torvalds { 881d9edf9e2SArnaldo Carvalho de Melo struct igmphdr *ih = igmp_hdr(skb); 882d9edf9e2SArnaldo Carvalho de Melo struct igmpv3_query *ih3 = igmpv3_query_hdr(skb); 8831da177e4SLinus Torvalds struct ip_mc_list *im; 88463007727SAl Viro __be32 group = ih->group; 8851da177e4SLinus Torvalds int max_delay; 8861da177e4SLinus Torvalds int mark = 0; 8871da177e4SLinus Torvalds 8881da177e4SLinus Torvalds 8895b7c8406SDavid Stevens if (len == 8) { 8901da177e4SLinus Torvalds if (ih->code == 0) { 8911da177e4SLinus Torvalds /* Alas, old v1 router presents here. */ 8921da177e4SLinus Torvalds 893436f7c20SFabian Frederick max_delay = IGMP_QUERY_RESPONSE_INTERVAL; 8941da177e4SLinus Torvalds in_dev->mr_v1_seen = jiffies + 895436f7c20SFabian Frederick IGMP_V1_ROUTER_PRESENT_TIMEOUT; 8961da177e4SLinus Torvalds group = 0; 8971da177e4SLinus Torvalds } else { 8981da177e4SLinus Torvalds /* v2 router present */ 8991da177e4SLinus Torvalds max_delay = ih->code*(HZ/IGMP_TIMER_SCALE); 9001da177e4SLinus Torvalds in_dev->mr_v2_seen = jiffies + 901436f7c20SFabian Frederick IGMP_V2_ROUTER_PRESENT_TIMEOUT; 9021da177e4SLinus Torvalds } 9031da177e4SLinus Torvalds /* cancel the interface change timer */ 9041da177e4SLinus Torvalds in_dev->mr_ifc_count = 0; 9051da177e4SLinus Torvalds if (del_timer(&in_dev->mr_ifc_timer)) 9061da177e4SLinus Torvalds __in_dev_put(in_dev); 9071da177e4SLinus Torvalds /* clear deleted report items */ 9081da177e4SLinus Torvalds igmpv3_clear_delrec(in_dev); 9091da177e4SLinus Torvalds } else if (len < 12) { 910d679c532SEric Dumazet return true; /* ignore bogus packet; freed by caller */ 9115b7c8406SDavid Stevens } else if (IGMP_V1_SEEN(in_dev)) { 9125b7c8406SDavid Stevens /* This is a v3 query with v1 queriers present */ 913436f7c20SFabian Frederick max_delay = IGMP_QUERY_RESPONSE_INTERVAL; 9145b7c8406SDavid Stevens group = 0; 9155b7c8406SDavid Stevens } else if (IGMP_V2_SEEN(in_dev)) { 9165b7c8406SDavid Stevens /* this is a v3 query with v2 queriers present; 9175b7c8406SDavid Stevens * Interpretation of the max_delay code is problematic here. 9185b7c8406SDavid Stevens * A real v2 host would use ih_code directly, while v3 has a 9195b7c8406SDavid Stevens * different encoding. We use the v3 encoding as more likely 9205b7c8406SDavid Stevens * to be intended in a v3 query. 9215b7c8406SDavid Stevens */ 9225b7c8406SDavid Stevens max_delay = IGMPV3_MRC(ih3->code)*(HZ/IGMP_TIMER_SCALE); 923a8c1f65cSBen Hutchings if (!max_delay) 924a8c1f65cSBen Hutchings max_delay = 1; /* can't mod w/ 0 */ 9251da177e4SLinus Torvalds } else { /* v3 */ 9261da177e4SLinus Torvalds if (!pskb_may_pull(skb, sizeof(struct igmpv3_query))) 927d679c532SEric Dumazet return true; 9281da177e4SLinus Torvalds 929d9edf9e2SArnaldo Carvalho de Melo ih3 = igmpv3_query_hdr(skb); 9301da177e4SLinus Torvalds if (ih3->nsrcs) { 9311da177e4SLinus Torvalds if (!pskb_may_pull(skb, sizeof(struct igmpv3_query) 93263007727SAl Viro + ntohs(ih3->nsrcs)*sizeof(__be32))) 933d679c532SEric Dumazet return true; 934d9edf9e2SArnaldo Carvalho de Melo ih3 = igmpv3_query_hdr(skb); 9351da177e4SLinus Torvalds } 9361da177e4SLinus Torvalds 9371da177e4SLinus Torvalds max_delay = IGMPV3_MRC(ih3->code)*(HZ/IGMP_TIMER_SCALE); 9381da177e4SLinus Torvalds if (!max_delay) 9391da177e4SLinus Torvalds max_delay = 1; /* can't mod w/ 0 */ 9401da177e4SLinus Torvalds in_dev->mr_maxdelay = max_delay; 9411da177e4SLinus Torvalds if (ih3->qrv) 9421da177e4SLinus Torvalds in_dev->mr_qrv = ih3->qrv; 9431da177e4SLinus Torvalds if (!group) { /* general query */ 9441da177e4SLinus Torvalds if (ih3->nsrcs) 945b47bd8d2SDaniel Borkmann return true; /* no sources allowed */ 9461da177e4SLinus Torvalds igmp_gq_start_timer(in_dev); 947d679c532SEric Dumazet return false; 9481da177e4SLinus Torvalds } 9491da177e4SLinus Torvalds /* mark sources to include, if group & source-specific */ 9501da177e4SLinus Torvalds mark = ih3->nsrcs != 0; 9511da177e4SLinus Torvalds } 9521da177e4SLinus Torvalds 9531da177e4SLinus Torvalds /* 9541da177e4SLinus Torvalds * - Start the timers in all of our membership records 9551da177e4SLinus Torvalds * that the query applies to for the interface on 9561da177e4SLinus Torvalds * which the query arrived excl. those that belong 9571da177e4SLinus Torvalds * to a "local" group (224.0.0.X) 9581da177e4SLinus Torvalds * - For timers already running check if they need to 9591da177e4SLinus Torvalds * be reset. 9601da177e4SLinus Torvalds * - Use the igmp->igmp_code field as the maximum 9611da177e4SLinus Torvalds * delay possible 9621da177e4SLinus Torvalds */ 9631d7138deSEric Dumazet rcu_read_lock(); 9641d7138deSEric Dumazet for_each_pmc_rcu(in_dev, im) { 965ad12583fSDavid L Stevens int changed; 966ad12583fSDavid L Stevens 9671da177e4SLinus Torvalds if (group && group != im->multiaddr) 9681da177e4SLinus Torvalds continue; 9691da177e4SLinus Torvalds if (im->multiaddr == IGMP_ALL_HOSTS) 9701da177e4SLinus Torvalds continue; 971df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(im->multiaddr) && 972df2cf4a7SPhilip Downey !sysctl_igmp_llm_reports) 973df2cf4a7SPhilip Downey continue; 9741da177e4SLinus Torvalds spin_lock_bh(&im->lock); 9751da177e4SLinus Torvalds if (im->tm_running) 9761da177e4SLinus Torvalds im->gsquery = im->gsquery && mark; 9771da177e4SLinus Torvalds else 9781da177e4SLinus Torvalds im->gsquery = mark; 979ad12583fSDavid L Stevens changed = !im->gsquery || 9801da177e4SLinus Torvalds igmp_marksources(im, ntohs(ih3->nsrcs), ih3->srcs); 9811da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 982ad12583fSDavid L Stevens if (changed) 9831da177e4SLinus Torvalds igmp_mod_timer(im, max_delay); 9841da177e4SLinus Torvalds } 9851d7138deSEric Dumazet rcu_read_unlock(); 986d679c532SEric Dumazet return false; 9871da177e4SLinus Torvalds } 9881da177e4SLinus Torvalds 9899a57a9d2SEric Dumazet /* called in rcu_read_lock() section */ 9901da177e4SLinus Torvalds int igmp_rcv(struct sk_buff *skb) 9911da177e4SLinus Torvalds { 9921da177e4SLinus Torvalds /* This basically follows the spec line by line -- see RFC1112 */ 9931da177e4SLinus Torvalds struct igmphdr *ih; 9949a57a9d2SEric Dumazet struct in_device *in_dev = __in_dev_get_rcu(skb->dev); 9951da177e4SLinus Torvalds int len = skb->len; 996d679c532SEric Dumazet bool dropped = true; 9971da177e4SLinus Torvalds 99851456b29SIan Morris if (!in_dev) 999cd557bc1SDenis V. Lunev goto drop; 10001da177e4SLinus Torvalds 1001fb286bb2SHerbert Xu if (!pskb_may_pull(skb, sizeof(struct igmphdr))) 10029a57a9d2SEric Dumazet goto drop; 1003fb286bb2SHerbert Xu 1004de08dc1aSTom Herbert if (skb_checksum_simple_validate(skb)) 10059a57a9d2SEric Dumazet goto drop; 10061da177e4SLinus Torvalds 1007d9edf9e2SArnaldo Carvalho de Melo ih = igmp_hdr(skb); 10081da177e4SLinus Torvalds switch (ih->type) { 10091da177e4SLinus Torvalds case IGMP_HOST_MEMBERSHIP_QUERY: 1010d679c532SEric Dumazet dropped = igmp_heard_query(in_dev, skb, len); 10111da177e4SLinus Torvalds break; 10121da177e4SLinus Torvalds case IGMP_HOST_MEMBERSHIP_REPORT: 10131da177e4SLinus Torvalds case IGMPV2_HOST_MEMBERSHIP_REPORT: 10141da177e4SLinus Torvalds /* Is it our report looped back? */ 1015c7537967SDavid S. Miller if (rt_is_output_route(skb_rtable(skb))) 10161da177e4SLinus Torvalds break; 101724c69275SDavid Stevens /* don't rely on MC router hearing unicast reports */ 101824c69275SDavid Stevens if (skb->pkt_type == PACKET_MULTICAST || 101924c69275SDavid Stevens skb->pkt_type == PACKET_BROADCAST) 1020d679c532SEric Dumazet dropped = igmp_heard_report(in_dev, ih->group); 10211da177e4SLinus Torvalds break; 10221da177e4SLinus Torvalds case IGMP_PIM: 10231da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM_V1 10241da177e4SLinus Torvalds return pim_rcv_v1(skb); 10251da177e4SLinus Torvalds #endif 1026c6b471e6SHerbert Xu case IGMPV3_HOST_MEMBERSHIP_REPORT: 10271da177e4SLinus Torvalds case IGMP_DVMRP: 10281da177e4SLinus Torvalds case IGMP_TRACE: 10291da177e4SLinus Torvalds case IGMP_HOST_LEAVE_MESSAGE: 10301da177e4SLinus Torvalds case IGMP_MTRACE: 10311da177e4SLinus Torvalds case IGMP_MTRACE_RESP: 10321da177e4SLinus Torvalds break; 10331da177e4SLinus Torvalds default: 1034dd1c1853SLinus Torvalds break; 10351da177e4SLinus Torvalds } 1036fb286bb2SHerbert Xu 1037cd557bc1SDenis V. Lunev drop: 1038d679c532SEric Dumazet if (dropped) 10391da177e4SLinus Torvalds kfree_skb(skb); 1040d679c532SEric Dumazet else 1041d679c532SEric Dumazet consume_skb(skb); 10421da177e4SLinus Torvalds return 0; 10431da177e4SLinus Torvalds } 10441da177e4SLinus Torvalds 10451da177e4SLinus Torvalds #endif 10461da177e4SLinus Torvalds 10471da177e4SLinus Torvalds 10481da177e4SLinus Torvalds /* 10491da177e4SLinus Torvalds * Add a filter to a device 10501da177e4SLinus Torvalds */ 10511da177e4SLinus Torvalds 105263007727SAl Viro static void ip_mc_filter_add(struct in_device *in_dev, __be32 addr) 10531da177e4SLinus Torvalds { 10541da177e4SLinus Torvalds char buf[MAX_ADDR_LEN]; 10551da177e4SLinus Torvalds struct net_device *dev = in_dev->dev; 10561da177e4SLinus Torvalds 10571da177e4SLinus Torvalds /* Checking for IFF_MULTICAST here is WRONG-WRONG-WRONG. 10581da177e4SLinus Torvalds We will get multicast token leakage, when IFF_MULTICAST 1059b81693d9SJiri Pirko is changed. This check should be done in ndo_set_rx_mode 10601da177e4SLinus Torvalds routine. Something sort of: 10611da177e4SLinus Torvalds if (dev->mc_list && dev->flags&IFF_MULTICAST) { do it; } 10621da177e4SLinus Torvalds --ANK 10631da177e4SLinus Torvalds */ 10641da177e4SLinus Torvalds if (arp_mc_map(addr, buf, dev, 0) == 0) 106522bedad3SJiri Pirko dev_mc_add(dev, buf); 10661da177e4SLinus Torvalds } 10671da177e4SLinus Torvalds 10681da177e4SLinus Torvalds /* 10691da177e4SLinus Torvalds * Remove a filter from a device 10701da177e4SLinus Torvalds */ 10711da177e4SLinus Torvalds 107263007727SAl Viro static void ip_mc_filter_del(struct in_device *in_dev, __be32 addr) 10731da177e4SLinus Torvalds { 10741da177e4SLinus Torvalds char buf[MAX_ADDR_LEN]; 10751da177e4SLinus Torvalds struct net_device *dev = in_dev->dev; 10761da177e4SLinus Torvalds 10771da177e4SLinus Torvalds if (arp_mc_map(addr, buf, dev, 0) == 0) 107822bedad3SJiri Pirko dev_mc_del(dev, buf); 10791da177e4SLinus Torvalds } 10801da177e4SLinus Torvalds 10811da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 10821da177e4SLinus Torvalds /* 10831da177e4SLinus Torvalds * deleted ip_mc_list manipulation 10841da177e4SLinus Torvalds */ 10851da177e4SLinus Torvalds static void igmpv3_add_delrec(struct in_device *in_dev, struct ip_mc_list *im) 10861da177e4SLinus Torvalds { 10871da177e4SLinus Torvalds struct ip_mc_list *pmc; 10881da177e4SLinus Torvalds 10891da177e4SLinus Torvalds /* this is an "ip_mc_list" for convenience; only the fields below 10901da177e4SLinus Torvalds * are actually used. In particular, the refcnt and users are not 10911da177e4SLinus Torvalds * used for management of the delete list. Using the same structure 10921da177e4SLinus Torvalds * for deleted items allows change reports to use common code with 10931da177e4SLinus Torvalds * non-deleted or query-response MCA's. 10941da177e4SLinus Torvalds */ 10950da974f4SPanagiotis Issaris pmc = kzalloc(sizeof(*pmc), GFP_KERNEL); 10961da177e4SLinus Torvalds if (!pmc) 10971da177e4SLinus Torvalds return; 10981da177e4SLinus Torvalds spin_lock_bh(&im->lock); 10991da177e4SLinus Torvalds pmc->interface = im->interface; 11001da177e4SLinus Torvalds in_dev_hold(in_dev); 11011da177e4SLinus Torvalds pmc->multiaddr = im->multiaddr; 1102a9fe8e29SHannes Frederic Sowa pmc->crcount = in_dev->mr_qrv ?: sysctl_igmp_qrv; 11031da177e4SLinus Torvalds pmc->sfmode = im->sfmode; 11041da177e4SLinus Torvalds if (pmc->sfmode == MCAST_INCLUDE) { 11051da177e4SLinus Torvalds struct ip_sf_list *psf; 11061da177e4SLinus Torvalds 11071da177e4SLinus Torvalds pmc->tomb = im->tomb; 11081da177e4SLinus Torvalds pmc->sources = im->sources; 11091da177e4SLinus Torvalds im->tomb = im->sources = NULL; 11101da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) 11111da177e4SLinus Torvalds psf->sf_crcount = pmc->crcount; 11121da177e4SLinus Torvalds } 11131da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 11141da177e4SLinus Torvalds 11151da177e4SLinus Torvalds spin_lock_bh(&in_dev->mc_tomb_lock); 11161da177e4SLinus Torvalds pmc->next = in_dev->mc_tomb; 11171da177e4SLinus Torvalds in_dev->mc_tomb = pmc; 11181da177e4SLinus Torvalds spin_unlock_bh(&in_dev->mc_tomb_lock); 11191da177e4SLinus Torvalds } 11201da177e4SLinus Torvalds 112163007727SAl Viro static void igmpv3_del_delrec(struct in_device *in_dev, __be32 multiaddr) 11221da177e4SLinus Torvalds { 11231da177e4SLinus Torvalds struct ip_mc_list *pmc, *pmc_prev; 11241da177e4SLinus Torvalds struct ip_sf_list *psf, *psf_next; 11251da177e4SLinus Torvalds 11261da177e4SLinus Torvalds spin_lock_bh(&in_dev->mc_tomb_lock); 11271da177e4SLinus Torvalds pmc_prev = NULL; 11281da177e4SLinus Torvalds for (pmc = in_dev->mc_tomb; pmc; pmc = pmc->next) { 11291da177e4SLinus Torvalds if (pmc->multiaddr == multiaddr) 11301da177e4SLinus Torvalds break; 11311da177e4SLinus Torvalds pmc_prev = pmc; 11321da177e4SLinus Torvalds } 11331da177e4SLinus Torvalds if (pmc) { 11341da177e4SLinus Torvalds if (pmc_prev) 11351da177e4SLinus Torvalds pmc_prev->next = pmc->next; 11361da177e4SLinus Torvalds else 11371da177e4SLinus Torvalds in_dev->mc_tomb = pmc->next; 11381da177e4SLinus Torvalds } 11391da177e4SLinus Torvalds spin_unlock_bh(&in_dev->mc_tomb_lock); 11401da177e4SLinus Torvalds if (pmc) { 11411da177e4SLinus Torvalds for (psf = pmc->tomb; psf; psf = psf_next) { 11421da177e4SLinus Torvalds psf_next = psf->sf_next; 11431da177e4SLinus Torvalds kfree(psf); 11441da177e4SLinus Torvalds } 11451da177e4SLinus Torvalds in_dev_put(pmc->interface); 11461da177e4SLinus Torvalds kfree(pmc); 11471da177e4SLinus Torvalds } 11481da177e4SLinus Torvalds } 11491da177e4SLinus Torvalds 11501da177e4SLinus Torvalds static void igmpv3_clear_delrec(struct in_device *in_dev) 11511da177e4SLinus Torvalds { 11521da177e4SLinus Torvalds struct ip_mc_list *pmc, *nextpmc; 11531da177e4SLinus Torvalds 11541da177e4SLinus Torvalds spin_lock_bh(&in_dev->mc_tomb_lock); 11551da177e4SLinus Torvalds pmc = in_dev->mc_tomb; 11561da177e4SLinus Torvalds in_dev->mc_tomb = NULL; 11571da177e4SLinus Torvalds spin_unlock_bh(&in_dev->mc_tomb_lock); 11581da177e4SLinus Torvalds 11591da177e4SLinus Torvalds for (; pmc; pmc = nextpmc) { 11601da177e4SLinus Torvalds nextpmc = pmc->next; 11611da177e4SLinus Torvalds ip_mc_clear_src(pmc); 11621da177e4SLinus Torvalds in_dev_put(pmc->interface); 11631da177e4SLinus Torvalds kfree(pmc); 11641da177e4SLinus Torvalds } 11651da177e4SLinus Torvalds /* clear dead sources, too */ 11661d7138deSEric Dumazet rcu_read_lock(); 11671d7138deSEric Dumazet for_each_pmc_rcu(in_dev, pmc) { 11681da177e4SLinus Torvalds struct ip_sf_list *psf, *psf_next; 11691da177e4SLinus Torvalds 11701da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 11711da177e4SLinus Torvalds psf = pmc->tomb; 11721da177e4SLinus Torvalds pmc->tomb = NULL; 11731da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 11741da177e4SLinus Torvalds for (; psf; psf = psf_next) { 11751da177e4SLinus Torvalds psf_next = psf->sf_next; 11761da177e4SLinus Torvalds kfree(psf); 11771da177e4SLinus Torvalds } 11781da177e4SLinus Torvalds } 11791d7138deSEric Dumazet rcu_read_unlock(); 11801da177e4SLinus Torvalds } 11811da177e4SLinus Torvalds #endif 11821da177e4SLinus Torvalds 11831da177e4SLinus Torvalds static void igmp_group_dropped(struct ip_mc_list *im) 11841da177e4SLinus Torvalds { 11851da177e4SLinus Torvalds struct in_device *in_dev = im->interface; 11861da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 11871da177e4SLinus Torvalds int reporter; 11881da177e4SLinus Torvalds #endif 11891da177e4SLinus Torvalds 11901da177e4SLinus Torvalds if (im->loaded) { 11911da177e4SLinus Torvalds im->loaded = 0; 11921da177e4SLinus Torvalds ip_mc_filter_del(in_dev, im->multiaddr); 11931da177e4SLinus Torvalds } 11941da177e4SLinus Torvalds 11951da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 11961da177e4SLinus Torvalds if (im->multiaddr == IGMP_ALL_HOSTS) 11971da177e4SLinus Torvalds return; 1198df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(im->multiaddr) && !sysctl_igmp_llm_reports) 1199df2cf4a7SPhilip Downey return; 12001da177e4SLinus Torvalds 12011da177e4SLinus Torvalds reporter = im->reporter; 12021da177e4SLinus Torvalds igmp_stop_timer(im); 12031da177e4SLinus Torvalds 12041da177e4SLinus Torvalds if (!in_dev->dead) { 12051da177e4SLinus Torvalds if (IGMP_V1_SEEN(in_dev)) 120624cf3af3SVeaceslav Falico return; 12071da177e4SLinus Torvalds if (IGMP_V2_SEEN(in_dev)) { 12081da177e4SLinus Torvalds if (reporter) 12091da177e4SLinus Torvalds igmp_send_report(in_dev, im, IGMP_HOST_LEAVE_MESSAGE); 121024cf3af3SVeaceslav Falico return; 12111da177e4SLinus Torvalds } 12121da177e4SLinus Torvalds /* IGMPv3 */ 12131da177e4SLinus Torvalds igmpv3_add_delrec(in_dev, im); 12141da177e4SLinus Torvalds 12151da177e4SLinus Torvalds igmp_ifc_event(in_dev); 12161da177e4SLinus Torvalds } 12171da177e4SLinus Torvalds #endif 12181da177e4SLinus Torvalds } 12191da177e4SLinus Torvalds 12201da177e4SLinus Torvalds static void igmp_group_added(struct ip_mc_list *im) 12211da177e4SLinus Torvalds { 12221da177e4SLinus Torvalds struct in_device *in_dev = im->interface; 12231da177e4SLinus Torvalds 12241da177e4SLinus Torvalds if (im->loaded == 0) { 12251da177e4SLinus Torvalds im->loaded = 1; 12261da177e4SLinus Torvalds ip_mc_filter_add(in_dev, im->multiaddr); 12271da177e4SLinus Torvalds } 12281da177e4SLinus Torvalds 12291da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 12301da177e4SLinus Torvalds if (im->multiaddr == IGMP_ALL_HOSTS) 12311da177e4SLinus Torvalds return; 1232df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(im->multiaddr) && !sysctl_igmp_llm_reports) 1233df2cf4a7SPhilip Downey return; 12341da177e4SLinus Torvalds 12351da177e4SLinus Torvalds if (in_dev->dead) 12361da177e4SLinus Torvalds return; 12371da177e4SLinus Torvalds if (IGMP_V1_SEEN(in_dev) || IGMP_V2_SEEN(in_dev)) { 12381da177e4SLinus Torvalds spin_lock_bh(&im->lock); 1239436f7c20SFabian Frederick igmp_start_timer(im, IGMP_INITIAL_REPORT_DELAY); 12401da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 12411da177e4SLinus Torvalds return; 12421da177e4SLinus Torvalds } 12431da177e4SLinus Torvalds /* else, v3 */ 12441da177e4SLinus Torvalds 1245a9fe8e29SHannes Frederic Sowa im->crcount = in_dev->mr_qrv ?: sysctl_igmp_qrv; 12461da177e4SLinus Torvalds igmp_ifc_event(in_dev); 12471da177e4SLinus Torvalds #endif 12481da177e4SLinus Torvalds } 12491da177e4SLinus Torvalds 12501da177e4SLinus Torvalds 12511da177e4SLinus Torvalds /* 12521da177e4SLinus Torvalds * Multicast list managers 12531da177e4SLinus Torvalds */ 12541da177e4SLinus Torvalds 1255e9897071SEric Dumazet static u32 ip_mc_hash(const struct ip_mc_list *im) 1256e9897071SEric Dumazet { 1257c70eba74SEric Dumazet return hash_32((__force u32)im->multiaddr, MC_HASH_SZ_LOG); 1258e9897071SEric Dumazet } 1259e9897071SEric Dumazet 1260e9897071SEric Dumazet static void ip_mc_hash_add(struct in_device *in_dev, 1261e9897071SEric Dumazet struct ip_mc_list *im) 1262e9897071SEric Dumazet { 1263e9897071SEric Dumazet struct ip_mc_list __rcu **mc_hash; 1264e9897071SEric Dumazet u32 hash; 1265e9897071SEric Dumazet 1266e9897071SEric Dumazet mc_hash = rtnl_dereference(in_dev->mc_hash); 1267e9897071SEric Dumazet if (mc_hash) { 1268e9897071SEric Dumazet hash = ip_mc_hash(im); 1269c70eba74SEric Dumazet im->next_hash = mc_hash[hash]; 1270e9897071SEric Dumazet rcu_assign_pointer(mc_hash[hash], im); 1271e9897071SEric Dumazet return; 1272e9897071SEric Dumazet } 1273e9897071SEric Dumazet 1274e9897071SEric Dumazet /* do not use a hash table for small number of items */ 1275e9897071SEric Dumazet if (in_dev->mc_count < 4) 1276e9897071SEric Dumazet return; 1277e9897071SEric Dumazet 1278e9897071SEric Dumazet mc_hash = kzalloc(sizeof(struct ip_mc_list *) << MC_HASH_SZ_LOG, 1279e9897071SEric Dumazet GFP_KERNEL); 1280e9897071SEric Dumazet if (!mc_hash) 1281e9897071SEric Dumazet return; 1282e9897071SEric Dumazet 1283e9897071SEric Dumazet for_each_pmc_rtnl(in_dev, im) { 1284e9897071SEric Dumazet hash = ip_mc_hash(im); 1285c70eba74SEric Dumazet im->next_hash = mc_hash[hash]; 1286e9897071SEric Dumazet RCU_INIT_POINTER(mc_hash[hash], im); 1287e9897071SEric Dumazet } 1288e9897071SEric Dumazet 1289e9897071SEric Dumazet rcu_assign_pointer(in_dev->mc_hash, mc_hash); 1290e9897071SEric Dumazet } 1291e9897071SEric Dumazet 1292e9897071SEric Dumazet static void ip_mc_hash_remove(struct in_device *in_dev, 1293e9897071SEric Dumazet struct ip_mc_list *im) 1294e9897071SEric Dumazet { 1295e9897071SEric Dumazet struct ip_mc_list __rcu **mc_hash = rtnl_dereference(in_dev->mc_hash); 1296e9897071SEric Dumazet struct ip_mc_list *aux; 1297e9897071SEric Dumazet 1298e9897071SEric Dumazet if (!mc_hash) 1299e9897071SEric Dumazet return; 1300e9897071SEric Dumazet mc_hash += ip_mc_hash(im); 1301e9897071SEric Dumazet while ((aux = rtnl_dereference(*mc_hash)) != im) 1302e9897071SEric Dumazet mc_hash = &aux->next_hash; 1303e9897071SEric Dumazet *mc_hash = im->next_hash; 1304e9897071SEric Dumazet } 1305e9897071SEric Dumazet 13061da177e4SLinus Torvalds 13071da177e4SLinus Torvalds /* 13081da177e4SLinus Torvalds * A socket has joined a multicast group on device dev. 13091da177e4SLinus Torvalds */ 13101da177e4SLinus Torvalds 13118f935bbdSAl Viro void ip_mc_inc_group(struct in_device *in_dev, __be32 addr) 13121da177e4SLinus Torvalds { 13131da177e4SLinus Torvalds struct ip_mc_list *im; 13141da177e4SLinus Torvalds 13151da177e4SLinus Torvalds ASSERT_RTNL(); 13161da177e4SLinus Torvalds 13171d7138deSEric Dumazet for_each_pmc_rtnl(in_dev, im) { 13181da177e4SLinus Torvalds if (im->multiaddr == addr) { 13191da177e4SLinus Torvalds im->users++; 13201da177e4SLinus Torvalds ip_mc_add_src(in_dev, &addr, MCAST_EXCLUDE, 0, NULL, 0); 13211da177e4SLinus Torvalds goto out; 13221da177e4SLinus Torvalds } 13231da177e4SLinus Torvalds } 13241da177e4SLinus Torvalds 13251d7138deSEric Dumazet im = kzalloc(sizeof(*im), GFP_KERNEL); 13261da177e4SLinus Torvalds if (!im) 13271da177e4SLinus Torvalds goto out; 13281da177e4SLinus Torvalds 13291da177e4SLinus Torvalds im->users = 1; 13301da177e4SLinus Torvalds im->interface = in_dev; 13311da177e4SLinus Torvalds in_dev_hold(in_dev); 13321da177e4SLinus Torvalds im->multiaddr = addr; 13331da177e4SLinus Torvalds /* initial mode is (EX, empty) */ 13341da177e4SLinus Torvalds im->sfmode = MCAST_EXCLUDE; 13351da177e4SLinus Torvalds im->sfcount[MCAST_EXCLUDE] = 1; 13361da177e4SLinus Torvalds atomic_set(&im->refcnt, 1); 13371da177e4SLinus Torvalds spin_lock_init(&im->lock); 13381da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 1339179542a5SHimangi Saraogi setup_timer(&im->timer, igmp_timer_expire, (unsigned long)im); 1340a9fe8e29SHannes Frederic Sowa im->unsolicit_count = sysctl_igmp_qrv; 13411da177e4SLinus Torvalds #endif 13421d7138deSEric Dumazet 13431d7138deSEric Dumazet im->next_rcu = in_dev->mc_list; 1344b8bae41eSRami Rosen in_dev->mc_count++; 1345cf778b00SEric Dumazet rcu_assign_pointer(in_dev->mc_list, im); 13461d7138deSEric Dumazet 1347e9897071SEric Dumazet ip_mc_hash_add(in_dev, im); 1348e9897071SEric Dumazet 13491da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 13501da177e4SLinus Torvalds igmpv3_del_delrec(in_dev, im->multiaddr); 13511da177e4SLinus Torvalds #endif 13521da177e4SLinus Torvalds igmp_group_added(im); 13531da177e4SLinus Torvalds if (!in_dev->dead) 13541da177e4SLinus Torvalds ip_rt_multicast_event(in_dev); 13551da177e4SLinus Torvalds out: 13561da177e4SLinus Torvalds return; 13571da177e4SLinus Torvalds } 13584bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_mc_inc_group); 13591da177e4SLinus Torvalds 13609afd85c9SLinus Lüssing static int ip_mc_check_iphdr(struct sk_buff *skb) 13619afd85c9SLinus Lüssing { 13629afd85c9SLinus Lüssing const struct iphdr *iph; 13639afd85c9SLinus Lüssing unsigned int len; 13649afd85c9SLinus Lüssing unsigned int offset = skb_network_offset(skb) + sizeof(*iph); 13659afd85c9SLinus Lüssing 13669afd85c9SLinus Lüssing if (!pskb_may_pull(skb, offset)) 13679afd85c9SLinus Lüssing return -EINVAL; 13689afd85c9SLinus Lüssing 13699afd85c9SLinus Lüssing iph = ip_hdr(skb); 13709afd85c9SLinus Lüssing 13719afd85c9SLinus Lüssing if (iph->version != 4 || ip_hdrlen(skb) < sizeof(*iph)) 13729afd85c9SLinus Lüssing return -EINVAL; 13739afd85c9SLinus Lüssing 13749afd85c9SLinus Lüssing offset += ip_hdrlen(skb) - sizeof(*iph); 13759afd85c9SLinus Lüssing 13769afd85c9SLinus Lüssing if (!pskb_may_pull(skb, offset)) 13779afd85c9SLinus Lüssing return -EINVAL; 13789afd85c9SLinus Lüssing 13799afd85c9SLinus Lüssing iph = ip_hdr(skb); 13809afd85c9SLinus Lüssing 13819afd85c9SLinus Lüssing if (unlikely(ip_fast_csum((u8 *)iph, iph->ihl))) 13829afd85c9SLinus Lüssing return -EINVAL; 13839afd85c9SLinus Lüssing 13849afd85c9SLinus Lüssing len = skb_network_offset(skb) + ntohs(iph->tot_len); 13859afd85c9SLinus Lüssing if (skb->len < len || len < offset) 13869afd85c9SLinus Lüssing return -EINVAL; 13879afd85c9SLinus Lüssing 13889afd85c9SLinus Lüssing skb_set_transport_header(skb, offset); 13899afd85c9SLinus Lüssing 13909afd85c9SLinus Lüssing return 0; 13919afd85c9SLinus Lüssing } 13929afd85c9SLinus Lüssing 13939afd85c9SLinus Lüssing static int ip_mc_check_igmp_reportv3(struct sk_buff *skb) 13949afd85c9SLinus Lüssing { 13959afd85c9SLinus Lüssing unsigned int len = skb_transport_offset(skb); 13969afd85c9SLinus Lüssing 13979afd85c9SLinus Lüssing len += sizeof(struct igmpv3_report); 13989afd85c9SLinus Lüssing 13999afd85c9SLinus Lüssing return pskb_may_pull(skb, len) ? 0 : -EINVAL; 14009afd85c9SLinus Lüssing } 14019afd85c9SLinus Lüssing 14029afd85c9SLinus Lüssing static int ip_mc_check_igmp_query(struct sk_buff *skb) 14039afd85c9SLinus Lüssing { 14049afd85c9SLinus Lüssing unsigned int len = skb_transport_offset(skb); 14059afd85c9SLinus Lüssing 14069afd85c9SLinus Lüssing len += sizeof(struct igmphdr); 14079afd85c9SLinus Lüssing if (skb->len < len) 14089afd85c9SLinus Lüssing return -EINVAL; 14099afd85c9SLinus Lüssing 14109afd85c9SLinus Lüssing /* IGMPv{1,2}? */ 14119afd85c9SLinus Lüssing if (skb->len != len) { 14129afd85c9SLinus Lüssing /* or IGMPv3? */ 14139afd85c9SLinus Lüssing len += sizeof(struct igmpv3_query) - sizeof(struct igmphdr); 14149afd85c9SLinus Lüssing if (skb->len < len || !pskb_may_pull(skb, len)) 14159afd85c9SLinus Lüssing return -EINVAL; 14169afd85c9SLinus Lüssing } 14179afd85c9SLinus Lüssing 14189afd85c9SLinus Lüssing /* RFC2236+RFC3376 (IGMPv2+IGMPv3) require the multicast link layer 14199afd85c9SLinus Lüssing * all-systems destination addresses (224.0.0.1) for general queries 14209afd85c9SLinus Lüssing */ 14219afd85c9SLinus Lüssing if (!igmp_hdr(skb)->group && 14229afd85c9SLinus Lüssing ip_hdr(skb)->daddr != htonl(INADDR_ALLHOSTS_GROUP)) 14239afd85c9SLinus Lüssing return -EINVAL; 14249afd85c9SLinus Lüssing 14259afd85c9SLinus Lüssing return 0; 14269afd85c9SLinus Lüssing } 14279afd85c9SLinus Lüssing 14289afd85c9SLinus Lüssing static int ip_mc_check_igmp_msg(struct sk_buff *skb) 14299afd85c9SLinus Lüssing { 14309afd85c9SLinus Lüssing switch (igmp_hdr(skb)->type) { 14319afd85c9SLinus Lüssing case IGMP_HOST_LEAVE_MESSAGE: 14329afd85c9SLinus Lüssing case IGMP_HOST_MEMBERSHIP_REPORT: 14339afd85c9SLinus Lüssing case IGMPV2_HOST_MEMBERSHIP_REPORT: 14349afd85c9SLinus Lüssing /* fall through */ 14359afd85c9SLinus Lüssing return 0; 14369afd85c9SLinus Lüssing case IGMPV3_HOST_MEMBERSHIP_REPORT: 14379afd85c9SLinus Lüssing return ip_mc_check_igmp_reportv3(skb); 14389afd85c9SLinus Lüssing case IGMP_HOST_MEMBERSHIP_QUERY: 14399afd85c9SLinus Lüssing return ip_mc_check_igmp_query(skb); 14409afd85c9SLinus Lüssing default: 14419afd85c9SLinus Lüssing return -ENOMSG; 14429afd85c9SLinus Lüssing } 14439afd85c9SLinus Lüssing } 14449afd85c9SLinus Lüssing 14459afd85c9SLinus Lüssing static inline __sum16 ip_mc_validate_checksum(struct sk_buff *skb) 14469afd85c9SLinus Lüssing { 14479afd85c9SLinus Lüssing return skb_checksum_simple_validate(skb); 14489afd85c9SLinus Lüssing } 14499afd85c9SLinus Lüssing 14509afd85c9SLinus Lüssing static int __ip_mc_check_igmp(struct sk_buff *skb, struct sk_buff **skb_trimmed) 14519afd85c9SLinus Lüssing 14529afd85c9SLinus Lüssing { 14539afd85c9SLinus Lüssing struct sk_buff *skb_chk; 14549afd85c9SLinus Lüssing unsigned int transport_len; 14559afd85c9SLinus Lüssing unsigned int len = skb_transport_offset(skb) + sizeof(struct igmphdr); 1456a516993fSLinus Lüssing int ret = -EINVAL; 14579afd85c9SLinus Lüssing 14589afd85c9SLinus Lüssing transport_len = ntohs(ip_hdr(skb)->tot_len) - ip_hdrlen(skb); 14599afd85c9SLinus Lüssing 14609afd85c9SLinus Lüssing skb_chk = skb_checksum_trimmed(skb, transport_len, 14619afd85c9SLinus Lüssing ip_mc_validate_checksum); 14629afd85c9SLinus Lüssing if (!skb_chk) 1463a516993fSLinus Lüssing goto err; 14649afd85c9SLinus Lüssing 1465a516993fSLinus Lüssing if (!pskb_may_pull(skb_chk, len)) 1466a516993fSLinus Lüssing goto err; 14679afd85c9SLinus Lüssing 14689afd85c9SLinus Lüssing ret = ip_mc_check_igmp_msg(skb_chk); 1469a516993fSLinus Lüssing if (ret) 1470a516993fSLinus Lüssing goto err; 14719afd85c9SLinus Lüssing 14729afd85c9SLinus Lüssing if (skb_trimmed) 14739afd85c9SLinus Lüssing *skb_trimmed = skb_chk; 1474a516993fSLinus Lüssing /* free now unneeded clone */ 1475a516993fSLinus Lüssing else if (skb_chk != skb) 14769afd85c9SLinus Lüssing kfree_skb(skb_chk); 14779afd85c9SLinus Lüssing 1478a516993fSLinus Lüssing ret = 0; 1479a516993fSLinus Lüssing 1480a516993fSLinus Lüssing err: 1481a516993fSLinus Lüssing if (ret && skb_chk && skb_chk != skb) 1482a516993fSLinus Lüssing kfree_skb(skb_chk); 1483a516993fSLinus Lüssing 1484a516993fSLinus Lüssing return ret; 14859afd85c9SLinus Lüssing } 14869afd85c9SLinus Lüssing 14879afd85c9SLinus Lüssing /** 14889afd85c9SLinus Lüssing * ip_mc_check_igmp - checks whether this is a sane IGMP packet 14899afd85c9SLinus Lüssing * @skb: the skb to validate 14909afd85c9SLinus Lüssing * @skb_trimmed: to store an skb pointer trimmed to IPv4 packet tail (optional) 14919afd85c9SLinus Lüssing * 14929afd85c9SLinus Lüssing * Checks whether an IPv4 packet is a valid IGMP packet. If so sets 1493a516993fSLinus Lüssing * skb transport header accordingly and returns zero. 14949afd85c9SLinus Lüssing * 14959afd85c9SLinus Lüssing * -EINVAL: A broken packet was detected, i.e. it violates some internet 14969afd85c9SLinus Lüssing * standard 14979afd85c9SLinus Lüssing * -ENOMSG: IP header validation succeeded but it is not an IGMP packet. 14989afd85c9SLinus Lüssing * -ENOMEM: A memory allocation failure happened. 14999afd85c9SLinus Lüssing * 15009afd85c9SLinus Lüssing * Optionally, an skb pointer might be provided via skb_trimmed (or set it 15019afd85c9SLinus Lüssing * to NULL): After parsing an IGMP packet successfully it will point to 15029afd85c9SLinus Lüssing * an skb which has its tail aligned to the IP packet end. This might 15039afd85c9SLinus Lüssing * either be the originally provided skb or a trimmed, cloned version if 15049afd85c9SLinus Lüssing * the skb frame had data beyond the IP packet. A cloned skb allows us 15059afd85c9SLinus Lüssing * to leave the original skb and its full frame unchanged (which might be 15069afd85c9SLinus Lüssing * desirable for layer 2 frame jugglers). 15079afd85c9SLinus Lüssing * 1508a516993fSLinus Lüssing * Caller needs to set the skb network header and free any returned skb if it 1509a516993fSLinus Lüssing * differs from the provided skb. 15109afd85c9SLinus Lüssing */ 15119afd85c9SLinus Lüssing int ip_mc_check_igmp(struct sk_buff *skb, struct sk_buff **skb_trimmed) 15129afd85c9SLinus Lüssing { 15139afd85c9SLinus Lüssing int ret = ip_mc_check_iphdr(skb); 15149afd85c9SLinus Lüssing 15159afd85c9SLinus Lüssing if (ret < 0) 15169afd85c9SLinus Lüssing return ret; 15179afd85c9SLinus Lüssing 15189afd85c9SLinus Lüssing if (ip_hdr(skb)->protocol != IPPROTO_IGMP) 15199afd85c9SLinus Lüssing return -ENOMSG; 15209afd85c9SLinus Lüssing 15219afd85c9SLinus Lüssing return __ip_mc_check_igmp(skb, skb_trimmed); 15229afd85c9SLinus Lüssing } 15239afd85c9SLinus Lüssing EXPORT_SYMBOL(ip_mc_check_igmp); 15249afd85c9SLinus Lüssing 15251da177e4SLinus Torvalds /* 15264aa5dee4SJiri Pirko * Resend IGMP JOIN report; used by netdev notifier. 1527a816c7c7SJay Vosburgh */ 15284aa5dee4SJiri Pirko static void ip_mc_rejoin_groups(struct in_device *in_dev) 1529a816c7c7SJay Vosburgh { 153008882669SGeert Uytterhoeven #ifdef CONFIG_IP_MULTICAST 1531866f3b25SEric Dumazet struct ip_mc_list *im; 1532866f3b25SEric Dumazet int type; 1533a816c7c7SJay Vosburgh 15344aa5dee4SJiri Pirko ASSERT_RTNL(); 15354aa5dee4SJiri Pirko 15364aa5dee4SJiri Pirko for_each_pmc_rtnl(in_dev, im) { 1537a816c7c7SJay Vosburgh if (im->multiaddr == IGMP_ALL_HOSTS) 1538866f3b25SEric Dumazet continue; 1539df2cf4a7SPhilip Downey if (ipv4_is_local_multicast(im->multiaddr) && 1540df2cf4a7SPhilip Downey !sysctl_igmp_llm_reports) 1541df2cf4a7SPhilip Downey continue; 1542a816c7c7SJay Vosburgh 1543e12b4539SFlavio Leitner /* a failover is happening and switches 1544866f3b25SEric Dumazet * must be notified immediately 1545866f3b25SEric Dumazet */ 1546e12b4539SFlavio Leitner if (IGMP_V1_SEEN(in_dev)) 1547866f3b25SEric Dumazet type = IGMP_HOST_MEMBERSHIP_REPORT; 1548e12b4539SFlavio Leitner else if (IGMP_V2_SEEN(in_dev)) 1549866f3b25SEric Dumazet type = IGMPV2_HOST_MEMBERSHIP_REPORT; 1550e12b4539SFlavio Leitner else 1551866f3b25SEric Dumazet type = IGMPV3_HOST_MEMBERSHIP_REPORT; 1552866f3b25SEric Dumazet igmp_send_report(in_dev, im, type); 1553866f3b25SEric Dumazet } 1554a816c7c7SJay Vosburgh #endif 1555a816c7c7SJay Vosburgh } 1556a816c7c7SJay Vosburgh 1557a816c7c7SJay Vosburgh /* 15581da177e4SLinus Torvalds * A socket has left a multicast group on device dev 15591da177e4SLinus Torvalds */ 15601da177e4SLinus Torvalds 15618f935bbdSAl Viro void ip_mc_dec_group(struct in_device *in_dev, __be32 addr) 15621da177e4SLinus Torvalds { 15631d7138deSEric Dumazet struct ip_mc_list *i; 15641d7138deSEric Dumazet struct ip_mc_list __rcu **ip; 15651da177e4SLinus Torvalds 15661da177e4SLinus Torvalds ASSERT_RTNL(); 15671da177e4SLinus Torvalds 15681d7138deSEric Dumazet for (ip = &in_dev->mc_list; 15691d7138deSEric Dumazet (i = rtnl_dereference(*ip)) != NULL; 15701d7138deSEric Dumazet ip = &i->next_rcu) { 15711da177e4SLinus Torvalds if (i->multiaddr == addr) { 15721da177e4SLinus Torvalds if (--i->users == 0) { 1573e9897071SEric Dumazet ip_mc_hash_remove(in_dev, i); 15741d7138deSEric Dumazet *ip = i->next_rcu; 1575b8bae41eSRami Rosen in_dev->mc_count--; 15761da177e4SLinus Torvalds igmp_group_dropped(i); 157724cf3af3SVeaceslav Falico ip_mc_clear_src(i); 15781da177e4SLinus Torvalds 15791da177e4SLinus Torvalds if (!in_dev->dead) 15801da177e4SLinus Torvalds ip_rt_multicast_event(in_dev); 15811da177e4SLinus Torvalds 15821da177e4SLinus Torvalds ip_ma_put(i); 15831da177e4SLinus Torvalds return; 15841da177e4SLinus Torvalds } 15851da177e4SLinus Torvalds break; 15861da177e4SLinus Torvalds } 15871da177e4SLinus Torvalds } 15881da177e4SLinus Torvalds } 15894bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_mc_dec_group); 15901da177e4SLinus Torvalds 159175c78500SMoni Shoua /* Device changing type */ 159275c78500SMoni Shoua 159375c78500SMoni Shoua void ip_mc_unmap(struct in_device *in_dev) 159475c78500SMoni Shoua { 15951d7138deSEric Dumazet struct ip_mc_list *pmc; 159675c78500SMoni Shoua 159775c78500SMoni Shoua ASSERT_RTNL(); 159875c78500SMoni Shoua 15991d7138deSEric Dumazet for_each_pmc_rtnl(in_dev, pmc) 16001d7138deSEric Dumazet igmp_group_dropped(pmc); 160175c78500SMoni Shoua } 160275c78500SMoni Shoua 160375c78500SMoni Shoua void ip_mc_remap(struct in_device *in_dev) 160475c78500SMoni Shoua { 16051d7138deSEric Dumazet struct ip_mc_list *pmc; 160675c78500SMoni Shoua 160775c78500SMoni Shoua ASSERT_RTNL(); 160875c78500SMoni Shoua 16091d7138deSEric Dumazet for_each_pmc_rtnl(in_dev, pmc) 16101d7138deSEric Dumazet igmp_group_added(pmc); 161175c78500SMoni Shoua } 161275c78500SMoni Shoua 16131da177e4SLinus Torvalds /* Device going down */ 16141da177e4SLinus Torvalds 16151da177e4SLinus Torvalds void ip_mc_down(struct in_device *in_dev) 16161da177e4SLinus Torvalds { 16171d7138deSEric Dumazet struct ip_mc_list *pmc; 16181da177e4SLinus Torvalds 16191da177e4SLinus Torvalds ASSERT_RTNL(); 16201da177e4SLinus Torvalds 16211d7138deSEric Dumazet for_each_pmc_rtnl(in_dev, pmc) 16221d7138deSEric Dumazet igmp_group_dropped(pmc); 16231da177e4SLinus Torvalds 16241da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 16251da177e4SLinus Torvalds in_dev->mr_ifc_count = 0; 16261da177e4SLinus Torvalds if (del_timer(&in_dev->mr_ifc_timer)) 16271da177e4SLinus Torvalds __in_dev_put(in_dev); 16281da177e4SLinus Torvalds in_dev->mr_gq_running = 0; 16291da177e4SLinus Torvalds if (del_timer(&in_dev->mr_gq_timer)) 16301da177e4SLinus Torvalds __in_dev_put(in_dev); 16311da177e4SLinus Torvalds igmpv3_clear_delrec(in_dev); 16321da177e4SLinus Torvalds #endif 16331da177e4SLinus Torvalds 16341da177e4SLinus Torvalds ip_mc_dec_group(in_dev, IGMP_ALL_HOSTS); 16351da177e4SLinus Torvalds } 16361da177e4SLinus Torvalds 16371da177e4SLinus Torvalds void ip_mc_init_dev(struct in_device *in_dev) 16381da177e4SLinus Torvalds { 16391da177e4SLinus Torvalds ASSERT_RTNL(); 16401da177e4SLinus Torvalds 16411da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 1642b24b8a24SPavel Emelyanov setup_timer(&in_dev->mr_gq_timer, igmp_gq_timer_expire, 1643b24b8a24SPavel Emelyanov (unsigned long)in_dev); 1644b24b8a24SPavel Emelyanov setup_timer(&in_dev->mr_ifc_timer, igmp_ifc_timer_expire, 1645b24b8a24SPavel Emelyanov (unsigned long)in_dev); 1646a9fe8e29SHannes Frederic Sowa in_dev->mr_qrv = sysctl_igmp_qrv; 16471da177e4SLinus Torvalds #endif 16481da177e4SLinus Torvalds 16491da177e4SLinus Torvalds spin_lock_init(&in_dev->mc_tomb_lock); 16501da177e4SLinus Torvalds } 16511da177e4SLinus Torvalds 16521da177e4SLinus Torvalds /* Device going up */ 16531da177e4SLinus Torvalds 16541da177e4SLinus Torvalds void ip_mc_up(struct in_device *in_dev) 16551da177e4SLinus Torvalds { 16561d7138deSEric Dumazet struct ip_mc_list *pmc; 16571da177e4SLinus Torvalds 16581da177e4SLinus Torvalds ASSERT_RTNL(); 16591da177e4SLinus Torvalds 1660a9fe8e29SHannes Frederic Sowa #ifdef CONFIG_IP_MULTICAST 1661a9fe8e29SHannes Frederic Sowa in_dev->mr_qrv = sysctl_igmp_qrv; 1662a9fe8e29SHannes Frederic Sowa #endif 16631da177e4SLinus Torvalds ip_mc_inc_group(in_dev, IGMP_ALL_HOSTS); 16641da177e4SLinus Torvalds 16651d7138deSEric Dumazet for_each_pmc_rtnl(in_dev, pmc) 16661d7138deSEric Dumazet igmp_group_added(pmc); 16671da177e4SLinus Torvalds } 16681da177e4SLinus Torvalds 16691da177e4SLinus Torvalds /* 16701da177e4SLinus Torvalds * Device is about to be destroyed: clean up. 16711da177e4SLinus Torvalds */ 16721da177e4SLinus Torvalds 16731da177e4SLinus Torvalds void ip_mc_destroy_dev(struct in_device *in_dev) 16741da177e4SLinus Torvalds { 16751da177e4SLinus Torvalds struct ip_mc_list *i; 16761da177e4SLinus Torvalds 16771da177e4SLinus Torvalds ASSERT_RTNL(); 16781da177e4SLinus Torvalds 16791da177e4SLinus Torvalds /* Deactivate timers */ 16801da177e4SLinus Torvalds ip_mc_down(in_dev); 16811da177e4SLinus Torvalds 16821d7138deSEric Dumazet while ((i = rtnl_dereference(in_dev->mc_list)) != NULL) { 16831d7138deSEric Dumazet in_dev->mc_list = i->next_rcu; 1684b8bae41eSRami Rosen in_dev->mc_count--; 16851d7138deSEric Dumazet 168624cf3af3SVeaceslav Falico /* We've dropped the groups in ip_mc_down already */ 168724cf3af3SVeaceslav Falico ip_mc_clear_src(i); 16881da177e4SLinus Torvalds ip_ma_put(i); 16891da177e4SLinus Torvalds } 16901da177e4SLinus Torvalds } 16911da177e4SLinus Torvalds 16929e917dcaSEric Dumazet /* RTNL is locked */ 1693877acedcSDaniel Lezcano static struct in_device *ip_mc_find_dev(struct net *net, struct ip_mreqn *imr) 16941da177e4SLinus Torvalds { 16951da177e4SLinus Torvalds struct net_device *dev = NULL; 16961da177e4SLinus Torvalds struct in_device *idev = NULL; 16971da177e4SLinus Torvalds 16981da177e4SLinus Torvalds if (imr->imr_ifindex) { 1699877acedcSDaniel Lezcano idev = inetdev_by_index(net, imr->imr_ifindex); 17001da177e4SLinus Torvalds return idev; 17011da177e4SLinus Torvalds } 17021da177e4SLinus Torvalds if (imr->imr_address.s_addr) { 17039e917dcaSEric Dumazet dev = __ip_dev_find(net, imr->imr_address.s_addr, false); 17041da177e4SLinus Torvalds if (!dev) 17051da177e4SLinus Torvalds return NULL; 17061da177e4SLinus Torvalds } 17071da177e4SLinus Torvalds 1708b23dd4feSDavid S. Miller if (!dev) { 170978fbfd8aSDavid S. Miller struct rtable *rt = ip_route_output(net, 171078fbfd8aSDavid S. Miller imr->imr_multiaddr.s_addr, 171178fbfd8aSDavid S. Miller 0, 0, 0); 1712b23dd4feSDavid S. Miller if (!IS_ERR(rt)) { 1713d8d1f30bSChangli Gao dev = rt->dst.dev; 17141da177e4SLinus Torvalds ip_rt_put(rt); 17151da177e4SLinus Torvalds } 1716b23dd4feSDavid S. Miller } 17171da177e4SLinus Torvalds if (dev) { 17181da177e4SLinus Torvalds imr->imr_ifindex = dev->ifindex; 1719e5ed6399SHerbert Xu idev = __in_dev_get_rtnl(dev); 17201da177e4SLinus Torvalds } 17211da177e4SLinus Torvalds return idev; 17221da177e4SLinus Torvalds } 17231da177e4SLinus Torvalds 17241da177e4SLinus Torvalds /* 17251da177e4SLinus Torvalds * Join a socket to a group 17261da177e4SLinus Torvalds */ 1727a9fe8e29SHannes Frederic Sowa #ifdef CONFIG_IP_MULTICAST 1728436f7c20SFabian Frederick int sysctl_igmp_qrv __read_mostly = IGMP_QUERY_ROBUSTNESS_VARIABLE; 1729a9fe8e29SHannes Frederic Sowa #endif 17301da177e4SLinus Torvalds 17311da177e4SLinus Torvalds static int ip_mc_del1_src(struct ip_mc_list *pmc, int sfmode, 17328f935bbdSAl Viro __be32 *psfsrc) 17331da177e4SLinus Torvalds { 17341da177e4SLinus Torvalds struct ip_sf_list *psf, *psf_prev; 17351da177e4SLinus Torvalds int rv = 0; 17361da177e4SLinus Torvalds 17371da177e4SLinus Torvalds psf_prev = NULL; 17381da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) { 17391da177e4SLinus Torvalds if (psf->sf_inaddr == *psfsrc) 17401da177e4SLinus Torvalds break; 17411da177e4SLinus Torvalds psf_prev = psf; 17421da177e4SLinus Torvalds } 17431da177e4SLinus Torvalds if (!psf || psf->sf_count[sfmode] == 0) { 17441da177e4SLinus Torvalds /* source filter not found, or count wrong => bug */ 17451da177e4SLinus Torvalds return -ESRCH; 17461da177e4SLinus Torvalds } 17471da177e4SLinus Torvalds psf->sf_count[sfmode]--; 17481da177e4SLinus Torvalds if (psf->sf_count[sfmode] == 0) { 17491da177e4SLinus Torvalds ip_rt_multicast_event(pmc->interface); 17501da177e4SLinus Torvalds } 17511da177e4SLinus Torvalds if (!psf->sf_count[MCAST_INCLUDE] && !psf->sf_count[MCAST_EXCLUDE]) { 17521da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 17531da177e4SLinus Torvalds struct in_device *in_dev = pmc->interface; 17541da177e4SLinus Torvalds #endif 17551da177e4SLinus Torvalds 17561da177e4SLinus Torvalds /* no more filters for this source */ 17571da177e4SLinus Torvalds if (psf_prev) 17581da177e4SLinus Torvalds psf_prev->sf_next = psf->sf_next; 17591da177e4SLinus Torvalds else 17601da177e4SLinus Torvalds pmc->sources = psf->sf_next; 17611da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 17621da177e4SLinus Torvalds if (psf->sf_oldin && 17631da177e4SLinus Torvalds !IGMP_V1_SEEN(in_dev) && !IGMP_V2_SEEN(in_dev)) { 1764a9fe8e29SHannes Frederic Sowa psf->sf_crcount = in_dev->mr_qrv ?: sysctl_igmp_qrv; 17651da177e4SLinus Torvalds psf->sf_next = pmc->tomb; 17661da177e4SLinus Torvalds pmc->tomb = psf; 17671da177e4SLinus Torvalds rv = 1; 17681da177e4SLinus Torvalds } else 17691da177e4SLinus Torvalds #endif 17701da177e4SLinus Torvalds kfree(psf); 17711da177e4SLinus Torvalds } 17721da177e4SLinus Torvalds return rv; 17731da177e4SLinus Torvalds } 17741da177e4SLinus Torvalds 17751da177e4SLinus Torvalds #ifndef CONFIG_IP_MULTICAST 17761da177e4SLinus Torvalds #define igmp_ifc_event(x) do { } while (0) 17771da177e4SLinus Torvalds #endif 17781da177e4SLinus Torvalds 17798f935bbdSAl Viro static int ip_mc_del_src(struct in_device *in_dev, __be32 *pmca, int sfmode, 17808f935bbdSAl Viro int sfcount, __be32 *psfsrc, int delta) 17811da177e4SLinus Torvalds { 17821da177e4SLinus Torvalds struct ip_mc_list *pmc; 17831da177e4SLinus Torvalds int changerec = 0; 17841da177e4SLinus Torvalds int i, err; 17851da177e4SLinus Torvalds 17861da177e4SLinus Torvalds if (!in_dev) 17871da177e4SLinus Torvalds return -ENODEV; 17881d7138deSEric Dumazet rcu_read_lock(); 17891d7138deSEric Dumazet for_each_pmc_rcu(in_dev, pmc) { 17901da177e4SLinus Torvalds if (*pmca == pmc->multiaddr) 17911da177e4SLinus Torvalds break; 17921da177e4SLinus Torvalds } 17931da177e4SLinus Torvalds if (!pmc) { 17941da177e4SLinus Torvalds /* MCA not found?? bug */ 17951d7138deSEric Dumazet rcu_read_unlock(); 17961da177e4SLinus Torvalds return -ESRCH; 17971da177e4SLinus Torvalds } 17981da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 17991d7138deSEric Dumazet rcu_read_unlock(); 18001da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 18011da177e4SLinus Torvalds sf_markstate(pmc); 18021da177e4SLinus Torvalds #endif 18031da177e4SLinus Torvalds if (!delta) { 18041da177e4SLinus Torvalds err = -EINVAL; 18051da177e4SLinus Torvalds if (!pmc->sfcount[sfmode]) 18061da177e4SLinus Torvalds goto out_unlock; 18071da177e4SLinus Torvalds pmc->sfcount[sfmode]--; 18081da177e4SLinus Torvalds } 18091da177e4SLinus Torvalds err = 0; 18101da177e4SLinus Torvalds for (i = 0; i < sfcount; i++) { 18111da177e4SLinus Torvalds int rv = ip_mc_del1_src(pmc, sfmode, &psfsrc[i]); 18121da177e4SLinus Torvalds 18131da177e4SLinus Torvalds changerec |= rv > 0; 18141da177e4SLinus Torvalds if (!err && rv < 0) 18151da177e4SLinus Torvalds err = rv; 18161da177e4SLinus Torvalds } 18171da177e4SLinus Torvalds if (pmc->sfmode == MCAST_EXCLUDE && 18181da177e4SLinus Torvalds pmc->sfcount[MCAST_EXCLUDE] == 0 && 18191da177e4SLinus Torvalds pmc->sfcount[MCAST_INCLUDE]) { 18201da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 18211da177e4SLinus Torvalds struct ip_sf_list *psf; 18221da177e4SLinus Torvalds #endif 18231da177e4SLinus Torvalds 18241da177e4SLinus Torvalds /* filter mode change */ 18251da177e4SLinus Torvalds pmc->sfmode = MCAST_INCLUDE; 18261da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 1827a9fe8e29SHannes Frederic Sowa pmc->crcount = in_dev->mr_qrv ?: sysctl_igmp_qrv; 18281da177e4SLinus Torvalds in_dev->mr_ifc_count = pmc->crcount; 18291da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) 18301da177e4SLinus Torvalds psf->sf_crcount = 0; 18311da177e4SLinus Torvalds igmp_ifc_event(pmc->interface); 18321da177e4SLinus Torvalds } else if (sf_setstate(pmc) || changerec) { 18331da177e4SLinus Torvalds igmp_ifc_event(pmc->interface); 18341da177e4SLinus Torvalds #endif 18351da177e4SLinus Torvalds } 18361da177e4SLinus Torvalds out_unlock: 18371da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 18381da177e4SLinus Torvalds return err; 18391da177e4SLinus Torvalds } 18401da177e4SLinus Torvalds 18411da177e4SLinus Torvalds /* 18421da177e4SLinus Torvalds * Add multicast single-source filter to the interface list 18431da177e4SLinus Torvalds */ 18441da177e4SLinus Torvalds static int ip_mc_add1_src(struct ip_mc_list *pmc, int sfmode, 18455eb81e89SJun Zhao __be32 *psfsrc) 18461da177e4SLinus Torvalds { 18471da177e4SLinus Torvalds struct ip_sf_list *psf, *psf_prev; 18481da177e4SLinus Torvalds 18491da177e4SLinus Torvalds psf_prev = NULL; 18501da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) { 18511da177e4SLinus Torvalds if (psf->sf_inaddr == *psfsrc) 18521da177e4SLinus Torvalds break; 18531da177e4SLinus Torvalds psf_prev = psf; 18541da177e4SLinus Torvalds } 18551da177e4SLinus Torvalds if (!psf) { 18560da974f4SPanagiotis Issaris psf = kzalloc(sizeof(*psf), GFP_ATOMIC); 18571da177e4SLinus Torvalds if (!psf) 18581da177e4SLinus Torvalds return -ENOBUFS; 18591da177e4SLinus Torvalds psf->sf_inaddr = *psfsrc; 18601da177e4SLinus Torvalds if (psf_prev) { 18611da177e4SLinus Torvalds psf_prev->sf_next = psf; 18621da177e4SLinus Torvalds } else 18631da177e4SLinus Torvalds pmc->sources = psf; 18641da177e4SLinus Torvalds } 18651da177e4SLinus Torvalds psf->sf_count[sfmode]++; 18661da177e4SLinus Torvalds if (psf->sf_count[sfmode] == 1) { 18671da177e4SLinus Torvalds ip_rt_multicast_event(pmc->interface); 18681da177e4SLinus Torvalds } 18691da177e4SLinus Torvalds return 0; 18701da177e4SLinus Torvalds } 18711da177e4SLinus Torvalds 18721da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 18731da177e4SLinus Torvalds static void sf_markstate(struct ip_mc_list *pmc) 18741da177e4SLinus Torvalds { 18751da177e4SLinus Torvalds struct ip_sf_list *psf; 18761da177e4SLinus Torvalds int mca_xcount = pmc->sfcount[MCAST_EXCLUDE]; 18771da177e4SLinus Torvalds 18781da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) 18791da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) { 18801da177e4SLinus Torvalds psf->sf_oldin = mca_xcount == 18811da177e4SLinus Torvalds psf->sf_count[MCAST_EXCLUDE] && 18821da177e4SLinus Torvalds !psf->sf_count[MCAST_INCLUDE]; 18831da177e4SLinus Torvalds } else 18841da177e4SLinus Torvalds psf->sf_oldin = psf->sf_count[MCAST_INCLUDE] != 0; 18851da177e4SLinus Torvalds } 18861da177e4SLinus Torvalds 18871da177e4SLinus Torvalds static int sf_setstate(struct ip_mc_list *pmc) 18881da177e4SLinus Torvalds { 1889ad12583fSDavid L Stevens struct ip_sf_list *psf, *dpsf; 18901da177e4SLinus Torvalds int mca_xcount = pmc->sfcount[MCAST_EXCLUDE]; 18911da177e4SLinus Torvalds int qrv = pmc->interface->mr_qrv; 18921da177e4SLinus Torvalds int new_in, rv; 18931da177e4SLinus Torvalds 18941da177e4SLinus Torvalds rv = 0; 18951da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) { 18961da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) { 18971da177e4SLinus Torvalds new_in = mca_xcount == psf->sf_count[MCAST_EXCLUDE] && 18981da177e4SLinus Torvalds !psf->sf_count[MCAST_INCLUDE]; 18991da177e4SLinus Torvalds } else 19001da177e4SLinus Torvalds new_in = psf->sf_count[MCAST_INCLUDE] != 0; 1901ad12583fSDavid L Stevens if (new_in) { 1902ad12583fSDavid L Stevens if (!psf->sf_oldin) { 190376edc605SAl Viro struct ip_sf_list *prev = NULL; 1904ad12583fSDavid L Stevens 1905ad12583fSDavid L Stevens for (dpsf = pmc->tomb; dpsf; dpsf = dpsf->sf_next) { 1906ad12583fSDavid L Stevens if (dpsf->sf_inaddr == psf->sf_inaddr) 1907ad12583fSDavid L Stevens break; 1908ad12583fSDavid L Stevens prev = dpsf; 1909ad12583fSDavid L Stevens } 1910ad12583fSDavid L Stevens if (dpsf) { 1911ad12583fSDavid L Stevens if (prev) 1912ad12583fSDavid L Stevens prev->sf_next = dpsf->sf_next; 1913ad12583fSDavid L Stevens else 1914ad12583fSDavid L Stevens pmc->tomb = dpsf->sf_next; 1915ad12583fSDavid L Stevens kfree(dpsf); 1916ad12583fSDavid L Stevens } 19171da177e4SLinus Torvalds psf->sf_crcount = qrv; 19181da177e4SLinus Torvalds rv++; 19191da177e4SLinus Torvalds } 1920ad12583fSDavid L Stevens } else if (psf->sf_oldin) { 1921ad12583fSDavid L Stevens 1922ad12583fSDavid L Stevens psf->sf_crcount = 0; 1923ad12583fSDavid L Stevens /* 1924ad12583fSDavid L Stevens * add or update "delete" records if an active filter 1925ad12583fSDavid L Stevens * is now inactive 1926ad12583fSDavid L Stevens */ 1927ad12583fSDavid L Stevens for (dpsf = pmc->tomb; dpsf; dpsf = dpsf->sf_next) 1928ad12583fSDavid L Stevens if (dpsf->sf_inaddr == psf->sf_inaddr) 1929ad12583fSDavid L Stevens break; 1930ad12583fSDavid L Stevens if (!dpsf) { 19313ed37a6fSJoe Perches dpsf = kmalloc(sizeof(*dpsf), GFP_ATOMIC); 1932ad12583fSDavid L Stevens if (!dpsf) 1933ad12583fSDavid L Stevens continue; 1934ad12583fSDavid L Stevens *dpsf = *psf; 1935ad12583fSDavid L Stevens /* pmc->lock held by callers */ 1936ad12583fSDavid L Stevens dpsf->sf_next = pmc->tomb; 1937ad12583fSDavid L Stevens pmc->tomb = dpsf; 1938ad12583fSDavid L Stevens } 1939ad12583fSDavid L Stevens dpsf->sf_crcount = qrv; 1940ad12583fSDavid L Stevens rv++; 1941ad12583fSDavid L Stevens } 19421da177e4SLinus Torvalds } 19431da177e4SLinus Torvalds return rv; 19441da177e4SLinus Torvalds } 19451da177e4SLinus Torvalds #endif 19461da177e4SLinus Torvalds 19471da177e4SLinus Torvalds /* 19481da177e4SLinus Torvalds * Add multicast source filter list to the interface list 19491da177e4SLinus Torvalds */ 19508f935bbdSAl Viro static int ip_mc_add_src(struct in_device *in_dev, __be32 *pmca, int sfmode, 19518f935bbdSAl Viro int sfcount, __be32 *psfsrc, int delta) 19521da177e4SLinus Torvalds { 19531da177e4SLinus Torvalds struct ip_mc_list *pmc; 19541da177e4SLinus Torvalds int isexclude; 19551da177e4SLinus Torvalds int i, err; 19561da177e4SLinus Torvalds 19571da177e4SLinus Torvalds if (!in_dev) 19581da177e4SLinus Torvalds return -ENODEV; 19591d7138deSEric Dumazet rcu_read_lock(); 19601d7138deSEric Dumazet for_each_pmc_rcu(in_dev, pmc) { 19611da177e4SLinus Torvalds if (*pmca == pmc->multiaddr) 19621da177e4SLinus Torvalds break; 19631da177e4SLinus Torvalds } 19641da177e4SLinus Torvalds if (!pmc) { 19651da177e4SLinus Torvalds /* MCA not found?? bug */ 19661d7138deSEric Dumazet rcu_read_unlock(); 19671da177e4SLinus Torvalds return -ESRCH; 19681da177e4SLinus Torvalds } 19691da177e4SLinus Torvalds spin_lock_bh(&pmc->lock); 19701d7138deSEric Dumazet rcu_read_unlock(); 19711da177e4SLinus Torvalds 19721da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 19731da177e4SLinus Torvalds sf_markstate(pmc); 19741da177e4SLinus Torvalds #endif 19751da177e4SLinus Torvalds isexclude = pmc->sfmode == MCAST_EXCLUDE; 19761da177e4SLinus Torvalds if (!delta) 19771da177e4SLinus Torvalds pmc->sfcount[sfmode]++; 19781da177e4SLinus Torvalds err = 0; 19791da177e4SLinus Torvalds for (i = 0; i < sfcount; i++) { 19805eb81e89SJun Zhao err = ip_mc_add1_src(pmc, sfmode, &psfsrc[i]); 19811da177e4SLinus Torvalds if (err) 19821da177e4SLinus Torvalds break; 19831da177e4SLinus Torvalds } 19841da177e4SLinus Torvalds if (err) { 19851da177e4SLinus Torvalds int j; 19861da177e4SLinus Torvalds 1987685f94e6SJun Zhao if (!delta) 19881da177e4SLinus Torvalds pmc->sfcount[sfmode]--; 19891da177e4SLinus Torvalds for (j = 0; j < i; j++) 1990a1889c0dSJulia Lawall (void) ip_mc_del1_src(pmc, sfmode, &psfsrc[j]); 19911da177e4SLinus Torvalds } else if (isexclude != (pmc->sfcount[MCAST_EXCLUDE] != 0)) { 19921da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 19931da177e4SLinus Torvalds struct ip_sf_list *psf; 1994cfcabdccSStephen Hemminger in_dev = pmc->interface; 19951da177e4SLinus Torvalds #endif 19961da177e4SLinus Torvalds 19971da177e4SLinus Torvalds /* filter mode change */ 19981da177e4SLinus Torvalds if (pmc->sfcount[MCAST_EXCLUDE]) 19991da177e4SLinus Torvalds pmc->sfmode = MCAST_EXCLUDE; 20001da177e4SLinus Torvalds else if (pmc->sfcount[MCAST_INCLUDE]) 20011da177e4SLinus Torvalds pmc->sfmode = MCAST_INCLUDE; 20021da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 20031da177e4SLinus Torvalds /* else no filters; keep old mode for reports */ 20041da177e4SLinus Torvalds 2005a9fe8e29SHannes Frederic Sowa pmc->crcount = in_dev->mr_qrv ?: sysctl_igmp_qrv; 20061da177e4SLinus Torvalds in_dev->mr_ifc_count = pmc->crcount; 20071da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = psf->sf_next) 20081da177e4SLinus Torvalds psf->sf_crcount = 0; 20091da177e4SLinus Torvalds igmp_ifc_event(in_dev); 20101da177e4SLinus Torvalds } else if (sf_setstate(pmc)) { 20111da177e4SLinus Torvalds igmp_ifc_event(in_dev); 20121da177e4SLinus Torvalds #endif 20131da177e4SLinus Torvalds } 20141da177e4SLinus Torvalds spin_unlock_bh(&pmc->lock); 20151da177e4SLinus Torvalds return err; 20161da177e4SLinus Torvalds } 20171da177e4SLinus Torvalds 20181da177e4SLinus Torvalds static void ip_mc_clear_src(struct ip_mc_list *pmc) 20191da177e4SLinus Torvalds { 20201da177e4SLinus Torvalds struct ip_sf_list *psf, *nextpsf; 20211da177e4SLinus Torvalds 20221da177e4SLinus Torvalds for (psf = pmc->tomb; psf; psf = nextpsf) { 20231da177e4SLinus Torvalds nextpsf = psf->sf_next; 20241da177e4SLinus Torvalds kfree(psf); 20251da177e4SLinus Torvalds } 20261da177e4SLinus Torvalds pmc->tomb = NULL; 20271da177e4SLinus Torvalds for (psf = pmc->sources; psf; psf = nextpsf) { 20281da177e4SLinus Torvalds nextpsf = psf->sf_next; 20291da177e4SLinus Torvalds kfree(psf); 20301da177e4SLinus Torvalds } 20311da177e4SLinus Torvalds pmc->sources = NULL; 20321da177e4SLinus Torvalds pmc->sfmode = MCAST_EXCLUDE; 2033de9daad9SDenis Lukianov pmc->sfcount[MCAST_INCLUDE] = 0; 20341da177e4SLinus Torvalds pmc->sfcount[MCAST_EXCLUDE] = 1; 20351da177e4SLinus Torvalds } 20361da177e4SLinus Torvalds 203754ff9ef3SMarcelo Ricardo Leitner /* Join a multicast group 203854ff9ef3SMarcelo Ricardo Leitner */ 203954ff9ef3SMarcelo Ricardo Leitner 204054ff9ef3SMarcelo Ricardo Leitner int ip_mc_join_group(struct sock *sk, struct ip_mreqn *imr) 20411da177e4SLinus Torvalds { 20428f935bbdSAl Viro __be32 addr = imr->imr_multiaddr.s_addr; 2043959d10f6SEric Dumazet struct ip_mc_socklist *iml, *i; 20441da177e4SLinus Torvalds struct in_device *in_dev; 20451da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 2046877acedcSDaniel Lezcano struct net *net = sock_net(sk); 2047ca9b907dSDavid L Stevens int ifindex; 20481da177e4SLinus Torvalds int count = 0; 2049959d10f6SEric Dumazet int err; 2050959d10f6SEric Dumazet 2051959d10f6SEric Dumazet ASSERT_RTNL(); 20521da177e4SLinus Torvalds 2053f97c1e0cSJoe Perches if (!ipv4_is_multicast(addr)) 20541da177e4SLinus Torvalds return -EINVAL; 20551da177e4SLinus Torvalds 2056877acedcSDaniel Lezcano in_dev = ip_mc_find_dev(net, imr); 20571da177e4SLinus Torvalds 20581da177e4SLinus Torvalds if (!in_dev) { 20591da177e4SLinus Torvalds err = -ENODEV; 20601da177e4SLinus Torvalds goto done; 20611da177e4SLinus Torvalds } 20621da177e4SLinus Torvalds 20631da177e4SLinus Torvalds err = -EADDRINUSE; 2064ca9b907dSDavid L Stevens ifindex = imr->imr_ifindex; 20651d7138deSEric Dumazet for_each_pmc_rtnl(inet, i) { 2066ca9b907dSDavid L Stevens if (i->multi.imr_multiaddr.s_addr == addr && 2067ca9b907dSDavid L Stevens i->multi.imr_ifindex == ifindex) 20681da177e4SLinus Torvalds goto done; 20691da177e4SLinus Torvalds count++; 20701da177e4SLinus Torvalds } 20711da177e4SLinus Torvalds err = -ENOBUFS; 2072815c5270SNikolay Borisov if (count >= net->ipv4.sysctl_igmp_max_memberships) 20731da177e4SLinus Torvalds goto done; 20748b3a7005SKris Katterjohn iml = sock_kmalloc(sk, sizeof(*iml), GFP_KERNEL); 207551456b29SIan Morris if (!iml) 2076ca9b907dSDavid L Stevens goto done; 2077ca9b907dSDavid L Stevens 20781da177e4SLinus Torvalds memcpy(&iml->multi, imr, sizeof(*imr)); 20791d7138deSEric Dumazet iml->next_rcu = inet->mc_list; 20801da177e4SLinus Torvalds iml->sflist = NULL; 20811da177e4SLinus Torvalds iml->sfmode = MCAST_EXCLUDE; 2082cf778b00SEric Dumazet rcu_assign_pointer(inet->mc_list, iml); 20831da177e4SLinus Torvalds ip_mc_inc_group(in_dev, addr); 20841da177e4SLinus Torvalds err = 0; 20851da177e4SLinus Torvalds done: 20861da177e4SLinus Torvalds return err; 20871da177e4SLinus Torvalds } 20884bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_mc_join_group); 20891da177e4SLinus Torvalds 20901da177e4SLinus Torvalds static int ip_mc_leave_src(struct sock *sk, struct ip_mc_socklist *iml, 20911da177e4SLinus Torvalds struct in_device *in_dev) 20921da177e4SLinus Torvalds { 20931d7138deSEric Dumazet struct ip_sf_socklist *psf = rtnl_dereference(iml->sflist); 20941da177e4SLinus Torvalds int err; 20951da177e4SLinus Torvalds 209651456b29SIan Morris if (!psf) { 20971da177e4SLinus Torvalds /* any-source empty exclude case */ 20981da177e4SLinus Torvalds return ip_mc_del_src(in_dev, &iml->multi.imr_multiaddr.s_addr, 20991da177e4SLinus Torvalds iml->sfmode, 0, NULL, 0); 21001da177e4SLinus Torvalds } 21011da177e4SLinus Torvalds err = ip_mc_del_src(in_dev, &iml->multi.imr_multiaddr.s_addr, 2102c85bb41eSFlavio Leitner iml->sfmode, psf->sl_count, psf->sl_addr, 0); 2103a9b3cd7fSStephen Hemminger RCU_INIT_POINTER(iml->sflist, NULL); 2104c85bb41eSFlavio Leitner /* decrease mem now to avoid the memleak warning */ 2105c85bb41eSFlavio Leitner atomic_sub(IP_SFLSIZE(psf->sl_max), &sk->sk_omem_alloc); 21067519cce4SLai Jiangshan kfree_rcu(psf, rcu); 21071da177e4SLinus Torvalds return err; 21081da177e4SLinus Torvalds } 21091da177e4SLinus Torvalds 211054ff9ef3SMarcelo Ricardo Leitner int ip_mc_leave_group(struct sock *sk, struct ip_mreqn *imr) 21111da177e4SLinus Torvalds { 21121da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 21131d7138deSEric Dumazet struct ip_mc_socklist *iml; 21141d7138deSEric Dumazet struct ip_mc_socklist __rcu **imlp; 211584b42baeSDavid L Stevens struct in_device *in_dev; 2116877acedcSDaniel Lezcano struct net *net = sock_net(sk); 21178f935bbdSAl Viro __be32 group = imr->imr_multiaddr.s_addr; 211884b42baeSDavid L Stevens u32 ifindex; 2119acd6e00bSDavid L Stevens int ret = -EADDRNOTAVAIL; 21201da177e4SLinus Torvalds 2121959d10f6SEric Dumazet ASSERT_RTNL(); 2122959d10f6SEric Dumazet 2123877acedcSDaniel Lezcano in_dev = ip_mc_find_dev(net, imr); 21244eba7bb1SAndrew Lunn if (!imr->imr_ifindex && !imr->imr_address.s_addr && !in_dev) { 212552ad353aSdingtianhong ret = -ENODEV; 212652ad353aSdingtianhong goto out; 212752ad353aSdingtianhong } 212884b42baeSDavid L Stevens ifindex = imr->imr_ifindex; 21291d7138deSEric Dumazet for (imlp = &inet->mc_list; 21301d7138deSEric Dumazet (iml = rtnl_dereference(*imlp)) != NULL; 21311d7138deSEric Dumazet imlp = &iml->next_rcu) { 2132acd6e00bSDavid L Stevens if (iml->multi.imr_multiaddr.s_addr != group) 2133acd6e00bSDavid L Stevens continue; 2134acd6e00bSDavid L Stevens if (ifindex) { 2135acd6e00bSDavid L Stevens if (iml->multi.imr_ifindex != ifindex) 2136acd6e00bSDavid L Stevens continue; 2137acd6e00bSDavid L Stevens } else if (imr->imr_address.s_addr && imr->imr_address.s_addr != 2138acd6e00bSDavid L Stevens iml->multi.imr_address.s_addr) 2139acd6e00bSDavid L Stevens continue; 2140acd6e00bSDavid L Stevens 21411da177e4SLinus Torvalds (void) ip_mc_leave_src(sk, iml, in_dev); 21421da177e4SLinus Torvalds 21431d7138deSEric Dumazet *imlp = iml->next_rcu; 21441da177e4SLinus Torvalds 21454eba7bb1SAndrew Lunn if (in_dev) 214684b42baeSDavid L Stevens ip_mc_dec_group(in_dev, group); 2147959d10f6SEric Dumazet 2148c85bb41eSFlavio Leitner /* decrease mem now to avoid the memleak warning */ 2149c85bb41eSFlavio Leitner atomic_sub(sizeof(*iml), &sk->sk_omem_alloc); 215010d50e74SLai Jiangshan kfree_rcu(iml, rcu); 21511da177e4SLinus Torvalds return 0; 21521da177e4SLinus Torvalds } 215352ad353aSdingtianhong out: 2154959d10f6SEric Dumazet return ret; 2155959d10f6SEric Dumazet } 2156193ba924Sstephen hemminger EXPORT_SYMBOL(ip_mc_leave_group); 21571da177e4SLinus Torvalds 21581da177e4SLinus Torvalds int ip_mc_source(int add, int omode, struct sock *sk, struct 21591da177e4SLinus Torvalds ip_mreq_source *mreqs, int ifindex) 21601da177e4SLinus Torvalds { 21611da177e4SLinus Torvalds int err; 21621da177e4SLinus Torvalds struct ip_mreqn imr; 216363007727SAl Viro __be32 addr = mreqs->imr_multiaddr; 21641da177e4SLinus Torvalds struct ip_mc_socklist *pmc; 21651da177e4SLinus Torvalds struct in_device *in_dev = NULL; 21661da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 21671da177e4SLinus Torvalds struct ip_sf_socklist *psl; 2168877acedcSDaniel Lezcano struct net *net = sock_net(sk); 21698cdaaa15SDavid L Stevens int leavegroup = 0; 21701da177e4SLinus Torvalds int i, j, rv; 21711da177e4SLinus Torvalds 2172f97c1e0cSJoe Perches if (!ipv4_is_multicast(addr)) 21731da177e4SLinus Torvalds return -EINVAL; 21741da177e4SLinus Torvalds 217554ff9ef3SMarcelo Ricardo Leitner ASSERT_RTNL(); 21761da177e4SLinus Torvalds 21771da177e4SLinus Torvalds imr.imr_multiaddr.s_addr = mreqs->imr_multiaddr; 21781da177e4SLinus Torvalds imr.imr_address.s_addr = mreqs->imr_interface; 21791da177e4SLinus Torvalds imr.imr_ifindex = ifindex; 2180877acedcSDaniel Lezcano in_dev = ip_mc_find_dev(net, &imr); 21811da177e4SLinus Torvalds 21821da177e4SLinus Torvalds if (!in_dev) { 21831da177e4SLinus Torvalds err = -ENODEV; 21841da177e4SLinus Torvalds goto done; 21851da177e4SLinus Torvalds } 21861da177e4SLinus Torvalds err = -EADDRNOTAVAIL; 21871da177e4SLinus Torvalds 21881d7138deSEric Dumazet for_each_pmc_rtnl(inet, pmc) { 2189f64f9e71SJoe Perches if ((pmc->multi.imr_multiaddr.s_addr == 2190f64f9e71SJoe Perches imr.imr_multiaddr.s_addr) && 2191f64f9e71SJoe Perches (pmc->multi.imr_ifindex == imr.imr_ifindex)) 21921da177e4SLinus Torvalds break; 21931da177e4SLinus Torvalds } 2194917f2f10SDavid L Stevens if (!pmc) { /* must have a prior join */ 2195917f2f10SDavid L Stevens err = -EINVAL; 21961da177e4SLinus Torvalds goto done; 2197917f2f10SDavid L Stevens } 21981da177e4SLinus Torvalds /* if a source filter was set, must be the same mode as before */ 21991da177e4SLinus Torvalds if (pmc->sflist) { 2200917f2f10SDavid L Stevens if (pmc->sfmode != omode) { 2201917f2f10SDavid L Stevens err = -EINVAL; 22021da177e4SLinus Torvalds goto done; 2203917f2f10SDavid L Stevens } 22041da177e4SLinus Torvalds } else if (pmc->sfmode != omode) { 22051da177e4SLinus Torvalds /* allow mode switches for empty-set filters */ 22061da177e4SLinus Torvalds ip_mc_add_src(in_dev, &mreqs->imr_multiaddr, omode, 0, NULL, 0); 22071da177e4SLinus Torvalds ip_mc_del_src(in_dev, &mreqs->imr_multiaddr, pmc->sfmode, 0, 22081da177e4SLinus Torvalds NULL, 0); 22091da177e4SLinus Torvalds pmc->sfmode = omode; 22101da177e4SLinus Torvalds } 22111da177e4SLinus Torvalds 22121d7138deSEric Dumazet psl = rtnl_dereference(pmc->sflist); 22131da177e4SLinus Torvalds if (!add) { 22141da177e4SLinus Torvalds if (!psl) 2215917f2f10SDavid L Stevens goto done; /* err = -EADDRNOTAVAIL */ 22161da177e4SLinus Torvalds rv = !0; 22171da177e4SLinus Torvalds for (i = 0; i < psl->sl_count; i++) { 22181da177e4SLinus Torvalds rv = memcmp(&psl->sl_addr[i], &mreqs->imr_sourceaddr, 221963007727SAl Viro sizeof(__be32)); 22201da177e4SLinus Torvalds if (rv == 0) 22211da177e4SLinus Torvalds break; 22221da177e4SLinus Torvalds } 22231da177e4SLinus Torvalds if (rv) /* source not found */ 2224917f2f10SDavid L Stevens goto done; /* err = -EADDRNOTAVAIL */ 22251da177e4SLinus Torvalds 22268cdaaa15SDavid L Stevens /* special case - (INCLUDE, empty) == LEAVE_GROUP */ 22278cdaaa15SDavid L Stevens if (psl->sl_count == 1 && omode == MCAST_INCLUDE) { 22288cdaaa15SDavid L Stevens leavegroup = 1; 22298cdaaa15SDavid L Stevens goto done; 22308cdaaa15SDavid L Stevens } 22318cdaaa15SDavid L Stevens 22321da177e4SLinus Torvalds /* update the interface filter */ 22331da177e4SLinus Torvalds ip_mc_del_src(in_dev, &mreqs->imr_multiaddr, omode, 1, 22341da177e4SLinus Torvalds &mreqs->imr_sourceaddr, 1); 22351da177e4SLinus Torvalds 22361da177e4SLinus Torvalds for (j = i+1; j < psl->sl_count; j++) 22371da177e4SLinus Torvalds psl->sl_addr[j-1] = psl->sl_addr[j]; 22381da177e4SLinus Torvalds psl->sl_count--; 22391da177e4SLinus Torvalds err = 0; 22401da177e4SLinus Torvalds goto done; 22411da177e4SLinus Torvalds } 22421da177e4SLinus Torvalds /* else, add a new source to the filter */ 22431da177e4SLinus Torvalds 2244*166b6b2dSNikolay Borisov if (psl && psl->sl_count >= net->ipv4.sysctl_igmp_max_msf) { 22451da177e4SLinus Torvalds err = -ENOBUFS; 22461da177e4SLinus Torvalds goto done; 22471da177e4SLinus Torvalds } 22481da177e4SLinus Torvalds if (!psl || psl->sl_count == psl->sl_max) { 22491da177e4SLinus Torvalds struct ip_sf_socklist *newpsl; 22501da177e4SLinus Torvalds int count = IP_SFBLOCK; 22511da177e4SLinus Torvalds 22521da177e4SLinus Torvalds if (psl) 22531da177e4SLinus Torvalds count += psl->sl_max; 22548b3a7005SKris Katterjohn newpsl = sock_kmalloc(sk, IP_SFLSIZE(count), GFP_KERNEL); 22551da177e4SLinus Torvalds if (!newpsl) { 22561da177e4SLinus Torvalds err = -ENOBUFS; 22571da177e4SLinus Torvalds goto done; 22581da177e4SLinus Torvalds } 22591da177e4SLinus Torvalds newpsl->sl_max = count; 22601da177e4SLinus Torvalds newpsl->sl_count = count - IP_SFBLOCK; 22611da177e4SLinus Torvalds if (psl) { 22621da177e4SLinus Torvalds for (i = 0; i < psl->sl_count; i++) 22631da177e4SLinus Torvalds newpsl->sl_addr[i] = psl->sl_addr[i]; 2264c85bb41eSFlavio Leitner /* decrease mem now to avoid the memleak warning */ 2265c85bb41eSFlavio Leitner atomic_sub(IP_SFLSIZE(psl->sl_max), &sk->sk_omem_alloc); 22667519cce4SLai Jiangshan kfree_rcu(psl, rcu); 22671da177e4SLinus Torvalds } 2268cf778b00SEric Dumazet rcu_assign_pointer(pmc->sflist, newpsl); 2269c85bb41eSFlavio Leitner psl = newpsl; 22701da177e4SLinus Torvalds } 22711da177e4SLinus Torvalds rv = 1; /* > 0 for insert logic below if sl_count is 0 */ 22721da177e4SLinus Torvalds for (i = 0; i < psl->sl_count; i++) { 22731da177e4SLinus Torvalds rv = memcmp(&psl->sl_addr[i], &mreqs->imr_sourceaddr, 227463007727SAl Viro sizeof(__be32)); 22751da177e4SLinus Torvalds if (rv == 0) 22761da177e4SLinus Torvalds break; 22771da177e4SLinus Torvalds } 22781da177e4SLinus Torvalds if (rv == 0) /* address already there is an error */ 22791da177e4SLinus Torvalds goto done; 22801da177e4SLinus Torvalds for (j = psl->sl_count-1; j >= i; j--) 22811da177e4SLinus Torvalds psl->sl_addr[j+1] = psl->sl_addr[j]; 22821da177e4SLinus Torvalds psl->sl_addr[i] = mreqs->imr_sourceaddr; 22831da177e4SLinus Torvalds psl->sl_count++; 22841da177e4SLinus Torvalds err = 0; 22851da177e4SLinus Torvalds /* update the interface list */ 22861da177e4SLinus Torvalds ip_mc_add_src(in_dev, &mreqs->imr_multiaddr, omode, 1, 22871da177e4SLinus Torvalds &mreqs->imr_sourceaddr, 1); 22881da177e4SLinus Torvalds done: 22898cdaaa15SDavid L Stevens if (leavegroup) 229054ff9ef3SMarcelo Ricardo Leitner err = ip_mc_leave_group(sk, &imr); 22911da177e4SLinus Torvalds return err; 22921da177e4SLinus Torvalds } 22931da177e4SLinus Torvalds 22941da177e4SLinus Torvalds int ip_mc_msfilter(struct sock *sk, struct ip_msfilter *msf, int ifindex) 22951da177e4SLinus Torvalds { 22969951f036SDavid L Stevens int err = 0; 22971da177e4SLinus Torvalds struct ip_mreqn imr; 229863007727SAl Viro __be32 addr = msf->imsf_multiaddr; 22991da177e4SLinus Torvalds struct ip_mc_socklist *pmc; 23001da177e4SLinus Torvalds struct in_device *in_dev; 23011da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 23021da177e4SLinus Torvalds struct ip_sf_socklist *newpsl, *psl; 2303877acedcSDaniel Lezcano struct net *net = sock_net(sk); 23049951f036SDavid L Stevens int leavegroup = 0; 23051da177e4SLinus Torvalds 2306f97c1e0cSJoe Perches if (!ipv4_is_multicast(addr)) 23071da177e4SLinus Torvalds return -EINVAL; 23081da177e4SLinus Torvalds if (msf->imsf_fmode != MCAST_INCLUDE && 23091da177e4SLinus Torvalds msf->imsf_fmode != MCAST_EXCLUDE) 23101da177e4SLinus Torvalds return -EINVAL; 23111da177e4SLinus Torvalds 231254ff9ef3SMarcelo Ricardo Leitner ASSERT_RTNL(); 23131da177e4SLinus Torvalds 23141da177e4SLinus Torvalds imr.imr_multiaddr.s_addr = msf->imsf_multiaddr; 23151da177e4SLinus Torvalds imr.imr_address.s_addr = msf->imsf_interface; 23161da177e4SLinus Torvalds imr.imr_ifindex = ifindex; 2317877acedcSDaniel Lezcano in_dev = ip_mc_find_dev(net, &imr); 23181da177e4SLinus Torvalds 23191da177e4SLinus Torvalds if (!in_dev) { 23201da177e4SLinus Torvalds err = -ENODEV; 23211da177e4SLinus Torvalds goto done; 23221da177e4SLinus Torvalds } 23231da177e4SLinus Torvalds 23249951f036SDavid L Stevens /* special case - (INCLUDE, empty) == LEAVE_GROUP */ 23259951f036SDavid L Stevens if (msf->imsf_fmode == MCAST_INCLUDE && msf->imsf_numsrc == 0) { 23269951f036SDavid L Stevens leavegroup = 1; 23279951f036SDavid L Stevens goto done; 23289951f036SDavid L Stevens } 23299951f036SDavid L Stevens 23301d7138deSEric Dumazet for_each_pmc_rtnl(inet, pmc) { 23311da177e4SLinus Torvalds if (pmc->multi.imr_multiaddr.s_addr == msf->imsf_multiaddr && 23321da177e4SLinus Torvalds pmc->multi.imr_ifindex == imr.imr_ifindex) 23331da177e4SLinus Torvalds break; 23341da177e4SLinus Torvalds } 2335917f2f10SDavid L Stevens if (!pmc) { /* must have a prior join */ 2336917f2f10SDavid L Stevens err = -EINVAL; 23371da177e4SLinus Torvalds goto done; 2338917f2f10SDavid L Stevens } 23391da177e4SLinus Torvalds if (msf->imsf_numsrc) { 23408b3a7005SKris Katterjohn newpsl = sock_kmalloc(sk, IP_SFLSIZE(msf->imsf_numsrc), 23418b3a7005SKris Katterjohn GFP_KERNEL); 23421da177e4SLinus Torvalds if (!newpsl) { 23431da177e4SLinus Torvalds err = -ENOBUFS; 23441da177e4SLinus Torvalds goto done; 23451da177e4SLinus Torvalds } 23461da177e4SLinus Torvalds newpsl->sl_max = newpsl->sl_count = msf->imsf_numsrc; 23471da177e4SLinus Torvalds memcpy(newpsl->sl_addr, msf->imsf_slist, 23481da177e4SLinus Torvalds msf->imsf_numsrc * sizeof(msf->imsf_slist[0])); 23491da177e4SLinus Torvalds err = ip_mc_add_src(in_dev, &msf->imsf_multiaddr, 23501da177e4SLinus Torvalds msf->imsf_fmode, newpsl->sl_count, newpsl->sl_addr, 0); 23511da177e4SLinus Torvalds if (err) { 23521da177e4SLinus Torvalds sock_kfree_s(sk, newpsl, IP_SFLSIZE(newpsl->sl_max)); 23531da177e4SLinus Torvalds goto done; 23541da177e4SLinus Torvalds } 23558713dbf0SYan Zheng } else { 23561da177e4SLinus Torvalds newpsl = NULL; 23578713dbf0SYan Zheng (void) ip_mc_add_src(in_dev, &msf->imsf_multiaddr, 23588713dbf0SYan Zheng msf->imsf_fmode, 0, NULL, 0); 23598713dbf0SYan Zheng } 23601d7138deSEric Dumazet psl = rtnl_dereference(pmc->sflist); 23611da177e4SLinus Torvalds if (psl) { 23621da177e4SLinus Torvalds (void) ip_mc_del_src(in_dev, &msf->imsf_multiaddr, pmc->sfmode, 23631da177e4SLinus Torvalds psl->sl_count, psl->sl_addr, 0); 2364c85bb41eSFlavio Leitner /* decrease mem now to avoid the memleak warning */ 2365c85bb41eSFlavio Leitner atomic_sub(IP_SFLSIZE(psl->sl_max), &sk->sk_omem_alloc); 23667519cce4SLai Jiangshan kfree_rcu(psl, rcu); 23671da177e4SLinus Torvalds } else 23681da177e4SLinus Torvalds (void) ip_mc_del_src(in_dev, &msf->imsf_multiaddr, pmc->sfmode, 23691da177e4SLinus Torvalds 0, NULL, 0); 2370cf778b00SEric Dumazet rcu_assign_pointer(pmc->sflist, newpsl); 23711da177e4SLinus Torvalds pmc->sfmode = msf->imsf_fmode; 2372917f2f10SDavid L Stevens err = 0; 23731da177e4SLinus Torvalds done: 23749951f036SDavid L Stevens if (leavegroup) 23759951f036SDavid L Stevens err = ip_mc_leave_group(sk, &imr); 23761da177e4SLinus Torvalds return err; 23771da177e4SLinus Torvalds } 23781da177e4SLinus Torvalds 23791da177e4SLinus Torvalds int ip_mc_msfget(struct sock *sk, struct ip_msfilter *msf, 23801da177e4SLinus Torvalds struct ip_msfilter __user *optval, int __user *optlen) 23811da177e4SLinus Torvalds { 23821da177e4SLinus Torvalds int err, len, count, copycount; 23831da177e4SLinus Torvalds struct ip_mreqn imr; 238463007727SAl Viro __be32 addr = msf->imsf_multiaddr; 23851da177e4SLinus Torvalds struct ip_mc_socklist *pmc; 23861da177e4SLinus Torvalds struct in_device *in_dev; 23871da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 23881da177e4SLinus Torvalds struct ip_sf_socklist *psl; 2389877acedcSDaniel Lezcano struct net *net = sock_net(sk); 23901da177e4SLinus Torvalds 239187e9f031SWANG Cong ASSERT_RTNL(); 239287e9f031SWANG Cong 2393f97c1e0cSJoe Perches if (!ipv4_is_multicast(addr)) 23941da177e4SLinus Torvalds return -EINVAL; 23951da177e4SLinus Torvalds 23961da177e4SLinus Torvalds imr.imr_multiaddr.s_addr = msf->imsf_multiaddr; 23971da177e4SLinus Torvalds imr.imr_address.s_addr = msf->imsf_interface; 23981da177e4SLinus Torvalds imr.imr_ifindex = 0; 2399877acedcSDaniel Lezcano in_dev = ip_mc_find_dev(net, &imr); 24001da177e4SLinus Torvalds 24011da177e4SLinus Torvalds if (!in_dev) { 24021da177e4SLinus Torvalds err = -ENODEV; 24031da177e4SLinus Torvalds goto done; 24041da177e4SLinus Torvalds } 24051da177e4SLinus Torvalds err = -EADDRNOTAVAIL; 24061da177e4SLinus Torvalds 24071d7138deSEric Dumazet for_each_pmc_rtnl(inet, pmc) { 24081da177e4SLinus Torvalds if (pmc->multi.imr_multiaddr.s_addr == msf->imsf_multiaddr && 24091da177e4SLinus Torvalds pmc->multi.imr_ifindex == imr.imr_ifindex) 24101da177e4SLinus Torvalds break; 24111da177e4SLinus Torvalds } 24121da177e4SLinus Torvalds if (!pmc) /* must have a prior join */ 24131da177e4SLinus Torvalds goto done; 24141da177e4SLinus Torvalds msf->imsf_fmode = pmc->sfmode; 24151d7138deSEric Dumazet psl = rtnl_dereference(pmc->sflist); 24161da177e4SLinus Torvalds if (!psl) { 24171da177e4SLinus Torvalds len = 0; 24181da177e4SLinus Torvalds count = 0; 24191da177e4SLinus Torvalds } else { 24201da177e4SLinus Torvalds count = psl->sl_count; 24211da177e4SLinus Torvalds } 24221da177e4SLinus Torvalds copycount = count < msf->imsf_numsrc ? count : msf->imsf_numsrc; 24231da177e4SLinus Torvalds len = copycount * sizeof(psl->sl_addr[0]); 24241da177e4SLinus Torvalds msf->imsf_numsrc = count; 24251da177e4SLinus Torvalds if (put_user(IP_MSFILTER_SIZE(copycount), optlen) || 24261da177e4SLinus Torvalds copy_to_user(optval, msf, IP_MSFILTER_SIZE(0))) { 24271da177e4SLinus Torvalds return -EFAULT; 24281da177e4SLinus Torvalds } 24291da177e4SLinus Torvalds if (len && 24301da177e4SLinus Torvalds copy_to_user(&optval->imsf_slist[0], psl->sl_addr, len)) 24311da177e4SLinus Torvalds return -EFAULT; 24321da177e4SLinus Torvalds return 0; 24331da177e4SLinus Torvalds done: 24341da177e4SLinus Torvalds return err; 24351da177e4SLinus Torvalds } 24361da177e4SLinus Torvalds 24371da177e4SLinus Torvalds int ip_mc_gsfget(struct sock *sk, struct group_filter *gsf, 24381da177e4SLinus Torvalds struct group_filter __user *optval, int __user *optlen) 24391da177e4SLinus Torvalds { 24401da177e4SLinus Torvalds int err, i, count, copycount; 24411da177e4SLinus Torvalds struct sockaddr_in *psin; 244263007727SAl Viro __be32 addr; 24431da177e4SLinus Torvalds struct ip_mc_socklist *pmc; 24441da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 24451da177e4SLinus Torvalds struct ip_sf_socklist *psl; 24461da177e4SLinus Torvalds 244787e9f031SWANG Cong ASSERT_RTNL(); 244887e9f031SWANG Cong 24491da177e4SLinus Torvalds psin = (struct sockaddr_in *)&gsf->gf_group; 24501da177e4SLinus Torvalds if (psin->sin_family != AF_INET) 24511da177e4SLinus Torvalds return -EINVAL; 24521da177e4SLinus Torvalds addr = psin->sin_addr.s_addr; 2453f97c1e0cSJoe Perches if (!ipv4_is_multicast(addr)) 24541da177e4SLinus Torvalds return -EINVAL; 24551da177e4SLinus Torvalds 24561da177e4SLinus Torvalds err = -EADDRNOTAVAIL; 24571da177e4SLinus Torvalds 24581d7138deSEric Dumazet for_each_pmc_rtnl(inet, pmc) { 24591da177e4SLinus Torvalds if (pmc->multi.imr_multiaddr.s_addr == addr && 24601da177e4SLinus Torvalds pmc->multi.imr_ifindex == gsf->gf_interface) 24611da177e4SLinus Torvalds break; 24621da177e4SLinus Torvalds } 24631da177e4SLinus Torvalds if (!pmc) /* must have a prior join */ 24641da177e4SLinus Torvalds goto done; 24651da177e4SLinus Torvalds gsf->gf_fmode = pmc->sfmode; 24661d7138deSEric Dumazet psl = rtnl_dereference(pmc->sflist); 24671da177e4SLinus Torvalds count = psl ? psl->sl_count : 0; 24681da177e4SLinus Torvalds copycount = count < gsf->gf_numsrc ? count : gsf->gf_numsrc; 24691da177e4SLinus Torvalds gsf->gf_numsrc = count; 24701da177e4SLinus Torvalds if (put_user(GROUP_FILTER_SIZE(copycount), optlen) || 24711da177e4SLinus Torvalds copy_to_user(optval, gsf, GROUP_FILTER_SIZE(0))) { 24721da177e4SLinus Torvalds return -EFAULT; 24731da177e4SLinus Torvalds } 24741da177e4SLinus Torvalds for (i = 0; i < copycount; i++) { 24751da177e4SLinus Torvalds struct sockaddr_storage ss; 24761da177e4SLinus Torvalds 24771da177e4SLinus Torvalds psin = (struct sockaddr_in *)&ss; 24781da177e4SLinus Torvalds memset(&ss, 0, sizeof(ss)); 24791da177e4SLinus Torvalds psin->sin_family = AF_INET; 24801da177e4SLinus Torvalds psin->sin_addr.s_addr = psl->sl_addr[i]; 24811da177e4SLinus Torvalds if (copy_to_user(&optval->gf_slist[i], &ss, sizeof(ss))) 24821da177e4SLinus Torvalds return -EFAULT; 24831da177e4SLinus Torvalds } 24841da177e4SLinus Torvalds return 0; 24851da177e4SLinus Torvalds done: 24861da177e4SLinus Torvalds return err; 24871da177e4SLinus Torvalds } 24881da177e4SLinus Torvalds 24891da177e4SLinus Torvalds /* 24901da177e4SLinus Torvalds * check if a multicast source filter allows delivery for a given <src,dst,intf> 24911da177e4SLinus Torvalds */ 2492c0cda068SAl Viro int ip_mc_sf_allow(struct sock *sk, __be32 loc_addr, __be32 rmt_addr, int dif) 24931da177e4SLinus Torvalds { 24941da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 24951da177e4SLinus Torvalds struct ip_mc_socklist *pmc; 24961da177e4SLinus Torvalds struct ip_sf_socklist *psl; 24971da177e4SLinus Torvalds int i; 2498c85bb41eSFlavio Leitner int ret; 24991da177e4SLinus Torvalds 2500c85bb41eSFlavio Leitner ret = 1; 2501f97c1e0cSJoe Perches if (!ipv4_is_multicast(loc_addr)) 2502c85bb41eSFlavio Leitner goto out; 25031da177e4SLinus Torvalds 2504c85bb41eSFlavio Leitner rcu_read_lock(); 25051d7138deSEric Dumazet for_each_pmc_rcu(inet, pmc) { 25061da177e4SLinus Torvalds if (pmc->multi.imr_multiaddr.s_addr == loc_addr && 25071da177e4SLinus Torvalds pmc->multi.imr_ifindex == dif) 25081da177e4SLinus Torvalds break; 25091da177e4SLinus Torvalds } 2510c85bb41eSFlavio Leitner ret = inet->mc_all; 25111da177e4SLinus Torvalds if (!pmc) 2512c85bb41eSFlavio Leitner goto unlock; 25131d7138deSEric Dumazet psl = rcu_dereference(pmc->sflist); 2514c85bb41eSFlavio Leitner ret = (pmc->sfmode == MCAST_EXCLUDE); 25151da177e4SLinus Torvalds if (!psl) 2516c85bb41eSFlavio Leitner goto unlock; 25171da177e4SLinus Torvalds 25181da177e4SLinus Torvalds for (i = 0; i < psl->sl_count; i++) { 25191da177e4SLinus Torvalds if (psl->sl_addr[i] == rmt_addr) 25201da177e4SLinus Torvalds break; 25211da177e4SLinus Torvalds } 2522c85bb41eSFlavio Leitner ret = 0; 25231da177e4SLinus Torvalds if (pmc->sfmode == MCAST_INCLUDE && i >= psl->sl_count) 2524c85bb41eSFlavio Leitner goto unlock; 25251da177e4SLinus Torvalds if (pmc->sfmode == MCAST_EXCLUDE && i < psl->sl_count) 2526c85bb41eSFlavio Leitner goto unlock; 2527c85bb41eSFlavio Leitner ret = 1; 2528c85bb41eSFlavio Leitner unlock: 2529c85bb41eSFlavio Leitner rcu_read_unlock(); 2530c85bb41eSFlavio Leitner out: 2531c85bb41eSFlavio Leitner return ret; 25321da177e4SLinus Torvalds } 25331da177e4SLinus Torvalds 25341da177e4SLinus Torvalds /* 25351da177e4SLinus Torvalds * A socket is closing. 25361da177e4SLinus Torvalds */ 25371da177e4SLinus Torvalds 25381da177e4SLinus Torvalds void ip_mc_drop_socket(struct sock *sk) 25391da177e4SLinus Torvalds { 25401da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 25411da177e4SLinus Torvalds struct ip_mc_socklist *iml; 2542877acedcSDaniel Lezcano struct net *net = sock_net(sk); 25431da177e4SLinus Torvalds 254451456b29SIan Morris if (!inet->mc_list) 25451da177e4SLinus Torvalds return; 25461da177e4SLinus Torvalds 25471da177e4SLinus Torvalds rtnl_lock(); 25481d7138deSEric Dumazet while ((iml = rtnl_dereference(inet->mc_list)) != NULL) { 25491da177e4SLinus Torvalds struct in_device *in_dev; 25501da177e4SLinus Torvalds 25511d7138deSEric Dumazet inet->mc_list = iml->next_rcu; 2552877acedcSDaniel Lezcano in_dev = inetdev_by_index(net, iml->multi.imr_ifindex); 25531da177e4SLinus Torvalds (void) ip_mc_leave_src(sk, iml, in_dev); 255400db4124SIan Morris if (in_dev) 25551da177e4SLinus Torvalds ip_mc_dec_group(in_dev, iml->multi.imr_multiaddr.s_addr); 2556c85bb41eSFlavio Leitner /* decrease mem now to avoid the memleak warning */ 2557c85bb41eSFlavio Leitner atomic_sub(sizeof(*iml), &sk->sk_omem_alloc); 255810d50e74SLai Jiangshan kfree_rcu(iml, rcu); 25591da177e4SLinus Torvalds } 25601da177e4SLinus Torvalds rtnl_unlock(); 25611da177e4SLinus Torvalds } 25621da177e4SLinus Torvalds 2563dbdd9a52SDavid S. Miller /* called with rcu_read_lock() */ 25642094acbbSAlexander Duyck int ip_check_mc_rcu(struct in_device *in_dev, __be32 mc_addr, __be32 src_addr, u8 proto) 25651da177e4SLinus Torvalds { 25661da177e4SLinus Torvalds struct ip_mc_list *im; 2567e9897071SEric Dumazet struct ip_mc_list __rcu **mc_hash; 25681da177e4SLinus Torvalds struct ip_sf_list *psf; 25691da177e4SLinus Torvalds int rv = 0; 25701da177e4SLinus Torvalds 2571e9897071SEric Dumazet mc_hash = rcu_dereference(in_dev->mc_hash); 2572e9897071SEric Dumazet if (mc_hash) { 2573c70eba74SEric Dumazet u32 hash = hash_32((__force u32)mc_addr, MC_HASH_SZ_LOG); 2574e9897071SEric Dumazet 2575e9897071SEric Dumazet for (im = rcu_dereference(mc_hash[hash]); 2576e9897071SEric Dumazet im != NULL; 2577e9897071SEric Dumazet im = rcu_dereference(im->next_hash)) { 2578e9897071SEric Dumazet if (im->multiaddr == mc_addr) 2579e9897071SEric Dumazet break; 2580e9897071SEric Dumazet } 2581e9897071SEric Dumazet } else { 25821d7138deSEric Dumazet for_each_pmc_rcu(in_dev, im) { 25831da177e4SLinus Torvalds if (im->multiaddr == mc_addr) 25841da177e4SLinus Torvalds break; 25851da177e4SLinus Torvalds } 2586e9897071SEric Dumazet } 25871da177e4SLinus Torvalds if (im && proto == IPPROTO_IGMP) { 25881da177e4SLinus Torvalds rv = 1; 25891da177e4SLinus Torvalds } else if (im) { 25901da177e4SLinus Torvalds if (src_addr) { 25911da177e4SLinus Torvalds for (psf = im->sources; psf; psf = psf->sf_next) { 25921da177e4SLinus Torvalds if (psf->sf_inaddr == src_addr) 25931da177e4SLinus Torvalds break; 25941da177e4SLinus Torvalds } 25951da177e4SLinus Torvalds if (psf) 25961da177e4SLinus Torvalds rv = psf->sf_count[MCAST_INCLUDE] || 25971da177e4SLinus Torvalds psf->sf_count[MCAST_EXCLUDE] != 25981da177e4SLinus Torvalds im->sfcount[MCAST_EXCLUDE]; 25991da177e4SLinus Torvalds else 26001da177e4SLinus Torvalds rv = im->sfcount[MCAST_EXCLUDE] != 0; 26011da177e4SLinus Torvalds } else 26021da177e4SLinus Torvalds rv = 1; /* unspecified source; tentatively allow */ 26031da177e4SLinus Torvalds } 26041da177e4SLinus Torvalds return rv; 26051da177e4SLinus Torvalds } 26061da177e4SLinus Torvalds 26071da177e4SLinus Torvalds #if defined(CONFIG_PROC_FS) 26081da177e4SLinus Torvalds struct igmp_mc_iter_state { 26097091e728SAlexey Dobriyan struct seq_net_private p; 26101da177e4SLinus Torvalds struct net_device *dev; 26111da177e4SLinus Torvalds struct in_device *in_dev; 26121da177e4SLinus Torvalds }; 26131da177e4SLinus Torvalds 26141da177e4SLinus Torvalds #define igmp_mc_seq_private(seq) ((struct igmp_mc_iter_state *)(seq)->private) 26151da177e4SLinus Torvalds 26161da177e4SLinus Torvalds static inline struct ip_mc_list *igmp_mc_get_first(struct seq_file *seq) 26171da177e4SLinus Torvalds { 26187091e728SAlexey Dobriyan struct net *net = seq_file_net(seq); 26191da177e4SLinus Torvalds struct ip_mc_list *im = NULL; 26201da177e4SLinus Torvalds struct igmp_mc_iter_state *state = igmp_mc_seq_private(seq); 26211da177e4SLinus Torvalds 26227562f876SPavel Emelianov state->in_dev = NULL; 262361fbab77Sstephen hemminger for_each_netdev_rcu(net, state->dev) { 26241da177e4SLinus Torvalds struct in_device *in_dev; 26256baff150SEric Dumazet 26266baff150SEric Dumazet in_dev = __in_dev_get_rcu(state->dev); 26271da177e4SLinus Torvalds if (!in_dev) 26281da177e4SLinus Torvalds continue; 26291d7138deSEric Dumazet im = rcu_dereference(in_dev->mc_list); 26301da177e4SLinus Torvalds if (im) { 26311da177e4SLinus Torvalds state->in_dev = in_dev; 26321da177e4SLinus Torvalds break; 26331da177e4SLinus Torvalds } 26341da177e4SLinus Torvalds } 26351da177e4SLinus Torvalds return im; 26361da177e4SLinus Torvalds } 26371da177e4SLinus Torvalds 26381da177e4SLinus Torvalds static struct ip_mc_list *igmp_mc_get_next(struct seq_file *seq, struct ip_mc_list *im) 26391da177e4SLinus Torvalds { 26401da177e4SLinus Torvalds struct igmp_mc_iter_state *state = igmp_mc_seq_private(seq); 26416baff150SEric Dumazet 26421d7138deSEric Dumazet im = rcu_dereference(im->next_rcu); 26431d7138deSEric Dumazet while (!im) { 26446baff150SEric Dumazet state->dev = next_net_device_rcu(state->dev); 26451da177e4SLinus Torvalds if (!state->dev) { 26461da177e4SLinus Torvalds state->in_dev = NULL; 26471da177e4SLinus Torvalds break; 26481da177e4SLinus Torvalds } 26496baff150SEric Dumazet state->in_dev = __in_dev_get_rcu(state->dev); 26501da177e4SLinus Torvalds if (!state->in_dev) 26511da177e4SLinus Torvalds continue; 26521d7138deSEric Dumazet im = rcu_dereference(state->in_dev->mc_list); 26531da177e4SLinus Torvalds } 26541da177e4SLinus Torvalds return im; 26551da177e4SLinus Torvalds } 26561da177e4SLinus Torvalds 26571da177e4SLinus Torvalds static struct ip_mc_list *igmp_mc_get_idx(struct seq_file *seq, loff_t pos) 26581da177e4SLinus Torvalds { 26591da177e4SLinus Torvalds struct ip_mc_list *im = igmp_mc_get_first(seq); 26601da177e4SLinus Torvalds if (im) 26611da177e4SLinus Torvalds while (pos && (im = igmp_mc_get_next(seq, im)) != NULL) 26621da177e4SLinus Torvalds --pos; 26631da177e4SLinus Torvalds return pos ? NULL : im; 26641da177e4SLinus Torvalds } 26651da177e4SLinus Torvalds 26661da177e4SLinus Torvalds static void *igmp_mc_seq_start(struct seq_file *seq, loff_t *pos) 266761fbab77Sstephen hemminger __acquires(rcu) 26681da177e4SLinus Torvalds { 266961fbab77Sstephen hemminger rcu_read_lock(); 26701da177e4SLinus Torvalds return *pos ? igmp_mc_get_idx(seq, *pos - 1) : SEQ_START_TOKEN; 26711da177e4SLinus Torvalds } 26721da177e4SLinus Torvalds 26731da177e4SLinus Torvalds static void *igmp_mc_seq_next(struct seq_file *seq, void *v, loff_t *pos) 26741da177e4SLinus Torvalds { 26751da177e4SLinus Torvalds struct ip_mc_list *im; 26761da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) 26771da177e4SLinus Torvalds im = igmp_mc_get_first(seq); 26781da177e4SLinus Torvalds else 26791da177e4SLinus Torvalds im = igmp_mc_get_next(seq, v); 26801da177e4SLinus Torvalds ++*pos; 26811da177e4SLinus Torvalds return im; 26821da177e4SLinus Torvalds } 26831da177e4SLinus Torvalds 26841da177e4SLinus Torvalds static void igmp_mc_seq_stop(struct seq_file *seq, void *v) 268561fbab77Sstephen hemminger __releases(rcu) 26861da177e4SLinus Torvalds { 26871da177e4SLinus Torvalds struct igmp_mc_iter_state *state = igmp_mc_seq_private(seq); 26881d7138deSEric Dumazet 26891da177e4SLinus Torvalds state->in_dev = NULL; 26901da177e4SLinus Torvalds state->dev = NULL; 269161fbab77Sstephen hemminger rcu_read_unlock(); 26921da177e4SLinus Torvalds } 26931da177e4SLinus Torvalds 26941da177e4SLinus Torvalds static int igmp_mc_seq_show(struct seq_file *seq, void *v) 26951da177e4SLinus Torvalds { 26961da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) 26971da177e4SLinus Torvalds seq_puts(seq, 26981da177e4SLinus Torvalds "Idx\tDevice : Count Querier\tGroup Users Timer\tReporter\n"); 26991da177e4SLinus Torvalds else { 27001da177e4SLinus Torvalds struct ip_mc_list *im = (struct ip_mc_list *)v; 27011da177e4SLinus Torvalds struct igmp_mc_iter_state *state = igmp_mc_seq_private(seq); 27021da177e4SLinus Torvalds char *querier; 2703a399a805SEric Dumazet long delta; 2704a399a805SEric Dumazet 27051da177e4SLinus Torvalds #ifdef CONFIG_IP_MULTICAST 27061da177e4SLinus Torvalds querier = IGMP_V1_SEEN(state->in_dev) ? "V1" : 27071da177e4SLinus Torvalds IGMP_V2_SEEN(state->in_dev) ? "V2" : 27081da177e4SLinus Torvalds "V3"; 27091da177e4SLinus Torvalds #else 27101da177e4SLinus Torvalds querier = "NONE"; 27111da177e4SLinus Torvalds #endif 27121da177e4SLinus Torvalds 2713e6b68883SAndreea-Cristina Bernat if (rcu_access_pointer(state->in_dev->mc_list) == im) { 27141da177e4SLinus Torvalds seq_printf(seq, "%d\t%-10s: %5d %7s\n", 2715b8bae41eSRami Rosen state->dev->ifindex, state->dev->name, state->in_dev->mc_count, querier); 27161da177e4SLinus Torvalds } 27171da177e4SLinus Torvalds 2718a399a805SEric Dumazet delta = im->timer.expires - jiffies; 27191da177e4SLinus Torvalds seq_printf(seq, 2720338fcf98SAlexey Dobriyan "\t\t\t\t%08X %5d %d:%08lX\t\t%d\n", 27211da177e4SLinus Torvalds im->multiaddr, im->users, 2722a399a805SEric Dumazet im->tm_running, 2723a399a805SEric Dumazet im->tm_running ? jiffies_delta_to_clock_t(delta) : 0, 27241da177e4SLinus Torvalds im->reporter); 27251da177e4SLinus Torvalds } 27261da177e4SLinus Torvalds return 0; 27271da177e4SLinus Torvalds } 27281da177e4SLinus Torvalds 2729f690808eSStephen Hemminger static const struct seq_operations igmp_mc_seq_ops = { 27301da177e4SLinus Torvalds .start = igmp_mc_seq_start, 27311da177e4SLinus Torvalds .next = igmp_mc_seq_next, 27321da177e4SLinus Torvalds .stop = igmp_mc_seq_stop, 27331da177e4SLinus Torvalds .show = igmp_mc_seq_show, 27341da177e4SLinus Torvalds }; 27351da177e4SLinus Torvalds 27361da177e4SLinus Torvalds static int igmp_mc_seq_open(struct inode *inode, struct file *file) 27371da177e4SLinus Torvalds { 27387091e728SAlexey Dobriyan return seq_open_net(inode, file, &igmp_mc_seq_ops, 2739cf7732e4SPavel Emelyanov sizeof(struct igmp_mc_iter_state)); 27401da177e4SLinus Torvalds } 27411da177e4SLinus Torvalds 27429a32144eSArjan van de Ven static const struct file_operations igmp_mc_seq_fops = { 27431da177e4SLinus Torvalds .owner = THIS_MODULE, 27441da177e4SLinus Torvalds .open = igmp_mc_seq_open, 27451da177e4SLinus Torvalds .read = seq_read, 27461da177e4SLinus Torvalds .llseek = seq_lseek, 27477091e728SAlexey Dobriyan .release = seq_release_net, 27481da177e4SLinus Torvalds }; 27491da177e4SLinus Torvalds 27501da177e4SLinus Torvalds struct igmp_mcf_iter_state { 27517091e728SAlexey Dobriyan struct seq_net_private p; 27521da177e4SLinus Torvalds struct net_device *dev; 27531da177e4SLinus Torvalds struct in_device *idev; 27541da177e4SLinus Torvalds struct ip_mc_list *im; 27551da177e4SLinus Torvalds }; 27561da177e4SLinus Torvalds 27571da177e4SLinus Torvalds #define igmp_mcf_seq_private(seq) ((struct igmp_mcf_iter_state *)(seq)->private) 27581da177e4SLinus Torvalds 27591da177e4SLinus Torvalds static inline struct ip_sf_list *igmp_mcf_get_first(struct seq_file *seq) 27601da177e4SLinus Torvalds { 27617091e728SAlexey Dobriyan struct net *net = seq_file_net(seq); 27621da177e4SLinus Torvalds struct ip_sf_list *psf = NULL; 27631da177e4SLinus Torvalds struct ip_mc_list *im = NULL; 27641da177e4SLinus Torvalds struct igmp_mcf_iter_state *state = igmp_mcf_seq_private(seq); 27651da177e4SLinus Torvalds 27667562f876SPavel Emelianov state->idev = NULL; 27677562f876SPavel Emelianov state->im = NULL; 276861fbab77Sstephen hemminger for_each_netdev_rcu(net, state->dev) { 27691da177e4SLinus Torvalds struct in_device *idev; 27706baff150SEric Dumazet idev = __in_dev_get_rcu(state->dev); 277151456b29SIan Morris if (unlikely(!idev)) 27721da177e4SLinus Torvalds continue; 27731d7138deSEric Dumazet im = rcu_dereference(idev->mc_list); 277400db4124SIan Morris if (likely(im)) { 27751da177e4SLinus Torvalds spin_lock_bh(&im->lock); 27761da177e4SLinus Torvalds psf = im->sources; 277700db4124SIan Morris if (likely(psf)) { 27781da177e4SLinus Torvalds state->im = im; 27791da177e4SLinus Torvalds state->idev = idev; 27801da177e4SLinus Torvalds break; 27811da177e4SLinus Torvalds } 27821da177e4SLinus Torvalds spin_unlock_bh(&im->lock); 27831da177e4SLinus Torvalds } 27841da177e4SLinus Torvalds } 27851da177e4SLinus Torvalds return psf; 27861da177e4SLinus Torvalds } 27871da177e4SLinus Torvalds 27881da177e4SLinus Torvalds static struct ip_sf_list *igmp_mcf_get_next(struct seq_file *seq, struct ip_sf_list *psf) 27891da177e4SLinus Torvalds { 27901da177e4SLinus Torvalds struct igmp_mcf_iter_state *state = igmp_mcf_seq_private(seq); 27911da177e4SLinus Torvalds 27921da177e4SLinus Torvalds psf = psf->sf_next; 27931da177e4SLinus Torvalds while (!psf) { 27941da177e4SLinus Torvalds spin_unlock_bh(&state->im->lock); 27951da177e4SLinus Torvalds state->im = state->im->next; 27961da177e4SLinus Torvalds while (!state->im) { 27976baff150SEric Dumazet state->dev = next_net_device_rcu(state->dev); 27981da177e4SLinus Torvalds if (!state->dev) { 27991da177e4SLinus Torvalds state->idev = NULL; 28001da177e4SLinus Torvalds goto out; 28011da177e4SLinus Torvalds } 28026baff150SEric Dumazet state->idev = __in_dev_get_rcu(state->dev); 28031da177e4SLinus Torvalds if (!state->idev) 28041da177e4SLinus Torvalds continue; 28051d7138deSEric Dumazet state->im = rcu_dereference(state->idev->mc_list); 28061da177e4SLinus Torvalds } 28071da177e4SLinus Torvalds if (!state->im) 28081da177e4SLinus Torvalds break; 28091da177e4SLinus Torvalds spin_lock_bh(&state->im->lock); 28101da177e4SLinus Torvalds psf = state->im->sources; 28111da177e4SLinus Torvalds } 28121da177e4SLinus Torvalds out: 28131da177e4SLinus Torvalds return psf; 28141da177e4SLinus Torvalds } 28151da177e4SLinus Torvalds 28161da177e4SLinus Torvalds static struct ip_sf_list *igmp_mcf_get_idx(struct seq_file *seq, loff_t pos) 28171da177e4SLinus Torvalds { 28181da177e4SLinus Torvalds struct ip_sf_list *psf = igmp_mcf_get_first(seq); 28191da177e4SLinus Torvalds if (psf) 28201da177e4SLinus Torvalds while (pos && (psf = igmp_mcf_get_next(seq, psf)) != NULL) 28211da177e4SLinus Torvalds --pos; 28221da177e4SLinus Torvalds return pos ? NULL : psf; 28231da177e4SLinus Torvalds } 28241da177e4SLinus Torvalds 28251da177e4SLinus Torvalds static void *igmp_mcf_seq_start(struct seq_file *seq, loff_t *pos) 282661fbab77Sstephen hemminger __acquires(rcu) 28271da177e4SLinus Torvalds { 282861fbab77Sstephen hemminger rcu_read_lock(); 28291da177e4SLinus Torvalds return *pos ? igmp_mcf_get_idx(seq, *pos - 1) : SEQ_START_TOKEN; 28301da177e4SLinus Torvalds } 28311da177e4SLinus Torvalds 28321da177e4SLinus Torvalds static void *igmp_mcf_seq_next(struct seq_file *seq, void *v, loff_t *pos) 28331da177e4SLinus Torvalds { 28341da177e4SLinus Torvalds struct ip_sf_list *psf; 28351da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) 28361da177e4SLinus Torvalds psf = igmp_mcf_get_first(seq); 28371da177e4SLinus Torvalds else 28381da177e4SLinus Torvalds psf = igmp_mcf_get_next(seq, v); 28391da177e4SLinus Torvalds ++*pos; 28401da177e4SLinus Torvalds return psf; 28411da177e4SLinus Torvalds } 28421da177e4SLinus Torvalds 28431da177e4SLinus Torvalds static void igmp_mcf_seq_stop(struct seq_file *seq, void *v) 284461fbab77Sstephen hemminger __releases(rcu) 28451da177e4SLinus Torvalds { 28461da177e4SLinus Torvalds struct igmp_mcf_iter_state *state = igmp_mcf_seq_private(seq); 284700db4124SIan Morris if (likely(state->im)) { 28481da177e4SLinus Torvalds spin_unlock_bh(&state->im->lock); 28491da177e4SLinus Torvalds state->im = NULL; 28501da177e4SLinus Torvalds } 28511da177e4SLinus Torvalds state->idev = NULL; 28521da177e4SLinus Torvalds state->dev = NULL; 285361fbab77Sstephen hemminger rcu_read_unlock(); 28541da177e4SLinus Torvalds } 28551da177e4SLinus Torvalds 28561da177e4SLinus Torvalds static int igmp_mcf_seq_show(struct seq_file *seq, void *v) 28571da177e4SLinus Torvalds { 28581da177e4SLinus Torvalds struct ip_sf_list *psf = (struct ip_sf_list *)v; 28591da177e4SLinus Torvalds struct igmp_mcf_iter_state *state = igmp_mcf_seq_private(seq); 28601da177e4SLinus Torvalds 28611da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) { 28621744bea1SJoe Perches seq_puts(seq, "Idx Device MCA SRC INC EXC\n"); 28631da177e4SLinus Torvalds } else { 28641da177e4SLinus Torvalds seq_printf(seq, 28651da177e4SLinus Torvalds "%3d %6.6s 0x%08x " 28661da177e4SLinus Torvalds "0x%08x %6lu %6lu\n", 28671da177e4SLinus Torvalds state->dev->ifindex, state->dev->name, 28681da177e4SLinus Torvalds ntohl(state->im->multiaddr), 28691da177e4SLinus Torvalds ntohl(psf->sf_inaddr), 28701da177e4SLinus Torvalds psf->sf_count[MCAST_INCLUDE], 28711da177e4SLinus Torvalds psf->sf_count[MCAST_EXCLUDE]); 28721da177e4SLinus Torvalds } 28731da177e4SLinus Torvalds return 0; 28741da177e4SLinus Torvalds } 28751da177e4SLinus Torvalds 2876f690808eSStephen Hemminger static const struct seq_operations igmp_mcf_seq_ops = { 28771da177e4SLinus Torvalds .start = igmp_mcf_seq_start, 28781da177e4SLinus Torvalds .next = igmp_mcf_seq_next, 28791da177e4SLinus Torvalds .stop = igmp_mcf_seq_stop, 28801da177e4SLinus Torvalds .show = igmp_mcf_seq_show, 28811da177e4SLinus Torvalds }; 28821da177e4SLinus Torvalds 28831da177e4SLinus Torvalds static int igmp_mcf_seq_open(struct inode *inode, struct file *file) 28841da177e4SLinus Torvalds { 28857091e728SAlexey Dobriyan return seq_open_net(inode, file, &igmp_mcf_seq_ops, 2886cf7732e4SPavel Emelyanov sizeof(struct igmp_mcf_iter_state)); 28871da177e4SLinus Torvalds } 28881da177e4SLinus Torvalds 28899a32144eSArjan van de Ven static const struct file_operations igmp_mcf_seq_fops = { 28901da177e4SLinus Torvalds .owner = THIS_MODULE, 28911da177e4SLinus Torvalds .open = igmp_mcf_seq_open, 28921da177e4SLinus Torvalds .read = seq_read, 28931da177e4SLinus Torvalds .llseek = seq_lseek, 28947091e728SAlexey Dobriyan .release = seq_release_net, 28957091e728SAlexey Dobriyan }; 28967091e728SAlexey Dobriyan 28972c8c1e72SAlexey Dobriyan static int __net_init igmp_net_init(struct net *net) 28987091e728SAlexey Dobriyan { 28997091e728SAlexey Dobriyan struct proc_dir_entry *pde; 290093a714d6SMadhu Challa int err; 29017091e728SAlexey Dobriyan 2902d4beaa66SGao feng pde = proc_create("igmp", S_IRUGO, net->proc_net, &igmp_mc_seq_fops); 29037091e728SAlexey Dobriyan if (!pde) 29047091e728SAlexey Dobriyan goto out_igmp; 2905d4beaa66SGao feng pde = proc_create("mcfilter", S_IRUGO, net->proc_net, 2906d4beaa66SGao feng &igmp_mcf_seq_fops); 29077091e728SAlexey Dobriyan if (!pde) 29087091e728SAlexey Dobriyan goto out_mcfilter; 290993a714d6SMadhu Challa err = inet_ctl_sock_create(&net->ipv4.mc_autojoin_sk, AF_INET, 291093a714d6SMadhu Challa SOCK_DGRAM, 0, net); 291193a714d6SMadhu Challa if (err < 0) { 291293a714d6SMadhu Challa pr_err("Failed to initialize the IGMP autojoin socket (err %d)\n", 291393a714d6SMadhu Challa err); 291493a714d6SMadhu Challa goto out_sock; 291593a714d6SMadhu Challa } 291693a714d6SMadhu Challa 29177091e728SAlexey Dobriyan return 0; 29187091e728SAlexey Dobriyan 291993a714d6SMadhu Challa out_sock: 292093a714d6SMadhu Challa remove_proc_entry("mcfilter", net->proc_net); 29217091e728SAlexey Dobriyan out_mcfilter: 2922ece31ffdSGao feng remove_proc_entry("igmp", net->proc_net); 29237091e728SAlexey Dobriyan out_igmp: 29247091e728SAlexey Dobriyan return -ENOMEM; 29257091e728SAlexey Dobriyan } 29267091e728SAlexey Dobriyan 29272c8c1e72SAlexey Dobriyan static void __net_exit igmp_net_exit(struct net *net) 29287091e728SAlexey Dobriyan { 2929ece31ffdSGao feng remove_proc_entry("mcfilter", net->proc_net); 2930ece31ffdSGao feng remove_proc_entry("igmp", net->proc_net); 293193a714d6SMadhu Challa inet_ctl_sock_destroy(net->ipv4.mc_autojoin_sk); 29327091e728SAlexey Dobriyan } 29337091e728SAlexey Dobriyan 29347091e728SAlexey Dobriyan static struct pernet_operations igmp_net_ops = { 29357091e728SAlexey Dobriyan .init = igmp_net_init, 29367091e728SAlexey Dobriyan .exit = igmp_net_exit, 29371da177e4SLinus Torvalds }; 293872c1d3bdSWANG Cong #endif 29391da177e4SLinus Torvalds 29404aa5dee4SJiri Pirko static int igmp_netdev_event(struct notifier_block *this, 29414aa5dee4SJiri Pirko unsigned long event, void *ptr) 29424aa5dee4SJiri Pirko { 29434aa5dee4SJiri Pirko struct net_device *dev = netdev_notifier_info_to_dev(ptr); 29444aa5dee4SJiri Pirko struct in_device *in_dev; 29454aa5dee4SJiri Pirko 29464aa5dee4SJiri Pirko switch (event) { 29474aa5dee4SJiri Pirko case NETDEV_RESEND_IGMP: 29484aa5dee4SJiri Pirko in_dev = __in_dev_get_rtnl(dev); 29494aa5dee4SJiri Pirko if (in_dev) 29504aa5dee4SJiri Pirko ip_mc_rejoin_groups(in_dev); 29514aa5dee4SJiri Pirko break; 29524aa5dee4SJiri Pirko default: 29534aa5dee4SJiri Pirko break; 29544aa5dee4SJiri Pirko } 29554aa5dee4SJiri Pirko return NOTIFY_DONE; 29564aa5dee4SJiri Pirko } 29574aa5dee4SJiri Pirko 29584aa5dee4SJiri Pirko static struct notifier_block igmp_notifier = { 29594aa5dee4SJiri Pirko .notifier_call = igmp_netdev_event, 29604aa5dee4SJiri Pirko }; 29614aa5dee4SJiri Pirko 296272c1d3bdSWANG Cong int __init igmp_mc_init(void) 29631da177e4SLinus Torvalds { 296472c1d3bdSWANG Cong #if defined(CONFIG_PROC_FS) 29654aa5dee4SJiri Pirko int err; 29664aa5dee4SJiri Pirko 29674aa5dee4SJiri Pirko err = register_pernet_subsys(&igmp_net_ops); 29684aa5dee4SJiri Pirko if (err) 29694aa5dee4SJiri Pirko return err; 29704aa5dee4SJiri Pirko err = register_netdevice_notifier(&igmp_notifier); 29714aa5dee4SJiri Pirko if (err) 29724aa5dee4SJiri Pirko goto reg_notif_fail; 29734aa5dee4SJiri Pirko return 0; 29744aa5dee4SJiri Pirko 29754aa5dee4SJiri Pirko reg_notif_fail: 29764aa5dee4SJiri Pirko unregister_pernet_subsys(&igmp_net_ops); 29774aa5dee4SJiri Pirko return err; 297872c1d3bdSWANG Cong #else 297972c1d3bdSWANG Cong return register_netdevice_notifier(&igmp_notifier); 29801da177e4SLinus Torvalds #endif 298172c1d3bdSWANG Cong } 2982