mcast.c 70 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950
  1. /*
  2. * Multicast support for IPv6
  3. * Linux INET6 implementation
  4. *
  5. * Authors:
  6. * Pedro Roque <roque@di.fc.ul.pt>
  7. *
  8. * Based on linux/ipv4/igmp.c and linux/ipv4/ip_sockglue.c
  9. *
  10. * This program is free software; you can redistribute it and/or
  11. * modify it under the terms of the GNU General Public License
  12. * as published by the Free Software Foundation; either version
  13. * 2 of the License, or (at your option) any later version.
  14. */
  15. /* Changes:
  16. *
  17. * yoshfuji : fix format of router-alert option
  18. * YOSHIFUJI Hideaki @USAGI:
  19. * Fixed source address for MLD message based on
  20. * <draft-ietf-magma-mld-source-05.txt>.
  21. * YOSHIFUJI Hideaki @USAGI:
  22. * - Ignore Queries for invalid addresses.
  23. * - MLD for link-local addresses.
  24. * David L Stevens <dlstevens@us.ibm.com>:
  25. * - MLDv2 support
  26. */
  27. #include <linux/module.h>
  28. #include <linux/errno.h>
  29. #include <linux/types.h>
  30. #include <linux/string.h>
  31. #include <linux/socket.h>
  32. #include <linux/sockios.h>
  33. #include <linux/jiffies.h>
  34. #include <linux/times.h>
  35. #include <linux/net.h>
  36. #include <linux/in.h>
  37. #include <linux/in6.h>
  38. #include <linux/netdevice.h>
  39. #include <linux/if_arp.h>
  40. #include <linux/route.h>
  41. #include <linux/init.h>
  42. #include <linux/proc_fs.h>
  43. #include <linux/seq_file.h>
  44. #include <linux/slab.h>
  45. #include <linux/pkt_sched.h>
  46. #include <net/mld.h>
  47. #include <linux/netfilter.h>
  48. #include <linux/netfilter_ipv6.h>
  49. #include <net/net_namespace.h>
  50. #include <net/sock.h>
  51. #include <net/snmp.h>
  52. #include <net/ipv6.h>
  53. #include <net/protocol.h>
  54. #include <net/if_inet6.h>
  55. #include <net/ndisc.h>
  56. #include <net/addrconf.h>
  57. #include <net/ip6_route.h>
  58. #include <net/inet_common.h>
  59. #include <net/ip6_checksum.h>
  60. /* Ensure that we have struct in6_addr aligned on 32bit word. */
  61. static void *__mld2_query_bugs[] __attribute__((__unused__)) = {
  62. BUILD_BUG_ON_NULL(offsetof(struct mld2_query, mld2q_srcs) % 4),
  63. BUILD_BUG_ON_NULL(offsetof(struct mld2_report, mld2r_grec) % 4),
  64. BUILD_BUG_ON_NULL(offsetof(struct mld2_grec, grec_mca) % 4)
  65. };
  66. static struct in6_addr mld2_all_mcr = MLD2_ALL_MCR_INIT;
  67. static void igmp6_join_group(struct ifmcaddr6 *ma);
  68. static void igmp6_leave_group(struct ifmcaddr6 *ma);
  69. static void igmp6_timer_handler(unsigned long data);
  70. static void mld_gq_timer_expire(unsigned long data);
  71. static void mld_ifc_timer_expire(unsigned long data);
  72. static void mld_ifc_event(struct inet6_dev *idev);
  73. static void mld_add_delrec(struct inet6_dev *idev, struct ifmcaddr6 *pmc);
  74. static void mld_del_delrec(struct inet6_dev *idev, const struct in6_addr *addr);
  75. static void mld_clear_delrec(struct inet6_dev *idev);
  76. static bool mld_in_v1_mode(const struct inet6_dev *idev);
  77. static int sf_setstate(struct ifmcaddr6 *pmc);
  78. static void sf_markstate(struct ifmcaddr6 *pmc);
  79. static void ip6_mc_clear_src(struct ifmcaddr6 *pmc);
  80. static int ip6_mc_del_src(struct inet6_dev *idev, const struct in6_addr *pmca,
  81. int sfmode, int sfcount, const struct in6_addr *psfsrc,
  82. int delta);
  83. static int ip6_mc_add_src(struct inet6_dev *idev, const struct in6_addr *pmca,
  84. int sfmode, int sfcount, const struct in6_addr *psfsrc,
  85. int delta);
  86. static int ip6_mc_leave_src(struct sock *sk, struct ipv6_mc_socklist *iml,
  87. struct inet6_dev *idev);
  88. #define MLD_QRV_DEFAULT 2
  89. /* RFC3810, 9.2. Query Interval */
  90. #define MLD_QI_DEFAULT (125 * HZ)
  91. /* RFC3810, 9.3. Query Response Interval */
  92. #define MLD_QRI_DEFAULT (10 * HZ)
  93. /* RFC3810, 8.1 Query Version Distinctions */
  94. #define MLD_V1_QUERY_LEN 24
  95. #define MLD_V2_QUERY_LEN_MIN 28
  96. #define IPV6_MLD_MAX_MSF 64
  97. int sysctl_mld_max_msf __read_mostly = IPV6_MLD_MAX_MSF;
  98. int sysctl_mld_qrv __read_mostly = MLD_QRV_DEFAULT;
  99. /*
  100. * socket join on multicast group
  101. */
  102. #define for_each_pmc_rcu(np, pmc) \
  103. for (pmc = rcu_dereference(np->ipv6_mc_list); \
  104. pmc != NULL; \
  105. pmc = rcu_dereference(pmc->next))
  106. static int unsolicited_report_interval(struct inet6_dev *idev)
  107. {
  108. int iv;
  109. if (mld_in_v1_mode(idev))
  110. iv = idev->cnf.mldv1_unsolicited_report_interval;
  111. else
  112. iv = idev->cnf.mldv2_unsolicited_report_interval;
  113. return iv > 0 ? iv : 1;
  114. }
  115. int ipv6_sock_mc_join(struct sock *sk, int ifindex, const struct in6_addr *addr)
  116. {
  117. struct net_device *dev = NULL;
  118. struct ipv6_mc_socklist *mc_lst;
  119. struct ipv6_pinfo *np = inet6_sk(sk);
  120. struct net *net = sock_net(sk);
  121. int err;
  122. ASSERT_RTNL();
  123. if (!ipv6_addr_is_multicast(addr))
  124. return -EINVAL;
  125. rcu_read_lock();
  126. for_each_pmc_rcu(np, mc_lst) {
  127. if ((ifindex == 0 || mc_lst->ifindex == ifindex) &&
  128. ipv6_addr_equal(&mc_lst->addr, addr)) {
  129. rcu_read_unlock();
  130. return -EADDRINUSE;
  131. }
  132. }
  133. rcu_read_unlock();
  134. mc_lst = sock_kmalloc(sk, sizeof(struct ipv6_mc_socklist), GFP_KERNEL);
  135. if (!mc_lst)
  136. return -ENOMEM;
  137. mc_lst->next = NULL;
  138. mc_lst->addr = *addr;
  139. if (ifindex == 0) {
  140. struct rt6_info *rt;
  141. rt = rt6_lookup(net, addr, NULL, 0, 0);
  142. if (rt) {
  143. dev = rt->dst.dev;
  144. ip6_rt_put(rt);
  145. }
  146. } else
  147. dev = __dev_get_by_index(net, ifindex);
  148. if (!dev) {
  149. sock_kfree_s(sk, mc_lst, sizeof(*mc_lst));
  150. return -ENODEV;
  151. }
  152. mc_lst->ifindex = dev->ifindex;
  153. mc_lst->sfmode = MCAST_EXCLUDE;
  154. rwlock_init(&mc_lst->sflock);
  155. mc_lst->sflist = NULL;
  156. /*
  157. * now add/increase the group membership on the device
  158. */
  159. err = ipv6_dev_mc_inc(dev, addr);
  160. if (err) {
  161. sock_kfree_s(sk, mc_lst, sizeof(*mc_lst));
  162. return err;
  163. }
  164. mc_lst->next = np->ipv6_mc_list;
  165. rcu_assign_pointer(np->ipv6_mc_list, mc_lst);
  166. return 0;
  167. }
  168. EXPORT_SYMBOL(ipv6_sock_mc_join);
  169. /*
  170. * socket leave on multicast group
  171. */
  172. int ipv6_sock_mc_drop(struct sock *sk, int ifindex, const struct in6_addr *addr)
  173. {
  174. struct ipv6_pinfo *np = inet6_sk(sk);
  175. struct ipv6_mc_socklist *mc_lst;
  176. struct ipv6_mc_socklist __rcu **lnk;
  177. struct net *net = sock_net(sk);
  178. ASSERT_RTNL();
  179. if (!ipv6_addr_is_multicast(addr))
  180. return -EINVAL;
  181. for (lnk = &np->ipv6_mc_list;
  182. (mc_lst = rtnl_dereference(*lnk)) != NULL;
  183. lnk = &mc_lst->next) {
  184. if ((ifindex == 0 || mc_lst->ifindex == ifindex) &&
  185. ipv6_addr_equal(&mc_lst->addr, addr)) {
  186. struct net_device *dev;
  187. *lnk = mc_lst->next;
  188. dev = __dev_get_by_index(net, mc_lst->ifindex);
  189. if (dev) {
  190. struct inet6_dev *idev = __in6_dev_get(dev);
  191. (void) ip6_mc_leave_src(sk, mc_lst, idev);
  192. if (idev)
  193. __ipv6_dev_mc_dec(idev, &mc_lst->addr);
  194. } else
  195. (void) ip6_mc_leave_src(sk, mc_lst, NULL);
  196. atomic_sub(sizeof(*mc_lst), &sk->sk_omem_alloc);
  197. kfree_rcu(mc_lst, rcu);
  198. return 0;
  199. }
  200. }
  201. return -EADDRNOTAVAIL;
  202. }
  203. EXPORT_SYMBOL(ipv6_sock_mc_drop);
  204. /* called with rcu_read_lock() */
  205. static struct inet6_dev *ip6_mc_find_dev_rcu(struct net *net,
  206. const struct in6_addr *group,
  207. int ifindex)
  208. {
  209. struct net_device *dev = NULL;
  210. struct inet6_dev *idev = NULL;
  211. if (ifindex == 0) {
  212. struct rt6_info *rt = rt6_lookup(net, group, NULL, 0, 0);
  213. if (rt) {
  214. dev = rt->dst.dev;
  215. ip6_rt_put(rt);
  216. }
  217. } else
  218. dev = dev_get_by_index_rcu(net, ifindex);
  219. if (!dev)
  220. return NULL;
  221. idev = __in6_dev_get(dev);
  222. if (!idev)
  223. return NULL;
  224. read_lock_bh(&idev->lock);
  225. if (idev->dead) {
  226. read_unlock_bh(&idev->lock);
  227. return NULL;
  228. }
  229. return idev;
  230. }
  231. void ipv6_sock_mc_close(struct sock *sk)
  232. {
  233. struct ipv6_pinfo *np = inet6_sk(sk);
  234. struct ipv6_mc_socklist *mc_lst;
  235. struct net *net = sock_net(sk);
  236. if (!rcu_access_pointer(np->ipv6_mc_list))
  237. return;
  238. rtnl_lock();
  239. while ((mc_lst = rtnl_dereference(np->ipv6_mc_list)) != NULL) {
  240. struct net_device *dev;
  241. np->ipv6_mc_list = mc_lst->next;
  242. dev = __dev_get_by_index(net, mc_lst->ifindex);
  243. if (dev) {
  244. struct inet6_dev *idev = __in6_dev_get(dev);
  245. (void) ip6_mc_leave_src(sk, mc_lst, idev);
  246. if (idev)
  247. __ipv6_dev_mc_dec(idev, &mc_lst->addr);
  248. } else
  249. (void) ip6_mc_leave_src(sk, mc_lst, NULL);
  250. atomic_sub(sizeof(*mc_lst), &sk->sk_omem_alloc);
  251. kfree_rcu(mc_lst, rcu);
  252. }
  253. rtnl_unlock();
  254. }
  255. int ip6_mc_source(int add, int omode, struct sock *sk,
  256. struct group_source_req *pgsr)
  257. {
  258. struct in6_addr *source, *group;
  259. struct ipv6_mc_socklist *pmc;
  260. struct inet6_dev *idev;
  261. struct ipv6_pinfo *inet6 = inet6_sk(sk);
  262. struct ip6_sf_socklist *psl;
  263. struct net *net = sock_net(sk);
  264. int i, j, rv;
  265. int leavegroup = 0;
  266. int pmclocked = 0;
  267. int err;
  268. source = &((struct sockaddr_in6 *)&pgsr->gsr_source)->sin6_addr;
  269. group = &((struct sockaddr_in6 *)&pgsr->gsr_group)->sin6_addr;
  270. if (!ipv6_addr_is_multicast(group))
  271. return -EINVAL;
  272. rcu_read_lock();
  273. idev = ip6_mc_find_dev_rcu(net, group, pgsr->gsr_interface);
  274. if (!idev) {
  275. rcu_read_unlock();
  276. return -ENODEV;
  277. }
  278. err = -EADDRNOTAVAIL;
  279. for_each_pmc_rcu(inet6, pmc) {
  280. if (pgsr->gsr_interface && pmc->ifindex != pgsr->gsr_interface)
  281. continue;
  282. if (ipv6_addr_equal(&pmc->addr, group))
  283. break;
  284. }
  285. if (!pmc) { /* must have a prior join */
  286. err = -EINVAL;
  287. goto done;
  288. }
  289. /* if a source filter was set, must be the same mode as before */
  290. if (pmc->sflist) {
  291. if (pmc->sfmode != omode) {
  292. err = -EINVAL;
  293. goto done;
  294. }
  295. } else if (pmc->sfmode != omode) {
  296. /* allow mode switches for empty-set filters */
  297. ip6_mc_add_src(idev, group, omode, 0, NULL, 0);
  298. ip6_mc_del_src(idev, group, pmc->sfmode, 0, NULL, 0);
  299. pmc->sfmode = omode;
  300. }
  301. write_lock(&pmc->sflock);
  302. pmclocked = 1;
  303. psl = pmc->sflist;
  304. if (!add) {
  305. if (!psl)
  306. goto done; /* err = -EADDRNOTAVAIL */
  307. rv = !0;
  308. for (i = 0; i < psl->sl_count; i++) {
  309. rv = !ipv6_addr_equal(&psl->sl_addr[i], source);
  310. if (rv == 0)
  311. break;
  312. }
  313. if (rv) /* source not found */
  314. goto done; /* err = -EADDRNOTAVAIL */
  315. /* special case - (INCLUDE, empty) == LEAVE_GROUP */
  316. if (psl->sl_count == 1 && omode == MCAST_INCLUDE) {
  317. leavegroup = 1;
  318. goto done;
  319. }
  320. /* update the interface filter */
  321. ip6_mc_del_src(idev, group, omode, 1, source, 1);
  322. for (j = i+1; j < psl->sl_count; j++)
  323. psl->sl_addr[j-1] = psl->sl_addr[j];
  324. psl->sl_count--;
  325. err = 0;
  326. goto done;
  327. }
  328. /* else, add a new source to the filter */
  329. if (psl && psl->sl_count >= sysctl_mld_max_msf) {
  330. err = -ENOBUFS;
  331. goto done;
  332. }
  333. if (!psl || psl->sl_count == psl->sl_max) {
  334. struct ip6_sf_socklist *newpsl;
  335. int count = IP6_SFBLOCK;
  336. if (psl)
  337. count += psl->sl_max;
  338. newpsl = sock_kmalloc(sk, IP6_SFLSIZE(count), GFP_ATOMIC);
  339. if (!newpsl) {
  340. err = -ENOBUFS;
  341. goto done;
  342. }
  343. newpsl->sl_max = count;
  344. newpsl->sl_count = count - IP6_SFBLOCK;
  345. if (psl) {
  346. for (i = 0; i < psl->sl_count; i++)
  347. newpsl->sl_addr[i] = psl->sl_addr[i];
  348. sock_kfree_s(sk, psl, IP6_SFLSIZE(psl->sl_max));
  349. }
  350. pmc->sflist = psl = newpsl;
  351. }
  352. rv = 1; /* > 0 for insert logic below if sl_count is 0 */
  353. for (i = 0; i < psl->sl_count; i++) {
  354. rv = !ipv6_addr_equal(&psl->sl_addr[i], source);
  355. if (rv == 0) /* There is an error in the address. */
  356. goto done;
  357. }
  358. for (j = psl->sl_count-1; j >= i; j--)
  359. psl->sl_addr[j+1] = psl->sl_addr[j];
  360. psl->sl_addr[i] = *source;
  361. psl->sl_count++;
  362. err = 0;
  363. /* update the interface list */
  364. ip6_mc_add_src(idev, group, omode, 1, source, 1);
  365. done:
  366. if (pmclocked)
  367. write_unlock(&pmc->sflock);
  368. read_unlock_bh(&idev->lock);
  369. rcu_read_unlock();
  370. if (leavegroup)
  371. err = ipv6_sock_mc_drop(sk, pgsr->gsr_interface, group);
  372. return err;
  373. }
  374. int ip6_mc_msfilter(struct sock *sk, struct group_filter *gsf)
  375. {
  376. const struct in6_addr *group;
  377. struct ipv6_mc_socklist *pmc;
  378. struct inet6_dev *idev;
  379. struct ipv6_pinfo *inet6 = inet6_sk(sk);
  380. struct ip6_sf_socklist *newpsl, *psl;
  381. struct net *net = sock_net(sk);
  382. int leavegroup = 0;
  383. int i, err;
  384. group = &((struct sockaddr_in6 *)&gsf->gf_group)->sin6_addr;
  385. if (!ipv6_addr_is_multicast(group))
  386. return -EINVAL;
  387. if (gsf->gf_fmode != MCAST_INCLUDE &&
  388. gsf->gf_fmode != MCAST_EXCLUDE)
  389. return -EINVAL;
  390. rcu_read_lock();
  391. idev = ip6_mc_find_dev_rcu(net, group, gsf->gf_interface);
  392. if (!idev) {
  393. rcu_read_unlock();
  394. return -ENODEV;
  395. }
  396. err = 0;
  397. if (gsf->gf_fmode == MCAST_INCLUDE && gsf->gf_numsrc == 0) {
  398. leavegroup = 1;
  399. goto done;
  400. }
  401. for_each_pmc_rcu(inet6, pmc) {
  402. if (pmc->ifindex != gsf->gf_interface)
  403. continue;
  404. if (ipv6_addr_equal(&pmc->addr, group))
  405. break;
  406. }
  407. if (!pmc) { /* must have a prior join */
  408. err = -EINVAL;
  409. goto done;
  410. }
  411. if (gsf->gf_numsrc) {
  412. newpsl = sock_kmalloc(sk, IP6_SFLSIZE(gsf->gf_numsrc),
  413. GFP_ATOMIC);
  414. if (!newpsl) {
  415. err = -ENOBUFS;
  416. goto done;
  417. }
  418. newpsl->sl_max = newpsl->sl_count = gsf->gf_numsrc;
  419. for (i = 0; i < newpsl->sl_count; ++i) {
  420. struct sockaddr_in6 *psin6;
  421. psin6 = (struct sockaddr_in6 *)&gsf->gf_slist[i];
  422. newpsl->sl_addr[i] = psin6->sin6_addr;
  423. }
  424. err = ip6_mc_add_src(idev, group, gsf->gf_fmode,
  425. newpsl->sl_count, newpsl->sl_addr, 0);
  426. if (err) {
  427. sock_kfree_s(sk, newpsl, IP6_SFLSIZE(newpsl->sl_max));
  428. goto done;
  429. }
  430. } else {
  431. newpsl = NULL;
  432. (void) ip6_mc_add_src(idev, group, gsf->gf_fmode, 0, NULL, 0);
  433. }
  434. write_lock(&pmc->sflock);
  435. psl = pmc->sflist;
  436. if (psl) {
  437. (void) ip6_mc_del_src(idev, group, pmc->sfmode,
  438. psl->sl_count, psl->sl_addr, 0);
  439. sock_kfree_s(sk, psl, IP6_SFLSIZE(psl->sl_max));
  440. } else
  441. (void) ip6_mc_del_src(idev, group, pmc->sfmode, 0, NULL, 0);
  442. pmc->sflist = newpsl;
  443. pmc->sfmode = gsf->gf_fmode;
  444. write_unlock(&pmc->sflock);
  445. err = 0;
  446. done:
  447. read_unlock_bh(&idev->lock);
  448. rcu_read_unlock();
  449. if (leavegroup)
  450. err = ipv6_sock_mc_drop(sk, gsf->gf_interface, group);
  451. return err;
  452. }
  453. int ip6_mc_msfget(struct sock *sk, struct group_filter *gsf,
  454. struct group_filter __user *optval, int __user *optlen)
  455. {
  456. int err, i, count, copycount;
  457. const struct in6_addr *group;
  458. struct ipv6_mc_socklist *pmc;
  459. struct inet6_dev *idev;
  460. struct ipv6_pinfo *inet6 = inet6_sk(sk);
  461. struct ip6_sf_socklist *psl;
  462. struct net *net = sock_net(sk);
  463. group = &((struct sockaddr_in6 *)&gsf->gf_group)->sin6_addr;
  464. if (!ipv6_addr_is_multicast(group))
  465. return -EINVAL;
  466. rcu_read_lock();
  467. idev = ip6_mc_find_dev_rcu(net, group, gsf->gf_interface);
  468. if (!idev) {
  469. rcu_read_unlock();
  470. return -ENODEV;
  471. }
  472. err = -EADDRNOTAVAIL;
  473. /* changes to the ipv6_mc_list require the socket lock and
  474. * rtnl lock. We have the socket lock and rcu read lock,
  475. * so reading the list is safe.
  476. */
  477. for_each_pmc_rcu(inet6, pmc) {
  478. if (pmc->ifindex != gsf->gf_interface)
  479. continue;
  480. if (ipv6_addr_equal(group, &pmc->addr))
  481. break;
  482. }
  483. if (!pmc) /* must have a prior join */
  484. goto done;
  485. gsf->gf_fmode = pmc->sfmode;
  486. psl = pmc->sflist;
  487. count = psl ? psl->sl_count : 0;
  488. read_unlock_bh(&idev->lock);
  489. rcu_read_unlock();
  490. copycount = count < gsf->gf_numsrc ? count : gsf->gf_numsrc;
  491. gsf->gf_numsrc = count;
  492. if (put_user(GROUP_FILTER_SIZE(copycount), optlen) ||
  493. copy_to_user(optval, gsf, GROUP_FILTER_SIZE(0))) {
  494. return -EFAULT;
  495. }
  496. /* changes to psl require the socket lock, and a write lock
  497. * on pmc->sflock. We have the socket lock so reading here is safe.
  498. */
  499. for (i = 0; i < copycount; i++) {
  500. struct sockaddr_in6 *psin6;
  501. struct sockaddr_storage ss;
  502. psin6 = (struct sockaddr_in6 *)&ss;
  503. memset(&ss, 0, sizeof(ss));
  504. psin6->sin6_family = AF_INET6;
  505. psin6->sin6_addr = psl->sl_addr[i];
  506. if (copy_to_user(&optval->gf_slist[i], &ss, sizeof(ss)))
  507. return -EFAULT;
  508. }
  509. return 0;
  510. done:
  511. read_unlock_bh(&idev->lock);
  512. rcu_read_unlock();
  513. return err;
  514. }
  515. bool inet6_mc_check(struct sock *sk, const struct in6_addr *mc_addr,
  516. const struct in6_addr *src_addr)
  517. {
  518. struct ipv6_pinfo *np = inet6_sk(sk);
  519. struct ipv6_mc_socklist *mc;
  520. struct ip6_sf_socklist *psl;
  521. bool rv = true;
  522. rcu_read_lock();
  523. for_each_pmc_rcu(np, mc) {
  524. if (ipv6_addr_equal(&mc->addr, mc_addr))
  525. break;
  526. }
  527. if (!mc) {
  528. rcu_read_unlock();
  529. return true;
  530. }
  531. read_lock(&mc->sflock);
  532. psl = mc->sflist;
  533. if (!psl) {
  534. rv = mc->sfmode == MCAST_EXCLUDE;
  535. } else {
  536. int i;
  537. for (i = 0; i < psl->sl_count; i++) {
  538. if (ipv6_addr_equal(&psl->sl_addr[i], src_addr))
  539. break;
  540. }
  541. if (mc->sfmode == MCAST_INCLUDE && i >= psl->sl_count)
  542. rv = false;
  543. if (mc->sfmode == MCAST_EXCLUDE && i < psl->sl_count)
  544. rv = false;
  545. }
  546. read_unlock(&mc->sflock);
  547. rcu_read_unlock();
  548. return rv;
  549. }
  550. static void igmp6_group_added(struct ifmcaddr6 *mc)
  551. {
  552. struct net_device *dev = mc->idev->dev;
  553. char buf[MAX_ADDR_LEN];
  554. if (IPV6_ADDR_MC_SCOPE(&mc->mca_addr) <
  555. IPV6_ADDR_SCOPE_LINKLOCAL)
  556. return;
  557. spin_lock_bh(&mc->mca_lock);
  558. if (!(mc->mca_flags&MAF_LOADED)) {
  559. mc->mca_flags |= MAF_LOADED;
  560. if (ndisc_mc_map(&mc->mca_addr, buf, dev, 0) == 0)
  561. dev_mc_add(dev, buf);
  562. }
  563. spin_unlock_bh(&mc->mca_lock);
  564. if (!(dev->flags & IFF_UP) || (mc->mca_flags & MAF_NOREPORT))
  565. return;
  566. if (mld_in_v1_mode(mc->idev)) {
  567. igmp6_join_group(mc);
  568. return;
  569. }
  570. /* else v2 */
  571. mc->mca_crcount = mc->idev->mc_qrv;
  572. mld_ifc_event(mc->idev);
  573. }
  574. static void igmp6_group_dropped(struct ifmcaddr6 *mc)
  575. {
  576. struct net_device *dev = mc->idev->dev;
  577. char buf[MAX_ADDR_LEN];
  578. if (IPV6_ADDR_MC_SCOPE(&mc->mca_addr) <
  579. IPV6_ADDR_SCOPE_LINKLOCAL)
  580. return;
  581. spin_lock_bh(&mc->mca_lock);
  582. if (mc->mca_flags&MAF_LOADED) {
  583. mc->mca_flags &= ~MAF_LOADED;
  584. if (ndisc_mc_map(&mc->mca_addr, buf, dev, 0) == 0)
  585. dev_mc_del(dev, buf);
  586. }
  587. if (mc->mca_flags & MAF_NOREPORT)
  588. goto done;
  589. spin_unlock_bh(&mc->mca_lock);
  590. if (!mc->idev->dead)
  591. igmp6_leave_group(mc);
  592. spin_lock_bh(&mc->mca_lock);
  593. if (del_timer(&mc->mca_timer))
  594. atomic_dec(&mc->mca_refcnt);
  595. done:
  596. ip6_mc_clear_src(mc);
  597. spin_unlock_bh(&mc->mca_lock);
  598. }
  599. /*
  600. * deleted ifmcaddr6 manipulation
  601. */
  602. static void mld_add_delrec(struct inet6_dev *idev, struct ifmcaddr6 *im)
  603. {
  604. struct ifmcaddr6 *pmc;
  605. /* this is an "ifmcaddr6" for convenience; only the fields below
  606. * are actually used. In particular, the refcnt and users are not
  607. * used for management of the delete list. Using the same structure
  608. * for deleted items allows change reports to use common code with
  609. * non-deleted or query-response MCA's.
  610. */
  611. pmc = kzalloc(sizeof(*pmc), GFP_ATOMIC);
  612. if (!pmc)
  613. return;
  614. spin_lock_bh(&im->mca_lock);
  615. spin_lock_init(&pmc->mca_lock);
  616. pmc->idev = im->idev;
  617. in6_dev_hold(idev);
  618. pmc->mca_addr = im->mca_addr;
  619. pmc->mca_crcount = idev->mc_qrv;
  620. pmc->mca_sfmode = im->mca_sfmode;
  621. if (pmc->mca_sfmode == MCAST_INCLUDE) {
  622. struct ip6_sf_list *psf;
  623. pmc->mca_tomb = im->mca_tomb;
  624. pmc->mca_sources = im->mca_sources;
  625. im->mca_tomb = im->mca_sources = NULL;
  626. for (psf = pmc->mca_sources; psf; psf = psf->sf_next)
  627. psf->sf_crcount = pmc->mca_crcount;
  628. }
  629. spin_unlock_bh(&im->mca_lock);
  630. spin_lock_bh(&idev->mc_lock);
  631. pmc->next = idev->mc_tomb;
  632. idev->mc_tomb = pmc;
  633. spin_unlock_bh(&idev->mc_lock);
  634. }
  635. static void mld_del_delrec(struct inet6_dev *idev, const struct in6_addr *pmca)
  636. {
  637. struct ifmcaddr6 *pmc, *pmc_prev;
  638. struct ip6_sf_list *psf, *psf_next;
  639. spin_lock_bh(&idev->mc_lock);
  640. pmc_prev = NULL;
  641. for (pmc = idev->mc_tomb; pmc; pmc = pmc->next) {
  642. if (ipv6_addr_equal(&pmc->mca_addr, pmca))
  643. break;
  644. pmc_prev = pmc;
  645. }
  646. if (pmc) {
  647. if (pmc_prev)
  648. pmc_prev->next = pmc->next;
  649. else
  650. idev->mc_tomb = pmc->next;
  651. }
  652. spin_unlock_bh(&idev->mc_lock);
  653. if (pmc) {
  654. for (psf = pmc->mca_tomb; psf; psf = psf_next) {
  655. psf_next = psf->sf_next;
  656. kfree(psf);
  657. }
  658. in6_dev_put(pmc->idev);
  659. kfree(pmc);
  660. }
  661. }
  662. static void mld_clear_delrec(struct inet6_dev *idev)
  663. {
  664. struct ifmcaddr6 *pmc, *nextpmc;
  665. spin_lock_bh(&idev->mc_lock);
  666. pmc = idev->mc_tomb;
  667. idev->mc_tomb = NULL;
  668. spin_unlock_bh(&idev->mc_lock);
  669. for (; pmc; pmc = nextpmc) {
  670. nextpmc = pmc->next;
  671. ip6_mc_clear_src(pmc);
  672. in6_dev_put(pmc->idev);
  673. kfree(pmc);
  674. }
  675. /* clear dead sources, too */
  676. read_lock_bh(&idev->lock);
  677. for (pmc = idev->mc_list; pmc; pmc = pmc->next) {
  678. struct ip6_sf_list *psf, *psf_next;
  679. spin_lock_bh(&pmc->mca_lock);
  680. psf = pmc->mca_tomb;
  681. pmc->mca_tomb = NULL;
  682. spin_unlock_bh(&pmc->mca_lock);
  683. for (; psf; psf = psf_next) {
  684. psf_next = psf->sf_next;
  685. kfree(psf);
  686. }
  687. }
  688. read_unlock_bh(&idev->lock);
  689. }
  690. static void mca_get(struct ifmcaddr6 *mc)
  691. {
  692. atomic_inc(&mc->mca_refcnt);
  693. }
  694. static void ma_put(struct ifmcaddr6 *mc)
  695. {
  696. if (atomic_dec_and_test(&mc->mca_refcnt)) {
  697. in6_dev_put(mc->idev);
  698. kfree(mc);
  699. }
  700. }
  701. static struct ifmcaddr6 *mca_alloc(struct inet6_dev *idev,
  702. const struct in6_addr *addr)
  703. {
  704. struct ifmcaddr6 *mc;
  705. mc = kzalloc(sizeof(*mc), GFP_ATOMIC);
  706. if (!mc)
  707. return NULL;
  708. setup_timer(&mc->mca_timer, igmp6_timer_handler, (unsigned long)mc);
  709. mc->mca_addr = *addr;
  710. mc->idev = idev; /* reference taken by caller */
  711. mc->mca_users = 1;
  712. /* mca_stamp should be updated upon changes */
  713. mc->mca_cstamp = mc->mca_tstamp = jiffies;
  714. atomic_set(&mc->mca_refcnt, 1);
  715. spin_lock_init(&mc->mca_lock);
  716. /* initial mode is (EX, empty) */
  717. mc->mca_sfmode = MCAST_EXCLUDE;
  718. mc->mca_sfcount[MCAST_EXCLUDE] = 1;
  719. if (ipv6_addr_is_ll_all_nodes(&mc->mca_addr) ||
  720. IPV6_ADDR_MC_SCOPE(&mc->mca_addr) < IPV6_ADDR_SCOPE_LINKLOCAL)
  721. mc->mca_flags |= MAF_NOREPORT;
  722. return mc;
  723. }
  724. /*
  725. * device multicast group inc (add if not found)
  726. */
  727. int ipv6_dev_mc_inc(struct net_device *dev, const struct in6_addr *addr)
  728. {
  729. struct ifmcaddr6 *mc;
  730. struct inet6_dev *idev;
  731. ASSERT_RTNL();
  732. /* we need to take a reference on idev */
  733. idev = in6_dev_get(dev);
  734. if (!idev)
  735. return -EINVAL;
  736. write_lock_bh(&idev->lock);
  737. if (idev->dead) {
  738. write_unlock_bh(&idev->lock);
  739. in6_dev_put(idev);
  740. return -ENODEV;
  741. }
  742. for (mc = idev->mc_list; mc; mc = mc->next) {
  743. if (ipv6_addr_equal(&mc->mca_addr, addr)) {
  744. mc->mca_users++;
  745. write_unlock_bh(&idev->lock);
  746. ip6_mc_add_src(idev, &mc->mca_addr, MCAST_EXCLUDE, 0,
  747. NULL, 0);
  748. in6_dev_put(idev);
  749. return 0;
  750. }
  751. }
  752. mc = mca_alloc(idev, addr);
  753. if (!mc) {
  754. write_unlock_bh(&idev->lock);
  755. in6_dev_put(idev);
  756. return -ENOMEM;
  757. }
  758. mc->next = idev->mc_list;
  759. idev->mc_list = mc;
  760. /* Hold this for the code below before we unlock,
  761. * it is already exposed via idev->mc_list.
  762. */
  763. mca_get(mc);
  764. write_unlock_bh(&idev->lock);
  765. mld_del_delrec(idev, &mc->mca_addr);
  766. igmp6_group_added(mc);
  767. ma_put(mc);
  768. return 0;
  769. }
  770. /*
  771. * device multicast group del
  772. */
  773. int __ipv6_dev_mc_dec(struct inet6_dev *idev, const struct in6_addr *addr)
  774. {
  775. struct ifmcaddr6 *ma, **map;
  776. ASSERT_RTNL();
  777. write_lock_bh(&idev->lock);
  778. for (map = &idev->mc_list; (ma = *map) != NULL; map = &ma->next) {
  779. if (ipv6_addr_equal(&ma->mca_addr, addr)) {
  780. if (--ma->mca_users == 0) {
  781. *map = ma->next;
  782. write_unlock_bh(&idev->lock);
  783. igmp6_group_dropped(ma);
  784. ma_put(ma);
  785. return 0;
  786. }
  787. write_unlock_bh(&idev->lock);
  788. return 0;
  789. }
  790. }
  791. write_unlock_bh(&idev->lock);
  792. return -ENOENT;
  793. }
  794. int ipv6_dev_mc_dec(struct net_device *dev, const struct in6_addr *addr)
  795. {
  796. struct inet6_dev *idev;
  797. int err;
  798. ASSERT_RTNL();
  799. idev = __in6_dev_get(dev);
  800. if (!idev)
  801. err = -ENODEV;
  802. else
  803. err = __ipv6_dev_mc_dec(idev, addr);
  804. return err;
  805. }
  806. /*
  807. * check if the interface/address pair is valid
  808. */
  809. bool ipv6_chk_mcast_addr(struct net_device *dev, const struct in6_addr *group,
  810. const struct in6_addr *src_addr)
  811. {
  812. struct inet6_dev *idev;
  813. struct ifmcaddr6 *mc;
  814. bool rv = false;
  815. rcu_read_lock();
  816. idev = __in6_dev_get(dev);
  817. if (idev) {
  818. read_lock_bh(&idev->lock);
  819. for (mc = idev->mc_list; mc; mc = mc->next) {
  820. if (ipv6_addr_equal(&mc->mca_addr, group))
  821. break;
  822. }
  823. if (mc) {
  824. if (src_addr && !ipv6_addr_any(src_addr)) {
  825. struct ip6_sf_list *psf;
  826. spin_lock_bh(&mc->mca_lock);
  827. for (psf = mc->mca_sources; psf; psf = psf->sf_next) {
  828. if (ipv6_addr_equal(&psf->sf_addr, src_addr))
  829. break;
  830. }
  831. if (psf)
  832. rv = psf->sf_count[MCAST_INCLUDE] ||
  833. psf->sf_count[MCAST_EXCLUDE] !=
  834. mc->mca_sfcount[MCAST_EXCLUDE];
  835. else
  836. rv = mc->mca_sfcount[MCAST_EXCLUDE] != 0;
  837. spin_unlock_bh(&mc->mca_lock);
  838. } else
  839. rv = true; /* don't filter unspecified source */
  840. }
  841. read_unlock_bh(&idev->lock);
  842. }
  843. rcu_read_unlock();
  844. return rv;
  845. }
  846. static void mld_gq_start_timer(struct inet6_dev *idev)
  847. {
  848. unsigned long tv = prandom_u32() % idev->mc_maxdelay;
  849. idev->mc_gq_running = 1;
  850. if (!mod_timer(&idev->mc_gq_timer, jiffies+tv+2))
  851. in6_dev_hold(idev);
  852. }
  853. static void mld_gq_stop_timer(struct inet6_dev *idev)
  854. {
  855. idev->mc_gq_running = 0;
  856. if (del_timer(&idev->mc_gq_timer))
  857. __in6_dev_put(idev);
  858. }
  859. static void mld_ifc_start_timer(struct inet6_dev *idev, unsigned long delay)
  860. {
  861. unsigned long tv = prandom_u32() % delay;
  862. if (!mod_timer(&idev->mc_ifc_timer, jiffies+tv+2))
  863. in6_dev_hold(idev);
  864. }
  865. static void mld_ifc_stop_timer(struct inet6_dev *idev)
  866. {
  867. idev->mc_ifc_count = 0;
  868. if (del_timer(&idev->mc_ifc_timer))
  869. __in6_dev_put(idev);
  870. }
  871. static void mld_dad_start_timer(struct inet6_dev *idev, unsigned long delay)
  872. {
  873. unsigned long tv = prandom_u32() % delay;
  874. if (!mod_timer(&idev->mc_dad_timer, jiffies+tv+2))
  875. in6_dev_hold(idev);
  876. }
  877. static void mld_dad_stop_timer(struct inet6_dev *idev)
  878. {
  879. if (del_timer(&idev->mc_dad_timer))
  880. __in6_dev_put(idev);
  881. }
  882. /*
  883. * IGMP handling (alias multicast ICMPv6 messages)
  884. */
  885. static void igmp6_group_queried(struct ifmcaddr6 *ma, unsigned long resptime)
  886. {
  887. unsigned long delay = resptime;
  888. /* Do not start timer for these addresses */
  889. if (ipv6_addr_is_ll_all_nodes(&ma->mca_addr) ||
  890. IPV6_ADDR_MC_SCOPE(&ma->mca_addr) < IPV6_ADDR_SCOPE_LINKLOCAL)
  891. return;
  892. if (del_timer(&ma->mca_timer)) {
  893. atomic_dec(&ma->mca_refcnt);
  894. delay = ma->mca_timer.expires - jiffies;
  895. }
  896. if (delay >= resptime)
  897. delay = prandom_u32() % resptime;
  898. ma->mca_timer.expires = jiffies + delay;
  899. if (!mod_timer(&ma->mca_timer, jiffies + delay))
  900. atomic_inc(&ma->mca_refcnt);
  901. ma->mca_flags |= MAF_TIMER_RUNNING;
  902. }
  903. /* mark EXCLUDE-mode sources */
  904. static bool mld_xmarksources(struct ifmcaddr6 *pmc, int nsrcs,
  905. const struct in6_addr *srcs)
  906. {
  907. struct ip6_sf_list *psf;
  908. int i, scount;
  909. scount = 0;
  910. for (psf = pmc->mca_sources; psf; psf = psf->sf_next) {
  911. if (scount == nsrcs)
  912. break;
  913. for (i = 0; i < nsrcs; i++) {
  914. /* skip inactive filters */
  915. if (psf->sf_count[MCAST_INCLUDE] ||
  916. pmc->mca_sfcount[MCAST_EXCLUDE] !=
  917. psf->sf_count[MCAST_EXCLUDE])
  918. break;
  919. if (ipv6_addr_equal(&srcs[i], &psf->sf_addr)) {
  920. scount++;
  921. break;
  922. }
  923. }
  924. }
  925. pmc->mca_flags &= ~MAF_GSQUERY;
  926. if (scount == nsrcs) /* all sources excluded */
  927. return false;
  928. return true;
  929. }
  930. static bool mld_marksources(struct ifmcaddr6 *pmc, int nsrcs,
  931. const struct in6_addr *srcs)
  932. {
  933. struct ip6_sf_list *psf;
  934. int i, scount;
  935. if (pmc->mca_sfmode == MCAST_EXCLUDE)
  936. return mld_xmarksources(pmc, nsrcs, srcs);
  937. /* mark INCLUDE-mode sources */
  938. scount = 0;
  939. for (psf = pmc->mca_sources; psf; psf = psf->sf_next) {
  940. if (scount == nsrcs)
  941. break;
  942. for (i = 0; i < nsrcs; i++) {
  943. if (ipv6_addr_equal(&srcs[i], &psf->sf_addr)) {
  944. psf->sf_gsresp = 1;
  945. scount++;
  946. break;
  947. }
  948. }
  949. }
  950. if (!scount) {
  951. pmc->mca_flags &= ~MAF_GSQUERY;
  952. return false;
  953. }
  954. pmc->mca_flags |= MAF_GSQUERY;
  955. return true;
  956. }
  957. static int mld_force_mld_version(const struct inet6_dev *idev)
  958. {
  959. /* Normally, both are 0 here. If enforcement to a particular is
  960. * being used, individual device enforcement will have a lower
  961. * precedence over 'all' device (.../conf/all/force_mld_version).
  962. */
  963. if (dev_net(idev->dev)->ipv6.devconf_all->force_mld_version != 0)
  964. return dev_net(idev->dev)->ipv6.devconf_all->force_mld_version;
  965. else
  966. return idev->cnf.force_mld_version;
  967. }
  968. static bool mld_in_v2_mode_only(const struct inet6_dev *idev)
  969. {
  970. return mld_force_mld_version(idev) == 2;
  971. }
  972. static bool mld_in_v1_mode_only(const struct inet6_dev *idev)
  973. {
  974. return mld_force_mld_version(idev) == 1;
  975. }
  976. static bool mld_in_v1_mode(const struct inet6_dev *idev)
  977. {
  978. if (mld_in_v2_mode_only(idev))
  979. return false;
  980. if (mld_in_v1_mode_only(idev))
  981. return true;
  982. if (idev->mc_v1_seen && time_before(jiffies, idev->mc_v1_seen))
  983. return true;
  984. return false;
  985. }
  986. static void mld_set_v1_mode(struct inet6_dev *idev)
  987. {
  988. /* RFC3810, relevant sections:
  989. * - 9.1. Robustness Variable
  990. * - 9.2. Query Interval
  991. * - 9.3. Query Response Interval
  992. * - 9.12. Older Version Querier Present Timeout
  993. */
  994. unsigned long switchback;
  995. switchback = (idev->mc_qrv * idev->mc_qi) + idev->mc_qri;
  996. idev->mc_v1_seen = jiffies + switchback;
  997. }
  998. static void mld_update_qrv(struct inet6_dev *idev,
  999. const struct mld2_query *mlh2)
  1000. {
  1001. /* RFC3810, relevant sections:
  1002. * - 5.1.8. QRV (Querier's Robustness Variable)
  1003. * - 9.1. Robustness Variable
  1004. */
  1005. /* The value of the Robustness Variable MUST NOT be zero,
  1006. * and SHOULD NOT be one. Catch this here if we ever run
  1007. * into such a case in future.
  1008. */
  1009. const int min_qrv = min(MLD_QRV_DEFAULT, sysctl_mld_qrv);
  1010. WARN_ON(idev->mc_qrv == 0);
  1011. if (mlh2->mld2q_qrv > 0)
  1012. idev->mc_qrv = mlh2->mld2q_qrv;
  1013. if (unlikely(idev->mc_qrv < min_qrv)) {
  1014. net_warn_ratelimited("IPv6: MLD: clamping QRV from %u to %u!\n",
  1015. idev->mc_qrv, min_qrv);
  1016. idev->mc_qrv = min_qrv;
  1017. }
  1018. }
  1019. static void mld_update_qi(struct inet6_dev *idev,
  1020. const struct mld2_query *mlh2)
  1021. {
  1022. /* RFC3810, relevant sections:
  1023. * - 5.1.9. QQIC (Querier's Query Interval Code)
  1024. * - 9.2. Query Interval
  1025. * - 9.12. Older Version Querier Present Timeout
  1026. * (the [Query Interval] in the last Query received)
  1027. */
  1028. unsigned long mc_qqi;
  1029. if (mlh2->mld2q_qqic < 128) {
  1030. mc_qqi = mlh2->mld2q_qqic;
  1031. } else {
  1032. unsigned long mc_man, mc_exp;
  1033. mc_exp = MLDV2_QQIC_EXP(mlh2->mld2q_qqic);
  1034. mc_man = MLDV2_QQIC_MAN(mlh2->mld2q_qqic);
  1035. mc_qqi = (mc_man | 0x10) << (mc_exp + 3);
  1036. }
  1037. idev->mc_qi = mc_qqi * HZ;
  1038. }
  1039. static void mld_update_qri(struct inet6_dev *idev,
  1040. const struct mld2_query *mlh2)
  1041. {
  1042. /* RFC3810, relevant sections:
  1043. * - 5.1.3. Maximum Response Code
  1044. * - 9.3. Query Response Interval
  1045. */
  1046. idev->mc_qri = msecs_to_jiffies(mldv2_mrc(mlh2));
  1047. }
  1048. static int mld_process_v1(struct inet6_dev *idev, struct mld_msg *mld,
  1049. unsigned long *max_delay, bool v1_query)
  1050. {
  1051. unsigned long mldv1_md;
  1052. /* Ignore v1 queries */
  1053. if (mld_in_v2_mode_only(idev))
  1054. return -EINVAL;
  1055. mldv1_md = ntohs(mld->mld_maxdelay);
  1056. /* When in MLDv1 fallback and a MLDv2 router start-up being
  1057. * unaware of current MLDv1 operation, the MRC == MRD mapping
  1058. * only works when the exponential algorithm is not being
  1059. * used (as MLDv1 is unaware of such things).
  1060. *
  1061. * According to the RFC author, the MLDv2 implementations
  1062. * he's aware of all use a MRC < 32768 on start up queries.
  1063. *
  1064. * Thus, should we *ever* encounter something else larger
  1065. * than that, just assume the maximum possible within our
  1066. * reach.
  1067. */
  1068. if (!v1_query)
  1069. mldv1_md = min(mldv1_md, MLDV1_MRD_MAX_COMPAT);
  1070. *max_delay = max(msecs_to_jiffies(mldv1_md), 1UL);
  1071. /* MLDv1 router present: we need to go into v1 mode *only*
  1072. * when an MLDv1 query is received as per section 9.12. of
  1073. * RFC3810! And we know from RFC2710 section 3.7 that MLDv1
  1074. * queries MUST be of exactly 24 octets.
  1075. */
  1076. if (v1_query)
  1077. mld_set_v1_mode(idev);
  1078. /* cancel MLDv2 report timer */
  1079. mld_gq_stop_timer(idev);
  1080. /* cancel the interface change timer */
  1081. mld_ifc_stop_timer(idev);
  1082. /* clear deleted report items */
  1083. mld_clear_delrec(idev);
  1084. return 0;
  1085. }
  1086. static int mld_process_v2(struct inet6_dev *idev, struct mld2_query *mld,
  1087. unsigned long *max_delay)
  1088. {
  1089. *max_delay = max(msecs_to_jiffies(mldv2_mrc(mld)), 1UL);
  1090. mld_update_qrv(idev, mld);
  1091. mld_update_qi(idev, mld);
  1092. mld_update_qri(idev, mld);
  1093. idev->mc_maxdelay = *max_delay;
  1094. return 0;
  1095. }
  1096. /* called with rcu_read_lock() */
  1097. int igmp6_event_query(struct sk_buff *skb)
  1098. {
  1099. struct mld2_query *mlh2 = NULL;
  1100. struct ifmcaddr6 *ma;
  1101. const struct in6_addr *group;
  1102. unsigned long max_delay;
  1103. struct inet6_dev *idev;
  1104. struct mld_msg *mld;
  1105. int group_type;
  1106. int mark = 0;
  1107. int len, err;
  1108. if (!pskb_may_pull(skb, sizeof(struct in6_addr)))
  1109. return -EINVAL;
  1110. /* compute payload length excluding extension headers */
  1111. len = ntohs(ipv6_hdr(skb)->payload_len) + sizeof(struct ipv6hdr);
  1112. len -= skb_network_header_len(skb);
  1113. /* RFC3810 6.2
  1114. * Upon reception of an MLD message that contains a Query, the node
  1115. * checks if the source address of the message is a valid link-local
  1116. * address, if the Hop Limit is set to 1, and if the Router Alert
  1117. * option is present in the Hop-By-Hop Options header of the IPv6
  1118. * packet. If any of these checks fails, the packet is dropped.
  1119. */
  1120. if (!(ipv6_addr_type(&ipv6_hdr(skb)->saddr) & IPV6_ADDR_LINKLOCAL) ||
  1121. ipv6_hdr(skb)->hop_limit != 1 ||
  1122. !(IP6CB(skb)->flags & IP6SKB_ROUTERALERT) ||
  1123. IP6CB(skb)->ra != htons(IPV6_OPT_ROUTERALERT_MLD))
  1124. return -EINVAL;
  1125. idev = __in6_dev_get(skb->dev);
  1126. if (!idev)
  1127. return 0;
  1128. mld = (struct mld_msg *)icmp6_hdr(skb);
  1129. group = &mld->mld_mca;
  1130. group_type = ipv6_addr_type(group);
  1131. if (group_type != IPV6_ADDR_ANY &&
  1132. !(group_type&IPV6_ADDR_MULTICAST))
  1133. return -EINVAL;
  1134. if (len < MLD_V1_QUERY_LEN) {
  1135. return -EINVAL;
  1136. } else if (len == MLD_V1_QUERY_LEN || mld_in_v1_mode(idev)) {
  1137. err = mld_process_v1(idev, mld, &max_delay,
  1138. len == MLD_V1_QUERY_LEN);
  1139. if (err < 0)
  1140. return err;
  1141. } else if (len >= MLD_V2_QUERY_LEN_MIN) {
  1142. int srcs_offset = sizeof(struct mld2_query) -
  1143. sizeof(struct icmp6hdr);
  1144. if (!pskb_may_pull(skb, srcs_offset))
  1145. return -EINVAL;
  1146. mlh2 = (struct mld2_query *)skb_transport_header(skb);
  1147. err = mld_process_v2(idev, mlh2, &max_delay);
  1148. if (err < 0)
  1149. return err;
  1150. if (group_type == IPV6_ADDR_ANY) { /* general query */
  1151. if (mlh2->mld2q_nsrcs)
  1152. return -EINVAL; /* no sources allowed */
  1153. mld_gq_start_timer(idev);
  1154. return 0;
  1155. }
  1156. /* mark sources to include, if group & source-specific */
  1157. if (mlh2->mld2q_nsrcs != 0) {
  1158. if (!pskb_may_pull(skb, srcs_offset +
  1159. ntohs(mlh2->mld2q_nsrcs) * sizeof(struct in6_addr)))
  1160. return -EINVAL;
  1161. mlh2 = (struct mld2_query *)skb_transport_header(skb);
  1162. mark = 1;
  1163. }
  1164. } else {
  1165. return -EINVAL;
  1166. }
  1167. read_lock_bh(&idev->lock);
  1168. if (group_type == IPV6_ADDR_ANY) {
  1169. for (ma = idev->mc_list; ma; ma = ma->next) {
  1170. spin_lock_bh(&ma->mca_lock);
  1171. igmp6_group_queried(ma, max_delay);
  1172. spin_unlock_bh(&ma->mca_lock);
  1173. }
  1174. } else {
  1175. for (ma = idev->mc_list; ma; ma = ma->next) {
  1176. if (!ipv6_addr_equal(group, &ma->mca_addr))
  1177. continue;
  1178. spin_lock_bh(&ma->mca_lock);
  1179. if (ma->mca_flags & MAF_TIMER_RUNNING) {
  1180. /* gsquery <- gsquery && mark */
  1181. if (!mark)
  1182. ma->mca_flags &= ~MAF_GSQUERY;
  1183. } else {
  1184. /* gsquery <- mark */
  1185. if (mark)
  1186. ma->mca_flags |= MAF_GSQUERY;
  1187. else
  1188. ma->mca_flags &= ~MAF_GSQUERY;
  1189. }
  1190. if (!(ma->mca_flags & MAF_GSQUERY) ||
  1191. mld_marksources(ma, ntohs(mlh2->mld2q_nsrcs), mlh2->mld2q_srcs))
  1192. igmp6_group_queried(ma, max_delay);
  1193. spin_unlock_bh(&ma->mca_lock);
  1194. break;
  1195. }
  1196. }
  1197. read_unlock_bh(&idev->lock);
  1198. return 0;
  1199. }
  1200. /* called with rcu_read_lock() */
  1201. int igmp6_event_report(struct sk_buff *skb)
  1202. {
  1203. struct ifmcaddr6 *ma;
  1204. struct inet6_dev *idev;
  1205. struct mld_msg *mld;
  1206. int addr_type;
  1207. /* Our own report looped back. Ignore it. */
  1208. if (skb->pkt_type == PACKET_LOOPBACK)
  1209. return 0;
  1210. /* send our report if the MC router may not have heard this report */
  1211. if (skb->pkt_type != PACKET_MULTICAST &&
  1212. skb->pkt_type != PACKET_BROADCAST)
  1213. return 0;
  1214. if (!pskb_may_pull(skb, sizeof(*mld) - sizeof(struct icmp6hdr)))
  1215. return -EINVAL;
  1216. mld = (struct mld_msg *)icmp6_hdr(skb);
  1217. /* Drop reports with not link local source */
  1218. addr_type = ipv6_addr_type(&ipv6_hdr(skb)->saddr);
  1219. if (addr_type != IPV6_ADDR_ANY &&
  1220. !(addr_type&IPV6_ADDR_LINKLOCAL))
  1221. return -EINVAL;
  1222. idev = __in6_dev_get(skb->dev);
  1223. if (!idev)
  1224. return -ENODEV;
  1225. /*
  1226. * Cancel the timer for this group
  1227. */
  1228. read_lock_bh(&idev->lock);
  1229. for (ma = idev->mc_list; ma; ma = ma->next) {
  1230. if (ipv6_addr_equal(&ma->mca_addr, &mld->mld_mca)) {
  1231. spin_lock(&ma->mca_lock);
  1232. if (del_timer(&ma->mca_timer))
  1233. atomic_dec(&ma->mca_refcnt);
  1234. ma->mca_flags &= ~(MAF_LAST_REPORTER|MAF_TIMER_RUNNING);
  1235. spin_unlock(&ma->mca_lock);
  1236. break;
  1237. }
  1238. }
  1239. read_unlock_bh(&idev->lock);
  1240. return 0;
  1241. }
  1242. static bool is_in(struct ifmcaddr6 *pmc, struct ip6_sf_list *psf, int type,
  1243. int gdeleted, int sdeleted)
  1244. {
  1245. switch (type) {
  1246. case MLD2_MODE_IS_INCLUDE:
  1247. case MLD2_MODE_IS_EXCLUDE:
  1248. if (gdeleted || sdeleted)
  1249. return false;
  1250. if (!((pmc->mca_flags & MAF_GSQUERY) && !psf->sf_gsresp)) {
  1251. if (pmc->mca_sfmode == MCAST_INCLUDE)
  1252. return true;
  1253. /* don't include if this source is excluded
  1254. * in all filters
  1255. */
  1256. if (psf->sf_count[MCAST_INCLUDE])
  1257. return type == MLD2_MODE_IS_INCLUDE;
  1258. return pmc->mca_sfcount[MCAST_EXCLUDE] ==
  1259. psf->sf_count[MCAST_EXCLUDE];
  1260. }
  1261. return false;
  1262. case MLD2_CHANGE_TO_INCLUDE:
  1263. if (gdeleted || sdeleted)
  1264. return false;
  1265. return psf->sf_count[MCAST_INCLUDE] != 0;
  1266. case MLD2_CHANGE_TO_EXCLUDE:
  1267. if (gdeleted || sdeleted)
  1268. return false;
  1269. if (pmc->mca_sfcount[MCAST_EXCLUDE] == 0 ||
  1270. psf->sf_count[MCAST_INCLUDE])
  1271. return false;
  1272. return pmc->mca_sfcount[MCAST_EXCLUDE] ==
  1273. psf->sf_count[MCAST_EXCLUDE];
  1274. case MLD2_ALLOW_NEW_SOURCES:
  1275. if (gdeleted || !psf->sf_crcount)
  1276. return false;
  1277. return (pmc->mca_sfmode == MCAST_INCLUDE) ^ sdeleted;
  1278. case MLD2_BLOCK_OLD_SOURCES:
  1279. if (pmc->mca_sfmode == MCAST_INCLUDE)
  1280. return gdeleted || (psf->sf_crcount && sdeleted);
  1281. return psf->sf_crcount && !gdeleted && !sdeleted;
  1282. }
  1283. return false;
  1284. }
  1285. static int
  1286. mld_scount(struct ifmcaddr6 *pmc, int type, int gdeleted, int sdeleted)
  1287. {
  1288. struct ip6_sf_list *psf;
  1289. int scount = 0;
  1290. for (psf = pmc->mca_sources; psf; psf = psf->sf_next) {
  1291. if (!is_in(pmc, psf, type, gdeleted, sdeleted))
  1292. continue;
  1293. scount++;
  1294. }
  1295. return scount;
  1296. }
  1297. static void ip6_mc_hdr(struct sock *sk, struct sk_buff *skb,
  1298. struct net_device *dev,
  1299. const struct in6_addr *saddr,
  1300. const struct in6_addr *daddr,
  1301. int proto, int len)
  1302. {
  1303. struct ipv6hdr *hdr;
  1304. skb->protocol = htons(ETH_P_IPV6);
  1305. skb->dev = dev;
  1306. skb_reset_network_header(skb);
  1307. skb_put(skb, sizeof(struct ipv6hdr));
  1308. hdr = ipv6_hdr(skb);
  1309. ip6_flow_hdr(hdr, 0, 0);
  1310. hdr->payload_len = htons(len);
  1311. hdr->nexthdr = proto;
  1312. hdr->hop_limit = inet6_sk(sk)->hop_limit;
  1313. hdr->saddr = *saddr;
  1314. hdr->daddr = *daddr;
  1315. }
  1316. static struct sk_buff *mld_newpack(struct inet6_dev *idev, unsigned int mtu)
  1317. {
  1318. struct net_device *dev = idev->dev;
  1319. struct net *net = dev_net(dev);
  1320. struct sock *sk = net->ipv6.igmp_sk;
  1321. struct sk_buff *skb;
  1322. struct mld2_report *pmr;
  1323. struct in6_addr addr_buf;
  1324. const struct in6_addr *saddr;
  1325. int hlen = LL_RESERVED_SPACE(dev);
  1326. int tlen = dev->needed_tailroom;
  1327. unsigned int size = mtu + hlen + tlen;
  1328. int err;
  1329. u8 ra[8] = { IPPROTO_ICMPV6, 0,
  1330. IPV6_TLV_ROUTERALERT, 2, 0, 0,
  1331. IPV6_TLV_PADN, 0 };
  1332. /* we assume size > sizeof(ra) here */
  1333. /* limit our allocations to order-0 page */
  1334. size = min_t(int, size, SKB_MAX_ORDER(0, 0));
  1335. skb = sock_alloc_send_skb(sk, size, 1, &err);
  1336. if (!skb)
  1337. return NULL;
  1338. skb->priority = TC_PRIO_CONTROL;
  1339. skb->reserved_tailroom = skb_end_offset(skb) -
  1340. min(mtu, skb_end_offset(skb));
  1341. skb_reserve(skb, hlen);
  1342. if (__ipv6_get_lladdr(idev, &addr_buf, IFA_F_TENTATIVE)) {
  1343. /* <draft-ietf-magma-mld-source-05.txt>:
  1344. * use unspecified address as the source address
  1345. * when a valid link-local address is not available.
  1346. */
  1347. saddr = &in6addr_any;
  1348. } else
  1349. saddr = &addr_buf;
  1350. ip6_mc_hdr(sk, skb, dev, saddr, &mld2_all_mcr, NEXTHDR_HOP, 0);
  1351. memcpy(skb_put(skb, sizeof(ra)), ra, sizeof(ra));
  1352. skb_set_transport_header(skb, skb_tail_pointer(skb) - skb->data);
  1353. skb_put(skb, sizeof(*pmr));
  1354. pmr = (struct mld2_report *)skb_transport_header(skb);
  1355. pmr->mld2r_type = ICMPV6_MLD2_REPORT;
  1356. pmr->mld2r_resv1 = 0;
  1357. pmr->mld2r_cksum = 0;
  1358. pmr->mld2r_resv2 = 0;
  1359. pmr->mld2r_ngrec = 0;
  1360. return skb;
  1361. }
  1362. static void mld_sendpack(struct sk_buff *skb)
  1363. {
  1364. struct ipv6hdr *pip6 = ipv6_hdr(skb);
  1365. struct mld2_report *pmr =
  1366. (struct mld2_report *)skb_transport_header(skb);
  1367. int payload_len, mldlen;
  1368. struct inet6_dev *idev;
  1369. struct net *net = dev_net(skb->dev);
  1370. int err;
  1371. struct flowi6 fl6;
  1372. struct dst_entry *dst;
  1373. rcu_read_lock();
  1374. idev = __in6_dev_get(skb->dev);
  1375. IP6_UPD_PO_STATS(net, idev, IPSTATS_MIB_OUT, skb->len);
  1376. payload_len = (skb_tail_pointer(skb) - skb_network_header(skb)) -
  1377. sizeof(*pip6);
  1378. mldlen = skb_tail_pointer(skb) - skb_transport_header(skb);
  1379. pip6->payload_len = htons(payload_len);
  1380. pmr->mld2r_cksum = csum_ipv6_magic(&pip6->saddr, &pip6->daddr, mldlen,
  1381. IPPROTO_ICMPV6,
  1382. csum_partial(skb_transport_header(skb),
  1383. mldlen, 0));
  1384. icmpv6_flow_init(net->ipv6.igmp_sk, &fl6, ICMPV6_MLD2_REPORT,
  1385. &ipv6_hdr(skb)->saddr, &ipv6_hdr(skb)->daddr,
  1386. skb->dev->ifindex);
  1387. dst = icmp6_dst_alloc(skb->dev, &fl6);
  1388. err = 0;
  1389. if (IS_ERR(dst)) {
  1390. err = PTR_ERR(dst);
  1391. dst = NULL;
  1392. }
  1393. skb_dst_set(skb, dst);
  1394. if (err)
  1395. goto err_out;
  1396. payload_len = skb->len;
  1397. err = NF_HOOK(NFPROTO_IPV6, NF_INET_LOCAL_OUT,
  1398. net, net->ipv6.igmp_sk, skb, NULL, skb->dev,
  1399. dst_output);
  1400. out:
  1401. if (!err) {
  1402. ICMP6MSGOUT_INC_STATS(net, idev, ICMPV6_MLD2_REPORT);
  1403. ICMP6_INC_STATS(net, idev, ICMP6_MIB_OUTMSGS);
  1404. } else {
  1405. IP6_INC_STATS(net, idev, IPSTATS_MIB_OUTDISCARDS);
  1406. }
  1407. rcu_read_unlock();
  1408. return;
  1409. err_out:
  1410. kfree_skb(skb);
  1411. goto out;
  1412. }
  1413. static int grec_size(struct ifmcaddr6 *pmc, int type, int gdel, int sdel)
  1414. {
  1415. return sizeof(struct mld2_grec) + 16 * mld_scount(pmc,type,gdel,sdel);
  1416. }
  1417. static struct sk_buff *add_grhead(struct sk_buff *skb, struct ifmcaddr6 *pmc,
  1418. int type, struct mld2_grec **ppgr)
  1419. {
  1420. struct net_device *dev = pmc->idev->dev;
  1421. struct mld2_report *pmr;
  1422. struct mld2_grec *pgr;
  1423. if (!skb)
  1424. skb = mld_newpack(pmc->idev, dev->mtu);
  1425. if (!skb)
  1426. return NULL;
  1427. pgr = (struct mld2_grec *)skb_put(skb, sizeof(struct mld2_grec));
  1428. pgr->grec_type = type;
  1429. pgr->grec_auxwords = 0;
  1430. pgr->grec_nsrcs = 0;
  1431. pgr->grec_mca = pmc->mca_addr; /* structure copy */
  1432. pmr = (struct mld2_report *)skb_transport_header(skb);
  1433. pmr->mld2r_ngrec = htons(ntohs(pmr->mld2r_ngrec)+1);
  1434. *ppgr = pgr;
  1435. return skb;
  1436. }
  1437. #define AVAILABLE(skb) ((skb) ? skb_availroom(skb) : 0)
  1438. static struct sk_buff *add_grec(struct sk_buff *skb, struct ifmcaddr6 *pmc,
  1439. int type, int gdeleted, int sdeleted, int crsend)
  1440. {
  1441. struct inet6_dev *idev = pmc->idev;
  1442. struct net_device *dev = idev->dev;
  1443. struct mld2_report *pmr;
  1444. struct mld2_grec *pgr = NULL;
  1445. struct ip6_sf_list *psf, *psf_next, *psf_prev, **psf_list;
  1446. int scount, stotal, first, isquery, truncate;
  1447. if (pmc->mca_flags & MAF_NOREPORT)
  1448. return skb;
  1449. isquery = type == MLD2_MODE_IS_INCLUDE ||
  1450. type == MLD2_MODE_IS_EXCLUDE;
  1451. truncate = type == MLD2_MODE_IS_EXCLUDE ||
  1452. type == MLD2_CHANGE_TO_EXCLUDE;
  1453. stotal = scount = 0;
  1454. psf_list = sdeleted ? &pmc->mca_tomb : &pmc->mca_sources;
  1455. if (!*psf_list)
  1456. goto empty_source;
  1457. pmr = skb ? (struct mld2_report *)skb_transport_header(skb) : NULL;
  1458. /* EX and TO_EX get a fresh packet, if needed */
  1459. if (truncate) {
  1460. if (pmr && pmr->mld2r_ngrec &&
  1461. AVAILABLE(skb) < grec_size(pmc, type, gdeleted, sdeleted)) {
  1462. if (skb)
  1463. mld_sendpack(skb);
  1464. skb = mld_newpack(idev, dev->mtu);
  1465. }
  1466. }
  1467. first = 1;
  1468. psf_prev = NULL;
  1469. for (psf = *psf_list; psf; psf = psf_next) {
  1470. struct in6_addr *psrc;
  1471. psf_next = psf->sf_next;
  1472. if (!is_in(pmc, psf, type, gdeleted, sdeleted)) {
  1473. psf_prev = psf;
  1474. continue;
  1475. }
  1476. /* clear marks on query responses */
  1477. if (isquery)
  1478. psf->sf_gsresp = 0;
  1479. if (AVAILABLE(skb) < sizeof(*psrc) +
  1480. first*sizeof(struct mld2_grec)) {
  1481. if (truncate && !first)
  1482. break; /* truncate these */
  1483. if (pgr)
  1484. pgr->grec_nsrcs = htons(scount);
  1485. if (skb)
  1486. mld_sendpack(skb);
  1487. skb = mld_newpack(idev, dev->mtu);
  1488. first = 1;
  1489. scount = 0;
  1490. }
  1491. if (first) {
  1492. skb = add_grhead(skb, pmc, type, &pgr);
  1493. first = 0;
  1494. }
  1495. if (!skb)
  1496. return NULL;
  1497. psrc = (struct in6_addr *)skb_put(skb, sizeof(*psrc));
  1498. *psrc = psf->sf_addr;
  1499. scount++; stotal++;
  1500. if ((type == MLD2_ALLOW_NEW_SOURCES ||
  1501. type == MLD2_BLOCK_OLD_SOURCES) && psf->sf_crcount) {
  1502. psf->sf_crcount--;
  1503. if ((sdeleted || gdeleted) && psf->sf_crcount == 0) {
  1504. if (psf_prev)
  1505. psf_prev->sf_next = psf->sf_next;
  1506. else
  1507. *psf_list = psf->sf_next;
  1508. kfree(psf);
  1509. continue;
  1510. }
  1511. }
  1512. psf_prev = psf;
  1513. }
  1514. empty_source:
  1515. if (!stotal) {
  1516. if (type == MLD2_ALLOW_NEW_SOURCES ||
  1517. type == MLD2_BLOCK_OLD_SOURCES)
  1518. return skb;
  1519. if (pmc->mca_crcount || isquery || crsend) {
  1520. /* make sure we have room for group header */
  1521. if (skb && AVAILABLE(skb) < sizeof(struct mld2_grec)) {
  1522. mld_sendpack(skb);
  1523. skb = NULL; /* add_grhead will get a new one */
  1524. }
  1525. skb = add_grhead(skb, pmc, type, &pgr);
  1526. }
  1527. }
  1528. if (pgr)
  1529. pgr->grec_nsrcs = htons(scount);
  1530. if (isquery)
  1531. pmc->mca_flags &= ~MAF_GSQUERY; /* clear query state */
  1532. return skb;
  1533. }
  1534. static void mld_send_report(struct inet6_dev *idev, struct ifmcaddr6 *pmc)
  1535. {
  1536. struct sk_buff *skb = NULL;
  1537. int type;
  1538. read_lock_bh(&idev->lock);
  1539. if (!pmc) {
  1540. for (pmc = idev->mc_list; pmc; pmc = pmc->next) {
  1541. if (pmc->mca_flags & MAF_NOREPORT)
  1542. continue;
  1543. spin_lock_bh(&pmc->mca_lock);
  1544. if (pmc->mca_sfcount[MCAST_EXCLUDE])
  1545. type = MLD2_MODE_IS_EXCLUDE;
  1546. else
  1547. type = MLD2_MODE_IS_INCLUDE;
  1548. skb = add_grec(skb, pmc, type, 0, 0, 0);
  1549. spin_unlock_bh(&pmc->mca_lock);
  1550. }
  1551. } else {
  1552. spin_lock_bh(&pmc->mca_lock);
  1553. if (pmc->mca_sfcount[MCAST_EXCLUDE])
  1554. type = MLD2_MODE_IS_EXCLUDE;
  1555. else
  1556. type = MLD2_MODE_IS_INCLUDE;
  1557. skb = add_grec(skb, pmc, type, 0, 0, 0);
  1558. spin_unlock_bh(&pmc->mca_lock);
  1559. }
  1560. read_unlock_bh(&idev->lock);
  1561. if (skb)
  1562. mld_sendpack(skb);
  1563. }
  1564. /*
  1565. * remove zero-count source records from a source filter list
  1566. */
  1567. static void mld_clear_zeros(struct ip6_sf_list **ppsf)
  1568. {
  1569. struct ip6_sf_list *psf_prev, *psf_next, *psf;
  1570. psf_prev = NULL;
  1571. for (psf = *ppsf; psf; psf = psf_next) {
  1572. psf_next = psf->sf_next;
  1573. if (psf->sf_crcount == 0) {
  1574. if (psf_prev)
  1575. psf_prev->sf_next = psf->sf_next;
  1576. else
  1577. *ppsf = psf->sf_next;
  1578. kfree(psf);
  1579. } else
  1580. psf_prev = psf;
  1581. }
  1582. }
  1583. static void mld_send_cr(struct inet6_dev *idev)
  1584. {
  1585. struct ifmcaddr6 *pmc, *pmc_prev, *pmc_next;
  1586. struct sk_buff *skb = NULL;
  1587. int type, dtype;
  1588. read_lock_bh(&idev->lock);
  1589. spin_lock(&idev->mc_lock);
  1590. /* deleted MCA's */
  1591. pmc_prev = NULL;
  1592. for (pmc = idev->mc_tomb; pmc; pmc = pmc_next) {
  1593. pmc_next = pmc->next;
  1594. if (pmc->mca_sfmode == MCAST_INCLUDE) {
  1595. type = MLD2_BLOCK_OLD_SOURCES;
  1596. dtype = MLD2_BLOCK_OLD_SOURCES;
  1597. skb = add_grec(skb, pmc, type, 1, 0, 0);
  1598. skb = add_grec(skb, pmc, dtype, 1, 1, 0);
  1599. }
  1600. if (pmc->mca_crcount) {
  1601. if (pmc->mca_sfmode == MCAST_EXCLUDE) {
  1602. type = MLD2_CHANGE_TO_INCLUDE;
  1603. skb = add_grec(skb, pmc, type, 1, 0, 0);
  1604. }
  1605. pmc->mca_crcount--;
  1606. if (pmc->mca_crcount == 0) {
  1607. mld_clear_zeros(&pmc->mca_tomb);
  1608. mld_clear_zeros(&pmc->mca_sources);
  1609. }
  1610. }
  1611. if (pmc->mca_crcount == 0 && !pmc->mca_tomb &&
  1612. !pmc->mca_sources) {
  1613. if (pmc_prev)
  1614. pmc_prev->next = pmc_next;
  1615. else
  1616. idev->mc_tomb = pmc_next;
  1617. in6_dev_put(pmc->idev);
  1618. kfree(pmc);
  1619. } else
  1620. pmc_prev = pmc;
  1621. }
  1622. spin_unlock(&idev->mc_lock);
  1623. /* change recs */
  1624. for (pmc = idev->mc_list; pmc; pmc = pmc->next) {
  1625. spin_lock_bh(&pmc->mca_lock);
  1626. if (pmc->mca_sfcount[MCAST_EXCLUDE]) {
  1627. type = MLD2_BLOCK_OLD_SOURCES;
  1628. dtype = MLD2_ALLOW_NEW_SOURCES;
  1629. } else {
  1630. type = MLD2_ALLOW_NEW_SOURCES;
  1631. dtype = MLD2_BLOCK_OLD_SOURCES;
  1632. }
  1633. skb = add_grec(skb, pmc, type, 0, 0, 0);
  1634. skb = add_grec(skb, pmc, dtype, 0, 1, 0); /* deleted sources */
  1635. /* filter mode changes */
  1636. if (pmc->mca_crcount) {
  1637. if (pmc->mca_sfmode == MCAST_EXCLUDE)
  1638. type = MLD2_CHANGE_TO_EXCLUDE;
  1639. else
  1640. type = MLD2_CHANGE_TO_INCLUDE;
  1641. skb = add_grec(skb, pmc, type, 0, 0, 0);
  1642. pmc->mca_crcount--;
  1643. }
  1644. spin_unlock_bh(&pmc->mca_lock);
  1645. }
  1646. read_unlock_bh(&idev->lock);
  1647. if (!skb)
  1648. return;
  1649. (void) mld_sendpack(skb);
  1650. }
  1651. static void igmp6_send(struct in6_addr *addr, struct net_device *dev, int type)
  1652. {
  1653. struct net *net = dev_net(dev);
  1654. struct sock *sk = net->ipv6.igmp_sk;
  1655. struct inet6_dev *idev;
  1656. struct sk_buff *skb;
  1657. struct mld_msg *hdr;
  1658. const struct in6_addr *snd_addr, *saddr;
  1659. struct in6_addr addr_buf;
  1660. int hlen = LL_RESERVED_SPACE(dev);
  1661. int tlen = dev->needed_tailroom;
  1662. int err, len, payload_len, full_len;
  1663. u8 ra[8] = { IPPROTO_ICMPV6, 0,
  1664. IPV6_TLV_ROUTERALERT, 2, 0, 0,
  1665. IPV6_TLV_PADN, 0 };
  1666. struct flowi6 fl6;
  1667. struct dst_entry *dst;
  1668. if (type == ICMPV6_MGM_REDUCTION)
  1669. snd_addr = &in6addr_linklocal_allrouters;
  1670. else
  1671. snd_addr = addr;
  1672. len = sizeof(struct icmp6hdr) + sizeof(struct in6_addr);
  1673. payload_len = len + sizeof(ra);
  1674. full_len = sizeof(struct ipv6hdr) + payload_len;
  1675. rcu_read_lock();
  1676. IP6_UPD_PO_STATS(net, __in6_dev_get(dev),
  1677. IPSTATS_MIB_OUT, full_len);
  1678. rcu_read_unlock();
  1679. skb = sock_alloc_send_skb(sk, hlen + tlen + full_len, 1, &err);
  1680. if (!skb) {
  1681. rcu_read_lock();
  1682. IP6_INC_STATS(net, __in6_dev_get(dev),
  1683. IPSTATS_MIB_OUTDISCARDS);
  1684. rcu_read_unlock();
  1685. return;
  1686. }
  1687. skb->priority = TC_PRIO_CONTROL;
  1688. skb_reserve(skb, hlen);
  1689. if (ipv6_get_lladdr(dev, &addr_buf, IFA_F_TENTATIVE)) {
  1690. /* <draft-ietf-magma-mld-source-05.txt>:
  1691. * use unspecified address as the source address
  1692. * when a valid link-local address is not available.
  1693. */
  1694. saddr = &in6addr_any;
  1695. } else
  1696. saddr = &addr_buf;
  1697. ip6_mc_hdr(sk, skb, dev, saddr, snd_addr, NEXTHDR_HOP, payload_len);
  1698. memcpy(skb_put(skb, sizeof(ra)), ra, sizeof(ra));
  1699. hdr = (struct mld_msg *) skb_put(skb, sizeof(struct mld_msg));
  1700. memset(hdr, 0, sizeof(struct mld_msg));
  1701. hdr->mld_type = type;
  1702. hdr->mld_mca = *addr;
  1703. hdr->mld_cksum = csum_ipv6_magic(saddr, snd_addr, len,
  1704. IPPROTO_ICMPV6,
  1705. csum_partial(hdr, len, 0));
  1706. rcu_read_lock();
  1707. idev = __in6_dev_get(skb->dev);
  1708. icmpv6_flow_init(sk, &fl6, type,
  1709. &ipv6_hdr(skb)->saddr, &ipv6_hdr(skb)->daddr,
  1710. skb->dev->ifindex);
  1711. dst = icmp6_dst_alloc(skb->dev, &fl6);
  1712. if (IS_ERR(dst)) {
  1713. err = PTR_ERR(dst);
  1714. goto err_out;
  1715. }
  1716. skb_dst_set(skb, dst);
  1717. err = NF_HOOK(NFPROTO_IPV6, NF_INET_LOCAL_OUT,
  1718. net, sk, skb, NULL, skb->dev,
  1719. dst_output);
  1720. out:
  1721. if (!err) {
  1722. ICMP6MSGOUT_INC_STATS(net, idev, type);
  1723. ICMP6_INC_STATS(net, idev, ICMP6_MIB_OUTMSGS);
  1724. } else
  1725. IP6_INC_STATS(net, idev, IPSTATS_MIB_OUTDISCARDS);
  1726. rcu_read_unlock();
  1727. return;
  1728. err_out:
  1729. kfree_skb(skb);
  1730. goto out;
  1731. }
  1732. static void mld_send_initial_cr(struct inet6_dev *idev)
  1733. {
  1734. struct sk_buff *skb;
  1735. struct ifmcaddr6 *pmc;
  1736. int type;
  1737. if (mld_in_v1_mode(idev))
  1738. return;
  1739. skb = NULL;
  1740. read_lock_bh(&idev->lock);
  1741. for (pmc = idev->mc_list; pmc; pmc = pmc->next) {
  1742. spin_lock_bh(&pmc->mca_lock);
  1743. if (pmc->mca_sfcount[MCAST_EXCLUDE])
  1744. type = MLD2_CHANGE_TO_EXCLUDE;
  1745. else
  1746. type = MLD2_CHANGE_TO_INCLUDE;
  1747. skb = add_grec(skb, pmc, type, 0, 0, 1);
  1748. spin_unlock_bh(&pmc->mca_lock);
  1749. }
  1750. read_unlock_bh(&idev->lock);
  1751. if (skb)
  1752. mld_sendpack(skb);
  1753. }
  1754. void ipv6_mc_dad_complete(struct inet6_dev *idev)
  1755. {
  1756. idev->mc_dad_count = idev->mc_qrv;
  1757. if (idev->mc_dad_count) {
  1758. mld_send_initial_cr(idev);
  1759. idev->mc_dad_count--;
  1760. if (idev->mc_dad_count)
  1761. mld_dad_start_timer(idev, idev->mc_maxdelay);
  1762. }
  1763. }
  1764. static void mld_dad_timer_expire(unsigned long data)
  1765. {
  1766. struct inet6_dev *idev = (struct inet6_dev *)data;
  1767. mld_send_initial_cr(idev);
  1768. if (idev->mc_dad_count) {
  1769. idev->mc_dad_count--;
  1770. if (idev->mc_dad_count)
  1771. mld_dad_start_timer(idev, idev->mc_maxdelay);
  1772. }
  1773. in6_dev_put(idev);
  1774. }
  1775. static int ip6_mc_del1_src(struct ifmcaddr6 *pmc, int sfmode,
  1776. const struct in6_addr *psfsrc)
  1777. {
  1778. struct ip6_sf_list *psf, *psf_prev;
  1779. int rv = 0;
  1780. psf_prev = NULL;
  1781. for (psf = pmc->mca_sources; psf; psf = psf->sf_next) {
  1782. if (ipv6_addr_equal(&psf->sf_addr, psfsrc))
  1783. break;
  1784. psf_prev = psf;
  1785. }
  1786. if (!psf || psf->sf_count[sfmode] == 0) {
  1787. /* source filter not found, or count wrong => bug */
  1788. return -ESRCH;
  1789. }
  1790. psf->sf_count[sfmode]--;
  1791. if (!psf->sf_count[MCAST_INCLUDE] && !psf->sf_count[MCAST_EXCLUDE]) {
  1792. struct inet6_dev *idev = pmc->idev;
  1793. /* no more filters for this source */
  1794. if (psf_prev)
  1795. psf_prev->sf_next = psf->sf_next;
  1796. else
  1797. pmc->mca_sources = psf->sf_next;
  1798. if (psf->sf_oldin && !(pmc->mca_flags & MAF_NOREPORT) &&
  1799. !mld_in_v1_mode(idev)) {
  1800. psf->sf_crcount = idev->mc_qrv;
  1801. psf->sf_next = pmc->mca_tomb;
  1802. pmc->mca_tomb = psf;
  1803. rv = 1;
  1804. } else
  1805. kfree(psf);
  1806. }
  1807. return rv;
  1808. }
  1809. static int ip6_mc_del_src(struct inet6_dev *idev, const struct in6_addr *pmca,
  1810. int sfmode, int sfcount, const struct in6_addr *psfsrc,
  1811. int delta)
  1812. {
  1813. struct ifmcaddr6 *pmc;
  1814. int changerec = 0;
  1815. int i, err;
  1816. if (!idev)
  1817. return -ENODEV;
  1818. read_lock_bh(&idev->lock);
  1819. for (pmc = idev->mc_list; pmc; pmc = pmc->next) {
  1820. if (ipv6_addr_equal(pmca, &pmc->mca_addr))
  1821. break;
  1822. }
  1823. if (!pmc) {
  1824. /* MCA not found?? bug */
  1825. read_unlock_bh(&idev->lock);
  1826. return -ESRCH;
  1827. }
  1828. spin_lock_bh(&pmc->mca_lock);
  1829. sf_markstate(pmc);
  1830. if (!delta) {
  1831. if (!pmc->mca_sfcount[sfmode]) {
  1832. spin_unlock_bh(&pmc->mca_lock);
  1833. read_unlock_bh(&idev->lock);
  1834. return -EINVAL;
  1835. }
  1836. pmc->mca_sfcount[sfmode]--;
  1837. }
  1838. err = 0;
  1839. for (i = 0; i < sfcount; i++) {
  1840. int rv = ip6_mc_del1_src(pmc, sfmode, &psfsrc[i]);
  1841. changerec |= rv > 0;
  1842. if (!err && rv < 0)
  1843. err = rv;
  1844. }
  1845. if (pmc->mca_sfmode == MCAST_EXCLUDE &&
  1846. pmc->mca_sfcount[MCAST_EXCLUDE] == 0 &&
  1847. pmc->mca_sfcount[MCAST_INCLUDE]) {
  1848. struct ip6_sf_list *psf;
  1849. /* filter mode change */
  1850. pmc->mca_sfmode = MCAST_INCLUDE;
  1851. pmc->mca_crcount = idev->mc_qrv;
  1852. idev->mc_ifc_count = pmc->mca_crcount;
  1853. for (psf = pmc->mca_sources; psf; psf = psf->sf_next)
  1854. psf->sf_crcount = 0;
  1855. mld_ifc_event(pmc->idev);
  1856. } else if (sf_setstate(pmc) || changerec)
  1857. mld_ifc_event(pmc->idev);
  1858. spin_unlock_bh(&pmc->mca_lock);
  1859. read_unlock_bh(&idev->lock);
  1860. return err;
  1861. }
  1862. /*
  1863. * Add multicast single-source filter to the interface list
  1864. */
  1865. static int ip6_mc_add1_src(struct ifmcaddr6 *pmc, int sfmode,
  1866. const struct in6_addr *psfsrc)
  1867. {
  1868. struct ip6_sf_list *psf, *psf_prev;
  1869. psf_prev = NULL;
  1870. for (psf = pmc->mca_sources; psf; psf = psf->sf_next) {
  1871. if (ipv6_addr_equal(&psf->sf_addr, psfsrc))
  1872. break;
  1873. psf_prev = psf;
  1874. }
  1875. if (!psf) {
  1876. psf = kzalloc(sizeof(*psf), GFP_ATOMIC);
  1877. if (!psf)
  1878. return -ENOBUFS;
  1879. psf->sf_addr = *psfsrc;
  1880. if (psf_prev) {
  1881. psf_prev->sf_next = psf;
  1882. } else
  1883. pmc->mca_sources = psf;
  1884. }
  1885. psf->sf_count[sfmode]++;
  1886. return 0;
  1887. }
  1888. static void sf_markstate(struct ifmcaddr6 *pmc)
  1889. {
  1890. struct ip6_sf_list *psf;
  1891. int mca_xcount = pmc->mca_sfcount[MCAST_EXCLUDE];
  1892. for (psf = pmc->mca_sources; psf; psf = psf->sf_next)
  1893. if (pmc->mca_sfcount[MCAST_EXCLUDE]) {
  1894. psf->sf_oldin = mca_xcount ==
  1895. psf->sf_count[MCAST_EXCLUDE] &&
  1896. !psf->sf_count[MCAST_INCLUDE];
  1897. } else
  1898. psf->sf_oldin = psf->sf_count[MCAST_INCLUDE] != 0;
  1899. }
  1900. static int sf_setstate(struct ifmcaddr6 *pmc)
  1901. {
  1902. struct ip6_sf_list *psf, *dpsf;
  1903. int mca_xcount = pmc->mca_sfcount[MCAST_EXCLUDE];
  1904. int qrv = pmc->idev->mc_qrv;
  1905. int new_in, rv;
  1906. rv = 0;
  1907. for (psf = pmc->mca_sources; psf; psf = psf->sf_next) {
  1908. if (pmc->mca_sfcount[MCAST_EXCLUDE]) {
  1909. new_in = mca_xcount == psf->sf_count[MCAST_EXCLUDE] &&
  1910. !psf->sf_count[MCAST_INCLUDE];
  1911. } else
  1912. new_in = psf->sf_count[MCAST_INCLUDE] != 0;
  1913. if (new_in) {
  1914. if (!psf->sf_oldin) {
  1915. struct ip6_sf_list *prev = NULL;
  1916. for (dpsf = pmc->mca_tomb; dpsf;
  1917. dpsf = dpsf->sf_next) {
  1918. if (ipv6_addr_equal(&dpsf->sf_addr,
  1919. &psf->sf_addr))
  1920. break;
  1921. prev = dpsf;
  1922. }
  1923. if (dpsf) {
  1924. if (prev)
  1925. prev->sf_next = dpsf->sf_next;
  1926. else
  1927. pmc->mca_tomb = dpsf->sf_next;
  1928. kfree(dpsf);
  1929. }
  1930. psf->sf_crcount = qrv;
  1931. rv++;
  1932. }
  1933. } else if (psf->sf_oldin) {
  1934. psf->sf_crcount = 0;
  1935. /*
  1936. * add or update "delete" records if an active filter
  1937. * is now inactive
  1938. */
  1939. for (dpsf = pmc->mca_tomb; dpsf; dpsf = dpsf->sf_next)
  1940. if (ipv6_addr_equal(&dpsf->sf_addr,
  1941. &psf->sf_addr))
  1942. break;
  1943. if (!dpsf) {
  1944. dpsf = kmalloc(sizeof(*dpsf), GFP_ATOMIC);
  1945. if (!dpsf)
  1946. continue;
  1947. *dpsf = *psf;
  1948. /* pmc->mca_lock held by callers */
  1949. dpsf->sf_next = pmc->mca_tomb;
  1950. pmc->mca_tomb = dpsf;
  1951. }
  1952. dpsf->sf_crcount = qrv;
  1953. rv++;
  1954. }
  1955. }
  1956. return rv;
  1957. }
  1958. /*
  1959. * Add multicast source filter list to the interface list
  1960. */
  1961. static int ip6_mc_add_src(struct inet6_dev *idev, const struct in6_addr *pmca,
  1962. int sfmode, int sfcount, const struct in6_addr *psfsrc,
  1963. int delta)
  1964. {
  1965. struct ifmcaddr6 *pmc;
  1966. int isexclude;
  1967. int i, err;
  1968. if (!idev)
  1969. return -ENODEV;
  1970. read_lock_bh(&idev->lock);
  1971. for (pmc = idev->mc_list; pmc; pmc = pmc->next) {
  1972. if (ipv6_addr_equal(pmca, &pmc->mca_addr))
  1973. break;
  1974. }
  1975. if (!pmc) {
  1976. /* MCA not found?? bug */
  1977. read_unlock_bh(&idev->lock);
  1978. return -ESRCH;
  1979. }
  1980. spin_lock_bh(&pmc->mca_lock);
  1981. sf_markstate(pmc);
  1982. isexclude = pmc->mca_sfmode == MCAST_EXCLUDE;
  1983. if (!delta)
  1984. pmc->mca_sfcount[sfmode]++;
  1985. err = 0;
  1986. for (i = 0; i < sfcount; i++) {
  1987. err = ip6_mc_add1_src(pmc, sfmode, &psfsrc[i]);
  1988. if (err)
  1989. break;
  1990. }
  1991. if (err) {
  1992. int j;
  1993. if (!delta)
  1994. pmc->mca_sfcount[sfmode]--;
  1995. for (j = 0; j < i; j++)
  1996. ip6_mc_del1_src(pmc, sfmode, &psfsrc[j]);
  1997. } else if (isexclude != (pmc->mca_sfcount[MCAST_EXCLUDE] != 0)) {
  1998. struct ip6_sf_list *psf;
  1999. /* filter mode change */
  2000. if (pmc->mca_sfcount[MCAST_EXCLUDE])
  2001. pmc->mca_sfmode = MCAST_EXCLUDE;
  2002. else if (pmc->mca_sfcount[MCAST_INCLUDE])
  2003. pmc->mca_sfmode = MCAST_INCLUDE;
  2004. /* else no filters; keep old mode for reports */
  2005. pmc->mca_crcount = idev->mc_qrv;
  2006. idev->mc_ifc_count = pmc->mca_crcount;
  2007. for (psf = pmc->mca_sources; psf; psf = psf->sf_next)
  2008. psf->sf_crcount = 0;
  2009. mld_ifc_event(idev);
  2010. } else if (sf_setstate(pmc))
  2011. mld_ifc_event(idev);
  2012. spin_unlock_bh(&pmc->mca_lock);
  2013. read_unlock_bh(&idev->lock);
  2014. return err;
  2015. }
  2016. static void ip6_mc_clear_src(struct ifmcaddr6 *pmc)
  2017. {
  2018. struct ip6_sf_list *psf, *nextpsf;
  2019. for (psf = pmc->mca_tomb; psf; psf = nextpsf) {
  2020. nextpsf = psf->sf_next;
  2021. kfree(psf);
  2022. }
  2023. pmc->mca_tomb = NULL;
  2024. for (psf = pmc->mca_sources; psf; psf = nextpsf) {
  2025. nextpsf = psf->sf_next;
  2026. kfree(psf);
  2027. }
  2028. pmc->mca_sources = NULL;
  2029. pmc->mca_sfmode = MCAST_EXCLUDE;
  2030. pmc->mca_sfcount[MCAST_INCLUDE] = 0;
  2031. pmc->mca_sfcount[MCAST_EXCLUDE] = 1;
  2032. }
  2033. static void igmp6_join_group(struct ifmcaddr6 *ma)
  2034. {
  2035. unsigned long delay;
  2036. if (ma->mca_flags & MAF_NOREPORT)
  2037. return;
  2038. igmp6_send(&ma->mca_addr, ma->idev->dev, ICMPV6_MGM_REPORT);
  2039. delay = prandom_u32() % unsolicited_report_interval(ma->idev);
  2040. spin_lock_bh(&ma->mca_lock);
  2041. if (del_timer(&ma->mca_timer)) {
  2042. atomic_dec(&ma->mca_refcnt);
  2043. delay = ma->mca_timer.expires - jiffies;
  2044. }
  2045. if (!mod_timer(&ma->mca_timer, jiffies + delay))
  2046. atomic_inc(&ma->mca_refcnt);
  2047. ma->mca_flags |= MAF_TIMER_RUNNING | MAF_LAST_REPORTER;
  2048. spin_unlock_bh(&ma->mca_lock);
  2049. }
  2050. static int ip6_mc_leave_src(struct sock *sk, struct ipv6_mc_socklist *iml,
  2051. struct inet6_dev *idev)
  2052. {
  2053. int err;
  2054. /* callers have the socket lock and rtnl lock
  2055. * so no other readers or writers of iml or its sflist
  2056. */
  2057. if (!iml->sflist) {
  2058. /* any-source empty exclude case */
  2059. return ip6_mc_del_src(idev, &iml->addr, iml->sfmode, 0, NULL, 0);
  2060. }
  2061. err = ip6_mc_del_src(idev, &iml->addr, iml->sfmode,
  2062. iml->sflist->sl_count, iml->sflist->sl_addr, 0);
  2063. sock_kfree_s(sk, iml->sflist, IP6_SFLSIZE(iml->sflist->sl_max));
  2064. iml->sflist = NULL;
  2065. return err;
  2066. }
  2067. static void igmp6_leave_group(struct ifmcaddr6 *ma)
  2068. {
  2069. if (mld_in_v1_mode(ma->idev)) {
  2070. if (ma->mca_flags & MAF_LAST_REPORTER)
  2071. igmp6_send(&ma->mca_addr, ma->idev->dev,
  2072. ICMPV6_MGM_REDUCTION);
  2073. } else {
  2074. mld_add_delrec(ma->idev, ma);
  2075. mld_ifc_event(ma->idev);
  2076. }
  2077. }
  2078. static void mld_gq_timer_expire(unsigned long data)
  2079. {
  2080. struct inet6_dev *idev = (struct inet6_dev *)data;
  2081. idev->mc_gq_running = 0;
  2082. mld_send_report(idev, NULL);
  2083. in6_dev_put(idev);
  2084. }
  2085. static void mld_ifc_timer_expire(unsigned long data)
  2086. {
  2087. struct inet6_dev *idev = (struct inet6_dev *)data;
  2088. mld_send_cr(idev);
  2089. if (idev->mc_ifc_count) {
  2090. idev->mc_ifc_count--;
  2091. if (idev->mc_ifc_count)
  2092. mld_ifc_start_timer(idev, idev->mc_maxdelay);
  2093. }
  2094. in6_dev_put(idev);
  2095. }
  2096. static void mld_ifc_event(struct inet6_dev *idev)
  2097. {
  2098. if (mld_in_v1_mode(idev))
  2099. return;
  2100. idev->mc_ifc_count = idev->mc_qrv;
  2101. mld_ifc_start_timer(idev, 1);
  2102. }
  2103. static void igmp6_timer_handler(unsigned long data)
  2104. {
  2105. struct ifmcaddr6 *ma = (struct ifmcaddr6 *) data;
  2106. if (mld_in_v1_mode(ma->idev))
  2107. igmp6_send(&ma->mca_addr, ma->idev->dev, ICMPV6_MGM_REPORT);
  2108. else
  2109. mld_send_report(ma->idev, ma);
  2110. spin_lock(&ma->mca_lock);
  2111. ma->mca_flags |= MAF_LAST_REPORTER;
  2112. ma->mca_flags &= ~MAF_TIMER_RUNNING;
  2113. spin_unlock(&ma->mca_lock);
  2114. ma_put(ma);
  2115. }
  2116. /* Device changing type */
  2117. void ipv6_mc_unmap(struct inet6_dev *idev)
  2118. {
  2119. struct ifmcaddr6 *i;
  2120. /* Install multicast list, except for all-nodes (already installed) */
  2121. read_lock_bh(&idev->lock);
  2122. for (i = idev->mc_list; i; i = i->next)
  2123. igmp6_group_dropped(i);
  2124. read_unlock_bh(&idev->lock);
  2125. }
  2126. void ipv6_mc_remap(struct inet6_dev *idev)
  2127. {
  2128. ipv6_mc_up(idev);
  2129. }
  2130. /* Device going down */
  2131. void ipv6_mc_down(struct inet6_dev *idev)
  2132. {
  2133. struct ifmcaddr6 *i;
  2134. /* Withdraw multicast list */
  2135. read_lock_bh(&idev->lock);
  2136. mld_ifc_stop_timer(idev);
  2137. mld_gq_stop_timer(idev);
  2138. mld_dad_stop_timer(idev);
  2139. for (i = idev->mc_list; i; i = i->next)
  2140. igmp6_group_dropped(i);
  2141. read_unlock_bh(&idev->lock);
  2142. mld_clear_delrec(idev);
  2143. }
  2144. static void ipv6_mc_reset(struct inet6_dev *idev)
  2145. {
  2146. idev->mc_qrv = sysctl_mld_qrv;
  2147. idev->mc_qi = MLD_QI_DEFAULT;
  2148. idev->mc_qri = MLD_QRI_DEFAULT;
  2149. idev->mc_v1_seen = 0;
  2150. idev->mc_maxdelay = unsolicited_report_interval(idev);
  2151. }
  2152. /* Device going up */
  2153. void ipv6_mc_up(struct inet6_dev *idev)
  2154. {
  2155. struct ifmcaddr6 *i;
  2156. /* Install multicast list, except for all-nodes (already installed) */
  2157. read_lock_bh(&idev->lock);
  2158. ipv6_mc_reset(idev);
  2159. for (i = idev->mc_list; i; i = i->next)
  2160. igmp6_group_added(i);
  2161. read_unlock_bh(&idev->lock);
  2162. }
  2163. /* IPv6 device initialization. */
  2164. void ipv6_mc_init_dev(struct inet6_dev *idev)
  2165. {
  2166. write_lock_bh(&idev->lock);
  2167. spin_lock_init(&idev->mc_lock);
  2168. idev->mc_gq_running = 0;
  2169. setup_timer(&idev->mc_gq_timer, mld_gq_timer_expire,
  2170. (unsigned long)idev);
  2171. idev->mc_tomb = NULL;
  2172. idev->mc_ifc_count = 0;
  2173. setup_timer(&idev->mc_ifc_timer, mld_ifc_timer_expire,
  2174. (unsigned long)idev);
  2175. setup_timer(&idev->mc_dad_timer, mld_dad_timer_expire,
  2176. (unsigned long)idev);
  2177. ipv6_mc_reset(idev);
  2178. write_unlock_bh(&idev->lock);
  2179. }
  2180. /*
  2181. * Device is about to be destroyed: clean up.
  2182. */
  2183. void ipv6_mc_destroy_dev(struct inet6_dev *idev)
  2184. {
  2185. struct ifmcaddr6 *i;
  2186. /* Deactivate timers */
  2187. ipv6_mc_down(idev);
  2188. /* Delete all-nodes address. */
  2189. /* We cannot call ipv6_dev_mc_dec() directly, our caller in
  2190. * addrconf.c has NULL'd out dev->ip6_ptr so in6_dev_get() will
  2191. * fail.
  2192. */
  2193. __ipv6_dev_mc_dec(idev, &in6addr_linklocal_allnodes);
  2194. if (idev->cnf.forwarding)
  2195. __ipv6_dev_mc_dec(idev, &in6addr_linklocal_allrouters);
  2196. write_lock_bh(&idev->lock);
  2197. while ((i = idev->mc_list) != NULL) {
  2198. idev->mc_list = i->next;
  2199. write_unlock_bh(&idev->lock);
  2200. igmp6_group_dropped(i);
  2201. ma_put(i);
  2202. write_lock_bh(&idev->lock);
  2203. }
  2204. write_unlock_bh(&idev->lock);
  2205. }
  2206. #ifdef CONFIG_PROC_FS
  2207. struct igmp6_mc_iter_state {
  2208. struct seq_net_private p;
  2209. struct net_device *dev;
  2210. struct inet6_dev *idev;
  2211. };
  2212. #define igmp6_mc_seq_private(seq) ((struct igmp6_mc_iter_state *)(seq)->private)
  2213. static inline struct ifmcaddr6 *igmp6_mc_get_first(struct seq_file *seq)
  2214. {
  2215. struct ifmcaddr6 *im = NULL;
  2216. struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
  2217. struct net *net = seq_file_net(seq);
  2218. state->idev = NULL;
  2219. for_each_netdev_rcu(net, state->dev) {
  2220. struct inet6_dev *idev;
  2221. idev = __in6_dev_get(state->dev);
  2222. if (!idev)
  2223. continue;
  2224. read_lock_bh(&idev->lock);
  2225. im = idev->mc_list;
  2226. if (im) {
  2227. state->idev = idev;
  2228. break;
  2229. }
  2230. read_unlock_bh(&idev->lock);
  2231. }
  2232. return im;
  2233. }
  2234. static struct ifmcaddr6 *igmp6_mc_get_next(struct seq_file *seq, struct ifmcaddr6 *im)
  2235. {
  2236. struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
  2237. im = im->next;
  2238. while (!im) {
  2239. if (likely(state->idev))
  2240. read_unlock_bh(&state->idev->lock);
  2241. state->dev = next_net_device_rcu(state->dev);
  2242. if (!state->dev) {
  2243. state->idev = NULL;
  2244. break;
  2245. }
  2246. state->idev = __in6_dev_get(state->dev);
  2247. if (!state->idev)
  2248. continue;
  2249. read_lock_bh(&state->idev->lock);
  2250. im = state->idev->mc_list;
  2251. }
  2252. return im;
  2253. }
  2254. static struct ifmcaddr6 *igmp6_mc_get_idx(struct seq_file *seq, loff_t pos)
  2255. {
  2256. struct ifmcaddr6 *im = igmp6_mc_get_first(seq);
  2257. if (im)
  2258. while (pos && (im = igmp6_mc_get_next(seq, im)) != NULL)
  2259. --pos;
  2260. return pos ? NULL : im;
  2261. }
  2262. static void *igmp6_mc_seq_start(struct seq_file *seq, loff_t *pos)
  2263. __acquires(RCU)
  2264. {
  2265. rcu_read_lock();
  2266. return igmp6_mc_get_idx(seq, *pos);
  2267. }
  2268. static void *igmp6_mc_seq_next(struct seq_file *seq, void *v, loff_t *pos)
  2269. {
  2270. struct ifmcaddr6 *im = igmp6_mc_get_next(seq, v);
  2271. ++*pos;
  2272. return im;
  2273. }
  2274. static void igmp6_mc_seq_stop(struct seq_file *seq, void *v)
  2275. __releases(RCU)
  2276. {
  2277. struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
  2278. if (likely(state->idev)) {
  2279. read_unlock_bh(&state->idev->lock);
  2280. state->idev = NULL;
  2281. }
  2282. state->dev = NULL;
  2283. rcu_read_unlock();
  2284. }
  2285. static int igmp6_mc_seq_show(struct seq_file *seq, void *v)
  2286. {
  2287. struct ifmcaddr6 *im = (struct ifmcaddr6 *)v;
  2288. struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
  2289. seq_printf(seq,
  2290. "%-4d %-15s %pi6 %5d %08X %ld\n",
  2291. state->dev->ifindex, state->dev->name,
  2292. &im->mca_addr,
  2293. im->mca_users, im->mca_flags,
  2294. (im->mca_flags&MAF_TIMER_RUNNING) ?
  2295. jiffies_to_clock_t(im->mca_timer.expires-jiffies) : 0);
  2296. return 0;
  2297. }
  2298. static const struct seq_operations igmp6_mc_seq_ops = {
  2299. .start = igmp6_mc_seq_start,
  2300. .next = igmp6_mc_seq_next,
  2301. .stop = igmp6_mc_seq_stop,
  2302. .show = igmp6_mc_seq_show,
  2303. };
  2304. static int igmp6_mc_seq_open(struct inode *inode, struct file *file)
  2305. {
  2306. return seq_open_net(inode, file, &igmp6_mc_seq_ops,
  2307. sizeof(struct igmp6_mc_iter_state));
  2308. }
  2309. static const struct file_operations igmp6_mc_seq_fops = {
  2310. .owner = THIS_MODULE,
  2311. .open = igmp6_mc_seq_open,
  2312. .read = seq_read,
  2313. .llseek = seq_lseek,
  2314. .release = seq_release_net,
  2315. };
  2316. struct igmp6_mcf_iter_state {
  2317. struct seq_net_private p;
  2318. struct net_device *dev;
  2319. struct inet6_dev *idev;
  2320. struct ifmcaddr6 *im;
  2321. };
  2322. #define igmp6_mcf_seq_private(seq) ((struct igmp6_mcf_iter_state *)(seq)->private)
  2323. static inline struct ip6_sf_list *igmp6_mcf_get_first(struct seq_file *seq)
  2324. {
  2325. struct ip6_sf_list *psf = NULL;
  2326. struct ifmcaddr6 *im = NULL;
  2327. struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
  2328. struct net *net = seq_file_net(seq);
  2329. state->idev = NULL;
  2330. state->im = NULL;
  2331. for_each_netdev_rcu(net, state->dev) {
  2332. struct inet6_dev *idev;
  2333. idev = __in6_dev_get(state->dev);
  2334. if (unlikely(idev == NULL))
  2335. continue;
  2336. read_lock_bh(&idev->lock);
  2337. im = idev->mc_list;
  2338. if (likely(im)) {
  2339. spin_lock_bh(&im->mca_lock);
  2340. psf = im->mca_sources;
  2341. if (likely(psf)) {
  2342. state->im = im;
  2343. state->idev = idev;
  2344. break;
  2345. }
  2346. spin_unlock_bh(&im->mca_lock);
  2347. }
  2348. read_unlock_bh(&idev->lock);
  2349. }
  2350. return psf;
  2351. }
  2352. static struct ip6_sf_list *igmp6_mcf_get_next(struct seq_file *seq, struct ip6_sf_list *psf)
  2353. {
  2354. struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
  2355. psf = psf->sf_next;
  2356. while (!psf) {
  2357. spin_unlock_bh(&state->im->mca_lock);
  2358. state->im = state->im->next;
  2359. while (!state->im) {
  2360. if (likely(state->idev))
  2361. read_unlock_bh(&state->idev->lock);
  2362. state->dev = next_net_device_rcu(state->dev);
  2363. if (!state->dev) {
  2364. state->idev = NULL;
  2365. goto out;
  2366. }
  2367. state->idev = __in6_dev_get(state->dev);
  2368. if (!state->idev)
  2369. continue;
  2370. read_lock_bh(&state->idev->lock);
  2371. state->im = state->idev->mc_list;
  2372. }
  2373. if (!state->im)
  2374. break;
  2375. spin_lock_bh(&state->im->mca_lock);
  2376. psf = state->im->mca_sources;
  2377. }
  2378. out:
  2379. return psf;
  2380. }
  2381. static struct ip6_sf_list *igmp6_mcf_get_idx(struct seq_file *seq, loff_t pos)
  2382. {
  2383. struct ip6_sf_list *psf = igmp6_mcf_get_first(seq);
  2384. if (psf)
  2385. while (pos && (psf = igmp6_mcf_get_next(seq, psf)) != NULL)
  2386. --pos;
  2387. return pos ? NULL : psf;
  2388. }
  2389. static void *igmp6_mcf_seq_start(struct seq_file *seq, loff_t *pos)
  2390. __acquires(RCU)
  2391. {
  2392. rcu_read_lock();
  2393. return *pos ? igmp6_mcf_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
  2394. }
  2395. static void *igmp6_mcf_seq_next(struct seq_file *seq, void *v, loff_t *pos)
  2396. {
  2397. struct ip6_sf_list *psf;
  2398. if (v == SEQ_START_TOKEN)
  2399. psf = igmp6_mcf_get_first(seq);
  2400. else
  2401. psf = igmp6_mcf_get_next(seq, v);
  2402. ++*pos;
  2403. return psf;
  2404. }
  2405. static void igmp6_mcf_seq_stop(struct seq_file *seq, void *v)
  2406. __releases(RCU)
  2407. {
  2408. struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
  2409. if (likely(state->im)) {
  2410. spin_unlock_bh(&state->im->mca_lock);
  2411. state->im = NULL;
  2412. }
  2413. if (likely(state->idev)) {
  2414. read_unlock_bh(&state->idev->lock);
  2415. state->idev = NULL;
  2416. }
  2417. state->dev = NULL;
  2418. rcu_read_unlock();
  2419. }
  2420. static int igmp6_mcf_seq_show(struct seq_file *seq, void *v)
  2421. {
  2422. struct ip6_sf_list *psf = (struct ip6_sf_list *)v;
  2423. struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
  2424. if (v == SEQ_START_TOKEN) {
  2425. seq_puts(seq, "Idx Device Multicast Address Source Address INC EXC\n");
  2426. } else {
  2427. seq_printf(seq,
  2428. "%3d %6.6s %pi6 %pi6 %6lu %6lu\n",
  2429. state->dev->ifindex, state->dev->name,
  2430. &state->im->mca_addr,
  2431. &psf->sf_addr,
  2432. psf->sf_count[MCAST_INCLUDE],
  2433. psf->sf_count[MCAST_EXCLUDE]);
  2434. }
  2435. return 0;
  2436. }
  2437. static const struct seq_operations igmp6_mcf_seq_ops = {
  2438. .start = igmp6_mcf_seq_start,
  2439. .next = igmp6_mcf_seq_next,
  2440. .stop = igmp6_mcf_seq_stop,
  2441. .show = igmp6_mcf_seq_show,
  2442. };
  2443. static int igmp6_mcf_seq_open(struct inode *inode, struct file *file)
  2444. {
  2445. return seq_open_net(inode, file, &igmp6_mcf_seq_ops,
  2446. sizeof(struct igmp6_mcf_iter_state));
  2447. }
  2448. static const struct file_operations igmp6_mcf_seq_fops = {
  2449. .owner = THIS_MODULE,
  2450. .open = igmp6_mcf_seq_open,
  2451. .read = seq_read,
  2452. .llseek = seq_lseek,
  2453. .release = seq_release_net,
  2454. };
  2455. static int __net_init igmp6_proc_init(struct net *net)
  2456. {
  2457. int err;
  2458. err = -ENOMEM;
  2459. if (!proc_create("igmp6", S_IRUGO, net->proc_net, &igmp6_mc_seq_fops))
  2460. goto out;
  2461. if (!proc_create("mcfilter6", S_IRUGO, net->proc_net,
  2462. &igmp6_mcf_seq_fops))
  2463. goto out_proc_net_igmp6;
  2464. err = 0;
  2465. out:
  2466. return err;
  2467. out_proc_net_igmp6:
  2468. remove_proc_entry("igmp6", net->proc_net);
  2469. goto out;
  2470. }
  2471. static void __net_exit igmp6_proc_exit(struct net *net)
  2472. {
  2473. remove_proc_entry("mcfilter6", net->proc_net);
  2474. remove_proc_entry("igmp6", net->proc_net);
  2475. }
  2476. #else
  2477. static inline int igmp6_proc_init(struct net *net)
  2478. {
  2479. return 0;
  2480. }
  2481. static inline void igmp6_proc_exit(struct net *net)
  2482. {
  2483. }
  2484. #endif
  2485. static int __net_init igmp6_net_init(struct net *net)
  2486. {
  2487. int err;
  2488. err = inet_ctl_sock_create(&net->ipv6.igmp_sk, PF_INET6,
  2489. SOCK_RAW, IPPROTO_ICMPV6, net);
  2490. if (err < 0) {
  2491. pr_err("Failed to initialize the IGMP6 control socket (err %d)\n",
  2492. err);
  2493. goto out;
  2494. }
  2495. inet6_sk(net->ipv6.igmp_sk)->hop_limit = 1;
  2496. err = inet_ctl_sock_create(&net->ipv6.mc_autojoin_sk, PF_INET6,
  2497. SOCK_RAW, IPPROTO_ICMPV6, net);
  2498. if (err < 0) {
  2499. pr_err("Failed to initialize the IGMP6 autojoin socket (err %d)\n",
  2500. err);
  2501. goto out_sock_create;
  2502. }
  2503. err = igmp6_proc_init(net);
  2504. if (err)
  2505. goto out_sock_create_autojoin;
  2506. return 0;
  2507. out_sock_create_autojoin:
  2508. inet_ctl_sock_destroy(net->ipv6.mc_autojoin_sk);
  2509. out_sock_create:
  2510. inet_ctl_sock_destroy(net->ipv6.igmp_sk);
  2511. out:
  2512. return err;
  2513. }
  2514. static void __net_exit igmp6_net_exit(struct net *net)
  2515. {
  2516. inet_ctl_sock_destroy(net->ipv6.igmp_sk);
  2517. inet_ctl_sock_destroy(net->ipv6.mc_autojoin_sk);
  2518. igmp6_proc_exit(net);
  2519. }
  2520. static struct pernet_operations igmp6_net_ops = {
  2521. .init = igmp6_net_init,
  2522. .exit = igmp6_net_exit,
  2523. };
  2524. int __init igmp6_init(void)
  2525. {
  2526. return register_pernet_subsys(&igmp6_net_ops);
  2527. }
  2528. void igmp6_cleanup(void)
  2529. {
  2530. unregister_pernet_subsys(&igmp6_net_ops);
  2531. }