ipmr.c 55.4 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3
/*
 *	IP multicast routing support for mrouted 3.6/3.8
 *
4
 *		(c) 1995 Alan Cox, <alan@lxorguk.ukuu.org.uk>
L
Linus Torvalds 已提交
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
 *	  Linux Consultancy and Custom Driver Development
 *
 *	This program is free software; you can redistribute it and/or
 *	modify it under the terms of the GNU General Public License
 *	as published by the Free Software Foundation; either version
 *	2 of the License, or (at your option) any later version.
 *
 *	Fixes:
 *	Michael Chastain	:	Incorrect size of copying.
 *	Alan Cox		:	Added the cache manager code
 *	Alan Cox		:	Fixed the clone/copy bug and device race.
 *	Mike McLagan		:	Routing by source
 *	Malcolm Beattie		:	Buffer handling fixes.
 *	Alexey Kuznetsov	:	Double buffer free and other fixes.
 *	SVR Anand		:	Fixed several multicast bugs and problems.
 *	Alexey Kuznetsov	:	Status, optimisations and more.
 *	Brad Parker		:	Better behaviour on mrouted upcall
 *					overflow.
 *      Carlos Picoto           :       PIMv1 Support
 *	Pavlin Ivanov Radoslavov:	PIMv2 Registers must checksum only PIM header
25
 *					Relax this requirement to work with older peers.
L
Linus Torvalds 已提交
26 27 28 29 30 31
 *
 */

#include <asm/system.h>
#include <asm/uaccess.h>
#include <linux/types.h>
32
#include <linux/capability.h>
L
Linus Torvalds 已提交
33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48
#include <linux/errno.h>
#include <linux/timer.h>
#include <linux/mm.h>
#include <linux/kernel.h>
#include <linux/fcntl.h>
#include <linux/stat.h>
#include <linux/socket.h>
#include <linux/in.h>
#include <linux/inet.h>
#include <linux/netdevice.h>
#include <linux/inetdevice.h>
#include <linux/igmp.h>
#include <linux/proc_fs.h>
#include <linux/seq_file.h>
#include <linux/mroute.h>
#include <linux/init.h>
49
#include <linux/if_ether.h>
50
#include <linux/slab.h>
51
#include <net/net_namespace.h>
L
Linus Torvalds 已提交
52 53 54
#include <net/ip.h>
#include <net/protocol.h>
#include <linux/skbuff.h>
55
#include <net/route.h>
L
Linus Torvalds 已提交
56 57 58 59 60 61 62 63 64
#include <net/sock.h>
#include <net/icmp.h>
#include <net/udp.h>
#include <net/raw.h>
#include <linux/notifier.h>
#include <linux/if_arp.h>
#include <linux/netfilter_ipv4.h>
#include <net/ipip.h>
#include <net/checksum.h>
65
#include <net/netlink.h>
66
#include <net/fib_rules.h>
L
Linus Torvalds 已提交
67 68 69 70 71

#if defined(CONFIG_IP_PIMSM_V1) || defined(CONFIG_IP_PIMSM_V2)
#define CONFIG_IP_PIMSM	1
#endif

72
struct mr_table {
73
	struct list_head	list;
74 75 76
#ifdef CONFIG_NET_NS
	struct net		*net;
#endif
77
	u32			id;
E
Eric Dumazet 已提交
78
	struct sock __rcu	*mroute_sk;
79 80 81 82 83 84 85 86 87 88 89 90 91
	struct timer_list	ipmr_expire_timer;
	struct list_head	mfc_unres_queue;
	struct list_head	mfc_cache_array[MFC_LINES];
	struct vif_device	vif_table[MAXVIFS];
	int			maxvif;
	atomic_t		cache_resolve_queue_len;
	int			mroute_do_assert;
	int			mroute_do_pim;
#if defined(CONFIG_IP_PIMSM_V1) || defined(CONFIG_IP_PIMSM_V2)
	int			mroute_reg_vif_num;
#endif
};

92 93 94 95 96 97 98 99
struct ipmr_rule {
	struct fib_rule		common;
};

struct ipmr_result {
	struct mr_table		*mrt;
};

L
Linus Torvalds 已提交
100 101 102 103 104 105 106 107 108 109
/* Big lock, protecting vif table, mrt cache and mroute socket state.
   Note that the changes are semaphored via rtnl_lock.
 */

static DEFINE_RWLOCK(mrt_lock);

/*
 *	Multicast router control variables
 */

110
#define VIF_EXISTS(_mrt, _idx) ((_mrt)->vif_table[_idx].dev != NULL)
L
Linus Torvalds 已提交
111 112 113 114 115 116 117 118 119 120 121 122

/* Special spinlock for queue of unresolved entries */
static DEFINE_SPINLOCK(mfc_unres_lock);

/* We return to original Alan's scheme. Hash table of resolved
   entries is changed only in process context and protected
   with weak lock mrt_lock. Queue of unresolved entries is protected
   with strong spinlock mfc_unres_lock.

   In this case data path is free of exclusive locks at all.
 */

123
static struct kmem_cache *mrt_cachep __read_mostly;
L
Linus Torvalds 已提交
124

125
static struct mr_table *ipmr_new_table(struct net *net, u32 id);
126 127 128 129
static int ip_mr_forward(struct net *net, struct mr_table *mrt,
			 struct sk_buff *skb, struct mfc_cache *cache,
			 int local);
static int ipmr_cache_report(struct mr_table *mrt,
130
			     struct sk_buff *pkt, vifi_t vifi, int assert);
131 132
static int __ipmr_fill_mroute(struct mr_table *mrt, struct sk_buff *skb,
			      struct mfc_cache *c, struct rtmsg *rtm);
133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168
static void ipmr_expire_process(unsigned long arg);

#ifdef CONFIG_IP_MROUTE_MULTIPLE_TABLES
#define ipmr_for_each_table(mrt, net) \
	list_for_each_entry_rcu(mrt, &net->ipv4.mr_tables, list)

static struct mr_table *ipmr_get_table(struct net *net, u32 id)
{
	struct mr_table *mrt;

	ipmr_for_each_table(mrt, net) {
		if (mrt->id == id)
			return mrt;
	}
	return NULL;
}

static int ipmr_fib_lookup(struct net *net, struct flowi *flp,
			   struct mr_table **mrt)
{
	struct ipmr_result res;
	struct fib_lookup_arg arg = { .result = &res, };
	int err;

	err = fib_rules_lookup(net->ipv4.mr_rules_ops, flp, 0, &arg);
	if (err < 0)
		return err;
	*mrt = res.mrt;
	return 0;
}

static int ipmr_rule_action(struct fib_rule *rule, struct flowi *flp,
			    int flags, struct fib_lookup_arg *arg)
{
	struct ipmr_result *res = arg->result;
	struct mr_table *mrt;
L
Linus Torvalds 已提交
169

170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218
	switch (rule->action) {
	case FR_ACT_TO_TBL:
		break;
	case FR_ACT_UNREACHABLE:
		return -ENETUNREACH;
	case FR_ACT_PROHIBIT:
		return -EACCES;
	case FR_ACT_BLACKHOLE:
	default:
		return -EINVAL;
	}

	mrt = ipmr_get_table(rule->fr_net, rule->table);
	if (mrt == NULL)
		return -EAGAIN;
	res->mrt = mrt;
	return 0;
}

static int ipmr_rule_match(struct fib_rule *rule, struct flowi *fl, int flags)
{
	return 1;
}

static const struct nla_policy ipmr_rule_policy[FRA_MAX + 1] = {
	FRA_GENERIC_POLICY,
};

static int ipmr_rule_configure(struct fib_rule *rule, struct sk_buff *skb,
			       struct fib_rule_hdr *frh, struct nlattr **tb)
{
	return 0;
}

static int ipmr_rule_compare(struct fib_rule *rule, struct fib_rule_hdr *frh,
			     struct nlattr **tb)
{
	return 1;
}

static int ipmr_rule_fill(struct fib_rule *rule, struct sk_buff *skb,
			  struct fib_rule_hdr *frh)
{
	frh->dst_len = 0;
	frh->src_len = 0;
	frh->tos     = 0;
	return 0;
}

219
static const struct fib_rules_ops __net_initdata ipmr_rules_ops_template = {
220
	.family		= RTNL_FAMILY_IPMR,
221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269
	.rule_size	= sizeof(struct ipmr_rule),
	.addr_size	= sizeof(u32),
	.action		= ipmr_rule_action,
	.match		= ipmr_rule_match,
	.configure	= ipmr_rule_configure,
	.compare	= ipmr_rule_compare,
	.default_pref	= fib_default_rule_pref,
	.fill		= ipmr_rule_fill,
	.nlgroup	= RTNLGRP_IPV4_RULE,
	.policy		= ipmr_rule_policy,
	.owner		= THIS_MODULE,
};

static int __net_init ipmr_rules_init(struct net *net)
{
	struct fib_rules_ops *ops;
	struct mr_table *mrt;
	int err;

	ops = fib_rules_register(&ipmr_rules_ops_template, net);
	if (IS_ERR(ops))
		return PTR_ERR(ops);

	INIT_LIST_HEAD(&net->ipv4.mr_tables);

	mrt = ipmr_new_table(net, RT_TABLE_DEFAULT);
	if (mrt == NULL) {
		err = -ENOMEM;
		goto err1;
	}

	err = fib_default_rule_add(ops, 0x7fff, RT_TABLE_DEFAULT, 0);
	if (err < 0)
		goto err2;

	net->ipv4.mr_rules_ops = ops;
	return 0;

err2:
	kfree(mrt);
err1:
	fib_rules_unregister(ops);
	return err;
}

static void __net_exit ipmr_rules_exit(struct net *net)
{
	struct mr_table *mrt, *next;

E
Eric Dumazet 已提交
270 271
	list_for_each_entry_safe(mrt, next, &net->ipv4.mr_tables, list) {
		list_del(&mrt->list);
272
		kfree(mrt);
E
Eric Dumazet 已提交
273
	}
274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307
	fib_rules_unregister(net->ipv4.mr_rules_ops);
}
#else
#define ipmr_for_each_table(mrt, net) \
	for (mrt = net->ipv4.mrt; mrt; mrt = NULL)

static struct mr_table *ipmr_get_table(struct net *net, u32 id)
{
	return net->ipv4.mrt;
}

static int ipmr_fib_lookup(struct net *net, struct flowi *flp,
			   struct mr_table **mrt)
{
	*mrt = net->ipv4.mrt;
	return 0;
}

static int __net_init ipmr_rules_init(struct net *net)
{
	net->ipv4.mrt = ipmr_new_table(net, RT_TABLE_DEFAULT);
	return net->ipv4.mrt ? 0 : -ENOMEM;
}

static void __net_exit ipmr_rules_exit(struct net *net)
{
	kfree(net->ipv4.mrt);
}
#endif

static struct mr_table *ipmr_new_table(struct net *net, u32 id)
{
	struct mr_table *mrt;
	unsigned int i;
L
Linus Torvalds 已提交
308

309 310 311 312 313 314 315
	mrt = ipmr_get_table(net, id);
	if (mrt != NULL)
		return mrt;

	mrt = kzalloc(sizeof(*mrt), GFP_KERNEL);
	if (mrt == NULL)
		return NULL;
316
	write_pnet(&mrt->net, net);
317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335
	mrt->id = id;

	/* Forwarding cache */
	for (i = 0; i < MFC_LINES; i++)
		INIT_LIST_HEAD(&mrt->mfc_cache_array[i]);

	INIT_LIST_HEAD(&mrt->mfc_unres_queue);

	setup_timer(&mrt->ipmr_expire_timer, ipmr_expire_process,
		    (unsigned long)mrt);

#ifdef CONFIG_IP_PIMSM
	mrt->mroute_reg_vif_num = -1;
#endif
#ifdef CONFIG_IP_MROUTE_MULTIPLE_TABLES
	list_add_tail_rcu(&mrt->list, &net->ipv4.mr_tables);
#endif
	return mrt;
}
L
Linus Torvalds 已提交
336 337 338

/* Service routines creating virtual interfaces: DVMRP tunnels and PIMREG */

339 340
static void ipmr_del_tunnel(struct net_device *dev, struct vifctl *v)
{
341 342
	struct net *net = dev_net(dev);

343 344
	dev_close(dev);

345
	dev = __dev_get_by_name(net, "tunl0");
346
	if (dev) {
347
		const struct net_device_ops *ops = dev->netdev_ops;
348 349 350 351 352 353 354 355 356 357 358 359
		struct ifreq ifr;
		struct ip_tunnel_parm p;

		memset(&p, 0, sizeof(p));
		p.iph.daddr = v->vifc_rmt_addr.s_addr;
		p.iph.saddr = v->vifc_lcl_addr.s_addr;
		p.iph.version = 4;
		p.iph.ihl = 5;
		p.iph.protocol = IPPROTO_IPIP;
		sprintf(p.name, "dvmrp%d", v->vifc_vifi);
		ifr.ifr_ifru.ifru_data = (__force void __user *)&p;

360 361 362 363 364 365 366
		if (ops->ndo_do_ioctl) {
			mm_segment_t oldfs = get_fs();

			set_fs(KERNEL_DS);
			ops->ndo_do_ioctl(dev, &ifr, SIOCDELTUNNEL);
			set_fs(oldfs);
		}
367 368 369
	}
}

L
Linus Torvalds 已提交
370
static
371
struct net_device *ipmr_new_tunnel(struct net *net, struct vifctl *v)
L
Linus Torvalds 已提交
372 373 374
{
	struct net_device  *dev;

375
	dev = __dev_get_by_name(net, "tunl0");
L
Linus Torvalds 已提交
376 377

	if (dev) {
378
		const struct net_device_ops *ops = dev->netdev_ops;
L
Linus Torvalds 已提交
379 380 381 382 383 384 385 386 387 388 389 390
		int err;
		struct ifreq ifr;
		struct ip_tunnel_parm p;
		struct in_device  *in_dev;

		memset(&p, 0, sizeof(p));
		p.iph.daddr = v->vifc_rmt_addr.s_addr;
		p.iph.saddr = v->vifc_lcl_addr.s_addr;
		p.iph.version = 4;
		p.iph.ihl = 5;
		p.iph.protocol = IPPROTO_IPIP;
		sprintf(p.name, "dvmrp%d", v->vifc_vifi);
S
Stephen Hemminger 已提交
391
		ifr.ifr_ifru.ifru_data = (__force void __user *)&p;
L
Linus Torvalds 已提交
392

393 394 395 396 397 398 399 400
		if (ops->ndo_do_ioctl) {
			mm_segment_t oldfs = get_fs();

			set_fs(KERNEL_DS);
			err = ops->ndo_do_ioctl(dev, &ifr, SIOCADDTUNNEL);
			set_fs(oldfs);
		} else
			err = -EOPNOTSUPP;
L
Linus Torvalds 已提交
401 402 403

		dev = NULL;

404 405
		if (err == 0 &&
		    (dev = __dev_get_by_name(net, p.name)) != NULL) {
L
Linus Torvalds 已提交
406 407
			dev->flags |= IFF_MULTICAST;

408
			in_dev = __in_dev_get_rtnl(dev);
409
			if (in_dev == NULL)
L
Linus Torvalds 已提交
410
				goto failure;
411 412 413

			ipv4_devconf_setall(in_dev);
			IPV4_DEVCONF(in_dev->cnf, RP_FILTER) = 0;
L
Linus Torvalds 已提交
414 415 416

			if (dev_open(dev))
				goto failure;
417
			dev_hold(dev);
L
Linus Torvalds 已提交
418 419 420 421 422 423 424 425 426 427 428 429 430 431 432
		}
	}
	return dev;

failure:
	/* allow the register to be completed before unregistering. */
	rtnl_unlock();
	rtnl_lock();

	unregister_netdevice(dev);
	return NULL;
}

#ifdef CONFIG_IP_PIMSM

433
static netdev_tx_t reg_vif_xmit(struct sk_buff *skb, struct net_device *dev)
L
Linus Torvalds 已提交
434
{
435
	struct net *net = dev_net(dev);
436 437 438 439 440 441 442 443 444
	struct mr_table *mrt;
	struct flowi fl = {
		.oif		= dev->ifindex,
		.iif		= skb->skb_iif,
		.mark		= skb->mark,
	};
	int err;

	err = ipmr_fib_lookup(net, &fl, &mrt);
445 446
	if (err < 0) {
		kfree_skb(skb);
447
		return err;
448
	}
449

L
Linus Torvalds 已提交
450
	read_lock(&mrt_lock);
451 452
	dev->stats.tx_bytes += skb->len;
	dev->stats.tx_packets++;
453
	ipmr_cache_report(mrt, skb, mrt->mroute_reg_vif_num, IGMPMSG_WHOLEPKT);
L
Linus Torvalds 已提交
454 455
	read_unlock(&mrt_lock);
	kfree_skb(skb);
456
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
457 458
}

459 460 461 462
static const struct net_device_ops reg_vif_netdev_ops = {
	.ndo_start_xmit	= reg_vif_xmit,
};

L
Linus Torvalds 已提交
463 464 465
static void reg_vif_setup(struct net_device *dev)
{
	dev->type		= ARPHRD_PIMREG;
466
	dev->mtu		= ETH_DATA_LEN - sizeof(struct iphdr) - 8;
L
Linus Torvalds 已提交
467
	dev->flags		= IFF_NOARP;
468
	dev->netdev_ops		= &reg_vif_netdev_ops,
L
Linus Torvalds 已提交
469
	dev->destructor		= free_netdev;
T
Tom Goff 已提交
470
	dev->features		|= NETIF_F_NETNS_LOCAL;
L
Linus Torvalds 已提交
471 472
}

473
static struct net_device *ipmr_reg_vif(struct net *net, struct mr_table *mrt)
L
Linus Torvalds 已提交
474 475 476
{
	struct net_device *dev;
	struct in_device *in_dev;
477
	char name[IFNAMSIZ];
L
Linus Torvalds 已提交
478

479 480 481 482
	if (mrt->id == RT_TABLE_DEFAULT)
		sprintf(name, "pimreg");
	else
		sprintf(name, "pimreg%u", mrt->id);
L
Linus Torvalds 已提交
483

484
	dev = alloc_netdev(0, name, reg_vif_setup);
L
Linus Torvalds 已提交
485 486 487 488

	if (dev == NULL)
		return NULL;

T
Tom Goff 已提交
489 490
	dev_net_set(dev, net);

L
Linus Torvalds 已提交
491 492 493 494 495 496
	if (register_netdevice(dev)) {
		free_netdev(dev);
		return NULL;
	}
	dev->iflink = 0;

497 498 499
	rcu_read_lock();
	if ((in_dev = __in_dev_get_rcu(dev)) == NULL) {
		rcu_read_unlock();
L
Linus Torvalds 已提交
500
		goto failure;
501
	}
L
Linus Torvalds 已提交
502

503 504 505
	ipv4_devconf_setall(in_dev);
	IPV4_DEVCONF(in_dev->cnf, RP_FILTER) = 0;
	rcu_read_unlock();
L
Linus Torvalds 已提交
506 507 508 509

	if (dev_open(dev))
		goto failure;

510 511
	dev_hold(dev);

L
Linus Torvalds 已提交
512 513 514 515 516 517 518 519 520 521 522 523 524 525
	return dev;

failure:
	/* allow the register to be completed before unregistering. */
	rtnl_unlock();
	rtnl_lock();

	unregister_netdevice(dev);
	return NULL;
}
#endif

/*
 *	Delete a VIF entry
526
 *	@notify: Set to 1, if the caller is a notifier_call
L
Linus Torvalds 已提交
527
 */
528

529
static int vif_delete(struct mr_table *mrt, int vifi, int notify,
530
		      struct list_head *head)
L
Linus Torvalds 已提交
531 532 533 534 535
{
	struct vif_device *v;
	struct net_device *dev;
	struct in_device *in_dev;

536
	if (vifi < 0 || vifi >= mrt->maxvif)
L
Linus Torvalds 已提交
537 538
		return -EADDRNOTAVAIL;

539
	v = &mrt->vif_table[vifi];
L
Linus Torvalds 已提交
540 541 542 543 544 545 546 547 548 549 550

	write_lock_bh(&mrt_lock);
	dev = v->dev;
	v->dev = NULL;

	if (!dev) {
		write_unlock_bh(&mrt_lock);
		return -EADDRNOTAVAIL;
	}

#ifdef CONFIG_IP_PIMSM
551 552
	if (vifi == mrt->mroute_reg_vif_num)
		mrt->mroute_reg_vif_num = -1;
L
Linus Torvalds 已提交
553 554
#endif

555
	if (vifi+1 == mrt->maxvif) {
L
Linus Torvalds 已提交
556 557
		int tmp;
		for (tmp=vifi-1; tmp>=0; tmp--) {
558
			if (VIF_EXISTS(mrt, tmp))
L
Linus Torvalds 已提交
559 560
				break;
		}
561
		mrt->maxvif = tmp+1;
L
Linus Torvalds 已提交
562 563 564 565 566 567
	}

	write_unlock_bh(&mrt_lock);

	dev_set_allmulti(dev, -1);

568
	if ((in_dev = __in_dev_get_rtnl(dev)) != NULL) {
569
		IPV4_DEVCONF(in_dev->cnf, MC_FORWARDING)--;
L
Linus Torvalds 已提交
570 571 572
		ip_rt_multicast_event(in_dev);
	}

573
	if (v->flags&(VIFF_TUNNEL|VIFF_REGISTER) && !notify)
574
		unregister_netdevice_queue(dev, head);
L
Linus Torvalds 已提交
575 576 577 578 579

	dev_put(dev);
	return 0;
}

580
static void ipmr_cache_free_rcu(struct rcu_head *head)
581
{
582 583
	struct mfc_cache *c = container_of(head, struct mfc_cache, rcu);

584 585 586
	kmem_cache_free(mrt_cachep, c);
}

587 588 589 590 591
static inline void ipmr_cache_free(struct mfc_cache *c)
{
	call_rcu(&c->rcu, ipmr_cache_free_rcu);
}

L
Linus Torvalds 已提交
592 593 594 595
/* Destroy an unresolved cache entry, killing queued skbs
   and reporting error to netlink readers.
 */

596
static void ipmr_destroy_unres(struct mr_table *mrt, struct mfc_cache *c)
L
Linus Torvalds 已提交
597
{
598
	struct net *net = read_pnet(&mrt->net);
L
Linus Torvalds 已提交
599
	struct sk_buff *skb;
600
	struct nlmsgerr *e;
L
Linus Torvalds 已提交
601

602
	atomic_dec(&mrt->cache_resolve_queue_len);
L
Linus Torvalds 已提交
603

J
Jianjun Kong 已提交
604
	while ((skb = skb_dequeue(&c->mfc_un.unres.unresolved))) {
605
		if (ip_hdr(skb)->version == 0) {
L
Linus Torvalds 已提交
606 607 608 609
			struct nlmsghdr *nlh = (struct nlmsghdr *)skb_pull(skb, sizeof(struct iphdr));
			nlh->nlmsg_type = NLMSG_ERROR;
			nlh->nlmsg_len = NLMSG_LENGTH(sizeof(struct nlmsgerr));
			skb_trim(skb, nlh->nlmsg_len);
610 611 612
			e = NLMSG_DATA(nlh);
			e->error = -ETIMEDOUT;
			memset(&e->msg, 0, sizeof(e->msg));
613

614
			rtnl_unicast(skb, net, NETLINK_CB(skb).pid);
L
Linus Torvalds 已提交
615 616 617 618
		} else
			kfree_skb(skb);
	}

619
	ipmr_cache_free(c);
L
Linus Torvalds 已提交
620 621 622
}


623
/* Timer process for the unresolved queue. */
L
Linus Torvalds 已提交
624

625
static void ipmr_expire_process(unsigned long arg)
L
Linus Torvalds 已提交
626
{
627
	struct mr_table *mrt = (struct mr_table *)arg;
L
Linus Torvalds 已提交
628 629
	unsigned long now;
	unsigned long expires;
630
	struct mfc_cache *c, *next;
L
Linus Torvalds 已提交
631 632

	if (!spin_trylock(&mfc_unres_lock)) {
633
		mod_timer(&mrt->ipmr_expire_timer, jiffies+HZ/10);
L
Linus Torvalds 已提交
634 635 636
		return;
	}

637
	if (list_empty(&mrt->mfc_unres_queue))
L
Linus Torvalds 已提交
638 639 640 641 642
		goto out;

	now = jiffies;
	expires = 10*HZ;

643
	list_for_each_entry_safe(c, next, &mrt->mfc_unres_queue, list) {
L
Linus Torvalds 已提交
644 645 646 647 648 649 650
		if (time_after(c->mfc_un.unres.expires, now)) {
			unsigned long interval = c->mfc_un.unres.expires - now;
			if (interval < expires)
				expires = interval;
			continue;
		}

651
		list_del(&c->list);
652
		ipmr_destroy_unres(mrt, c);
L
Linus Torvalds 已提交
653 654
	}

655 656
	if (!list_empty(&mrt->mfc_unres_queue))
		mod_timer(&mrt->ipmr_expire_timer, jiffies + expires);
L
Linus Torvalds 已提交
657 658 659 660 661 662 663

out:
	spin_unlock(&mfc_unres_lock);
}

/* Fill oifs list. It is called under write locked mrt_lock. */

664
static void ipmr_update_thresholds(struct mr_table *mrt, struct mfc_cache *cache,
665
				   unsigned char *ttls)
L
Linus Torvalds 已提交
666 667 668 669 670 671 672
{
	int vifi;

	cache->mfc_un.res.minvif = MAXVIFS;
	cache->mfc_un.res.maxvif = 0;
	memset(cache->mfc_un.res.ttls, 255, MAXVIFS);

673 674
	for (vifi = 0; vifi < mrt->maxvif; vifi++) {
		if (VIF_EXISTS(mrt, vifi) &&
675
		    ttls[vifi] && ttls[vifi] < 255) {
L
Linus Torvalds 已提交
676 677 678 679 680 681 682 683 684
			cache->mfc_un.res.ttls[vifi] = ttls[vifi];
			if (cache->mfc_un.res.minvif > vifi)
				cache->mfc_un.res.minvif = vifi;
			if (cache->mfc_un.res.maxvif <= vifi)
				cache->mfc_un.res.maxvif = vifi + 1;
		}
	}
}

685 686
static int vif_add(struct net *net, struct mr_table *mrt,
		   struct vifctl *vifc, int mrtsock)
L
Linus Torvalds 已提交
687 688
{
	int vifi = vifc->vifc_vifi;
689
	struct vif_device *v = &mrt->vif_table[vifi];
L
Linus Torvalds 已提交
690 691
	struct net_device *dev;
	struct in_device *in_dev;
692
	int err;
L
Linus Torvalds 已提交
693 694

	/* Is vif busy ? */
695
	if (VIF_EXISTS(mrt, vifi))
L
Linus Torvalds 已提交
696 697 698 699 700 701 702 703 704
		return -EADDRINUSE;

	switch (vifc->vifc_flags) {
#ifdef CONFIG_IP_PIMSM
	case VIFF_REGISTER:
		/*
		 * Special Purpose VIF in PIM
		 * All the packets will be sent to the daemon
		 */
705
		if (mrt->mroute_reg_vif_num >= 0)
L
Linus Torvalds 已提交
706
			return -EADDRINUSE;
707
		dev = ipmr_reg_vif(net, mrt);
L
Linus Torvalds 已提交
708 709
		if (!dev)
			return -ENOBUFS;
710 711 712
		err = dev_set_allmulti(dev, 1);
		if (err) {
			unregister_netdevice(dev);
713
			dev_put(dev);
714 715
			return err;
		}
L
Linus Torvalds 已提交
716 717
		break;
#endif
718
	case VIFF_TUNNEL:
719
		dev = ipmr_new_tunnel(net, vifc);
L
Linus Torvalds 已提交
720 721
		if (!dev)
			return -ENOBUFS;
722 723 724
		err = dev_set_allmulti(dev, 1);
		if (err) {
			ipmr_del_tunnel(dev, vifc);
725
			dev_put(dev);
726 727
			return err;
		}
L
Linus Torvalds 已提交
728
		break;
729 730

	case VIFF_USE_IFINDEX:
L
Linus Torvalds 已提交
731
	case 0:
732 733
		if (vifc->vifc_flags == VIFF_USE_IFINDEX) {
			dev = dev_get_by_index(net, vifc->vifc_lcl_ifindex);
E
Eric Dumazet 已提交
734
			if (dev && __in_dev_get_rtnl(dev) == NULL) {
735 736 737 738 739 740
				dev_put(dev);
				return -EADDRNOTAVAIL;
			}
		} else
			dev = ip_dev_find(net, vifc->vifc_lcl_addr.s_addr);

L
Linus Torvalds 已提交
741 742
		if (!dev)
			return -EADDRNOTAVAIL;
743
		err = dev_set_allmulti(dev, 1);
744 745
		if (err) {
			dev_put(dev);
746
			return err;
747
		}
L
Linus Torvalds 已提交
748 749 750 751 752
		break;
	default:
		return -EINVAL;
	}

753 754
	if ((in_dev = __in_dev_get_rtnl(dev)) == NULL) {
		dev_put(dev);
L
Linus Torvalds 已提交
755
		return -EADDRNOTAVAIL;
756
	}
757
	IPV4_DEVCONF(in_dev->cnf, MC_FORWARDING)++;
L
Linus Torvalds 已提交
758 759 760 761 762
	ip_rt_multicast_event(in_dev);

	/*
	 *	Fill in the VIF structures
	 */
J
Jianjun Kong 已提交
763 764 765 766
	v->rate_limit = vifc->vifc_rate_limit;
	v->local = vifc->vifc_lcl_addr.s_addr;
	v->remote = vifc->vifc_rmt_addr.s_addr;
	v->flags = vifc->vifc_flags;
L
Linus Torvalds 已提交
767 768
	if (!mrtsock)
		v->flags |= VIFF_STATIC;
J
Jianjun Kong 已提交
769
	v->threshold = vifc->vifc_threshold;
L
Linus Torvalds 已提交
770 771 772 773 774 775 776 777 778 779
	v->bytes_in = 0;
	v->bytes_out = 0;
	v->pkt_in = 0;
	v->pkt_out = 0;
	v->link = dev->ifindex;
	if (v->flags&(VIFF_TUNNEL|VIFF_REGISTER))
		v->link = dev->iflink;

	/* And finish update writing critical data */
	write_lock_bh(&mrt_lock);
J
Jianjun Kong 已提交
780
	v->dev = dev;
L
Linus Torvalds 已提交
781 782
#ifdef CONFIG_IP_PIMSM
	if (v->flags&VIFF_REGISTER)
783
		mrt->mroute_reg_vif_num = vifi;
L
Linus Torvalds 已提交
784
#endif
785 786
	if (vifi+1 > mrt->maxvif)
		mrt->maxvif = vifi+1;
L
Linus Torvalds 已提交
787 788 789 790
	write_unlock_bh(&mrt_lock);
	return 0;
}

791
/* called with rcu_read_lock() */
792
static struct mfc_cache *ipmr_cache_find(struct mr_table *mrt,
793 794
					 __be32 origin,
					 __be32 mcastgrp)
L
Linus Torvalds 已提交
795
{
J
Jianjun Kong 已提交
796
	int line = MFC_HASH(mcastgrp, origin);
L
Linus Torvalds 已提交
797 798
	struct mfc_cache *c;

799
	list_for_each_entry_rcu(c, &mrt->mfc_cache_array[line], list) {
800 801
		if (c->mfc_origin == origin && c->mfc_mcastgrp == mcastgrp)
			return c;
L
Linus Torvalds 已提交
802
	}
803
	return NULL;
L
Linus Torvalds 已提交
804 805 806 807 808
}

/*
 *	Allocate a multicast cache entry
 */
809
static struct mfc_cache *ipmr_cache_alloc(void)
L
Linus Torvalds 已提交
810
{
J
Jianjun Kong 已提交
811
	struct mfc_cache *c = kmem_cache_zalloc(mrt_cachep, GFP_KERNEL);
812 813 814

	if (c)
		c->mfc_un.res.minvif = MAXVIFS;
L
Linus Torvalds 已提交
815 816 817
	return c;
}

818
static struct mfc_cache *ipmr_cache_alloc_unres(void)
L
Linus Torvalds 已提交
819
{
J
Jianjun Kong 已提交
820
	struct mfc_cache *c = kmem_cache_zalloc(mrt_cachep, GFP_ATOMIC);
821 822 823 824 825

	if (c) {
		skb_queue_head_init(&c->mfc_un.unres.unresolved);
		c->mfc_un.unres.expires = jiffies + 10*HZ;
	}
L
Linus Torvalds 已提交
826 827 828 829 830 831
	return c;
}

/*
 *	A cache entry has gone into a resolved state from queued
 */
832

833 834
static void ipmr_cache_resolve(struct net *net, struct mr_table *mrt,
			       struct mfc_cache *uc, struct mfc_cache *c)
L
Linus Torvalds 已提交
835 836
{
	struct sk_buff *skb;
837
	struct nlmsgerr *e;
L
Linus Torvalds 已提交
838 839 840 841 842

	/*
	 *	Play the pending entries through our router
	 */

J
Jianjun Kong 已提交
843
	while ((skb = __skb_dequeue(&uc->mfc_un.unres.unresolved))) {
844
		if (ip_hdr(skb)->version == 0) {
L
Linus Torvalds 已提交
845 846
			struct nlmsghdr *nlh = (struct nlmsghdr *)skb_pull(skb, sizeof(struct iphdr));

847
			if (__ipmr_fill_mroute(mrt, skb, c, NLMSG_DATA(nlh)) > 0) {
848 849
				nlh->nlmsg_len = (skb_tail_pointer(skb) -
						  (u8 *)nlh);
L
Linus Torvalds 已提交
850 851 852 853
			} else {
				nlh->nlmsg_type = NLMSG_ERROR;
				nlh->nlmsg_len = NLMSG_LENGTH(sizeof(struct nlmsgerr));
				skb_trim(skb, nlh->nlmsg_len);
854 855 856
				e = NLMSG_DATA(nlh);
				e->error = -EMSGSIZE;
				memset(&e->msg, 0, sizeof(e->msg));
L
Linus Torvalds 已提交
857
			}
858

859
			rtnl_unicast(skb, net, NETLINK_CB(skb).pid);
L
Linus Torvalds 已提交
860
		} else
861
			ip_mr_forward(net, mrt, skb, c, 0);
L
Linus Torvalds 已提交
862 863 864 865 866 867 868 869 870
	}
}

/*
 *	Bounce a cache query up to mrouted. We could use netlink for this but mrouted
 *	expects the following bizarre scheme.
 *
 *	Called under mrt_lock.
 */
871

872
static int ipmr_cache_report(struct mr_table *mrt,
873
			     struct sk_buff *pkt, vifi_t vifi, int assert)
L
Linus Torvalds 已提交
874 875
{
	struct sk_buff *skb;
876
	const int ihl = ip_hdrlen(pkt);
L
Linus Torvalds 已提交
877 878
	struct igmphdr *igmp;
	struct igmpmsg *msg;
E
Eric Dumazet 已提交
879
	struct sock *mroute_sk;
L
Linus Torvalds 已提交
880 881 882 883 884 885 886 887 888
	int ret;

#ifdef CONFIG_IP_PIMSM
	if (assert == IGMPMSG_WHOLEPKT)
		skb = skb_realloc_headroom(pkt, sizeof(struct iphdr));
	else
#endif
		skb = alloc_skb(128, GFP_ATOMIC);

S
Stephen Hemminger 已提交
889
	if (!skb)
L
Linus Torvalds 已提交
890 891 892 893 894 895 896 897 898
		return -ENOBUFS;

#ifdef CONFIG_IP_PIMSM
	if (assert == IGMPMSG_WHOLEPKT) {
		/* Ugly, but we have no choice with this interface.
		   Duplicate old header, fix ihl, length etc.
		   And all this only to mangle msg->im_msgtype and
		   to set msg->im_mbz to "mbz" :-)
		 */
899 900
		skb_push(skb, sizeof(struct iphdr));
		skb_reset_network_header(skb);
901
		skb_reset_transport_header(skb);
902
		msg = (struct igmpmsg *)skb_network_header(skb);
903
		memcpy(msg, skb_network_header(pkt), sizeof(struct iphdr));
L
Linus Torvalds 已提交
904 905
		msg->im_msgtype = IGMPMSG_WHOLEPKT;
		msg->im_mbz = 0;
906
		msg->im_vif = mrt->mroute_reg_vif_num;
907 908 909
		ip_hdr(skb)->ihl = sizeof(struct iphdr) >> 2;
		ip_hdr(skb)->tot_len = htons(ntohs(ip_hdr(pkt)->tot_len) +
					     sizeof(struct iphdr));
910
	} else
L
Linus Torvalds 已提交
911
#endif
912 913
	{

L
Linus Torvalds 已提交
914 915 916 917
	/*
	 *	Copy the IP header
	 */

918
	skb->network_header = skb->tail;
919
	skb_put(skb, ihl);
920
	skb_copy_to_linear_data(skb, pkt->data, ihl);
921 922
	ip_hdr(skb)->protocol = 0;			/* Flag to the kernel this is a route add */
	msg = (struct igmpmsg *)skb_network_header(skb);
L
Linus Torvalds 已提交
923
	msg->im_vif = vifi;
E
Eric Dumazet 已提交
924
	skb_dst_set(skb, dst_clone(skb_dst(pkt)));
L
Linus Torvalds 已提交
925 926 927 928 929

	/*
	 *	Add our header
	 */

J
Jianjun Kong 已提交
930
	igmp=(struct igmphdr *)skb_put(skb, sizeof(struct igmphdr));
L
Linus Torvalds 已提交
931 932 933
	igmp->type	=
	msg->im_msgtype = assert;
	igmp->code 	=	0;
934
	ip_hdr(skb)->tot_len = htons(skb->len);			/* Fix the length */
935
	skb->transport_header = skb->network_header;
936
	}
L
Linus Torvalds 已提交
937

E
Eric Dumazet 已提交
938 939 940 941
	rcu_read_lock();
	mroute_sk = rcu_dereference(mrt->mroute_sk);
	if (mroute_sk == NULL) {
		rcu_read_unlock();
L
Linus Torvalds 已提交
942 943 944 945 946 947 948
		kfree_skb(skb);
		return -EINVAL;
	}

	/*
	 *	Deliver to mrouted
	 */
E
Eric Dumazet 已提交
949 950
	ret = sock_queue_rcv_skb(mroute_sk, skb);
	rcu_read_unlock();
951
	if (ret < 0) {
L
Linus Torvalds 已提交
952 953 954 955 956 957 958 959 960 961 962
		if (net_ratelimit())
			printk(KERN_WARNING "mroute: pending queue full, dropping entries.\n");
		kfree_skb(skb);
	}

	return ret;
}

/*
 *	Queue a packet for resolution. It gets locked cache entry!
 */
963

L
Linus Torvalds 已提交
964
static int
965
ipmr_cache_unresolved(struct mr_table *mrt, vifi_t vifi, struct sk_buff *skb)
L
Linus Torvalds 已提交
966
{
967
	bool found = false;
L
Linus Torvalds 已提交
968 969
	int err;
	struct mfc_cache *c;
970
	const struct iphdr *iph = ip_hdr(skb);
L
Linus Torvalds 已提交
971 972

	spin_lock_bh(&mfc_unres_lock);
973
	list_for_each_entry(c, &mrt->mfc_unres_queue, list) {
974
		if (c->mfc_mcastgrp == iph->daddr &&
975 976
		    c->mfc_origin == iph->saddr) {
			found = true;
L
Linus Torvalds 已提交
977
			break;
978
		}
L
Linus Torvalds 已提交
979 980
	}

981
	if (!found) {
L
Linus Torvalds 已提交
982 983 984 985
		/*
		 *	Create a new entry if allowable
		 */

986
		if (atomic_read(&mrt->cache_resolve_queue_len) >= 10 ||
987
		    (c = ipmr_cache_alloc_unres()) == NULL) {
L
Linus Torvalds 已提交
988 989 990 991 992 993 994 995 996
			spin_unlock_bh(&mfc_unres_lock);

			kfree_skb(skb);
			return -ENOBUFS;
		}

		/*
		 *	Fill in the new cache entry
		 */
997 998 999
		c->mfc_parent	= -1;
		c->mfc_origin	= iph->saddr;
		c->mfc_mcastgrp	= iph->daddr;
L
Linus Torvalds 已提交
1000 1001 1002 1003

		/*
		 *	Reflect first query at mrouted.
		 */
1004
		err = ipmr_cache_report(mrt, skb, vifi, IGMPMSG_NOCACHE);
1005
		if (err < 0) {
1006
			/* If the report failed throw the cache entry
L
Linus Torvalds 已提交
1007 1008 1009 1010
			   out - Brad Parker
			 */
			spin_unlock_bh(&mfc_unres_lock);

1011
			ipmr_cache_free(c);
L
Linus Torvalds 已提交
1012 1013 1014 1015
			kfree_skb(skb);
			return err;
		}

1016 1017
		atomic_inc(&mrt->cache_resolve_queue_len);
		list_add(&c->list, &mrt->mfc_unres_queue);
L
Linus Torvalds 已提交
1018

1019 1020
		if (atomic_read(&mrt->cache_resolve_queue_len) == 1)
			mod_timer(&mrt->ipmr_expire_timer, c->mfc_un.unres.expires);
L
Linus Torvalds 已提交
1021 1022 1023 1024 1025 1026 1027 1028 1029
	}

	/*
	 *	See if we can append the packet
	 */
	if (c->mfc_un.unres.unresolved.qlen>3) {
		kfree_skb(skb);
		err = -ENOBUFS;
	} else {
J
Jianjun Kong 已提交
1030
		skb_queue_tail(&c->mfc_un.unres.unresolved, skb);
L
Linus Torvalds 已提交
1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041
		err = 0;
	}

	spin_unlock_bh(&mfc_unres_lock);
	return err;
}

/*
 *	MFC cache manipulation by user space mroute daemon
 */

1042
static int ipmr_mfc_delete(struct mr_table *mrt, struct mfcctl *mfc)
L
Linus Torvalds 已提交
1043 1044
{
	int line;
1045
	struct mfc_cache *c, *next;
L
Linus Torvalds 已提交
1046

J
Jianjun Kong 已提交
1047
	line = MFC_HASH(mfc->mfcc_mcastgrp.s_addr, mfc->mfcc_origin.s_addr);
L
Linus Torvalds 已提交
1048

1049
	list_for_each_entry_safe(c, next, &mrt->mfc_cache_array[line], list) {
L
Linus Torvalds 已提交
1050 1051
		if (c->mfc_origin == mfc->mfcc_origin.s_addr &&
		    c->mfc_mcastgrp == mfc->mfcc_mcastgrp.s_addr) {
1052
			list_del_rcu(&c->list);
L
Linus Torvalds 已提交
1053

1054
			ipmr_cache_free(c);
L
Linus Torvalds 已提交
1055 1056 1057 1058 1059 1060
			return 0;
		}
	}
	return -ENOENT;
}

1061 1062
static int ipmr_mfc_add(struct net *net, struct mr_table *mrt,
			struct mfcctl *mfc, int mrtsock)
L
Linus Torvalds 已提交
1063
{
1064
	bool found = false;
L
Linus Torvalds 已提交
1065
	int line;
1066
	struct mfc_cache *uc, *c;
L
Linus Torvalds 已提交
1067

1068 1069 1070
	if (mfc->mfcc_parent >= MAXVIFS)
		return -ENFILE;

J
Jianjun Kong 已提交
1071
	line = MFC_HASH(mfc->mfcc_mcastgrp.s_addr, mfc->mfcc_origin.s_addr);
L
Linus Torvalds 已提交
1072

1073
	list_for_each_entry(c, &mrt->mfc_cache_array[line], list) {
L
Linus Torvalds 已提交
1074
		if (c->mfc_origin == mfc->mfcc_origin.s_addr &&
1075 1076
		    c->mfc_mcastgrp == mfc->mfcc_mcastgrp.s_addr) {
			found = true;
L
Linus Torvalds 已提交
1077
			break;
1078
		}
L
Linus Torvalds 已提交
1079 1080
	}

1081
	if (found) {
L
Linus Torvalds 已提交
1082 1083
		write_lock_bh(&mrt_lock);
		c->mfc_parent = mfc->mfcc_parent;
1084
		ipmr_update_thresholds(mrt, c, mfc->mfcc_ttls);
L
Linus Torvalds 已提交
1085 1086 1087 1088 1089 1090
		if (!mrtsock)
			c->mfc_flags |= MFC_STATIC;
		write_unlock_bh(&mrt_lock);
		return 0;
	}

1091
	if (!ipv4_is_multicast(mfc->mfcc_mcastgrp.s_addr))
L
Linus Torvalds 已提交
1092 1093
		return -EINVAL;

1094
	c = ipmr_cache_alloc();
J
Jianjun Kong 已提交
1095
	if (c == NULL)
L
Linus Torvalds 已提交
1096 1097
		return -ENOMEM;

J
Jianjun Kong 已提交
1098 1099 1100
	c->mfc_origin = mfc->mfcc_origin.s_addr;
	c->mfc_mcastgrp = mfc->mfcc_mcastgrp.s_addr;
	c->mfc_parent = mfc->mfcc_parent;
1101
	ipmr_update_thresholds(mrt, c, mfc->mfcc_ttls);
L
Linus Torvalds 已提交
1102 1103 1104
	if (!mrtsock)
		c->mfc_flags |= MFC_STATIC;

1105
	list_add_rcu(&c->list, &mrt->mfc_cache_array[line]);
L
Linus Torvalds 已提交
1106 1107 1108 1109 1110

	/*
	 *	Check to see if we resolved a queued list. If so we
	 *	need to send on the frames and tidy up.
	 */
1111
	found = false;
L
Linus Torvalds 已提交
1112
	spin_lock_bh(&mfc_unres_lock);
1113
	list_for_each_entry(uc, &mrt->mfc_unres_queue, list) {
1114
		if (uc->mfc_origin == c->mfc_origin &&
L
Linus Torvalds 已提交
1115
		    uc->mfc_mcastgrp == c->mfc_mcastgrp) {
1116
			list_del(&uc->list);
1117
			atomic_dec(&mrt->cache_resolve_queue_len);
1118
			found = true;
L
Linus Torvalds 已提交
1119 1120 1121
			break;
		}
	}
1122 1123
	if (list_empty(&mrt->mfc_unres_queue))
		del_timer(&mrt->ipmr_expire_timer);
L
Linus Torvalds 已提交
1124 1125
	spin_unlock_bh(&mfc_unres_lock);

1126
	if (found) {
1127
		ipmr_cache_resolve(net, mrt, uc, c);
1128
		ipmr_cache_free(uc);
L
Linus Torvalds 已提交
1129 1130 1131 1132 1133 1134 1135
	}
	return 0;
}

/*
 *	Close the multicast socket, and clear the vif tables etc
 */
1136

1137
static void mroute_clean_tables(struct mr_table *mrt)
L
Linus Torvalds 已提交
1138 1139
{
	int i;
1140
	LIST_HEAD(list);
1141
	struct mfc_cache *c, *next;
1142

L
Linus Torvalds 已提交
1143 1144 1145
	/*
	 *	Shut down all active vif entries
	 */
1146 1147 1148
	for (i = 0; i < mrt->maxvif; i++) {
		if (!(mrt->vif_table[i].flags&VIFF_STATIC))
			vif_delete(mrt, i, 0, &list);
L
Linus Torvalds 已提交
1149
	}
1150
	unregister_netdevice_many(&list);
L
Linus Torvalds 已提交
1151 1152 1153 1154

	/*
	 *	Wipe the cache
	 */
1155
	for (i = 0; i < MFC_LINES; i++) {
1156
		list_for_each_entry_safe(c, next, &mrt->mfc_cache_array[i], list) {
1157
			if (c->mfc_flags & MFC_STATIC)
L
Linus Torvalds 已提交
1158
				continue;
1159
			list_del_rcu(&c->list);
1160
			ipmr_cache_free(c);
L
Linus Torvalds 已提交
1161 1162 1163
		}
	}

1164
	if (atomic_read(&mrt->cache_resolve_queue_len) != 0) {
L
Linus Torvalds 已提交
1165
		spin_lock_bh(&mfc_unres_lock);
1166
		list_for_each_entry_safe(c, next, &mrt->mfc_unres_queue, list) {
1167
			list_del(&c->list);
1168
			ipmr_destroy_unres(mrt, c);
L
Linus Torvalds 已提交
1169 1170 1171 1172 1173
		}
		spin_unlock_bh(&mfc_unres_lock);
	}
}

E
Eric Dumazet 已提交
1174 1175 1176
/* called from ip_ra_control(), before an RCU grace period,
 * we dont need to call synchronize_rcu() here
 */
L
Linus Torvalds 已提交
1177 1178
static void mrtsock_destruct(struct sock *sk)
{
1179
	struct net *net = sock_net(sk);
1180
	struct mr_table *mrt;
1181

L
Linus Torvalds 已提交
1182
	rtnl_lock();
1183
	ipmr_for_each_table(mrt, net) {
E
Eric Dumazet 已提交
1184
		if (sk == rtnl_dereference(mrt->mroute_sk)) {
1185
			IPV4_DEVCONF_ALL(net, MC_FORWARDING)--;
E
Eric Dumazet 已提交
1186
			rcu_assign_pointer(mrt->mroute_sk, NULL);
1187 1188
			mroute_clean_tables(mrt);
		}
L
Linus Torvalds 已提交
1189 1190 1191 1192 1193 1194 1195 1196 1197 1198
	}
	rtnl_unlock();
}

/*
 *	Socket options and virtual interface manipulation. The whole
 *	virtual interface system is a complete heap, but unfortunately
 *	that's how BSD mrouted happens to think. Maybe one day with a proper
 *	MOSPF/PIM router set up we can clean this up.
 */
1199

1200
int ip_mroute_setsockopt(struct sock *sk, int optname, char __user *optval, unsigned int optlen)
L
Linus Torvalds 已提交
1201 1202 1203 1204
{
	int ret;
	struct vifctl vif;
	struct mfcctl mfc;
1205
	struct net *net = sock_net(sk);
1206 1207 1208 1209 1210
	struct mr_table *mrt;

	mrt = ipmr_get_table(net, raw_sk(sk)->ipmr_table ? : RT_TABLE_DEFAULT);
	if (mrt == NULL)
		return -ENOENT;
1211

S
Stephen Hemminger 已提交
1212
	if (optname != MRT_INIT) {
E
Eric Dumazet 已提交
1213 1214
		if (sk != rcu_dereference_raw(mrt->mroute_sk) &&
		    !capable(CAP_NET_ADMIN))
L
Linus Torvalds 已提交
1215 1216 1217
			return -EACCES;
	}

S
Stephen Hemminger 已提交
1218 1219 1220
	switch (optname) {
	case MRT_INIT:
		if (sk->sk_type != SOCK_RAW ||
E
Eric Dumazet 已提交
1221
		    inet_sk(sk)->inet_num != IPPROTO_IGMP)
S
Stephen Hemminger 已提交
1222
			return -EOPNOTSUPP;
J
Jianjun Kong 已提交
1223
		if (optlen != sizeof(int))
S
Stephen Hemminger 已提交
1224
			return -ENOPROTOOPT;
L
Linus Torvalds 已提交
1225

S
Stephen Hemminger 已提交
1226
		rtnl_lock();
E
Eric Dumazet 已提交
1227
		if (rtnl_dereference(mrt->mroute_sk)) {
L
Linus Torvalds 已提交
1228
			rtnl_unlock();
S
Stephen Hemminger 已提交
1229 1230 1231 1232 1233
			return -EADDRINUSE;
		}

		ret = ip_ra_control(sk, 1, mrtsock_destruct);
		if (ret == 0) {
E
Eric Dumazet 已提交
1234
			rcu_assign_pointer(mrt->mroute_sk, sk);
1235
			IPV4_DEVCONF_ALL(net, MC_FORWARDING)++;
S
Stephen Hemminger 已提交
1236 1237 1238 1239
		}
		rtnl_unlock();
		return ret;
	case MRT_DONE:
E
Eric Dumazet 已提交
1240
		if (sk != rcu_dereference_raw(mrt->mroute_sk))
S
Stephen Hemminger 已提交
1241 1242 1243 1244
			return -EACCES;
		return ip_ra_control(sk, 0, NULL);
	case MRT_ADD_VIF:
	case MRT_DEL_VIF:
J
Jianjun Kong 已提交
1245
		if (optlen != sizeof(vif))
S
Stephen Hemminger 已提交
1246
			return -EINVAL;
J
Jianjun Kong 已提交
1247
		if (copy_from_user(&vif, optval, sizeof(vif)))
S
Stephen Hemminger 已提交
1248 1249 1250 1251
			return -EFAULT;
		if (vif.vifc_vifi >= MAXVIFS)
			return -ENFILE;
		rtnl_lock();
J
Jianjun Kong 已提交
1252
		if (optname == MRT_ADD_VIF) {
E
Eric Dumazet 已提交
1253 1254
			ret = vif_add(net, mrt, &vif,
				      sk == rtnl_dereference(mrt->mroute_sk));
S
Stephen Hemminger 已提交
1255
		} else {
1256
			ret = vif_delete(mrt, vif.vifc_vifi, 0, NULL);
S
Stephen Hemminger 已提交
1257 1258 1259
		}
		rtnl_unlock();
		return ret;
L
Linus Torvalds 已提交
1260 1261 1262 1263 1264

		/*
		 *	Manipulate the forwarding caches. These live
		 *	in a sort of kernel/user symbiosis.
		 */
S
Stephen Hemminger 已提交
1265 1266
	case MRT_ADD_MFC:
	case MRT_DEL_MFC:
J
Jianjun Kong 已提交
1267
		if (optlen != sizeof(mfc))
S
Stephen Hemminger 已提交
1268
			return -EINVAL;
J
Jianjun Kong 已提交
1269
		if (copy_from_user(&mfc, optval, sizeof(mfc)))
S
Stephen Hemminger 已提交
1270 1271
			return -EFAULT;
		rtnl_lock();
J
Jianjun Kong 已提交
1272
		if (optname == MRT_DEL_MFC)
1273
			ret = ipmr_mfc_delete(mrt, &mfc);
S
Stephen Hemminger 已提交
1274
		else
E
Eric Dumazet 已提交
1275 1276
			ret = ipmr_mfc_add(net, mrt, &mfc,
					   sk == rtnl_dereference(mrt->mroute_sk));
S
Stephen Hemminger 已提交
1277 1278
		rtnl_unlock();
		return ret;
L
Linus Torvalds 已提交
1279 1280 1281
		/*
		 *	Control PIM assert.
		 */
S
Stephen Hemminger 已提交
1282 1283 1284 1285 1286
	case MRT_ASSERT:
	{
		int v;
		if (get_user(v,(int __user *)optval))
			return -EFAULT;
1287
		mrt->mroute_do_assert = (v) ? 1 : 0;
S
Stephen Hemminger 已提交
1288 1289
		return 0;
	}
L
Linus Torvalds 已提交
1290
#ifdef CONFIG_IP_PIMSM
S
Stephen Hemminger 已提交
1291 1292
	case MRT_PIM:
	{
S
Stephen Hemminger 已提交
1293 1294
		int v;

S
Stephen Hemminger 已提交
1295 1296
		if (get_user(v,(int __user *)optval))
			return -EFAULT;
S
Stephen Hemminger 已提交
1297 1298
		v = (v) ? 1 : 0;

S
Stephen Hemminger 已提交
1299 1300
		rtnl_lock();
		ret = 0;
1301 1302 1303
		if (v != mrt->mroute_do_pim) {
			mrt->mroute_do_pim = v;
			mrt->mroute_do_assert = v;
L
Linus Torvalds 已提交
1304
		}
S
Stephen Hemminger 已提交
1305 1306 1307
		rtnl_unlock();
		return ret;
	}
1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320
#endif
#ifdef CONFIG_IP_MROUTE_MULTIPLE_TABLES
	case MRT_TABLE:
	{
		u32 v;

		if (optlen != sizeof(u32))
			return -EINVAL;
		if (get_user(v, (u32 __user *)optval))
			return -EFAULT;

		rtnl_lock();
		ret = 0;
E
Eric Dumazet 已提交
1321 1322 1323 1324 1325 1326 1327
		if (sk == rtnl_dereference(mrt->mroute_sk)) {
			ret = -EBUSY;
		} else {
			if (!ipmr_new_table(net, v))
				ret = -ENOMEM;
			raw_sk(sk)->ipmr_table = v;
		}
1328 1329 1330
		rtnl_unlock();
		return ret;
	}
L
Linus Torvalds 已提交
1331
#endif
S
Stephen Hemminger 已提交
1332 1333 1334 1335 1336 1337
	/*
	 *	Spurious command, or MRT_VERSION which you cannot
	 *	set.
	 */
	default:
		return -ENOPROTOOPT;
L
Linus Torvalds 已提交
1338 1339 1340 1341 1342 1343
	}
}

/*
 *	Getsock opt support for the multicast routing system.
 */
1344

J
Jianjun Kong 已提交
1345
int ip_mroute_getsockopt(struct sock *sk, int optname, char __user *optval, int __user *optlen)
L
Linus Torvalds 已提交
1346 1347 1348
{
	int olr;
	int val;
1349
	struct net *net = sock_net(sk);
1350 1351 1352 1353 1354
	struct mr_table *mrt;

	mrt = ipmr_get_table(net, raw_sk(sk)->ipmr_table ? : RT_TABLE_DEFAULT);
	if (mrt == NULL)
		return -ENOENT;
L
Linus Torvalds 已提交
1355

J
Jianjun Kong 已提交
1356
	if (optname != MRT_VERSION &&
L
Linus Torvalds 已提交
1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368
#ifdef CONFIG_IP_PIMSM
	   optname!=MRT_PIM &&
#endif
	   optname!=MRT_ASSERT)
		return -ENOPROTOOPT;

	if (get_user(olr, optlen))
		return -EFAULT;

	olr = min_t(unsigned int, olr, sizeof(int));
	if (olr < 0)
		return -EINVAL;
1369

J
Jianjun Kong 已提交
1370
	if (put_user(olr, optlen))
L
Linus Torvalds 已提交
1371
		return -EFAULT;
J
Jianjun Kong 已提交
1372 1373
	if (optname == MRT_VERSION)
		val = 0x0305;
L
Linus Torvalds 已提交
1374
#ifdef CONFIG_IP_PIMSM
J
Jianjun Kong 已提交
1375
	else if (optname == MRT_PIM)
1376
		val = mrt->mroute_do_pim;
L
Linus Torvalds 已提交
1377 1378
#endif
	else
1379
		val = mrt->mroute_do_assert;
J
Jianjun Kong 已提交
1380
	if (copy_to_user(optval, &val, olr))
L
Linus Torvalds 已提交
1381 1382 1383 1384 1385 1386 1387
		return -EFAULT;
	return 0;
}

/*
 *	The IP multicast ioctl support routines.
 */
1388

L
Linus Torvalds 已提交
1389 1390 1391 1392 1393 1394
int ipmr_ioctl(struct sock *sk, int cmd, void __user *arg)
{
	struct sioc_sg_req sr;
	struct sioc_vif_req vr;
	struct vif_device *vif;
	struct mfc_cache *c;
1395
	struct net *net = sock_net(sk);
1396 1397 1398 1399 1400
	struct mr_table *mrt;

	mrt = ipmr_get_table(net, raw_sk(sk)->ipmr_table ? : RT_TABLE_DEFAULT);
	if (mrt == NULL)
		return -ENOENT;
1401

S
Stephen Hemminger 已提交
1402 1403
	switch (cmd) {
	case SIOCGETVIFCNT:
J
Jianjun Kong 已提交
1404
		if (copy_from_user(&vr, arg, sizeof(vr)))
S
Stephen Hemminger 已提交
1405
			return -EFAULT;
1406
		if (vr.vifi >= mrt->maxvif)
S
Stephen Hemminger 已提交
1407 1408
			return -EINVAL;
		read_lock(&mrt_lock);
1409 1410
		vif = &mrt->vif_table[vr.vifi];
		if (VIF_EXISTS(mrt, vr.vifi)) {
J
Jianjun Kong 已提交
1411 1412 1413 1414
			vr.icount = vif->pkt_in;
			vr.ocount = vif->pkt_out;
			vr.ibytes = vif->bytes_in;
			vr.obytes = vif->bytes_out;
L
Linus Torvalds 已提交
1415 1416
			read_unlock(&mrt_lock);

J
Jianjun Kong 已提交
1417
			if (copy_to_user(arg, &vr, sizeof(vr)))
S
Stephen Hemminger 已提交
1418 1419 1420 1421 1422 1423
				return -EFAULT;
			return 0;
		}
		read_unlock(&mrt_lock);
		return -EADDRNOTAVAIL;
	case SIOCGETSGCNT:
J
Jianjun Kong 已提交
1424
		if (copy_from_user(&sr, arg, sizeof(sr)))
S
Stephen Hemminger 已提交
1425 1426
			return -EFAULT;

1427
		rcu_read_lock();
1428
		c = ipmr_cache_find(mrt, sr.src.s_addr, sr.grp.s_addr);
S
Stephen Hemminger 已提交
1429 1430 1431 1432
		if (c) {
			sr.pktcnt = c->mfc_un.res.pkt;
			sr.bytecnt = c->mfc_un.res.bytes;
			sr.wrong_if = c->mfc_un.res.wrong_if;
1433
			rcu_read_unlock();
S
Stephen Hemminger 已提交
1434

J
Jianjun Kong 已提交
1435
			if (copy_to_user(arg, &sr, sizeof(sr)))
S
Stephen Hemminger 已提交
1436 1437 1438
				return -EFAULT;
			return 0;
		}
1439
		rcu_read_unlock();
S
Stephen Hemminger 已提交
1440 1441 1442
		return -EADDRNOTAVAIL;
	default:
		return -ENOIOCTLCMD;
L
Linus Torvalds 已提交
1443 1444 1445 1446 1447 1448
	}
}


static int ipmr_device_event(struct notifier_block *this, unsigned long event, void *ptr)
{
1449
	struct net_device *dev = ptr;
1450
	struct net *net = dev_net(dev);
1451
	struct mr_table *mrt;
L
Linus Torvalds 已提交
1452 1453
	struct vif_device *v;
	int ct;
1454
	LIST_HEAD(list);
1455

L
Linus Torvalds 已提交
1456 1457
	if (event != NETDEV_UNREGISTER)
		return NOTIFY_DONE;
1458 1459 1460 1461 1462 1463 1464

	ipmr_for_each_table(mrt, net) {
		v = &mrt->vif_table[0];
		for (ct = 0; ct < mrt->maxvif; ct++, v++) {
			if (v->dev == dev)
				vif_delete(mrt, ct, 1, &list);
		}
L
Linus Torvalds 已提交
1465
	}
1466
	unregister_netdevice_many(&list);
L
Linus Torvalds 已提交
1467 1468 1469 1470
	return NOTIFY_DONE;
}


J
Jianjun Kong 已提交
1471
static struct notifier_block ip_mr_notifier = {
L
Linus Torvalds 已提交
1472 1473 1474 1475 1476 1477 1478 1479
	.notifier_call = ipmr_device_event,
};

/*
 * 	Encapsulate a packet by attaching a valid IPIP header to it.
 *	This avoids tunnel drivers and other mess and gives us the speed so
 *	important for multicast video.
 */
1480

A
Al Viro 已提交
1481
static void ip_encap(struct sk_buff *skb, __be32 saddr, __be32 daddr)
L
Linus Torvalds 已提交
1482
{
1483
	struct iphdr *iph;
1484
	struct iphdr *old_iph = ip_hdr(skb);
1485 1486

	skb_push(skb, sizeof(struct iphdr));
1487
	skb->transport_header = skb->network_header;
1488
	skb_reset_network_header(skb);
1489
	iph = ip_hdr(skb);
L
Linus Torvalds 已提交
1490 1491

	iph->version	= 	4;
1492 1493
	iph->tos	=	old_iph->tos;
	iph->ttl	=	old_iph->ttl;
L
Linus Torvalds 已提交
1494 1495 1496 1497 1498 1499
	iph->frag_off	=	0;
	iph->daddr	=	daddr;
	iph->saddr	=	saddr;
	iph->protocol	=	IPPROTO_IPIP;
	iph->ihl	=	5;
	iph->tot_len	=	htons(skb->len);
E
Eric Dumazet 已提交
1500
	ip_select_ident(iph, skb_dst(skb), NULL);
L
Linus Torvalds 已提交
1501 1502 1503 1504 1505 1506 1507 1508 1509 1510
	ip_send_check(iph);

	memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt));
	nf_reset(skb);
}

static inline int ipmr_forward_finish(struct sk_buff *skb)
{
	struct ip_options * opt	= &(IPCB(skb)->opt);

E
Eric Dumazet 已提交
1511
	IP_INC_STATS_BH(dev_net(skb_dst(skb)->dev), IPSTATS_MIB_OUTFORWDATAGRAMS);
L
Linus Torvalds 已提交
1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522

	if (unlikely(opt->optlen))
		ip_forward_options(skb);

	return dst_output(skb);
}

/*
 *	Processing handlers for ipmr_forward
 */

1523 1524
static void ipmr_queue_xmit(struct net *net, struct mr_table *mrt,
			    struct sk_buff *skb, struct mfc_cache *c, int vifi)
L
Linus Torvalds 已提交
1525
{
1526
	const struct iphdr *iph = ip_hdr(skb);
1527
	struct vif_device *vif = &mrt->vif_table[vifi];
L
Linus Torvalds 已提交
1528 1529 1530 1531 1532 1533 1534 1535 1536 1537
	struct net_device *dev;
	struct rtable *rt;
	int    encap = 0;

	if (vif->dev == NULL)
		goto out_free;

#ifdef CONFIG_IP_PIMSM
	if (vif->flags & VIFF_REGISTER) {
		vif->pkt_out++;
J
Jianjun Kong 已提交
1538
		vif->bytes_out += skb->len;
1539 1540
		vif->dev->stats.tx_bytes += skb->len;
		vif->dev->stats.tx_packets++;
1541
		ipmr_cache_report(mrt, skb, vifi, IGMPMSG_WHOLEPKT);
1542
		goto out_free;
L
Linus Torvalds 已提交
1543 1544 1545 1546 1547 1548 1549 1550 1551 1552
	}
#endif

	if (vif->flags&VIFF_TUNNEL) {
		struct flowi fl = { .oif = vif->link,
				    .nl_u = { .ip4_u =
					      { .daddr = vif->remote,
						.saddr = vif->local,
						.tos = RT_TOS(iph->tos) } },
				    .proto = IPPROTO_IPIP };
1553
		if (ip_route_output_key(net, &rt, &fl))
L
Linus Torvalds 已提交
1554 1555 1556 1557 1558 1559 1560 1561
			goto out_free;
		encap = sizeof(struct iphdr);
	} else {
		struct flowi fl = { .oif = vif->link,
				    .nl_u = { .ip4_u =
					      { .daddr = iph->daddr,
						.tos = RT_TOS(iph->tos) } },
				    .proto = IPPROTO_IPIP };
1562
		if (ip_route_output_key(net, &rt, &fl))
L
Linus Torvalds 已提交
1563 1564 1565
			goto out_free;
	}

1566
	dev = rt->dst.dev;
L
Linus Torvalds 已提交
1567

1568
	if (skb->len+encap > dst_mtu(&rt->dst) && (ntohs(iph->frag_off) & IP_DF)) {
L
Linus Torvalds 已提交
1569 1570 1571 1572 1573
		/* Do not fragment multicasts. Alas, IPv4 does not
		   allow to send ICMP, so that packets will disappear
		   to blackhole.
		 */

1574
		IP_INC_STATS_BH(dev_net(dev), IPSTATS_MIB_FRAGFAILS);
L
Linus Torvalds 已提交
1575 1576 1577 1578
		ip_rt_put(rt);
		goto out_free;
	}

1579
	encap += LL_RESERVED_SPACE(dev) + rt->dst.header_len;
L
Linus Torvalds 已提交
1580 1581

	if (skb_cow(skb, encap)) {
1582
		ip_rt_put(rt);
L
Linus Torvalds 已提交
1583 1584 1585 1586
		goto out_free;
	}

	vif->pkt_out++;
J
Jianjun Kong 已提交
1587
	vif->bytes_out += skb->len;
L
Linus Torvalds 已提交
1588

E
Eric Dumazet 已提交
1589
	skb_dst_drop(skb);
1590
	skb_dst_set(skb, &rt->dst);
1591
	ip_decrease_ttl(ip_hdr(skb));
L
Linus Torvalds 已提交
1592 1593 1594 1595 1596 1597

	/* FIXME: forward and output firewalls used to be called here.
	 * What do we do with netfilter? -- RR */
	if (vif->flags & VIFF_TUNNEL) {
		ip_encap(skb, vif->local, vif->remote);
		/* FIXME: extra output firewall step used to be here. --RR */
1598 1599
		vif->dev->stats.tx_packets++;
		vif->dev->stats.tx_bytes += skb->len;
L
Linus Torvalds 已提交
1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614
	}

	IPCB(skb)->flags |= IPSKB_FORWARDED;

	/*
	 * RFC1584 teaches, that DVMRP/PIM router must deliver packets locally
	 * not only before forwarding, but after forwarding on all output
	 * interfaces. It is clear, if mrouter runs a multicasting
	 * program, it should receive packets not depending to what interface
	 * program is joined.
	 * If we will not make it, the program will have to join on all
	 * interfaces. On the other hand, multihoming host (or router, but
	 * not mrouter) cannot join to more than one interface - it will
	 * result in receiving multiple packets.
	 */
1615
	NF_HOOK(NFPROTO_IPV4, NF_INET_FORWARD, skb, skb->dev, dev,
L
Linus Torvalds 已提交
1616 1617 1618 1619 1620 1621 1622
		ipmr_forward_finish);
	return;

out_free:
	kfree_skb(skb);
}

1623
static int ipmr_find_vif(struct mr_table *mrt, struct net_device *dev)
L
Linus Torvalds 已提交
1624 1625
{
	int ct;
1626 1627 1628

	for (ct = mrt->maxvif-1; ct >= 0; ct--) {
		if (mrt->vif_table[ct].dev == dev)
L
Linus Torvalds 已提交
1629 1630 1631 1632 1633 1634 1635
			break;
	}
	return ct;
}

/* "local" means that we should preserve one skb (for local delivery) */

1636 1637 1638
static int ip_mr_forward(struct net *net, struct mr_table *mrt,
			 struct sk_buff *skb, struct mfc_cache *cache,
			 int local)
L
Linus Torvalds 已提交
1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649
{
	int psend = -1;
	int vif, ct;

	vif = cache->mfc_parent;
	cache->mfc_un.res.pkt++;
	cache->mfc_un.res.bytes += skb->len;

	/*
	 * Wrong interface: drop packet and (maybe) send PIM assert.
	 */
1650
	if (mrt->vif_table[vif].dev != skb->dev) {
L
Linus Torvalds 已提交
1651 1652
		int true_vifi;

E
Eric Dumazet 已提交
1653
		if (skb_rtable(skb)->fl.iif == 0) {
L
Linus Torvalds 已提交
1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668
			/* It is our own packet, looped back.
			   Very complicated situation...

			   The best workaround until routing daemons will be
			   fixed is not to redistribute packet, if it was
			   send through wrong interface. It means, that
			   multicast applications WILL NOT work for
			   (S,G), which have default multicast route pointing
			   to wrong oif. In any case, it is not a good
			   idea to use multicasting applications on router.
			 */
			goto dont_forward;
		}

		cache->mfc_un.res.wrong_if++;
1669
		true_vifi = ipmr_find_vif(mrt, skb->dev);
L
Linus Torvalds 已提交
1670

1671
		if (true_vifi >= 0 && mrt->mroute_do_assert &&
L
Linus Torvalds 已提交
1672 1673 1674 1675 1676
		    /* pimsm uses asserts, when switching from RPT to SPT,
		       so that we cannot check that packet arrived on an oif.
		       It is bad, but otherwise we would need to move pretty
		       large chunk of pimd to kernel. Ough... --ANK
		     */
1677
		    (mrt->mroute_do_pim ||
1678
		     cache->mfc_un.res.ttls[true_vifi] < 255) &&
1679
		    time_after(jiffies,
L
Linus Torvalds 已提交
1680 1681
			       cache->mfc_un.res.last_assert + MFC_ASSERT_THRESH)) {
			cache->mfc_un.res.last_assert = jiffies;
1682
			ipmr_cache_report(mrt, skb, true_vifi, IGMPMSG_WRONGVIF);
L
Linus Torvalds 已提交
1683 1684 1685 1686
		}
		goto dont_forward;
	}

1687 1688
	mrt->vif_table[vif].pkt_in++;
	mrt->vif_table[vif].bytes_in += skb->len;
L
Linus Torvalds 已提交
1689 1690 1691 1692 1693

	/*
	 *	Forward the frame
	 */
	for (ct = cache->mfc_un.res.maxvif-1; ct >= cache->mfc_un.res.minvif; ct--) {
1694
		if (ip_hdr(skb)->ttl > cache->mfc_un.res.ttls[ct]) {
L
Linus Torvalds 已提交
1695 1696 1697
			if (psend != -1) {
				struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
				if (skb2)
1698 1699
					ipmr_queue_xmit(net, mrt, skb2, cache,
							psend);
L
Linus Torvalds 已提交
1700
			}
J
Jianjun Kong 已提交
1701
			psend = ct;
L
Linus Torvalds 已提交
1702 1703 1704 1705 1706 1707
		}
	}
	if (psend != -1) {
		if (local) {
			struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
			if (skb2)
1708
				ipmr_queue_xmit(net, mrt, skb2, cache, psend);
L
Linus Torvalds 已提交
1709
		} else {
1710
			ipmr_queue_xmit(net, mrt, skb, cache, psend);
L
Linus Torvalds 已提交
1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723
			return 0;
		}
	}

dont_forward:
	if (!local)
		kfree_skb(skb);
	return 0;
}


/*
 *	Multicast packets for forwarding arrive here
E
Eric Dumazet 已提交
1724
 *	Called with rcu_read_lock();
L
Linus Torvalds 已提交
1725 1726 1727 1728 1729
 */

int ip_mr_input(struct sk_buff *skb)
{
	struct mfc_cache *cache;
1730
	struct net *net = dev_net(skb->dev);
E
Eric Dumazet 已提交
1731
	int local = skb_rtable(skb)->rt_flags & RTCF_LOCAL;
1732 1733
	struct mr_table *mrt;
	int err;
L
Linus Torvalds 已提交
1734 1735 1736 1737

	/* Packet is looped back after forward, it should not be
	   forwarded second time, but still can be delivered locally.
	 */
E
Eric Dumazet 已提交
1738
	if (IPCB(skb)->flags & IPSKB_FORWARDED)
L
Linus Torvalds 已提交
1739 1740
		goto dont_forward;

1741
	err = ipmr_fib_lookup(net, &skb_rtable(skb)->fl, &mrt);
1742 1743
	if (err < 0) {
		kfree_skb(skb);
1744
		return err;
1745
	}
1746

L
Linus Torvalds 已提交
1747
	if (!local) {
E
Eric Dumazet 已提交
1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765
		if (IPCB(skb)->opt.router_alert) {
			if (ip_call_ra_chain(skb))
				return 0;
		} else if (ip_hdr(skb)->protocol == IPPROTO_IGMP) {
			/* IGMPv1 (and broken IGMPv2 implementations sort of
			 * Cisco IOS <= 11.2(8)) do not put router alert
			 * option to IGMP packets destined to routable
			 * groups. It is very bad, because it means
			 * that we can forward NO IGMP messages.
			 */
			struct sock *mroute_sk;

			mroute_sk = rcu_dereference(mrt->mroute_sk);
			if (mroute_sk) {
				nf_reset(skb);
				raw_rcv(mroute_sk, skb);
				return 0;
			}
L
Linus Torvalds 已提交
1766 1767 1768
		    }
	}

1769
	/* already under rcu_read_lock() */
1770
	cache = ipmr_cache_find(mrt, ip_hdr(skb)->saddr, ip_hdr(skb)->daddr);
L
Linus Torvalds 已提交
1771 1772 1773 1774

	/*
	 *	No usable cache entry
	 */
J
Jianjun Kong 已提交
1775
	if (cache == NULL) {
L
Linus Torvalds 已提交
1776 1777 1778 1779 1780
		int vif;

		if (local) {
			struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
			ip_local_deliver(skb);
1781
			if (skb2 == NULL)
L
Linus Torvalds 已提交
1782 1783 1784 1785
				return -ENOBUFS;
			skb = skb2;
		}

1786
		read_lock(&mrt_lock);
1787
		vif = ipmr_find_vif(mrt, skb->dev);
L
Linus Torvalds 已提交
1788
		if (vif >= 0) {
1789
			int err2 = ipmr_cache_unresolved(mrt, vif, skb);
L
Linus Torvalds 已提交
1790 1791
			read_unlock(&mrt_lock);

1792
			return err2;
L
Linus Torvalds 已提交
1793 1794 1795 1796 1797 1798
		}
		read_unlock(&mrt_lock);
		kfree_skb(skb);
		return -ENODEV;
	}

1799
	read_lock(&mrt_lock);
1800
	ip_mr_forward(net, mrt, skb, cache, local);
L
Linus Torvalds 已提交
1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814
	read_unlock(&mrt_lock);

	if (local)
		return ip_local_deliver(skb);

	return 0;

dont_forward:
	if (local)
		return ip_local_deliver(skb);
	kfree_skb(skb);
	return 0;
}

I
Ilpo Järvinen 已提交
1815
#ifdef CONFIG_IP_PIMSM
1816
/* called with rcu_read_lock() */
1817 1818
static int __pim_rcv(struct mr_table *mrt, struct sk_buff *skb,
		     unsigned int pimlen)
L
Linus Torvalds 已提交
1819
{
I
Ilpo Järvinen 已提交
1820 1821
	struct net_device *reg_dev = NULL;
	struct iphdr *encap;
L
Linus Torvalds 已提交
1822

I
Ilpo Järvinen 已提交
1823
	encap = (struct iphdr *)(skb_transport_header(skb) + pimlen);
L
Linus Torvalds 已提交
1824 1825 1826 1827 1828 1829
	/*
	   Check that:
	   a. packet is really destinted to a multicast group
	   b. packet is not a NULL-REGISTER
	   c. packet is not truncated
	 */
1830
	if (!ipv4_is_multicast(encap->daddr) ||
L
Linus Torvalds 已提交
1831
	    encap->tot_len == 0 ||
I
Ilpo Järvinen 已提交
1832 1833
	    ntohs(encap->tot_len) + pimlen > skb->len)
		return 1;
L
Linus Torvalds 已提交
1834 1835

	read_lock(&mrt_lock);
1836 1837
	if (mrt->mroute_reg_vif_num >= 0)
		reg_dev = mrt->vif_table[mrt->mroute_reg_vif_num].dev;
L
Linus Torvalds 已提交
1838 1839
	read_unlock(&mrt_lock);

1840
	if (reg_dev == NULL)
I
Ilpo Järvinen 已提交
1841
		return 1;
L
Linus Torvalds 已提交
1842

1843
	skb->mac_header = skb->network_header;
1844
	skb_pull(skb, (u8 *)encap - skb->data);
1845
	skb_reset_network_header(skb);
L
Linus Torvalds 已提交
1846
	skb->protocol = htons(ETH_P_IP);
1847
	skb->ip_summed = CHECKSUM_NONE;
L
Linus Torvalds 已提交
1848
	skb->pkt_type = PACKET_HOST;
1849 1850 1851

	skb_tunnel_rx(skb, reg_dev);

L
Linus Torvalds 已提交
1852
	netif_rx(skb);
I
Ilpo Järvinen 已提交
1853

1854
	return NET_RX_SUCCESS;
I
Ilpo Järvinen 已提交
1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865
}
#endif

#ifdef CONFIG_IP_PIMSM_V1
/*
 * Handle IGMP messages of PIMv1
 */

int pim_rcv_v1(struct sk_buff * skb)
{
	struct igmphdr *pim;
1866
	struct net *net = dev_net(skb->dev);
1867
	struct mr_table *mrt;
I
Ilpo Järvinen 已提交
1868 1869 1870 1871 1872 1873

	if (!pskb_may_pull(skb, sizeof(*pim) + sizeof(struct iphdr)))
		goto drop;

	pim = igmp_hdr(skb);

1874 1875 1876
	if (ipmr_fib_lookup(net, &skb_rtable(skb)->fl, &mrt) < 0)
		goto drop;

1877
	if (!mrt->mroute_do_pim ||
I
Ilpo Järvinen 已提交
1878 1879 1880
	    pim->group != PIM_V1_VERSION || pim->code != PIM_V1_REGISTER)
		goto drop;

1881
	if (__pim_rcv(mrt, skb, sizeof(*pim))) {
I
Ilpo Järvinen 已提交
1882 1883 1884
drop:
		kfree_skb(skb);
	}
L
Linus Torvalds 已提交
1885 1886 1887 1888 1889 1890 1891 1892
	return 0;
}
#endif

#ifdef CONFIG_IP_PIMSM_V2
static int pim_rcv(struct sk_buff * skb)
{
	struct pimreghdr *pim;
1893 1894
	struct net *net = dev_net(skb->dev);
	struct mr_table *mrt;
L
Linus Torvalds 已提交
1895

I
Ilpo Järvinen 已提交
1896
	if (!pskb_may_pull(skb, sizeof(*pim) + sizeof(struct iphdr)))
L
Linus Torvalds 已提交
1897 1898
		goto drop;

1899
	pim = (struct pimreghdr *)skb_transport_header(skb);
1900
	if (pim->type != ((PIM_VERSION<<4)|(PIM_REGISTER)) ||
L
Linus Torvalds 已提交
1901
	    (pim->flags&PIM_NULL_REGISTER) ||
1902
	    (ip_compute_csum((void *)pim, sizeof(*pim)) != 0 &&
1903
	     csum_fold(skb_checksum(skb, 0, skb->len, 0))))
L
Linus Torvalds 已提交
1904 1905
		goto drop;

1906 1907 1908 1909
	if (ipmr_fib_lookup(net, &skb_rtable(skb)->fl, &mrt) < 0)
		goto drop;

	if (__pim_rcv(mrt, skb, sizeof(*pim))) {
I
Ilpo Järvinen 已提交
1910 1911 1912
drop:
		kfree_skb(skb);
	}
L
Linus Torvalds 已提交
1913 1914 1915 1916
	return 0;
}
#endif

1917 1918
static int __ipmr_fill_mroute(struct mr_table *mrt, struct sk_buff *skb,
			      struct mfc_cache *c, struct rtmsg *rtm)
L
Linus Torvalds 已提交
1919 1920 1921
{
	int ct;
	struct rtnexthop *nhp;
1922
	u8 *b = skb_tail_pointer(skb);
L
Linus Torvalds 已提交
1923 1924
	struct rtattr *mp_head;

1925
	/* If cache is unresolved, don't try to parse IIF and OIF */
1926
	if (c->mfc_parent >= MAXVIFS)
1927 1928
		return -ENOENT;

1929 1930
	if (VIF_EXISTS(mrt, c->mfc_parent))
		RTA_PUT(skb, RTA_IIF, 4, &mrt->vif_table[c->mfc_parent].dev->ifindex);
L
Linus Torvalds 已提交
1931

J
Jianjun Kong 已提交
1932
	mp_head = (struct rtattr *)skb_put(skb, RTA_LENGTH(0));
L
Linus Torvalds 已提交
1933 1934

	for (ct = c->mfc_un.res.minvif; ct < c->mfc_un.res.maxvif; ct++) {
1935
		if (VIF_EXISTS(mrt, ct) && c->mfc_un.res.ttls[ct] < 255) {
L
Linus Torvalds 已提交
1936 1937
			if (skb_tailroom(skb) < RTA_ALIGN(RTA_ALIGN(sizeof(*nhp)) + 4))
				goto rtattr_failure;
J
Jianjun Kong 已提交
1938
			nhp = (struct rtnexthop *)skb_put(skb, RTA_ALIGN(sizeof(*nhp)));
L
Linus Torvalds 已提交
1939 1940
			nhp->rtnh_flags = 0;
			nhp->rtnh_hops = c->mfc_un.res.ttls[ct];
1941
			nhp->rtnh_ifindex = mrt->vif_table[ct].dev->ifindex;
L
Linus Torvalds 已提交
1942 1943 1944 1945
			nhp->rtnh_len = sizeof(*nhp);
		}
	}
	mp_head->rta_type = RTA_MULTIPATH;
1946
	mp_head->rta_len = skb_tail_pointer(skb) - (u8 *)mp_head;
L
Linus Torvalds 已提交
1947 1948 1949 1950
	rtm->rtm_type = RTN_MULTICAST;
	return 1;

rtattr_failure:
1951
	nlmsg_trim(skb, b);
L
Linus Torvalds 已提交
1952 1953 1954
	return -EMSGSIZE;
}

1955 1956
int ipmr_get_route(struct net *net,
		   struct sk_buff *skb, struct rtmsg *rtm, int nowait)
L
Linus Torvalds 已提交
1957 1958
{
	int err;
1959
	struct mr_table *mrt;
L
Linus Torvalds 已提交
1960
	struct mfc_cache *cache;
E
Eric Dumazet 已提交
1961
	struct rtable *rt = skb_rtable(skb);
L
Linus Torvalds 已提交
1962

1963 1964 1965 1966
	mrt = ipmr_get_table(net, RT_TABLE_DEFAULT);
	if (mrt == NULL)
		return -ENOENT;

1967
	rcu_read_lock();
1968
	cache = ipmr_cache_find(mrt, rt->rt_src, rt->rt_dst);
L
Linus Torvalds 已提交
1969

J
Jianjun Kong 已提交
1970
	if (cache == NULL) {
1971
		struct sk_buff *skb2;
1972
		struct iphdr *iph;
L
Linus Torvalds 已提交
1973 1974 1975 1976
		struct net_device *dev;
		int vif;

		if (nowait) {
1977
			rcu_read_unlock();
L
Linus Torvalds 已提交
1978 1979 1980 1981
			return -EAGAIN;
		}

		dev = skb->dev;
1982
		read_lock(&mrt_lock);
1983
		if (dev == NULL || (vif = ipmr_find_vif(mrt, dev)) < 0) {
L
Linus Torvalds 已提交
1984
			read_unlock(&mrt_lock);
1985
			rcu_read_unlock();
L
Linus Torvalds 已提交
1986 1987
			return -ENODEV;
		}
1988 1989 1990
		skb2 = skb_clone(skb, GFP_ATOMIC);
		if (!skb2) {
			read_unlock(&mrt_lock);
1991
			rcu_read_unlock();
1992 1993 1994
			return -ENOMEM;
		}

1995 1996
		skb_push(skb2, sizeof(struct iphdr));
		skb_reset_network_header(skb2);
1997 1998 1999 2000 2001
		iph = ip_hdr(skb2);
		iph->ihl = sizeof(struct iphdr) >> 2;
		iph->saddr = rt->rt_src;
		iph->daddr = rt->rt_dst;
		iph->version = 0;
2002
		err = ipmr_cache_unresolved(mrt, vif, skb2);
L
Linus Torvalds 已提交
2003
		read_unlock(&mrt_lock);
2004
		rcu_read_unlock();
L
Linus Torvalds 已提交
2005 2006 2007
		return err;
	}

2008 2009
	read_lock(&mrt_lock);
	if (!nowait && (rtm->rtm_flags & RTM_F_NOTIFY))
L
Linus Torvalds 已提交
2010
		cache->mfc_flags |= MFC_NOTIFY;
2011
	err = __ipmr_fill_mroute(mrt, skb, cache, rtm);
L
Linus Torvalds 已提交
2012
	read_unlock(&mrt_lock);
2013
	rcu_read_unlock();
L
Linus Torvalds 已提交
2014 2015 2016
	return err;
}

2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064
static int ipmr_fill_mroute(struct mr_table *mrt, struct sk_buff *skb,
			    u32 pid, u32 seq, struct mfc_cache *c)
{
	struct nlmsghdr *nlh;
	struct rtmsg *rtm;

	nlh = nlmsg_put(skb, pid, seq, RTM_NEWROUTE, sizeof(*rtm), NLM_F_MULTI);
	if (nlh == NULL)
		return -EMSGSIZE;

	rtm = nlmsg_data(nlh);
	rtm->rtm_family   = RTNL_FAMILY_IPMR;
	rtm->rtm_dst_len  = 32;
	rtm->rtm_src_len  = 32;
	rtm->rtm_tos      = 0;
	rtm->rtm_table    = mrt->id;
	NLA_PUT_U32(skb, RTA_TABLE, mrt->id);
	rtm->rtm_type     = RTN_MULTICAST;
	rtm->rtm_scope    = RT_SCOPE_UNIVERSE;
	rtm->rtm_protocol = RTPROT_UNSPEC;
	rtm->rtm_flags    = 0;

	NLA_PUT_BE32(skb, RTA_SRC, c->mfc_origin);
	NLA_PUT_BE32(skb, RTA_DST, c->mfc_mcastgrp);

	if (__ipmr_fill_mroute(mrt, skb, c, rtm) < 0)
		goto nla_put_failure;

	return nlmsg_end(skb, nlh);

nla_put_failure:
	nlmsg_cancel(skb, nlh);
	return -EMSGSIZE;
}

static int ipmr_rtm_dumproute(struct sk_buff *skb, struct netlink_callback *cb)
{
	struct net *net = sock_net(skb->sk);
	struct mr_table *mrt;
	struct mfc_cache *mfc;
	unsigned int t = 0, s_t;
	unsigned int h = 0, s_h;
	unsigned int e = 0, s_e;

	s_t = cb->args[0];
	s_h = cb->args[1];
	s_e = cb->args[2];

2065
	rcu_read_lock();
2066 2067 2068 2069 2070 2071
	ipmr_for_each_table(mrt, net) {
		if (t < s_t)
			goto next_table;
		if (t > s_t)
			s_h = 0;
		for (h = s_h; h < MFC_LINES; h++) {
2072
			list_for_each_entry_rcu(mfc, &mrt->mfc_cache_array[h], list) {
2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089
				if (e < s_e)
					goto next_entry;
				if (ipmr_fill_mroute(mrt, skb,
						     NETLINK_CB(cb->skb).pid,
						     cb->nlh->nlmsg_seq,
						     mfc) < 0)
					goto done;
next_entry:
				e++;
			}
			e = s_e = 0;
		}
		s_h = 0;
next_table:
		t++;
	}
done:
2090
	rcu_read_unlock();
2091 2092 2093 2094 2095 2096 2097 2098

	cb->args[2] = e;
	cb->args[1] = h;
	cb->args[0] = t;

	return skb->len;
}

2099
#ifdef CONFIG_PROC_FS
L
Linus Torvalds 已提交
2100 2101 2102 2103
/*
 *	The /proc interfaces to multicast routing /proc/ip_mr_cache /proc/ip_mr_vif
 */
struct ipmr_vif_iter {
2104
	struct seq_net_private p;
2105
	struct mr_table *mrt;
L
Linus Torvalds 已提交
2106 2107 2108
	int ct;
};

2109 2110
static struct vif_device *ipmr_vif_seq_idx(struct net *net,
					   struct ipmr_vif_iter *iter,
L
Linus Torvalds 已提交
2111 2112
					   loff_t pos)
{
2113
	struct mr_table *mrt = iter->mrt;
2114 2115 2116

	for (iter->ct = 0; iter->ct < mrt->maxvif; ++iter->ct) {
		if (!VIF_EXISTS(mrt, iter->ct))
L
Linus Torvalds 已提交
2117
			continue;
2118
		if (pos-- == 0)
2119
			return &mrt->vif_table[iter->ct];
L
Linus Torvalds 已提交
2120 2121 2122 2123 2124
	}
	return NULL;
}

static void *ipmr_vif_seq_start(struct seq_file *seq, loff_t *pos)
S
Stephen Hemminger 已提交
2125
	__acquires(mrt_lock)
L
Linus Torvalds 已提交
2126
{
2127
	struct ipmr_vif_iter *iter = seq->private;
2128
	struct net *net = seq_file_net(seq);
2129 2130 2131 2132 2133 2134 2135
	struct mr_table *mrt;

	mrt = ipmr_get_table(net, RT_TABLE_DEFAULT);
	if (mrt == NULL)
		return ERR_PTR(-ENOENT);

	iter->mrt = mrt;
2136

L
Linus Torvalds 已提交
2137
	read_lock(&mrt_lock);
2138
	return *pos ? ipmr_vif_seq_idx(net, seq->private, *pos - 1)
L
Linus Torvalds 已提交
2139 2140 2141 2142 2143 2144
		: SEQ_START_TOKEN;
}

static void *ipmr_vif_seq_next(struct seq_file *seq, void *v, loff_t *pos)
{
	struct ipmr_vif_iter *iter = seq->private;
2145
	struct net *net = seq_file_net(seq);
2146
	struct mr_table *mrt = iter->mrt;
L
Linus Torvalds 已提交
2147 2148 2149

	++*pos;
	if (v == SEQ_START_TOKEN)
2150
		return ipmr_vif_seq_idx(net, iter, 0);
2151

2152 2153
	while (++iter->ct < mrt->maxvif) {
		if (!VIF_EXISTS(mrt, iter->ct))
L
Linus Torvalds 已提交
2154
			continue;
2155
		return &mrt->vif_table[iter->ct];
L
Linus Torvalds 已提交
2156 2157 2158 2159 2160
	}
	return NULL;
}

static void ipmr_vif_seq_stop(struct seq_file *seq, void *v)
S
Stephen Hemminger 已提交
2161
	__releases(mrt_lock)
L
Linus Torvalds 已提交
2162 2163 2164 2165 2166 2167
{
	read_unlock(&mrt_lock);
}

static int ipmr_vif_seq_show(struct seq_file *seq, void *v)
{
2168 2169
	struct ipmr_vif_iter *iter = seq->private;
	struct mr_table *mrt = iter->mrt;
2170

L
Linus Torvalds 已提交
2171
	if (v == SEQ_START_TOKEN) {
2172
		seq_puts(seq,
L
Linus Torvalds 已提交
2173 2174 2175 2176 2177 2178 2179
			 "Interface      BytesIn  PktsIn  BytesOut PktsOut Flags Local    Remote\n");
	} else {
		const struct vif_device *vif = v;
		const char *name =  vif->dev ? vif->dev->name : "none";

		seq_printf(seq,
			   "%2Zd %-10s %8ld %7ld  %8ld %7ld %05X %08X %08X\n",
2180
			   vif - mrt->vif_table,
2181
			   name, vif->bytes_in, vif->pkt_in,
L
Linus Torvalds 已提交
2182 2183 2184 2185 2186 2187
			   vif->bytes_out, vif->pkt_out,
			   vif->flags, vif->local, vif->remote);
	}
	return 0;
}

2188
static const struct seq_operations ipmr_vif_seq_ops = {
L
Linus Torvalds 已提交
2189 2190 2191 2192 2193 2194 2195 2196
	.start = ipmr_vif_seq_start,
	.next  = ipmr_vif_seq_next,
	.stop  = ipmr_vif_seq_stop,
	.show  = ipmr_vif_seq_show,
};

static int ipmr_vif_open(struct inode *inode, struct file *file)
{
2197 2198
	return seq_open_net(inode, file, &ipmr_vif_seq_ops,
			    sizeof(struct ipmr_vif_iter));
L
Linus Torvalds 已提交
2199 2200
}

2201
static const struct file_operations ipmr_vif_fops = {
L
Linus Torvalds 已提交
2202 2203 2204 2205
	.owner	 = THIS_MODULE,
	.open    = ipmr_vif_open,
	.read    = seq_read,
	.llseek  = seq_lseek,
2206
	.release = seq_release_net,
L
Linus Torvalds 已提交
2207 2208 2209
};

struct ipmr_mfc_iter {
2210
	struct seq_net_private p;
2211
	struct mr_table *mrt;
2212
	struct list_head *cache;
L
Linus Torvalds 已提交
2213 2214 2215 2216
	int ct;
};


2217 2218
static struct mfc_cache *ipmr_mfc_seq_idx(struct net *net,
					  struct ipmr_mfc_iter *it, loff_t pos)
L
Linus Torvalds 已提交
2219
{
2220
	struct mr_table *mrt = it->mrt;
L
Linus Torvalds 已提交
2221 2222
	struct mfc_cache *mfc;

2223
	rcu_read_lock();
2224
	for (it->ct = 0; it->ct < MFC_LINES; it->ct++) {
2225
		it->cache = &mrt->mfc_cache_array[it->ct];
2226
		list_for_each_entry_rcu(mfc, it->cache, list)
2227
			if (pos-- == 0)
L
Linus Torvalds 已提交
2228
				return mfc;
2229
	}
2230
	rcu_read_unlock();
L
Linus Torvalds 已提交
2231 2232

	spin_lock_bh(&mfc_unres_lock);
2233
	it->cache = &mrt->mfc_unres_queue;
2234
	list_for_each_entry(mfc, it->cache, list)
2235
		if (pos-- == 0)
L
Linus Torvalds 已提交
2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246
			return mfc;
	spin_unlock_bh(&mfc_unres_lock);

	it->cache = NULL;
	return NULL;
}


static void *ipmr_mfc_seq_start(struct seq_file *seq, loff_t *pos)
{
	struct ipmr_mfc_iter *it = seq->private;
2247
	struct net *net = seq_file_net(seq);
2248
	struct mr_table *mrt;
2249

2250 2251 2252
	mrt = ipmr_get_table(net, RT_TABLE_DEFAULT);
	if (mrt == NULL)
		return ERR_PTR(-ENOENT);
2253

2254
	it->mrt = mrt;
L
Linus Torvalds 已提交
2255 2256
	it->cache = NULL;
	it->ct = 0;
2257
	return *pos ? ipmr_mfc_seq_idx(net, seq->private, *pos - 1)
L
Linus Torvalds 已提交
2258 2259 2260 2261 2262 2263 2264
		: SEQ_START_TOKEN;
}

static void *ipmr_mfc_seq_next(struct seq_file *seq, void *v, loff_t *pos)
{
	struct mfc_cache *mfc = v;
	struct ipmr_mfc_iter *it = seq->private;
2265
	struct net *net = seq_file_net(seq);
2266
	struct mr_table *mrt = it->mrt;
L
Linus Torvalds 已提交
2267 2268 2269 2270

	++*pos;

	if (v == SEQ_START_TOKEN)
2271
		return ipmr_mfc_seq_idx(net, seq->private, 0);
L
Linus Torvalds 已提交
2272

2273 2274
	if (mfc->list.next != it->cache)
		return list_entry(mfc->list.next, struct mfc_cache, list);
2275

2276
	if (it->cache == &mrt->mfc_unres_queue)
L
Linus Torvalds 已提交
2277 2278
		goto end_of_list;

2279
	BUG_ON(it->cache != &mrt->mfc_cache_array[it->ct]);
L
Linus Torvalds 已提交
2280 2281

	while (++it->ct < MFC_LINES) {
2282
		it->cache = &mrt->mfc_cache_array[it->ct];
2283 2284 2285
		if (list_empty(it->cache))
			continue;
		return list_first_entry(it->cache, struct mfc_cache, list);
L
Linus Torvalds 已提交
2286 2287 2288
	}

	/* exhausted cache_array, show unresolved */
2289
	rcu_read_unlock();
2290
	it->cache = &mrt->mfc_unres_queue;
L
Linus Torvalds 已提交
2291
	it->ct = 0;
2292

L
Linus Torvalds 已提交
2293
	spin_lock_bh(&mfc_unres_lock);
2294 2295
	if (!list_empty(it->cache))
		return list_first_entry(it->cache, struct mfc_cache, list);
L
Linus Torvalds 已提交
2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306

 end_of_list:
	spin_unlock_bh(&mfc_unres_lock);
	it->cache = NULL;

	return NULL;
}

static void ipmr_mfc_seq_stop(struct seq_file *seq, void *v)
{
	struct ipmr_mfc_iter *it = seq->private;
2307
	struct mr_table *mrt = it->mrt;
L
Linus Torvalds 已提交
2308

2309
	if (it->cache == &mrt->mfc_unres_queue)
L
Linus Torvalds 已提交
2310
		spin_unlock_bh(&mfc_unres_lock);
2311
	else if (it->cache == &mrt->mfc_cache_array[it->ct])
2312
		rcu_read_unlock();
L
Linus Torvalds 已提交
2313 2314 2315 2316 2317 2318 2319
}

static int ipmr_mfc_seq_show(struct seq_file *seq, void *v)
{
	int n;

	if (v == SEQ_START_TOKEN) {
2320
		seq_puts(seq,
L
Linus Torvalds 已提交
2321 2322 2323 2324
		 "Group    Origin   Iif     Pkts    Bytes    Wrong Oifs\n");
	} else {
		const struct mfc_cache *mfc = v;
		const struct ipmr_mfc_iter *it = seq->private;
2325
		const struct mr_table *mrt = it->mrt;
2326

2327 2328 2329
		seq_printf(seq, "%08X %08X %-3hd",
			   (__force u32) mfc->mfc_mcastgrp,
			   (__force u32) mfc->mfc_origin,
2330
			   mfc->mfc_parent);
L
Linus Torvalds 已提交
2331

2332
		if (it->cache != &mrt->mfc_unres_queue) {
2333 2334 2335 2336
			seq_printf(seq, " %8lu %8lu %8lu",
				   mfc->mfc_un.res.pkt,
				   mfc->mfc_un.res.bytes,
				   mfc->mfc_un.res.wrong_if);
S
Stephen Hemminger 已提交
2337 2338
			for (n = mfc->mfc_un.res.minvif;
			     n < mfc->mfc_un.res.maxvif; n++ ) {
2339
				if (VIF_EXISTS(mrt, n) &&
2340 2341
				    mfc->mfc_un.res.ttls[n] < 255)
					seq_printf(seq,
2342
					   " %2d:%-3d",
L
Linus Torvalds 已提交
2343 2344
					   n, mfc->mfc_un.res.ttls[n]);
			}
2345 2346 2347 2348 2349
		} else {
			/* unresolved mfc_caches don't contain
			 * pkt, bytes and wrong_if values
			 */
			seq_printf(seq, " %8lu %8lu %8lu", 0ul, 0ul, 0ul);
L
Linus Torvalds 已提交
2350 2351 2352 2353 2354 2355
		}
		seq_putc(seq, '\n');
	}
	return 0;
}

2356
static const struct seq_operations ipmr_mfc_seq_ops = {
L
Linus Torvalds 已提交
2357 2358 2359 2360 2361 2362 2363 2364
	.start = ipmr_mfc_seq_start,
	.next  = ipmr_mfc_seq_next,
	.stop  = ipmr_mfc_seq_stop,
	.show  = ipmr_mfc_seq_show,
};

static int ipmr_mfc_open(struct inode *inode, struct file *file)
{
2365 2366
	return seq_open_net(inode, file, &ipmr_mfc_seq_ops,
			    sizeof(struct ipmr_mfc_iter));
L
Linus Torvalds 已提交
2367 2368
}

2369
static const struct file_operations ipmr_mfc_fops = {
L
Linus Torvalds 已提交
2370 2371 2372 2373
	.owner	 = THIS_MODULE,
	.open    = ipmr_mfc_open,
	.read    = seq_read,
	.llseek  = seq_lseek,
2374
	.release = seq_release_net,
L
Linus Torvalds 已提交
2375
};
2376
#endif
L
Linus Torvalds 已提交
2377 2378

#ifdef CONFIG_IP_PIMSM_V2
2379
static const struct net_protocol pim_protocol = {
L
Linus Torvalds 已提交
2380
	.handler	=	pim_rcv,
T
Tom Goff 已提交
2381
	.netns_ok	=	1,
L
Linus Torvalds 已提交
2382 2383 2384 2385 2386 2387 2388
};
#endif


/*
 *	Setup for IP multicast routing
 */
2389 2390
static int __net_init ipmr_net_init(struct net *net)
{
2391
	int err;
2392

2393 2394
	err = ipmr_rules_init(net);
	if (err < 0)
2395
		goto fail;
2396 2397 2398 2399 2400 2401 2402 2403

#ifdef CONFIG_PROC_FS
	err = -ENOMEM;
	if (!proc_net_fops_create(net, "ip_mr_vif", 0, &ipmr_vif_fops))
		goto proc_vif_fail;
	if (!proc_net_fops_create(net, "ip_mr_cache", 0, &ipmr_mfc_fops))
		goto proc_cache_fail;
#endif
2404 2405
	return 0;

2406 2407 2408 2409
#ifdef CONFIG_PROC_FS
proc_cache_fail:
	proc_net_remove(net, "ip_mr_vif");
proc_vif_fail:
2410
	ipmr_rules_exit(net);
2411
#endif
2412 2413 2414 2415 2416 2417
fail:
	return err;
}

static void __net_exit ipmr_net_exit(struct net *net)
{
2418 2419 2420 2421
#ifdef CONFIG_PROC_FS
	proc_net_remove(net, "ip_mr_cache");
	proc_net_remove(net, "ip_mr_vif");
#endif
2422
	ipmr_rules_exit(net);
2423 2424 2425 2426 2427 2428
}

static struct pernet_operations ipmr_net_ops = {
	.init = ipmr_net_init,
	.exit = ipmr_net_exit,
};
2429

W
Wang Chen 已提交
2430
int __init ip_mr_init(void)
L
Linus Torvalds 已提交
2431
{
W
Wang Chen 已提交
2432 2433
	int err;

L
Linus Torvalds 已提交
2434 2435
	mrt_cachep = kmem_cache_create("ip_mrt_cache",
				       sizeof(struct mfc_cache),
2436
				       0, SLAB_HWCACHE_ALIGN | SLAB_PANIC,
2437
				       NULL);
W
Wang Chen 已提交
2438 2439 2440
	if (!mrt_cachep)
		return -ENOMEM;

2441 2442 2443 2444
	err = register_pernet_subsys(&ipmr_net_ops);
	if (err)
		goto reg_pernet_fail;

W
Wang Chen 已提交
2445 2446 2447
	err = register_netdevice_notifier(&ip_mr_notifier);
	if (err)
		goto reg_notif_fail;
T
Tom Goff 已提交
2448 2449 2450 2451 2452 2453 2454
#ifdef CONFIG_IP_PIMSM_V2
	if (inet_add_protocol(&pim_protocol, IPPROTO_PIM) < 0) {
		printk(KERN_ERR "ip_mr_init: can't add PIM protocol\n");
		err = -EAGAIN;
		goto add_proto_fail;
	}
#endif
2455
	rtnl_register(RTNL_FAMILY_IPMR, RTM_GETROUTE, NULL, ipmr_rtm_dumproute);
W
Wang Chen 已提交
2456
	return 0;
2457

T
Tom Goff 已提交
2458 2459 2460 2461
#ifdef CONFIG_IP_PIMSM_V2
add_proto_fail:
	unregister_netdevice_notifier(&ip_mr_notifier);
#endif
B
Benjamin Thery 已提交
2462
reg_notif_fail:
2463 2464
	unregister_pernet_subsys(&ipmr_net_ops);
reg_pernet_fail:
B
Benjamin Thery 已提交
2465
	kmem_cache_destroy(mrt_cachep);
W
Wang Chen 已提交
2466
	return err;
L
Linus Torvalds 已提交
2467
}