2 * Multicast support for IPv6
3 * Linux INET6 implementation
6 * Pedro Roque <roque@di.fc.ul.pt>
8 * $Id: mcast.c,v 1.40 2002/02/08 03:57:19 davem Exp $
10 * Based on linux/ipv4/igmp.c and linux/ipv4/ip_sockglue.c
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License
14 * as published by the Free Software Foundation; either version
15 * 2 of the License, or (at your option) any later version.
20 * yoshfuji : fix format of router-alert option
21 * YOSHIFUJI Hideaki @USAGI:
22 * Fixed source address for MLD message based on
23 * <draft-ietf-magma-mld-source-05.txt>.
24 * YOSHIFUJI Hideaki @USAGI:
25 * - Ignore Queries for invalid addresses.
26 * - MLD for link-local addresses.
27 * David L Stevens <dlstevens@us.ibm.com>:
31 #include <linux/module.h>
32 #include <linux/errno.h>
33 #include <linux/types.h>
34 #include <linux/string.h>
35 #include <linux/socket.h>
36 #include <linux/sockios.h>
37 #include <linux/jiffies.h>
38 #include <linux/times.h>
39 #include <linux/net.h>
41 #include <linux/in6.h>
42 #include <linux/netdevice.h>
43 #include <linux/if_arp.h>
44 #include <linux/route.h>
45 #include <linux/init.h>
46 #include <linux/proc_fs.h>
47 #include <linux/seq_file.h>
49 #include <linux/netfilter.h>
50 #include <linux/netfilter_ipv6.h>
52 #include <net/net_namespace.h>
57 #include <net/protocol.h>
58 #include <net/if_inet6.h>
59 #include <net/ndisc.h>
60 #include <net/addrconf.h>
61 #include <net/ip6_route.h>
63 #include <net/ip6_checksum.h>
65 /* Set to 3 to get tracing... */
69 #define MDBG(x) printk x
75 * These header formats should be in a separate include file, but icmpv6.h
76 * doesn't have in6_addr defined in all cases, there is no __u128, and no
77 * other files reference these.
82 /* Multicast Listener Discovery version 2 headers */
88 struct in6_addr grec_mca
;
89 struct in6_addr grec_src
[0];
98 struct mld2_grec grec
[0];
108 #if defined(__LITTLE_ENDIAN_BITFIELD)
112 #elif defined(__BIG_ENDIAN_BITFIELD)
117 #error "Please fix <asm/byteorder.h>"
121 struct in6_addr srcs
[0];
124 static struct in6_addr mld2_all_mcr
= MLD2_ALL_MCR_INIT
;
126 /* Big mc list lock for all the sockets */
127 static DEFINE_RWLOCK(ipv6_sk_mc_lock
);
129 static struct socket
*igmp6_socket
;
131 int __ipv6_dev_mc_dec(struct inet6_dev
*idev
, struct in6_addr
*addr
);
133 static void igmp6_join_group(struct ifmcaddr6
*ma
);
134 static void igmp6_leave_group(struct ifmcaddr6
*ma
);
135 static void igmp6_timer_handler(unsigned long data
);
137 static void mld_gq_timer_expire(unsigned long data
);
138 static void mld_ifc_timer_expire(unsigned long data
);
139 static void mld_ifc_event(struct inet6_dev
*idev
);
140 static void mld_add_delrec(struct inet6_dev
*idev
, struct ifmcaddr6
*pmc
);
141 static void mld_del_delrec(struct inet6_dev
*idev
, struct in6_addr
*addr
);
142 static void mld_clear_delrec(struct inet6_dev
*idev
);
143 static int sf_setstate(struct ifmcaddr6
*pmc
);
144 static void sf_markstate(struct ifmcaddr6
*pmc
);
145 static void ip6_mc_clear_src(struct ifmcaddr6
*pmc
);
146 static int ip6_mc_del_src(struct inet6_dev
*idev
, struct in6_addr
*pmca
,
147 int sfmode
, int sfcount
, struct in6_addr
*psfsrc
,
149 static int ip6_mc_add_src(struct inet6_dev
*idev
, struct in6_addr
*pmca
,
150 int sfmode
, int sfcount
, struct in6_addr
*psfsrc
,
152 static int ip6_mc_leave_src(struct sock
*sk
, struct ipv6_mc_socklist
*iml
,
153 struct inet6_dev
*idev
);
156 #define IGMP6_UNSOLICITED_IVAL (10*HZ)
157 #define MLD_QRV_DEFAULT 2
159 #define MLD_V1_SEEN(idev) (ipv6_devconf.force_mld_version == 1 || \
160 (idev)->cnf.force_mld_version == 1 || \
161 ((idev)->mc_v1_seen && \
162 time_before(jiffies, (idev)->mc_v1_seen)))
164 #define MLDV2_MASK(value, nb) ((nb)>=32 ? (value) : ((1<<(nb))-1) & (value))
165 #define MLDV2_EXP(thresh, nbmant, nbexp, value) \
166 ((value) < (thresh) ? (value) : \
167 ((MLDV2_MASK(value, nbmant) | (1<<(nbmant))) << \
168 (MLDV2_MASK((value) >> (nbmant), nbexp) + (nbexp))))
170 #define MLDV2_QQIC(value) MLDV2_EXP(0x80, 4, 3, value)
171 #define MLDV2_MRC(value) MLDV2_EXP(0x8000, 12, 3, value)
173 #define IPV6_MLD_MAX_MSF 64
175 int sysctl_mld_max_msf __read_mostly
= IPV6_MLD_MAX_MSF
;
178 * socket join on multicast group
181 int ipv6_sock_mc_join(struct sock
*sk
, int ifindex
, struct in6_addr
*addr
)
183 struct net_device
*dev
= NULL
;
184 struct ipv6_mc_socklist
*mc_lst
;
185 struct ipv6_pinfo
*np
= inet6_sk(sk
);
188 if (!ipv6_addr_is_multicast(addr
))
191 read_lock_bh(&ipv6_sk_mc_lock
);
192 for (mc_lst
=np
->ipv6_mc_list
; mc_lst
; mc_lst
=mc_lst
->next
) {
193 if ((ifindex
== 0 || mc_lst
->ifindex
== ifindex
) &&
194 ipv6_addr_equal(&mc_lst
->addr
, addr
)) {
195 read_unlock_bh(&ipv6_sk_mc_lock
);
199 read_unlock_bh(&ipv6_sk_mc_lock
);
201 mc_lst
= sock_kmalloc(sk
, sizeof(struct ipv6_mc_socklist
), GFP_KERNEL
);
207 ipv6_addr_copy(&mc_lst
->addr
, addr
);
211 rt
= rt6_lookup(addr
, NULL
, 0, 0);
215 dst_release(&rt
->u
.dst
);
218 dev
= dev_get_by_index(&init_net
, ifindex
);
221 sock_kfree_s(sk
, mc_lst
, sizeof(*mc_lst
));
225 mc_lst
->ifindex
= dev
->ifindex
;
226 mc_lst
->sfmode
= MCAST_EXCLUDE
;
227 rwlock_init(&mc_lst
->sflock
);
228 mc_lst
->sflist
= NULL
;
231 * now add/increase the group membership on the device
234 err
= ipv6_dev_mc_inc(dev
, addr
);
237 sock_kfree_s(sk
, mc_lst
, sizeof(*mc_lst
));
242 write_lock_bh(&ipv6_sk_mc_lock
);
243 mc_lst
->next
= np
->ipv6_mc_list
;
244 np
->ipv6_mc_list
= mc_lst
;
245 write_unlock_bh(&ipv6_sk_mc_lock
);
253 * socket leave on multicast group
255 int ipv6_sock_mc_drop(struct sock
*sk
, int ifindex
, struct in6_addr
*addr
)
257 struct ipv6_pinfo
*np
= inet6_sk(sk
);
258 struct ipv6_mc_socklist
*mc_lst
, **lnk
;
260 write_lock_bh(&ipv6_sk_mc_lock
);
261 for (lnk
= &np
->ipv6_mc_list
; (mc_lst
= *lnk
) !=NULL
; lnk
= &mc_lst
->next
) {
262 if ((ifindex
== 0 || mc_lst
->ifindex
== ifindex
) &&
263 ipv6_addr_equal(&mc_lst
->addr
, addr
)) {
264 struct net_device
*dev
;
267 write_unlock_bh(&ipv6_sk_mc_lock
);
269 if ((dev
= dev_get_by_index(&init_net
, mc_lst
->ifindex
)) != NULL
) {
270 struct inet6_dev
*idev
= in6_dev_get(dev
);
272 (void) ip6_mc_leave_src(sk
, mc_lst
, idev
);
274 __ipv6_dev_mc_dec(idev
, &mc_lst
->addr
);
279 (void) ip6_mc_leave_src(sk
, mc_lst
, NULL
);
280 sock_kfree_s(sk
, mc_lst
, sizeof(*mc_lst
));
284 write_unlock_bh(&ipv6_sk_mc_lock
);
286 return -EADDRNOTAVAIL
;
289 static struct inet6_dev
*ip6_mc_find_dev(struct in6_addr
*group
, int ifindex
)
291 struct net_device
*dev
= NULL
;
292 struct inet6_dev
*idev
= NULL
;
297 rt
= rt6_lookup(group
, NULL
, 0, 0);
301 dst_release(&rt
->u
.dst
);
304 dev
= dev_get_by_index(&init_net
, ifindex
);
308 idev
= in6_dev_get(dev
);
313 read_lock_bh(&idev
->lock
);
315 read_unlock_bh(&idev
->lock
);
323 void ipv6_sock_mc_close(struct sock
*sk
)
325 struct ipv6_pinfo
*np
= inet6_sk(sk
);
326 struct ipv6_mc_socklist
*mc_lst
;
328 write_lock_bh(&ipv6_sk_mc_lock
);
329 while ((mc_lst
= np
->ipv6_mc_list
) != NULL
) {
330 struct net_device
*dev
;
332 np
->ipv6_mc_list
= mc_lst
->next
;
333 write_unlock_bh(&ipv6_sk_mc_lock
);
335 dev
= dev_get_by_index(&init_net
, mc_lst
->ifindex
);
337 struct inet6_dev
*idev
= in6_dev_get(dev
);
339 (void) ip6_mc_leave_src(sk
, mc_lst
, idev
);
341 __ipv6_dev_mc_dec(idev
, &mc_lst
->addr
);
346 (void) ip6_mc_leave_src(sk
, mc_lst
, NULL
);
348 sock_kfree_s(sk
, mc_lst
, sizeof(*mc_lst
));
350 write_lock_bh(&ipv6_sk_mc_lock
);
352 write_unlock_bh(&ipv6_sk_mc_lock
);
355 int ip6_mc_source(int add
, int omode
, struct sock
*sk
,
356 struct group_source_req
*pgsr
)
358 struct in6_addr
*source
, *group
;
359 struct ipv6_mc_socklist
*pmc
;
360 struct net_device
*dev
;
361 struct inet6_dev
*idev
;
362 struct ipv6_pinfo
*inet6
= inet6_sk(sk
);
363 struct ip6_sf_socklist
*psl
;
369 if (pgsr
->gsr_group
.ss_family
!= AF_INET6
||
370 pgsr
->gsr_source
.ss_family
!= AF_INET6
)
373 source
= &((struct sockaddr_in6
*)&pgsr
->gsr_source
)->sin6_addr
;
374 group
= &((struct sockaddr_in6
*)&pgsr
->gsr_group
)->sin6_addr
;
376 if (!ipv6_addr_is_multicast(group
))
379 idev
= ip6_mc_find_dev(group
, pgsr
->gsr_interface
);
384 err
= -EADDRNOTAVAIL
;
386 read_lock_bh(&ipv6_sk_mc_lock
);
387 for (pmc
=inet6
->ipv6_mc_list
; pmc
; pmc
=pmc
->next
) {
388 if (pgsr
->gsr_interface
&& pmc
->ifindex
!= pgsr
->gsr_interface
)
390 if (ipv6_addr_equal(&pmc
->addr
, group
))
393 if (!pmc
) { /* must have a prior join */
397 /* if a source filter was set, must be the same mode as before */
399 if (pmc
->sfmode
!= omode
) {
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);
410 write_lock_bh(&pmc
->sflock
);
416 goto done
; /* err = -EADDRNOTAVAIL */
418 for (i
=0; i
<psl
->sl_count
; i
++) {
419 rv
= memcmp(&psl
->sl_addr
[i
], source
,
420 sizeof(struct in6_addr
));
424 if (rv
) /* source not found */
425 goto done
; /* err = -EADDRNOTAVAIL */
427 /* special case - (INCLUDE, empty) == LEAVE_GROUP */
428 if (psl
->sl_count
== 1 && omode
== MCAST_INCLUDE
) {
433 /* update the interface filter */
434 ip6_mc_del_src(idev
, group
, omode
, 1, source
, 1);
436 for (j
=i
+1; j
<psl
->sl_count
; j
++)
437 psl
->sl_addr
[j
-1] = psl
->sl_addr
[j
];
442 /* else, add a new source to the filter */
444 if (psl
&& psl
->sl_count
>= sysctl_mld_max_msf
) {
448 if (!psl
|| psl
->sl_count
== psl
->sl_max
) {
449 struct ip6_sf_socklist
*newpsl
;
450 int count
= IP6_SFBLOCK
;
453 count
+= psl
->sl_max
;
454 newpsl
= sock_kmalloc(sk
, IP6_SFLSIZE(count
), GFP_ATOMIC
);
459 newpsl
->sl_max
= count
;
460 newpsl
->sl_count
= count
- IP6_SFBLOCK
;
462 for (i
=0; i
<psl
->sl_count
; i
++)
463 newpsl
->sl_addr
[i
] = psl
->sl_addr
[i
];
464 sock_kfree_s(sk
, psl
, IP6_SFLSIZE(psl
->sl_max
));
466 pmc
->sflist
= psl
= newpsl
;
468 rv
= 1; /* > 0 for insert logic below if sl_count is 0 */
469 for (i
=0; i
<psl
->sl_count
; i
++) {
470 rv
= memcmp(&psl
->sl_addr
[i
], source
, sizeof(struct in6_addr
));
474 if (rv
== 0) /* address already there is an error */
476 for (j
=psl
->sl_count
-1; j
>=i
; j
--)
477 psl
->sl_addr
[j
+1] = psl
->sl_addr
[j
];
478 psl
->sl_addr
[i
] = *source
;
481 /* update the interface list */
482 ip6_mc_add_src(idev
, group
, omode
, 1, source
, 1);
485 write_unlock_bh(&pmc
->sflock
);
486 read_unlock_bh(&ipv6_sk_mc_lock
);
487 read_unlock_bh(&idev
->lock
);
491 return ipv6_sock_mc_drop(sk
, pgsr
->gsr_interface
, group
);
495 int ip6_mc_msfilter(struct sock
*sk
, struct group_filter
*gsf
)
497 struct in6_addr
*group
;
498 struct ipv6_mc_socklist
*pmc
;
499 struct net_device
*dev
;
500 struct inet6_dev
*idev
;
501 struct ipv6_pinfo
*inet6
= inet6_sk(sk
);
502 struct ip6_sf_socklist
*newpsl
, *psl
;
506 group
= &((struct sockaddr_in6
*)&gsf
->gf_group
)->sin6_addr
;
508 if (!ipv6_addr_is_multicast(group
))
510 if (gsf
->gf_fmode
!= MCAST_INCLUDE
&&
511 gsf
->gf_fmode
!= MCAST_EXCLUDE
)
514 idev
= ip6_mc_find_dev(group
, gsf
->gf_interface
);
521 read_lock_bh(&ipv6_sk_mc_lock
);
523 if (gsf
->gf_fmode
== MCAST_INCLUDE
&& gsf
->gf_numsrc
== 0) {
528 for (pmc
=inet6
->ipv6_mc_list
; pmc
; pmc
=pmc
->next
) {
529 if (pmc
->ifindex
!= gsf
->gf_interface
)
531 if (ipv6_addr_equal(&pmc
->addr
, group
))
534 if (!pmc
) { /* must have a prior join */
538 if (gsf
->gf_numsrc
) {
539 newpsl
= sock_kmalloc(sk
, IP6_SFLSIZE(gsf
->gf_numsrc
),
545 newpsl
->sl_max
= newpsl
->sl_count
= gsf
->gf_numsrc
;
546 for (i
=0; i
<newpsl
->sl_count
; ++i
) {
547 struct sockaddr_in6
*psin6
;
549 psin6
= (struct sockaddr_in6
*)&gsf
->gf_slist
[i
];
550 newpsl
->sl_addr
[i
] = psin6
->sin6_addr
;
552 err
= ip6_mc_add_src(idev
, group
, gsf
->gf_fmode
,
553 newpsl
->sl_count
, newpsl
->sl_addr
, 0);
555 sock_kfree_s(sk
, newpsl
, IP6_SFLSIZE(newpsl
->sl_max
));
560 (void) ip6_mc_add_src(idev
, group
, gsf
->gf_fmode
, 0, NULL
, 0);
563 write_lock_bh(&pmc
->sflock
);
566 (void) ip6_mc_del_src(idev
, group
, pmc
->sfmode
,
567 psl
->sl_count
, psl
->sl_addr
, 0);
568 sock_kfree_s(sk
, psl
, IP6_SFLSIZE(psl
->sl_max
));
570 (void) ip6_mc_del_src(idev
, group
, pmc
->sfmode
, 0, NULL
, 0);
571 pmc
->sflist
= newpsl
;
572 pmc
->sfmode
= gsf
->gf_fmode
;
573 write_unlock_bh(&pmc
->sflock
);
576 read_unlock_bh(&ipv6_sk_mc_lock
);
577 read_unlock_bh(&idev
->lock
);
581 err
= ipv6_sock_mc_drop(sk
, gsf
->gf_interface
, group
);
585 int ip6_mc_msfget(struct sock
*sk
, struct group_filter
*gsf
,
586 struct group_filter __user
*optval
, int __user
*optlen
)
588 int err
, i
, count
, copycount
;
589 struct in6_addr
*group
;
590 struct ipv6_mc_socklist
*pmc
;
591 struct inet6_dev
*idev
;
592 struct net_device
*dev
;
593 struct ipv6_pinfo
*inet6
= inet6_sk(sk
);
594 struct ip6_sf_socklist
*psl
;
596 group
= &((struct sockaddr_in6
*)&gsf
->gf_group
)->sin6_addr
;
598 if (!ipv6_addr_is_multicast(group
))
601 idev
= ip6_mc_find_dev(group
, gsf
->gf_interface
);
608 err
= -EADDRNOTAVAIL
;
610 * changes to the ipv6_mc_list require the socket lock and
611 * a read lock on ip6_sk_mc_lock. We have the socket lock,
612 * so reading the list is safe.
615 for (pmc
=inet6
->ipv6_mc_list
; pmc
; pmc
=pmc
->next
) {
616 if (pmc
->ifindex
!= gsf
->gf_interface
)
618 if (ipv6_addr_equal(group
, &pmc
->addr
))
621 if (!pmc
) /* must have a prior join */
623 gsf
->gf_fmode
= pmc
->sfmode
;
625 count
= psl
? psl
->sl_count
: 0;
626 read_unlock_bh(&idev
->lock
);
630 copycount
= count
< gsf
->gf_numsrc
? count
: gsf
->gf_numsrc
;
631 gsf
->gf_numsrc
= count
;
632 if (put_user(GROUP_FILTER_SIZE(copycount
), optlen
) ||
633 copy_to_user(optval
, gsf
, GROUP_FILTER_SIZE(0))) {
636 /* changes to psl require the socket lock, a read lock on
637 * on ipv6_sk_mc_lock and a write lock on pmc->sflock. We
638 * have the socket lock, so reading here is safe.
640 for (i
=0; i
<copycount
; i
++) {
641 struct sockaddr_in6
*psin6
;
642 struct sockaddr_storage ss
;
644 psin6
= (struct sockaddr_in6
*)&ss
;
645 memset(&ss
, 0, sizeof(ss
));
646 psin6
->sin6_family
= AF_INET6
;
647 psin6
->sin6_addr
= psl
->sl_addr
[i
];
648 if (copy_to_user(&optval
->gf_slist
[i
], &ss
, sizeof(ss
)))
653 read_unlock_bh(&idev
->lock
);
659 int inet6_mc_check(struct sock
*sk
, struct in6_addr
*mc_addr
,
660 struct in6_addr
*src_addr
)
662 struct ipv6_pinfo
*np
= inet6_sk(sk
);
663 struct ipv6_mc_socklist
*mc
;
664 struct ip6_sf_socklist
*psl
;
667 read_lock(&ipv6_sk_mc_lock
);
668 for (mc
= np
->ipv6_mc_list
; mc
; mc
= mc
->next
) {
669 if (ipv6_addr_equal(&mc
->addr
, mc_addr
))
673 read_unlock(&ipv6_sk_mc_lock
);
676 read_lock(&mc
->sflock
);
679 rv
= mc
->sfmode
== MCAST_EXCLUDE
;
683 for (i
=0; i
<psl
->sl_count
; i
++) {
684 if (ipv6_addr_equal(&psl
->sl_addr
[i
], src_addr
))
687 if (mc
->sfmode
== MCAST_INCLUDE
&& i
>= psl
->sl_count
)
689 if (mc
->sfmode
== MCAST_EXCLUDE
&& i
< psl
->sl_count
)
692 read_unlock(&mc
->sflock
);
693 read_unlock(&ipv6_sk_mc_lock
);
698 static void ma_put(struct ifmcaddr6
*mc
)
700 if (atomic_dec_and_test(&mc
->mca_refcnt
)) {
701 in6_dev_put(mc
->idev
);
706 static void igmp6_group_added(struct ifmcaddr6
*mc
)
708 struct net_device
*dev
= mc
->idev
->dev
;
709 char buf
[MAX_ADDR_LEN
];
711 spin_lock_bh(&mc
->mca_lock
);
712 if (!(mc
->mca_flags
&MAF_LOADED
)) {
713 mc
->mca_flags
|= MAF_LOADED
;
714 if (ndisc_mc_map(&mc
->mca_addr
, buf
, dev
, 0) == 0)
715 dev_mc_add(dev
, buf
, dev
->addr_len
, 0);
717 spin_unlock_bh(&mc
->mca_lock
);
719 if (!(dev
->flags
& IFF_UP
) || (mc
->mca_flags
& MAF_NOREPORT
))
722 if (MLD_V1_SEEN(mc
->idev
)) {
723 igmp6_join_group(mc
);
728 mc
->mca_crcount
= mc
->idev
->mc_qrv
;
729 mld_ifc_event(mc
->idev
);
732 static void igmp6_group_dropped(struct ifmcaddr6
*mc
)
734 struct net_device
*dev
= mc
->idev
->dev
;
735 char buf
[MAX_ADDR_LEN
];
737 spin_lock_bh(&mc
->mca_lock
);
738 if (mc
->mca_flags
&MAF_LOADED
) {
739 mc
->mca_flags
&= ~MAF_LOADED
;
740 if (ndisc_mc_map(&mc
->mca_addr
, buf
, dev
, 0) == 0)
741 dev_mc_delete(dev
, buf
, dev
->addr_len
, 0);
744 if (mc
->mca_flags
& MAF_NOREPORT
)
746 spin_unlock_bh(&mc
->mca_lock
);
749 igmp6_leave_group(mc
);
751 spin_lock_bh(&mc
->mca_lock
);
752 if (del_timer(&mc
->mca_timer
))
753 atomic_dec(&mc
->mca_refcnt
);
755 ip6_mc_clear_src(mc
);
756 spin_unlock_bh(&mc
->mca_lock
);
760 * deleted ifmcaddr6 manipulation
762 static void mld_add_delrec(struct inet6_dev
*idev
, struct ifmcaddr6
*im
)
764 struct ifmcaddr6
*pmc
;
766 /* this is an "ifmcaddr6" for convenience; only the fields below
767 * are actually used. In particular, the refcnt and users are not
768 * used for management of the delete list. Using the same structure
769 * for deleted items allows change reports to use common code with
770 * non-deleted or query-response MCA's.
772 pmc
= kzalloc(sizeof(*pmc
), GFP_ATOMIC
);
776 spin_lock_bh(&im
->mca_lock
);
777 spin_lock_init(&pmc
->mca_lock
);
778 pmc
->idev
= im
->idev
;
780 pmc
->mca_addr
= im
->mca_addr
;
781 pmc
->mca_crcount
= idev
->mc_qrv
;
782 pmc
->mca_sfmode
= im
->mca_sfmode
;
783 if (pmc
->mca_sfmode
== MCAST_INCLUDE
) {
784 struct ip6_sf_list
*psf
;
786 pmc
->mca_tomb
= im
->mca_tomb
;
787 pmc
->mca_sources
= im
->mca_sources
;
788 im
->mca_tomb
= im
->mca_sources
= NULL
;
789 for (psf
=pmc
->mca_sources
; psf
; psf
=psf
->sf_next
)
790 psf
->sf_crcount
= pmc
->mca_crcount
;
792 spin_unlock_bh(&im
->mca_lock
);
794 write_lock_bh(&idev
->mc_lock
);
795 pmc
->next
= idev
->mc_tomb
;
797 write_unlock_bh(&idev
->mc_lock
);
800 static void mld_del_delrec(struct inet6_dev
*idev
, struct in6_addr
*pmca
)
802 struct ifmcaddr6
*pmc
, *pmc_prev
;
803 struct ip6_sf_list
*psf
, *psf_next
;
805 write_lock_bh(&idev
->mc_lock
);
807 for (pmc
=idev
->mc_tomb
; pmc
; pmc
=pmc
->next
) {
808 if (ipv6_addr_equal(&pmc
->mca_addr
, pmca
))
814 pmc_prev
->next
= pmc
->next
;
816 idev
->mc_tomb
= pmc
->next
;
818 write_unlock_bh(&idev
->mc_lock
);
820 for (psf
=pmc
->mca_tomb
; psf
; psf
=psf_next
) {
821 psf_next
= psf
->sf_next
;
824 in6_dev_put(pmc
->idev
);
829 static void mld_clear_delrec(struct inet6_dev
*idev
)
831 struct ifmcaddr6
*pmc
, *nextpmc
;
833 write_lock_bh(&idev
->mc_lock
);
835 idev
->mc_tomb
= NULL
;
836 write_unlock_bh(&idev
->mc_lock
);
838 for (; pmc
; pmc
= nextpmc
) {
840 ip6_mc_clear_src(pmc
);
841 in6_dev_put(pmc
->idev
);
845 /* clear dead sources, too */
846 read_lock_bh(&idev
->lock
);
847 for (pmc
=idev
->mc_list
; pmc
; pmc
=pmc
->next
) {
848 struct ip6_sf_list
*psf
, *psf_next
;
850 spin_lock_bh(&pmc
->mca_lock
);
852 pmc
->mca_tomb
= NULL
;
853 spin_unlock_bh(&pmc
->mca_lock
);
854 for (; psf
; psf
=psf_next
) {
855 psf_next
= psf
->sf_next
;
859 read_unlock_bh(&idev
->lock
);
864 * device multicast group inc (add if not found)
866 int ipv6_dev_mc_inc(struct net_device
*dev
, struct in6_addr
*addr
)
868 struct ifmcaddr6
*mc
;
869 struct inet6_dev
*idev
;
871 idev
= in6_dev_get(dev
);
876 write_lock_bh(&idev
->lock
);
878 write_unlock_bh(&idev
->lock
);
883 for (mc
= idev
->mc_list
; mc
; mc
= mc
->next
) {
884 if (ipv6_addr_equal(&mc
->mca_addr
, addr
)) {
886 write_unlock_bh(&idev
->lock
);
887 ip6_mc_add_src(idev
, &mc
->mca_addr
, MCAST_EXCLUDE
, 0,
895 * not found: create a new one.
898 mc
= kzalloc(sizeof(struct ifmcaddr6
), GFP_ATOMIC
);
901 write_unlock_bh(&idev
->lock
);
906 init_timer(&mc
->mca_timer
);
907 mc
->mca_timer
.function
= igmp6_timer_handler
;
908 mc
->mca_timer
.data
= (unsigned long) mc
;
910 ipv6_addr_copy(&mc
->mca_addr
, addr
);
913 /* mca_stamp should be updated upon changes */
914 mc
->mca_cstamp
= mc
->mca_tstamp
= jiffies
;
915 atomic_set(&mc
->mca_refcnt
, 2);
916 spin_lock_init(&mc
->mca_lock
);
918 /* initial mode is (EX, empty) */
919 mc
->mca_sfmode
= MCAST_EXCLUDE
;
920 mc
->mca_sfcount
[MCAST_EXCLUDE
] = 1;
922 if (ipv6_addr_is_ll_all_nodes(&mc
->mca_addr
) ||
923 IPV6_ADDR_MC_SCOPE(&mc
->mca_addr
) < IPV6_ADDR_SCOPE_LINKLOCAL
)
924 mc
->mca_flags
|= MAF_NOREPORT
;
926 mc
->next
= idev
->mc_list
;
928 write_unlock_bh(&idev
->lock
);
930 mld_del_delrec(idev
, &mc
->mca_addr
);
931 igmp6_group_added(mc
);
937 * device multicast group del
939 int __ipv6_dev_mc_dec(struct inet6_dev
*idev
, struct in6_addr
*addr
)
941 struct ifmcaddr6
*ma
, **map
;
943 write_lock_bh(&idev
->lock
);
944 for (map
= &idev
->mc_list
; (ma
=*map
) != NULL
; map
= &ma
->next
) {
945 if (ipv6_addr_equal(&ma
->mca_addr
, addr
)) {
946 if (--ma
->mca_users
== 0) {
948 write_unlock_bh(&idev
->lock
);
950 igmp6_group_dropped(ma
);
955 write_unlock_bh(&idev
->lock
);
959 write_unlock_bh(&idev
->lock
);
964 int ipv6_dev_mc_dec(struct net_device
*dev
, struct in6_addr
*addr
)
966 struct inet6_dev
*idev
= in6_dev_get(dev
);
972 err
= __ipv6_dev_mc_dec(idev
, addr
);
980 * identify MLD packets for MLD filter exceptions
982 int ipv6_is_mld(struct sk_buff
*skb
, int nexthdr
)
984 struct icmp6hdr
*pic
;
986 if (nexthdr
!= IPPROTO_ICMPV6
)
989 if (!pskb_may_pull(skb
, sizeof(struct icmp6hdr
)))
992 pic
= icmp6_hdr(skb
);
994 switch (pic
->icmp6_type
) {
995 case ICMPV6_MGM_QUERY
:
996 case ICMPV6_MGM_REPORT
:
997 case ICMPV6_MGM_REDUCTION
:
998 case ICMPV6_MLD2_REPORT
:
1007 * check if the interface/address pair is valid
1009 int ipv6_chk_mcast_addr(struct net_device
*dev
, struct in6_addr
*group
,
1010 struct in6_addr
*src_addr
)
1012 struct inet6_dev
*idev
;
1013 struct ifmcaddr6
*mc
;
1016 idev
= in6_dev_get(dev
);
1018 read_lock_bh(&idev
->lock
);
1019 for (mc
= idev
->mc_list
; mc
; mc
=mc
->next
) {
1020 if (ipv6_addr_equal(&mc
->mca_addr
, group
))
1024 if (src_addr
&& !ipv6_addr_any(src_addr
)) {
1025 struct ip6_sf_list
*psf
;
1027 spin_lock_bh(&mc
->mca_lock
);
1028 for (psf
=mc
->mca_sources
;psf
;psf
=psf
->sf_next
) {
1029 if (ipv6_addr_equal(&psf
->sf_addr
, src_addr
))
1033 rv
= psf
->sf_count
[MCAST_INCLUDE
] ||
1034 psf
->sf_count
[MCAST_EXCLUDE
] !=
1035 mc
->mca_sfcount
[MCAST_EXCLUDE
];
1037 rv
= mc
->mca_sfcount
[MCAST_EXCLUDE
] !=0;
1038 spin_unlock_bh(&mc
->mca_lock
);
1040 rv
= 1; /* don't filter unspecified source */
1042 read_unlock_bh(&idev
->lock
);
1048 static void mld_gq_start_timer(struct inet6_dev
*idev
)
1050 int tv
= net_random() % idev
->mc_maxdelay
;
1052 idev
->mc_gq_running
= 1;
1053 if (!mod_timer(&idev
->mc_gq_timer
, jiffies
+tv
+2))
1057 static void mld_ifc_start_timer(struct inet6_dev
*idev
, int delay
)
1059 int tv
= net_random() % delay
;
1061 if (!mod_timer(&idev
->mc_ifc_timer
, jiffies
+tv
+2))
1066 * IGMP handling (alias multicast ICMPv6 messages)
1069 static void igmp6_group_queried(struct ifmcaddr6
*ma
, unsigned long resptime
)
1071 unsigned long delay
= resptime
;
1073 /* Do not start timer for these addresses */
1074 if (ipv6_addr_is_ll_all_nodes(&ma
->mca_addr
) ||
1075 IPV6_ADDR_MC_SCOPE(&ma
->mca_addr
) < IPV6_ADDR_SCOPE_LINKLOCAL
)
1078 if (del_timer(&ma
->mca_timer
)) {
1079 atomic_dec(&ma
->mca_refcnt
);
1080 delay
= ma
->mca_timer
.expires
- jiffies
;
1083 if (delay
>= resptime
) {
1085 delay
= net_random() % resptime
;
1089 ma
->mca_timer
.expires
= jiffies
+ delay
;
1090 if (!mod_timer(&ma
->mca_timer
, jiffies
+ delay
))
1091 atomic_inc(&ma
->mca_refcnt
);
1092 ma
->mca_flags
|= MAF_TIMER_RUNNING
;
1095 /* mark EXCLUDE-mode sources */
1096 static int mld_xmarksources(struct ifmcaddr6
*pmc
, int nsrcs
,
1097 struct in6_addr
*srcs
)
1099 struct ip6_sf_list
*psf
;
1103 for (psf
=pmc
->mca_sources
; psf
; psf
=psf
->sf_next
) {
1104 if (scount
== nsrcs
)
1106 for (i
=0; i
<nsrcs
; i
++) {
1107 /* skip inactive filters */
1108 if (pmc
->mca_sfcount
[MCAST_INCLUDE
] ||
1109 pmc
->mca_sfcount
[MCAST_EXCLUDE
] !=
1110 psf
->sf_count
[MCAST_EXCLUDE
])
1112 if (ipv6_addr_equal(&srcs
[i
], &psf
->sf_addr
)) {
1118 pmc
->mca_flags
&= ~MAF_GSQUERY
;
1119 if (scount
== nsrcs
) /* all sources excluded */
1124 static int mld_marksources(struct ifmcaddr6
*pmc
, int nsrcs
,
1125 struct in6_addr
*srcs
)
1127 struct ip6_sf_list
*psf
;
1130 if (pmc
->mca_sfmode
== MCAST_EXCLUDE
)
1131 return mld_xmarksources(pmc
, nsrcs
, srcs
);
1133 /* mark INCLUDE-mode sources */
1136 for (psf
=pmc
->mca_sources
; psf
; psf
=psf
->sf_next
) {
1137 if (scount
== nsrcs
)
1139 for (i
=0; i
<nsrcs
; i
++) {
1140 if (ipv6_addr_equal(&srcs
[i
], &psf
->sf_addr
)) {
1148 pmc
->mca_flags
&= ~MAF_GSQUERY
;
1151 pmc
->mca_flags
|= MAF_GSQUERY
;
1155 int igmp6_event_query(struct sk_buff
*skb
)
1157 struct mld2_query
*mlh2
= NULL
;
1158 struct ifmcaddr6
*ma
;
1159 struct in6_addr
*group
;
1160 unsigned long max_delay
;
1161 struct inet6_dev
*idev
;
1162 struct icmp6hdr
*hdr
;
1167 if (!pskb_may_pull(skb
, sizeof(struct in6_addr
)))
1170 /* compute payload length excluding extension headers */
1171 len
= ntohs(ipv6_hdr(skb
)->payload_len
) + sizeof(struct ipv6hdr
);
1172 len
-= skb_network_header_len(skb
);
1174 /* Drop queries with not link local source */
1175 if (!(ipv6_addr_type(&ipv6_hdr(skb
)->saddr
) & IPV6_ADDR_LINKLOCAL
))
1178 idev
= in6_dev_get(skb
->dev
);
1183 hdr
= icmp6_hdr(skb
);
1184 group
= (struct in6_addr
*) (hdr
+ 1);
1185 group_type
= ipv6_addr_type(group
);
1187 if (group_type
!= IPV6_ADDR_ANY
&&
1188 !(group_type
&IPV6_ADDR_MULTICAST
)) {
1195 /* MLDv1 router present */
1197 /* Translate milliseconds to jiffies */
1198 max_delay
= (ntohs(hdr
->icmp6_maxdelay
)*HZ
)/1000;
1200 switchback
= (idev
->mc_qrv
+ 1) * max_delay
;
1201 idev
->mc_v1_seen
= jiffies
+ switchback
;
1203 /* cancel the interface change timer */
1204 idev
->mc_ifc_count
= 0;
1205 if (del_timer(&idev
->mc_ifc_timer
))
1206 __in6_dev_put(idev
);
1207 /* clear deleted report items */
1208 mld_clear_delrec(idev
);
1209 } else if (len
>= 28) {
1210 int srcs_offset
= sizeof(struct mld2_query
) -
1211 sizeof(struct icmp6hdr
);
1212 if (!pskb_may_pull(skb
, srcs_offset
)) {
1216 mlh2
= (struct mld2_query
*)skb_transport_header(skb
);
1217 max_delay
= (MLDV2_MRC(ntohs(mlh2
->mrc
))*HZ
)/1000;
1220 idev
->mc_maxdelay
= max_delay
;
1222 idev
->mc_qrv
= mlh2
->qrv
;
1223 if (group_type
== IPV6_ADDR_ANY
) { /* general query */
1226 return -EINVAL
; /* no sources allowed */
1228 mld_gq_start_timer(idev
);
1232 /* mark sources to include, if group & source-specific */
1233 if (mlh2
->nsrcs
!= 0) {
1234 if (!pskb_may_pull(skb
, srcs_offset
+
1235 ntohs(mlh2
->nsrcs
) * sizeof(struct in6_addr
))) {
1239 mlh2
= (struct mld2_query
*)skb_transport_header(skb
);
1247 read_lock_bh(&idev
->lock
);
1248 if (group_type
== IPV6_ADDR_ANY
) {
1249 for (ma
= idev
->mc_list
; ma
; ma
=ma
->next
) {
1250 spin_lock_bh(&ma
->mca_lock
);
1251 igmp6_group_queried(ma
, max_delay
);
1252 spin_unlock_bh(&ma
->mca_lock
);
1255 for (ma
= idev
->mc_list
; ma
; ma
=ma
->next
) {
1256 if (!ipv6_addr_equal(group
, &ma
->mca_addr
))
1258 spin_lock_bh(&ma
->mca_lock
);
1259 if (ma
->mca_flags
& MAF_TIMER_RUNNING
) {
1260 /* gsquery <- gsquery && mark */
1262 ma
->mca_flags
&= ~MAF_GSQUERY
;
1264 /* gsquery <- mark */
1266 ma
->mca_flags
|= MAF_GSQUERY
;
1268 ma
->mca_flags
&= ~MAF_GSQUERY
;
1270 if (!(ma
->mca_flags
& MAF_GSQUERY
) ||
1271 mld_marksources(ma
, ntohs(mlh2
->nsrcs
), mlh2
->srcs
))
1272 igmp6_group_queried(ma
, max_delay
);
1273 spin_unlock_bh(&ma
->mca_lock
);
1277 read_unlock_bh(&idev
->lock
);
1284 int igmp6_event_report(struct sk_buff
*skb
)
1286 struct ifmcaddr6
*ma
;
1287 struct in6_addr
*addrp
;
1288 struct inet6_dev
*idev
;
1289 struct icmp6hdr
*hdr
;
1292 /* Our own report looped back. Ignore it. */
1293 if (skb
->pkt_type
== PACKET_LOOPBACK
)
1296 /* send our report if the MC router may not have heard this report */
1297 if (skb
->pkt_type
!= PACKET_MULTICAST
&&
1298 skb
->pkt_type
!= PACKET_BROADCAST
)
1301 if (!pskb_may_pull(skb
, sizeof(struct in6_addr
)))
1304 hdr
= icmp6_hdr(skb
);
1306 /* Drop reports with not link local source */
1307 addr_type
= ipv6_addr_type(&ipv6_hdr(skb
)->saddr
);
1308 if (addr_type
!= IPV6_ADDR_ANY
&&
1309 !(addr_type
&IPV6_ADDR_LINKLOCAL
))
1312 addrp
= (struct in6_addr
*) (hdr
+ 1);
1314 idev
= in6_dev_get(skb
->dev
);
1319 * Cancel the timer for this group
1322 read_lock_bh(&idev
->lock
);
1323 for (ma
= idev
->mc_list
; ma
; ma
=ma
->next
) {
1324 if (ipv6_addr_equal(&ma
->mca_addr
, addrp
)) {
1325 spin_lock(&ma
->mca_lock
);
1326 if (del_timer(&ma
->mca_timer
))
1327 atomic_dec(&ma
->mca_refcnt
);
1328 ma
->mca_flags
&= ~(MAF_LAST_REPORTER
|MAF_TIMER_RUNNING
);
1329 spin_unlock(&ma
->mca_lock
);
1333 read_unlock_bh(&idev
->lock
);
1338 static int is_in(struct ifmcaddr6
*pmc
, struct ip6_sf_list
*psf
, int type
,
1339 int gdeleted
, int sdeleted
)
1342 case MLD2_MODE_IS_INCLUDE
:
1343 case MLD2_MODE_IS_EXCLUDE
:
1344 if (gdeleted
|| sdeleted
)
1346 if (!((pmc
->mca_flags
& MAF_GSQUERY
) && !psf
->sf_gsresp
)) {
1347 if (pmc
->mca_sfmode
== MCAST_INCLUDE
)
1349 /* don't include if this source is excluded
1352 if (psf
->sf_count
[MCAST_INCLUDE
])
1353 return type
== MLD2_MODE_IS_INCLUDE
;
1354 return pmc
->mca_sfcount
[MCAST_EXCLUDE
] ==
1355 psf
->sf_count
[MCAST_EXCLUDE
];
1358 case MLD2_CHANGE_TO_INCLUDE
:
1359 if (gdeleted
|| sdeleted
)
1361 return psf
->sf_count
[MCAST_INCLUDE
] != 0;
1362 case MLD2_CHANGE_TO_EXCLUDE
:
1363 if (gdeleted
|| sdeleted
)
1365 if (pmc
->mca_sfcount
[MCAST_EXCLUDE
] == 0 ||
1366 psf
->sf_count
[MCAST_INCLUDE
])
1368 return pmc
->mca_sfcount
[MCAST_EXCLUDE
] ==
1369 psf
->sf_count
[MCAST_EXCLUDE
];
1370 case MLD2_ALLOW_NEW_SOURCES
:
1371 if (gdeleted
|| !psf
->sf_crcount
)
1373 return (pmc
->mca_sfmode
== MCAST_INCLUDE
) ^ sdeleted
;
1374 case MLD2_BLOCK_OLD_SOURCES
:
1375 if (pmc
->mca_sfmode
== MCAST_INCLUDE
)
1376 return gdeleted
|| (psf
->sf_crcount
&& sdeleted
);
1377 return psf
->sf_crcount
&& !gdeleted
&& !sdeleted
;
1383 mld_scount(struct ifmcaddr6
*pmc
, int type
, int gdeleted
, int sdeleted
)
1385 struct ip6_sf_list
*psf
;
1388 for (psf
=pmc
->mca_sources
; psf
; psf
=psf
->sf_next
) {
1389 if (!is_in(pmc
, psf
, type
, gdeleted
, sdeleted
))
1396 static struct sk_buff
*mld_newpack(struct net_device
*dev
, int size
)
1398 struct sock
*sk
= igmp6_socket
->sk
;
1399 struct sk_buff
*skb
;
1400 struct mld2_report
*pmr
;
1401 struct in6_addr addr_buf
;
1403 u8 ra
[8] = { IPPROTO_ICMPV6
, 0,
1404 IPV6_TLV_ROUTERALERT
, 2, 0, 0,
1407 /* we assume size > sizeof(ra) here */
1408 skb
= sock_alloc_send_skb(sk
, size
+ LL_RESERVED_SPACE(dev
), 1, &err
);
1413 skb_reserve(skb
, LL_RESERVED_SPACE(dev
));
1415 if (ipv6_get_lladdr(dev
, &addr_buf
, IFA_F_TENTATIVE
)) {
1416 /* <draft-ietf-magma-mld-source-05.txt>:
1417 * use unspecified address as the source address
1418 * when a valid link-local address is not available.
1420 memset(&addr_buf
, 0, sizeof(addr_buf
));
1423 ip6_nd_hdr(sk
, skb
, dev
, &addr_buf
, &mld2_all_mcr
, NEXTHDR_HOP
, 0);
1425 memcpy(skb_put(skb
, sizeof(ra
)), ra
, sizeof(ra
));
1427 skb_set_transport_header(skb
, skb_tail_pointer(skb
) - skb
->data
);
1428 skb_put(skb
, sizeof(*pmr
));
1429 pmr
= (struct mld2_report
*)skb_transport_header(skb
);
1430 pmr
->type
= ICMPV6_MLD2_REPORT
;
1438 static inline int mld_dev_queue_xmit2(struct sk_buff
*skb
)
1440 struct net_device
*dev
= skb
->dev
;
1442 if (dev
->hard_header
) {
1443 unsigned char ha
[MAX_ADDR_LEN
];
1446 ndisc_mc_map(&ipv6_hdr(skb
)->daddr
, ha
, dev
, 1);
1447 err
= dev
->hard_header(skb
, dev
, ETH_P_IPV6
, ha
, NULL
, skb
->len
);
1453 return dev_queue_xmit(skb
);
1456 static inline int mld_dev_queue_xmit(struct sk_buff
*skb
)
1458 return NF_HOOK(PF_INET6
, NF_IP6_POST_ROUTING
, skb
, NULL
, skb
->dev
,
1459 mld_dev_queue_xmit2
);
1462 static void mld_sendpack(struct sk_buff
*skb
)
1464 struct ipv6hdr
*pip6
= ipv6_hdr(skb
);
1465 struct mld2_report
*pmr
=
1466 (struct mld2_report
*)skb_transport_header(skb
);
1467 int payload_len
, mldlen
;
1468 struct inet6_dev
*idev
= in6_dev_get(skb
->dev
);
1471 IP6_INC_STATS(idev
, IPSTATS_MIB_OUTREQUESTS
);
1472 payload_len
= (skb
->tail
- skb
->network_header
) - sizeof(*pip6
);
1473 mldlen
= skb
->tail
- skb
->transport_header
;
1474 pip6
->payload_len
= htons(payload_len
);
1476 pmr
->csum
= csum_ipv6_magic(&pip6
->saddr
, &pip6
->daddr
, mldlen
,
1477 IPPROTO_ICMPV6
, csum_partial(skb_transport_header(skb
),
1479 err
= NF_HOOK(PF_INET6
, NF_IP6_LOCAL_OUT
, skb
, NULL
, skb
->dev
,
1480 mld_dev_queue_xmit
);
1482 ICMP6_INC_STATS(idev
,ICMP6_MIB_OUTMSGS
);
1483 IP6_INC_STATS(idev
, IPSTATS_MIB_OUTMCASTPKTS
);
1485 IP6_INC_STATS(idev
, IPSTATS_MIB_OUTDISCARDS
);
1487 if (likely(idev
!= NULL
))
1491 static int grec_size(struct ifmcaddr6
*pmc
, int type
, int gdel
, int sdel
)
1493 return sizeof(struct mld2_grec
) + 16 * mld_scount(pmc
,type
,gdel
,sdel
);
1496 static struct sk_buff
*add_grhead(struct sk_buff
*skb
, struct ifmcaddr6
*pmc
,
1497 int type
, struct mld2_grec
**ppgr
)
1499 struct net_device
*dev
= pmc
->idev
->dev
;
1500 struct mld2_report
*pmr
;
1501 struct mld2_grec
*pgr
;
1504 skb
= mld_newpack(dev
, dev
->mtu
);
1507 pgr
= (struct mld2_grec
*)skb_put(skb
, sizeof(struct mld2_grec
));
1508 pgr
->grec_type
= type
;
1509 pgr
->grec_auxwords
= 0;
1510 pgr
->grec_nsrcs
= 0;
1511 pgr
->grec_mca
= pmc
->mca_addr
; /* structure copy */
1512 pmr
= (struct mld2_report
*)skb_transport_header(skb
);
1513 pmr
->ngrec
= htons(ntohs(pmr
->ngrec
)+1);
1518 #define AVAILABLE(skb) ((skb) ? ((skb)->dev ? (skb)->dev->mtu - (skb)->len : \
1519 skb_tailroom(skb)) : 0)
1521 static struct sk_buff
*add_grec(struct sk_buff
*skb
, struct ifmcaddr6
*pmc
,
1522 int type
, int gdeleted
, int sdeleted
)
1524 struct net_device
*dev
= pmc
->idev
->dev
;
1525 struct mld2_report
*pmr
;
1526 struct mld2_grec
*pgr
= NULL
;
1527 struct ip6_sf_list
*psf
, *psf_next
, *psf_prev
, **psf_list
;
1528 int scount
, stotal
, first
, isquery
, truncate
;
1530 if (pmc
->mca_flags
& MAF_NOREPORT
)
1533 isquery
= type
== MLD2_MODE_IS_INCLUDE
||
1534 type
== MLD2_MODE_IS_EXCLUDE
;
1535 truncate
= type
== MLD2_MODE_IS_EXCLUDE
||
1536 type
== MLD2_CHANGE_TO_EXCLUDE
;
1538 stotal
= scount
= 0;
1540 psf_list
= sdeleted
? &pmc
->mca_tomb
: &pmc
->mca_sources
;
1545 pmr
= skb
? (struct mld2_report
*)skb_transport_header(skb
) : NULL
;
1547 /* EX and TO_EX get a fresh packet, if needed */
1549 if (pmr
&& pmr
->ngrec
&&
1550 AVAILABLE(skb
) < grec_size(pmc
, type
, gdeleted
, sdeleted
)) {
1553 skb
= mld_newpack(dev
, dev
->mtu
);
1558 for (psf
=*psf_list
; psf
; psf
=psf_next
) {
1559 struct in6_addr
*psrc
;
1561 psf_next
= psf
->sf_next
;
1563 if (!is_in(pmc
, psf
, type
, gdeleted
, sdeleted
)) {
1568 /* clear marks on query responses */
1572 if (AVAILABLE(skb
) < sizeof(*psrc
) +
1573 first
*sizeof(struct mld2_grec
)) {
1574 if (truncate
&& !first
)
1575 break; /* truncate these */
1577 pgr
->grec_nsrcs
= htons(scount
);
1580 skb
= mld_newpack(dev
, dev
->mtu
);
1585 skb
= add_grhead(skb
, pmc
, type
, &pgr
);
1590 psrc
= (struct in6_addr
*)skb_put(skb
, sizeof(*psrc
));
1591 *psrc
= psf
->sf_addr
;
1593 if ((type
== MLD2_ALLOW_NEW_SOURCES
||
1594 type
== MLD2_BLOCK_OLD_SOURCES
) && psf
->sf_crcount
) {
1596 if ((sdeleted
|| gdeleted
) && psf
->sf_crcount
== 0) {
1598 psf_prev
->sf_next
= psf
->sf_next
;
1600 *psf_list
= psf
->sf_next
;
1610 if (type
== MLD2_ALLOW_NEW_SOURCES
||
1611 type
== MLD2_BLOCK_OLD_SOURCES
)
1613 if (pmc
->mca_crcount
|| isquery
) {
1614 /* make sure we have room for group header */
1615 if (skb
&& AVAILABLE(skb
) < sizeof(struct mld2_grec
)) {
1617 skb
= NULL
; /* add_grhead will get a new one */
1619 skb
= add_grhead(skb
, pmc
, type
, &pgr
);
1623 pgr
->grec_nsrcs
= htons(scount
);
1626 pmc
->mca_flags
&= ~MAF_GSQUERY
; /* clear query state */
1630 static void mld_send_report(struct inet6_dev
*idev
, struct ifmcaddr6
*pmc
)
1632 struct sk_buff
*skb
= NULL
;
1636 read_lock_bh(&idev
->lock
);
1637 for (pmc
=idev
->mc_list
; pmc
; pmc
=pmc
->next
) {
1638 if (pmc
->mca_flags
& MAF_NOREPORT
)
1640 spin_lock_bh(&pmc
->mca_lock
);
1641 if (pmc
->mca_sfcount
[MCAST_EXCLUDE
])
1642 type
= MLD2_MODE_IS_EXCLUDE
;
1644 type
= MLD2_MODE_IS_INCLUDE
;
1645 skb
= add_grec(skb
, pmc
, type
, 0, 0);
1646 spin_unlock_bh(&pmc
->mca_lock
);
1648 read_unlock_bh(&idev
->lock
);
1650 spin_lock_bh(&pmc
->mca_lock
);
1651 if (pmc
->mca_sfcount
[MCAST_EXCLUDE
])
1652 type
= MLD2_MODE_IS_EXCLUDE
;
1654 type
= MLD2_MODE_IS_INCLUDE
;
1655 skb
= add_grec(skb
, pmc
, type
, 0, 0);
1656 spin_unlock_bh(&pmc
->mca_lock
);
1663 * remove zero-count source records from a source filter list
1665 static void mld_clear_zeros(struct ip6_sf_list
**ppsf
)
1667 struct ip6_sf_list
*psf_prev
, *psf_next
, *psf
;
1670 for (psf
=*ppsf
; psf
; psf
= psf_next
) {
1671 psf_next
= psf
->sf_next
;
1672 if (psf
->sf_crcount
== 0) {
1674 psf_prev
->sf_next
= psf
->sf_next
;
1676 *ppsf
= psf
->sf_next
;
1683 static void mld_send_cr(struct inet6_dev
*idev
)
1685 struct ifmcaddr6
*pmc
, *pmc_prev
, *pmc_next
;
1686 struct sk_buff
*skb
= NULL
;
1689 read_lock_bh(&idev
->lock
);
1690 write_lock_bh(&idev
->mc_lock
);
1694 for (pmc
=idev
->mc_tomb
; pmc
; pmc
=pmc_next
) {
1695 pmc_next
= pmc
->next
;
1696 if (pmc
->mca_sfmode
== MCAST_INCLUDE
) {
1697 type
= MLD2_BLOCK_OLD_SOURCES
;
1698 dtype
= MLD2_BLOCK_OLD_SOURCES
;
1699 skb
= add_grec(skb
, pmc
, type
, 1, 0);
1700 skb
= add_grec(skb
, pmc
, dtype
, 1, 1);
1702 if (pmc
->mca_crcount
) {
1703 if (pmc
->mca_sfmode
== MCAST_EXCLUDE
) {
1704 type
= MLD2_CHANGE_TO_INCLUDE
;
1705 skb
= add_grec(skb
, pmc
, type
, 1, 0);
1708 if (pmc
->mca_crcount
== 0) {
1709 mld_clear_zeros(&pmc
->mca_tomb
);
1710 mld_clear_zeros(&pmc
->mca_sources
);
1713 if (pmc
->mca_crcount
== 0 && !pmc
->mca_tomb
&&
1714 !pmc
->mca_sources
) {
1716 pmc_prev
->next
= pmc_next
;
1718 idev
->mc_tomb
= pmc_next
;
1719 in6_dev_put(pmc
->idev
);
1724 write_unlock_bh(&idev
->mc_lock
);
1727 for (pmc
=idev
->mc_list
; pmc
; pmc
=pmc
->next
) {
1728 spin_lock_bh(&pmc
->mca_lock
);
1729 if (pmc
->mca_sfcount
[MCAST_EXCLUDE
]) {
1730 type
= MLD2_BLOCK_OLD_SOURCES
;
1731 dtype
= MLD2_ALLOW_NEW_SOURCES
;
1733 type
= MLD2_ALLOW_NEW_SOURCES
;
1734 dtype
= MLD2_BLOCK_OLD_SOURCES
;
1736 skb
= add_grec(skb
, pmc
, type
, 0, 0);
1737 skb
= add_grec(skb
, pmc
, dtype
, 0, 1); /* deleted sources */
1739 /* filter mode changes */
1740 if (pmc
->mca_crcount
) {
1741 if (pmc
->mca_sfmode
== MCAST_EXCLUDE
)
1742 type
= MLD2_CHANGE_TO_EXCLUDE
;
1744 type
= MLD2_CHANGE_TO_INCLUDE
;
1745 skb
= add_grec(skb
, pmc
, type
, 0, 0);
1748 spin_unlock_bh(&pmc
->mca_lock
);
1750 read_unlock_bh(&idev
->lock
);
1753 (void) mld_sendpack(skb
);
1756 static void igmp6_send(struct in6_addr
*addr
, struct net_device
*dev
, int type
)
1758 struct sock
*sk
= igmp6_socket
->sk
;
1759 struct inet6_dev
*idev
;
1760 struct sk_buff
*skb
;
1761 struct icmp6hdr
*hdr
;
1762 struct in6_addr
*snd_addr
;
1763 struct in6_addr
*addrp
;
1764 struct in6_addr addr_buf
;
1765 struct in6_addr all_routers
;
1766 int err
, len
, payload_len
, full_len
;
1767 u8 ra
[8] = { IPPROTO_ICMPV6
, 0,
1768 IPV6_TLV_ROUTERALERT
, 2, 0, 0,
1772 IP6_INC_STATS(__in6_dev_get(dev
),
1773 IPSTATS_MIB_OUTREQUESTS
);
1776 if (type
== ICMPV6_MGM_REDUCTION
) {
1777 snd_addr
= &all_routers
;
1778 ipv6_addr_all_routers(&all_routers
);
1781 len
= sizeof(struct icmp6hdr
) + sizeof(struct in6_addr
);
1782 payload_len
= len
+ sizeof(ra
);
1783 full_len
= sizeof(struct ipv6hdr
) + payload_len
;
1785 skb
= sock_alloc_send_skb(sk
, LL_RESERVED_SPACE(dev
) + full_len
, 1, &err
);
1789 IP6_INC_STATS(__in6_dev_get(dev
),
1790 IPSTATS_MIB_OUTDISCARDS
);
1795 skb_reserve(skb
, LL_RESERVED_SPACE(dev
));
1797 if (ipv6_get_lladdr(dev
, &addr_buf
, IFA_F_TENTATIVE
)) {
1798 /* <draft-ietf-magma-mld-source-05.txt>:
1799 * use unspecified address as the source address
1800 * when a valid link-local address is not available.
1802 memset(&addr_buf
, 0, sizeof(addr_buf
));
1805 ip6_nd_hdr(sk
, skb
, dev
, &addr_buf
, snd_addr
, NEXTHDR_HOP
, payload_len
);
1807 memcpy(skb_put(skb
, sizeof(ra
)), ra
, sizeof(ra
));
1809 hdr
= (struct icmp6hdr
*) skb_put(skb
, sizeof(struct icmp6hdr
));
1810 memset(hdr
, 0, sizeof(struct icmp6hdr
));
1811 hdr
->icmp6_type
= type
;
1813 addrp
= (struct in6_addr
*) skb_put(skb
, sizeof(struct in6_addr
));
1814 ipv6_addr_copy(addrp
, addr
);
1816 hdr
->icmp6_cksum
= csum_ipv6_magic(&addr_buf
, snd_addr
, len
,
1818 csum_partial((__u8
*) hdr
, len
, 0));
1820 idev
= in6_dev_get(skb
->dev
);
1822 err
= NF_HOOK(PF_INET6
, NF_IP6_LOCAL_OUT
, skb
, NULL
, skb
->dev
,
1823 mld_dev_queue_xmit
);
1825 if (type
== ICMPV6_MGM_REDUCTION
)
1826 ICMP6_INC_STATS(idev
, ICMP6_MIB_OUTGROUPMEMBREDUCTIONS
);
1828 ICMP6_INC_STATS(idev
, ICMP6_MIB_OUTGROUPMEMBRESPONSES
);
1829 ICMP6_INC_STATS(idev
, ICMP6_MIB_OUTMSGS
);
1830 IP6_INC_STATS(idev
, IPSTATS_MIB_OUTMCASTPKTS
);
1832 IP6_INC_STATS(idev
, IPSTATS_MIB_OUTDISCARDS
);
1834 if (likely(idev
!= NULL
))
1839 static int ip6_mc_del1_src(struct ifmcaddr6
*pmc
, int sfmode
,
1840 struct in6_addr
*psfsrc
)
1842 struct ip6_sf_list
*psf
, *psf_prev
;
1846 for (psf
=pmc
->mca_sources
; psf
; psf
=psf
->sf_next
) {
1847 if (ipv6_addr_equal(&psf
->sf_addr
, psfsrc
))
1851 if (!psf
|| psf
->sf_count
[sfmode
] == 0) {
1852 /* source filter not found, or count wrong => bug */
1855 psf
->sf_count
[sfmode
]--;
1856 if (!psf
->sf_count
[MCAST_INCLUDE
] && !psf
->sf_count
[MCAST_EXCLUDE
]) {
1857 struct inet6_dev
*idev
= pmc
->idev
;
1859 /* no more filters for this source */
1861 psf_prev
->sf_next
= psf
->sf_next
;
1863 pmc
->mca_sources
= psf
->sf_next
;
1864 if (psf
->sf_oldin
&& !(pmc
->mca_flags
& MAF_NOREPORT
) &&
1865 !MLD_V1_SEEN(idev
)) {
1866 psf
->sf_crcount
= idev
->mc_qrv
;
1867 psf
->sf_next
= pmc
->mca_tomb
;
1868 pmc
->mca_tomb
= psf
;
1876 static int ip6_mc_del_src(struct inet6_dev
*idev
, struct in6_addr
*pmca
,
1877 int sfmode
, int sfcount
, struct in6_addr
*psfsrc
,
1880 struct ifmcaddr6
*pmc
;
1886 read_lock_bh(&idev
->lock
);
1887 for (pmc
=idev
->mc_list
; pmc
; pmc
=pmc
->next
) {
1888 if (ipv6_addr_equal(pmca
, &pmc
->mca_addr
))
1892 /* MCA not found?? bug */
1893 read_unlock_bh(&idev
->lock
);
1896 spin_lock_bh(&pmc
->mca_lock
);
1899 if (!pmc
->mca_sfcount
[sfmode
]) {
1900 spin_unlock_bh(&pmc
->mca_lock
);
1901 read_unlock_bh(&idev
->lock
);
1904 pmc
->mca_sfcount
[sfmode
]--;
1907 for (i
=0; i
<sfcount
; i
++) {
1908 int rv
= ip6_mc_del1_src(pmc
, sfmode
, &psfsrc
[i
]);
1910 changerec
|= rv
> 0;
1914 if (pmc
->mca_sfmode
== MCAST_EXCLUDE
&&
1915 pmc
->mca_sfcount
[MCAST_EXCLUDE
] == 0 &&
1916 pmc
->mca_sfcount
[MCAST_INCLUDE
]) {
1917 struct ip6_sf_list
*psf
;
1919 /* filter mode change */
1920 pmc
->mca_sfmode
= MCAST_INCLUDE
;
1921 pmc
->mca_crcount
= idev
->mc_qrv
;
1922 idev
->mc_ifc_count
= pmc
->mca_crcount
;
1923 for (psf
=pmc
->mca_sources
; psf
; psf
= psf
->sf_next
)
1924 psf
->sf_crcount
= 0;
1925 mld_ifc_event(pmc
->idev
);
1926 } else if (sf_setstate(pmc
) || changerec
)
1927 mld_ifc_event(pmc
->idev
);
1928 spin_unlock_bh(&pmc
->mca_lock
);
1929 read_unlock_bh(&idev
->lock
);
1934 * Add multicast single-source filter to the interface list
1936 static int ip6_mc_add1_src(struct ifmcaddr6
*pmc
, int sfmode
,
1937 struct in6_addr
*psfsrc
, int delta
)
1939 struct ip6_sf_list
*psf
, *psf_prev
;
1942 for (psf
=pmc
->mca_sources
; psf
; psf
=psf
->sf_next
) {
1943 if (ipv6_addr_equal(&psf
->sf_addr
, psfsrc
))
1948 psf
= kzalloc(sizeof(*psf
), GFP_ATOMIC
);
1952 psf
->sf_addr
= *psfsrc
;
1954 psf_prev
->sf_next
= psf
;
1956 pmc
->mca_sources
= psf
;
1958 psf
->sf_count
[sfmode
]++;
1962 static void sf_markstate(struct ifmcaddr6
*pmc
)
1964 struct ip6_sf_list
*psf
;
1965 int mca_xcount
= pmc
->mca_sfcount
[MCAST_EXCLUDE
];
1967 for (psf
=pmc
->mca_sources
; psf
; psf
=psf
->sf_next
)
1968 if (pmc
->mca_sfcount
[MCAST_EXCLUDE
]) {
1969 psf
->sf_oldin
= mca_xcount
==
1970 psf
->sf_count
[MCAST_EXCLUDE
] &&
1971 !psf
->sf_count
[MCAST_INCLUDE
];
1973 psf
->sf_oldin
= psf
->sf_count
[MCAST_INCLUDE
] != 0;
1976 static int sf_setstate(struct ifmcaddr6
*pmc
)
1978 struct ip6_sf_list
*psf
, *dpsf
;
1979 int mca_xcount
= pmc
->mca_sfcount
[MCAST_EXCLUDE
];
1980 int qrv
= pmc
->idev
->mc_qrv
;
1984 for (psf
=pmc
->mca_sources
; psf
; psf
=psf
->sf_next
) {
1985 if (pmc
->mca_sfcount
[MCAST_EXCLUDE
]) {
1986 new_in
= mca_xcount
== psf
->sf_count
[MCAST_EXCLUDE
] &&
1987 !psf
->sf_count
[MCAST_INCLUDE
];
1989 new_in
= psf
->sf_count
[MCAST_INCLUDE
] != 0;
1991 if (!psf
->sf_oldin
) {
1992 struct ip6_sf_list
*prev
= NULL
;
1994 for (dpsf
=pmc
->mca_tomb
; dpsf
;
1995 dpsf
=dpsf
->sf_next
) {
1996 if (ipv6_addr_equal(&dpsf
->sf_addr
,
2003 prev
->sf_next
= dpsf
->sf_next
;
2005 pmc
->mca_tomb
= dpsf
->sf_next
;
2008 psf
->sf_crcount
= qrv
;
2011 } else if (psf
->sf_oldin
) {
2012 psf
->sf_crcount
= 0;
2014 * add or update "delete" records if an active filter
2017 for (dpsf
=pmc
->mca_tomb
; dpsf
; dpsf
=dpsf
->sf_next
)
2018 if (ipv6_addr_equal(&dpsf
->sf_addr
,
2022 dpsf
= (struct ip6_sf_list
*)
2023 kmalloc(sizeof(*dpsf
), GFP_ATOMIC
);
2027 /* pmc->mca_lock held by callers */
2028 dpsf
->sf_next
= pmc
->mca_tomb
;
2029 pmc
->mca_tomb
= dpsf
;
2031 dpsf
->sf_crcount
= qrv
;
2039 * Add multicast source filter list to the interface list
2041 static int ip6_mc_add_src(struct inet6_dev
*idev
, struct in6_addr
*pmca
,
2042 int sfmode
, int sfcount
, struct in6_addr
*psfsrc
,
2045 struct ifmcaddr6
*pmc
;
2051 read_lock_bh(&idev
->lock
);
2052 for (pmc
=idev
->mc_list
; pmc
; pmc
=pmc
->next
) {
2053 if (ipv6_addr_equal(pmca
, &pmc
->mca_addr
))
2057 /* MCA not found?? bug */
2058 read_unlock_bh(&idev
->lock
);
2061 spin_lock_bh(&pmc
->mca_lock
);
2064 isexclude
= pmc
->mca_sfmode
== MCAST_EXCLUDE
;
2066 pmc
->mca_sfcount
[sfmode
]++;
2068 for (i
=0; i
<sfcount
; i
++) {
2069 err
= ip6_mc_add1_src(pmc
, sfmode
, &psfsrc
[i
], delta
);
2077 pmc
->mca_sfcount
[sfmode
]--;
2079 (void) ip6_mc_del1_src(pmc
, sfmode
, &psfsrc
[i
]);
2080 } else if (isexclude
!= (pmc
->mca_sfcount
[MCAST_EXCLUDE
] != 0)) {
2081 struct inet6_dev
*idev
= pmc
->idev
;
2082 struct ip6_sf_list
*psf
;
2084 /* filter mode change */
2085 if (pmc
->mca_sfcount
[MCAST_EXCLUDE
])
2086 pmc
->mca_sfmode
= MCAST_EXCLUDE
;
2087 else if (pmc
->mca_sfcount
[MCAST_INCLUDE
])
2088 pmc
->mca_sfmode
= MCAST_INCLUDE
;
2089 /* else no filters; keep old mode for reports */
2091 pmc
->mca_crcount
= idev
->mc_qrv
;
2092 idev
->mc_ifc_count
= pmc
->mca_crcount
;
2093 for (psf
=pmc
->mca_sources
; psf
; psf
= psf
->sf_next
)
2094 psf
->sf_crcount
= 0;
2095 mld_ifc_event(idev
);
2096 } else if (sf_setstate(pmc
))
2097 mld_ifc_event(idev
);
2098 spin_unlock_bh(&pmc
->mca_lock
);
2099 read_unlock_bh(&idev
->lock
);
2103 static void ip6_mc_clear_src(struct ifmcaddr6
*pmc
)
2105 struct ip6_sf_list
*psf
, *nextpsf
;
2107 for (psf
=pmc
->mca_tomb
; psf
; psf
=nextpsf
) {
2108 nextpsf
= psf
->sf_next
;
2111 pmc
->mca_tomb
= NULL
;
2112 for (psf
=pmc
->mca_sources
; psf
; psf
=nextpsf
) {
2113 nextpsf
= psf
->sf_next
;
2116 pmc
->mca_sources
= NULL
;
2117 pmc
->mca_sfmode
= MCAST_EXCLUDE
;
2118 pmc
->mca_sfcount
[MCAST_INCLUDE
] = 0;
2119 pmc
->mca_sfcount
[MCAST_EXCLUDE
] = 1;
2123 static void igmp6_join_group(struct ifmcaddr6
*ma
)
2125 unsigned long delay
;
2127 if (ma
->mca_flags
& MAF_NOREPORT
)
2130 igmp6_send(&ma
->mca_addr
, ma
->idev
->dev
, ICMPV6_MGM_REPORT
);
2132 delay
= net_random() % IGMP6_UNSOLICITED_IVAL
;
2134 spin_lock_bh(&ma
->mca_lock
);
2135 if (del_timer(&ma
->mca_timer
)) {
2136 atomic_dec(&ma
->mca_refcnt
);
2137 delay
= ma
->mca_timer
.expires
- jiffies
;
2140 if (!mod_timer(&ma
->mca_timer
, jiffies
+ delay
))
2141 atomic_inc(&ma
->mca_refcnt
);
2142 ma
->mca_flags
|= MAF_TIMER_RUNNING
| MAF_LAST_REPORTER
;
2143 spin_unlock_bh(&ma
->mca_lock
);
2146 static int ip6_mc_leave_src(struct sock
*sk
, struct ipv6_mc_socklist
*iml
,
2147 struct inet6_dev
*idev
)
2151 /* callers have the socket lock and a write lock on ipv6_sk_mc_lock,
2152 * so no other readers or writers of iml or its sflist
2154 if (iml
->sflist
== 0) {
2155 /* any-source empty exclude case */
2156 return ip6_mc_del_src(idev
, &iml
->addr
, iml
->sfmode
, 0, NULL
, 0);
2158 err
= ip6_mc_del_src(idev
, &iml
->addr
, iml
->sfmode
,
2159 iml
->sflist
->sl_count
, iml
->sflist
->sl_addr
, 0);
2160 sock_kfree_s(sk
, iml
->sflist
, IP6_SFLSIZE(iml
->sflist
->sl_max
));
2165 static void igmp6_leave_group(struct ifmcaddr6
*ma
)
2167 if (MLD_V1_SEEN(ma
->idev
)) {
2168 if (ma
->mca_flags
& MAF_LAST_REPORTER
)
2169 igmp6_send(&ma
->mca_addr
, ma
->idev
->dev
,
2170 ICMPV6_MGM_REDUCTION
);
2172 mld_add_delrec(ma
->idev
, ma
);
2173 mld_ifc_event(ma
->idev
);
2177 static void mld_gq_timer_expire(unsigned long data
)
2179 struct inet6_dev
*idev
= (struct inet6_dev
*)data
;
2181 idev
->mc_gq_running
= 0;
2182 mld_send_report(idev
, NULL
);
2183 __in6_dev_put(idev
);
2186 static void mld_ifc_timer_expire(unsigned long data
)
2188 struct inet6_dev
*idev
= (struct inet6_dev
*)data
;
2191 if (idev
->mc_ifc_count
) {
2192 idev
->mc_ifc_count
--;
2193 if (idev
->mc_ifc_count
)
2194 mld_ifc_start_timer(idev
, idev
->mc_maxdelay
);
2196 __in6_dev_put(idev
);
2199 static void mld_ifc_event(struct inet6_dev
*idev
)
2201 if (MLD_V1_SEEN(idev
))
2203 idev
->mc_ifc_count
= idev
->mc_qrv
;
2204 mld_ifc_start_timer(idev
, 1);
2208 static void igmp6_timer_handler(unsigned long data
)
2210 struct ifmcaddr6
*ma
= (struct ifmcaddr6
*) data
;
2212 if (MLD_V1_SEEN(ma
->idev
))
2213 igmp6_send(&ma
->mca_addr
, ma
->idev
->dev
, ICMPV6_MGM_REPORT
);
2215 mld_send_report(ma
->idev
, ma
);
2217 spin_lock(&ma
->mca_lock
);
2218 ma
->mca_flags
|= MAF_LAST_REPORTER
;
2219 ma
->mca_flags
&= ~MAF_TIMER_RUNNING
;
2220 spin_unlock(&ma
->mca_lock
);
2224 /* Device going down */
2226 void ipv6_mc_down(struct inet6_dev
*idev
)
2228 struct ifmcaddr6
*i
;
2230 /* Withdraw multicast list */
2232 read_lock_bh(&idev
->lock
);
2233 idev
->mc_ifc_count
= 0;
2234 if (del_timer(&idev
->mc_ifc_timer
))
2235 __in6_dev_put(idev
);
2236 idev
->mc_gq_running
= 0;
2237 if (del_timer(&idev
->mc_gq_timer
))
2238 __in6_dev_put(idev
);
2240 for (i
= idev
->mc_list
; i
; i
=i
->next
)
2241 igmp6_group_dropped(i
);
2242 read_unlock_bh(&idev
->lock
);
2244 mld_clear_delrec(idev
);
2248 /* Device going up */
2250 void ipv6_mc_up(struct inet6_dev
*idev
)
2252 struct ifmcaddr6
*i
;
2254 /* Install multicast list, except for all-nodes (already installed) */
2256 read_lock_bh(&idev
->lock
);
2257 for (i
= idev
->mc_list
; i
; i
=i
->next
)
2258 igmp6_group_added(i
);
2259 read_unlock_bh(&idev
->lock
);
2262 /* IPv6 device initialization. */
2264 void ipv6_mc_init_dev(struct inet6_dev
*idev
)
2266 write_lock_bh(&idev
->lock
);
2267 rwlock_init(&idev
->mc_lock
);
2268 idev
->mc_gq_running
= 0;
2269 init_timer(&idev
->mc_gq_timer
);
2270 idev
->mc_gq_timer
.data
= (unsigned long) idev
;
2271 idev
->mc_gq_timer
.function
= &mld_gq_timer_expire
;
2272 idev
->mc_tomb
= NULL
;
2273 idev
->mc_ifc_count
= 0;
2274 init_timer(&idev
->mc_ifc_timer
);
2275 idev
->mc_ifc_timer
.data
= (unsigned long) idev
;
2276 idev
->mc_ifc_timer
.function
= &mld_ifc_timer_expire
;
2277 idev
->mc_qrv
= MLD_QRV_DEFAULT
;
2278 idev
->mc_maxdelay
= IGMP6_UNSOLICITED_IVAL
;
2279 idev
->mc_v1_seen
= 0;
2280 write_unlock_bh(&idev
->lock
);
2284 * Device is about to be destroyed: clean up.
2287 void ipv6_mc_destroy_dev(struct inet6_dev
*idev
)
2289 struct ifmcaddr6
*i
;
2290 struct in6_addr maddr
;
2292 /* Deactivate timers */
2295 /* Delete all-nodes address. */
2296 ipv6_addr_all_nodes(&maddr
);
2298 /* We cannot call ipv6_dev_mc_dec() directly, our caller in
2299 * addrconf.c has NULL'd out dev->ip6_ptr so in6_dev_get() will
2302 __ipv6_dev_mc_dec(idev
, &maddr
);
2304 if (idev
->cnf
.forwarding
) {
2305 ipv6_addr_all_routers(&maddr
);
2306 __ipv6_dev_mc_dec(idev
, &maddr
);
2309 write_lock_bh(&idev
->lock
);
2310 while ((i
= idev
->mc_list
) != NULL
) {
2311 idev
->mc_list
= i
->next
;
2312 write_unlock_bh(&idev
->lock
);
2314 igmp6_group_dropped(i
);
2317 write_lock_bh(&idev
->lock
);
2319 write_unlock_bh(&idev
->lock
);
2322 #ifdef CONFIG_PROC_FS
2323 struct igmp6_mc_iter_state
{
2324 struct net_device
*dev
;
2325 struct inet6_dev
*idev
;
2328 #define igmp6_mc_seq_private(seq) ((struct igmp6_mc_iter_state *)(seq)->private)
2330 static inline struct ifmcaddr6
*igmp6_mc_get_first(struct seq_file
*seq
)
2332 struct ifmcaddr6
*im
= NULL
;
2333 struct igmp6_mc_iter_state
*state
= igmp6_mc_seq_private(seq
);
2336 for_each_netdev(&init_net
, state
->dev
) {
2337 struct inet6_dev
*idev
;
2338 idev
= in6_dev_get(state
->dev
);
2341 read_lock_bh(&idev
->lock
);
2347 read_unlock_bh(&idev
->lock
);
2353 static struct ifmcaddr6
*igmp6_mc_get_next(struct seq_file
*seq
, struct ifmcaddr6
*im
)
2355 struct igmp6_mc_iter_state
*state
= igmp6_mc_seq_private(seq
);
2359 if (likely(state
->idev
!= NULL
)) {
2360 read_unlock_bh(&state
->idev
->lock
);
2361 in6_dev_put(state
->idev
);
2363 state
->dev
= next_net_device(state
->dev
);
2368 state
->idev
= in6_dev_get(state
->dev
);
2371 read_lock_bh(&state
->idev
->lock
);
2372 im
= state
->idev
->mc_list
;
2377 static struct ifmcaddr6
*igmp6_mc_get_idx(struct seq_file
*seq
, loff_t pos
)
2379 struct ifmcaddr6
*im
= igmp6_mc_get_first(seq
);
2381 while (pos
&& (im
= igmp6_mc_get_next(seq
, im
)) != NULL
)
2383 return pos
? NULL
: im
;
2386 static void *igmp6_mc_seq_start(struct seq_file
*seq
, loff_t
*pos
)
2388 read_lock(&dev_base_lock
);
2389 return igmp6_mc_get_idx(seq
, *pos
);
2392 static void *igmp6_mc_seq_next(struct seq_file
*seq
, void *v
, loff_t
*pos
)
2394 struct ifmcaddr6
*im
;
2395 im
= igmp6_mc_get_next(seq
, v
);
2400 static void igmp6_mc_seq_stop(struct seq_file
*seq
, void *v
)
2402 struct igmp6_mc_iter_state
*state
= igmp6_mc_seq_private(seq
);
2403 if (likely(state
->idev
!= NULL
)) {
2404 read_unlock_bh(&state
->idev
->lock
);
2405 in6_dev_put(state
->idev
);
2409 read_unlock(&dev_base_lock
);
2412 static int igmp6_mc_seq_show(struct seq_file
*seq
, void *v
)
2414 struct ifmcaddr6
*im
= (struct ifmcaddr6
*)v
;
2415 struct igmp6_mc_iter_state
*state
= igmp6_mc_seq_private(seq
);
2418 "%-4d %-15s " NIP6_SEQFMT
" %5d %08X %ld\n",
2419 state
->dev
->ifindex
, state
->dev
->name
,
2421 im
->mca_users
, im
->mca_flags
,
2422 (im
->mca_flags
&MAF_TIMER_RUNNING
) ?
2423 jiffies_to_clock_t(im
->mca_timer
.expires
-jiffies
) : 0);
2427 static const struct seq_operations igmp6_mc_seq_ops
= {
2428 .start
= igmp6_mc_seq_start
,
2429 .next
= igmp6_mc_seq_next
,
2430 .stop
= igmp6_mc_seq_stop
,
2431 .show
= igmp6_mc_seq_show
,
2434 static int igmp6_mc_seq_open(struct inode
*inode
, struct file
*file
)
2436 struct seq_file
*seq
;
2438 struct igmp6_mc_iter_state
*s
= kzalloc(sizeof(*s
), GFP_KERNEL
);
2443 rc
= seq_open(file
, &igmp6_mc_seq_ops
);
2447 seq
= file
->private_data
;
2456 static const struct file_operations igmp6_mc_seq_fops
= {
2457 .owner
= THIS_MODULE
,
2458 .open
= igmp6_mc_seq_open
,
2460 .llseek
= seq_lseek
,
2461 .release
= seq_release_private
,
2464 struct igmp6_mcf_iter_state
{
2465 struct net_device
*dev
;
2466 struct inet6_dev
*idev
;
2467 struct ifmcaddr6
*im
;
2470 #define igmp6_mcf_seq_private(seq) ((struct igmp6_mcf_iter_state *)(seq)->private)
2472 static inline struct ip6_sf_list
*igmp6_mcf_get_first(struct seq_file
*seq
)
2474 struct ip6_sf_list
*psf
= NULL
;
2475 struct ifmcaddr6
*im
= NULL
;
2476 struct igmp6_mcf_iter_state
*state
= igmp6_mcf_seq_private(seq
);
2480 for_each_netdev(&init_net
, state
->dev
) {
2481 struct inet6_dev
*idev
;
2482 idev
= in6_dev_get(state
->dev
);
2483 if (unlikely(idev
== NULL
))
2485 read_lock_bh(&idev
->lock
);
2487 if (likely(im
!= NULL
)) {
2488 spin_lock_bh(&im
->mca_lock
);
2489 psf
= im
->mca_sources
;
2490 if (likely(psf
!= NULL
)) {
2495 spin_unlock_bh(&im
->mca_lock
);
2497 read_unlock_bh(&idev
->lock
);
2503 static struct ip6_sf_list
*igmp6_mcf_get_next(struct seq_file
*seq
, struct ip6_sf_list
*psf
)
2505 struct igmp6_mcf_iter_state
*state
= igmp6_mcf_seq_private(seq
);
2509 spin_unlock_bh(&state
->im
->mca_lock
);
2510 state
->im
= state
->im
->next
;
2511 while (!state
->im
) {
2512 if (likely(state
->idev
!= NULL
)) {
2513 read_unlock_bh(&state
->idev
->lock
);
2514 in6_dev_put(state
->idev
);
2516 state
->dev
= next_net_device(state
->dev
);
2521 state
->idev
= in6_dev_get(state
->dev
);
2524 read_lock_bh(&state
->idev
->lock
);
2525 state
->im
= state
->idev
->mc_list
;
2529 spin_lock_bh(&state
->im
->mca_lock
);
2530 psf
= state
->im
->mca_sources
;
2536 static struct ip6_sf_list
*igmp6_mcf_get_idx(struct seq_file
*seq
, loff_t pos
)
2538 struct ip6_sf_list
*psf
= igmp6_mcf_get_first(seq
);
2540 while (pos
&& (psf
= igmp6_mcf_get_next(seq
, psf
)) != NULL
)
2542 return pos
? NULL
: psf
;
2545 static void *igmp6_mcf_seq_start(struct seq_file
*seq
, loff_t
*pos
)
2547 read_lock(&dev_base_lock
);
2548 return *pos
? igmp6_mcf_get_idx(seq
, *pos
- 1) : SEQ_START_TOKEN
;
2551 static void *igmp6_mcf_seq_next(struct seq_file
*seq
, void *v
, loff_t
*pos
)
2553 struct ip6_sf_list
*psf
;
2554 if (v
== SEQ_START_TOKEN
)
2555 psf
= igmp6_mcf_get_first(seq
);
2557 psf
= igmp6_mcf_get_next(seq
, v
);
2562 static void igmp6_mcf_seq_stop(struct seq_file
*seq
, void *v
)
2564 struct igmp6_mcf_iter_state
*state
= igmp6_mcf_seq_private(seq
);
2565 if (likely(state
->im
!= NULL
)) {
2566 spin_unlock_bh(&state
->im
->mca_lock
);
2569 if (likely(state
->idev
!= NULL
)) {
2570 read_unlock_bh(&state
->idev
->lock
);
2571 in6_dev_put(state
->idev
);
2575 read_unlock(&dev_base_lock
);
2578 static int igmp6_mcf_seq_show(struct seq_file
*seq
, void *v
)
2580 struct ip6_sf_list
*psf
= (struct ip6_sf_list
*)v
;
2581 struct igmp6_mcf_iter_state
*state
= igmp6_mcf_seq_private(seq
);
2583 if (v
== SEQ_START_TOKEN
) {
2586 "%32s %32s %6s %6s\n", "Idx",
2587 "Device", "Multicast Address",
2588 "Source Address", "INC", "EXC");
2591 "%3d %6.6s " NIP6_SEQFMT
" " NIP6_SEQFMT
" %6lu %6lu\n",
2592 state
->dev
->ifindex
, state
->dev
->name
,
2593 NIP6(state
->im
->mca_addr
),
2595 psf
->sf_count
[MCAST_INCLUDE
],
2596 psf
->sf_count
[MCAST_EXCLUDE
]);
2601 static const struct seq_operations igmp6_mcf_seq_ops
= {
2602 .start
= igmp6_mcf_seq_start
,
2603 .next
= igmp6_mcf_seq_next
,
2604 .stop
= igmp6_mcf_seq_stop
,
2605 .show
= igmp6_mcf_seq_show
,
2608 static int igmp6_mcf_seq_open(struct inode
*inode
, struct file
*file
)
2610 struct seq_file
*seq
;
2612 struct igmp6_mcf_iter_state
*s
= kzalloc(sizeof(*s
), GFP_KERNEL
);
2617 rc
= seq_open(file
, &igmp6_mcf_seq_ops
);
2621 seq
= file
->private_data
;
2630 static const struct file_operations igmp6_mcf_seq_fops
= {
2631 .owner
= THIS_MODULE
,
2632 .open
= igmp6_mcf_seq_open
,
2634 .llseek
= seq_lseek
,
2635 .release
= seq_release_private
,
2639 int __init
igmp6_init(struct net_proto_family
*ops
)
2641 struct ipv6_pinfo
*np
;
2645 err
= sock_create_kern(PF_INET6
, SOCK_RAW
, IPPROTO_ICMPV6
, &igmp6_socket
);
2648 "Failed to initialize the IGMP6 control socket (err %d).\n",
2650 igmp6_socket
= NULL
; /* For safety. */
2654 sk
= igmp6_socket
->sk
;
2655 sk
->sk_allocation
= GFP_ATOMIC
;
2656 sk
->sk_prot
->unhash(sk
);
2661 #ifdef CONFIG_PROC_FS
2662 proc_net_fops_create(&init_net
, "igmp6", S_IRUGO
, &igmp6_mc_seq_fops
);
2663 proc_net_fops_create(&init_net
, "mcfilter6", S_IRUGO
, &igmp6_mcf_seq_fops
);
2669 void igmp6_cleanup(void)
2671 sock_release(igmp6_socket
);
2672 igmp6_socket
= NULL
; /* for safety */
2674 #ifdef CONFIG_PROC_FS
2675 proc_net_remove(&init_net
, "mcfilter6");
2676 proc_net_remove(&init_net
, "igmp6");