blob: da6681ddc509882e184128f266e6c53ec416dac7 [file] [log] [blame]
Robert Olsson19baf832005-06-21 12:43:18 -07001/*
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 *
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090010 * Jens Laas <jens.laas@data.slu.se> Swedish University of
Robert Olsson19baf832005-06-21 12:43:18 -070011 * Agricultural Sciences.
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090012 *
Robert Olsson19baf832005-06-21 12:43:18 -070013 * Hans Liss <hans.liss@its.uu.se> Uppsala Universitet
14 *
15 * This work is based on the LPC-trie which is originally descibed in:
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090016 *
Robert Olsson19baf832005-06-21 12:43:18 -070017 * 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.
Robert Olssonfd966252005-12-22 11:25:10 -080044 *
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>
Robert Olsson19baf832005-06-21 12:43:18 -070051 */
52
Robert Olsson05eee482007-03-19 16:27:37 -070053#define VERSION "0.408"
Robert Olsson19baf832005-06-21 12:43:18 -070054
Robert Olsson19baf832005-06-21 12:43:18 -070055#include <asm/uaccess.h>
56#include <asm/system.h>
Jiri Slaby1977f032007-10-18 23:40:25 -070057#include <linux/bitops.h>
Robert Olsson19baf832005-06-21 12:43:18 -070058#include <linux/types.h>
59#include <linux/kernel.h>
Robert Olsson19baf832005-06-21 12:43:18 -070060#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>
Stephen Hemmingercd8787a2006-01-03 14:38:34 -080067#include <linux/inetdevice.h>
Robert Olsson19baf832005-06-21 12:43:18 -070068#include <linux/netdevice.h>
69#include <linux/if_arp.h>
70#include <linux/proc_fs.h>
Robert Olsson2373ce12005-08-25 13:01:29 -070071#include <linux/rcupdate.h>
Robert Olsson19baf832005-06-21 12:43:18 -070072#include <linux/skbuff.h>
73#include <linux/netlink.h>
74#include <linux/init.h>
75#include <linux/list.h>
Eric W. Biederman457c4cb2007-09-12 12:01:34 +020076#include <net/net_namespace.h>
Robert Olsson19baf832005-06-21 12:43:18 -070077#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
Robert Olsson06ef9212006-03-20 21:35:01 -080085#define MAX_STAT_DEPTH 32
Robert Olsson19baf832005-06-21 12:43:18 -070086
Robert Olsson19baf832005-06-21 12:43:18 -070087#define KEYLENGTH (8*sizeof(t_key))
Robert Olsson19baf832005-06-21 12:43:18 -070088
Robert Olsson19baf832005-06-21 12:43:18 -070089typedef unsigned int t_key;
90
91#define T_TNODE 0
92#define T_LEAF 1
93#define NODE_TYPE_MASK 0x1UL
Robert Olsson2373ce12005-08-25 13:01:29 -070094#define NODE_TYPE(node) ((node)->parent & NODE_TYPE_MASK)
95
Olof Johansson91b9a272005-08-09 20:24:39 -070096#define IS_TNODE(n) (!(n->parent & T_LEAF))
97#define IS_LEAF(n) (n->parent & T_LEAF)
Robert Olsson19baf832005-06-21 12:43:18 -070098
99struct node {
Olof Johansson91b9a272005-08-09 20:24:39 -0700100 t_key key;
101 unsigned long parent;
Robert Olsson19baf832005-06-21 12:43:18 -0700102};
103
104struct leaf {
Olof Johansson91b9a272005-08-09 20:24:39 -0700105 t_key key;
106 unsigned long parent;
Robert Olsson19baf832005-06-21 12:43:18 -0700107 struct hlist_head list;
Robert Olsson2373ce12005-08-25 13:01:29 -0700108 struct rcu_head rcu;
Robert Olsson19baf832005-06-21 12:43:18 -0700109};
110
111struct leaf_info {
112 struct hlist_node hlist;
Robert Olsson2373ce12005-08-25 13:01:29 -0700113 struct rcu_head rcu;
Robert Olsson19baf832005-06-21 12:43:18 -0700114 int plen;
115 struct list_head falh;
116};
117
118struct tnode {
Olof Johansson91b9a272005-08-09 20:24:39 -0700119 t_key key;
120 unsigned long parent;
Eric Dumazet112d8cf2008-01-12 21:27:41 -0800121 unsigned char pos; /* 2log(KEYLENGTH) bits needed */
122 unsigned char bits; /* 2log(KEYLENGTH) bits needed */
Olof Johansson91b9a272005-08-09 20:24:39 -0700123 unsigned short full_children; /* KEYLENGTH bits needed */
124 unsigned short empty_children; /* KEYLENGTH bits needed */
Robert Olsson2373ce12005-08-25 13:01:29 -0700125 struct rcu_head rcu;
Olof Johansson91b9a272005-08-09 20:24:39 -0700126 struct node *child[0];
Robert Olsson19baf832005-06-21 12:43:18 -0700127};
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;
Robert Olsson2f368952005-07-05 15:02:40 -0700136 unsigned int resize_node_skipped;
Robert Olsson19baf832005-06-21 12:43:18 -0700137};
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;
Robert Olsson06ef9212006-03-20 21:35:01 -0800146 unsigned int nodesizes[MAX_STAT_DEPTH];
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700147};
Robert Olsson19baf832005-06-21 12:43:18 -0700148
149struct trie {
Olof Johansson91b9a272005-08-09 20:24:39 -0700150 struct node *trie;
Robert Olsson19baf832005-06-21 12:43:18 -0700151#ifdef CONFIG_IP_FIB_TRIE_STATS
152 struct trie_use_stats stats;
153#endif
Olof Johansson91b9a272005-08-09 20:24:39 -0700154 int size;
Robert Olsson19baf832005-06-21 12:43:18 -0700155};
156
Robert Olsson19baf832005-06-21 12:43:18 -0700157static 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);
Robert Olsson19baf832005-06-21 12:43:18 -0700159static struct node *resize(struct trie *t, struct tnode *tn);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700160static struct tnode *inflate(struct trie *t, struct tnode *tn);
161static struct tnode *halve(struct trie *t, struct tnode *tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700162static void tnode_free(struct tnode *tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700163
Christoph Lametere18b8902006-12-06 20:33:20 -0800164static struct kmem_cache *fn_alias_kmem __read_mostly;
Robert Olsson19baf832005-06-21 12:43:18 -0700165
Stephen Hemminger06801912007-08-10 15:22:13 -0700166static 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}
Robert Olsson2373ce12005-08-25 13:01:29 -0700179
180/* rcu_read_lock needs to be hold by caller from readside */
181
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700182static inline struct node *tnode_get_child(struct tnode *tn, int i)
Robert Olsson19baf832005-06-21 12:43:18 -0700183{
Olof Johansson91b9a272005-08-09 20:24:39 -0700184 BUG_ON(i >= 1 << tn->bits);
Robert Olsson19baf832005-06-21 12:43:18 -0700185
Robert Olsson2373ce12005-08-25 13:01:29 -0700186 return rcu_dereference(tn->child[i]);
Robert Olsson19baf832005-06-21 12:43:18 -0700187}
188
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700189static inline int tnode_child_length(const struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700190{
Olof Johansson91b9a272005-08-09 20:24:39 -0700191 return 1 << tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -0700192}
193
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700194static inline t_key mask_pfx(t_key k, unsigned short l)
195{
196 return (l == 0) ? 0 : k >> (KEYLENGTH-l) << (KEYLENGTH-l);
197}
198
Robert Olsson19baf832005-06-21 12:43:18 -0700199static inline t_key tkey_extract_bits(t_key a, int offset, int bits)
200{
Olof Johansson91b9a272005-08-09 20:24:39 -0700201 if (offset < KEYLENGTH)
Robert Olsson19baf832005-06-21 12:43:18 -0700202 return ((t_key)(a << offset)) >> (KEYLENGTH - bits);
Olof Johansson91b9a272005-08-09 20:24:39 -0700203 else
Robert Olsson19baf832005-06-21 12:43:18 -0700204 return 0;
205}
206
207static inline int tkey_equals(t_key a, t_key b)
208{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700209 return a == b;
Robert Olsson19baf832005-06-21 12:43:18 -0700210}
211
212static inline int tkey_sub_equals(t_key a, int offset, int bits, t_key b)
213{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700214 if (bits == 0 || offset >= KEYLENGTH)
215 return 1;
Olof Johansson91b9a272005-08-09 20:24:39 -0700216 bits = bits > KEYLENGTH ? KEYLENGTH : bits;
217 return ((a ^ b) << offset) >> (KEYLENGTH - bits) == 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700218}
Robert Olsson19baf832005-06-21 12:43:18 -0700219
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
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700225 if (!diff)
226 return 0;
227 while ((diff << i) >> (KEYLENGTH-1) == 0)
Robert Olsson19baf832005-06-21 12:43:18 -0700228 i++;
229 return i;
230}
231
Robert Olsson19baf832005-06-21 12:43:18 -0700232/*
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900233 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
Robert Olsson19baf832005-06-21 12:43:18 -0700235 all of the bits in that key are significant.
236
237 Consider a node 'n' and its parent 'tp'.
238
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900239 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
Robert Olsson19baf832005-06-21 12:43:18 -0700244 correct key path.
245
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900246 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
Robert Olsson19baf832005-06-21 12:43:18 -0700251 call to tkey_sub_equals() in trie_insert().
252
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900253 if n is an internal node - a 'tnode' here, the various parts of its key
Robert Olsson19baf832005-06-21 12:43:18 -0700254 have many different meanings.
255
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900256 Example:
Robert Olsson19baf832005-06-21 12:43:18 -0700257 _________________________________________________________________
258 | i | i | i | i | i | i | i | N | N | N | S | S | S | S | S | C |
259 -----------------------------------------------------------------
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900260 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
Robert Olsson19baf832005-06-21 12:43:18 -0700261
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
Olof Johansson91b9a272005-08-09 20:24:39 -0700270 n->bits = 4
Robert Olsson19baf832005-06-21 12:43:18 -0700271
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900272 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
Robert Olsson19baf832005-06-21 12:43:18 -0700274 not use them for anything.
275
276 The bits from (tp->pos) to (tp->pos + tp->bits - 1) - "N", above - are the
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900277 index into the parent's child array. That is, they will be used to find
Robert Olsson19baf832005-06-21 12:43:18 -0700278 '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
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900283 All the bits we have seen so far are significant to the node n. The rest
Robert Olsson19baf832005-06-21 12:43:18 -0700284 of the bits are really not needed or indeed known in n->key.
285
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900286 The bits from (n->pos) to (n->pos + n->bits - 1) - "C" - are the index into
Robert Olsson19baf832005-06-21 12:43:18 -0700287 n's child array, and will of course be different for each child.
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900288
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700289
Robert Olsson19baf832005-06-21 12:43:18 -0700290 The rest of the bits, from (n->pos + n->bits) onward, are completely unknown
291 at this point.
292
293*/
294
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700295static inline void check_tnode(const struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700296{
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700297 WARN_ON(tn && tn->pos+tn->bits > 32);
Robert Olsson19baf832005-06-21 12:43:18 -0700298}
299
Denis V. Lunevf5026fa2007-12-13 09:47:57 -0800300static 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;
Robert Olsson19baf832005-06-21 12:43:18 -0700304
Robert Olsson2373ce12005-08-25 13:01:29 -0700305
306static void __alias_free_mem(struct rcu_head *head)
307{
308 struct fib_alias *fa = container_of(head, struct fib_alias, rcu);
309 kmem_cache_free(fn_alias_kmem, fa);
310}
311
312static inline void alias_free_mem_rcu(struct fib_alias *fa)
313{
314 call_rcu(&fa->rcu, __alias_free_mem);
315}
316
317static void __leaf_free_rcu(struct rcu_head *head)
318{
319 kfree(container_of(head, struct leaf, rcu));
320}
321
Robert Olsson2373ce12005-08-25 13:01:29 -0700322static void __leaf_info_free_rcu(struct rcu_head *head)
323{
324 kfree(container_of(head, struct leaf_info, rcu));
325}
326
327static inline void free_leaf_info(struct leaf_info *leaf)
328{
329 call_rcu(&leaf->rcu, __leaf_info_free_rcu);
330}
331
332static struct tnode *tnode_alloc(unsigned int size)
333{
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);
344}
345
346static void __tnode_free_rcu(struct rcu_head *head)
347{
348 struct tnode *tn = container_of(head, struct tnode, rcu);
349 unsigned int size = sizeof(struct tnode) +
350 (1 << tn->bits) * sizeof(struct node *);
351
352 if (size <= PAGE_SIZE)
353 kfree(tn);
354 else
355 free_pages((unsigned long)tn, get_order(size));
356}
357
358static inline void tnode_free(struct tnode *tn)
359{
Stephen Hemminger132adf52007-03-08 20:44:43 -0800360 if (IS_LEAF(tn)) {
Robert Olsson550e29b2006-04-04 12:53:35 -0700361 struct leaf *l = (struct leaf *) tn;
362 call_rcu_bh(&l->rcu, __leaf_free_rcu);
Stephen Hemminger132adf52007-03-08 20:44:43 -0800363 } else
Robert Olsson550e29b2006-04-04 12:53:35 -0700364 call_rcu(&tn->rcu, __tnode_free_rcu);
Robert Olsson2373ce12005-08-25 13:01:29 -0700365}
366
Robert Olsson19baf832005-06-21 12:43:18 -0700367static struct leaf *leaf_new(void)
368{
369 struct leaf *l = kmalloc(sizeof(struct leaf), GFP_KERNEL);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700370 if (l) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700371 l->parent = T_LEAF;
Robert Olsson19baf832005-06-21 12:43:18 -0700372 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);
Robert Olsson2373ce12005-08-25 13:01:29 -0700380 if (li) {
381 li->plen = plen;
382 INIT_LIST_HEAD(&li->falh);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700383 }
Robert Olsson2373ce12005-08-25 13:01:29 -0700384 return li;
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700385}
386
Robert Olsson19baf832005-06-21 12:43:18 -0700387static 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 *);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700391 struct tnode *tn = tnode_alloc(sz);
Robert Olsson19baf832005-06-21 12:43:18 -0700392
Olof Johansson91b9a272005-08-09 20:24:39 -0700393 if (tn) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700394 tn->parent = T_TNODE;
Robert Olsson19baf832005-06-21 12:43:18 -0700395 tn->pos = pos;
396 tn->bits = bits;
397 tn->key = key;
398 tn->full_children = 0;
399 tn->empty_children = 1<<bits;
400 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700401
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700402 pr_debug("AT %p s=%u %u\n", tn, (unsigned int) sizeof(struct tnode),
403 (unsigned int) (sizeof(struct node) * 1<<bits));
Robert Olsson19baf832005-06-21 12:43:18 -0700404 return tn;
405}
406
Robert Olsson19baf832005-06-21 12:43:18 -0700407/*
408 * Check whether a tnode 'n' is "full", i.e. it is an internal node
409 * and no bits are skipped. See discussion in dyntree paper p. 6
410 */
411
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700412static inline int tnode_full(const struct tnode *tn, const struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700413{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700414 if (n == NULL || IS_LEAF(n))
Robert Olsson19baf832005-06-21 12:43:18 -0700415 return 0;
416
417 return ((struct tnode *) n)->pos == tn->pos + tn->bits;
418}
419
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700420static inline void put_child(struct trie *t, struct tnode *tn, int i, struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700421{
422 tnode_put_child_reorg(tn, i, n, -1);
423}
424
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700425 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700426 * Add a child at position i overwriting the old value.
427 * Update the value of full_children and empty_children.
428 */
429
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700430static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n, int wasfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700431{
Robert Olsson2373ce12005-08-25 13:01:29 -0700432 struct node *chi = tn->child[i];
Robert Olsson19baf832005-06-21 12:43:18 -0700433 int isfull;
434
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700435 BUG_ON(i >= 1<<tn->bits);
436
Robert Olsson19baf832005-06-21 12:43:18 -0700437
438 /* update emptyChildren */
439 if (n == NULL && chi != NULL)
440 tn->empty_children++;
441 else if (n != NULL && chi == NULL)
442 tn->empty_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700443
Robert Olsson19baf832005-06-21 12:43:18 -0700444 /* update fullChildren */
Olof Johansson91b9a272005-08-09 20:24:39 -0700445 if (wasfull == -1)
Robert Olsson19baf832005-06-21 12:43:18 -0700446 wasfull = tnode_full(tn, chi);
447
448 isfull = tnode_full(tn, n);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700449 if (wasfull && !isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700450 tn->full_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700451 else if (!wasfull && isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700452 tn->full_children++;
Olof Johansson91b9a272005-08-09 20:24:39 -0700453
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700454 if (n)
Stephen Hemminger06801912007-08-10 15:22:13 -0700455 node_set_parent(n, tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700456
Robert Olsson2373ce12005-08-25 13:01:29 -0700457 rcu_assign_pointer(tn->child[i], n);
Robert Olsson19baf832005-06-21 12:43:18 -0700458}
459
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700460static struct node *resize(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700461{
462 int i;
Robert Olsson2f368952005-07-05 15:02:40 -0700463 int err = 0;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700464 struct tnode *old_tn;
Robert Olssone6308be2005-10-04 13:01:58 -0700465 int inflate_threshold_use;
466 int halve_threshold_use;
Robert Olsson05eee482007-03-19 16:27:37 -0700467 int max_resize;
Robert Olsson19baf832005-06-21 12:43:18 -0700468
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900469 if (!tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700470 return NULL;
471
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700472 pr_debug("In tnode_resize %p inflate_threshold=%d threshold=%d\n",
473 tn, inflate_threshold, halve_threshold);
Robert Olsson19baf832005-06-21 12:43:18 -0700474
475 /* No children */
476 if (tn->empty_children == tnode_child_length(tn)) {
477 tnode_free(tn);
478 return NULL;
479 }
480 /* One child */
481 if (tn->empty_children == tnode_child_length(tn) - 1)
482 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700483 struct node *n;
Robert Olsson19baf832005-06-21 12:43:18 -0700484
Olof Johansson91b9a272005-08-09 20:24:39 -0700485 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700486 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700487 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700488
489 /* compress one level */
Stephen Hemminger06801912007-08-10 15:22:13 -0700490 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700491 tnode_free(tn);
492 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700493 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700494 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700495 * Double as long as the resulting node has a number of
496 * nonempty nodes that are above the threshold.
497 */
498
499 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700500 * From "Implementing a dynamic compressed trie" by Stefan Nilsson of
501 * the Helsinki University of Technology and Matti Tikkanen of Nokia
Robert Olsson19baf832005-06-21 12:43:18 -0700502 * Telecommunications, page 6:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700503 * "A node is doubled if the ratio of non-empty children to all
Robert Olsson19baf832005-06-21 12:43:18 -0700504 * children in the *doubled* node is at least 'high'."
505 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700506 * 'high' in this instance is the variable 'inflate_threshold'. It
507 * is expressed as a percentage, so we multiply it with
508 * tnode_child_length() and instead of multiplying by 2 (since the
509 * child array will be doubled by inflate()) and multiplying
510 * the left-hand side by 100 (to handle the percentage thing) we
Robert Olsson19baf832005-06-21 12:43:18 -0700511 * multiply the left-hand side by 50.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700512 *
513 * The left-hand side may look a bit weird: tnode_child_length(tn)
514 * - tn->empty_children is of course the number of non-null children
515 * in the current node. tn->full_children is the number of "full"
Robert Olsson19baf832005-06-21 12:43:18 -0700516 * children, that is non-null tnodes with a skip value of 0.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700517 * All of those will be doubled in the resulting inflated tnode, so
Robert Olsson19baf832005-06-21 12:43:18 -0700518 * we just count them one extra time here.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700519 *
Robert Olsson19baf832005-06-21 12:43:18 -0700520 * A clearer way to write this would be:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700521 *
Robert Olsson19baf832005-06-21 12:43:18 -0700522 * to_be_doubled = tn->full_children;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700523 * not_to_be_doubled = tnode_child_length(tn) - tn->empty_children -
Robert Olsson19baf832005-06-21 12:43:18 -0700524 * tn->full_children;
525 *
526 * new_child_length = tnode_child_length(tn) * 2;
527 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700528 * new_fill_factor = 100 * (not_to_be_doubled + 2*to_be_doubled) /
Robert Olsson19baf832005-06-21 12:43:18 -0700529 * new_child_length;
530 * if (new_fill_factor >= inflate_threshold)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700531 *
532 * ...and so on, tho it would mess up the while () loop.
533 *
Robert Olsson19baf832005-06-21 12:43:18 -0700534 * anyway,
535 * 100 * (not_to_be_doubled + 2*to_be_doubled) / new_child_length >=
536 * inflate_threshold
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700537 *
Robert Olsson19baf832005-06-21 12:43:18 -0700538 * avoid a division:
539 * 100 * (not_to_be_doubled + 2*to_be_doubled) >=
540 * inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700541 *
Robert Olsson19baf832005-06-21 12:43:18 -0700542 * expand not_to_be_doubled and to_be_doubled, and shorten:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700543 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700544 * tn->full_children) >= inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700545 *
Robert Olsson19baf832005-06-21 12:43:18 -0700546 * expand new_child_length:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700547 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700548 * tn->full_children) >=
Robert Olsson19baf832005-06-21 12:43:18 -0700549 * inflate_threshold * tnode_child_length(tn) * 2
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700550 *
Robert Olsson19baf832005-06-21 12:43:18 -0700551 * shorten again:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700552 * 50 * (tn->full_children + tnode_child_length(tn) -
Olof Johansson91b9a272005-08-09 20:24:39 -0700553 * tn->empty_children) >= inflate_threshold *
Robert Olsson19baf832005-06-21 12:43:18 -0700554 * tnode_child_length(tn)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700555 *
Robert Olsson19baf832005-06-21 12:43:18 -0700556 */
557
558 check_tnode(tn);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700559
Robert Olssone6308be2005-10-04 13:01:58 -0700560 /* Keep root node larger */
561
Stephen Hemminger132adf52007-03-08 20:44:43 -0800562 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700563 inflate_threshold_use = inflate_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900564 else
Robert Olssone6308be2005-10-04 13:01:58 -0700565 inflate_threshold_use = inflate_threshold;
566
Robert Olsson2f368952005-07-05 15:02:40 -0700567 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700568 max_resize = 10;
569 while ((tn->full_children > 0 && max_resize-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700570 50 * (tn->full_children + tnode_child_length(tn) - tn->empty_children) >=
Robert Olssone6308be2005-10-04 13:01:58 -0700571 inflate_threshold_use * tnode_child_length(tn))) {
Robert Olsson19baf832005-06-21 12:43:18 -0700572
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700573 old_tn = tn;
574 tn = inflate(t, tn);
575 if (IS_ERR(tn)) {
576 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700577#ifdef CONFIG_IP_FIB_TRIE_STATS
578 t->stats.resize_node_skipped++;
579#endif
580 break;
581 }
Robert Olsson19baf832005-06-21 12:43:18 -0700582 }
583
Robert Olsson05eee482007-03-19 16:27:37 -0700584 if (max_resize < 0) {
585 if (!tn->parent)
586 printk(KERN_WARNING "Fix inflate_threshold_root. Now=%d size=%d bits\n",
587 inflate_threshold_root, tn->bits);
588 else
589 printk(KERN_WARNING "Fix inflate_threshold. Now=%d size=%d bits\n",
590 inflate_threshold, tn->bits);
591 }
592
Robert Olsson19baf832005-06-21 12:43:18 -0700593 check_tnode(tn);
594
595 /*
596 * Halve as long as the number of empty children in this
597 * node is above threshold.
598 */
Robert Olsson2f368952005-07-05 15:02:40 -0700599
Robert Olssone6308be2005-10-04 13:01:58 -0700600
601 /* Keep root node larger */
602
Stephen Hemminger132adf52007-03-08 20:44:43 -0800603 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700604 halve_threshold_use = halve_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900605 else
Robert Olssone6308be2005-10-04 13:01:58 -0700606 halve_threshold_use = halve_threshold;
607
Robert Olsson2f368952005-07-05 15:02:40 -0700608 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700609 max_resize = 10;
610 while (tn->bits > 1 && max_resize-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700611 100 * (tnode_child_length(tn) - tn->empty_children) <
Robert Olssone6308be2005-10-04 13:01:58 -0700612 halve_threshold_use * tnode_child_length(tn)) {
Robert Olsson19baf832005-06-21 12:43:18 -0700613
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700614 old_tn = tn;
615 tn = halve(t, tn);
616 if (IS_ERR(tn)) {
617 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700618#ifdef CONFIG_IP_FIB_TRIE_STATS
619 t->stats.resize_node_skipped++;
620#endif
621 break;
622 }
623 }
624
Robert Olsson05eee482007-03-19 16:27:37 -0700625 if (max_resize < 0) {
626 if (!tn->parent)
627 printk(KERN_WARNING "Fix halve_threshold_root. Now=%d size=%d bits\n",
628 halve_threshold_root, tn->bits);
629 else
630 printk(KERN_WARNING "Fix halve_threshold. Now=%d size=%d bits\n",
631 halve_threshold, tn->bits);
632 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700633
Robert Olsson19baf832005-06-21 12:43:18 -0700634 /* Only one child remains */
Robert Olsson19baf832005-06-21 12:43:18 -0700635 if (tn->empty_children == tnode_child_length(tn) - 1)
636 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700637 struct node *n;
638
Olof Johansson91b9a272005-08-09 20:24:39 -0700639 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700640 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700641 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700642
643 /* compress one level */
644
Stephen Hemminger06801912007-08-10 15:22:13 -0700645 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700646 tnode_free(tn);
647 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700648 }
649
650 return (struct node *) tn;
651}
652
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700653static struct tnode *inflate(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700654{
Robert Olsson19baf832005-06-21 12:43:18 -0700655 struct tnode *oldtnode = tn;
656 int olen = tnode_child_length(tn);
657 int i;
658
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700659 pr_debug("In inflate\n");
Robert Olsson19baf832005-06-21 12:43:18 -0700660
661 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits + 1);
662
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700663 if (!tn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700664 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700665
666 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700667 * Preallocate and store tnodes before the actual work so we
668 * don't get into an inconsistent state if memory allocation
669 * fails. In case of failure we return the oldnode and inflate
Robert Olsson2f368952005-07-05 15:02:40 -0700670 * of tnode is ignored.
671 */
Olof Johansson91b9a272005-08-09 20:24:39 -0700672
673 for (i = 0; i < olen; i++) {
Robert Olsson2f368952005-07-05 15:02:40 -0700674 struct tnode *inode = (struct tnode *) tnode_get_child(oldtnode, i);
675
676 if (inode &&
677 IS_TNODE(inode) &&
678 inode->pos == oldtnode->pos + oldtnode->bits &&
679 inode->bits > 1) {
680 struct tnode *left, *right;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700681 t_key m = ~0U << (KEYLENGTH - 1) >> inode->pos;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700682
Robert Olsson2f368952005-07-05 15:02:40 -0700683 left = tnode_new(inode->key&(~m), inode->pos + 1,
684 inode->bits - 1);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700685 if (!left)
686 goto nomem;
Olof Johansson91b9a272005-08-09 20:24:39 -0700687
Robert Olsson2f368952005-07-05 15:02:40 -0700688 right = tnode_new(inode->key|m, inode->pos + 1,
689 inode->bits - 1);
690
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900691 if (!right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700692 tnode_free(left);
693 goto nomem;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900694 }
Robert Olsson2f368952005-07-05 15:02:40 -0700695
696 put_child(t, tn, 2*i, (struct node *) left);
697 put_child(t, tn, 2*i+1, (struct node *) right);
698 }
699 }
700
Olof Johansson91b9a272005-08-09 20:24:39 -0700701 for (i = 0; i < olen; i++) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -0800702 struct tnode *inode;
Robert Olsson19baf832005-06-21 12:43:18 -0700703 struct node *node = tnode_get_child(oldtnode, i);
Olof Johansson91b9a272005-08-09 20:24:39 -0700704 struct tnode *left, *right;
705 int size, j;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700706
Robert Olsson19baf832005-06-21 12:43:18 -0700707 /* An empty child */
708 if (node == NULL)
709 continue;
710
711 /* A leaf or an internal node with skipped bits */
712
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700713 if (IS_LEAF(node) || ((struct tnode *) node)->pos >
Robert Olsson19baf832005-06-21 12:43:18 -0700714 tn->pos + tn->bits - 1) {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700715 if (tkey_extract_bits(node->key, oldtnode->pos + oldtnode->bits,
Robert Olsson19baf832005-06-21 12:43:18 -0700716 1) == 0)
717 put_child(t, tn, 2*i, node);
718 else
719 put_child(t, tn, 2*i+1, node);
720 continue;
721 }
722
723 /* An internal node with two children */
724 inode = (struct tnode *) node;
725
726 if (inode->bits == 1) {
727 put_child(t, tn, 2*i, inode->child[0]);
728 put_child(t, tn, 2*i+1, inode->child[1]);
729
730 tnode_free(inode);
Olof Johansson91b9a272005-08-09 20:24:39 -0700731 continue;
Robert Olsson19baf832005-06-21 12:43:18 -0700732 }
733
Olof Johansson91b9a272005-08-09 20:24:39 -0700734 /* An internal node with more than two children */
Robert Olsson19baf832005-06-21 12:43:18 -0700735
Olof Johansson91b9a272005-08-09 20:24:39 -0700736 /* We will replace this node 'inode' with two new
737 * ones, 'left' and 'right', each with half of the
738 * original children. The two new nodes will have
739 * a position one bit further down the key and this
740 * means that the "significant" part of their keys
741 * (see the discussion near the top of this file)
742 * will differ by one bit, which will be "0" in
743 * left's key and "1" in right's key. Since we are
744 * moving the key position by one step, the bit that
745 * we are moving away from - the bit at position
746 * (inode->pos) - is the one that will differ between
747 * left and right. So... we synthesize that bit in the
748 * two new keys.
749 * The mask 'm' below will be a single "one" bit at
750 * the position (inode->pos)
751 */
Robert Olsson19baf832005-06-21 12:43:18 -0700752
Olof Johansson91b9a272005-08-09 20:24:39 -0700753 /* Use the old key, but set the new significant
754 * bit to zero.
755 */
Robert Olsson19baf832005-06-21 12:43:18 -0700756
Olof Johansson91b9a272005-08-09 20:24:39 -0700757 left = (struct tnode *) tnode_get_child(tn, 2*i);
758 put_child(t, tn, 2*i, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -0700759
Olof Johansson91b9a272005-08-09 20:24:39 -0700760 BUG_ON(!left);
Robert Olsson2f368952005-07-05 15:02:40 -0700761
Olof Johansson91b9a272005-08-09 20:24:39 -0700762 right = (struct tnode *) tnode_get_child(tn, 2*i+1);
763 put_child(t, tn, 2*i+1, NULL);
Robert Olsson2f368952005-07-05 15:02:40 -0700764
Olof Johansson91b9a272005-08-09 20:24:39 -0700765 BUG_ON(!right);
Robert Olsson2f368952005-07-05 15:02:40 -0700766
Olof Johansson91b9a272005-08-09 20:24:39 -0700767 size = tnode_child_length(left);
768 for (j = 0; j < size; j++) {
769 put_child(t, left, j, inode->child[j]);
770 put_child(t, right, j, inode->child[j + size]);
Robert Olsson19baf832005-06-21 12:43:18 -0700771 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700772 put_child(t, tn, 2*i, resize(t, left));
773 put_child(t, tn, 2*i+1, resize(t, right));
774
775 tnode_free(inode);
Robert Olsson19baf832005-06-21 12:43:18 -0700776 }
777 tnode_free(oldtnode);
778 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700779nomem:
780 {
781 int size = tnode_child_length(tn);
782 int j;
783
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700784 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700785 if (tn->child[j])
786 tnode_free((struct tnode *)tn->child[j]);
787
788 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700789
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700790 return ERR_PTR(-ENOMEM);
791 }
Robert Olsson19baf832005-06-21 12:43:18 -0700792}
793
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700794static struct tnode *halve(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700795{
796 struct tnode *oldtnode = tn;
797 struct node *left, *right;
798 int i;
799 int olen = tnode_child_length(tn);
800
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700801 pr_debug("In halve\n");
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700802
803 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits - 1);
Robert Olsson19baf832005-06-21 12:43:18 -0700804
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700805 if (!tn)
806 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700807
808 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700809 * Preallocate and store tnodes before the actual work so we
810 * don't get into an inconsistent state if memory allocation
811 * fails. In case of failure we return the oldnode and halve
Robert Olsson2f368952005-07-05 15:02:40 -0700812 * of tnode is ignored.
813 */
814
Olof Johansson91b9a272005-08-09 20:24:39 -0700815 for (i = 0; i < olen; i += 2) {
Robert Olsson2f368952005-07-05 15:02:40 -0700816 left = tnode_get_child(oldtnode, i);
817 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700818
Robert Olsson2f368952005-07-05 15:02:40 -0700819 /* Two nonempty children */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700820 if (left && right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700821 struct tnode *newn;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700822
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700823 newn = tnode_new(left->key, tn->pos + tn->bits, 1);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700824
825 if (!newn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700826 goto nomem;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700827
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700828 put_child(t, tn, i/2, (struct node *)newn);
Robert Olsson2f368952005-07-05 15:02:40 -0700829 }
Robert Olsson2f368952005-07-05 15:02:40 -0700830
Robert Olsson2f368952005-07-05 15:02:40 -0700831 }
Robert Olsson19baf832005-06-21 12:43:18 -0700832
Olof Johansson91b9a272005-08-09 20:24:39 -0700833 for (i = 0; i < olen; i += 2) {
834 struct tnode *newBinNode;
835
Robert Olsson19baf832005-06-21 12:43:18 -0700836 left = tnode_get_child(oldtnode, i);
837 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700838
Robert Olsson19baf832005-06-21 12:43:18 -0700839 /* At least one of the children is empty */
840 if (left == NULL) {
841 if (right == NULL) /* Both are empty */
842 continue;
843 put_child(t, tn, i/2, right);
Olof Johansson91b9a272005-08-09 20:24:39 -0700844 continue;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700845 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700846
847 if (right == NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700848 put_child(t, tn, i/2, left);
Olof Johansson91b9a272005-08-09 20:24:39 -0700849 continue;
850 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700851
Robert Olsson19baf832005-06-21 12:43:18 -0700852 /* Two nonempty children */
Olof Johansson91b9a272005-08-09 20:24:39 -0700853 newBinNode = (struct tnode *) tnode_get_child(tn, i/2);
854 put_child(t, tn, i/2, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700855 put_child(t, newBinNode, 0, left);
856 put_child(t, newBinNode, 1, right);
857 put_child(t, tn, i/2, resize(t, newBinNode));
Robert Olsson19baf832005-06-21 12:43:18 -0700858 }
859 tnode_free(oldtnode);
860 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700861nomem:
862 {
863 int size = tnode_child_length(tn);
864 int j;
865
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700866 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700867 if (tn->child[j])
868 tnode_free((struct tnode *)tn->child[j]);
869
870 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700871
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700872 return ERR_PTR(-ENOMEM);
873 }
Robert Olsson19baf832005-06-21 12:43:18 -0700874}
875
Robert Olsson772cb712005-09-19 15:31:18 -0700876/* readside must use rcu_read_lock currently dump routines
Robert Olsson2373ce12005-08-25 13:01:29 -0700877 via get_fa_head and dump */
878
Robert Olsson772cb712005-09-19 15:31:18 -0700879static struct leaf_info *find_leaf_info(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700880{
Robert Olsson772cb712005-09-19 15:31:18 -0700881 struct hlist_head *head = &l->list;
Robert Olsson19baf832005-06-21 12:43:18 -0700882 struct hlist_node *node;
883 struct leaf_info *li;
884
Robert Olsson2373ce12005-08-25 13:01:29 -0700885 hlist_for_each_entry_rcu(li, node, head, hlist)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700886 if (li->plen == plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700887 return li;
Olof Johansson91b9a272005-08-09 20:24:39 -0700888
Robert Olsson19baf832005-06-21 12:43:18 -0700889 return NULL;
890}
891
892static inline struct list_head * get_fa_head(struct leaf *l, int plen)
893{
Robert Olsson772cb712005-09-19 15:31:18 -0700894 struct leaf_info *li = find_leaf_info(l, plen);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700895
Olof Johansson91b9a272005-08-09 20:24:39 -0700896 if (!li)
897 return NULL;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700898
Olof Johansson91b9a272005-08-09 20:24:39 -0700899 return &li->falh;
Robert Olsson19baf832005-06-21 12:43:18 -0700900}
901
902static void insert_leaf_info(struct hlist_head *head, struct leaf_info *new)
903{
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900904 struct leaf_info *li = NULL, *last = NULL;
905 struct hlist_node *node;
Robert Olsson19baf832005-06-21 12:43:18 -0700906
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900907 if (hlist_empty(head)) {
908 hlist_add_head_rcu(&new->hlist, head);
909 } else {
910 hlist_for_each_entry(li, node, head, hlist) {
911 if (new->plen > li->plen)
912 break;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700913
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900914 last = li;
915 }
916 if (last)
917 hlist_add_after_rcu(&last->hlist, &new->hlist);
918 else
919 hlist_add_before_rcu(&new->hlist, &li->hlist);
920 }
Robert Olsson19baf832005-06-21 12:43:18 -0700921}
922
Robert Olsson2373ce12005-08-25 13:01:29 -0700923/* rcu_read_lock needs to be hold by caller from readside */
924
Robert Olsson19baf832005-06-21 12:43:18 -0700925static struct leaf *
926fib_find_node(struct trie *t, u32 key)
927{
928 int pos;
929 struct tnode *tn;
930 struct node *n;
931
932 pos = 0;
Robert Olsson2373ce12005-08-25 13:01:29 -0700933 n = rcu_dereference(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -0700934
935 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
936 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -0700937
Robert Olsson19baf832005-06-21 12:43:18 -0700938 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700939
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700940 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700941 pos = tn->pos + tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -0700942 n = tnode_get_child(tn, tkey_extract_bits(key, tn->pos, tn->bits));
Olof Johansson91b9a272005-08-09 20:24:39 -0700943 } else
Robert Olsson19baf832005-06-21 12:43:18 -0700944 break;
945 }
946 /* Case we have found a leaf. Compare prefixes */
947
Olof Johansson91b9a272005-08-09 20:24:39 -0700948 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key))
949 return (struct leaf *)n;
950
Robert Olsson19baf832005-06-21 12:43:18 -0700951 return NULL;
952}
953
954static struct node *trie_rebalance(struct trie *t, struct tnode *tn)
955{
Robert Olsson19baf832005-06-21 12:43:18 -0700956 int wasfull;
Stephen Hemminger06801912007-08-10 15:22:13 -0700957 t_key cindex, key = tn->key;
958 struct tnode *tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700959
Stephen Hemminger06801912007-08-10 15:22:13 -0700960 while (tn != NULL && (tp = node_parent((struct node *)tn)) != NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700961 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
962 wasfull = tnode_full(tp, tnode_get_child(tp, cindex));
963 tn = (struct tnode *) resize (t, (struct tnode *)tn);
964 tnode_put_child_reorg((struct tnode *)tp, cindex,(struct node*)tn, wasfull);
Olof Johansson91b9a272005-08-09 20:24:39 -0700965
Stephen Hemminger06801912007-08-10 15:22:13 -0700966 tp = node_parent((struct node *) tn);
967 if (!tp)
Robert Olsson19baf832005-06-21 12:43:18 -0700968 break;
Stephen Hemminger06801912007-08-10 15:22:13 -0700969 tn = tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700970 }
Stephen Hemminger06801912007-08-10 15:22:13 -0700971
Robert Olsson19baf832005-06-21 12:43:18 -0700972 /* Handle last (top) tnode */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700973 if (IS_TNODE(tn))
Robert Olsson19baf832005-06-21 12:43:18 -0700974 tn = (struct tnode*) resize(t, (struct tnode *)tn);
975
976 return (struct node*) tn;
977}
978
Robert Olsson2373ce12005-08-25 13:01:29 -0700979/* only used from updater-side */
980
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -0800981static struct list_head *fib_insert_node(struct trie *t, u32 key, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700982{
983 int pos, newpos;
984 struct tnode *tp = NULL, *tn = NULL;
985 struct node *n;
986 struct leaf *l;
987 int missbit;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700988 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -0700989 struct leaf_info *li;
990 t_key cindex;
991
992 pos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700993 n = t->trie;
Robert Olsson19baf832005-06-21 12:43:18 -0700994
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700995 /* If we point to NULL, stop. Either the tree is empty and we should
996 * just put a new leaf in if, or we have reached an empty child slot,
Robert Olsson19baf832005-06-21 12:43:18 -0700997 * and we should just put our new leaf in that.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700998 * If we point to a T_TNODE, check if it matches our key. Note that
999 * a T_TNODE might be skipping any number of bits - its 'pos' need
Robert Olsson19baf832005-06-21 12:43:18 -07001000 * not be the parent's 'pos'+'bits'!
1001 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001002 * If it does match the current key, get pos/bits from it, extract
Robert Olsson19baf832005-06-21 12:43:18 -07001003 * the index from our key, push the T_TNODE and walk the tree.
1004 *
1005 * If it doesn't, we have to replace it with a new T_TNODE.
1006 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001007 * If we point to a T_LEAF, it might or might not have the same key
1008 * as we do. If it does, just change the value, update the T_LEAF's
1009 * value, and return it.
Robert Olsson19baf832005-06-21 12:43:18 -07001010 * If it doesn't, we need to replace it with a T_TNODE.
1011 */
1012
1013 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
1014 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -07001015
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001016 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001017
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001018 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001019 tp = tn;
Olof Johansson91b9a272005-08-09 20:24:39 -07001020 pos = tn->pos + tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001021 n = tnode_get_child(tn, tkey_extract_bits(key, tn->pos, tn->bits));
1022
Stephen Hemminger06801912007-08-10 15:22:13 -07001023 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001024 } else
Robert Olsson19baf832005-06-21 12:43:18 -07001025 break;
1026 }
1027
1028 /*
1029 * n ----> NULL, LEAF or TNODE
1030 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001031 * tp is n's (parent) ----> NULL or TNODE
Robert Olsson19baf832005-06-21 12:43:18 -07001032 */
1033
Olof Johansson91b9a272005-08-09 20:24:39 -07001034 BUG_ON(tp && IS_LEAF(tp));
Robert Olsson19baf832005-06-21 12:43:18 -07001035
1036 /* Case 1: n is a leaf. Compare prefixes */
1037
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001038 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key)) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08001039 l = (struct leaf *) n;
Robert Olsson19baf832005-06-21 12:43:18 -07001040 li = leaf_info_new(plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001041
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001042 if (!li)
1043 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001044
1045 fa_head = &li->falh;
1046 insert_leaf_info(&l->list, li);
1047 goto done;
1048 }
1049 t->size++;
1050 l = leaf_new();
1051
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001052 if (!l)
1053 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001054
1055 l->key = key;
1056 li = leaf_info_new(plen);
1057
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001058 if (!li) {
Robert Olssonf835e472005-06-28 15:00:39 -07001059 tnode_free((struct tnode *) l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001060 return NULL;
Robert Olssonf835e472005-06-28 15:00:39 -07001061 }
Robert Olsson19baf832005-06-21 12:43:18 -07001062
1063 fa_head = &li->falh;
1064 insert_leaf_info(&l->list, li);
1065
Robert Olsson19baf832005-06-21 12:43:18 -07001066 if (t->trie && n == NULL) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001067 /* Case 2: n is NULL, and will just insert a new leaf */
Robert Olsson19baf832005-06-21 12:43:18 -07001068
Stephen Hemminger06801912007-08-10 15:22:13 -07001069 node_set_parent((struct node *)l, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001070
Olof Johansson91b9a272005-08-09 20:24:39 -07001071 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1072 put_child(t, (struct tnode *)tp, cindex, (struct node *)l);
1073 } else {
1074 /* Case 3: n is a LEAF or a TNODE and the key doesn't match. */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001075 /*
1076 * Add a new tnode here
Robert Olsson19baf832005-06-21 12:43:18 -07001077 * first tnode need some special handling
1078 */
1079
1080 if (tp)
Olof Johansson91b9a272005-08-09 20:24:39 -07001081 pos = tp->pos+tp->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001082 else
Olof Johansson91b9a272005-08-09 20:24:39 -07001083 pos = 0;
1084
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001085 if (n) {
Robert Olsson19baf832005-06-21 12:43:18 -07001086 newpos = tkey_mismatch(key, pos, n->key);
1087 tn = tnode_new(n->key, newpos, 1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001088 } else {
Robert Olsson19baf832005-06-21 12:43:18 -07001089 newpos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001090 tn = tnode_new(key, newpos, 1); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001091 }
Robert Olsson19baf832005-06-21 12:43:18 -07001092
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001093 if (!tn) {
Robert Olssonf835e472005-06-28 15:00:39 -07001094 free_leaf_info(li);
1095 tnode_free((struct tnode *) l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001096 return NULL;
Olof Johansson91b9a272005-08-09 20:24:39 -07001097 }
1098
Stephen Hemminger06801912007-08-10 15:22:13 -07001099 node_set_parent((struct node *)tn, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001100
Olof Johansson91b9a272005-08-09 20:24:39 -07001101 missbit = tkey_extract_bits(key, newpos, 1);
Robert Olsson19baf832005-06-21 12:43:18 -07001102 put_child(t, tn, missbit, (struct node *)l);
1103 put_child(t, tn, 1-missbit, n);
1104
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001105 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001106 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1107 put_child(t, (struct tnode *)tp, cindex, (struct node *)tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001108 } else {
Robert Olsson2373ce12005-08-25 13:01:29 -07001109 rcu_assign_pointer(t->trie, (struct node *)tn); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001110 tp = tn;
1111 }
1112 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001113
1114 if (tp && tp->pos + tp->bits > 32)
Stephen Hemminger78c66712005-09-21 00:15:39 -07001115 printk(KERN_WARNING "fib_trie tp=%p pos=%d, bits=%d, key=%0x plen=%d\n",
Robert Olsson19baf832005-06-21 12:43:18 -07001116 tp, tp->pos, tp->bits, key, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001117
Robert Olsson19baf832005-06-21 12:43:18 -07001118 /* Rebalance the trie */
Robert Olsson2373ce12005-08-25 13:01:29 -07001119
1120 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Robert Olssonf835e472005-06-28 15:00:39 -07001121done:
Robert Olsson19baf832005-06-21 12:43:18 -07001122 return fa_head;
1123}
1124
Robert Olssond562f1f2007-03-26 14:22:22 -07001125/*
1126 * Caller must hold RTNL.
1127 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001128static int fn_trie_insert(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001129{
1130 struct trie *t = (struct trie *) tb->tb_data;
1131 struct fib_alias *fa, *new_fa;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001132 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001133 struct fib_info *fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001134 int plen = cfg->fc_dst_len;
1135 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001136 u32 key, mask;
1137 int err;
1138 struct leaf *l;
1139
1140 if (plen > 32)
1141 return -EINVAL;
1142
Thomas Graf4e902c52006-08-17 18:14:52 -07001143 key = ntohl(cfg->fc_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001144
Patrick McHardy2dfe55b2006-08-10 23:08:33 -07001145 pr_debug("Insert table=%u %08x/%d\n", tb->tb_id, key, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001146
Olof Johansson91b9a272005-08-09 20:24:39 -07001147 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001148
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001149 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001150 return -EINVAL;
1151
1152 key = key & mask;
1153
Thomas Graf4e902c52006-08-17 18:14:52 -07001154 fi = fib_create_info(cfg);
1155 if (IS_ERR(fi)) {
1156 err = PTR_ERR(fi);
Robert Olsson19baf832005-06-21 12:43:18 -07001157 goto err;
Thomas Graf4e902c52006-08-17 18:14:52 -07001158 }
Robert Olsson19baf832005-06-21 12:43:18 -07001159
1160 l = fib_find_node(t, key);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001161 fa = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001162
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001163 if (l) {
Robert Olsson19baf832005-06-21 12:43:18 -07001164 fa_head = get_fa_head(l, plen);
1165 fa = fib_find_alias(fa_head, tos, fi->fib_priority);
1166 }
1167
1168 /* Now fa, if non-NULL, points to the first fib alias
1169 * with the same keys [prefix,tos,priority], if such key already
1170 * exists or to the node before which we will insert new one.
1171 *
1172 * If fa is NULL, we will need to allocate a new one and
1173 * insert to the head of f.
1174 *
1175 * If f is NULL, no fib node matched the destination key
1176 * and we need to allocate a new one of those as well.
1177 */
1178
Olof Johansson91b9a272005-08-09 20:24:39 -07001179 if (fa && fa->fa_info->fib_priority == fi->fib_priority) {
Robert Olsson19baf832005-06-21 12:43:18 -07001180 struct fib_alias *fa_orig;
1181
1182 err = -EEXIST;
Thomas Graf4e902c52006-08-17 18:14:52 -07001183 if (cfg->fc_nlflags & NLM_F_EXCL)
Robert Olsson19baf832005-06-21 12:43:18 -07001184 goto out;
1185
Thomas Graf4e902c52006-08-17 18:14:52 -07001186 if (cfg->fc_nlflags & NLM_F_REPLACE) {
Robert Olsson19baf832005-06-21 12:43:18 -07001187 struct fib_info *fi_drop;
1188 u8 state;
1189
Joonwoo Park67250332008-01-18 03:45:18 -08001190 if (fi->fib_treeref > 1)
1191 goto out;
1192
Robert Olsson2373ce12005-08-25 13:01:29 -07001193 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001194 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001195 if (new_fa == NULL)
1196 goto out;
Robert Olsson19baf832005-06-21 12:43:18 -07001197
1198 fi_drop = fa->fa_info;
Robert Olsson2373ce12005-08-25 13:01:29 -07001199 new_fa->fa_tos = fa->fa_tos;
1200 new_fa->fa_info = fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001201 new_fa->fa_type = cfg->fc_type;
1202 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001203 state = fa->fa_state;
Robert Olsson2373ce12005-08-25 13:01:29 -07001204 new_fa->fa_state &= ~FA_S_ACCESSED;
Robert Olsson19baf832005-06-21 12:43:18 -07001205
Robert Olsson2373ce12005-08-25 13:01:29 -07001206 list_replace_rcu(&fa->fa_list, &new_fa->fa_list);
1207 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001208
1209 fib_release_info(fi_drop);
1210 if (state & FA_S_ACCESSED)
Olof Johansson91b9a272005-08-09 20:24:39 -07001211 rt_cache_flush(-1);
Milan Kocianb8f55832007-05-23 14:55:06 -07001212 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen,
1213 tb->tb_id, &cfg->fc_nlinfo, NLM_F_REPLACE);
Robert Olsson19baf832005-06-21 12:43:18 -07001214
Olof Johansson91b9a272005-08-09 20:24:39 -07001215 goto succeeded;
Robert Olsson19baf832005-06-21 12:43:18 -07001216 }
1217 /* Error if we find a perfect match which
1218 * uses the same scope, type, and nexthop
1219 * information.
1220 */
1221 fa_orig = fa;
1222 list_for_each_entry(fa, fa_orig->fa_list.prev, fa_list) {
1223 if (fa->fa_tos != tos)
1224 break;
1225 if (fa->fa_info->fib_priority != fi->fib_priority)
1226 break;
Thomas Graf4e902c52006-08-17 18:14:52 -07001227 if (fa->fa_type == cfg->fc_type &&
1228 fa->fa_scope == cfg->fc_scope &&
Robert Olsson19baf832005-06-21 12:43:18 -07001229 fa->fa_info == fi) {
1230 goto out;
1231 }
1232 }
Thomas Graf4e902c52006-08-17 18:14:52 -07001233 if (!(cfg->fc_nlflags & NLM_F_APPEND))
Robert Olsson19baf832005-06-21 12:43:18 -07001234 fa = fa_orig;
1235 }
1236 err = -ENOENT;
Thomas Graf4e902c52006-08-17 18:14:52 -07001237 if (!(cfg->fc_nlflags & NLM_F_CREATE))
Robert Olsson19baf832005-06-21 12:43:18 -07001238 goto out;
1239
1240 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001241 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson19baf832005-06-21 12:43:18 -07001242 if (new_fa == NULL)
1243 goto out;
1244
1245 new_fa->fa_info = fi;
1246 new_fa->fa_tos = tos;
Thomas Graf4e902c52006-08-17 18:14:52 -07001247 new_fa->fa_type = cfg->fc_type;
1248 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001249 new_fa->fa_state = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001250 /*
1251 * Insert new entry to the list.
1252 */
1253
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001254 if (!fa_head) {
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001255 fa_head = fib_insert_node(t, key, plen);
1256 if (unlikely(!fa_head)) {
1257 err = -ENOMEM;
Robert Olssonf835e472005-06-28 15:00:39 -07001258 goto out_free_new_fa;
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001259 }
Robert Olssonf835e472005-06-28 15:00:39 -07001260 }
Robert Olsson19baf832005-06-21 12:43:18 -07001261
Robert Olsson2373ce12005-08-25 13:01:29 -07001262 list_add_tail_rcu(&new_fa->fa_list,
1263 (fa ? &fa->fa_list : fa_head));
Robert Olsson19baf832005-06-21 12:43:18 -07001264
1265 rt_cache_flush(-1);
Thomas Graf4e902c52006-08-17 18:14:52 -07001266 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001267 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001268succeeded:
1269 return 0;
Robert Olssonf835e472005-06-28 15:00:39 -07001270
1271out_free_new_fa:
1272 kmem_cache_free(fn_alias_kmem, new_fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001273out:
1274 fib_release_info(fi);
Olof Johansson91b9a272005-08-09 20:24:39 -07001275err:
Robert Olsson19baf832005-06-21 12:43:18 -07001276 return err;
1277}
1278
Robert Olsson2373ce12005-08-25 13:01:29 -07001279
Robert Olsson772cb712005-09-19 15:31:18 -07001280/* should be called with rcu_read_lock */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001281static inline int check_leaf(struct trie *t, struct leaf *l,
1282 t_key key, int *plen, const struct flowi *flp,
Patrick McHardy06c74272005-08-23 22:06:09 -07001283 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001284{
Patrick McHardy06c74272005-08-23 22:06:09 -07001285 int err, i;
Al Viro888454c2006-09-19 13:42:46 -07001286 __be32 mask;
Robert Olsson19baf832005-06-21 12:43:18 -07001287 struct leaf_info *li;
1288 struct hlist_head *hhead = &l->list;
1289 struct hlist_node *node;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001290
Robert Olsson2373ce12005-08-25 13:01:29 -07001291 hlist_for_each_entry_rcu(li, node, hhead, hlist) {
Robert Olsson19baf832005-06-21 12:43:18 -07001292 i = li->plen;
Al Viro888454c2006-09-19 13:42:46 -07001293 mask = inet_make_mask(i);
1294 if (l->key != (key & ntohl(mask)))
Robert Olsson19baf832005-06-21 12:43:18 -07001295 continue;
1296
Al Viro888454c2006-09-19 13:42:46 -07001297 if ((err = fib_semantic_match(&li->falh, flp, res, htonl(l->key), mask, i)) <= 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001298 *plen = i;
1299#ifdef CONFIG_IP_FIB_TRIE_STATS
1300 t->stats.semantic_match_passed++;
1301#endif
Patrick McHardy06c74272005-08-23 22:06:09 -07001302 return err;
Robert Olsson19baf832005-06-21 12:43:18 -07001303 }
1304#ifdef CONFIG_IP_FIB_TRIE_STATS
1305 t->stats.semantic_match_miss++;
1306#endif
1307 }
Patrick McHardy06c74272005-08-23 22:06:09 -07001308 return 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001309}
1310
1311static int
1312fn_trie_lookup(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1313{
1314 struct trie *t = (struct trie *) tb->tb_data;
1315 int plen, ret = 0;
1316 struct node *n;
1317 struct tnode *pn;
1318 int pos, bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001319 t_key key = ntohl(flp->fl4_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001320 int chopped_off;
1321 t_key cindex = 0;
1322 int current_prefix_length = KEYLENGTH;
Olof Johansson91b9a272005-08-09 20:24:39 -07001323 struct tnode *cn;
1324 t_key node_prefix, key_prefix, pref_mismatch;
1325 int mp;
1326
Robert Olsson2373ce12005-08-25 13:01:29 -07001327 rcu_read_lock();
Robert Olsson19baf832005-06-21 12:43:18 -07001328
Robert Olsson2373ce12005-08-25 13:01:29 -07001329 n = rcu_dereference(t->trie);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001330 if (!n)
Robert Olsson19baf832005-06-21 12:43:18 -07001331 goto failed;
1332
1333#ifdef CONFIG_IP_FIB_TRIE_STATS
1334 t->stats.gets++;
1335#endif
1336
1337 /* Just a leaf? */
1338 if (IS_LEAF(n)) {
Patrick McHardy06c74272005-08-23 22:06:09 -07001339 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001340 goto found;
1341 goto failed;
1342 }
1343 pn = (struct tnode *) n;
1344 chopped_off = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001345
Olof Johansson91b9a272005-08-09 20:24:39 -07001346 while (pn) {
Robert Olsson19baf832005-06-21 12:43:18 -07001347 pos = pn->pos;
1348 bits = pn->bits;
1349
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001350 if (!chopped_off)
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001351 cindex = tkey_extract_bits(mask_pfx(key, current_prefix_length),
1352 pos, bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001353
1354 n = tnode_get_child(pn, cindex);
1355
1356 if (n == NULL) {
1357#ifdef CONFIG_IP_FIB_TRIE_STATS
1358 t->stats.null_node_hit++;
1359#endif
1360 goto backtrace;
1361 }
1362
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001363 if (IS_LEAF(n)) {
Patrick McHardy06c74272005-08-23 22:06:09 -07001364 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001365 goto found;
Olof Johansson91b9a272005-08-09 20:24:39 -07001366 else
1367 goto backtrace;
1368 }
1369
1370#define HL_OPTIMIZE
1371#ifdef HL_OPTIMIZE
1372 cn = (struct tnode *)n;
1373
1374 /*
1375 * It's a tnode, and we can do some extra checks here if we
1376 * like, to avoid descending into a dead-end branch.
1377 * This tnode is in the parent's child array at index
1378 * key[p_pos..p_pos+p_bits] but potentially with some bits
1379 * chopped off, so in reality the index may be just a
1380 * subprefix, padded with zero at the end.
1381 * We can also take a look at any skipped bits in this
1382 * tnode - everything up to p_pos is supposed to be ok,
1383 * and the non-chopped bits of the index (se previous
1384 * paragraph) are also guaranteed ok, but the rest is
1385 * considered unknown.
1386 *
1387 * The skipped bits are key[pos+bits..cn->pos].
1388 */
1389
1390 /* If current_prefix_length < pos+bits, we are already doing
1391 * actual prefix matching, which means everything from
1392 * pos+(bits-chopped_off) onward must be zero along some
1393 * branch of this subtree - otherwise there is *no* valid
1394 * prefix present. Here we can only check the skipped
1395 * bits. Remember, since we have already indexed into the
1396 * parent's child array, we know that the bits we chopped of
1397 * *are* zero.
1398 */
1399
1400 /* NOTA BENE: CHECKING ONLY SKIPPED BITS FOR THE NEW NODE HERE */
1401
1402 if (current_prefix_length < pos+bits) {
1403 if (tkey_extract_bits(cn->key, current_prefix_length,
1404 cn->pos - current_prefix_length) != 0 ||
1405 !(cn->child[0]))
1406 goto backtrace;
1407 }
1408
1409 /*
1410 * If chopped_off=0, the index is fully validated and we
1411 * only need to look at the skipped bits for this, the new,
1412 * tnode. What we actually want to do is to find out if
1413 * these skipped bits match our key perfectly, or if we will
1414 * have to count on finding a matching prefix further down,
1415 * because if we do, we would like to have some way of
1416 * verifying the existence of such a prefix at this point.
1417 */
1418
1419 /* The only thing we can do at this point is to verify that
1420 * any such matching prefix can indeed be a prefix to our
1421 * key, and if the bits in the node we are inspecting that
1422 * do not match our key are not ZERO, this cannot be true.
1423 * Thus, find out where there is a mismatch (before cn->pos)
1424 * and verify that all the mismatching bits are zero in the
1425 * new tnode's key.
1426 */
1427
1428 /* Note: We aren't very concerned about the piece of the key
1429 * that precede pn->pos+pn->bits, since these have already been
1430 * checked. The bits after cn->pos aren't checked since these are
1431 * by definition "unknown" at this point. Thus, what we want to
1432 * see is if we are about to enter the "prefix matching" state,
1433 * and in that case verify that the skipped bits that will prevail
1434 * throughout this subtree are zero, as they have to be if we are
1435 * to find a matching prefix.
1436 */
1437
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001438 node_prefix = mask_pfx(cn->key, cn->pos);
1439 key_prefix = mask_pfx(key, cn->pos);
Olof Johansson91b9a272005-08-09 20:24:39 -07001440 pref_mismatch = key_prefix^node_prefix;
1441 mp = 0;
1442
1443 /* In short: If skipped bits in this node do not match the search
1444 * key, enter the "prefix matching" state.directly.
1445 */
1446 if (pref_mismatch) {
1447 while (!(pref_mismatch & (1<<(KEYLENGTH-1)))) {
1448 mp++;
1449 pref_mismatch = pref_mismatch <<1;
1450 }
1451 key_prefix = tkey_extract_bits(cn->key, mp, cn->pos-mp);
1452
1453 if (key_prefix != 0)
1454 goto backtrace;
1455
1456 if (current_prefix_length >= cn->pos)
1457 current_prefix_length = mp;
1458 }
1459#endif
1460 pn = (struct tnode *)n; /* Descend */
1461 chopped_off = 0;
1462 continue;
1463
Robert Olsson19baf832005-06-21 12:43:18 -07001464backtrace:
1465 chopped_off++;
1466
1467 /* As zero don't change the child key (cindex) */
Olof Johansson91b9a272005-08-09 20:24:39 -07001468 while ((chopped_off <= pn->bits) && !(cindex & (1<<(chopped_off-1))))
Robert Olsson19baf832005-06-21 12:43:18 -07001469 chopped_off++;
Robert Olsson19baf832005-06-21 12:43:18 -07001470
1471 /* Decrease current_... with bits chopped off */
1472 if (current_prefix_length > pn->pos + pn->bits - chopped_off)
1473 current_prefix_length = pn->pos + pn->bits - chopped_off;
Olof Johansson91b9a272005-08-09 20:24:39 -07001474
Robert Olsson19baf832005-06-21 12:43:18 -07001475 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001476 * Either we do the actual chop off according or if we have
Robert Olsson19baf832005-06-21 12:43:18 -07001477 * chopped off all bits in this tnode walk up to our parent.
1478 */
1479
Olof Johansson91b9a272005-08-09 20:24:39 -07001480 if (chopped_off <= pn->bits) {
Robert Olsson19baf832005-06-21 12:43:18 -07001481 cindex &= ~(1 << (chopped_off-1));
Olof Johansson91b9a272005-08-09 20:24:39 -07001482 } else {
Stephen Hemminger06801912007-08-10 15:22:13 -07001483 struct tnode *parent = node_parent((struct node *) pn);
1484 if (!parent)
Robert Olsson19baf832005-06-21 12:43:18 -07001485 goto failed;
Olof Johansson91b9a272005-08-09 20:24:39 -07001486
Robert Olsson19baf832005-06-21 12:43:18 -07001487 /* Get Child's index */
Stephen Hemminger06801912007-08-10 15:22:13 -07001488 cindex = tkey_extract_bits(pn->key, parent->pos, parent->bits);
1489 pn = parent;
Robert Olsson19baf832005-06-21 12:43:18 -07001490 chopped_off = 0;
1491
1492#ifdef CONFIG_IP_FIB_TRIE_STATS
1493 t->stats.backtrack++;
1494#endif
1495 goto backtrace;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001496 }
Robert Olsson19baf832005-06-21 12:43:18 -07001497 }
1498failed:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001499 ret = 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001500found:
Robert Olsson2373ce12005-08-25 13:01:29 -07001501 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001502 return ret;
1503}
1504
Robert Olsson2373ce12005-08-25 13:01:29 -07001505/* only called from updater side */
Robert Olsson19baf832005-06-21 12:43:18 -07001506static int trie_leaf_remove(struct trie *t, t_key key)
1507{
1508 t_key cindex;
1509 struct tnode *tp = NULL;
1510 struct node *n = t->trie;
1511 struct leaf *l;
1512
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001513 pr_debug("entering trie_leaf_remove(%p)\n", n);
Robert Olsson19baf832005-06-21 12:43:18 -07001514
1515 /* Note that in the case skipped bits, those bits are *not* checked!
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001516 * When we finish this, we will have NULL or a T_LEAF, and the
Robert Olsson19baf832005-06-21 12:43:18 -07001517 * T_LEAF may or may not match our key.
1518 */
1519
Olof Johansson91b9a272005-08-09 20:24:39 -07001520 while (n != NULL && IS_TNODE(n)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001521 struct tnode *tn = (struct tnode *) n;
1522 check_tnode(tn);
1523 n = tnode_get_child(tn ,tkey_extract_bits(key, tn->pos, tn->bits));
1524
Stephen Hemminger06801912007-08-10 15:22:13 -07001525 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001526 }
Robert Olsson19baf832005-06-21 12:43:18 -07001527 l = (struct leaf *) n;
1528
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001529 if (!n || !tkey_equals(l->key, key))
Robert Olsson19baf832005-06-21 12:43:18 -07001530 return 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001531
1532 /*
1533 * Key found.
1534 * Remove the leaf and rebalance the tree
Robert Olsson19baf832005-06-21 12:43:18 -07001535 */
1536
Robert Olsson19baf832005-06-21 12:43:18 -07001537 t->size--;
1538
Stephen Hemminger06801912007-08-10 15:22:13 -07001539 tp = node_parent(n);
Robert Olsson19baf832005-06-21 12:43:18 -07001540 tnode_free((struct tnode *) n);
1541
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001542 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001543 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1544 put_child(t, (struct tnode *)tp, cindex, NULL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001545 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Olof Johansson91b9a272005-08-09 20:24:39 -07001546 } else
Robert Olsson2373ce12005-08-25 13:01:29 -07001547 rcu_assign_pointer(t->trie, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001548
1549 return 1;
1550}
1551
Robert Olssond562f1f2007-03-26 14:22:22 -07001552/*
1553 * Caller must hold RTNL.
1554 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001555static int fn_trie_delete(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001556{
1557 struct trie *t = (struct trie *) tb->tb_data;
1558 u32 key, mask;
Thomas Graf4e902c52006-08-17 18:14:52 -07001559 int plen = cfg->fc_dst_len;
1560 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001561 struct fib_alias *fa, *fa_to_delete;
1562 struct list_head *fa_head;
1563 struct leaf *l;
Olof Johansson91b9a272005-08-09 20:24:39 -07001564 struct leaf_info *li;
1565
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001566 if (plen > 32)
Robert Olsson19baf832005-06-21 12:43:18 -07001567 return -EINVAL;
1568
Thomas Graf4e902c52006-08-17 18:14:52 -07001569 key = ntohl(cfg->fc_dst);
Olof Johansson91b9a272005-08-09 20:24:39 -07001570 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001571
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001572 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001573 return -EINVAL;
1574
1575 key = key & mask;
1576 l = fib_find_node(t, key);
1577
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001578 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001579 return -ESRCH;
1580
1581 fa_head = get_fa_head(l, plen);
1582 fa = fib_find_alias(fa_head, tos, 0);
1583
1584 if (!fa)
1585 return -ESRCH;
1586
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001587 pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t);
Robert Olsson19baf832005-06-21 12:43:18 -07001588
1589 fa_to_delete = NULL;
1590 fa_head = fa->fa_list.prev;
Robert Olsson2373ce12005-08-25 13:01:29 -07001591
Robert Olsson19baf832005-06-21 12:43:18 -07001592 list_for_each_entry(fa, fa_head, fa_list) {
1593 struct fib_info *fi = fa->fa_info;
1594
1595 if (fa->fa_tos != tos)
1596 break;
1597
Thomas Graf4e902c52006-08-17 18:14:52 -07001598 if ((!cfg->fc_type || fa->fa_type == cfg->fc_type) &&
1599 (cfg->fc_scope == RT_SCOPE_NOWHERE ||
1600 fa->fa_scope == cfg->fc_scope) &&
1601 (!cfg->fc_protocol ||
1602 fi->fib_protocol == cfg->fc_protocol) &&
1603 fib_nh_match(cfg, fi) == 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001604 fa_to_delete = fa;
1605 break;
1606 }
1607 }
1608
Olof Johansson91b9a272005-08-09 20:24:39 -07001609 if (!fa_to_delete)
1610 return -ESRCH;
Robert Olsson19baf832005-06-21 12:43:18 -07001611
Olof Johansson91b9a272005-08-09 20:24:39 -07001612 fa = fa_to_delete;
Thomas Graf4e902c52006-08-17 18:14:52 -07001613 rtmsg_fib(RTM_DELROUTE, htonl(key), fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001614 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001615
Olof Johansson91b9a272005-08-09 20:24:39 -07001616 l = fib_find_node(t, key);
Robert Olsson772cb712005-09-19 15:31:18 -07001617 li = find_leaf_info(l, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001618
Robert Olsson2373ce12005-08-25 13:01:29 -07001619 list_del_rcu(&fa->fa_list);
Robert Olsson19baf832005-06-21 12:43:18 -07001620
Olof Johansson91b9a272005-08-09 20:24:39 -07001621 if (list_empty(fa_head)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001622 hlist_del_rcu(&li->hlist);
Olof Johansson91b9a272005-08-09 20:24:39 -07001623 free_leaf_info(li);
Robert Olsson2373ce12005-08-25 13:01:29 -07001624 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001625
1626 if (hlist_empty(&l->list))
1627 trie_leaf_remove(t, key);
1628
1629 if (fa->fa_state & FA_S_ACCESSED)
1630 rt_cache_flush(-1);
1631
Robert Olsson2373ce12005-08-25 13:01:29 -07001632 fib_release_info(fa->fa_info);
1633 alias_free_mem_rcu(fa);
Olof Johansson91b9a272005-08-09 20:24:39 -07001634 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001635}
1636
1637static int trie_flush_list(struct trie *t, struct list_head *head)
1638{
1639 struct fib_alias *fa, *fa_node;
1640 int found = 0;
1641
1642 list_for_each_entry_safe(fa, fa_node, head, fa_list) {
1643 struct fib_info *fi = fa->fa_info;
Robert Olsson19baf832005-06-21 12:43:18 -07001644
Robert Olsson2373ce12005-08-25 13:01:29 -07001645 if (fi && (fi->fib_flags & RTNH_F_DEAD)) {
1646 list_del_rcu(&fa->fa_list);
1647 fib_release_info(fa->fa_info);
1648 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001649 found++;
1650 }
1651 }
1652 return found;
1653}
1654
1655static int trie_flush_leaf(struct trie *t, struct leaf *l)
1656{
1657 int found = 0;
1658 struct hlist_head *lih = &l->list;
1659 struct hlist_node *node, *tmp;
1660 struct leaf_info *li = NULL;
1661
1662 hlist_for_each_entry_safe(li, node, tmp, lih, hlist) {
Robert Olsson19baf832005-06-21 12:43:18 -07001663 found += trie_flush_list(t, &li->falh);
1664
1665 if (list_empty(&li->falh)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001666 hlist_del_rcu(&li->hlist);
Robert Olsson19baf832005-06-21 12:43:18 -07001667 free_leaf_info(li);
1668 }
1669 }
1670 return found;
1671}
1672
Robert Olsson2373ce12005-08-25 13:01:29 -07001673/* rcu_read_lock needs to be hold by caller from readside */
1674
Robert Olsson19baf832005-06-21 12:43:18 -07001675static struct leaf *nextleaf(struct trie *t, struct leaf *thisleaf)
1676{
1677 struct node *c = (struct node *) thisleaf;
1678 struct tnode *p;
1679 int idx;
Robert Olsson2373ce12005-08-25 13:01:29 -07001680 struct node *trie = rcu_dereference(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -07001681
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001682 if (c == NULL) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001683 if (trie == NULL)
Robert Olsson19baf832005-06-21 12:43:18 -07001684 return NULL;
1685
Robert Olsson2373ce12005-08-25 13:01:29 -07001686 if (IS_LEAF(trie)) /* trie w. just a leaf */
1687 return (struct leaf *) trie;
Robert Olsson19baf832005-06-21 12:43:18 -07001688
Robert Olsson2373ce12005-08-25 13:01:29 -07001689 p = (struct tnode*) trie; /* Start */
Olof Johansson91b9a272005-08-09 20:24:39 -07001690 } else
Stephen Hemminger06801912007-08-10 15:22:13 -07001691 p = node_parent(c);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001692
Robert Olsson19baf832005-06-21 12:43:18 -07001693 while (p) {
1694 int pos, last;
1695
1696 /* Find the next child of the parent */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001697 if (c)
1698 pos = 1 + tkey_extract_bits(c->key, p->pos, p->bits);
1699 else
Robert Olsson19baf832005-06-21 12:43:18 -07001700 pos = 0;
1701
1702 last = 1 << p->bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001703 for (idx = pos; idx < last ; idx++) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001704 c = rcu_dereference(p->child[idx]);
1705
1706 if (!c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001707 continue;
Robert Olsson19baf832005-06-21 12:43:18 -07001708
Olof Johansson91b9a272005-08-09 20:24:39 -07001709 /* Decend if tnode */
Robert Olsson2373ce12005-08-25 13:01:29 -07001710 while (IS_TNODE(c)) {
1711 p = (struct tnode *) c;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09001712 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001713
Olof Johansson91b9a272005-08-09 20:24:39 -07001714 /* Rightmost non-NULL branch */
1715 if (p && IS_TNODE(p))
Robert Olsson2373ce12005-08-25 13:01:29 -07001716 while (!(c = rcu_dereference(p->child[idx]))
1717 && idx < (1<<p->bits)) idx++;
Robert Olsson19baf832005-06-21 12:43:18 -07001718
Olof Johansson91b9a272005-08-09 20:24:39 -07001719 /* Done with this tnode? */
Robert Olsson2373ce12005-08-25 13:01:29 -07001720 if (idx >= (1 << p->bits) || !c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001721 goto up;
Robert Olsson19baf832005-06-21 12:43:18 -07001722 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001723 return (struct leaf *) c;
Robert Olsson19baf832005-06-21 12:43:18 -07001724 }
1725up:
1726 /* No more children go up one step */
Olof Johansson91b9a272005-08-09 20:24:39 -07001727 c = (struct node *) p;
Stephen Hemminger06801912007-08-10 15:22:13 -07001728 p = node_parent(c);
Robert Olsson19baf832005-06-21 12:43:18 -07001729 }
1730 return NULL; /* Ready. Root of trie */
1731}
1732
Robert Olssond562f1f2007-03-26 14:22:22 -07001733/*
1734 * Caller must hold RTNL.
1735 */
Robert Olsson19baf832005-06-21 12:43:18 -07001736static int fn_trie_flush(struct fib_table *tb)
1737{
1738 struct trie *t = (struct trie *) tb->tb_data;
1739 struct leaf *ll = NULL, *l = NULL;
1740 int found = 0, h;
1741
Olof Johansson91b9a272005-08-09 20:24:39 -07001742 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001743 found += trie_flush_leaf(t, l);
1744
1745 if (ll && hlist_empty(&ll->list))
1746 trie_leaf_remove(t, ll->key);
1747 ll = l;
1748 }
1749
1750 if (ll && hlist_empty(&ll->list))
1751 trie_leaf_remove(t, ll->key);
1752
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001753 pr_debug("trie_flush found=%d\n", found);
Robert Olsson19baf832005-06-21 12:43:18 -07001754 return found;
1755}
1756
Robert Olsson19baf832005-06-21 12:43:18 -07001757static void
1758fn_trie_select_default(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1759{
1760 struct trie *t = (struct trie *) tb->tb_data;
1761 int order, last_idx;
1762 struct fib_info *fi = NULL;
1763 struct fib_info *last_resort;
1764 struct fib_alias *fa = NULL;
1765 struct list_head *fa_head;
1766 struct leaf *l;
1767
1768 last_idx = -1;
1769 last_resort = NULL;
1770 order = -1;
1771
Robert Olsson2373ce12005-08-25 13:01:29 -07001772 rcu_read_lock();
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001773
Robert Olsson19baf832005-06-21 12:43:18 -07001774 l = fib_find_node(t, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001775 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001776 goto out;
1777
1778 fa_head = get_fa_head(l, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001779 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001780 goto out;
1781
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001782 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001783 goto out;
1784
Robert Olsson2373ce12005-08-25 13:01:29 -07001785 list_for_each_entry_rcu(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001786 struct fib_info *next_fi = fa->fa_info;
Olof Johansson91b9a272005-08-09 20:24:39 -07001787
Robert Olsson19baf832005-06-21 12:43:18 -07001788 if (fa->fa_scope != res->scope ||
1789 fa->fa_type != RTN_UNICAST)
1790 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -07001791
Robert Olsson19baf832005-06-21 12:43:18 -07001792 if (next_fi->fib_priority > res->fi->fib_priority)
1793 break;
1794 if (!next_fi->fib_nh[0].nh_gw ||
1795 next_fi->fib_nh[0].nh_scope != RT_SCOPE_LINK)
1796 continue;
1797 fa->fa_state |= FA_S_ACCESSED;
Olof Johansson91b9a272005-08-09 20:24:39 -07001798
Robert Olsson19baf832005-06-21 12:43:18 -07001799 if (fi == NULL) {
1800 if (next_fi != res->fi)
1801 break;
1802 } else if (!fib_detect_death(fi, order, &last_resort,
Denis V. Lunev971b8932007-12-08 00:32:23 -08001803 &last_idx, tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001804 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001805 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001806 goto out;
1807 }
1808 fi = next_fi;
1809 order++;
1810 }
1811 if (order <= 0 || fi == NULL) {
Denis V. Lunev971b8932007-12-08 00:32:23 -08001812 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001813 goto out;
1814 }
1815
Denis V. Lunev971b8932007-12-08 00:32:23 -08001816 if (!fib_detect_death(fi, order, &last_resort, &last_idx,
1817 tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001818 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001819 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001820 goto out;
1821 }
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001822 if (last_idx >= 0)
1823 fib_result_assign(res, last_resort);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001824 tb->tb_default = last_idx;
1825out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001826 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001827}
1828
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001829static int fn_trie_dump_fa(t_key key, int plen, struct list_head *fah, struct fib_table *tb,
Robert Olsson19baf832005-06-21 12:43:18 -07001830 struct sk_buff *skb, struct netlink_callback *cb)
1831{
1832 int i, s_i;
1833 struct fib_alias *fa;
1834
Al Viro32ab5f82006-09-26 22:21:45 -07001835 __be32 xkey = htonl(key);
Robert Olsson19baf832005-06-21 12:43:18 -07001836
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001837 s_i = cb->args[4];
Robert Olsson19baf832005-06-21 12:43:18 -07001838 i = 0;
1839
Robert Olsson2373ce12005-08-25 13:01:29 -07001840 /* rcu_read_lock is hold by caller */
1841
1842 list_for_each_entry_rcu(fa, fah, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001843 if (i < s_i) {
1844 i++;
1845 continue;
1846 }
Stephen Hemminger78c66712005-09-21 00:15:39 -07001847 BUG_ON(!fa->fa_info);
Robert Olsson19baf832005-06-21 12:43:18 -07001848
1849 if (fib_dump_info(skb, NETLINK_CB(cb->skb).pid,
1850 cb->nlh->nlmsg_seq,
1851 RTM_NEWROUTE,
1852 tb->tb_id,
1853 fa->fa_type,
1854 fa->fa_scope,
Thomas Grafbe403ea2006-08-17 18:15:17 -07001855 xkey,
Robert Olsson19baf832005-06-21 12:43:18 -07001856 plen,
1857 fa->fa_tos,
David S. Miller90f66912005-06-21 14:43:28 -07001858 fa->fa_info, 0) < 0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001859 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001860 return -1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001861 }
Robert Olsson19baf832005-06-21 12:43:18 -07001862 i++;
1863 }
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001864 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001865 return skb->len;
1866}
1867
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001868static int fn_trie_dump_plen(struct trie *t, int plen, struct fib_table *tb, struct sk_buff *skb,
Robert Olsson19baf832005-06-21 12:43:18 -07001869 struct netlink_callback *cb)
1870{
1871 int h, s_h;
1872 struct list_head *fa_head;
1873 struct leaf *l = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001874
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001875 s_h = cb->args[3];
Robert Olsson19baf832005-06-21 12:43:18 -07001876
Olof Johansson91b9a272005-08-09 20:24:39 -07001877 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001878 if (h < s_h)
1879 continue;
1880 if (h > s_h)
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001881 memset(&cb->args[4], 0,
1882 sizeof(cb->args) - 4*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001883
1884 fa_head = get_fa_head(l, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001885
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001886 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001887 continue;
1888
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001889 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001890 continue;
1891
1892 if (fn_trie_dump_fa(l->key, plen, fa_head, tb, skb, cb)<0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001893 cb->args[3] = h;
Robert Olsson19baf832005-06-21 12:43:18 -07001894 return -1;
1895 }
1896 }
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001897 cb->args[3] = h;
Robert Olsson19baf832005-06-21 12:43:18 -07001898 return skb->len;
1899}
1900
1901static int fn_trie_dump(struct fib_table *tb, struct sk_buff *skb, struct netlink_callback *cb)
1902{
1903 int m, s_m;
1904 struct trie *t = (struct trie *) tb->tb_data;
1905
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001906 s_m = cb->args[2];
Robert Olsson19baf832005-06-21 12:43:18 -07001907
Robert Olsson2373ce12005-08-25 13:01:29 -07001908 rcu_read_lock();
Olof Johansson91b9a272005-08-09 20:24:39 -07001909 for (m = 0; m <= 32; m++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001910 if (m < s_m)
1911 continue;
1912 if (m > s_m)
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001913 memset(&cb->args[3], 0,
1914 sizeof(cb->args) - 3*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001915
1916 if (fn_trie_dump_plen(t, 32-m, tb, skb, cb)<0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001917 cb->args[2] = m;
Robert Olsson19baf832005-06-21 12:43:18 -07001918 goto out;
1919 }
1920 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001921 rcu_read_unlock();
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001922 cb->args[2] = m;
Robert Olsson19baf832005-06-21 12:43:18 -07001923 return skb->len;
Olof Johansson91b9a272005-08-09 20:24:39 -07001924out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001925 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001926 return -1;
1927}
1928
1929/* Fix more generic FIB names for init later */
1930
Denis V. Lunev7b1a74f2008-01-10 03:22:17 -08001931struct fib_table *fib_hash_init(u32 id)
Robert Olsson19baf832005-06-21 12:43:18 -07001932{
1933 struct fib_table *tb;
1934 struct trie *t;
1935
1936 if (fn_alias_kmem == NULL)
1937 fn_alias_kmem = kmem_cache_create("ip_fib_alias",
1938 sizeof(struct fib_alias),
1939 0, SLAB_HWCACHE_ALIGN,
Paul Mundt20c2df82007-07-20 10:11:58 +09001940 NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001941
1942 tb = kmalloc(sizeof(struct fib_table) + sizeof(struct trie),
1943 GFP_KERNEL);
1944 if (tb == NULL)
1945 return NULL;
1946
1947 tb->tb_id = id;
Denis V. Lunev971b8932007-12-08 00:32:23 -08001948 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001949 tb->tb_lookup = fn_trie_lookup;
1950 tb->tb_insert = fn_trie_insert;
1951 tb->tb_delete = fn_trie_delete;
1952 tb->tb_flush = fn_trie_flush;
1953 tb->tb_select_default = fn_trie_select_default;
1954 tb->tb_dump = fn_trie_dump;
Robert Olsson19baf832005-06-21 12:43:18 -07001955
1956 t = (struct trie *) tb->tb_data;
Stephen Hemmingerc28a1cf2008-01-12 20:49:13 -08001957 memset(t, 0, sizeof(*t));
Robert Olsson19baf832005-06-21 12:43:18 -07001958
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001959 if (id == RT_TABLE_LOCAL)
Stephen Hemminger78c66712005-09-21 00:15:39 -07001960 printk(KERN_INFO "IPv4 FIB: Using LC-trie version %s\n", VERSION);
Robert Olsson19baf832005-06-21 12:43:18 -07001961
1962 return tb;
1963}
1964
Robert Olsson19baf832005-06-21 12:43:18 -07001965#ifdef CONFIG_PROC_FS
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001966/* Depth first Trie walk iterator */
1967struct fib_trie_iter {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08001968 struct seq_net_private p;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08001969 struct trie *trie_local, *trie_main;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001970 struct tnode *tnode;
1971 struct trie *trie;
1972 unsigned index;
1973 unsigned depth;
1974};
Robert Olsson19baf832005-06-21 12:43:18 -07001975
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001976static struct node *fib_trie_get_next(struct fib_trie_iter *iter)
Robert Olsson19baf832005-06-21 12:43:18 -07001977{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001978 struct tnode *tn = iter->tnode;
1979 unsigned cindex = iter->index;
1980 struct tnode *p;
1981
Eric W. Biederman6640e692007-01-24 14:42:04 -08001982 /* A single entry routing table */
1983 if (!tn)
1984 return NULL;
1985
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001986 pr_debug("get_next iter={node=%p index=%d depth=%d}\n",
1987 iter->tnode, iter->index, iter->depth);
1988rescan:
1989 while (cindex < (1<<tn->bits)) {
1990 struct node *n = tnode_get_child(tn, cindex);
1991
1992 if (n) {
1993 if (IS_LEAF(n)) {
1994 iter->tnode = tn;
1995 iter->index = cindex + 1;
1996 } else {
1997 /* push down one level */
1998 iter->tnode = (struct tnode *) n;
1999 iter->index = 0;
2000 ++iter->depth;
2001 }
2002 return n;
2003 }
2004
2005 ++cindex;
2006 }
2007
2008 /* Current node exhausted, pop back up */
Stephen Hemminger06801912007-08-10 15:22:13 -07002009 p = node_parent((struct node *)tn);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002010 if (p) {
2011 cindex = tkey_extract_bits(tn->key, p->pos, p->bits)+1;
2012 tn = p;
2013 --iter->depth;
2014 goto rescan;
2015 }
2016
2017 /* got root? */
Robert Olsson19baf832005-06-21 12:43:18 -07002018 return NULL;
2019}
2020
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002021static struct node *fib_trie_get_first(struct fib_trie_iter *iter,
2022 struct trie *t)
Robert Olsson19baf832005-06-21 12:43:18 -07002023{
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002024 struct node *n ;
2025
Stephen Hemminger132adf52007-03-08 20:44:43 -08002026 if (!t)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002027 return NULL;
2028
2029 n = rcu_dereference(t->trie);
2030
Stephen Hemminger132adf52007-03-08 20:44:43 -08002031 if (!iter)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002032 return NULL;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002033
Eric W. Biederman6640e692007-01-24 14:42:04 -08002034 if (n) {
2035 if (IS_TNODE(n)) {
2036 iter->tnode = (struct tnode *) n;
2037 iter->trie = t;
2038 iter->index = 0;
2039 iter->depth = 1;
2040 } else {
2041 iter->tnode = NULL;
2042 iter->trie = t;
2043 iter->index = 0;
2044 iter->depth = 0;
2045 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002046 return n;
2047 }
Robert Olsson19baf832005-06-21 12:43:18 -07002048 return NULL;
2049}
2050
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002051static void trie_collect_stats(struct trie *t, struct trie_stat *s)
Robert Olsson19baf832005-06-21 12:43:18 -07002052{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002053 struct node *n;
2054 struct fib_trie_iter iter;
Robert Olsson19baf832005-06-21 12:43:18 -07002055
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002056 memset(s, 0, sizeof(*s));
Robert Olsson19baf832005-06-21 12:43:18 -07002057
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002058 rcu_read_lock();
2059 for (n = fib_trie_get_first(&iter, t); n;
2060 n = fib_trie_get_next(&iter)) {
2061 if (IS_LEAF(n)) {
2062 s->leaves++;
2063 s->totdepth += iter.depth;
2064 if (iter.depth > s->maxdepth)
2065 s->maxdepth = iter.depth;
2066 } else {
2067 const struct tnode *tn = (const struct tnode *) n;
2068 int i;
Robert Olsson19baf832005-06-21 12:43:18 -07002069
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002070 s->tnodes++;
Stephen Hemminger132adf52007-03-08 20:44:43 -08002071 if (tn->bits < MAX_STAT_DEPTH)
Robert Olsson06ef9212006-03-20 21:35:01 -08002072 s->nodesizes[tn->bits]++;
2073
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002074 for (i = 0; i < (1<<tn->bits); i++)
2075 if (!tn->child[i])
2076 s->nullpointers++;
2077 }
2078 }
2079 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002080}
2081
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002082/*
Robert Olsson19baf832005-06-21 12:43:18 -07002083 * This outputs /proc/net/fib_triestats
Robert Olsson19baf832005-06-21 12:43:18 -07002084 */
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002085static void trie_show_stats(struct seq_file *seq, struct trie_stat *stat)
Robert Olsson19baf832005-06-21 12:43:18 -07002086{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002087 unsigned i, max, pointers, bytes, avdepth;
Robert Olsson19baf832005-06-21 12:43:18 -07002088
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002089 if (stat->leaves)
2090 avdepth = stat->totdepth*100 / stat->leaves;
2091 else
2092 avdepth = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002093
Stephen Hemminger187b5182008-01-12 20:55:55 -08002094 seq_printf(seq, "\tAver depth: %u.%02d\n", avdepth / 100, avdepth % 100 );
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002095 seq_printf(seq, "\tMax depth: %u\n", stat->maxdepth);
Robert Olsson19baf832005-06-21 12:43:18 -07002096
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002097 seq_printf(seq, "\tLeaves: %u\n", stat->leaves);
Olof Johansson91b9a272005-08-09 20:24:39 -07002098
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002099 bytes = sizeof(struct leaf) * stat->leaves;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002100 seq_printf(seq, "\tInternal nodes: %u\n\t", stat->tnodes);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002101 bytes += sizeof(struct tnode) * stat->tnodes;
Robert Olsson19baf832005-06-21 12:43:18 -07002102
Robert Olsson06ef9212006-03-20 21:35:01 -08002103 max = MAX_STAT_DEPTH;
2104 while (max > 0 && stat->nodesizes[max-1] == 0)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002105 max--;
Robert Olsson19baf832005-06-21 12:43:18 -07002106
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002107 pointers = 0;
2108 for (i = 1; i <= max; i++)
2109 if (stat->nodesizes[i] != 0) {
Stephen Hemminger187b5182008-01-12 20:55:55 -08002110 seq_printf(seq, " %u: %u", i, stat->nodesizes[i]);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002111 pointers += (1<<i) * stat->nodesizes[i];
2112 }
2113 seq_putc(seq, '\n');
Stephen Hemminger187b5182008-01-12 20:55:55 -08002114 seq_printf(seq, "\tPointers: %u\n", pointers);
Robert Olsson19baf832005-06-21 12:43:18 -07002115
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002116 bytes += sizeof(struct node *) * pointers;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002117 seq_printf(seq, "Null ptrs: %u\n", stat->nullpointers);
2118 seq_printf(seq, "Total size: %u kB\n", (bytes + 1023) / 1024);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002119}
Robert Olsson19baf832005-06-21 12:43:18 -07002120
2121#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002122static void trie_show_usage(struct seq_file *seq,
2123 const struct trie_use_stats *stats)
2124{
2125 seq_printf(seq, "\nCounters:\n---------\n");
2126 seq_printf(seq,"gets = %u\n", stats->gets);
2127 seq_printf(seq,"backtracks = %u\n", stats->backtrack);
2128 seq_printf(seq,"semantic match passed = %u\n", stats->semantic_match_passed);
2129 seq_printf(seq,"semantic match miss = %u\n", stats->semantic_match_miss);
2130 seq_printf(seq,"null node hit= %u\n", stats->null_node_hit);
2131 seq_printf(seq,"skipped node resize = %u\n\n", stats->resize_node_skipped);
Robert Olsson19baf832005-06-21 12:43:18 -07002132}
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002133#endif /* CONFIG_IP_FIB_TRIE_STATS */
2134
Robert Olsson19baf832005-06-21 12:43:18 -07002135
2136static int fib_triestat_seq_show(struct seq_file *seq, void *v)
2137{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002138 struct net *net = (struct net *)seq->private;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002139 struct trie *trie_local, *trie_main;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002140 struct trie_stat *stat;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002141 struct fib_table *tb;
2142
2143 trie_local = NULL;
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002144 tb = fib_get_table(net, RT_TABLE_LOCAL);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002145 if (tb)
2146 trie_local = (struct trie *) tb->tb_data;
2147
2148 trie_main = NULL;
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002149 tb = fib_get_table(net, RT_TABLE_MAIN);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002150 if (tb)
2151 trie_main = (struct trie *) tb->tb_data;
2152
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002153
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002154 stat = kmalloc(sizeof(*stat), GFP_KERNEL);
2155 if (!stat)
2156 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002157
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002158 seq_printf(seq, "Basic info: size of leaf: %Zd bytes, size of tnode: %Zd bytes.\n",
2159 sizeof(struct leaf), sizeof(struct tnode));
Olof Johansson91b9a272005-08-09 20:24:39 -07002160
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002161 if (trie_local) {
2162 seq_printf(seq, "Local:\n");
2163 trie_collect_stats(trie_local, stat);
2164 trie_show_stats(seq, stat);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002165#ifdef CONFIG_IP_FIB_TRIE_STATS
2166 trie_show_usage(seq, &trie_local->stats);
2167#endif
Robert Olsson19baf832005-06-21 12:43:18 -07002168 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002169
2170 if (trie_main) {
2171 seq_printf(seq, "Main:\n");
2172 trie_collect_stats(trie_main, stat);
2173 trie_show_stats(seq, stat);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002174#ifdef CONFIG_IP_FIB_TRIE_STATS
2175 trie_show_usage(seq, &trie_main->stats);
2176#endif
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002177 }
2178 kfree(stat);
2179
Robert Olsson19baf832005-06-21 12:43:18 -07002180 return 0;
2181}
2182
Robert Olsson19baf832005-06-21 12:43:18 -07002183static int fib_triestat_seq_open(struct inode *inode, struct file *file)
2184{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002185 int err;
2186 struct net *net;
2187
2188 net = get_proc_net(inode);
2189 if (net == NULL)
2190 return -ENXIO;
2191 err = single_open(file, fib_triestat_seq_show, net);
2192 if (err < 0) {
2193 put_net(net);
2194 return err;
2195 }
2196 return 0;
2197}
2198
2199static int fib_triestat_seq_release(struct inode *ino, struct file *f)
2200{
2201 struct seq_file *seq = f->private_data;
2202 put_net(seq->private);
2203 return single_release(ino, f);
Robert Olsson19baf832005-06-21 12:43:18 -07002204}
2205
Arjan van de Ven9a321442007-02-12 00:55:35 -08002206static const struct file_operations fib_triestat_fops = {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002207 .owner = THIS_MODULE,
2208 .open = fib_triestat_seq_open,
2209 .read = seq_read,
2210 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002211 .release = fib_triestat_seq_release,
Robert Olsson19baf832005-06-21 12:43:18 -07002212};
2213
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002214static struct node *fib_trie_get_idx(struct fib_trie_iter *iter,
2215 loff_t pos)
Robert Olsson19baf832005-06-21 12:43:18 -07002216{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002217 loff_t idx = 0;
2218 struct node *n;
Robert Olsson19baf832005-06-21 12:43:18 -07002219
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002220 for (n = fib_trie_get_first(iter, iter->trie_local);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002221 n; ++idx, n = fib_trie_get_next(iter)) {
2222 if (pos == idx)
2223 return n;
2224 }
Robert Olsson19baf832005-06-21 12:43:18 -07002225
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002226 for (n = fib_trie_get_first(iter, iter->trie_main);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002227 n; ++idx, n = fib_trie_get_next(iter)) {
2228 if (pos == idx)
2229 return n;
2230 }
Robert Olsson19baf832005-06-21 12:43:18 -07002231 return NULL;
2232}
2233
2234static void *fib_trie_seq_start(struct seq_file *seq, loff_t *pos)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002235 __acquires(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002236{
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002237 struct fib_trie_iter *iter = seq->private;
2238 struct fib_table *tb;
2239
2240 if (!iter->trie_local) {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002241 tb = fib_get_table(iter->p.net, RT_TABLE_LOCAL);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002242 if (tb)
2243 iter->trie_local = (struct trie *) tb->tb_data;
2244 }
2245 if (!iter->trie_main) {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002246 tb = fib_get_table(iter->p.net, RT_TABLE_MAIN);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002247 if (tb)
2248 iter->trie_main = (struct trie *) tb->tb_data;
2249 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002250 rcu_read_lock();
2251 if (*pos == 0)
Olof Johansson91b9a272005-08-09 20:24:39 -07002252 return SEQ_START_TOKEN;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002253 return fib_trie_get_idx(iter, *pos - 1);
Robert Olsson19baf832005-06-21 12:43:18 -07002254}
2255
2256static void *fib_trie_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2257{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002258 struct fib_trie_iter *iter = seq->private;
2259 void *l = v;
2260
Robert Olsson19baf832005-06-21 12:43:18 -07002261 ++*pos;
Olof Johansson91b9a272005-08-09 20:24:39 -07002262 if (v == SEQ_START_TOKEN)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002263 return fib_trie_get_idx(iter, 0);
Olof Johansson91b9a272005-08-09 20:24:39 -07002264
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002265 v = fib_trie_get_next(iter);
2266 BUG_ON(v == l);
2267 if (v)
2268 return v;
2269
2270 /* continue scan in next trie */
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002271 if (iter->trie == iter->trie_local)
2272 return fib_trie_get_first(iter, iter->trie_main);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002273
2274 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07002275}
2276
2277static void fib_trie_seq_stop(struct seq_file *seq, void *v)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002278 __releases(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002279{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002280 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002281}
2282
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002283static void seq_indent(struct seq_file *seq, int n)
2284{
2285 while (n-- > 0) seq_puts(seq, " ");
2286}
Robert Olsson19baf832005-06-21 12:43:18 -07002287
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002288static inline const char *rtn_scope(enum rt_scope_t s)
2289{
2290 static char buf[32];
2291
Stephen Hemminger132adf52007-03-08 20:44:43 -08002292 switch (s) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002293 case RT_SCOPE_UNIVERSE: return "universe";
2294 case RT_SCOPE_SITE: return "site";
2295 case RT_SCOPE_LINK: return "link";
2296 case RT_SCOPE_HOST: return "host";
2297 case RT_SCOPE_NOWHERE: return "nowhere";
2298 default:
2299 snprintf(buf, sizeof(buf), "scope=%d", s);
2300 return buf;
2301 }
2302}
2303
2304static const char *rtn_type_names[__RTN_MAX] = {
2305 [RTN_UNSPEC] = "UNSPEC",
2306 [RTN_UNICAST] = "UNICAST",
2307 [RTN_LOCAL] = "LOCAL",
2308 [RTN_BROADCAST] = "BROADCAST",
2309 [RTN_ANYCAST] = "ANYCAST",
2310 [RTN_MULTICAST] = "MULTICAST",
2311 [RTN_BLACKHOLE] = "BLACKHOLE",
2312 [RTN_UNREACHABLE] = "UNREACHABLE",
2313 [RTN_PROHIBIT] = "PROHIBIT",
2314 [RTN_THROW] = "THROW",
2315 [RTN_NAT] = "NAT",
2316 [RTN_XRESOLVE] = "XRESOLVE",
2317};
2318
2319static inline const char *rtn_type(unsigned t)
2320{
2321 static char buf[32];
2322
2323 if (t < __RTN_MAX && rtn_type_names[t])
2324 return rtn_type_names[t];
Stephen Hemminger187b5182008-01-12 20:55:55 -08002325 snprintf(buf, sizeof(buf), "type %u", t);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002326 return buf;
2327}
2328
2329/* Pretty print the trie */
Robert Olsson19baf832005-06-21 12:43:18 -07002330static int fib_trie_seq_show(struct seq_file *seq, void *v)
2331{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002332 const struct fib_trie_iter *iter = seq->private;
2333 struct node *n = v;
Robert Olsson19baf832005-06-21 12:43:18 -07002334
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002335 if (v == SEQ_START_TOKEN)
2336 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002337
Stephen Hemminger06801912007-08-10 15:22:13 -07002338 if (!node_parent(n)) {
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002339 if (iter->trie == iter->trie_local)
Robert Olsson095b8502007-01-26 19:06:01 -08002340 seq_puts(seq, "<local>:\n");
2341 else
2342 seq_puts(seq, "<main>:\n");
2343 }
2344
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002345 if (IS_TNODE(n)) {
2346 struct tnode *tn = (struct tnode *) n;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07002347 __be32 prf = htonl(mask_pfx(tn->key, tn->pos));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002348
Robert Olsson1d25cd62005-09-19 15:29:52 -07002349 seq_indent(seq, iter->depth-1);
2350 seq_printf(seq, " +-- %d.%d.%d.%d/%d %d %d %d\n",
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002351 NIPQUAD(prf), tn->pos, tn->bits, tn->full_children,
Robert Olsson1d25cd62005-09-19 15:29:52 -07002352 tn->empty_children);
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002353
Olof Johansson91b9a272005-08-09 20:24:39 -07002354 } else {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002355 struct leaf *l = (struct leaf *) n;
2356 int i;
Al Viro32ab5f82006-09-26 22:21:45 -07002357 __be32 val = htonl(l->key);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002358
2359 seq_indent(seq, iter->depth);
2360 seq_printf(seq, " |-- %d.%d.%d.%d\n", NIPQUAD(val));
2361 for (i = 32; i >= 0; i--) {
Robert Olsson772cb712005-09-19 15:31:18 -07002362 struct leaf_info *li = find_leaf_info(l, i);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002363 if (li) {
2364 struct fib_alias *fa;
2365 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
2366 seq_indent(seq, iter->depth+1);
2367 seq_printf(seq, " /%d %s %s", i,
2368 rtn_scope(fa->fa_scope),
2369 rtn_type(fa->fa_type));
2370 if (fa->fa_tos)
2371 seq_printf(seq, "tos =%d\n",
2372 fa->fa_tos);
2373 seq_putc(seq, '\n');
2374 }
2375 }
2376 }
Robert Olsson19baf832005-06-21 12:43:18 -07002377 }
2378
2379 return 0;
2380}
2381
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002382static const struct seq_operations fib_trie_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002383 .start = fib_trie_seq_start,
2384 .next = fib_trie_seq_next,
2385 .stop = fib_trie_seq_stop,
2386 .show = fib_trie_seq_show,
Robert Olsson19baf832005-06-21 12:43:18 -07002387};
2388
2389static int fib_trie_seq_open(struct inode *inode, struct file *file)
2390{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002391 return seq_open_net(inode, file, &fib_trie_seq_ops,
2392 sizeof(struct fib_trie_iter));
Robert Olsson19baf832005-06-21 12:43:18 -07002393}
2394
Arjan van de Ven9a321442007-02-12 00:55:35 -08002395static const struct file_operations fib_trie_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002396 .owner = THIS_MODULE,
2397 .open = fib_trie_seq_open,
2398 .read = seq_read,
2399 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002400 .release = seq_release_net,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002401};
2402
Al Viro32ab5f82006-09-26 22:21:45 -07002403static unsigned fib_flag_trans(int type, __be32 mask, const struct fib_info *fi)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002404{
2405 static unsigned type2flags[RTN_MAX + 1] = {
2406 [7] = RTF_REJECT, [8] = RTF_REJECT,
2407 };
2408 unsigned flags = type2flags[type];
2409
2410 if (fi && fi->fib_nh->nh_gw)
2411 flags |= RTF_GATEWAY;
Al Viro32ab5f82006-09-26 22:21:45 -07002412 if (mask == htonl(0xFFFFFFFF))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002413 flags |= RTF_HOST;
2414 flags |= RTF_UP;
2415 return flags;
2416}
2417
2418/*
2419 * This outputs /proc/net/route.
2420 * The format of the file is not supposed to be changed
2421 * and needs to be same as fib_hash output to avoid breaking
2422 * legacy utilities
2423 */
2424static int fib_route_seq_show(struct seq_file *seq, void *v)
2425{
Patrick McHardyc9e53cb2005-11-20 21:09:00 -08002426 const struct fib_trie_iter *iter = seq->private;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002427 struct leaf *l = v;
2428 int i;
2429 char bf[128];
2430
2431 if (v == SEQ_START_TOKEN) {
2432 seq_printf(seq, "%-127s\n", "Iface\tDestination\tGateway "
2433 "\tFlags\tRefCnt\tUse\tMetric\tMask\t\tMTU"
2434 "\tWindow\tIRTT");
2435 return 0;
2436 }
2437
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002438 if (iter->trie == iter->trie_local)
Patrick McHardyc9e53cb2005-11-20 21:09:00 -08002439 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002440 if (IS_TNODE(l))
2441 return 0;
2442
2443 for (i=32; i>=0; i--) {
Robert Olsson772cb712005-09-19 15:31:18 -07002444 struct leaf_info *li = find_leaf_info(l, i);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002445 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07002446 __be32 mask, prefix;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002447
2448 if (!li)
2449 continue;
2450
2451 mask = inet_make_mask(li->plen);
2452 prefix = htonl(l->key);
2453
2454 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
Herbert Xu1371e372005-10-15 09:42:39 +10002455 const struct fib_info *fi = fa->fa_info;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002456 unsigned flags = fib_flag_trans(fa->fa_type, mask, fi);
2457
2458 if (fa->fa_type == RTN_BROADCAST
2459 || fa->fa_type == RTN_MULTICAST)
2460 continue;
2461
2462 if (fi)
2463 snprintf(bf, sizeof(bf),
2464 "%s\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2465 fi->fib_dev ? fi->fib_dev->name : "*",
2466 prefix,
2467 fi->fib_nh->nh_gw, flags, 0, 0,
2468 fi->fib_priority,
2469 mask,
2470 (fi->fib_advmss ? fi->fib_advmss + 40 : 0),
2471 fi->fib_window,
2472 fi->fib_rtt >> 3);
2473 else
2474 snprintf(bf, sizeof(bf),
2475 "*\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2476 prefix, 0, flags, 0, 0, 0,
2477 mask, 0, 0, 0);
2478
2479 seq_printf(seq, "%-127s\n", bf);
2480 }
2481 }
2482
2483 return 0;
2484}
2485
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002486static const struct seq_operations fib_route_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002487 .start = fib_trie_seq_start,
2488 .next = fib_trie_seq_next,
2489 .stop = fib_trie_seq_stop,
2490 .show = fib_route_seq_show,
2491};
2492
2493static int fib_route_seq_open(struct inode *inode, struct file *file)
2494{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002495 return seq_open_net(inode, file, &fib_route_seq_ops,
2496 sizeof(struct fib_trie_iter));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002497}
2498
Arjan van de Ven9a321442007-02-12 00:55:35 -08002499static const struct file_operations fib_route_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002500 .owner = THIS_MODULE,
2501 .open = fib_route_seq_open,
2502 .read = seq_read,
2503 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002504 .release = seq_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002505};
2506
Denis V. Lunev61a02652008-01-10 03:21:09 -08002507int __net_init fib_proc_init(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002508{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002509 if (!proc_net_fops_create(net, "fib_trie", S_IRUGO, &fib_trie_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002510 goto out1;
2511
Denis V. Lunev61a02652008-01-10 03:21:09 -08002512 if (!proc_net_fops_create(net, "fib_triestat", S_IRUGO,
2513 &fib_triestat_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002514 goto out2;
2515
Denis V. Lunev61a02652008-01-10 03:21:09 -08002516 if (!proc_net_fops_create(net, "route", S_IRUGO, &fib_route_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002517 goto out3;
2518
Robert Olsson19baf832005-06-21 12:43:18 -07002519 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002520
2521out3:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002522 proc_net_remove(net, "fib_triestat");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002523out2:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002524 proc_net_remove(net, "fib_trie");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002525out1:
2526 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002527}
2528
Denis V. Lunev61a02652008-01-10 03:21:09 -08002529void __net_exit fib_proc_exit(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002530{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002531 proc_net_remove(net, "fib_trie");
2532 proc_net_remove(net, "fib_triestat");
2533 proc_net_remove(net, "route");
Robert Olsson19baf832005-06-21 12:43:18 -07002534}
2535
2536#endif /* CONFIG_PROC_FS */