ip6_fib.c 37.7 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
2
 *	Linux INET6 implementation
L
Linus Torvalds 已提交
3 4 5
 *	Forwarding Information Database
 *
 *	Authors:
6
 *	Pedro Roque		<roque@di.fc.ul.pt>
L
Linus Torvalds 已提交
7 8 9 10 11 12 13 14 15 16 17 18
 *
 *	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.
 */

/*
 * 	Changes:
 * 	Yuji SEKIYA @USAGI:	Support default route on router node;
 * 				remove ip6_null_entry from the top of
 * 				routing table.
19
 * 	Ville Nuorvala:		Fixed routing subtrees.
L
Linus Torvalds 已提交
20
 */
21 22 23

#define pr_fmt(fmt) "IPv6: " fmt

L
Linus Torvalds 已提交
24 25 26 27 28 29 30
#include <linux/errno.h>
#include <linux/types.h>
#include <linux/net.h>
#include <linux/route.h>
#include <linux/netdevice.h>
#include <linux/in6.h>
#include <linux/init.h>
T
Thomas Graf 已提交
31
#include <linux/list.h>
32
#include <linux/slab.h>
L
Linus Torvalds 已提交
33 34 35 36 37 38 39 40 41 42 43

#include <net/ipv6.h>
#include <net/ndisc.h>
#include <net/addrconf.h>

#include <net/ip6_fib.h>
#include <net/ip6_route.h>

#define RT6_DEBUG 2

#if RT6_DEBUG >= 3
44
#define RT6_TRACE(x...) pr_debug(x)
L
Linus Torvalds 已提交
45 46 47 48
#else
#define RT6_TRACE(x...) do { ; } while (0)
#endif

49
static struct kmem_cache * fib6_node_kmem __read_mostly;
L
Linus Torvalds 已提交
50 51 52 53 54 55 56 57 58 59 60 61 62 63 64

enum fib_walk_state_t
{
#ifdef CONFIG_IPV6_SUBTREES
	FWS_S,
#endif
	FWS_L,
	FWS_R,
	FWS_C,
	FWS_U
};

struct fib6_cleaner_t
{
	struct fib6_walker_t w;
65
	struct net *net;
L
Linus Torvalds 已提交
66 67 68 69
	int (*func)(struct rt6_info *, void *arg);
	void *arg;
};

A
Adrian Bunk 已提交
70
static DEFINE_RWLOCK(fib6_walker_lock);
L
Linus Torvalds 已提交
71 72 73 74 75 76 77

#ifdef CONFIG_IPV6_SUBTREES
#define FWS_INIT FWS_S
#else
#define FWS_INIT FWS_L
#endif

78 79
static void fib6_prune_clones(struct net *net, struct fib6_node *fn,
			      struct rt6_info *rt);
80 81
static struct rt6_info *fib6_find_prefix(struct net *net, struct fib6_node *fn);
static struct fib6_node *fib6_repair_tree(struct net *net, struct fib6_node *fn);
A
Adrian Bunk 已提交
82 83
static int fib6_walk(struct fib6_walker_t *w);
static int fib6_walk_continue(struct fib6_walker_t *w);
L
Linus Torvalds 已提交
84 85 86 87 88 89 90 91 92 93

/*
 *	A routing update causes an increase of the serial number on the
 *	affected subtree. This allows for cached routes to be asynchronously
 *	tested when modifications are made to the destination cache as a
 *	result of redirects, path MTU changes, etc.
 */

static __u32 rt_sernum;

94 95
static void fib6_gc_timer_cb(unsigned long arg);

96 97
static LIST_HEAD(fib6_walkers);
#define FOR_WALKERS(w) list_for_each_entry(w, &fib6_walkers, lh)
L
Linus Torvalds 已提交
98

A
Adrian Bunk 已提交
99 100 101
static inline void fib6_walker_link(struct fib6_walker_t *w)
{
	write_lock_bh(&fib6_walker_lock);
102
	list_add(&w->lh, &fib6_walkers);
A
Adrian Bunk 已提交
103 104 105 106 107 108
	write_unlock_bh(&fib6_walker_lock);
}

static inline void fib6_walker_unlink(struct fib6_walker_t *w)
{
	write_lock_bh(&fib6_walker_lock);
109
	list_del(&w->lh);
A
Adrian Bunk 已提交
110 111
	write_unlock_bh(&fib6_walker_lock);
}
L
Linus Torvalds 已提交
112 113 114 115 116 117 118 119 120 121 122
static __inline__ u32 fib6_new_sernum(void)
{
	u32 n = ++rt_sernum;
	if ((__s32)n <= 0)
		rt_sernum = n = 1;
	return n;
}

/*
 *	Auxiliary address test functions for the radix tree.
 *
123
 *	These assume a 32bit processor (although it will work on
L
Linus Torvalds 已提交
124 125 126 127 128 129
 *	64bit processors)
 */

/*
 *	test bit
 */
130 131 132 133 134
#if defined(__LITTLE_ENDIAN)
# define BITOP_BE32_SWIZZLE	(0x1F & ~7)
#else
# define BITOP_BE32_SWIZZLE	0
#endif
L
Linus Torvalds 已提交
135

136
static __inline__ __be32 addr_bit_set(const void *token, int fn_bit)
L
Linus Torvalds 已提交
137
{
138
	const __be32 *addr = token;
139 140 141 142 143 144 145
	/*
	 * Here,
	 * 	1 << ((~fn_bit ^ BITOP_BE32_SWIZZLE) & 0x1f)
	 * is optimized version of
	 *	htonl(1 << ((~fn_bit)&0x1F))
	 * See include/asm-generic/bitops/le.h.
	 */
146 147
	return (__force __be32)(1 << ((~fn_bit ^ BITOP_BE32_SWIZZLE) & 0x1f)) &
	       addr[fn_bit >> 5];
L
Linus Torvalds 已提交
148 149 150 151 152 153
}

static __inline__ struct fib6_node * node_alloc(void)
{
	struct fib6_node *fn;

154
	fn = kmem_cache_zalloc(fib6_node_kmem, GFP_ATOMIC);
L
Linus Torvalds 已提交
155 156 157 158 159 160 161 162 163 164 165 166

	return fn;
}

static __inline__ void node_free(struct fib6_node * fn)
{
	kmem_cache_free(fib6_node_kmem, fn);
}

static __inline__ void rt6_release(struct rt6_info *rt)
{
	if (atomic_dec_and_test(&rt->rt6i_ref))
167
		dst_free(&rt->dst);
L
Linus Torvalds 已提交
168 169
}

170
static void fib6_link_table(struct net *net, struct fib6_table *tb)
171 172 173
{
	unsigned int h;

174 175 176 177 178 179
	/*
	 * Initialize table lock at a single place to give lockdep a key,
	 * tables aren't visible prior to being linked to the list.
	 */
	rwlock_init(&tb->tb6_lock);

180
	h = tb->tb6_id & (FIB6_TABLE_HASHSZ - 1);
181 182 183 184 185

	/*
	 * No protection necessary, this is the only list mutatation
	 * operation, tables never disappear once they exist.
	 */
186
	hlist_add_head_rcu(&tb->tb6_hlist, &net->ipv6.fib_table_hash[h]);
187
}
T
Thomas Graf 已提交
188

189
#ifdef CONFIG_IPV6_MULTIPLE_TABLES
190

191
static struct fib6_table *fib6_alloc_table(struct net *net, u32 id)
T
Thomas Graf 已提交
192 193 194 195
{
	struct fib6_table *table;

	table = kzalloc(sizeof(*table), GFP_ATOMIC);
196
	if (table) {
T
Thomas Graf 已提交
197
		table->tb6_id = id;
198
		table->tb6_root.leaf = net->ipv6.ip6_null_entry;
T
Thomas Graf 已提交
199
		table->tb6_root.fn_flags = RTN_ROOT | RTN_TL_ROOT | RTN_RTINFO;
200
		inet_peer_base_init(&table->tb6_peers);
T
Thomas Graf 已提交
201 202 203 204 205
	}

	return table;
}

206
struct fib6_table *fib6_new_table(struct net *net, u32 id)
T
Thomas Graf 已提交
207 208 209 210 211
{
	struct fib6_table *tb;

	if (id == 0)
		id = RT6_TABLE_MAIN;
212
	tb = fib6_get_table(net, id);
T
Thomas Graf 已提交
213 214 215
	if (tb)
		return tb;

216
	tb = fib6_alloc_table(net, id);
217
	if (tb)
218
		fib6_link_table(net, tb);
T
Thomas Graf 已提交
219 220 221 222

	return tb;
}

223
struct fib6_table *fib6_get_table(struct net *net, u32 id)
T
Thomas Graf 已提交
224 225
{
	struct fib6_table *tb;
226
	struct hlist_head *head;
T
Thomas Graf 已提交
227 228 229 230 231
	struct hlist_node *node;
	unsigned int h;

	if (id == 0)
		id = RT6_TABLE_MAIN;
232
	h = id & (FIB6_TABLE_HASHSZ - 1);
T
Thomas Graf 已提交
233
	rcu_read_lock();
234 235
	head = &net->ipv6.fib_table_hash[h];
	hlist_for_each_entry_rcu(tb, node, head, tb6_hlist) {
T
Thomas Graf 已提交
236 237 238 239 240 241 242 243 244 245
		if (tb->tb6_id == id) {
			rcu_read_unlock();
			return tb;
		}
	}
	rcu_read_unlock();

	return NULL;
}

246
static void __net_init fib6_tables_init(struct net *net)
T
Thomas Graf 已提交
247
{
248 249
	fib6_link_table(net, net->ipv6.fib6_main_tbl);
	fib6_link_table(net, net->ipv6.fib6_local_tbl);
T
Thomas Graf 已提交
250 251 252
}
#else

253
struct fib6_table *fib6_new_table(struct net *net, u32 id)
T
Thomas Graf 已提交
254
{
255
	return fib6_get_table(net, id);
T
Thomas Graf 已提交
256 257
}

258
struct fib6_table *fib6_get_table(struct net *net, u32 id)
T
Thomas Graf 已提交
259
{
260
	  return net->ipv6.fib6_main_tbl;
T
Thomas Graf 已提交
261 262
}

263
struct dst_entry *fib6_rule_lookup(struct net *net, struct flowi6 *fl6,
264
				   int flags, pol_lookup_t lookup)
T
Thomas Graf 已提交
265
{
266
	return (struct dst_entry *) lookup(net, net->ipv6.fib6_main_tbl, fl6, flags);
T
Thomas Graf 已提交
267 268
}

269
static void __net_init fib6_tables_init(struct net *net)
T
Thomas Graf 已提交
270
{
271
	fib6_link_table(net, net->ipv6.fib6_main_tbl);
T
Thomas Graf 已提交
272 273 274 275
}

#endif

276 277 278 279 280
static int fib6_dump_node(struct fib6_walker_t *w)
{
	int res;
	struct rt6_info *rt;

281
	for (rt = w->leaf; rt; rt = rt->dst.rt6_next) {
282 283 284 285 286 287
		res = rt6_dump_route(rt, w->args);
		if (res < 0) {
			/* Frame is full, suspend walking */
			w->leaf = rt;
			return 1;
		}
288
		WARN_ON(res == 0);
289 290 291 292 293 294 295 296 297 298
	}
	w->leaf = NULL;
	return 0;
}

static void fib6_dump_end(struct netlink_callback *cb)
{
	struct fib6_walker_t *w = (void*)cb->args[2];

	if (w) {
299 300 301 302
		if (cb->args[4]) {
			cb->args[4] = 0;
			fib6_walker_unlink(w);
		}
303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325
		cb->args[2] = 0;
		kfree(w);
	}
	cb->done = (void*)cb->args[3];
	cb->args[1] = 3;
}

static int fib6_dump_done(struct netlink_callback *cb)
{
	fib6_dump_end(cb);
	return cb->done ? cb->done(cb) : 0;
}

static int fib6_dump_table(struct fib6_table *table, struct sk_buff *skb,
			   struct netlink_callback *cb)
{
	struct fib6_walker_t *w;
	int res;

	w = (void *)cb->args[2];
	w->root = &table->tb6_root;

	if (cb->args[4] == 0) {
326 327 328
		w->count = 0;
		w->skip = 0;

329 330 331
		read_lock_bh(&table->tb6_lock);
		res = fib6_walk(w);
		read_unlock_bh(&table->tb6_lock);
332
		if (res > 0) {
333
			cb->args[4] = 1;
334 335
			cb->args[5] = w->root->fn_sernum;
		}
336
	} else {
337 338 339 340 341 342 343 344 345
		if (cb->args[5] != w->root->fn_sernum) {
			/* Begin at the root if the tree changed */
			cb->args[5] = w->root->fn_sernum;
			w->state = FWS_INIT;
			w->node = w->root;
			w->skip = w->count;
		} else
			w->skip = 0;

346 347 348
		read_lock_bh(&table->tb6_lock);
		res = fib6_walk_continue(w);
		read_unlock_bh(&table->tb6_lock);
349 350 351
		if (res <= 0) {
			fib6_walker_unlink(w);
			cb->args[4] = 0;
352 353
		}
	}
354

355 356 357
	return res;
}

358
static int inet6_dump_fib(struct sk_buff *skb, struct netlink_callback *cb)
359
{
360
	struct net *net = sock_net(skb->sk);
361 362 363 364 365 366
	unsigned int h, s_h;
	unsigned int e = 0, s_e;
	struct rt6_rtnl_dump_arg arg;
	struct fib6_walker_t *w;
	struct fib6_table *tb;
	struct hlist_node *node;
367
	struct hlist_head *head;
368 369 370 371 372 373
	int res = 0;

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

	w = (void *)cb->args[2];
374
	if (!w) {
375 376 377 378 379 380 381 382 383 384 385
		/* New dump:
		 *
		 * 1. hook callback destructor.
		 */
		cb->args[3] = (long)cb->done;
		cb->done = fib6_dump_done;

		/*
		 * 2. allocate and initialize walker.
		 */
		w = kzalloc(sizeof(*w), GFP_ATOMIC);
386
		if (!w)
387 388 389 390 391 392 393
			return -ENOMEM;
		w->func = fib6_dump_node;
		cb->args[2] = (long)w;
	}

	arg.skb = skb;
	arg.cb = cb;
394
	arg.net = net;
395 396
	w->args = &arg;

397
	rcu_read_lock();
398
	for (h = s_h; h < FIB6_TABLE_HASHSZ; h++, s_e = 0) {
399
		e = 0;
400
		head = &net->ipv6.fib_table_hash[h];
401
		hlist_for_each_entry_rcu(tb, node, head, tb6_hlist) {
402 403 404 405 406 407 408 409 410 411
			if (e < s_e)
				goto next;
			res = fib6_dump_table(tb, skb, cb);
			if (res != 0)
				goto out;
next:
			e++;
		}
	}
out:
412
	rcu_read_unlock();
413 414 415 416 417 418 419 420
	cb->args[1] = e;
	cb->args[0] = h;

	res = res < 0 ? res : skb->len;
	if (res <= 0)
		fib6_dump_end(cb);
	return res;
}
L
Linus Torvalds 已提交
421 422 423 424 425 426 427 428 429 430 431

/*
 *	Routing Table
 *
 *	return the appropriate node for a routing tree "add" operation
 *	by either creating and inserting or by returning an existing
 *	node.
 */

static struct fib6_node * fib6_add_1(struct fib6_node *root, void *addr,
				     int addrlen, int plen,
432 433
				     int offset, int allow_create,
				     int replace_required)
L
Linus Torvalds 已提交
434 435 436 437 438
{
	struct fib6_node *fn, *in, *ln;
	struct fib6_node *pn = NULL;
	struct rt6key *key;
	int	bit;
439
	__be32	dir = 0;
L
Linus Torvalds 已提交
440 441 442 443 444 445 446 447 448 449 450 451 452 453 454
	__u32	sernum = fib6_new_sernum();

	RT6_TRACE("fib6_add_1\n");

	/* insert node in tree */

	fn = root;

	do {
		key = (struct rt6key *)((u8 *)fn->leaf + offset);

		/*
		 *	Prefix match
		 */
		if (plen < fn->fn_bit ||
455
		    !ipv6_prefix_equal(&key->addr, addr, fn->fn_bit)) {
456 457
			if (!allow_create) {
				if (replace_required) {
458
					pr_warn("Can't replace route, no match found\n");
459 460
					return ERR_PTR(-ENOENT);
				}
461
				pr_warn("NLM_F_CREATE should be set when creating new route\n");
462
			}
L
Linus Torvalds 已提交
463
			goto insert_above;
464
		}
465

L
Linus Torvalds 已提交
466 467 468
		/*
		 *	Exact match ?
		 */
469

L
Linus Torvalds 已提交
470 471
		if (plen == fn->fn_bit) {
			/* clean up an intermediate node */
472
			if (!(fn->fn_flags & RTN_RTINFO)) {
L
Linus Torvalds 已提交
473 474 475
				rt6_release(fn->leaf);
				fn->leaf = NULL;
			}
476

L
Linus Torvalds 已提交
477
			fn->fn_sernum = sernum;
478

L
Linus Torvalds 已提交
479 480 481 482 483 484
			return fn;
		}

		/*
		 *	We have more bits to go
		 */
485

L
Linus Torvalds 已提交
486 487 488 489 490 491 492
		/* Try to walk down on tree. */
		fn->fn_sernum = sernum;
		dir = addr_bit_set(addr, fn->fn_bit);
		pn = fn;
		fn = dir ? fn->right: fn->left;
	} while (fn);

493
	if (!allow_create) {
494 495 496 497 498 499 500 501 502
		/* We should not create new node because
		 * NLM_F_REPLACE was specified without NLM_F_CREATE
		 * I assume it is safe to require NLM_F_CREATE when
		 * REPLACE flag is used! Later we may want to remove the
		 * check for replace_required, because according
		 * to netlink specification, NLM_F_CREATE
		 * MUST be specified if new route is created.
		 * That would keep IPv6 consistent with IPv4
		 */
503
		if (replace_required) {
504
			pr_warn("Can't replace route, no match found\n");
505 506
			return ERR_PTR(-ENOENT);
		}
507
		pr_warn("NLM_F_CREATE should be set when creating new route\n");
508
	}
L
Linus Torvalds 已提交
509 510 511 512 513 514 515
	/*
	 *	We walked to the bottom of tree.
	 *	Create new leaf node without children.
	 */

	ln = node_alloc();

516
	if (!ln)
517
		return ERR_PTR(-ENOMEM);
L
Linus Torvalds 已提交
518
	ln->fn_bit = plen;
519

L
Linus Torvalds 已提交
520 521 522 523 524 525 526 527 528 529 530 531 532
	ln->parent = pn;
	ln->fn_sernum = sernum;

	if (dir)
		pn->right = ln;
	else
		pn->left  = ln;

	return ln;


insert_above:
	/*
533
	 * split since we don't have a common prefix anymore or
L
Linus Torvalds 已提交
534 535 536 537 538 539 540 541 542 543
	 * we have a less significant route.
	 * we've to insert an intermediate node on the list
	 * this new node will point to the one we need to create
	 * and the current
	 */

	pn = fn->parent;

	/* find 1st bit in difference between the 2 addrs.

544
	   See comment in __ipv6_addr_diff: bit may be an invalid value,
L
Linus Torvalds 已提交
545 546
	   but if it is >= plen, the value is ignored in any case.
	 */
547

548
	bit = __ipv6_addr_diff(addr, &key->addr, addrlen);
L
Linus Torvalds 已提交
549

550 551
	/*
	 *		(intermediate)[in]
L
Linus Torvalds 已提交
552 553 554 555 556 557
	 *	          /	   \
	 *	(new leaf node)[ln] (old node)[fn]
	 */
	if (plen > bit) {
		in = node_alloc();
		ln = node_alloc();
558

559
		if (!in || !ln) {
L
Linus Torvalds 已提交
560 561 562 563
			if (in)
				node_free(in);
			if (ln)
				node_free(ln);
564
			return ERR_PTR(-ENOMEM);
L
Linus Torvalds 已提交
565 566
		}

567 568
		/*
		 * new intermediate node.
L
Linus Torvalds 已提交
569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604
		 * RTN_RTINFO will
		 * be off since that an address that chooses one of
		 * the branches would not match less specific routes
		 * in the other branch
		 */

		in->fn_bit = bit;

		in->parent = pn;
		in->leaf = fn->leaf;
		atomic_inc(&in->leaf->rt6i_ref);

		in->fn_sernum = sernum;

		/* update parent pointer */
		if (dir)
			pn->right = in;
		else
			pn->left  = in;

		ln->fn_bit = plen;

		ln->parent = in;
		fn->parent = in;

		ln->fn_sernum = sernum;

		if (addr_bit_set(addr, bit)) {
			in->right = ln;
			in->left  = fn;
		} else {
			in->left  = ln;
			in->right = fn;
		}
	} else { /* plen <= bit */

605
		/*
L
Linus Torvalds 已提交
606 607 608 609 610 611 612
		 *		(new leaf node)[ln]
		 *	          /	   \
		 *	     (old node)[fn] NULL
		 */

		ln = node_alloc();

613
		if (!ln)
614
			return ERR_PTR(-ENOMEM);
L
Linus Torvalds 已提交
615 616 617 618 619 620

		ln->fn_bit = plen;

		ln->parent = pn;

		ln->fn_sernum = sernum;
621

L
Linus Torvalds 已提交
622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641
		if (dir)
			pn->right = ln;
		else
			pn->left  = ln;

		if (addr_bit_set(&key->addr, plen))
			ln->right = fn;
		else
			ln->left  = fn;

		fn->parent = ln;
	}
	return ln;
}

/*
 *	Insert routing information in a node.
 */

static int fib6_add_rt2node(struct fib6_node *fn, struct rt6_info *rt,
642
			    struct nl_info *info)
L
Linus Torvalds 已提交
643 644 645
{
	struct rt6_info *iter = NULL;
	struct rt6_info **ins;
646 647 648 649
	int replace = (info->nlh &&
		       (info->nlh->nlmsg_flags & NLM_F_REPLACE));
	int add = (!info->nlh ||
		   (info->nlh->nlmsg_flags & NLM_F_CREATE));
650
	int found = 0;
L
Linus Torvalds 已提交
651 652 653

	ins = &fn->leaf;

654
	for (iter = fn->leaf; iter; iter = iter->dst.rt6_next) {
L
Linus Torvalds 已提交
655 656 657 658 659 660 661 662
		/*
		 *	Search for duplicates
		 */

		if (iter->rt6i_metric == rt->rt6i_metric) {
			/*
			 *	Same priority level
			 */
663 664
			if (info->nlh &&
			    (info->nlh->nlmsg_flags & NLM_F_EXCL))
665 666 667 668 669
				return -EEXIST;
			if (replace) {
				found++;
				break;
			}
L
Linus Torvalds 已提交
670

671
			if (iter->dst.dev == rt->dst.dev &&
L
Linus Torvalds 已提交
672 673 674
			    iter->rt6i_idev == rt->rt6i_idev &&
			    ipv6_addr_equal(&iter->rt6i_gateway,
					    &rt->rt6i_gateway)) {
675 676
				if (rt->rt6i_nsiblings)
					rt->rt6i_nsiblings = 0;
677
				if (!(iter->rt6i_flags & RTF_EXPIRES))
L
Linus Torvalds 已提交
678
					return -EEXIST;
679 680 681 682
				if (!(rt->rt6i_flags & RTF_EXPIRES))
					rt6_clean_expires(iter);
				else
					rt6_set_expires(iter, rt->dst.expires);
L
Linus Torvalds 已提交
683 684
				return -EEXIST;
			}
685 686 687 688 689 690 691 692 693 694 695 696 697 698 699
			/* If we have the same destination and the same metric,
			 * but not the same gateway, then the route we try to
			 * add is sibling to this route, increment our counter
			 * of siblings, and later we will add our route to the
			 * list.
			 * Only static routes (which don't have flag
			 * RTF_EXPIRES) are used for ECMPv6.
			 *
			 * To avoid long list, we only had siblings if the
			 * route have a gateway.
			 */
			if (rt->rt6i_flags & RTF_GATEWAY &&
			    !(rt->rt6i_flags & RTF_EXPIRES) &&
			    !(iter->rt6i_flags & RTF_EXPIRES))
				rt->rt6i_nsiblings++;
L
Linus Torvalds 已提交
700 701 702 703 704
		}

		if (iter->rt6i_metric > rt->rt6i_metric)
			break;

705
		ins = &iter->dst.rt6_next;
L
Linus Torvalds 已提交
706 707
	}

708 709 710 711
	/* Reset round-robin state, if necessary */
	if (ins == &fn->leaf)
		fn->rr_ptr = NULL;

712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740
	/* Link this route to others same route. */
	if (rt->rt6i_nsiblings) {
		unsigned int rt6i_nsiblings;
		struct rt6_info *sibling, *temp_sibling;

		/* Find the first route that have the same metric */
		sibling = fn->leaf;
		while (sibling) {
			if (sibling->rt6i_metric == rt->rt6i_metric) {
				list_add_tail(&rt->rt6i_siblings,
					      &sibling->rt6i_siblings);
				break;
			}
			sibling = sibling->dst.rt6_next;
		}
		/* For each sibling in the list, increment the counter of
		 * siblings. BUG() if counters does not match, list of siblings
		 * is broken!
		 */
		rt6i_nsiblings = 0;
		list_for_each_entry_safe(sibling, temp_sibling,
					 &rt->rt6i_siblings, rt6i_siblings) {
			sibling->rt6i_nsiblings++;
			BUG_ON(sibling->rt6i_nsiblings != rt->rt6i_nsiblings);
			rt6i_nsiblings++;
		}
		BUG_ON(rt6i_nsiblings != rt->rt6i_nsiblings);
	}

L
Linus Torvalds 已提交
741 742 743
	/*
	 *	insert node
	 */
744 745
	if (!replace) {
		if (!add)
746
			pr_warn("NLM_F_CREATE should be set when creating new route\n");
747 748 749 750 751 752 753 754 755

add:
		rt->dst.rt6_next = iter;
		*ins = rt;
		rt->rt6i_node = fn;
		atomic_inc(&rt->rt6i_ref);
		inet6_rt_notify(RTM_NEWROUTE, rt, info);
		info->nl_net->ipv6.rt6_stats->fib_rt_entries++;

756
		if (!(fn->fn_flags & RTN_RTINFO)) {
757 758 759
			info->nl_net->ipv6.rt6_stats->fib_route_nodes++;
			fn->fn_flags |= RTN_RTINFO;
		}
L
Linus Torvalds 已提交
760

761 762 763 764
	} else {
		if (!found) {
			if (add)
				goto add;
765
			pr_warn("NLM_F_REPLACE set, but no existing node found!\n");
766 767 768 769 770 771 772 773
			return -ENOENT;
		}
		*ins = rt;
		rt->rt6i_node = fn;
		rt->dst.rt6_next = iter->dst.rt6_next;
		atomic_inc(&rt->rt6i_ref);
		inet6_rt_notify(RTM_NEWROUTE, rt, info);
		rt6_release(iter);
774
		if (!(fn->fn_flags & RTN_RTINFO)) {
775 776 777
			info->nl_net->ipv6.rt6_stats->fib_route_nodes++;
			fn->fn_flags |= RTN_RTINFO;
		}
L
Linus Torvalds 已提交
778 779 780 781 782
	}

	return 0;
}

783
static __inline__ void fib6_start_gc(struct net *net, struct rt6_info *rt)
L
Linus Torvalds 已提交
784
{
785
	if (!timer_pending(&net->ipv6.ip6_fib_timer) &&
786
	    (rt->rt6i_flags & (RTF_EXPIRES | RTF_CACHE)))
787
		mod_timer(&net->ipv6.ip6_fib_timer,
S
Stephen Hemminger 已提交
788
			  jiffies + net->ipv6.sysctl.ip6_rt_gc_interval);
L
Linus Torvalds 已提交
789 790
}

791
void fib6_force_start_gc(struct net *net)
L
Linus Torvalds 已提交
792
{
793 794
	if (!timer_pending(&net->ipv6.ip6_fib_timer))
		mod_timer(&net->ipv6.ip6_fib_timer,
S
Stephen Hemminger 已提交
795
			  jiffies + net->ipv6.sysctl.ip6_rt_gc_interval);
L
Linus Torvalds 已提交
796 797 798 799 800 801 802 803
}

/*
 *	Add routing information to the routing tree.
 *	<destination addr>/<source addr>
 *	with source addr info in sub-trees
 */

804
int fib6_add(struct fib6_node *root, struct rt6_info *rt, struct nl_info *info)
L
Linus Torvalds 已提交
805
{
806
	struct fib6_node *fn, *pn = NULL;
L
Linus Torvalds 已提交
807
	int err = -ENOMEM;
808 809
	int allow_create = 1;
	int replace_required = 0;
810 811 812

	if (info->nlh) {
		if (!(info->nlh->nlmsg_flags & NLM_F_CREATE))
813
			allow_create = 0;
814
		if (info->nlh->nlmsg_flags & NLM_F_REPLACE)
815 816 817
			replace_required = 1;
	}
	if (!allow_create && !replace_required)
818
		pr_warn("RTM_NEWROUTE with no NLM_F_CREATE or NLM_F_REPLACE\n");
L
Linus Torvalds 已提交
819 820

	fn = fib6_add_1(root, &rt->rt6i_dst.addr, sizeof(struct in6_addr),
821 822
			rt->rt6i_dst.plen, offsetof(struct rt6_info, rt6i_dst),
			allow_create, replace_required);
823 824 825

	if (IS_ERR(fn)) {
		err = PTR_ERR(fn);
L
Linus Torvalds 已提交
826
		goto out;
827
	}
L
Linus Torvalds 已提交
828

829 830
	pn = fn;

L
Linus Torvalds 已提交
831 832 833 834
#ifdef CONFIG_IPV6_SUBTREES
	if (rt->rt6i_src.plen) {
		struct fib6_node *sn;

835
		if (!fn->subtree) {
L
Linus Torvalds 已提交
836 837 838 839 840 841 842 843 844 845 846 847 848 849
			struct fib6_node *sfn;

			/*
			 * Create subtree.
			 *
			 *		fn[main tree]
			 *		|
			 *		sfn[subtree root]
			 *		   \
			 *		    sn[new leaf node]
			 */

			/* Create subtree root node */
			sfn = node_alloc();
850
			if (!sfn)
L
Linus Torvalds 已提交
851 852
				goto st_failure;

853 854
			sfn->leaf = info->nl_net->ipv6.ip6_null_entry;
			atomic_inc(&info->nl_net->ipv6.ip6_null_entry->rt6i_ref);
L
Linus Torvalds 已提交
855 856 857 858 859 860 861
			sfn->fn_flags = RTN_ROOT;
			sfn->fn_sernum = fib6_new_sernum();

			/* Now add the first leaf node to new subtree */

			sn = fib6_add_1(sfn, &rt->rt6i_src.addr,
					sizeof(struct in6_addr), rt->rt6i_src.plen,
862 863
					offsetof(struct rt6_info, rt6i_src),
					allow_create, replace_required);
L
Linus Torvalds 已提交
864

865
			if (IS_ERR(sn)) {
L
Linus Torvalds 已提交
866 867 868 869 870
				/* If it is failed, discard just allocated
				   root, and then (in st_failure) stale node
				   in main tree.
				 */
				node_free(sfn);
871
				err = PTR_ERR(sn);
L
Linus Torvalds 已提交
872 873 874 875 876 877 878 879 880
				goto st_failure;
			}

			/* Now link new subtree to main tree */
			sfn->parent = fn;
			fn->subtree = sfn;
		} else {
			sn = fib6_add_1(fn->subtree, &rt->rt6i_src.addr,
					sizeof(struct in6_addr), rt->rt6i_src.plen,
881 882
					offsetof(struct rt6_info, rt6i_src),
					allow_create, replace_required);
L
Linus Torvalds 已提交
883

884 885
			if (IS_ERR(sn)) {
				err = PTR_ERR(sn);
L
Linus Torvalds 已提交
886
				goto st_failure;
887
			}
L
Linus Torvalds 已提交
888 889
		}

890
		if (!fn->leaf) {
891 892 893
			fn->leaf = rt;
			atomic_inc(&rt->rt6i_ref);
		}
L
Linus Torvalds 已提交
894 895 896 897
		fn = sn;
	}
#endif

898
	err = fib6_add_rt2node(fn, rt, info);
899
	if (!err) {
900
		fib6_start_gc(info->nl_net, rt);
901
		if (!(rt->rt6i_flags & RTF_CACHE))
902
			fib6_prune_clones(info->nl_net, pn, rt);
L
Linus Torvalds 已提交
903 904 905
	}

out:
906 907 908 909 910 911
	if (err) {
#ifdef CONFIG_IPV6_SUBTREES
		/*
		 * If fib6_add_1 has cleared the old leaf pointer in the
		 * super-tree leaf node we have to find a new one for it.
		 */
912 913 914 915
		if (pn != fn && pn->leaf == rt) {
			pn->leaf = NULL;
			atomic_dec(&rt->rt6i_ref);
		}
916
		if (pn != fn && !pn->leaf && !(pn->fn_flags & RTN_RTINFO)) {
917
			pn->leaf = fib6_find_prefix(info->nl_net, pn);
918 919
#if RT6_DEBUG >= 2
			if (!pn->leaf) {
920
				WARN_ON(pn->leaf == NULL);
921
				pn->leaf = info->nl_net->ipv6.ip6_null_entry;
922 923 924 925 926
			}
#endif
			atomic_inc(&pn->leaf->rt6i_ref);
		}
#endif
927
		dst_free(&rt->dst);
928
	}
L
Linus Torvalds 已提交
929 930 931 932 933 934 935 936
	return err;

#ifdef CONFIG_IPV6_SUBTREES
	/* Subtree creation failed, probably main tree node
	   is orphan. If it is, shoot it.
	 */
st_failure:
	if (fn && !(fn->fn_flags & (RTN_RTINFO|RTN_ROOT)))
937
		fib6_repair_tree(info->nl_net, fn);
938
	dst_free(&rt->dst);
L
Linus Torvalds 已提交
939 940 941 942 943 944 945 946 947 948
	return err;
#endif
}

/*
 *	Routing tree lookup
 *
 */

struct lookup_args {
949
	int			offset;		/* key offset on rt6_info	*/
950
	const struct in6_addr	*addr;		/* search key			*/
L
Linus Torvalds 已提交
951 952 953 954 955 956
};

static struct fib6_node * fib6_lookup_1(struct fib6_node *root,
					struct lookup_args *args)
{
	struct fib6_node *fn;
A
Al Viro 已提交
957
	__be32 dir;
L
Linus Torvalds 已提交
958

959 960 961
	if (unlikely(args->offset == 0))
		return NULL;

L
Linus Torvalds 已提交
962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981
	/*
	 *	Descend on a tree
	 */

	fn = root;

	for (;;) {
		struct fib6_node *next;

		dir = addr_bit_set(args->addr, fn->fn_bit);

		next = dir ? fn->right : fn->left;

		if (next) {
			fn = next;
			continue;
		}
		break;
	}

982
	while (fn) {
983
		if (FIB6_SUBTREE(fn) || fn->fn_flags & RTN_RTINFO) {
L
Linus Torvalds 已提交
984 985 986 987 988
			struct rt6key *key;

			key = (struct rt6key *) ((u8 *) fn->leaf +
						 args->offset);

989 990 991 992 993 994 995 996
			if (ipv6_prefix_equal(&key->addr, args->addr, key->plen)) {
#ifdef CONFIG_IPV6_SUBTREES
				if (fn->subtree)
					fn = fib6_lookup_1(fn->subtree, args + 1);
#endif
				if (!fn || fn->fn_flags & RTN_RTINFO)
					return fn;
			}
L
Linus Torvalds 已提交
997 998
		}

999 1000 1001
		if (fn->fn_flags & RTN_ROOT)
			break;

L
Linus Torvalds 已提交
1002 1003 1004 1005 1006 1007
		fn = fn->parent;
	}

	return NULL;
}

1008 1009
struct fib6_node * fib6_lookup(struct fib6_node *root, const struct in6_addr *daddr,
			       const struct in6_addr *saddr)
L
Linus Torvalds 已提交
1010 1011
{
	struct fib6_node *fn;
1012 1013 1014 1015 1016
	struct lookup_args args[] = {
		{
			.offset = offsetof(struct rt6_info, rt6i_dst),
			.addr = daddr,
		},
L
Linus Torvalds 已提交
1017
#ifdef CONFIG_IPV6_SUBTREES
1018 1019 1020 1021
		{
			.offset = offsetof(struct rt6_info, rt6i_src),
			.addr = saddr,
		},
L
Linus Torvalds 已提交
1022
#endif
1023 1024 1025 1026
		{
			.offset = 0,	/* sentinel */
		}
	};
L
Linus Torvalds 已提交
1027

1028
	fn = fib6_lookup_1(root, daddr ? args : args + 1);
1029
	if (!fn || fn->fn_flags & RTN_TL_ROOT)
L
Linus Torvalds 已提交
1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041
		fn = root;

	return fn;
}

/*
 *	Get node with specified destination prefix (and source prefix,
 *	if subtrees are used)
 */


static struct fib6_node * fib6_locate_1(struct fib6_node *root,
1042
					const struct in6_addr *addr,
L
Linus Torvalds 已提交
1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071
					int plen, int offset)
{
	struct fib6_node *fn;

	for (fn = root; fn ; ) {
		struct rt6key *key = (struct rt6key *)((u8 *)fn->leaf + offset);

		/*
		 *	Prefix match
		 */
		if (plen < fn->fn_bit ||
		    !ipv6_prefix_equal(&key->addr, addr, fn->fn_bit))
			return NULL;

		if (plen == fn->fn_bit)
			return fn;

		/*
		 *	We have more bits to go
		 */
		if (addr_bit_set(addr, fn->fn_bit))
			fn = fn->right;
		else
			fn = fn->left;
	}
	return NULL;
}

struct fib6_node * fib6_locate(struct fib6_node *root,
1072 1073
			       const struct in6_addr *daddr, int dst_len,
			       const struct in6_addr *saddr, int src_len)
L
Linus Torvalds 已提交
1074 1075 1076 1077 1078 1079 1080 1081
{
	struct fib6_node *fn;

	fn = fib6_locate_1(root, daddr, dst_len,
			   offsetof(struct rt6_info, rt6i_dst));

#ifdef CONFIG_IPV6_SUBTREES
	if (src_len) {
1082
		WARN_ON(saddr == NULL);
1083 1084
		if (fn && fn->subtree)
			fn = fib6_locate_1(fn->subtree, saddr, src_len,
L
Linus Torvalds 已提交
1085 1086 1087 1088
					   offsetof(struct rt6_info, rt6i_src));
	}
#endif

1089
	if (fn && fn->fn_flags & RTN_RTINFO)
L
Linus Torvalds 已提交
1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100
		return fn;

	return NULL;
}


/*
 *	Deletion
 *
 */

1101
static struct rt6_info *fib6_find_prefix(struct net *net, struct fib6_node *fn)
L
Linus Torvalds 已提交
1102
{
1103
	if (fn->fn_flags & RTN_ROOT)
1104
		return net->ipv6.ip6_null_entry;
L
Linus Torvalds 已提交
1105

1106 1107
	while (fn) {
		if (fn->left)
L
Linus Torvalds 已提交
1108
			return fn->left->leaf;
1109
		if (fn->right)
L
Linus Torvalds 已提交
1110 1111
			return fn->right->leaf;

1112
		fn = FIB6_SUBTREE(fn);
L
Linus Torvalds 已提交
1113 1114 1115 1116 1117 1118 1119 1120 1121
	}
	return NULL;
}

/*
 *	Called to trim the tree of intermediate nodes when possible. "fn"
 *	is the node we want to try and remove.
 */

1122 1123
static struct fib6_node *fib6_repair_tree(struct net *net,
					   struct fib6_node *fn)
L
Linus Torvalds 已提交
1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134
{
	int children;
	int nstate;
	struct fib6_node *child, *pn;
	struct fib6_walker_t *w;
	int iter = 0;

	for (;;) {
		RT6_TRACE("fixing tree: plen=%d iter=%d\n", fn->fn_bit, iter);
		iter++;

1135 1136 1137
		WARN_ON(fn->fn_flags & RTN_RTINFO);
		WARN_ON(fn->fn_flags & RTN_TL_ROOT);
		WARN_ON(fn->leaf != NULL);
L
Linus Torvalds 已提交
1138 1139 1140 1141 1142 1143

		children = 0;
		child = NULL;
		if (fn->right) child = fn->right, children |= 1;
		if (fn->left) child = fn->left, children |= 2;

1144
		if (children == 3 || FIB6_SUBTREE(fn)
L
Linus Torvalds 已提交
1145 1146
#ifdef CONFIG_IPV6_SUBTREES
		    /* Subtree root (i.e. fn) may have one child */
1147
		    || (children && fn->fn_flags & RTN_ROOT)
L
Linus Torvalds 已提交
1148 1149
#endif
		    ) {
1150
			fn->leaf = fib6_find_prefix(net, fn);
L
Linus Torvalds 已提交
1151
#if RT6_DEBUG >= 2
1152
			if (!fn->leaf) {
1153
				WARN_ON(!fn->leaf);
1154
				fn->leaf = net->ipv6.ip6_null_entry;
L
Linus Torvalds 已提交
1155 1156 1157 1158 1159 1160 1161 1162
			}
#endif
			atomic_inc(&fn->leaf->rt6i_ref);
			return fn->parent;
		}

		pn = fn->parent;
#ifdef CONFIG_IPV6_SUBTREES
1163
		if (FIB6_SUBTREE(pn) == fn) {
1164
			WARN_ON(!(fn->fn_flags & RTN_ROOT));
1165
			FIB6_SUBTREE(pn) = NULL;
L
Linus Torvalds 已提交
1166 1167
			nstate = FWS_L;
		} else {
1168
			WARN_ON(fn->fn_flags & RTN_ROOT);
L
Linus Torvalds 已提交
1169 1170 1171 1172
#endif
			if (pn->right == fn) pn->right = child;
			else if (pn->left == fn) pn->left = child;
#if RT6_DEBUG >= 2
1173 1174
			else
				WARN_ON(1);
L
Linus Torvalds 已提交
1175 1176 1177 1178 1179 1180 1181 1182 1183 1184
#endif
			if (child)
				child->parent = pn;
			nstate = FWS_R;
#ifdef CONFIG_IPV6_SUBTREES
		}
#endif

		read_lock(&fib6_walker_lock);
		FOR_WALKERS(w) {
1185
			if (!child) {
L
Linus Torvalds 已提交
1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213
				if (w->root == fn) {
					w->root = w->node = NULL;
					RT6_TRACE("W %p adjusted by delroot 1\n", w);
				} else if (w->node == fn) {
					RT6_TRACE("W %p adjusted by delnode 1, s=%d/%d\n", w, w->state, nstate);
					w->node = pn;
					w->state = nstate;
				}
			} else {
				if (w->root == fn) {
					w->root = child;
					RT6_TRACE("W %p adjusted by delroot 2\n", w);
				}
				if (w->node == fn) {
					w->node = child;
					if (children&2) {
						RT6_TRACE("W %p adjusted by delnode 2, s=%d\n", w, w->state);
						w->state = w->state>=FWS_R ? FWS_U : FWS_INIT;
					} else {
						RT6_TRACE("W %p adjusted by delnode 2, s=%d\n", w, w->state);
						w->state = w->state>=FWS_C ? FWS_U : FWS_INIT;
					}
				}
			}
		}
		read_unlock(&fib6_walker_lock);

		node_free(fn);
1214
		if (pn->fn_flags & RTN_RTINFO || FIB6_SUBTREE(pn))
L
Linus Torvalds 已提交
1215 1216 1217 1218 1219 1220 1221 1222 1223
			return pn;

		rt6_release(pn->leaf);
		pn->leaf = NULL;
		fn = pn;
	}
}

static void fib6_del_route(struct fib6_node *fn, struct rt6_info **rtp,
1224
			   struct nl_info *info)
L
Linus Torvalds 已提交
1225 1226 1227
{
	struct fib6_walker_t *w;
	struct rt6_info *rt = *rtp;
1228
	struct net *net = info->nl_net;
L
Linus Torvalds 已提交
1229 1230 1231 1232

	RT6_TRACE("fib6_del_route\n");

	/* Unlink it */
1233
	*rtp = rt->dst.rt6_next;
L
Linus Torvalds 已提交
1234
	rt->rt6i_node = NULL;
1235 1236
	net->ipv6.rt6_stats->fib_rt_entries--;
	net->ipv6.rt6_stats->fib_discarded_routes++;
L
Linus Torvalds 已提交
1237

1238 1239 1240 1241
	/* Reset round-robin state, if necessary */
	if (fn->rr_ptr == rt)
		fn->rr_ptr = NULL;

1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252
	/* Remove this entry from other siblings */
	if (rt->rt6i_nsiblings) {
		struct rt6_info *sibling, *next_sibling;

		list_for_each_entry_safe(sibling, next_sibling,
					 &rt->rt6i_siblings, rt6i_siblings)
			sibling->rt6i_nsiblings--;
		rt->rt6i_nsiblings = 0;
		list_del_init(&rt->rt6i_siblings);
	}

L
Linus Torvalds 已提交
1253 1254 1255 1256 1257
	/* Adjust walkers */
	read_lock(&fib6_walker_lock);
	FOR_WALKERS(w) {
		if (w->state == FWS_C && w->leaf == rt) {
			RT6_TRACE("walker %p adjusted by delroute\n", w);
1258
			w->leaf = rt->dst.rt6_next;
1259
			if (!w->leaf)
L
Linus Torvalds 已提交
1260 1261 1262 1263 1264
				w->state = FWS_U;
		}
	}
	read_unlock(&fib6_walker_lock);

1265
	rt->dst.rt6_next = NULL;
L
Linus Torvalds 已提交
1266 1267

	/* If it was last route, expunge its radix tree node */
1268
	if (!fn->leaf) {
L
Linus Torvalds 已提交
1269
		fn->fn_flags &= ~RTN_RTINFO;
1270
		net->ipv6.rt6_stats->fib_route_nodes--;
1271
		fn = fib6_repair_tree(net, fn);
L
Linus Torvalds 已提交
1272 1273 1274 1275 1276 1277 1278 1279 1280 1281
	}

	if (atomic_read(&rt->rt6i_ref) != 1) {
		/* This route is used as dummy address holder in some split
		 * nodes. It is not leaked, but it still holds other resources,
		 * which must be released in time. So, scan ascendant nodes
		 * and replace dummy references to this route with references
		 * to still alive ones.
		 */
		while (fn) {
1282
			if (!(fn->fn_flags & RTN_RTINFO) && fn->leaf == rt) {
1283
				fn->leaf = fib6_find_prefix(net, fn);
L
Linus Torvalds 已提交
1284 1285 1286 1287 1288 1289
				atomic_inc(&fn->leaf->rt6i_ref);
				rt6_release(rt);
			}
			fn = fn->parent;
		}
		/* No more references are possible at this point. */
1290
		BUG_ON(atomic_read(&rt->rt6i_ref) != 1);
L
Linus Torvalds 已提交
1291 1292
	}

1293
	inet6_rt_notify(RTM_DELROUTE, rt, info);
L
Linus Torvalds 已提交
1294 1295 1296
	rt6_release(rt);
}

1297
int fib6_del(struct rt6_info *rt, struct nl_info *info)
L
Linus Torvalds 已提交
1298
{
1299
	struct net *net = info->nl_net;
L
Linus Torvalds 已提交
1300 1301 1302 1303
	struct fib6_node *fn = rt->rt6i_node;
	struct rt6_info **rtp;

#if RT6_DEBUG >= 2
1304
	if (rt->dst.obsolete>0) {
1305
		WARN_ON(fn != NULL);
L
Linus Torvalds 已提交
1306 1307 1308
		return -ENOENT;
	}
#endif
1309
	if (!fn || rt == net->ipv6.ip6_null_entry)
L
Linus Torvalds 已提交
1310 1311
		return -ENOENT;

1312
	WARN_ON(!(fn->fn_flags & RTN_RTINFO));
L
Linus Torvalds 已提交
1313

1314
	if (!(rt->rt6i_flags & RTF_CACHE)) {
1315 1316 1317 1318
		struct fib6_node *pn = fn;
#ifdef CONFIG_IPV6_SUBTREES
		/* clones of this route might be in another subtree */
		if (rt->rt6i_src.plen) {
1319
			while (!(pn->fn_flags & RTN_ROOT))
1320 1321 1322 1323
				pn = pn->parent;
			pn = pn->parent;
		}
#endif
1324
		fib6_prune_clones(info->nl_net, pn, rt);
1325
	}
L
Linus Torvalds 已提交
1326 1327 1328 1329 1330

	/*
	 *	Walk the leaf entries looking for ourself
	 */

1331
	for (rtp = &fn->leaf; *rtp; rtp = &(*rtp)->dst.rt6_next) {
L
Linus Torvalds 已提交
1332
		if (*rtp == rt) {
1333
			fib6_del_route(fn, rtp, info);
L
Linus Torvalds 已提交
1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346
			return 0;
		}
	}
	return -ENOENT;
}

/*
 *	Tree traversal function.
 *
 *	Certainly, it is not interrupt safe.
 *	However, it is internally reenterable wrt itself and fib6_add/fib6_del.
 *	It means, that we can modify tree during walking
 *	and use this function for garbage collection, clone pruning,
1347
 *	cleaning tree when a device goes down etc. etc.
L
Linus Torvalds 已提交
1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363
 *
 *	It guarantees that every node will be traversed,
 *	and that it will be traversed only once.
 *
 *	Callback function w->func may return:
 *	0 -> continue walking.
 *	positive value -> walking is suspended (used by tree dumps,
 *	and probably by gc, if it will be split to several slices)
 *	negative value -> terminate walking.
 *
 *	The function itself returns:
 *	0   -> walk is complete.
 *	>0  -> walk is incomplete (i.e. suspended)
 *	<0  -> walk is terminated by an error.
 */

A
Adrian Bunk 已提交
1364
static int fib6_walk_continue(struct fib6_walker_t *w)
L
Linus Torvalds 已提交
1365 1366 1367 1368 1369
{
	struct fib6_node *fn, *pn;

	for (;;) {
		fn = w->node;
1370
		if (!fn)
L
Linus Torvalds 已提交
1371 1372 1373
			return 0;

		if (w->prune && fn != w->root &&
1374
		    fn->fn_flags & RTN_RTINFO && w->state < FWS_C) {
L
Linus Torvalds 已提交
1375 1376 1377 1378 1379 1380
			w->state = FWS_C;
			w->leaf = fn->leaf;
		}
		switch (w->state) {
#ifdef CONFIG_IPV6_SUBTREES
		case FWS_S:
1381 1382
			if (FIB6_SUBTREE(fn)) {
				w->node = FIB6_SUBTREE(fn);
L
Linus Torvalds 已提交
1383 1384 1385
				continue;
			}
			w->state = FWS_L;
1386
#endif
L
Linus Torvalds 已提交
1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402
		case FWS_L:
			if (fn->left) {
				w->node = fn->left;
				w->state = FWS_INIT;
				continue;
			}
			w->state = FWS_R;
		case FWS_R:
			if (fn->right) {
				w->node = fn->right;
				w->state = FWS_INIT;
				continue;
			}
			w->state = FWS_C;
			w->leaf = fn->leaf;
		case FWS_C:
1403
			if (w->leaf && fn->fn_flags & RTN_RTINFO) {
1404 1405
				int err;

E
Eric Dumazet 已提交
1406 1407
				if (w->skip) {
					w->skip--;
1408 1409 1410 1411
					continue;
				}

				err = w->func(w);
L
Linus Torvalds 已提交
1412 1413
				if (err)
					return err;
1414 1415

				w->count++;
L
Linus Torvalds 已提交
1416 1417 1418 1419 1420 1421 1422 1423 1424
				continue;
			}
			w->state = FWS_U;
		case FWS_U:
			if (fn == w->root)
				return 0;
			pn = fn->parent;
			w->node = pn;
#ifdef CONFIG_IPV6_SUBTREES
1425
			if (FIB6_SUBTREE(pn) == fn) {
1426
				WARN_ON(!(fn->fn_flags & RTN_ROOT));
L
Linus Torvalds 已提交
1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440
				w->state = FWS_L;
				continue;
			}
#endif
			if (pn->left == fn) {
				w->state = FWS_R;
				continue;
			}
			if (pn->right == fn) {
				w->state = FWS_C;
				w->leaf = w->node->leaf;
				continue;
			}
#if RT6_DEBUG >= 2
1441
			WARN_ON(1);
L
Linus Torvalds 已提交
1442 1443 1444 1445 1446
#endif
		}
	}
}

A
Adrian Bunk 已提交
1447
static int fib6_walk(struct fib6_walker_t *w)
L
Linus Torvalds 已提交
1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464
{
	int res;

	w->state = FWS_INIT;
	w->node = w->root;

	fib6_walker_link(w);
	res = fib6_walk_continue(w);
	if (res <= 0)
		fib6_walker_unlink(w);
	return res;
}

static int fib6_clean_node(struct fib6_walker_t *w)
{
	int res;
	struct rt6_info *rt;
1465
	struct fib6_cleaner_t *c = container_of(w, struct fib6_cleaner_t, w);
1466 1467 1468
	struct nl_info info = {
		.nl_net = c->net,
	};
L
Linus Torvalds 已提交
1469

1470
	for (rt = w->leaf; rt; rt = rt->dst.rt6_next) {
L
Linus Torvalds 已提交
1471 1472 1473
		res = c->func(rt, c->arg);
		if (res < 0) {
			w->leaf = rt;
1474
			res = fib6_del(rt, &info);
L
Linus Torvalds 已提交
1475 1476
			if (res) {
#if RT6_DEBUG >= 2
1477 1478
				pr_debug("%s: del failed: rt=%p@%p err=%d\n",
					 __func__, rt, rt->rt6i_node, res);
L
Linus Torvalds 已提交
1479 1480 1481 1482 1483
#endif
				continue;
			}
			return 0;
		}
1484
		WARN_ON(res != 0);
L
Linus Torvalds 已提交
1485 1486 1487 1488 1489 1490 1491
	}
	w->leaf = rt;
	return 0;
}

/*
 *	Convenient frontend to tree walker.
1492
 *
L
Linus Torvalds 已提交
1493 1494 1495 1496 1497 1498 1499 1500
 *	func is called on each route.
 *		It may return -1 -> delete this route.
 *		              0  -> continue walking
 *
 *	prune==1 -> only immediate children of node (certainly,
 *	ignoring pure split nodes) will be scanned.
 */

1501
static void fib6_clean_tree(struct net *net, struct fib6_node *root,
A
Adrian Bunk 已提交
1502 1503
			    int (*func)(struct rt6_info *, void *arg),
			    int prune, void *arg)
L
Linus Torvalds 已提交
1504 1505 1506 1507 1508 1509
{
	struct fib6_cleaner_t c;

	c.w.root = root;
	c.w.func = fib6_clean_node;
	c.w.prune = prune;
1510 1511
	c.w.count = 0;
	c.w.skip = 0;
L
Linus Torvalds 已提交
1512 1513
	c.func = func;
	c.arg = arg;
1514
	c.net = net;
L
Linus Torvalds 已提交
1515 1516 1517 1518

	fib6_walk(&c.w);
}

1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538
void fib6_clean_all_ro(struct net *net, int (*func)(struct rt6_info *, void *arg),
		    int prune, void *arg)
{
	struct fib6_table *table;
	struct hlist_node *node;
	struct hlist_head *head;
	unsigned int h;

	rcu_read_lock();
	for (h = 0; h < FIB6_TABLE_HASHSZ; h++) {
		head = &net->ipv6.fib_table_hash[h];
		hlist_for_each_entry_rcu(table, node, head, tb6_hlist) {
			read_lock_bh(&table->tb6_lock);
			fib6_clean_tree(net, &table->tb6_root,
					func, prune, arg);
			read_unlock_bh(&table->tb6_lock);
		}
	}
	rcu_read_unlock();
}
1539
void fib6_clean_all(struct net *net, int (*func)(struct rt6_info *, void *arg),
T
Thomas Graf 已提交
1540 1541 1542
		    int prune, void *arg)
{
	struct fib6_table *table;
1543
	struct hlist_node *node;
1544
	struct hlist_head *head;
1545
	unsigned int h;
T
Thomas Graf 已提交
1546

1547
	rcu_read_lock();
1548
	for (h = 0; h < FIB6_TABLE_HASHSZ; h++) {
1549
		head = &net->ipv6.fib_table_hash[h];
1550
		hlist_for_each_entry_rcu(table, node, head, tb6_hlist) {
T
Thomas Graf 已提交
1551
			write_lock_bh(&table->tb6_lock);
1552 1553
			fib6_clean_tree(net, &table->tb6_root,
					func, prune, arg);
T
Thomas Graf 已提交
1554 1555 1556
			write_unlock_bh(&table->tb6_lock);
		}
	}
1557
	rcu_read_unlock();
T
Thomas Graf 已提交
1558 1559
}

L
Linus Torvalds 已提交
1560 1561 1562 1563 1564 1565 1566 1567 1568 1569
static int fib6_prune_clone(struct rt6_info *rt, void *arg)
{
	if (rt->rt6i_flags & RTF_CACHE) {
		RT6_TRACE("pruning clone %p\n", rt);
		return -1;
	}

	return 0;
}

1570 1571
static void fib6_prune_clones(struct net *net, struct fib6_node *fn,
			      struct rt6_info *rt)
L
Linus Torvalds 已提交
1572
{
1573
	fib6_clean_tree(net, fn, fib6_prune_clone, 1, rt);
L
Linus Torvalds 已提交
1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597
}

/*
 *	Garbage collection
 */

static struct fib6_gc_args
{
	int			timeout;
	int			more;
} gc_args;

static int fib6_age(struct rt6_info *rt, void *arg)
{
	unsigned long now = jiffies;

	/*
	 *	check addrconf expiration here.
	 *	Routes are expired even if they are in use.
	 *
	 *	Also age clones. Note, that clones are aged out
	 *	only if they are not in use now.
	 */

1598 1599
	if (rt->rt6i_flags & RTF_EXPIRES && rt->dst.expires) {
		if (time_after(now, rt->dst.expires)) {
L
Linus Torvalds 已提交
1600 1601 1602 1603 1604
			RT6_TRACE("expiring %p\n", rt);
			return -1;
		}
		gc_args.more++;
	} else if (rt->rt6i_flags & RTF_CACHE) {
1605 1606
		if (atomic_read(&rt->dst.__refcnt) == 0 &&
		    time_after_eq(now, rt->dst.lastuse + gc_args.timeout)) {
L
Linus Torvalds 已提交
1607 1608
			RT6_TRACE("aging clone %p\n", rt);
			return -1;
1609 1610 1611 1612 1613 1614 1615 1616 1617
		} else if (rt->rt6i_flags & RTF_GATEWAY) {
			struct neighbour *neigh;
			__u8 neigh_flags = 0;

			neigh = dst_neigh_lookup(&rt->dst, &rt->rt6i_gateway);
			if (neigh) {
				neigh_flags = neigh->flags;
				neigh_release(neigh);
			}
1618
			if (!(neigh_flags & NTF_ROUTER)) {
1619 1620 1621 1622
				RT6_TRACE("purging route %p via non-router but gateway\n",
					  rt);
				return -1;
			}
L
Linus Torvalds 已提交
1623 1624 1625 1626 1627 1628 1629 1630 1631
		}
		gc_args.more++;
	}

	return 0;
}

static DEFINE_SPINLOCK(fib6_gc_lock);

1632
void fib6_run_gc(unsigned long expires, struct net *net)
L
Linus Torvalds 已提交
1633
{
1634
	if (expires != ~0UL) {
L
Linus Torvalds 已提交
1635
		spin_lock_bh(&fib6_gc_lock);
1636 1637
		gc_args.timeout = expires ? (int)expires :
			net->ipv6.sysctl.ip6_rt_gc_interval;
L
Linus Torvalds 已提交
1638
	} else {
S
Stephen Hemminger 已提交
1639
		if (!spin_trylock_bh(&fib6_gc_lock)) {
1640
			mod_timer(&net->ipv6.ip6_fib_timer, jiffies + HZ);
L
Linus Torvalds 已提交
1641 1642
			return;
		}
1643
		gc_args.timeout = net->ipv6.sysctl.ip6_rt_gc_interval;
L
Linus Torvalds 已提交
1644 1645
	}

1646
	gc_args.more = icmp6_dst_gc();
1647

1648
	fib6_clean_all(net, fib6_age, 0, NULL);
L
Linus Torvalds 已提交
1649 1650

	if (gc_args.more)
S
Stephen Hemminger 已提交
1651 1652 1653
		mod_timer(&net->ipv6.ip6_fib_timer,
			  round_jiffies(jiffies
					+ net->ipv6.sysctl.ip6_rt_gc_interval));
1654 1655
	else
		del_timer(&net->ipv6.ip6_fib_timer);
L
Linus Torvalds 已提交
1656 1657 1658
	spin_unlock_bh(&fib6_gc_lock);
}

1659 1660 1661 1662 1663
static void fib6_gc_timer_cb(unsigned long arg)
{
	fib6_run_gc(0, (struct net *)arg);
}

1664
static int __net_init fib6_net_init(struct net *net)
L
Linus Torvalds 已提交
1665
{
1666 1667
	size_t size = sizeof(struct hlist_head) * FIB6_TABLE_HASHSZ;

1668
	setup_timer(&net->ipv6.ip6_fib_timer, fib6_gc_timer_cb, (unsigned long)net);
1669

1670 1671 1672 1673
	net->ipv6.rt6_stats = kzalloc(sizeof(*net->ipv6.rt6_stats), GFP_KERNEL);
	if (!net->ipv6.rt6_stats)
		goto out_timer;

1674 1675 1676 1677
	/* Avoid false sharing : Use at least a full cache line */
	size = max_t(size_t, size, L1_CACHE_BYTES);

	net->ipv6.fib_table_hash = kzalloc(size, GFP_KERNEL);
1678
	if (!net->ipv6.fib_table_hash)
1679
		goto out_rt6_stats;
1680

1681 1682 1683
	net->ipv6.fib6_main_tbl = kzalloc(sizeof(*net->ipv6.fib6_main_tbl),
					  GFP_KERNEL);
	if (!net->ipv6.fib6_main_tbl)
1684 1685
		goto out_fib_table_hash;

1686
	net->ipv6.fib6_main_tbl->tb6_id = RT6_TABLE_MAIN;
1687
	net->ipv6.fib6_main_tbl->tb6_root.leaf = net->ipv6.ip6_null_entry;
1688 1689
	net->ipv6.fib6_main_tbl->tb6_root.fn_flags =
		RTN_ROOT | RTN_TL_ROOT | RTN_RTINFO;
1690
	inet_peer_base_init(&net->ipv6.fib6_main_tbl->tb6_peers);
1691 1692

#ifdef CONFIG_IPV6_MULTIPLE_TABLES
1693 1694 1695
	net->ipv6.fib6_local_tbl = kzalloc(sizeof(*net->ipv6.fib6_local_tbl),
					   GFP_KERNEL);
	if (!net->ipv6.fib6_local_tbl)
1696
		goto out_fib6_main_tbl;
1697
	net->ipv6.fib6_local_tbl->tb6_id = RT6_TABLE_LOCAL;
1698
	net->ipv6.fib6_local_tbl->tb6_root.leaf = net->ipv6.ip6_null_entry;
1699 1700
	net->ipv6.fib6_local_tbl->tb6_root.fn_flags =
		RTN_ROOT | RTN_TL_ROOT | RTN_RTINFO;
1701
	inet_peer_base_init(&net->ipv6.fib6_local_tbl->tb6_peers);
1702
#endif
1703
	fib6_tables_init(net);
1704

1705
	return 0;
1706

1707 1708
#ifdef CONFIG_IPV6_MULTIPLE_TABLES
out_fib6_main_tbl:
1709
	kfree(net->ipv6.fib6_main_tbl);
1710 1711
#endif
out_fib_table_hash:
1712
	kfree(net->ipv6.fib_table_hash);
1713 1714
out_rt6_stats:
	kfree(net->ipv6.rt6_stats);
1715
out_timer:
1716
	return -ENOMEM;
1717 1718 1719 1720
 }

static void fib6_net_exit(struct net *net)
{
1721
	rt6_ifdown(net, NULL);
1722 1723
	del_timer_sync(&net->ipv6.ip6_fib_timer);

1724
#ifdef CONFIG_IPV6_MULTIPLE_TABLES
1725
	inetpeer_invalidate_tree(&net->ipv6.fib6_local_tbl->tb6_peers);
1726 1727
	kfree(net->ipv6.fib6_local_tbl);
#endif
1728
	inetpeer_invalidate_tree(&net->ipv6.fib6_main_tbl->tb6_peers);
1729 1730
	kfree(net->ipv6.fib6_main_tbl);
	kfree(net->ipv6.fib_table_hash);
1731
	kfree(net->ipv6.rt6_stats);
1732 1733 1734 1735 1736 1737 1738 1739 1740 1741
}

static struct pernet_operations fib6_net_ops = {
	.init = fib6_net_init,
	.exit = fib6_net_exit,
};

int __init fib6_init(void)
{
	int ret = -ENOMEM;
1742

1743 1744 1745 1746 1747 1748 1749 1750 1751
	fib6_node_kmem = kmem_cache_create("fib6_nodes",
					   sizeof(struct fib6_node),
					   0, SLAB_HWCACHE_ALIGN,
					   NULL);
	if (!fib6_node_kmem)
		goto out;

	ret = register_pernet_subsys(&fib6_net_ops);
	if (ret)
1752
		goto out_kmem_cache_create;
1753 1754 1755 1756 1757

	ret = __rtnl_register(PF_INET6, RTM_GETROUTE, NULL, inet6_dump_fib,
			      NULL);
	if (ret)
		goto out_unregister_subsys;
1758 1759 1760
out:
	return ret;

1761 1762
out_unregister_subsys:
	unregister_pernet_subsys(&fib6_net_ops);
1763 1764 1765
out_kmem_cache_create:
	kmem_cache_destroy(fib6_node_kmem);
	goto out;
L
Linus Torvalds 已提交
1766 1767 1768 1769
}

void fib6_gc_cleanup(void)
{
1770
	unregister_pernet_subsys(&fib6_net_ops);
L
Linus Torvalds 已提交
1771 1772
	kmem_cache_destroy(fib6_node_kmem);
}