xref: /linux/net/ipv4/ipmr.c (revision 55747a0a73ea74a25fcebb0731e8d3f13fe8c09d)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  *	IP multicast routing support for mrouted 3.6/3.8
31da177e4SLinus Torvalds  *
4113aa838SAlan Cox  *		(c) 1995 Alan Cox, <alan@lxorguk.ukuu.org.uk>
51da177e4SLinus Torvalds  *	  Linux Consultancy and Custom Driver Development
61da177e4SLinus Torvalds  *
71da177e4SLinus Torvalds  *	This program is free software; you can redistribute it and/or
81da177e4SLinus Torvalds  *	modify it under the terms of the GNU General Public License
91da177e4SLinus Torvalds  *	as published by the Free Software Foundation; either version
101da177e4SLinus Torvalds  *	2 of the License, or (at your option) any later version.
111da177e4SLinus Torvalds  *
121da177e4SLinus Torvalds  *	Fixes:
131da177e4SLinus Torvalds  *	Michael Chastain	:	Incorrect size of copying.
141da177e4SLinus Torvalds  *	Alan Cox		:	Added the cache manager code
151da177e4SLinus Torvalds  *	Alan Cox		:	Fixed the clone/copy bug and device race.
161da177e4SLinus Torvalds  *	Mike McLagan		:	Routing by source
171da177e4SLinus Torvalds  *	Malcolm Beattie		:	Buffer handling fixes.
181da177e4SLinus Torvalds  *	Alexey Kuznetsov	:	Double buffer free and other fixes.
191da177e4SLinus Torvalds  *	SVR Anand		:	Fixed several multicast bugs and problems.
201da177e4SLinus Torvalds  *	Alexey Kuznetsov	:	Status, optimisations and more.
211da177e4SLinus Torvalds  *	Brad Parker		:	Better behaviour on mrouted upcall
221da177e4SLinus Torvalds  *					overflow.
231da177e4SLinus Torvalds  *      Carlos Picoto           :       PIMv1 Support
241da177e4SLinus Torvalds  *	Pavlin Ivanov Radoslavov:	PIMv2 Registers must checksum only PIM header
25f77f13e2SGilles Espinasse  *					Relax this requirement to work with older peers.
261da177e4SLinus Torvalds  *
271da177e4SLinus Torvalds  */
281da177e4SLinus Torvalds 
291da177e4SLinus Torvalds #include <asm/system.h>
301da177e4SLinus Torvalds #include <asm/uaccess.h>
311da177e4SLinus Torvalds #include <linux/types.h>
324fc268d2SRandy Dunlap #include <linux/capability.h>
331da177e4SLinus Torvalds #include <linux/errno.h>
341da177e4SLinus Torvalds #include <linux/timer.h>
351da177e4SLinus Torvalds #include <linux/mm.h>
361da177e4SLinus Torvalds #include <linux/kernel.h>
371da177e4SLinus Torvalds #include <linux/fcntl.h>
381da177e4SLinus Torvalds #include <linux/stat.h>
391da177e4SLinus Torvalds #include <linux/socket.h>
401da177e4SLinus Torvalds #include <linux/in.h>
411da177e4SLinus Torvalds #include <linux/inet.h>
421da177e4SLinus Torvalds #include <linux/netdevice.h>
431da177e4SLinus Torvalds #include <linux/inetdevice.h>
441da177e4SLinus Torvalds #include <linux/igmp.h>
451da177e4SLinus Torvalds #include <linux/proc_fs.h>
461da177e4SLinus Torvalds #include <linux/seq_file.h>
471da177e4SLinus Torvalds #include <linux/mroute.h>
481da177e4SLinus Torvalds #include <linux/init.h>
4946f25dffSKris Katterjohn #include <linux/if_ether.h>
505a0e3ad6STejun Heo #include <linux/slab.h>
51457c4cbcSEric W. Biederman #include <net/net_namespace.h>
521da177e4SLinus Torvalds #include <net/ip.h>
531da177e4SLinus Torvalds #include <net/protocol.h>
541da177e4SLinus Torvalds #include <linux/skbuff.h>
5514c85021SArnaldo Carvalho de Melo #include <net/route.h>
561da177e4SLinus Torvalds #include <net/sock.h>
571da177e4SLinus Torvalds #include <net/icmp.h>
581da177e4SLinus Torvalds #include <net/udp.h>
591da177e4SLinus Torvalds #include <net/raw.h>
601da177e4SLinus Torvalds #include <linux/notifier.h>
611da177e4SLinus Torvalds #include <linux/if_arp.h>
621da177e4SLinus Torvalds #include <linux/netfilter_ipv4.h>
631da177e4SLinus Torvalds #include <net/ipip.h>
641da177e4SLinus Torvalds #include <net/checksum.h>
65dc5fc579SArnaldo Carvalho de Melo #include <net/netlink.h>
66f0ad0860SPatrick McHardy #include <net/fib_rules.h>
671da177e4SLinus Torvalds 
681da177e4SLinus Torvalds #if defined(CONFIG_IP_PIMSM_V1) || defined(CONFIG_IP_PIMSM_V2)
691da177e4SLinus Torvalds #define CONFIG_IP_PIMSM	1
701da177e4SLinus Torvalds #endif
711da177e4SLinus Torvalds 
720c12295aSPatrick McHardy struct mr_table {
73f0ad0860SPatrick McHardy 	struct list_head	list;
748de53dfbSPatrick McHardy #ifdef CONFIG_NET_NS
758de53dfbSPatrick McHardy 	struct net		*net;
768de53dfbSPatrick McHardy #endif
77f0ad0860SPatrick McHardy 	u32			id;
780c12295aSPatrick McHardy 	struct sock		*mroute_sk;
790c12295aSPatrick McHardy 	struct timer_list	ipmr_expire_timer;
800c12295aSPatrick McHardy 	struct list_head	mfc_unres_queue;
810c12295aSPatrick McHardy 	struct list_head	mfc_cache_array[MFC_LINES];
820c12295aSPatrick McHardy 	struct vif_device	vif_table[MAXVIFS];
830c12295aSPatrick McHardy 	int			maxvif;
840c12295aSPatrick McHardy 	atomic_t		cache_resolve_queue_len;
850c12295aSPatrick McHardy 	int			mroute_do_assert;
860c12295aSPatrick McHardy 	int			mroute_do_pim;
870c12295aSPatrick McHardy #if defined(CONFIG_IP_PIMSM_V1) || defined(CONFIG_IP_PIMSM_V2)
880c12295aSPatrick McHardy 	int			mroute_reg_vif_num;
890c12295aSPatrick McHardy #endif
900c12295aSPatrick McHardy };
910c12295aSPatrick McHardy 
92f0ad0860SPatrick McHardy struct ipmr_rule {
93f0ad0860SPatrick McHardy 	struct fib_rule		common;
94f0ad0860SPatrick McHardy };
95f0ad0860SPatrick McHardy 
96f0ad0860SPatrick McHardy struct ipmr_result {
97f0ad0860SPatrick McHardy 	struct mr_table		*mrt;
98f0ad0860SPatrick McHardy };
99f0ad0860SPatrick McHardy 
1001da177e4SLinus Torvalds /* Big lock, protecting vif table, mrt cache and mroute socket state.
1011da177e4SLinus Torvalds    Note that the changes are semaphored via rtnl_lock.
1021da177e4SLinus Torvalds  */
1031da177e4SLinus Torvalds 
1041da177e4SLinus Torvalds static DEFINE_RWLOCK(mrt_lock);
1051da177e4SLinus Torvalds 
1061da177e4SLinus Torvalds /*
1071da177e4SLinus Torvalds  *	Multicast router control variables
1081da177e4SLinus Torvalds  */
1091da177e4SLinus Torvalds 
1100c12295aSPatrick McHardy #define VIF_EXISTS(_mrt, _idx) ((_mrt)->vif_table[_idx].dev != NULL)
1111da177e4SLinus Torvalds 
1121da177e4SLinus Torvalds /* Special spinlock for queue of unresolved entries */
1131da177e4SLinus Torvalds static DEFINE_SPINLOCK(mfc_unres_lock);
1141da177e4SLinus Torvalds 
1151da177e4SLinus Torvalds /* We return to original Alan's scheme. Hash table of resolved
1161da177e4SLinus Torvalds    entries is changed only in process context and protected
1171da177e4SLinus Torvalds    with weak lock mrt_lock. Queue of unresolved entries is protected
1181da177e4SLinus Torvalds    with strong spinlock mfc_unres_lock.
1191da177e4SLinus Torvalds 
1201da177e4SLinus Torvalds    In this case data path is free of exclusive locks at all.
1211da177e4SLinus Torvalds  */
1221da177e4SLinus Torvalds 
123e18b890bSChristoph Lameter static struct kmem_cache *mrt_cachep __read_mostly;
1241da177e4SLinus Torvalds 
125f0ad0860SPatrick McHardy static struct mr_table *ipmr_new_table(struct net *net, u32 id);
1260c12295aSPatrick McHardy static int ip_mr_forward(struct net *net, struct mr_table *mrt,
1270c12295aSPatrick McHardy 			 struct sk_buff *skb, struct mfc_cache *cache,
1280c12295aSPatrick McHardy 			 int local);
1290c12295aSPatrick McHardy static int ipmr_cache_report(struct mr_table *mrt,
1304feb88e5SBenjamin Thery 			     struct sk_buff *pkt, vifi_t vifi, int assert);
131cb6a4e46SPatrick McHardy static int __ipmr_fill_mroute(struct mr_table *mrt, struct sk_buff *skb,
132d658f8a0SPatrick McHardy 			      struct mfc_cache *c, struct rtmsg *rtm);
133f0ad0860SPatrick McHardy static void ipmr_expire_process(unsigned long arg);
1341da177e4SLinus Torvalds 
135f0ad0860SPatrick McHardy #ifdef CONFIG_IP_MROUTE_MULTIPLE_TABLES
136f0ad0860SPatrick McHardy #define ipmr_for_each_table(mrt, net) \
137f0ad0860SPatrick McHardy 	list_for_each_entry_rcu(mrt, &net->ipv4.mr_tables, list)
138f0ad0860SPatrick McHardy 
139f0ad0860SPatrick McHardy static struct mr_table *ipmr_get_table(struct net *net, u32 id)
140f0ad0860SPatrick McHardy {
141f0ad0860SPatrick McHardy 	struct mr_table *mrt;
142f0ad0860SPatrick McHardy 
143f0ad0860SPatrick McHardy 	ipmr_for_each_table(mrt, net) {
144f0ad0860SPatrick McHardy 		if (mrt->id == id)
145f0ad0860SPatrick McHardy 			return mrt;
146f0ad0860SPatrick McHardy 	}
147f0ad0860SPatrick McHardy 	return NULL;
148f0ad0860SPatrick McHardy }
149f0ad0860SPatrick McHardy 
150f0ad0860SPatrick McHardy static int ipmr_fib_lookup(struct net *net, struct flowi *flp,
151f0ad0860SPatrick McHardy 			   struct mr_table **mrt)
152f0ad0860SPatrick McHardy {
153f0ad0860SPatrick McHardy 	struct ipmr_result res;
154f0ad0860SPatrick McHardy 	struct fib_lookup_arg arg = { .result = &res, };
155f0ad0860SPatrick McHardy 	int err;
156f0ad0860SPatrick McHardy 
157f0ad0860SPatrick McHardy 	err = fib_rules_lookup(net->ipv4.mr_rules_ops, flp, 0, &arg);
158f0ad0860SPatrick McHardy 	if (err < 0)
159f0ad0860SPatrick McHardy 		return err;
160f0ad0860SPatrick McHardy 	*mrt = res.mrt;
161f0ad0860SPatrick McHardy 	return 0;
162f0ad0860SPatrick McHardy }
163f0ad0860SPatrick McHardy 
164f0ad0860SPatrick McHardy static int ipmr_rule_action(struct fib_rule *rule, struct flowi *flp,
165f0ad0860SPatrick McHardy 			    int flags, struct fib_lookup_arg *arg)
166f0ad0860SPatrick McHardy {
167f0ad0860SPatrick McHardy 	struct ipmr_result *res = arg->result;
168f0ad0860SPatrick McHardy 	struct mr_table *mrt;
169f0ad0860SPatrick McHardy 
170f0ad0860SPatrick McHardy 	switch (rule->action) {
171f0ad0860SPatrick McHardy 	case FR_ACT_TO_TBL:
172f0ad0860SPatrick McHardy 		break;
173f0ad0860SPatrick McHardy 	case FR_ACT_UNREACHABLE:
174f0ad0860SPatrick McHardy 		return -ENETUNREACH;
175f0ad0860SPatrick McHardy 	case FR_ACT_PROHIBIT:
176f0ad0860SPatrick McHardy 		return -EACCES;
177f0ad0860SPatrick McHardy 	case FR_ACT_BLACKHOLE:
178f0ad0860SPatrick McHardy 	default:
179f0ad0860SPatrick McHardy 		return -EINVAL;
180f0ad0860SPatrick McHardy 	}
181f0ad0860SPatrick McHardy 
182f0ad0860SPatrick McHardy 	mrt = ipmr_get_table(rule->fr_net, rule->table);
183f0ad0860SPatrick McHardy 	if (mrt == NULL)
184f0ad0860SPatrick McHardy 		return -EAGAIN;
185f0ad0860SPatrick McHardy 	res->mrt = mrt;
186f0ad0860SPatrick McHardy 	return 0;
187f0ad0860SPatrick McHardy }
188f0ad0860SPatrick McHardy 
189f0ad0860SPatrick McHardy static int ipmr_rule_match(struct fib_rule *rule, struct flowi *fl, int flags)
190f0ad0860SPatrick McHardy {
191f0ad0860SPatrick McHardy 	return 1;
192f0ad0860SPatrick McHardy }
193f0ad0860SPatrick McHardy 
194f0ad0860SPatrick McHardy static const struct nla_policy ipmr_rule_policy[FRA_MAX + 1] = {
195f0ad0860SPatrick McHardy 	FRA_GENERIC_POLICY,
196f0ad0860SPatrick McHardy };
197f0ad0860SPatrick McHardy 
198f0ad0860SPatrick McHardy static int ipmr_rule_configure(struct fib_rule *rule, struct sk_buff *skb,
199f0ad0860SPatrick McHardy 			       struct fib_rule_hdr *frh, struct nlattr **tb)
200f0ad0860SPatrick McHardy {
201f0ad0860SPatrick McHardy 	return 0;
202f0ad0860SPatrick McHardy }
203f0ad0860SPatrick McHardy 
204f0ad0860SPatrick McHardy static int ipmr_rule_compare(struct fib_rule *rule, struct fib_rule_hdr *frh,
205f0ad0860SPatrick McHardy 			     struct nlattr **tb)
206f0ad0860SPatrick McHardy {
207f0ad0860SPatrick McHardy 	return 1;
208f0ad0860SPatrick McHardy }
209f0ad0860SPatrick McHardy 
210f0ad0860SPatrick McHardy static int ipmr_rule_fill(struct fib_rule *rule, struct sk_buff *skb,
211f0ad0860SPatrick McHardy 			  struct fib_rule_hdr *frh)
212f0ad0860SPatrick McHardy {
213f0ad0860SPatrick McHardy 	frh->dst_len = 0;
214f0ad0860SPatrick McHardy 	frh->src_len = 0;
215f0ad0860SPatrick McHardy 	frh->tos     = 0;
216f0ad0860SPatrick McHardy 	return 0;
217f0ad0860SPatrick McHardy }
218f0ad0860SPatrick McHardy 
2193d0c9c4eSPatrick McHardy static const struct fib_rules_ops __net_initdata ipmr_rules_ops_template = {
22025239ceeSPatrick McHardy 	.family		= RTNL_FAMILY_IPMR,
221f0ad0860SPatrick McHardy 	.rule_size	= sizeof(struct ipmr_rule),
222f0ad0860SPatrick McHardy 	.addr_size	= sizeof(u32),
223f0ad0860SPatrick McHardy 	.action		= ipmr_rule_action,
224f0ad0860SPatrick McHardy 	.match		= ipmr_rule_match,
225f0ad0860SPatrick McHardy 	.configure	= ipmr_rule_configure,
226f0ad0860SPatrick McHardy 	.compare	= ipmr_rule_compare,
227f0ad0860SPatrick McHardy 	.default_pref	= fib_default_rule_pref,
228f0ad0860SPatrick McHardy 	.fill		= ipmr_rule_fill,
229f0ad0860SPatrick McHardy 	.nlgroup	= RTNLGRP_IPV4_RULE,
230f0ad0860SPatrick McHardy 	.policy		= ipmr_rule_policy,
231f0ad0860SPatrick McHardy 	.owner		= THIS_MODULE,
232f0ad0860SPatrick McHardy };
233f0ad0860SPatrick McHardy 
234f0ad0860SPatrick McHardy static int __net_init ipmr_rules_init(struct net *net)
235f0ad0860SPatrick McHardy {
236f0ad0860SPatrick McHardy 	struct fib_rules_ops *ops;
237f0ad0860SPatrick McHardy 	struct mr_table *mrt;
238f0ad0860SPatrick McHardy 	int err;
239f0ad0860SPatrick McHardy 
240f0ad0860SPatrick McHardy 	ops = fib_rules_register(&ipmr_rules_ops_template, net);
241f0ad0860SPatrick McHardy 	if (IS_ERR(ops))
242f0ad0860SPatrick McHardy 		return PTR_ERR(ops);
243f0ad0860SPatrick McHardy 
244f0ad0860SPatrick McHardy 	INIT_LIST_HEAD(&net->ipv4.mr_tables);
245f0ad0860SPatrick McHardy 
246f0ad0860SPatrick McHardy 	mrt = ipmr_new_table(net, RT_TABLE_DEFAULT);
247f0ad0860SPatrick McHardy 	if (mrt == NULL) {
248f0ad0860SPatrick McHardy 		err = -ENOMEM;
249f0ad0860SPatrick McHardy 		goto err1;
250f0ad0860SPatrick McHardy 	}
251f0ad0860SPatrick McHardy 
252f0ad0860SPatrick McHardy 	err = fib_default_rule_add(ops, 0x7fff, RT_TABLE_DEFAULT, 0);
253f0ad0860SPatrick McHardy 	if (err < 0)
254f0ad0860SPatrick McHardy 		goto err2;
255f0ad0860SPatrick McHardy 
256f0ad0860SPatrick McHardy 	net->ipv4.mr_rules_ops = ops;
257f0ad0860SPatrick McHardy 	return 0;
258f0ad0860SPatrick McHardy 
259f0ad0860SPatrick McHardy err2:
260f0ad0860SPatrick McHardy 	kfree(mrt);
261f0ad0860SPatrick McHardy err1:
262f0ad0860SPatrick McHardy 	fib_rules_unregister(ops);
263f0ad0860SPatrick McHardy 	return err;
264f0ad0860SPatrick McHardy }
265f0ad0860SPatrick McHardy 
266f0ad0860SPatrick McHardy static void __net_exit ipmr_rules_exit(struct net *net)
267f0ad0860SPatrick McHardy {
268f0ad0860SPatrick McHardy 	struct mr_table *mrt, *next;
269f0ad0860SPatrick McHardy 
270035320d5SEric Dumazet 	list_for_each_entry_safe(mrt, next, &net->ipv4.mr_tables, list) {
271035320d5SEric Dumazet 		list_del(&mrt->list);
272f0ad0860SPatrick McHardy 		kfree(mrt);
273035320d5SEric Dumazet 	}
274f0ad0860SPatrick McHardy 	fib_rules_unregister(net->ipv4.mr_rules_ops);
275f0ad0860SPatrick McHardy }
276f0ad0860SPatrick McHardy #else
277f0ad0860SPatrick McHardy #define ipmr_for_each_table(mrt, net) \
278f0ad0860SPatrick McHardy 	for (mrt = net->ipv4.mrt; mrt; mrt = NULL)
279f0ad0860SPatrick McHardy 
280f0ad0860SPatrick McHardy static struct mr_table *ipmr_get_table(struct net *net, u32 id)
281f0ad0860SPatrick McHardy {
282f0ad0860SPatrick McHardy 	return net->ipv4.mrt;
283f0ad0860SPatrick McHardy }
284f0ad0860SPatrick McHardy 
285f0ad0860SPatrick McHardy static int ipmr_fib_lookup(struct net *net, struct flowi *flp,
286f0ad0860SPatrick McHardy 			   struct mr_table **mrt)
287f0ad0860SPatrick McHardy {
288f0ad0860SPatrick McHardy 	*mrt = net->ipv4.mrt;
289f0ad0860SPatrick McHardy 	return 0;
290f0ad0860SPatrick McHardy }
291f0ad0860SPatrick McHardy 
292f0ad0860SPatrick McHardy static int __net_init ipmr_rules_init(struct net *net)
293f0ad0860SPatrick McHardy {
294f0ad0860SPatrick McHardy 	net->ipv4.mrt = ipmr_new_table(net, RT_TABLE_DEFAULT);
295f0ad0860SPatrick McHardy 	return net->ipv4.mrt ? 0 : -ENOMEM;
296f0ad0860SPatrick McHardy }
297f0ad0860SPatrick McHardy 
298f0ad0860SPatrick McHardy static void __net_exit ipmr_rules_exit(struct net *net)
299f0ad0860SPatrick McHardy {
300f0ad0860SPatrick McHardy 	kfree(net->ipv4.mrt);
301f0ad0860SPatrick McHardy }
302f0ad0860SPatrick McHardy #endif
303f0ad0860SPatrick McHardy 
304f0ad0860SPatrick McHardy static struct mr_table *ipmr_new_table(struct net *net, u32 id)
305f0ad0860SPatrick McHardy {
306f0ad0860SPatrick McHardy 	struct mr_table *mrt;
307f0ad0860SPatrick McHardy 	unsigned int i;
308f0ad0860SPatrick McHardy 
309f0ad0860SPatrick McHardy 	mrt = ipmr_get_table(net, id);
310f0ad0860SPatrick McHardy 	if (mrt != NULL)
311f0ad0860SPatrick McHardy 		return mrt;
312f0ad0860SPatrick McHardy 
313f0ad0860SPatrick McHardy 	mrt = kzalloc(sizeof(*mrt), GFP_KERNEL);
314f0ad0860SPatrick McHardy 	if (mrt == NULL)
315f0ad0860SPatrick McHardy 		return NULL;
3168de53dfbSPatrick McHardy 	write_pnet(&mrt->net, net);
317f0ad0860SPatrick McHardy 	mrt->id = id;
318f0ad0860SPatrick McHardy 
319f0ad0860SPatrick McHardy 	/* Forwarding cache */
320f0ad0860SPatrick McHardy 	for (i = 0; i < MFC_LINES; i++)
321f0ad0860SPatrick McHardy 		INIT_LIST_HEAD(&mrt->mfc_cache_array[i]);
322f0ad0860SPatrick McHardy 
323f0ad0860SPatrick McHardy 	INIT_LIST_HEAD(&mrt->mfc_unres_queue);
324f0ad0860SPatrick McHardy 
325f0ad0860SPatrick McHardy 	setup_timer(&mrt->ipmr_expire_timer, ipmr_expire_process,
326f0ad0860SPatrick McHardy 		    (unsigned long)mrt);
327f0ad0860SPatrick McHardy 
328f0ad0860SPatrick McHardy #ifdef CONFIG_IP_PIMSM
329f0ad0860SPatrick McHardy 	mrt->mroute_reg_vif_num = -1;
330f0ad0860SPatrick McHardy #endif
331f0ad0860SPatrick McHardy #ifdef CONFIG_IP_MROUTE_MULTIPLE_TABLES
332f0ad0860SPatrick McHardy 	list_add_tail_rcu(&mrt->list, &net->ipv4.mr_tables);
333f0ad0860SPatrick McHardy #endif
334f0ad0860SPatrick McHardy 	return mrt;
335f0ad0860SPatrick McHardy }
3361da177e4SLinus Torvalds 
3371da177e4SLinus Torvalds /* Service routines creating virtual interfaces: DVMRP tunnels and PIMREG */
3381da177e4SLinus Torvalds 
339d607032dSWang Chen static void ipmr_del_tunnel(struct net_device *dev, struct vifctl *v)
340d607032dSWang Chen {
3414feb88e5SBenjamin Thery 	struct net *net = dev_net(dev);
3424feb88e5SBenjamin Thery 
343d607032dSWang Chen 	dev_close(dev);
344d607032dSWang Chen 
3454feb88e5SBenjamin Thery 	dev = __dev_get_by_name(net, "tunl0");
346d607032dSWang Chen 	if (dev) {
3475bc3eb7eSStephen Hemminger 		const struct net_device_ops *ops = dev->netdev_ops;
348d607032dSWang Chen 		struct ifreq ifr;
349d607032dSWang Chen 		struct ip_tunnel_parm p;
350d607032dSWang Chen 
351d607032dSWang Chen 		memset(&p, 0, sizeof(p));
352d607032dSWang Chen 		p.iph.daddr = v->vifc_rmt_addr.s_addr;
353d607032dSWang Chen 		p.iph.saddr = v->vifc_lcl_addr.s_addr;
354d607032dSWang Chen 		p.iph.version = 4;
355d607032dSWang Chen 		p.iph.ihl = 5;
356d607032dSWang Chen 		p.iph.protocol = IPPROTO_IPIP;
357d607032dSWang Chen 		sprintf(p.name, "dvmrp%d", v->vifc_vifi);
358d607032dSWang Chen 		ifr.ifr_ifru.ifru_data = (__force void __user *)&p;
359d607032dSWang Chen 
3605bc3eb7eSStephen Hemminger 		if (ops->ndo_do_ioctl) {
3615bc3eb7eSStephen Hemminger 			mm_segment_t oldfs = get_fs();
3625bc3eb7eSStephen Hemminger 
3635bc3eb7eSStephen Hemminger 			set_fs(KERNEL_DS);
3645bc3eb7eSStephen Hemminger 			ops->ndo_do_ioctl(dev, &ifr, SIOCDELTUNNEL);
365d607032dSWang Chen 			set_fs(oldfs);
366d607032dSWang Chen 		}
367d607032dSWang Chen 	}
3685bc3eb7eSStephen Hemminger }
369d607032dSWang Chen 
3701da177e4SLinus Torvalds static
3714feb88e5SBenjamin Thery struct net_device *ipmr_new_tunnel(struct net *net, struct vifctl *v)
3721da177e4SLinus Torvalds {
3731da177e4SLinus Torvalds 	struct net_device  *dev;
3741da177e4SLinus Torvalds 
3754feb88e5SBenjamin Thery 	dev = __dev_get_by_name(net, "tunl0");
3761da177e4SLinus Torvalds 
3771da177e4SLinus Torvalds 	if (dev) {
3785bc3eb7eSStephen Hemminger 		const struct net_device_ops *ops = dev->netdev_ops;
3791da177e4SLinus Torvalds 		int err;
3801da177e4SLinus Torvalds 		struct ifreq ifr;
3811da177e4SLinus Torvalds 		struct ip_tunnel_parm p;
3821da177e4SLinus Torvalds 		struct in_device  *in_dev;
3831da177e4SLinus Torvalds 
3841da177e4SLinus Torvalds 		memset(&p, 0, sizeof(p));
3851da177e4SLinus Torvalds 		p.iph.daddr = v->vifc_rmt_addr.s_addr;
3861da177e4SLinus Torvalds 		p.iph.saddr = v->vifc_lcl_addr.s_addr;
3871da177e4SLinus Torvalds 		p.iph.version = 4;
3881da177e4SLinus Torvalds 		p.iph.ihl = 5;
3891da177e4SLinus Torvalds 		p.iph.protocol = IPPROTO_IPIP;
3901da177e4SLinus Torvalds 		sprintf(p.name, "dvmrp%d", v->vifc_vifi);
391ba93ef74SStephen Hemminger 		ifr.ifr_ifru.ifru_data = (__force void __user *)&p;
3921da177e4SLinus Torvalds 
3935bc3eb7eSStephen Hemminger 		if (ops->ndo_do_ioctl) {
3945bc3eb7eSStephen Hemminger 			mm_segment_t oldfs = get_fs();
3955bc3eb7eSStephen Hemminger 
3965bc3eb7eSStephen Hemminger 			set_fs(KERNEL_DS);
3975bc3eb7eSStephen Hemminger 			err = ops->ndo_do_ioctl(dev, &ifr, SIOCADDTUNNEL);
3981da177e4SLinus Torvalds 			set_fs(oldfs);
3995bc3eb7eSStephen Hemminger 		} else
4005bc3eb7eSStephen Hemminger 			err = -EOPNOTSUPP;
4011da177e4SLinus Torvalds 
4021da177e4SLinus Torvalds 		dev = NULL;
4031da177e4SLinus Torvalds 
4044feb88e5SBenjamin Thery 		if (err == 0 &&
4054feb88e5SBenjamin Thery 		    (dev = __dev_get_by_name(net, p.name)) != NULL) {
4061da177e4SLinus Torvalds 			dev->flags |= IFF_MULTICAST;
4071da177e4SLinus Torvalds 
408e5ed6399SHerbert Xu 			in_dev = __in_dev_get_rtnl(dev);
40971e27da9SHerbert Xu 			if (in_dev == NULL)
4101da177e4SLinus Torvalds 				goto failure;
41171e27da9SHerbert Xu 
41271e27da9SHerbert Xu 			ipv4_devconf_setall(in_dev);
41371e27da9SHerbert Xu 			IPV4_DEVCONF(in_dev->cnf, RP_FILTER) = 0;
4141da177e4SLinus Torvalds 
4151da177e4SLinus Torvalds 			if (dev_open(dev))
4161da177e4SLinus Torvalds 				goto failure;
4177dc00c82SWang Chen 			dev_hold(dev);
4181da177e4SLinus Torvalds 		}
4191da177e4SLinus Torvalds 	}
4201da177e4SLinus Torvalds 	return dev;
4211da177e4SLinus Torvalds 
4221da177e4SLinus Torvalds failure:
4231da177e4SLinus Torvalds 	/* allow the register to be completed before unregistering. */
4241da177e4SLinus Torvalds 	rtnl_unlock();
4251da177e4SLinus Torvalds 	rtnl_lock();
4261da177e4SLinus Torvalds 
4271da177e4SLinus Torvalds 	unregister_netdevice(dev);
4281da177e4SLinus Torvalds 	return NULL;
4291da177e4SLinus Torvalds }
4301da177e4SLinus Torvalds 
4311da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM
4321da177e4SLinus Torvalds 
4336fef4c0cSStephen Hemminger static netdev_tx_t reg_vif_xmit(struct sk_buff *skb, struct net_device *dev)
4341da177e4SLinus Torvalds {
4354feb88e5SBenjamin Thery 	struct net *net = dev_net(dev);
436f0ad0860SPatrick McHardy 	struct mr_table *mrt;
437f0ad0860SPatrick McHardy 	struct flowi fl = {
438f0ad0860SPatrick McHardy 		.oif		= dev->ifindex,
439f0ad0860SPatrick McHardy 		.iif		= skb->skb_iif,
440f0ad0860SPatrick McHardy 		.mark		= skb->mark,
441f0ad0860SPatrick McHardy 	};
442f0ad0860SPatrick McHardy 	int err;
443f0ad0860SPatrick McHardy 
444f0ad0860SPatrick McHardy 	err = ipmr_fib_lookup(net, &fl, &mrt);
445e40dbc51SBen Greear 	if (err < 0) {
446e40dbc51SBen Greear 		kfree_skb(skb);
447f0ad0860SPatrick McHardy 		return err;
448e40dbc51SBen Greear 	}
4494feb88e5SBenjamin Thery 
4501da177e4SLinus Torvalds 	read_lock(&mrt_lock);
451cf3677aeSPavel Emelyanov 	dev->stats.tx_bytes += skb->len;
452cf3677aeSPavel Emelyanov 	dev->stats.tx_packets++;
4530c12295aSPatrick McHardy 	ipmr_cache_report(mrt, skb, mrt->mroute_reg_vif_num, IGMPMSG_WHOLEPKT);
4541da177e4SLinus Torvalds 	read_unlock(&mrt_lock);
4551da177e4SLinus Torvalds 	kfree_skb(skb);
4566ed10654SPatrick McHardy 	return NETDEV_TX_OK;
4571da177e4SLinus Torvalds }
4581da177e4SLinus Torvalds 
459007c3838SStephen Hemminger static const struct net_device_ops reg_vif_netdev_ops = {
460007c3838SStephen Hemminger 	.ndo_start_xmit	= reg_vif_xmit,
461007c3838SStephen Hemminger };
462007c3838SStephen Hemminger 
4631da177e4SLinus Torvalds static void reg_vif_setup(struct net_device *dev)
4641da177e4SLinus Torvalds {
4651da177e4SLinus Torvalds 	dev->type		= ARPHRD_PIMREG;
46646f25dffSKris Katterjohn 	dev->mtu		= ETH_DATA_LEN - sizeof(struct iphdr) - 8;
4671da177e4SLinus Torvalds 	dev->flags		= IFF_NOARP;
468007c3838SStephen Hemminger 	dev->netdev_ops		= &reg_vif_netdev_ops,
4691da177e4SLinus Torvalds 	dev->destructor		= free_netdev;
470403dbb97STom Goff 	dev->features		|= NETIF_F_NETNS_LOCAL;
4711da177e4SLinus Torvalds }
4721da177e4SLinus Torvalds 
473f0ad0860SPatrick McHardy static struct net_device *ipmr_reg_vif(struct net *net, struct mr_table *mrt)
4741da177e4SLinus Torvalds {
4751da177e4SLinus Torvalds 	struct net_device *dev;
4761da177e4SLinus Torvalds 	struct in_device *in_dev;
477f0ad0860SPatrick McHardy 	char name[IFNAMSIZ];
4781da177e4SLinus Torvalds 
479f0ad0860SPatrick McHardy 	if (mrt->id == RT_TABLE_DEFAULT)
480f0ad0860SPatrick McHardy 		sprintf(name, "pimreg");
481f0ad0860SPatrick McHardy 	else
482f0ad0860SPatrick McHardy 		sprintf(name, "pimreg%u", mrt->id);
483f0ad0860SPatrick McHardy 
484f0ad0860SPatrick McHardy 	dev = alloc_netdev(0, name, reg_vif_setup);
4851da177e4SLinus Torvalds 
4861da177e4SLinus Torvalds 	if (dev == NULL)
4871da177e4SLinus Torvalds 		return NULL;
4881da177e4SLinus Torvalds 
489403dbb97STom Goff 	dev_net_set(dev, net);
490403dbb97STom Goff 
4911da177e4SLinus Torvalds 	if (register_netdevice(dev)) {
4921da177e4SLinus Torvalds 		free_netdev(dev);
4931da177e4SLinus Torvalds 		return NULL;
4941da177e4SLinus Torvalds 	}
4951da177e4SLinus Torvalds 	dev->iflink = 0;
4961da177e4SLinus Torvalds 
49771e27da9SHerbert Xu 	rcu_read_lock();
49871e27da9SHerbert Xu 	if ((in_dev = __in_dev_get_rcu(dev)) == NULL) {
49971e27da9SHerbert Xu 		rcu_read_unlock();
5001da177e4SLinus Torvalds 		goto failure;
50171e27da9SHerbert Xu 	}
5021da177e4SLinus Torvalds 
50371e27da9SHerbert Xu 	ipv4_devconf_setall(in_dev);
50471e27da9SHerbert Xu 	IPV4_DEVCONF(in_dev->cnf, RP_FILTER) = 0;
50571e27da9SHerbert Xu 	rcu_read_unlock();
5061da177e4SLinus Torvalds 
5071da177e4SLinus Torvalds 	if (dev_open(dev))
5081da177e4SLinus Torvalds 		goto failure;
5091da177e4SLinus Torvalds 
5107dc00c82SWang Chen 	dev_hold(dev);
5117dc00c82SWang Chen 
5121da177e4SLinus Torvalds 	return dev;
5131da177e4SLinus Torvalds 
5141da177e4SLinus Torvalds failure:
5151da177e4SLinus Torvalds 	/* allow the register to be completed before unregistering. */
5161da177e4SLinus Torvalds 	rtnl_unlock();
5171da177e4SLinus Torvalds 	rtnl_lock();
5181da177e4SLinus Torvalds 
5191da177e4SLinus Torvalds 	unregister_netdevice(dev);
5201da177e4SLinus Torvalds 	return NULL;
5211da177e4SLinus Torvalds }
5221da177e4SLinus Torvalds #endif
5231da177e4SLinus Torvalds 
5241da177e4SLinus Torvalds /*
5251da177e4SLinus Torvalds  *	Delete a VIF entry
5267dc00c82SWang Chen  *	@notify: Set to 1, if the caller is a notifier_call
5271da177e4SLinus Torvalds  */
5281da177e4SLinus Torvalds 
5290c12295aSPatrick McHardy static int vif_delete(struct mr_table *mrt, int vifi, int notify,
530d17fa6faSEric Dumazet 		      struct list_head *head)
5311da177e4SLinus Torvalds {
5321da177e4SLinus Torvalds 	struct vif_device *v;
5331da177e4SLinus Torvalds 	struct net_device *dev;
5341da177e4SLinus Torvalds 	struct in_device *in_dev;
5351da177e4SLinus Torvalds 
5360c12295aSPatrick McHardy 	if (vifi < 0 || vifi >= mrt->maxvif)
5371da177e4SLinus Torvalds 		return -EADDRNOTAVAIL;
5381da177e4SLinus Torvalds 
5390c12295aSPatrick McHardy 	v = &mrt->vif_table[vifi];
5401da177e4SLinus Torvalds 
5411da177e4SLinus Torvalds 	write_lock_bh(&mrt_lock);
5421da177e4SLinus Torvalds 	dev = v->dev;
5431da177e4SLinus Torvalds 	v->dev = NULL;
5441da177e4SLinus Torvalds 
5451da177e4SLinus Torvalds 	if (!dev) {
5461da177e4SLinus Torvalds 		write_unlock_bh(&mrt_lock);
5471da177e4SLinus Torvalds 		return -EADDRNOTAVAIL;
5481da177e4SLinus Torvalds 	}
5491da177e4SLinus Torvalds 
5501da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM
5510c12295aSPatrick McHardy 	if (vifi == mrt->mroute_reg_vif_num)
5520c12295aSPatrick McHardy 		mrt->mroute_reg_vif_num = -1;
5531da177e4SLinus Torvalds #endif
5541da177e4SLinus Torvalds 
5550c12295aSPatrick McHardy 	if (vifi+1 == mrt->maxvif) {
5561da177e4SLinus Torvalds 		int tmp;
5571da177e4SLinus Torvalds 		for (tmp=vifi-1; tmp>=0; tmp--) {
5580c12295aSPatrick McHardy 			if (VIF_EXISTS(mrt, tmp))
5591da177e4SLinus Torvalds 				break;
5601da177e4SLinus Torvalds 		}
5610c12295aSPatrick McHardy 		mrt->maxvif = tmp+1;
5621da177e4SLinus Torvalds 	}
5631da177e4SLinus Torvalds 
5641da177e4SLinus Torvalds 	write_unlock_bh(&mrt_lock);
5651da177e4SLinus Torvalds 
5661da177e4SLinus Torvalds 	dev_set_allmulti(dev, -1);
5671da177e4SLinus Torvalds 
568e5ed6399SHerbert Xu 	if ((in_dev = __in_dev_get_rtnl(dev)) != NULL) {
56942f811b8SHerbert Xu 		IPV4_DEVCONF(in_dev->cnf, MC_FORWARDING)--;
5701da177e4SLinus Torvalds 		ip_rt_multicast_event(in_dev);
5711da177e4SLinus Torvalds 	}
5721da177e4SLinus Torvalds 
5737dc00c82SWang Chen 	if (v->flags&(VIFF_TUNNEL|VIFF_REGISTER) && !notify)
574d17fa6faSEric Dumazet 		unregister_netdevice_queue(dev, head);
5751da177e4SLinus Torvalds 
5761da177e4SLinus Torvalds 	dev_put(dev);
5771da177e4SLinus Torvalds 	return 0;
5781da177e4SLinus Torvalds }
5791da177e4SLinus Torvalds 
5805c0a66f5SBenjamin Thery static inline void ipmr_cache_free(struct mfc_cache *c)
5815c0a66f5SBenjamin Thery {
5825c0a66f5SBenjamin Thery 	kmem_cache_free(mrt_cachep, c);
5835c0a66f5SBenjamin Thery }
5845c0a66f5SBenjamin Thery 
5851da177e4SLinus Torvalds /* Destroy an unresolved cache entry, killing queued skbs
5861da177e4SLinus Torvalds    and reporting error to netlink readers.
5871da177e4SLinus Torvalds  */
5881da177e4SLinus Torvalds 
5890c12295aSPatrick McHardy static void ipmr_destroy_unres(struct mr_table *mrt, struct mfc_cache *c)
5901da177e4SLinus Torvalds {
5918de53dfbSPatrick McHardy 	struct net *net = read_pnet(&mrt->net);
5921da177e4SLinus Torvalds 	struct sk_buff *skb;
5939ef1d4c7SPatrick McHardy 	struct nlmsgerr *e;
5941da177e4SLinus Torvalds 
5950c12295aSPatrick McHardy 	atomic_dec(&mrt->cache_resolve_queue_len);
5961da177e4SLinus Torvalds 
5971da177e4SLinus Torvalds 	while ((skb = skb_dequeue(&c->mfc_un.unres.unresolved))) {
598eddc9ec5SArnaldo Carvalho de Melo 		if (ip_hdr(skb)->version == 0) {
5991da177e4SLinus Torvalds 			struct nlmsghdr *nlh = (struct nlmsghdr *)skb_pull(skb, sizeof(struct iphdr));
6001da177e4SLinus Torvalds 			nlh->nlmsg_type = NLMSG_ERROR;
6011da177e4SLinus Torvalds 			nlh->nlmsg_len = NLMSG_LENGTH(sizeof(struct nlmsgerr));
6021da177e4SLinus Torvalds 			skb_trim(skb, nlh->nlmsg_len);
6039ef1d4c7SPatrick McHardy 			e = NLMSG_DATA(nlh);
6049ef1d4c7SPatrick McHardy 			e->error = -ETIMEDOUT;
6059ef1d4c7SPatrick McHardy 			memset(&e->msg, 0, sizeof(e->msg));
6062942e900SThomas Graf 
6074feb88e5SBenjamin Thery 			rtnl_unicast(skb, net, NETLINK_CB(skb).pid);
6081da177e4SLinus Torvalds 		} else
6091da177e4SLinus Torvalds 			kfree_skb(skb);
6101da177e4SLinus Torvalds 	}
6111da177e4SLinus Torvalds 
6125c0a66f5SBenjamin Thery 	ipmr_cache_free(c);
6131da177e4SLinus Torvalds }
6141da177e4SLinus Torvalds 
6151da177e4SLinus Torvalds 
616e258beb2SPatrick McHardy /* Timer process for the unresolved queue. */
6171da177e4SLinus Torvalds 
618e258beb2SPatrick McHardy static void ipmr_expire_process(unsigned long arg)
6191da177e4SLinus Torvalds {
6200c12295aSPatrick McHardy 	struct mr_table *mrt = (struct mr_table *)arg;
6211da177e4SLinus Torvalds 	unsigned long now;
6221da177e4SLinus Torvalds 	unsigned long expires;
623862465f2SPatrick McHardy 	struct mfc_cache *c, *next;
6241da177e4SLinus Torvalds 
6251da177e4SLinus Torvalds 	if (!spin_trylock(&mfc_unres_lock)) {
6260c12295aSPatrick McHardy 		mod_timer(&mrt->ipmr_expire_timer, jiffies+HZ/10);
6271da177e4SLinus Torvalds 		return;
6281da177e4SLinus Torvalds 	}
6291da177e4SLinus Torvalds 
6300c12295aSPatrick McHardy 	if (list_empty(&mrt->mfc_unres_queue))
6311da177e4SLinus Torvalds 		goto out;
6321da177e4SLinus Torvalds 
6331da177e4SLinus Torvalds 	now = jiffies;
6341da177e4SLinus Torvalds 	expires = 10*HZ;
6351da177e4SLinus Torvalds 
6360c12295aSPatrick McHardy 	list_for_each_entry_safe(c, next, &mrt->mfc_unres_queue, list) {
6371da177e4SLinus Torvalds 		if (time_after(c->mfc_un.unres.expires, now)) {
6381da177e4SLinus Torvalds 			unsigned long interval = c->mfc_un.unres.expires - now;
6391da177e4SLinus Torvalds 			if (interval < expires)
6401da177e4SLinus Torvalds 				expires = interval;
6411da177e4SLinus Torvalds 			continue;
6421da177e4SLinus Torvalds 		}
6431da177e4SLinus Torvalds 
644862465f2SPatrick McHardy 		list_del(&c->list);
6450c12295aSPatrick McHardy 		ipmr_destroy_unres(mrt, c);
6461da177e4SLinus Torvalds 	}
6471da177e4SLinus Torvalds 
6480c12295aSPatrick McHardy 	if (!list_empty(&mrt->mfc_unres_queue))
6490c12295aSPatrick McHardy 		mod_timer(&mrt->ipmr_expire_timer, jiffies + expires);
6501da177e4SLinus Torvalds 
6511da177e4SLinus Torvalds out:
6521da177e4SLinus Torvalds 	spin_unlock(&mfc_unres_lock);
6531da177e4SLinus Torvalds }
6541da177e4SLinus Torvalds 
6551da177e4SLinus Torvalds /* Fill oifs list. It is called under write locked mrt_lock. */
6561da177e4SLinus Torvalds 
6570c12295aSPatrick McHardy static void ipmr_update_thresholds(struct mr_table *mrt, struct mfc_cache *cache,
658d658f8a0SPatrick McHardy 				   unsigned char *ttls)
6591da177e4SLinus Torvalds {
6601da177e4SLinus Torvalds 	int vifi;
6611da177e4SLinus Torvalds 
6621da177e4SLinus Torvalds 	cache->mfc_un.res.minvif = MAXVIFS;
6631da177e4SLinus Torvalds 	cache->mfc_un.res.maxvif = 0;
6641da177e4SLinus Torvalds 	memset(cache->mfc_un.res.ttls, 255, MAXVIFS);
6651da177e4SLinus Torvalds 
6660c12295aSPatrick McHardy 	for (vifi = 0; vifi < mrt->maxvif; vifi++) {
6670c12295aSPatrick McHardy 		if (VIF_EXISTS(mrt, vifi) &&
668cf958ae3SBenjamin Thery 		    ttls[vifi] && ttls[vifi] < 255) {
6691da177e4SLinus Torvalds 			cache->mfc_un.res.ttls[vifi] = ttls[vifi];
6701da177e4SLinus Torvalds 			if (cache->mfc_un.res.minvif > vifi)
6711da177e4SLinus Torvalds 				cache->mfc_un.res.minvif = vifi;
6721da177e4SLinus Torvalds 			if (cache->mfc_un.res.maxvif <= vifi)
6731da177e4SLinus Torvalds 				cache->mfc_un.res.maxvif = vifi + 1;
6741da177e4SLinus Torvalds 		}
6751da177e4SLinus Torvalds 	}
6761da177e4SLinus Torvalds }
6771da177e4SLinus Torvalds 
6780c12295aSPatrick McHardy static int vif_add(struct net *net, struct mr_table *mrt,
6790c12295aSPatrick McHardy 		   struct vifctl *vifc, int mrtsock)
6801da177e4SLinus Torvalds {
6811da177e4SLinus Torvalds 	int vifi = vifc->vifc_vifi;
6820c12295aSPatrick McHardy 	struct vif_device *v = &mrt->vif_table[vifi];
6831da177e4SLinus Torvalds 	struct net_device *dev;
6841da177e4SLinus Torvalds 	struct in_device *in_dev;
685d607032dSWang Chen 	int err;
6861da177e4SLinus Torvalds 
6871da177e4SLinus Torvalds 	/* Is vif busy ? */
6880c12295aSPatrick McHardy 	if (VIF_EXISTS(mrt, vifi))
6891da177e4SLinus Torvalds 		return -EADDRINUSE;
6901da177e4SLinus Torvalds 
6911da177e4SLinus Torvalds 	switch (vifc->vifc_flags) {
6921da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM
6931da177e4SLinus Torvalds 	case VIFF_REGISTER:
6941da177e4SLinus Torvalds 		/*
6951da177e4SLinus Torvalds 		 * Special Purpose VIF in PIM
6961da177e4SLinus Torvalds 		 * All the packets will be sent to the daemon
6971da177e4SLinus Torvalds 		 */
6980c12295aSPatrick McHardy 		if (mrt->mroute_reg_vif_num >= 0)
6991da177e4SLinus Torvalds 			return -EADDRINUSE;
700f0ad0860SPatrick McHardy 		dev = ipmr_reg_vif(net, mrt);
7011da177e4SLinus Torvalds 		if (!dev)
7021da177e4SLinus Torvalds 			return -ENOBUFS;
703d607032dSWang Chen 		err = dev_set_allmulti(dev, 1);
704d607032dSWang Chen 		if (err) {
705d607032dSWang Chen 			unregister_netdevice(dev);
7067dc00c82SWang Chen 			dev_put(dev);
707d607032dSWang Chen 			return err;
708d607032dSWang Chen 		}
7091da177e4SLinus Torvalds 		break;
7101da177e4SLinus Torvalds #endif
7111da177e4SLinus Torvalds 	case VIFF_TUNNEL:
7124feb88e5SBenjamin Thery 		dev = ipmr_new_tunnel(net, vifc);
7131da177e4SLinus Torvalds 		if (!dev)
7141da177e4SLinus Torvalds 			return -ENOBUFS;
715d607032dSWang Chen 		err = dev_set_allmulti(dev, 1);
716d607032dSWang Chen 		if (err) {
717d607032dSWang Chen 			ipmr_del_tunnel(dev, vifc);
7187dc00c82SWang Chen 			dev_put(dev);
719d607032dSWang Chen 			return err;
720d607032dSWang Chen 		}
7211da177e4SLinus Torvalds 		break;
722ee5e81f0SIlia K 
723ee5e81f0SIlia K 	case VIFF_USE_IFINDEX:
7241da177e4SLinus Torvalds 	case 0:
725ee5e81f0SIlia K 		if (vifc->vifc_flags == VIFF_USE_IFINDEX) {
726ee5e81f0SIlia K 			dev = dev_get_by_index(net, vifc->vifc_lcl_ifindex);
72795ae6b22SEric Dumazet 			if (dev && __in_dev_get_rtnl(dev) == NULL) {
728ee5e81f0SIlia K 				dev_put(dev);
729ee5e81f0SIlia K 				return -EADDRNOTAVAIL;
730ee5e81f0SIlia K 			}
731ee5e81f0SIlia K 		} else
7324feb88e5SBenjamin Thery 			dev = ip_dev_find(net, vifc->vifc_lcl_addr.s_addr);
733ee5e81f0SIlia K 
7341da177e4SLinus Torvalds 		if (!dev)
7351da177e4SLinus Torvalds 			return -EADDRNOTAVAIL;
736d607032dSWang Chen 		err = dev_set_allmulti(dev, 1);
7377dc00c82SWang Chen 		if (err) {
7387dc00c82SWang Chen 			dev_put(dev);
739d607032dSWang Chen 			return err;
7407dc00c82SWang Chen 		}
7411da177e4SLinus Torvalds 		break;
7421da177e4SLinus Torvalds 	default:
7431da177e4SLinus Torvalds 		return -EINVAL;
7441da177e4SLinus Torvalds 	}
7451da177e4SLinus Torvalds 
746d0490cfdSDan Carpenter 	if ((in_dev = __in_dev_get_rtnl(dev)) == NULL) {
747d0490cfdSDan Carpenter 		dev_put(dev);
7481da177e4SLinus Torvalds 		return -EADDRNOTAVAIL;
749d0490cfdSDan Carpenter 	}
75042f811b8SHerbert Xu 	IPV4_DEVCONF(in_dev->cnf, MC_FORWARDING)++;
7511da177e4SLinus Torvalds 	ip_rt_multicast_event(in_dev);
7521da177e4SLinus Torvalds 
7531da177e4SLinus Torvalds 	/*
7541da177e4SLinus Torvalds 	 *	Fill in the VIF structures
7551da177e4SLinus Torvalds 	 */
7561da177e4SLinus Torvalds 	v->rate_limit = vifc->vifc_rate_limit;
7571da177e4SLinus Torvalds 	v->local = vifc->vifc_lcl_addr.s_addr;
7581da177e4SLinus Torvalds 	v->remote = vifc->vifc_rmt_addr.s_addr;
7591da177e4SLinus Torvalds 	v->flags = vifc->vifc_flags;
7601da177e4SLinus Torvalds 	if (!mrtsock)
7611da177e4SLinus Torvalds 		v->flags |= VIFF_STATIC;
7621da177e4SLinus Torvalds 	v->threshold = vifc->vifc_threshold;
7631da177e4SLinus Torvalds 	v->bytes_in = 0;
7641da177e4SLinus Torvalds 	v->bytes_out = 0;
7651da177e4SLinus Torvalds 	v->pkt_in = 0;
7661da177e4SLinus Torvalds 	v->pkt_out = 0;
7671da177e4SLinus Torvalds 	v->link = dev->ifindex;
7681da177e4SLinus Torvalds 	if (v->flags&(VIFF_TUNNEL|VIFF_REGISTER))
7691da177e4SLinus Torvalds 		v->link = dev->iflink;
7701da177e4SLinus Torvalds 
7711da177e4SLinus Torvalds 	/* And finish update writing critical data */
7721da177e4SLinus Torvalds 	write_lock_bh(&mrt_lock);
7731da177e4SLinus Torvalds 	v->dev = dev;
7741da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM
7751da177e4SLinus Torvalds 	if (v->flags&VIFF_REGISTER)
7760c12295aSPatrick McHardy 		mrt->mroute_reg_vif_num = vifi;
7771da177e4SLinus Torvalds #endif
7780c12295aSPatrick McHardy 	if (vifi+1 > mrt->maxvif)
7790c12295aSPatrick McHardy 		mrt->maxvif = vifi+1;
7801da177e4SLinus Torvalds 	write_unlock_bh(&mrt_lock);
7811da177e4SLinus Torvalds 	return 0;
7821da177e4SLinus Torvalds }
7831da177e4SLinus Torvalds 
7840c12295aSPatrick McHardy static struct mfc_cache *ipmr_cache_find(struct mr_table *mrt,
7854feb88e5SBenjamin Thery 					 __be32 origin,
7864feb88e5SBenjamin Thery 					 __be32 mcastgrp)
7871da177e4SLinus Torvalds {
7881da177e4SLinus Torvalds 	int line = MFC_HASH(mcastgrp, origin);
7891da177e4SLinus Torvalds 	struct mfc_cache *c;
7901da177e4SLinus Torvalds 
7910c12295aSPatrick McHardy 	list_for_each_entry(c, &mrt->mfc_cache_array[line], list) {
7921da177e4SLinus Torvalds 		if (c->mfc_origin == origin && c->mfc_mcastgrp == mcastgrp)
7931da177e4SLinus Torvalds 			return c;
7941da177e4SLinus Torvalds 	}
795862465f2SPatrick McHardy 	return NULL;
796862465f2SPatrick McHardy }
7971da177e4SLinus Torvalds 
7981da177e4SLinus Torvalds /*
7991da177e4SLinus Torvalds  *	Allocate a multicast cache entry
8001da177e4SLinus Torvalds  */
801d658f8a0SPatrick McHardy static struct mfc_cache *ipmr_cache_alloc(void)
8021da177e4SLinus Torvalds {
803c3762229SRobert P. J. Day 	struct mfc_cache *c = kmem_cache_zalloc(mrt_cachep, GFP_KERNEL);
8041da177e4SLinus Torvalds 	if (c == NULL)
8051da177e4SLinus Torvalds 		return NULL;
8061da177e4SLinus Torvalds 	c->mfc_un.res.minvif = MAXVIFS;
8071da177e4SLinus Torvalds 	return c;
8081da177e4SLinus Torvalds }
8091da177e4SLinus Torvalds 
810d658f8a0SPatrick McHardy static struct mfc_cache *ipmr_cache_alloc_unres(void)
8111da177e4SLinus Torvalds {
812c3762229SRobert P. J. Day 	struct mfc_cache *c = kmem_cache_zalloc(mrt_cachep, GFP_ATOMIC);
8131da177e4SLinus Torvalds 	if (c == NULL)
8141da177e4SLinus Torvalds 		return NULL;
8151da177e4SLinus Torvalds 	skb_queue_head_init(&c->mfc_un.unres.unresolved);
8161da177e4SLinus Torvalds 	c->mfc_un.unres.expires = jiffies + 10*HZ;
8171da177e4SLinus Torvalds 	return c;
8181da177e4SLinus Torvalds }
8191da177e4SLinus Torvalds 
8201da177e4SLinus Torvalds /*
8211da177e4SLinus Torvalds  *	A cache entry has gone into a resolved state from queued
8221da177e4SLinus Torvalds  */
8231da177e4SLinus Torvalds 
8240c12295aSPatrick McHardy static void ipmr_cache_resolve(struct net *net, struct mr_table *mrt,
8250c12295aSPatrick McHardy 			       struct mfc_cache *uc, struct mfc_cache *c)
8261da177e4SLinus Torvalds {
8271da177e4SLinus Torvalds 	struct sk_buff *skb;
8289ef1d4c7SPatrick McHardy 	struct nlmsgerr *e;
8291da177e4SLinus Torvalds 
8301da177e4SLinus Torvalds 	/*
8311da177e4SLinus Torvalds 	 *	Play the pending entries through our router
8321da177e4SLinus Torvalds 	 */
8331da177e4SLinus Torvalds 
8341da177e4SLinus Torvalds 	while ((skb = __skb_dequeue(&uc->mfc_un.unres.unresolved))) {
835eddc9ec5SArnaldo Carvalho de Melo 		if (ip_hdr(skb)->version == 0) {
8361da177e4SLinus Torvalds 			struct nlmsghdr *nlh = (struct nlmsghdr *)skb_pull(skb, sizeof(struct iphdr));
8371da177e4SLinus Torvalds 
838cb6a4e46SPatrick McHardy 			if (__ipmr_fill_mroute(mrt, skb, c, NLMSG_DATA(nlh)) > 0) {
83927a884dcSArnaldo Carvalho de Melo 				nlh->nlmsg_len = (skb_tail_pointer(skb) -
84027a884dcSArnaldo Carvalho de Melo 						  (u8 *)nlh);
8411da177e4SLinus Torvalds 			} else {
8421da177e4SLinus Torvalds 				nlh->nlmsg_type = NLMSG_ERROR;
8431da177e4SLinus Torvalds 				nlh->nlmsg_len = NLMSG_LENGTH(sizeof(struct nlmsgerr));
8441da177e4SLinus Torvalds 				skb_trim(skb, nlh->nlmsg_len);
8459ef1d4c7SPatrick McHardy 				e = NLMSG_DATA(nlh);
8469ef1d4c7SPatrick McHardy 				e->error = -EMSGSIZE;
8479ef1d4c7SPatrick McHardy 				memset(&e->msg, 0, sizeof(e->msg));
8481da177e4SLinus Torvalds 			}
8492942e900SThomas Graf 
850d658f8a0SPatrick McHardy 			rtnl_unicast(skb, net, NETLINK_CB(skb).pid);
8511da177e4SLinus Torvalds 		} else
8520c12295aSPatrick McHardy 			ip_mr_forward(net, mrt, skb, c, 0);
8531da177e4SLinus Torvalds 	}
8541da177e4SLinus Torvalds }
8551da177e4SLinus Torvalds 
8561da177e4SLinus Torvalds /*
8571da177e4SLinus Torvalds  *	Bounce a cache query up to mrouted. We could use netlink for this but mrouted
8581da177e4SLinus Torvalds  *	expects the following bizarre scheme.
8591da177e4SLinus Torvalds  *
8601da177e4SLinus Torvalds  *	Called under mrt_lock.
8611da177e4SLinus Torvalds  */
8621da177e4SLinus Torvalds 
8630c12295aSPatrick McHardy static int ipmr_cache_report(struct mr_table *mrt,
8644feb88e5SBenjamin Thery 			     struct sk_buff *pkt, vifi_t vifi, int assert)
8651da177e4SLinus Torvalds {
8661da177e4SLinus Torvalds 	struct sk_buff *skb;
867c9bdd4b5SArnaldo Carvalho de Melo 	const int ihl = ip_hdrlen(pkt);
8681da177e4SLinus Torvalds 	struct igmphdr *igmp;
8691da177e4SLinus Torvalds 	struct igmpmsg *msg;
8701da177e4SLinus Torvalds 	int ret;
8711da177e4SLinus Torvalds 
8721da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM
8731da177e4SLinus Torvalds 	if (assert == IGMPMSG_WHOLEPKT)
8741da177e4SLinus Torvalds 		skb = skb_realloc_headroom(pkt, sizeof(struct iphdr));
8751da177e4SLinus Torvalds 	else
8761da177e4SLinus Torvalds #endif
8771da177e4SLinus Torvalds 		skb = alloc_skb(128, GFP_ATOMIC);
8781da177e4SLinus Torvalds 
8791da177e4SLinus Torvalds 	if (!skb)
8801da177e4SLinus Torvalds 		return -ENOBUFS;
8811da177e4SLinus Torvalds 
8821da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM
8831da177e4SLinus Torvalds 	if (assert == IGMPMSG_WHOLEPKT) {
8841da177e4SLinus Torvalds 		/* Ugly, but we have no choice with this interface.
8851da177e4SLinus Torvalds 		   Duplicate old header, fix ihl, length etc.
8861da177e4SLinus Torvalds 		   And all this only to mangle msg->im_msgtype and
8871da177e4SLinus Torvalds 		   to set msg->im_mbz to "mbz" :-)
8881da177e4SLinus Torvalds 		 */
889878c8145SArnaldo Carvalho de Melo 		skb_push(skb, sizeof(struct iphdr));
890878c8145SArnaldo Carvalho de Melo 		skb_reset_network_header(skb);
891badff6d0SArnaldo Carvalho de Melo 		skb_reset_transport_header(skb);
8920272ffc4SArnaldo Carvalho de Melo 		msg = (struct igmpmsg *)skb_network_header(skb);
893d56f90a7SArnaldo Carvalho de Melo 		memcpy(msg, skb_network_header(pkt), sizeof(struct iphdr));
8941da177e4SLinus Torvalds 		msg->im_msgtype = IGMPMSG_WHOLEPKT;
8951da177e4SLinus Torvalds 		msg->im_mbz = 0;
8960c12295aSPatrick McHardy 		msg->im_vif = mrt->mroute_reg_vif_num;
897eddc9ec5SArnaldo Carvalho de Melo 		ip_hdr(skb)->ihl = sizeof(struct iphdr) >> 2;
898eddc9ec5SArnaldo Carvalho de Melo 		ip_hdr(skb)->tot_len = htons(ntohs(ip_hdr(pkt)->tot_len) +
899eddc9ec5SArnaldo Carvalho de Melo 					     sizeof(struct iphdr));
9001da177e4SLinus Torvalds 	} else
9011da177e4SLinus Torvalds #endif
9021da177e4SLinus Torvalds 	{
9031da177e4SLinus Torvalds 
9041da177e4SLinus Torvalds 	/*
9051da177e4SLinus Torvalds 	 *	Copy the IP header
9061da177e4SLinus Torvalds 	 */
9071da177e4SLinus Torvalds 
90827a884dcSArnaldo Carvalho de Melo 	skb->network_header = skb->tail;
909ddc7b8e3SArnaldo Carvalho de Melo 	skb_put(skb, ihl);
91027d7ff46SArnaldo Carvalho de Melo 	skb_copy_to_linear_data(skb, pkt->data, ihl);
911eddc9ec5SArnaldo Carvalho de Melo 	ip_hdr(skb)->protocol = 0;			/* Flag to the kernel this is a route add */
912eddc9ec5SArnaldo Carvalho de Melo 	msg = (struct igmpmsg *)skb_network_header(skb);
9131da177e4SLinus Torvalds 	msg->im_vif = vifi;
914adf30907SEric Dumazet 	skb_dst_set(skb, dst_clone(skb_dst(pkt)));
9151da177e4SLinus Torvalds 
9161da177e4SLinus Torvalds 	/*
9171da177e4SLinus Torvalds 	 *	Add our header
9181da177e4SLinus Torvalds 	 */
9191da177e4SLinus Torvalds 
9201da177e4SLinus Torvalds 	igmp=(struct igmphdr *)skb_put(skb, sizeof(struct igmphdr));
9211da177e4SLinus Torvalds 	igmp->type	=
9221da177e4SLinus Torvalds 	msg->im_msgtype = assert;
9231da177e4SLinus Torvalds 	igmp->code 	=	0;
924eddc9ec5SArnaldo Carvalho de Melo 	ip_hdr(skb)->tot_len = htons(skb->len);			/* Fix the length */
925b0e380b1SArnaldo Carvalho de Melo 	skb->transport_header = skb->network_header;
9261da177e4SLinus Torvalds 	}
9271da177e4SLinus Torvalds 
9280c12295aSPatrick McHardy 	if (mrt->mroute_sk == NULL) {
9291da177e4SLinus Torvalds 		kfree_skb(skb);
9301da177e4SLinus Torvalds 		return -EINVAL;
9311da177e4SLinus Torvalds 	}
9321da177e4SLinus Torvalds 
9331da177e4SLinus Torvalds 	/*
9341da177e4SLinus Torvalds 	 *	Deliver to mrouted
9351da177e4SLinus Torvalds 	 */
9360c12295aSPatrick McHardy 	ret = sock_queue_rcv_skb(mrt->mroute_sk, skb);
93770a269e6SBenjamin Thery 	if (ret < 0) {
9381da177e4SLinus Torvalds 		if (net_ratelimit())
9391da177e4SLinus Torvalds 			printk(KERN_WARNING "mroute: pending queue full, dropping entries.\n");
9401da177e4SLinus Torvalds 		kfree_skb(skb);
9411da177e4SLinus Torvalds 	}
9421da177e4SLinus Torvalds 
9431da177e4SLinus Torvalds 	return ret;
9441da177e4SLinus Torvalds }
9451da177e4SLinus Torvalds 
9461da177e4SLinus Torvalds /*
9471da177e4SLinus Torvalds  *	Queue a packet for resolution. It gets locked cache entry!
9481da177e4SLinus Torvalds  */
9491da177e4SLinus Torvalds 
9501da177e4SLinus Torvalds static int
9510c12295aSPatrick McHardy ipmr_cache_unresolved(struct mr_table *mrt, vifi_t vifi, struct sk_buff *skb)
9521da177e4SLinus Torvalds {
953862465f2SPatrick McHardy 	bool found = false;
9541da177e4SLinus Torvalds 	int err;
9551da177e4SLinus Torvalds 	struct mfc_cache *c;
956eddc9ec5SArnaldo Carvalho de Melo 	const struct iphdr *iph = ip_hdr(skb);
9571da177e4SLinus Torvalds 
9581da177e4SLinus Torvalds 	spin_lock_bh(&mfc_unres_lock);
9590c12295aSPatrick McHardy 	list_for_each_entry(c, &mrt->mfc_unres_queue, list) {
960e258beb2SPatrick McHardy 		if (c->mfc_mcastgrp == iph->daddr &&
961862465f2SPatrick McHardy 		    c->mfc_origin == iph->saddr) {
962862465f2SPatrick McHardy 			found = true;
9631da177e4SLinus Torvalds 			break;
9641da177e4SLinus Torvalds 		}
965862465f2SPatrick McHardy 	}
9661da177e4SLinus Torvalds 
967862465f2SPatrick McHardy 	if (!found) {
9681da177e4SLinus Torvalds 		/*
9691da177e4SLinus Torvalds 		 *	Create a new entry if allowable
9701da177e4SLinus Torvalds 		 */
9711da177e4SLinus Torvalds 
9720c12295aSPatrick McHardy 		if (atomic_read(&mrt->cache_resolve_queue_len) >= 10 ||
973d658f8a0SPatrick McHardy 		    (c = ipmr_cache_alloc_unres()) == NULL) {
9741da177e4SLinus Torvalds 			spin_unlock_bh(&mfc_unres_lock);
9751da177e4SLinus Torvalds 
9761da177e4SLinus Torvalds 			kfree_skb(skb);
9771da177e4SLinus Torvalds 			return -ENOBUFS;
9781da177e4SLinus Torvalds 		}
9791da177e4SLinus Torvalds 
9801da177e4SLinus Torvalds 		/*
9811da177e4SLinus Torvalds 		 *	Fill in the new cache entry
9821da177e4SLinus Torvalds 		 */
9831da177e4SLinus Torvalds 		c->mfc_parent	= -1;
984eddc9ec5SArnaldo Carvalho de Melo 		c->mfc_origin	= iph->saddr;
985eddc9ec5SArnaldo Carvalho de Melo 		c->mfc_mcastgrp	= iph->daddr;
9861da177e4SLinus Torvalds 
9871da177e4SLinus Torvalds 		/*
9881da177e4SLinus Torvalds 		 *	Reflect first query at mrouted.
9891da177e4SLinus Torvalds 		 */
9900c12295aSPatrick McHardy 		err = ipmr_cache_report(mrt, skb, vifi, IGMPMSG_NOCACHE);
9914feb88e5SBenjamin Thery 		if (err < 0) {
9921da177e4SLinus Torvalds 			/* If the report failed throw the cache entry
9931da177e4SLinus Torvalds 			   out - Brad Parker
9941da177e4SLinus Torvalds 			 */
9951da177e4SLinus Torvalds 			spin_unlock_bh(&mfc_unres_lock);
9961da177e4SLinus Torvalds 
9975c0a66f5SBenjamin Thery 			ipmr_cache_free(c);
9981da177e4SLinus Torvalds 			kfree_skb(skb);
9991da177e4SLinus Torvalds 			return err;
10001da177e4SLinus Torvalds 		}
10011da177e4SLinus Torvalds 
10020c12295aSPatrick McHardy 		atomic_inc(&mrt->cache_resolve_queue_len);
10030c12295aSPatrick McHardy 		list_add(&c->list, &mrt->mfc_unres_queue);
10041da177e4SLinus Torvalds 
1005278554bdSDavid S. Miller 		if (atomic_read(&mrt->cache_resolve_queue_len) == 1)
10060c12295aSPatrick McHardy 			mod_timer(&mrt->ipmr_expire_timer, c->mfc_un.unres.expires);
10071da177e4SLinus Torvalds 	}
10081da177e4SLinus Torvalds 
10091da177e4SLinus Torvalds 	/*
10101da177e4SLinus Torvalds 	 *	See if we can append the packet
10111da177e4SLinus Torvalds 	 */
10121da177e4SLinus Torvalds 	if (c->mfc_un.unres.unresolved.qlen>3) {
10131da177e4SLinus Torvalds 		kfree_skb(skb);
10141da177e4SLinus Torvalds 		err = -ENOBUFS;
10151da177e4SLinus Torvalds 	} else {
10161da177e4SLinus Torvalds 		skb_queue_tail(&c->mfc_un.unres.unresolved, skb);
10171da177e4SLinus Torvalds 		err = 0;
10181da177e4SLinus Torvalds 	}
10191da177e4SLinus Torvalds 
10201da177e4SLinus Torvalds 	spin_unlock_bh(&mfc_unres_lock);
10211da177e4SLinus Torvalds 	return err;
10221da177e4SLinus Torvalds }
10231da177e4SLinus Torvalds 
10241da177e4SLinus Torvalds /*
10251da177e4SLinus Torvalds  *	MFC cache manipulation by user space mroute daemon
10261da177e4SLinus Torvalds  */
10271da177e4SLinus Torvalds 
10280c12295aSPatrick McHardy static int ipmr_mfc_delete(struct mr_table *mrt, struct mfcctl *mfc)
10291da177e4SLinus Torvalds {
10301da177e4SLinus Torvalds 	int line;
1031862465f2SPatrick McHardy 	struct mfc_cache *c, *next;
10321da177e4SLinus Torvalds 
10331da177e4SLinus Torvalds 	line = MFC_HASH(mfc->mfcc_mcastgrp.s_addr, mfc->mfcc_origin.s_addr);
10341da177e4SLinus Torvalds 
10350c12295aSPatrick McHardy 	list_for_each_entry_safe(c, next, &mrt->mfc_cache_array[line], list) {
10361da177e4SLinus Torvalds 		if (c->mfc_origin == mfc->mfcc_origin.s_addr &&
10371da177e4SLinus Torvalds 		    c->mfc_mcastgrp == mfc->mfcc_mcastgrp.s_addr) {
10381da177e4SLinus Torvalds 			write_lock_bh(&mrt_lock);
1039862465f2SPatrick McHardy 			list_del(&c->list);
10401da177e4SLinus Torvalds 			write_unlock_bh(&mrt_lock);
10411da177e4SLinus Torvalds 
10425c0a66f5SBenjamin Thery 			ipmr_cache_free(c);
10431da177e4SLinus Torvalds 			return 0;
10441da177e4SLinus Torvalds 		}
10451da177e4SLinus Torvalds 	}
10461da177e4SLinus Torvalds 	return -ENOENT;
10471da177e4SLinus Torvalds }
10481da177e4SLinus Torvalds 
10490c12295aSPatrick McHardy static int ipmr_mfc_add(struct net *net, struct mr_table *mrt,
10500c12295aSPatrick McHardy 			struct mfcctl *mfc, int mrtsock)
10511da177e4SLinus Torvalds {
1052862465f2SPatrick McHardy 	bool found = false;
10531da177e4SLinus Torvalds 	int line;
1054862465f2SPatrick McHardy 	struct mfc_cache *uc, *c;
10551da177e4SLinus Torvalds 
1056a50436f2SPatrick McHardy 	if (mfc->mfcc_parent >= MAXVIFS)
1057a50436f2SPatrick McHardy 		return -ENFILE;
1058a50436f2SPatrick McHardy 
10591da177e4SLinus Torvalds 	line = MFC_HASH(mfc->mfcc_mcastgrp.s_addr, mfc->mfcc_origin.s_addr);
10601da177e4SLinus Torvalds 
10610c12295aSPatrick McHardy 	list_for_each_entry(c, &mrt->mfc_cache_array[line], list) {
10621da177e4SLinus Torvalds 		if (c->mfc_origin == mfc->mfcc_origin.s_addr &&
1063862465f2SPatrick McHardy 		    c->mfc_mcastgrp == mfc->mfcc_mcastgrp.s_addr) {
1064862465f2SPatrick McHardy 			found = true;
10651da177e4SLinus Torvalds 			break;
10661da177e4SLinus Torvalds 		}
1067862465f2SPatrick McHardy 	}
10681da177e4SLinus Torvalds 
1069862465f2SPatrick McHardy 	if (found) {
10701da177e4SLinus Torvalds 		write_lock_bh(&mrt_lock);
10711da177e4SLinus Torvalds 		c->mfc_parent = mfc->mfcc_parent;
10720c12295aSPatrick McHardy 		ipmr_update_thresholds(mrt, c, mfc->mfcc_ttls);
10731da177e4SLinus Torvalds 		if (!mrtsock)
10741da177e4SLinus Torvalds 			c->mfc_flags |= MFC_STATIC;
10751da177e4SLinus Torvalds 		write_unlock_bh(&mrt_lock);
10761da177e4SLinus Torvalds 		return 0;
10771da177e4SLinus Torvalds 	}
10781da177e4SLinus Torvalds 
1079f97c1e0cSJoe Perches 	if (!ipv4_is_multicast(mfc->mfcc_mcastgrp.s_addr))
10801da177e4SLinus Torvalds 		return -EINVAL;
10811da177e4SLinus Torvalds 
1082d658f8a0SPatrick McHardy 	c = ipmr_cache_alloc();
10831da177e4SLinus Torvalds 	if (c == NULL)
10841da177e4SLinus Torvalds 		return -ENOMEM;
10851da177e4SLinus Torvalds 
10861da177e4SLinus Torvalds 	c->mfc_origin = mfc->mfcc_origin.s_addr;
10871da177e4SLinus Torvalds 	c->mfc_mcastgrp = mfc->mfcc_mcastgrp.s_addr;
10881da177e4SLinus Torvalds 	c->mfc_parent = mfc->mfcc_parent;
10890c12295aSPatrick McHardy 	ipmr_update_thresholds(mrt, c, mfc->mfcc_ttls);
10901da177e4SLinus Torvalds 	if (!mrtsock)
10911da177e4SLinus Torvalds 		c->mfc_flags |= MFC_STATIC;
10921da177e4SLinus Torvalds 
10931da177e4SLinus Torvalds 	write_lock_bh(&mrt_lock);
10940c12295aSPatrick McHardy 	list_add(&c->list, &mrt->mfc_cache_array[line]);
10951da177e4SLinus Torvalds 	write_unlock_bh(&mrt_lock);
10961da177e4SLinus Torvalds 
10971da177e4SLinus Torvalds 	/*
10981da177e4SLinus Torvalds 	 *	Check to see if we resolved a queued list. If so we
10991da177e4SLinus Torvalds 	 *	need to send on the frames and tidy up.
11001da177e4SLinus Torvalds 	 */
1101b0ebb739SPatrick McHardy 	found = false;
11021da177e4SLinus Torvalds 	spin_lock_bh(&mfc_unres_lock);
11030c12295aSPatrick McHardy 	list_for_each_entry(uc, &mrt->mfc_unres_queue, list) {
1104e258beb2SPatrick McHardy 		if (uc->mfc_origin == c->mfc_origin &&
11051da177e4SLinus Torvalds 		    uc->mfc_mcastgrp == c->mfc_mcastgrp) {
1106862465f2SPatrick McHardy 			list_del(&uc->list);
11070c12295aSPatrick McHardy 			atomic_dec(&mrt->cache_resolve_queue_len);
1108b0ebb739SPatrick McHardy 			found = true;
11091da177e4SLinus Torvalds 			break;
11101da177e4SLinus Torvalds 		}
11111da177e4SLinus Torvalds 	}
11120c12295aSPatrick McHardy 	if (list_empty(&mrt->mfc_unres_queue))
11130c12295aSPatrick McHardy 		del_timer(&mrt->ipmr_expire_timer);
11141da177e4SLinus Torvalds 	spin_unlock_bh(&mfc_unres_lock);
11151da177e4SLinus Torvalds 
1116b0ebb739SPatrick McHardy 	if (found) {
11170c12295aSPatrick McHardy 		ipmr_cache_resolve(net, mrt, uc, c);
11185c0a66f5SBenjamin Thery 		ipmr_cache_free(uc);
11191da177e4SLinus Torvalds 	}
11201da177e4SLinus Torvalds 	return 0;
11211da177e4SLinus Torvalds }
11221da177e4SLinus Torvalds 
11231da177e4SLinus Torvalds /*
11241da177e4SLinus Torvalds  *	Close the multicast socket, and clear the vif tables etc
11251da177e4SLinus Torvalds  */
11261da177e4SLinus Torvalds 
11270c12295aSPatrick McHardy static void mroute_clean_tables(struct mr_table *mrt)
11281da177e4SLinus Torvalds {
11291da177e4SLinus Torvalds 	int i;
1130d17fa6faSEric Dumazet 	LIST_HEAD(list);
1131862465f2SPatrick McHardy 	struct mfc_cache *c, *next;
11321da177e4SLinus Torvalds 
11331da177e4SLinus Torvalds 	/*
11341da177e4SLinus Torvalds 	 *	Shut down all active vif entries
11351da177e4SLinus Torvalds 	 */
11360c12295aSPatrick McHardy 	for (i = 0; i < mrt->maxvif; i++) {
11370c12295aSPatrick McHardy 		if (!(mrt->vif_table[i].flags&VIFF_STATIC))
11380c12295aSPatrick McHardy 			vif_delete(mrt, i, 0, &list);
11391da177e4SLinus Torvalds 	}
1140d17fa6faSEric Dumazet 	unregister_netdevice_many(&list);
11411da177e4SLinus Torvalds 
11421da177e4SLinus Torvalds 	/*
11431da177e4SLinus Torvalds 	 *	Wipe the cache
11441da177e4SLinus Torvalds 	 */
11451da177e4SLinus Torvalds 	for (i = 0; i < MFC_LINES; i++) {
11460c12295aSPatrick McHardy 		list_for_each_entry_safe(c, next, &mrt->mfc_cache_array[i], list) {
1147862465f2SPatrick McHardy 			if (c->mfc_flags&MFC_STATIC)
11481da177e4SLinus Torvalds 				continue;
11491da177e4SLinus Torvalds 			write_lock_bh(&mrt_lock);
1150862465f2SPatrick McHardy 			list_del(&c->list);
11511da177e4SLinus Torvalds 			write_unlock_bh(&mrt_lock);
11521da177e4SLinus Torvalds 
11535c0a66f5SBenjamin Thery 			ipmr_cache_free(c);
11541da177e4SLinus Torvalds 		}
11551da177e4SLinus Torvalds 	}
11561da177e4SLinus Torvalds 
11570c12295aSPatrick McHardy 	if (atomic_read(&mrt->cache_resolve_queue_len) != 0) {
11581da177e4SLinus Torvalds 		spin_lock_bh(&mfc_unres_lock);
11590c12295aSPatrick McHardy 		list_for_each_entry_safe(c, next, &mrt->mfc_unres_queue, list) {
1160862465f2SPatrick McHardy 			list_del(&c->list);
11610c12295aSPatrick McHardy 			ipmr_destroy_unres(mrt, c);
11621da177e4SLinus Torvalds 		}
11631da177e4SLinus Torvalds 		spin_unlock_bh(&mfc_unres_lock);
11641da177e4SLinus Torvalds 	}
11651da177e4SLinus Torvalds }
11661da177e4SLinus Torvalds 
11671da177e4SLinus Torvalds static void mrtsock_destruct(struct sock *sk)
11681da177e4SLinus Torvalds {
11694feb88e5SBenjamin Thery 	struct net *net = sock_net(sk);
1170f0ad0860SPatrick McHardy 	struct mr_table *mrt;
11714feb88e5SBenjamin Thery 
11721da177e4SLinus Torvalds 	rtnl_lock();
1173f0ad0860SPatrick McHardy 	ipmr_for_each_table(mrt, net) {
11740c12295aSPatrick McHardy 		if (sk == mrt->mroute_sk) {
11754feb88e5SBenjamin Thery 			IPV4_DEVCONF_ALL(net, MC_FORWARDING)--;
11761da177e4SLinus Torvalds 
11771da177e4SLinus Torvalds 			write_lock_bh(&mrt_lock);
11780c12295aSPatrick McHardy 			mrt->mroute_sk = NULL;
11791da177e4SLinus Torvalds 			write_unlock_bh(&mrt_lock);
11801da177e4SLinus Torvalds 
11810c12295aSPatrick McHardy 			mroute_clean_tables(mrt);
11821da177e4SLinus Torvalds 		}
11831da177e4SLinus Torvalds 	}
11841da177e4SLinus Torvalds 	rtnl_unlock();
11851da177e4SLinus Torvalds }
11861da177e4SLinus Torvalds 
11871da177e4SLinus Torvalds /*
11881da177e4SLinus Torvalds  *	Socket options and virtual interface manipulation. The whole
11891da177e4SLinus Torvalds  *	virtual interface system is a complete heap, but unfortunately
11901da177e4SLinus Torvalds  *	that's how BSD mrouted happens to think. Maybe one day with a proper
11911da177e4SLinus Torvalds  *	MOSPF/PIM router set up we can clean this up.
11921da177e4SLinus Torvalds  */
11931da177e4SLinus Torvalds 
1194b7058842SDavid S. Miller int ip_mroute_setsockopt(struct sock *sk, int optname, char __user *optval, unsigned int optlen)
11951da177e4SLinus Torvalds {
11961da177e4SLinus Torvalds 	int ret;
11971da177e4SLinus Torvalds 	struct vifctl vif;
11981da177e4SLinus Torvalds 	struct mfcctl mfc;
11994feb88e5SBenjamin Thery 	struct net *net = sock_net(sk);
1200f0ad0860SPatrick McHardy 	struct mr_table *mrt;
1201f0ad0860SPatrick McHardy 
1202f0ad0860SPatrick McHardy 	mrt = ipmr_get_table(net, raw_sk(sk)->ipmr_table ? : RT_TABLE_DEFAULT);
1203f0ad0860SPatrick McHardy 	if (mrt == NULL)
1204f0ad0860SPatrick McHardy 		return -ENOENT;
12051da177e4SLinus Torvalds 
1206132adf54SStephen Hemminger 	if (optname != MRT_INIT) {
12070c12295aSPatrick McHardy 		if (sk != mrt->mroute_sk && !capable(CAP_NET_ADMIN))
12081da177e4SLinus Torvalds 			return -EACCES;
12091da177e4SLinus Torvalds 	}
12101da177e4SLinus Torvalds 
1211132adf54SStephen Hemminger 	switch (optname) {
12121da177e4SLinus Torvalds 	case MRT_INIT:
12131da177e4SLinus Torvalds 		if (sk->sk_type != SOCK_RAW ||
1214c720c7e8SEric Dumazet 		    inet_sk(sk)->inet_num != IPPROTO_IGMP)
12151da177e4SLinus Torvalds 			return -EOPNOTSUPP;
12161da177e4SLinus Torvalds 		if (optlen != sizeof(int))
12171da177e4SLinus Torvalds 			return -ENOPROTOOPT;
12181da177e4SLinus Torvalds 
12191da177e4SLinus Torvalds 		rtnl_lock();
12200c12295aSPatrick McHardy 		if (mrt->mroute_sk) {
12211da177e4SLinus Torvalds 			rtnl_unlock();
12221da177e4SLinus Torvalds 			return -EADDRINUSE;
12231da177e4SLinus Torvalds 		}
12241da177e4SLinus Torvalds 
12251da177e4SLinus Torvalds 		ret = ip_ra_control(sk, 1, mrtsock_destruct);
12261da177e4SLinus Torvalds 		if (ret == 0) {
12271da177e4SLinus Torvalds 			write_lock_bh(&mrt_lock);
12280c12295aSPatrick McHardy 			mrt->mroute_sk = sk;
12291da177e4SLinus Torvalds 			write_unlock_bh(&mrt_lock);
12301da177e4SLinus Torvalds 
12314feb88e5SBenjamin Thery 			IPV4_DEVCONF_ALL(net, MC_FORWARDING)++;
12321da177e4SLinus Torvalds 		}
12331da177e4SLinus Torvalds 		rtnl_unlock();
12341da177e4SLinus Torvalds 		return ret;
12351da177e4SLinus Torvalds 	case MRT_DONE:
12360c12295aSPatrick McHardy 		if (sk != mrt->mroute_sk)
12371da177e4SLinus Torvalds 			return -EACCES;
12381da177e4SLinus Torvalds 		return ip_ra_control(sk, 0, NULL);
12391da177e4SLinus Torvalds 	case MRT_ADD_VIF:
12401da177e4SLinus Torvalds 	case MRT_DEL_VIF:
12411da177e4SLinus Torvalds 		if (optlen != sizeof(vif))
12421da177e4SLinus Torvalds 			return -EINVAL;
12431da177e4SLinus Torvalds 		if (copy_from_user(&vif, optval, sizeof(vif)))
12441da177e4SLinus Torvalds 			return -EFAULT;
12451da177e4SLinus Torvalds 		if (vif.vifc_vifi >= MAXVIFS)
12461da177e4SLinus Torvalds 			return -ENFILE;
12471da177e4SLinus Torvalds 		rtnl_lock();
12481da177e4SLinus Torvalds 		if (optname == MRT_ADD_VIF) {
12490c12295aSPatrick McHardy 			ret = vif_add(net, mrt, &vif, sk == mrt->mroute_sk);
12501da177e4SLinus Torvalds 		} else {
12510c12295aSPatrick McHardy 			ret = vif_delete(mrt, vif.vifc_vifi, 0, NULL);
12521da177e4SLinus Torvalds 		}
12531da177e4SLinus Torvalds 		rtnl_unlock();
12541da177e4SLinus Torvalds 		return ret;
12551da177e4SLinus Torvalds 
12561da177e4SLinus Torvalds 		/*
12571da177e4SLinus Torvalds 		 *	Manipulate the forwarding caches. These live
12581da177e4SLinus Torvalds 		 *	in a sort of kernel/user symbiosis.
12591da177e4SLinus Torvalds 		 */
12601da177e4SLinus Torvalds 	case MRT_ADD_MFC:
12611da177e4SLinus Torvalds 	case MRT_DEL_MFC:
12621da177e4SLinus Torvalds 		if (optlen != sizeof(mfc))
12631da177e4SLinus Torvalds 			return -EINVAL;
12641da177e4SLinus Torvalds 		if (copy_from_user(&mfc, optval, sizeof(mfc)))
12651da177e4SLinus Torvalds 			return -EFAULT;
12661da177e4SLinus Torvalds 		rtnl_lock();
12671da177e4SLinus Torvalds 		if (optname == MRT_DEL_MFC)
12680c12295aSPatrick McHardy 			ret = ipmr_mfc_delete(mrt, &mfc);
12691da177e4SLinus Torvalds 		else
12700c12295aSPatrick McHardy 			ret = ipmr_mfc_add(net, mrt, &mfc, sk == mrt->mroute_sk);
12711da177e4SLinus Torvalds 		rtnl_unlock();
12721da177e4SLinus Torvalds 		return ret;
12731da177e4SLinus Torvalds 		/*
12741da177e4SLinus Torvalds 		 *	Control PIM assert.
12751da177e4SLinus Torvalds 		 */
12761da177e4SLinus Torvalds 	case MRT_ASSERT:
12771da177e4SLinus Torvalds 	{
12781da177e4SLinus Torvalds 		int v;
12791da177e4SLinus Torvalds 		if (get_user(v,(int __user *)optval))
12801da177e4SLinus Torvalds 			return -EFAULT;
12810c12295aSPatrick McHardy 		mrt->mroute_do_assert = (v) ? 1 : 0;
12821da177e4SLinus Torvalds 		return 0;
12831da177e4SLinus Torvalds 	}
12841da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM
12851da177e4SLinus Torvalds 	case MRT_PIM:
12861da177e4SLinus Torvalds 	{
1287ba93ef74SStephen Hemminger 		int v;
1288ba93ef74SStephen Hemminger 
12891da177e4SLinus Torvalds 		if (get_user(v,(int __user *)optval))
12901da177e4SLinus Torvalds 			return -EFAULT;
12911da177e4SLinus Torvalds 		v = (v) ? 1 : 0;
1292ba93ef74SStephen Hemminger 
12931da177e4SLinus Torvalds 		rtnl_lock();
12941da177e4SLinus Torvalds 		ret = 0;
12950c12295aSPatrick McHardy 		if (v != mrt->mroute_do_pim) {
12960c12295aSPatrick McHardy 			mrt->mroute_do_pim = v;
12970c12295aSPatrick McHardy 			mrt->mroute_do_assert = v;
12981da177e4SLinus Torvalds 		}
12991da177e4SLinus Torvalds 		rtnl_unlock();
13001da177e4SLinus Torvalds 		return ret;
13011da177e4SLinus Torvalds 	}
13021da177e4SLinus Torvalds #endif
1303f0ad0860SPatrick McHardy #ifdef CONFIG_IP_MROUTE_MULTIPLE_TABLES
1304f0ad0860SPatrick McHardy 	case MRT_TABLE:
1305f0ad0860SPatrick McHardy 	{
1306f0ad0860SPatrick McHardy 		u32 v;
1307f0ad0860SPatrick McHardy 
1308f0ad0860SPatrick McHardy 		if (optlen != sizeof(u32))
1309f0ad0860SPatrick McHardy 			return -EINVAL;
1310f0ad0860SPatrick McHardy 		if (get_user(v, (u32 __user *)optval))
1311f0ad0860SPatrick McHardy 			return -EFAULT;
1312f0ad0860SPatrick McHardy 		if (sk == mrt->mroute_sk)
1313f0ad0860SPatrick McHardy 			return -EBUSY;
1314f0ad0860SPatrick McHardy 
1315f0ad0860SPatrick McHardy 		rtnl_lock();
1316f0ad0860SPatrick McHardy 		ret = 0;
1317f0ad0860SPatrick McHardy 		if (!ipmr_new_table(net, v))
1318f0ad0860SPatrick McHardy 			ret = -ENOMEM;
1319f0ad0860SPatrick McHardy 		raw_sk(sk)->ipmr_table = v;
1320f0ad0860SPatrick McHardy 		rtnl_unlock();
1321f0ad0860SPatrick McHardy 		return ret;
1322f0ad0860SPatrick McHardy 	}
1323f0ad0860SPatrick McHardy #endif
13241da177e4SLinus Torvalds 	/*
13251da177e4SLinus Torvalds 	 *	Spurious command, or MRT_VERSION which you cannot
13261da177e4SLinus Torvalds 	 *	set.
13271da177e4SLinus Torvalds 	 */
13281da177e4SLinus Torvalds 	default:
13291da177e4SLinus Torvalds 		return -ENOPROTOOPT;
13301da177e4SLinus Torvalds 	}
13311da177e4SLinus Torvalds }
13321da177e4SLinus Torvalds 
13331da177e4SLinus Torvalds /*
13341da177e4SLinus Torvalds  *	Getsock opt support for the multicast routing system.
13351da177e4SLinus Torvalds  */
13361da177e4SLinus Torvalds 
13371da177e4SLinus Torvalds int ip_mroute_getsockopt(struct sock *sk, int optname, char __user *optval, int __user *optlen)
13381da177e4SLinus Torvalds {
13391da177e4SLinus Torvalds 	int olr;
13401da177e4SLinus Torvalds 	int val;
13414feb88e5SBenjamin Thery 	struct net *net = sock_net(sk);
1342f0ad0860SPatrick McHardy 	struct mr_table *mrt;
1343f0ad0860SPatrick McHardy 
1344f0ad0860SPatrick McHardy 	mrt = ipmr_get_table(net, raw_sk(sk)->ipmr_table ? : RT_TABLE_DEFAULT);
1345f0ad0860SPatrick McHardy 	if (mrt == NULL)
1346f0ad0860SPatrick McHardy 		return -ENOENT;
13471da177e4SLinus Torvalds 
13481da177e4SLinus Torvalds 	if (optname != MRT_VERSION &&
13491da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM
13501da177e4SLinus Torvalds 	   optname!=MRT_PIM &&
13511da177e4SLinus Torvalds #endif
13521da177e4SLinus Torvalds 	   optname!=MRT_ASSERT)
13531da177e4SLinus Torvalds 		return -ENOPROTOOPT;
13541da177e4SLinus Torvalds 
13551da177e4SLinus Torvalds 	if (get_user(olr, optlen))
13561da177e4SLinus Torvalds 		return -EFAULT;
13571da177e4SLinus Torvalds 
13581da177e4SLinus Torvalds 	olr = min_t(unsigned int, olr, sizeof(int));
13591da177e4SLinus Torvalds 	if (olr < 0)
13601da177e4SLinus Torvalds 		return -EINVAL;
13611da177e4SLinus Torvalds 
13621da177e4SLinus Torvalds 	if (put_user(olr, optlen))
13631da177e4SLinus Torvalds 		return -EFAULT;
13641da177e4SLinus Torvalds 	if (optname == MRT_VERSION)
13651da177e4SLinus Torvalds 		val = 0x0305;
13661da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM
13671da177e4SLinus Torvalds 	else if (optname == MRT_PIM)
13680c12295aSPatrick McHardy 		val = mrt->mroute_do_pim;
13691da177e4SLinus Torvalds #endif
13701da177e4SLinus Torvalds 	else
13710c12295aSPatrick McHardy 		val = mrt->mroute_do_assert;
13721da177e4SLinus Torvalds 	if (copy_to_user(optval, &val, olr))
13731da177e4SLinus Torvalds 		return -EFAULT;
13741da177e4SLinus Torvalds 	return 0;
13751da177e4SLinus Torvalds }
13761da177e4SLinus Torvalds 
13771da177e4SLinus Torvalds /*
13781da177e4SLinus Torvalds  *	The IP multicast ioctl support routines.
13791da177e4SLinus Torvalds  */
13801da177e4SLinus Torvalds 
13811da177e4SLinus Torvalds int ipmr_ioctl(struct sock *sk, int cmd, void __user *arg)
13821da177e4SLinus Torvalds {
13831da177e4SLinus Torvalds 	struct sioc_sg_req sr;
13841da177e4SLinus Torvalds 	struct sioc_vif_req vr;
13851da177e4SLinus Torvalds 	struct vif_device *vif;
13861da177e4SLinus Torvalds 	struct mfc_cache *c;
13874feb88e5SBenjamin Thery 	struct net *net = sock_net(sk);
1388f0ad0860SPatrick McHardy 	struct mr_table *mrt;
1389f0ad0860SPatrick McHardy 
1390f0ad0860SPatrick McHardy 	mrt = ipmr_get_table(net, raw_sk(sk)->ipmr_table ? : RT_TABLE_DEFAULT);
1391f0ad0860SPatrick McHardy 	if (mrt == NULL)
1392f0ad0860SPatrick McHardy 		return -ENOENT;
13931da177e4SLinus Torvalds 
1394132adf54SStephen Hemminger 	switch (cmd) {
13951da177e4SLinus Torvalds 	case SIOCGETVIFCNT:
13961da177e4SLinus Torvalds 		if (copy_from_user(&vr, arg, sizeof(vr)))
13971da177e4SLinus Torvalds 			return -EFAULT;
13980c12295aSPatrick McHardy 		if (vr.vifi >= mrt->maxvif)
13991da177e4SLinus Torvalds 			return -EINVAL;
14001da177e4SLinus Torvalds 		read_lock(&mrt_lock);
14010c12295aSPatrick McHardy 		vif = &mrt->vif_table[vr.vifi];
14020c12295aSPatrick McHardy 		if (VIF_EXISTS(mrt, vr.vifi)) {
14031da177e4SLinus Torvalds 			vr.icount = vif->pkt_in;
14041da177e4SLinus Torvalds 			vr.ocount = vif->pkt_out;
14051da177e4SLinus Torvalds 			vr.ibytes = vif->bytes_in;
14061da177e4SLinus Torvalds 			vr.obytes = vif->bytes_out;
14071da177e4SLinus Torvalds 			read_unlock(&mrt_lock);
14081da177e4SLinus Torvalds 
14091da177e4SLinus Torvalds 			if (copy_to_user(arg, &vr, sizeof(vr)))
14101da177e4SLinus Torvalds 				return -EFAULT;
14111da177e4SLinus Torvalds 			return 0;
14121da177e4SLinus Torvalds 		}
14131da177e4SLinus Torvalds 		read_unlock(&mrt_lock);
14141da177e4SLinus Torvalds 		return -EADDRNOTAVAIL;
14151da177e4SLinus Torvalds 	case SIOCGETSGCNT:
14161da177e4SLinus Torvalds 		if (copy_from_user(&sr, arg, sizeof(sr)))
14171da177e4SLinus Torvalds 			return -EFAULT;
14181da177e4SLinus Torvalds 
14191da177e4SLinus Torvalds 		read_lock(&mrt_lock);
14200c12295aSPatrick McHardy 		c = ipmr_cache_find(mrt, sr.src.s_addr, sr.grp.s_addr);
14211da177e4SLinus Torvalds 		if (c) {
14221da177e4SLinus Torvalds 			sr.pktcnt = c->mfc_un.res.pkt;
14231da177e4SLinus Torvalds 			sr.bytecnt = c->mfc_un.res.bytes;
14241da177e4SLinus Torvalds 			sr.wrong_if = c->mfc_un.res.wrong_if;
14251da177e4SLinus Torvalds 			read_unlock(&mrt_lock);
14261da177e4SLinus Torvalds 
14271da177e4SLinus Torvalds 			if (copy_to_user(arg, &sr, sizeof(sr)))
14281da177e4SLinus Torvalds 				return -EFAULT;
14291da177e4SLinus Torvalds 			return 0;
14301da177e4SLinus Torvalds 		}
14311da177e4SLinus Torvalds 		read_unlock(&mrt_lock);
14321da177e4SLinus Torvalds 		return -EADDRNOTAVAIL;
14331da177e4SLinus Torvalds 	default:
14341da177e4SLinus Torvalds 		return -ENOIOCTLCMD;
14351da177e4SLinus Torvalds 	}
14361da177e4SLinus Torvalds }
14371da177e4SLinus Torvalds 
14381da177e4SLinus Torvalds 
14391da177e4SLinus Torvalds static int ipmr_device_event(struct notifier_block *this, unsigned long event, void *ptr)
14401da177e4SLinus Torvalds {
1441e9dc8653SEric W. Biederman 	struct net_device *dev = ptr;
14424feb88e5SBenjamin Thery 	struct net *net = dev_net(dev);
1443f0ad0860SPatrick McHardy 	struct mr_table *mrt;
14441da177e4SLinus Torvalds 	struct vif_device *v;
14451da177e4SLinus Torvalds 	int ct;
1446d17fa6faSEric Dumazet 	LIST_HEAD(list);
1447e9dc8653SEric W. Biederman 
14481da177e4SLinus Torvalds 	if (event != NETDEV_UNREGISTER)
14491da177e4SLinus Torvalds 		return NOTIFY_DONE;
1450f0ad0860SPatrick McHardy 
1451f0ad0860SPatrick McHardy 	ipmr_for_each_table(mrt, net) {
14520c12295aSPatrick McHardy 		v = &mrt->vif_table[0];
14530c12295aSPatrick McHardy 		for (ct = 0; ct < mrt->maxvif; ct++, v++) {
1454e9dc8653SEric W. Biederman 			if (v->dev == dev)
14550c12295aSPatrick McHardy 				vif_delete(mrt, ct, 1, &list);
14561da177e4SLinus Torvalds 		}
14571da177e4SLinus Torvalds 	}
1458d17fa6faSEric Dumazet 	unregister_netdevice_many(&list);
14591da177e4SLinus Torvalds 	return NOTIFY_DONE;
14601da177e4SLinus Torvalds }
14611da177e4SLinus Torvalds 
14621da177e4SLinus Torvalds 
14631da177e4SLinus Torvalds static struct notifier_block ip_mr_notifier = {
14641da177e4SLinus Torvalds 	.notifier_call = ipmr_device_event,
14651da177e4SLinus Torvalds };
14661da177e4SLinus Torvalds 
14671da177e4SLinus Torvalds /*
14681da177e4SLinus Torvalds  * 	Encapsulate a packet by attaching a valid IPIP header to it.
14691da177e4SLinus Torvalds  *	This avoids tunnel drivers and other mess and gives us the speed so
14701da177e4SLinus Torvalds  *	important for multicast video.
14711da177e4SLinus Torvalds  */
14721da177e4SLinus Torvalds 
1473114c7844SAl Viro static void ip_encap(struct sk_buff *skb, __be32 saddr, __be32 daddr)
14741da177e4SLinus Torvalds {
14758856dfa3SArnaldo Carvalho de Melo 	struct iphdr *iph;
1476eddc9ec5SArnaldo Carvalho de Melo 	struct iphdr *old_iph = ip_hdr(skb);
14778856dfa3SArnaldo Carvalho de Melo 
14788856dfa3SArnaldo Carvalho de Melo 	skb_push(skb, sizeof(struct iphdr));
1479b0e380b1SArnaldo Carvalho de Melo 	skb->transport_header = skb->network_header;
14808856dfa3SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
1481eddc9ec5SArnaldo Carvalho de Melo 	iph = ip_hdr(skb);
14821da177e4SLinus Torvalds 
14831da177e4SLinus Torvalds 	iph->version	= 	4;
1484e023dd64SArnaldo Carvalho de Melo 	iph->tos	=	old_iph->tos;
1485e023dd64SArnaldo Carvalho de Melo 	iph->ttl	=	old_iph->ttl;
14861da177e4SLinus Torvalds 	iph->frag_off	=	0;
14871da177e4SLinus Torvalds 	iph->daddr	=	daddr;
14881da177e4SLinus Torvalds 	iph->saddr	=	saddr;
14891da177e4SLinus Torvalds 	iph->protocol	=	IPPROTO_IPIP;
14901da177e4SLinus Torvalds 	iph->ihl	=	5;
14911da177e4SLinus Torvalds 	iph->tot_len	=	htons(skb->len);
1492adf30907SEric Dumazet 	ip_select_ident(iph, skb_dst(skb), NULL);
14931da177e4SLinus Torvalds 	ip_send_check(iph);
14941da177e4SLinus Torvalds 
14951da177e4SLinus Torvalds 	memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt));
14961da177e4SLinus Torvalds 	nf_reset(skb);
14971da177e4SLinus Torvalds }
14981da177e4SLinus Torvalds 
14991da177e4SLinus Torvalds static inline int ipmr_forward_finish(struct sk_buff *skb)
15001da177e4SLinus Torvalds {
15011da177e4SLinus Torvalds 	struct ip_options * opt	= &(IPCB(skb)->opt);
15021da177e4SLinus Torvalds 
1503adf30907SEric Dumazet 	IP_INC_STATS_BH(dev_net(skb_dst(skb)->dev), IPSTATS_MIB_OUTFORWDATAGRAMS);
15041da177e4SLinus Torvalds 
15051da177e4SLinus Torvalds 	if (unlikely(opt->optlen))
15061da177e4SLinus Torvalds 		ip_forward_options(skb);
15071da177e4SLinus Torvalds 
15081da177e4SLinus Torvalds 	return dst_output(skb);
15091da177e4SLinus Torvalds }
15101da177e4SLinus Torvalds 
15111da177e4SLinus Torvalds /*
15121da177e4SLinus Torvalds  *	Processing handlers for ipmr_forward
15131da177e4SLinus Torvalds  */
15141da177e4SLinus Torvalds 
15150c12295aSPatrick McHardy static void ipmr_queue_xmit(struct net *net, struct mr_table *mrt,
15160c12295aSPatrick McHardy 			    struct sk_buff *skb, struct mfc_cache *c, int vifi)
15171da177e4SLinus Torvalds {
1518eddc9ec5SArnaldo Carvalho de Melo 	const struct iphdr *iph = ip_hdr(skb);
15190c12295aSPatrick McHardy 	struct vif_device *vif = &mrt->vif_table[vifi];
15201da177e4SLinus Torvalds 	struct net_device *dev;
15211da177e4SLinus Torvalds 	struct rtable *rt;
15221da177e4SLinus Torvalds 	int    encap = 0;
15231da177e4SLinus Torvalds 
15241da177e4SLinus Torvalds 	if (vif->dev == NULL)
15251da177e4SLinus Torvalds 		goto out_free;
15261da177e4SLinus Torvalds 
15271da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM
15281da177e4SLinus Torvalds 	if (vif->flags & VIFF_REGISTER) {
15291da177e4SLinus Torvalds 		vif->pkt_out++;
15301da177e4SLinus Torvalds 		vif->bytes_out += skb->len;
1531cf3677aeSPavel Emelyanov 		vif->dev->stats.tx_bytes += skb->len;
1532cf3677aeSPavel Emelyanov 		vif->dev->stats.tx_packets++;
15330c12295aSPatrick McHardy 		ipmr_cache_report(mrt, skb, vifi, IGMPMSG_WHOLEPKT);
153469ebbf58SIlpo Järvinen 		goto out_free;
15351da177e4SLinus Torvalds 	}
15361da177e4SLinus Torvalds #endif
15371da177e4SLinus Torvalds 
15381da177e4SLinus Torvalds 	if (vif->flags&VIFF_TUNNEL) {
15391da177e4SLinus Torvalds 		struct flowi fl = { .oif = vif->link,
15401da177e4SLinus Torvalds 				    .nl_u = { .ip4_u =
15411da177e4SLinus Torvalds 					      { .daddr = vif->remote,
15421da177e4SLinus Torvalds 						.saddr = vif->local,
15431da177e4SLinus Torvalds 						.tos = RT_TOS(iph->tos) } },
15441da177e4SLinus Torvalds 				    .proto = IPPROTO_IPIP };
15454feb88e5SBenjamin Thery 		if (ip_route_output_key(net, &rt, &fl))
15461da177e4SLinus Torvalds 			goto out_free;
15471da177e4SLinus Torvalds 		encap = sizeof(struct iphdr);
15481da177e4SLinus Torvalds 	} else {
15491da177e4SLinus Torvalds 		struct flowi fl = { .oif = vif->link,
15501da177e4SLinus Torvalds 				    .nl_u = { .ip4_u =
15511da177e4SLinus Torvalds 					      { .daddr = iph->daddr,
15521da177e4SLinus Torvalds 						.tos = RT_TOS(iph->tos) } },
15531da177e4SLinus Torvalds 				    .proto = IPPROTO_IPIP };
15544feb88e5SBenjamin Thery 		if (ip_route_output_key(net, &rt, &fl))
15551da177e4SLinus Torvalds 			goto out_free;
15561da177e4SLinus Torvalds 	}
15571da177e4SLinus Torvalds 
1558d8d1f30bSChangli Gao 	dev = rt->dst.dev;
15591da177e4SLinus Torvalds 
1560d8d1f30bSChangli Gao 	if (skb->len+encap > dst_mtu(&rt->dst) && (ntohs(iph->frag_off) & IP_DF)) {
15611da177e4SLinus Torvalds 		/* Do not fragment multicasts. Alas, IPv4 does not
15621da177e4SLinus Torvalds 		   allow to send ICMP, so that packets will disappear
15631da177e4SLinus Torvalds 		   to blackhole.
15641da177e4SLinus Torvalds 		 */
15651da177e4SLinus Torvalds 
15667c73a6faSPavel Emelyanov 		IP_INC_STATS_BH(dev_net(dev), IPSTATS_MIB_FRAGFAILS);
15671da177e4SLinus Torvalds 		ip_rt_put(rt);
15681da177e4SLinus Torvalds 		goto out_free;
15691da177e4SLinus Torvalds 	}
15701da177e4SLinus Torvalds 
1571d8d1f30bSChangli Gao 	encap += LL_RESERVED_SPACE(dev) + rt->dst.header_len;
15721da177e4SLinus Torvalds 
15731da177e4SLinus Torvalds 	if (skb_cow(skb, encap)) {
15741da177e4SLinus Torvalds 		ip_rt_put(rt);
15751da177e4SLinus Torvalds 		goto out_free;
15761da177e4SLinus Torvalds 	}
15771da177e4SLinus Torvalds 
15781da177e4SLinus Torvalds 	vif->pkt_out++;
15791da177e4SLinus Torvalds 	vif->bytes_out += skb->len;
15801da177e4SLinus Torvalds 
1581adf30907SEric Dumazet 	skb_dst_drop(skb);
1582d8d1f30bSChangli Gao 	skb_dst_set(skb, &rt->dst);
1583eddc9ec5SArnaldo Carvalho de Melo 	ip_decrease_ttl(ip_hdr(skb));
15841da177e4SLinus Torvalds 
15851da177e4SLinus Torvalds 	/* FIXME: forward and output firewalls used to be called here.
15861da177e4SLinus Torvalds 	 * What do we do with netfilter? -- RR */
15871da177e4SLinus Torvalds 	if (vif->flags & VIFF_TUNNEL) {
15881da177e4SLinus Torvalds 		ip_encap(skb, vif->local, vif->remote);
15891da177e4SLinus Torvalds 		/* FIXME: extra output firewall step used to be here. --RR */
15902f4c02d4SPavel Emelyanov 		vif->dev->stats.tx_packets++;
15912f4c02d4SPavel Emelyanov 		vif->dev->stats.tx_bytes += skb->len;
15921da177e4SLinus Torvalds 	}
15931da177e4SLinus Torvalds 
15941da177e4SLinus Torvalds 	IPCB(skb)->flags |= IPSKB_FORWARDED;
15951da177e4SLinus Torvalds 
15961da177e4SLinus Torvalds 	/*
15971da177e4SLinus Torvalds 	 * RFC1584 teaches, that DVMRP/PIM router must deliver packets locally
15981da177e4SLinus Torvalds 	 * not only before forwarding, but after forwarding on all output
15991da177e4SLinus Torvalds 	 * interfaces. It is clear, if mrouter runs a multicasting
16001da177e4SLinus Torvalds 	 * program, it should receive packets not depending to what interface
16011da177e4SLinus Torvalds 	 * program is joined.
16021da177e4SLinus Torvalds 	 * If we will not make it, the program will have to join on all
16031da177e4SLinus Torvalds 	 * interfaces. On the other hand, multihoming host (or router, but
16041da177e4SLinus Torvalds 	 * not mrouter) cannot join to more than one interface - it will
16051da177e4SLinus Torvalds 	 * result in receiving multiple packets.
16061da177e4SLinus Torvalds 	 */
16079bbc768aSJan Engelhardt 	NF_HOOK(NFPROTO_IPV4, NF_INET_FORWARD, skb, skb->dev, dev,
16081da177e4SLinus Torvalds 		ipmr_forward_finish);
16091da177e4SLinus Torvalds 	return;
16101da177e4SLinus Torvalds 
16111da177e4SLinus Torvalds out_free:
16121da177e4SLinus Torvalds 	kfree_skb(skb);
16131da177e4SLinus Torvalds }
16141da177e4SLinus Torvalds 
16150c12295aSPatrick McHardy static int ipmr_find_vif(struct mr_table *mrt, struct net_device *dev)
16161da177e4SLinus Torvalds {
16171da177e4SLinus Torvalds 	int ct;
16180c12295aSPatrick McHardy 
16190c12295aSPatrick McHardy 	for (ct = mrt->maxvif-1; ct >= 0; ct--) {
16200c12295aSPatrick McHardy 		if (mrt->vif_table[ct].dev == dev)
16211da177e4SLinus Torvalds 			break;
16221da177e4SLinus Torvalds 	}
16231da177e4SLinus Torvalds 	return ct;
16241da177e4SLinus Torvalds }
16251da177e4SLinus Torvalds 
16261da177e4SLinus Torvalds /* "local" means that we should preserve one skb (for local delivery) */
16271da177e4SLinus Torvalds 
16280c12295aSPatrick McHardy static int ip_mr_forward(struct net *net, struct mr_table *mrt,
16290c12295aSPatrick McHardy 			 struct sk_buff *skb, struct mfc_cache *cache,
16300c12295aSPatrick McHardy 			 int local)
16311da177e4SLinus Torvalds {
16321da177e4SLinus Torvalds 	int psend = -1;
16331da177e4SLinus Torvalds 	int vif, ct;
16341da177e4SLinus Torvalds 
16351da177e4SLinus Torvalds 	vif = cache->mfc_parent;
16361da177e4SLinus Torvalds 	cache->mfc_un.res.pkt++;
16371da177e4SLinus Torvalds 	cache->mfc_un.res.bytes += skb->len;
16381da177e4SLinus Torvalds 
16391da177e4SLinus Torvalds 	/*
16401da177e4SLinus Torvalds 	 * Wrong interface: drop packet and (maybe) send PIM assert.
16411da177e4SLinus Torvalds 	 */
16420c12295aSPatrick McHardy 	if (mrt->vif_table[vif].dev != skb->dev) {
16431da177e4SLinus Torvalds 		int true_vifi;
16441da177e4SLinus Torvalds 
1645511c3f92SEric Dumazet 		if (skb_rtable(skb)->fl.iif == 0) {
16461da177e4SLinus Torvalds 			/* It is our own packet, looped back.
16471da177e4SLinus Torvalds 			   Very complicated situation...
16481da177e4SLinus Torvalds 
16491da177e4SLinus Torvalds 			   The best workaround until routing daemons will be
16501da177e4SLinus Torvalds 			   fixed is not to redistribute packet, if it was
16511da177e4SLinus Torvalds 			   send through wrong interface. It means, that
16521da177e4SLinus Torvalds 			   multicast applications WILL NOT work for
16531da177e4SLinus Torvalds 			   (S,G), which have default multicast route pointing
16541da177e4SLinus Torvalds 			   to wrong oif. In any case, it is not a good
16551da177e4SLinus Torvalds 			   idea to use multicasting applications on router.
16561da177e4SLinus Torvalds 			 */
16571da177e4SLinus Torvalds 			goto dont_forward;
16581da177e4SLinus Torvalds 		}
16591da177e4SLinus Torvalds 
16601da177e4SLinus Torvalds 		cache->mfc_un.res.wrong_if++;
16610c12295aSPatrick McHardy 		true_vifi = ipmr_find_vif(mrt, skb->dev);
16621da177e4SLinus Torvalds 
16630c12295aSPatrick McHardy 		if (true_vifi >= 0 && mrt->mroute_do_assert &&
16641da177e4SLinus Torvalds 		    /* pimsm uses asserts, when switching from RPT to SPT,
16651da177e4SLinus Torvalds 		       so that we cannot check that packet arrived on an oif.
16661da177e4SLinus Torvalds 		       It is bad, but otherwise we would need to move pretty
16671da177e4SLinus Torvalds 		       large chunk of pimd to kernel. Ough... --ANK
16681da177e4SLinus Torvalds 		     */
16690c12295aSPatrick McHardy 		    (mrt->mroute_do_pim ||
16706f9374a9SBenjamin Thery 		     cache->mfc_un.res.ttls[true_vifi] < 255) &&
16711da177e4SLinus Torvalds 		    time_after(jiffies,
16721da177e4SLinus Torvalds 			       cache->mfc_un.res.last_assert + MFC_ASSERT_THRESH)) {
16731da177e4SLinus Torvalds 			cache->mfc_un.res.last_assert = jiffies;
16740c12295aSPatrick McHardy 			ipmr_cache_report(mrt, skb, true_vifi, IGMPMSG_WRONGVIF);
16751da177e4SLinus Torvalds 		}
16761da177e4SLinus Torvalds 		goto dont_forward;
16771da177e4SLinus Torvalds 	}
16781da177e4SLinus Torvalds 
16790c12295aSPatrick McHardy 	mrt->vif_table[vif].pkt_in++;
16800c12295aSPatrick McHardy 	mrt->vif_table[vif].bytes_in += skb->len;
16811da177e4SLinus Torvalds 
16821da177e4SLinus Torvalds 	/*
16831da177e4SLinus Torvalds 	 *	Forward the frame
16841da177e4SLinus Torvalds 	 */
16851da177e4SLinus Torvalds 	for (ct = cache->mfc_un.res.maxvif-1; ct >= cache->mfc_un.res.minvif; ct--) {
1686eddc9ec5SArnaldo Carvalho de Melo 		if (ip_hdr(skb)->ttl > cache->mfc_un.res.ttls[ct]) {
16871da177e4SLinus Torvalds 			if (psend != -1) {
16881da177e4SLinus Torvalds 				struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
16891da177e4SLinus Torvalds 				if (skb2)
16900c12295aSPatrick McHardy 					ipmr_queue_xmit(net, mrt, skb2, cache,
16910c12295aSPatrick McHardy 							psend);
16921da177e4SLinus Torvalds 			}
16931da177e4SLinus Torvalds 			psend = ct;
16941da177e4SLinus Torvalds 		}
16951da177e4SLinus Torvalds 	}
16961da177e4SLinus Torvalds 	if (psend != -1) {
16971da177e4SLinus Torvalds 		if (local) {
16981da177e4SLinus Torvalds 			struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
16991da177e4SLinus Torvalds 			if (skb2)
17000c12295aSPatrick McHardy 				ipmr_queue_xmit(net, mrt, skb2, cache, psend);
17011da177e4SLinus Torvalds 		} else {
17020c12295aSPatrick McHardy 			ipmr_queue_xmit(net, mrt, skb, cache, psend);
17031da177e4SLinus Torvalds 			return 0;
17041da177e4SLinus Torvalds 		}
17051da177e4SLinus Torvalds 	}
17061da177e4SLinus Torvalds 
17071da177e4SLinus Torvalds dont_forward:
17081da177e4SLinus Torvalds 	if (!local)
17091da177e4SLinus Torvalds 		kfree_skb(skb);
17101da177e4SLinus Torvalds 	return 0;
17111da177e4SLinus Torvalds }
17121da177e4SLinus Torvalds 
17131da177e4SLinus Torvalds 
17141da177e4SLinus Torvalds /*
17151da177e4SLinus Torvalds  *	Multicast packets for forwarding arrive here
17161da177e4SLinus Torvalds  */
17171da177e4SLinus Torvalds 
17181da177e4SLinus Torvalds int ip_mr_input(struct sk_buff *skb)
17191da177e4SLinus Torvalds {
17201da177e4SLinus Torvalds 	struct mfc_cache *cache;
17214feb88e5SBenjamin Thery 	struct net *net = dev_net(skb->dev);
1722511c3f92SEric Dumazet 	int local = skb_rtable(skb)->rt_flags & RTCF_LOCAL;
1723f0ad0860SPatrick McHardy 	struct mr_table *mrt;
1724f0ad0860SPatrick McHardy 	int err;
17251da177e4SLinus Torvalds 
17261da177e4SLinus Torvalds 	/* Packet is looped back after forward, it should not be
17271da177e4SLinus Torvalds 	   forwarded second time, but still can be delivered locally.
17281da177e4SLinus Torvalds 	 */
17291da177e4SLinus Torvalds 	if (IPCB(skb)->flags&IPSKB_FORWARDED)
17301da177e4SLinus Torvalds 		goto dont_forward;
17311da177e4SLinus Torvalds 
1732f0ad0860SPatrick McHardy 	err = ipmr_fib_lookup(net, &skb_rtable(skb)->fl, &mrt);
1733e40dbc51SBen Greear 	if (err < 0) {
1734e40dbc51SBen Greear 		kfree_skb(skb);
1735f0ad0860SPatrick McHardy 		return err;
1736e40dbc51SBen Greear 	}
1737f0ad0860SPatrick McHardy 
17381da177e4SLinus Torvalds 	if (!local) {
17391da177e4SLinus Torvalds 		    if (IPCB(skb)->opt.router_alert) {
17401da177e4SLinus Torvalds 			    if (ip_call_ra_chain(skb))
17411da177e4SLinus Torvalds 				    return 0;
1742eddc9ec5SArnaldo Carvalho de Melo 		    } else if (ip_hdr(skb)->protocol == IPPROTO_IGMP){
17431da177e4SLinus Torvalds 			    /* IGMPv1 (and broken IGMPv2 implementations sort of
17441da177e4SLinus Torvalds 			       Cisco IOS <= 11.2(8)) do not put router alert
17451da177e4SLinus Torvalds 			       option to IGMP packets destined to routable
17461da177e4SLinus Torvalds 			       groups. It is very bad, because it means
17471da177e4SLinus Torvalds 			       that we can forward NO IGMP messages.
17481da177e4SLinus Torvalds 			     */
17491da177e4SLinus Torvalds 			    read_lock(&mrt_lock);
17500c12295aSPatrick McHardy 			    if (mrt->mroute_sk) {
17512715bcf9SPatrick McHardy 				    nf_reset(skb);
17520c12295aSPatrick McHardy 				    raw_rcv(mrt->mroute_sk, skb);
17531da177e4SLinus Torvalds 				    read_unlock(&mrt_lock);
17541da177e4SLinus Torvalds 				    return 0;
17551da177e4SLinus Torvalds 			    }
17561da177e4SLinus Torvalds 			    read_unlock(&mrt_lock);
17571da177e4SLinus Torvalds 		    }
17581da177e4SLinus Torvalds 	}
17591da177e4SLinus Torvalds 
17601da177e4SLinus Torvalds 	read_lock(&mrt_lock);
17610c12295aSPatrick McHardy 	cache = ipmr_cache_find(mrt, ip_hdr(skb)->saddr, ip_hdr(skb)->daddr);
17621da177e4SLinus Torvalds 
17631da177e4SLinus Torvalds 	/*
17641da177e4SLinus Torvalds 	 *	No usable cache entry
17651da177e4SLinus Torvalds 	 */
17661da177e4SLinus Torvalds 	if (cache == NULL) {
17671da177e4SLinus Torvalds 		int vif;
17681da177e4SLinus Torvalds 
17691da177e4SLinus Torvalds 		if (local) {
17701da177e4SLinus Torvalds 			struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
17711da177e4SLinus Torvalds 			ip_local_deliver(skb);
17721da177e4SLinus Torvalds 			if (skb2 == NULL) {
17731da177e4SLinus Torvalds 				read_unlock(&mrt_lock);
17741da177e4SLinus Torvalds 				return -ENOBUFS;
17751da177e4SLinus Torvalds 			}
17761da177e4SLinus Torvalds 			skb = skb2;
17771da177e4SLinus Torvalds 		}
17781da177e4SLinus Torvalds 
17790c12295aSPatrick McHardy 		vif = ipmr_find_vif(mrt, skb->dev);
17801da177e4SLinus Torvalds 		if (vif >= 0) {
17810eae88f3SEric Dumazet 			int err2 = ipmr_cache_unresolved(mrt, vif, skb);
17821da177e4SLinus Torvalds 			read_unlock(&mrt_lock);
17831da177e4SLinus Torvalds 
17840eae88f3SEric Dumazet 			return err2;
17851da177e4SLinus Torvalds 		}
17861da177e4SLinus Torvalds 		read_unlock(&mrt_lock);
17871da177e4SLinus Torvalds 		kfree_skb(skb);
17881da177e4SLinus Torvalds 		return -ENODEV;
17891da177e4SLinus Torvalds 	}
17901da177e4SLinus Torvalds 
17910c12295aSPatrick McHardy 	ip_mr_forward(net, mrt, skb, cache, local);
17921da177e4SLinus Torvalds 
17931da177e4SLinus Torvalds 	read_unlock(&mrt_lock);
17941da177e4SLinus Torvalds 
17951da177e4SLinus Torvalds 	if (local)
17961da177e4SLinus Torvalds 		return ip_local_deliver(skb);
17971da177e4SLinus Torvalds 
17981da177e4SLinus Torvalds 	return 0;
17991da177e4SLinus Torvalds 
18001da177e4SLinus Torvalds dont_forward:
18011da177e4SLinus Torvalds 	if (local)
18021da177e4SLinus Torvalds 		return ip_local_deliver(skb);
18031da177e4SLinus Torvalds 	kfree_skb(skb);
18041da177e4SLinus Torvalds 	return 0;
18051da177e4SLinus Torvalds }
18061da177e4SLinus Torvalds 
1807b1879204SIlpo Järvinen #ifdef CONFIG_IP_PIMSM
1808*55747a0aSEric Dumazet /* called with rcu_read_lock() */
1809f0ad0860SPatrick McHardy static int __pim_rcv(struct mr_table *mrt, struct sk_buff *skb,
1810f0ad0860SPatrick McHardy 		     unsigned int pimlen)
18111da177e4SLinus Torvalds {
18121da177e4SLinus Torvalds 	struct net_device *reg_dev = NULL;
1813b1879204SIlpo Järvinen 	struct iphdr *encap;
18141da177e4SLinus Torvalds 
1815b1879204SIlpo Järvinen 	encap = (struct iphdr *)(skb_transport_header(skb) + pimlen);
18161da177e4SLinus Torvalds 	/*
18171da177e4SLinus Torvalds 	   Check that:
18181da177e4SLinus Torvalds 	   a. packet is really destinted to a multicast group
18191da177e4SLinus Torvalds 	   b. packet is not a NULL-REGISTER
18201da177e4SLinus Torvalds 	   c. packet is not truncated
18211da177e4SLinus Torvalds 	 */
1822f97c1e0cSJoe Perches 	if (!ipv4_is_multicast(encap->daddr) ||
18231da177e4SLinus Torvalds 	    encap->tot_len == 0 ||
1824b1879204SIlpo Järvinen 	    ntohs(encap->tot_len) + pimlen > skb->len)
1825b1879204SIlpo Järvinen 		return 1;
18261da177e4SLinus Torvalds 
18271da177e4SLinus Torvalds 	read_lock(&mrt_lock);
18280c12295aSPatrick McHardy 	if (mrt->mroute_reg_vif_num >= 0)
18290c12295aSPatrick McHardy 		reg_dev = mrt->vif_table[mrt->mroute_reg_vif_num].dev;
18301da177e4SLinus Torvalds 	read_unlock(&mrt_lock);
18311da177e4SLinus Torvalds 
18321da177e4SLinus Torvalds 	if (reg_dev == NULL)
1833b1879204SIlpo Järvinen 		return 1;
18341da177e4SLinus Torvalds 
1835b0e380b1SArnaldo Carvalho de Melo 	skb->mac_header = skb->network_header;
18361da177e4SLinus Torvalds 	skb_pull(skb, (u8 *)encap - skb->data);
183731c7711bSArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
18381da177e4SLinus Torvalds 	skb->protocol = htons(ETH_P_IP);
1839*55747a0aSEric Dumazet 	skb->ip_summed = CHECKSUM_NONE;
18401da177e4SLinus Torvalds 	skb->pkt_type = PACKET_HOST;
1841d19d56ddSEric Dumazet 
1842d19d56ddSEric Dumazet 	skb_tunnel_rx(skb, reg_dev);
1843d19d56ddSEric Dumazet 
18441da177e4SLinus Torvalds 	netif_rx(skb);
1845b1879204SIlpo Järvinen 
1846*55747a0aSEric Dumazet 	return NET_RX_SUCCESS;
1847b1879204SIlpo Järvinen }
1848b1879204SIlpo Järvinen #endif
1849b1879204SIlpo Järvinen 
1850b1879204SIlpo Järvinen #ifdef CONFIG_IP_PIMSM_V1
1851b1879204SIlpo Järvinen /*
1852b1879204SIlpo Järvinen  * Handle IGMP messages of PIMv1
1853b1879204SIlpo Järvinen  */
1854b1879204SIlpo Järvinen 
1855b1879204SIlpo Järvinen int pim_rcv_v1(struct sk_buff * skb)
1856b1879204SIlpo Järvinen {
1857b1879204SIlpo Järvinen 	struct igmphdr *pim;
18584feb88e5SBenjamin Thery 	struct net *net = dev_net(skb->dev);
1859f0ad0860SPatrick McHardy 	struct mr_table *mrt;
1860b1879204SIlpo Järvinen 
1861b1879204SIlpo Järvinen 	if (!pskb_may_pull(skb, sizeof(*pim) + sizeof(struct iphdr)))
1862b1879204SIlpo Järvinen 		goto drop;
1863b1879204SIlpo Järvinen 
1864b1879204SIlpo Järvinen 	pim = igmp_hdr(skb);
1865b1879204SIlpo Järvinen 
1866f0ad0860SPatrick McHardy 	if (ipmr_fib_lookup(net, &skb_rtable(skb)->fl, &mrt) < 0)
1867f0ad0860SPatrick McHardy 		goto drop;
1868f0ad0860SPatrick McHardy 
18690c12295aSPatrick McHardy 	if (!mrt->mroute_do_pim ||
1870b1879204SIlpo Järvinen 	    pim->group != PIM_V1_VERSION || pim->code != PIM_V1_REGISTER)
1871b1879204SIlpo Järvinen 		goto drop;
1872b1879204SIlpo Järvinen 
1873f0ad0860SPatrick McHardy 	if (__pim_rcv(mrt, skb, sizeof(*pim))) {
18741da177e4SLinus Torvalds drop:
18751da177e4SLinus Torvalds 		kfree_skb(skb);
1876b1879204SIlpo Järvinen 	}
18771da177e4SLinus Torvalds 	return 0;
18781da177e4SLinus Torvalds }
18791da177e4SLinus Torvalds #endif
18801da177e4SLinus Torvalds 
18811da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM_V2
18821da177e4SLinus Torvalds static int pim_rcv(struct sk_buff * skb)
18831da177e4SLinus Torvalds {
18841da177e4SLinus Torvalds 	struct pimreghdr *pim;
1885f0ad0860SPatrick McHardy 	struct net *net = dev_net(skb->dev);
1886f0ad0860SPatrick McHardy 	struct mr_table *mrt;
18871da177e4SLinus Torvalds 
1888b1879204SIlpo Järvinen 	if (!pskb_may_pull(skb, sizeof(*pim) + sizeof(struct iphdr)))
18891da177e4SLinus Torvalds 		goto drop;
18901da177e4SLinus Torvalds 
18919c70220bSArnaldo Carvalho de Melo 	pim = (struct pimreghdr *)skb_transport_header(skb);
18921da177e4SLinus Torvalds 	if (pim->type != ((PIM_VERSION<<4)|(PIM_REGISTER)) ||
18931da177e4SLinus Torvalds 	    (pim->flags&PIM_NULL_REGISTER) ||
18941da177e4SLinus Torvalds 	    (ip_compute_csum((void *)pim, sizeof(*pim)) != 0 &&
1895d3bc23e7SAl Viro 	     csum_fold(skb_checksum(skb, 0, skb->len, 0))))
18961da177e4SLinus Torvalds 		goto drop;
18971da177e4SLinus Torvalds 
1898f0ad0860SPatrick McHardy 	if (ipmr_fib_lookup(net, &skb_rtable(skb)->fl, &mrt) < 0)
1899f0ad0860SPatrick McHardy 		goto drop;
1900f0ad0860SPatrick McHardy 
1901f0ad0860SPatrick McHardy 	if (__pim_rcv(mrt, skb, sizeof(*pim))) {
19021da177e4SLinus Torvalds drop:
19031da177e4SLinus Torvalds 		kfree_skb(skb);
1904b1879204SIlpo Järvinen 	}
19051da177e4SLinus Torvalds 	return 0;
19061da177e4SLinus Torvalds }
19071da177e4SLinus Torvalds #endif
19081da177e4SLinus Torvalds 
1909cb6a4e46SPatrick McHardy static int __ipmr_fill_mroute(struct mr_table *mrt, struct sk_buff *skb,
1910cb6a4e46SPatrick McHardy 			      struct mfc_cache *c, struct rtmsg *rtm)
19111da177e4SLinus Torvalds {
19121da177e4SLinus Torvalds 	int ct;
19131da177e4SLinus Torvalds 	struct rtnexthop *nhp;
191427a884dcSArnaldo Carvalho de Melo 	u8 *b = skb_tail_pointer(skb);
19151da177e4SLinus Torvalds 	struct rtattr *mp_head;
19161da177e4SLinus Torvalds 
19177438189bSNicolas Dichtel 	/* If cache is unresolved, don't try to parse IIF and OIF */
1918ed0f160aSDan Carpenter 	if (c->mfc_parent >= MAXVIFS)
19197438189bSNicolas Dichtel 		return -ENOENT;
19207438189bSNicolas Dichtel 
19210c12295aSPatrick McHardy 	if (VIF_EXISTS(mrt, c->mfc_parent))
19220c12295aSPatrick McHardy 		RTA_PUT(skb, RTA_IIF, 4, &mrt->vif_table[c->mfc_parent].dev->ifindex);
19231da177e4SLinus Torvalds 
19241da177e4SLinus Torvalds 	mp_head = (struct rtattr *)skb_put(skb, RTA_LENGTH(0));
19251da177e4SLinus Torvalds 
19261da177e4SLinus Torvalds 	for (ct = c->mfc_un.res.minvif; ct < c->mfc_un.res.maxvif; ct++) {
19270c12295aSPatrick McHardy 		if (VIF_EXISTS(mrt, ct) && c->mfc_un.res.ttls[ct] < 255) {
19281da177e4SLinus Torvalds 			if (skb_tailroom(skb) < RTA_ALIGN(RTA_ALIGN(sizeof(*nhp)) + 4))
19291da177e4SLinus Torvalds 				goto rtattr_failure;
19301da177e4SLinus Torvalds 			nhp = (struct rtnexthop *)skb_put(skb, RTA_ALIGN(sizeof(*nhp)));
19311da177e4SLinus Torvalds 			nhp->rtnh_flags = 0;
19321da177e4SLinus Torvalds 			nhp->rtnh_hops = c->mfc_un.res.ttls[ct];
19330c12295aSPatrick McHardy 			nhp->rtnh_ifindex = mrt->vif_table[ct].dev->ifindex;
19341da177e4SLinus Torvalds 			nhp->rtnh_len = sizeof(*nhp);
19351da177e4SLinus Torvalds 		}
19361da177e4SLinus Torvalds 	}
19371da177e4SLinus Torvalds 	mp_head->rta_type = RTA_MULTIPATH;
193827a884dcSArnaldo Carvalho de Melo 	mp_head->rta_len = skb_tail_pointer(skb) - (u8 *)mp_head;
19391da177e4SLinus Torvalds 	rtm->rtm_type = RTN_MULTICAST;
19401da177e4SLinus Torvalds 	return 1;
19411da177e4SLinus Torvalds 
19421da177e4SLinus Torvalds rtattr_failure:
1943dc5fc579SArnaldo Carvalho de Melo 	nlmsg_trim(skb, b);
19441da177e4SLinus Torvalds 	return -EMSGSIZE;
19451da177e4SLinus Torvalds }
19461da177e4SLinus Torvalds 
19474feb88e5SBenjamin Thery int ipmr_get_route(struct net *net,
19484feb88e5SBenjamin Thery 		   struct sk_buff *skb, struct rtmsg *rtm, int nowait)
19491da177e4SLinus Torvalds {
19501da177e4SLinus Torvalds 	int err;
1951f0ad0860SPatrick McHardy 	struct mr_table *mrt;
19521da177e4SLinus Torvalds 	struct mfc_cache *cache;
1953511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
19541da177e4SLinus Torvalds 
1955f0ad0860SPatrick McHardy 	mrt = ipmr_get_table(net, RT_TABLE_DEFAULT);
1956f0ad0860SPatrick McHardy 	if (mrt == NULL)
1957f0ad0860SPatrick McHardy 		return -ENOENT;
1958f0ad0860SPatrick McHardy 
19591da177e4SLinus Torvalds 	read_lock(&mrt_lock);
19600c12295aSPatrick McHardy 	cache = ipmr_cache_find(mrt, rt->rt_src, rt->rt_dst);
19611da177e4SLinus Torvalds 
19621da177e4SLinus Torvalds 	if (cache == NULL) {
196372287490SAlexey Kuznetsov 		struct sk_buff *skb2;
1964eddc9ec5SArnaldo Carvalho de Melo 		struct iphdr *iph;
19651da177e4SLinus Torvalds 		struct net_device *dev;
19661da177e4SLinus Torvalds 		int vif;
19671da177e4SLinus Torvalds 
19681da177e4SLinus Torvalds 		if (nowait) {
19691da177e4SLinus Torvalds 			read_unlock(&mrt_lock);
19701da177e4SLinus Torvalds 			return -EAGAIN;
19711da177e4SLinus Torvalds 		}
19721da177e4SLinus Torvalds 
19731da177e4SLinus Torvalds 		dev = skb->dev;
19740c12295aSPatrick McHardy 		if (dev == NULL || (vif = ipmr_find_vif(mrt, dev)) < 0) {
19751da177e4SLinus Torvalds 			read_unlock(&mrt_lock);
19761da177e4SLinus Torvalds 			return -ENODEV;
19771da177e4SLinus Torvalds 		}
197872287490SAlexey Kuznetsov 		skb2 = skb_clone(skb, GFP_ATOMIC);
197972287490SAlexey Kuznetsov 		if (!skb2) {
198072287490SAlexey Kuznetsov 			read_unlock(&mrt_lock);
198172287490SAlexey Kuznetsov 			return -ENOMEM;
198272287490SAlexey Kuznetsov 		}
198372287490SAlexey Kuznetsov 
1984e2d1bca7SArnaldo Carvalho de Melo 		skb_push(skb2, sizeof(struct iphdr));
1985e2d1bca7SArnaldo Carvalho de Melo 		skb_reset_network_header(skb2);
1986eddc9ec5SArnaldo Carvalho de Melo 		iph = ip_hdr(skb2);
1987eddc9ec5SArnaldo Carvalho de Melo 		iph->ihl = sizeof(struct iphdr) >> 2;
1988eddc9ec5SArnaldo Carvalho de Melo 		iph->saddr = rt->rt_src;
1989eddc9ec5SArnaldo Carvalho de Melo 		iph->daddr = rt->rt_dst;
1990eddc9ec5SArnaldo Carvalho de Melo 		iph->version = 0;
19910c12295aSPatrick McHardy 		err = ipmr_cache_unresolved(mrt, vif, skb2);
19921da177e4SLinus Torvalds 		read_unlock(&mrt_lock);
19931da177e4SLinus Torvalds 		return err;
19941da177e4SLinus Torvalds 	}
19951da177e4SLinus Torvalds 
19961da177e4SLinus Torvalds 	if (!nowait && (rtm->rtm_flags&RTM_F_NOTIFY))
19971da177e4SLinus Torvalds 		cache->mfc_flags |= MFC_NOTIFY;
1998cb6a4e46SPatrick McHardy 	err = __ipmr_fill_mroute(mrt, skb, cache, rtm);
19991da177e4SLinus Torvalds 	read_unlock(&mrt_lock);
20001da177e4SLinus Torvalds 	return err;
20011da177e4SLinus Torvalds }
20021da177e4SLinus Torvalds 
2003cb6a4e46SPatrick McHardy static int ipmr_fill_mroute(struct mr_table *mrt, struct sk_buff *skb,
2004cb6a4e46SPatrick McHardy 			    u32 pid, u32 seq, struct mfc_cache *c)
2005cb6a4e46SPatrick McHardy {
2006cb6a4e46SPatrick McHardy 	struct nlmsghdr *nlh;
2007cb6a4e46SPatrick McHardy 	struct rtmsg *rtm;
2008cb6a4e46SPatrick McHardy 
2009cb6a4e46SPatrick McHardy 	nlh = nlmsg_put(skb, pid, seq, RTM_NEWROUTE, sizeof(*rtm), NLM_F_MULTI);
2010cb6a4e46SPatrick McHardy 	if (nlh == NULL)
2011cb6a4e46SPatrick McHardy 		return -EMSGSIZE;
2012cb6a4e46SPatrick McHardy 
2013cb6a4e46SPatrick McHardy 	rtm = nlmsg_data(nlh);
2014cb6a4e46SPatrick McHardy 	rtm->rtm_family   = RTNL_FAMILY_IPMR;
2015cb6a4e46SPatrick McHardy 	rtm->rtm_dst_len  = 32;
2016cb6a4e46SPatrick McHardy 	rtm->rtm_src_len  = 32;
2017cb6a4e46SPatrick McHardy 	rtm->rtm_tos      = 0;
2018cb6a4e46SPatrick McHardy 	rtm->rtm_table    = mrt->id;
2019cb6a4e46SPatrick McHardy 	NLA_PUT_U32(skb, RTA_TABLE, mrt->id);
2020cb6a4e46SPatrick McHardy 	rtm->rtm_type     = RTN_MULTICAST;
2021cb6a4e46SPatrick McHardy 	rtm->rtm_scope    = RT_SCOPE_UNIVERSE;
2022cb6a4e46SPatrick McHardy 	rtm->rtm_protocol = RTPROT_UNSPEC;
2023cb6a4e46SPatrick McHardy 	rtm->rtm_flags    = 0;
2024cb6a4e46SPatrick McHardy 
2025cb6a4e46SPatrick McHardy 	NLA_PUT_BE32(skb, RTA_SRC, c->mfc_origin);
2026cb6a4e46SPatrick McHardy 	NLA_PUT_BE32(skb, RTA_DST, c->mfc_mcastgrp);
2027cb6a4e46SPatrick McHardy 
2028cb6a4e46SPatrick McHardy 	if (__ipmr_fill_mroute(mrt, skb, c, rtm) < 0)
2029cb6a4e46SPatrick McHardy 		goto nla_put_failure;
2030cb6a4e46SPatrick McHardy 
2031cb6a4e46SPatrick McHardy 	return nlmsg_end(skb, nlh);
2032cb6a4e46SPatrick McHardy 
2033cb6a4e46SPatrick McHardy nla_put_failure:
2034cb6a4e46SPatrick McHardy 	nlmsg_cancel(skb, nlh);
2035cb6a4e46SPatrick McHardy 	return -EMSGSIZE;
2036cb6a4e46SPatrick McHardy }
2037cb6a4e46SPatrick McHardy 
2038cb6a4e46SPatrick McHardy static int ipmr_rtm_dumproute(struct sk_buff *skb, struct netlink_callback *cb)
2039cb6a4e46SPatrick McHardy {
2040cb6a4e46SPatrick McHardy 	struct net *net = sock_net(skb->sk);
2041cb6a4e46SPatrick McHardy 	struct mr_table *mrt;
2042cb6a4e46SPatrick McHardy 	struct mfc_cache *mfc;
2043cb6a4e46SPatrick McHardy 	unsigned int t = 0, s_t;
2044cb6a4e46SPatrick McHardy 	unsigned int h = 0, s_h;
2045cb6a4e46SPatrick McHardy 	unsigned int e = 0, s_e;
2046cb6a4e46SPatrick McHardy 
2047cb6a4e46SPatrick McHardy 	s_t = cb->args[0];
2048cb6a4e46SPatrick McHardy 	s_h = cb->args[1];
2049cb6a4e46SPatrick McHardy 	s_e = cb->args[2];
2050cb6a4e46SPatrick McHardy 
2051cb6a4e46SPatrick McHardy 	read_lock(&mrt_lock);
2052cb6a4e46SPatrick McHardy 	ipmr_for_each_table(mrt, net) {
2053cb6a4e46SPatrick McHardy 		if (t < s_t)
2054cb6a4e46SPatrick McHardy 			goto next_table;
2055cb6a4e46SPatrick McHardy 		if (t > s_t)
2056cb6a4e46SPatrick McHardy 			s_h = 0;
2057cb6a4e46SPatrick McHardy 		for (h = s_h; h < MFC_LINES; h++) {
2058cb6a4e46SPatrick McHardy 			list_for_each_entry(mfc, &mrt->mfc_cache_array[h], list) {
2059cb6a4e46SPatrick McHardy 				if (e < s_e)
2060cb6a4e46SPatrick McHardy 					goto next_entry;
2061cb6a4e46SPatrick McHardy 				if (ipmr_fill_mroute(mrt, skb,
2062cb6a4e46SPatrick McHardy 						     NETLINK_CB(cb->skb).pid,
2063cb6a4e46SPatrick McHardy 						     cb->nlh->nlmsg_seq,
2064cb6a4e46SPatrick McHardy 						     mfc) < 0)
2065cb6a4e46SPatrick McHardy 					goto done;
2066cb6a4e46SPatrick McHardy next_entry:
2067cb6a4e46SPatrick McHardy 				e++;
2068cb6a4e46SPatrick McHardy 			}
2069cb6a4e46SPatrick McHardy 			e = s_e = 0;
2070cb6a4e46SPatrick McHardy 		}
2071cb6a4e46SPatrick McHardy 		s_h = 0;
2072cb6a4e46SPatrick McHardy next_table:
2073cb6a4e46SPatrick McHardy 		t++;
2074cb6a4e46SPatrick McHardy 	}
2075cb6a4e46SPatrick McHardy done:
2076cb6a4e46SPatrick McHardy 	read_unlock(&mrt_lock);
2077cb6a4e46SPatrick McHardy 
2078cb6a4e46SPatrick McHardy 	cb->args[2] = e;
2079cb6a4e46SPatrick McHardy 	cb->args[1] = h;
2080cb6a4e46SPatrick McHardy 	cb->args[0] = t;
2081cb6a4e46SPatrick McHardy 
2082cb6a4e46SPatrick McHardy 	return skb->len;
2083cb6a4e46SPatrick McHardy }
2084cb6a4e46SPatrick McHardy 
20851da177e4SLinus Torvalds #ifdef CONFIG_PROC_FS
20861da177e4SLinus Torvalds /*
20871da177e4SLinus Torvalds  *	The /proc interfaces to multicast routing /proc/ip_mr_cache /proc/ip_mr_vif
20881da177e4SLinus Torvalds  */
20891da177e4SLinus Torvalds struct ipmr_vif_iter {
2090f6bb4514SBenjamin Thery 	struct seq_net_private p;
2091f0ad0860SPatrick McHardy 	struct mr_table *mrt;
20921da177e4SLinus Torvalds 	int ct;
20931da177e4SLinus Torvalds };
20941da177e4SLinus Torvalds 
2095f6bb4514SBenjamin Thery static struct vif_device *ipmr_vif_seq_idx(struct net *net,
2096f6bb4514SBenjamin Thery 					   struct ipmr_vif_iter *iter,
20971da177e4SLinus Torvalds 					   loff_t pos)
20981da177e4SLinus Torvalds {
2099f0ad0860SPatrick McHardy 	struct mr_table *mrt = iter->mrt;
21000c12295aSPatrick McHardy 
21010c12295aSPatrick McHardy 	for (iter->ct = 0; iter->ct < mrt->maxvif; ++iter->ct) {
21020c12295aSPatrick McHardy 		if (!VIF_EXISTS(mrt, iter->ct))
21031da177e4SLinus Torvalds 			continue;
21041da177e4SLinus Torvalds 		if (pos-- == 0)
21050c12295aSPatrick McHardy 			return &mrt->vif_table[iter->ct];
21061da177e4SLinus Torvalds 	}
21071da177e4SLinus Torvalds 	return NULL;
21081da177e4SLinus Torvalds }
21091da177e4SLinus Torvalds 
21101da177e4SLinus Torvalds static void *ipmr_vif_seq_start(struct seq_file *seq, loff_t *pos)
2111ba93ef74SStephen Hemminger 	__acquires(mrt_lock)
21121da177e4SLinus Torvalds {
2113f0ad0860SPatrick McHardy 	struct ipmr_vif_iter *iter = seq->private;
2114f6bb4514SBenjamin Thery 	struct net *net = seq_file_net(seq);
2115f0ad0860SPatrick McHardy 	struct mr_table *mrt;
2116f0ad0860SPatrick McHardy 
2117f0ad0860SPatrick McHardy 	mrt = ipmr_get_table(net, RT_TABLE_DEFAULT);
2118f0ad0860SPatrick McHardy 	if (mrt == NULL)
2119f0ad0860SPatrick McHardy 		return ERR_PTR(-ENOENT);
2120f0ad0860SPatrick McHardy 
2121f0ad0860SPatrick McHardy 	iter->mrt = mrt;
2122f6bb4514SBenjamin Thery 
21231da177e4SLinus Torvalds 	read_lock(&mrt_lock);
2124f6bb4514SBenjamin Thery 	return *pos ? ipmr_vif_seq_idx(net, seq->private, *pos - 1)
21251da177e4SLinus Torvalds 		: SEQ_START_TOKEN;
21261da177e4SLinus Torvalds }
21271da177e4SLinus Torvalds 
21281da177e4SLinus Torvalds static void *ipmr_vif_seq_next(struct seq_file *seq, void *v, loff_t *pos)
21291da177e4SLinus Torvalds {
21301da177e4SLinus Torvalds 	struct ipmr_vif_iter *iter = seq->private;
2131f6bb4514SBenjamin Thery 	struct net *net = seq_file_net(seq);
2132f0ad0860SPatrick McHardy 	struct mr_table *mrt = iter->mrt;
21331da177e4SLinus Torvalds 
21341da177e4SLinus Torvalds 	++*pos;
21351da177e4SLinus Torvalds 	if (v == SEQ_START_TOKEN)
2136f6bb4514SBenjamin Thery 		return ipmr_vif_seq_idx(net, iter, 0);
21371da177e4SLinus Torvalds 
21380c12295aSPatrick McHardy 	while (++iter->ct < mrt->maxvif) {
21390c12295aSPatrick McHardy 		if (!VIF_EXISTS(mrt, iter->ct))
21401da177e4SLinus Torvalds 			continue;
21410c12295aSPatrick McHardy 		return &mrt->vif_table[iter->ct];
21421da177e4SLinus Torvalds 	}
21431da177e4SLinus Torvalds 	return NULL;
21441da177e4SLinus Torvalds }
21451da177e4SLinus Torvalds 
21461da177e4SLinus Torvalds static void ipmr_vif_seq_stop(struct seq_file *seq, void *v)
2147ba93ef74SStephen Hemminger 	__releases(mrt_lock)
21481da177e4SLinus Torvalds {
21491da177e4SLinus Torvalds 	read_unlock(&mrt_lock);
21501da177e4SLinus Torvalds }
21511da177e4SLinus Torvalds 
21521da177e4SLinus Torvalds static int ipmr_vif_seq_show(struct seq_file *seq, void *v)
21531da177e4SLinus Torvalds {
2154f0ad0860SPatrick McHardy 	struct ipmr_vif_iter *iter = seq->private;
2155f0ad0860SPatrick McHardy 	struct mr_table *mrt = iter->mrt;
2156f6bb4514SBenjamin Thery 
21571da177e4SLinus Torvalds 	if (v == SEQ_START_TOKEN) {
21581da177e4SLinus Torvalds 		seq_puts(seq,
21591da177e4SLinus Torvalds 			 "Interface      BytesIn  PktsIn  BytesOut PktsOut Flags Local    Remote\n");
21601da177e4SLinus Torvalds 	} else {
21611da177e4SLinus Torvalds 		const struct vif_device *vif = v;
21621da177e4SLinus Torvalds 		const char *name =  vif->dev ? vif->dev->name : "none";
21631da177e4SLinus Torvalds 
21641da177e4SLinus Torvalds 		seq_printf(seq,
21651da177e4SLinus Torvalds 			   "%2Zd %-10s %8ld %7ld  %8ld %7ld %05X %08X %08X\n",
21660c12295aSPatrick McHardy 			   vif - mrt->vif_table,
21671da177e4SLinus Torvalds 			   name, vif->bytes_in, vif->pkt_in,
21681da177e4SLinus Torvalds 			   vif->bytes_out, vif->pkt_out,
21691da177e4SLinus Torvalds 			   vif->flags, vif->local, vif->remote);
21701da177e4SLinus Torvalds 	}
21711da177e4SLinus Torvalds 	return 0;
21721da177e4SLinus Torvalds }
21731da177e4SLinus Torvalds 
2174f690808eSStephen Hemminger static const struct seq_operations ipmr_vif_seq_ops = {
21751da177e4SLinus Torvalds 	.start = ipmr_vif_seq_start,
21761da177e4SLinus Torvalds 	.next  = ipmr_vif_seq_next,
21771da177e4SLinus Torvalds 	.stop  = ipmr_vif_seq_stop,
21781da177e4SLinus Torvalds 	.show  = ipmr_vif_seq_show,
21791da177e4SLinus Torvalds };
21801da177e4SLinus Torvalds 
21811da177e4SLinus Torvalds static int ipmr_vif_open(struct inode *inode, struct file *file)
21821da177e4SLinus Torvalds {
2183f6bb4514SBenjamin Thery 	return seq_open_net(inode, file, &ipmr_vif_seq_ops,
2184cf7732e4SPavel Emelyanov 			    sizeof(struct ipmr_vif_iter));
21851da177e4SLinus Torvalds }
21861da177e4SLinus Torvalds 
21879a32144eSArjan van de Ven static const struct file_operations ipmr_vif_fops = {
21881da177e4SLinus Torvalds 	.owner	 = THIS_MODULE,
21891da177e4SLinus Torvalds 	.open    = ipmr_vif_open,
21901da177e4SLinus Torvalds 	.read    = seq_read,
21911da177e4SLinus Torvalds 	.llseek  = seq_lseek,
2192f6bb4514SBenjamin Thery 	.release = seq_release_net,
21931da177e4SLinus Torvalds };
21941da177e4SLinus Torvalds 
21951da177e4SLinus Torvalds struct ipmr_mfc_iter {
2196f6bb4514SBenjamin Thery 	struct seq_net_private p;
2197f0ad0860SPatrick McHardy 	struct mr_table *mrt;
2198862465f2SPatrick McHardy 	struct list_head *cache;
21991da177e4SLinus Torvalds 	int ct;
22001da177e4SLinus Torvalds };
22011da177e4SLinus Torvalds 
22021da177e4SLinus Torvalds 
2203f6bb4514SBenjamin Thery static struct mfc_cache *ipmr_mfc_seq_idx(struct net *net,
2204f6bb4514SBenjamin Thery 					  struct ipmr_mfc_iter *it, loff_t pos)
22051da177e4SLinus Torvalds {
2206f0ad0860SPatrick McHardy 	struct mr_table *mrt = it->mrt;
22071da177e4SLinus Torvalds 	struct mfc_cache *mfc;
22081da177e4SLinus Torvalds 
22091da177e4SLinus Torvalds 	read_lock(&mrt_lock);
2210862465f2SPatrick McHardy 	for (it->ct = 0; it->ct < MFC_LINES; it->ct++) {
22110c12295aSPatrick McHardy 		it->cache = &mrt->mfc_cache_array[it->ct];
2212862465f2SPatrick McHardy 		list_for_each_entry(mfc, it->cache, list)
22131da177e4SLinus Torvalds 			if (pos-- == 0)
22141da177e4SLinus Torvalds 				return mfc;
2215862465f2SPatrick McHardy 	}
22161da177e4SLinus Torvalds 	read_unlock(&mrt_lock);
22171da177e4SLinus Torvalds 
22181da177e4SLinus Torvalds 	spin_lock_bh(&mfc_unres_lock);
22190c12295aSPatrick McHardy 	it->cache = &mrt->mfc_unres_queue;
2220862465f2SPatrick McHardy 	list_for_each_entry(mfc, it->cache, list)
2221e258beb2SPatrick McHardy 		if (pos-- == 0)
22221da177e4SLinus Torvalds 			return mfc;
22231da177e4SLinus Torvalds 	spin_unlock_bh(&mfc_unres_lock);
22241da177e4SLinus Torvalds 
22251da177e4SLinus Torvalds 	it->cache = NULL;
22261da177e4SLinus Torvalds 	return NULL;
22271da177e4SLinus Torvalds }
22281da177e4SLinus Torvalds 
22291da177e4SLinus Torvalds 
22301da177e4SLinus Torvalds static void *ipmr_mfc_seq_start(struct seq_file *seq, loff_t *pos)
22311da177e4SLinus Torvalds {
22321da177e4SLinus Torvalds 	struct ipmr_mfc_iter *it = seq->private;
2233f6bb4514SBenjamin Thery 	struct net *net = seq_file_net(seq);
2234f0ad0860SPatrick McHardy 	struct mr_table *mrt;
2235f6bb4514SBenjamin Thery 
2236f0ad0860SPatrick McHardy 	mrt = ipmr_get_table(net, RT_TABLE_DEFAULT);
2237f0ad0860SPatrick McHardy 	if (mrt == NULL)
2238f0ad0860SPatrick McHardy 		return ERR_PTR(-ENOENT);
2239f0ad0860SPatrick McHardy 
2240f0ad0860SPatrick McHardy 	it->mrt = mrt;
22411da177e4SLinus Torvalds 	it->cache = NULL;
22421da177e4SLinus Torvalds 	it->ct = 0;
2243f6bb4514SBenjamin Thery 	return *pos ? ipmr_mfc_seq_idx(net, seq->private, *pos - 1)
22441da177e4SLinus Torvalds 		: SEQ_START_TOKEN;
22451da177e4SLinus Torvalds }
22461da177e4SLinus Torvalds 
22471da177e4SLinus Torvalds static void *ipmr_mfc_seq_next(struct seq_file *seq, void *v, loff_t *pos)
22481da177e4SLinus Torvalds {
22491da177e4SLinus Torvalds 	struct mfc_cache *mfc = v;
22501da177e4SLinus Torvalds 	struct ipmr_mfc_iter *it = seq->private;
2251f6bb4514SBenjamin Thery 	struct net *net = seq_file_net(seq);
2252f0ad0860SPatrick McHardy 	struct mr_table *mrt = it->mrt;
22531da177e4SLinus Torvalds 
22541da177e4SLinus Torvalds 	++*pos;
22551da177e4SLinus Torvalds 
22561da177e4SLinus Torvalds 	if (v == SEQ_START_TOKEN)
2257f6bb4514SBenjamin Thery 		return ipmr_mfc_seq_idx(net, seq->private, 0);
22581da177e4SLinus Torvalds 
2259862465f2SPatrick McHardy 	if (mfc->list.next != it->cache)
2260862465f2SPatrick McHardy 		return list_entry(mfc->list.next, struct mfc_cache, list);
22611da177e4SLinus Torvalds 
22620c12295aSPatrick McHardy 	if (it->cache == &mrt->mfc_unres_queue)
22631da177e4SLinus Torvalds 		goto end_of_list;
22641da177e4SLinus Torvalds 
22650c12295aSPatrick McHardy 	BUG_ON(it->cache != &mrt->mfc_cache_array[it->ct]);
22661da177e4SLinus Torvalds 
22671da177e4SLinus Torvalds 	while (++it->ct < MFC_LINES) {
22680c12295aSPatrick McHardy 		it->cache = &mrt->mfc_cache_array[it->ct];
2269862465f2SPatrick McHardy 		if (list_empty(it->cache))
2270862465f2SPatrick McHardy 			continue;
2271862465f2SPatrick McHardy 		return list_first_entry(it->cache, struct mfc_cache, list);
22721da177e4SLinus Torvalds 	}
22731da177e4SLinus Torvalds 
22741da177e4SLinus Torvalds 	/* exhausted cache_array, show unresolved */
22751da177e4SLinus Torvalds 	read_unlock(&mrt_lock);
22760c12295aSPatrick McHardy 	it->cache = &mrt->mfc_unres_queue;
22771da177e4SLinus Torvalds 	it->ct = 0;
22781da177e4SLinus Torvalds 
22791da177e4SLinus Torvalds 	spin_lock_bh(&mfc_unres_lock);
2280862465f2SPatrick McHardy 	if (!list_empty(it->cache))
2281862465f2SPatrick McHardy 		return list_first_entry(it->cache, struct mfc_cache, list);
22821da177e4SLinus Torvalds 
22831da177e4SLinus Torvalds  end_of_list:
22841da177e4SLinus Torvalds 	spin_unlock_bh(&mfc_unres_lock);
22851da177e4SLinus Torvalds 	it->cache = NULL;
22861da177e4SLinus Torvalds 
22871da177e4SLinus Torvalds 	return NULL;
22881da177e4SLinus Torvalds }
22891da177e4SLinus Torvalds 
22901da177e4SLinus Torvalds static void ipmr_mfc_seq_stop(struct seq_file *seq, void *v)
22911da177e4SLinus Torvalds {
22921da177e4SLinus Torvalds 	struct ipmr_mfc_iter *it = seq->private;
2293f0ad0860SPatrick McHardy 	struct mr_table *mrt = it->mrt;
22941da177e4SLinus Torvalds 
22950c12295aSPatrick McHardy 	if (it->cache == &mrt->mfc_unres_queue)
22961da177e4SLinus Torvalds 		spin_unlock_bh(&mfc_unres_lock);
22970c12295aSPatrick McHardy 	else if (it->cache == &mrt->mfc_cache_array[it->ct])
22981da177e4SLinus Torvalds 		read_unlock(&mrt_lock);
22991da177e4SLinus Torvalds }
23001da177e4SLinus Torvalds 
23011da177e4SLinus Torvalds static int ipmr_mfc_seq_show(struct seq_file *seq, void *v)
23021da177e4SLinus Torvalds {
23031da177e4SLinus Torvalds 	int n;
23041da177e4SLinus Torvalds 
23051da177e4SLinus Torvalds 	if (v == SEQ_START_TOKEN) {
23061da177e4SLinus Torvalds 		seq_puts(seq,
23071da177e4SLinus Torvalds 		 "Group    Origin   Iif     Pkts    Bytes    Wrong Oifs\n");
23081da177e4SLinus Torvalds 	} else {
23091da177e4SLinus Torvalds 		const struct mfc_cache *mfc = v;
23101da177e4SLinus Torvalds 		const struct ipmr_mfc_iter *it = seq->private;
2311f0ad0860SPatrick McHardy 		const struct mr_table *mrt = it->mrt;
23121da177e4SLinus Torvalds 
23130eae88f3SEric Dumazet 		seq_printf(seq, "%08X %08X %-3hd",
23140eae88f3SEric Dumazet 			   (__force u32) mfc->mfc_mcastgrp,
23150eae88f3SEric Dumazet 			   (__force u32) mfc->mfc_origin,
23161ea472e2SBenjamin Thery 			   mfc->mfc_parent);
23171ea472e2SBenjamin Thery 
23180c12295aSPatrick McHardy 		if (it->cache != &mrt->mfc_unres_queue) {
23191ea472e2SBenjamin Thery 			seq_printf(seq, " %8lu %8lu %8lu",
23201da177e4SLinus Torvalds 				   mfc->mfc_un.res.pkt,
23211da177e4SLinus Torvalds 				   mfc->mfc_un.res.bytes,
23221da177e4SLinus Torvalds 				   mfc->mfc_un.res.wrong_if);
23231da177e4SLinus Torvalds 			for (n = mfc->mfc_un.res.minvif;
23241da177e4SLinus Torvalds 			     n < mfc->mfc_un.res.maxvif; n++ ) {
23250c12295aSPatrick McHardy 				if (VIF_EXISTS(mrt, n) &&
2326cf958ae3SBenjamin Thery 				    mfc->mfc_un.res.ttls[n] < 255)
23271da177e4SLinus Torvalds 					seq_printf(seq,
23281da177e4SLinus Torvalds 					   " %2d:%-3d",
23291da177e4SLinus Torvalds 					   n, mfc->mfc_un.res.ttls[n]);
23301da177e4SLinus Torvalds 			}
23311ea472e2SBenjamin Thery 		} else {
23321ea472e2SBenjamin Thery 			/* unresolved mfc_caches don't contain
23331ea472e2SBenjamin Thery 			 * pkt, bytes and wrong_if values
23341ea472e2SBenjamin Thery 			 */
23351ea472e2SBenjamin Thery 			seq_printf(seq, " %8lu %8lu %8lu", 0ul, 0ul, 0ul);
23361da177e4SLinus Torvalds 		}
23371da177e4SLinus Torvalds 		seq_putc(seq, '\n');
23381da177e4SLinus Torvalds 	}
23391da177e4SLinus Torvalds 	return 0;
23401da177e4SLinus Torvalds }
23411da177e4SLinus Torvalds 
2342f690808eSStephen Hemminger static const struct seq_operations ipmr_mfc_seq_ops = {
23431da177e4SLinus Torvalds 	.start = ipmr_mfc_seq_start,
23441da177e4SLinus Torvalds 	.next  = ipmr_mfc_seq_next,
23451da177e4SLinus Torvalds 	.stop  = ipmr_mfc_seq_stop,
23461da177e4SLinus Torvalds 	.show  = ipmr_mfc_seq_show,
23471da177e4SLinus Torvalds };
23481da177e4SLinus Torvalds 
23491da177e4SLinus Torvalds static int ipmr_mfc_open(struct inode *inode, struct file *file)
23501da177e4SLinus Torvalds {
2351f6bb4514SBenjamin Thery 	return seq_open_net(inode, file, &ipmr_mfc_seq_ops,
2352cf7732e4SPavel Emelyanov 			    sizeof(struct ipmr_mfc_iter));
23531da177e4SLinus Torvalds }
23541da177e4SLinus Torvalds 
23559a32144eSArjan van de Ven static const struct file_operations ipmr_mfc_fops = {
23561da177e4SLinus Torvalds 	.owner	 = THIS_MODULE,
23571da177e4SLinus Torvalds 	.open    = ipmr_mfc_open,
23581da177e4SLinus Torvalds 	.read    = seq_read,
23591da177e4SLinus Torvalds 	.llseek  = seq_lseek,
2360f6bb4514SBenjamin Thery 	.release = seq_release_net,
23611da177e4SLinus Torvalds };
23621da177e4SLinus Torvalds #endif
23631da177e4SLinus Torvalds 
23641da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM_V2
236532613090SAlexey Dobriyan static const struct net_protocol pim_protocol = {
23661da177e4SLinus Torvalds 	.handler	=	pim_rcv,
2367403dbb97STom Goff 	.netns_ok	=	1,
23681da177e4SLinus Torvalds };
23691da177e4SLinus Torvalds #endif
23701da177e4SLinus Torvalds 
23711da177e4SLinus Torvalds 
23721da177e4SLinus Torvalds /*
23731da177e4SLinus Torvalds  *	Setup for IP multicast routing
23741da177e4SLinus Torvalds  */
2375cf958ae3SBenjamin Thery static int __net_init ipmr_net_init(struct net *net)
2376cf958ae3SBenjamin Thery {
2377f0ad0860SPatrick McHardy 	int err;
2378cf958ae3SBenjamin Thery 
2379f0ad0860SPatrick McHardy 	err = ipmr_rules_init(net);
2380f0ad0860SPatrick McHardy 	if (err < 0)
2381cf958ae3SBenjamin Thery 		goto fail;
2382f6bb4514SBenjamin Thery 
2383f6bb4514SBenjamin Thery #ifdef CONFIG_PROC_FS
2384f6bb4514SBenjamin Thery 	err = -ENOMEM;
2385f6bb4514SBenjamin Thery 	if (!proc_net_fops_create(net, "ip_mr_vif", 0, &ipmr_vif_fops))
2386f6bb4514SBenjamin Thery 		goto proc_vif_fail;
2387f6bb4514SBenjamin Thery 	if (!proc_net_fops_create(net, "ip_mr_cache", 0, &ipmr_mfc_fops))
2388f6bb4514SBenjamin Thery 		goto proc_cache_fail;
2389f6bb4514SBenjamin Thery #endif
23902bb8b26cSBenjamin Thery 	return 0;
23912bb8b26cSBenjamin Thery 
2392f6bb4514SBenjamin Thery #ifdef CONFIG_PROC_FS
2393f6bb4514SBenjamin Thery proc_cache_fail:
2394f6bb4514SBenjamin Thery 	proc_net_remove(net, "ip_mr_vif");
2395f6bb4514SBenjamin Thery proc_vif_fail:
2396f0ad0860SPatrick McHardy 	ipmr_rules_exit(net);
2397f6bb4514SBenjamin Thery #endif
2398cf958ae3SBenjamin Thery fail:
2399cf958ae3SBenjamin Thery 	return err;
2400cf958ae3SBenjamin Thery }
2401cf958ae3SBenjamin Thery 
2402cf958ae3SBenjamin Thery static void __net_exit ipmr_net_exit(struct net *net)
2403cf958ae3SBenjamin Thery {
2404f6bb4514SBenjamin Thery #ifdef CONFIG_PROC_FS
2405f6bb4514SBenjamin Thery 	proc_net_remove(net, "ip_mr_cache");
2406f6bb4514SBenjamin Thery 	proc_net_remove(net, "ip_mr_vif");
2407f6bb4514SBenjamin Thery #endif
2408f0ad0860SPatrick McHardy 	ipmr_rules_exit(net);
2409cf958ae3SBenjamin Thery }
2410cf958ae3SBenjamin Thery 
2411cf958ae3SBenjamin Thery static struct pernet_operations ipmr_net_ops = {
2412cf958ae3SBenjamin Thery 	.init = ipmr_net_init,
2413cf958ae3SBenjamin Thery 	.exit = ipmr_net_exit,
2414cf958ae3SBenjamin Thery };
24151da177e4SLinus Torvalds 
241603d2f897SWang Chen int __init ip_mr_init(void)
24171da177e4SLinus Torvalds {
241803d2f897SWang Chen 	int err;
241903d2f897SWang Chen 
24201da177e4SLinus Torvalds 	mrt_cachep = kmem_cache_create("ip_mrt_cache",
24211da177e4SLinus Torvalds 				       sizeof(struct mfc_cache),
2422e5d679f3SAlexey Dobriyan 				       0, SLAB_HWCACHE_ALIGN|SLAB_PANIC,
242320c2df83SPaul Mundt 				       NULL);
242403d2f897SWang Chen 	if (!mrt_cachep)
242503d2f897SWang Chen 		return -ENOMEM;
242603d2f897SWang Chen 
2427cf958ae3SBenjamin Thery 	err = register_pernet_subsys(&ipmr_net_ops);
2428cf958ae3SBenjamin Thery 	if (err)
2429cf958ae3SBenjamin Thery 		goto reg_pernet_fail;
2430cf958ae3SBenjamin Thery 
243103d2f897SWang Chen 	err = register_netdevice_notifier(&ip_mr_notifier);
243203d2f897SWang Chen 	if (err)
243303d2f897SWang Chen 		goto reg_notif_fail;
2434403dbb97STom Goff #ifdef CONFIG_IP_PIMSM_V2
2435403dbb97STom Goff 	if (inet_add_protocol(&pim_protocol, IPPROTO_PIM) < 0) {
2436403dbb97STom Goff 		printk(KERN_ERR "ip_mr_init: can't add PIM protocol\n");
2437403dbb97STom Goff 		err = -EAGAIN;
2438403dbb97STom Goff 		goto add_proto_fail;
2439403dbb97STom Goff 	}
2440403dbb97STom Goff #endif
2441cb6a4e46SPatrick McHardy 	rtnl_register(RTNL_FAMILY_IPMR, RTM_GETROUTE, NULL, ipmr_rtm_dumproute);
244203d2f897SWang Chen 	return 0;
2443f6bb4514SBenjamin Thery 
2444403dbb97STom Goff #ifdef CONFIG_IP_PIMSM_V2
2445403dbb97STom Goff add_proto_fail:
2446403dbb97STom Goff 	unregister_netdevice_notifier(&ip_mr_notifier);
2447403dbb97STom Goff #endif
2448c3e38896SBenjamin Thery reg_notif_fail:
2449cf958ae3SBenjamin Thery 	unregister_pernet_subsys(&ipmr_net_ops);
2450cf958ae3SBenjamin Thery reg_pernet_fail:
2451c3e38896SBenjamin Thery 	kmem_cache_destroy(mrt_cachep);
245203d2f897SWang Chen 	return err;
24531da177e4SLinus Torvalds }
2454