net: qualcomm: rmnet: always expose a few functions
[linux-block.git] / net / ipv6 / mcast.c
CommitLineData
2874c5fd 1// SPDX-License-Identifier: GPL-2.0-or-later
1da177e4
LT
2/*
3 * Multicast support for IPv6
1ab1457c 4 * Linux INET6 implementation
1da177e4
LT
5 *
6 * Authors:
1ab1457c 7 * Pedro Roque <roque@di.fc.ul.pt>
1da177e4 8 *
1ab1457c 9 * Based on linux/ipv4/igmp.c and linux/ipv4/ip_sockglue.c
1da177e4
LT
10 */
11
12/* Changes:
13 *
14 * yoshfuji : fix format of router-alert option
15 * YOSHIFUJI Hideaki @USAGI:
16 * Fixed source address for MLD message based on
17 * <draft-ietf-magma-mld-source-05.txt>.
18 * YOSHIFUJI Hideaki @USAGI:
19 * - Ignore Queries for invalid addresses.
20 * - MLD for link-local addresses.
21 * David L Stevens <dlstevens@us.ibm.com>:
22 * - MLDv2 support
23 */
24
1da177e4
LT
25#include <linux/module.h>
26#include <linux/errno.h>
27#include <linux/types.h>
28#include <linux/string.h>
29#include <linux/socket.h>
30#include <linux/sockios.h>
31#include <linux/jiffies.h>
1da177e4
LT
32#include <linux/net.h>
33#include <linux/in.h>
34#include <linux/in6.h>
35#include <linux/netdevice.h>
36#include <linux/if_arp.h>
37#include <linux/route.h>
38#include <linux/init.h>
39#include <linux/proc_fs.h>
40#include <linux/seq_file.h>
5a0e3ad6 41#include <linux/slab.h>
9d4a0314 42#include <linux/pkt_sched.h>
6e7cb837 43#include <net/mld.h>
2d9a93b4 44#include <linux/workqueue.h>
1da177e4
LT
45
46#include <linux/netfilter.h>
47#include <linux/netfilter_ipv6.h>
48
457c4cbc 49#include <net/net_namespace.h>
1da177e4
LT
50#include <net/sock.h>
51#include <net/snmp.h>
52
53#include <net/ipv6.h>
54#include <net/protocol.h>
55#include <net/if_inet6.h>
56#include <net/ndisc.h>
57#include <net/addrconf.h>
58#include <net/ip6_route.h>
1ed8516f 59#include <net/inet_common.h>
1da177e4
LT
60
61#include <net/ip6_checksum.h>
62
6e7cb837 63/* Ensure that we have struct in6_addr aligned on 32bit word. */
32b395a1
MY
64static int __mld2_query_bugs[] __attribute__((__unused__)) = {
65 BUILD_BUG_ON_ZERO(offsetof(struct mld2_query, mld2q_srcs) % 4),
66 BUILD_BUG_ON_ZERO(offsetof(struct mld2_report, mld2r_grec) % 4),
67 BUILD_BUG_ON_ZERO(offsetof(struct mld2_grec, grec_mca) % 4)
1da177e4
LT
68};
69
2d9a93b4 70static struct workqueue_struct *mld_wq;
1da177e4
LT
71static struct in6_addr mld2_all_mcr = MLD2_ALL_MCR_INIT;
72
1da177e4
LT
73static void igmp6_join_group(struct ifmcaddr6 *ma);
74static void igmp6_leave_group(struct ifmcaddr6 *ma);
2d9a93b4 75static void mld_mca_work(struct work_struct *work);
1da177e4 76
1da177e4 77static void mld_ifc_event(struct inet6_dev *idev);
6c567b78 78static bool mld_in_v1_mode(const struct inet6_dev *idev);
1da177e4
LT
79static int sf_setstate(struct ifmcaddr6 *pmc);
80static void sf_markstate(struct ifmcaddr6 *pmc);
81static void ip6_mc_clear_src(struct ifmcaddr6 *pmc);
b71d1d42
ED
82static int ip6_mc_del_src(struct inet6_dev *idev, const struct in6_addr *pmca,
83 int sfmode, int sfcount, const struct in6_addr *psfsrc,
1da177e4 84 int delta);
b71d1d42
ED
85static int ip6_mc_add_src(struct inet6_dev *idev, const struct in6_addr *pmca,
86 int sfmode, int sfcount, const struct in6_addr *psfsrc,
1da177e4
LT
87 int delta);
88static int ip6_mc_leave_src(struct sock *sk, struct ipv6_mc_socklist *iml,
89 struct inet6_dev *idev);
c7ea20c9
HL
90static int __ipv6_dev_mc_inc(struct net_device *dev,
91 const struct in6_addr *addr, unsigned int mode);
1da177e4 92
1da177e4 93#define MLD_QRV_DEFAULT 2
89225d1c
DB
94/* RFC3810, 9.2. Query Interval */
95#define MLD_QI_DEFAULT (125 * HZ)
96/* RFC3810, 9.3. Query Response Interval */
97#define MLD_QRI_DEFAULT (10 * HZ)
1da177e4 98
9fd07841
DB
99/* RFC3810, 8.1 Query Version Distinctions */
100#define MLD_V1_QUERY_LEN 24
101#define MLD_V2_QUERY_LEN_MIN 28
102
6f4353d8 103#define IPV6_MLD_MAX_MSF 64
1da177e4 104
ab32ea5d 105int sysctl_mld_max_msf __read_mostly = IPV6_MLD_MAX_MSF;
2f711939 106int sysctl_mld_qrv __read_mostly = MLD_QRV_DEFAULT;
1da177e4
LT
107
108/*
109 * socket join on multicast group
110 */
63ed8de4
TY
111#define mc_dereference(e, idev) \
112 rcu_dereference_protected(e, lockdep_is_held(&(idev)->mc_lock))
1da177e4 113
4b4b8446
TY
114#define sock_dereference(e, sk) \
115 rcu_dereference_protected(e, lockdep_sock_is_held(sk))
116
117#define for_each_pmc_socklock(np, sk, pmc) \
118 for (pmc = sock_dereference((np)->ipv6_mc_list, sk); \
88e2ca30 119 pmc; \
4b4b8446 120 pmc = sock_dereference(pmc->next, sk))
88e2ca30 121
456b61bc 122#define for_each_pmc_rcu(np, pmc) \
4b200e39
TY
123 for (pmc = rcu_dereference((np)->ipv6_mc_list); \
124 pmc; \
456b61bc
ED
125 pmc = rcu_dereference(pmc->next))
126
63ed8de4
TY
127#define for_each_psf_mclock(mc, psf) \
128 for (psf = mc_dereference((mc)->mca_sources, mc->idev); \
4b200e39 129 psf; \
63ed8de4 130 psf = mc_dereference(psf->sf_next, mc->idev))
4b200e39
TY
131
132#define for_each_psf_rcu(mc, psf) \
133 for (psf = rcu_dereference((mc)->mca_sources); \
134 psf; \
135 psf = rcu_dereference(psf->sf_next))
136
137#define for_each_psf_tomb(mc, psf) \
63ed8de4 138 for (psf = mc_dereference((mc)->mca_tomb, mc->idev); \
4b200e39 139 psf; \
63ed8de4 140 psf = mc_dereference(psf->sf_next, mc->idev))
4b200e39 141
63ed8de4
TY
142#define for_each_mc_mclock(idev, mc) \
143 for (mc = mc_dereference((idev)->mc_list, idev); \
88e2ca30 144 mc; \
63ed8de4 145 mc = mc_dereference(mc->next, idev))
88e2ca30
TY
146
147#define for_each_mc_rcu(idev, mc) \
148 for (mc = rcu_dereference((idev)->mc_list); \
149 mc; \
150 mc = rcu_dereference(mc->next))
151
152#define for_each_mc_tomb(idev, mc) \
63ed8de4 153 for (mc = mc_dereference((idev)->mc_tomb, idev); \
88e2ca30 154 mc; \
63ed8de4 155 mc = mc_dereference(mc->next, idev))
88e2ca30 156
fc4eba58
HFS
157static int unsolicited_report_interval(struct inet6_dev *idev)
158{
159 int iv;
160
6c567b78 161 if (mld_in_v1_mode(idev))
fc4eba58
HFS
162 iv = idev->cnf.mldv1_unsolicited_report_interval;
163 else
164 iv = idev->cnf.mldv2_unsolicited_report_interval;
165
166 return iv > 0 ? iv : 1;
167}
168
c7ea20c9
HL
169static int __ipv6_sock_mc_join(struct sock *sk, int ifindex,
170 const struct in6_addr *addr, unsigned int mode)
1da177e4
LT
171{
172 struct net_device *dev = NULL;
173 struct ipv6_mc_socklist *mc_lst;
174 struct ipv6_pinfo *np = inet6_sk(sk);
3b1e0a65 175 struct net *net = sock_net(sk);
1da177e4
LT
176 int err;
177
46a4dee0
MC
178 ASSERT_RTNL();
179
1da177e4
LT
180 if (!ipv6_addr_is_multicast(addr))
181 return -EINVAL;
182
4b4b8446 183 for_each_pmc_socklock(np, sk, mc_lst) {
c9e3e8b6 184 if ((ifindex == 0 || mc_lst->ifindex == ifindex) &&
88e2ca30 185 ipv6_addr_equal(&mc_lst->addr, addr))
c9e3e8b6 186 return -EADDRINUSE;
c9e3e8b6 187 }
c9e3e8b6 188
1da177e4
LT
189 mc_lst = sock_kmalloc(sk, sizeof(struct ipv6_mc_socklist), GFP_KERNEL);
190
63159f29 191 if (!mc_lst)
1da177e4
LT
192 return -ENOMEM;
193
194 mc_lst->next = NULL;
4e3fd7a0 195 mc_lst->addr = *addr;
1da177e4
LT
196
197 if (ifindex == 0) {
198 struct rt6_info *rt;
b75cc8f9 199 rt = rt6_lookup(net, addr, NULL, 0, NULL, 0);
1da177e4 200 if (rt) {
d1918542 201 dev = rt->dst.dev;
94e187c0 202 ip6_rt_put(rt);
1da177e4
LT
203 }
204 } else
414b6c94 205 dev = __dev_get_by_index(net, ifindex);
1da177e4 206
63159f29 207 if (!dev) {
1da177e4
LT
208 sock_kfree_s(sk, mc_lst, sizeof(*mc_lst));
209 return -ENODEV;
210 }
211
212 mc_lst->ifindex = dev->ifindex;
c7ea20c9 213 mc_lst->sfmode = mode;
882ba1f7 214 RCU_INIT_POINTER(mc_lst->sflist, NULL);
1da177e4
LT
215
216 /*
217 * now add/increase the group membership on the device
218 */
219
c7ea20c9 220 err = __ipv6_dev_mc_inc(dev, addr, mode);
1da177e4
LT
221
222 if (err) {
223 sock_kfree_s(sk, mc_lst, sizeof(*mc_lst));
1da177e4
LT
224 return err;
225 }
226
1da177e4 227 mc_lst->next = np->ipv6_mc_list;
456b61bc 228 rcu_assign_pointer(np->ipv6_mc_list, mc_lst);
1da177e4 229
46a4dee0
MC
230 return 0;
231}
c7ea20c9
HL
232
233int ipv6_sock_mc_join(struct sock *sk, int ifindex, const struct in6_addr *addr)
234{
235 return __ipv6_sock_mc_join(sk, ifindex, addr, MCAST_EXCLUDE);
236}
46a4dee0 237EXPORT_SYMBOL(ipv6_sock_mc_join);
1da177e4 238
c7ea20c9
HL
239int ipv6_sock_mc_join_ssm(struct sock *sk, int ifindex,
240 const struct in6_addr *addr, unsigned int mode)
241{
242 return __ipv6_sock_mc_join(sk, ifindex, addr, mode);
243}
244
1da177e4
LT
245/*
246 * socket leave on multicast group
247 */
54ff9ef3 248int ipv6_sock_mc_drop(struct sock *sk, int ifindex, const struct in6_addr *addr)
1da177e4
LT
249{
250 struct ipv6_pinfo *np = inet6_sk(sk);
456b61bc
ED
251 struct ipv6_mc_socklist *mc_lst;
252 struct ipv6_mc_socklist __rcu **lnk;
3b1e0a65 253 struct net *net = sock_net(sk);
1da177e4 254
46a4dee0
MC
255 ASSERT_RTNL();
256
a858d64b
LW
257 if (!ipv6_addr_is_multicast(addr))
258 return -EINVAL;
259
456b61bc 260 for (lnk = &np->ipv6_mc_list;
4b4b8446 261 (mc_lst = sock_dereference(*lnk, sk)) != NULL;
456b61bc 262 lnk = &mc_lst->next) {
1da177e4
LT
263 if ((ifindex == 0 || mc_lst->ifindex == ifindex) &&
264 ipv6_addr_equal(&mc_lst->addr, addr)) {
265 struct net_device *dev;
266
267 *lnk = mc_lst->next;
1da177e4 268
414b6c94 269 dev = __dev_get_by_index(net, mc_lst->ifindex);
53b24b8f 270 if (dev) {
96b52e61 271 struct inet6_dev *idev = __in6_dev_get(dev);
1da177e4 272
63ed8de4 273 ip6_mc_leave_src(sk, mc_lst, idev);
96b52e61 274 if (idev)
1da177e4 275 __ipv6_dev_mc_dec(idev, &mc_lst->addr);
63ed8de4
TY
276 } else {
277 ip6_mc_leave_src(sk, mc_lst, NULL);
278 }
a9ed4a29 279
456b61bc 280 atomic_sub(sizeof(*mc_lst), &sk->sk_omem_alloc);
e3cbf28f 281 kfree_rcu(mc_lst, rcu);
1da177e4
LT
282 return 0;
283 }
284 }
1da177e4 285
9951f036 286 return -EADDRNOTAVAIL;
1da177e4 287}
46a4dee0 288EXPORT_SYMBOL(ipv6_sock_mc_drop);
1da177e4 289
88e2ca30
TY
290static struct inet6_dev *ip6_mc_find_dev_rtnl(struct net *net,
291 const struct in6_addr *group,
292 int ifindex)
1da177e4
LT
293{
294 struct net_device *dev = NULL;
295 struct inet6_dev *idev = NULL;
296
297 if (ifindex == 0) {
b75cc8f9 298 struct rt6_info *rt = rt6_lookup(net, group, NULL, 0, NULL, 0);
1da177e4 299
1da177e4 300 if (rt) {
d1918542 301 dev = rt->dst.dev;
94e187c0 302 ip6_rt_put(rt);
1da177e4 303 }
88e2ca30
TY
304 } else {
305 dev = __dev_get_by_index(net, ifindex);
306 }
1da177e4
LT
307
308 if (!dev)
96b52e61
ED
309 return NULL;
310 idev = __in6_dev_get(dev);
448eb71f 311 if (!idev)
8a22c99a 312 return NULL;
88e2ca30 313 if (idev->dead)
96b52e61 314 return NULL;
1da177e4
LT
315 return idev;
316}
317
8651be8f 318void __ipv6_sock_mc_close(struct sock *sk)
1da177e4
LT
319{
320 struct ipv6_pinfo *np = inet6_sk(sk);
321 struct ipv6_mc_socklist *mc_lst;
3b1e0a65 322 struct net *net = sock_net(sk);
1da177e4 323
8651be8f 324 ASSERT_RTNL();
0e1efe9d 325
4b4b8446 326 while ((mc_lst = sock_dereference(np->ipv6_mc_list, sk)) != NULL) {
1da177e4
LT
327 struct net_device *dev;
328
329 np->ipv6_mc_list = mc_lst->next;
1da177e4 330
414b6c94 331 dev = __dev_get_by_index(net, mc_lst->ifindex);
1da177e4 332 if (dev) {
96b52e61 333 struct inet6_dev *idev = __in6_dev_get(dev);
1da177e4 334
63ed8de4 335 ip6_mc_leave_src(sk, mc_lst, idev);
96b52e61 336 if (idev)
1da177e4 337 __ipv6_dev_mc_dec(idev, &mc_lst->addr);
63ed8de4
TY
338 } else {
339 ip6_mc_leave_src(sk, mc_lst, NULL);
340 }
1da177e4 341
456b61bc 342 atomic_sub(sizeof(*mc_lst), &sk->sk_omem_alloc);
e3cbf28f 343 kfree_rcu(mc_lst, rcu);
1da177e4 344 }
8651be8f
WC
345}
346
347void ipv6_sock_mc_close(struct sock *sk)
348{
349 struct ipv6_pinfo *np = inet6_sk(sk);
350
351 if (!rcu_access_pointer(np->ipv6_mc_list))
352 return;
4b4b8446 353
8651be8f 354 rtnl_lock();
4b4b8446 355 lock_sock(sk);
8651be8f 356 __ipv6_sock_mc_close(sk);
4b4b8446 357 release_sock(sk);
a9ed4a29 358 rtnl_unlock();
1da177e4
LT
359}
360
361int ip6_mc_source(int add, int omode, struct sock *sk,
362 struct group_source_req *pgsr)
363{
364 struct in6_addr *source, *group;
365 struct ipv6_mc_socklist *pmc;
1da177e4
LT
366 struct inet6_dev *idev;
367 struct ipv6_pinfo *inet6 = inet6_sk(sk);
368 struct ip6_sf_socklist *psl;
3b1e0a65 369 struct net *net = sock_net(sk);
1da177e4 370 int i, j, rv;
c9e3e8b6 371 int leavegroup = 0;
1da177e4
LT
372 int err;
373
1da177e4
LT
374 source = &((struct sockaddr_in6 *)&pgsr->gsr_source)->sin6_addr;
375 group = &((struct sockaddr_in6 *)&pgsr->gsr_group)->sin6_addr;
376
377 if (!ipv6_addr_is_multicast(group))
378 return -EINVAL;
379
88e2ca30
TY
380 idev = ip6_mc_find_dev_rtnl(net, group, pgsr->gsr_interface);
381 if (!idev)
1da177e4 382 return -ENODEV;
1da177e4
LT
383
384 err = -EADDRNOTAVAIL;
385
63ed8de4 386 mutex_lock(&idev->mc_lock);
4b4b8446 387 for_each_pmc_socklock(inet6, sk, pmc) {
1da177e4
LT
388 if (pgsr->gsr_interface && pmc->ifindex != pgsr->gsr_interface)
389 continue;
390 if (ipv6_addr_equal(&pmc->addr, group))
391 break;
392 }
917f2f10
DS
393 if (!pmc) { /* must have a prior join */
394 err = -EINVAL;
1da177e4 395 goto done;
917f2f10 396 }
1da177e4 397 /* if a source filter was set, must be the same mode as before */
882ba1f7 398 if (rcu_access_pointer(pmc->sflist)) {
917f2f10
DS
399 if (pmc->sfmode != omode) {
400 err = -EINVAL;
1da177e4 401 goto done;
917f2f10 402 }
1da177e4
LT
403 } else if (pmc->sfmode != omode) {
404 /* allow mode switches for empty-set filters */
405 ip6_mc_add_src(idev, group, omode, 0, NULL, 0);
406 ip6_mc_del_src(idev, group, pmc->sfmode, 0, NULL, 0);
407 pmc->sfmode = omode;
408 }
409
4b4b8446 410 psl = sock_dereference(pmc->sflist, sk);
1da177e4
LT
411 if (!add) {
412 if (!psl)
917f2f10 413 goto done; /* err = -EADDRNOTAVAIL */
1da177e4 414 rv = !0;
67ba4152 415 for (i = 0; i < psl->sl_count; i++) {
07c2fecc 416 rv = !ipv6_addr_equal(&psl->sl_addr[i], source);
1da177e4
LT
417 if (rv == 0)
418 break;
419 }
420 if (rv) /* source not found */
917f2f10 421 goto done; /* err = -EADDRNOTAVAIL */
1da177e4 422
c9e3e8b6
DS
423 /* special case - (INCLUDE, empty) == LEAVE_GROUP */
424 if (psl->sl_count == 1 && omode == MCAST_INCLUDE) {
425 leavegroup = 1;
426 goto done;
427 }
428
1da177e4
LT
429 /* update the interface filter */
430 ip6_mc_del_src(idev, group, omode, 1, source, 1);
431
67ba4152 432 for (j = i+1; j < psl->sl_count; j++)
1da177e4
LT
433 psl->sl_addr[j-1] = psl->sl_addr[j];
434 psl->sl_count--;
435 err = 0;
436 goto done;
437 }
438 /* else, add a new source to the filter */
439
440 if (psl && psl->sl_count >= sysctl_mld_max_msf) {
441 err = -ENOBUFS;
442 goto done;
443 }
444 if (!psl || psl->sl_count == psl->sl_max) {
445 struct ip6_sf_socklist *newpsl;
446 int count = IP6_SFBLOCK;
447
448 if (psl)
449 count += psl->sl_max;
f185de28 450 newpsl = sock_kmalloc(sk, IP6_SFLSIZE(count), GFP_KERNEL);
1da177e4
LT
451 if (!newpsl) {
452 err = -ENOBUFS;
453 goto done;
454 }
455 newpsl->sl_max = count;
456 newpsl->sl_count = count - IP6_SFBLOCK;
457 if (psl) {
67ba4152 458 for (i = 0; i < psl->sl_count; i++)
1da177e4 459 newpsl->sl_addr[i] = psl->sl_addr[i];
882ba1f7
TY
460 atomic_sub(IP6_SFLSIZE(psl->sl_max), &sk->sk_omem_alloc);
461 kfree_rcu(psl, rcu);
1da177e4 462 }
882ba1f7
TY
463 psl = newpsl;
464 rcu_assign_pointer(pmc->sflist, psl);
1da177e4
LT
465 }
466 rv = 1; /* > 0 for insert logic below if sl_count is 0 */
67ba4152 467 for (i = 0; i < psl->sl_count; i++) {
07c2fecc 468 rv = !ipv6_addr_equal(&psl->sl_addr[i], source);
56db1c5f
JS
469 if (rv == 0) /* There is an error in the address. */
470 goto done;
1da177e4 471 }
67ba4152 472 for (j = psl->sl_count-1; j >= i; j--)
1da177e4
LT
473 psl->sl_addr[j+1] = psl->sl_addr[j];
474 psl->sl_addr[i] = *source;
475 psl->sl_count++;
476 err = 0;
477 /* update the interface list */
478 ip6_mc_add_src(idev, group, omode, 1, source, 1);
479done:
63ed8de4 480 mutex_unlock(&idev->mc_lock);
c9e3e8b6 481 if (leavegroup)
54ff9ef3 482 err = ipv6_sock_mc_drop(sk, pgsr->gsr_interface, group);
1da177e4
LT
483 return err;
484}
485
d59eb177
AV
486int ip6_mc_msfilter(struct sock *sk, struct group_filter *gsf,
487 struct sockaddr_storage *list)
1da177e4 488{
b71d1d42 489 const struct in6_addr *group;
1da177e4 490 struct ipv6_mc_socklist *pmc;
1da177e4
LT
491 struct inet6_dev *idev;
492 struct ipv6_pinfo *inet6 = inet6_sk(sk);
493 struct ip6_sf_socklist *newpsl, *psl;
3b1e0a65 494 struct net *net = sock_net(sk);
9951f036 495 int leavegroup = 0;
1da177e4
LT
496 int i, err;
497
498 group = &((struct sockaddr_in6 *)&gsf->gf_group)->sin6_addr;
499
500 if (!ipv6_addr_is_multicast(group))
501 return -EINVAL;
502 if (gsf->gf_fmode != MCAST_INCLUDE &&
503 gsf->gf_fmode != MCAST_EXCLUDE)
504 return -EINVAL;
505
88e2ca30
TY
506 idev = ip6_mc_find_dev_rtnl(net, group, gsf->gf_interface);
507 if (!idev)
1da177e4 508 return -ENODEV;
1da177e4 509
9c05989b 510 err = 0;
5ab4a6c8 511
9951f036
DS
512 if (gsf->gf_fmode == MCAST_INCLUDE && gsf->gf_numsrc == 0) {
513 leavegroup = 1;
514 goto done;
515 }
516
4b4b8446 517 for_each_pmc_socklock(inet6, sk, pmc) {
1da177e4
LT
518 if (pmc->ifindex != gsf->gf_interface)
519 continue;
520 if (ipv6_addr_equal(&pmc->addr, group))
521 break;
522 }
917f2f10
DS
523 if (!pmc) { /* must have a prior join */
524 err = -EINVAL;
1da177e4 525 goto done;
917f2f10 526 }
1da177e4 527 if (gsf->gf_numsrc) {
8b3a7005 528 newpsl = sock_kmalloc(sk, IP6_SFLSIZE(gsf->gf_numsrc),
f185de28 529 GFP_KERNEL);
1da177e4
LT
530 if (!newpsl) {
531 err = -ENOBUFS;
532 goto done;
533 }
534 newpsl->sl_max = newpsl->sl_count = gsf->gf_numsrc;
d59eb177 535 for (i = 0; i < newpsl->sl_count; ++i, ++list) {
1da177e4
LT
536 struct sockaddr_in6 *psin6;
537
d59eb177 538 psin6 = (struct sockaddr_in6 *)list;
1da177e4
LT
539 newpsl->sl_addr[i] = psin6->sin6_addr;
540 }
63ed8de4 541 mutex_lock(&idev->mc_lock);
1da177e4 542 err = ip6_mc_add_src(idev, group, gsf->gf_fmode,
63ed8de4 543 newpsl->sl_count, newpsl->sl_addr, 0);
1da177e4 544 if (err) {
63ed8de4 545 mutex_unlock(&idev->mc_lock);
1da177e4
LT
546 sock_kfree_s(sk, newpsl, IP6_SFLSIZE(newpsl->sl_max));
547 goto done;
548 }
63ed8de4 549 mutex_unlock(&idev->mc_lock);
8713dbf0 550 } else {
1da177e4 551 newpsl = NULL;
63ed8de4
TY
552 mutex_lock(&idev->mc_lock);
553 ip6_mc_add_src(idev, group, gsf->gf_fmode, 0, NULL, 0);
554 mutex_unlock(&idev->mc_lock);
8713dbf0 555 }
5ab4a6c8 556
63ed8de4 557 mutex_lock(&idev->mc_lock);
4b4b8446 558 psl = sock_dereference(pmc->sflist, sk);
1da177e4 559 if (psl) {
63ed8de4
TY
560 ip6_mc_del_src(idev, group, pmc->sfmode,
561 psl->sl_count, psl->sl_addr, 0);
882ba1f7
TY
562 atomic_sub(IP6_SFLSIZE(psl->sl_max), &sk->sk_omem_alloc);
563 kfree_rcu(psl, rcu);
63ed8de4
TY
564 } else {
565 ip6_mc_del_src(idev, group, pmc->sfmode, 0, NULL, 0);
566 }
567 mutex_unlock(&idev->mc_lock);
882ba1f7 568 rcu_assign_pointer(pmc->sflist, newpsl);
1da177e4 569 pmc->sfmode = gsf->gf_fmode;
917f2f10 570 err = 0;
1da177e4 571done:
9951f036
DS
572 if (leavegroup)
573 err = ipv6_sock_mc_drop(sk, gsf->gf_interface, group);
1da177e4
LT
574 return err;
575}
576
577int ip6_mc_msfget(struct sock *sk, struct group_filter *gsf,
400490ac 578 struct sockaddr_storage __user *p)
1da177e4 579{
4b4b8446 580 struct ipv6_pinfo *inet6 = inet6_sk(sk);
b71d1d42 581 const struct in6_addr *group;
1da177e4 582 struct ipv6_mc_socklist *pmc;
1da177e4 583 struct ip6_sf_socklist *psl;
4b4b8446 584 int i, count, copycount;
1da177e4
LT
585
586 group = &((struct sockaddr_in6 *)&gsf->gf_group)->sin6_addr;
587
588 if (!ipv6_addr_is_multicast(group))
589 return -EINVAL;
590
f7ed925c 591 /* changes to the ipv6_mc_list require the socket lock and
4b4b8446 592 * rtnl lock. We have the socket lock, so reading the list is safe.
5ab4a6c8 593 */
1da177e4 594
4b4b8446 595 for_each_pmc_socklock(inet6, sk, pmc) {
1da177e4
LT
596 if (pmc->ifindex != gsf->gf_interface)
597 continue;
598 if (ipv6_addr_equal(group, &pmc->addr))
599 break;
600 }
601 if (!pmc) /* must have a prior join */
4b4b8446 602 return -EADDRNOTAVAIL;
88e2ca30 603
1da177e4 604 gsf->gf_fmode = pmc->sfmode;
4b4b8446 605 psl = sock_dereference(pmc->sflist, sk);
1da177e4 606 count = psl ? psl->sl_count : 0;
1da177e4
LT
607
608 copycount = count < gsf->gf_numsrc ? count : gsf->gf_numsrc;
609 gsf->gf_numsrc = count;
882ba1f7 610
931ca7ab 611 for (i = 0; i < copycount; i++, p++) {
1da177e4
LT
612 struct sockaddr_in6 *psin6;
613 struct sockaddr_storage ss;
614
615 psin6 = (struct sockaddr_in6 *)&ss;
616 memset(&ss, 0, sizeof(ss));
617 psin6->sin6_family = AF_INET6;
618 psin6->sin6_addr = psl->sl_addr[i];
931ca7ab 619 if (copy_to_user(p, &ss, sizeof(ss)))
1da177e4
LT
620 return -EFAULT;
621 }
622 return 0;
1da177e4
LT
623}
624
a50feda5
ED
625bool inet6_mc_check(struct sock *sk, const struct in6_addr *mc_addr,
626 const struct in6_addr *src_addr)
1da177e4
LT
627{
628 struct ipv6_pinfo *np = inet6_sk(sk);
629 struct ipv6_mc_socklist *mc;
630 struct ip6_sf_socklist *psl;
a50feda5 631 bool rv = true;
1da177e4 632
456b61bc
ED
633 rcu_read_lock();
634 for_each_pmc_rcu(np, mc) {
1da177e4
LT
635 if (ipv6_addr_equal(&mc->addr, mc_addr))
636 break;
637 }
638 if (!mc) {
456b61bc 639 rcu_read_unlock();
15033f04 640 return np->mc_all;
1da177e4 641 }
882ba1f7 642 psl = rcu_dereference(mc->sflist);
1da177e4
LT
643 if (!psl) {
644 rv = mc->sfmode == MCAST_EXCLUDE;
645 } else {
646 int i;
647
67ba4152 648 for (i = 0; i < psl->sl_count; i++) {
1da177e4
LT
649 if (ipv6_addr_equal(&psl->sl_addr[i], src_addr))
650 break;
651 }
652 if (mc->sfmode == MCAST_INCLUDE && i >= psl->sl_count)
a50feda5 653 rv = false;
1da177e4 654 if (mc->sfmode == MCAST_EXCLUDE && i < psl->sl_count)
a50feda5 655 rv = false;
1da177e4 656 }
456b61bc 657 rcu_read_unlock();
1da177e4
LT
658
659 return rv;
660}
661
63ed8de4 662/* called with mc_lock */
0ae0d60a 663static void igmp6_group_added(struct ifmcaddr6 *mc)
1da177e4
LT
664{
665 struct net_device *dev = mc->idev->dev;
666 char buf[MAX_ADDR_LEN];
667
ec16ef22
YH
668 if (IPV6_ADDR_MC_SCOPE(&mc->mca_addr) <
669 IPV6_ADDR_SCOPE_LINKLOCAL)
670 return;
671
1da177e4
LT
672 if (!(mc->mca_flags&MAF_LOADED)) {
673 mc->mca_flags |= MAF_LOADED;
674 if (ndisc_mc_map(&mc->mca_addr, buf, dev, 0) == 0)
22bedad3 675 dev_mc_add(dev, buf);
1da177e4 676 }
1da177e4
LT
677
678 if (!(dev->flags & IFF_UP) || (mc->mca_flags & MAF_NOREPORT))
679 return;
680
6c567b78 681 if (mld_in_v1_mode(mc->idev)) {
1da177e4
LT
682 igmp6_join_group(mc);
683 return;
684 }
685 /* else v2 */
686
c7ea20c9
HL
687 /* Based on RFC3810 6.1, for newly added INCLUDE SSM, we
688 * should not send filter-mode change record as the mode
689 * should be from IN() to IN(A).
690 */
0ae0d60a 691 if (mc->mca_sfmode == MCAST_EXCLUDE)
c7ea20c9
HL
692 mc->mca_crcount = mc->idev->mc_qrv;
693
1da177e4
LT
694 mld_ifc_event(mc->idev);
695}
696
63ed8de4 697/* called with mc_lock */
1da177e4
LT
698static void igmp6_group_dropped(struct ifmcaddr6 *mc)
699{
700 struct net_device *dev = mc->idev->dev;
701 char buf[MAX_ADDR_LEN];
702
ec16ef22
YH
703 if (IPV6_ADDR_MC_SCOPE(&mc->mca_addr) <
704 IPV6_ADDR_SCOPE_LINKLOCAL)
705 return;
706
1da177e4
LT
707 if (mc->mca_flags&MAF_LOADED) {
708 mc->mca_flags &= ~MAF_LOADED;
709 if (ndisc_mc_map(&mc->mca_addr, buf, dev, 0) == 0)
22bedad3 710 dev_mc_del(dev, buf);
1da177e4
LT
711 }
712
1666d49e
HL
713 if (mc->mca_flags & MAF_NOREPORT)
714 return;
1da177e4
LT
715
716 if (!mc->idev->dead)
717 igmp6_leave_group(mc);
718
2d9a93b4 719 if (cancel_delayed_work(&mc->mca_work))
d3981bc6 720 refcount_dec(&mc->mca_refcnt);
1da177e4
LT
721}
722
723/*
724 * deleted ifmcaddr6 manipulation
63ed8de4 725 * called with mc_lock
1da177e4
LT
726 */
727static void mld_add_delrec(struct inet6_dev *idev, struct ifmcaddr6 *im)
728{
729 struct ifmcaddr6 *pmc;
730
731 /* this is an "ifmcaddr6" for convenience; only the fields below
732 * are actually used. In particular, the refcnt and users are not
733 * used for management of the delete list. Using the same structure
734 * for deleted items allows change reports to use common code with
735 * non-deleted or query-response MCA's.
736 */
f185de28 737 pmc = kzalloc(sizeof(*pmc), GFP_KERNEL);
1da177e4
LT
738 if (!pmc)
739 return;
0c600eda 740
1da177e4
LT
741 pmc->idev = im->idev;
742 in6_dev_hold(idev);
743 pmc->mca_addr = im->mca_addr;
744 pmc->mca_crcount = idev->mc_qrv;
745 pmc->mca_sfmode = im->mca_sfmode;
746 if (pmc->mca_sfmode == MCAST_INCLUDE) {
747 struct ip6_sf_list *psf;
748
4b200e39 749 rcu_assign_pointer(pmc->mca_tomb,
63ed8de4 750 mc_dereference(im->mca_tomb, idev));
4b200e39 751 rcu_assign_pointer(pmc->mca_sources,
63ed8de4 752 mc_dereference(im->mca_sources, idev));
4b200e39
TY
753 RCU_INIT_POINTER(im->mca_tomb, NULL);
754 RCU_INIT_POINTER(im->mca_sources, NULL);
755
63ed8de4 756 for_each_psf_mclock(pmc, psf)
1da177e4
LT
757 psf->sf_crcount = pmc->mca_crcount;
758 }
1da177e4 759
88e2ca30
TY
760 rcu_assign_pointer(pmc->next, idev->mc_tomb);
761 rcu_assign_pointer(idev->mc_tomb, pmc);
1da177e4
LT
762}
763
63ed8de4 764/* called with mc_lock */
1666d49e 765static void mld_del_delrec(struct inet6_dev *idev, struct ifmcaddr6 *im)
1da177e4 766{
4b200e39 767 struct ip6_sf_list *psf, *sources, *tomb;
1666d49e 768 struct in6_addr *pmca = &im->mca_addr;
4b200e39 769 struct ifmcaddr6 *pmc, *pmc_prev;
1da177e4 770
1da177e4 771 pmc_prev = NULL;
88e2ca30 772 for_each_mc_tomb(idev, pmc) {
1da177e4
LT
773 if (ipv6_addr_equal(&pmc->mca_addr, pmca))
774 break;
775 pmc_prev = pmc;
776 }
777 if (pmc) {
778 if (pmc_prev)
88e2ca30 779 rcu_assign_pointer(pmc_prev->next, pmc->next);
1da177e4 780 else
88e2ca30 781 rcu_assign_pointer(idev->mc_tomb, pmc->next);
1da177e4 782 }
6457d26b 783
1da177e4 784 if (pmc) {
1666d49e 785 im->idev = pmc->idev;
08d3ffcc 786 if (im->mca_sfmode == MCAST_INCLUDE) {
4b200e39 787 tomb = rcu_replace_pointer(im->mca_tomb,
63ed8de4
TY
788 mc_dereference(pmc->mca_tomb, pmc->idev),
789 lockdep_is_held(&im->idev->mc_lock));
4b200e39
TY
790 rcu_assign_pointer(pmc->mca_tomb, tomb);
791
792 sources = rcu_replace_pointer(im->mca_sources,
63ed8de4
TY
793 mc_dereference(pmc->mca_sources, pmc->idev),
794 lockdep_is_held(&im->idev->mc_lock));
4b200e39 795 rcu_assign_pointer(pmc->mca_sources, sources);
63ed8de4 796 for_each_psf_mclock(im, psf)
c7ea20c9
HL
797 psf->sf_crcount = idev->mc_qrv;
798 } else {
799 im->mca_crcount = idev->mc_qrv;
1da177e4
LT
800 }
801 in6_dev_put(pmc->idev);
a84d0164 802 ip6_mc_clear_src(pmc);
88e2ca30 803 kfree_rcu(pmc, rcu);
1da177e4
LT
804 }
805}
806
63ed8de4 807/* called with mc_lock */
1da177e4
LT
808static void mld_clear_delrec(struct inet6_dev *idev)
809{
810 struct ifmcaddr6 *pmc, *nextpmc;
811
63ed8de4 812 pmc = mc_dereference(idev->mc_tomb, idev);
88e2ca30 813 RCU_INIT_POINTER(idev->mc_tomb, NULL);
1da177e4
LT
814
815 for (; pmc; pmc = nextpmc) {
63ed8de4 816 nextpmc = mc_dereference(pmc->next, idev);
1da177e4
LT
817 ip6_mc_clear_src(pmc);
818 in6_dev_put(pmc->idev);
88e2ca30 819 kfree_rcu(pmc, rcu);
1da177e4
LT
820 }
821
822 /* clear dead sources, too */
63ed8de4 823 for_each_mc_mclock(idev, pmc) {
1da177e4
LT
824 struct ip6_sf_list *psf, *psf_next;
825
63ed8de4 826 psf = mc_dereference(pmc->mca_tomb, idev);
4b200e39 827 RCU_INIT_POINTER(pmc->mca_tomb, NULL);
67ba4152 828 for (; psf; psf = psf_next) {
63ed8de4 829 psf_next = mc_dereference(psf->sf_next, idev);
4b200e39 830 kfree_rcu(psf, rcu);
1da177e4
LT
831 }
832 }
1da177e4
LT
833}
834
f185de28
TY
835static void mld_clear_query(struct inet6_dev *idev)
836{
837 struct sk_buff *skb;
838
839 spin_lock_bh(&idev->mc_query_lock);
840 while ((skb = __skb_dequeue(&idev->mc_query_queue)))
841 kfree_skb(skb);
842 spin_unlock_bh(&idev->mc_query_lock);
843}
844
845static void mld_clear_report(struct inet6_dev *idev)
846{
847 struct sk_buff *skb;
848
849 spin_lock_bh(&idev->mc_report_lock);
850 while ((skb = __skb_dequeue(&idev->mc_report_queue)))
851 kfree_skb(skb);
852 spin_unlock_bh(&idev->mc_report_lock);
853}
854
1691c63e
WC
855static void mca_get(struct ifmcaddr6 *mc)
856{
d3981bc6 857 refcount_inc(&mc->mca_refcnt);
1691c63e
WC
858}
859
860static void ma_put(struct ifmcaddr6 *mc)
861{
d3981bc6 862 if (refcount_dec_and_test(&mc->mca_refcnt)) {
1691c63e 863 in6_dev_put(mc->idev);
88e2ca30 864 kfree_rcu(mc, rcu);
1691c63e
WC
865 }
866}
867
63ed8de4 868/* called with mc_lock */
1691c63e 869static struct ifmcaddr6 *mca_alloc(struct inet6_dev *idev,
c7ea20c9
HL
870 const struct in6_addr *addr,
871 unsigned int mode)
1691c63e
WC
872{
873 struct ifmcaddr6 *mc;
874
f185de28 875 mc = kzalloc(sizeof(*mc), GFP_KERNEL);
63159f29 876 if (!mc)
1691c63e
WC
877 return NULL;
878
2d9a93b4 879 INIT_DELAYED_WORK(&mc->mca_work, mld_mca_work);
1691c63e
WC
880
881 mc->mca_addr = *addr;
882 mc->idev = idev; /* reference taken by caller */
883 mc->mca_users = 1;
884 /* mca_stamp should be updated upon changes */
885 mc->mca_cstamp = mc->mca_tstamp = jiffies;
d3981bc6 886 refcount_set(&mc->mca_refcnt, 1);
1691c63e 887
c7ea20c9
HL
888 mc->mca_sfmode = mode;
889 mc->mca_sfcount[mode] = 1;
1691c63e
WC
890
891 if (ipv6_addr_is_ll_all_nodes(&mc->mca_addr) ||
892 IPV6_ADDR_MC_SCOPE(&mc->mca_addr) < IPV6_ADDR_SCOPE_LINKLOCAL)
893 mc->mca_flags |= MAF_NOREPORT;
894
895 return mc;
896}
1da177e4
LT
897
898/*
899 * device multicast group inc (add if not found)
900 */
c7ea20c9
HL
901static int __ipv6_dev_mc_inc(struct net_device *dev,
902 const struct in6_addr *addr, unsigned int mode)
1da177e4
LT
903{
904 struct ifmcaddr6 *mc;
905 struct inet6_dev *idev;
906
a9ed4a29
SD
907 ASSERT_RTNL();
908
96b52e61 909 /* we need to take a reference on idev */
1da177e4
LT
910 idev = in6_dev_get(dev);
911
63159f29 912 if (!idev)
1da177e4
LT
913 return -EINVAL;
914
1da177e4 915 if (idev->dead) {
1da177e4
LT
916 in6_dev_put(idev);
917 return -ENODEV;
918 }
919
63ed8de4
TY
920 mutex_lock(&idev->mc_lock);
921 for_each_mc_mclock(idev, mc) {
1da177e4
LT
922 if (ipv6_addr_equal(&mc->mca_addr, addr)) {
923 mc->mca_users++;
c7ea20c9 924 ip6_mc_add_src(idev, &mc->mca_addr, mode, 0, NULL, 0);
63ed8de4 925 mutex_unlock(&idev->mc_lock);
1da177e4
LT
926 in6_dev_put(idev);
927 return 0;
928 }
929 }
930
c7ea20c9 931 mc = mca_alloc(idev, addr, mode);
1691c63e 932 if (!mc) {
63ed8de4 933 mutex_unlock(&idev->mc_lock);
1da177e4
LT
934 in6_dev_put(idev);
935 return -ENOMEM;
936 }
937
88e2ca30
TY
938 rcu_assign_pointer(mc->next, idev->mc_list);
939 rcu_assign_pointer(idev->mc_list, mc);
1691c63e 940
1691c63e 941 mca_get(mc);
1da177e4 942
1666d49e 943 mld_del_delrec(idev, mc);
0ae0d60a 944 igmp6_group_added(mc);
63ed8de4 945 mutex_unlock(&idev->mc_lock);
1da177e4
LT
946 ma_put(mc);
947 return 0;
948}
949
c7ea20c9
HL
950int ipv6_dev_mc_inc(struct net_device *dev, const struct in6_addr *addr)
951{
952 return __ipv6_dev_mc_inc(dev, addr, MCAST_EXCLUDE);
953}
4effd28c 954EXPORT_SYMBOL(ipv6_dev_mc_inc);
c7ea20c9 955
1da177e4 956/*
63ed8de4 957 * device multicast group del
1da177e4 958 */
9acd9f3a 959int __ipv6_dev_mc_dec(struct inet6_dev *idev, const struct in6_addr *addr)
1da177e4 960{
88e2ca30 961 struct ifmcaddr6 *ma, __rcu **map;
1da177e4 962
a9ed4a29
SD
963 ASSERT_RTNL();
964
63ed8de4 965 mutex_lock(&idev->mc_lock);
88e2ca30 966 for (map = &idev->mc_list;
63ed8de4 967 (ma = mc_dereference(*map, idev));
88e2ca30 968 map = &ma->next) {
1da177e4
LT
969 if (ipv6_addr_equal(&ma->mca_addr, addr)) {
970 if (--ma->mca_users == 0) {
971 *map = ma->next;
1da177e4
LT
972
973 igmp6_group_dropped(ma);
1666d49e 974 ip6_mc_clear_src(ma);
63ed8de4 975 mutex_unlock(&idev->mc_lock);
1da177e4
LT
976
977 ma_put(ma);
978 return 0;
979 }
63ed8de4 980 mutex_unlock(&idev->mc_lock);
1da177e4
LT
981 return 0;
982 }
983 }
1da177e4 984
63ed8de4 985 mutex_unlock(&idev->mc_lock);
1da177e4
LT
986 return -ENOENT;
987}
988
9acd9f3a 989int ipv6_dev_mc_dec(struct net_device *dev, const struct in6_addr *addr)
1da177e4 990{
96b52e61 991 struct inet6_dev *idev;
1da177e4
LT
992 int err;
993
414b6c94 994 ASSERT_RTNL();
1da177e4 995
96b52e61
ED
996 idev = __in6_dev_get(dev);
997 if (!idev)
998 err = -ENODEV;
999 else
1000 err = __ipv6_dev_mc_dec(idev, addr);
1da177e4
LT
1001
1002 return err;
1003}
4effd28c 1004EXPORT_SYMBOL(ipv6_dev_mc_dec);
1da177e4 1005
1da177e4
LT
1006/*
1007 * check if the interface/address pair is valid
1008 */
a50feda5
ED
1009bool ipv6_chk_mcast_addr(struct net_device *dev, const struct in6_addr *group,
1010 const struct in6_addr *src_addr)
1da177e4
LT
1011{
1012 struct inet6_dev *idev;
1013 struct ifmcaddr6 *mc;
a50feda5 1014 bool rv = false;
1da177e4 1015
96b52e61
ED
1016 rcu_read_lock();
1017 idev = __in6_dev_get(dev);
1da177e4 1018 if (idev) {
88e2ca30 1019 for_each_mc_rcu(idev, mc) {
1da177e4
LT
1020 if (ipv6_addr_equal(&mc->mca_addr, group))
1021 break;
1022 }
1023 if (mc) {
1024 if (src_addr && !ipv6_addr_any(src_addr)) {
1025 struct ip6_sf_list *psf;
1026
4b200e39 1027 for_each_psf_rcu(mc, psf) {
1da177e4
LT
1028 if (ipv6_addr_equal(&psf->sf_addr, src_addr))
1029 break;
1030 }
1031 if (psf)
1032 rv = psf->sf_count[MCAST_INCLUDE] ||
1033 psf->sf_count[MCAST_EXCLUDE] !=
1034 mc->mca_sfcount[MCAST_EXCLUDE];
1035 else
67ba4152 1036 rv = mc->mca_sfcount[MCAST_EXCLUDE] != 0;
1da177e4 1037 } else
a50feda5 1038 rv = true; /* don't filter unspecified source */
1da177e4 1039 }
1da177e4 1040 }
96b52e61 1041 rcu_read_unlock();
1da177e4
LT
1042 return rv;
1043}
1044
63ed8de4 1045/* called with mc_lock */
2d9a93b4 1046static void mld_gq_start_work(struct inet6_dev *idev)
1da177e4 1047{
63862b5b 1048 unsigned long tv = prandom_u32() % idev->mc_maxdelay;
1da177e4
LT
1049
1050 idev->mc_gq_running = 1;
2d9a93b4 1051 if (!mod_delayed_work(mld_wq, &idev->mc_gq_work, tv + 2))
1da177e4
LT
1052 in6_dev_hold(idev);
1053}
1054
63ed8de4 1055/* called with mc_lock */
2d9a93b4 1056static void mld_gq_stop_work(struct inet6_dev *idev)
b4af8def
DB
1057{
1058 idev->mc_gq_running = 0;
2d9a93b4 1059 if (cancel_delayed_work(&idev->mc_gq_work))
b4af8def
DB
1060 __in6_dev_put(idev);
1061}
1062
63ed8de4 1063/* called with mc_lock */
2d9a93b4 1064static void mld_ifc_start_work(struct inet6_dev *idev, unsigned long delay)
1da177e4 1065{
63862b5b 1066 unsigned long tv = prandom_u32() % delay;
1da177e4 1067
2d9a93b4 1068 if (!mod_delayed_work(mld_wq, &idev->mc_ifc_work, tv + 2))
1da177e4
LT
1069 in6_dev_hold(idev);
1070}
1071
63ed8de4 1072/* called with mc_lock */
2d9a93b4 1073static void mld_ifc_stop_work(struct inet6_dev *idev)
b4af8def
DB
1074{
1075 idev->mc_ifc_count = 0;
2d9a93b4 1076 if (cancel_delayed_work(&idev->mc_ifc_work))
b4af8def
DB
1077 __in6_dev_put(idev);
1078}
1079
63ed8de4 1080/* called with mc_lock */
2d9a93b4 1081static void mld_dad_start_work(struct inet6_dev *idev, unsigned long delay)
b173ee48 1082{
63862b5b 1083 unsigned long tv = prandom_u32() % delay;
b173ee48 1084
2d9a93b4 1085 if (!mod_delayed_work(mld_wq, &idev->mc_dad_work, tv + 2))
b173ee48
HFS
1086 in6_dev_hold(idev);
1087}
1088
2d9a93b4 1089static void mld_dad_stop_work(struct inet6_dev *idev)
b4af8def 1090{
2d9a93b4 1091 if (cancel_delayed_work(&idev->mc_dad_work))
b4af8def
DB
1092 __in6_dev_put(idev);
1093}
1094
f185de28
TY
1095static void mld_query_stop_work(struct inet6_dev *idev)
1096{
1097 spin_lock_bh(&idev->mc_query_lock);
1098 if (cancel_delayed_work(&idev->mc_query_work))
1099 __in6_dev_put(idev);
1100 spin_unlock_bh(&idev->mc_query_lock);
1101}
1102
1103static void mld_report_stop_work(struct inet6_dev *idev)
1104{
1105 if (cancel_delayed_work_sync(&idev->mc_report_work))
1106 __in6_dev_put(idev);
1107}
1108
1da177e4 1109/*
88e2ca30 1110 * IGMP handling (alias multicast ICMPv6 messages)
63ed8de4 1111 * called with mc_lock
1da177e4 1112 */
1da177e4
LT
1113static void igmp6_group_queried(struct ifmcaddr6 *ma, unsigned long resptime)
1114{
1115 unsigned long delay = resptime;
1116
2d9a93b4 1117 /* Do not start work for these addresses */
1da177e4
LT
1118 if (ipv6_addr_is_ll_all_nodes(&ma->mca_addr) ||
1119 IPV6_ADDR_MC_SCOPE(&ma->mca_addr) < IPV6_ADDR_SCOPE_LINKLOCAL)
1120 return;
1121
2d9a93b4 1122 if (cancel_delayed_work(&ma->mca_work)) {
d3981bc6 1123 refcount_dec(&ma->mca_refcnt);
2d9a93b4 1124 delay = ma->mca_work.timer.expires - jiffies;
1da177e4
LT
1125 }
1126
cc7f7ab7 1127 if (delay >= resptime)
63862b5b 1128 delay = prandom_u32() % resptime;
cc7f7ab7 1129
2d9a93b4 1130 if (!mod_delayed_work(mld_wq, &ma->mca_work, delay))
d3981bc6 1131 refcount_inc(&ma->mca_refcnt);
1da177e4
LT
1132 ma->mca_flags |= MAF_TIMER_RUNNING;
1133}
1134
63ed8de4
TY
1135/* mark EXCLUDE-mode sources
1136 * called with mc_lock
1137 */
a50feda5
ED
1138static bool mld_xmarksources(struct ifmcaddr6 *pmc, int nsrcs,
1139 const struct in6_addr *srcs)
1da177e4
LT
1140{
1141 struct ip6_sf_list *psf;
1142 int i, scount;
1143
1144 scount = 0;
63ed8de4 1145 for_each_psf_mclock(pmc, psf) {
1da177e4
LT
1146 if (scount == nsrcs)
1147 break;
67ba4152 1148 for (i = 0; i < nsrcs; i++) {
5ab4a6c8 1149 /* skip inactive filters */
e05c4ad3 1150 if (psf->sf_count[MCAST_INCLUDE] ||
5ab4a6c8
DS
1151 pmc->mca_sfcount[MCAST_EXCLUDE] !=
1152 psf->sf_count[MCAST_EXCLUDE])
ce713ee5 1153 break;
5ab4a6c8
DS
1154 if (ipv6_addr_equal(&srcs[i], &psf->sf_addr)) {
1155 scount++;
1156 break;
1157 }
1158 }
1159 }
1160 pmc->mca_flags &= ~MAF_GSQUERY;
1161 if (scount == nsrcs) /* all sources excluded */
a50feda5
ED
1162 return false;
1163 return true;
5ab4a6c8
DS
1164}
1165
63ed8de4 1166/* called with mc_lock */
a50feda5
ED
1167static bool mld_marksources(struct ifmcaddr6 *pmc, int nsrcs,
1168 const struct in6_addr *srcs)
5ab4a6c8
DS
1169{
1170 struct ip6_sf_list *psf;
1171 int i, scount;
1172
1173 if (pmc->mca_sfmode == MCAST_EXCLUDE)
1174 return mld_xmarksources(pmc, nsrcs, srcs);
1175
1176 /* mark INCLUDE-mode sources */
1177
1178 scount = 0;
63ed8de4 1179 for_each_psf_mclock(pmc, psf) {
5ab4a6c8
DS
1180 if (scount == nsrcs)
1181 break;
67ba4152 1182 for (i = 0; i < nsrcs; i++) {
1da177e4
LT
1183 if (ipv6_addr_equal(&srcs[i], &psf->sf_addr)) {
1184 psf->sf_gsresp = 1;
1185 scount++;
1186 break;
1187 }
5ab4a6c8
DS
1188 }
1189 }
1190 if (!scount) {
1191 pmc->mca_flags &= ~MAF_GSQUERY;
a50feda5 1192 return false;
1da177e4 1193 }
5ab4a6c8 1194 pmc->mca_flags |= MAF_GSQUERY;
a50feda5 1195 return true;
1da177e4
LT
1196}
1197
58c0ecfd
DB
1198static int mld_force_mld_version(const struct inet6_dev *idev)
1199{
1200 /* Normally, both are 0 here. If enforcement to a particular is
1201 * being used, individual device enforcement will have a lower
1202 * precedence over 'all' device (.../conf/all/force_mld_version).
1203 */
1204
1205 if (dev_net(idev->dev)->ipv6.devconf_all->force_mld_version != 0)
1206 return dev_net(idev->dev)->ipv6.devconf_all->force_mld_version;
1207 else
1208 return idev->cnf.force_mld_version;
1209}
1210
1211static bool mld_in_v2_mode_only(const struct inet6_dev *idev)
1212{
1213 return mld_force_mld_version(idev) == 2;
1214}
1215
1216static bool mld_in_v1_mode_only(const struct inet6_dev *idev)
1217{
1218 return mld_force_mld_version(idev) == 1;
1219}
1220
6c567b78
DB
1221static bool mld_in_v1_mode(const struct inet6_dev *idev)
1222{
58c0ecfd
DB
1223 if (mld_in_v2_mode_only(idev))
1224 return false;
1225 if (mld_in_v1_mode_only(idev))
6c567b78
DB
1226 return true;
1227 if (idev->mc_v1_seen && time_before(jiffies, idev->mc_v1_seen))
1228 return true;
1229
1230 return false;
1231}
1232
89225d1c
DB
1233static void mld_set_v1_mode(struct inet6_dev *idev)
1234{
1235 /* RFC3810, relevant sections:
1236 * - 9.1. Robustness Variable
1237 * - 9.2. Query Interval
1238 * - 9.3. Query Response Interval
1239 * - 9.12. Older Version Querier Present Timeout
1240 */
1241 unsigned long switchback;
1242
1243 switchback = (idev->mc_qrv * idev->mc_qi) + idev->mc_qri;
1244
1245 idev->mc_v1_seen = jiffies + switchback;
1246}
1247
1248static void mld_update_qrv(struct inet6_dev *idev,
1249 const struct mld2_query *mlh2)
1250{
1251 /* RFC3810, relevant sections:
1252 * - 5.1.8. QRV (Querier's Robustness Variable)
1253 * - 9.1. Robustness Variable
1254 */
1255
1256 /* The value of the Robustness Variable MUST NOT be zero,
1257 * and SHOULD NOT be one. Catch this here if we ever run
1258 * into such a case in future.
1259 */
2f711939 1260 const int min_qrv = min(MLD_QRV_DEFAULT, sysctl_mld_qrv);
89225d1c
DB
1261 WARN_ON(idev->mc_qrv == 0);
1262
1263 if (mlh2->mld2q_qrv > 0)
1264 idev->mc_qrv = mlh2->mld2q_qrv;
1265
2f711939 1266 if (unlikely(idev->mc_qrv < min_qrv)) {
89225d1c 1267 net_warn_ratelimited("IPv6: MLD: clamping QRV from %u to %u!\n",
2f711939
HFS
1268 idev->mc_qrv, min_qrv);
1269 idev->mc_qrv = min_qrv;
89225d1c
DB
1270 }
1271}
1272
1273static void mld_update_qi(struct inet6_dev *idev,
1274 const struct mld2_query *mlh2)
1275{
1276 /* RFC3810, relevant sections:
1277 * - 5.1.9. QQIC (Querier's Query Interval Code)
1278 * - 9.2. Query Interval
1279 * - 9.12. Older Version Querier Present Timeout
1280 * (the [Query Interval] in the last Query received)
1281 */
1282 unsigned long mc_qqi;
1283
1284 if (mlh2->mld2q_qqic < 128) {
1285 mc_qqi = mlh2->mld2q_qqic;
1286 } else {
1287 unsigned long mc_man, mc_exp;
1288
1289 mc_exp = MLDV2_QQIC_EXP(mlh2->mld2q_qqic);
1290 mc_man = MLDV2_QQIC_MAN(mlh2->mld2q_qqic);
1291
1292 mc_qqi = (mc_man | 0x10) << (mc_exp + 3);
1293 }
1294
1295 idev->mc_qi = mc_qqi * HZ;
1296}
1297
1298static void mld_update_qri(struct inet6_dev *idev,
1299 const struct mld2_query *mlh2)
1300{
1301 /* RFC3810, relevant sections:
1302 * - 5.1.3. Maximum Response Code
1303 * - 9.3. Query Response Interval
1304 */
e3f5b170 1305 idev->mc_qri = msecs_to_jiffies(mldv2_mrc(mlh2));
89225d1c
DB
1306}
1307
2b7c121f 1308static int mld_process_v1(struct inet6_dev *idev, struct mld_msg *mld,
35f7aa53 1309 unsigned long *max_delay, bool v1_query)
2b7c121f
DB
1310{
1311 unsigned long mldv1_md;
1312
1313 /* Ignore v1 queries */
1314 if (mld_in_v2_mode_only(idev))
1315 return -EINVAL;
1316
2b7c121f 1317 mldv1_md = ntohs(mld->mld_maxdelay);
35f7aa53
DB
1318
1319 /* When in MLDv1 fallback and a MLDv2 router start-up being
1320 * unaware of current MLDv1 operation, the MRC == MRD mapping
1321 * only works when the exponential algorithm is not being
1322 * used (as MLDv1 is unaware of such things).
1323 *
1324 * According to the RFC author, the MLDv2 implementations
1325 * he's aware of all use a MRC < 32768 on start up queries.
1326 *
1327 * Thus, should we *ever* encounter something else larger
1328 * than that, just assume the maximum possible within our
1329 * reach.
1330 */
1331 if (!v1_query)
1332 mldv1_md = min(mldv1_md, MLDV1_MRD_MAX_COMPAT);
1333
2b7c121f
DB
1334 *max_delay = max(msecs_to_jiffies(mldv1_md), 1UL);
1335
35f7aa53
DB
1336 /* MLDv1 router present: we need to go into v1 mode *only*
1337 * when an MLDv1 query is received as per section 9.12. of
1338 * RFC3810! And we know from RFC2710 section 3.7 that MLDv1
1339 * queries MUST be of exactly 24 octets.
1340 */
1341 if (v1_query)
1342 mld_set_v1_mode(idev);
2b7c121f 1343
2d9a93b4
TY
1344 /* cancel MLDv2 report work */
1345 mld_gq_stop_work(idev);
1346 /* cancel the interface change work */
1347 mld_ifc_stop_work(idev);
2b7c121f
DB
1348 /* clear deleted report items */
1349 mld_clear_delrec(idev);
1350
1351 return 0;
1352}
1353
1354static int mld_process_v2(struct inet6_dev *idev, struct mld2_query *mld,
1355 unsigned long *max_delay)
1356{
2b7c121f
DB
1357 *max_delay = max(msecs_to_jiffies(mldv2_mrc(mld)), 1UL);
1358
1359 mld_update_qrv(idev, mld);
1360 mld_update_qi(idev, mld);
1361 mld_update_qri(idev, mld);
1362
1363 idev->mc_maxdelay = *max_delay;
1364
1365 return 0;
1366}
1367
96b52e61 1368/* called with rcu_read_lock() */
1da177e4 1369int igmp6_event_query(struct sk_buff *skb)
f185de28
TY
1370{
1371 struct inet6_dev *idev = __in6_dev_get(skb->dev);
1372
1373 if (!idev)
1374 return -EINVAL;
1375
1376 if (idev->dead) {
1377 kfree_skb(skb);
1378 return -ENODEV;
1379 }
1380
1381 spin_lock_bh(&idev->mc_query_lock);
1382 if (skb_queue_len(&idev->mc_query_queue) < MLD_MAX_SKBS) {
1383 __skb_queue_tail(&idev->mc_query_queue, skb);
1384 if (!mod_delayed_work(mld_wq, &idev->mc_query_work, 0))
1385 in6_dev_hold(idev);
1386 }
1387 spin_unlock_bh(&idev->mc_query_lock);
1388
1389 return 0;
1390}
1391
1392static void __mld_query_work(struct sk_buff *skb)
1da177e4 1393{
97300b5f 1394 struct mld2_query *mlh2 = NULL;
b71d1d42 1395 const struct in6_addr *group;
1da177e4
LT
1396 unsigned long max_delay;
1397 struct inet6_dev *idev;
f185de28 1398 struct ifmcaddr6 *ma;
6e7cb837 1399 struct mld_msg *mld;
1da177e4
LT
1400 int group_type;
1401 int mark = 0;
2b7c121f 1402 int len, err;
1da177e4
LT
1403
1404 if (!pskb_may_pull(skb, sizeof(struct in6_addr)))
63ed8de4 1405 goto kfree_skb;
1da177e4
LT
1406
1407 /* compute payload length excluding extension headers */
0660e03f 1408 len = ntohs(ipv6_hdr(skb)->payload_len) + sizeof(struct ipv6hdr);
cfe1fc77 1409 len -= skb_network_header_len(skb);
1da177e4 1410
e940f5d6
HL
1411 /* RFC3810 6.2
1412 * Upon reception of an MLD message that contains a Query, the node
1413 * checks if the source address of the message is a valid link-local
1414 * address, if the Hop Limit is set to 1, and if the Router Alert
1415 * option is present in the Hop-By-Hop Options header of the IPv6
1416 * packet. If any of these checks fails, the packet is dropped.
1417 */
1418 if (!(ipv6_addr_type(&ipv6_hdr(skb)->saddr) & IPV6_ADDR_LINKLOCAL) ||
1419 ipv6_hdr(skb)->hop_limit != 1 ||
1420 !(IP6CB(skb)->flags & IP6SKB_ROUTERALERT) ||
1421 IP6CB(skb)->ra != htons(IPV6_OPT_ROUTERALERT_MLD))
63ed8de4 1422 goto kfree_skb;
1da177e4 1423
63ed8de4 1424 idev = in6_dev_get(skb->dev);
63159f29 1425 if (!idev)
63ed8de4 1426 goto kfree_skb;
1da177e4 1427
6e7cb837
YH
1428 mld = (struct mld_msg *)icmp6_hdr(skb);
1429 group = &mld->mld_mca;
1da177e4
LT
1430 group_type = ipv6_addr_type(group);
1431
1432 if (group_type != IPV6_ADDR_ANY &&
96b52e61 1433 !(group_type&IPV6_ADDR_MULTICAST))
f185de28 1434 goto out;
1da177e4 1435
35f7aa53 1436 if (len < MLD_V1_QUERY_LEN) {
f185de28 1437 goto out;
35f7aa53
DB
1438 } else if (len == MLD_V1_QUERY_LEN || mld_in_v1_mode(idev)) {
1439 err = mld_process_v1(idev, mld, &max_delay,
1440 len == MLD_V1_QUERY_LEN);
2b7c121f 1441 if (err < 0)
f185de28 1442 goto out;
9fd07841 1443 } else if (len >= MLD_V2_QUERY_LEN_MIN) {
1ab1457c 1444 int srcs_offset = sizeof(struct mld2_query) -
97300b5f 1445 sizeof(struct icmp6hdr);
89225d1c 1446
96b52e61 1447 if (!pskb_may_pull(skb, srcs_offset))
f185de28 1448 goto out;
96b52e61 1449
9c70220b 1450 mlh2 = (struct mld2_query *)skb_transport_header(skb);
84698963 1451
2b7c121f
DB
1452 err = mld_process_v2(idev, mlh2, &max_delay);
1453 if (err < 0)
f185de28 1454 goto out;
89225d1c 1455
1da177e4 1456 if (group_type == IPV6_ADDR_ANY) { /* general query */
96b52e61 1457 if (mlh2->mld2q_nsrcs)
f185de28 1458 goto out; /* no sources allowed */
96b52e61 1459
2d9a93b4 1460 mld_gq_start_work(idev);
f185de28 1461 goto out;
1da177e4
LT
1462 }
1463 /* mark sources to include, if group & source-specific */
6e7cb837 1464 if (mlh2->mld2q_nsrcs != 0) {
1ab1457c 1465 if (!pskb_may_pull(skb, srcs_offset +
96b52e61 1466 ntohs(mlh2->mld2q_nsrcs) * sizeof(struct in6_addr)))
f185de28 1467 goto out;
96b52e61 1468
9c70220b 1469 mlh2 = (struct mld2_query *)skb_transport_header(skb);
97300b5f
YZ
1470 mark = 1;
1471 }
35f7aa53 1472 } else {
f185de28 1473 goto out;
35f7aa53 1474 }
1da177e4 1475
1da177e4 1476 if (group_type == IPV6_ADDR_ANY) {
63ed8de4 1477 for_each_mc_mclock(idev, ma) {
1da177e4 1478 igmp6_group_queried(ma, max_delay);
1da177e4
LT
1479 }
1480 } else {
63ed8de4 1481 for_each_mc_mclock(idev, ma) {
7add2a43 1482 if (!ipv6_addr_equal(group, &ma->mca_addr))
1da177e4 1483 continue;
1da177e4
LT
1484 if (ma->mca_flags & MAF_TIMER_RUNNING) {
1485 /* gsquery <- gsquery && mark */
1486 if (!mark)
1487 ma->mca_flags &= ~MAF_GSQUERY;
1488 } else {
1489 /* gsquery <- mark */
1490 if (mark)
1491 ma->mca_flags |= MAF_GSQUERY;
1492 else
1493 ma->mca_flags &= ~MAF_GSQUERY;
1494 }
5ab4a6c8 1495 if (!(ma->mca_flags & MAF_GSQUERY) ||
6e7cb837 1496 mld_marksources(ma, ntohs(mlh2->mld2q_nsrcs), mlh2->mld2q_srcs))
5ab4a6c8 1497 igmp6_group_queried(ma, max_delay);
7add2a43 1498 break;
1da177e4
LT
1499 }
1500 }
1da177e4 1501
f185de28 1502out:
63ed8de4
TY
1503 in6_dev_put(idev);
1504kfree_skb:
f185de28
TY
1505 consume_skb(skb);
1506}
1507
1508static void mld_query_work(struct work_struct *work)
1509{
1510 struct inet6_dev *idev = container_of(to_delayed_work(work),
1511 struct inet6_dev,
1512 mc_query_work);
1513 struct sk_buff_head q;
1514 struct sk_buff *skb;
1515 bool rework = false;
1516 int cnt = 0;
1517
1518 skb_queue_head_init(&q);
1519
1520 spin_lock_bh(&idev->mc_query_lock);
1521 while ((skb = __skb_dequeue(&idev->mc_query_queue))) {
1522 __skb_queue_tail(&q, skb);
1523
1524 if (++cnt >= MLD_MAX_QUEUE) {
1525 rework = true;
1526 schedule_delayed_work(&idev->mc_query_work, 0);
1527 break;
1528 }
1529 }
1530 spin_unlock_bh(&idev->mc_query_lock);
1531
63ed8de4 1532 mutex_lock(&idev->mc_lock);
f185de28
TY
1533 while ((skb = __skb_dequeue(&q)))
1534 __mld_query_work(skb);
63ed8de4 1535 mutex_unlock(&idev->mc_lock);
f185de28
TY
1536
1537 if (!rework)
1538 in6_dev_put(idev);
1da177e4
LT
1539}
1540
96b52e61 1541/* called with rcu_read_lock() */
1da177e4 1542int igmp6_event_report(struct sk_buff *skb)
f185de28
TY
1543{
1544 struct inet6_dev *idev = __in6_dev_get(skb->dev);
1545
1546 if (!idev)
1547 return -EINVAL;
1548
1549 if (idev->dead) {
1550 kfree_skb(skb);
1551 return -ENODEV;
1552 }
1553
1554 spin_lock_bh(&idev->mc_report_lock);
1555 if (skb_queue_len(&idev->mc_report_queue) < MLD_MAX_SKBS) {
1556 __skb_queue_tail(&idev->mc_report_queue, skb);
1557 if (!mod_delayed_work(mld_wq, &idev->mc_report_work, 0))
1558 in6_dev_hold(idev);
1559 }
1560 spin_unlock_bh(&idev->mc_report_lock);
1561
1562 return 0;
1563}
1564
1565static void __mld_report_work(struct sk_buff *skb)
1da177e4 1566{
1da177e4 1567 struct inet6_dev *idev;
63ed8de4 1568 struct ifmcaddr6 *ma;
6e7cb837 1569 struct mld_msg *mld;
1da177e4
LT
1570 int addr_type;
1571
1572 /* Our own report looped back. Ignore it. */
1573 if (skb->pkt_type == PACKET_LOOPBACK)
63ed8de4 1574 goto kfree_skb;
1da177e4 1575
24c69275
DS
1576 /* send our report if the MC router may not have heard this report */
1577 if (skb->pkt_type != PACKET_MULTICAST &&
1578 skb->pkt_type != PACKET_BROADCAST)
63ed8de4 1579 goto kfree_skb;
24c69275 1580
6e7cb837 1581 if (!pskb_may_pull(skb, sizeof(*mld) - sizeof(struct icmp6hdr)))
63ed8de4 1582 goto kfree_skb;
1da177e4 1583
6e7cb837 1584 mld = (struct mld_msg *)icmp6_hdr(skb);
1da177e4
LT
1585
1586 /* Drop reports with not link local source */
0660e03f 1587 addr_type = ipv6_addr_type(&ipv6_hdr(skb)->saddr);
1ab1457c 1588 if (addr_type != IPV6_ADDR_ANY &&
1da177e4 1589 !(addr_type&IPV6_ADDR_LINKLOCAL))
63ed8de4 1590 goto kfree_skb;
1da177e4 1591
63ed8de4 1592 idev = in6_dev_get(skb->dev);
63159f29 1593 if (!idev)
63ed8de4 1594 goto kfree_skb;
1da177e4
LT
1595
1596 /*
2d9a93b4 1597 * Cancel the work for this group
1da177e4
LT
1598 */
1599
63ed8de4 1600 for_each_mc_mclock(idev, ma) {
6e7cb837 1601 if (ipv6_addr_equal(&ma->mca_addr, &mld->mld_mca)) {
2d9a93b4 1602 if (cancel_delayed_work(&ma->mca_work))
d3981bc6 1603 refcount_dec(&ma->mca_refcnt);
88e2ca30
TY
1604 ma->mca_flags &= ~(MAF_LAST_REPORTER |
1605 MAF_TIMER_RUNNING);
1da177e4
LT
1606 break;
1607 }
1608 }
f185de28 1609
63ed8de4
TY
1610 in6_dev_put(idev);
1611kfree_skb:
f185de28
TY
1612 consume_skb(skb);
1613}
1614
1615static void mld_report_work(struct work_struct *work)
1616{
1617 struct inet6_dev *idev = container_of(to_delayed_work(work),
1618 struct inet6_dev,
1619 mc_report_work);
1620 struct sk_buff_head q;
1621 struct sk_buff *skb;
1622 bool rework = false;
1623 int cnt = 0;
1624
1625 skb_queue_head_init(&q);
1626 spin_lock_bh(&idev->mc_report_lock);
1627 while ((skb = __skb_dequeue(&idev->mc_report_queue))) {
1628 __skb_queue_tail(&q, skb);
1629
1630 if (++cnt >= MLD_MAX_QUEUE) {
1631 rework = true;
1632 schedule_delayed_work(&idev->mc_report_work, 0);
1633 break;
1634 }
1635 }
1636 spin_unlock_bh(&idev->mc_report_lock);
1637
63ed8de4 1638 mutex_lock(&idev->mc_lock);
f185de28
TY
1639 while ((skb = __skb_dequeue(&q)))
1640 __mld_report_work(skb);
63ed8de4 1641 mutex_unlock(&idev->mc_lock);
f185de28
TY
1642
1643 if (!rework)
1644 in6_dev_put(idev);
1da177e4
LT
1645}
1646
a50feda5
ED
1647static bool is_in(struct ifmcaddr6 *pmc, struct ip6_sf_list *psf, int type,
1648 int gdeleted, int sdeleted)
1da177e4
LT
1649{
1650 switch (type) {
1651 case MLD2_MODE_IS_INCLUDE:
1652 case MLD2_MODE_IS_EXCLUDE:
1653 if (gdeleted || sdeleted)
a50feda5 1654 return false;
5ab4a6c8
DS
1655 if (!((pmc->mca_flags & MAF_GSQUERY) && !psf->sf_gsresp)) {
1656 if (pmc->mca_sfmode == MCAST_INCLUDE)
a50feda5 1657 return true;
5ab4a6c8
DS
1658 /* don't include if this source is excluded
1659 * in all filters
1660 */
1661 if (psf->sf_count[MCAST_INCLUDE])
7add2a43 1662 return type == MLD2_MODE_IS_INCLUDE;
5ab4a6c8
DS
1663 return pmc->mca_sfcount[MCAST_EXCLUDE] ==
1664 psf->sf_count[MCAST_EXCLUDE];
1665 }
a50feda5 1666 return false;
1da177e4
LT
1667 case MLD2_CHANGE_TO_INCLUDE:
1668 if (gdeleted || sdeleted)
a50feda5 1669 return false;
1da177e4
LT
1670 return psf->sf_count[MCAST_INCLUDE] != 0;
1671 case MLD2_CHANGE_TO_EXCLUDE:
1672 if (gdeleted || sdeleted)
a50feda5 1673 return false;
1da177e4
LT
1674 if (pmc->mca_sfcount[MCAST_EXCLUDE] == 0 ||
1675 psf->sf_count[MCAST_INCLUDE])
a50feda5 1676 return false;
1da177e4
LT
1677 return pmc->mca_sfcount[MCAST_EXCLUDE] ==
1678 psf->sf_count[MCAST_EXCLUDE];
1679 case MLD2_ALLOW_NEW_SOURCES:
1680 if (gdeleted || !psf->sf_crcount)
a50feda5 1681 return false;
1da177e4
LT
1682 return (pmc->mca_sfmode == MCAST_INCLUDE) ^ sdeleted;
1683 case MLD2_BLOCK_OLD_SOURCES:
1684 if (pmc->mca_sfmode == MCAST_INCLUDE)
1685 return gdeleted || (psf->sf_crcount && sdeleted);
1686 return psf->sf_crcount && !gdeleted && !sdeleted;
1687 }
a50feda5 1688 return false;
1da177e4
LT
1689}
1690
1691static int
1692mld_scount(struct ifmcaddr6 *pmc, int type, int gdeleted, int sdeleted)
1693{
1694 struct ip6_sf_list *psf;
1695 int scount = 0;
1696
63ed8de4 1697 for_each_psf_mclock(pmc, psf) {
1da177e4
LT
1698 if (!is_in(pmc, psf, type, gdeleted, sdeleted))
1699 continue;
1700 scount++;
1701 }
1702 return scount;
1703}
1704
2576f17d
YH
1705static void ip6_mc_hdr(struct sock *sk, struct sk_buff *skb,
1706 struct net_device *dev,
1707 const struct in6_addr *saddr,
1708 const struct in6_addr *daddr,
1709 int proto, int len)
1710{
1711 struct ipv6hdr *hdr;
1712
1713 skb->protocol = htons(ETH_P_IPV6);
1714 skb->dev = dev;
1715
1716 skb_reset_network_header(skb);
1717 skb_put(skb, sizeof(struct ipv6hdr));
1718 hdr = ipv6_hdr(skb);
1719
1720 ip6_flow_hdr(hdr, 0, 0);
1721
1722 hdr->payload_len = htons(len);
1723 hdr->nexthdr = proto;
1724 hdr->hop_limit = inet6_sk(sk)->hop_limit;
1725
1726 hdr->saddr = *saddr;
1727 hdr->daddr = *daddr;
1728}
1729
4c672e4b 1730static struct sk_buff *mld_newpack(struct inet6_dev *idev, unsigned int mtu)
1da177e4 1731{
8965779d 1732 struct net_device *dev = idev->dev;
c346dca1 1733 struct net *net = dev_net(dev);
b8ad0cbc 1734 struct sock *sk = net->ipv6.igmp_sk;
1da177e4
LT
1735 struct sk_buff *skb;
1736 struct mld2_report *pmr;
1737 struct in6_addr addr_buf;
d7aabf22 1738 const struct in6_addr *saddr;
a7ae1992
HX
1739 int hlen = LL_RESERVED_SPACE(dev);
1740 int tlen = dev->needed_tailroom;
4c672e4b 1741 unsigned int size = mtu + hlen + tlen;
1da177e4
LT
1742 int err;
1743 u8 ra[8] = { IPPROTO_ICMPV6, 0,
1744 IPV6_TLV_ROUTERALERT, 2, 0, 0,
1745 IPV6_TLV_PADN, 0 };
1746
1747 /* we assume size > sizeof(ra) here */
72e09ad1 1748 skb = sock_alloc_send_skb(sk, size, 1, &err);
cfcabdcc 1749 if (!skb)
1da177e4
LT
1750 return NULL;
1751
9d4a0314 1752 skb->priority = TC_PRIO_CONTROL;
a7ae1992 1753 skb_reserve(skb, hlen);
1837b2e2 1754 skb_tailroom_reserve(skb, mtu, tlen);
1da177e4 1755
8965779d 1756 if (__ipv6_get_lladdr(idev, &addr_buf, IFA_F_TENTATIVE)) {
1da177e4 1757 /* <draft-ietf-magma-mld-source-05.txt>:
1ab1457c 1758 * use unspecified address as the source address
1da177e4
LT
1759 * when a valid link-local address is not available.
1760 */
d7aabf22
YH
1761 saddr = &in6addr_any;
1762 } else
1763 saddr = &addr_buf;
1da177e4 1764
2576f17d 1765 ip6_mc_hdr(sk, skb, dev, saddr, &mld2_all_mcr, NEXTHDR_HOP, 0);
1da177e4 1766
59ae1d12 1767 skb_put_data(skb, ra, sizeof(ra));
1da177e4 1768
27a884dc 1769 skb_set_transport_header(skb, skb_tail_pointer(skb) - skb->data);
d10ba34b
ACM
1770 skb_put(skb, sizeof(*pmr));
1771 pmr = (struct mld2_report *)skb_transport_header(skb);
6e7cb837
YH
1772 pmr->mld2r_type = ICMPV6_MLD2_REPORT;
1773 pmr->mld2r_resv1 = 0;
1774 pmr->mld2r_cksum = 0;
1775 pmr->mld2r_resv2 = 0;
1776 pmr->mld2r_ngrec = 0;
1da177e4
LT
1777 return skb;
1778}
1779
1780static void mld_sendpack(struct sk_buff *skb)
1781{
0660e03f 1782 struct ipv6hdr *pip6 = ipv6_hdr(skb);
9c70220b
ACM
1783 struct mld2_report *pmr =
1784 (struct mld2_report *)skb_transport_header(skb);
1da177e4 1785 int payload_len, mldlen;
96b52e61 1786 struct inet6_dev *idev;
c346dca1 1787 struct net *net = dev_net(skb->dev);
1da177e4 1788 int err;
4c9483b2 1789 struct flowi6 fl6;
adf30907 1790 struct dst_entry *dst;
1da177e4 1791
96b52e61
ED
1792 rcu_read_lock();
1793 idev = __in6_dev_get(skb->dev);
edf391ff
NH
1794 IP6_UPD_PO_STATS(net, idev, IPSTATS_MIB_OUT, skb->len);
1795
29a3cad5
SH
1796 payload_len = (skb_tail_pointer(skb) - skb_network_header(skb)) -
1797 sizeof(*pip6);
1798 mldlen = skb_tail_pointer(skb) - skb_transport_header(skb);
1da177e4
LT
1799 pip6->payload_len = htons(payload_len);
1800
6e7cb837
YH
1801 pmr->mld2r_cksum = csum_ipv6_magic(&pip6->saddr, &pip6->daddr, mldlen,
1802 IPPROTO_ICMPV6,
1803 csum_partial(skb_transport_header(skb),
1804 mldlen, 0));
41927178 1805
4c9483b2 1806 icmpv6_flow_init(net->ipv6.igmp_sk, &fl6, ICMPV6_MLD2_REPORT,
41927178
YH
1807 &ipv6_hdr(skb)->saddr, &ipv6_hdr(skb)->daddr,
1808 skb->dev->ifindex);
12fd84f4 1809 dst = icmp6_dst_alloc(skb->dev, &fl6);
41927178 1810
452edd59
DM
1811 err = 0;
1812 if (IS_ERR(dst)) {
1813 err = PTR_ERR(dst);
1814 dst = NULL;
1815 }
adf30907 1816 skb_dst_set(skb, dst);
41927178
YH
1817 if (err)
1818 goto err_out;
1819
7026b1dd 1820 err = NF_HOOK(NFPROTO_IPV6, NF_INET_LOCAL_OUT,
29a26a56 1821 net, net->ipv6.igmp_sk, skb, NULL, skb->dev,
13206b6b 1822 dst_output);
41927178 1823out:
1da177e4 1824 if (!err) {
43a43b60
HFS
1825 ICMP6MSGOUT_INC_STATS(net, idev, ICMPV6_MLD2_REPORT);
1826 ICMP6_INC_STATS(net, idev, ICMP6_MIB_OUTMSGS);
43a43b60
HFS
1827 } else {
1828 IP6_INC_STATS(net, idev, IPSTATS_MIB_OUTDISCARDS);
1829 }
1da177e4 1830
96b52e61 1831 rcu_read_unlock();
41927178
YH
1832 return;
1833
1834err_out:
1835 kfree_skb(skb);
1836 goto out;
1da177e4
LT
1837}
1838
1839static int grec_size(struct ifmcaddr6 *pmc, int type, int gdel, int sdel)
1840{
fab10fe3 1841 return sizeof(struct mld2_grec) + 16 * mld_scount(pmc,type,gdel,sdel);
1da177e4
LT
1842}
1843
1844static struct sk_buff *add_grhead(struct sk_buff *skb, struct ifmcaddr6 *pmc,
b9b312a7 1845 int type, struct mld2_grec **ppgr, unsigned int mtu)
1da177e4 1846{
1da177e4
LT
1847 struct mld2_report *pmr;
1848 struct mld2_grec *pgr;
1849
b9b312a7
ED
1850 if (!skb) {
1851 skb = mld_newpack(pmc->idev, mtu);
1852 if (!skb)
1853 return NULL;
1854 }
4df864c1 1855 pgr = skb_put(skb, sizeof(struct mld2_grec));
1da177e4
LT
1856 pgr->grec_type = type;
1857 pgr->grec_auxwords = 0;
1858 pgr->grec_nsrcs = 0;
1859 pgr->grec_mca = pmc->mca_addr; /* structure copy */
9c70220b 1860 pmr = (struct mld2_report *)skb_transport_header(skb);
6e7cb837 1861 pmr->mld2r_ngrec = htons(ntohs(pmr->mld2r_ngrec)+1);
1da177e4
LT
1862 *ppgr = pgr;
1863 return skb;
1864}
1865
4c672e4b 1866#define AVAILABLE(skb) ((skb) ? skb_availroom(skb) : 0)
1da177e4 1867
63ed8de4 1868/* called with mc_lock */
1da177e4 1869static struct sk_buff *add_grec(struct sk_buff *skb, struct ifmcaddr6 *pmc,
4b200e39
TY
1870 int type, int gdeleted, int sdeleted,
1871 int crsend)
1da177e4 1872{
4b200e39
TY
1873 struct ip6_sf_list *psf, *psf_prev, *psf_next;
1874 int scount, stotal, first, isquery, truncate;
1875 struct ip6_sf_list __rcu **psf_list;
8965779d
AW
1876 struct inet6_dev *idev = pmc->idev;
1877 struct net_device *dev = idev->dev;
1da177e4 1878 struct mld2_grec *pgr = NULL;
4b200e39 1879 struct mld2_report *pmr;
b9b312a7 1880 unsigned int mtu;
1da177e4
LT
1881
1882 if (pmc->mca_flags & MAF_NOREPORT)
1883 return skb;
1884
b9b312a7
ED
1885 mtu = READ_ONCE(dev->mtu);
1886 if (mtu < IPV6_MIN_MTU)
1887 return skb;
1888
1da177e4
LT
1889 isquery = type == MLD2_MODE_IS_INCLUDE ||
1890 type == MLD2_MODE_IS_EXCLUDE;
1891 truncate = type == MLD2_MODE_IS_EXCLUDE ||
1892 type == MLD2_CHANGE_TO_EXCLUDE;
1893
5ab4a6c8
DS
1894 stotal = scount = 0;
1895
1da177e4
LT
1896 psf_list = sdeleted ? &pmc->mca_tomb : &pmc->mca_sources;
1897
4b200e39 1898 if (!rcu_access_pointer(*psf_list))
5ab4a6c8
DS
1899 goto empty_source;
1900
9c70220b 1901 pmr = skb ? (struct mld2_report *)skb_transport_header(skb) : NULL;
1da177e4
LT
1902
1903 /* EX and TO_EX get a fresh packet, if needed */
1904 if (truncate) {
6e7cb837 1905 if (pmr && pmr->mld2r_ngrec &&
1da177e4
LT
1906 AVAILABLE(skb) < grec_size(pmc, type, gdeleted, sdeleted)) {
1907 if (skb)
1908 mld_sendpack(skb);
b9b312a7 1909 skb = mld_newpack(idev, mtu);
1da177e4
LT
1910 }
1911 }
1912 first = 1;
1da177e4 1913 psf_prev = NULL;
63ed8de4 1914 for (psf = mc_dereference(*psf_list, idev);
4b200e39
TY
1915 psf;
1916 psf = psf_next) {
1da177e4
LT
1917 struct in6_addr *psrc;
1918
63ed8de4 1919 psf_next = mc_dereference(psf->sf_next, idev);
1da177e4 1920
c7ea20c9 1921 if (!is_in(pmc, psf, type, gdeleted, sdeleted) && !crsend) {
1da177e4
LT
1922 psf_prev = psf;
1923 continue;
1924 }
1925
a052517a
HL
1926 /* Based on RFC3810 6.1. Should not send source-list change
1927 * records when there is a filter mode change.
1928 */
1929 if (((gdeleted && pmc->mca_sfmode == MCAST_EXCLUDE) ||
1930 (!gdeleted && pmc->mca_crcount)) &&
1931 (type == MLD2_ALLOW_NEW_SOURCES ||
1932 type == MLD2_BLOCK_OLD_SOURCES) && psf->sf_crcount)
1933 goto decrease_sf_crcount;
1934
1da177e4
LT
1935 /* clear marks on query responses */
1936 if (isquery)
1937 psf->sf_gsresp = 0;
1938
1939 if (AVAILABLE(skb) < sizeof(*psrc) +
1940 first*sizeof(struct mld2_grec)) {
1941 if (truncate && !first)
1942 break; /* truncate these */
1943 if (pgr)
1944 pgr->grec_nsrcs = htons(scount);
1945 if (skb)
1946 mld_sendpack(skb);
b9b312a7 1947 skb = mld_newpack(idev, mtu);
1da177e4
LT
1948 first = 1;
1949 scount = 0;
1950 }
1951 if (first) {
b9b312a7 1952 skb = add_grhead(skb, pmc, type, &pgr, mtu);
1da177e4
LT
1953 first = 0;
1954 }
cc63f70b
AD
1955 if (!skb)
1956 return NULL;
4df864c1 1957 psrc = skb_put(skb, sizeof(*psrc));
1da177e4 1958 *psrc = psf->sf_addr;
5ab4a6c8 1959 scount++; stotal++;
1da177e4
LT
1960 if ((type == MLD2_ALLOW_NEW_SOURCES ||
1961 type == MLD2_BLOCK_OLD_SOURCES) && psf->sf_crcount) {
a052517a 1962decrease_sf_crcount:
1da177e4
LT
1963 psf->sf_crcount--;
1964 if ((sdeleted || gdeleted) && psf->sf_crcount == 0) {
1965 if (psf_prev)
4b200e39 1966 rcu_assign_pointer(psf_prev->sf_next,
63ed8de4 1967 mc_dereference(psf->sf_next, idev));
1da177e4 1968 else
4b200e39 1969 rcu_assign_pointer(*psf_list,
63ed8de4 1970 mc_dereference(psf->sf_next, idev));
4b200e39 1971 kfree_rcu(psf, rcu);
1da177e4
LT
1972 continue;
1973 }
1974 }
1975 psf_prev = psf;
1976 }
5ab4a6c8
DS
1977
1978empty_source:
1979 if (!stotal) {
1980 if (type == MLD2_ALLOW_NEW_SOURCES ||
1981 type == MLD2_BLOCK_OLD_SOURCES)
1982 return skb;
6a7cc418 1983 if (pmc->mca_crcount || isquery || crsend) {
5ab4a6c8
DS
1984 /* make sure we have room for group header */
1985 if (skb && AVAILABLE(skb) < sizeof(struct mld2_grec)) {
1986 mld_sendpack(skb);
1987 skb = NULL; /* add_grhead will get a new one */
1988 }
b9b312a7 1989 skb = add_grhead(skb, pmc, type, &pgr, mtu);
5ab4a6c8
DS
1990 }
1991 }
1da177e4
LT
1992 if (pgr)
1993 pgr->grec_nsrcs = htons(scount);
1994
1995 if (isquery)
1996 pmc->mca_flags &= ~MAF_GSQUERY; /* clear query state */
1997 return skb;
1998}
1999
63ed8de4 2000/* called with mc_lock */
1da177e4
LT
2001static void mld_send_report(struct inet6_dev *idev, struct ifmcaddr6 *pmc)
2002{
2003 struct sk_buff *skb = NULL;
2004 int type;
2005
2006 if (!pmc) {
63ed8de4 2007 for_each_mc_mclock(idev, pmc) {
1da177e4
LT
2008 if (pmc->mca_flags & MAF_NOREPORT)
2009 continue;
1da177e4
LT
2010 if (pmc->mca_sfcount[MCAST_EXCLUDE])
2011 type = MLD2_MODE_IS_EXCLUDE;
2012 else
2013 type = MLD2_MODE_IS_INCLUDE;
6a7cc418 2014 skb = add_grec(skb, pmc, type, 0, 0, 0);
1da177e4 2015 }
1da177e4 2016 } else {
1da177e4
LT
2017 if (pmc->mca_sfcount[MCAST_EXCLUDE])
2018 type = MLD2_MODE_IS_EXCLUDE;
2019 else
2020 type = MLD2_MODE_IS_INCLUDE;
6a7cc418 2021 skb = add_grec(skb, pmc, type, 0, 0, 0);
1da177e4
LT
2022 }
2023 if (skb)
2024 mld_sendpack(skb);
2025}
2026
2027/*
2028 * remove zero-count source records from a source filter list
63ed8de4 2029 * called with mc_lock
1da177e4 2030 */
63ed8de4 2031static void mld_clear_zeros(struct ip6_sf_list __rcu **ppsf, struct inet6_dev *idev)
1da177e4
LT
2032{
2033 struct ip6_sf_list *psf_prev, *psf_next, *psf;
2034
2035 psf_prev = NULL;
63ed8de4 2036 for (psf = mc_dereference(*ppsf, idev);
4b200e39
TY
2037 psf;
2038 psf = psf_next) {
63ed8de4 2039 psf_next = mc_dereference(psf->sf_next, idev);
1da177e4
LT
2040 if (psf->sf_crcount == 0) {
2041 if (psf_prev)
4b200e39 2042 rcu_assign_pointer(psf_prev->sf_next,
63ed8de4 2043 mc_dereference(psf->sf_next, idev));
1da177e4 2044 else
4b200e39 2045 rcu_assign_pointer(*ppsf,
63ed8de4 2046 mc_dereference(psf->sf_next, idev));
4b200e39
TY
2047 kfree_rcu(psf, rcu);
2048 } else {
1da177e4 2049 psf_prev = psf;
4b200e39 2050 }
1da177e4
LT
2051 }
2052}
2053
63ed8de4 2054/* called with mc_lock */
1da177e4
LT
2055static void mld_send_cr(struct inet6_dev *idev)
2056{
2057 struct ifmcaddr6 *pmc, *pmc_prev, *pmc_next;
2058 struct sk_buff *skb = NULL;
2059 int type, dtype;
2060
1da177e4
LT
2061 /* deleted MCA's */
2062 pmc_prev = NULL;
63ed8de4 2063 for (pmc = mc_dereference(idev->mc_tomb, idev);
88e2ca30
TY
2064 pmc;
2065 pmc = pmc_next) {
63ed8de4 2066 pmc_next = mc_dereference(pmc->next, idev);
1da177e4
LT
2067 if (pmc->mca_sfmode == MCAST_INCLUDE) {
2068 type = MLD2_BLOCK_OLD_SOURCES;
2069 dtype = MLD2_BLOCK_OLD_SOURCES;
6a7cc418
FL
2070 skb = add_grec(skb, pmc, type, 1, 0, 0);
2071 skb = add_grec(skb, pmc, dtype, 1, 1, 0);
1da177e4
LT
2072 }
2073 if (pmc->mca_crcount) {
1da177e4
LT
2074 if (pmc->mca_sfmode == MCAST_EXCLUDE) {
2075 type = MLD2_CHANGE_TO_INCLUDE;
6a7cc418 2076 skb = add_grec(skb, pmc, type, 1, 0, 0);
1da177e4 2077 }
5ab4a6c8 2078 pmc->mca_crcount--;
1da177e4 2079 if (pmc->mca_crcount == 0) {
63ed8de4
TY
2080 mld_clear_zeros(&pmc->mca_tomb, idev);
2081 mld_clear_zeros(&pmc->mca_sources, idev);
1da177e4
LT
2082 }
2083 }
4b200e39
TY
2084 if (pmc->mca_crcount == 0 &&
2085 !rcu_access_pointer(pmc->mca_tomb) &&
2086 !rcu_access_pointer(pmc->mca_sources)) {
1da177e4 2087 if (pmc_prev)
88e2ca30 2088 rcu_assign_pointer(pmc_prev->next, pmc_next);
1da177e4 2089 else
88e2ca30 2090 rcu_assign_pointer(idev->mc_tomb, pmc_next);
1da177e4 2091 in6_dev_put(pmc->idev);
88e2ca30 2092 kfree_rcu(pmc, rcu);
1da177e4
LT
2093 } else
2094 pmc_prev = pmc;
2095 }
1da177e4
LT
2096
2097 /* change recs */
63ed8de4 2098 for_each_mc_mclock(idev, pmc) {
1da177e4
LT
2099 if (pmc->mca_sfcount[MCAST_EXCLUDE]) {
2100 type = MLD2_BLOCK_OLD_SOURCES;
2101 dtype = MLD2_ALLOW_NEW_SOURCES;
2102 } else {
2103 type = MLD2_ALLOW_NEW_SOURCES;
2104 dtype = MLD2_BLOCK_OLD_SOURCES;
2105 }
6a7cc418
FL
2106 skb = add_grec(skb, pmc, type, 0, 0, 0);
2107 skb = add_grec(skb, pmc, dtype, 0, 1, 0); /* deleted sources */
1da177e4
LT
2108
2109 /* filter mode changes */
2110 if (pmc->mca_crcount) {
1da177e4
LT
2111 if (pmc->mca_sfmode == MCAST_EXCLUDE)
2112 type = MLD2_CHANGE_TO_EXCLUDE;
2113 else
2114 type = MLD2_CHANGE_TO_INCLUDE;
6a7cc418 2115 skb = add_grec(skb, pmc, type, 0, 0, 0);
5ab4a6c8 2116 pmc->mca_crcount--;
1da177e4 2117 }
1da177e4 2118 }
1da177e4
LT
2119 if (!skb)
2120 return;
2121 (void) mld_sendpack(skb);
2122}
2123
2124static void igmp6_send(struct in6_addr *addr, struct net_device *dev, int type)
2125{
c346dca1 2126 struct net *net = dev_net(dev);
b8ad0cbc 2127 struct sock *sk = net->ipv6.igmp_sk;
1da177e4 2128 struct inet6_dev *idev;
1ab1457c 2129 struct sk_buff *skb;
6e7cb837 2130 struct mld_msg *hdr;
d7aabf22 2131 const struct in6_addr *snd_addr, *saddr;
1da177e4 2132 struct in6_addr addr_buf;
a7ae1992
HX
2133 int hlen = LL_RESERVED_SPACE(dev);
2134 int tlen = dev->needed_tailroom;
1da177e4
LT
2135 int err, len, payload_len, full_len;
2136 u8 ra[8] = { IPPROTO_ICMPV6, 0,
2137 IPV6_TLV_ROUTERALERT, 2, 0, 0,
2138 IPV6_TLV_PADN, 0 };
4c9483b2 2139 struct flowi6 fl6;
adf30907 2140 struct dst_entry *dst;
1da177e4 2141
f3ee4010
YH
2142 if (type == ICMPV6_MGM_REDUCTION)
2143 snd_addr = &in6addr_linklocal_allrouters;
2144 else
2145 snd_addr = addr;
1da177e4
LT
2146
2147 len = sizeof(struct icmp6hdr) + sizeof(struct in6_addr);
2148 payload_len = len + sizeof(ra);
2149 full_len = sizeof(struct ipv6hdr) + payload_len;
2150
edf391ff
NH
2151 rcu_read_lock();
2152 IP6_UPD_PO_STATS(net, __in6_dev_get(dev),
2153 IPSTATS_MIB_OUT, full_len);
2154 rcu_read_unlock();
2155
a7ae1992 2156 skb = sock_alloc_send_skb(sk, hlen + tlen + full_len, 1, &err);
1da177e4 2157
63159f29 2158 if (!skb) {
a11d206d 2159 rcu_read_lock();
3bd653c8 2160 IP6_INC_STATS(net, __in6_dev_get(dev),
a11d206d
YH
2161 IPSTATS_MIB_OUTDISCARDS);
2162 rcu_read_unlock();
1da177e4
LT
2163 return;
2164 }
9d4a0314 2165 skb->priority = TC_PRIO_CONTROL;
a7ae1992 2166 skb_reserve(skb, hlen);
1da177e4 2167
95c385b4 2168 if (ipv6_get_lladdr(dev, &addr_buf, IFA_F_TENTATIVE)) {
1da177e4 2169 /* <draft-ietf-magma-mld-source-05.txt>:
1ab1457c 2170 * use unspecified address as the source address
1da177e4
LT
2171 * when a valid link-local address is not available.
2172 */
d7aabf22
YH
2173 saddr = &in6addr_any;
2174 } else
2175 saddr = &addr_buf;
1da177e4 2176
2576f17d 2177 ip6_mc_hdr(sk, skb, dev, saddr, snd_addr, NEXTHDR_HOP, payload_len);
1da177e4 2178
59ae1d12 2179 skb_put_data(skb, ra, sizeof(ra));
1da177e4 2180
b080db58 2181 hdr = skb_put_zero(skb, sizeof(struct mld_msg));
6e7cb837 2182 hdr->mld_type = type;
4e3fd7a0 2183 hdr->mld_mca = *addr;
1da177e4 2184
6e7cb837
YH
2185 hdr->mld_cksum = csum_ipv6_magic(saddr, snd_addr, len,
2186 IPPROTO_ICMPV6,
2187 csum_partial(hdr, len, 0));
1da177e4 2188
96b52e61
ED
2189 rcu_read_lock();
2190 idev = __in6_dev_get(skb->dev);
1da177e4 2191
4c9483b2 2192 icmpv6_flow_init(sk, &fl6, type,
41927178
YH
2193 &ipv6_hdr(skb)->saddr, &ipv6_hdr(skb)->daddr,
2194 skb->dev->ifindex);
12fd84f4 2195 dst = icmp6_dst_alloc(skb->dev, &fl6);
452edd59
DM
2196 if (IS_ERR(dst)) {
2197 err = PTR_ERR(dst);
41927178 2198 goto err_out;
452edd59 2199 }
41927178 2200
adf30907 2201 skb_dst_set(skb, dst);
29a26a56
EB
2202 err = NF_HOOK(NFPROTO_IPV6, NF_INET_LOCAL_OUT,
2203 net, sk, skb, NULL, skb->dev,
13206b6b 2204 dst_output);
41927178 2205out:
1da177e4 2206 if (!err) {
5c5d244b 2207 ICMP6MSGOUT_INC_STATS(net, idev, type);
a862f6a6 2208 ICMP6_INC_STATS(net, idev, ICMP6_MIB_OUTMSGS);
1da177e4 2209 } else
3bd653c8 2210 IP6_INC_STATS(net, idev, IPSTATS_MIB_OUTDISCARDS);
1da177e4 2211
96b52e61 2212 rcu_read_unlock();
1da177e4 2213 return;
41927178
YH
2214
2215err_out:
2216 kfree_skb(skb);
2217 goto out;
1da177e4
LT
2218}
2219
63ed8de4 2220/* called with mc_lock */
6a7cc418 2221static void mld_send_initial_cr(struct inet6_dev *idev)
b173ee48 2222{
6a7cc418
FL
2223 struct sk_buff *skb;
2224 struct ifmcaddr6 *pmc;
2225 int type;
2226
2227 if (mld_in_v1_mode(idev))
2228 return;
2229
2230 skb = NULL;
63ed8de4 2231 for_each_mc_mclock(idev, pmc) {
6a7cc418
FL
2232 if (pmc->mca_sfcount[MCAST_EXCLUDE])
2233 type = MLD2_CHANGE_TO_EXCLUDE;
2234 else
c7ea20c9 2235 type = MLD2_ALLOW_NEW_SOURCES;
6a7cc418 2236 skb = add_grec(skb, pmc, type, 0, 0, 1);
b173ee48 2237 }
6a7cc418
FL
2238 if (skb)
2239 mld_sendpack(skb);
b173ee48
HFS
2240}
2241
2242void ipv6_mc_dad_complete(struct inet6_dev *idev)
2243{
63ed8de4 2244 mutex_lock(&idev->mc_lock);
b173ee48
HFS
2245 idev->mc_dad_count = idev->mc_qrv;
2246 if (idev->mc_dad_count) {
6a7cc418 2247 mld_send_initial_cr(idev);
b173ee48
HFS
2248 idev->mc_dad_count--;
2249 if (idev->mc_dad_count)
2d9a93b4
TY
2250 mld_dad_start_work(idev,
2251 unsolicited_report_interval(idev));
b173ee48 2252 }
63ed8de4 2253 mutex_unlock(&idev->mc_lock);
b173ee48
HFS
2254}
2255
2d9a93b4 2256static void mld_dad_work(struct work_struct *work)
b173ee48 2257{
2d9a93b4
TY
2258 struct inet6_dev *idev = container_of(to_delayed_work(work),
2259 struct inet6_dev,
2260 mc_dad_work);
63ed8de4 2261 mutex_lock(&idev->mc_lock);
6a7cc418 2262 mld_send_initial_cr(idev);
b173ee48
HFS
2263 if (idev->mc_dad_count) {
2264 idev->mc_dad_count--;
2265 if (idev->mc_dad_count)
2d9a93b4
TY
2266 mld_dad_start_work(idev,
2267 unsolicited_report_interval(idev));
b173ee48 2268 }
63ed8de4 2269 mutex_unlock(&idev->mc_lock);
9260d3e1 2270 in6_dev_put(idev);
b173ee48
HFS
2271}
2272
63ed8de4 2273/* called with mc_lock */
1da177e4 2274static int ip6_mc_del1_src(struct ifmcaddr6 *pmc, int sfmode,
b71d1d42 2275 const struct in6_addr *psfsrc)
1da177e4
LT
2276{
2277 struct ip6_sf_list *psf, *psf_prev;
2278 int rv = 0;
2279
2280 psf_prev = NULL;
63ed8de4 2281 for_each_psf_mclock(pmc, psf) {
1da177e4
LT
2282 if (ipv6_addr_equal(&psf->sf_addr, psfsrc))
2283 break;
2284 psf_prev = psf;
2285 }
2286 if (!psf || psf->sf_count[sfmode] == 0) {
2287 /* source filter not found, or count wrong => bug */
2288 return -ESRCH;
2289 }
2290 psf->sf_count[sfmode]--;
2291 if (!psf->sf_count[MCAST_INCLUDE] && !psf->sf_count[MCAST_EXCLUDE]) {
2292 struct inet6_dev *idev = pmc->idev;
2293
2294 /* no more filters for this source */
2295 if (psf_prev)
4b200e39 2296 rcu_assign_pointer(psf_prev->sf_next,
63ed8de4 2297 mc_dereference(psf->sf_next, idev));
1da177e4 2298 else
4b200e39 2299 rcu_assign_pointer(pmc->mca_sources,
63ed8de4 2300 mc_dereference(psf->sf_next, idev));
4b200e39 2301
1da177e4 2302 if (psf->sf_oldin && !(pmc->mca_flags & MAF_NOREPORT) &&
6c567b78 2303 !mld_in_v1_mode(idev)) {
1da177e4 2304 psf->sf_crcount = idev->mc_qrv;
4b200e39 2305 rcu_assign_pointer(psf->sf_next,
63ed8de4 2306 mc_dereference(pmc->mca_tomb, idev));
4b200e39 2307 rcu_assign_pointer(pmc->mca_tomb, psf);
1da177e4 2308 rv = 1;
4b200e39
TY
2309 } else {
2310 kfree_rcu(psf, rcu);
2311 }
1da177e4
LT
2312 }
2313 return rv;
2314}
2315
63ed8de4 2316/* called with mc_lock */
b71d1d42
ED
2317static int ip6_mc_del_src(struct inet6_dev *idev, const struct in6_addr *pmca,
2318 int sfmode, int sfcount, const struct in6_addr *psfsrc,
1da177e4
LT
2319 int delta)
2320{
2321 struct ifmcaddr6 *pmc;
2322 int changerec = 0;
2323 int i, err;
2324
2325 if (!idev)
2326 return -ENODEV;
88e2ca30 2327
63ed8de4 2328 for_each_mc_mclock(idev, pmc) {
1da177e4
LT
2329 if (ipv6_addr_equal(pmca, &pmc->mca_addr))
2330 break;
2331 }
88e2ca30 2332 if (!pmc)
1da177e4 2333 return -ESRCH;
88e2ca30 2334
1da177e4
LT
2335 sf_markstate(pmc);
2336 if (!delta) {
63ed8de4 2337 if (!pmc->mca_sfcount[sfmode])
1da177e4 2338 return -EINVAL;
88e2ca30 2339
1da177e4
LT
2340 pmc->mca_sfcount[sfmode]--;
2341 }
2342 err = 0;
67ba4152 2343 for (i = 0; i < sfcount; i++) {
1da177e4
LT
2344 int rv = ip6_mc_del1_src(pmc, sfmode, &psfsrc[i]);
2345
2346 changerec |= rv > 0;
2347 if (!err && rv < 0)
2348 err = rv;
2349 }
2350 if (pmc->mca_sfmode == MCAST_EXCLUDE &&
2351 pmc->mca_sfcount[MCAST_EXCLUDE] == 0 &&
2352 pmc->mca_sfcount[MCAST_INCLUDE]) {
2353 struct ip6_sf_list *psf;
2354
2355 /* filter mode change */
2356 pmc->mca_sfmode = MCAST_INCLUDE;
2357 pmc->mca_crcount = idev->mc_qrv;
2358 idev->mc_ifc_count = pmc->mca_crcount;
63ed8de4 2359 for_each_psf_mclock(pmc, psf)
1da177e4
LT
2360 psf->sf_crcount = 0;
2361 mld_ifc_event(pmc->idev);
63ed8de4 2362 } else if (sf_setstate(pmc) || changerec) {
1da177e4 2363 mld_ifc_event(pmc->idev);
63ed8de4
TY
2364 }
2365
1da177e4
LT
2366 return err;
2367}
2368
2369/*
2370 * Add multicast single-source filter to the interface list
63ed8de4 2371 * called with mc_lock
1da177e4
LT
2372 */
2373static int ip6_mc_add1_src(struct ifmcaddr6 *pmc, int sfmode,
99d2f47a 2374 const struct in6_addr *psfsrc)
1da177e4
LT
2375{
2376 struct ip6_sf_list *psf, *psf_prev;
2377
2378 psf_prev = NULL;
63ed8de4 2379 for_each_psf_mclock(pmc, psf) {
1da177e4
LT
2380 if (ipv6_addr_equal(&psf->sf_addr, psfsrc))
2381 break;
2382 psf_prev = psf;
2383 }
2384 if (!psf) {
f185de28 2385 psf = kzalloc(sizeof(*psf), GFP_KERNEL);
1da177e4
LT
2386 if (!psf)
2387 return -ENOBUFS;
0c600eda 2388
1da177e4
LT
2389 psf->sf_addr = *psfsrc;
2390 if (psf_prev) {
4b200e39
TY
2391 rcu_assign_pointer(psf_prev->sf_next, psf);
2392 } else {
2393 rcu_assign_pointer(pmc->mca_sources, psf);
2394 }
1da177e4
LT
2395 }
2396 psf->sf_count[sfmode]++;
2397 return 0;
2398}
2399
63ed8de4 2400/* called with mc_lock */
1da177e4
LT
2401static void sf_markstate(struct ifmcaddr6 *pmc)
2402{
2403 struct ip6_sf_list *psf;
2404 int mca_xcount = pmc->mca_sfcount[MCAST_EXCLUDE];
2405
63ed8de4 2406 for_each_psf_mclock(pmc, psf) {
1da177e4
LT
2407 if (pmc->mca_sfcount[MCAST_EXCLUDE]) {
2408 psf->sf_oldin = mca_xcount ==
2409 psf->sf_count[MCAST_EXCLUDE] &&
2410 !psf->sf_count[MCAST_INCLUDE];
4b200e39 2411 } else {
1da177e4 2412 psf->sf_oldin = psf->sf_count[MCAST_INCLUDE] != 0;
4b200e39
TY
2413 }
2414 }
1da177e4
LT
2415}
2416
63ed8de4 2417/* called with mc_lock */
1da177e4
LT
2418static int sf_setstate(struct ifmcaddr6 *pmc)
2419{
7add2a43 2420 struct ip6_sf_list *psf, *dpsf;
1da177e4
LT
2421 int mca_xcount = pmc->mca_sfcount[MCAST_EXCLUDE];
2422 int qrv = pmc->idev->mc_qrv;
2423 int new_in, rv;
2424
2425 rv = 0;
63ed8de4 2426 for_each_psf_mclock(pmc, psf) {
1da177e4
LT
2427 if (pmc->mca_sfcount[MCAST_EXCLUDE]) {
2428 new_in = mca_xcount == psf->sf_count[MCAST_EXCLUDE] &&
2429 !psf->sf_count[MCAST_INCLUDE];
2430 } else
2431 new_in = psf->sf_count[MCAST_INCLUDE] != 0;
7add2a43
DS
2432 if (new_in) {
2433 if (!psf->sf_oldin) {
e80e28b6 2434 struct ip6_sf_list *prev = NULL;
7add2a43 2435
4b200e39 2436 for_each_psf_tomb(pmc, dpsf) {
7add2a43
DS
2437 if (ipv6_addr_equal(&dpsf->sf_addr,
2438 &psf->sf_addr))
2439 break;
2440 prev = dpsf;
2441 }
2442 if (dpsf) {
2443 if (prev)
4b200e39 2444 rcu_assign_pointer(prev->sf_next,
63ed8de4
TY
2445 mc_dereference(dpsf->sf_next,
2446 pmc->idev));
7add2a43 2447 else
4b200e39 2448 rcu_assign_pointer(pmc->mca_tomb,
63ed8de4
TY
2449 mc_dereference(dpsf->sf_next,
2450 pmc->idev));
4b200e39 2451 kfree_rcu(dpsf, rcu);
7add2a43
DS
2452 }
2453 psf->sf_crcount = qrv;
2454 rv++;
2455 }
2456 } else if (psf->sf_oldin) {
2457 psf->sf_crcount = 0;
2458 /*
2459 * add or update "delete" records if an active filter
2460 * is now inactive
2461 */
4b200e39
TY
2462
2463 for_each_psf_tomb(pmc, dpsf)
7add2a43
DS
2464 if (ipv6_addr_equal(&dpsf->sf_addr,
2465 &psf->sf_addr))
2466 break;
2467 if (!dpsf) {
f185de28 2468 dpsf = kmalloc(sizeof(*dpsf), GFP_KERNEL);
7add2a43
DS
2469 if (!dpsf)
2470 continue;
2471 *dpsf = *psf;
4b200e39 2472 rcu_assign_pointer(dpsf->sf_next,
63ed8de4 2473 mc_dereference(pmc->mca_tomb, pmc->idev));
4b200e39 2474 rcu_assign_pointer(pmc->mca_tomb, dpsf);
7add2a43
DS
2475 }
2476 dpsf->sf_crcount = qrv;
1da177e4
LT
2477 rv++;
2478 }
2479 }
2480 return rv;
2481}
2482
2483/*
2484 * Add multicast source filter list to the interface list
63ed8de4 2485 * called with mc_lock
1da177e4 2486 */
b71d1d42
ED
2487static int ip6_mc_add_src(struct inet6_dev *idev, const struct in6_addr *pmca,
2488 int sfmode, int sfcount, const struct in6_addr *psfsrc,
1da177e4
LT
2489 int delta)
2490{
2491 struct ifmcaddr6 *pmc;
2492 int isexclude;
2493 int i, err;
2494
2495 if (!idev)
2496 return -ENODEV;
88e2ca30 2497
63ed8de4 2498 for_each_mc_mclock(idev, pmc) {
1da177e4
LT
2499 if (ipv6_addr_equal(pmca, &pmc->mca_addr))
2500 break;
2501 }
88e2ca30 2502 if (!pmc)
1da177e4 2503 return -ESRCH;
1da177e4
LT
2504
2505 sf_markstate(pmc);
2506 isexclude = pmc->mca_sfmode == MCAST_EXCLUDE;
2507 if (!delta)
2508 pmc->mca_sfcount[sfmode]++;
2509 err = 0;
67ba4152 2510 for (i = 0; i < sfcount; i++) {
99d2f47a 2511 err = ip6_mc_add1_src(pmc, sfmode, &psfsrc[i]);
1da177e4
LT
2512 if (err)
2513 break;
2514 }
2515 if (err) {
2516 int j;
2517
2518 if (!delta)
2519 pmc->mca_sfcount[sfmode]--;
67ba4152 2520 for (j = 0; j < i; j++)
78d50217 2521 ip6_mc_del1_src(pmc, sfmode, &psfsrc[j]);
1da177e4 2522 } else if (isexclude != (pmc->mca_sfcount[MCAST_EXCLUDE] != 0)) {
1da177e4
LT
2523 struct ip6_sf_list *psf;
2524
2525 /* filter mode change */
2526 if (pmc->mca_sfcount[MCAST_EXCLUDE])
2527 pmc->mca_sfmode = MCAST_EXCLUDE;
2528 else if (pmc->mca_sfcount[MCAST_INCLUDE])
2529 pmc->mca_sfmode = MCAST_INCLUDE;
2530 /* else no filters; keep old mode for reports */
2531
2532 pmc->mca_crcount = idev->mc_qrv;
2533 idev->mc_ifc_count = pmc->mca_crcount;
63ed8de4 2534 for_each_psf_mclock(pmc, psf)
1da177e4
LT
2535 psf->sf_crcount = 0;
2536 mld_ifc_event(idev);
88e2ca30 2537 } else if (sf_setstate(pmc)) {
1da177e4 2538 mld_ifc_event(idev);
88e2ca30 2539 }
1da177e4
LT
2540 return err;
2541}
2542
63ed8de4 2543/* called with mc_lock */
1da177e4
LT
2544static void ip6_mc_clear_src(struct ifmcaddr6 *pmc)
2545{
2546 struct ip6_sf_list *psf, *nextpsf;
2547
63ed8de4 2548 for (psf = mc_dereference(pmc->mca_tomb, pmc->idev);
4b200e39
TY
2549 psf;
2550 psf = nextpsf) {
63ed8de4 2551 nextpsf = mc_dereference(psf->sf_next, pmc->idev);
4b200e39 2552 kfree_rcu(psf, rcu);
1da177e4 2553 }
4b200e39 2554 RCU_INIT_POINTER(pmc->mca_tomb, NULL);
63ed8de4 2555 for (psf = mc_dereference(pmc->mca_sources, pmc->idev);
4b200e39
TY
2556 psf;
2557 psf = nextpsf) {
63ed8de4 2558 nextpsf = mc_dereference(psf->sf_next, pmc->idev);
4b200e39 2559 kfree_rcu(psf, rcu);
1da177e4 2560 }
4b200e39 2561 RCU_INIT_POINTER(pmc->mca_sources, NULL);
1da177e4 2562 pmc->mca_sfmode = MCAST_EXCLUDE;
de9daad9 2563 pmc->mca_sfcount[MCAST_INCLUDE] = 0;
1da177e4
LT
2564 pmc->mca_sfcount[MCAST_EXCLUDE] = 1;
2565}
2566
63ed8de4 2567/* called with mc_lock */
1da177e4
LT
2568static void igmp6_join_group(struct ifmcaddr6 *ma)
2569{
2570 unsigned long delay;
2571
2572 if (ma->mca_flags & MAF_NOREPORT)
2573 return;
2574
2575 igmp6_send(&ma->mca_addr, ma->idev->dev, ICMPV6_MGM_REPORT);
2576
63862b5b 2577 delay = prandom_u32() % unsolicited_report_interval(ma->idev);
1da177e4 2578
2d9a93b4 2579 if (cancel_delayed_work(&ma->mca_work)) {
d3981bc6 2580 refcount_dec(&ma->mca_refcnt);
2d9a93b4 2581 delay = ma->mca_work.timer.expires - jiffies;
1da177e4
LT
2582 }
2583
2d9a93b4 2584 if (!mod_delayed_work(mld_wq, &ma->mca_work, delay))
d3981bc6 2585 refcount_inc(&ma->mca_refcnt);
1da177e4 2586 ma->mca_flags |= MAF_TIMER_RUNNING | MAF_LAST_REPORTER;
1da177e4
LT
2587}
2588
2589static int ip6_mc_leave_src(struct sock *sk, struct ipv6_mc_socklist *iml,
2590 struct inet6_dev *idev)
2591{
882ba1f7 2592 struct ip6_sf_socklist *psl;
1da177e4
LT
2593 int err;
2594
4b4b8446 2595 psl = sock_dereference(iml->sflist, sk);
882ba1f7 2596
63ed8de4
TY
2597 if (idev)
2598 mutex_lock(&idev->mc_lock);
2599
882ba1f7 2600 if (!psl) {
1da177e4 2601 /* any-source empty exclude case */
dc012f36
ED
2602 err = ip6_mc_del_src(idev, &iml->addr, iml->sfmode, 0, NULL, 0);
2603 } else {
2604 err = ip6_mc_del_src(idev, &iml->addr, iml->sfmode,
63ed8de4 2605 psl->sl_count, psl->sl_addr, 0);
882ba1f7
TY
2606 RCU_INIT_POINTER(iml->sflist, NULL);
2607 atomic_sub(IP6_SFLSIZE(psl->sl_max), &sk->sk_omem_alloc);
2608 kfree_rcu(psl, rcu);
1da177e4 2609 }
63ed8de4
TY
2610
2611 if (idev)
2612 mutex_unlock(&idev->mc_lock);
2613
1da177e4
LT
2614 return err;
2615}
2616
63ed8de4 2617/* called with mc_lock */
1da177e4
LT
2618static void igmp6_leave_group(struct ifmcaddr6 *ma)
2619{
6c567b78 2620 if (mld_in_v1_mode(ma->idev)) {
88e2ca30 2621 if (ma->mca_flags & MAF_LAST_REPORTER) {
1da177e4
LT
2622 igmp6_send(&ma->mca_addr, ma->idev->dev,
2623 ICMPV6_MGM_REDUCTION);
88e2ca30 2624 }
1da177e4
LT
2625 } else {
2626 mld_add_delrec(ma->idev, ma);
2627 mld_ifc_event(ma->idev);
2628 }
2629}
2630
2d9a93b4 2631static void mld_gq_work(struct work_struct *work)
1da177e4 2632{
2d9a93b4
TY
2633 struct inet6_dev *idev = container_of(to_delayed_work(work),
2634 struct inet6_dev,
2635 mc_gq_work);
1da177e4 2636
63ed8de4 2637 mutex_lock(&idev->mc_lock);
1da177e4 2638 mld_send_report(idev, NULL);
88e2ca30 2639 idev->mc_gq_running = 0;
63ed8de4 2640 mutex_unlock(&idev->mc_lock);
88e2ca30 2641
9260d3e1 2642 in6_dev_put(idev);
1da177e4
LT
2643}
2644
2d9a93b4 2645static void mld_ifc_work(struct work_struct *work)
1da177e4 2646{
2d9a93b4
TY
2647 struct inet6_dev *idev = container_of(to_delayed_work(work),
2648 struct inet6_dev,
2649 mc_ifc_work);
1da177e4 2650
63ed8de4 2651 mutex_lock(&idev->mc_lock);
1da177e4 2652 mld_send_cr(idev);
88e2ca30 2653
1da177e4
LT
2654 if (idev->mc_ifc_count) {
2655 idev->mc_ifc_count--;
2656 if (idev->mc_ifc_count)
2d9a93b4
TY
2657 mld_ifc_start_work(idev,
2658 unsolicited_report_interval(idev));
1da177e4 2659 }
63ed8de4 2660 mutex_unlock(&idev->mc_lock);
9260d3e1 2661 in6_dev_put(idev);
1da177e4
LT
2662}
2663
63ed8de4 2664/* called with mc_lock */
1da177e4
LT
2665static void mld_ifc_event(struct inet6_dev *idev)
2666{
6c567b78 2667 if (mld_in_v1_mode(idev))
1da177e4 2668 return;
88e2ca30 2669
1da177e4 2670 idev->mc_ifc_count = idev->mc_qrv;
2d9a93b4 2671 mld_ifc_start_work(idev, 1);
1da177e4
LT
2672}
2673
2d9a93b4 2674static void mld_mca_work(struct work_struct *work)
1da177e4 2675{
2d9a93b4
TY
2676 struct ifmcaddr6 *ma = container_of(to_delayed_work(work),
2677 struct ifmcaddr6, mca_work);
1da177e4 2678
63ed8de4 2679 mutex_lock(&ma->idev->mc_lock);
6c567b78 2680 if (mld_in_v1_mode(ma->idev))
1da177e4
LT
2681 igmp6_send(&ma->mca_addr, ma->idev->dev, ICMPV6_MGM_REPORT);
2682 else
2683 mld_send_report(ma->idev, ma);
1da177e4
LT
2684 ma->mca_flags |= MAF_LAST_REPORTER;
2685 ma->mca_flags &= ~MAF_TIMER_RUNNING;
63ed8de4 2686 mutex_unlock(&ma->idev->mc_lock);
f185de28 2687
1da177e4
LT
2688 ma_put(ma);
2689}
2690
75c78500
MS
2691/* Device changing type */
2692
2693void ipv6_mc_unmap(struct inet6_dev *idev)
2694{
2695 struct ifmcaddr6 *i;
2696
2697 /* Install multicast list, except for all-nodes (already installed) */
2698
63ed8de4
TY
2699 mutex_lock(&idev->mc_lock);
2700 for_each_mc_mclock(idev, i)
75c78500 2701 igmp6_group_dropped(i);
63ed8de4 2702 mutex_unlock(&idev->mc_lock);
75c78500
MS
2703}
2704
2705void ipv6_mc_remap(struct inet6_dev *idev)
2706{
2707 ipv6_mc_up(idev);
2708}
2709
1da177e4 2710/* Device going down */
1da177e4
LT
2711void ipv6_mc_down(struct inet6_dev *idev)
2712{
2713 struct ifmcaddr6 *i;
2714
63ed8de4 2715 mutex_lock(&idev->mc_lock);
1da177e4 2716 /* Withdraw multicast list */
63ed8de4 2717 for_each_mc_mclock(idev, i)
1da177e4 2718 igmp6_group_dropped(i);
63ed8de4 2719 mutex_unlock(&idev->mc_lock);
1da177e4 2720
2d9a93b4
TY
2721 /* Should stop work after group drop. or we will
2722 * start work again in mld_ifc_event()
1666d49e 2723 */
f185de28
TY
2724 synchronize_net();
2725 mld_query_stop_work(idev);
2726 mld_report_stop_work(idev);
2d9a93b4
TY
2727 mld_ifc_stop_work(idev);
2728 mld_gq_stop_work(idev);
2729 mld_dad_stop_work(idev);
1da177e4
LT
2730}
2731
2f711939
HFS
2732static void ipv6_mc_reset(struct inet6_dev *idev)
2733{
2734 idev->mc_qrv = sysctl_mld_qrv;
2735 idev->mc_qi = MLD_QI_DEFAULT;
2736 idev->mc_qri = MLD_QRI_DEFAULT;
2737 idev->mc_v1_seen = 0;
2738 idev->mc_maxdelay = unsolicited_report_interval(idev);
2739}
1da177e4
LT
2740
2741/* Device going up */
2742
2743void ipv6_mc_up(struct inet6_dev *idev)
2744{
2745 struct ifmcaddr6 *i;
2746
2747 /* Install multicast list, except for all-nodes (already installed) */
2748
2f711939 2749 ipv6_mc_reset(idev);
63ed8de4
TY
2750 mutex_lock(&idev->mc_lock);
2751 for_each_mc_mclock(idev, i) {
1666d49e 2752 mld_del_delrec(idev, i);
0ae0d60a 2753 igmp6_group_added(i);
1666d49e 2754 }
63ed8de4 2755 mutex_unlock(&idev->mc_lock);
1da177e4
LT
2756}
2757
2758/* IPv6 device initialization. */
2759
2760void ipv6_mc_init_dev(struct inet6_dev *idev)
2761{
1da177e4 2762 idev->mc_gq_running = 0;
2d9a93b4 2763 INIT_DELAYED_WORK(&idev->mc_gq_work, mld_gq_work);
88e2ca30 2764 RCU_INIT_POINTER(idev->mc_tomb, NULL);
1da177e4 2765 idev->mc_ifc_count = 0;
2d9a93b4
TY
2766 INIT_DELAYED_WORK(&idev->mc_ifc_work, mld_ifc_work);
2767 INIT_DELAYED_WORK(&idev->mc_dad_work, mld_dad_work);
f185de28
TY
2768 INIT_DELAYED_WORK(&idev->mc_query_work, mld_query_work);
2769 INIT_DELAYED_WORK(&idev->mc_report_work, mld_report_work);
2770 skb_queue_head_init(&idev->mc_query_queue);
2771 skb_queue_head_init(&idev->mc_report_queue);
2772 spin_lock_init(&idev->mc_query_lock);
2773 spin_lock_init(&idev->mc_report_lock);
63ed8de4 2774 mutex_init(&idev->mc_lock);
2f711939 2775 ipv6_mc_reset(idev);
1da177e4
LT
2776}
2777
2778/*
2779 * Device is about to be destroyed: clean up.
2780 */
2781
2782void ipv6_mc_destroy_dev(struct inet6_dev *idev)
2783{
2784 struct ifmcaddr6 *i;
1da177e4 2785
2d9a93b4 2786 /* Deactivate works */
1da177e4 2787 ipv6_mc_down(idev);
63ed8de4 2788 mutex_lock(&idev->mc_lock);
1666d49e 2789 mld_clear_delrec(idev);
63ed8de4 2790 mutex_unlock(&idev->mc_lock);
f185de28
TY
2791 mld_clear_query(idev);
2792 mld_clear_report(idev);
1da177e4
LT
2793
2794 /* Delete all-nodes address. */
1da177e4
LT
2795 /* We cannot call ipv6_dev_mc_dec() directly, our caller in
2796 * addrconf.c has NULL'd out dev->ip6_ptr so in6_dev_get() will
2797 * fail.
2798 */
f3ee4010 2799 __ipv6_dev_mc_dec(idev, &in6addr_linklocal_allnodes);
1da177e4 2800
f3ee4010
YH
2801 if (idev->cnf.forwarding)
2802 __ipv6_dev_mc_dec(idev, &in6addr_linklocal_allrouters);
1da177e4 2803
63ed8de4
TY
2804 mutex_lock(&idev->mc_lock);
2805 while ((i = mc_dereference(idev->mc_list, idev))) {
2806 rcu_assign_pointer(idev->mc_list, mc_dereference(i->next, idev));
1da177e4 2807
ea2fce88 2808 ip6_mc_clear_src(i);
1da177e4 2809 ma_put(i);
1da177e4 2810 }
63ed8de4 2811 mutex_unlock(&idev->mc_lock);
1da177e4
LT
2812}
2813
382ed724
VY
2814static void ipv6_mc_rejoin_groups(struct inet6_dev *idev)
2815{
2816 struct ifmcaddr6 *pmc;
2817
2818 ASSERT_RTNL();
2819
63ed8de4 2820 mutex_lock(&idev->mc_lock);
382ed724 2821 if (mld_in_v1_mode(idev)) {
63ed8de4 2822 for_each_mc_mclock(idev, pmc)
382ed724 2823 igmp6_join_group(pmc);
88e2ca30 2824 } else {
382ed724 2825 mld_send_report(idev, NULL);
88e2ca30 2826 }
63ed8de4 2827 mutex_unlock(&idev->mc_lock);
382ed724
VY
2828}
2829
2830static int ipv6_mc_netdev_event(struct notifier_block *this,
2831 unsigned long event,
2832 void *ptr)
2833{
2834 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
2835 struct inet6_dev *idev = __in6_dev_get(dev);
2836
2837 switch (event) {
2838 case NETDEV_RESEND_IGMP:
2839 if (idev)
2840 ipv6_mc_rejoin_groups(idev);
2841 break;
2842 default:
2843 break;
2844 }
2845
2846 return NOTIFY_DONE;
2847}
2848
2849static struct notifier_block igmp6_netdev_notifier = {
2850 .notifier_call = ipv6_mc_netdev_event,
2851};
2852
1da177e4
LT
2853#ifdef CONFIG_PROC_FS
2854struct igmp6_mc_iter_state {
b8ad0cbc 2855 struct seq_net_private p;
1da177e4
LT
2856 struct net_device *dev;
2857 struct inet6_dev *idev;
2858};
2859
2860#define igmp6_mc_seq_private(seq) ((struct igmp6_mc_iter_state *)(seq)->private)
2861
2862static inline struct ifmcaddr6 *igmp6_mc_get_first(struct seq_file *seq)
2863{
2864 struct ifmcaddr6 *im = NULL;
2865 struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
1218854a 2866 struct net *net = seq_file_net(seq);
1da177e4 2867
7562f876 2868 state->idev = NULL;
ce81b76a 2869 for_each_netdev_rcu(net, state->dev) {
1da177e4 2870 struct inet6_dev *idev;
ce81b76a 2871 idev = __in6_dev_get(state->dev);
1da177e4
LT
2872 if (!idev)
2873 continue;
88e2ca30
TY
2874
2875 im = rcu_dereference(idev->mc_list);
1da177e4
LT
2876 if (im) {
2877 state->idev = idev;
2878 break;
2879 }
1da177e4
LT
2880 }
2881 return im;
2882}
2883
2884static struct ifmcaddr6 *igmp6_mc_get_next(struct seq_file *seq, struct ifmcaddr6 *im)
2885{
2886 struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
2887
88e2ca30 2888 im = rcu_dereference(im->next);
1da177e4 2889 while (!im) {
ce81b76a 2890 state->dev = next_net_device_rcu(state->dev);
1da177e4
LT
2891 if (!state->dev) {
2892 state->idev = NULL;
2893 break;
2894 }
ce81b76a 2895 state->idev = __in6_dev_get(state->dev);
1da177e4
LT
2896 if (!state->idev)
2897 continue;
88e2ca30 2898 im = rcu_dereference(state->idev->mc_list);
1da177e4
LT
2899 }
2900 return im;
2901}
2902
2903static struct ifmcaddr6 *igmp6_mc_get_idx(struct seq_file *seq, loff_t pos)
2904{
2905 struct ifmcaddr6 *im = igmp6_mc_get_first(seq);
2906 if (im)
2907 while (pos && (im = igmp6_mc_get_next(seq, im)) != NULL)
2908 --pos;
2909 return pos ? NULL : im;
2910}
2911
2912static void *igmp6_mc_seq_start(struct seq_file *seq, loff_t *pos)
ce81b76a 2913 __acquires(RCU)
1da177e4 2914{
ce81b76a 2915 rcu_read_lock();
1da177e4
LT
2916 return igmp6_mc_get_idx(seq, *pos);
2917}
2918
2919static void *igmp6_mc_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2920{
ce81b76a
ED
2921 struct ifmcaddr6 *im = igmp6_mc_get_next(seq, v);
2922
1da177e4
LT
2923 ++*pos;
2924 return im;
2925}
2926
2927static void igmp6_mc_seq_stop(struct seq_file *seq, void *v)
ce81b76a 2928 __releases(RCU)
1da177e4
LT
2929{
2930 struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
ce81b76a 2931
88e2ca30 2932 if (likely(state->idev))
1da177e4 2933 state->idev = NULL;
1da177e4 2934 state->dev = NULL;
ce81b76a 2935 rcu_read_unlock();
1da177e4
LT
2936}
2937
2938static int igmp6_mc_seq_show(struct seq_file *seq, void *v)
2939{
2940 struct ifmcaddr6 *im = (struct ifmcaddr6 *)v;
2941 struct igmp6_mc_iter_state *state = igmp6_mc_seq_private(seq);
2942
2943 seq_printf(seq,
4b7a4274 2944 "%-4d %-15s %pi6 %5d %08X %ld\n",
1da177e4 2945 state->dev->ifindex, state->dev->name,
b071195d 2946 &im->mca_addr,
1da177e4 2947 im->mca_users, im->mca_flags,
88e2ca30 2948 (im->mca_flags & MAF_TIMER_RUNNING) ?
2d9a93b4 2949 jiffies_to_clock_t(im->mca_work.timer.expires - jiffies) : 0);
1da177e4
LT
2950 return 0;
2951}
2952
56b3d975 2953static const struct seq_operations igmp6_mc_seq_ops = {
1da177e4
LT
2954 .start = igmp6_mc_seq_start,
2955 .next = igmp6_mc_seq_next,
2956 .stop = igmp6_mc_seq_stop,
2957 .show = igmp6_mc_seq_show,
2958};
2959
1da177e4 2960struct igmp6_mcf_iter_state {
b8ad0cbc 2961 struct seq_net_private p;
1da177e4
LT
2962 struct net_device *dev;
2963 struct inet6_dev *idev;
2964 struct ifmcaddr6 *im;
2965};
2966
2967#define igmp6_mcf_seq_private(seq) ((struct igmp6_mcf_iter_state *)(seq)->private)
2968
2969static inline struct ip6_sf_list *igmp6_mcf_get_first(struct seq_file *seq)
2970{
2971 struct ip6_sf_list *psf = NULL;
2972 struct ifmcaddr6 *im = NULL;
2973 struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
1218854a 2974 struct net *net = seq_file_net(seq);
1da177e4 2975
7562f876
PE
2976 state->idev = NULL;
2977 state->im = NULL;
ce81b76a 2978 for_each_netdev_rcu(net, state->dev) {
1da177e4 2979 struct inet6_dev *idev;
ce81b76a 2980 idev = __in6_dev_get(state->dev);
1da177e4
LT
2981 if (unlikely(idev == NULL))
2982 continue;
88e2ca30
TY
2983
2984 im = rcu_dereference(idev->mc_list);
53b24b8f 2985 if (likely(im)) {
4b200e39 2986 psf = rcu_dereference(im->mca_sources);
53b24b8f 2987 if (likely(psf)) {
1da177e4
LT
2988 state->im = im;
2989 state->idev = idev;
2990 break;
2991 }
1da177e4 2992 }
1da177e4
LT
2993 }
2994 return psf;
2995}
2996
2997static struct ip6_sf_list *igmp6_mcf_get_next(struct seq_file *seq, struct ip6_sf_list *psf)
2998{
2999 struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
3000
4b200e39 3001 psf = rcu_dereference(psf->sf_next);
1da177e4 3002 while (!psf) {
88e2ca30 3003 state->im = rcu_dereference(state->im->next);
1da177e4 3004 while (!state->im) {
ce81b76a 3005 state->dev = next_net_device_rcu(state->dev);
1da177e4
LT
3006 if (!state->dev) {
3007 state->idev = NULL;
3008 goto out;
3009 }
ce81b76a 3010 state->idev = __in6_dev_get(state->dev);
1da177e4
LT
3011 if (!state->idev)
3012 continue;
88e2ca30 3013 state->im = rcu_dereference(state->idev->mc_list);
1da177e4
LT
3014 }
3015 if (!state->im)
3016 break;
4b200e39 3017 psf = rcu_dereference(state->im->mca_sources);
1da177e4
LT
3018 }
3019out:
3020 return psf;
3021}
3022
3023static struct ip6_sf_list *igmp6_mcf_get_idx(struct seq_file *seq, loff_t pos)
3024{
3025 struct ip6_sf_list *psf = igmp6_mcf_get_first(seq);
3026 if (psf)
3027 while (pos && (psf = igmp6_mcf_get_next(seq, psf)) != NULL)
3028 --pos;
3029 return pos ? NULL : psf;
3030}
3031
3032static void *igmp6_mcf_seq_start(struct seq_file *seq, loff_t *pos)
ce81b76a 3033 __acquires(RCU)
1da177e4 3034{
ce81b76a 3035 rcu_read_lock();
1da177e4
LT
3036 return *pos ? igmp6_mcf_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
3037}
3038
3039static void *igmp6_mcf_seq_next(struct seq_file *seq, void *v, loff_t *pos)
3040{
3041 struct ip6_sf_list *psf;
3042 if (v == SEQ_START_TOKEN)
3043 psf = igmp6_mcf_get_first(seq);
3044 else
3045 psf = igmp6_mcf_get_next(seq, v);
3046 ++*pos;
3047 return psf;
3048}
3049
3050static void igmp6_mcf_seq_stop(struct seq_file *seq, void *v)
ce81b76a 3051 __releases(RCU)
1da177e4
LT
3052{
3053 struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
88e2ca30 3054
f185de28 3055 if (likely(state->im))
1da177e4 3056 state->im = NULL;
88e2ca30 3057 if (likely(state->idev))
1da177e4 3058 state->idev = NULL;
88e2ca30 3059
1da177e4 3060 state->dev = NULL;
ce81b76a 3061 rcu_read_unlock();
1da177e4
LT
3062}
3063
3064static int igmp6_mcf_seq_show(struct seq_file *seq, void *v)
3065{
3066 struct ip6_sf_list *psf = (struct ip6_sf_list *)v;
3067 struct igmp6_mcf_iter_state *state = igmp6_mcf_seq_private(seq);
3068
3069 if (v == SEQ_START_TOKEN) {
1744bea1 3070 seq_puts(seq, "Idx Device Multicast Address Source Address INC EXC\n");
1da177e4
LT
3071 } else {
3072 seq_printf(seq,
4b7a4274 3073 "%3d %6.6s %pi6 %pi6 %6lu %6lu\n",
1da177e4 3074 state->dev->ifindex, state->dev->name,
b071195d
HH
3075 &state->im->mca_addr,
3076 &psf->sf_addr,
1da177e4
LT
3077 psf->sf_count[MCAST_INCLUDE],
3078 psf->sf_count[MCAST_EXCLUDE]);
3079 }
3080 return 0;
3081}
3082
56b3d975 3083static const struct seq_operations igmp6_mcf_seq_ops = {
1da177e4
LT
3084 .start = igmp6_mcf_seq_start,
3085 .next = igmp6_mcf_seq_next,
3086 .stop = igmp6_mcf_seq_stop,
3087 .show = igmp6_mcf_seq_show,
3088};
3089
2c8c1e72 3090static int __net_init igmp6_proc_init(struct net *net)
ea82edf7
DL
3091{
3092 int err;
3093
3094 err = -ENOMEM;
c3506372
CH
3095 if (!proc_create_net("igmp6", 0444, net->proc_net, &igmp6_mc_seq_ops,
3096 sizeof(struct igmp6_mc_iter_state)))
ea82edf7 3097 goto out;
c3506372
CH
3098 if (!proc_create_net("mcfilter6", 0444, net->proc_net,
3099 &igmp6_mcf_seq_ops,
3100 sizeof(struct igmp6_mcf_iter_state)))
ea82edf7
DL
3101 goto out_proc_net_igmp6;
3102
3103 err = 0;
3104out:
3105 return err;
3106
3107out_proc_net_igmp6:
ece31ffd 3108 remove_proc_entry("igmp6", net->proc_net);
ea82edf7
DL
3109 goto out;
3110}
3111
2c8c1e72 3112static void __net_exit igmp6_proc_exit(struct net *net)
ea82edf7 3113{
ece31ffd
G
3114 remove_proc_entry("mcfilter6", net->proc_net);
3115 remove_proc_entry("igmp6", net->proc_net);
ea82edf7
DL
3116}
3117#else
2c8c1e72 3118static inline int igmp6_proc_init(struct net *net)
ea82edf7
DL
3119{
3120 return 0;
3121}
2c8c1e72 3122static inline void igmp6_proc_exit(struct net *net)
ea82edf7 3123{
ea82edf7 3124}
1da177e4
LT
3125#endif
3126
2c8c1e72 3127static int __net_init igmp6_net_init(struct net *net)
1da177e4 3128{
1da177e4
LT
3129 int err;
3130
1ed8516f
DL
3131 err = inet_ctl_sock_create(&net->ipv6.igmp_sk, PF_INET6,
3132 SOCK_RAW, IPPROTO_ICMPV6, net);
1da177e4 3133 if (err < 0) {
f3213831 3134 pr_err("Failed to initialize the IGMP6 control socket (err %d)\n",
1da177e4 3135 err);
b8ad0cbc 3136 goto out;
1da177e4
LT
3137 }
3138
1ed8516f 3139 inet6_sk(net->ipv6.igmp_sk)->hop_limit = 1;
f185de28 3140 net->ipv6.igmp_sk->sk_allocation = GFP_KERNEL;
1da177e4 3141
93a714d6
MC
3142 err = inet_ctl_sock_create(&net->ipv6.mc_autojoin_sk, PF_INET6,
3143 SOCK_RAW, IPPROTO_ICMPV6, net);
3144 if (err < 0) {
3145 pr_err("Failed to initialize the IGMP6 autojoin socket (err %d)\n",
3146 err);
3147 goto out_sock_create;
3148 }
3149
ea82edf7
DL
3150 err = igmp6_proc_init(net);
3151 if (err)
93a714d6
MC
3152 goto out_sock_create_autojoin;
3153
3154 return 0;
b8ad0cbc 3155
93a714d6
MC
3156out_sock_create_autojoin:
3157 inet_ctl_sock_destroy(net->ipv6.mc_autojoin_sk);
b8ad0cbc 3158out_sock_create:
1ed8516f 3159 inet_ctl_sock_destroy(net->ipv6.igmp_sk);
93a714d6
MC
3160out:
3161 return err;
1da177e4
LT
3162}
3163
2c8c1e72 3164static void __net_exit igmp6_net_exit(struct net *net)
1da177e4 3165{
1ed8516f 3166 inet_ctl_sock_destroy(net->ipv6.igmp_sk);
93a714d6 3167 inet_ctl_sock_destroy(net->ipv6.mc_autojoin_sk);
ea82edf7 3168 igmp6_proc_exit(net);
1da177e4 3169}
b8ad0cbc
DL
3170
3171static struct pernet_operations igmp6_net_ops = {
3172 .init = igmp6_net_init,
3173 .exit = igmp6_net_exit,
3174};
3175
3176int __init igmp6_init(void)
3177{
2d9a93b4
TY
3178 int err;
3179
3180 err = register_pernet_subsys(&igmp6_net_ops);
3181 if (err)
3182 return err;
3183
3184 mld_wq = create_workqueue("mld");
3185 if (!mld_wq) {
3186 unregister_pernet_subsys(&igmp6_net_ops);
3187 return -ENOMEM;
3188 }
3189
3190 return err;
b8ad0cbc
DL
3191}
3192
382ed724
VY
3193int __init igmp6_late_init(void)
3194{
3195 return register_netdevice_notifier(&igmp6_netdev_notifier);
3196}
3197
b8ad0cbc
DL
3198void igmp6_cleanup(void)
3199{
3200 unregister_pernet_subsys(&igmp6_net_ops);
2d9a93b4 3201 destroy_workqueue(mld_wq);
b8ad0cbc 3202}
382ed724
VY
3203
3204void igmp6_late_cleanup(void)
3205{
3206 unregister_netdevice_notifier(&igmp6_netdev_notifier);
3207}