blob: 2075eea7eea7b3a33533742d225a3a6c96b7bfaf [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;
121 unsigned short pos:5; /* 2log(KEYLENGTH) bits needed */
122 unsigned short bits:5; /* 2log(KEYLENGTH) bits needed */
123 unsigned short full_children; /* KEYLENGTH bits needed */
124 unsigned short empty_children; /* KEYLENGTH bits needed */
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{
656 struct tnode *inode;
657 struct tnode *oldtnode = tn;
658 int olen = tnode_child_length(tn);
659 int i;
660
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700661 pr_debug("In inflate\n");
Robert Olsson19baf832005-06-21 12:43:18 -0700662
663 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits + 1);
664
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700665 if (!tn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700666 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700667
668 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700669 * Preallocate and store tnodes before the actual work so we
670 * don't get into an inconsistent state if memory allocation
671 * fails. In case of failure we return the oldnode and inflate
Robert Olsson2f368952005-07-05 15:02:40 -0700672 * of tnode is ignored.
673 */
Olof Johansson91b9a272005-08-09 20:24:39 -0700674
675 for (i = 0; i < olen; i++) {
Robert Olsson2f368952005-07-05 15:02:40 -0700676 struct tnode *inode = (struct tnode *) tnode_get_child(oldtnode, i);
677
678 if (inode &&
679 IS_TNODE(inode) &&
680 inode->pos == oldtnode->pos + oldtnode->bits &&
681 inode->bits > 1) {
682 struct tnode *left, *right;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700683 t_key m = ~0U << (KEYLENGTH - 1) >> inode->pos;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700684
Robert Olsson2f368952005-07-05 15:02:40 -0700685 left = tnode_new(inode->key&(~m), inode->pos + 1,
686 inode->bits - 1);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700687 if (!left)
688 goto nomem;
Olof Johansson91b9a272005-08-09 20:24:39 -0700689
Robert Olsson2f368952005-07-05 15:02:40 -0700690 right = tnode_new(inode->key|m, inode->pos + 1,
691 inode->bits - 1);
692
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900693 if (!right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700694 tnode_free(left);
695 goto nomem;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900696 }
Robert Olsson2f368952005-07-05 15:02:40 -0700697
698 put_child(t, tn, 2*i, (struct node *) left);
699 put_child(t, tn, 2*i+1, (struct node *) right);
700 }
701 }
702
Olof Johansson91b9a272005-08-09 20:24:39 -0700703 for (i = 0; i < olen; i++) {
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)) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001040 struct leaf *l = (struct leaf *) n;
1041
Robert Olsson19baf832005-06-21 12:43:18 -07001042 li = leaf_info_new(plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001043
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001044 if (!li)
1045 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001046
1047 fa_head = &li->falh;
1048 insert_leaf_info(&l->list, li);
1049 goto done;
1050 }
1051 t->size++;
1052 l = leaf_new();
1053
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001054 if (!l)
1055 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001056
1057 l->key = key;
1058 li = leaf_info_new(plen);
1059
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001060 if (!li) {
Robert Olssonf835e472005-06-28 15:00:39 -07001061 tnode_free((struct tnode *) l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001062 return NULL;
Robert Olssonf835e472005-06-28 15:00:39 -07001063 }
Robert Olsson19baf832005-06-21 12:43:18 -07001064
1065 fa_head = &li->falh;
1066 insert_leaf_info(&l->list, li);
1067
Robert Olsson19baf832005-06-21 12:43:18 -07001068 if (t->trie && n == NULL) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001069 /* Case 2: n is NULL, and will just insert a new leaf */
Robert Olsson19baf832005-06-21 12:43:18 -07001070
Stephen Hemminger06801912007-08-10 15:22:13 -07001071 node_set_parent((struct node *)l, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001072
Olof Johansson91b9a272005-08-09 20:24:39 -07001073 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1074 put_child(t, (struct tnode *)tp, cindex, (struct node *)l);
1075 } else {
1076 /* Case 3: n is a LEAF or a TNODE and the key doesn't match. */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001077 /*
1078 * Add a new tnode here
Robert Olsson19baf832005-06-21 12:43:18 -07001079 * first tnode need some special handling
1080 */
1081
1082 if (tp)
Olof Johansson91b9a272005-08-09 20:24:39 -07001083 pos = tp->pos+tp->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001084 else
Olof Johansson91b9a272005-08-09 20:24:39 -07001085 pos = 0;
1086
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001087 if (n) {
Robert Olsson19baf832005-06-21 12:43:18 -07001088 newpos = tkey_mismatch(key, pos, n->key);
1089 tn = tnode_new(n->key, newpos, 1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001090 } else {
Robert Olsson19baf832005-06-21 12:43:18 -07001091 newpos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001092 tn = tnode_new(key, newpos, 1); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001093 }
Robert Olsson19baf832005-06-21 12:43:18 -07001094
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001095 if (!tn) {
Robert Olssonf835e472005-06-28 15:00:39 -07001096 free_leaf_info(li);
1097 tnode_free((struct tnode *) l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001098 return NULL;
Olof Johansson91b9a272005-08-09 20:24:39 -07001099 }
1100
Stephen Hemminger06801912007-08-10 15:22:13 -07001101 node_set_parent((struct node *)tn, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001102
Olof Johansson91b9a272005-08-09 20:24:39 -07001103 missbit = tkey_extract_bits(key, newpos, 1);
Robert Olsson19baf832005-06-21 12:43:18 -07001104 put_child(t, tn, missbit, (struct node *)l);
1105 put_child(t, tn, 1-missbit, n);
1106
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001107 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001108 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1109 put_child(t, (struct tnode *)tp, cindex, (struct node *)tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001110 } else {
Robert Olsson2373ce12005-08-25 13:01:29 -07001111 rcu_assign_pointer(t->trie, (struct node *)tn); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001112 tp = tn;
1113 }
1114 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001115
1116 if (tp && tp->pos + tp->bits > 32)
Stephen Hemminger78c66712005-09-21 00:15:39 -07001117 printk(KERN_WARNING "fib_trie tp=%p pos=%d, bits=%d, key=%0x plen=%d\n",
Robert Olsson19baf832005-06-21 12:43:18 -07001118 tp, tp->pos, tp->bits, key, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001119
Robert Olsson19baf832005-06-21 12:43:18 -07001120 /* Rebalance the trie */
Robert Olsson2373ce12005-08-25 13:01:29 -07001121
1122 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Robert Olssonf835e472005-06-28 15:00:39 -07001123done:
Robert Olsson19baf832005-06-21 12:43:18 -07001124 return fa_head;
1125}
1126
Robert Olssond562f1f2007-03-26 14:22:22 -07001127/*
1128 * Caller must hold RTNL.
1129 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001130static int fn_trie_insert(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001131{
1132 struct trie *t = (struct trie *) tb->tb_data;
1133 struct fib_alias *fa, *new_fa;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001134 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001135 struct fib_info *fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001136 int plen = cfg->fc_dst_len;
1137 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001138 u32 key, mask;
1139 int err;
1140 struct leaf *l;
1141
1142 if (plen > 32)
1143 return -EINVAL;
1144
Thomas Graf4e902c52006-08-17 18:14:52 -07001145 key = ntohl(cfg->fc_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001146
Patrick McHardy2dfe55b2006-08-10 23:08:33 -07001147 pr_debug("Insert table=%u %08x/%d\n", tb->tb_id, key, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001148
Olof Johansson91b9a272005-08-09 20:24:39 -07001149 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001150
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001151 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001152 return -EINVAL;
1153
1154 key = key & mask;
1155
Thomas Graf4e902c52006-08-17 18:14:52 -07001156 fi = fib_create_info(cfg);
1157 if (IS_ERR(fi)) {
1158 err = PTR_ERR(fi);
Robert Olsson19baf832005-06-21 12:43:18 -07001159 goto err;
Thomas Graf4e902c52006-08-17 18:14:52 -07001160 }
Robert Olsson19baf832005-06-21 12:43:18 -07001161
1162 l = fib_find_node(t, key);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001163 fa = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001164
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001165 if (l) {
Robert Olsson19baf832005-06-21 12:43:18 -07001166 fa_head = get_fa_head(l, plen);
1167 fa = fib_find_alias(fa_head, tos, fi->fib_priority);
1168 }
1169
1170 /* Now fa, if non-NULL, points to the first fib alias
1171 * with the same keys [prefix,tos,priority], if such key already
1172 * exists or to the node before which we will insert new one.
1173 *
1174 * If fa is NULL, we will need to allocate a new one and
1175 * insert to the head of f.
1176 *
1177 * If f is NULL, no fib node matched the destination key
1178 * and we need to allocate a new one of those as well.
1179 */
1180
Olof Johansson91b9a272005-08-09 20:24:39 -07001181 if (fa && fa->fa_info->fib_priority == fi->fib_priority) {
Robert Olsson19baf832005-06-21 12:43:18 -07001182 struct fib_alias *fa_orig;
1183
1184 err = -EEXIST;
Thomas Graf4e902c52006-08-17 18:14:52 -07001185 if (cfg->fc_nlflags & NLM_F_EXCL)
Robert Olsson19baf832005-06-21 12:43:18 -07001186 goto out;
1187
Thomas Graf4e902c52006-08-17 18:14:52 -07001188 if (cfg->fc_nlflags & NLM_F_REPLACE) {
Robert Olsson19baf832005-06-21 12:43:18 -07001189 struct fib_info *fi_drop;
1190 u8 state;
1191
Joonwoo Park67250332008-01-18 03:45:18 -08001192 if (fi->fib_treeref > 1)
1193 goto out;
1194
Robert Olsson2373ce12005-08-25 13:01:29 -07001195 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001196 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001197 if (new_fa == NULL)
1198 goto out;
Robert Olsson19baf832005-06-21 12:43:18 -07001199
1200 fi_drop = fa->fa_info;
Robert Olsson2373ce12005-08-25 13:01:29 -07001201 new_fa->fa_tos = fa->fa_tos;
1202 new_fa->fa_info = fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001203 new_fa->fa_type = cfg->fc_type;
1204 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001205 state = fa->fa_state;
Robert Olsson2373ce12005-08-25 13:01:29 -07001206 new_fa->fa_state &= ~FA_S_ACCESSED;
Robert Olsson19baf832005-06-21 12:43:18 -07001207
Robert Olsson2373ce12005-08-25 13:01:29 -07001208 list_replace_rcu(&fa->fa_list, &new_fa->fa_list);
1209 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001210
1211 fib_release_info(fi_drop);
1212 if (state & FA_S_ACCESSED)
Olof Johansson91b9a272005-08-09 20:24:39 -07001213 rt_cache_flush(-1);
Milan Kocianb8f55832007-05-23 14:55:06 -07001214 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen,
1215 tb->tb_id, &cfg->fc_nlinfo, NLM_F_REPLACE);
Robert Olsson19baf832005-06-21 12:43:18 -07001216
Olof Johansson91b9a272005-08-09 20:24:39 -07001217 goto succeeded;
Robert Olsson19baf832005-06-21 12:43:18 -07001218 }
1219 /* Error if we find a perfect match which
1220 * uses the same scope, type, and nexthop
1221 * information.
1222 */
1223 fa_orig = fa;
1224 list_for_each_entry(fa, fa_orig->fa_list.prev, fa_list) {
1225 if (fa->fa_tos != tos)
1226 break;
1227 if (fa->fa_info->fib_priority != fi->fib_priority)
1228 break;
Thomas Graf4e902c52006-08-17 18:14:52 -07001229 if (fa->fa_type == cfg->fc_type &&
1230 fa->fa_scope == cfg->fc_scope &&
Robert Olsson19baf832005-06-21 12:43:18 -07001231 fa->fa_info == fi) {
1232 goto out;
1233 }
1234 }
Thomas Graf4e902c52006-08-17 18:14:52 -07001235 if (!(cfg->fc_nlflags & NLM_F_APPEND))
Robert Olsson19baf832005-06-21 12:43:18 -07001236 fa = fa_orig;
1237 }
1238 err = -ENOENT;
Thomas Graf4e902c52006-08-17 18:14:52 -07001239 if (!(cfg->fc_nlflags & NLM_F_CREATE))
Robert Olsson19baf832005-06-21 12:43:18 -07001240 goto out;
1241
1242 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001243 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson19baf832005-06-21 12:43:18 -07001244 if (new_fa == NULL)
1245 goto out;
1246
1247 new_fa->fa_info = fi;
1248 new_fa->fa_tos = tos;
Thomas Graf4e902c52006-08-17 18:14:52 -07001249 new_fa->fa_type = cfg->fc_type;
1250 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001251 new_fa->fa_state = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001252 /*
1253 * Insert new entry to the list.
1254 */
1255
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001256 if (!fa_head) {
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001257 fa_head = fib_insert_node(t, key, plen);
1258 if (unlikely(!fa_head)) {
1259 err = -ENOMEM;
Robert Olssonf835e472005-06-28 15:00:39 -07001260 goto out_free_new_fa;
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001261 }
Robert Olssonf835e472005-06-28 15:00:39 -07001262 }
Robert Olsson19baf832005-06-21 12:43:18 -07001263
Robert Olsson2373ce12005-08-25 13:01:29 -07001264 list_add_tail_rcu(&new_fa->fa_list,
1265 (fa ? &fa->fa_list : fa_head));
Robert Olsson19baf832005-06-21 12:43:18 -07001266
1267 rt_cache_flush(-1);
Thomas Graf4e902c52006-08-17 18:14:52 -07001268 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001269 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001270succeeded:
1271 return 0;
Robert Olssonf835e472005-06-28 15:00:39 -07001272
1273out_free_new_fa:
1274 kmem_cache_free(fn_alias_kmem, new_fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001275out:
1276 fib_release_info(fi);
Olof Johansson91b9a272005-08-09 20:24:39 -07001277err:
Robert Olsson19baf832005-06-21 12:43:18 -07001278 return err;
1279}
1280
Robert Olsson2373ce12005-08-25 13:01:29 -07001281
Robert Olsson772cb712005-09-19 15:31:18 -07001282/* should be called with rcu_read_lock */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001283static inline int check_leaf(struct trie *t, struct leaf *l,
1284 t_key key, int *plen, const struct flowi *flp,
Patrick McHardy06c74272005-08-23 22:06:09 -07001285 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001286{
Patrick McHardy06c74272005-08-23 22:06:09 -07001287 int err, i;
Al Viro888454c2006-09-19 13:42:46 -07001288 __be32 mask;
Robert Olsson19baf832005-06-21 12:43:18 -07001289 struct leaf_info *li;
1290 struct hlist_head *hhead = &l->list;
1291 struct hlist_node *node;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001292
Robert Olsson2373ce12005-08-25 13:01:29 -07001293 hlist_for_each_entry_rcu(li, node, hhead, hlist) {
Robert Olsson19baf832005-06-21 12:43:18 -07001294 i = li->plen;
Al Viro888454c2006-09-19 13:42:46 -07001295 mask = inet_make_mask(i);
1296 if (l->key != (key & ntohl(mask)))
Robert Olsson19baf832005-06-21 12:43:18 -07001297 continue;
1298
Al Viro888454c2006-09-19 13:42:46 -07001299 if ((err = fib_semantic_match(&li->falh, flp, res, htonl(l->key), mask, i)) <= 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001300 *plen = i;
1301#ifdef CONFIG_IP_FIB_TRIE_STATS
1302 t->stats.semantic_match_passed++;
1303#endif
Patrick McHardy06c74272005-08-23 22:06:09 -07001304 return err;
Robert Olsson19baf832005-06-21 12:43:18 -07001305 }
1306#ifdef CONFIG_IP_FIB_TRIE_STATS
1307 t->stats.semantic_match_miss++;
1308#endif
1309 }
Patrick McHardy06c74272005-08-23 22:06:09 -07001310 return 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001311}
1312
1313static int
1314fn_trie_lookup(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1315{
1316 struct trie *t = (struct trie *) tb->tb_data;
1317 int plen, ret = 0;
1318 struct node *n;
1319 struct tnode *pn;
1320 int pos, bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001321 t_key key = ntohl(flp->fl4_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001322 int chopped_off;
1323 t_key cindex = 0;
1324 int current_prefix_length = KEYLENGTH;
Olof Johansson91b9a272005-08-09 20:24:39 -07001325 struct tnode *cn;
1326 t_key node_prefix, key_prefix, pref_mismatch;
1327 int mp;
1328
Robert Olsson2373ce12005-08-25 13:01:29 -07001329 rcu_read_lock();
Robert Olsson19baf832005-06-21 12:43:18 -07001330
Robert Olsson2373ce12005-08-25 13:01:29 -07001331 n = rcu_dereference(t->trie);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001332 if (!n)
Robert Olsson19baf832005-06-21 12:43:18 -07001333 goto failed;
1334
1335#ifdef CONFIG_IP_FIB_TRIE_STATS
1336 t->stats.gets++;
1337#endif
1338
1339 /* Just a leaf? */
1340 if (IS_LEAF(n)) {
Patrick McHardy06c74272005-08-23 22:06:09 -07001341 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001342 goto found;
1343 goto failed;
1344 }
1345 pn = (struct tnode *) n;
1346 chopped_off = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001347
Olof Johansson91b9a272005-08-09 20:24:39 -07001348 while (pn) {
Robert Olsson19baf832005-06-21 12:43:18 -07001349 pos = pn->pos;
1350 bits = pn->bits;
1351
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001352 if (!chopped_off)
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001353 cindex = tkey_extract_bits(mask_pfx(key, current_prefix_length),
1354 pos, bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001355
1356 n = tnode_get_child(pn, cindex);
1357
1358 if (n == NULL) {
1359#ifdef CONFIG_IP_FIB_TRIE_STATS
1360 t->stats.null_node_hit++;
1361#endif
1362 goto backtrace;
1363 }
1364
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001365 if (IS_LEAF(n)) {
Patrick McHardy06c74272005-08-23 22:06:09 -07001366 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001367 goto found;
Olof Johansson91b9a272005-08-09 20:24:39 -07001368 else
1369 goto backtrace;
1370 }
1371
1372#define HL_OPTIMIZE
1373#ifdef HL_OPTIMIZE
1374 cn = (struct tnode *)n;
1375
1376 /*
1377 * It's a tnode, and we can do some extra checks here if we
1378 * like, to avoid descending into a dead-end branch.
1379 * This tnode is in the parent's child array at index
1380 * key[p_pos..p_pos+p_bits] but potentially with some bits
1381 * chopped off, so in reality the index may be just a
1382 * subprefix, padded with zero at the end.
1383 * We can also take a look at any skipped bits in this
1384 * tnode - everything up to p_pos is supposed to be ok,
1385 * and the non-chopped bits of the index (se previous
1386 * paragraph) are also guaranteed ok, but the rest is
1387 * considered unknown.
1388 *
1389 * The skipped bits are key[pos+bits..cn->pos].
1390 */
1391
1392 /* If current_prefix_length < pos+bits, we are already doing
1393 * actual prefix matching, which means everything from
1394 * pos+(bits-chopped_off) onward must be zero along some
1395 * branch of this subtree - otherwise there is *no* valid
1396 * prefix present. Here we can only check the skipped
1397 * bits. Remember, since we have already indexed into the
1398 * parent's child array, we know that the bits we chopped of
1399 * *are* zero.
1400 */
1401
1402 /* NOTA BENE: CHECKING ONLY SKIPPED BITS FOR THE NEW NODE HERE */
1403
1404 if (current_prefix_length < pos+bits) {
1405 if (tkey_extract_bits(cn->key, current_prefix_length,
1406 cn->pos - current_prefix_length) != 0 ||
1407 !(cn->child[0]))
1408 goto backtrace;
1409 }
1410
1411 /*
1412 * If chopped_off=0, the index is fully validated and we
1413 * only need to look at the skipped bits for this, the new,
1414 * tnode. What we actually want to do is to find out if
1415 * these skipped bits match our key perfectly, or if we will
1416 * have to count on finding a matching prefix further down,
1417 * because if we do, we would like to have some way of
1418 * verifying the existence of such a prefix at this point.
1419 */
1420
1421 /* The only thing we can do at this point is to verify that
1422 * any such matching prefix can indeed be a prefix to our
1423 * key, and if the bits in the node we are inspecting that
1424 * do not match our key are not ZERO, this cannot be true.
1425 * Thus, find out where there is a mismatch (before cn->pos)
1426 * and verify that all the mismatching bits are zero in the
1427 * new tnode's key.
1428 */
1429
1430 /* Note: We aren't very concerned about the piece of the key
1431 * that precede pn->pos+pn->bits, since these have already been
1432 * checked. The bits after cn->pos aren't checked since these are
1433 * by definition "unknown" at this point. Thus, what we want to
1434 * see is if we are about to enter the "prefix matching" state,
1435 * and in that case verify that the skipped bits that will prevail
1436 * throughout this subtree are zero, as they have to be if we are
1437 * to find a matching prefix.
1438 */
1439
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001440 node_prefix = mask_pfx(cn->key, cn->pos);
1441 key_prefix = mask_pfx(key, cn->pos);
Olof Johansson91b9a272005-08-09 20:24:39 -07001442 pref_mismatch = key_prefix^node_prefix;
1443 mp = 0;
1444
1445 /* In short: If skipped bits in this node do not match the search
1446 * key, enter the "prefix matching" state.directly.
1447 */
1448 if (pref_mismatch) {
1449 while (!(pref_mismatch & (1<<(KEYLENGTH-1)))) {
1450 mp++;
1451 pref_mismatch = pref_mismatch <<1;
1452 }
1453 key_prefix = tkey_extract_bits(cn->key, mp, cn->pos-mp);
1454
1455 if (key_prefix != 0)
1456 goto backtrace;
1457
1458 if (current_prefix_length >= cn->pos)
1459 current_prefix_length = mp;
1460 }
1461#endif
1462 pn = (struct tnode *)n; /* Descend */
1463 chopped_off = 0;
1464 continue;
1465
Robert Olsson19baf832005-06-21 12:43:18 -07001466backtrace:
1467 chopped_off++;
1468
1469 /* As zero don't change the child key (cindex) */
Olof Johansson91b9a272005-08-09 20:24:39 -07001470 while ((chopped_off <= pn->bits) && !(cindex & (1<<(chopped_off-1))))
Robert Olsson19baf832005-06-21 12:43:18 -07001471 chopped_off++;
Robert Olsson19baf832005-06-21 12:43:18 -07001472
1473 /* Decrease current_... with bits chopped off */
1474 if (current_prefix_length > pn->pos + pn->bits - chopped_off)
1475 current_prefix_length = pn->pos + pn->bits - chopped_off;
Olof Johansson91b9a272005-08-09 20:24:39 -07001476
Robert Olsson19baf832005-06-21 12:43:18 -07001477 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001478 * Either we do the actual chop off according or if we have
Robert Olsson19baf832005-06-21 12:43:18 -07001479 * chopped off all bits in this tnode walk up to our parent.
1480 */
1481
Olof Johansson91b9a272005-08-09 20:24:39 -07001482 if (chopped_off <= pn->bits) {
Robert Olsson19baf832005-06-21 12:43:18 -07001483 cindex &= ~(1 << (chopped_off-1));
Olof Johansson91b9a272005-08-09 20:24:39 -07001484 } else {
Stephen Hemminger06801912007-08-10 15:22:13 -07001485 struct tnode *parent = node_parent((struct node *) pn);
1486 if (!parent)
Robert Olsson19baf832005-06-21 12:43:18 -07001487 goto failed;
Olof Johansson91b9a272005-08-09 20:24:39 -07001488
Robert Olsson19baf832005-06-21 12:43:18 -07001489 /* Get Child's index */
Stephen Hemminger06801912007-08-10 15:22:13 -07001490 cindex = tkey_extract_bits(pn->key, parent->pos, parent->bits);
1491 pn = parent;
Robert Olsson19baf832005-06-21 12:43:18 -07001492 chopped_off = 0;
1493
1494#ifdef CONFIG_IP_FIB_TRIE_STATS
1495 t->stats.backtrack++;
1496#endif
1497 goto backtrace;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001498 }
Robert Olsson19baf832005-06-21 12:43:18 -07001499 }
1500failed:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001501 ret = 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001502found:
Robert Olsson2373ce12005-08-25 13:01:29 -07001503 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001504 return ret;
1505}
1506
Robert Olsson2373ce12005-08-25 13:01:29 -07001507/* only called from updater side */
Robert Olsson19baf832005-06-21 12:43:18 -07001508static int trie_leaf_remove(struct trie *t, t_key key)
1509{
1510 t_key cindex;
1511 struct tnode *tp = NULL;
1512 struct node *n = t->trie;
1513 struct leaf *l;
1514
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001515 pr_debug("entering trie_leaf_remove(%p)\n", n);
Robert Olsson19baf832005-06-21 12:43:18 -07001516
1517 /* Note that in the case skipped bits, those bits are *not* checked!
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001518 * When we finish this, we will have NULL or a T_LEAF, and the
Robert Olsson19baf832005-06-21 12:43:18 -07001519 * T_LEAF may or may not match our key.
1520 */
1521
Olof Johansson91b9a272005-08-09 20:24:39 -07001522 while (n != NULL && IS_TNODE(n)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001523 struct tnode *tn = (struct tnode *) n;
1524 check_tnode(tn);
1525 n = tnode_get_child(tn ,tkey_extract_bits(key, tn->pos, tn->bits));
1526
Stephen Hemminger06801912007-08-10 15:22:13 -07001527 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001528 }
Robert Olsson19baf832005-06-21 12:43:18 -07001529 l = (struct leaf *) n;
1530
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001531 if (!n || !tkey_equals(l->key, key))
Robert Olsson19baf832005-06-21 12:43:18 -07001532 return 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001533
1534 /*
1535 * Key found.
1536 * Remove the leaf and rebalance the tree
Robert Olsson19baf832005-06-21 12:43:18 -07001537 */
1538
Robert Olsson19baf832005-06-21 12:43:18 -07001539 t->size--;
1540
Stephen Hemminger06801912007-08-10 15:22:13 -07001541 tp = node_parent(n);
Robert Olsson19baf832005-06-21 12:43:18 -07001542 tnode_free((struct tnode *) n);
1543
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001544 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001545 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1546 put_child(t, (struct tnode *)tp, cindex, NULL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001547 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Olof Johansson91b9a272005-08-09 20:24:39 -07001548 } else
Robert Olsson2373ce12005-08-25 13:01:29 -07001549 rcu_assign_pointer(t->trie, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001550
1551 return 1;
1552}
1553
Robert Olssond562f1f2007-03-26 14:22:22 -07001554/*
1555 * Caller must hold RTNL.
1556 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001557static int fn_trie_delete(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001558{
1559 struct trie *t = (struct trie *) tb->tb_data;
1560 u32 key, mask;
Thomas Graf4e902c52006-08-17 18:14:52 -07001561 int plen = cfg->fc_dst_len;
1562 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001563 struct fib_alias *fa, *fa_to_delete;
1564 struct list_head *fa_head;
1565 struct leaf *l;
Olof Johansson91b9a272005-08-09 20:24:39 -07001566 struct leaf_info *li;
1567
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001568 if (plen > 32)
Robert Olsson19baf832005-06-21 12:43:18 -07001569 return -EINVAL;
1570
Thomas Graf4e902c52006-08-17 18:14:52 -07001571 key = ntohl(cfg->fc_dst);
Olof Johansson91b9a272005-08-09 20:24:39 -07001572 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001573
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001574 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001575 return -EINVAL;
1576
1577 key = key & mask;
1578 l = fib_find_node(t, key);
1579
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001580 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001581 return -ESRCH;
1582
1583 fa_head = get_fa_head(l, plen);
1584 fa = fib_find_alias(fa_head, tos, 0);
1585
1586 if (!fa)
1587 return -ESRCH;
1588
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001589 pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t);
Robert Olsson19baf832005-06-21 12:43:18 -07001590
1591 fa_to_delete = NULL;
1592 fa_head = fa->fa_list.prev;
Robert Olsson2373ce12005-08-25 13:01:29 -07001593
Robert Olsson19baf832005-06-21 12:43:18 -07001594 list_for_each_entry(fa, fa_head, fa_list) {
1595 struct fib_info *fi = fa->fa_info;
1596
1597 if (fa->fa_tos != tos)
1598 break;
1599
Thomas Graf4e902c52006-08-17 18:14:52 -07001600 if ((!cfg->fc_type || fa->fa_type == cfg->fc_type) &&
1601 (cfg->fc_scope == RT_SCOPE_NOWHERE ||
1602 fa->fa_scope == cfg->fc_scope) &&
1603 (!cfg->fc_protocol ||
1604 fi->fib_protocol == cfg->fc_protocol) &&
1605 fib_nh_match(cfg, fi) == 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001606 fa_to_delete = fa;
1607 break;
1608 }
1609 }
1610
Olof Johansson91b9a272005-08-09 20:24:39 -07001611 if (!fa_to_delete)
1612 return -ESRCH;
Robert Olsson19baf832005-06-21 12:43:18 -07001613
Olof Johansson91b9a272005-08-09 20:24:39 -07001614 fa = fa_to_delete;
Thomas Graf4e902c52006-08-17 18:14:52 -07001615 rtmsg_fib(RTM_DELROUTE, htonl(key), fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001616 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001617
Olof Johansson91b9a272005-08-09 20:24:39 -07001618 l = fib_find_node(t, key);
Robert Olsson772cb712005-09-19 15:31:18 -07001619 li = find_leaf_info(l, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001620
Robert Olsson2373ce12005-08-25 13:01:29 -07001621 list_del_rcu(&fa->fa_list);
Robert Olsson19baf832005-06-21 12:43:18 -07001622
Olof Johansson91b9a272005-08-09 20:24:39 -07001623 if (list_empty(fa_head)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001624 hlist_del_rcu(&li->hlist);
Olof Johansson91b9a272005-08-09 20:24:39 -07001625 free_leaf_info(li);
Robert Olsson2373ce12005-08-25 13:01:29 -07001626 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001627
1628 if (hlist_empty(&l->list))
1629 trie_leaf_remove(t, key);
1630
1631 if (fa->fa_state & FA_S_ACCESSED)
1632 rt_cache_flush(-1);
1633
Robert Olsson2373ce12005-08-25 13:01:29 -07001634 fib_release_info(fa->fa_info);
1635 alias_free_mem_rcu(fa);
Olof Johansson91b9a272005-08-09 20:24:39 -07001636 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001637}
1638
1639static int trie_flush_list(struct trie *t, struct list_head *head)
1640{
1641 struct fib_alias *fa, *fa_node;
1642 int found = 0;
1643
1644 list_for_each_entry_safe(fa, fa_node, head, fa_list) {
1645 struct fib_info *fi = fa->fa_info;
Robert Olsson19baf832005-06-21 12:43:18 -07001646
Robert Olsson2373ce12005-08-25 13:01:29 -07001647 if (fi && (fi->fib_flags & RTNH_F_DEAD)) {
1648 list_del_rcu(&fa->fa_list);
1649 fib_release_info(fa->fa_info);
1650 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001651 found++;
1652 }
1653 }
1654 return found;
1655}
1656
1657static int trie_flush_leaf(struct trie *t, struct leaf *l)
1658{
1659 int found = 0;
1660 struct hlist_head *lih = &l->list;
1661 struct hlist_node *node, *tmp;
1662 struct leaf_info *li = NULL;
1663
1664 hlist_for_each_entry_safe(li, node, tmp, lih, hlist) {
Robert Olsson19baf832005-06-21 12:43:18 -07001665 found += trie_flush_list(t, &li->falh);
1666
1667 if (list_empty(&li->falh)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001668 hlist_del_rcu(&li->hlist);
Robert Olsson19baf832005-06-21 12:43:18 -07001669 free_leaf_info(li);
1670 }
1671 }
1672 return found;
1673}
1674
Robert Olsson2373ce12005-08-25 13:01:29 -07001675/* rcu_read_lock needs to be hold by caller from readside */
1676
Robert Olsson19baf832005-06-21 12:43:18 -07001677static struct leaf *nextleaf(struct trie *t, struct leaf *thisleaf)
1678{
1679 struct node *c = (struct node *) thisleaf;
1680 struct tnode *p;
1681 int idx;
Robert Olsson2373ce12005-08-25 13:01:29 -07001682 struct node *trie = rcu_dereference(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -07001683
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001684 if (c == NULL) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001685 if (trie == NULL)
Robert Olsson19baf832005-06-21 12:43:18 -07001686 return NULL;
1687
Robert Olsson2373ce12005-08-25 13:01:29 -07001688 if (IS_LEAF(trie)) /* trie w. just a leaf */
1689 return (struct leaf *) trie;
Robert Olsson19baf832005-06-21 12:43:18 -07001690
Robert Olsson2373ce12005-08-25 13:01:29 -07001691 p = (struct tnode*) trie; /* Start */
Olof Johansson91b9a272005-08-09 20:24:39 -07001692 } else
Stephen Hemminger06801912007-08-10 15:22:13 -07001693 p = node_parent(c);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001694
Robert Olsson19baf832005-06-21 12:43:18 -07001695 while (p) {
1696 int pos, last;
1697
1698 /* Find the next child of the parent */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001699 if (c)
1700 pos = 1 + tkey_extract_bits(c->key, p->pos, p->bits);
1701 else
Robert Olsson19baf832005-06-21 12:43:18 -07001702 pos = 0;
1703
1704 last = 1 << p->bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001705 for (idx = pos; idx < last ; idx++) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001706 c = rcu_dereference(p->child[idx]);
1707
1708 if (!c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001709 continue;
Robert Olsson19baf832005-06-21 12:43:18 -07001710
Olof Johansson91b9a272005-08-09 20:24:39 -07001711 /* Decend if tnode */
Robert Olsson2373ce12005-08-25 13:01:29 -07001712 while (IS_TNODE(c)) {
1713 p = (struct tnode *) c;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09001714 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001715
Olof Johansson91b9a272005-08-09 20:24:39 -07001716 /* Rightmost non-NULL branch */
1717 if (p && IS_TNODE(p))
Robert Olsson2373ce12005-08-25 13:01:29 -07001718 while (!(c = rcu_dereference(p->child[idx]))
1719 && idx < (1<<p->bits)) idx++;
Robert Olsson19baf832005-06-21 12:43:18 -07001720
Olof Johansson91b9a272005-08-09 20:24:39 -07001721 /* Done with this tnode? */
Robert Olsson2373ce12005-08-25 13:01:29 -07001722 if (idx >= (1 << p->bits) || !c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001723 goto up;
Robert Olsson19baf832005-06-21 12:43:18 -07001724 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001725 return (struct leaf *) c;
Robert Olsson19baf832005-06-21 12:43:18 -07001726 }
1727up:
1728 /* No more children go up one step */
Olof Johansson91b9a272005-08-09 20:24:39 -07001729 c = (struct node *) p;
Stephen Hemminger06801912007-08-10 15:22:13 -07001730 p = node_parent(c);
Robert Olsson19baf832005-06-21 12:43:18 -07001731 }
1732 return NULL; /* Ready. Root of trie */
1733}
1734
Robert Olssond562f1f2007-03-26 14:22:22 -07001735/*
1736 * Caller must hold RTNL.
1737 */
Robert Olsson19baf832005-06-21 12:43:18 -07001738static int fn_trie_flush(struct fib_table *tb)
1739{
1740 struct trie *t = (struct trie *) tb->tb_data;
1741 struct leaf *ll = NULL, *l = NULL;
1742 int found = 0, h;
1743
Olof Johansson91b9a272005-08-09 20:24:39 -07001744 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001745 found += trie_flush_leaf(t, l);
1746
1747 if (ll && hlist_empty(&ll->list))
1748 trie_leaf_remove(t, ll->key);
1749 ll = l;
1750 }
1751
1752 if (ll && hlist_empty(&ll->list))
1753 trie_leaf_remove(t, ll->key);
1754
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001755 pr_debug("trie_flush found=%d\n", found);
Robert Olsson19baf832005-06-21 12:43:18 -07001756 return found;
1757}
1758
Robert Olsson19baf832005-06-21 12:43:18 -07001759static void
1760fn_trie_select_default(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1761{
1762 struct trie *t = (struct trie *) tb->tb_data;
1763 int order, last_idx;
1764 struct fib_info *fi = NULL;
1765 struct fib_info *last_resort;
1766 struct fib_alias *fa = NULL;
1767 struct list_head *fa_head;
1768 struct leaf *l;
1769
1770 last_idx = -1;
1771 last_resort = NULL;
1772 order = -1;
1773
Robert Olsson2373ce12005-08-25 13:01:29 -07001774 rcu_read_lock();
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001775
Robert Olsson19baf832005-06-21 12:43:18 -07001776 l = fib_find_node(t, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001777 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001778 goto out;
1779
1780 fa_head = get_fa_head(l, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001781 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001782 goto out;
1783
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001784 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001785 goto out;
1786
Robert Olsson2373ce12005-08-25 13:01:29 -07001787 list_for_each_entry_rcu(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001788 struct fib_info *next_fi = fa->fa_info;
Olof Johansson91b9a272005-08-09 20:24:39 -07001789
Robert Olsson19baf832005-06-21 12:43:18 -07001790 if (fa->fa_scope != res->scope ||
1791 fa->fa_type != RTN_UNICAST)
1792 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -07001793
Robert Olsson19baf832005-06-21 12:43:18 -07001794 if (next_fi->fib_priority > res->fi->fib_priority)
1795 break;
1796 if (!next_fi->fib_nh[0].nh_gw ||
1797 next_fi->fib_nh[0].nh_scope != RT_SCOPE_LINK)
1798 continue;
1799 fa->fa_state |= FA_S_ACCESSED;
Olof Johansson91b9a272005-08-09 20:24:39 -07001800
Robert Olsson19baf832005-06-21 12:43:18 -07001801 if (fi == NULL) {
1802 if (next_fi != res->fi)
1803 break;
1804 } else if (!fib_detect_death(fi, order, &last_resort,
Denis V. Lunev971b8932007-12-08 00:32:23 -08001805 &last_idx, tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001806 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001807 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001808 goto out;
1809 }
1810 fi = next_fi;
1811 order++;
1812 }
1813 if (order <= 0 || fi == NULL) {
Denis V. Lunev971b8932007-12-08 00:32:23 -08001814 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001815 goto out;
1816 }
1817
Denis V. Lunev971b8932007-12-08 00:32:23 -08001818 if (!fib_detect_death(fi, order, &last_resort, &last_idx,
1819 tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001820 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001821 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001822 goto out;
1823 }
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001824 if (last_idx >= 0)
1825 fib_result_assign(res, last_resort);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001826 tb->tb_default = last_idx;
1827out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001828 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001829}
1830
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001831static 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 -07001832 struct sk_buff *skb, struct netlink_callback *cb)
1833{
1834 int i, s_i;
1835 struct fib_alias *fa;
1836
Al Viro32ab5f82006-09-26 22:21:45 -07001837 __be32 xkey = htonl(key);
Robert Olsson19baf832005-06-21 12:43:18 -07001838
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001839 s_i = cb->args[4];
Robert Olsson19baf832005-06-21 12:43:18 -07001840 i = 0;
1841
Robert Olsson2373ce12005-08-25 13:01:29 -07001842 /* rcu_read_lock is hold by caller */
1843
1844 list_for_each_entry_rcu(fa, fah, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001845 if (i < s_i) {
1846 i++;
1847 continue;
1848 }
Stephen Hemminger78c66712005-09-21 00:15:39 -07001849 BUG_ON(!fa->fa_info);
Robert Olsson19baf832005-06-21 12:43:18 -07001850
1851 if (fib_dump_info(skb, NETLINK_CB(cb->skb).pid,
1852 cb->nlh->nlmsg_seq,
1853 RTM_NEWROUTE,
1854 tb->tb_id,
1855 fa->fa_type,
1856 fa->fa_scope,
Thomas Grafbe403ea2006-08-17 18:15:17 -07001857 xkey,
Robert Olsson19baf832005-06-21 12:43:18 -07001858 plen,
1859 fa->fa_tos,
David S. Miller90f66912005-06-21 14:43:28 -07001860 fa->fa_info, 0) < 0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001861 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001862 return -1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001863 }
Robert Olsson19baf832005-06-21 12:43:18 -07001864 i++;
1865 }
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001866 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001867 return skb->len;
1868}
1869
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001870static 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 -07001871 struct netlink_callback *cb)
1872{
1873 int h, s_h;
1874 struct list_head *fa_head;
1875 struct leaf *l = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001876
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001877 s_h = cb->args[3];
Robert Olsson19baf832005-06-21 12:43:18 -07001878
Olof Johansson91b9a272005-08-09 20:24:39 -07001879 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001880 if (h < s_h)
1881 continue;
1882 if (h > s_h)
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001883 memset(&cb->args[4], 0,
1884 sizeof(cb->args) - 4*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001885
1886 fa_head = get_fa_head(l, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001887
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001888 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001889 continue;
1890
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001891 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001892 continue;
1893
1894 if (fn_trie_dump_fa(l->key, plen, fa_head, tb, skb, cb)<0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001895 cb->args[3] = h;
Robert Olsson19baf832005-06-21 12:43:18 -07001896 return -1;
1897 }
1898 }
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001899 cb->args[3] = h;
Robert Olsson19baf832005-06-21 12:43:18 -07001900 return skb->len;
1901}
1902
1903static int fn_trie_dump(struct fib_table *tb, struct sk_buff *skb, struct netlink_callback *cb)
1904{
1905 int m, s_m;
1906 struct trie *t = (struct trie *) tb->tb_data;
1907
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001908 s_m = cb->args[2];
Robert Olsson19baf832005-06-21 12:43:18 -07001909
Robert Olsson2373ce12005-08-25 13:01:29 -07001910 rcu_read_lock();
Olof Johansson91b9a272005-08-09 20:24:39 -07001911 for (m = 0; m <= 32; m++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001912 if (m < s_m)
1913 continue;
1914 if (m > s_m)
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001915 memset(&cb->args[3], 0,
1916 sizeof(cb->args) - 3*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001917
1918 if (fn_trie_dump_plen(t, 32-m, tb, skb, cb)<0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001919 cb->args[2] = m;
Robert Olsson19baf832005-06-21 12:43:18 -07001920 goto out;
1921 }
1922 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001923 rcu_read_unlock();
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001924 cb->args[2] = m;
Robert Olsson19baf832005-06-21 12:43:18 -07001925 return skb->len;
Olof Johansson91b9a272005-08-09 20:24:39 -07001926out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001927 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001928 return -1;
1929}
1930
1931/* Fix more generic FIB names for init later */
1932
Denis V. Lunev7b1a74f2008-01-10 03:22:17 -08001933struct fib_table *fib_hash_init(u32 id)
Robert Olsson19baf832005-06-21 12:43:18 -07001934{
1935 struct fib_table *tb;
1936 struct trie *t;
1937
1938 if (fn_alias_kmem == NULL)
1939 fn_alias_kmem = kmem_cache_create("ip_fib_alias",
1940 sizeof(struct fib_alias),
1941 0, SLAB_HWCACHE_ALIGN,
Paul Mundt20c2df82007-07-20 10:11:58 +09001942 NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001943
1944 tb = kmalloc(sizeof(struct fib_table) + sizeof(struct trie),
1945 GFP_KERNEL);
1946 if (tb == NULL)
1947 return NULL;
1948
1949 tb->tb_id = id;
Denis V. Lunev971b8932007-12-08 00:32:23 -08001950 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001951 tb->tb_lookup = fn_trie_lookup;
1952 tb->tb_insert = fn_trie_insert;
1953 tb->tb_delete = fn_trie_delete;
1954 tb->tb_flush = fn_trie_flush;
1955 tb->tb_select_default = fn_trie_select_default;
1956 tb->tb_dump = fn_trie_dump;
Robert Olsson19baf832005-06-21 12:43:18 -07001957
1958 t = (struct trie *) tb->tb_data;
Stephen Hemmingerc28a1cf2008-01-12 20:49:13 -08001959 memset(t, 0, sizeof(*t));
Robert Olsson19baf832005-06-21 12:43:18 -07001960
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001961 if (id == RT_TABLE_LOCAL)
Stephen Hemminger78c66712005-09-21 00:15:39 -07001962 printk(KERN_INFO "IPv4 FIB: Using LC-trie version %s\n", VERSION);
Robert Olsson19baf832005-06-21 12:43:18 -07001963
1964 return tb;
1965}
1966
Robert Olsson19baf832005-06-21 12:43:18 -07001967#ifdef CONFIG_PROC_FS
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001968/* Depth first Trie walk iterator */
1969struct fib_trie_iter {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08001970 struct seq_net_private p;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08001971 struct trie *trie_local, *trie_main;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001972 struct tnode *tnode;
1973 struct trie *trie;
1974 unsigned index;
1975 unsigned depth;
1976};
Robert Olsson19baf832005-06-21 12:43:18 -07001977
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001978static struct node *fib_trie_get_next(struct fib_trie_iter *iter)
Robert Olsson19baf832005-06-21 12:43:18 -07001979{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001980 struct tnode *tn = iter->tnode;
1981 unsigned cindex = iter->index;
1982 struct tnode *p;
1983
Eric W. Biederman6640e692007-01-24 14:42:04 -08001984 /* A single entry routing table */
1985 if (!tn)
1986 return NULL;
1987
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001988 pr_debug("get_next iter={node=%p index=%d depth=%d}\n",
1989 iter->tnode, iter->index, iter->depth);
1990rescan:
1991 while (cindex < (1<<tn->bits)) {
1992 struct node *n = tnode_get_child(tn, cindex);
1993
1994 if (n) {
1995 if (IS_LEAF(n)) {
1996 iter->tnode = tn;
1997 iter->index = cindex + 1;
1998 } else {
1999 /* push down one level */
2000 iter->tnode = (struct tnode *) n;
2001 iter->index = 0;
2002 ++iter->depth;
2003 }
2004 return n;
2005 }
2006
2007 ++cindex;
2008 }
2009
2010 /* Current node exhausted, pop back up */
Stephen Hemminger06801912007-08-10 15:22:13 -07002011 p = node_parent((struct node *)tn);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002012 if (p) {
2013 cindex = tkey_extract_bits(tn->key, p->pos, p->bits)+1;
2014 tn = p;
2015 --iter->depth;
2016 goto rescan;
2017 }
2018
2019 /* got root? */
Robert Olsson19baf832005-06-21 12:43:18 -07002020 return NULL;
2021}
2022
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002023static struct node *fib_trie_get_first(struct fib_trie_iter *iter,
2024 struct trie *t)
Robert Olsson19baf832005-06-21 12:43:18 -07002025{
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002026 struct node *n ;
2027
Stephen Hemminger132adf52007-03-08 20:44:43 -08002028 if (!t)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002029 return NULL;
2030
2031 n = rcu_dereference(t->trie);
2032
Stephen Hemminger132adf52007-03-08 20:44:43 -08002033 if (!iter)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002034 return NULL;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002035
Eric W. Biederman6640e692007-01-24 14:42:04 -08002036 if (n) {
2037 if (IS_TNODE(n)) {
2038 iter->tnode = (struct tnode *) n;
2039 iter->trie = t;
2040 iter->index = 0;
2041 iter->depth = 1;
2042 } else {
2043 iter->tnode = NULL;
2044 iter->trie = t;
2045 iter->index = 0;
2046 iter->depth = 0;
2047 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002048 return n;
2049 }
Robert Olsson19baf832005-06-21 12:43:18 -07002050 return NULL;
2051}
2052
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002053static void trie_collect_stats(struct trie *t, struct trie_stat *s)
Robert Olsson19baf832005-06-21 12:43:18 -07002054{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002055 struct node *n;
2056 struct fib_trie_iter iter;
Robert Olsson19baf832005-06-21 12:43:18 -07002057
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002058 memset(s, 0, sizeof(*s));
Robert Olsson19baf832005-06-21 12:43:18 -07002059
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002060 rcu_read_lock();
2061 for (n = fib_trie_get_first(&iter, t); n;
2062 n = fib_trie_get_next(&iter)) {
2063 if (IS_LEAF(n)) {
2064 s->leaves++;
2065 s->totdepth += iter.depth;
2066 if (iter.depth > s->maxdepth)
2067 s->maxdepth = iter.depth;
2068 } else {
2069 const struct tnode *tn = (const struct tnode *) n;
2070 int i;
Robert Olsson19baf832005-06-21 12:43:18 -07002071
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002072 s->tnodes++;
Stephen Hemminger132adf52007-03-08 20:44:43 -08002073 if (tn->bits < MAX_STAT_DEPTH)
Robert Olsson06ef9212006-03-20 21:35:01 -08002074 s->nodesizes[tn->bits]++;
2075
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002076 for (i = 0; i < (1<<tn->bits); i++)
2077 if (!tn->child[i])
2078 s->nullpointers++;
2079 }
2080 }
2081 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002082}
2083
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002084/*
Robert Olsson19baf832005-06-21 12:43:18 -07002085 * This outputs /proc/net/fib_triestats
Robert Olsson19baf832005-06-21 12:43:18 -07002086 */
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002087static void trie_show_stats(struct seq_file *seq, struct trie_stat *stat)
Robert Olsson19baf832005-06-21 12:43:18 -07002088{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002089 unsigned i, max, pointers, bytes, avdepth;
Robert Olsson19baf832005-06-21 12:43:18 -07002090
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002091 if (stat->leaves)
2092 avdepth = stat->totdepth*100 / stat->leaves;
2093 else
2094 avdepth = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002095
Stephen Hemminger187b5182008-01-12 20:55:55 -08002096 seq_printf(seq, "\tAver depth: %u.%02d\n", avdepth / 100, avdepth % 100 );
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002097 seq_printf(seq, "\tMax depth: %u\n", stat->maxdepth);
Robert Olsson19baf832005-06-21 12:43:18 -07002098
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002099 seq_printf(seq, "\tLeaves: %u\n", stat->leaves);
Olof Johansson91b9a272005-08-09 20:24:39 -07002100
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002101 bytes = sizeof(struct leaf) * stat->leaves;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002102 seq_printf(seq, "\tInternal nodes: %u\n\t", stat->tnodes);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002103 bytes += sizeof(struct tnode) * stat->tnodes;
Robert Olsson19baf832005-06-21 12:43:18 -07002104
Robert Olsson06ef9212006-03-20 21:35:01 -08002105 max = MAX_STAT_DEPTH;
2106 while (max > 0 && stat->nodesizes[max-1] == 0)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002107 max--;
Robert Olsson19baf832005-06-21 12:43:18 -07002108
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002109 pointers = 0;
2110 for (i = 1; i <= max; i++)
2111 if (stat->nodesizes[i] != 0) {
Stephen Hemminger187b5182008-01-12 20:55:55 -08002112 seq_printf(seq, " %u: %u", i, stat->nodesizes[i]);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002113 pointers += (1<<i) * stat->nodesizes[i];
2114 }
2115 seq_putc(seq, '\n');
Stephen Hemminger187b5182008-01-12 20:55:55 -08002116 seq_printf(seq, "\tPointers: %u\n", pointers);
Robert Olsson19baf832005-06-21 12:43:18 -07002117
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002118 bytes += sizeof(struct node *) * pointers;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002119 seq_printf(seq, "Null ptrs: %u\n", stat->nullpointers);
2120 seq_printf(seq, "Total size: %u kB\n", (bytes + 1023) / 1024);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002121}
Robert Olsson19baf832005-06-21 12:43:18 -07002122
2123#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002124static void trie_show_usage(struct seq_file *seq,
2125 const struct trie_use_stats *stats)
2126{
2127 seq_printf(seq, "\nCounters:\n---------\n");
2128 seq_printf(seq,"gets = %u\n", stats->gets);
2129 seq_printf(seq,"backtracks = %u\n", stats->backtrack);
2130 seq_printf(seq,"semantic match passed = %u\n", stats->semantic_match_passed);
2131 seq_printf(seq,"semantic match miss = %u\n", stats->semantic_match_miss);
2132 seq_printf(seq,"null node hit= %u\n", stats->null_node_hit);
2133 seq_printf(seq,"skipped node resize = %u\n\n", stats->resize_node_skipped);
Robert Olsson19baf832005-06-21 12:43:18 -07002134}
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002135#endif /* CONFIG_IP_FIB_TRIE_STATS */
2136
Robert Olsson19baf832005-06-21 12:43:18 -07002137
2138static int fib_triestat_seq_show(struct seq_file *seq, void *v)
2139{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002140 struct net *net = (struct net *)seq->private;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002141 struct trie *trie_local, *trie_main;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002142 struct trie_stat *stat;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002143 struct fib_table *tb;
2144
2145 trie_local = NULL;
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002146 tb = fib_get_table(net, RT_TABLE_LOCAL);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002147 if (tb)
2148 trie_local = (struct trie *) tb->tb_data;
2149
2150 trie_main = NULL;
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002151 tb = fib_get_table(net, RT_TABLE_MAIN);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002152 if (tb)
2153 trie_main = (struct trie *) tb->tb_data;
2154
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002155
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002156 stat = kmalloc(sizeof(*stat), GFP_KERNEL);
2157 if (!stat)
2158 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002159
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002160 seq_printf(seq, "Basic info: size of leaf: %Zd bytes, size of tnode: %Zd bytes.\n",
2161 sizeof(struct leaf), sizeof(struct tnode));
Olof Johansson91b9a272005-08-09 20:24:39 -07002162
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002163 if (trie_local) {
2164 seq_printf(seq, "Local:\n");
2165 trie_collect_stats(trie_local, stat);
2166 trie_show_stats(seq, stat);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002167#ifdef CONFIG_IP_FIB_TRIE_STATS
2168 trie_show_usage(seq, &trie_local->stats);
2169#endif
Robert Olsson19baf832005-06-21 12:43:18 -07002170 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002171
2172 if (trie_main) {
2173 seq_printf(seq, "Main:\n");
2174 trie_collect_stats(trie_main, stat);
2175 trie_show_stats(seq, stat);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002176#ifdef CONFIG_IP_FIB_TRIE_STATS
2177 trie_show_usage(seq, &trie_main->stats);
2178#endif
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002179 }
2180 kfree(stat);
2181
Robert Olsson19baf832005-06-21 12:43:18 -07002182 return 0;
2183}
2184
Robert Olsson19baf832005-06-21 12:43:18 -07002185static int fib_triestat_seq_open(struct inode *inode, struct file *file)
2186{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002187 int err;
2188 struct net *net;
2189
2190 net = get_proc_net(inode);
2191 if (net == NULL)
2192 return -ENXIO;
2193 err = single_open(file, fib_triestat_seq_show, net);
2194 if (err < 0) {
2195 put_net(net);
2196 return err;
2197 }
2198 return 0;
2199}
2200
2201static int fib_triestat_seq_release(struct inode *ino, struct file *f)
2202{
2203 struct seq_file *seq = f->private_data;
2204 put_net(seq->private);
2205 return single_release(ino, f);
Robert Olsson19baf832005-06-21 12:43:18 -07002206}
2207
Arjan van de Ven9a321442007-02-12 00:55:35 -08002208static const struct file_operations fib_triestat_fops = {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002209 .owner = THIS_MODULE,
2210 .open = fib_triestat_seq_open,
2211 .read = seq_read,
2212 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002213 .release = fib_triestat_seq_release,
Robert Olsson19baf832005-06-21 12:43:18 -07002214};
2215
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002216static struct node *fib_trie_get_idx(struct fib_trie_iter *iter,
2217 loff_t pos)
Robert Olsson19baf832005-06-21 12:43:18 -07002218{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002219 loff_t idx = 0;
2220 struct node *n;
Robert Olsson19baf832005-06-21 12:43:18 -07002221
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002222 for (n = fib_trie_get_first(iter, iter->trie_local);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002223 n; ++idx, n = fib_trie_get_next(iter)) {
2224 if (pos == idx)
2225 return n;
2226 }
Robert Olsson19baf832005-06-21 12:43:18 -07002227
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002228 for (n = fib_trie_get_first(iter, iter->trie_main);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002229 n; ++idx, n = fib_trie_get_next(iter)) {
2230 if (pos == idx)
2231 return n;
2232 }
Robert Olsson19baf832005-06-21 12:43:18 -07002233 return NULL;
2234}
2235
2236static void *fib_trie_seq_start(struct seq_file *seq, loff_t *pos)
2237{
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)
2279{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002280 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002281}
2282
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002283static void seq_indent(struct seq_file *seq, int n)
2284{
2285 while (n-- > 0) seq_puts(seq, " ");
2286}
Robert Olsson19baf832005-06-21 12:43:18 -07002287
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002288static inline const char *rtn_scope(enum rt_scope_t s)
2289{
2290 static char buf[32];
2291
Stephen Hemminger132adf52007-03-08 20:44:43 -08002292 switch (s) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002293 case RT_SCOPE_UNIVERSE: return "universe";
2294 case RT_SCOPE_SITE: return "site";
2295 case RT_SCOPE_LINK: return "link";
2296 case RT_SCOPE_HOST: return "host";
2297 case RT_SCOPE_NOWHERE: return "nowhere";
2298 default:
2299 snprintf(buf, sizeof(buf), "scope=%d", s);
2300 return buf;
2301 }
2302}
2303
2304static const char *rtn_type_names[__RTN_MAX] = {
2305 [RTN_UNSPEC] = "UNSPEC",
2306 [RTN_UNICAST] = "UNICAST",
2307 [RTN_LOCAL] = "LOCAL",
2308 [RTN_BROADCAST] = "BROADCAST",
2309 [RTN_ANYCAST] = "ANYCAST",
2310 [RTN_MULTICAST] = "MULTICAST",
2311 [RTN_BLACKHOLE] = "BLACKHOLE",
2312 [RTN_UNREACHABLE] = "UNREACHABLE",
2313 [RTN_PROHIBIT] = "PROHIBIT",
2314 [RTN_THROW] = "THROW",
2315 [RTN_NAT] = "NAT",
2316 [RTN_XRESOLVE] = "XRESOLVE",
2317};
2318
2319static inline const char *rtn_type(unsigned t)
2320{
2321 static char buf[32];
2322
2323 if (t < __RTN_MAX && rtn_type_names[t])
2324 return rtn_type_names[t];
Stephen Hemminger187b5182008-01-12 20:55:55 -08002325 snprintf(buf, sizeof(buf), "type %u", t);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002326 return buf;
2327}
2328
2329/* Pretty print the trie */
Robert Olsson19baf832005-06-21 12:43:18 -07002330static int fib_trie_seq_show(struct seq_file *seq, void *v)
2331{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002332 const struct fib_trie_iter *iter = seq->private;
2333 struct node *n = v;
Robert Olsson19baf832005-06-21 12:43:18 -07002334
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002335 if (v == SEQ_START_TOKEN)
2336 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002337
Stephen Hemminger06801912007-08-10 15:22:13 -07002338 if (!node_parent(n)) {
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002339 if (iter->trie == iter->trie_local)
Robert Olsson095b8502007-01-26 19:06:01 -08002340 seq_puts(seq, "<local>:\n");
2341 else
2342 seq_puts(seq, "<main>:\n");
2343 }
2344
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002345 if (IS_TNODE(n)) {
2346 struct tnode *tn = (struct tnode *) n;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07002347 __be32 prf = htonl(mask_pfx(tn->key, tn->pos));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002348
Robert Olsson1d25cd62005-09-19 15:29:52 -07002349 seq_indent(seq, iter->depth-1);
2350 seq_printf(seq, " +-- %d.%d.%d.%d/%d %d %d %d\n",
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002351 NIPQUAD(prf), tn->pos, tn->bits, tn->full_children,
Robert Olsson1d25cd62005-09-19 15:29:52 -07002352 tn->empty_children);
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002353
Olof Johansson91b9a272005-08-09 20:24:39 -07002354 } else {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002355 struct leaf *l = (struct leaf *) n;
2356 int i;
Al Viro32ab5f82006-09-26 22:21:45 -07002357 __be32 val = htonl(l->key);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002358
2359 seq_indent(seq, iter->depth);
2360 seq_printf(seq, " |-- %d.%d.%d.%d\n", NIPQUAD(val));
2361 for (i = 32; i >= 0; i--) {
Robert Olsson772cb712005-09-19 15:31:18 -07002362 struct leaf_info *li = find_leaf_info(l, i);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002363 if (li) {
2364 struct fib_alias *fa;
2365 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
2366 seq_indent(seq, iter->depth+1);
2367 seq_printf(seq, " /%d %s %s", i,
2368 rtn_scope(fa->fa_scope),
2369 rtn_type(fa->fa_type));
2370 if (fa->fa_tos)
2371 seq_printf(seq, "tos =%d\n",
2372 fa->fa_tos);
2373 seq_putc(seq, '\n');
2374 }
2375 }
2376 }
Robert Olsson19baf832005-06-21 12:43:18 -07002377 }
2378
2379 return 0;
2380}
2381
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002382static const struct seq_operations fib_trie_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002383 .start = fib_trie_seq_start,
2384 .next = fib_trie_seq_next,
2385 .stop = fib_trie_seq_stop,
2386 .show = fib_trie_seq_show,
Robert Olsson19baf832005-06-21 12:43:18 -07002387};
2388
2389static int fib_trie_seq_open(struct inode *inode, struct file *file)
2390{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002391 return seq_open_net(inode, file, &fib_trie_seq_ops,
2392 sizeof(struct fib_trie_iter));
Robert Olsson19baf832005-06-21 12:43:18 -07002393}
2394
Arjan van de Ven9a321442007-02-12 00:55:35 -08002395static const struct file_operations fib_trie_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002396 .owner = THIS_MODULE,
2397 .open = fib_trie_seq_open,
2398 .read = seq_read,
2399 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002400 .release = seq_release_net,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002401};
2402
Al Viro32ab5f82006-09-26 22:21:45 -07002403static unsigned fib_flag_trans(int type, __be32 mask, const struct fib_info *fi)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002404{
2405 static unsigned type2flags[RTN_MAX + 1] = {
2406 [7] = RTF_REJECT, [8] = RTF_REJECT,
2407 };
2408 unsigned flags = type2flags[type];
2409
2410 if (fi && fi->fib_nh->nh_gw)
2411 flags |= RTF_GATEWAY;
Al Viro32ab5f82006-09-26 22:21:45 -07002412 if (mask == htonl(0xFFFFFFFF))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002413 flags |= RTF_HOST;
2414 flags |= RTF_UP;
2415 return flags;
2416}
2417
2418/*
2419 * This outputs /proc/net/route.
2420 * The format of the file is not supposed to be changed
2421 * and needs to be same as fib_hash output to avoid breaking
2422 * legacy utilities
2423 */
2424static int fib_route_seq_show(struct seq_file *seq, void *v)
2425{
Patrick McHardyc9e53cb2005-11-20 21:09:00 -08002426 const struct fib_trie_iter *iter = seq->private;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002427 struct leaf *l = v;
2428 int i;
2429 char bf[128];
2430
2431 if (v == SEQ_START_TOKEN) {
2432 seq_printf(seq, "%-127s\n", "Iface\tDestination\tGateway "
2433 "\tFlags\tRefCnt\tUse\tMetric\tMask\t\tMTU"
2434 "\tWindow\tIRTT");
2435 return 0;
2436 }
2437
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002438 if (iter->trie == iter->trie_local)
Patrick McHardyc9e53cb2005-11-20 21:09:00 -08002439 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002440 if (IS_TNODE(l))
2441 return 0;
2442
2443 for (i=32; i>=0; i--) {
Robert Olsson772cb712005-09-19 15:31:18 -07002444 struct leaf_info *li = find_leaf_info(l, i);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002445 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07002446 __be32 mask, prefix;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002447
2448 if (!li)
2449 continue;
2450
2451 mask = inet_make_mask(li->plen);
2452 prefix = htonl(l->key);
2453
2454 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
Herbert Xu1371e372005-10-15 09:42:39 +10002455 const struct fib_info *fi = fa->fa_info;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002456 unsigned flags = fib_flag_trans(fa->fa_type, mask, fi);
2457
2458 if (fa->fa_type == RTN_BROADCAST
2459 || fa->fa_type == RTN_MULTICAST)
2460 continue;
2461
2462 if (fi)
2463 snprintf(bf, sizeof(bf),
2464 "%s\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2465 fi->fib_dev ? fi->fib_dev->name : "*",
2466 prefix,
2467 fi->fib_nh->nh_gw, flags, 0, 0,
2468 fi->fib_priority,
2469 mask,
2470 (fi->fib_advmss ? fi->fib_advmss + 40 : 0),
2471 fi->fib_window,
2472 fi->fib_rtt >> 3);
2473 else
2474 snprintf(bf, sizeof(bf),
2475 "*\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2476 prefix, 0, flags, 0, 0, 0,
2477 mask, 0, 0, 0);
2478
2479 seq_printf(seq, "%-127s\n", bf);
2480 }
2481 }
2482
2483 return 0;
2484}
2485
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002486static const struct seq_operations fib_route_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002487 .start = fib_trie_seq_start,
2488 .next = fib_trie_seq_next,
2489 .stop = fib_trie_seq_stop,
2490 .show = fib_route_seq_show,
2491};
2492
2493static int fib_route_seq_open(struct inode *inode, struct file *file)
2494{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002495 return seq_open_net(inode, file, &fib_route_seq_ops,
2496 sizeof(struct fib_trie_iter));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002497}
2498
Arjan van de Ven9a321442007-02-12 00:55:35 -08002499static const struct file_operations fib_route_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002500 .owner = THIS_MODULE,
2501 .open = fib_route_seq_open,
2502 .read = seq_read,
2503 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002504 .release = seq_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002505};
2506
Denis V. Lunev61a02652008-01-10 03:21:09 -08002507int __net_init fib_proc_init(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002508{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002509 if (!proc_net_fops_create(net, "fib_trie", S_IRUGO, &fib_trie_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002510 goto out1;
2511
Denis V. Lunev61a02652008-01-10 03:21:09 -08002512 if (!proc_net_fops_create(net, "fib_triestat", S_IRUGO,
2513 &fib_triestat_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002514 goto out2;
2515
Denis V. Lunev61a02652008-01-10 03:21:09 -08002516 if (!proc_net_fops_create(net, "route", S_IRUGO, &fib_route_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002517 goto out3;
2518
Robert Olsson19baf832005-06-21 12:43:18 -07002519 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002520
2521out3:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002522 proc_net_remove(net, "fib_triestat");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002523out2:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002524 proc_net_remove(net, "fib_trie");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002525out1:
2526 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002527}
2528
Denis V. Lunev61a02652008-01-10 03:21:09 -08002529void __net_exit fib_proc_exit(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002530{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002531 proc_net_remove(net, "fib_trie");
2532 proc_net_remove(net, "fib_triestat");
2533 proc_net_remove(net, "route");
Robert Olsson19baf832005-06-21 12:43:18 -07002534}
2535
2536#endif /* CONFIG_PROC_FS */