2 * Bridge multicast support.
4 * Copyright (c) 2010 Herbert Xu <herbert@gondor.apana.org.au>
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License as published by the Free
8 * Software Foundation; either version 2 of the License, or (at your option)
13 #include <linux/err.h>
14 #include <linux/if_ether.h>
15 #include <linux/igmp.h>
16 #include <linux/jhash.h>
17 #include <linux/kernel.h>
18 #include <linux/netdevice.h>
19 #include <linux/netfilter_bridge.h>
20 #include <linux/random.h>
21 #include <linux/rculist.h>
22 #include <linux/skbuff.h>
23 #include <linux/slab.h>
24 #include <linux/timer.h>
27 #include "br_private.h"
29 static inline int br_ip_hash(struct net_bridge_mdb_htable
*mdb
, __be32 ip
)
31 return jhash_1word(mdb
->secret
, (u32
)ip
) & (mdb
->max
- 1);
34 static struct net_bridge_mdb_entry
*__br_mdb_ip_get(
35 struct net_bridge_mdb_htable
*mdb
, __be32 dst
, int hash
)
37 struct net_bridge_mdb_entry
*mp
;
40 hlist_for_each_entry(mp
, p
, &mdb
->mhash
[hash
], hlist
[mdb
->ver
]) {
48 static struct net_bridge_mdb_entry
*br_mdb_ip_get(
49 struct net_bridge_mdb_htable
*mdb
, __be32 dst
)
51 return __br_mdb_ip_get(mdb
, dst
, br_ip_hash(mdb
, dst
));
54 struct net_bridge_mdb_entry
*br_mdb_get(struct net_bridge
*br
,
57 struct net_bridge_mdb_htable
*mdb
= br
->mdb
;
59 if (!mdb
|| br
->multicast_disabled
)
62 switch (skb
->protocol
) {
64 if (BR_INPUT_SKB_CB(skb
)->igmp
)
66 return br_mdb_ip_get(mdb
, ip_hdr(skb
)->daddr
);
72 static void br_mdb_free(struct rcu_head
*head
)
74 struct net_bridge_mdb_htable
*mdb
=
75 container_of(head
, struct net_bridge_mdb_htable
, rcu
);
76 struct net_bridge_mdb_htable
*old
= mdb
->old
;
83 static int br_mdb_copy(struct net_bridge_mdb_htable
*new,
84 struct net_bridge_mdb_htable
*old
,
87 struct net_bridge_mdb_entry
*mp
;
93 for (i
= 0; i
< old
->max
; i
++)
94 hlist_for_each_entry(mp
, p
, &old
->mhash
[i
], hlist
[old
->ver
])
95 hlist_add_head(&mp
->hlist
[new->ver
],
96 &new->mhash
[br_ip_hash(new, mp
->addr
)]);
102 for (i
= 0; i
< new->max
; i
++) {
104 hlist_for_each_entry(mp
, p
, &new->mhash
[i
], hlist
[new->ver
])
110 return maxlen
> elasticity
? -EINVAL
: 0;
113 static void br_multicast_free_pg(struct rcu_head
*head
)
115 struct net_bridge_port_group
*p
=
116 container_of(head
, struct net_bridge_port_group
, rcu
);
121 static void br_multicast_free_group(struct rcu_head
*head
)
123 struct net_bridge_mdb_entry
*mp
=
124 container_of(head
, struct net_bridge_mdb_entry
, rcu
);
129 static void br_multicast_group_expired(unsigned long data
)
131 struct net_bridge_mdb_entry
*mp
= (void *)data
;
132 struct net_bridge
*br
= mp
->br
;
133 struct net_bridge_mdb_htable
*mdb
;
135 spin_lock(&br
->multicast_lock
);
136 if (!netif_running(br
->dev
) || timer_pending(&mp
->timer
))
139 if (!hlist_unhashed(&mp
->mglist
))
140 hlist_del_init(&mp
->mglist
);
146 hlist_del_rcu(&mp
->hlist
[mdb
->ver
]);
149 del_timer(&mp
->query_timer
);
150 call_rcu_bh(&mp
->rcu
, br_multicast_free_group
);
153 spin_unlock(&br
->multicast_lock
);
156 static void br_multicast_del_pg(struct net_bridge
*br
,
157 struct net_bridge_port_group
*pg
)
159 struct net_bridge_mdb_htable
*mdb
= br
->mdb
;
160 struct net_bridge_mdb_entry
*mp
;
161 struct net_bridge_port_group
*p
;
162 struct net_bridge_port_group
**pp
;
164 mp
= br_mdb_ip_get(mdb
, pg
->addr
);
168 for (pp
= &mp
->ports
; (p
= *pp
); pp
= &p
->next
) {
173 hlist_del_init(&p
->mglist
);
174 del_timer(&p
->timer
);
175 del_timer(&p
->query_timer
);
176 call_rcu_bh(&p
->rcu
, br_multicast_free_pg
);
178 if (!mp
->ports
&& hlist_unhashed(&mp
->mglist
) &&
179 netif_running(br
->dev
))
180 mod_timer(&mp
->timer
, jiffies
);
188 static void br_multicast_port_group_expired(unsigned long data
)
190 struct net_bridge_port_group
*pg
= (void *)data
;
191 struct net_bridge
*br
= pg
->port
->br
;
193 spin_lock(&br
->multicast_lock
);
194 if (!netif_running(br
->dev
) || timer_pending(&pg
->timer
) ||
195 hlist_unhashed(&pg
->mglist
))
198 br_multicast_del_pg(br
, pg
);
201 spin_unlock(&br
->multicast_lock
);
204 static int br_mdb_rehash(struct net_bridge_mdb_htable
**mdbp
, int max
,
207 struct net_bridge_mdb_htable
*old
= *mdbp
;
208 struct net_bridge_mdb_htable
*mdb
;
211 mdb
= kmalloc(sizeof(*mdb
), GFP_ATOMIC
);
218 mdb
->mhash
= kzalloc(max
* sizeof(*mdb
->mhash
), GFP_ATOMIC
);
224 mdb
->size
= old
? old
->size
: 0;
225 mdb
->ver
= old
? old
->ver
^ 1 : 0;
227 if (!old
|| elasticity
)
228 get_random_bytes(&mdb
->secret
, sizeof(mdb
->secret
));
230 mdb
->secret
= old
->secret
;
235 err
= br_mdb_copy(mdb
, old
, elasticity
);
242 call_rcu_bh(&mdb
->rcu
, br_mdb_free
);
245 rcu_assign_pointer(*mdbp
, mdb
);
250 static struct sk_buff
*br_multicast_alloc_query(struct net_bridge
*br
,
258 skb
= netdev_alloc_skb_ip_align(br
->dev
, sizeof(*eth
) + sizeof(*iph
) +
263 skb
->protocol
= htons(ETH_P_IP
);
265 skb_reset_mac_header(skb
);
268 memcpy(eth
->h_source
, br
->dev
->dev_addr
, 6);
271 eth
->h_dest
[2] = 0x5e;
275 eth
->h_proto
= htons(ETH_P_IP
);
276 skb_put(skb
, sizeof(*eth
));
278 skb_set_network_header(skb
, skb
->len
);
284 iph
->tot_len
= htons(sizeof(*iph
) + sizeof(*ih
) + 4);
286 iph
->frag_off
= htons(IP_DF
);
288 iph
->protocol
= IPPROTO_IGMP
;
290 iph
->daddr
= htonl(INADDR_ALLHOSTS_GROUP
);
291 ((u8
*)&iph
[1])[0] = IPOPT_RA
;
292 ((u8
*)&iph
[1])[1] = 4;
293 ((u8
*)&iph
[1])[2] = 0;
294 ((u8
*)&iph
[1])[3] = 0;
298 skb_set_transport_header(skb
, skb
->len
);
300 ih
->type
= IGMP_HOST_MEMBERSHIP_QUERY
;
301 ih
->code
= (group
? br
->multicast_last_member_interval
:
302 br
->multicast_query_response_interval
) /
303 (HZ
/ IGMP_TIMER_SCALE
);
306 ih
->csum
= ip_compute_csum((void *)ih
, sizeof(struct igmphdr
));
307 skb_put(skb
, sizeof(*ih
));
309 __skb_pull(skb
, sizeof(*eth
));
315 static void br_multicast_send_group_query(struct net_bridge_mdb_entry
*mp
)
317 struct net_bridge
*br
= mp
->br
;
320 skb
= br_multicast_alloc_query(br
, mp
->addr
);
327 if (++mp
->queries_sent
< br
->multicast_last_member_count
)
328 mod_timer(&mp
->query_timer
,
329 jiffies
+ br
->multicast_last_member_interval
);
332 static void br_multicast_group_query_expired(unsigned long data
)
334 struct net_bridge_mdb_entry
*mp
= (void *)data
;
335 struct net_bridge
*br
= mp
->br
;
337 spin_lock(&br
->multicast_lock
);
338 if (!netif_running(br
->dev
) || hlist_unhashed(&mp
->mglist
) ||
339 mp
->queries_sent
>= br
->multicast_last_member_count
)
342 br_multicast_send_group_query(mp
);
345 spin_unlock(&br
->multicast_lock
);
348 static void br_multicast_send_port_group_query(struct net_bridge_port_group
*pg
)
350 struct net_bridge_port
*port
= pg
->port
;
351 struct net_bridge
*br
= port
->br
;
354 skb
= br_multicast_alloc_query(br
, pg
->addr
);
358 br_deliver(port
, skb
);
361 if (++pg
->queries_sent
< br
->multicast_last_member_count
)
362 mod_timer(&pg
->query_timer
,
363 jiffies
+ br
->multicast_last_member_interval
);
366 static void br_multicast_port_group_query_expired(unsigned long data
)
368 struct net_bridge_port_group
*pg
= (void *)data
;
369 struct net_bridge_port
*port
= pg
->port
;
370 struct net_bridge
*br
= port
->br
;
372 spin_lock(&br
->multicast_lock
);
373 if (!netif_running(br
->dev
) || hlist_unhashed(&pg
->mglist
) ||
374 pg
->queries_sent
>= br
->multicast_last_member_count
)
377 br_multicast_send_port_group_query(pg
);
380 spin_unlock(&br
->multicast_lock
);
383 static struct net_bridge_mdb_entry
*br_multicast_get_group(
384 struct net_bridge
*br
, struct net_bridge_port
*port
, __be32 group
,
387 struct net_bridge_mdb_htable
*mdb
= br
->mdb
;
388 struct net_bridge_mdb_entry
*mp
;
389 struct hlist_node
*p
;
395 hlist_for_each_entry(mp
, p
, &mdb
->mhash
[hash
], hlist
[mdb
->ver
]) {
397 if (unlikely(group
== mp
->addr
)) {
405 if (unlikely(count
> br
->hash_elasticity
&& count
)) {
407 printk(KERN_INFO
"%s: Multicast hash table "
408 "chain limit reached: %s\n",
409 br
->dev
->name
, port
? port
->dev
->name
:
412 elasticity
= br
->hash_elasticity
;
415 if (mdb
->size
>= max
) {
417 if (unlikely(max
>= br
->hash_max
)) {
418 printk(KERN_WARNING
"%s: Multicast hash table maximum "
419 "reached, disabling snooping: %s, %d\n",
420 br
->dev
->name
, port
? port
->dev
->name
:
425 br
->multicast_disabled
= 1;
430 if (max
> mdb
->max
|| elasticity
) {
433 printk(KERN_INFO
"%s: Multicast hash table "
435 br
->dev
->name
, port
? port
->dev
->name
:
441 err
= br_mdb_rehash(&br
->mdb
, max
, elasticity
);
443 printk(KERN_WARNING
"%s: Cannot rehash multicast "
444 "hash table, disabling snooping: "
446 br
->dev
->name
, port
? port
->dev
->name
:
463 static struct net_bridge_mdb_entry
*br_multicast_new_group(
464 struct net_bridge
*br
, struct net_bridge_port
*port
, __be32 group
)
466 struct net_bridge_mdb_htable
*mdb
= br
->mdb
;
467 struct net_bridge_mdb_entry
*mp
;
471 if (br_mdb_rehash(&br
->mdb
, BR_HASH_SIZE
, 0))
476 hash
= br_ip_hash(mdb
, group
);
477 mp
= br_multicast_get_group(br
, port
, group
, hash
);
478 switch (PTR_ERR(mp
)) {
485 hash
= br_ip_hash(mdb
, group
);
492 mp
= kzalloc(sizeof(*mp
), GFP_ATOMIC
);
498 setup_timer(&mp
->timer
, br_multicast_group_expired
,
500 setup_timer(&mp
->query_timer
, br_multicast_group_query_expired
,
503 hlist_add_head_rcu(&mp
->hlist
[mdb
->ver
], &mdb
->mhash
[hash
]);
510 static int br_multicast_add_group(struct net_bridge
*br
,
511 struct net_bridge_port
*port
, __be32 group
)
513 struct net_bridge_mdb_entry
*mp
;
514 struct net_bridge_port_group
*p
;
515 struct net_bridge_port_group
**pp
;
516 unsigned long now
= jiffies
;
519 if (ipv4_is_local_multicast(group
))
522 spin_lock(&br
->multicast_lock
);
523 if (!netif_running(br
->dev
) ||
524 (port
&& port
->state
== BR_STATE_DISABLED
))
527 mp
= br_multicast_new_group(br
, port
, group
);
529 if (unlikely(IS_ERR(mp
) || !mp
))
533 hlist_add_head(&mp
->mglist
, &br
->mglist
);
534 mod_timer(&mp
->timer
, now
+ br
->multicast_membership_interval
);
538 for (pp
= &mp
->ports
; (p
= *pp
); pp
= &p
->next
) {
541 if ((unsigned long)p
->port
< (unsigned long)port
)
545 p
= kzalloc(sizeof(*p
), GFP_ATOMIC
);
553 hlist_add_head(&p
->mglist
, &port
->mglist
);
554 setup_timer(&p
->timer
, br_multicast_port_group_expired
,
556 setup_timer(&p
->query_timer
, br_multicast_port_group_query_expired
,
559 rcu_assign_pointer(*pp
, p
);
562 mod_timer(&p
->timer
, now
+ br
->multicast_membership_interval
);
567 spin_unlock(&br
->multicast_lock
);
571 static void br_multicast_router_expired(unsigned long data
)
573 struct net_bridge_port
*port
= (void *)data
;
574 struct net_bridge
*br
= port
->br
;
576 spin_lock(&br
->multicast_lock
);
577 if (port
->multicast_router
!= 1 ||
578 timer_pending(&port
->multicast_router_timer
) ||
579 hlist_unhashed(&port
->rlist
))
582 hlist_del_init_rcu(&port
->rlist
);
585 spin_unlock(&br
->multicast_lock
);
588 static void br_multicast_local_router_expired(unsigned long data
)
592 static void br_multicast_send_query(struct net_bridge
*br
,
593 struct net_bridge_port
*port
, u32 sent
)
598 if (!netif_running(br
->dev
) || br
->multicast_disabled
||
599 timer_pending(&br
->multicast_querier_timer
))
602 skb
= br_multicast_alloc_query(br
, 0);
607 __skb_push(skb
, sizeof(struct ethhdr
));
608 skb
->dev
= port
->dev
;
609 NF_HOOK(PF_BRIDGE
, NF_BR_LOCAL_OUT
, skb
, NULL
, skb
->dev
,
616 time
+= sent
< br
->multicast_startup_query_count
?
617 br
->multicast_startup_query_interval
:
618 br
->multicast_query_interval
;
619 mod_timer(port
? &port
->multicast_query_timer
:
620 &br
->multicast_query_timer
, time
);
623 static void br_multicast_port_query_expired(unsigned long data
)
625 struct net_bridge_port
*port
= (void *)data
;
626 struct net_bridge
*br
= port
->br
;
628 spin_lock(&br
->multicast_lock
);
629 if (port
&& (port
->state
== BR_STATE_DISABLED
||
630 port
->state
== BR_STATE_BLOCKING
))
633 if (port
->multicast_startup_queries_sent
<
634 br
->multicast_startup_query_count
)
635 port
->multicast_startup_queries_sent
++;
637 br_multicast_send_query(port
->br
, port
,
638 port
->multicast_startup_queries_sent
);
641 spin_unlock(&br
->multicast_lock
);
644 void br_multicast_add_port(struct net_bridge_port
*port
)
646 port
->multicast_router
= 1;
648 setup_timer(&port
->multicast_router_timer
, br_multicast_router_expired
,
649 (unsigned long)port
);
650 setup_timer(&port
->multicast_query_timer
,
651 br_multicast_port_query_expired
, (unsigned long)port
);
654 void br_multicast_del_port(struct net_bridge_port
*port
)
656 del_timer_sync(&port
->multicast_router_timer
);
659 void br_multicast_enable_port(struct net_bridge_port
*port
)
661 struct net_bridge
*br
= port
->br
;
663 spin_lock(&br
->multicast_lock
);
664 if (br
->multicast_disabled
|| !netif_running(br
->dev
))
667 port
->multicast_startup_queries_sent
= 0;
669 if (try_to_del_timer_sync(&port
->multicast_query_timer
) >= 0 ||
670 del_timer(&port
->multicast_query_timer
))
671 mod_timer(&port
->multicast_query_timer
, jiffies
);
674 spin_unlock(&br
->multicast_lock
);
677 void br_multicast_disable_port(struct net_bridge_port
*port
)
679 struct net_bridge
*br
= port
->br
;
680 struct net_bridge_port_group
*pg
;
681 struct hlist_node
*p
, *n
;
683 spin_lock(&br
->multicast_lock
);
684 hlist_for_each_entry_safe(pg
, p
, n
, &port
->mglist
, mglist
)
685 br_multicast_del_pg(br
, pg
);
687 if (!hlist_unhashed(&port
->rlist
))
688 hlist_del_init_rcu(&port
->rlist
);
689 del_timer(&port
->multicast_router_timer
);
690 del_timer(&port
->multicast_query_timer
);
691 spin_unlock(&br
->multicast_lock
);
694 static int br_multicast_igmp3_report(struct net_bridge
*br
,
695 struct net_bridge_port
*port
,
698 struct igmpv3_report
*ih
;
699 struct igmpv3_grec
*grec
;
707 if (!pskb_may_pull(skb
, sizeof(*ih
)))
710 ih
= igmpv3_report_hdr(skb
);
711 num
= ntohs(ih
->ngrec
);
714 for (i
= 0; i
< num
; i
++) {
715 len
+= sizeof(*grec
);
716 if (!pskb_may_pull(skb
, len
))
719 grec
= (void *)(skb
->data
+ len
);
720 group
= grec
->grec_mca
;
721 type
= grec
->grec_type
;
723 len
+= grec
->grec_nsrcs
* 4;
724 if (!pskb_may_pull(skb
, len
))
727 /* We treat this as an IGMPv2 report for now. */
729 case IGMPV3_MODE_IS_INCLUDE
:
730 case IGMPV3_MODE_IS_EXCLUDE
:
731 case IGMPV3_CHANGE_TO_INCLUDE
:
732 case IGMPV3_CHANGE_TO_EXCLUDE
:
733 case IGMPV3_ALLOW_NEW_SOURCES
:
734 case IGMPV3_BLOCK_OLD_SOURCES
:
741 err
= br_multicast_add_group(br
, port
, group
);
749 static void br_multicast_mark_router(struct net_bridge
*br
,
750 struct net_bridge_port
*port
)
752 unsigned long now
= jiffies
;
753 struct hlist_node
*p
;
754 struct hlist_node
**h
;
757 if (br
->multicast_router
== 1)
758 mod_timer(&br
->multicast_router_timer
,
759 now
+ br
->multicast_querier_interval
);
763 if (port
->multicast_router
!= 1)
766 if (!hlist_unhashed(&port
->rlist
))
769 for (h
= &br
->router_list
.first
;
771 (unsigned long)container_of(p
, struct net_bridge_port
, rlist
) >
776 port
->rlist
.pprev
= h
;
777 port
->rlist
.next
= p
;
778 rcu_assign_pointer(*h
, &port
->rlist
);
780 p
->pprev
= &port
->rlist
.next
;
783 mod_timer(&port
->multicast_router_timer
,
784 now
+ br
->multicast_querier_interval
);
787 static void br_multicast_query_received(struct net_bridge
*br
,
788 struct net_bridge_port
*port
,
792 mod_timer(&br
->multicast_querier_timer
,
793 jiffies
+ br
->multicast_querier_interval
);
794 else if (timer_pending(&br
->multicast_querier_timer
))
797 br_multicast_mark_router(br
, port
);
800 static int br_multicast_query(struct net_bridge
*br
,
801 struct net_bridge_port
*port
,
804 struct iphdr
*iph
= ip_hdr(skb
);
805 struct igmphdr
*ih
= igmp_hdr(skb
);
806 struct net_bridge_mdb_entry
*mp
;
807 struct igmpv3_query
*ih3
;
808 struct net_bridge_port_group
*p
;
809 struct net_bridge_port_group
**pp
;
810 unsigned long max_delay
;
811 unsigned long now
= jiffies
;
814 spin_lock(&br
->multicast_lock
);
815 if (!netif_running(br
->dev
) ||
816 (port
&& port
->state
== BR_STATE_DISABLED
))
819 br_multicast_query_received(br
, port
, iph
->saddr
);
823 if (skb
->len
== sizeof(*ih
)) {
824 max_delay
= ih
->code
* (HZ
/ IGMP_TIMER_SCALE
);
831 if (!pskb_may_pull(skb
, sizeof(struct igmpv3_query
)))
834 ih3
= igmpv3_query_hdr(skb
);
838 max_delay
= ih3
->code
? 1 :
839 IGMPV3_MRC(ih3
->code
) * (HZ
/ IGMP_TIMER_SCALE
);
845 mp
= br_mdb_ip_get(br
->mdb
, group
);
849 max_delay
*= br
->multicast_last_member_count
;
851 if (!hlist_unhashed(&mp
->mglist
) &&
852 (timer_pending(&mp
->timer
) ?
853 time_after(mp
->timer
.expires
, now
+ max_delay
) :
854 try_to_del_timer_sync(&mp
->timer
) >= 0))
855 mod_timer(&mp
->timer
, now
+ max_delay
);
857 for (pp
= &mp
->ports
; (p
= *pp
); pp
= &p
->next
) {
858 if (timer_pending(&p
->timer
) ?
859 time_after(p
->timer
.expires
, now
+ max_delay
) :
860 try_to_del_timer_sync(&p
->timer
) >= 0)
861 mod_timer(&mp
->timer
, now
+ max_delay
);
865 spin_unlock(&br
->multicast_lock
);
869 static void br_multicast_leave_group(struct net_bridge
*br
,
870 struct net_bridge_port
*port
,
873 struct net_bridge_mdb_htable
*mdb
;
874 struct net_bridge_mdb_entry
*mp
;
875 struct net_bridge_port_group
*p
;
879 if (ipv4_is_local_multicast(group
))
882 spin_lock(&br
->multicast_lock
);
883 if (!netif_running(br
->dev
) ||
884 (port
&& port
->state
== BR_STATE_DISABLED
) ||
885 timer_pending(&br
->multicast_querier_timer
))
889 mp
= br_mdb_ip_get(mdb
, group
);
894 time
= now
+ br
->multicast_last_member_count
*
895 br
->multicast_last_member_interval
;
898 if (!hlist_unhashed(&mp
->mglist
) &&
899 (timer_pending(&mp
->timer
) ?
900 time_after(mp
->timer
.expires
, time
) :
901 try_to_del_timer_sync(&mp
->timer
) >= 0)) {
902 mod_timer(&mp
->timer
, time
);
904 mp
->queries_sent
= 0;
905 mod_timer(&mp
->query_timer
, now
);
911 for (p
= mp
->ports
; p
; p
= p
->next
) {
915 if (!hlist_unhashed(&p
->mglist
) &&
916 (timer_pending(&p
->timer
) ?
917 time_after(p
->timer
.expires
, time
) :
918 try_to_del_timer_sync(&p
->timer
) >= 0)) {
919 mod_timer(&p
->timer
, time
);
922 mod_timer(&p
->query_timer
, now
);
929 spin_unlock(&br
->multicast_lock
);
932 static int br_multicast_ipv4_rcv(struct net_bridge
*br
,
933 struct net_bridge_port
*port
,
936 struct sk_buff
*skb2
= skb
;
943 BR_INPUT_SKB_CB(skb
)->igmp
= 0;
944 BR_INPUT_SKB_CB(skb
)->mrouters_only
= 0;
946 /* We treat OOM as packet loss for now. */
947 if (!pskb_may_pull(skb
, sizeof(*iph
)))
952 if (iph
->ihl
< 5 || iph
->version
!= 4)
955 if (!pskb_may_pull(skb
, ip_hdrlen(skb
)))
960 if (unlikely(ip_fast_csum((u8
*)iph
, iph
->ihl
)))
963 if (iph
->protocol
!= IPPROTO_IGMP
)
966 len
= ntohs(iph
->tot_len
);
967 if (skb
->len
< len
|| len
< ip_hdrlen(skb
))
970 if (skb
->len
> len
) {
971 skb2
= skb_clone(skb
, GFP_ATOMIC
);
975 err
= pskb_trim_rcsum(skb2
, len
);
980 len
-= ip_hdrlen(skb2
);
981 offset
= skb_network_offset(skb2
) + ip_hdrlen(skb2
);
982 __skb_pull(skb2
, offset
);
983 skb_reset_transport_header(skb2
);
986 if (!pskb_may_pull(skb2
, sizeof(*ih
)))
991 switch (skb2
->ip_summed
) {
992 case CHECKSUM_COMPLETE
:
993 if (!csum_fold(skb2
->csum
))
998 if (skb_checksum_complete(skb2
))
1004 BR_INPUT_SKB_CB(skb
)->igmp
= 1;
1005 ih
= igmp_hdr(skb2
);
1008 case IGMP_HOST_MEMBERSHIP_REPORT
:
1009 case IGMPV2_HOST_MEMBERSHIP_REPORT
:
1010 BR_INPUT_SKB_CB(skb2
)->mrouters_only
= 1;
1011 err
= br_multicast_add_group(br
, port
, ih
->group
);
1013 case IGMPV3_HOST_MEMBERSHIP_REPORT
:
1014 err
= br_multicast_igmp3_report(br
, port
, skb2
);
1016 case IGMP_HOST_MEMBERSHIP_QUERY
:
1017 err
= br_multicast_query(br
, port
, skb2
);
1019 case IGMP_HOST_LEAVE_MESSAGE
:
1020 br_multicast_leave_group(br
, port
, ih
->group
);
1025 __skb_push(skb2
, offset
);
1031 int br_multicast_rcv(struct net_bridge
*br
, struct net_bridge_port
*port
,
1032 struct sk_buff
*skb
)
1034 if (br
->multicast_disabled
)
1037 switch (skb
->protocol
) {
1038 case htons(ETH_P_IP
):
1039 return br_multicast_ipv4_rcv(br
, port
, skb
);
1045 static void br_multicast_query_expired(unsigned long data
)
1047 struct net_bridge
*br
= (void *)data
;
1049 spin_lock(&br
->multicast_lock
);
1050 if (br
->multicast_startup_queries_sent
<
1051 br
->multicast_startup_query_count
)
1052 br
->multicast_startup_queries_sent
++;
1054 br_multicast_send_query(br
, NULL
, br
->multicast_startup_queries_sent
);
1056 spin_unlock(&br
->multicast_lock
);
1059 void br_multicast_init(struct net_bridge
*br
)
1061 br
->hash_elasticity
= 4;
1064 br
->multicast_router
= 1;
1065 br
->multicast_last_member_count
= 2;
1066 br
->multicast_startup_query_count
= 2;
1068 br
->multicast_last_member_interval
= HZ
;
1069 br
->multicast_query_response_interval
= 10 * HZ
;
1070 br
->multicast_startup_query_interval
= 125 * HZ
/ 4;
1071 br
->multicast_query_interval
= 125 * HZ
;
1072 br
->multicast_querier_interval
= 255 * HZ
;
1073 br
->multicast_membership_interval
= 260 * HZ
;
1075 spin_lock_init(&br
->multicast_lock
);
1076 setup_timer(&br
->multicast_router_timer
,
1077 br_multicast_local_router_expired
, 0);
1078 setup_timer(&br
->multicast_querier_timer
,
1079 br_multicast_local_router_expired
, 0);
1080 setup_timer(&br
->multicast_query_timer
, br_multicast_query_expired
,
1084 void br_multicast_open(struct net_bridge
*br
)
1086 br
->multicast_startup_queries_sent
= 0;
1088 if (br
->multicast_disabled
)
1091 mod_timer(&br
->multicast_query_timer
, jiffies
);
1094 void br_multicast_stop(struct net_bridge
*br
)
1096 struct net_bridge_mdb_htable
*mdb
;
1097 struct net_bridge_mdb_entry
*mp
;
1098 struct hlist_node
*p
, *n
;
1102 del_timer_sync(&br
->multicast_router_timer
);
1103 del_timer_sync(&br
->multicast_querier_timer
);
1104 del_timer_sync(&br
->multicast_query_timer
);
1106 spin_lock_bh(&br
->multicast_lock
);
1114 for (i
= 0; i
< mdb
->max
; i
++) {
1115 hlist_for_each_entry_safe(mp
, p
, n
, &mdb
->mhash
[i
],
1117 del_timer(&mp
->timer
);
1118 del_timer(&mp
->query_timer
);
1119 call_rcu_bh(&mp
->rcu
, br_multicast_free_group
);
1124 spin_unlock_bh(&br
->multicast_lock
);
1125 synchronize_rcu_bh();
1126 spin_lock_bh(&br
->multicast_lock
);
1131 call_rcu_bh(&mdb
->rcu
, br_mdb_free
);
1134 spin_unlock_bh(&br
->multicast_lock
);