blob: 350904c233ee343b5375decd6d8b67d898daa996 [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 Olsson19baf832005-06-21 12:43:18 -0700394 memset(tn, 0, sz);
Robert Olsson2373ce12005-08-25 13:01:29 -0700395 tn->parent = T_TNODE;
Robert Olsson19baf832005-06-21 12:43:18 -0700396 tn->pos = pos;
397 tn->bits = bits;
398 tn->key = key;
399 tn->full_children = 0;
400 tn->empty_children = 1<<bits;
401 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700402
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700403 pr_debug("AT %p s=%u %u\n", tn, (unsigned int) sizeof(struct tnode),
404 (unsigned int) (sizeof(struct node) * 1<<bits));
Robert Olsson19baf832005-06-21 12:43:18 -0700405 return tn;
406}
407
Robert Olsson19baf832005-06-21 12:43:18 -0700408/*
409 * Check whether a tnode 'n' is "full", i.e. it is an internal node
410 * and no bits are skipped. See discussion in dyntree paper p. 6
411 */
412
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700413static inline int tnode_full(const struct tnode *tn, const struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700414{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700415 if (n == NULL || IS_LEAF(n))
Robert Olsson19baf832005-06-21 12:43:18 -0700416 return 0;
417
418 return ((struct tnode *) n)->pos == tn->pos + tn->bits;
419}
420
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700421static inline void put_child(struct trie *t, struct tnode *tn, int i, struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700422{
423 tnode_put_child_reorg(tn, i, n, -1);
424}
425
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700426 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700427 * Add a child at position i overwriting the old value.
428 * Update the value of full_children and empty_children.
429 */
430
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700431static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n, int wasfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700432{
Robert Olsson2373ce12005-08-25 13:01:29 -0700433 struct node *chi = tn->child[i];
Robert Olsson19baf832005-06-21 12:43:18 -0700434 int isfull;
435
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700436 BUG_ON(i >= 1<<tn->bits);
437
Robert Olsson19baf832005-06-21 12:43:18 -0700438
439 /* update emptyChildren */
440 if (n == NULL && chi != NULL)
441 tn->empty_children++;
442 else if (n != NULL && chi == NULL)
443 tn->empty_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700444
Robert Olsson19baf832005-06-21 12:43:18 -0700445 /* update fullChildren */
Olof Johansson91b9a272005-08-09 20:24:39 -0700446 if (wasfull == -1)
Robert Olsson19baf832005-06-21 12:43:18 -0700447 wasfull = tnode_full(tn, chi);
448
449 isfull = tnode_full(tn, n);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700450 if (wasfull && !isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700451 tn->full_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700452 else if (!wasfull && isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700453 tn->full_children++;
Olof Johansson91b9a272005-08-09 20:24:39 -0700454
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700455 if (n)
Stephen Hemminger06801912007-08-10 15:22:13 -0700456 node_set_parent(n, tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700457
Robert Olsson2373ce12005-08-25 13:01:29 -0700458 rcu_assign_pointer(tn->child[i], n);
Robert Olsson19baf832005-06-21 12:43:18 -0700459}
460
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700461static struct node *resize(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700462{
463 int i;
Robert Olsson2f368952005-07-05 15:02:40 -0700464 int err = 0;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700465 struct tnode *old_tn;
Robert Olssone6308be2005-10-04 13:01:58 -0700466 int inflate_threshold_use;
467 int halve_threshold_use;
Robert Olsson05eee482007-03-19 16:27:37 -0700468 int max_resize;
Robert Olsson19baf832005-06-21 12:43:18 -0700469
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900470 if (!tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700471 return NULL;
472
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700473 pr_debug("In tnode_resize %p inflate_threshold=%d threshold=%d\n",
474 tn, inflate_threshold, halve_threshold);
Robert Olsson19baf832005-06-21 12:43:18 -0700475
476 /* No children */
477 if (tn->empty_children == tnode_child_length(tn)) {
478 tnode_free(tn);
479 return NULL;
480 }
481 /* One child */
482 if (tn->empty_children == tnode_child_length(tn) - 1)
483 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700484 struct node *n;
Robert Olsson19baf832005-06-21 12:43:18 -0700485
Olof Johansson91b9a272005-08-09 20:24:39 -0700486 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700487 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700488 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700489
490 /* compress one level */
Stephen Hemminger06801912007-08-10 15:22:13 -0700491 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700492 tnode_free(tn);
493 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700494 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700495 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700496 * Double as long as the resulting node has a number of
497 * nonempty nodes that are above the threshold.
498 */
499
500 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700501 * From "Implementing a dynamic compressed trie" by Stefan Nilsson of
502 * the Helsinki University of Technology and Matti Tikkanen of Nokia
Robert Olsson19baf832005-06-21 12:43:18 -0700503 * Telecommunications, page 6:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700504 * "A node is doubled if the ratio of non-empty children to all
Robert Olsson19baf832005-06-21 12:43:18 -0700505 * children in the *doubled* node is at least 'high'."
506 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700507 * 'high' in this instance is the variable 'inflate_threshold'. It
508 * is expressed as a percentage, so we multiply it with
509 * tnode_child_length() and instead of multiplying by 2 (since the
510 * child array will be doubled by inflate()) and multiplying
511 * the left-hand side by 100 (to handle the percentage thing) we
Robert Olsson19baf832005-06-21 12:43:18 -0700512 * multiply the left-hand side by 50.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700513 *
514 * The left-hand side may look a bit weird: tnode_child_length(tn)
515 * - tn->empty_children is of course the number of non-null children
516 * in the current node. tn->full_children is the number of "full"
Robert Olsson19baf832005-06-21 12:43:18 -0700517 * children, that is non-null tnodes with a skip value of 0.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700518 * All of those will be doubled in the resulting inflated tnode, so
Robert Olsson19baf832005-06-21 12:43:18 -0700519 * we just count them one extra time here.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700520 *
Robert Olsson19baf832005-06-21 12:43:18 -0700521 * A clearer way to write this would be:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700522 *
Robert Olsson19baf832005-06-21 12:43:18 -0700523 * to_be_doubled = tn->full_children;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700524 * not_to_be_doubled = tnode_child_length(tn) - tn->empty_children -
Robert Olsson19baf832005-06-21 12:43:18 -0700525 * tn->full_children;
526 *
527 * new_child_length = tnode_child_length(tn) * 2;
528 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700529 * new_fill_factor = 100 * (not_to_be_doubled + 2*to_be_doubled) /
Robert Olsson19baf832005-06-21 12:43:18 -0700530 * new_child_length;
531 * if (new_fill_factor >= inflate_threshold)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700532 *
533 * ...and so on, tho it would mess up the while () loop.
534 *
Robert Olsson19baf832005-06-21 12:43:18 -0700535 * anyway,
536 * 100 * (not_to_be_doubled + 2*to_be_doubled) / new_child_length >=
537 * inflate_threshold
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700538 *
Robert Olsson19baf832005-06-21 12:43:18 -0700539 * avoid a division:
540 * 100 * (not_to_be_doubled + 2*to_be_doubled) >=
541 * inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700542 *
Robert Olsson19baf832005-06-21 12:43:18 -0700543 * expand not_to_be_doubled and to_be_doubled, and shorten:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700544 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700545 * tn->full_children) >= inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700546 *
Robert Olsson19baf832005-06-21 12:43:18 -0700547 * expand new_child_length:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700548 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700549 * tn->full_children) >=
Robert Olsson19baf832005-06-21 12:43:18 -0700550 * inflate_threshold * tnode_child_length(tn) * 2
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700551 *
Robert Olsson19baf832005-06-21 12:43:18 -0700552 * shorten again:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700553 * 50 * (tn->full_children + tnode_child_length(tn) -
Olof Johansson91b9a272005-08-09 20:24:39 -0700554 * tn->empty_children) >= inflate_threshold *
Robert Olsson19baf832005-06-21 12:43:18 -0700555 * tnode_child_length(tn)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700556 *
Robert Olsson19baf832005-06-21 12:43:18 -0700557 */
558
559 check_tnode(tn);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700560
Robert Olssone6308be2005-10-04 13:01:58 -0700561 /* Keep root node larger */
562
Stephen Hemminger132adf52007-03-08 20:44:43 -0800563 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700564 inflate_threshold_use = inflate_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900565 else
Robert Olssone6308be2005-10-04 13:01:58 -0700566 inflate_threshold_use = inflate_threshold;
567
Robert Olsson2f368952005-07-05 15:02:40 -0700568 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700569 max_resize = 10;
570 while ((tn->full_children > 0 && max_resize-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700571 50 * (tn->full_children + tnode_child_length(tn) - tn->empty_children) >=
Robert Olssone6308be2005-10-04 13:01:58 -0700572 inflate_threshold_use * tnode_child_length(tn))) {
Robert Olsson19baf832005-06-21 12:43:18 -0700573
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700574 old_tn = tn;
575 tn = inflate(t, tn);
576 if (IS_ERR(tn)) {
577 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700578#ifdef CONFIG_IP_FIB_TRIE_STATS
579 t->stats.resize_node_skipped++;
580#endif
581 break;
582 }
Robert Olsson19baf832005-06-21 12:43:18 -0700583 }
584
Robert Olsson05eee482007-03-19 16:27:37 -0700585 if (max_resize < 0) {
586 if (!tn->parent)
587 printk(KERN_WARNING "Fix inflate_threshold_root. Now=%d size=%d bits\n",
588 inflate_threshold_root, tn->bits);
589 else
590 printk(KERN_WARNING "Fix inflate_threshold. Now=%d size=%d bits\n",
591 inflate_threshold, tn->bits);
592 }
593
Robert Olsson19baf832005-06-21 12:43:18 -0700594 check_tnode(tn);
595
596 /*
597 * Halve as long as the number of empty children in this
598 * node is above threshold.
599 */
Robert Olsson2f368952005-07-05 15:02:40 -0700600
Robert Olssone6308be2005-10-04 13:01:58 -0700601
602 /* Keep root node larger */
603
Stephen Hemminger132adf52007-03-08 20:44:43 -0800604 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700605 halve_threshold_use = halve_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900606 else
Robert Olssone6308be2005-10-04 13:01:58 -0700607 halve_threshold_use = halve_threshold;
608
Robert Olsson2f368952005-07-05 15:02:40 -0700609 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700610 max_resize = 10;
611 while (tn->bits > 1 && max_resize-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700612 100 * (tnode_child_length(tn) - tn->empty_children) <
Robert Olssone6308be2005-10-04 13:01:58 -0700613 halve_threshold_use * tnode_child_length(tn)) {
Robert Olsson19baf832005-06-21 12:43:18 -0700614
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700615 old_tn = tn;
616 tn = halve(t, tn);
617 if (IS_ERR(tn)) {
618 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700619#ifdef CONFIG_IP_FIB_TRIE_STATS
620 t->stats.resize_node_skipped++;
621#endif
622 break;
623 }
624 }
625
Robert Olsson05eee482007-03-19 16:27:37 -0700626 if (max_resize < 0) {
627 if (!tn->parent)
628 printk(KERN_WARNING "Fix halve_threshold_root. Now=%d size=%d bits\n",
629 halve_threshold_root, tn->bits);
630 else
631 printk(KERN_WARNING "Fix halve_threshold. Now=%d size=%d bits\n",
632 halve_threshold, tn->bits);
633 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700634
Robert Olsson19baf832005-06-21 12:43:18 -0700635 /* Only one child remains */
Robert Olsson19baf832005-06-21 12:43:18 -0700636 if (tn->empty_children == tnode_child_length(tn) - 1)
637 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700638 struct node *n;
639
Olof Johansson91b9a272005-08-09 20:24:39 -0700640 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700641 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700642 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700643
644 /* compress one level */
645
Stephen Hemminger06801912007-08-10 15:22:13 -0700646 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700647 tnode_free(tn);
648 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700649 }
650
651 return (struct node *) tn;
652}
653
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700654static struct tnode *inflate(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700655{
Robert Olsson19baf832005-06-21 12:43:18 -0700656 struct tnode *oldtnode = tn;
657 int olen = tnode_child_length(tn);
658 int i;
659
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700660 pr_debug("In inflate\n");
Robert Olsson19baf832005-06-21 12:43:18 -0700661
662 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits + 1);
663
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700664 if (!tn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700665 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700666
667 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700668 * Preallocate and store tnodes before the actual work so we
669 * don't get into an inconsistent state if memory allocation
670 * fails. In case of failure we return the oldnode and inflate
Robert Olsson2f368952005-07-05 15:02:40 -0700671 * of tnode is ignored.
672 */
Olof Johansson91b9a272005-08-09 20:24:39 -0700673
674 for (i = 0; i < olen; i++) {
Robert Olsson2f368952005-07-05 15:02:40 -0700675 struct tnode *inode = (struct tnode *) tnode_get_child(oldtnode, i);
676
677 if (inode &&
678 IS_TNODE(inode) &&
679 inode->pos == oldtnode->pos + oldtnode->bits &&
680 inode->bits > 1) {
681 struct tnode *left, *right;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700682 t_key m = ~0U << (KEYLENGTH - 1) >> inode->pos;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700683
Robert Olsson2f368952005-07-05 15:02:40 -0700684 left = tnode_new(inode->key&(~m), inode->pos + 1,
685 inode->bits - 1);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700686 if (!left)
687 goto nomem;
Olof Johansson91b9a272005-08-09 20:24:39 -0700688
Robert Olsson2f368952005-07-05 15:02:40 -0700689 right = tnode_new(inode->key|m, inode->pos + 1,
690 inode->bits - 1);
691
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900692 if (!right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700693 tnode_free(left);
694 goto nomem;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900695 }
Robert Olsson2f368952005-07-05 15:02:40 -0700696
697 put_child(t, tn, 2*i, (struct node *) left);
698 put_child(t, tn, 2*i+1, (struct node *) right);
699 }
700 }
701
Olof Johansson91b9a272005-08-09 20:24:39 -0700702 for (i = 0; i < olen; i++) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -0800703 struct tnode *inode;
Robert Olsson19baf832005-06-21 12:43:18 -0700704 struct node *node = tnode_get_child(oldtnode, i);
Olof Johansson91b9a272005-08-09 20:24:39 -0700705 struct tnode *left, *right;
706 int size, j;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700707
Robert Olsson19baf832005-06-21 12:43:18 -0700708 /* An empty child */
709 if (node == NULL)
710 continue;
711
712 /* A leaf or an internal node with skipped bits */
713
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700714 if (IS_LEAF(node) || ((struct tnode *) node)->pos >
Robert Olsson19baf832005-06-21 12:43:18 -0700715 tn->pos + tn->bits - 1) {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700716 if (tkey_extract_bits(node->key, oldtnode->pos + oldtnode->bits,
Robert Olsson19baf832005-06-21 12:43:18 -0700717 1) == 0)
718 put_child(t, tn, 2*i, node);
719 else
720 put_child(t, tn, 2*i+1, node);
721 continue;
722 }
723
724 /* An internal node with two children */
725 inode = (struct tnode *) node;
726
727 if (inode->bits == 1) {
728 put_child(t, tn, 2*i, inode->child[0]);
729 put_child(t, tn, 2*i+1, inode->child[1]);
730
731 tnode_free(inode);
Olof Johansson91b9a272005-08-09 20:24:39 -0700732 continue;
Robert Olsson19baf832005-06-21 12:43:18 -0700733 }
734
Olof Johansson91b9a272005-08-09 20:24:39 -0700735 /* An internal node with more than two children */
Robert Olsson19baf832005-06-21 12:43:18 -0700736
Olof Johansson91b9a272005-08-09 20:24:39 -0700737 /* We will replace this node 'inode' with two new
738 * ones, 'left' and 'right', each with half of the
739 * original children. The two new nodes will have
740 * a position one bit further down the key and this
741 * means that the "significant" part of their keys
742 * (see the discussion near the top of this file)
743 * will differ by one bit, which will be "0" in
744 * left's key and "1" in right's key. Since we are
745 * moving the key position by one step, the bit that
746 * we are moving away from - the bit at position
747 * (inode->pos) - is the one that will differ between
748 * left and right. So... we synthesize that bit in the
749 * two new keys.
750 * The mask 'm' below will be a single "one" bit at
751 * the position (inode->pos)
752 */
Robert Olsson19baf832005-06-21 12:43:18 -0700753
Olof Johansson91b9a272005-08-09 20:24:39 -0700754 /* Use the old key, but set the new significant
755 * bit to zero.
756 */
Robert Olsson19baf832005-06-21 12:43:18 -0700757
Olof Johansson91b9a272005-08-09 20:24:39 -0700758 left = (struct tnode *) tnode_get_child(tn, 2*i);
759 put_child(t, tn, 2*i, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -0700760
Olof Johansson91b9a272005-08-09 20:24:39 -0700761 BUG_ON(!left);
Robert Olsson2f368952005-07-05 15:02:40 -0700762
Olof Johansson91b9a272005-08-09 20:24:39 -0700763 right = (struct tnode *) tnode_get_child(tn, 2*i+1);
764 put_child(t, tn, 2*i+1, NULL);
Robert Olsson2f368952005-07-05 15:02:40 -0700765
Olof Johansson91b9a272005-08-09 20:24:39 -0700766 BUG_ON(!right);
Robert Olsson2f368952005-07-05 15:02:40 -0700767
Olof Johansson91b9a272005-08-09 20:24:39 -0700768 size = tnode_child_length(left);
769 for (j = 0; j < size; j++) {
770 put_child(t, left, j, inode->child[j]);
771 put_child(t, right, j, inode->child[j + size]);
Robert Olsson19baf832005-06-21 12:43:18 -0700772 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700773 put_child(t, tn, 2*i, resize(t, left));
774 put_child(t, tn, 2*i+1, resize(t, right));
775
776 tnode_free(inode);
Robert Olsson19baf832005-06-21 12:43:18 -0700777 }
778 tnode_free(oldtnode);
779 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700780nomem:
781 {
782 int size = tnode_child_length(tn);
783 int j;
784
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700785 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700786 if (tn->child[j])
787 tnode_free((struct tnode *)tn->child[j]);
788
789 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700790
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700791 return ERR_PTR(-ENOMEM);
792 }
Robert Olsson19baf832005-06-21 12:43:18 -0700793}
794
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700795static struct tnode *halve(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700796{
797 struct tnode *oldtnode = tn;
798 struct node *left, *right;
799 int i;
800 int olen = tnode_child_length(tn);
801
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700802 pr_debug("In halve\n");
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700803
804 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits - 1);
Robert Olsson19baf832005-06-21 12:43:18 -0700805
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700806 if (!tn)
807 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700808
809 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700810 * Preallocate and store tnodes before the actual work so we
811 * don't get into an inconsistent state if memory allocation
812 * fails. In case of failure we return the oldnode and halve
Robert Olsson2f368952005-07-05 15:02:40 -0700813 * of tnode is ignored.
814 */
815
Olof Johansson91b9a272005-08-09 20:24:39 -0700816 for (i = 0; i < olen; i += 2) {
Robert Olsson2f368952005-07-05 15:02:40 -0700817 left = tnode_get_child(oldtnode, i);
818 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700819
Robert Olsson2f368952005-07-05 15:02:40 -0700820 /* Two nonempty children */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700821 if (left && right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700822 struct tnode *newn;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700823
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700824 newn = tnode_new(left->key, tn->pos + tn->bits, 1);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700825
826 if (!newn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700827 goto nomem;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700828
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700829 put_child(t, tn, i/2, (struct node *)newn);
Robert Olsson2f368952005-07-05 15:02:40 -0700830 }
Robert Olsson2f368952005-07-05 15:02:40 -0700831
Robert Olsson2f368952005-07-05 15:02:40 -0700832 }
Robert Olsson19baf832005-06-21 12:43:18 -0700833
Olof Johansson91b9a272005-08-09 20:24:39 -0700834 for (i = 0; i < olen; i += 2) {
835 struct tnode *newBinNode;
836
Robert Olsson19baf832005-06-21 12:43:18 -0700837 left = tnode_get_child(oldtnode, i);
838 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700839
Robert Olsson19baf832005-06-21 12:43:18 -0700840 /* At least one of the children is empty */
841 if (left == NULL) {
842 if (right == NULL) /* Both are empty */
843 continue;
844 put_child(t, tn, i/2, right);
Olof Johansson91b9a272005-08-09 20:24:39 -0700845 continue;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700846 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700847
848 if (right == NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700849 put_child(t, tn, i/2, left);
Olof Johansson91b9a272005-08-09 20:24:39 -0700850 continue;
851 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700852
Robert Olsson19baf832005-06-21 12:43:18 -0700853 /* Two nonempty children */
Olof Johansson91b9a272005-08-09 20:24:39 -0700854 newBinNode = (struct tnode *) tnode_get_child(tn, i/2);
855 put_child(t, tn, i/2, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700856 put_child(t, newBinNode, 0, left);
857 put_child(t, newBinNode, 1, right);
858 put_child(t, tn, i/2, resize(t, newBinNode));
Robert Olsson19baf832005-06-21 12:43:18 -0700859 }
860 tnode_free(oldtnode);
861 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700862nomem:
863 {
864 int size = tnode_child_length(tn);
865 int j;
866
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700867 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700868 if (tn->child[j])
869 tnode_free((struct tnode *)tn->child[j]);
870
871 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700872
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700873 return ERR_PTR(-ENOMEM);
874 }
Robert Olsson19baf832005-06-21 12:43:18 -0700875}
876
Robert Olsson772cb712005-09-19 15:31:18 -0700877/* readside must use rcu_read_lock currently dump routines
Robert Olsson2373ce12005-08-25 13:01:29 -0700878 via get_fa_head and dump */
879
Robert Olsson772cb712005-09-19 15:31:18 -0700880static struct leaf_info *find_leaf_info(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700881{
Robert Olsson772cb712005-09-19 15:31:18 -0700882 struct hlist_head *head = &l->list;
Robert Olsson19baf832005-06-21 12:43:18 -0700883 struct hlist_node *node;
884 struct leaf_info *li;
885
Robert Olsson2373ce12005-08-25 13:01:29 -0700886 hlist_for_each_entry_rcu(li, node, head, hlist)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700887 if (li->plen == plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700888 return li;
Olof Johansson91b9a272005-08-09 20:24:39 -0700889
Robert Olsson19baf832005-06-21 12:43:18 -0700890 return NULL;
891}
892
893static inline struct list_head * get_fa_head(struct leaf *l, int plen)
894{
Robert Olsson772cb712005-09-19 15:31:18 -0700895 struct leaf_info *li = find_leaf_info(l, plen);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700896
Olof Johansson91b9a272005-08-09 20:24:39 -0700897 if (!li)
898 return NULL;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700899
Olof Johansson91b9a272005-08-09 20:24:39 -0700900 return &li->falh;
Robert Olsson19baf832005-06-21 12:43:18 -0700901}
902
903static void insert_leaf_info(struct hlist_head *head, struct leaf_info *new)
904{
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900905 struct leaf_info *li = NULL, *last = NULL;
906 struct hlist_node *node;
Robert Olsson19baf832005-06-21 12:43:18 -0700907
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900908 if (hlist_empty(head)) {
909 hlist_add_head_rcu(&new->hlist, head);
910 } else {
911 hlist_for_each_entry(li, node, head, hlist) {
912 if (new->plen > li->plen)
913 break;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700914
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900915 last = li;
916 }
917 if (last)
918 hlist_add_after_rcu(&last->hlist, &new->hlist);
919 else
920 hlist_add_before_rcu(&new->hlist, &li->hlist);
921 }
Robert Olsson19baf832005-06-21 12:43:18 -0700922}
923
Robert Olsson2373ce12005-08-25 13:01:29 -0700924/* rcu_read_lock needs to be hold by caller from readside */
925
Robert Olsson19baf832005-06-21 12:43:18 -0700926static struct leaf *
927fib_find_node(struct trie *t, u32 key)
928{
929 int pos;
930 struct tnode *tn;
931 struct node *n;
932
933 pos = 0;
Robert Olsson2373ce12005-08-25 13:01:29 -0700934 n = rcu_dereference(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -0700935
936 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
937 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -0700938
Robert Olsson19baf832005-06-21 12:43:18 -0700939 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700940
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700941 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700942 pos = tn->pos + tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -0700943 n = tnode_get_child(tn, tkey_extract_bits(key, tn->pos, tn->bits));
Olof Johansson91b9a272005-08-09 20:24:39 -0700944 } else
Robert Olsson19baf832005-06-21 12:43:18 -0700945 break;
946 }
947 /* Case we have found a leaf. Compare prefixes */
948
Olof Johansson91b9a272005-08-09 20:24:39 -0700949 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key))
950 return (struct leaf *)n;
951
Robert Olsson19baf832005-06-21 12:43:18 -0700952 return NULL;
953}
954
955static struct node *trie_rebalance(struct trie *t, struct tnode *tn)
956{
Robert Olsson19baf832005-06-21 12:43:18 -0700957 int wasfull;
Stephen Hemminger06801912007-08-10 15:22:13 -0700958 t_key cindex, key = tn->key;
959 struct tnode *tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700960
Stephen Hemminger06801912007-08-10 15:22:13 -0700961 while (tn != NULL && (tp = node_parent((struct node *)tn)) != NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700962 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
963 wasfull = tnode_full(tp, tnode_get_child(tp, cindex));
964 tn = (struct tnode *) resize (t, (struct tnode *)tn);
965 tnode_put_child_reorg((struct tnode *)tp, cindex,(struct node*)tn, wasfull);
Olof Johansson91b9a272005-08-09 20:24:39 -0700966
Stephen Hemminger06801912007-08-10 15:22:13 -0700967 tp = node_parent((struct node *) tn);
968 if (!tp)
Robert Olsson19baf832005-06-21 12:43:18 -0700969 break;
Stephen Hemminger06801912007-08-10 15:22:13 -0700970 tn = tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700971 }
Stephen Hemminger06801912007-08-10 15:22:13 -0700972
Robert Olsson19baf832005-06-21 12:43:18 -0700973 /* Handle last (top) tnode */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700974 if (IS_TNODE(tn))
Robert Olsson19baf832005-06-21 12:43:18 -0700975 tn = (struct tnode*) resize(t, (struct tnode *)tn);
976
977 return (struct node*) tn;
978}
979
Robert Olsson2373ce12005-08-25 13:01:29 -0700980/* only used from updater-side */
981
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -0800982static struct list_head *fib_insert_node(struct trie *t, u32 key, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700983{
984 int pos, newpos;
985 struct tnode *tp = NULL, *tn = NULL;
986 struct node *n;
987 struct leaf *l;
988 int missbit;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700989 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -0700990 struct leaf_info *li;
991 t_key cindex;
992
993 pos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700994 n = t->trie;
Robert Olsson19baf832005-06-21 12:43:18 -0700995
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700996 /* If we point to NULL, stop. Either the tree is empty and we should
997 * just put a new leaf in if, or we have reached an empty child slot,
Robert Olsson19baf832005-06-21 12:43:18 -0700998 * and we should just put our new leaf in that.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700999 * If we point to a T_TNODE, check if it matches our key. Note that
1000 * a T_TNODE might be skipping any number of bits - its 'pos' need
Robert Olsson19baf832005-06-21 12:43:18 -07001001 * not be the parent's 'pos'+'bits'!
1002 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001003 * If it does match the current key, get pos/bits from it, extract
Robert Olsson19baf832005-06-21 12:43:18 -07001004 * the index from our key, push the T_TNODE and walk the tree.
1005 *
1006 * If it doesn't, we have to replace it with a new T_TNODE.
1007 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001008 * If we point to a T_LEAF, it might or might not have the same key
1009 * as we do. If it does, just change the value, update the T_LEAF's
1010 * value, and return it.
Robert Olsson19baf832005-06-21 12:43:18 -07001011 * If it doesn't, we need to replace it with a T_TNODE.
1012 */
1013
1014 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
1015 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -07001016
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001017 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001018
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001019 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001020 tp = tn;
Olof Johansson91b9a272005-08-09 20:24:39 -07001021 pos = tn->pos + tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001022 n = tnode_get_child(tn, tkey_extract_bits(key, tn->pos, tn->bits));
1023
Stephen Hemminger06801912007-08-10 15:22:13 -07001024 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001025 } else
Robert Olsson19baf832005-06-21 12:43:18 -07001026 break;
1027 }
1028
1029 /*
1030 * n ----> NULL, LEAF or TNODE
1031 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001032 * tp is n's (parent) ----> NULL or TNODE
Robert Olsson19baf832005-06-21 12:43:18 -07001033 */
1034
Olof Johansson91b9a272005-08-09 20:24:39 -07001035 BUG_ON(tp && IS_LEAF(tp));
Robert Olsson19baf832005-06-21 12:43:18 -07001036
1037 /* Case 1: n is a leaf. Compare prefixes */
1038
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001039 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key)) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08001040 l = (struct leaf *) n;
Robert Olsson19baf832005-06-21 12:43:18 -07001041 li = leaf_info_new(plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001042
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001043 if (!li)
1044 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001045
1046 fa_head = &li->falh;
1047 insert_leaf_info(&l->list, li);
1048 goto done;
1049 }
1050 t->size++;
1051 l = leaf_new();
1052
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001053 if (!l)
1054 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001055
1056 l->key = key;
1057 li = leaf_info_new(plen);
1058
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001059 if (!li) {
Robert Olssonf835e472005-06-28 15:00:39 -07001060 tnode_free((struct tnode *) l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001061 return NULL;
Robert Olssonf835e472005-06-28 15:00:39 -07001062 }
Robert Olsson19baf832005-06-21 12:43:18 -07001063
1064 fa_head = &li->falh;
1065 insert_leaf_info(&l->list, li);
1066
Robert Olsson19baf832005-06-21 12:43:18 -07001067 if (t->trie && n == NULL) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001068 /* Case 2: n is NULL, and will just insert a new leaf */
Robert Olsson19baf832005-06-21 12:43:18 -07001069
Stephen Hemminger06801912007-08-10 15:22:13 -07001070 node_set_parent((struct node *)l, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001071
Olof Johansson91b9a272005-08-09 20:24:39 -07001072 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1073 put_child(t, (struct tnode *)tp, cindex, (struct node *)l);
1074 } else {
1075 /* Case 3: n is a LEAF or a TNODE and the key doesn't match. */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001076 /*
1077 * Add a new tnode here
Robert Olsson19baf832005-06-21 12:43:18 -07001078 * first tnode need some special handling
1079 */
1080
1081 if (tp)
Olof Johansson91b9a272005-08-09 20:24:39 -07001082 pos = tp->pos+tp->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001083 else
Olof Johansson91b9a272005-08-09 20:24:39 -07001084 pos = 0;
1085
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001086 if (n) {
Robert Olsson19baf832005-06-21 12:43:18 -07001087 newpos = tkey_mismatch(key, pos, n->key);
1088 tn = tnode_new(n->key, newpos, 1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001089 } else {
Robert Olsson19baf832005-06-21 12:43:18 -07001090 newpos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001091 tn = tnode_new(key, newpos, 1); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001092 }
Robert Olsson19baf832005-06-21 12:43:18 -07001093
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001094 if (!tn) {
Robert Olssonf835e472005-06-28 15:00:39 -07001095 free_leaf_info(li);
1096 tnode_free((struct tnode *) l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001097 return NULL;
Olof Johansson91b9a272005-08-09 20:24:39 -07001098 }
1099
Stephen Hemminger06801912007-08-10 15:22:13 -07001100 node_set_parent((struct node *)tn, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001101
Olof Johansson91b9a272005-08-09 20:24:39 -07001102 missbit = tkey_extract_bits(key, newpos, 1);
Robert Olsson19baf832005-06-21 12:43:18 -07001103 put_child(t, tn, missbit, (struct node *)l);
1104 put_child(t, tn, 1-missbit, n);
1105
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001106 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001107 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1108 put_child(t, (struct tnode *)tp, cindex, (struct node *)tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001109 } else {
Robert Olsson2373ce12005-08-25 13:01:29 -07001110 rcu_assign_pointer(t->trie, (struct node *)tn); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001111 tp = tn;
1112 }
1113 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001114
1115 if (tp && tp->pos + tp->bits > 32)
Stephen Hemminger78c66712005-09-21 00:15:39 -07001116 printk(KERN_WARNING "fib_trie tp=%p pos=%d, bits=%d, key=%0x plen=%d\n",
Robert Olsson19baf832005-06-21 12:43:18 -07001117 tp, tp->pos, tp->bits, key, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001118
Robert Olsson19baf832005-06-21 12:43:18 -07001119 /* Rebalance the trie */
Robert Olsson2373ce12005-08-25 13:01:29 -07001120
1121 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Robert Olssonf835e472005-06-28 15:00:39 -07001122done:
Robert Olsson19baf832005-06-21 12:43:18 -07001123 return fa_head;
1124}
1125
Robert Olssond562f1f2007-03-26 14:22:22 -07001126/*
1127 * Caller must hold RTNL.
1128 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001129static int fn_trie_insert(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001130{
1131 struct trie *t = (struct trie *) tb->tb_data;
1132 struct fib_alias *fa, *new_fa;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001133 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001134 struct fib_info *fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001135 int plen = cfg->fc_dst_len;
1136 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001137 u32 key, mask;
1138 int err;
1139 struct leaf *l;
1140
1141 if (plen > 32)
1142 return -EINVAL;
1143
Thomas Graf4e902c52006-08-17 18:14:52 -07001144 key = ntohl(cfg->fc_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001145
Patrick McHardy2dfe55b2006-08-10 23:08:33 -07001146 pr_debug("Insert table=%u %08x/%d\n", tb->tb_id, key, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001147
Olof Johansson91b9a272005-08-09 20:24:39 -07001148 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001149
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001150 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001151 return -EINVAL;
1152
1153 key = key & mask;
1154
Thomas Graf4e902c52006-08-17 18:14:52 -07001155 fi = fib_create_info(cfg);
1156 if (IS_ERR(fi)) {
1157 err = PTR_ERR(fi);
Robert Olsson19baf832005-06-21 12:43:18 -07001158 goto err;
Thomas Graf4e902c52006-08-17 18:14:52 -07001159 }
Robert Olsson19baf832005-06-21 12:43:18 -07001160
1161 l = fib_find_node(t, key);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001162 fa = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001163
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001164 if (l) {
Robert Olsson19baf832005-06-21 12:43:18 -07001165 fa_head = get_fa_head(l, plen);
1166 fa = fib_find_alias(fa_head, tos, fi->fib_priority);
1167 }
1168
1169 /* Now fa, if non-NULL, points to the first fib alias
1170 * with the same keys [prefix,tos,priority], if such key already
1171 * exists or to the node before which we will insert new one.
1172 *
1173 * If fa is NULL, we will need to allocate a new one and
1174 * insert to the head of f.
1175 *
1176 * If f is NULL, no fib node matched the destination key
1177 * and we need to allocate a new one of those as well.
1178 */
1179
Olof Johansson91b9a272005-08-09 20:24:39 -07001180 if (fa && fa->fa_info->fib_priority == fi->fib_priority) {
Robert Olsson19baf832005-06-21 12:43:18 -07001181 struct fib_alias *fa_orig;
1182
1183 err = -EEXIST;
Thomas Graf4e902c52006-08-17 18:14:52 -07001184 if (cfg->fc_nlflags & NLM_F_EXCL)
Robert Olsson19baf832005-06-21 12:43:18 -07001185 goto out;
1186
Thomas Graf4e902c52006-08-17 18:14:52 -07001187 if (cfg->fc_nlflags & NLM_F_REPLACE) {
Robert Olsson19baf832005-06-21 12:43:18 -07001188 struct fib_info *fi_drop;
1189 u8 state;
1190
Joonwoo Park67250332008-01-18 03:45:18 -08001191 if (fi->fib_treeref > 1)
1192 goto out;
1193
Robert Olsson2373ce12005-08-25 13:01:29 -07001194 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001195 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001196 if (new_fa == NULL)
1197 goto out;
Robert Olsson19baf832005-06-21 12:43:18 -07001198
1199 fi_drop = fa->fa_info;
Robert Olsson2373ce12005-08-25 13:01:29 -07001200 new_fa->fa_tos = fa->fa_tos;
1201 new_fa->fa_info = fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001202 new_fa->fa_type = cfg->fc_type;
1203 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001204 state = fa->fa_state;
Robert Olsson2373ce12005-08-25 13:01:29 -07001205 new_fa->fa_state &= ~FA_S_ACCESSED;
Robert Olsson19baf832005-06-21 12:43:18 -07001206
Robert Olsson2373ce12005-08-25 13:01:29 -07001207 list_replace_rcu(&fa->fa_list, &new_fa->fa_list);
1208 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001209
1210 fib_release_info(fi_drop);
1211 if (state & FA_S_ACCESSED)
Olof Johansson91b9a272005-08-09 20:24:39 -07001212 rt_cache_flush(-1);
Milan Kocianb8f55832007-05-23 14:55:06 -07001213 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen,
1214 tb->tb_id, &cfg->fc_nlinfo, NLM_F_REPLACE);
Robert Olsson19baf832005-06-21 12:43:18 -07001215
Olof Johansson91b9a272005-08-09 20:24:39 -07001216 goto succeeded;
Robert Olsson19baf832005-06-21 12:43:18 -07001217 }
1218 /* Error if we find a perfect match which
1219 * uses the same scope, type, and nexthop
1220 * information.
1221 */
1222 fa_orig = fa;
1223 list_for_each_entry(fa, fa_orig->fa_list.prev, fa_list) {
1224 if (fa->fa_tos != tos)
1225 break;
1226 if (fa->fa_info->fib_priority != fi->fib_priority)
1227 break;
Thomas Graf4e902c52006-08-17 18:14:52 -07001228 if (fa->fa_type == cfg->fc_type &&
1229 fa->fa_scope == cfg->fc_scope &&
Robert Olsson19baf832005-06-21 12:43:18 -07001230 fa->fa_info == fi) {
1231 goto out;
1232 }
1233 }
Thomas Graf4e902c52006-08-17 18:14:52 -07001234 if (!(cfg->fc_nlflags & NLM_F_APPEND))
Robert Olsson19baf832005-06-21 12:43:18 -07001235 fa = fa_orig;
1236 }
1237 err = -ENOENT;
Thomas Graf4e902c52006-08-17 18:14:52 -07001238 if (!(cfg->fc_nlflags & NLM_F_CREATE))
Robert Olsson19baf832005-06-21 12:43:18 -07001239 goto out;
1240
1241 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001242 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson19baf832005-06-21 12:43:18 -07001243 if (new_fa == NULL)
1244 goto out;
1245
1246 new_fa->fa_info = fi;
1247 new_fa->fa_tos = tos;
Thomas Graf4e902c52006-08-17 18:14:52 -07001248 new_fa->fa_type = cfg->fc_type;
1249 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001250 new_fa->fa_state = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001251 /*
1252 * Insert new entry to the list.
1253 */
1254
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001255 if (!fa_head) {
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001256 fa_head = fib_insert_node(t, key, plen);
1257 if (unlikely(!fa_head)) {
1258 err = -ENOMEM;
Robert Olssonf835e472005-06-28 15:00:39 -07001259 goto out_free_new_fa;
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001260 }
Robert Olssonf835e472005-06-28 15:00:39 -07001261 }
Robert Olsson19baf832005-06-21 12:43:18 -07001262
Robert Olsson2373ce12005-08-25 13:01:29 -07001263 list_add_tail_rcu(&new_fa->fa_list,
1264 (fa ? &fa->fa_list : fa_head));
Robert Olsson19baf832005-06-21 12:43:18 -07001265
1266 rt_cache_flush(-1);
Thomas Graf4e902c52006-08-17 18:14:52 -07001267 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001268 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001269succeeded:
1270 return 0;
Robert Olssonf835e472005-06-28 15:00:39 -07001271
1272out_free_new_fa:
1273 kmem_cache_free(fn_alias_kmem, new_fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001274out:
1275 fib_release_info(fi);
Olof Johansson91b9a272005-08-09 20:24:39 -07001276err:
Robert Olsson19baf832005-06-21 12:43:18 -07001277 return err;
1278}
1279
Robert Olsson2373ce12005-08-25 13:01:29 -07001280
Robert Olsson772cb712005-09-19 15:31:18 -07001281/* should be called with rcu_read_lock */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001282static inline int check_leaf(struct trie *t, struct leaf *l,
1283 t_key key, int *plen, const struct flowi *flp,
Patrick McHardy06c74272005-08-23 22:06:09 -07001284 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001285{
Patrick McHardy06c74272005-08-23 22:06:09 -07001286 int err, i;
Al Viro888454c2006-09-19 13:42:46 -07001287 __be32 mask;
Robert Olsson19baf832005-06-21 12:43:18 -07001288 struct leaf_info *li;
1289 struct hlist_head *hhead = &l->list;
1290 struct hlist_node *node;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001291
Robert Olsson2373ce12005-08-25 13:01:29 -07001292 hlist_for_each_entry_rcu(li, node, hhead, hlist) {
Robert Olsson19baf832005-06-21 12:43:18 -07001293 i = li->plen;
Al Viro888454c2006-09-19 13:42:46 -07001294 mask = inet_make_mask(i);
1295 if (l->key != (key & ntohl(mask)))
Robert Olsson19baf832005-06-21 12:43:18 -07001296 continue;
1297
Al Viro888454c2006-09-19 13:42:46 -07001298 if ((err = fib_semantic_match(&li->falh, flp, res, htonl(l->key), mask, i)) <= 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001299 *plen = i;
1300#ifdef CONFIG_IP_FIB_TRIE_STATS
1301 t->stats.semantic_match_passed++;
1302#endif
Patrick McHardy06c74272005-08-23 22:06:09 -07001303 return err;
Robert Olsson19baf832005-06-21 12:43:18 -07001304 }
1305#ifdef CONFIG_IP_FIB_TRIE_STATS
1306 t->stats.semantic_match_miss++;
1307#endif
1308 }
Patrick McHardy06c74272005-08-23 22:06:09 -07001309 return 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001310}
1311
1312static int
1313fn_trie_lookup(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1314{
1315 struct trie *t = (struct trie *) tb->tb_data;
1316 int plen, ret = 0;
1317 struct node *n;
1318 struct tnode *pn;
1319 int pos, bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001320 t_key key = ntohl(flp->fl4_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001321 int chopped_off;
1322 t_key cindex = 0;
1323 int current_prefix_length = KEYLENGTH;
Olof Johansson91b9a272005-08-09 20:24:39 -07001324 struct tnode *cn;
1325 t_key node_prefix, key_prefix, pref_mismatch;
1326 int mp;
1327
Robert Olsson2373ce12005-08-25 13:01:29 -07001328 rcu_read_lock();
Robert Olsson19baf832005-06-21 12:43:18 -07001329
Robert Olsson2373ce12005-08-25 13:01:29 -07001330 n = rcu_dereference(t->trie);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001331 if (!n)
Robert Olsson19baf832005-06-21 12:43:18 -07001332 goto failed;
1333
1334#ifdef CONFIG_IP_FIB_TRIE_STATS
1335 t->stats.gets++;
1336#endif
1337
1338 /* Just a leaf? */
1339 if (IS_LEAF(n)) {
Patrick McHardy06c74272005-08-23 22:06:09 -07001340 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001341 goto found;
1342 goto failed;
1343 }
1344 pn = (struct tnode *) n;
1345 chopped_off = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001346
Olof Johansson91b9a272005-08-09 20:24:39 -07001347 while (pn) {
Robert Olsson19baf832005-06-21 12:43:18 -07001348 pos = pn->pos;
1349 bits = pn->bits;
1350
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001351 if (!chopped_off)
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001352 cindex = tkey_extract_bits(mask_pfx(key, current_prefix_length),
1353 pos, bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001354
1355 n = tnode_get_child(pn, cindex);
1356
1357 if (n == NULL) {
1358#ifdef CONFIG_IP_FIB_TRIE_STATS
1359 t->stats.null_node_hit++;
1360#endif
1361 goto backtrace;
1362 }
1363
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001364 if (IS_LEAF(n)) {
Patrick McHardy06c74272005-08-23 22:06:09 -07001365 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001366 goto found;
Olof Johansson91b9a272005-08-09 20:24:39 -07001367 else
1368 goto backtrace;
1369 }
1370
1371#define HL_OPTIMIZE
1372#ifdef HL_OPTIMIZE
1373 cn = (struct tnode *)n;
1374
1375 /*
1376 * It's a tnode, and we can do some extra checks here if we
1377 * like, to avoid descending into a dead-end branch.
1378 * This tnode is in the parent's child array at index
1379 * key[p_pos..p_pos+p_bits] but potentially with some bits
1380 * chopped off, so in reality the index may be just a
1381 * subprefix, padded with zero at the end.
1382 * We can also take a look at any skipped bits in this
1383 * tnode - everything up to p_pos is supposed to be ok,
1384 * and the non-chopped bits of the index (se previous
1385 * paragraph) are also guaranteed ok, but the rest is
1386 * considered unknown.
1387 *
1388 * The skipped bits are key[pos+bits..cn->pos].
1389 */
1390
1391 /* If current_prefix_length < pos+bits, we are already doing
1392 * actual prefix matching, which means everything from
1393 * pos+(bits-chopped_off) onward must be zero along some
1394 * branch of this subtree - otherwise there is *no* valid
1395 * prefix present. Here we can only check the skipped
1396 * bits. Remember, since we have already indexed into the
1397 * parent's child array, we know that the bits we chopped of
1398 * *are* zero.
1399 */
1400
1401 /* NOTA BENE: CHECKING ONLY SKIPPED BITS FOR THE NEW NODE HERE */
1402
1403 if (current_prefix_length < pos+bits) {
1404 if (tkey_extract_bits(cn->key, current_prefix_length,
1405 cn->pos - current_prefix_length) != 0 ||
1406 !(cn->child[0]))
1407 goto backtrace;
1408 }
1409
1410 /*
1411 * If chopped_off=0, the index is fully validated and we
1412 * only need to look at the skipped bits for this, the new,
1413 * tnode. What we actually want to do is to find out if
1414 * these skipped bits match our key perfectly, or if we will
1415 * have to count on finding a matching prefix further down,
1416 * because if we do, we would like to have some way of
1417 * verifying the existence of such a prefix at this point.
1418 */
1419
1420 /* The only thing we can do at this point is to verify that
1421 * any such matching prefix can indeed be a prefix to our
1422 * key, and if the bits in the node we are inspecting that
1423 * do not match our key are not ZERO, this cannot be true.
1424 * Thus, find out where there is a mismatch (before cn->pos)
1425 * and verify that all the mismatching bits are zero in the
1426 * new tnode's key.
1427 */
1428
1429 /* Note: We aren't very concerned about the piece of the key
1430 * that precede pn->pos+pn->bits, since these have already been
1431 * checked. The bits after cn->pos aren't checked since these are
1432 * by definition "unknown" at this point. Thus, what we want to
1433 * see is if we are about to enter the "prefix matching" state,
1434 * and in that case verify that the skipped bits that will prevail
1435 * throughout this subtree are zero, as they have to be if we are
1436 * to find a matching prefix.
1437 */
1438
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001439 node_prefix = mask_pfx(cn->key, cn->pos);
1440 key_prefix = mask_pfx(key, cn->pos);
Olof Johansson91b9a272005-08-09 20:24:39 -07001441 pref_mismatch = key_prefix^node_prefix;
1442 mp = 0;
1443
1444 /* In short: If skipped bits in this node do not match the search
1445 * key, enter the "prefix matching" state.directly.
1446 */
1447 if (pref_mismatch) {
1448 while (!(pref_mismatch & (1<<(KEYLENGTH-1)))) {
1449 mp++;
1450 pref_mismatch = pref_mismatch <<1;
1451 }
1452 key_prefix = tkey_extract_bits(cn->key, mp, cn->pos-mp);
1453
1454 if (key_prefix != 0)
1455 goto backtrace;
1456
1457 if (current_prefix_length >= cn->pos)
1458 current_prefix_length = mp;
1459 }
1460#endif
1461 pn = (struct tnode *)n; /* Descend */
1462 chopped_off = 0;
1463 continue;
1464
Robert Olsson19baf832005-06-21 12:43:18 -07001465backtrace:
1466 chopped_off++;
1467
1468 /* As zero don't change the child key (cindex) */
Olof Johansson91b9a272005-08-09 20:24:39 -07001469 while ((chopped_off <= pn->bits) && !(cindex & (1<<(chopped_off-1))))
Robert Olsson19baf832005-06-21 12:43:18 -07001470 chopped_off++;
Robert Olsson19baf832005-06-21 12:43:18 -07001471
1472 /* Decrease current_... with bits chopped off */
1473 if (current_prefix_length > pn->pos + pn->bits - chopped_off)
1474 current_prefix_length = pn->pos + pn->bits - chopped_off;
Olof Johansson91b9a272005-08-09 20:24:39 -07001475
Robert Olsson19baf832005-06-21 12:43:18 -07001476 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001477 * Either we do the actual chop off according or if we have
Robert Olsson19baf832005-06-21 12:43:18 -07001478 * chopped off all bits in this tnode walk up to our parent.
1479 */
1480
Olof Johansson91b9a272005-08-09 20:24:39 -07001481 if (chopped_off <= pn->bits) {
Robert Olsson19baf832005-06-21 12:43:18 -07001482 cindex &= ~(1 << (chopped_off-1));
Olof Johansson91b9a272005-08-09 20:24:39 -07001483 } else {
Stephen Hemminger06801912007-08-10 15:22:13 -07001484 struct tnode *parent = node_parent((struct node *) pn);
1485 if (!parent)
Robert Olsson19baf832005-06-21 12:43:18 -07001486 goto failed;
Olof Johansson91b9a272005-08-09 20:24:39 -07001487
Robert Olsson19baf832005-06-21 12:43:18 -07001488 /* Get Child's index */
Stephen Hemminger06801912007-08-10 15:22:13 -07001489 cindex = tkey_extract_bits(pn->key, parent->pos, parent->bits);
1490 pn = parent;
Robert Olsson19baf832005-06-21 12:43:18 -07001491 chopped_off = 0;
1492
1493#ifdef CONFIG_IP_FIB_TRIE_STATS
1494 t->stats.backtrack++;
1495#endif
1496 goto backtrace;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001497 }
Robert Olsson19baf832005-06-21 12:43:18 -07001498 }
1499failed:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001500 ret = 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001501found:
Robert Olsson2373ce12005-08-25 13:01:29 -07001502 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001503 return ret;
1504}
1505
Robert Olsson2373ce12005-08-25 13:01:29 -07001506/* only called from updater side */
Robert Olsson19baf832005-06-21 12:43:18 -07001507static int trie_leaf_remove(struct trie *t, t_key key)
1508{
1509 t_key cindex;
1510 struct tnode *tp = NULL;
1511 struct node *n = t->trie;
1512 struct leaf *l;
1513
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001514 pr_debug("entering trie_leaf_remove(%p)\n", n);
Robert Olsson19baf832005-06-21 12:43:18 -07001515
1516 /* Note that in the case skipped bits, those bits are *not* checked!
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001517 * When we finish this, we will have NULL or a T_LEAF, and the
Robert Olsson19baf832005-06-21 12:43:18 -07001518 * T_LEAF may or may not match our key.
1519 */
1520
Olof Johansson91b9a272005-08-09 20:24:39 -07001521 while (n != NULL && IS_TNODE(n)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001522 struct tnode *tn = (struct tnode *) n;
1523 check_tnode(tn);
1524 n = tnode_get_child(tn ,tkey_extract_bits(key, tn->pos, tn->bits));
1525
Stephen Hemminger06801912007-08-10 15:22:13 -07001526 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001527 }
Robert Olsson19baf832005-06-21 12:43:18 -07001528 l = (struct leaf *) n;
1529
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001530 if (!n || !tkey_equals(l->key, key))
Robert Olsson19baf832005-06-21 12:43:18 -07001531 return 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001532
1533 /*
1534 * Key found.
1535 * Remove the leaf and rebalance the tree
Robert Olsson19baf832005-06-21 12:43:18 -07001536 */
1537
Robert Olsson19baf832005-06-21 12:43:18 -07001538 t->size--;
1539
Stephen Hemminger06801912007-08-10 15:22:13 -07001540 tp = node_parent(n);
Robert Olsson19baf832005-06-21 12:43:18 -07001541 tnode_free((struct tnode *) n);
1542
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001543 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001544 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1545 put_child(t, (struct tnode *)tp, cindex, NULL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001546 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Olof Johansson91b9a272005-08-09 20:24:39 -07001547 } else
Robert Olsson2373ce12005-08-25 13:01:29 -07001548 rcu_assign_pointer(t->trie, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001549
1550 return 1;
1551}
1552
Robert Olssond562f1f2007-03-26 14:22:22 -07001553/*
1554 * Caller must hold RTNL.
1555 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001556static int fn_trie_delete(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001557{
1558 struct trie *t = (struct trie *) tb->tb_data;
1559 u32 key, mask;
Thomas Graf4e902c52006-08-17 18:14:52 -07001560 int plen = cfg->fc_dst_len;
1561 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001562 struct fib_alias *fa, *fa_to_delete;
1563 struct list_head *fa_head;
1564 struct leaf *l;
Olof Johansson91b9a272005-08-09 20:24:39 -07001565 struct leaf_info *li;
1566
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001567 if (plen > 32)
Robert Olsson19baf832005-06-21 12:43:18 -07001568 return -EINVAL;
1569
Thomas Graf4e902c52006-08-17 18:14:52 -07001570 key = ntohl(cfg->fc_dst);
Olof Johansson91b9a272005-08-09 20:24:39 -07001571 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001572
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001573 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001574 return -EINVAL;
1575
1576 key = key & mask;
1577 l = fib_find_node(t, key);
1578
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001579 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001580 return -ESRCH;
1581
1582 fa_head = get_fa_head(l, plen);
1583 fa = fib_find_alias(fa_head, tos, 0);
1584
1585 if (!fa)
1586 return -ESRCH;
1587
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001588 pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t);
Robert Olsson19baf832005-06-21 12:43:18 -07001589
1590 fa_to_delete = NULL;
1591 fa_head = fa->fa_list.prev;
Robert Olsson2373ce12005-08-25 13:01:29 -07001592
Robert Olsson19baf832005-06-21 12:43:18 -07001593 list_for_each_entry(fa, fa_head, fa_list) {
1594 struct fib_info *fi = fa->fa_info;
1595
1596 if (fa->fa_tos != tos)
1597 break;
1598
Thomas Graf4e902c52006-08-17 18:14:52 -07001599 if ((!cfg->fc_type || fa->fa_type == cfg->fc_type) &&
1600 (cfg->fc_scope == RT_SCOPE_NOWHERE ||
1601 fa->fa_scope == cfg->fc_scope) &&
1602 (!cfg->fc_protocol ||
1603 fi->fib_protocol == cfg->fc_protocol) &&
1604 fib_nh_match(cfg, fi) == 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001605 fa_to_delete = fa;
1606 break;
1607 }
1608 }
1609
Olof Johansson91b9a272005-08-09 20:24:39 -07001610 if (!fa_to_delete)
1611 return -ESRCH;
Robert Olsson19baf832005-06-21 12:43:18 -07001612
Olof Johansson91b9a272005-08-09 20:24:39 -07001613 fa = fa_to_delete;
Thomas Graf4e902c52006-08-17 18:14:52 -07001614 rtmsg_fib(RTM_DELROUTE, htonl(key), fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001615 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001616
Olof Johansson91b9a272005-08-09 20:24:39 -07001617 l = fib_find_node(t, key);
Robert Olsson772cb712005-09-19 15:31:18 -07001618 li = find_leaf_info(l, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001619
Robert Olsson2373ce12005-08-25 13:01:29 -07001620 list_del_rcu(&fa->fa_list);
Robert Olsson19baf832005-06-21 12:43:18 -07001621
Olof Johansson91b9a272005-08-09 20:24:39 -07001622 if (list_empty(fa_head)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001623 hlist_del_rcu(&li->hlist);
Olof Johansson91b9a272005-08-09 20:24:39 -07001624 free_leaf_info(li);
Robert Olsson2373ce12005-08-25 13:01:29 -07001625 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001626
1627 if (hlist_empty(&l->list))
1628 trie_leaf_remove(t, key);
1629
1630 if (fa->fa_state & FA_S_ACCESSED)
1631 rt_cache_flush(-1);
1632
Robert Olsson2373ce12005-08-25 13:01:29 -07001633 fib_release_info(fa->fa_info);
1634 alias_free_mem_rcu(fa);
Olof Johansson91b9a272005-08-09 20:24:39 -07001635 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001636}
1637
1638static int trie_flush_list(struct trie *t, struct list_head *head)
1639{
1640 struct fib_alias *fa, *fa_node;
1641 int found = 0;
1642
1643 list_for_each_entry_safe(fa, fa_node, head, fa_list) {
1644 struct fib_info *fi = fa->fa_info;
Robert Olsson19baf832005-06-21 12:43:18 -07001645
Robert Olsson2373ce12005-08-25 13:01:29 -07001646 if (fi && (fi->fib_flags & RTNH_F_DEAD)) {
1647 list_del_rcu(&fa->fa_list);
1648 fib_release_info(fa->fa_info);
1649 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001650 found++;
1651 }
1652 }
1653 return found;
1654}
1655
1656static int trie_flush_leaf(struct trie *t, struct leaf *l)
1657{
1658 int found = 0;
1659 struct hlist_head *lih = &l->list;
1660 struct hlist_node *node, *tmp;
1661 struct leaf_info *li = NULL;
1662
1663 hlist_for_each_entry_safe(li, node, tmp, lih, hlist) {
Robert Olsson19baf832005-06-21 12:43:18 -07001664 found += trie_flush_list(t, &li->falh);
1665
1666 if (list_empty(&li->falh)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001667 hlist_del_rcu(&li->hlist);
Robert Olsson19baf832005-06-21 12:43:18 -07001668 free_leaf_info(li);
1669 }
1670 }
1671 return found;
1672}
1673
Robert Olsson2373ce12005-08-25 13:01:29 -07001674/* rcu_read_lock needs to be hold by caller from readside */
1675
Robert Olsson19baf832005-06-21 12:43:18 -07001676static struct leaf *nextleaf(struct trie *t, struct leaf *thisleaf)
1677{
1678 struct node *c = (struct node *) thisleaf;
1679 struct tnode *p;
1680 int idx;
Robert Olsson2373ce12005-08-25 13:01:29 -07001681 struct node *trie = rcu_dereference(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -07001682
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001683 if (c == NULL) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001684 if (trie == NULL)
Robert Olsson19baf832005-06-21 12:43:18 -07001685 return NULL;
1686
Robert Olsson2373ce12005-08-25 13:01:29 -07001687 if (IS_LEAF(trie)) /* trie w. just a leaf */
1688 return (struct leaf *) trie;
Robert Olsson19baf832005-06-21 12:43:18 -07001689
Robert Olsson2373ce12005-08-25 13:01:29 -07001690 p = (struct tnode*) trie; /* Start */
Olof Johansson91b9a272005-08-09 20:24:39 -07001691 } else
Stephen Hemminger06801912007-08-10 15:22:13 -07001692 p = node_parent(c);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001693
Robert Olsson19baf832005-06-21 12:43:18 -07001694 while (p) {
1695 int pos, last;
1696
1697 /* Find the next child of the parent */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001698 if (c)
1699 pos = 1 + tkey_extract_bits(c->key, p->pos, p->bits);
1700 else
Robert Olsson19baf832005-06-21 12:43:18 -07001701 pos = 0;
1702
1703 last = 1 << p->bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001704 for (idx = pos; idx < last ; idx++) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001705 c = rcu_dereference(p->child[idx]);
1706
1707 if (!c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001708 continue;
Robert Olsson19baf832005-06-21 12:43:18 -07001709
Olof Johansson91b9a272005-08-09 20:24:39 -07001710 /* Decend if tnode */
Robert Olsson2373ce12005-08-25 13:01:29 -07001711 while (IS_TNODE(c)) {
1712 p = (struct tnode *) c;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09001713 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001714
Olof Johansson91b9a272005-08-09 20:24:39 -07001715 /* Rightmost non-NULL branch */
1716 if (p && IS_TNODE(p))
Robert Olsson2373ce12005-08-25 13:01:29 -07001717 while (!(c = rcu_dereference(p->child[idx]))
1718 && idx < (1<<p->bits)) idx++;
Robert Olsson19baf832005-06-21 12:43:18 -07001719
Olof Johansson91b9a272005-08-09 20:24:39 -07001720 /* Done with this tnode? */
Robert Olsson2373ce12005-08-25 13:01:29 -07001721 if (idx >= (1 << p->bits) || !c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001722 goto up;
Robert Olsson19baf832005-06-21 12:43:18 -07001723 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001724 return (struct leaf *) c;
Robert Olsson19baf832005-06-21 12:43:18 -07001725 }
1726up:
1727 /* No more children go up one step */
Olof Johansson91b9a272005-08-09 20:24:39 -07001728 c = (struct node *) p;
Stephen Hemminger06801912007-08-10 15:22:13 -07001729 p = node_parent(c);
Robert Olsson19baf832005-06-21 12:43:18 -07001730 }
1731 return NULL; /* Ready. Root of trie */
1732}
1733
Robert Olssond562f1f2007-03-26 14:22:22 -07001734/*
1735 * Caller must hold RTNL.
1736 */
Robert Olsson19baf832005-06-21 12:43:18 -07001737static int fn_trie_flush(struct fib_table *tb)
1738{
1739 struct trie *t = (struct trie *) tb->tb_data;
1740 struct leaf *ll = NULL, *l = NULL;
1741 int found = 0, h;
1742
Olof Johansson91b9a272005-08-09 20:24:39 -07001743 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001744 found += trie_flush_leaf(t, l);
1745
1746 if (ll && hlist_empty(&ll->list))
1747 trie_leaf_remove(t, ll->key);
1748 ll = l;
1749 }
1750
1751 if (ll && hlist_empty(&ll->list))
1752 trie_leaf_remove(t, ll->key);
1753
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001754 pr_debug("trie_flush found=%d\n", found);
Robert Olsson19baf832005-06-21 12:43:18 -07001755 return found;
1756}
1757
Robert Olsson19baf832005-06-21 12:43:18 -07001758static void
1759fn_trie_select_default(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1760{
1761 struct trie *t = (struct trie *) tb->tb_data;
1762 int order, last_idx;
1763 struct fib_info *fi = NULL;
1764 struct fib_info *last_resort;
1765 struct fib_alias *fa = NULL;
1766 struct list_head *fa_head;
1767 struct leaf *l;
1768
1769 last_idx = -1;
1770 last_resort = NULL;
1771 order = -1;
1772
Robert Olsson2373ce12005-08-25 13:01:29 -07001773 rcu_read_lock();
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001774
Robert Olsson19baf832005-06-21 12:43:18 -07001775 l = fib_find_node(t, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001776 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001777 goto out;
1778
1779 fa_head = get_fa_head(l, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001780 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001781 goto out;
1782
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001783 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001784 goto out;
1785
Robert Olsson2373ce12005-08-25 13:01:29 -07001786 list_for_each_entry_rcu(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001787 struct fib_info *next_fi = fa->fa_info;
Olof Johansson91b9a272005-08-09 20:24:39 -07001788
Robert Olsson19baf832005-06-21 12:43:18 -07001789 if (fa->fa_scope != res->scope ||
1790 fa->fa_type != RTN_UNICAST)
1791 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -07001792
Robert Olsson19baf832005-06-21 12:43:18 -07001793 if (next_fi->fib_priority > res->fi->fib_priority)
1794 break;
1795 if (!next_fi->fib_nh[0].nh_gw ||
1796 next_fi->fib_nh[0].nh_scope != RT_SCOPE_LINK)
1797 continue;
1798 fa->fa_state |= FA_S_ACCESSED;
Olof Johansson91b9a272005-08-09 20:24:39 -07001799
Robert Olsson19baf832005-06-21 12:43:18 -07001800 if (fi == NULL) {
1801 if (next_fi != res->fi)
1802 break;
1803 } else if (!fib_detect_death(fi, order, &last_resort,
Denis V. Lunev971b8932007-12-08 00:32:23 -08001804 &last_idx, tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001805 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001806 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001807 goto out;
1808 }
1809 fi = next_fi;
1810 order++;
1811 }
1812 if (order <= 0 || fi == NULL) {
Denis V. Lunev971b8932007-12-08 00:32:23 -08001813 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001814 goto out;
1815 }
1816
Denis V. Lunev971b8932007-12-08 00:32:23 -08001817 if (!fib_detect_death(fi, order, &last_resort, &last_idx,
1818 tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001819 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001820 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001821 goto out;
1822 }
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001823 if (last_idx >= 0)
1824 fib_result_assign(res, last_resort);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001825 tb->tb_default = last_idx;
1826out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001827 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001828}
1829
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001830static 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 -07001831 struct sk_buff *skb, struct netlink_callback *cb)
1832{
1833 int i, s_i;
1834 struct fib_alias *fa;
1835
Al Viro32ab5f82006-09-26 22:21:45 -07001836 __be32 xkey = htonl(key);
Robert Olsson19baf832005-06-21 12:43:18 -07001837
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001838 s_i = cb->args[4];
Robert Olsson19baf832005-06-21 12:43:18 -07001839 i = 0;
1840
Robert Olsson2373ce12005-08-25 13:01:29 -07001841 /* rcu_read_lock is hold by caller */
1842
1843 list_for_each_entry_rcu(fa, fah, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001844 if (i < s_i) {
1845 i++;
1846 continue;
1847 }
Stephen Hemminger78c66712005-09-21 00:15:39 -07001848 BUG_ON(!fa->fa_info);
Robert Olsson19baf832005-06-21 12:43:18 -07001849
1850 if (fib_dump_info(skb, NETLINK_CB(cb->skb).pid,
1851 cb->nlh->nlmsg_seq,
1852 RTM_NEWROUTE,
1853 tb->tb_id,
1854 fa->fa_type,
1855 fa->fa_scope,
Thomas Grafbe403ea2006-08-17 18:15:17 -07001856 xkey,
Robert Olsson19baf832005-06-21 12:43:18 -07001857 plen,
1858 fa->fa_tos,
David S. Miller90f66912005-06-21 14:43:28 -07001859 fa->fa_info, 0) < 0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001860 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001861 return -1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001862 }
Robert Olsson19baf832005-06-21 12:43:18 -07001863 i++;
1864 }
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001865 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001866 return skb->len;
1867}
1868
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001869static 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 -07001870 struct netlink_callback *cb)
1871{
1872 int h, s_h;
1873 struct list_head *fa_head;
1874 struct leaf *l = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001875
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001876 s_h = cb->args[3];
Robert Olsson19baf832005-06-21 12:43:18 -07001877
Olof Johansson91b9a272005-08-09 20:24:39 -07001878 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001879 if (h < s_h)
1880 continue;
1881 if (h > s_h)
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001882 memset(&cb->args[4], 0,
1883 sizeof(cb->args) - 4*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001884
1885 fa_head = get_fa_head(l, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001886
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001887 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001888 continue;
1889
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001890 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001891 continue;
1892
1893 if (fn_trie_dump_fa(l->key, plen, fa_head, tb, skb, cb)<0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001894 cb->args[3] = h;
Robert Olsson19baf832005-06-21 12:43:18 -07001895 return -1;
1896 }
1897 }
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001898 cb->args[3] = h;
Robert Olsson19baf832005-06-21 12:43:18 -07001899 return skb->len;
1900}
1901
1902static int fn_trie_dump(struct fib_table *tb, struct sk_buff *skb, struct netlink_callback *cb)
1903{
1904 int m, s_m;
1905 struct trie *t = (struct trie *) tb->tb_data;
1906
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001907 s_m = cb->args[2];
Robert Olsson19baf832005-06-21 12:43:18 -07001908
Robert Olsson2373ce12005-08-25 13:01:29 -07001909 rcu_read_lock();
Olof Johansson91b9a272005-08-09 20:24:39 -07001910 for (m = 0; m <= 32; m++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001911 if (m < s_m)
1912 continue;
1913 if (m > s_m)
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001914 memset(&cb->args[3], 0,
1915 sizeof(cb->args) - 3*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001916
1917 if (fn_trie_dump_plen(t, 32-m, tb, skb, cb)<0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001918 cb->args[2] = m;
Robert Olsson19baf832005-06-21 12:43:18 -07001919 goto out;
1920 }
1921 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001922 rcu_read_unlock();
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001923 cb->args[2] = m;
Robert Olsson19baf832005-06-21 12:43:18 -07001924 return skb->len;
Olof Johansson91b9a272005-08-09 20:24:39 -07001925out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001926 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001927 return -1;
1928}
1929
1930/* Fix more generic FIB names for init later */
1931
Denis V. Lunev7b1a74f2008-01-10 03:22:17 -08001932struct fib_table *fib_hash_init(u32 id)
Robert Olsson19baf832005-06-21 12:43:18 -07001933{
1934 struct fib_table *tb;
1935 struct trie *t;
1936
1937 if (fn_alias_kmem == NULL)
1938 fn_alias_kmem = kmem_cache_create("ip_fib_alias",
1939 sizeof(struct fib_alias),
1940 0, SLAB_HWCACHE_ALIGN,
Paul Mundt20c2df82007-07-20 10:11:58 +09001941 NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001942
1943 tb = kmalloc(sizeof(struct fib_table) + sizeof(struct trie),
1944 GFP_KERNEL);
1945 if (tb == NULL)
1946 return NULL;
1947
1948 tb->tb_id = id;
Denis V. Lunev971b8932007-12-08 00:32:23 -08001949 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001950 tb->tb_lookup = fn_trie_lookup;
1951 tb->tb_insert = fn_trie_insert;
1952 tb->tb_delete = fn_trie_delete;
1953 tb->tb_flush = fn_trie_flush;
1954 tb->tb_select_default = fn_trie_select_default;
1955 tb->tb_dump = fn_trie_dump;
Robert Olsson19baf832005-06-21 12:43:18 -07001956
1957 t = (struct trie *) tb->tb_data;
Stephen Hemmingerc28a1cf2008-01-12 20:49:13 -08001958 memset(t, 0, sizeof(*t));
Robert Olsson19baf832005-06-21 12:43:18 -07001959
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001960 if (id == RT_TABLE_LOCAL)
Stephen Hemminger78c66712005-09-21 00:15:39 -07001961 printk(KERN_INFO "IPv4 FIB: Using LC-trie version %s\n", VERSION);
Robert Olsson19baf832005-06-21 12:43:18 -07001962
1963 return tb;
1964}
1965
Robert Olsson19baf832005-06-21 12:43:18 -07001966#ifdef CONFIG_PROC_FS
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001967/* Depth first Trie walk iterator */
1968struct fib_trie_iter {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08001969 struct seq_net_private p;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08001970 struct trie *trie_local, *trie_main;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001971 struct tnode *tnode;
1972 struct trie *trie;
1973 unsigned index;
1974 unsigned depth;
1975};
Robert Olsson19baf832005-06-21 12:43:18 -07001976
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001977static struct node *fib_trie_get_next(struct fib_trie_iter *iter)
Robert Olsson19baf832005-06-21 12:43:18 -07001978{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001979 struct tnode *tn = iter->tnode;
1980 unsigned cindex = iter->index;
1981 struct tnode *p;
1982
Eric W. Biederman6640e692007-01-24 14:42:04 -08001983 /* A single entry routing table */
1984 if (!tn)
1985 return NULL;
1986
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001987 pr_debug("get_next iter={node=%p index=%d depth=%d}\n",
1988 iter->tnode, iter->index, iter->depth);
1989rescan:
1990 while (cindex < (1<<tn->bits)) {
1991 struct node *n = tnode_get_child(tn, cindex);
1992
1993 if (n) {
1994 if (IS_LEAF(n)) {
1995 iter->tnode = tn;
1996 iter->index = cindex + 1;
1997 } else {
1998 /* push down one level */
1999 iter->tnode = (struct tnode *) n;
2000 iter->index = 0;
2001 ++iter->depth;
2002 }
2003 return n;
2004 }
2005
2006 ++cindex;
2007 }
2008
2009 /* Current node exhausted, pop back up */
Stephen Hemminger06801912007-08-10 15:22:13 -07002010 p = node_parent((struct node *)tn);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002011 if (p) {
2012 cindex = tkey_extract_bits(tn->key, p->pos, p->bits)+1;
2013 tn = p;
2014 --iter->depth;
2015 goto rescan;
2016 }
2017
2018 /* got root? */
Robert Olsson19baf832005-06-21 12:43:18 -07002019 return NULL;
2020}
2021
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002022static struct node *fib_trie_get_first(struct fib_trie_iter *iter,
2023 struct trie *t)
Robert Olsson19baf832005-06-21 12:43:18 -07002024{
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002025 struct node *n ;
2026
Stephen Hemminger132adf52007-03-08 20:44:43 -08002027 if (!t)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002028 return NULL;
2029
2030 n = rcu_dereference(t->trie);
2031
Stephen Hemminger132adf52007-03-08 20:44:43 -08002032 if (!iter)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002033 return NULL;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002034
Eric W. Biederman6640e692007-01-24 14:42:04 -08002035 if (n) {
2036 if (IS_TNODE(n)) {
2037 iter->tnode = (struct tnode *) n;
2038 iter->trie = t;
2039 iter->index = 0;
2040 iter->depth = 1;
2041 } else {
2042 iter->tnode = NULL;
2043 iter->trie = t;
2044 iter->index = 0;
2045 iter->depth = 0;
2046 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002047 return n;
2048 }
Robert Olsson19baf832005-06-21 12:43:18 -07002049 return NULL;
2050}
2051
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002052static void trie_collect_stats(struct trie *t, struct trie_stat *s)
Robert Olsson19baf832005-06-21 12:43:18 -07002053{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002054 struct node *n;
2055 struct fib_trie_iter iter;
Robert Olsson19baf832005-06-21 12:43:18 -07002056
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002057 memset(s, 0, sizeof(*s));
Robert Olsson19baf832005-06-21 12:43:18 -07002058
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002059 rcu_read_lock();
2060 for (n = fib_trie_get_first(&iter, t); n;
2061 n = fib_trie_get_next(&iter)) {
2062 if (IS_LEAF(n)) {
2063 s->leaves++;
2064 s->totdepth += iter.depth;
2065 if (iter.depth > s->maxdepth)
2066 s->maxdepth = iter.depth;
2067 } else {
2068 const struct tnode *tn = (const struct tnode *) n;
2069 int i;
Robert Olsson19baf832005-06-21 12:43:18 -07002070
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002071 s->tnodes++;
Stephen Hemminger132adf52007-03-08 20:44:43 -08002072 if (tn->bits < MAX_STAT_DEPTH)
Robert Olsson06ef9212006-03-20 21:35:01 -08002073 s->nodesizes[tn->bits]++;
2074
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002075 for (i = 0; i < (1<<tn->bits); i++)
2076 if (!tn->child[i])
2077 s->nullpointers++;
2078 }
2079 }
2080 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002081}
2082
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002083/*
Robert Olsson19baf832005-06-21 12:43:18 -07002084 * This outputs /proc/net/fib_triestats
Robert Olsson19baf832005-06-21 12:43:18 -07002085 */
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002086static void trie_show_stats(struct seq_file *seq, struct trie_stat *stat)
Robert Olsson19baf832005-06-21 12:43:18 -07002087{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002088 unsigned i, max, pointers, bytes, avdepth;
Robert Olsson19baf832005-06-21 12:43:18 -07002089
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002090 if (stat->leaves)
2091 avdepth = stat->totdepth*100 / stat->leaves;
2092 else
2093 avdepth = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002094
Stephen Hemminger187b5182008-01-12 20:55:55 -08002095 seq_printf(seq, "\tAver depth: %u.%02d\n", avdepth / 100, avdepth % 100 );
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002096 seq_printf(seq, "\tMax depth: %u\n", stat->maxdepth);
Robert Olsson19baf832005-06-21 12:43:18 -07002097
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002098 seq_printf(seq, "\tLeaves: %u\n", stat->leaves);
Olof Johansson91b9a272005-08-09 20:24:39 -07002099
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002100 bytes = sizeof(struct leaf) * stat->leaves;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002101 seq_printf(seq, "\tInternal nodes: %u\n\t", stat->tnodes);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002102 bytes += sizeof(struct tnode) * stat->tnodes;
Robert Olsson19baf832005-06-21 12:43:18 -07002103
Robert Olsson06ef9212006-03-20 21:35:01 -08002104 max = MAX_STAT_DEPTH;
2105 while (max > 0 && stat->nodesizes[max-1] == 0)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002106 max--;
Robert Olsson19baf832005-06-21 12:43:18 -07002107
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002108 pointers = 0;
2109 for (i = 1; i <= max; i++)
2110 if (stat->nodesizes[i] != 0) {
Stephen Hemminger187b5182008-01-12 20:55:55 -08002111 seq_printf(seq, " %u: %u", i, stat->nodesizes[i]);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002112 pointers += (1<<i) * stat->nodesizes[i];
2113 }
2114 seq_putc(seq, '\n');
Stephen Hemminger187b5182008-01-12 20:55:55 -08002115 seq_printf(seq, "\tPointers: %u\n", pointers);
Robert Olsson19baf832005-06-21 12:43:18 -07002116
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002117 bytes += sizeof(struct node *) * pointers;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002118 seq_printf(seq, "Null ptrs: %u\n", stat->nullpointers);
2119 seq_printf(seq, "Total size: %u kB\n", (bytes + 1023) / 1024);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002120}
Robert Olsson19baf832005-06-21 12:43:18 -07002121
2122#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002123static void trie_show_usage(struct seq_file *seq,
2124 const struct trie_use_stats *stats)
2125{
2126 seq_printf(seq, "\nCounters:\n---------\n");
2127 seq_printf(seq,"gets = %u\n", stats->gets);
2128 seq_printf(seq,"backtracks = %u\n", stats->backtrack);
2129 seq_printf(seq,"semantic match passed = %u\n", stats->semantic_match_passed);
2130 seq_printf(seq,"semantic match miss = %u\n", stats->semantic_match_miss);
2131 seq_printf(seq,"null node hit= %u\n", stats->null_node_hit);
2132 seq_printf(seq,"skipped node resize = %u\n\n", stats->resize_node_skipped);
Robert Olsson19baf832005-06-21 12:43:18 -07002133}
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002134#endif /* CONFIG_IP_FIB_TRIE_STATS */
2135
Robert Olsson19baf832005-06-21 12:43:18 -07002136
2137static int fib_triestat_seq_show(struct seq_file *seq, void *v)
2138{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002139 struct net *net = (struct net *)seq->private;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002140 struct trie *trie_local, *trie_main;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002141 struct trie_stat *stat;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002142 struct fib_table *tb;
2143
2144 trie_local = NULL;
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002145 tb = fib_get_table(net, RT_TABLE_LOCAL);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002146 if (tb)
2147 trie_local = (struct trie *) tb->tb_data;
2148
2149 trie_main = NULL;
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002150 tb = fib_get_table(net, RT_TABLE_MAIN);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002151 if (tb)
2152 trie_main = (struct trie *) tb->tb_data;
2153
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002154
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002155 stat = kmalloc(sizeof(*stat), GFP_KERNEL);
2156 if (!stat)
2157 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002158
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002159 seq_printf(seq, "Basic info: size of leaf: %Zd bytes, size of tnode: %Zd bytes.\n",
2160 sizeof(struct leaf), sizeof(struct tnode));
Olof Johansson91b9a272005-08-09 20:24:39 -07002161
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002162 if (trie_local) {
2163 seq_printf(seq, "Local:\n");
2164 trie_collect_stats(trie_local, stat);
2165 trie_show_stats(seq, stat);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002166#ifdef CONFIG_IP_FIB_TRIE_STATS
2167 trie_show_usage(seq, &trie_local->stats);
2168#endif
Robert Olsson19baf832005-06-21 12:43:18 -07002169 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002170
2171 if (trie_main) {
2172 seq_printf(seq, "Main:\n");
2173 trie_collect_stats(trie_main, stat);
2174 trie_show_stats(seq, stat);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002175#ifdef CONFIG_IP_FIB_TRIE_STATS
2176 trie_show_usage(seq, &trie_main->stats);
2177#endif
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002178 }
2179 kfree(stat);
2180
Robert Olsson19baf832005-06-21 12:43:18 -07002181 return 0;
2182}
2183
Robert Olsson19baf832005-06-21 12:43:18 -07002184static int fib_triestat_seq_open(struct inode *inode, struct file *file)
2185{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002186 int err;
2187 struct net *net;
2188
2189 net = get_proc_net(inode);
2190 if (net == NULL)
2191 return -ENXIO;
2192 err = single_open(file, fib_triestat_seq_show, net);
2193 if (err < 0) {
2194 put_net(net);
2195 return err;
2196 }
2197 return 0;
2198}
2199
2200static int fib_triestat_seq_release(struct inode *ino, struct file *f)
2201{
2202 struct seq_file *seq = f->private_data;
2203 put_net(seq->private);
2204 return single_release(ino, f);
Robert Olsson19baf832005-06-21 12:43:18 -07002205}
2206
Arjan van de Ven9a321442007-02-12 00:55:35 -08002207static const struct file_operations fib_triestat_fops = {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002208 .owner = THIS_MODULE,
2209 .open = fib_triestat_seq_open,
2210 .read = seq_read,
2211 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002212 .release = fib_triestat_seq_release,
Robert Olsson19baf832005-06-21 12:43:18 -07002213};
2214
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002215static struct node *fib_trie_get_idx(struct fib_trie_iter *iter,
2216 loff_t pos)
Robert Olsson19baf832005-06-21 12:43:18 -07002217{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002218 loff_t idx = 0;
2219 struct node *n;
Robert Olsson19baf832005-06-21 12:43:18 -07002220
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002221 for (n = fib_trie_get_first(iter, iter->trie_local);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002222 n; ++idx, n = fib_trie_get_next(iter)) {
2223 if (pos == idx)
2224 return n;
2225 }
Robert Olsson19baf832005-06-21 12:43:18 -07002226
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002227 for (n = fib_trie_get_first(iter, iter->trie_main);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002228 n; ++idx, n = fib_trie_get_next(iter)) {
2229 if (pos == idx)
2230 return n;
2231 }
Robert Olsson19baf832005-06-21 12:43:18 -07002232 return NULL;
2233}
2234
2235static void *fib_trie_seq_start(struct seq_file *seq, loff_t *pos)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002236 __acquires(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002237{
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002238 struct fib_trie_iter *iter = seq->private;
2239 struct fib_table *tb;
2240
2241 if (!iter->trie_local) {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002242 tb = fib_get_table(iter->p.net, RT_TABLE_LOCAL);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002243 if (tb)
2244 iter->trie_local = (struct trie *) tb->tb_data;
2245 }
2246 if (!iter->trie_main) {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002247 tb = fib_get_table(iter->p.net, RT_TABLE_MAIN);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002248 if (tb)
2249 iter->trie_main = (struct trie *) tb->tb_data;
2250 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002251 rcu_read_lock();
2252 if (*pos == 0)
Olof Johansson91b9a272005-08-09 20:24:39 -07002253 return SEQ_START_TOKEN;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002254 return fib_trie_get_idx(iter, *pos - 1);
Robert Olsson19baf832005-06-21 12:43:18 -07002255}
2256
2257static void *fib_trie_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2258{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002259 struct fib_trie_iter *iter = seq->private;
2260 void *l = v;
2261
Robert Olsson19baf832005-06-21 12:43:18 -07002262 ++*pos;
Olof Johansson91b9a272005-08-09 20:24:39 -07002263 if (v == SEQ_START_TOKEN)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002264 return fib_trie_get_idx(iter, 0);
Olof Johansson91b9a272005-08-09 20:24:39 -07002265
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002266 v = fib_trie_get_next(iter);
2267 BUG_ON(v == l);
2268 if (v)
2269 return v;
2270
2271 /* continue scan in next trie */
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002272 if (iter->trie == iter->trie_local)
2273 return fib_trie_get_first(iter, iter->trie_main);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002274
2275 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07002276}
2277
2278static void fib_trie_seq_stop(struct seq_file *seq, void *v)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002279 __releases(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002280{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002281 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002282}
2283
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002284static void seq_indent(struct seq_file *seq, int n)
2285{
2286 while (n-- > 0) seq_puts(seq, " ");
2287}
Robert Olsson19baf832005-06-21 12:43:18 -07002288
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002289static inline const char *rtn_scope(enum rt_scope_t s)
2290{
2291 static char buf[32];
2292
Stephen Hemminger132adf52007-03-08 20:44:43 -08002293 switch (s) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002294 case RT_SCOPE_UNIVERSE: return "universe";
2295 case RT_SCOPE_SITE: return "site";
2296 case RT_SCOPE_LINK: return "link";
2297 case RT_SCOPE_HOST: return "host";
2298 case RT_SCOPE_NOWHERE: return "nowhere";
2299 default:
2300 snprintf(buf, sizeof(buf), "scope=%d", s);
2301 return buf;
2302 }
2303}
2304
2305static const char *rtn_type_names[__RTN_MAX] = {
2306 [RTN_UNSPEC] = "UNSPEC",
2307 [RTN_UNICAST] = "UNICAST",
2308 [RTN_LOCAL] = "LOCAL",
2309 [RTN_BROADCAST] = "BROADCAST",
2310 [RTN_ANYCAST] = "ANYCAST",
2311 [RTN_MULTICAST] = "MULTICAST",
2312 [RTN_BLACKHOLE] = "BLACKHOLE",
2313 [RTN_UNREACHABLE] = "UNREACHABLE",
2314 [RTN_PROHIBIT] = "PROHIBIT",
2315 [RTN_THROW] = "THROW",
2316 [RTN_NAT] = "NAT",
2317 [RTN_XRESOLVE] = "XRESOLVE",
2318};
2319
2320static inline const char *rtn_type(unsigned t)
2321{
2322 static char buf[32];
2323
2324 if (t < __RTN_MAX && rtn_type_names[t])
2325 return rtn_type_names[t];
Stephen Hemminger187b5182008-01-12 20:55:55 -08002326 snprintf(buf, sizeof(buf), "type %u", t);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002327 return buf;
2328}
2329
2330/* Pretty print the trie */
Robert Olsson19baf832005-06-21 12:43:18 -07002331static int fib_trie_seq_show(struct seq_file *seq, void *v)
2332{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002333 const struct fib_trie_iter *iter = seq->private;
2334 struct node *n = v;
Robert Olsson19baf832005-06-21 12:43:18 -07002335
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002336 if (v == SEQ_START_TOKEN)
2337 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002338
Stephen Hemminger06801912007-08-10 15:22:13 -07002339 if (!node_parent(n)) {
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002340 if (iter->trie == iter->trie_local)
Robert Olsson095b8502007-01-26 19:06:01 -08002341 seq_puts(seq, "<local>:\n");
2342 else
2343 seq_puts(seq, "<main>:\n");
2344 }
2345
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002346 if (IS_TNODE(n)) {
2347 struct tnode *tn = (struct tnode *) n;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07002348 __be32 prf = htonl(mask_pfx(tn->key, tn->pos));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002349
Robert Olsson1d25cd62005-09-19 15:29:52 -07002350 seq_indent(seq, iter->depth-1);
2351 seq_printf(seq, " +-- %d.%d.%d.%d/%d %d %d %d\n",
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002352 NIPQUAD(prf), tn->pos, tn->bits, tn->full_children,
Robert Olsson1d25cd62005-09-19 15:29:52 -07002353 tn->empty_children);
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002354
Olof Johansson91b9a272005-08-09 20:24:39 -07002355 } else {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002356 struct leaf *l = (struct leaf *) n;
2357 int i;
Al Viro32ab5f82006-09-26 22:21:45 -07002358 __be32 val = htonl(l->key);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002359
2360 seq_indent(seq, iter->depth);
2361 seq_printf(seq, " |-- %d.%d.%d.%d\n", NIPQUAD(val));
2362 for (i = 32; i >= 0; i--) {
Robert Olsson772cb712005-09-19 15:31:18 -07002363 struct leaf_info *li = find_leaf_info(l, i);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002364 if (li) {
2365 struct fib_alias *fa;
2366 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
2367 seq_indent(seq, iter->depth+1);
2368 seq_printf(seq, " /%d %s %s", i,
2369 rtn_scope(fa->fa_scope),
2370 rtn_type(fa->fa_type));
2371 if (fa->fa_tos)
2372 seq_printf(seq, "tos =%d\n",
2373 fa->fa_tos);
2374 seq_putc(seq, '\n');
2375 }
2376 }
2377 }
Robert Olsson19baf832005-06-21 12:43:18 -07002378 }
2379
2380 return 0;
2381}
2382
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002383static const struct seq_operations fib_trie_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002384 .start = fib_trie_seq_start,
2385 .next = fib_trie_seq_next,
2386 .stop = fib_trie_seq_stop,
2387 .show = fib_trie_seq_show,
Robert Olsson19baf832005-06-21 12:43:18 -07002388};
2389
2390static int fib_trie_seq_open(struct inode *inode, struct file *file)
2391{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002392 return seq_open_net(inode, file, &fib_trie_seq_ops,
2393 sizeof(struct fib_trie_iter));
Robert Olsson19baf832005-06-21 12:43:18 -07002394}
2395
Arjan van de Ven9a321442007-02-12 00:55:35 -08002396static const struct file_operations fib_trie_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002397 .owner = THIS_MODULE,
2398 .open = fib_trie_seq_open,
2399 .read = seq_read,
2400 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002401 .release = seq_release_net,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002402};
2403
Al Viro32ab5f82006-09-26 22:21:45 -07002404static unsigned fib_flag_trans(int type, __be32 mask, const struct fib_info *fi)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002405{
2406 static unsigned type2flags[RTN_MAX + 1] = {
2407 [7] = RTF_REJECT, [8] = RTF_REJECT,
2408 };
2409 unsigned flags = type2flags[type];
2410
2411 if (fi && fi->fib_nh->nh_gw)
2412 flags |= RTF_GATEWAY;
Al Viro32ab5f82006-09-26 22:21:45 -07002413 if (mask == htonl(0xFFFFFFFF))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002414 flags |= RTF_HOST;
2415 flags |= RTF_UP;
2416 return flags;
2417}
2418
2419/*
2420 * This outputs /proc/net/route.
2421 * The format of the file is not supposed to be changed
2422 * and needs to be same as fib_hash output to avoid breaking
2423 * legacy utilities
2424 */
2425static int fib_route_seq_show(struct seq_file *seq, void *v)
2426{
Patrick McHardyc9e53cb2005-11-20 21:09:00 -08002427 const struct fib_trie_iter *iter = seq->private;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002428 struct leaf *l = v;
2429 int i;
2430 char bf[128];
2431
2432 if (v == SEQ_START_TOKEN) {
2433 seq_printf(seq, "%-127s\n", "Iface\tDestination\tGateway "
2434 "\tFlags\tRefCnt\tUse\tMetric\tMask\t\tMTU"
2435 "\tWindow\tIRTT");
2436 return 0;
2437 }
2438
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002439 if (iter->trie == iter->trie_local)
Patrick McHardyc9e53cb2005-11-20 21:09:00 -08002440 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002441 if (IS_TNODE(l))
2442 return 0;
2443
2444 for (i=32; i>=0; i--) {
Robert Olsson772cb712005-09-19 15:31:18 -07002445 struct leaf_info *li = find_leaf_info(l, i);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002446 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07002447 __be32 mask, prefix;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002448
2449 if (!li)
2450 continue;
2451
2452 mask = inet_make_mask(li->plen);
2453 prefix = htonl(l->key);
2454
2455 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
Herbert Xu1371e372005-10-15 09:42:39 +10002456 const struct fib_info *fi = fa->fa_info;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002457 unsigned flags = fib_flag_trans(fa->fa_type, mask, fi);
2458
2459 if (fa->fa_type == RTN_BROADCAST
2460 || fa->fa_type == RTN_MULTICAST)
2461 continue;
2462
2463 if (fi)
2464 snprintf(bf, sizeof(bf),
2465 "%s\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2466 fi->fib_dev ? fi->fib_dev->name : "*",
2467 prefix,
2468 fi->fib_nh->nh_gw, flags, 0, 0,
2469 fi->fib_priority,
2470 mask,
2471 (fi->fib_advmss ? fi->fib_advmss + 40 : 0),
2472 fi->fib_window,
2473 fi->fib_rtt >> 3);
2474 else
2475 snprintf(bf, sizeof(bf),
2476 "*\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2477 prefix, 0, flags, 0, 0, 0,
2478 mask, 0, 0, 0);
2479
2480 seq_printf(seq, "%-127s\n", bf);
2481 }
2482 }
2483
2484 return 0;
2485}
2486
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002487static const struct seq_operations fib_route_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002488 .start = fib_trie_seq_start,
2489 .next = fib_trie_seq_next,
2490 .stop = fib_trie_seq_stop,
2491 .show = fib_route_seq_show,
2492};
2493
2494static int fib_route_seq_open(struct inode *inode, struct file *file)
2495{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002496 return seq_open_net(inode, file, &fib_route_seq_ops,
2497 sizeof(struct fib_trie_iter));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002498}
2499
Arjan van de Ven9a321442007-02-12 00:55:35 -08002500static const struct file_operations fib_route_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002501 .owner = THIS_MODULE,
2502 .open = fib_route_seq_open,
2503 .read = seq_read,
2504 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002505 .release = seq_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002506};
2507
Denis V. Lunev61a02652008-01-10 03:21:09 -08002508int __net_init fib_proc_init(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002509{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002510 if (!proc_net_fops_create(net, "fib_trie", S_IRUGO, &fib_trie_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002511 goto out1;
2512
Denis V. Lunev61a02652008-01-10 03:21:09 -08002513 if (!proc_net_fops_create(net, "fib_triestat", S_IRUGO,
2514 &fib_triestat_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002515 goto out2;
2516
Denis V. Lunev61a02652008-01-10 03:21:09 -08002517 if (!proc_net_fops_create(net, "route", S_IRUGO, &fib_route_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002518 goto out3;
2519
Robert Olsson19baf832005-06-21 12:43:18 -07002520 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002521
2522out3:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002523 proc_net_remove(net, "fib_triestat");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002524out2:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002525 proc_net_remove(net, "fib_trie");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002526out1:
2527 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002528}
2529
Denis V. Lunev61a02652008-01-10 03:21:09 -08002530void __net_exit fib_proc_exit(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002531{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002532 proc_net_remove(net, "fib_trie");
2533 proc_net_remove(net, "fib_triestat");
2534 proc_net_remove(net, "route");
Robert Olsson19baf832005-06-21 12:43:18 -07002535}
2536
2537#endif /* CONFIG_PROC_FS */