[NETFILTER] xt_policy.c: kill some bloat
[deliverable/linux.git] / net / ipv4 / fib_trie.c
CommitLineData
19baf839
RO
1/*
2 * This program is free software; you can redistribute it and/or
3 * modify it under the terms of the GNU General Public License
4 * as published by the Free Software Foundation; either version
5 * 2 of the License, or (at your option) any later version.
6 *
7 * Robert Olsson <robert.olsson@its.uu.se> Uppsala Universitet
8 * & Swedish University of Agricultural Sciences.
9 *
e905a9ed 10 * Jens Laas <jens.laas@data.slu.se> Swedish University of
19baf839 11 * Agricultural Sciences.
e905a9ed 12 *
19baf839
RO
13 * Hans Liss <hans.liss@its.uu.se> Uppsala Universitet
14 *
15 * This work is based on the LPC-trie which is originally descibed in:
e905a9ed 16 *
19baf839
RO
17 * An experimental study of compression methods for dynamic tries
18 * Stefan Nilsson and Matti Tikkanen. Algorithmica, 33(1):19-33, 2002.
19 * http://www.nada.kth.se/~snilsson/public/papers/dyntrie2/
20 *
21 *
22 * IP-address lookup using LC-tries. Stefan Nilsson and Gunnar Karlsson
23 * IEEE Journal on Selected Areas in Communications, 17(6):1083-1092, June 1999
24 *
25 * Version: $Id: fib_trie.c,v 1.3 2005/06/08 14:20:01 robert Exp $
26 *
27 *
28 * Code from fib_hash has been reused which includes the following header:
29 *
30 *
31 * INET An implementation of the TCP/IP protocol suite for the LINUX
32 * operating system. INET is implemented using the BSD Socket
33 * interface as the means of communication with the user level.
34 *
35 * IPv4 FIB: lookup engine and maintenance routines.
36 *
37 *
38 * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
39 *
40 * This program is free software; you can redistribute it and/or
41 * modify it under the terms of the GNU General Public License
42 * as published by the Free Software Foundation; either version
43 * 2 of the License, or (at your option) any later version.
fd966255
RO
44 *
45 * Substantial contributions to this work comes from:
46 *
47 * David S. Miller, <davem@davemloft.net>
48 * Stephen Hemminger <shemminger@osdl.org>
49 * Paul E. McKenney <paulmck@us.ibm.com>
50 * Patrick McHardy <kaber@trash.net>
19baf839
RO
51 */
52
05eee48c 53#define VERSION "0.408"
19baf839 54
19baf839
RO
55#include <asm/uaccess.h>
56#include <asm/system.h>
1977f032 57#include <linux/bitops.h>
19baf839
RO
58#include <linux/types.h>
59#include <linux/kernel.h>
19baf839
RO
60#include <linux/mm.h>
61#include <linux/string.h>
62#include <linux/socket.h>
63#include <linux/sockios.h>
64#include <linux/errno.h>
65#include <linux/in.h>
66#include <linux/inet.h>
cd8787ab 67#include <linux/inetdevice.h>
19baf839
RO
68#include <linux/netdevice.h>
69#include <linux/if_arp.h>
70#include <linux/proc_fs.h>
2373ce1c 71#include <linux/rcupdate.h>
19baf839
RO
72#include <linux/skbuff.h>
73#include <linux/netlink.h>
74#include <linux/init.h>
75#include <linux/list.h>
457c4cbc 76#include <net/net_namespace.h>
19baf839
RO
77#include <net/ip.h>
78#include <net/protocol.h>
79#include <net/route.h>
80#include <net/tcp.h>
81#include <net/sock.h>
82#include <net/ip_fib.h>
83#include "fib_lookup.h"
84
06ef921d 85#define MAX_STAT_DEPTH 32
19baf839 86
19baf839 87#define KEYLENGTH (8*sizeof(t_key))
19baf839 88
19baf839
RO
89typedef unsigned int t_key;
90
91#define T_TNODE 0
92#define T_LEAF 1
93#define NODE_TYPE_MASK 0x1UL
2373ce1c
RO
94#define NODE_TYPE(node) ((node)->parent & NODE_TYPE_MASK)
95
91b9a277
OJ
96#define IS_TNODE(n) (!(n->parent & T_LEAF))
97#define IS_LEAF(n) (n->parent & T_LEAF)
19baf839
RO
98
99struct node {
91b9a277
OJ
100 t_key key;
101 unsigned long parent;
19baf839
RO
102};
103
104struct leaf {
91b9a277
OJ
105 t_key key;
106 unsigned long parent;
19baf839 107 struct hlist_head list;
2373ce1c 108 struct rcu_head rcu;
19baf839
RO
109};
110
111struct leaf_info {
112 struct hlist_node hlist;
2373ce1c 113 struct rcu_head rcu;
19baf839
RO
114 int plen;
115 struct list_head falh;
116};
117
118struct tnode {
91b9a277
OJ
119 t_key key;
120 unsigned long parent;
121 unsigned short pos:5; /* 2log(KEYLENGTH) bits needed */
122 unsigned short bits:5; /* 2log(KEYLENGTH) bits needed */
123 unsigned short full_children; /* KEYLENGTH bits needed */
124 unsigned short empty_children; /* KEYLENGTH bits needed */
2373ce1c 125 struct rcu_head rcu;
91b9a277 126 struct node *child[0];
19baf839
RO
127};
128
129#ifdef CONFIG_IP_FIB_TRIE_STATS
130struct trie_use_stats {
131 unsigned int gets;
132 unsigned int backtrack;
133 unsigned int semantic_match_passed;
134 unsigned int semantic_match_miss;
135 unsigned int null_node_hit;
2f36895a 136 unsigned int resize_node_skipped;
19baf839
RO
137};
138#endif
139
140struct trie_stat {
141 unsigned int totdepth;
142 unsigned int maxdepth;
143 unsigned int tnodes;
144 unsigned int leaves;
145 unsigned int nullpointers;
06ef921d 146 unsigned int nodesizes[MAX_STAT_DEPTH];
c877efb2 147};
19baf839
RO
148
149struct trie {
91b9a277 150 struct node *trie;
19baf839
RO
151#ifdef CONFIG_IP_FIB_TRIE_STATS
152 struct trie_use_stats stats;
153#endif
91b9a277 154 int size;
19baf839
RO
155};
156
19baf839
RO
157static void put_child(struct trie *t, struct tnode *tn, int i, struct node *n);
158static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n, int wasfull);
19baf839 159static struct node *resize(struct trie *t, struct tnode *tn);
2f80b3c8
RO
160static struct tnode *inflate(struct trie *t, struct tnode *tn);
161static struct tnode *halve(struct trie *t, struct tnode *tn);
19baf839 162static void tnode_free(struct tnode *tn);
19baf839 163
e18b890b 164static struct kmem_cache *fn_alias_kmem __read_mostly;
19baf839 165
06801916
SH
166static inline struct tnode *node_parent(struct node *node)
167{
168 struct tnode *ret;
169
170 ret = (struct tnode *)(node->parent & ~NODE_TYPE_MASK);
171 return rcu_dereference(ret);
172}
173
174static inline void node_set_parent(struct node *node, struct tnode *ptr)
175{
176 rcu_assign_pointer(node->parent,
177 (unsigned long)ptr | NODE_TYPE(node));
178}
2373ce1c
RO
179
180/* rcu_read_lock needs to be hold by caller from readside */
181
c877efb2 182static inline struct node *tnode_get_child(struct tnode *tn, int i)
19baf839 183{
91b9a277 184 BUG_ON(i >= 1 << tn->bits);
19baf839 185
2373ce1c 186 return rcu_dereference(tn->child[i]);
19baf839
RO
187}
188
bb435b8d 189static inline int tnode_child_length(const struct tnode *tn)
19baf839 190{
91b9a277 191 return 1 << tn->bits;
19baf839
RO
192}
193
ab66b4a7
SH
194static inline t_key mask_pfx(t_key k, unsigned short l)
195{
196 return (l == 0) ? 0 : k >> (KEYLENGTH-l) << (KEYLENGTH-l);
197}
198
19baf839
RO
199static inline t_key tkey_extract_bits(t_key a, int offset, int bits)
200{
91b9a277 201 if (offset < KEYLENGTH)
19baf839 202 return ((t_key)(a << offset)) >> (KEYLENGTH - bits);
91b9a277 203 else
19baf839
RO
204 return 0;
205}
206
207static inline int tkey_equals(t_key a, t_key b)
208{
c877efb2 209 return a == b;
19baf839
RO
210}
211
212static inline int tkey_sub_equals(t_key a, int offset, int bits, t_key b)
213{
c877efb2
SH
214 if (bits == 0 || offset >= KEYLENGTH)
215 return 1;
91b9a277
OJ
216 bits = bits > KEYLENGTH ? KEYLENGTH : bits;
217 return ((a ^ b) << offset) >> (KEYLENGTH - bits) == 0;
c877efb2 218}
19baf839
RO
219
220static inline int tkey_mismatch(t_key a, int offset, t_key b)
221{
222 t_key diff = a ^ b;
223 int i = offset;
224
c877efb2
SH
225 if (!diff)
226 return 0;
227 while ((diff << i) >> (KEYLENGTH-1) == 0)
19baf839
RO
228 i++;
229 return i;
230}
231
19baf839 232/*
e905a9ed
YH
233 To understand this stuff, an understanding of keys and all their bits is
234 necessary. Every node in the trie has a key associated with it, but not
19baf839
RO
235 all of the bits in that key are significant.
236
237 Consider a node 'n' and its parent 'tp'.
238
e905a9ed
YH
239 If n is a leaf, every bit in its key is significant. Its presence is
240 necessitated by path compression, since during a tree traversal (when
241 searching for a leaf - unless we are doing an insertion) we will completely
242 ignore all skipped bits we encounter. Thus we need to verify, at the end of
243 a potentially successful search, that we have indeed been walking the
19baf839
RO
244 correct key path.
245
e905a9ed
YH
246 Note that we can never "miss" the correct key in the tree if present by
247 following the wrong path. Path compression ensures that segments of the key
248 that are the same for all keys with a given prefix are skipped, but the
249 skipped part *is* identical for each node in the subtrie below the skipped
250 bit! trie_insert() in this implementation takes care of that - note the
19baf839
RO
251 call to tkey_sub_equals() in trie_insert().
252
e905a9ed 253 if n is an internal node - a 'tnode' here, the various parts of its key
19baf839
RO
254 have many different meanings.
255
e905a9ed 256 Example:
19baf839
RO
257 _________________________________________________________________
258 | i | i | i | i | i | i | i | N | N | N | S | S | S | S | S | C |
259 -----------------------------------------------------------------
e905a9ed 260 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
19baf839
RO
261
262 _________________________________________________________________
263 | C | C | C | u | u | u | u | u | u | u | u | u | u | u | u | u |
264 -----------------------------------------------------------------
265 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31
266
267 tp->pos = 7
268 tp->bits = 3
269 n->pos = 15
91b9a277 270 n->bits = 4
19baf839 271
e905a9ed
YH
272 First, let's just ignore the bits that come before the parent tp, that is
273 the bits from 0 to (tp->pos-1). They are *known* but at this point we do
19baf839
RO
274 not use them for anything.
275
276 The bits from (tp->pos) to (tp->pos + tp->bits - 1) - "N", above - are the
e905a9ed 277 index into the parent's child array. That is, they will be used to find
19baf839
RO
278 'n' among tp's children.
279
280 The bits from (tp->pos + tp->bits) to (n->pos - 1) - "S" - are skipped bits
281 for the node n.
282
e905a9ed 283 All the bits we have seen so far are significant to the node n. The rest
19baf839
RO
284 of the bits are really not needed or indeed known in n->key.
285
e905a9ed 286 The bits from (n->pos) to (n->pos + n->bits - 1) - "C" - are the index into
19baf839 287 n's child array, and will of course be different for each child.
e905a9ed 288
c877efb2 289
19baf839
RO
290 The rest of the bits, from (n->pos + n->bits) onward, are completely unknown
291 at this point.
292
293*/
294
0c7770c7 295static inline void check_tnode(const struct tnode *tn)
19baf839 296{
0c7770c7 297 WARN_ON(tn && tn->pos+tn->bits > 32);
19baf839
RO
298}
299
f5026fab
DL
300static const int halve_threshold = 25;
301static const int inflate_threshold = 50;
302static const int halve_threshold_root = 8;
303static const int inflate_threshold_root = 15;
19baf839 304
2373ce1c
RO
305
306static void __alias_free_mem(struct rcu_head *head)
19baf839 307{
2373ce1c
RO
308 struct fib_alias *fa = container_of(head, struct fib_alias, rcu);
309 kmem_cache_free(fn_alias_kmem, fa);
19baf839
RO
310}
311
2373ce1c 312static inline void alias_free_mem_rcu(struct fib_alias *fa)
19baf839 313{
2373ce1c
RO
314 call_rcu(&fa->rcu, __alias_free_mem);
315}
91b9a277 316
2373ce1c
RO
317static void __leaf_free_rcu(struct rcu_head *head)
318{
319 kfree(container_of(head, struct leaf, rcu));
320}
91b9a277 321
2373ce1c 322static void __leaf_info_free_rcu(struct rcu_head *head)
19baf839 323{
2373ce1c 324 kfree(container_of(head, struct leaf_info, rcu));
19baf839
RO
325}
326
2373ce1c 327static inline void free_leaf_info(struct leaf_info *leaf)
19baf839 328{
2373ce1c 329 call_rcu(&leaf->rcu, __leaf_info_free_rcu);
19baf839
RO
330}
331
f0e36f8c
PM
332static struct tnode *tnode_alloc(unsigned int size)
333{
2373ce1c
RO
334 struct page *pages;
335
336 if (size <= PAGE_SIZE)
337 return kcalloc(size, 1, GFP_KERNEL);
338
339 pages = alloc_pages(GFP_KERNEL|__GFP_ZERO, get_order(size));
340 if (!pages)
341 return NULL;
342
343 return page_address(pages);
f0e36f8c
PM
344}
345
2373ce1c 346static void __tnode_free_rcu(struct rcu_head *head)
f0e36f8c 347{
2373ce1c 348 struct tnode *tn = container_of(head, struct tnode, rcu);
f0e36f8c 349 unsigned int size = sizeof(struct tnode) +
2373ce1c 350 (1 << tn->bits) * sizeof(struct node *);
f0e36f8c
PM
351
352 if (size <= PAGE_SIZE)
353 kfree(tn);
354 else
355 free_pages((unsigned long)tn, get_order(size));
356}
357
2373ce1c
RO
358static inline void tnode_free(struct tnode *tn)
359{
132adf54 360 if (IS_LEAF(tn)) {
550e29bc
RO
361 struct leaf *l = (struct leaf *) tn;
362 call_rcu_bh(&l->rcu, __leaf_free_rcu);
132adf54 363 } else
550e29bc 364 call_rcu(&tn->rcu, __tnode_free_rcu);
2373ce1c
RO
365}
366
367static struct leaf *leaf_new(void)
368{
369 struct leaf *l = kmalloc(sizeof(struct leaf), GFP_KERNEL);
370 if (l) {
371 l->parent = T_LEAF;
372 INIT_HLIST_HEAD(&l->list);
373 }
374 return l;
375}
376
377static struct leaf_info *leaf_info_new(int plen)
378{
379 struct leaf_info *li = kmalloc(sizeof(struct leaf_info), GFP_KERNEL);
380 if (li) {
381 li->plen = plen;
382 INIT_LIST_HEAD(&li->falh);
383 }
384 return li;
385}
386
19baf839
RO
387static struct tnode* tnode_new(t_key key, int pos, int bits)
388{
389 int nchildren = 1<<bits;
390 int sz = sizeof(struct tnode) + nchildren * sizeof(struct node *);
f0e36f8c 391 struct tnode *tn = tnode_alloc(sz);
19baf839 392
91b9a277 393 if (tn) {
19baf839 394 memset(tn, 0, sz);
2373ce1c 395 tn->parent = T_TNODE;
19baf839
RO
396 tn->pos = pos;
397 tn->bits = bits;
398 tn->key = key;
399 tn->full_children = 0;
400 tn->empty_children = 1<<bits;
401 }
c877efb2 402
0c7770c7
SH
403 pr_debug("AT %p s=%u %u\n", tn, (unsigned int) sizeof(struct tnode),
404 (unsigned int) (sizeof(struct node) * 1<<bits));
19baf839
RO
405 return tn;
406}
407
19baf839
RO
408/*
409 * Check whether a tnode 'n' is "full", i.e. it is an internal node
410 * and no bits are skipped. See discussion in dyntree paper p. 6
411 */
412
bb435b8d 413static inline int tnode_full(const struct tnode *tn, const struct node *n)
19baf839 414{
c877efb2 415 if (n == NULL || IS_LEAF(n))
19baf839
RO
416 return 0;
417
418 return ((struct tnode *) n)->pos == tn->pos + tn->bits;
419}
420
c877efb2 421static inline void put_child(struct trie *t, struct tnode *tn, int i, struct node *n)
19baf839
RO
422{
423 tnode_put_child_reorg(tn, i, n, -1);
424}
425
c877efb2 426 /*
19baf839
RO
427 * Add a child at position i overwriting the old value.
428 * Update the value of full_children and empty_children.
429 */
430
c877efb2 431static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n, int wasfull)
19baf839 432{
2373ce1c 433 struct node *chi = tn->child[i];
19baf839
RO
434 int isfull;
435
0c7770c7
SH
436 BUG_ON(i >= 1<<tn->bits);
437
19baf839
RO
438
439 /* update emptyChildren */
440 if (n == NULL && chi != NULL)
441 tn->empty_children++;
442 else if (n != NULL && chi == NULL)
443 tn->empty_children--;
c877efb2 444
19baf839 445 /* update fullChildren */
91b9a277 446 if (wasfull == -1)
19baf839
RO
447 wasfull = tnode_full(tn, chi);
448
449 isfull = tnode_full(tn, n);
c877efb2 450 if (wasfull && !isfull)
19baf839 451 tn->full_children--;
c877efb2 452 else if (!wasfull && isfull)
19baf839 453 tn->full_children++;
91b9a277 454
c877efb2 455 if (n)
06801916 456 node_set_parent(n, tn);
19baf839 457
2373ce1c 458 rcu_assign_pointer(tn->child[i], n);
19baf839
RO
459}
460
c877efb2 461static struct node *resize(struct trie *t, struct tnode *tn)
19baf839
RO
462{
463 int i;
2f36895a 464 int err = 0;
2f80b3c8 465 struct tnode *old_tn;
e6308be8
RO
466 int inflate_threshold_use;
467 int halve_threshold_use;
05eee48c 468 int max_resize;
19baf839 469
e905a9ed 470 if (!tn)
19baf839
RO
471 return NULL;
472
0c7770c7
SH
473 pr_debug("In tnode_resize %p inflate_threshold=%d threshold=%d\n",
474 tn, inflate_threshold, halve_threshold);
19baf839
RO
475
476 /* No children */
477 if (tn->empty_children == tnode_child_length(tn)) {
478 tnode_free(tn);
479 return NULL;
480 }
481 /* One child */
482 if (tn->empty_children == tnode_child_length(tn) - 1)
483 for (i = 0; i < tnode_child_length(tn); i++) {
91b9a277 484 struct node *n;
19baf839 485
91b9a277 486 n = tn->child[i];
2373ce1c 487 if (!n)
91b9a277 488 continue;
91b9a277
OJ
489
490 /* compress one level */
06801916 491 node_set_parent(n, NULL);
91b9a277
OJ
492 tnode_free(tn);
493 return n;
19baf839 494 }
c877efb2 495 /*
19baf839
RO
496 * Double as long as the resulting node has a number of
497 * nonempty nodes that are above the threshold.
498 */
499
500 /*
c877efb2
SH
501 * From "Implementing a dynamic compressed trie" by Stefan Nilsson of
502 * the Helsinki University of Technology and Matti Tikkanen of Nokia
19baf839 503 * Telecommunications, page 6:
c877efb2 504 * "A node is doubled if the ratio of non-empty children to all
19baf839
RO
505 * children in the *doubled* node is at least 'high'."
506 *
c877efb2
SH
507 * 'high' in this instance is the variable 'inflate_threshold'. It
508 * is expressed as a percentage, so we multiply it with
509 * tnode_child_length() and instead of multiplying by 2 (since the
510 * child array will be doubled by inflate()) and multiplying
511 * the left-hand side by 100 (to handle the percentage thing) we
19baf839 512 * multiply the left-hand side by 50.
c877efb2
SH
513 *
514 * The left-hand side may look a bit weird: tnode_child_length(tn)
515 * - tn->empty_children is of course the number of non-null children
516 * in the current node. tn->full_children is the number of "full"
19baf839 517 * children, that is non-null tnodes with a skip value of 0.
c877efb2 518 * All of those will be doubled in the resulting inflated tnode, so
19baf839 519 * we just count them one extra time here.
c877efb2 520 *
19baf839 521 * A clearer way to write this would be:
c877efb2 522 *
19baf839 523 * to_be_doubled = tn->full_children;
c877efb2 524 * not_to_be_doubled = tnode_child_length(tn) - tn->empty_children -
19baf839
RO
525 * tn->full_children;
526 *
527 * new_child_length = tnode_child_length(tn) * 2;
528 *
c877efb2 529 * new_fill_factor = 100 * (not_to_be_doubled + 2*to_be_doubled) /
19baf839
RO
530 * new_child_length;
531 * if (new_fill_factor >= inflate_threshold)
c877efb2
SH
532 *
533 * ...and so on, tho it would mess up the while () loop.
534 *
19baf839
RO
535 * anyway,
536 * 100 * (not_to_be_doubled + 2*to_be_doubled) / new_child_length >=
537 * inflate_threshold
c877efb2 538 *
19baf839
RO
539 * avoid a division:
540 * 100 * (not_to_be_doubled + 2*to_be_doubled) >=
541 * inflate_threshold * new_child_length
c877efb2 542 *
19baf839 543 * expand not_to_be_doubled and to_be_doubled, and shorten:
c877efb2 544 * 100 * (tnode_child_length(tn) - tn->empty_children +
91b9a277 545 * tn->full_children) >= inflate_threshold * new_child_length
c877efb2 546 *
19baf839 547 * expand new_child_length:
c877efb2 548 * 100 * (tnode_child_length(tn) - tn->empty_children +
91b9a277 549 * tn->full_children) >=
19baf839 550 * inflate_threshold * tnode_child_length(tn) * 2
c877efb2 551 *
19baf839 552 * shorten again:
c877efb2 553 * 50 * (tn->full_children + tnode_child_length(tn) -
91b9a277 554 * tn->empty_children) >= inflate_threshold *
19baf839 555 * tnode_child_length(tn)
c877efb2 556 *
19baf839
RO
557 */
558
559 check_tnode(tn);
c877efb2 560
e6308be8
RO
561 /* Keep root node larger */
562
132adf54 563 if (!tn->parent)
e6308be8 564 inflate_threshold_use = inflate_threshold_root;
e905a9ed 565 else
e6308be8
RO
566 inflate_threshold_use = inflate_threshold;
567
2f36895a 568 err = 0;
05eee48c
RO
569 max_resize = 10;
570 while ((tn->full_children > 0 && max_resize-- &&
19baf839 571 50 * (tn->full_children + tnode_child_length(tn) - tn->empty_children) >=
e6308be8 572 inflate_threshold_use * tnode_child_length(tn))) {
19baf839 573
2f80b3c8
RO
574 old_tn = tn;
575 tn = inflate(t, tn);
576 if (IS_ERR(tn)) {
577 tn = old_tn;
2f36895a
RO
578#ifdef CONFIG_IP_FIB_TRIE_STATS
579 t->stats.resize_node_skipped++;
580#endif
581 break;
582 }
19baf839
RO
583 }
584
05eee48c
RO
585 if (max_resize < 0) {
586 if (!tn->parent)
587 printk(KERN_WARNING "Fix inflate_threshold_root. Now=%d size=%d bits\n",
588 inflate_threshold_root, tn->bits);
589 else
590 printk(KERN_WARNING "Fix inflate_threshold. Now=%d size=%d bits\n",
591 inflate_threshold, tn->bits);
592 }
593
19baf839
RO
594 check_tnode(tn);
595
596 /*
597 * Halve as long as the number of empty children in this
598 * node is above threshold.
599 */
2f36895a 600
e6308be8
RO
601
602 /* Keep root node larger */
603
132adf54 604 if (!tn->parent)
e6308be8 605 halve_threshold_use = halve_threshold_root;
e905a9ed 606 else
e6308be8
RO
607 halve_threshold_use = halve_threshold;
608
2f36895a 609 err = 0;
05eee48c
RO
610 max_resize = 10;
611 while (tn->bits > 1 && max_resize-- &&
19baf839 612 100 * (tnode_child_length(tn) - tn->empty_children) <
e6308be8 613 halve_threshold_use * tnode_child_length(tn)) {
2f36895a 614
2f80b3c8
RO
615 old_tn = tn;
616 tn = halve(t, tn);
617 if (IS_ERR(tn)) {
618 tn = old_tn;
2f36895a
RO
619#ifdef CONFIG_IP_FIB_TRIE_STATS
620 t->stats.resize_node_skipped++;
621#endif
622 break;
623 }
624 }
19baf839 625
05eee48c
RO
626 if (max_resize < 0) {
627 if (!tn->parent)
628 printk(KERN_WARNING "Fix halve_threshold_root. Now=%d size=%d bits\n",
629 halve_threshold_root, tn->bits);
630 else
631 printk(KERN_WARNING "Fix halve_threshold. Now=%d size=%d bits\n",
632 halve_threshold, tn->bits);
633 }
c877efb2 634
19baf839 635 /* Only one child remains */
19baf839
RO
636 if (tn->empty_children == tnode_child_length(tn) - 1)
637 for (i = 0; i < tnode_child_length(tn); i++) {
91b9a277 638 struct node *n;
19baf839 639
91b9a277 640 n = tn->child[i];
2373ce1c 641 if (!n)
91b9a277 642 continue;
91b9a277
OJ
643
644 /* compress one level */
645
06801916 646 node_set_parent(n, NULL);
91b9a277
OJ
647 tnode_free(tn);
648 return n;
19baf839
RO
649 }
650
651 return (struct node *) tn;
652}
653
2f80b3c8 654static struct tnode *inflate(struct trie *t, struct tnode *tn)
19baf839 655{
19baf839
RO
656 struct tnode *oldtnode = tn;
657 int olen = tnode_child_length(tn);
658 int i;
659
0c7770c7 660 pr_debug("In inflate\n");
19baf839
RO
661
662 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits + 1);
663
0c7770c7 664 if (!tn)
2f80b3c8 665 return ERR_PTR(-ENOMEM);
2f36895a
RO
666
667 /*
c877efb2
SH
668 * Preallocate and store tnodes before the actual work so we
669 * don't get into an inconsistent state if memory allocation
670 * fails. In case of failure we return the oldnode and inflate
2f36895a
RO
671 * of tnode is ignored.
672 */
91b9a277
OJ
673
674 for (i = 0; i < olen; i++) {
2f36895a
RO
675 struct tnode *inode = (struct tnode *) tnode_get_child(oldtnode, i);
676
677 if (inode &&
678 IS_TNODE(inode) &&
679 inode->pos == oldtnode->pos + oldtnode->bits &&
680 inode->bits > 1) {
681 struct tnode *left, *right;
ab66b4a7 682 t_key m = ~0U << (KEYLENGTH - 1) >> inode->pos;
c877efb2 683
2f36895a
RO
684 left = tnode_new(inode->key&(~m), inode->pos + 1,
685 inode->bits - 1);
2f80b3c8
RO
686 if (!left)
687 goto nomem;
91b9a277 688
2f36895a
RO
689 right = tnode_new(inode->key|m, inode->pos + 1,
690 inode->bits - 1);
691
e905a9ed 692 if (!right) {
2f80b3c8
RO
693 tnode_free(left);
694 goto nomem;
e905a9ed 695 }
2f36895a
RO
696
697 put_child(t, tn, 2*i, (struct node *) left);
698 put_child(t, tn, 2*i+1, (struct node *) right);
699 }
700 }
701
91b9a277 702 for (i = 0; i < olen; i++) {
c95aaf9a 703 struct tnode *inode;
19baf839 704 struct node *node = tnode_get_child(oldtnode, i);
91b9a277
OJ
705 struct tnode *left, *right;
706 int size, j;
c877efb2 707
19baf839
RO
708 /* An empty child */
709 if (node == NULL)
710 continue;
711
712 /* A leaf or an internal node with skipped bits */
713
c877efb2 714 if (IS_LEAF(node) || ((struct tnode *) node)->pos >
19baf839 715 tn->pos + tn->bits - 1) {
c877efb2 716 if (tkey_extract_bits(node->key, oldtnode->pos + oldtnode->bits,
19baf839
RO
717 1) == 0)
718 put_child(t, tn, 2*i, node);
719 else
720 put_child(t, tn, 2*i+1, node);
721 continue;
722 }
723
724 /* An internal node with two children */
725 inode = (struct tnode *) node;
726
727 if (inode->bits == 1) {
728 put_child(t, tn, 2*i, inode->child[0]);
729 put_child(t, tn, 2*i+1, inode->child[1]);
730
731 tnode_free(inode);
91b9a277 732 continue;
19baf839
RO
733 }
734
91b9a277
OJ
735 /* An internal node with more than two children */
736
737 /* We will replace this node 'inode' with two new
738 * ones, 'left' and 'right', each with half of the
739 * original children. The two new nodes will have
740 * a position one bit further down the key and this
741 * means that the "significant" part of their keys
742 * (see the discussion near the top of this file)
743 * will differ by one bit, which will be "0" in
744 * left's key and "1" in right's key. Since we are
745 * moving the key position by one step, the bit that
746 * we are moving away from - the bit at position
747 * (inode->pos) - is the one that will differ between
748 * left and right. So... we synthesize that bit in the
749 * two new keys.
750 * The mask 'm' below will be a single "one" bit at
751 * the position (inode->pos)
752 */
19baf839 753
91b9a277
OJ
754 /* Use the old key, but set the new significant
755 * bit to zero.
756 */
2f36895a 757
91b9a277
OJ
758 left = (struct tnode *) tnode_get_child(tn, 2*i);
759 put_child(t, tn, 2*i, NULL);
2f36895a 760
91b9a277 761 BUG_ON(!left);
2f36895a 762
91b9a277
OJ
763 right = (struct tnode *) tnode_get_child(tn, 2*i+1);
764 put_child(t, tn, 2*i+1, NULL);
19baf839 765
91b9a277 766 BUG_ON(!right);
19baf839 767
91b9a277
OJ
768 size = tnode_child_length(left);
769 for (j = 0; j < size; j++) {
770 put_child(t, left, j, inode->child[j]);
771 put_child(t, right, j, inode->child[j + size]);
19baf839 772 }
91b9a277
OJ
773 put_child(t, tn, 2*i, resize(t, left));
774 put_child(t, tn, 2*i+1, resize(t, right));
775
776 tnode_free(inode);
19baf839
RO
777 }
778 tnode_free(oldtnode);
779 return tn;
2f80b3c8
RO
780nomem:
781 {
782 int size = tnode_child_length(tn);
783 int j;
784
0c7770c7 785 for (j = 0; j < size; j++)
2f80b3c8
RO
786 if (tn->child[j])
787 tnode_free((struct tnode *)tn->child[j]);
788
789 tnode_free(tn);
0c7770c7 790
2f80b3c8
RO
791 return ERR_PTR(-ENOMEM);
792 }
19baf839
RO
793}
794
2f80b3c8 795static struct tnode *halve(struct trie *t, struct tnode *tn)
19baf839
RO
796{
797 struct tnode *oldtnode = tn;
798 struct node *left, *right;
799 int i;
800 int olen = tnode_child_length(tn);
801
0c7770c7 802 pr_debug("In halve\n");
c877efb2
SH
803
804 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits - 1);
19baf839 805
2f80b3c8
RO
806 if (!tn)
807 return ERR_PTR(-ENOMEM);
2f36895a
RO
808
809 /*
c877efb2
SH
810 * Preallocate and store tnodes before the actual work so we
811 * don't get into an inconsistent state if memory allocation
812 * fails. In case of failure we return the oldnode and halve
2f36895a
RO
813 * of tnode is ignored.
814 */
815
91b9a277 816 for (i = 0; i < olen; i += 2) {
2f36895a
RO
817 left = tnode_get_child(oldtnode, i);
818 right = tnode_get_child(oldtnode, i+1);
c877efb2 819
2f36895a 820 /* Two nonempty children */
0c7770c7 821 if (left && right) {
2f80b3c8 822 struct tnode *newn;
0c7770c7 823
2f80b3c8 824 newn = tnode_new(left->key, tn->pos + tn->bits, 1);
0c7770c7
SH
825
826 if (!newn)
2f80b3c8 827 goto nomem;
0c7770c7 828
2f80b3c8 829 put_child(t, tn, i/2, (struct node *)newn);
2f36895a 830 }
2f36895a 831
2f36895a 832 }
19baf839 833
91b9a277
OJ
834 for (i = 0; i < olen; i += 2) {
835 struct tnode *newBinNode;
836
19baf839
RO
837 left = tnode_get_child(oldtnode, i);
838 right = tnode_get_child(oldtnode, i+1);
c877efb2 839
19baf839
RO
840 /* At least one of the children is empty */
841 if (left == NULL) {
842 if (right == NULL) /* Both are empty */
843 continue;
844 put_child(t, tn, i/2, right);
91b9a277 845 continue;
0c7770c7 846 }
91b9a277
OJ
847
848 if (right == NULL) {
19baf839 849 put_child(t, tn, i/2, left);
91b9a277
OJ
850 continue;
851 }
c877efb2 852
19baf839 853 /* Two nonempty children */
91b9a277
OJ
854 newBinNode = (struct tnode *) tnode_get_child(tn, i/2);
855 put_child(t, tn, i/2, NULL);
91b9a277
OJ
856 put_child(t, newBinNode, 0, left);
857 put_child(t, newBinNode, 1, right);
858 put_child(t, tn, i/2, resize(t, newBinNode));
19baf839
RO
859 }
860 tnode_free(oldtnode);
861 return tn;
2f80b3c8
RO
862nomem:
863 {
864 int size = tnode_child_length(tn);
865 int j;
866
0c7770c7 867 for (j = 0; j < size; j++)
2f80b3c8
RO
868 if (tn->child[j])
869 tnode_free((struct tnode *)tn->child[j]);
870
871 tnode_free(tn);
0c7770c7 872
2f80b3c8
RO
873 return ERR_PTR(-ENOMEM);
874 }
19baf839
RO
875}
876
772cb712 877/* readside must use rcu_read_lock currently dump routines
2373ce1c
RO
878 via get_fa_head and dump */
879
772cb712 880static struct leaf_info *find_leaf_info(struct leaf *l, int plen)
19baf839 881{
772cb712 882 struct hlist_head *head = &l->list;
19baf839
RO
883 struct hlist_node *node;
884 struct leaf_info *li;
885
2373ce1c 886 hlist_for_each_entry_rcu(li, node, head, hlist)
c877efb2 887 if (li->plen == plen)
19baf839 888 return li;
91b9a277 889
19baf839
RO
890 return NULL;
891}
892
893static inline struct list_head * get_fa_head(struct leaf *l, int plen)
894{
772cb712 895 struct leaf_info *li = find_leaf_info(l, plen);
c877efb2 896
91b9a277
OJ
897 if (!li)
898 return NULL;
c877efb2 899
91b9a277 900 return &li->falh;
19baf839
RO
901}
902
903static void insert_leaf_info(struct hlist_head *head, struct leaf_info *new)
904{
e905a9ed
YH
905 struct leaf_info *li = NULL, *last = NULL;
906 struct hlist_node *node;
907
908 if (hlist_empty(head)) {
909 hlist_add_head_rcu(&new->hlist, head);
910 } else {
911 hlist_for_each_entry(li, node, head, hlist) {
912 if (new->plen > li->plen)
913 break;
914
915 last = li;
916 }
917 if (last)
918 hlist_add_after_rcu(&last->hlist, &new->hlist);
919 else
920 hlist_add_before_rcu(&new->hlist, &li->hlist);
921 }
19baf839
RO
922}
923
2373ce1c
RO
924/* rcu_read_lock needs to be hold by caller from readside */
925
19baf839
RO
926static struct leaf *
927fib_find_node(struct trie *t, u32 key)
928{
929 int pos;
930 struct tnode *tn;
931 struct node *n;
932
933 pos = 0;
2373ce1c 934 n = rcu_dereference(t->trie);
19baf839
RO
935
936 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
937 tn = (struct tnode *) n;
91b9a277 938
19baf839 939 check_tnode(tn);
91b9a277 940
c877efb2 941 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
91b9a277 942 pos = tn->pos + tn->bits;
19baf839 943 n = tnode_get_child(tn, tkey_extract_bits(key, tn->pos, tn->bits));
91b9a277 944 } else
19baf839
RO
945 break;
946 }
947 /* Case we have found a leaf. Compare prefixes */
948
91b9a277
OJ
949 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key))
950 return (struct leaf *)n;
951
19baf839
RO
952 return NULL;
953}
954
955static struct node *trie_rebalance(struct trie *t, struct tnode *tn)
956{
19baf839 957 int wasfull;
06801916
SH
958 t_key cindex, key = tn->key;
959 struct tnode *tp;
19baf839 960
06801916 961 while (tn != NULL && (tp = node_parent((struct node *)tn)) != NULL) {
19baf839
RO
962 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
963 wasfull = tnode_full(tp, tnode_get_child(tp, cindex));
964 tn = (struct tnode *) resize (t, (struct tnode *)tn);
965 tnode_put_child_reorg((struct tnode *)tp, cindex,(struct node*)tn, wasfull);
91b9a277 966
06801916
SH
967 tp = node_parent((struct node *) tn);
968 if (!tp)
19baf839 969 break;
06801916 970 tn = tp;
19baf839 971 }
06801916 972
19baf839 973 /* Handle last (top) tnode */
c877efb2 974 if (IS_TNODE(tn))
19baf839
RO
975 tn = (struct tnode*) resize(t, (struct tnode *)tn);
976
977 return (struct node*) tn;
978}
979
2373ce1c
RO
980/* only used from updater-side */
981
fea86ad8 982static struct list_head *fib_insert_node(struct trie *t, u32 key, int plen)
19baf839
RO
983{
984 int pos, newpos;
985 struct tnode *tp = NULL, *tn = NULL;
986 struct node *n;
987 struct leaf *l;
988 int missbit;
c877efb2 989 struct list_head *fa_head = NULL;
19baf839
RO
990 struct leaf_info *li;
991 t_key cindex;
992
993 pos = 0;
c877efb2 994 n = t->trie;
19baf839 995
c877efb2
SH
996 /* If we point to NULL, stop. Either the tree is empty and we should
997 * just put a new leaf in if, or we have reached an empty child slot,
19baf839 998 * and we should just put our new leaf in that.
c877efb2
SH
999 * If we point to a T_TNODE, check if it matches our key. Note that
1000 * a T_TNODE might be skipping any number of bits - its 'pos' need
19baf839
RO
1001 * not be the parent's 'pos'+'bits'!
1002 *
c877efb2 1003 * If it does match the current key, get pos/bits from it, extract
19baf839
RO
1004 * the index from our key, push the T_TNODE and walk the tree.
1005 *
1006 * If it doesn't, we have to replace it with a new T_TNODE.
1007 *
c877efb2
SH
1008 * If we point to a T_LEAF, it might or might not have the same key
1009 * as we do. If it does, just change the value, update the T_LEAF's
1010 * value, and return it.
19baf839
RO
1011 * If it doesn't, we need to replace it with a T_TNODE.
1012 */
1013
1014 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
1015 tn = (struct tnode *) n;
91b9a277 1016
c877efb2 1017 check_tnode(tn);
91b9a277 1018
c877efb2 1019 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
19baf839 1020 tp = tn;
91b9a277 1021 pos = tn->pos + tn->bits;
19baf839
RO
1022 n = tnode_get_child(tn, tkey_extract_bits(key, tn->pos, tn->bits));
1023
06801916 1024 BUG_ON(n && node_parent(n) != tn);
91b9a277 1025 } else
19baf839
RO
1026 break;
1027 }
1028
1029 /*
1030 * n ----> NULL, LEAF or TNODE
1031 *
c877efb2 1032 * tp is n's (parent) ----> NULL or TNODE
19baf839
RO
1033 */
1034
91b9a277 1035 BUG_ON(tp && IS_LEAF(tp));
19baf839
RO
1036
1037 /* Case 1: n is a leaf. Compare prefixes */
1038
c877efb2 1039 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key)) {
c95aaf9a 1040 l = (struct leaf *) n;
19baf839 1041 li = leaf_info_new(plen);
91b9a277 1042
fea86ad8
SH
1043 if (!li)
1044 return NULL;
19baf839
RO
1045
1046 fa_head = &li->falh;
1047 insert_leaf_info(&l->list, li);
1048 goto done;
1049 }
1050 t->size++;
1051 l = leaf_new();
1052
fea86ad8
SH
1053 if (!l)
1054 return NULL;
19baf839
RO
1055
1056 l->key = key;
1057 li = leaf_info_new(plen);
1058
c877efb2 1059 if (!li) {
f835e471 1060 tnode_free((struct tnode *) l);
fea86ad8 1061 return NULL;
f835e471 1062 }
19baf839
RO
1063
1064 fa_head = &li->falh;
1065 insert_leaf_info(&l->list, li);
1066
19baf839 1067 if (t->trie && n == NULL) {
91b9a277 1068 /* Case 2: n is NULL, and will just insert a new leaf */
19baf839 1069
06801916 1070 node_set_parent((struct node *)l, tp);
19baf839 1071
91b9a277
OJ
1072 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1073 put_child(t, (struct tnode *)tp, cindex, (struct node *)l);
1074 } else {
1075 /* Case 3: n is a LEAF or a TNODE and the key doesn't match. */
c877efb2
SH
1076 /*
1077 * Add a new tnode here
19baf839
RO
1078 * first tnode need some special handling
1079 */
1080
1081 if (tp)
91b9a277 1082 pos = tp->pos+tp->bits;
19baf839 1083 else
91b9a277
OJ
1084 pos = 0;
1085
c877efb2 1086 if (n) {
19baf839
RO
1087 newpos = tkey_mismatch(key, pos, n->key);
1088 tn = tnode_new(n->key, newpos, 1);
91b9a277 1089 } else {
19baf839 1090 newpos = 0;
c877efb2 1091 tn = tnode_new(key, newpos, 1); /* First tnode */
19baf839 1092 }
19baf839 1093
c877efb2 1094 if (!tn) {
f835e471
RO
1095 free_leaf_info(li);
1096 tnode_free((struct tnode *) l);
fea86ad8 1097 return NULL;
91b9a277
OJ
1098 }
1099
06801916 1100 node_set_parent((struct node *)tn, tp);
19baf839 1101
91b9a277 1102 missbit = tkey_extract_bits(key, newpos, 1);
19baf839
RO
1103 put_child(t, tn, missbit, (struct node *)l);
1104 put_child(t, tn, 1-missbit, n);
1105
c877efb2 1106 if (tp) {
19baf839
RO
1107 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1108 put_child(t, (struct tnode *)tp, cindex, (struct node *)tn);
91b9a277 1109 } else {
2373ce1c 1110 rcu_assign_pointer(t->trie, (struct node *)tn); /* First tnode */
19baf839
RO
1111 tp = tn;
1112 }
1113 }
91b9a277
OJ
1114
1115 if (tp && tp->pos + tp->bits > 32)
78c6671a 1116 printk(KERN_WARNING "fib_trie tp=%p pos=%d, bits=%d, key=%0x plen=%d\n",
19baf839 1117 tp, tp->pos, tp->bits, key, plen);
91b9a277 1118
19baf839 1119 /* Rebalance the trie */
2373ce1c
RO
1120
1121 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
f835e471 1122done:
19baf839
RO
1123 return fa_head;
1124}
1125
d562f1f8
RO
1126/*
1127 * Caller must hold RTNL.
1128 */
4e902c57 1129static int fn_trie_insert(struct fib_table *tb, struct fib_config *cfg)
19baf839
RO
1130{
1131 struct trie *t = (struct trie *) tb->tb_data;
1132 struct fib_alias *fa, *new_fa;
c877efb2 1133 struct list_head *fa_head = NULL;
19baf839 1134 struct fib_info *fi;
4e902c57
TG
1135 int plen = cfg->fc_dst_len;
1136 u8 tos = cfg->fc_tos;
19baf839
RO
1137 u32 key, mask;
1138 int err;
1139 struct leaf *l;
1140
1141 if (plen > 32)
1142 return -EINVAL;
1143
4e902c57 1144 key = ntohl(cfg->fc_dst);
19baf839 1145
2dfe55b4 1146 pr_debug("Insert table=%u %08x/%d\n", tb->tb_id, key, plen);
19baf839 1147
91b9a277 1148 mask = ntohl(inet_make_mask(plen));
19baf839 1149
c877efb2 1150 if (key & ~mask)
19baf839
RO
1151 return -EINVAL;
1152
1153 key = key & mask;
1154
4e902c57
TG
1155 fi = fib_create_info(cfg);
1156 if (IS_ERR(fi)) {
1157 err = PTR_ERR(fi);
19baf839 1158 goto err;
4e902c57 1159 }
19baf839
RO
1160
1161 l = fib_find_node(t, key);
c877efb2 1162 fa = NULL;
19baf839 1163
c877efb2 1164 if (l) {
19baf839
RO
1165 fa_head = get_fa_head(l, plen);
1166 fa = fib_find_alias(fa_head, tos, fi->fib_priority);
1167 }
1168
1169 /* Now fa, if non-NULL, points to the first fib alias
1170 * with the same keys [prefix,tos,priority], if such key already
1171 * exists or to the node before which we will insert new one.
1172 *
1173 * If fa is NULL, we will need to allocate a new one and
1174 * insert to the head of f.
1175 *
1176 * If f is NULL, no fib node matched the destination key
1177 * and we need to allocate a new one of those as well.
1178 */
1179
91b9a277 1180 if (fa && fa->fa_info->fib_priority == fi->fib_priority) {
19baf839
RO
1181 struct fib_alias *fa_orig;
1182
1183 err = -EEXIST;
4e902c57 1184 if (cfg->fc_nlflags & NLM_F_EXCL)
19baf839
RO
1185 goto out;
1186
4e902c57 1187 if (cfg->fc_nlflags & NLM_F_REPLACE) {
19baf839
RO
1188 struct fib_info *fi_drop;
1189 u8 state;
1190
6725033f
JP
1191 if (fi->fib_treeref > 1)
1192 goto out;
1193
2373ce1c 1194 err = -ENOBUFS;
e94b1766 1195 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
2373ce1c
RO
1196 if (new_fa == NULL)
1197 goto out;
19baf839
RO
1198
1199 fi_drop = fa->fa_info;
2373ce1c
RO
1200 new_fa->fa_tos = fa->fa_tos;
1201 new_fa->fa_info = fi;
4e902c57
TG
1202 new_fa->fa_type = cfg->fc_type;
1203 new_fa->fa_scope = cfg->fc_scope;
19baf839 1204 state = fa->fa_state;
2373ce1c 1205 new_fa->fa_state &= ~FA_S_ACCESSED;
19baf839 1206
2373ce1c
RO
1207 list_replace_rcu(&fa->fa_list, &new_fa->fa_list);
1208 alias_free_mem_rcu(fa);
19baf839
RO
1209
1210 fib_release_info(fi_drop);
1211 if (state & FA_S_ACCESSED)
91b9a277 1212 rt_cache_flush(-1);
b8f55831
MK
1213 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen,
1214 tb->tb_id, &cfg->fc_nlinfo, NLM_F_REPLACE);
19baf839 1215
91b9a277 1216 goto succeeded;
19baf839
RO
1217 }
1218 /* Error if we find a perfect match which
1219 * uses the same scope, type, and nexthop
1220 * information.
1221 */
1222 fa_orig = fa;
1223 list_for_each_entry(fa, fa_orig->fa_list.prev, fa_list) {
1224 if (fa->fa_tos != tos)
1225 break;
1226 if (fa->fa_info->fib_priority != fi->fib_priority)
1227 break;
4e902c57
TG
1228 if (fa->fa_type == cfg->fc_type &&
1229 fa->fa_scope == cfg->fc_scope &&
19baf839
RO
1230 fa->fa_info == fi) {
1231 goto out;
1232 }
1233 }
4e902c57 1234 if (!(cfg->fc_nlflags & NLM_F_APPEND))
19baf839
RO
1235 fa = fa_orig;
1236 }
1237 err = -ENOENT;
4e902c57 1238 if (!(cfg->fc_nlflags & NLM_F_CREATE))
19baf839
RO
1239 goto out;
1240
1241 err = -ENOBUFS;
e94b1766 1242 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
19baf839
RO
1243 if (new_fa == NULL)
1244 goto out;
1245
1246 new_fa->fa_info = fi;
1247 new_fa->fa_tos = tos;
4e902c57
TG
1248 new_fa->fa_type = cfg->fc_type;
1249 new_fa->fa_scope = cfg->fc_scope;
19baf839 1250 new_fa->fa_state = 0;
19baf839
RO
1251 /*
1252 * Insert new entry to the list.
1253 */
1254
c877efb2 1255 if (!fa_head) {
fea86ad8
SH
1256 fa_head = fib_insert_node(t, key, plen);
1257 if (unlikely(!fa_head)) {
1258 err = -ENOMEM;
f835e471 1259 goto out_free_new_fa;
fea86ad8 1260 }
f835e471 1261 }
19baf839 1262
2373ce1c
RO
1263 list_add_tail_rcu(&new_fa->fa_list,
1264 (fa ? &fa->fa_list : fa_head));
19baf839
RO
1265
1266 rt_cache_flush(-1);
4e902c57 1267 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen, tb->tb_id,
b8f55831 1268 &cfg->fc_nlinfo, 0);
19baf839
RO
1269succeeded:
1270 return 0;
f835e471
RO
1271
1272out_free_new_fa:
1273 kmem_cache_free(fn_alias_kmem, new_fa);
19baf839
RO
1274out:
1275 fib_release_info(fi);
91b9a277 1276err:
19baf839
RO
1277 return err;
1278}
1279
2373ce1c 1280
772cb712 1281/* should be called with rcu_read_lock */
0c7770c7
SH
1282static inline int check_leaf(struct trie *t, struct leaf *l,
1283 t_key key, int *plen, const struct flowi *flp,
06c74270 1284 struct fib_result *res)
19baf839 1285{
06c74270 1286 int err, i;
888454c5 1287 __be32 mask;
19baf839
RO
1288 struct leaf_info *li;
1289 struct hlist_head *hhead = &l->list;
1290 struct hlist_node *node;
c877efb2 1291
2373ce1c 1292 hlist_for_each_entry_rcu(li, node, hhead, hlist) {
19baf839 1293 i = li->plen;
888454c5
AV
1294 mask = inet_make_mask(i);
1295 if (l->key != (key & ntohl(mask)))
19baf839
RO
1296 continue;
1297
888454c5 1298 if ((err = fib_semantic_match(&li->falh, flp, res, htonl(l->key), mask, i)) <= 0) {
19baf839
RO
1299 *plen = i;
1300#ifdef CONFIG_IP_FIB_TRIE_STATS
1301 t->stats.semantic_match_passed++;
1302#endif
06c74270 1303 return err;
19baf839
RO
1304 }
1305#ifdef CONFIG_IP_FIB_TRIE_STATS
1306 t->stats.semantic_match_miss++;
1307#endif
1308 }
06c74270 1309 return 1;
19baf839
RO
1310}
1311
1312static int
1313fn_trie_lookup(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1314{
1315 struct trie *t = (struct trie *) tb->tb_data;
1316 int plen, ret = 0;
1317 struct node *n;
1318 struct tnode *pn;
1319 int pos, bits;
91b9a277 1320 t_key key = ntohl(flp->fl4_dst);
19baf839
RO
1321 int chopped_off;
1322 t_key cindex = 0;
1323 int current_prefix_length = KEYLENGTH;
91b9a277
OJ
1324 struct tnode *cn;
1325 t_key node_prefix, key_prefix, pref_mismatch;
1326 int mp;
1327
2373ce1c 1328 rcu_read_lock();
91b9a277 1329
2373ce1c 1330 n = rcu_dereference(t->trie);
c877efb2 1331 if (!n)
19baf839
RO
1332 goto failed;
1333
1334#ifdef CONFIG_IP_FIB_TRIE_STATS
1335 t->stats.gets++;
1336#endif
1337
1338 /* Just a leaf? */
1339 if (IS_LEAF(n)) {
06c74270 1340 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
19baf839
RO
1341 goto found;
1342 goto failed;
1343 }
1344 pn = (struct tnode *) n;
1345 chopped_off = 0;
c877efb2 1346
91b9a277 1347 while (pn) {
19baf839
RO
1348 pos = pn->pos;
1349 bits = pn->bits;
1350
c877efb2 1351 if (!chopped_off)
ab66b4a7
SH
1352 cindex = tkey_extract_bits(mask_pfx(key, current_prefix_length),
1353 pos, bits);
19baf839
RO
1354
1355 n = tnode_get_child(pn, cindex);
1356
1357 if (n == NULL) {
1358#ifdef CONFIG_IP_FIB_TRIE_STATS
1359 t->stats.null_node_hit++;
1360#endif
1361 goto backtrace;
1362 }
1363
91b9a277
OJ
1364 if (IS_LEAF(n)) {
1365 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
1366 goto found;
1367 else
1368 goto backtrace;
1369 }
1370
19baf839
RO
1371#define HL_OPTIMIZE
1372#ifdef HL_OPTIMIZE
91b9a277 1373 cn = (struct tnode *)n;
19baf839 1374
91b9a277
OJ
1375 /*
1376 * It's a tnode, and we can do some extra checks here if we
1377 * like, to avoid descending into a dead-end branch.
1378 * This tnode is in the parent's child array at index
1379 * key[p_pos..p_pos+p_bits] but potentially with some bits
1380 * chopped off, so in reality the index may be just a
1381 * subprefix, padded with zero at the end.
1382 * We can also take a look at any skipped bits in this
1383 * tnode - everything up to p_pos is supposed to be ok,
1384 * and the non-chopped bits of the index (se previous
1385 * paragraph) are also guaranteed ok, but the rest is
1386 * considered unknown.
1387 *
1388 * The skipped bits are key[pos+bits..cn->pos].
1389 */
19baf839 1390
91b9a277
OJ
1391 /* If current_prefix_length < pos+bits, we are already doing
1392 * actual prefix matching, which means everything from
1393 * pos+(bits-chopped_off) onward must be zero along some
1394 * branch of this subtree - otherwise there is *no* valid
1395 * prefix present. Here we can only check the skipped
1396 * bits. Remember, since we have already indexed into the
1397 * parent's child array, we know that the bits we chopped of
1398 * *are* zero.
1399 */
19baf839 1400
91b9a277 1401 /* NOTA BENE: CHECKING ONLY SKIPPED BITS FOR THE NEW NODE HERE */
19baf839 1402
91b9a277
OJ
1403 if (current_prefix_length < pos+bits) {
1404 if (tkey_extract_bits(cn->key, current_prefix_length,
1405 cn->pos - current_prefix_length) != 0 ||
1406 !(cn->child[0]))
1407 goto backtrace;
1408 }
19baf839 1409
91b9a277
OJ
1410 /*
1411 * If chopped_off=0, the index is fully validated and we
1412 * only need to look at the skipped bits for this, the new,
1413 * tnode. What we actually want to do is to find out if
1414 * these skipped bits match our key perfectly, or if we will
1415 * have to count on finding a matching prefix further down,
1416 * because if we do, we would like to have some way of
1417 * verifying the existence of such a prefix at this point.
1418 */
19baf839 1419
91b9a277
OJ
1420 /* The only thing we can do at this point is to verify that
1421 * any such matching prefix can indeed be a prefix to our
1422 * key, and if the bits in the node we are inspecting that
1423 * do not match our key are not ZERO, this cannot be true.
1424 * Thus, find out where there is a mismatch (before cn->pos)
1425 * and verify that all the mismatching bits are zero in the
1426 * new tnode's key.
1427 */
19baf839 1428
91b9a277
OJ
1429 /* Note: We aren't very concerned about the piece of the key
1430 * that precede pn->pos+pn->bits, since these have already been
1431 * checked. The bits after cn->pos aren't checked since these are
1432 * by definition "unknown" at this point. Thus, what we want to
1433 * see is if we are about to enter the "prefix matching" state,
1434 * and in that case verify that the skipped bits that will prevail
1435 * throughout this subtree are zero, as they have to be if we are
1436 * to find a matching prefix.
1437 */
1438
ab66b4a7
SH
1439 node_prefix = mask_pfx(cn->key, cn->pos);
1440 key_prefix = mask_pfx(key, cn->pos);
91b9a277
OJ
1441 pref_mismatch = key_prefix^node_prefix;
1442 mp = 0;
1443
1444 /* In short: If skipped bits in this node do not match the search
1445 * key, enter the "prefix matching" state.directly.
1446 */
1447 if (pref_mismatch) {
1448 while (!(pref_mismatch & (1<<(KEYLENGTH-1)))) {
1449 mp++;
1450 pref_mismatch = pref_mismatch <<1;
1451 }
1452 key_prefix = tkey_extract_bits(cn->key, mp, cn->pos-mp);
1453
1454 if (key_prefix != 0)
1455 goto backtrace;
1456
1457 if (current_prefix_length >= cn->pos)
1458 current_prefix_length = mp;
c877efb2 1459 }
91b9a277
OJ
1460#endif
1461 pn = (struct tnode *)n; /* Descend */
1462 chopped_off = 0;
1463 continue;
1464
19baf839
RO
1465backtrace:
1466 chopped_off++;
1467
1468 /* As zero don't change the child key (cindex) */
91b9a277 1469 while ((chopped_off <= pn->bits) && !(cindex & (1<<(chopped_off-1))))
19baf839 1470 chopped_off++;
19baf839
RO
1471
1472 /* Decrease current_... with bits chopped off */
1473 if (current_prefix_length > pn->pos + pn->bits - chopped_off)
1474 current_prefix_length = pn->pos + pn->bits - chopped_off;
91b9a277 1475
19baf839 1476 /*
c877efb2 1477 * Either we do the actual chop off according or if we have
19baf839
RO
1478 * chopped off all bits in this tnode walk up to our parent.
1479 */
1480
91b9a277 1481 if (chopped_off <= pn->bits) {
19baf839 1482 cindex &= ~(1 << (chopped_off-1));
91b9a277 1483 } else {
06801916
SH
1484 struct tnode *parent = node_parent((struct node *) pn);
1485 if (!parent)
19baf839 1486 goto failed;
91b9a277 1487
19baf839 1488 /* Get Child's index */
06801916
SH
1489 cindex = tkey_extract_bits(pn->key, parent->pos, parent->bits);
1490 pn = parent;
19baf839
RO
1491 chopped_off = 0;
1492
1493#ifdef CONFIG_IP_FIB_TRIE_STATS
1494 t->stats.backtrack++;
1495#endif
1496 goto backtrace;
c877efb2 1497 }
19baf839
RO
1498 }
1499failed:
c877efb2 1500 ret = 1;
19baf839 1501found:
2373ce1c 1502 rcu_read_unlock();
19baf839
RO
1503 return ret;
1504}
1505
2373ce1c 1506/* only called from updater side */
19baf839
RO
1507static int trie_leaf_remove(struct trie *t, t_key key)
1508{
1509 t_key cindex;
1510 struct tnode *tp = NULL;
1511 struct node *n = t->trie;
1512 struct leaf *l;
1513
0c7770c7 1514 pr_debug("entering trie_leaf_remove(%p)\n", n);
19baf839
RO
1515
1516 /* Note that in the case skipped bits, those bits are *not* checked!
c877efb2 1517 * When we finish this, we will have NULL or a T_LEAF, and the
19baf839
RO
1518 * T_LEAF may or may not match our key.
1519 */
1520
91b9a277 1521 while (n != NULL && IS_TNODE(n)) {
19baf839
RO
1522 struct tnode *tn = (struct tnode *) n;
1523 check_tnode(tn);
1524 n = tnode_get_child(tn ,tkey_extract_bits(key, tn->pos, tn->bits));
1525
06801916 1526 BUG_ON(n && node_parent(n) != tn);
91b9a277 1527 }
19baf839
RO
1528 l = (struct leaf *) n;
1529
c877efb2 1530 if (!n || !tkey_equals(l->key, key))
19baf839 1531 return 0;
c877efb2
SH
1532
1533 /*
1534 * Key found.
1535 * Remove the leaf and rebalance the tree
19baf839
RO
1536 */
1537
19baf839
RO
1538 t->size--;
1539
06801916 1540 tp = node_parent(n);
19baf839
RO
1541 tnode_free((struct tnode *) n);
1542
c877efb2 1543 if (tp) {
19baf839
RO
1544 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1545 put_child(t, (struct tnode *)tp, cindex, NULL);
2373ce1c 1546 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
91b9a277 1547 } else
2373ce1c 1548 rcu_assign_pointer(t->trie, NULL);
19baf839
RO
1549
1550 return 1;
1551}
1552
d562f1f8
RO
1553/*
1554 * Caller must hold RTNL.
1555 */
4e902c57 1556static int fn_trie_delete(struct fib_table *tb, struct fib_config *cfg)
19baf839
RO
1557{
1558 struct trie *t = (struct trie *) tb->tb_data;
1559 u32 key, mask;
4e902c57
TG
1560 int plen = cfg->fc_dst_len;
1561 u8 tos = cfg->fc_tos;
19baf839
RO
1562 struct fib_alias *fa, *fa_to_delete;
1563 struct list_head *fa_head;
1564 struct leaf *l;
91b9a277
OJ
1565 struct leaf_info *li;
1566
c877efb2 1567 if (plen > 32)
19baf839
RO
1568 return -EINVAL;
1569
4e902c57 1570 key = ntohl(cfg->fc_dst);
91b9a277 1571 mask = ntohl(inet_make_mask(plen));
19baf839 1572
c877efb2 1573 if (key & ~mask)
19baf839
RO
1574 return -EINVAL;
1575
1576 key = key & mask;
1577 l = fib_find_node(t, key);
1578
c877efb2 1579 if (!l)
19baf839
RO
1580 return -ESRCH;
1581
1582 fa_head = get_fa_head(l, plen);
1583 fa = fib_find_alias(fa_head, tos, 0);
1584
1585 if (!fa)
1586 return -ESRCH;
1587
0c7770c7 1588 pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t);
19baf839
RO
1589
1590 fa_to_delete = NULL;
1591 fa_head = fa->fa_list.prev;
2373ce1c 1592
19baf839
RO
1593 list_for_each_entry(fa, fa_head, fa_list) {
1594 struct fib_info *fi = fa->fa_info;
1595
1596 if (fa->fa_tos != tos)
1597 break;
1598
4e902c57
TG
1599 if ((!cfg->fc_type || fa->fa_type == cfg->fc_type) &&
1600 (cfg->fc_scope == RT_SCOPE_NOWHERE ||
1601 fa->fa_scope == cfg->fc_scope) &&
1602 (!cfg->fc_protocol ||
1603 fi->fib_protocol == cfg->fc_protocol) &&
1604 fib_nh_match(cfg, fi) == 0) {
19baf839
RO
1605 fa_to_delete = fa;
1606 break;
1607 }
1608 }
1609
91b9a277
OJ
1610 if (!fa_to_delete)
1611 return -ESRCH;
19baf839 1612
91b9a277 1613 fa = fa_to_delete;
4e902c57 1614 rtmsg_fib(RTM_DELROUTE, htonl(key), fa, plen, tb->tb_id,
b8f55831 1615 &cfg->fc_nlinfo, 0);
91b9a277
OJ
1616
1617 l = fib_find_node(t, key);
772cb712 1618 li = find_leaf_info(l, plen);
19baf839 1619
2373ce1c 1620 list_del_rcu(&fa->fa_list);
19baf839 1621
91b9a277 1622 if (list_empty(fa_head)) {
2373ce1c 1623 hlist_del_rcu(&li->hlist);
91b9a277 1624 free_leaf_info(li);
2373ce1c 1625 }
19baf839 1626
91b9a277
OJ
1627 if (hlist_empty(&l->list))
1628 trie_leaf_remove(t, key);
19baf839 1629
91b9a277
OJ
1630 if (fa->fa_state & FA_S_ACCESSED)
1631 rt_cache_flush(-1);
19baf839 1632
2373ce1c
RO
1633 fib_release_info(fa->fa_info);
1634 alias_free_mem_rcu(fa);
91b9a277 1635 return 0;
19baf839
RO
1636}
1637
1638static int trie_flush_list(struct trie *t, struct list_head *head)
1639{
1640 struct fib_alias *fa, *fa_node;
1641 int found = 0;
1642
1643 list_for_each_entry_safe(fa, fa_node, head, fa_list) {
1644 struct fib_info *fi = fa->fa_info;
19baf839 1645
2373ce1c
RO
1646 if (fi && (fi->fib_flags & RTNH_F_DEAD)) {
1647 list_del_rcu(&fa->fa_list);
1648 fib_release_info(fa->fa_info);
1649 alias_free_mem_rcu(fa);
19baf839
RO
1650 found++;
1651 }
1652 }
1653 return found;
1654}
1655
1656static int trie_flush_leaf(struct trie *t, struct leaf *l)
1657{
1658 int found = 0;
1659 struct hlist_head *lih = &l->list;
1660 struct hlist_node *node, *tmp;
1661 struct leaf_info *li = NULL;
1662
1663 hlist_for_each_entry_safe(li, node, tmp, lih, hlist) {
19baf839
RO
1664 found += trie_flush_list(t, &li->falh);
1665
1666 if (list_empty(&li->falh)) {
2373ce1c 1667 hlist_del_rcu(&li->hlist);
19baf839
RO
1668 free_leaf_info(li);
1669 }
1670 }
1671 return found;
1672}
1673
2373ce1c
RO
1674/* rcu_read_lock needs to be hold by caller from readside */
1675
19baf839
RO
1676static struct leaf *nextleaf(struct trie *t, struct leaf *thisleaf)
1677{
1678 struct node *c = (struct node *) thisleaf;
1679 struct tnode *p;
1680 int idx;
2373ce1c 1681 struct node *trie = rcu_dereference(t->trie);
19baf839 1682
c877efb2 1683 if (c == NULL) {
2373ce1c 1684 if (trie == NULL)
19baf839
RO
1685 return NULL;
1686
2373ce1c
RO
1687 if (IS_LEAF(trie)) /* trie w. just a leaf */
1688 return (struct leaf *) trie;
19baf839 1689
2373ce1c 1690 p = (struct tnode*) trie; /* Start */
91b9a277 1691 } else
06801916 1692 p = node_parent(c);
c877efb2 1693
19baf839
RO
1694 while (p) {
1695 int pos, last;
1696
1697 /* Find the next child of the parent */
c877efb2
SH
1698 if (c)
1699 pos = 1 + tkey_extract_bits(c->key, p->pos, p->bits);
1700 else
19baf839
RO
1701 pos = 0;
1702
1703 last = 1 << p->bits;
91b9a277 1704 for (idx = pos; idx < last ; idx++) {
2373ce1c
RO
1705 c = rcu_dereference(p->child[idx]);
1706
1707 if (!c)
91b9a277
OJ
1708 continue;
1709
1710 /* Decend if tnode */
2373ce1c
RO
1711 while (IS_TNODE(c)) {
1712 p = (struct tnode *) c;
e905a9ed 1713 idx = 0;
91b9a277
OJ
1714
1715 /* Rightmost non-NULL branch */
1716 if (p && IS_TNODE(p))
2373ce1c
RO
1717 while (!(c = rcu_dereference(p->child[idx]))
1718 && idx < (1<<p->bits)) idx++;
91b9a277
OJ
1719
1720 /* Done with this tnode? */
2373ce1c 1721 if (idx >= (1 << p->bits) || !c)
91b9a277 1722 goto up;
19baf839 1723 }
2373ce1c 1724 return (struct leaf *) c;
19baf839
RO
1725 }
1726up:
1727 /* No more children go up one step */
91b9a277 1728 c = (struct node *) p;
06801916 1729 p = node_parent(c);
19baf839
RO
1730 }
1731 return NULL; /* Ready. Root of trie */
1732}
1733
d562f1f8
RO
1734/*
1735 * Caller must hold RTNL.
1736 */
19baf839
RO
1737static int fn_trie_flush(struct fib_table *tb)
1738{
1739 struct trie *t = (struct trie *) tb->tb_data;
1740 struct leaf *ll = NULL, *l = NULL;
1741 int found = 0, h;
1742
91b9a277 1743 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
19baf839
RO
1744 found += trie_flush_leaf(t, l);
1745
1746 if (ll && hlist_empty(&ll->list))
1747 trie_leaf_remove(t, ll->key);
1748 ll = l;
1749 }
1750
1751 if (ll && hlist_empty(&ll->list))
1752 trie_leaf_remove(t, ll->key);
1753
0c7770c7 1754 pr_debug("trie_flush found=%d\n", found);
19baf839
RO
1755 return found;
1756}
1757
19baf839
RO
1758static void
1759fn_trie_select_default(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1760{
1761 struct trie *t = (struct trie *) tb->tb_data;
1762 int order, last_idx;
1763 struct fib_info *fi = NULL;
1764 struct fib_info *last_resort;
1765 struct fib_alias *fa = NULL;
1766 struct list_head *fa_head;
1767 struct leaf *l;
1768
1769 last_idx = -1;
1770 last_resort = NULL;
1771 order = -1;
1772
2373ce1c 1773 rcu_read_lock();
c877efb2 1774
19baf839 1775 l = fib_find_node(t, 0);
c877efb2 1776 if (!l)
19baf839
RO
1777 goto out;
1778
1779 fa_head = get_fa_head(l, 0);
c877efb2 1780 if (!fa_head)
19baf839
RO
1781 goto out;
1782
c877efb2 1783 if (list_empty(fa_head))
19baf839
RO
1784 goto out;
1785
2373ce1c 1786 list_for_each_entry_rcu(fa, fa_head, fa_list) {
19baf839 1787 struct fib_info *next_fi = fa->fa_info;
91b9a277 1788
19baf839
RO
1789 if (fa->fa_scope != res->scope ||
1790 fa->fa_type != RTN_UNICAST)
1791 continue;
91b9a277 1792
19baf839
RO
1793 if (next_fi->fib_priority > res->fi->fib_priority)
1794 break;
1795 if (!next_fi->fib_nh[0].nh_gw ||
1796 next_fi->fib_nh[0].nh_scope != RT_SCOPE_LINK)
1797 continue;
1798 fa->fa_state |= FA_S_ACCESSED;
91b9a277 1799
19baf839
RO
1800 if (fi == NULL) {
1801 if (next_fi != res->fi)
1802 break;
1803 } else if (!fib_detect_death(fi, order, &last_resort,
971b893e 1804 &last_idx, tb->tb_default)) {
a2bbe682 1805 fib_result_assign(res, fi);
971b893e 1806 tb->tb_default = order;
19baf839
RO
1807 goto out;
1808 }
1809 fi = next_fi;
1810 order++;
1811 }
1812 if (order <= 0 || fi == NULL) {
971b893e 1813 tb->tb_default = -1;
19baf839
RO
1814 goto out;
1815 }
1816
971b893e
DL
1817 if (!fib_detect_death(fi, order, &last_resort, &last_idx,
1818 tb->tb_default)) {
a2bbe682 1819 fib_result_assign(res, fi);
971b893e 1820 tb->tb_default = order;
19baf839
RO
1821 goto out;
1822 }
a2bbe682
DL
1823 if (last_idx >= 0)
1824 fib_result_assign(res, last_resort);
971b893e
DL
1825 tb->tb_default = last_idx;
1826out:
2373ce1c 1827 rcu_read_unlock();
19baf839
RO
1828}
1829
c877efb2 1830static int fn_trie_dump_fa(t_key key, int plen, struct list_head *fah, struct fib_table *tb,
19baf839
RO
1831 struct sk_buff *skb, struct netlink_callback *cb)
1832{
1833 int i, s_i;
1834 struct fib_alias *fa;
1835
32ab5f80 1836 __be32 xkey = htonl(key);
19baf839 1837
1af5a8c4 1838 s_i = cb->args[4];
19baf839
RO
1839 i = 0;
1840
2373ce1c
RO
1841 /* rcu_read_lock is hold by caller */
1842
1843 list_for_each_entry_rcu(fa, fah, fa_list) {
19baf839
RO
1844 if (i < s_i) {
1845 i++;
1846 continue;
1847 }
78c6671a 1848 BUG_ON(!fa->fa_info);
19baf839
RO
1849
1850 if (fib_dump_info(skb, NETLINK_CB(cb->skb).pid,
1851 cb->nlh->nlmsg_seq,
1852 RTM_NEWROUTE,
1853 tb->tb_id,
1854 fa->fa_type,
1855 fa->fa_scope,
be403ea1 1856 xkey,
19baf839
RO
1857 plen,
1858 fa->fa_tos,
90f66914 1859 fa->fa_info, 0) < 0) {
1af5a8c4 1860 cb->args[4] = i;
19baf839 1861 return -1;
91b9a277 1862 }
19baf839
RO
1863 i++;
1864 }
1af5a8c4 1865 cb->args[4] = i;
19baf839
RO
1866 return skb->len;
1867}
1868
c877efb2 1869static int fn_trie_dump_plen(struct trie *t, int plen, struct fib_table *tb, struct sk_buff *skb,
19baf839
RO
1870 struct netlink_callback *cb)
1871{
1872 int h, s_h;
1873 struct list_head *fa_head;
1874 struct leaf *l = NULL;
19baf839 1875
1af5a8c4 1876 s_h = cb->args[3];
19baf839 1877
91b9a277 1878 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
19baf839
RO
1879 if (h < s_h)
1880 continue;
1881 if (h > s_h)
1af5a8c4
PM
1882 memset(&cb->args[4], 0,
1883 sizeof(cb->args) - 4*sizeof(cb->args[0]));
19baf839
RO
1884
1885 fa_head = get_fa_head(l, plen);
91b9a277 1886
c877efb2 1887 if (!fa_head)
19baf839
RO
1888 continue;
1889
c877efb2 1890 if (list_empty(fa_head))
19baf839
RO
1891 continue;
1892
1893 if (fn_trie_dump_fa(l->key, plen, fa_head, tb, skb, cb)<0) {
1af5a8c4 1894 cb->args[3] = h;
19baf839
RO
1895 return -1;
1896 }
1897 }
1af5a8c4 1898 cb->args[3] = h;
19baf839
RO
1899 return skb->len;
1900}
1901
1902static int fn_trie_dump(struct fib_table *tb, struct sk_buff *skb, struct netlink_callback *cb)
1903{
1904 int m, s_m;
1905 struct trie *t = (struct trie *) tb->tb_data;
1906
1af5a8c4 1907 s_m = cb->args[2];
19baf839 1908
2373ce1c 1909 rcu_read_lock();
91b9a277 1910 for (m = 0; m <= 32; m++) {
19baf839
RO
1911 if (m < s_m)
1912 continue;
1913 if (m > s_m)
1af5a8c4
PM
1914 memset(&cb->args[3], 0,
1915 sizeof(cb->args) - 3*sizeof(cb->args[0]));
19baf839
RO
1916
1917 if (fn_trie_dump_plen(t, 32-m, tb, skb, cb)<0) {
1af5a8c4 1918 cb->args[2] = m;
19baf839
RO
1919 goto out;
1920 }
1921 }
2373ce1c 1922 rcu_read_unlock();
1af5a8c4 1923 cb->args[2] = m;
19baf839 1924 return skb->len;
91b9a277 1925out:
2373ce1c 1926 rcu_read_unlock();
19baf839
RO
1927 return -1;
1928}
1929
1930/* Fix more generic FIB names for init later */
1931
7b1a74fd 1932struct fib_table *fib_hash_init(u32 id)
19baf839
RO
1933{
1934 struct fib_table *tb;
1935 struct trie *t;
1936
1937 if (fn_alias_kmem == NULL)
1938 fn_alias_kmem = kmem_cache_create("ip_fib_alias",
1939 sizeof(struct fib_alias),
1940 0, SLAB_HWCACHE_ALIGN,
20c2df83 1941 NULL);
19baf839
RO
1942
1943 tb = kmalloc(sizeof(struct fib_table) + sizeof(struct trie),
1944 GFP_KERNEL);
1945 if (tb == NULL)
1946 return NULL;
1947
1948 tb->tb_id = id;
971b893e 1949 tb->tb_default = -1;
19baf839
RO
1950 tb->tb_lookup = fn_trie_lookup;
1951 tb->tb_insert = fn_trie_insert;
1952 tb->tb_delete = fn_trie_delete;
1953 tb->tb_flush = fn_trie_flush;
1954 tb->tb_select_default = fn_trie_select_default;
1955 tb->tb_dump = fn_trie_dump;
19baf839
RO
1956
1957 t = (struct trie *) tb->tb_data;
c28a1cf4 1958 memset(t, 0, sizeof(*t));
19baf839 1959
19baf839 1960 if (id == RT_TABLE_LOCAL)
78c6671a 1961 printk(KERN_INFO "IPv4 FIB: Using LC-trie version %s\n", VERSION);
19baf839
RO
1962
1963 return tb;
1964}
1965
cb7b593c
SH
1966#ifdef CONFIG_PROC_FS
1967/* Depth first Trie walk iterator */
1968struct fib_trie_iter {
1c340b2f 1969 struct seq_net_private p;
877a9bff 1970 struct trie *trie_local, *trie_main;
cb7b593c
SH
1971 struct tnode *tnode;
1972 struct trie *trie;
1973 unsigned index;
1974 unsigned depth;
1975};
19baf839 1976
cb7b593c 1977static struct node *fib_trie_get_next(struct fib_trie_iter *iter)
19baf839 1978{
cb7b593c
SH
1979 struct tnode *tn = iter->tnode;
1980 unsigned cindex = iter->index;
1981 struct tnode *p;
19baf839 1982
6640e697
EB
1983 /* A single entry routing table */
1984 if (!tn)
1985 return NULL;
1986
cb7b593c
SH
1987 pr_debug("get_next iter={node=%p index=%d depth=%d}\n",
1988 iter->tnode, iter->index, iter->depth);
1989rescan:
1990 while (cindex < (1<<tn->bits)) {
1991 struct node *n = tnode_get_child(tn, cindex);
19baf839 1992
cb7b593c
SH
1993 if (n) {
1994 if (IS_LEAF(n)) {
1995 iter->tnode = tn;
1996 iter->index = cindex + 1;
1997 } else {
1998 /* push down one level */
1999 iter->tnode = (struct tnode *) n;
2000 iter->index = 0;
2001 ++iter->depth;
2002 }
2003 return n;
2004 }
19baf839 2005
cb7b593c
SH
2006 ++cindex;
2007 }
91b9a277 2008
cb7b593c 2009 /* Current node exhausted, pop back up */
06801916 2010 p = node_parent((struct node *)tn);
cb7b593c
SH
2011 if (p) {
2012 cindex = tkey_extract_bits(tn->key, p->pos, p->bits)+1;
2013 tn = p;
2014 --iter->depth;
2015 goto rescan;
19baf839 2016 }
cb7b593c
SH
2017
2018 /* got root? */
2019 return NULL;
19baf839
RO
2020}
2021
cb7b593c
SH
2022static struct node *fib_trie_get_first(struct fib_trie_iter *iter,
2023 struct trie *t)
19baf839 2024{
5ddf0eb2
RO
2025 struct node *n ;
2026
132adf54 2027 if (!t)
5ddf0eb2
RO
2028 return NULL;
2029
2030 n = rcu_dereference(t->trie);
2031
132adf54 2032 if (!iter)
5ddf0eb2 2033 return NULL;
19baf839 2034
6640e697
EB
2035 if (n) {
2036 if (IS_TNODE(n)) {
2037 iter->tnode = (struct tnode *) n;
2038 iter->trie = t;
2039 iter->index = 0;
2040 iter->depth = 1;
2041 } else {
2042 iter->tnode = NULL;
2043 iter->trie = t;
2044 iter->index = 0;
2045 iter->depth = 0;
2046 }
cb7b593c 2047 return n;
91b9a277 2048 }
cb7b593c
SH
2049 return NULL;
2050}
91b9a277 2051
cb7b593c
SH
2052static void trie_collect_stats(struct trie *t, struct trie_stat *s)
2053{
2054 struct node *n;
2055 struct fib_trie_iter iter;
91b9a277 2056
cb7b593c 2057 memset(s, 0, sizeof(*s));
91b9a277 2058
cb7b593c
SH
2059 rcu_read_lock();
2060 for (n = fib_trie_get_first(&iter, t); n;
2061 n = fib_trie_get_next(&iter)) {
2062 if (IS_LEAF(n)) {
2063 s->leaves++;
2064 s->totdepth += iter.depth;
2065 if (iter.depth > s->maxdepth)
2066 s->maxdepth = iter.depth;
2067 } else {
2068 const struct tnode *tn = (const struct tnode *) n;
2069 int i;
2070
2071 s->tnodes++;
132adf54 2072 if (tn->bits < MAX_STAT_DEPTH)
06ef921d
RO
2073 s->nodesizes[tn->bits]++;
2074
cb7b593c
SH
2075 for (i = 0; i < (1<<tn->bits); i++)
2076 if (!tn->child[i])
2077 s->nullpointers++;
19baf839 2078 }
19baf839 2079 }
2373ce1c 2080 rcu_read_unlock();
19baf839
RO
2081}
2082
cb7b593c
SH
2083/*
2084 * This outputs /proc/net/fib_triestats
2085 */
2086static void trie_show_stats(struct seq_file *seq, struct trie_stat *stat)
19baf839 2087{
cb7b593c 2088 unsigned i, max, pointers, bytes, avdepth;
c877efb2 2089
cb7b593c
SH
2090 if (stat->leaves)
2091 avdepth = stat->totdepth*100 / stat->leaves;
2092 else
2093 avdepth = 0;
91b9a277 2094
187b5188 2095 seq_printf(seq, "\tAver depth: %u.%02d\n", avdepth / 100, avdepth % 100 );
cb7b593c 2096 seq_printf(seq, "\tMax depth: %u\n", stat->maxdepth);
91b9a277 2097
cb7b593c 2098 seq_printf(seq, "\tLeaves: %u\n", stat->leaves);
91b9a277 2099
cb7b593c 2100 bytes = sizeof(struct leaf) * stat->leaves;
187b5188 2101 seq_printf(seq, "\tInternal nodes: %u\n\t", stat->tnodes);
cb7b593c 2102 bytes += sizeof(struct tnode) * stat->tnodes;
19baf839 2103
06ef921d
RO
2104 max = MAX_STAT_DEPTH;
2105 while (max > 0 && stat->nodesizes[max-1] == 0)
cb7b593c 2106 max--;
19baf839 2107
cb7b593c
SH
2108 pointers = 0;
2109 for (i = 1; i <= max; i++)
2110 if (stat->nodesizes[i] != 0) {
187b5188 2111 seq_printf(seq, " %u: %u", i, stat->nodesizes[i]);
cb7b593c
SH
2112 pointers += (1<<i) * stat->nodesizes[i];
2113 }
2114 seq_putc(seq, '\n');
187b5188 2115 seq_printf(seq, "\tPointers: %u\n", pointers);
2373ce1c 2116
cb7b593c 2117 bytes += sizeof(struct node *) * pointers;
187b5188
SH
2118 seq_printf(seq, "Null ptrs: %u\n", stat->nullpointers);
2119 seq_printf(seq, "Total size: %u kB\n", (bytes + 1023) / 1024);
66a2f7fd 2120}
2373ce1c 2121
cb7b593c 2122#ifdef CONFIG_IP_FIB_TRIE_STATS
66a2f7fd
SH
2123static void trie_show_usage(struct seq_file *seq,
2124 const struct trie_use_stats *stats)
2125{
2126 seq_printf(seq, "\nCounters:\n---------\n");
2127 seq_printf(seq,"gets = %u\n", stats->gets);
2128 seq_printf(seq,"backtracks = %u\n", stats->backtrack);
2129 seq_printf(seq,"semantic match passed = %u\n", stats->semantic_match_passed);
2130 seq_printf(seq,"semantic match miss = %u\n", stats->semantic_match_miss);
2131 seq_printf(seq,"null node hit= %u\n", stats->null_node_hit);
2132 seq_printf(seq,"skipped node resize = %u\n\n", stats->resize_node_skipped);
cb7b593c 2133}
66a2f7fd
SH
2134#endif /* CONFIG_IP_FIB_TRIE_STATS */
2135
19baf839 2136
cb7b593c
SH
2137static int fib_triestat_seq_show(struct seq_file *seq, void *v)
2138{
1c340b2f 2139 struct net *net = (struct net *)seq->private;
877a9bff 2140 struct trie *trie_local, *trie_main;
cb7b593c 2141 struct trie_stat *stat;
877a9bff
EB
2142 struct fib_table *tb;
2143
2144 trie_local = NULL;
1c340b2f 2145 tb = fib_get_table(net, RT_TABLE_LOCAL);
877a9bff
EB
2146 if (tb)
2147 trie_local = (struct trie *) tb->tb_data;
2148
2149 trie_main = NULL;
1c340b2f 2150 tb = fib_get_table(net, RT_TABLE_MAIN);
877a9bff
EB
2151 if (tb)
2152 trie_main = (struct trie *) tb->tb_data;
2153
91b9a277 2154
cb7b593c
SH
2155 stat = kmalloc(sizeof(*stat), GFP_KERNEL);
2156 if (!stat)
2157 return -ENOMEM;
91b9a277 2158
cb7b593c
SH
2159 seq_printf(seq, "Basic info: size of leaf: %Zd bytes, size of tnode: %Zd bytes.\n",
2160 sizeof(struct leaf), sizeof(struct tnode));
91b9a277 2161
cb7b593c
SH
2162 if (trie_local) {
2163 seq_printf(seq, "Local:\n");
2164 trie_collect_stats(trie_local, stat);
2165 trie_show_stats(seq, stat);
66a2f7fd
SH
2166#ifdef CONFIG_IP_FIB_TRIE_STATS
2167 trie_show_usage(seq, &trie_local->stats);
2168#endif
cb7b593c 2169 }
91b9a277 2170
cb7b593c
SH
2171 if (trie_main) {
2172 seq_printf(seq, "Main:\n");
2173 trie_collect_stats(trie_main, stat);
2174 trie_show_stats(seq, stat);
66a2f7fd
SH
2175#ifdef CONFIG_IP_FIB_TRIE_STATS
2176 trie_show_usage(seq, &trie_main->stats);
2177#endif
19baf839 2178 }
cb7b593c 2179 kfree(stat);
19baf839 2180
cb7b593c 2181 return 0;
19baf839
RO
2182}
2183
cb7b593c 2184static int fib_triestat_seq_open(struct inode *inode, struct file *file)
19baf839 2185{
1c340b2f
DL
2186 int err;
2187 struct net *net;
2188
2189 net = get_proc_net(inode);
2190 if (net == NULL)
2191 return -ENXIO;
2192 err = single_open(file, fib_triestat_seq_show, net);
2193 if (err < 0) {
2194 put_net(net);
2195 return err;
2196 }
2197 return 0;
2198}
2199
2200static int fib_triestat_seq_release(struct inode *ino, struct file *f)
2201{
2202 struct seq_file *seq = f->private_data;
2203 put_net(seq->private);
2204 return single_release(ino, f);
19baf839
RO
2205}
2206
9a32144e 2207static const struct file_operations fib_triestat_fops = {
cb7b593c
SH
2208 .owner = THIS_MODULE,
2209 .open = fib_triestat_seq_open,
2210 .read = seq_read,
2211 .llseek = seq_lseek,
1c340b2f 2212 .release = fib_triestat_seq_release,
cb7b593c
SH
2213};
2214
2215static struct node *fib_trie_get_idx(struct fib_trie_iter *iter,
2216 loff_t pos)
19baf839 2217{
cb7b593c
SH
2218 loff_t idx = 0;
2219 struct node *n;
2220
877a9bff 2221 for (n = fib_trie_get_first(iter, iter->trie_local);
cb7b593c
SH
2222 n; ++idx, n = fib_trie_get_next(iter)) {
2223 if (pos == idx)
2224 return n;
2225 }
2226
877a9bff 2227 for (n = fib_trie_get_first(iter, iter->trie_main);
cb7b593c
SH
2228 n; ++idx, n = fib_trie_get_next(iter)) {
2229 if (pos == idx)
2230 return n;
2231 }
19baf839
RO
2232 return NULL;
2233}
2234
cb7b593c 2235static void *fib_trie_seq_start(struct seq_file *seq, loff_t *pos)
c95aaf9a 2236 __acquires(RCU)
19baf839 2237{
877a9bff
EB
2238 struct fib_trie_iter *iter = seq->private;
2239 struct fib_table *tb;
2240
2241 if (!iter->trie_local) {
1c340b2f 2242 tb = fib_get_table(iter->p.net, RT_TABLE_LOCAL);
877a9bff
EB
2243 if (tb)
2244 iter->trie_local = (struct trie *) tb->tb_data;
2245 }
2246 if (!iter->trie_main) {
1c340b2f 2247 tb = fib_get_table(iter->p.net, RT_TABLE_MAIN);
877a9bff
EB
2248 if (tb)
2249 iter->trie_main = (struct trie *) tb->tb_data;
2250 }
cb7b593c
SH
2251 rcu_read_lock();
2252 if (*pos == 0)
91b9a277 2253 return SEQ_START_TOKEN;
877a9bff 2254 return fib_trie_get_idx(iter, *pos - 1);
19baf839
RO
2255}
2256
cb7b593c 2257static void *fib_trie_seq_next(struct seq_file *seq, void *v, loff_t *pos)
19baf839 2258{
cb7b593c
SH
2259 struct fib_trie_iter *iter = seq->private;
2260 void *l = v;
2261
19baf839 2262 ++*pos;
91b9a277 2263 if (v == SEQ_START_TOKEN)
cb7b593c 2264 return fib_trie_get_idx(iter, 0);
19baf839 2265
cb7b593c
SH
2266 v = fib_trie_get_next(iter);
2267 BUG_ON(v == l);
2268 if (v)
2269 return v;
19baf839 2270
cb7b593c 2271 /* continue scan in next trie */
877a9bff
EB
2272 if (iter->trie == iter->trie_local)
2273 return fib_trie_get_first(iter, iter->trie_main);
19baf839 2274
cb7b593c
SH
2275 return NULL;
2276}
19baf839 2277
cb7b593c 2278static void fib_trie_seq_stop(struct seq_file *seq, void *v)
c95aaf9a 2279 __releases(RCU)
19baf839 2280{
cb7b593c
SH
2281 rcu_read_unlock();
2282}
91b9a277 2283
cb7b593c
SH
2284static void seq_indent(struct seq_file *seq, int n)
2285{
2286 while (n-- > 0) seq_puts(seq, " ");
2287}
19baf839 2288
cb7b593c
SH
2289static inline const char *rtn_scope(enum rt_scope_t s)
2290{
2291 static char buf[32];
19baf839 2292
132adf54 2293 switch (s) {
cb7b593c
SH
2294 case RT_SCOPE_UNIVERSE: return "universe";
2295 case RT_SCOPE_SITE: return "site";
2296 case RT_SCOPE_LINK: return "link";
2297 case RT_SCOPE_HOST: return "host";
2298 case RT_SCOPE_NOWHERE: return "nowhere";
2299 default:
2300 snprintf(buf, sizeof(buf), "scope=%d", s);
2301 return buf;
2302 }
2303}
19baf839 2304
cb7b593c
SH
2305static const char *rtn_type_names[__RTN_MAX] = {
2306 [RTN_UNSPEC] = "UNSPEC",
2307 [RTN_UNICAST] = "UNICAST",
2308 [RTN_LOCAL] = "LOCAL",
2309 [RTN_BROADCAST] = "BROADCAST",
2310 [RTN_ANYCAST] = "ANYCAST",
2311 [RTN_MULTICAST] = "MULTICAST",
2312 [RTN_BLACKHOLE] = "BLACKHOLE",
2313 [RTN_UNREACHABLE] = "UNREACHABLE",
2314 [RTN_PROHIBIT] = "PROHIBIT",
2315 [RTN_THROW] = "THROW",
2316 [RTN_NAT] = "NAT",
2317 [RTN_XRESOLVE] = "XRESOLVE",
2318};
19baf839 2319
cb7b593c
SH
2320static inline const char *rtn_type(unsigned t)
2321{
2322 static char buf[32];
19baf839 2323
cb7b593c
SH
2324 if (t < __RTN_MAX && rtn_type_names[t])
2325 return rtn_type_names[t];
187b5188 2326 snprintf(buf, sizeof(buf), "type %u", t);
cb7b593c 2327 return buf;
19baf839
RO
2328}
2329
cb7b593c
SH
2330/* Pretty print the trie */
2331static int fib_trie_seq_show(struct seq_file *seq, void *v)
19baf839 2332{
cb7b593c
SH
2333 const struct fib_trie_iter *iter = seq->private;
2334 struct node *n = v;
c877efb2 2335
cb7b593c
SH
2336 if (v == SEQ_START_TOKEN)
2337 return 0;
19baf839 2338
06801916 2339 if (!node_parent(n)) {
877a9bff 2340 if (iter->trie == iter->trie_local)
095b8501
RO
2341 seq_puts(seq, "<local>:\n");
2342 else
2343 seq_puts(seq, "<main>:\n");
2344 }
2345
cb7b593c
SH
2346 if (IS_TNODE(n)) {
2347 struct tnode *tn = (struct tnode *) n;
ab66b4a7 2348 __be32 prf = htonl(mask_pfx(tn->key, tn->pos));
91b9a277 2349
1d25cd6c
RO
2350 seq_indent(seq, iter->depth-1);
2351 seq_printf(seq, " +-- %d.%d.%d.%d/%d %d %d %d\n",
e905a9ed 2352 NIPQUAD(prf), tn->pos, tn->bits, tn->full_children,
1d25cd6c 2353 tn->empty_children);
e905a9ed 2354
cb7b593c
SH
2355 } else {
2356 struct leaf *l = (struct leaf *) n;
2357 int i;
32ab5f80 2358 __be32 val = htonl(l->key);
cb7b593c
SH
2359
2360 seq_indent(seq, iter->depth);
2361 seq_printf(seq, " |-- %d.%d.%d.%d\n", NIPQUAD(val));
2362 for (i = 32; i >= 0; i--) {
772cb712 2363 struct leaf_info *li = find_leaf_info(l, i);
cb7b593c
SH
2364 if (li) {
2365 struct fib_alias *fa;
2366 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
2367 seq_indent(seq, iter->depth+1);
2368 seq_printf(seq, " /%d %s %s", i,
2369 rtn_scope(fa->fa_scope),
2370 rtn_type(fa->fa_type));
2371 if (fa->fa_tos)
2372 seq_printf(seq, "tos =%d\n",
2373 fa->fa_tos);
2374 seq_putc(seq, '\n');
2375 }
2376 }
2377 }
19baf839 2378 }
cb7b593c 2379
19baf839
RO
2380 return 0;
2381}
2382
f690808e 2383static const struct seq_operations fib_trie_seq_ops = {
cb7b593c
SH
2384 .start = fib_trie_seq_start,
2385 .next = fib_trie_seq_next,
2386 .stop = fib_trie_seq_stop,
2387 .show = fib_trie_seq_show,
19baf839
RO
2388};
2389
cb7b593c 2390static int fib_trie_seq_open(struct inode *inode, struct file *file)
19baf839 2391{
1c340b2f
DL
2392 return seq_open_net(inode, file, &fib_trie_seq_ops,
2393 sizeof(struct fib_trie_iter));
19baf839
RO
2394}
2395
9a32144e 2396static const struct file_operations fib_trie_fops = {
cb7b593c
SH
2397 .owner = THIS_MODULE,
2398 .open = fib_trie_seq_open,
2399 .read = seq_read,
2400 .llseek = seq_lseek,
1c340b2f 2401 .release = seq_release_net,
19baf839
RO
2402};
2403
32ab5f80 2404static unsigned fib_flag_trans(int type, __be32 mask, const struct fib_info *fi)
19baf839 2405{
cb7b593c
SH
2406 static unsigned type2flags[RTN_MAX + 1] = {
2407 [7] = RTF_REJECT, [8] = RTF_REJECT,
2408 };
2409 unsigned flags = type2flags[type];
19baf839 2410
cb7b593c
SH
2411 if (fi && fi->fib_nh->nh_gw)
2412 flags |= RTF_GATEWAY;
32ab5f80 2413 if (mask == htonl(0xFFFFFFFF))
cb7b593c
SH
2414 flags |= RTF_HOST;
2415 flags |= RTF_UP;
2416 return flags;
19baf839
RO
2417}
2418
cb7b593c
SH
2419/*
2420 * This outputs /proc/net/route.
2421 * The format of the file is not supposed to be changed
2422 * and needs to be same as fib_hash output to avoid breaking
2423 * legacy utilities
2424 */
2425static int fib_route_seq_show(struct seq_file *seq, void *v)
19baf839 2426{
c9e53cbe 2427 const struct fib_trie_iter *iter = seq->private;
cb7b593c
SH
2428 struct leaf *l = v;
2429 int i;
2430 char bf[128];
19baf839 2431
cb7b593c
SH
2432 if (v == SEQ_START_TOKEN) {
2433 seq_printf(seq, "%-127s\n", "Iface\tDestination\tGateway "
2434 "\tFlags\tRefCnt\tUse\tMetric\tMask\t\tMTU"
2435 "\tWindow\tIRTT");
2436 return 0;
2437 }
19baf839 2438
877a9bff 2439 if (iter->trie == iter->trie_local)
c9e53cbe 2440 return 0;
cb7b593c
SH
2441 if (IS_TNODE(l))
2442 return 0;
19baf839 2443
cb7b593c 2444 for (i=32; i>=0; i--) {
772cb712 2445 struct leaf_info *li = find_leaf_info(l, i);
cb7b593c 2446 struct fib_alias *fa;
32ab5f80 2447 __be32 mask, prefix;
91b9a277 2448
cb7b593c
SH
2449 if (!li)
2450 continue;
19baf839 2451
cb7b593c
SH
2452 mask = inet_make_mask(li->plen);
2453 prefix = htonl(l->key);
19baf839 2454
cb7b593c 2455 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
1371e37d 2456 const struct fib_info *fi = fa->fa_info;
cb7b593c 2457 unsigned flags = fib_flag_trans(fa->fa_type, mask, fi);
19baf839 2458
cb7b593c
SH
2459 if (fa->fa_type == RTN_BROADCAST
2460 || fa->fa_type == RTN_MULTICAST)
2461 continue;
19baf839 2462
cb7b593c
SH
2463 if (fi)
2464 snprintf(bf, sizeof(bf),
2465 "%s\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2466 fi->fib_dev ? fi->fib_dev->name : "*",
2467 prefix,
2468 fi->fib_nh->nh_gw, flags, 0, 0,
2469 fi->fib_priority,
2470 mask,
2471 (fi->fib_advmss ? fi->fib_advmss + 40 : 0),
2472 fi->fib_window,
2473 fi->fib_rtt >> 3);
2474 else
2475 snprintf(bf, sizeof(bf),
2476 "*\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2477 prefix, 0, flags, 0, 0, 0,
2478 mask, 0, 0, 0);
19baf839 2479
cb7b593c
SH
2480 seq_printf(seq, "%-127s\n", bf);
2481 }
19baf839
RO
2482 }
2483
2484 return 0;
2485}
2486
f690808e 2487static const struct seq_operations fib_route_seq_ops = {
cb7b593c
SH
2488 .start = fib_trie_seq_start,
2489 .next = fib_trie_seq_next,
2490 .stop = fib_trie_seq_stop,
2491 .show = fib_route_seq_show,
19baf839
RO
2492};
2493
cb7b593c 2494static int fib_route_seq_open(struct inode *inode, struct file *file)
19baf839 2495{
1c340b2f
DL
2496 return seq_open_net(inode, file, &fib_route_seq_ops,
2497 sizeof(struct fib_trie_iter));
19baf839
RO
2498}
2499
9a32144e 2500static const struct file_operations fib_route_fops = {
cb7b593c
SH
2501 .owner = THIS_MODULE,
2502 .open = fib_route_seq_open,
2503 .read = seq_read,
2504 .llseek = seq_lseek,
1c340b2f 2505 .release = seq_release_net,
19baf839
RO
2506};
2507
61a02653 2508int __net_init fib_proc_init(struct net *net)
19baf839 2509{
61a02653 2510 if (!proc_net_fops_create(net, "fib_trie", S_IRUGO, &fib_trie_fops))
cb7b593c
SH
2511 goto out1;
2512
61a02653
DL
2513 if (!proc_net_fops_create(net, "fib_triestat", S_IRUGO,
2514 &fib_triestat_fops))
cb7b593c
SH
2515 goto out2;
2516
61a02653 2517 if (!proc_net_fops_create(net, "route", S_IRUGO, &fib_route_fops))
cb7b593c
SH
2518 goto out3;
2519
19baf839 2520 return 0;
cb7b593c
SH
2521
2522out3:
61a02653 2523 proc_net_remove(net, "fib_triestat");
cb7b593c 2524out2:
61a02653 2525 proc_net_remove(net, "fib_trie");
cb7b593c
SH
2526out1:
2527 return -ENOMEM;
19baf839
RO
2528}
2529
61a02653 2530void __net_exit fib_proc_exit(struct net *net)
19baf839 2531{
61a02653
DL
2532 proc_net_remove(net, "fib_trie");
2533 proc_net_remove(net, "fib_triestat");
2534 proc_net_remove(net, "route");
19baf839
RO
2535}
2536
2537#endif /* CONFIG_PROC_FS */
This page took 0.48096 seconds and 5 git commands to generate.