mcast.c 70 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957
  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_reserve(skb, hlen);
  1340. skb_tailroom_reserve(skb, mtu, tlen);
  1341. if (__ipv6_get_lladdr(idev, &addr_buf, IFA_F_TENTATIVE)) {
  1342. /* <draft-ietf-magma-mld-source-05.txt>:
  1343. * use unspecified address as the source address
  1344. * when a valid link-local address is not available.
  1345. */
  1346. saddr = &in6addr_any;
  1347. } else
  1348. saddr = &addr_buf;
  1349. ip6_mc_hdr(sk, skb, dev, saddr, &mld2_all_mcr, NEXTHDR_HOP, 0);
  1350. memcpy(skb_put(skb, sizeof(ra)), ra, sizeof(ra));
  1351. skb_set_transport_header(skb, skb_tail_pointer(skb) - skb->data);
  1352. skb_put(skb, sizeof(*pmr));
  1353. pmr = (struct mld2_report *)skb_transport_header(skb);
  1354. pmr->mld2r_type = ICMPV6_MLD2_REPORT;
  1355. pmr->mld2r_resv1 = 0;
  1356. pmr->mld2r_cksum = 0;
  1357. pmr->mld2r_resv2 = 0;
  1358. pmr->mld2r_ngrec = 0;
  1359. return skb;
  1360. }
  1361. static void mld_sendpack(struct sk_buff *skb)
  1362. {
  1363. struct ipv6hdr *pip6 = ipv6_hdr(skb);
  1364. struct mld2_report *pmr =
  1365. (struct mld2_report *)skb_transport_header(skb);
  1366. int payload_len, mldlen;
  1367. struct inet6_dev *idev;
  1368. struct net *net = dev_net(skb->dev);
  1369. int err;
  1370. struct flowi6 fl6;
  1371. struct dst_entry *dst;
  1372. rcu_read_lock();
  1373. idev = __in6_dev_get(skb->dev);
  1374. IP6_UPD_PO_STATS(net, idev, IPSTATS_MIB_OUT, skb->len);
  1375. payload_len = (skb_tail_pointer(skb) - skb_network_header(skb)) -
  1376. sizeof(*pip6);
  1377. mldlen = skb_tail_pointer(skb) - skb_transport_header(skb);
  1378. pip6->payload_len = htons(payload_len);
  1379. pmr->mld2r_cksum = csum_ipv6_magic(&pip6->saddr, &pip6->daddr, mldlen,
  1380. IPPROTO_ICMPV6,
  1381. csum_partial(skb_transport_header(skb),
  1382. mldlen, 0));
  1383. icmpv6_flow_init(net->ipv6.igmp_sk, &fl6, ICMPV6_MLD2_REPORT,
  1384. &ipv6_hdr(skb)->saddr, &ipv6_hdr(skb)->daddr,
  1385. skb->dev->ifindex);
  1386. dst = icmp6_dst_alloc(skb->dev, &fl6);
  1387. err = 0;
  1388. if (IS_ERR(dst)) {
  1389. err = PTR_ERR(dst);
  1390. dst = NULL;
  1391. }
  1392. skb_dst_set(skb, dst);
  1393. if (err)
  1394. goto err_out;
  1395. payload_len = skb->len;
  1396. err = NF_HOOK(NFPROTO_IPV6, NF_INET_LOCAL_OUT,
  1397. net, net->ipv6.igmp_sk, skb, NULL, skb->dev,
  1398. dst_output);
  1399. out:
  1400. if (!err) {
  1401. ICMP6MSGOUT_INC_STATS(net, idev, ICMPV6_MLD2_REPORT);
  1402. ICMP6_INC_STATS(net, idev, ICMP6_MIB_OUTMSGS);
  1403. } else {
  1404. IP6_INC_STATS(net, idev, IPSTATS_MIB_OUTDISCARDS);
  1405. }
  1406. rcu_read_unlock();
  1407. return;
  1408. err_out:
  1409. kfree_skb(skb);
  1410. goto out;
  1411. }
  1412. static int grec_size(struct ifmcaddr6 *pmc, int type, int gdel, int sdel)
  1413. {
  1414. return sizeof(struct mld2_grec) + 16 * mld_scount(pmc,type,gdel,sdel);
  1415. }
  1416. static struct sk_buff *add_grhead(struct sk_buff *skb, struct ifmcaddr6 *pmc,
  1417. int type, struct mld2_grec **ppgr, unsigned int mtu)
  1418. {
  1419. struct mld2_report *pmr;
  1420. struct mld2_grec *pgr;
  1421. if (!skb) {
  1422. skb = mld_newpack(pmc->idev, mtu);
  1423. if (!skb)
  1424. return NULL;
  1425. }
  1426. pgr = (struct mld2_grec *)skb_put(skb, sizeof(struct mld2_grec));
  1427. pgr->grec_type = type;
  1428. pgr->grec_auxwords = 0;
  1429. pgr->grec_nsrcs = 0;
  1430. pgr->grec_mca = pmc->mca_addr; /* structure copy */
  1431. pmr = (struct mld2_report *)skb_transport_header(skb);
  1432. pmr->mld2r_ngrec = htons(ntohs(pmr->mld2r_ngrec)+1);
  1433. *ppgr = pgr;
  1434. return skb;
  1435. }
  1436. #define AVAILABLE(skb) ((skb) ? skb_availroom(skb) : 0)
  1437. static struct sk_buff *add_grec(struct sk_buff *skb, struct ifmcaddr6 *pmc,
  1438. int type, int gdeleted, int sdeleted, int crsend)
  1439. {
  1440. struct inet6_dev *idev = pmc->idev;
  1441. struct net_device *dev = idev->dev;
  1442. struct mld2_report *pmr;
  1443. struct mld2_grec *pgr = NULL;
  1444. struct ip6_sf_list *psf, *psf_next, *psf_prev, **psf_list;
  1445. int scount, stotal, first, isquery, truncate;
  1446. unsigned int mtu;
  1447. if (pmc->mca_flags & MAF_NOREPORT)
  1448. return skb;
  1449. mtu = READ_ONCE(dev->mtu);
  1450. if (mtu < IPV6_MIN_MTU)
  1451. return skb;
  1452. isquery = type == MLD2_MODE_IS_INCLUDE ||
  1453. type == MLD2_MODE_IS_EXCLUDE;
  1454. truncate = type == MLD2_MODE_IS_EXCLUDE ||
  1455. type == MLD2_CHANGE_TO_EXCLUDE;
  1456. stotal = scount = 0;
  1457. psf_list = sdeleted ? &pmc->mca_tomb : &pmc->mca_sources;
  1458. if (!*psf_list)
  1459. goto empty_source;
  1460. pmr = skb ? (struct mld2_report *)skb_transport_header(skb) : NULL;
  1461. /* EX and TO_EX get a fresh packet, if needed */
  1462. if (truncate) {
  1463. if (pmr && pmr->mld2r_ngrec &&
  1464. AVAILABLE(skb) < grec_size(pmc, type, gdeleted, sdeleted)) {
  1465. if (skb)
  1466. mld_sendpack(skb);
  1467. skb = mld_newpack(idev, mtu);
  1468. }
  1469. }
  1470. first = 1;
  1471. psf_prev = NULL;
  1472. for (psf = *psf_list; psf; psf = psf_next) {
  1473. struct in6_addr *psrc;
  1474. psf_next = psf->sf_next;
  1475. if (!is_in(pmc, psf, type, gdeleted, sdeleted)) {
  1476. psf_prev = psf;
  1477. continue;
  1478. }
  1479. /* clear marks on query responses */
  1480. if (isquery)
  1481. psf->sf_gsresp = 0;
  1482. if (AVAILABLE(skb) < sizeof(*psrc) +
  1483. first*sizeof(struct mld2_grec)) {
  1484. if (truncate && !first)
  1485. break; /* truncate these */
  1486. if (pgr)
  1487. pgr->grec_nsrcs = htons(scount);
  1488. if (skb)
  1489. mld_sendpack(skb);
  1490. skb = mld_newpack(idev, mtu);
  1491. first = 1;
  1492. scount = 0;
  1493. }
  1494. if (first) {
  1495. skb = add_grhead(skb, pmc, type, &pgr, mtu);
  1496. first = 0;
  1497. }
  1498. if (!skb)
  1499. return NULL;
  1500. psrc = (struct in6_addr *)skb_put(skb, sizeof(*psrc));
  1501. *psrc = psf->sf_addr;
  1502. scount++; stotal++;
  1503. if ((type == MLD2_ALLOW_NEW_SOURCES ||
  1504. type == MLD2_BLOCK_OLD_SOURCES) && psf->sf_crcount) {
  1505. psf->sf_crcount--;
  1506. if ((sdeleted || gdeleted) && psf->sf_crcount == 0) {
  1507. if (psf_prev)
  1508. psf_prev->sf_next = psf->sf_next;
  1509. else
  1510. *psf_list = psf->sf_next;
  1511. kfree(psf);
  1512. continue;
  1513. }
  1514. }
  1515. psf_prev = psf;
  1516. }
  1517. empty_source:
  1518. if (!stotal) {
  1519. if (type == MLD2_ALLOW_NEW_SOURCES ||
  1520. type == MLD2_BLOCK_OLD_SOURCES)
  1521. return skb;
  1522. if (pmc->mca_crcount || isquery || crsend) {
  1523. /* make sure we have room for group header */
  1524. if (skb && AVAILABLE(skb) < sizeof(struct mld2_grec)) {
  1525. mld_sendpack(skb);
  1526. skb = NULL; /* add_grhead will get a new one */
  1527. }
  1528. skb = add_grhead(skb, pmc, type, &pgr, mtu);
  1529. }
  1530. }
  1531. if (pgr)
  1532. pgr->grec_nsrcs = htons(scount);
  1533. if (isquery)
  1534. pmc->mca_flags &= ~MAF_GSQUERY; /* clear query state */
  1535. return skb;
  1536. }
  1537. static void mld_send_report(struct inet6_dev *idev, struct ifmcaddr6 *pmc)
  1538. {
  1539. struct sk_buff *skb = NULL;
  1540. int type;
  1541. read_lock_bh(&idev->lock);
  1542. if (!pmc) {
  1543. for (pmc = idev->mc_list; pmc; pmc = pmc->next) {
  1544. if (pmc->mca_flags & MAF_NOREPORT)
  1545. continue;
  1546. spin_lock_bh(&pmc->mca_lock);
  1547. if (pmc->mca_sfcount[MCAST_EXCLUDE])
  1548. type = MLD2_MODE_IS_EXCLUDE;
  1549. else
  1550. type = MLD2_MODE_IS_INCLUDE;
  1551. skb = add_grec(skb, pmc, type, 0, 0, 0);
  1552. spin_unlock_bh(&pmc->mca_lock);
  1553. }
  1554. } else {
  1555. spin_lock_bh(&pmc->mca_lock);
  1556. if (pmc->mca_sfcount[MCAST_EXCLUDE])
  1557. type = MLD2_MODE_IS_EXCLUDE;
  1558. else
  1559. type = MLD2_MODE_IS_INCLUDE;
  1560. skb = add_grec(skb, pmc, type, 0, 0, 0);
  1561. spin_unlock_bh(&pmc->mca_lock);
  1562. }
  1563. read_unlock_bh(&idev->lock);
  1564. if (skb)
  1565. mld_sendpack(skb);
  1566. }
  1567. /*
  1568. * remove zero-count source records from a source filter list
  1569. */
  1570. static void mld_clear_zeros(struct ip6_sf_list **ppsf)
  1571. {
  1572. struct ip6_sf_list *psf_prev, *psf_next, *psf;
  1573. psf_prev = NULL;
  1574. for (psf = *ppsf; psf; psf = psf_next) {
  1575. psf_next = psf->sf_next;
  1576. if (psf->sf_crcount == 0) {
  1577. if (psf_prev)
  1578. psf_prev->sf_next = psf->sf_next;
  1579. else
  1580. *ppsf = psf->sf_next;
  1581. kfree(psf);
  1582. } else
  1583. psf_prev = psf;
  1584. }
  1585. }
  1586. static void mld_send_cr(struct inet6_dev *idev)
  1587. {
  1588. struct ifmcaddr6 *pmc, *pmc_prev, *pmc_next;
  1589. struct sk_buff *skb = NULL;
  1590. int type, dtype;
  1591. read_lock_bh(&idev->lock);
  1592. spin_lock(&idev->mc_lock);
  1593. /* deleted MCA's */
  1594. pmc_prev = NULL;
  1595. for (pmc = idev->mc_tomb; pmc; pmc = pmc_next) {
  1596. pmc_next = pmc->next;
  1597. if (pmc->mca_sfmode == MCAST_INCLUDE) {
  1598. type = MLD2_BLOCK_OLD_SOURCES;
  1599. dtype = MLD2_BLOCK_OLD_SOURCES;
  1600. skb = add_grec(skb, pmc, type, 1, 0, 0);
  1601. skb = add_grec(skb, pmc, dtype, 1, 1, 0);
  1602. }
  1603. if (pmc->mca_crcount) {
  1604. if (pmc->mca_sfmode == MCAST_EXCLUDE) {
  1605. type = MLD2_CHANGE_TO_INCLUDE;
  1606. skb = add_grec(skb, pmc, type, 1, 0, 0);
  1607. }
  1608. pmc->mca_crcount--;
  1609. if (pmc->mca_crcount == 0) {
  1610. mld_clear_zeros(&pmc->mca_tomb);
  1611. mld_clear_zeros(&pmc->mca_sources);
  1612. }
  1613. }
  1614. if (pmc->mca_crcount == 0 && !pmc->mca_tomb &&
  1615. !pmc->mca_sources) {
  1616. if (pmc_prev)
  1617. pmc_prev->next = pmc_next;
  1618. else
  1619. idev->mc_tomb = pmc_next;
  1620. in6_dev_put(pmc->idev);
  1621. kfree(pmc);
  1622. } else
  1623. pmc_prev = pmc;
  1624. }
  1625. spin_unlock(&idev->mc_lock);
  1626. /* change recs */
  1627. for (pmc = idev->mc_list; pmc; pmc = pmc->next) {
  1628. spin_lock_bh(&pmc->mca_lock);
  1629. if (pmc->mca_sfcount[MCAST_EXCLUDE]) {
  1630. type = MLD2_BLOCK_OLD_SOURCES;
  1631. dtype = MLD2_ALLOW_NEW_SOURCES;
  1632. } else {
  1633. type = MLD2_ALLOW_NEW_SOURCES;
  1634. dtype = MLD2_BLOCK_OLD_SOURCES;
  1635. }
  1636. skb = add_grec(skb, pmc, type, 0, 0, 0);
  1637. skb = add_grec(skb, pmc, dtype, 0, 1, 0); /* deleted sources */
  1638. /* filter mode changes */
  1639. if (pmc->mca_crcount) {
  1640. if (pmc->mca_sfmode == MCAST_EXCLUDE)
  1641. type = MLD2_CHANGE_TO_EXCLUDE;
  1642. else
  1643. type = MLD2_CHANGE_TO_INCLUDE;
  1644. skb = add_grec(skb, pmc, type, 0, 0, 0);
  1645. pmc->mca_crcount--;
  1646. }
  1647. spin_unlock_bh(&pmc->mca_lock);
  1648. }
  1649. read_unlock_bh(&idev->lock);
  1650. if (!skb)
  1651. return;
  1652. (void) mld_sendpack(skb);
  1653. }
  1654. static void igmp6_send(struct in6_addr *addr, struct net_device *dev, int type)
  1655. {
  1656. struct net *net = dev_net(dev);
  1657. struct sock *sk = net->ipv6.igmp_sk;
  1658. struct inet6_dev *idev;
  1659. struct sk_buff *skb;
  1660. struct mld_msg *hdr;
  1661. const struct in6_addr *snd_addr, *saddr;
  1662. struct in6_addr addr_buf;
  1663. int hlen = LL_RESERVED_SPACE(dev);
  1664. int tlen = dev->needed_tailroom;
  1665. int err, len, payload_len, full_len;
  1666. u8 ra[8] = { IPPROTO_ICMPV6, 0,
  1667. IPV6_TLV_ROUTERALERT, 2, 0, 0,
  1668. IPV6_TLV_PADN, 0 };
  1669. struct flowi6 fl6;
  1670. struct dst_entry *dst;
  1671. if (type == ICMPV6_MGM_REDUCTION)
  1672. snd_addr = &in6addr_linklocal_allrouters;
  1673. else
  1674. snd_addr = addr;
  1675. len = sizeof(struct icmp6hdr) + sizeof(struct in6_addr);
  1676. payload_len = len + sizeof(ra);
  1677. full_len = sizeof(struct ipv6hdr) + payload_len;
  1678. rcu_read_lock();
  1679. IP6_UPD_PO_STATS(net, __in6_dev_get(dev),
  1680. IPSTATS_MIB_OUT, full_len);
  1681. rcu_read_unlock();
  1682. skb = sock_alloc_send_skb(sk, hlen + tlen + full_len, 1, &err);
  1683. if (!skb) {
  1684. rcu_read_lock();
  1685. IP6_INC_STATS(net, __in6_dev_get(dev),
  1686. IPSTATS_MIB_OUTDISCARDS);
  1687. rcu_read_unlock();
  1688. return;
  1689. }
  1690. skb->priority = TC_PRIO_CONTROL;
  1691. skb_reserve(skb, hlen);
  1692. if (ipv6_get_lladdr(dev, &addr_buf, IFA_F_TENTATIVE)) {
  1693. /* <draft-ietf-magma-mld-source-05.txt>:
  1694. * use unspecified address as the source address
  1695. * when a valid link-local address is not available.
  1696. */
  1697. saddr = &in6addr_any;
  1698. } else
  1699. saddr = &addr_buf;
  1700. ip6_mc_hdr(sk, skb, dev, saddr, snd_addr, NEXTHDR_HOP, payload_len);
  1701. memcpy(skb_put(skb, sizeof(ra)), ra, sizeof(ra));
  1702. hdr = (struct mld_msg *) skb_put(skb, sizeof(struct mld_msg));
  1703. memset(hdr, 0, sizeof(struct mld_msg));
  1704. hdr->mld_type = type;
  1705. hdr->mld_mca = *addr;
  1706. hdr->mld_cksum = csum_ipv6_magic(saddr, snd_addr, len,
  1707. IPPROTO_ICMPV6,
  1708. csum_partial(hdr, len, 0));
  1709. rcu_read_lock();
  1710. idev = __in6_dev_get(skb->dev);
  1711. icmpv6_flow_init(sk, &fl6, type,
  1712. &ipv6_hdr(skb)->saddr, &ipv6_hdr(skb)->daddr,
  1713. skb->dev->ifindex);
  1714. dst = icmp6_dst_alloc(skb->dev, &fl6);
  1715. if (IS_ERR(dst)) {
  1716. err = PTR_ERR(dst);
  1717. goto err_out;
  1718. }
  1719. skb_dst_set(skb, dst);
  1720. err = NF_HOOK(NFPROTO_IPV6, NF_INET_LOCAL_OUT,
  1721. net, sk, skb, NULL, skb->dev,
  1722. dst_output);
  1723. out:
  1724. if (!err) {
  1725. ICMP6MSGOUT_INC_STATS(net, idev, type);
  1726. ICMP6_INC_STATS(net, idev, ICMP6_MIB_OUTMSGS);
  1727. } else
  1728. IP6_INC_STATS(net, idev, IPSTATS_MIB_OUTDISCARDS);
  1729. rcu_read_unlock();
  1730. return;
  1731. err_out:
  1732. kfree_skb(skb);
  1733. goto out;
  1734. }
  1735. static void mld_send_initial_cr(struct inet6_dev *idev)
  1736. {
  1737. struct sk_buff *skb;
  1738. struct ifmcaddr6 *pmc;
  1739. int type;
  1740. if (mld_in_v1_mode(idev))
  1741. return;
  1742. skb = NULL;
  1743. read_lock_bh(&idev->lock);
  1744. for (pmc = idev->mc_list; pmc; pmc = pmc->next) {
  1745. spin_lock_bh(&pmc->mca_lock);
  1746. if (pmc->mca_sfcount[MCAST_EXCLUDE])
  1747. type = MLD2_CHANGE_TO_EXCLUDE;
  1748. else
  1749. type = MLD2_CHANGE_TO_INCLUDE;
  1750. skb = add_grec(skb, pmc, type, 0, 0, 1);
  1751. spin_unlock_bh(&pmc->mca_lock);
  1752. }
  1753. read_unlock_bh(&idev->lock);
  1754. if (skb)
  1755. mld_sendpack(skb);
  1756. }
  1757. void ipv6_mc_dad_complete(struct inet6_dev *idev)
  1758. {
  1759. idev->mc_dad_count = idev->mc_qrv;
  1760. if (idev->mc_dad_count) {
  1761. mld_send_initial_cr(idev);
  1762. idev->mc_dad_count--;
  1763. if (idev->mc_dad_count)
  1764. mld_dad_start_timer(idev,
  1765. unsolicited_report_interval(idev));
  1766. }
  1767. }
  1768. static void mld_dad_timer_expire(unsigned long data)
  1769. {
  1770. struct inet6_dev *idev = (struct inet6_dev *)data;
  1771. mld_send_initial_cr(idev);
  1772. if (idev->mc_dad_count) {
  1773. idev->mc_dad_count--;
  1774. if (idev->mc_dad_count)
  1775. mld_dad_start_timer(idev,
  1776. unsolicited_report_interval(idev));
  1777. }
  1778. in6_dev_put(idev);
  1779. }
  1780. static int ip6_mc_del1_src(struct ifmcaddr6 *pmc, int sfmode,
  1781. const struct in6_addr *psfsrc)
  1782. {
  1783. struct ip6_sf_list *psf, *psf_prev;
  1784. int rv = 0;
  1785. psf_prev = NULL;
  1786. for (psf = pmc->mca_sources; psf; psf = psf->sf_next) {
  1787. if (ipv6_addr_equal(&psf->sf_addr, psfsrc))
  1788. break;
  1789. psf_prev = psf;
  1790. }
  1791. if (!psf || psf->sf_count[sfmode] == 0) {
  1792. /* source filter not found, or count wrong => bug */
  1793. return -ESRCH;
  1794. }
  1795. psf->sf_count[sfmode]--;
  1796. if (!psf->sf_count[MCAST_INCLUDE] && !psf->sf_count[MCAST_EXCLUDE]) {
  1797. struct inet6_dev *idev = pmc->idev;
  1798. /* no more filters for this source */
  1799. if (psf_prev)
  1800. psf_prev->sf_next = psf->sf_next;
  1801. else
  1802. pmc->mca_sources = psf->sf_next;
  1803. if (psf->sf_oldin && !(pmc->mca_flags & MAF_NOREPORT) &&
  1804. !mld_in_v1_mode(idev)) {
  1805. psf->sf_crcount = idev->mc_qrv;
  1806. psf->sf_next = pmc->mca_tomb;
  1807. pmc->mca_tomb = psf;
  1808. rv = 1;
  1809. } else
  1810. kfree(psf);
  1811. }
  1812. return rv;
  1813. }
  1814. static int ip6_mc_del_src(struct inet6_dev *idev, const struct in6_addr *pmca,
  1815. int sfmode, int sfcount, const struct in6_addr *psfsrc,
  1816. int delta)
  1817. {
  1818. struct ifmcaddr6 *pmc;
  1819. int changerec = 0;
  1820. int i, err;
  1821. if (!idev)
  1822. return -ENODEV;
  1823. read_lock_bh(&idev->lock);
  1824. for (pmc = idev->mc_list; pmc; pmc = pmc->next) {
  1825. if (ipv6_addr_equal(pmca, &pmc->mca_addr))
  1826. break;
  1827. }
  1828. if (!pmc) {
  1829. /* MCA not found?? bug */
  1830. read_unlock_bh(&idev->lock);
  1831. return -ESRCH;
  1832. }
  1833. spin_lock_bh(&pmc->mca_lock);
  1834. sf_markstate(pmc);
  1835. if (!delta) {
  1836. if (!pmc->mca_sfcount[sfmode]) {
  1837. spin_unlock_bh(&pmc->mca_lock);
  1838. read_unlock_bh(&idev->lock);
  1839. return -EINVAL;
  1840. }
  1841. pmc->mca_sfcount[sfmode]--;
  1842. }
  1843. err = 0;
  1844. for (i = 0; i < sfcount; i++) {
  1845. int rv = ip6_mc_del1_src(pmc, sfmode, &psfsrc[i]);
  1846. changerec |= rv > 0;
  1847. if (!err && rv < 0)
  1848. err = rv;
  1849. }
  1850. if (pmc->mca_sfmode == MCAST_EXCLUDE &&
  1851. pmc->mca_sfcount[MCAST_EXCLUDE] == 0 &&
  1852. pmc->mca_sfcount[MCAST_INCLUDE]) {
  1853. struct ip6_sf_list *psf;
  1854. /* filter mode change */
  1855. pmc->mca_sfmode = MCAST_INCLUDE;
  1856. pmc->mca_crcount = idev->mc_qrv;
  1857. idev->mc_ifc_count = pmc->mca_crcount;
  1858. for (psf = pmc->mca_sources; psf; psf = psf->sf_next)
  1859. psf->sf_crcount = 0;
  1860. mld_ifc_event(pmc->idev);
  1861. } else if (sf_setstate(pmc) || changerec)
  1862. mld_ifc_event(pmc->idev);
  1863. spin_unlock_bh(&pmc->mca_lock);
  1864. read_unlock_bh(&idev->lock);
  1865. return err;
  1866. }
  1867. /*
  1868. * Add multicast single-source filter to the interface list
  1869. */
  1870. static int ip6_mc_add1_src(struct ifmcaddr6 *pmc, int sfmode,
  1871. const struct in6_addr *psfsrc)
  1872. {
  1873. struct ip6_sf_list *psf, *psf_prev;
  1874. psf_prev = NULL;
  1875. for (psf = pmc->mca_sources; psf; psf = psf->sf_next) {
  1876. if (ipv6_addr_equal(&psf->sf_addr, psfsrc))
  1877. break;
  1878. psf_prev = psf;
  1879. }
  1880. if (!psf) {
  1881. psf = kzalloc(sizeof(*psf), GFP_ATOMIC);
  1882. if (!psf)
  1883. return -ENOBUFS;
  1884. psf->sf_addr = *psfsrc;
  1885. if (psf_prev) {
  1886. psf_prev->sf_next = psf;
  1887. } else
  1888. pmc->mca_sources = psf;
  1889. }
  1890. psf->sf_count[sfmode]++;
  1891. return 0;
  1892. }
  1893. static void sf_markstate(struct ifmcaddr6 *pmc)
  1894. {
  1895. struct ip6_sf_list *psf;
  1896. int mca_xcount = pmc->mca_sfcount[MCAST_EXCLUDE];
  1897. for (psf = pmc->mca_sources; psf; psf = psf->sf_next)
  1898. if (pmc->mca_sfcount[MCAST_EXCLUDE]) {
  1899. psf->sf_oldin = mca_xcount ==
  1900. psf->sf_count[MCAST_EXCLUDE] &&
  1901. !psf->sf_count[MCAST_INCLUDE];
  1902. } else
  1903. psf->sf_oldin = psf->sf_count[MCAST_INCLUDE] != 0;
  1904. }
  1905. static int sf_setstate(struct ifmcaddr6 *pmc)
  1906. {
  1907. struct ip6_sf_list *psf, *dpsf;
  1908. int mca_xcount = pmc->mca_sfcount[MCAST_EXCLUDE];
  1909. int qrv = pmc->idev->mc_qrv;
  1910. int new_in, rv;
  1911. rv = 0;
  1912. for (psf = pmc->mca_sources; psf; psf = psf->sf_next) {
  1913. if (pmc->mca_sfcount[MCAST_EXCLUDE]) {
  1914. new_in = mca_xcount == psf->sf_count[MCAST_EXCLUDE] &&
  1915. !psf->sf_count[MCAST_INCLUDE];
  1916. } else
  1917. new_in = psf->sf_count[MCAST_INCLUDE] != 0;
  1918. if (new_in) {
  1919. if (!psf->sf_oldin) {
  1920. struct ip6_sf_list *prev = NULL;
  1921. for (dpsf = pmc->mca_tomb; dpsf;
  1922. dpsf = dpsf->sf_next) {
  1923. if (ipv6_addr_equal(&dpsf->sf_addr,
  1924. &psf->sf_addr))
  1925. break;
  1926. prev = dpsf;
  1927. }
  1928. if (dpsf) {
  1929. if (prev)
  1930. prev->sf_next = dpsf->sf_next;
  1931. else
  1932. pmc->mca_tomb = dpsf->sf_next;
  1933. kfree(dpsf);
  1934. }
  1935. psf->sf_crcount = qrv;
  1936. rv++;
  1937. }
  1938. } else if (psf->sf_oldin) {
  1939. psf->sf_crcount = 0;
  1940. /*
  1941. * add or update "delete" records if an active filter
  1942. * is now inactive
  1943. */
  1944. for (dpsf = pmc->mca_tomb; dpsf; dpsf = dpsf->sf_next)
  1945. if (ipv6_addr_equal(&dpsf->sf_addr,
  1946. &psf->sf_addr))
  1947. break;
  1948. if (!dpsf) {
  1949. dpsf = kmalloc(sizeof(*dpsf), GFP_ATOMIC);
  1950. if (!dpsf)
  1951. continue;
  1952. *dpsf = *psf;
  1953. /* pmc->mca_lock held by callers */
  1954. dpsf->sf_next = pmc->mca_tomb;
  1955. pmc->mca_tomb = dpsf;
  1956. }
  1957. dpsf->sf_crcount = qrv;
  1958. rv++;
  1959. }
  1960. }
  1961. return rv;
  1962. }
  1963. /*
  1964. * Add multicast source filter list to the interface list
  1965. */
  1966. static int ip6_mc_add_src(struct inet6_dev *idev, const struct in6_addr *pmca,
  1967. int sfmode, int sfcount, const struct in6_addr *psfsrc,
  1968. int delta)
  1969. {
  1970. struct ifmcaddr6 *pmc;
  1971. int isexclude;
  1972. int i, err;
  1973. if (!idev)
  1974. return -ENODEV;
  1975. read_lock_bh(&idev->lock);
  1976. for (pmc = idev->mc_list; pmc; pmc = pmc->next) {
  1977. if (ipv6_addr_equal(pmca, &pmc->mca_addr))
  1978. break;
  1979. }
  1980. if (!pmc) {
  1981. /* MCA not found?? bug */
  1982. read_unlock_bh(&idev->lock);
  1983. return -ESRCH;
  1984. }
  1985. spin_lock_bh(&pmc->mca_lock);
  1986. sf_markstate(pmc);
  1987. isexclude = pmc->mca_sfmode == MCAST_EXCLUDE;
  1988. if (!delta)
  1989. pmc->mca_sfcount[sfmode]++;
  1990. err = 0;
  1991. for (i = 0; i < sfcount; i++) {
  1992. err = ip6_mc_add1_src(pmc, sfmode, &psfsrc[i]);
  1993. if (err)
  1994. break;
  1995. }
  1996. if (err) {
  1997. int j;
  1998. if (!delta)
  1999. pmc->mca_sfcount[sfmode]--;
  2000. for (j = 0; j < i; j++)
  2001. ip6_mc_del1_src(pmc, sfmode, &psfsrc[j]);
  2002. } else if (isexclude != (pmc->mca_sfcount[MCAST_EXCLUDE] != 0)) {
  2003. struct ip6_sf_list *psf;
  2004. /* filter mode change */
  2005. if (pmc->mca_sfcount[MCAST_EXCLUDE])
  2006. pmc->mca_sfmode = MCAST_EXCLUDE;
  2007. else if (pmc->mca_sfcount[MCAST_INCLUDE])
  2008. pmc->mca_sfmode = MCAST_INCLUDE;
  2009. /* else no filters; keep old mode for reports */
  2010. pmc->mca_crcount = idev->mc_qrv;
  2011. idev->mc_ifc_count = pmc->mca_crcount;
  2012. for (psf = pmc->mca_sources; psf; psf = psf->sf_next)
  2013. psf->sf_crcount = 0;
  2014. mld_ifc_event(idev);
  2015. } else if (sf_setstate(pmc))
  2016. mld_ifc_event(idev);
  2017. spin_unlock_bh(&pmc->mca_lock);
  2018. read_unlock_bh(&idev->lock);
  2019. return err;
  2020. }
  2021. static void ip6_mc_clear_src(struct ifmcaddr6 *pmc)
  2022. {
  2023. struct ip6_sf_list *psf, *nextpsf;
  2024. for (psf = pmc->mca_tomb; psf; psf = nextpsf) {
  2025. nextpsf = psf->sf_next;
  2026. kfree(psf);
  2027. }
  2028. pmc->mca_tomb = NULL;
  2029. for (psf = pmc->mca_sources; psf; psf = nextpsf) {
  2030. nextpsf = psf->sf_next;
  2031. kfree(psf);
  2032. }
  2033. pmc->mca_sources = NULL;
  2034. pmc->mca_sfmode = MCAST_EXCLUDE;
  2035. pmc->mca_sfcount[MCAST_INCLUDE] = 0;
  2036. pmc->mca_sfcount[MCAST_EXCLUDE] = 1;
  2037. }
  2038. static void igmp6_join_group(struct ifmcaddr6 *ma)
  2039. {
  2040. unsigned long delay;
  2041. if (ma->mca_flags & MAF_NOREPORT)
  2042. return;
  2043. igmp6_send(&ma->mca_addr, ma->idev->dev, ICMPV6_MGM_REPORT);
  2044. delay = prandom_u32() % unsolicited_report_interval(ma->idev);
  2045. spin_lock_bh(&ma->mca_lock);
  2046. if (del_timer(&ma->mca_timer)) {
  2047. atomic_dec(&ma->mca_refcnt);
  2048. delay = ma->mca_timer.expires - jiffies;
  2049. }
  2050. if (!mod_timer(&ma->mca_timer, jiffies + delay))
  2051. atomic_inc(&ma->mca_refcnt);
  2052. ma->mca_flags |= MAF_TIMER_RUNNING | MAF_LAST_REPORTER;
  2053. spin_unlock_bh(&ma->mca_lock);
  2054. }
  2055. static int ip6_mc_leave_src(struct sock *sk, struct ipv6_mc_socklist *iml,
  2056. struct inet6_dev *idev)
  2057. {
  2058. int err;
  2059. write_lock_bh(&iml->sflock);
  2060. if (!iml->sflist) {
  2061. /* any-source empty exclude case */
  2062. err = ip6_mc_del_src(idev, &iml->addr, iml->sfmode, 0, NULL, 0);
  2063. } else {
  2064. err = ip6_mc_del_src(idev, &iml->addr, iml->sfmode,
  2065. iml->sflist->sl_count, iml->sflist->sl_addr, 0);
  2066. sock_kfree_s(sk, iml->sflist, IP6_SFLSIZE(iml->sflist->sl_max));
  2067. iml->sflist = NULL;
  2068. }
  2069. write_unlock_bh(&iml->sflock);
  2070. return err;
  2071. }
  2072. static void igmp6_leave_group(struct ifmcaddr6 *ma)
  2073. {
  2074. if (mld_in_v1_mode(ma->idev)) {
  2075. if (ma->mca_flags & MAF_LAST_REPORTER)
  2076. igmp6_send(&ma->mca_addr, ma->idev->dev,
  2077. ICMPV6_MGM_REDUCTION);
  2078. } else {
  2079. mld_add_delrec(ma->idev, ma);
  2080. mld_ifc_event(ma->idev);
  2081. }
  2082. }
  2083. static void mld_gq_timer_expire(unsigned long data)
  2084. {
  2085. struct inet6_dev *idev = (struct inet6_dev *)data;
  2086. idev->mc_gq_running = 0;
  2087. mld_send_report(idev, NULL);
  2088. in6_dev_put(idev);
  2089. }
  2090. static void mld_ifc_timer_expire(unsigned long data)
  2091. {
  2092. struct inet6_dev *idev = (struct inet6_dev *)data;
  2093. mld_send_cr(idev);
  2094. if (idev->mc_ifc_count) {
  2095. idev->mc_ifc_count--;
  2096. if (idev->mc_ifc_count)
  2097. mld_ifc_start_timer(idev,
  2098. unsolicited_report_interval(idev));
  2099. }
  2100. in6_dev_put(idev);
  2101. }
  2102. static void mld_ifc_event(struct inet6_dev *idev)
  2103. {
  2104. if (mld_in_v1_mode(idev))
  2105. return;
  2106. idev->mc_ifc_count = idev->mc_qrv;
  2107. mld_ifc_start_timer(idev, 1);
  2108. }
  2109. static void igmp6_timer_handler(unsigned long data)
  2110. {
  2111. struct ifmcaddr6 *ma = (struct ifmcaddr6 *) data;
  2112. if (mld_in_v1_mode(ma->idev))
  2113. igmp6_send(&ma->mca_addr, ma->idev->dev, ICMPV6_MGM_REPORT);
  2114. else
  2115. mld_send_report(ma->idev, ma);
  2116. spin_lock(&ma->mca_lock);
  2117. ma->mca_flags |= MAF_LAST_REPORTER;
  2118. ma->mca_flags &= ~MAF_TIMER_RUNNING;
  2119. spin_unlock(&ma->mca_lock);
  2120. ma_put(ma);
  2121. }
  2122. /* Device changing type */
  2123. void ipv6_mc_unmap(struct inet6_dev *idev)
  2124. {
  2125. struct ifmcaddr6 *i;
  2126. /* Install multicast list, except for all-nodes (already installed) */
  2127. read_lock_bh(&idev->lock);
  2128. for (i = idev->mc_list; i; i = i->next)
  2129. igmp6_group_dropped(i);
  2130. read_unlock_bh(&idev->lock);
  2131. }
  2132. void ipv6_mc_remap(struct inet6_dev *idev)
  2133. {
  2134. ipv6_mc_up(idev);
  2135. }
  2136. /* Device going down */
  2137. void ipv6_mc_down(struct inet6_dev *idev)
  2138. {
  2139. struct ifmcaddr6 *i;
  2140. /* Withdraw multicast list */
  2141. read_lock_bh(&idev->lock);
  2142. mld_ifc_stop_timer(idev);
  2143. mld_gq_stop_timer(idev);
  2144. mld_dad_stop_timer(idev);
  2145. for (i = idev->mc_list; i; i = i->next)
  2146. igmp6_group_dropped(i);
  2147. read_unlock_bh(&idev->lock);
  2148. mld_clear_delrec(idev);
  2149. }
  2150. static void ipv6_mc_reset(struct inet6_dev *idev)
  2151. {
  2152. idev->mc_qrv = sysctl_mld_qrv;
  2153. idev->mc_qi = MLD_QI_DEFAULT;
  2154. idev->mc_qri = MLD_QRI_DEFAULT;
  2155. idev->mc_v1_seen = 0;
  2156. idev->mc_maxdelay = unsolicited_report_interval(idev);
  2157. }
  2158. /* Device going up */
  2159. void ipv6_mc_up(struct inet6_dev *idev)
  2160. {
  2161. struct ifmcaddr6 *i;
  2162. /* Install multicast list, except for all-nodes (already installed) */
  2163. read_lock_bh(&idev->lock);
  2164. ipv6_mc_reset(idev);
  2165. for (i = idev->mc_list; i; i = i->next)
  2166. igmp6_group_added(i);
  2167. read_unlock_bh(&idev->lock);
  2168. }
  2169. /* IPv6 device initialization. */
  2170. void ipv6_mc_init_dev(struct inet6_dev *idev)
  2171. {
  2172. write_lock_bh(&idev->lock);
  2173. spin_lock_init(&idev->mc_lock);
  2174. idev->mc_gq_running = 0;
  2175. setup_timer(&idev->mc_gq_timer, mld_gq_timer_expire,
  2176. (unsigned long)idev);
  2177. idev->mc_tomb = NULL;
  2178. idev->mc_ifc_count = 0;
  2179. setup_timer(&idev->mc_ifc_timer, mld_ifc_timer_expire,
  2180. (unsigned long)idev);
  2181. setup_timer(&idev->mc_dad_timer, mld_dad_timer_expire,
  2182. (unsigned long)idev);
  2183. ipv6_mc_reset(idev);
  2184. write_unlock_bh(&idev->lock);
  2185. }
  2186. /*
  2187. * Device is about to be destroyed: clean up.
  2188. */
  2189. void ipv6_mc_destroy_dev(struct inet6_dev *idev)
  2190. {
  2191. struct ifmcaddr6 *i;
  2192. /* Deactivate timers */
  2193. ipv6_mc_down(idev);
  2194. /* Delete all-nodes address. */
  2195. /* We cannot call ipv6_dev_mc_dec() directly, our caller in
  2196. * addrconf.c has NULL'd out dev->ip6_ptr so in6_dev_get() will
  2197. * fail.
  2198. */
  2199. __ipv6_dev_mc_dec(idev, &in6addr_linklocal_allnodes);
  2200. if (idev->cnf.forwarding)
  2201. __ipv6_dev_mc_dec(idev, &in6addr_linklocal_allrouters);
  2202. write_lock_bh(&idev->lock);
  2203. while ((i = idev->mc_list) != NULL) {
  2204. idev->mc_list = i->next;
  2205. write_unlock_bh(&idev->lock);
  2206. igmp6_group_dropped(i);
  2207. ma_put(i);
  2208. write_lock_bh(&idev->lock);
  2209. }
  2210. write_unlock_bh(&idev->lock);
  2211. }
  2212. #ifdef CONFIG_PROC_FS
  2213. struct igmp6_mc_iter_state {
  2214. struct seq_net_private p;
  2215. struct net_device *dev;
  2216. struct inet6_dev *idev;
  2217. };
  2218. #define igmp6_mc_seq_private(seq) ((struct igmp6_mc_iter_state *)(seq)->private)
  2219. static inline struct ifmcaddr6 *igmp6_mc_get_first(struct seq_file *seq)
  2220. {
  2221. struct ifmcaddr6 *im = NULL;
  2222. struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
  2223. struct net *net = seq_file_net(seq);
  2224. state->idev = NULL;
  2225. for_each_netdev_rcu(net, state->dev) {
  2226. struct inet6_dev *idev;
  2227. idev = __in6_dev_get(state->dev);
  2228. if (!idev)
  2229. continue;
  2230. read_lock_bh(&idev->lock);
  2231. im = idev->mc_list;
  2232. if (im) {
  2233. state->idev = idev;
  2234. break;
  2235. }
  2236. read_unlock_bh(&idev->lock);
  2237. }
  2238. return im;
  2239. }
  2240. static struct ifmcaddr6 *igmp6_mc_get_next(struct seq_file *seq, struct ifmcaddr6 *im)
  2241. {
  2242. struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
  2243. im = im->next;
  2244. while (!im) {
  2245. if (likely(state->idev))
  2246. read_unlock_bh(&state->idev->lock);
  2247. state->dev = next_net_device_rcu(state->dev);
  2248. if (!state->dev) {
  2249. state->idev = NULL;
  2250. break;
  2251. }
  2252. state->idev = __in6_dev_get(state->dev);
  2253. if (!state->idev)
  2254. continue;
  2255. read_lock_bh(&state->idev->lock);
  2256. im = state->idev->mc_list;
  2257. }
  2258. return im;
  2259. }
  2260. static struct ifmcaddr6 *igmp6_mc_get_idx(struct seq_file *seq, loff_t pos)
  2261. {
  2262. struct ifmcaddr6 *im = igmp6_mc_get_first(seq);
  2263. if (im)
  2264. while (pos && (im = igmp6_mc_get_next(seq, im)) != NULL)
  2265. --pos;
  2266. return pos ? NULL : im;
  2267. }
  2268. static void *igmp6_mc_seq_start(struct seq_file *seq, loff_t *pos)
  2269. __acquires(RCU)
  2270. {
  2271. rcu_read_lock();
  2272. return igmp6_mc_get_idx(seq, *pos);
  2273. }
  2274. static void *igmp6_mc_seq_next(struct seq_file *seq, void *v, loff_t *pos)
  2275. {
  2276. struct ifmcaddr6 *im = igmp6_mc_get_next(seq, v);
  2277. ++*pos;
  2278. return im;
  2279. }
  2280. static void igmp6_mc_seq_stop(struct seq_file *seq, void *v)
  2281. __releases(RCU)
  2282. {
  2283. struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
  2284. if (likely(state->idev)) {
  2285. read_unlock_bh(&state->idev->lock);
  2286. state->idev = NULL;
  2287. }
  2288. state->dev = NULL;
  2289. rcu_read_unlock();
  2290. }
  2291. static int igmp6_mc_seq_show(struct seq_file *seq, void *v)
  2292. {
  2293. struct ifmcaddr6 *im = (struct ifmcaddr6 *)v;
  2294. struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
  2295. seq_printf(seq,
  2296. "%-4d %-15s %pi6 %5d %08X %ld\n",
  2297. state->dev->ifindex, state->dev->name,
  2298. &im->mca_addr,
  2299. im->mca_users, im->mca_flags,
  2300. (im->mca_flags&MAF_TIMER_RUNNING) ?
  2301. jiffies_to_clock_t(im->mca_timer.expires-jiffies) : 0);
  2302. return 0;
  2303. }
  2304. static const struct seq_operations igmp6_mc_seq_ops = {
  2305. .start = igmp6_mc_seq_start,
  2306. .next = igmp6_mc_seq_next,
  2307. .stop = igmp6_mc_seq_stop,
  2308. .show = igmp6_mc_seq_show,
  2309. };
  2310. static int igmp6_mc_seq_open(struct inode *inode, struct file *file)
  2311. {
  2312. return seq_open_net(inode, file, &igmp6_mc_seq_ops,
  2313. sizeof(struct igmp6_mc_iter_state));
  2314. }
  2315. static const struct file_operations igmp6_mc_seq_fops = {
  2316. .owner = THIS_MODULE,
  2317. .open = igmp6_mc_seq_open,
  2318. .read = seq_read,
  2319. .llseek = seq_lseek,
  2320. .release = seq_release_net,
  2321. };
  2322. struct igmp6_mcf_iter_state {
  2323. struct seq_net_private p;
  2324. struct net_device *dev;
  2325. struct inet6_dev *idev;
  2326. struct ifmcaddr6 *im;
  2327. };
  2328. #define igmp6_mcf_seq_private(seq) ((struct igmp6_mcf_iter_state *)(seq)->private)
  2329. static inline struct ip6_sf_list *igmp6_mcf_get_first(struct seq_file *seq)
  2330. {
  2331. struct ip6_sf_list *psf = NULL;
  2332. struct ifmcaddr6 *im = NULL;
  2333. struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
  2334. struct net *net = seq_file_net(seq);
  2335. state->idev = NULL;
  2336. state->im = NULL;
  2337. for_each_netdev_rcu(net, state->dev) {
  2338. struct inet6_dev *idev;
  2339. idev = __in6_dev_get(state->dev);
  2340. if (unlikely(idev == NULL))
  2341. continue;
  2342. read_lock_bh(&idev->lock);
  2343. im = idev->mc_list;
  2344. if (likely(im)) {
  2345. spin_lock_bh(&im->mca_lock);
  2346. psf = im->mca_sources;
  2347. if (likely(psf)) {
  2348. state->im = im;
  2349. state->idev = idev;
  2350. break;
  2351. }
  2352. spin_unlock_bh(&im->mca_lock);
  2353. }
  2354. read_unlock_bh(&idev->lock);
  2355. }
  2356. return psf;
  2357. }
  2358. static struct ip6_sf_list *igmp6_mcf_get_next(struct seq_file *seq, struct ip6_sf_list *psf)
  2359. {
  2360. struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
  2361. psf = psf->sf_next;
  2362. while (!psf) {
  2363. spin_unlock_bh(&state->im->mca_lock);
  2364. state->im = state->im->next;
  2365. while (!state->im) {
  2366. if (likely(state->idev))
  2367. read_unlock_bh(&state->idev->lock);
  2368. state->dev = next_net_device_rcu(state->dev);
  2369. if (!state->dev) {
  2370. state->idev = NULL;
  2371. goto out;
  2372. }
  2373. state->idev = __in6_dev_get(state->dev);
  2374. if (!state->idev)
  2375. continue;
  2376. read_lock_bh(&state->idev->lock);
  2377. state->im = state->idev->mc_list;
  2378. }
  2379. if (!state->im)
  2380. break;
  2381. spin_lock_bh(&state->im->mca_lock);
  2382. psf = state->im->mca_sources;
  2383. }
  2384. out:
  2385. return psf;
  2386. }
  2387. static struct ip6_sf_list *igmp6_mcf_get_idx(struct seq_file *seq, loff_t pos)
  2388. {
  2389. struct ip6_sf_list *psf = igmp6_mcf_get_first(seq);
  2390. if (psf)
  2391. while (pos && (psf = igmp6_mcf_get_next(seq, psf)) != NULL)
  2392. --pos;
  2393. return pos ? NULL : psf;
  2394. }
  2395. static void *igmp6_mcf_seq_start(struct seq_file *seq, loff_t *pos)
  2396. __acquires(RCU)
  2397. {
  2398. rcu_read_lock();
  2399. return *pos ? igmp6_mcf_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
  2400. }
  2401. static void *igmp6_mcf_seq_next(struct seq_file *seq, void *v, loff_t *pos)
  2402. {
  2403. struct ip6_sf_list *psf;
  2404. if (v == SEQ_START_TOKEN)
  2405. psf = igmp6_mcf_get_first(seq);
  2406. else
  2407. psf = igmp6_mcf_get_next(seq, v);
  2408. ++*pos;
  2409. return psf;
  2410. }
  2411. static void igmp6_mcf_seq_stop(struct seq_file *seq, void *v)
  2412. __releases(RCU)
  2413. {
  2414. struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
  2415. if (likely(state->im)) {
  2416. spin_unlock_bh(&state->im->mca_lock);
  2417. state->im = NULL;
  2418. }
  2419. if (likely(state->idev)) {
  2420. read_unlock_bh(&state->idev->lock);
  2421. state->idev = NULL;
  2422. }
  2423. state->dev = NULL;
  2424. rcu_read_unlock();
  2425. }
  2426. static int igmp6_mcf_seq_show(struct seq_file *seq, void *v)
  2427. {
  2428. struct ip6_sf_list *psf = (struct ip6_sf_list *)v;
  2429. struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
  2430. if (v == SEQ_START_TOKEN) {
  2431. seq_puts(seq, "Idx Device Multicast Address Source Address INC EXC\n");
  2432. } else {
  2433. seq_printf(seq,
  2434. "%3d %6.6s %pi6 %pi6 %6lu %6lu\n",
  2435. state->dev->ifindex, state->dev->name,
  2436. &state->im->mca_addr,
  2437. &psf->sf_addr,
  2438. psf->sf_count[MCAST_INCLUDE],
  2439. psf->sf_count[MCAST_EXCLUDE]);
  2440. }
  2441. return 0;
  2442. }
  2443. static const struct seq_operations igmp6_mcf_seq_ops = {
  2444. .start = igmp6_mcf_seq_start,
  2445. .next = igmp6_mcf_seq_next,
  2446. .stop = igmp6_mcf_seq_stop,
  2447. .show = igmp6_mcf_seq_show,
  2448. };
  2449. static int igmp6_mcf_seq_open(struct inode *inode, struct file *file)
  2450. {
  2451. return seq_open_net(inode, file, &igmp6_mcf_seq_ops,
  2452. sizeof(struct igmp6_mcf_iter_state));
  2453. }
  2454. static const struct file_operations igmp6_mcf_seq_fops = {
  2455. .owner = THIS_MODULE,
  2456. .open = igmp6_mcf_seq_open,
  2457. .read = seq_read,
  2458. .llseek = seq_lseek,
  2459. .release = seq_release_net,
  2460. };
  2461. static int __net_init igmp6_proc_init(struct net *net)
  2462. {
  2463. int err;
  2464. err = -ENOMEM;
  2465. if (!proc_create("igmp6", S_IRUGO, net->proc_net, &igmp6_mc_seq_fops))
  2466. goto out;
  2467. if (!proc_create("mcfilter6", S_IRUGO, net->proc_net,
  2468. &igmp6_mcf_seq_fops))
  2469. goto out_proc_net_igmp6;
  2470. err = 0;
  2471. out:
  2472. return err;
  2473. out_proc_net_igmp6:
  2474. remove_proc_entry("igmp6", net->proc_net);
  2475. goto out;
  2476. }
  2477. static void __net_exit igmp6_proc_exit(struct net *net)
  2478. {
  2479. remove_proc_entry("mcfilter6", net->proc_net);
  2480. remove_proc_entry("igmp6", net->proc_net);
  2481. }
  2482. #else
  2483. static inline int igmp6_proc_init(struct net *net)
  2484. {
  2485. return 0;
  2486. }
  2487. static inline void igmp6_proc_exit(struct net *net)
  2488. {
  2489. }
  2490. #endif
  2491. static int __net_init igmp6_net_init(struct net *net)
  2492. {
  2493. int err;
  2494. err = inet_ctl_sock_create(&net->ipv6.igmp_sk, PF_INET6,
  2495. SOCK_RAW, IPPROTO_ICMPV6, net);
  2496. if (err < 0) {
  2497. pr_err("Failed to initialize the IGMP6 control socket (err %d)\n",
  2498. err);
  2499. goto out;
  2500. }
  2501. inet6_sk(net->ipv6.igmp_sk)->hop_limit = 1;
  2502. err = inet_ctl_sock_create(&net->ipv6.mc_autojoin_sk, PF_INET6,
  2503. SOCK_RAW, IPPROTO_ICMPV6, net);
  2504. if (err < 0) {
  2505. pr_err("Failed to initialize the IGMP6 autojoin socket (err %d)\n",
  2506. err);
  2507. goto out_sock_create;
  2508. }
  2509. err = igmp6_proc_init(net);
  2510. if (err)
  2511. goto out_sock_create_autojoin;
  2512. return 0;
  2513. out_sock_create_autojoin:
  2514. inet_ctl_sock_destroy(net->ipv6.mc_autojoin_sk);
  2515. out_sock_create:
  2516. inet_ctl_sock_destroy(net->ipv6.igmp_sk);
  2517. out:
  2518. return err;
  2519. }
  2520. static void __net_exit igmp6_net_exit(struct net *net)
  2521. {
  2522. inet_ctl_sock_destroy(net->ipv6.igmp_sk);
  2523. inet_ctl_sock_destroy(net->ipv6.mc_autojoin_sk);
  2524. igmp6_proc_exit(net);
  2525. }
  2526. static struct pernet_operations igmp6_net_ops = {
  2527. .init = igmp6_net_init,
  2528. .exit = igmp6_net_exit,
  2529. };
  2530. int __init igmp6_init(void)
  2531. {
  2532. return register_pernet_subsys(&igmp6_net_ops);
  2533. }
  2534. void igmp6_cleanup(void)
  2535. {
  2536. unregister_pernet_subsys(&igmp6_net_ops);
  2537. }