2 #include <linux/igmp.h>
3 #include <linux/kernel.h>
4 #include <linux/netdevice.h>
5 #include <linux/rculist.h>
6 #include <linux/skbuff.h>
7 #include <linux/if_ether.h>
9 #include <net/netlink.h>
10 #if IS_ENABLED(CONFIG_IPV6)
14 #include "br_private.h"
16 static int br_rports_fill_info(struct sk_buff
*skb
, struct netlink_callback
*cb
,
17 struct net_device
*dev
)
19 struct net_bridge
*br
= netdev_priv(dev
);
20 struct net_bridge_port
*p
;
24 if (!br
->multicast_router
|| hlist_empty(&br
->router_list
))
27 nest
= nla_nest_start(skb
, MDBA_ROUTER
);
31 hlist_for_each_entry_rcu(p
, n
, &br
->router_list
, rlist
) {
32 if (p
&& nla_put_u32(skb
, MDBA_ROUTER_PORT
, p
->dev
->ifindex
))
36 nla_nest_end(skb
, nest
);
39 nla_nest_cancel(skb
, nest
);
43 static int br_mdb_fill_info(struct sk_buff
*skb
, struct netlink_callback
*cb
,
44 struct net_device
*dev
)
46 struct net_bridge
*br
= netdev_priv(dev
);
47 struct net_bridge_mdb_htable
*mdb
;
48 struct nlattr
*nest
, *nest2
;
50 int idx
= 0, s_idx
= cb
->args
[1];
52 if (br
->multicast_disabled
)
55 mdb
= rcu_dereference(br
->mdb
);
59 nest
= nla_nest_start(skb
, MDBA_MDB
);
63 for (i
= 0; i
< mdb
->max
; i
++) {
65 struct net_bridge_mdb_entry
*mp
;
66 struct net_bridge_port_group
*p
, **pp
;
67 struct net_bridge_port
*port
;
69 hlist_for_each_entry_rcu(mp
, h
, &mdb
->mhash
[i
], hlist
[mdb
->ver
]) {
73 nest2
= nla_nest_start(skb
, MDBA_MDB_ENTRY
);
80 (p
= rcu_dereference(*pp
)) != NULL
;
84 struct br_mdb_entry e
;
85 e
.ifindex
= port
->dev
->ifindex
;
87 e
.addr
.u
.ip4
= p
->addr
.u
.ip4
;
88 #if IS_ENABLED(CONFIG_IPV6)
89 e
.addr
.u
.ip6
= p
->addr
.u
.ip6
;
91 e
.addr
.proto
= p
->addr
.proto
;
92 if (nla_put(skb
, MDBA_MDB_ENTRY_INFO
, sizeof(e
), &e
)) {
93 nla_nest_cancel(skb
, nest2
);
99 nla_nest_end(skb
, nest2
);
107 nla_nest_end(skb
, nest
);
111 static int br_mdb_dump(struct sk_buff
*skb
, struct netlink_callback
*cb
)
113 struct net_device
*dev
;
114 struct net
*net
= sock_net(skb
->sk
);
115 struct nlmsghdr
*nlh
= NULL
;
122 /* In theory this could be wrapped to 0... */
123 cb
->seq
= net
->dev_base_seq
+ br_mdb_rehash_seq
;
125 for_each_netdev_rcu(net
, dev
) {
126 if (dev
->priv_flags
& IFF_EBRIDGE
) {
127 struct br_port_msg
*bpm
;
132 nlh
= nlmsg_put(skb
, NETLINK_CB(cb
->skb
).portid
,
133 cb
->nlh
->nlmsg_seq
, RTM_GETMDB
,
134 sizeof(*bpm
), NLM_F_MULTI
);
138 bpm
= nlmsg_data(nlh
);
139 bpm
->ifindex
= dev
->ifindex
;
140 if (br_mdb_fill_info(skb
, cb
, dev
) < 0)
142 if (br_rports_fill_info(skb
, cb
, dev
) < 0)
160 static int nlmsg_populate_mdb_fill(struct sk_buff
*skb
,
161 struct net_device
*dev
,
162 struct br_mdb_entry
*entry
, u32 pid
,
163 u32 seq
, int type
, unsigned int flags
)
165 struct nlmsghdr
*nlh
;
166 struct br_port_msg
*bpm
;
167 struct nlattr
*nest
, *nest2
;
169 nlh
= nlmsg_put(skb
, pid
, seq
, type
, sizeof(*bpm
), NLM_F_MULTI
);
173 bpm
= nlmsg_data(nlh
);
174 bpm
->family
= AF_BRIDGE
;
175 bpm
->ifindex
= dev
->ifindex
;
176 nest
= nla_nest_start(skb
, MDBA_MDB
);
179 nest2
= nla_nest_start(skb
, MDBA_MDB_ENTRY
);
183 if (nla_put(skb
, MDBA_MDB_ENTRY_INFO
, sizeof(*entry
), entry
))
186 nla_nest_end(skb
, nest2
);
187 nla_nest_end(skb
, nest
);
188 return nlmsg_end(skb
, nlh
);
191 nla_nest_end(skb
, nest
);
193 nlmsg_cancel(skb
, nlh
);
197 static inline size_t rtnl_mdb_nlmsg_size(void)
199 return NLMSG_ALIGN(sizeof(struct br_port_msg
))
200 + nla_total_size(sizeof(struct br_mdb_entry
));
203 static void __br_mdb_notify(struct net_device
*dev
, struct br_mdb_entry
*entry
,
206 struct net
*net
= dev_net(dev
);
210 skb
= nlmsg_new(rtnl_mdb_nlmsg_size(), GFP_ATOMIC
);
214 err
= nlmsg_populate_mdb_fill(skb
, dev
, entry
, 0, 0, type
, NTF_SELF
);
220 rtnl_notify(skb
, net
, 0, RTNLGRP_MDB
, NULL
, GFP_ATOMIC
);
223 rtnl_set_sk_err(net
, RTNLGRP_MDB
, err
);
226 void br_mdb_notify(struct net_device
*dev
, struct net_bridge_port
*port
,
227 struct br_ip
*group
, int type
)
229 struct br_mdb_entry entry
;
231 entry
.ifindex
= port
->dev
->ifindex
;
232 entry
.addr
.proto
= group
->proto
;
233 entry
.addr
.u
.ip4
= group
->u
.ip4
;
234 #if IS_ENABLED(CONFIG_IPV6)
235 entry
.addr
.u
.ip6
= group
->u
.ip6
;
237 __br_mdb_notify(dev
, &entry
, type
);
240 static bool is_valid_mdb_entry(struct br_mdb_entry
*entry
)
242 if (entry
->ifindex
== 0)
245 if (entry
->addr
.proto
== htons(ETH_P_IP
)) {
246 if (!ipv4_is_multicast(entry
->addr
.u
.ip4
))
248 if (ipv4_is_local_multicast(entry
->addr
.u
.ip4
))
250 #if IS_ENABLED(CONFIG_IPV6)
251 } else if (entry
->addr
.proto
== htons(ETH_P_IPV6
)) {
252 if (!ipv6_is_transient_multicast(&entry
->addr
.u
.ip6
))
257 if (entry
->state
!= MDB_PERMANENT
&& entry
->state
!= MDB_TEMPORARY
)
263 static int br_mdb_parse(struct sk_buff
*skb
, struct nlmsghdr
*nlh
,
264 struct net_device
**pdev
, struct br_mdb_entry
**pentry
)
266 struct net
*net
= sock_net(skb
->sk
);
267 struct br_mdb_entry
*entry
;
268 struct br_port_msg
*bpm
;
269 struct nlattr
*tb
[MDBA_SET_ENTRY_MAX
+1];
270 struct net_device
*dev
;
273 if (!capable(CAP_NET_ADMIN
))
276 err
= nlmsg_parse(nlh
, sizeof(*bpm
), tb
, MDBA_SET_ENTRY
, NULL
);
280 bpm
= nlmsg_data(nlh
);
281 if (bpm
->ifindex
== 0) {
282 pr_info("PF_BRIDGE: br_mdb_parse() with invalid ifindex\n");
286 dev
= __dev_get_by_index(net
, bpm
->ifindex
);
288 pr_info("PF_BRIDGE: br_mdb_parse() with unknown ifindex\n");
292 if (!(dev
->priv_flags
& IFF_EBRIDGE
)) {
293 pr_info("PF_BRIDGE: br_mdb_parse() with non-bridge\n");
299 if (!tb
[MDBA_SET_ENTRY
] ||
300 nla_len(tb
[MDBA_SET_ENTRY
]) != sizeof(struct br_mdb_entry
)) {
301 pr_info("PF_BRIDGE: br_mdb_parse() with invalid attr\n");
305 entry
= nla_data(tb
[MDBA_SET_ENTRY
]);
306 if (!is_valid_mdb_entry(entry
)) {
307 pr_info("PF_BRIDGE: br_mdb_parse() with invalid entry\n");
315 static int br_mdb_add_group(struct net_bridge
*br
, struct net_bridge_port
*port
,
316 struct br_ip
*group
, unsigned char state
)
318 struct net_bridge_mdb_entry
*mp
;
319 struct net_bridge_port_group
*p
;
320 struct net_bridge_port_group __rcu
**pp
;
321 struct net_bridge_mdb_htable
*mdb
;
324 mdb
= mlock_dereference(br
->mdb
, br
);
325 mp
= br_mdb_ip_get(mdb
, group
);
327 mp
= br_multicast_new_group(br
, port
, group
);
333 for (pp
= &mp
->ports
;
334 (p
= mlock_dereference(*pp
, br
)) != NULL
;
338 if ((unsigned long)p
->port
< (unsigned long)port
)
342 p
= br_multicast_new_port_group(port
, group
, *pp
, state
);
345 rcu_assign_pointer(*pp
, p
);
347 br_mdb_notify(br
->dev
, port
, group
, RTM_NEWMDB
);
351 static int __br_mdb_add(struct net
*net
, struct net_bridge
*br
,
352 struct br_mdb_entry
*entry
)
355 struct net_device
*dev
;
356 struct net_bridge_port
*p
;
359 if (!netif_running(br
->dev
) || br
->multicast_disabled
)
362 dev
= __dev_get_by_index(net
, entry
->ifindex
);
366 p
= br_port_get_rtnl(dev
);
367 if (!p
|| p
->br
!= br
|| p
->state
== BR_STATE_DISABLED
)
370 ip
.proto
= entry
->addr
.proto
;
371 if (ip
.proto
== htons(ETH_P_IP
))
372 ip
.u
.ip4
= entry
->addr
.u
.ip4
;
373 #if IS_ENABLED(CONFIG_IPV6)
375 ip
.u
.ip6
= entry
->addr
.u
.ip6
;
378 spin_lock_bh(&br
->multicast_lock
);
379 ret
= br_mdb_add_group(br
, p
, &ip
, entry
->state
);
380 spin_unlock_bh(&br
->multicast_lock
);
384 static int br_mdb_add(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void *arg
)
386 struct net
*net
= sock_net(skb
->sk
);
387 struct br_mdb_entry
*entry
;
388 struct net_device
*dev
;
389 struct net_bridge
*br
;
392 err
= br_mdb_parse(skb
, nlh
, &dev
, &entry
);
396 br
= netdev_priv(dev
);
398 err
= __br_mdb_add(net
, br
, entry
);
400 __br_mdb_notify(dev
, entry
, RTM_NEWMDB
);
404 static int __br_mdb_del(struct net_bridge
*br
, struct br_mdb_entry
*entry
)
406 struct net_bridge_mdb_htable
*mdb
;
407 struct net_bridge_mdb_entry
*mp
;
408 struct net_bridge_port_group
*p
;
409 struct net_bridge_port_group __rcu
**pp
;
413 if (!netif_running(br
->dev
) || br
->multicast_disabled
)
416 if (timer_pending(&br
->multicast_querier_timer
))
419 ip
.proto
= entry
->addr
.proto
;
420 if (ip
.proto
== htons(ETH_P_IP
))
421 ip
.u
.ip4
= entry
->addr
.u
.ip4
;
422 #if IS_ENABLED(CONFIG_IPV6)
424 ip
.u
.ip6
= entry
->addr
.u
.ip6
;
427 spin_lock_bh(&br
->multicast_lock
);
428 mdb
= mlock_dereference(br
->mdb
, br
);
430 mp
= br_mdb_ip_get(mdb
, &ip
);
434 for (pp
= &mp
->ports
;
435 (p
= mlock_dereference(*pp
, br
)) != NULL
;
437 if (!p
->port
|| p
->port
->dev
->ifindex
!= entry
->ifindex
)
440 if (p
->port
->state
== BR_STATE_DISABLED
)
443 rcu_assign_pointer(*pp
, p
->next
);
444 hlist_del_init(&p
->mglist
);
445 del_timer(&p
->timer
);
446 call_rcu_bh(&p
->rcu
, br_multicast_free_pg
);
449 if (!mp
->ports
&& !mp
->mglist
&&
450 netif_running(br
->dev
))
451 mod_timer(&mp
->timer
, jiffies
);
456 spin_unlock_bh(&br
->multicast_lock
);
460 static int br_mdb_del(struct sk_buff
*skb
, struct nlmsghdr
*nlh
, void *arg
)
462 struct net_device
*dev
;
463 struct br_mdb_entry
*entry
;
464 struct net_bridge
*br
;
467 err
= br_mdb_parse(skb
, nlh
, &dev
, &entry
);
471 br
= netdev_priv(dev
);
473 err
= __br_mdb_del(br
, entry
);
475 __br_mdb_notify(dev
, entry
, RTM_DELMDB
);
479 void br_mdb_init(void)
481 rtnl_register(PF_BRIDGE
, RTM_GETMDB
, NULL
, br_mdb_dump
, NULL
);
482 rtnl_register(PF_BRIDGE
, RTM_NEWMDB
, br_mdb_add
, NULL
, NULL
);
483 rtnl_register(PF_BRIDGE
, RTM_DELMDB
, br_mdb_del
, NULL
, NULL
);
486 void br_mdb_uninit(void)
488 rtnl_unregister(PF_BRIDGE
, RTM_GETMDB
);
489 rtnl_unregister(PF_BRIDGE
, RTM_NEWMDB
);
490 rtnl_unregister(PF_BRIDGE
, RTM_DELMDB
);