ip6_fib.c 44.4 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
 *
 *	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.
12 13 14 15 16 17
 *
 *	Changes:
 *	Yuji SEKIYA @USAGI:	Support default route on router node;
 *				remove ip6_null_entry from the top of
 *				routing table.
 *	Ville Nuorvala:		Fixed routing subtrees.
L
Linus Torvalds 已提交
18
 */
19 20 21

#define pr_fmt(fmt) "IPv6: " fmt

L
Linus Torvalds 已提交
22 23 24 25 26 27 28
#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 已提交
29
#include <linux/list.h>
30
#include <linux/slab.h>
L
Linus Torvalds 已提交
31 32 33 34

#include <net/ipv6.h>
#include <net/ndisc.h>
#include <net/addrconf.h>
35
#include <net/lwtunnel.h>
L
Linus Torvalds 已提交
36 37 38 39 40 41 42

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

#define RT6_DEBUG 2

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

48
static struct kmem_cache *fib6_node_kmem __read_mostly;
L
Linus Torvalds 已提交
49

50 51
struct fib6_cleaner {
	struct fib6_walker w;
52
	struct net *net;
L
Linus Torvalds 已提交
53
	int (*func)(struct rt6_info *, void *arg);
54
	int sernum;
L
Linus Torvalds 已提交
55 56 57
	void *arg;
};

A
Adrian Bunk 已提交
58
static DEFINE_RWLOCK(fib6_walker_lock);
L
Linus Torvalds 已提交
59 60 61 62 63 64 65

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

66
static void fib6_prune_clones(struct net *net, struct fib6_node *fn);
67 68
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);
69 70
static int fib6_walk(struct fib6_walker *w);
static int fib6_walk_continue(struct fib6_walker *w);
L
Linus Torvalds 已提交
71 72 73 74 75 76 77 78

/*
 *	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.
 */

79 80
static void fib6_gc_timer_cb(unsigned long arg);

81 82
static LIST_HEAD(fib6_walkers);
#define FOR_WALKERS(w) list_for_each_entry(w, &fib6_walkers, lh)
L
Linus Torvalds 已提交
83

84
static void fib6_walker_link(struct fib6_walker *w)
A
Adrian Bunk 已提交
85 86
{
	write_lock_bh(&fib6_walker_lock);
87
	list_add(&w->lh, &fib6_walkers);
A
Adrian Bunk 已提交
88 89 90
	write_unlock_bh(&fib6_walker_lock);
}

91
static void fib6_walker_unlink(struct fib6_walker *w)
A
Adrian Bunk 已提交
92 93
{
	write_lock_bh(&fib6_walker_lock);
94
	list_del(&w->lh);
A
Adrian Bunk 已提交
95 96
	write_unlock_bh(&fib6_walker_lock);
}
97

98
static int fib6_new_sernum(struct net *net)
L
Linus Torvalds 已提交
99
{
100 101 102
	int new, old;

	do {
103
		old = atomic_read(&net->ipv6.fib6_sernum);
104
		new = old < INT_MAX ? old + 1 : 1;
105 106
	} while (atomic_cmpxchg(&net->ipv6.fib6_sernum,
				old, new) != old);
107
	return new;
L
Linus Torvalds 已提交
108 109
}

110 111 112 113
enum {
	FIB6_NO_SERNUM_CHANGE = 0,
};

L
Linus Torvalds 已提交
114 115 116
/*
 *	Auxiliary address test functions for the radix tree.
 *
117
 *	These assume a 32bit processor (although it will work on
L
Linus Torvalds 已提交
118 119 120 121 122 123
 *	64bit processors)
 */

/*
 *	test bit
 */
124 125 126 127 128
#if defined(__LITTLE_ENDIAN)
# define BITOP_BE32_SWIZZLE	(0x1F & ~7)
#else
# define BITOP_BE32_SWIZZLE	0
#endif
L
Linus Torvalds 已提交
129

130
static __be32 addr_bit_set(const void *token, int fn_bit)
L
Linus Torvalds 已提交
131
{
132
	const __be32 *addr = token;
133 134
	/*
	 * Here,
135
	 *	1 << ((~fn_bit ^ BITOP_BE32_SWIZZLE) & 0x1f)
136 137 138 139
	 * is optimized version of
	 *	htonl(1 << ((~fn_bit)&0x1F))
	 * See include/asm-generic/bitops/le.h.
	 */
140 141
	return (__force __be32)(1 << ((~fn_bit ^ BITOP_BE32_SWIZZLE) & 0x1f)) &
	       addr[fn_bit >> 5];
L
Linus Torvalds 已提交
142 143
}

144
static struct fib6_node *node_alloc(void)
L
Linus Torvalds 已提交
145 146 147
{
	struct fib6_node *fn;

148
	fn = kmem_cache_zalloc(fib6_node_kmem, GFP_ATOMIC);
L
Linus Torvalds 已提交
149 150 151 152

	return fn;
}

153
static void node_free(struct fib6_node *fn)
L
Linus Torvalds 已提交
154 155 156 157
{
	kmem_cache_free(fib6_node_kmem, fn);
}

158 159 160 161 162
static void rt6_rcu_free(struct rt6_info *rt)
{
	call_rcu(&rt->dst.rcu_head, dst_rcu_free);
}

M
Martin KaFai Lau 已提交
163 164 165 166 167 168 169 170 171 172 173 174 175 176
static void rt6_free_pcpu(struct rt6_info *non_pcpu_rt)
{
	int cpu;

	if (!non_pcpu_rt->rt6i_pcpu)
		return;

	for_each_possible_cpu(cpu) {
		struct rt6_info **ppcpu_rt;
		struct rt6_info *pcpu_rt;

		ppcpu_rt = per_cpu_ptr(non_pcpu_rt->rt6i_pcpu, cpu);
		pcpu_rt = *ppcpu_rt;
		if (pcpu_rt) {
177
			rt6_rcu_free(pcpu_rt);
M
Martin KaFai Lau 已提交
178 179 180
			*ppcpu_rt = NULL;
		}
	}
181 182

	non_pcpu_rt->rt6i_pcpu = NULL;
M
Martin KaFai Lau 已提交
183 184
}

185
static void rt6_release(struct rt6_info *rt)
L
Linus Torvalds 已提交
186
{
M
Martin KaFai Lau 已提交
187 188
	if (atomic_dec_and_test(&rt->rt6i_ref)) {
		rt6_free_pcpu(rt);
189
		rt6_rcu_free(rt);
M
Martin KaFai Lau 已提交
190
	}
L
Linus Torvalds 已提交
191 192
}

193
static void fib6_link_table(struct net *net, struct fib6_table *tb)
194 195 196
{
	unsigned int h;

197 198 199 200 201 202
	/*
	 * 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);

203
	h = tb->tb6_id & (FIB6_TABLE_HASHSZ - 1);
204 205 206 207 208

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

212
#ifdef CONFIG_IPV6_MULTIPLE_TABLES
213

214
static struct fib6_table *fib6_alloc_table(struct net *net, u32 id)
T
Thomas Graf 已提交
215 216 217 218
{
	struct fib6_table *table;

	table = kzalloc(sizeof(*table), GFP_ATOMIC);
219
	if (table) {
T
Thomas Graf 已提交
220
		table->tb6_id = id;
221
		table->tb6_root.leaf = net->ipv6.ip6_null_entry;
T
Thomas Graf 已提交
222
		table->tb6_root.fn_flags = RTN_ROOT | RTN_TL_ROOT | RTN_RTINFO;
223
		inet_peer_base_init(&table->tb6_peers);
T
Thomas Graf 已提交
224 225 226 227 228
	}

	return table;
}

229
struct fib6_table *fib6_new_table(struct net *net, u32 id)
T
Thomas Graf 已提交
230 231 232 233 234
{
	struct fib6_table *tb;

	if (id == 0)
		id = RT6_TABLE_MAIN;
235
	tb = fib6_get_table(net, id);
T
Thomas Graf 已提交
236 237 238
	if (tb)
		return tb;

239
	tb = fib6_alloc_table(net, id);
240
	if (tb)
241
		fib6_link_table(net, tb);
T
Thomas Graf 已提交
242 243 244 245

	return tb;
}

246
struct fib6_table *fib6_get_table(struct net *net, u32 id)
T
Thomas Graf 已提交
247 248
{
	struct fib6_table *tb;
249
	struct hlist_head *head;
T
Thomas Graf 已提交
250 251 252 253
	unsigned int h;

	if (id == 0)
		id = RT6_TABLE_MAIN;
254
	h = id & (FIB6_TABLE_HASHSZ - 1);
T
Thomas Graf 已提交
255
	rcu_read_lock();
256
	head = &net->ipv6.fib_table_hash[h];
257
	hlist_for_each_entry_rcu(tb, head, tb6_hlist) {
T
Thomas Graf 已提交
258 259 260 261 262 263 264 265 266 267
		if (tb->tb6_id == id) {
			rcu_read_unlock();
			return tb;
		}
	}
	rcu_read_unlock();

	return NULL;
}

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

275
struct fib6_table *fib6_new_table(struct net *net, u32 id)
T
Thomas Graf 已提交
276
{
277
	return fib6_get_table(net, id);
T
Thomas Graf 已提交
278 279
}

280
struct fib6_table *fib6_get_table(struct net *net, u32 id)
T
Thomas Graf 已提交
281
{
282
	  return net->ipv6.fib6_main_tbl;
T
Thomas Graf 已提交
283 284
}

285
struct dst_entry *fib6_rule_lookup(struct net *net, struct flowi6 *fl6,
286
				   int flags, pol_lookup_t lookup)
T
Thomas Graf 已提交
287
{
288
	return (struct dst_entry *) lookup(net, net->ipv6.fib6_main_tbl, fl6, flags);
T
Thomas Graf 已提交
289 290
}

291
static void __net_init fib6_tables_init(struct net *net)
T
Thomas Graf 已提交
292
{
293
	fib6_link_table(net, net->ipv6.fib6_main_tbl);
T
Thomas Graf 已提交
294 295 296 297
}

#endif

298
static int fib6_dump_node(struct fib6_walker *w)
299 300 301 302
{
	int res;
	struct rt6_info *rt;

303
	for (rt = w->leaf; rt; rt = rt->dst.rt6_next) {
304 305 306 307 308 309 310 311 312 313 314 315 316
		res = rt6_dump_route(rt, w->args);
		if (res < 0) {
			/* Frame is full, suspend walking */
			w->leaf = rt;
			return 1;
		}
	}
	w->leaf = NULL;
	return 0;
}

static void fib6_dump_end(struct netlink_callback *cb)
{
317
	struct fib6_walker *w = (void *)cb->args[2];
318 319

	if (w) {
320 321 322 323
		if (cb->args[4]) {
			cb->args[4] = 0;
			fib6_walker_unlink(w);
		}
324 325 326
		cb->args[2] = 0;
		kfree(w);
	}
327
	cb->done = (void *)cb->args[3];
328 329 330 331 332 333 334 335 336 337 338 339
	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)
{
340
	struct fib6_walker *w;
341 342 343 344 345 346
	int res;

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

	if (cb->args[4] == 0) {
347 348 349
		w->count = 0;
		w->skip = 0;

350 351 352
		read_lock_bh(&table->tb6_lock);
		res = fib6_walk(w);
		read_unlock_bh(&table->tb6_lock);
353
		if (res > 0) {
354
			cb->args[4] = 1;
355 356
			cb->args[5] = w->root->fn_sernum;
		}
357
	} else {
358 359 360 361 362 363 364 365 366
		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;

367 368 369
		read_lock_bh(&table->tb6_lock);
		res = fib6_walk_continue(w);
		read_unlock_bh(&table->tb6_lock);
370 371 372
		if (res <= 0) {
			fib6_walker_unlink(w);
			cb->args[4] = 0;
373 374
		}
	}
375

376 377 378
	return res;
}

379
static int inet6_dump_fib(struct sk_buff *skb, struct netlink_callback *cb)
380
{
381
	struct net *net = sock_net(skb->sk);
382 383 384
	unsigned int h, s_h;
	unsigned int e = 0, s_e;
	struct rt6_rtnl_dump_arg arg;
385
	struct fib6_walker *w;
386
	struct fib6_table *tb;
387
	struct hlist_head *head;
388 389 390 391 392 393
	int res = 0;

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

	w = (void *)cb->args[2];
394
	if (!w) {
395 396 397 398 399 400 401 402 403 404 405
		/* 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);
406
		if (!w)
407 408 409 410 411 412 413
			return -ENOMEM;
		w->func = fib6_dump_node;
		cb->args[2] = (long)w;
	}

	arg.skb = skb;
	arg.cb = cb;
414
	arg.net = net;
415 416
	w->args = &arg;

417
	rcu_read_lock();
418
	for (h = s_h; h < FIB6_TABLE_HASHSZ; h++, s_e = 0) {
419
		e = 0;
420
		head = &net->ipv6.fib_table_hash[h];
421
		hlist_for_each_entry_rcu(tb, head, tb6_hlist) {
422 423 424 425 426 427 428 429 430 431
			if (e < s_e)
				goto next;
			res = fib6_dump_table(tb, skb, cb);
			if (res != 0)
				goto out;
next:
			e++;
		}
	}
out:
432
	rcu_read_unlock();
433 434 435 436 437 438 439 440
	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 已提交
441 442 443 444 445 446 447 448 449

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

450 451
static struct fib6_node *fib6_add_1(struct fib6_node *root,
				     struct in6_addr *addr, int plen,
452
				     int offset, int allow_create,
453
				     int replace_required, int sernum)
L
Linus Torvalds 已提交
454 455 456 457 458
{
	struct fib6_node *fn, *in, *ln;
	struct fib6_node *pn = NULL;
	struct rt6key *key;
	int	bit;
459
	__be32	dir = 0;
L
Linus Torvalds 已提交
460 461 462 463 464 465 466 467 468 469 470 471 472 473

	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 ||
474
		    !ipv6_prefix_equal(&key->addr, addr, fn->fn_bit)) {
475 476
			if (!allow_create) {
				if (replace_required) {
477
					pr_warn("Can't replace route, no match found\n");
478 479
					return ERR_PTR(-ENOENT);
				}
480
				pr_warn("NLM_F_CREATE should be set when creating new route\n");
481
			}
L
Linus Torvalds 已提交
482
			goto insert_above;
483
		}
484

L
Linus Torvalds 已提交
485 486 487
		/*
		 *	Exact match ?
		 */
488

L
Linus Torvalds 已提交
489 490
		if (plen == fn->fn_bit) {
			/* clean up an intermediate node */
491
			if (!(fn->fn_flags & RTN_RTINFO)) {
L
Linus Torvalds 已提交
492 493 494
				rt6_release(fn->leaf);
				fn->leaf = NULL;
			}
495

L
Linus Torvalds 已提交
496
			fn->fn_sernum = sernum;
497

L
Linus Torvalds 已提交
498 499 500 501 502 503
			return fn;
		}

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

L
Linus Torvalds 已提交
505 506 507 508
		/* Try to walk down on tree. */
		fn->fn_sernum = sernum;
		dir = addr_bit_set(addr, fn->fn_bit);
		pn = fn;
509
		fn = dir ? fn->right : fn->left;
L
Linus Torvalds 已提交
510 511
	} while (fn);

512
	if (!allow_create) {
513 514 515 516 517 518 519 520 521
		/* 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
		 */
522
		if (replace_required) {
523
			pr_warn("Can't replace route, no match found\n");
524 525
			return ERR_PTR(-ENOENT);
		}
526
		pr_warn("NLM_F_CREATE should be set when creating new route\n");
527
	}
L
Linus Torvalds 已提交
528 529 530 531 532 533 534
	/*
	 *	We walked to the bottom of tree.
	 *	Create new leaf node without children.
	 */

	ln = node_alloc();

535
	if (!ln)
536
		return ERR_PTR(-ENOMEM);
L
Linus Torvalds 已提交
537
	ln->fn_bit = plen;
538

L
Linus Torvalds 已提交
539 540 541 542 543 544 545 546 547 548 549 550 551
	ln->parent = pn;
	ln->fn_sernum = sernum;

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

	return ln;


insert_above:
	/*
552
	 * split since we don't have a common prefix anymore or
L
Linus Torvalds 已提交
553 554 555 556 557 558 559 560 561 562
	 * 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.

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

567
	bit = __ipv6_addr_diff(addr, &key->addr, sizeof(*addr));
L
Linus Torvalds 已提交
568

569 570
	/*
	 *		(intermediate)[in]
L
Linus Torvalds 已提交
571 572 573 574 575 576
	 *	          /	   \
	 *	(new leaf node)[ln] (old node)[fn]
	 */
	if (plen > bit) {
		in = node_alloc();
		ln = node_alloc();
577

578
		if (!in || !ln) {
L
Linus Torvalds 已提交
579 580 581 582
			if (in)
				node_free(in);
			if (ln)
				node_free(ln);
583
			return ERR_PTR(-ENOMEM);
L
Linus Torvalds 已提交
584 585
		}

586 587
		/*
		 * new intermediate node.
L
Linus Torvalds 已提交
588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623
		 * 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 */

624
		/*
L
Linus Torvalds 已提交
625 626 627 628 629 630 631
		 *		(new leaf node)[ln]
		 *	          /	   \
		 *	     (old node)[fn] NULL
		 */

		ln = node_alloc();

632
		if (!ln)
633
			return ERR_PTR(-ENOMEM);
L
Linus Torvalds 已提交
634 635 636 637 638 639

		ln->fn_bit = plen;

		ln->parent = pn;

		ln->fn_sernum = sernum;
640

L
Linus Torvalds 已提交
641 642 643 644 645 646 647 648 649 650 651 652 653 654 655
		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;
}

656
static bool rt6_qualify_for_ecmp(struct rt6_info *rt)
657 658 659 660 661
{
	return (rt->rt6i_flags & (RTF_GATEWAY|RTF_ADDRCONF|RTF_DYNAMIC)) ==
	       RTF_GATEWAY;
}

662
static void fib6_copy_metrics(u32 *mp, const struct mx6_config *mxc)
663
{
664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688
	int i;

	for (i = 0; i < RTAX_MAX; i++) {
		if (test_bit(i, mxc->mx_valid))
			mp[i] = mxc->mx[i];
	}
}

static int fib6_commit_metrics(struct dst_entry *dst, struct mx6_config *mxc)
{
	if (!mxc->mx)
		return 0;

	if (dst->flags & DST_HOST) {
		u32 *mp = dst_metrics_write_ptr(dst);

		if (unlikely(!mp))
			return -ENOMEM;

		fib6_copy_metrics(mp, mxc);
	} else {
		dst_init_metrics(dst, mxc->mx, false);

		/* We've stolen mx now. */
		mxc->mx = NULL;
689
	}
690

691 692 693
	return 0;
}

694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716
static void fib6_purge_rt(struct rt6_info *rt, struct fib6_node *fn,
			  struct net *net)
{
	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) {
			if (!(fn->fn_flags & RTN_RTINFO) && fn->leaf == rt) {
				fn->leaf = fib6_find_prefix(net, fn);
				atomic_inc(&fn->leaf->rt6i_ref);
				rt6_release(rt);
			}
			fn = fn->parent;
		}
		/* No more references are possible at this point. */
		BUG_ON(atomic_read(&rt->rt6i_ref) != 1);
	}
}

L
Linus Torvalds 已提交
717 718 719 720 721
/*
 *	Insert routing information in a node.
 */

static int fib6_add_rt2node(struct fib6_node *fn, struct rt6_info *rt,
722
			    struct nl_info *info, struct mx6_config *mxc)
L
Linus Torvalds 已提交
723 724 725
{
	struct rt6_info *iter = NULL;
	struct rt6_info **ins;
726
	struct rt6_info **fallback_ins = NULL;
727 728 729 730
	int replace = (info->nlh &&
		       (info->nlh->nlmsg_flags & NLM_F_REPLACE));
	int add = (!info->nlh ||
		   (info->nlh->nlmsg_flags & NLM_F_CREATE));
731
	int found = 0;
732
	bool rt_can_ecmp = rt6_qualify_for_ecmp(rt);
733
	int err;
L
Linus Torvalds 已提交
734 735 736

	ins = &fn->leaf;

737
	for (iter = fn->leaf; iter; iter = iter->dst.rt6_next) {
L
Linus Torvalds 已提交
738 739 740 741 742 743 744 745
		/*
		 *	Search for duplicates
		 */

		if (iter->rt6i_metric == rt->rt6i_metric) {
			/*
			 *	Same priority level
			 */
746 747
			if (info->nlh &&
			    (info->nlh->nlmsg_flags & NLM_F_EXCL))
748 749
				return -EEXIST;
			if (replace) {
750 751 752 753 754 755 756
				if (rt_can_ecmp == rt6_qualify_for_ecmp(iter)) {
					found++;
					break;
				}
				if (rt_can_ecmp)
					fallback_ins = fallback_ins ?: ins;
				goto next_iter;
757
			}
L
Linus Torvalds 已提交
758

759
			if (iter->dst.dev == rt->dst.dev &&
L
Linus Torvalds 已提交
760 761 762
			    iter->rt6i_idev == rt->rt6i_idev &&
			    ipv6_addr_equal(&iter->rt6i_gateway,
					    &rt->rt6i_gateway)) {
763 764
				if (rt->rt6i_nsiblings)
					rt->rt6i_nsiblings = 0;
765
				if (!(iter->rt6i_flags & RTF_EXPIRES))
L
Linus Torvalds 已提交
766
					return -EEXIST;
767 768 769 770
				if (!(rt->rt6i_flags & RTF_EXPIRES))
					rt6_clean_expires(iter);
				else
					rt6_set_expires(iter, rt->dst.expires);
771
				iter->rt6i_pmtu = rt->rt6i_pmtu;
L
Linus Torvalds 已提交
772 773
				return -EEXIST;
			}
774 775 776 777 778 779 780 781 782 783 784
			/* 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.
			 */
785 786
			if (rt_can_ecmp &&
			    rt6_qualify_for_ecmp(iter))
787
				rt->rt6i_nsiblings++;
L
Linus Torvalds 已提交
788 789 790 791 792
		}

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

793
next_iter:
794
		ins = &iter->dst.rt6_next;
L
Linus Torvalds 已提交
795 796
	}

797 798 799 800 801 802 803
	if (fallback_ins && !found) {
		/* No ECMP-able route found, replace first non-ECMP one */
		ins = fallback_ins;
		iter = *ins;
		found++;
	}

804 805 806 807
	/* Reset round-robin state, if necessary */
	if (ins == &fn->leaf)
		fn->rr_ptr = NULL;

808 809 810 811 812 813 814 815
	/* 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) {
816 817
			if (sibling->rt6i_metric == rt->rt6i_metric &&
			    rt6_qualify_for_ecmp(sibling)) {
818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837
				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 已提交
838 839 840
	/*
	 *	insert node
	 */
841 842
	if (!replace) {
		if (!add)
843
			pr_warn("NLM_F_CREATE should be set when creating new route\n");
844 845

add:
846 847 848 849
		err = fib6_commit_metrics(&rt->dst, mxc);
		if (err)
			return err;

850 851 852 853 854 855 856
		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++;

857
		if (!(fn->fn_flags & RTN_RTINFO)) {
858 859 860
			info->nl_net->ipv6.rt6_stats->fib_route_nodes++;
			fn->fn_flags |= RTN_RTINFO;
		}
L
Linus Torvalds 已提交
861

862
	} else {
863 864
		int nsiblings;

865 866 867
		if (!found) {
			if (add)
				goto add;
868
			pr_warn("NLM_F_REPLACE set, but no existing node found!\n");
869 870
			return -ENOENT;
		}
871 872 873 874 875

		err = fib6_commit_metrics(&rt->dst, mxc);
		if (err)
			return err;

876 877 878 879 880
		*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);
881
		if (!(fn->fn_flags & RTN_RTINFO)) {
882 883 884
			info->nl_net->ipv6.rt6_stats->fib_route_nodes++;
			fn->fn_flags |= RTN_RTINFO;
		}
885
		nsiblings = iter->rt6i_nsiblings;
886 887
		fib6_purge_rt(iter, fn, info->nl_net);
		rt6_release(iter);
888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905

		if (nsiblings) {
			/* Replacing an ECMP route, remove all siblings */
			ins = &rt->dst.rt6_next;
			iter = *ins;
			while (iter) {
				if (rt6_qualify_for_ecmp(iter)) {
					*ins = iter->dst.rt6_next;
					fib6_purge_rt(iter, fn, info->nl_net);
					rt6_release(iter);
					nsiblings--;
				} else {
					ins = &iter->dst.rt6_next;
				}
				iter = *ins;
			}
			WARN_ON(nsiblings != 0);
		}
L
Linus Torvalds 已提交
906 907 908 909 910
	}

	return 0;
}

911
static void fib6_start_gc(struct net *net, struct rt6_info *rt)
L
Linus Torvalds 已提交
912
{
913
	if (!timer_pending(&net->ipv6.ip6_fib_timer) &&
914
	    (rt->rt6i_flags & (RTF_EXPIRES | RTF_CACHE)))
915
		mod_timer(&net->ipv6.ip6_fib_timer,
S
Stephen Hemminger 已提交
916
			  jiffies + net->ipv6.sysctl.ip6_rt_gc_interval);
L
Linus Torvalds 已提交
917 918
}

919
void fib6_force_start_gc(struct net *net)
L
Linus Torvalds 已提交
920
{
921 922
	if (!timer_pending(&net->ipv6.ip6_fib_timer))
		mod_timer(&net->ipv6.ip6_fib_timer,
S
Stephen Hemminger 已提交
923
			  jiffies + net->ipv6.sysctl.ip6_rt_gc_interval);
L
Linus Torvalds 已提交
924 925 926 927 928 929 930 931
}

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

932 933
int fib6_add(struct fib6_node *root, struct rt6_info *rt,
	     struct nl_info *info, struct mx6_config *mxc)
L
Linus Torvalds 已提交
934
{
935
	struct fib6_node *fn, *pn = NULL;
L
Linus Torvalds 已提交
936
	int err = -ENOMEM;
937 938
	int allow_create = 1;
	int replace_required = 0;
939
	int sernum = fib6_new_sernum(info->nl_net);
940

M
Martin KaFai Lau 已提交
941 942 943 944
	if (WARN_ON_ONCE((rt->dst.flags & DST_NOCACHE) &&
			 !atomic_read(&rt->dst.__refcnt)))
		return -EINVAL;

945 946
	if (info->nlh) {
		if (!(info->nlh->nlmsg_flags & NLM_F_CREATE))
947
			allow_create = 0;
948
		if (info->nlh->nlmsg_flags & NLM_F_REPLACE)
949 950 951
			replace_required = 1;
	}
	if (!allow_create && !replace_required)
952
		pr_warn("RTM_NEWROUTE with no NLM_F_CREATE or NLM_F_REPLACE\n");
L
Linus Torvalds 已提交
953

954 955
	fn = fib6_add_1(root, &rt->rt6i_dst.addr, rt->rt6i_dst.plen,
			offsetof(struct rt6_info, rt6i_dst), allow_create,
956
			replace_required, sernum);
957 958
	if (IS_ERR(fn)) {
		err = PTR_ERR(fn);
959
		fn = NULL;
L
Linus Torvalds 已提交
960
		goto out;
961
	}
L
Linus Torvalds 已提交
962

963 964
	pn = fn;

L
Linus Torvalds 已提交
965 966 967 968
#ifdef CONFIG_IPV6_SUBTREES
	if (rt->rt6i_src.plen) {
		struct fib6_node *sn;

969
		if (!fn->subtree) {
L
Linus Torvalds 已提交
970 971 972 973 974 975 976 977 978 979 980 981 982 983
			struct fib6_node *sfn;

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

			/* Create subtree root node */
			sfn = node_alloc();
984
			if (!sfn)
L
Linus Torvalds 已提交
985 986
				goto st_failure;

987 988
			sfn->leaf = info->nl_net->ipv6.ip6_null_entry;
			atomic_inc(&info->nl_net->ipv6.ip6_null_entry->rt6i_ref);
L
Linus Torvalds 已提交
989
			sfn->fn_flags = RTN_ROOT;
990
			sfn->fn_sernum = sernum;
L
Linus Torvalds 已提交
991 992 993 994

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

			sn = fib6_add_1(sfn, &rt->rt6i_src.addr,
995
					rt->rt6i_src.plen,
996
					offsetof(struct rt6_info, rt6i_src),
997
					allow_create, replace_required, sernum);
L
Linus Torvalds 已提交
998

999
			if (IS_ERR(sn)) {
L
Linus Torvalds 已提交
1000 1001 1002 1003 1004
				/* If it is failed, discard just allocated
				   root, and then (in st_failure) stale node
				   in main tree.
				 */
				node_free(sfn);
1005
				err = PTR_ERR(sn);
L
Linus Torvalds 已提交
1006 1007 1008 1009 1010 1011 1012 1013
				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,
1014
					rt->rt6i_src.plen,
1015
					offsetof(struct rt6_info, rt6i_src),
1016
					allow_create, replace_required, sernum);
L
Linus Torvalds 已提交
1017

1018 1019
			if (IS_ERR(sn)) {
				err = PTR_ERR(sn);
L
Linus Torvalds 已提交
1020
				goto st_failure;
1021
			}
L
Linus Torvalds 已提交
1022 1023
		}

1024
		if (!fn->leaf) {
1025 1026 1027
			fn->leaf = rt;
			atomic_inc(&rt->rt6i_ref);
		}
L
Linus Torvalds 已提交
1028 1029 1030 1031
		fn = sn;
	}
#endif

1032
	err = fib6_add_rt2node(fn, rt, info, mxc);
1033
	if (!err) {
1034
		fib6_start_gc(info->nl_net, rt);
1035
		if (!(rt->rt6i_flags & RTF_CACHE))
1036
			fib6_prune_clones(info->nl_net, pn);
M
Martin KaFai Lau 已提交
1037
		rt->dst.flags &= ~DST_NOCACHE;
L
Linus Torvalds 已提交
1038 1039 1040
	}

out:
1041 1042 1043 1044 1045 1046
	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.
		 */
1047 1048 1049 1050
		if (pn != fn && pn->leaf == rt) {
			pn->leaf = NULL;
			atomic_dec(&rt->rt6i_ref);
		}
1051
		if (pn != fn && !pn->leaf && !(pn->fn_flags & RTN_RTINFO)) {
1052
			pn->leaf = fib6_find_prefix(info->nl_net, pn);
1053 1054
#if RT6_DEBUG >= 2
			if (!pn->leaf) {
1055
				WARN_ON(pn->leaf == NULL);
1056
				pn->leaf = info->nl_net->ipv6.ip6_null_entry;
1057 1058 1059 1060 1061
			}
#endif
			atomic_inc(&pn->leaf->rt6i_ref);
		}
#endif
M
Martin KaFai Lau 已提交
1062 1063
		if (!(rt->dst.flags & DST_NOCACHE))
			dst_free(&rt->dst);
1064
	}
L
Linus Torvalds 已提交
1065 1066 1067 1068 1069 1070 1071 1072
	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)))
1073
		fib6_repair_tree(info->nl_net, fn);
M
Martin KaFai Lau 已提交
1074 1075
	if (!(rt->dst.flags & DST_NOCACHE))
		dst_free(&rt->dst);
L
Linus Torvalds 已提交
1076 1077 1078 1079 1080 1081 1082 1083 1084 1085
	return err;
#endif
}

/*
 *	Routing tree lookup
 *
 */

struct lookup_args {
1086
	int			offset;		/* key offset on rt6_info	*/
1087
	const struct in6_addr	*addr;		/* search key			*/
L
Linus Torvalds 已提交
1088 1089
};

1090 1091
static struct fib6_node *fib6_lookup_1(struct fib6_node *root,
				       struct lookup_args *args)
L
Linus Torvalds 已提交
1092 1093
{
	struct fib6_node *fn;
A
Al Viro 已提交
1094
	__be32 dir;
L
Linus Torvalds 已提交
1095

1096 1097 1098
	if (unlikely(args->offset == 0))
		return NULL;

L
Linus Torvalds 已提交
1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118
	/*
	 *	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;
	}

1119
	while (fn) {
1120
		if (FIB6_SUBTREE(fn) || fn->fn_flags & RTN_RTINFO) {
L
Linus Torvalds 已提交
1121 1122 1123 1124 1125
			struct rt6key *key;

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

1126 1127
			if (ipv6_prefix_equal(&key->addr, args->addr, key->plen)) {
#ifdef CONFIG_IPV6_SUBTREES
1128 1129 1130 1131 1132 1133 1134 1135
				if (fn->subtree) {
					struct fib6_node *sfn;
					sfn = fib6_lookup_1(fn->subtree,
							    args + 1);
					if (!sfn)
						goto backtrack;
					fn = sfn;
				}
1136
#endif
1137
				if (fn->fn_flags & RTN_RTINFO)
1138 1139
					return fn;
			}
L
Linus Torvalds 已提交
1140
		}
1141 1142 1143
#ifdef CONFIG_IPV6_SUBTREES
backtrack:
#endif
1144 1145 1146
		if (fn->fn_flags & RTN_ROOT)
			break;

L
Linus Torvalds 已提交
1147 1148 1149 1150 1151 1152
		fn = fn->parent;
	}

	return NULL;
}

1153 1154
struct fib6_node *fib6_lookup(struct fib6_node *root, const struct in6_addr *daddr,
			      const struct in6_addr *saddr)
L
Linus Torvalds 已提交
1155 1156
{
	struct fib6_node *fn;
1157 1158 1159 1160 1161
	struct lookup_args args[] = {
		{
			.offset = offsetof(struct rt6_info, rt6i_dst),
			.addr = daddr,
		},
L
Linus Torvalds 已提交
1162
#ifdef CONFIG_IPV6_SUBTREES
1163 1164 1165 1166
		{
			.offset = offsetof(struct rt6_info, rt6i_src),
			.addr = saddr,
		},
L
Linus Torvalds 已提交
1167
#endif
1168 1169 1170 1171
		{
			.offset = 0,	/* sentinel */
		}
	};
L
Linus Torvalds 已提交
1172

1173
	fn = fib6_lookup_1(root, daddr ? args : args + 1);
1174
	if (!fn || fn->fn_flags & RTN_TL_ROOT)
L
Linus Torvalds 已提交
1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185
		fn = root;

	return fn;
}

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


1186 1187 1188
static struct fib6_node *fib6_locate_1(struct fib6_node *root,
				       const struct in6_addr *addr,
				       int plen, int offset)
L
Linus Torvalds 已提交
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 1214 1215
{
	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;
}

1216 1217 1218
struct fib6_node *fib6_locate(struct fib6_node *root,
			      const struct in6_addr *daddr, int dst_len,
			      const struct in6_addr *saddr, int src_len)
L
Linus Torvalds 已提交
1219 1220 1221 1222 1223 1224 1225 1226
{
	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) {
1227
		WARN_ON(saddr == NULL);
1228 1229
		if (fn && fn->subtree)
			fn = fib6_locate_1(fn->subtree, saddr, src_len,
L
Linus Torvalds 已提交
1230 1231 1232 1233
					   offsetof(struct rt6_info, rt6i_src));
	}
#endif

1234
	if (fn && fn->fn_flags & RTN_RTINFO)
L
Linus Torvalds 已提交
1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245
		return fn;

	return NULL;
}


/*
 *	Deletion
 *
 */

1246
static struct rt6_info *fib6_find_prefix(struct net *net, struct fib6_node *fn)
L
Linus Torvalds 已提交
1247
{
1248
	if (fn->fn_flags & RTN_ROOT)
1249
		return net->ipv6.ip6_null_entry;
L
Linus Torvalds 已提交
1250

1251 1252
	while (fn) {
		if (fn->left)
L
Linus Torvalds 已提交
1253
			return fn->left->leaf;
1254
		if (fn->right)
L
Linus Torvalds 已提交
1255 1256
			return fn->right->leaf;

1257
		fn = FIB6_SUBTREE(fn);
L
Linus Torvalds 已提交
1258 1259 1260 1261 1262 1263 1264 1265 1266
	}
	return NULL;
}

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

1267 1268
static struct fib6_node *fib6_repair_tree(struct net *net,
					   struct fib6_node *fn)
L
Linus Torvalds 已提交
1269 1270 1271 1272
{
	int children;
	int nstate;
	struct fib6_node *child, *pn;
1273
	struct fib6_walker *w;
L
Linus Torvalds 已提交
1274 1275 1276 1277 1278 1279
	int iter = 0;

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

1280 1281
		WARN_ON(fn->fn_flags & RTN_RTINFO);
		WARN_ON(fn->fn_flags & RTN_TL_ROOT);
1282
		WARN_ON(fn->leaf);
L
Linus Torvalds 已提交
1283 1284 1285

		children = 0;
		child = NULL;
1286 1287 1288 1289
		if (fn->right)
			child = fn->right, children |= 1;
		if (fn->left)
			child = fn->left, children |= 2;
L
Linus Torvalds 已提交
1290

1291
		if (children == 3 || FIB6_SUBTREE(fn)
L
Linus Torvalds 已提交
1292 1293
#ifdef CONFIG_IPV6_SUBTREES
		    /* Subtree root (i.e. fn) may have one child */
1294
		    || (children && fn->fn_flags & RTN_ROOT)
L
Linus Torvalds 已提交
1295 1296
#endif
		    ) {
1297
			fn->leaf = fib6_find_prefix(net, fn);
L
Linus Torvalds 已提交
1298
#if RT6_DEBUG >= 2
1299
			if (!fn->leaf) {
1300
				WARN_ON(!fn->leaf);
1301
				fn->leaf = net->ipv6.ip6_null_entry;
L
Linus Torvalds 已提交
1302 1303 1304 1305 1306 1307 1308 1309
			}
#endif
			atomic_inc(&fn->leaf->rt6i_ref);
			return fn->parent;
		}

		pn = fn->parent;
#ifdef CONFIG_IPV6_SUBTREES
1310
		if (FIB6_SUBTREE(pn) == fn) {
1311
			WARN_ON(!(fn->fn_flags & RTN_ROOT));
1312
			FIB6_SUBTREE(pn) = NULL;
L
Linus Torvalds 已提交
1313 1314
			nstate = FWS_L;
		} else {
1315
			WARN_ON(fn->fn_flags & RTN_ROOT);
L
Linus Torvalds 已提交
1316
#endif
1317 1318 1319 1320
			if (pn->right == fn)
				pn->right = child;
			else if (pn->left == fn)
				pn->left = child;
L
Linus Torvalds 已提交
1321
#if RT6_DEBUG >= 2
1322 1323
			else
				WARN_ON(1);
L
Linus Torvalds 已提交
1324 1325 1326 1327 1328 1329 1330 1331 1332 1333
#endif
			if (child)
				child->parent = pn;
			nstate = FWS_R;
#ifdef CONFIG_IPV6_SUBTREES
		}
#endif

		read_lock(&fib6_walker_lock);
		FOR_WALKERS(w) {
1334
			if (!child) {
L
Linus Torvalds 已提交
1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351
				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);
1352
						w->state = w->state >= FWS_R ? FWS_U : FWS_INIT;
L
Linus Torvalds 已提交
1353 1354
					} else {
						RT6_TRACE("W %p adjusted by delnode 2, s=%d\n", w, w->state);
1355
						w->state = w->state >= FWS_C ? FWS_U : FWS_INIT;
L
Linus Torvalds 已提交
1356 1357 1358 1359 1360 1361 1362
					}
				}
			}
		}
		read_unlock(&fib6_walker_lock);

		node_free(fn);
1363
		if (pn->fn_flags & RTN_RTINFO || FIB6_SUBTREE(pn))
L
Linus Torvalds 已提交
1364 1365 1366 1367 1368 1369 1370 1371 1372
			return pn;

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

static void fib6_del_route(struct fib6_node *fn, struct rt6_info **rtp,
1373
			   struct nl_info *info)
L
Linus Torvalds 已提交
1374
{
1375
	struct fib6_walker *w;
L
Linus Torvalds 已提交
1376
	struct rt6_info *rt = *rtp;
1377
	struct net *net = info->nl_net;
L
Linus Torvalds 已提交
1378 1379 1380 1381

	RT6_TRACE("fib6_del_route\n");

	/* Unlink it */
1382
	*rtp = rt->dst.rt6_next;
L
Linus Torvalds 已提交
1383
	rt->rt6i_node = NULL;
1384 1385
	net->ipv6.rt6_stats->fib_rt_entries--;
	net->ipv6.rt6_stats->fib_discarded_routes++;
L
Linus Torvalds 已提交
1386

1387 1388 1389 1390
	/* Reset round-robin state, if necessary */
	if (fn->rr_ptr == rt)
		fn->rr_ptr = NULL;

1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401
	/* 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 已提交
1402 1403 1404 1405 1406
	/* 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);
1407
			w->leaf = rt->dst.rt6_next;
1408
			if (!w->leaf)
L
Linus Torvalds 已提交
1409 1410 1411 1412 1413
				w->state = FWS_U;
		}
	}
	read_unlock(&fib6_walker_lock);

1414
	rt->dst.rt6_next = NULL;
L
Linus Torvalds 已提交
1415 1416

	/* If it was last route, expunge its radix tree node */
1417
	if (!fn->leaf) {
L
Linus Torvalds 已提交
1418
		fn->fn_flags &= ~RTN_RTINFO;
1419
		net->ipv6.rt6_stats->fib_route_nodes--;
1420
		fn = fib6_repair_tree(net, fn);
L
Linus Torvalds 已提交
1421 1422
	}

1423
	fib6_purge_rt(rt, fn, net);
L
Linus Torvalds 已提交
1424

1425
	inet6_rt_notify(RTM_DELROUTE, rt, info);
L
Linus Torvalds 已提交
1426 1427 1428
	rt6_release(rt);
}

1429
int fib6_del(struct rt6_info *rt, struct nl_info *info)
L
Linus Torvalds 已提交
1430
{
1431
	struct net *net = info->nl_net;
L
Linus Torvalds 已提交
1432 1433 1434 1435
	struct fib6_node *fn = rt->rt6i_node;
	struct rt6_info **rtp;

#if RT6_DEBUG >= 2
1436
	if (rt->dst.obsolete > 0) {
1437
		WARN_ON(fn);
L
Linus Torvalds 已提交
1438 1439 1440
		return -ENOENT;
	}
#endif
1441
	if (!fn || rt == net->ipv6.ip6_null_entry)
L
Linus Torvalds 已提交
1442 1443
		return -ENOENT;

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

1446
	if (!(rt->rt6i_flags & RTF_CACHE)) {
1447 1448 1449 1450
		struct fib6_node *pn = fn;
#ifdef CONFIG_IPV6_SUBTREES
		/* clones of this route might be in another subtree */
		if (rt->rt6i_src.plen) {
1451
			while (!(pn->fn_flags & RTN_ROOT))
1452 1453 1454 1455
				pn = pn->parent;
			pn = pn->parent;
		}
#endif
1456
		fib6_prune_clones(info->nl_net, pn);
1457
	}
L
Linus Torvalds 已提交
1458 1459 1460 1461 1462

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

1463
	for (rtp = &fn->leaf; *rtp; rtp = &(*rtp)->dst.rt6_next) {
L
Linus Torvalds 已提交
1464
		if (*rtp == rt) {
1465
			fib6_del_route(fn, rtp, info);
L
Linus Torvalds 已提交
1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478
			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,
1479
 *	cleaning tree when a device goes down etc. etc.
L
Linus Torvalds 已提交
1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495
 *
 *	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.
 */

1496
static int fib6_walk_continue(struct fib6_walker *w)
L
Linus Torvalds 已提交
1497 1498 1499 1500 1501
{
	struct fib6_node *fn, *pn;

	for (;;) {
		fn = w->node;
1502
		if (!fn)
L
Linus Torvalds 已提交
1503 1504 1505
			return 0;

		if (w->prune && fn != w->root &&
1506
		    fn->fn_flags & RTN_RTINFO && w->state < FWS_C) {
L
Linus Torvalds 已提交
1507 1508 1509 1510 1511 1512
			w->state = FWS_C;
			w->leaf = fn->leaf;
		}
		switch (w->state) {
#ifdef CONFIG_IPV6_SUBTREES
		case FWS_S:
1513 1514
			if (FIB6_SUBTREE(fn)) {
				w->node = FIB6_SUBTREE(fn);
L
Linus Torvalds 已提交
1515 1516 1517
				continue;
			}
			w->state = FWS_L;
1518
#endif
L
Linus Torvalds 已提交
1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534
		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:
1535
			if (w->leaf && fn->fn_flags & RTN_RTINFO) {
1536 1537
				int err;

E
Eric Dumazet 已提交
1538 1539
				if (w->skip) {
					w->skip--;
1540
					goto skip;
1541 1542 1543
				}

				err = w->func(w);
L
Linus Torvalds 已提交
1544 1545
				if (err)
					return err;
1546 1547

				w->count++;
L
Linus Torvalds 已提交
1548 1549
				continue;
			}
1550
skip:
L
Linus Torvalds 已提交
1551 1552 1553 1554 1555 1556 1557
			w->state = FWS_U;
		case FWS_U:
			if (fn == w->root)
				return 0;
			pn = fn->parent;
			w->node = pn;
#ifdef CONFIG_IPV6_SUBTREES
1558
			if (FIB6_SUBTREE(pn) == fn) {
1559
				WARN_ON(!(fn->fn_flags & RTN_ROOT));
L
Linus Torvalds 已提交
1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573
				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
1574
			WARN_ON(1);
L
Linus Torvalds 已提交
1575 1576 1577 1578 1579
#endif
		}
	}
}

1580
static int fib6_walk(struct fib6_walker *w)
L
Linus Torvalds 已提交
1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593
{
	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;
}

1594
static int fib6_clean_node(struct fib6_walker *w)
L
Linus Torvalds 已提交
1595 1596 1597
{
	int res;
	struct rt6_info *rt;
1598
	struct fib6_cleaner *c = container_of(w, struct fib6_cleaner, w);
1599 1600 1601
	struct nl_info info = {
		.nl_net = c->net,
	};
L
Linus Torvalds 已提交
1602

1603 1604 1605 1606 1607 1608 1609 1610 1611 1612
	if (c->sernum != FIB6_NO_SERNUM_CHANGE &&
	    w->node->fn_sernum != c->sernum)
		w->node->fn_sernum = c->sernum;

	if (!c->func) {
		WARN_ON_ONCE(c->sernum == FIB6_NO_SERNUM_CHANGE);
		w->leaf = NULL;
		return 0;
	}

1613
	for (rt = w->leaf; rt; rt = rt->dst.rt6_next) {
L
Linus Torvalds 已提交
1614 1615 1616
		res = c->func(rt, c->arg);
		if (res < 0) {
			w->leaf = rt;
1617
			res = fib6_del(rt, &info);
L
Linus Torvalds 已提交
1618 1619
			if (res) {
#if RT6_DEBUG >= 2
1620 1621
				pr_debug("%s: del failed: rt=%p@%p err=%d\n",
					 __func__, rt, rt->rt6i_node, res);
L
Linus Torvalds 已提交
1622 1623 1624 1625 1626
#endif
				continue;
			}
			return 0;
		}
1627
		WARN_ON(res != 0);
L
Linus Torvalds 已提交
1628 1629 1630 1631 1632 1633 1634
	}
	w->leaf = rt;
	return 0;
}

/*
 *	Convenient frontend to tree walker.
1635
 *
L
Linus Torvalds 已提交
1636 1637 1638 1639 1640 1641 1642 1643
 *	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.
 */

1644
static void fib6_clean_tree(struct net *net, struct fib6_node *root,
A
Adrian Bunk 已提交
1645
			    int (*func)(struct rt6_info *, void *arg),
1646
			    bool prune, int sernum, void *arg)
L
Linus Torvalds 已提交
1647
{
1648
	struct fib6_cleaner c;
L
Linus Torvalds 已提交
1649 1650 1651 1652

	c.w.root = root;
	c.w.func = fib6_clean_node;
	c.w.prune = prune;
1653 1654
	c.w.count = 0;
	c.w.skip = 0;
L
Linus Torvalds 已提交
1655
	c.func = func;
1656
	c.sernum = sernum;
L
Linus Torvalds 已提交
1657
	c.arg = arg;
1658
	c.net = net;
L
Linus Torvalds 已提交
1659 1660 1661 1662

	fib6_walk(&c.w);
}

1663 1664 1665
static void __fib6_clean_all(struct net *net,
			     int (*func)(struct rt6_info *, void *),
			     int sernum, void *arg)
T
Thomas Graf 已提交
1666 1667
{
	struct fib6_table *table;
1668
	struct hlist_head *head;
1669
	unsigned int h;
T
Thomas Graf 已提交
1670

1671
	rcu_read_lock();
1672
	for (h = 0; h < FIB6_TABLE_HASHSZ; h++) {
1673
		head = &net->ipv6.fib_table_hash[h];
1674
		hlist_for_each_entry_rcu(table, head, tb6_hlist) {
T
Thomas Graf 已提交
1675
			write_lock_bh(&table->tb6_lock);
1676
			fib6_clean_tree(net, &table->tb6_root,
1677
					func, false, sernum, arg);
T
Thomas Graf 已提交
1678 1679 1680
			write_unlock_bh(&table->tb6_lock);
		}
	}
1681
	rcu_read_unlock();
T
Thomas Graf 已提交
1682 1683
}

1684 1685 1686 1687 1688 1689
void fib6_clean_all(struct net *net, int (*func)(struct rt6_info *, void *),
		    void *arg)
{
	__fib6_clean_all(net, func, FIB6_NO_SERNUM_CHANGE, arg);
}

L
Linus Torvalds 已提交
1690 1691 1692 1693 1694 1695 1696 1697 1698 1699
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;
}

1700
static void fib6_prune_clones(struct net *net, struct fib6_node *fn)
L
Linus Torvalds 已提交
1701
{
1702 1703
	fib6_clean_tree(net, fn, fib6_prune_clone, true,
			FIB6_NO_SERNUM_CHANGE, NULL);
H
Hannes Frederic Sowa 已提交
1704 1705 1706 1707
}

static void fib6_flush_trees(struct net *net)
{
1708
	int new_sernum = fib6_new_sernum(net);
H
Hannes Frederic Sowa 已提交
1709

1710
	__fib6_clean_all(net, NULL, new_sernum, NULL);
H
Hannes Frederic Sowa 已提交
1711 1712
}

L
Linus Torvalds 已提交
1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734
/*
 *	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.
	 */

1735 1736
	if (rt->rt6i_flags & RTF_EXPIRES && rt->dst.expires) {
		if (time_after(now, rt->dst.expires)) {
L
Linus Torvalds 已提交
1737 1738 1739 1740 1741
			RT6_TRACE("expiring %p\n", rt);
			return -1;
		}
		gc_args.more++;
	} else if (rt->rt6i_flags & RTF_CACHE) {
1742 1743
		if (atomic_read(&rt->dst.__refcnt) == 0 &&
		    time_after_eq(now, rt->dst.lastuse + gc_args.timeout)) {
L
Linus Torvalds 已提交
1744 1745
			RT6_TRACE("aging clone %p\n", rt);
			return -1;
1746 1747 1748 1749 1750 1751 1752 1753 1754
		} 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);
			}
1755
			if (!(neigh_flags & NTF_ROUTER)) {
1756 1757 1758 1759
				RT6_TRACE("purging route %p via non-router but gateway\n",
					  rt);
				return -1;
			}
L
Linus Torvalds 已提交
1760 1761 1762 1763 1764 1765 1766 1767 1768
		}
		gc_args.more++;
	}

	return 0;
}

static DEFINE_SPINLOCK(fib6_gc_lock);

1769
void fib6_run_gc(unsigned long expires, struct net *net, bool force)
L
Linus Torvalds 已提交
1770
{
1771 1772
	unsigned long now;

1773
	if (force) {
L
Linus Torvalds 已提交
1774
		spin_lock_bh(&fib6_gc_lock);
1775 1776 1777
	} else if (!spin_trylock_bh(&fib6_gc_lock)) {
		mod_timer(&net->ipv6.ip6_fib_timer, jiffies + HZ);
		return;
L
Linus Torvalds 已提交
1778
	}
1779 1780
	gc_args.timeout = expires ? (int)expires :
			  net->ipv6.sysctl.ip6_rt_gc_interval;
L
Linus Torvalds 已提交
1781

1782
	gc_args.more = icmp6_dst_gc();
1783

1784
	fib6_clean_all(net, fib6_age, NULL);
1785 1786
	now = jiffies;
	net->ipv6.ip6_rt_last_gc = now;
L
Linus Torvalds 已提交
1787 1788

	if (gc_args.more)
S
Stephen Hemminger 已提交
1789
		mod_timer(&net->ipv6.ip6_fib_timer,
1790
			  round_jiffies(now
S
Stephen Hemminger 已提交
1791
					+ net->ipv6.sysctl.ip6_rt_gc_interval));
1792 1793
	else
		del_timer(&net->ipv6.ip6_fib_timer);
L
Linus Torvalds 已提交
1794 1795 1796
	spin_unlock_bh(&fib6_gc_lock);
}

1797 1798
static void fib6_gc_timer_cb(unsigned long arg)
{
1799
	fib6_run_gc(0, (struct net *)arg, true);
1800 1801
}

1802
static int __net_init fib6_net_init(struct net *net)
L
Linus Torvalds 已提交
1803
{
1804 1805
	size_t size = sizeof(struct hlist_head) * FIB6_TABLE_HASHSZ;

1806
	setup_timer(&net->ipv6.ip6_fib_timer, fib6_gc_timer_cb, (unsigned long)net);
1807

1808 1809 1810 1811
	net->ipv6.rt6_stats = kzalloc(sizeof(*net->ipv6.rt6_stats), GFP_KERNEL);
	if (!net->ipv6.rt6_stats)
		goto out_timer;

1812 1813 1814 1815
	/* 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);
1816
	if (!net->ipv6.fib_table_hash)
1817
		goto out_rt6_stats;
1818

1819 1820 1821
	net->ipv6.fib6_main_tbl = kzalloc(sizeof(*net->ipv6.fib6_main_tbl),
					  GFP_KERNEL);
	if (!net->ipv6.fib6_main_tbl)
1822 1823
		goto out_fib_table_hash;

1824
	net->ipv6.fib6_main_tbl->tb6_id = RT6_TABLE_MAIN;
1825
	net->ipv6.fib6_main_tbl->tb6_root.leaf = net->ipv6.ip6_null_entry;
1826 1827
	net->ipv6.fib6_main_tbl->tb6_root.fn_flags =
		RTN_ROOT | RTN_TL_ROOT | RTN_RTINFO;
1828
	inet_peer_base_init(&net->ipv6.fib6_main_tbl->tb6_peers);
1829 1830

#ifdef CONFIG_IPV6_MULTIPLE_TABLES
1831 1832 1833
	net->ipv6.fib6_local_tbl = kzalloc(sizeof(*net->ipv6.fib6_local_tbl),
					   GFP_KERNEL);
	if (!net->ipv6.fib6_local_tbl)
1834
		goto out_fib6_main_tbl;
1835
	net->ipv6.fib6_local_tbl->tb6_id = RT6_TABLE_LOCAL;
1836
	net->ipv6.fib6_local_tbl->tb6_root.leaf = net->ipv6.ip6_null_entry;
1837 1838
	net->ipv6.fib6_local_tbl->tb6_root.fn_flags =
		RTN_ROOT | RTN_TL_ROOT | RTN_RTINFO;
1839
	inet_peer_base_init(&net->ipv6.fib6_local_tbl->tb6_peers);
1840
#endif
1841
	fib6_tables_init(net);
1842

1843
	return 0;
1844

1845 1846
#ifdef CONFIG_IPV6_MULTIPLE_TABLES
out_fib6_main_tbl:
1847
	kfree(net->ipv6.fib6_main_tbl);
1848 1849
#endif
out_fib_table_hash:
1850
	kfree(net->ipv6.fib_table_hash);
1851 1852
out_rt6_stats:
	kfree(net->ipv6.rt6_stats);
1853
out_timer:
1854
	return -ENOMEM;
1855
}
1856 1857 1858

static void fib6_net_exit(struct net *net)
{
1859
	rt6_ifdown(net, NULL);
1860 1861
	del_timer_sync(&net->ipv6.ip6_fib_timer);

1862
#ifdef CONFIG_IPV6_MULTIPLE_TABLES
1863
	inetpeer_invalidate_tree(&net->ipv6.fib6_local_tbl->tb6_peers);
1864 1865
	kfree(net->ipv6.fib6_local_tbl);
#endif
1866
	inetpeer_invalidate_tree(&net->ipv6.fib6_main_tbl->tb6_peers);
1867 1868
	kfree(net->ipv6.fib6_main_tbl);
	kfree(net->ipv6.fib_table_hash);
1869
	kfree(net->ipv6.rt6_stats);
1870 1871 1872 1873 1874 1875 1876 1877 1878 1879
}

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

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

1881 1882 1883 1884 1885 1886 1887 1888 1889
	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)
1890
		goto out_kmem_cache_create;
1891 1892 1893 1894 1895

	ret = __rtnl_register(PF_INET6, RTM_GETROUTE, NULL, inet6_dump_fib,
			      NULL);
	if (ret)
		goto out_unregister_subsys;
H
Hannes Frederic Sowa 已提交
1896 1897

	__fib6_flush_trees = fib6_flush_trees;
1898 1899 1900
out:
	return ret;

1901 1902
out_unregister_subsys:
	unregister_pernet_subsys(&fib6_net_ops);
1903 1904 1905
out_kmem_cache_create:
	kmem_cache_destroy(fib6_node_kmem);
	goto out;
L
Linus Torvalds 已提交
1906 1907 1908 1909
}

void fib6_gc_cleanup(void)
{
1910
	unregister_pernet_subsys(&fib6_net_ops);
L
Linus Torvalds 已提交
1911 1912
	kmem_cache_destroy(fib6_node_kmem);
}
1913 1914 1915 1916 1917

#ifdef CONFIG_PROC_FS

struct ipv6_route_iter {
	struct seq_net_private p;
1918
	struct fib6_walker w;
1919 1920
	loff_t skip;
	struct fib6_table *tbl;
1921
	int sernum;
1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948
};

static int ipv6_route_seq_show(struct seq_file *seq, void *v)
{
	struct rt6_info *rt = v;
	struct ipv6_route_iter *iter = seq->private;

	seq_printf(seq, "%pi6 %02x ", &rt->rt6i_dst.addr, rt->rt6i_dst.plen);

#ifdef CONFIG_IPV6_SUBTREES
	seq_printf(seq, "%pi6 %02x ", &rt->rt6i_src.addr, rt->rt6i_src.plen);
#else
	seq_puts(seq, "00000000000000000000000000000000 00 ");
#endif
	if (rt->rt6i_flags & RTF_GATEWAY)
		seq_printf(seq, "%pi6", &rt->rt6i_gateway);
	else
		seq_puts(seq, "00000000000000000000000000000000");

	seq_printf(seq, " %08x %08x %08x %08x %8s\n",
		   rt->rt6i_metric, atomic_read(&rt->dst.__refcnt),
		   rt->dst.__use, rt->rt6i_flags,
		   rt->dst.dev ? rt->dst.dev->name : "");
	iter->w.leaf = NULL;
	return 0;
}

1949
static int ipv6_route_yield(struct fib6_walker *w)
1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973
{
	struct ipv6_route_iter *iter = w->args;

	if (!iter->skip)
		return 1;

	do {
		iter->w.leaf = iter->w.leaf->dst.rt6_next;
		iter->skip--;
		if (!iter->skip && iter->w.leaf)
			return 1;
	} while (iter->w.leaf);

	return 0;
}

static void ipv6_route_seq_setup_walk(struct ipv6_route_iter *iter)
{
	memset(&iter->w, 0, sizeof(iter->w));
	iter->w.func = ipv6_route_yield;
	iter->w.root = &iter->tbl->tb6_root;
	iter->w.state = FWS_INIT;
	iter->w.node = iter->w.root;
	iter->w.args = iter;
1974
	iter->sernum = iter->w.root->fn_sernum;
1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999
	INIT_LIST_HEAD(&iter->w.lh);
	fib6_walker_link(&iter->w);
}

static struct fib6_table *ipv6_route_seq_next_table(struct fib6_table *tbl,
						    struct net *net)
{
	unsigned int h;
	struct hlist_node *node;

	if (tbl) {
		h = (tbl->tb6_id & (FIB6_TABLE_HASHSZ - 1)) + 1;
		node = rcu_dereference_bh(hlist_next_rcu(&tbl->tb6_hlist));
	} else {
		h = 0;
		node = NULL;
	}

	while (!node && h < FIB6_TABLE_HASHSZ) {
		node = rcu_dereference_bh(
			hlist_first_rcu(&net->ipv6.fib_table_hash[h++]));
	}
	return hlist_entry_safe(node, struct fib6_table, tb6_hlist);
}

2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010
static void ipv6_route_check_sernum(struct ipv6_route_iter *iter)
{
	if (iter->sernum != iter->w.root->fn_sernum) {
		iter->sernum = iter->w.root->fn_sernum;
		iter->w.state = FWS_INIT;
		iter->w.node = iter->w.root;
		WARN_ON(iter->w.skip);
		iter->w.skip = iter->w.count;
	}
}

2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027
static void *ipv6_route_seq_next(struct seq_file *seq, void *v, loff_t *pos)
{
	int r;
	struct rt6_info *n;
	struct net *net = seq_file_net(seq);
	struct ipv6_route_iter *iter = seq->private;

	if (!v)
		goto iter_table;

	n = ((struct rt6_info *)v)->dst.rt6_next;
	if (n) {
		++*pos;
		return n;
	}

iter_table:
2028
	ipv6_route_check_sernum(iter);
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 2065 2066 2067 2068 2069
	read_lock(&iter->tbl->tb6_lock);
	r = fib6_walk_continue(&iter->w);
	read_unlock(&iter->tbl->tb6_lock);
	if (r > 0) {
		if (v)
			++*pos;
		return iter->w.leaf;
	} else if (r < 0) {
		fib6_walker_unlink(&iter->w);
		return NULL;
	}
	fib6_walker_unlink(&iter->w);

	iter->tbl = ipv6_route_seq_next_table(iter->tbl, net);
	if (!iter->tbl)
		return NULL;

	ipv6_route_seq_setup_walk(iter);
	goto iter_table;
}

static void *ipv6_route_seq_start(struct seq_file *seq, loff_t *pos)
	__acquires(RCU_BH)
{
	struct net *net = seq_file_net(seq);
	struct ipv6_route_iter *iter = seq->private;

	rcu_read_lock_bh();
	iter->tbl = ipv6_route_seq_next_table(NULL, net);
	iter->skip = *pos;

	if (iter->tbl) {
		ipv6_route_seq_setup_walk(iter);
		return ipv6_route_seq_next(seq, NULL, pos);
	} else {
		return NULL;
	}
}

static bool ipv6_route_iter_active(struct ipv6_route_iter *iter)
{
2070
	struct fib6_walker *w = &iter->w;
2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098
	return w->node && !(w->state == FWS_U && w->node == w->root);
}

static void ipv6_route_seq_stop(struct seq_file *seq, void *v)
	__releases(RCU_BH)
{
	struct ipv6_route_iter *iter = seq->private;

	if (ipv6_route_iter_active(iter))
		fib6_walker_unlink(&iter->w);

	rcu_read_unlock_bh();
}

static const struct seq_operations ipv6_route_seq_ops = {
	.start	= ipv6_route_seq_start,
	.next	= ipv6_route_seq_next,
	.stop	= ipv6_route_seq_stop,
	.show	= ipv6_route_seq_show
};

int ipv6_route_open(struct inode *inode, struct file *file)
{
	return seq_open_net(inode, file, &ipv6_route_seq_ops,
			    sizeof(struct ipv6_route_iter));
}

#endif /* CONFIG_PROC_FS */