blob: 72c78c2209d55acde507b44541aeaf2c371f66c5 [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 unsigned long parent;
Eric Dumazet8d965442008-01-13 22:31:44 -0800101 t_key key;
Robert Olsson19baf832005-06-21 12:43:18 -0700102};
103
104struct leaf {
Olof Johansson91b9a272005-08-09 20:24:39 -0700105 unsigned long parent;
Eric Dumazet8d965442008-01-13 22:31:44 -0800106 t_key key;
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 unsigned long parent;
Eric Dumazet8d965442008-01-13 22:31:44 -0800120 t_key key;
Eric Dumazet112d8cf2008-01-12 21:27:41 -0800121 unsigned char pos; /* 2log(KEYLENGTH) bits needed */
122 unsigned char bits; /* 2log(KEYLENGTH) bits needed */
Eric Dumazet8d965442008-01-13 22:31:44 -0800123 unsigned int full_children; /* KEYLENGTH bits needed */
124 unsigned int 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
Eric Dumazet8d965442008-01-13 22:31:44 -0800332static struct tnode *tnode_alloc(size_t size)
Robert Olsson2373ce12005-08-25 13:01:29 -0700333{
334 struct page *pages;
335
336 if (size <= PAGE_SIZE)
Eric Dumazet8d965442008-01-13 22:31:44 -0800337 return kzalloc(size, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -0700338
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);
Eric Dumazet8d965442008-01-13 22:31:44 -0800349 size_t size = sizeof(struct tnode) +
350 (sizeof(struct node *) << tn->bits);
Robert Olsson2373ce12005-08-25 13:01:29 -0700351
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{
Eric Dumazet8d965442008-01-13 22:31:44 -0800389 size_t sz = sizeof(struct tnode) + (sizeof(struct node *) << bits);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700390 struct tnode *tn = tnode_alloc(sz);
Robert Olsson19baf832005-06-21 12:43:18 -0700391
Olof Johansson91b9a272005-08-09 20:24:39 -0700392 if (tn) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700393 tn->parent = T_TNODE;
Robert Olsson19baf832005-06-21 12:43:18 -0700394 tn->pos = pos;
395 tn->bits = bits;
396 tn->key = key;
397 tn->full_children = 0;
398 tn->empty_children = 1<<bits;
399 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700400
Eric Dumazet8d965442008-01-13 22:31:44 -0800401 pr_debug("AT %p s=%u %lu\n", tn, (unsigned int) sizeof(struct tnode),
402 (unsigned long) (sizeof(struct node) << bits));
Robert Olsson19baf832005-06-21 12:43:18 -0700403 return tn;
404}
405
Robert Olsson19baf832005-06-21 12:43:18 -0700406/*
407 * Check whether a tnode 'n' is "full", i.e. it is an internal node
408 * and no bits are skipped. See discussion in dyntree paper p. 6
409 */
410
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700411static inline int tnode_full(const struct tnode *tn, const struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700412{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700413 if (n == NULL || IS_LEAF(n))
Robert Olsson19baf832005-06-21 12:43:18 -0700414 return 0;
415
416 return ((struct tnode *) n)->pos == tn->pos + tn->bits;
417}
418
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700419static inline void put_child(struct trie *t, struct tnode *tn, int i, struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700420{
421 tnode_put_child_reorg(tn, i, n, -1);
422}
423
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700424 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700425 * Add a child at position i overwriting the old value.
426 * Update the value of full_children and empty_children.
427 */
428
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700429static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n, int wasfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700430{
Robert Olsson2373ce12005-08-25 13:01:29 -0700431 struct node *chi = tn->child[i];
Robert Olsson19baf832005-06-21 12:43:18 -0700432 int isfull;
433
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700434 BUG_ON(i >= 1<<tn->bits);
435
Robert Olsson19baf832005-06-21 12:43:18 -0700436
437 /* update emptyChildren */
438 if (n == NULL && chi != NULL)
439 tn->empty_children++;
440 else if (n != NULL && chi == NULL)
441 tn->empty_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700442
Robert Olsson19baf832005-06-21 12:43:18 -0700443 /* update fullChildren */
Olof Johansson91b9a272005-08-09 20:24:39 -0700444 if (wasfull == -1)
Robert Olsson19baf832005-06-21 12:43:18 -0700445 wasfull = tnode_full(tn, chi);
446
447 isfull = tnode_full(tn, n);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700448 if (wasfull && !isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700449 tn->full_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700450 else if (!wasfull && isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700451 tn->full_children++;
Olof Johansson91b9a272005-08-09 20:24:39 -0700452
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700453 if (n)
Stephen Hemminger06801912007-08-10 15:22:13 -0700454 node_set_parent(n, tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700455
Robert Olsson2373ce12005-08-25 13:01:29 -0700456 rcu_assign_pointer(tn->child[i], n);
Robert Olsson19baf832005-06-21 12:43:18 -0700457}
458
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700459static struct node *resize(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700460{
461 int i;
Robert Olsson2f368952005-07-05 15:02:40 -0700462 int err = 0;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700463 struct tnode *old_tn;
Robert Olssone6308be2005-10-04 13:01:58 -0700464 int inflate_threshold_use;
465 int halve_threshold_use;
Robert Olsson05eee482007-03-19 16:27:37 -0700466 int max_resize;
Robert Olsson19baf832005-06-21 12:43:18 -0700467
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900468 if (!tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700469 return NULL;
470
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700471 pr_debug("In tnode_resize %p inflate_threshold=%d threshold=%d\n",
472 tn, inflate_threshold, halve_threshold);
Robert Olsson19baf832005-06-21 12:43:18 -0700473
474 /* No children */
475 if (tn->empty_children == tnode_child_length(tn)) {
476 tnode_free(tn);
477 return NULL;
478 }
479 /* One child */
480 if (tn->empty_children == tnode_child_length(tn) - 1)
481 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700482 struct node *n;
Robert Olsson19baf832005-06-21 12:43:18 -0700483
Olof Johansson91b9a272005-08-09 20:24:39 -0700484 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700485 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700486 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700487
488 /* compress one level */
Stephen Hemminger06801912007-08-10 15:22:13 -0700489 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700490 tnode_free(tn);
491 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700492 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700493 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700494 * Double as long as the resulting node has a number of
495 * nonempty nodes that are above the threshold.
496 */
497
498 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700499 * From "Implementing a dynamic compressed trie" by Stefan Nilsson of
500 * the Helsinki University of Technology and Matti Tikkanen of Nokia
Robert Olsson19baf832005-06-21 12:43:18 -0700501 * Telecommunications, page 6:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700502 * "A node is doubled if the ratio of non-empty children to all
Robert Olsson19baf832005-06-21 12:43:18 -0700503 * children in the *doubled* node is at least 'high'."
504 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700505 * 'high' in this instance is the variable 'inflate_threshold'. It
506 * is expressed as a percentage, so we multiply it with
507 * tnode_child_length() and instead of multiplying by 2 (since the
508 * child array will be doubled by inflate()) and multiplying
509 * the left-hand side by 100 (to handle the percentage thing) we
Robert Olsson19baf832005-06-21 12:43:18 -0700510 * multiply the left-hand side by 50.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700511 *
512 * The left-hand side may look a bit weird: tnode_child_length(tn)
513 * - tn->empty_children is of course the number of non-null children
514 * in the current node. tn->full_children is the number of "full"
Robert Olsson19baf832005-06-21 12:43:18 -0700515 * children, that is non-null tnodes with a skip value of 0.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700516 * All of those will be doubled in the resulting inflated tnode, so
Robert Olsson19baf832005-06-21 12:43:18 -0700517 * we just count them one extra time here.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700518 *
Robert Olsson19baf832005-06-21 12:43:18 -0700519 * A clearer way to write this would be:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700520 *
Robert Olsson19baf832005-06-21 12:43:18 -0700521 * to_be_doubled = tn->full_children;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700522 * not_to_be_doubled = tnode_child_length(tn) - tn->empty_children -
Robert Olsson19baf832005-06-21 12:43:18 -0700523 * tn->full_children;
524 *
525 * new_child_length = tnode_child_length(tn) * 2;
526 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700527 * new_fill_factor = 100 * (not_to_be_doubled + 2*to_be_doubled) /
Robert Olsson19baf832005-06-21 12:43:18 -0700528 * new_child_length;
529 * if (new_fill_factor >= inflate_threshold)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700530 *
531 * ...and so on, tho it would mess up the while () loop.
532 *
Robert Olsson19baf832005-06-21 12:43:18 -0700533 * anyway,
534 * 100 * (not_to_be_doubled + 2*to_be_doubled) / new_child_length >=
535 * inflate_threshold
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700536 *
Robert Olsson19baf832005-06-21 12:43:18 -0700537 * avoid a division:
538 * 100 * (not_to_be_doubled + 2*to_be_doubled) >=
539 * inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700540 *
Robert Olsson19baf832005-06-21 12:43:18 -0700541 * expand not_to_be_doubled and to_be_doubled, and shorten:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700542 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700543 * tn->full_children) >= inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700544 *
Robert Olsson19baf832005-06-21 12:43:18 -0700545 * expand new_child_length:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700546 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700547 * tn->full_children) >=
Robert Olsson19baf832005-06-21 12:43:18 -0700548 * inflate_threshold * tnode_child_length(tn) * 2
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700549 *
Robert Olsson19baf832005-06-21 12:43:18 -0700550 * shorten again:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700551 * 50 * (tn->full_children + tnode_child_length(tn) -
Olof Johansson91b9a272005-08-09 20:24:39 -0700552 * tn->empty_children) >= inflate_threshold *
Robert Olsson19baf832005-06-21 12:43:18 -0700553 * tnode_child_length(tn)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700554 *
Robert Olsson19baf832005-06-21 12:43:18 -0700555 */
556
557 check_tnode(tn);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700558
Robert Olssone6308be2005-10-04 13:01:58 -0700559 /* Keep root node larger */
560
Stephen Hemminger132adf52007-03-08 20:44:43 -0800561 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700562 inflate_threshold_use = inflate_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900563 else
Robert Olssone6308be2005-10-04 13:01:58 -0700564 inflate_threshold_use = inflate_threshold;
565
Robert Olsson2f368952005-07-05 15:02:40 -0700566 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700567 max_resize = 10;
568 while ((tn->full_children > 0 && max_resize-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700569 50 * (tn->full_children + tnode_child_length(tn) - tn->empty_children) >=
Robert Olssone6308be2005-10-04 13:01:58 -0700570 inflate_threshold_use * tnode_child_length(tn))) {
Robert Olsson19baf832005-06-21 12:43:18 -0700571
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700572 old_tn = tn;
573 tn = inflate(t, tn);
574 if (IS_ERR(tn)) {
575 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700576#ifdef CONFIG_IP_FIB_TRIE_STATS
577 t->stats.resize_node_skipped++;
578#endif
579 break;
580 }
Robert Olsson19baf832005-06-21 12:43:18 -0700581 }
582
Robert Olsson05eee482007-03-19 16:27:37 -0700583 if (max_resize < 0) {
584 if (!tn->parent)
585 printk(KERN_WARNING "Fix inflate_threshold_root. Now=%d size=%d bits\n",
586 inflate_threshold_root, tn->bits);
587 else
588 printk(KERN_WARNING "Fix inflate_threshold. Now=%d size=%d bits\n",
589 inflate_threshold, tn->bits);
590 }
591
Robert Olsson19baf832005-06-21 12:43:18 -0700592 check_tnode(tn);
593
594 /*
595 * Halve as long as the number of empty children in this
596 * node is above threshold.
597 */
Robert Olsson2f368952005-07-05 15:02:40 -0700598
Robert Olssone6308be2005-10-04 13:01:58 -0700599
600 /* Keep root node larger */
601
Stephen Hemminger132adf52007-03-08 20:44:43 -0800602 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700603 halve_threshold_use = halve_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900604 else
Robert Olssone6308be2005-10-04 13:01:58 -0700605 halve_threshold_use = halve_threshold;
606
Robert Olsson2f368952005-07-05 15:02:40 -0700607 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700608 max_resize = 10;
609 while (tn->bits > 1 && max_resize-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700610 100 * (tnode_child_length(tn) - tn->empty_children) <
Robert Olssone6308be2005-10-04 13:01:58 -0700611 halve_threshold_use * tnode_child_length(tn)) {
Robert Olsson19baf832005-06-21 12:43:18 -0700612
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700613 old_tn = tn;
614 tn = halve(t, tn);
615 if (IS_ERR(tn)) {
616 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700617#ifdef CONFIG_IP_FIB_TRIE_STATS
618 t->stats.resize_node_skipped++;
619#endif
620 break;
621 }
622 }
623
Robert Olsson05eee482007-03-19 16:27:37 -0700624 if (max_resize < 0) {
625 if (!tn->parent)
626 printk(KERN_WARNING "Fix halve_threshold_root. Now=%d size=%d bits\n",
627 halve_threshold_root, tn->bits);
628 else
629 printk(KERN_WARNING "Fix halve_threshold. Now=%d size=%d bits\n",
630 halve_threshold, tn->bits);
631 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700632
Robert Olsson19baf832005-06-21 12:43:18 -0700633 /* Only one child remains */
Robert Olsson19baf832005-06-21 12:43:18 -0700634 if (tn->empty_children == tnode_child_length(tn) - 1)
635 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700636 struct node *n;
637
Olof Johansson91b9a272005-08-09 20:24:39 -0700638 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700639 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700640 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700641
642 /* compress one level */
643
Stephen Hemminger06801912007-08-10 15:22:13 -0700644 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700645 tnode_free(tn);
646 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700647 }
648
649 return (struct node *) tn;
650}
651
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700652static struct tnode *inflate(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700653{
Robert Olsson19baf832005-06-21 12:43:18 -0700654 struct tnode *oldtnode = tn;
655 int olen = tnode_child_length(tn);
656 int i;
657
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700658 pr_debug("In inflate\n");
Robert Olsson19baf832005-06-21 12:43:18 -0700659
660 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits + 1);
661
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700662 if (!tn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700663 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700664
665 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700666 * Preallocate and store tnodes before the actual work so we
667 * don't get into an inconsistent state if memory allocation
668 * fails. In case of failure we return the oldnode and inflate
Robert Olsson2f368952005-07-05 15:02:40 -0700669 * of tnode is ignored.
670 */
Olof Johansson91b9a272005-08-09 20:24:39 -0700671
672 for (i = 0; i < olen; i++) {
Robert Olsson2f368952005-07-05 15:02:40 -0700673 struct tnode *inode = (struct tnode *) tnode_get_child(oldtnode, i);
674
675 if (inode &&
676 IS_TNODE(inode) &&
677 inode->pos == oldtnode->pos + oldtnode->bits &&
678 inode->bits > 1) {
679 struct tnode *left, *right;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700680 t_key m = ~0U << (KEYLENGTH - 1) >> inode->pos;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700681
Robert Olsson2f368952005-07-05 15:02:40 -0700682 left = tnode_new(inode->key&(~m), inode->pos + 1,
683 inode->bits - 1);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700684 if (!left)
685 goto nomem;
Olof Johansson91b9a272005-08-09 20:24:39 -0700686
Robert Olsson2f368952005-07-05 15:02:40 -0700687 right = tnode_new(inode->key|m, inode->pos + 1,
688 inode->bits - 1);
689
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900690 if (!right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700691 tnode_free(left);
692 goto nomem;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900693 }
Robert Olsson2f368952005-07-05 15:02:40 -0700694
695 put_child(t, tn, 2*i, (struct node *) left);
696 put_child(t, tn, 2*i+1, (struct node *) right);
697 }
698 }
699
Olof Johansson91b9a272005-08-09 20:24:39 -0700700 for (i = 0; i < olen; i++) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -0800701 struct tnode *inode;
Robert Olsson19baf832005-06-21 12:43:18 -0700702 struct node *node = tnode_get_child(oldtnode, i);
Olof Johansson91b9a272005-08-09 20:24:39 -0700703 struct tnode *left, *right;
704 int size, j;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700705
Robert Olsson19baf832005-06-21 12:43:18 -0700706 /* An empty child */
707 if (node == NULL)
708 continue;
709
710 /* A leaf or an internal node with skipped bits */
711
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700712 if (IS_LEAF(node) || ((struct tnode *) node)->pos >
Robert Olsson19baf832005-06-21 12:43:18 -0700713 tn->pos + tn->bits - 1) {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700714 if (tkey_extract_bits(node->key, oldtnode->pos + oldtnode->bits,
Robert Olsson19baf832005-06-21 12:43:18 -0700715 1) == 0)
716 put_child(t, tn, 2*i, node);
717 else
718 put_child(t, tn, 2*i+1, node);
719 continue;
720 }
721
722 /* An internal node with two children */
723 inode = (struct tnode *) node;
724
725 if (inode->bits == 1) {
726 put_child(t, tn, 2*i, inode->child[0]);
727 put_child(t, tn, 2*i+1, inode->child[1]);
728
729 tnode_free(inode);
Olof Johansson91b9a272005-08-09 20:24:39 -0700730 continue;
Robert Olsson19baf832005-06-21 12:43:18 -0700731 }
732
Olof Johansson91b9a272005-08-09 20:24:39 -0700733 /* An internal node with more than two children */
Robert Olsson19baf832005-06-21 12:43:18 -0700734
Olof Johansson91b9a272005-08-09 20:24:39 -0700735 /* We will replace this node 'inode' with two new
736 * ones, 'left' and 'right', each with half of the
737 * original children. The two new nodes will have
738 * a position one bit further down the key and this
739 * means that the "significant" part of their keys
740 * (see the discussion near the top of this file)
741 * will differ by one bit, which will be "0" in
742 * left's key and "1" in right's key. Since we are
743 * moving the key position by one step, the bit that
744 * we are moving away from - the bit at position
745 * (inode->pos) - is the one that will differ between
746 * left and right. So... we synthesize that bit in the
747 * two new keys.
748 * The mask 'm' below will be a single "one" bit at
749 * the position (inode->pos)
750 */
Robert Olsson19baf832005-06-21 12:43:18 -0700751
Olof Johansson91b9a272005-08-09 20:24:39 -0700752 /* Use the old key, but set the new significant
753 * bit to zero.
754 */
Robert Olsson19baf832005-06-21 12:43:18 -0700755
Olof Johansson91b9a272005-08-09 20:24:39 -0700756 left = (struct tnode *) tnode_get_child(tn, 2*i);
757 put_child(t, tn, 2*i, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -0700758
Olof Johansson91b9a272005-08-09 20:24:39 -0700759 BUG_ON(!left);
Robert Olsson2f368952005-07-05 15:02:40 -0700760
Olof Johansson91b9a272005-08-09 20:24:39 -0700761 right = (struct tnode *) tnode_get_child(tn, 2*i+1);
762 put_child(t, tn, 2*i+1, NULL);
Robert Olsson2f368952005-07-05 15:02:40 -0700763
Olof Johansson91b9a272005-08-09 20:24:39 -0700764 BUG_ON(!right);
Robert Olsson2f368952005-07-05 15:02:40 -0700765
Olof Johansson91b9a272005-08-09 20:24:39 -0700766 size = tnode_child_length(left);
767 for (j = 0; j < size; j++) {
768 put_child(t, left, j, inode->child[j]);
769 put_child(t, right, j, inode->child[j + size]);
Robert Olsson19baf832005-06-21 12:43:18 -0700770 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700771 put_child(t, tn, 2*i, resize(t, left));
772 put_child(t, tn, 2*i+1, resize(t, right));
773
774 tnode_free(inode);
Robert Olsson19baf832005-06-21 12:43:18 -0700775 }
776 tnode_free(oldtnode);
777 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700778nomem:
779 {
780 int size = tnode_child_length(tn);
781 int j;
782
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700783 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700784 if (tn->child[j])
785 tnode_free((struct tnode *)tn->child[j]);
786
787 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700788
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700789 return ERR_PTR(-ENOMEM);
790 }
Robert Olsson19baf832005-06-21 12:43:18 -0700791}
792
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700793static struct tnode *halve(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700794{
795 struct tnode *oldtnode = tn;
796 struct node *left, *right;
797 int i;
798 int olen = tnode_child_length(tn);
799
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700800 pr_debug("In halve\n");
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700801
802 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits - 1);
Robert Olsson19baf832005-06-21 12:43:18 -0700803
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700804 if (!tn)
805 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700806
807 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700808 * Preallocate and store tnodes before the actual work so we
809 * don't get into an inconsistent state if memory allocation
810 * fails. In case of failure we return the oldnode and halve
Robert Olsson2f368952005-07-05 15:02:40 -0700811 * of tnode is ignored.
812 */
813
Olof Johansson91b9a272005-08-09 20:24:39 -0700814 for (i = 0; i < olen; i += 2) {
Robert Olsson2f368952005-07-05 15:02:40 -0700815 left = tnode_get_child(oldtnode, i);
816 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700817
Robert Olsson2f368952005-07-05 15:02:40 -0700818 /* Two nonempty children */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700819 if (left && right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700820 struct tnode *newn;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700821
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700822 newn = tnode_new(left->key, tn->pos + tn->bits, 1);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700823
824 if (!newn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700825 goto nomem;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700826
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700827 put_child(t, tn, i/2, (struct node *)newn);
Robert Olsson2f368952005-07-05 15:02:40 -0700828 }
Robert Olsson2f368952005-07-05 15:02:40 -0700829
Robert Olsson2f368952005-07-05 15:02:40 -0700830 }
Robert Olsson19baf832005-06-21 12:43:18 -0700831
Olof Johansson91b9a272005-08-09 20:24:39 -0700832 for (i = 0; i < olen; i += 2) {
833 struct tnode *newBinNode;
834
Robert Olsson19baf832005-06-21 12:43:18 -0700835 left = tnode_get_child(oldtnode, i);
836 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700837
Robert Olsson19baf832005-06-21 12:43:18 -0700838 /* At least one of the children is empty */
839 if (left == NULL) {
840 if (right == NULL) /* Both are empty */
841 continue;
842 put_child(t, tn, i/2, right);
Olof Johansson91b9a272005-08-09 20:24:39 -0700843 continue;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700844 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700845
846 if (right == NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700847 put_child(t, tn, i/2, left);
Olof Johansson91b9a272005-08-09 20:24:39 -0700848 continue;
849 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700850
Robert Olsson19baf832005-06-21 12:43:18 -0700851 /* Two nonempty children */
Olof Johansson91b9a272005-08-09 20:24:39 -0700852 newBinNode = (struct tnode *) tnode_get_child(tn, i/2);
853 put_child(t, tn, i/2, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700854 put_child(t, newBinNode, 0, left);
855 put_child(t, newBinNode, 1, right);
856 put_child(t, tn, i/2, resize(t, newBinNode));
Robert Olsson19baf832005-06-21 12:43:18 -0700857 }
858 tnode_free(oldtnode);
859 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700860nomem:
861 {
862 int size = tnode_child_length(tn);
863 int j;
864
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700865 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700866 if (tn->child[j])
867 tnode_free((struct tnode *)tn->child[j]);
868
869 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700870
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700871 return ERR_PTR(-ENOMEM);
872 }
Robert Olsson19baf832005-06-21 12:43:18 -0700873}
874
Robert Olsson772cb712005-09-19 15:31:18 -0700875/* readside must use rcu_read_lock currently dump routines
Robert Olsson2373ce12005-08-25 13:01:29 -0700876 via get_fa_head and dump */
877
Robert Olsson772cb712005-09-19 15:31:18 -0700878static struct leaf_info *find_leaf_info(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700879{
Robert Olsson772cb712005-09-19 15:31:18 -0700880 struct hlist_head *head = &l->list;
Robert Olsson19baf832005-06-21 12:43:18 -0700881 struct hlist_node *node;
882 struct leaf_info *li;
883
Robert Olsson2373ce12005-08-25 13:01:29 -0700884 hlist_for_each_entry_rcu(li, node, head, hlist)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700885 if (li->plen == plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700886 return li;
Olof Johansson91b9a272005-08-09 20:24:39 -0700887
Robert Olsson19baf832005-06-21 12:43:18 -0700888 return NULL;
889}
890
891static inline struct list_head * get_fa_head(struct leaf *l, int plen)
892{
Robert Olsson772cb712005-09-19 15:31:18 -0700893 struct leaf_info *li = find_leaf_info(l, plen);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700894
Olof Johansson91b9a272005-08-09 20:24:39 -0700895 if (!li)
896 return NULL;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700897
Olof Johansson91b9a272005-08-09 20:24:39 -0700898 return &li->falh;
Robert Olsson19baf832005-06-21 12:43:18 -0700899}
900
901static void insert_leaf_info(struct hlist_head *head, struct leaf_info *new)
902{
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900903 struct leaf_info *li = NULL, *last = NULL;
904 struct hlist_node *node;
Robert Olsson19baf832005-06-21 12:43:18 -0700905
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900906 if (hlist_empty(head)) {
907 hlist_add_head_rcu(&new->hlist, head);
908 } else {
909 hlist_for_each_entry(li, node, head, hlist) {
910 if (new->plen > li->plen)
911 break;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700912
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900913 last = li;
914 }
915 if (last)
916 hlist_add_after_rcu(&last->hlist, &new->hlist);
917 else
918 hlist_add_before_rcu(&new->hlist, &li->hlist);
919 }
Robert Olsson19baf832005-06-21 12:43:18 -0700920}
921
Robert Olsson2373ce12005-08-25 13:01:29 -0700922/* rcu_read_lock needs to be hold by caller from readside */
923
Robert Olsson19baf832005-06-21 12:43:18 -0700924static struct leaf *
925fib_find_node(struct trie *t, u32 key)
926{
927 int pos;
928 struct tnode *tn;
929 struct node *n;
930
931 pos = 0;
Robert Olsson2373ce12005-08-25 13:01:29 -0700932 n = rcu_dereference(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -0700933
934 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
935 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -0700936
Robert Olsson19baf832005-06-21 12:43:18 -0700937 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700938
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700939 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700940 pos = tn->pos + tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -0700941 n = tnode_get_child(tn, tkey_extract_bits(key, tn->pos, tn->bits));
Olof Johansson91b9a272005-08-09 20:24:39 -0700942 } else
Robert Olsson19baf832005-06-21 12:43:18 -0700943 break;
944 }
945 /* Case we have found a leaf. Compare prefixes */
946
Olof Johansson91b9a272005-08-09 20:24:39 -0700947 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key))
948 return (struct leaf *)n;
949
Robert Olsson19baf832005-06-21 12:43:18 -0700950 return NULL;
951}
952
953static struct node *trie_rebalance(struct trie *t, struct tnode *tn)
954{
Robert Olsson19baf832005-06-21 12:43:18 -0700955 int wasfull;
Stephen Hemminger06801912007-08-10 15:22:13 -0700956 t_key cindex, key = tn->key;
957 struct tnode *tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700958
Stephen Hemminger06801912007-08-10 15:22:13 -0700959 while (tn != NULL && (tp = node_parent((struct node *)tn)) != NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700960 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
961 wasfull = tnode_full(tp, tnode_get_child(tp, cindex));
962 tn = (struct tnode *) resize (t, (struct tnode *)tn);
963 tnode_put_child_reorg((struct tnode *)tp, cindex,(struct node*)tn, wasfull);
Olof Johansson91b9a272005-08-09 20:24:39 -0700964
Stephen Hemminger06801912007-08-10 15:22:13 -0700965 tp = node_parent((struct node *) tn);
966 if (!tp)
Robert Olsson19baf832005-06-21 12:43:18 -0700967 break;
Stephen Hemminger06801912007-08-10 15:22:13 -0700968 tn = tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700969 }
Stephen Hemminger06801912007-08-10 15:22:13 -0700970
Robert Olsson19baf832005-06-21 12:43:18 -0700971 /* Handle last (top) tnode */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700972 if (IS_TNODE(tn))
Robert Olsson19baf832005-06-21 12:43:18 -0700973 tn = (struct tnode*) resize(t, (struct tnode *)tn);
974
975 return (struct node*) tn;
976}
977
Robert Olsson2373ce12005-08-25 13:01:29 -0700978/* only used from updater-side */
979
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -0800980static struct list_head *fib_insert_node(struct trie *t, u32 key, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700981{
982 int pos, newpos;
983 struct tnode *tp = NULL, *tn = NULL;
984 struct node *n;
985 struct leaf *l;
986 int missbit;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700987 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -0700988 struct leaf_info *li;
989 t_key cindex;
990
991 pos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700992 n = t->trie;
Robert Olsson19baf832005-06-21 12:43:18 -0700993
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700994 /* If we point to NULL, stop. Either the tree is empty and we should
995 * just put a new leaf in if, or we have reached an empty child slot,
Robert Olsson19baf832005-06-21 12:43:18 -0700996 * and we should just put our new leaf in that.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700997 * If we point to a T_TNODE, check if it matches our key. Note that
998 * a T_TNODE might be skipping any number of bits - its 'pos' need
Robert Olsson19baf832005-06-21 12:43:18 -0700999 * not be the parent's 'pos'+'bits'!
1000 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001001 * If it does match the current key, get pos/bits from it, extract
Robert Olsson19baf832005-06-21 12:43:18 -07001002 * the index from our key, push the T_TNODE and walk the tree.
1003 *
1004 * If it doesn't, we have to replace it with a new T_TNODE.
1005 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001006 * If we point to a T_LEAF, it might or might not have the same key
1007 * as we do. If it does, just change the value, update the T_LEAF's
1008 * value, and return it.
Robert Olsson19baf832005-06-21 12:43:18 -07001009 * If it doesn't, we need to replace it with a T_TNODE.
1010 */
1011
1012 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
1013 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -07001014
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001015 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001016
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001017 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001018 tp = tn;
Olof Johansson91b9a272005-08-09 20:24:39 -07001019 pos = tn->pos + tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001020 n = tnode_get_child(tn, tkey_extract_bits(key, tn->pos, tn->bits));
1021
Stephen Hemminger06801912007-08-10 15:22:13 -07001022 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001023 } else
Robert Olsson19baf832005-06-21 12:43:18 -07001024 break;
1025 }
1026
1027 /*
1028 * n ----> NULL, LEAF or TNODE
1029 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001030 * tp is n's (parent) ----> NULL or TNODE
Robert Olsson19baf832005-06-21 12:43:18 -07001031 */
1032
Olof Johansson91b9a272005-08-09 20:24:39 -07001033 BUG_ON(tp && IS_LEAF(tp));
Robert Olsson19baf832005-06-21 12:43:18 -07001034
1035 /* Case 1: n is a leaf. Compare prefixes */
1036
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001037 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key)) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08001038 l = (struct leaf *) n;
Robert Olsson19baf832005-06-21 12:43:18 -07001039 li = leaf_info_new(plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001040
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001041 if (!li)
1042 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001043
1044 fa_head = &li->falh;
1045 insert_leaf_info(&l->list, li);
1046 goto done;
1047 }
1048 t->size++;
1049 l = leaf_new();
1050
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001051 if (!l)
1052 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001053
1054 l->key = key;
1055 li = leaf_info_new(plen);
1056
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001057 if (!li) {
Robert Olssonf835e472005-06-28 15:00:39 -07001058 tnode_free((struct tnode *) l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001059 return NULL;
Robert Olssonf835e472005-06-28 15:00:39 -07001060 }
Robert Olsson19baf832005-06-21 12:43:18 -07001061
1062 fa_head = &li->falh;
1063 insert_leaf_info(&l->list, li);
1064
Robert Olsson19baf832005-06-21 12:43:18 -07001065 if (t->trie && n == NULL) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001066 /* Case 2: n is NULL, and will just insert a new leaf */
Robert Olsson19baf832005-06-21 12:43:18 -07001067
Stephen Hemminger06801912007-08-10 15:22:13 -07001068 node_set_parent((struct node *)l, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001069
Olof Johansson91b9a272005-08-09 20:24:39 -07001070 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1071 put_child(t, (struct tnode *)tp, cindex, (struct node *)l);
1072 } else {
1073 /* Case 3: n is a LEAF or a TNODE and the key doesn't match. */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001074 /*
1075 * Add a new tnode here
Robert Olsson19baf832005-06-21 12:43:18 -07001076 * first tnode need some special handling
1077 */
1078
1079 if (tp)
Olof Johansson91b9a272005-08-09 20:24:39 -07001080 pos = tp->pos+tp->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001081 else
Olof Johansson91b9a272005-08-09 20:24:39 -07001082 pos = 0;
1083
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001084 if (n) {
Robert Olsson19baf832005-06-21 12:43:18 -07001085 newpos = tkey_mismatch(key, pos, n->key);
1086 tn = tnode_new(n->key, newpos, 1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001087 } else {
Robert Olsson19baf832005-06-21 12:43:18 -07001088 newpos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001089 tn = tnode_new(key, newpos, 1); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001090 }
Robert Olsson19baf832005-06-21 12:43:18 -07001091
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001092 if (!tn) {
Robert Olssonf835e472005-06-28 15:00:39 -07001093 free_leaf_info(li);
1094 tnode_free((struct tnode *) l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001095 return NULL;
Olof Johansson91b9a272005-08-09 20:24:39 -07001096 }
1097
Stephen Hemminger06801912007-08-10 15:22:13 -07001098 node_set_parent((struct node *)tn, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001099
Olof Johansson91b9a272005-08-09 20:24:39 -07001100 missbit = tkey_extract_bits(key, newpos, 1);
Robert Olsson19baf832005-06-21 12:43:18 -07001101 put_child(t, tn, missbit, (struct node *)l);
1102 put_child(t, tn, 1-missbit, n);
1103
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001104 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001105 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1106 put_child(t, (struct tnode *)tp, cindex, (struct node *)tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001107 } else {
Robert Olsson2373ce12005-08-25 13:01:29 -07001108 rcu_assign_pointer(t->trie, (struct node *)tn); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001109 tp = tn;
1110 }
1111 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001112
1113 if (tp && tp->pos + tp->bits > 32)
Stephen Hemminger78c66712005-09-21 00:15:39 -07001114 printk(KERN_WARNING "fib_trie tp=%p pos=%d, bits=%d, key=%0x plen=%d\n",
Robert Olsson19baf832005-06-21 12:43:18 -07001115 tp, tp->pos, tp->bits, key, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001116
Robert Olsson19baf832005-06-21 12:43:18 -07001117 /* Rebalance the trie */
Robert Olsson2373ce12005-08-25 13:01:29 -07001118
1119 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Robert Olssonf835e472005-06-28 15:00:39 -07001120done:
Robert Olsson19baf832005-06-21 12:43:18 -07001121 return fa_head;
1122}
1123
Robert Olssond562f1f2007-03-26 14:22:22 -07001124/*
1125 * Caller must hold RTNL.
1126 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001127static int fn_trie_insert(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001128{
1129 struct trie *t = (struct trie *) tb->tb_data;
1130 struct fib_alias *fa, *new_fa;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001131 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001132 struct fib_info *fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001133 int plen = cfg->fc_dst_len;
1134 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001135 u32 key, mask;
1136 int err;
1137 struct leaf *l;
1138
1139 if (plen > 32)
1140 return -EINVAL;
1141
Thomas Graf4e902c52006-08-17 18:14:52 -07001142 key = ntohl(cfg->fc_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001143
Patrick McHardy2dfe55b2006-08-10 23:08:33 -07001144 pr_debug("Insert table=%u %08x/%d\n", tb->tb_id, key, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001145
Olof Johansson91b9a272005-08-09 20:24:39 -07001146 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001147
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001148 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001149 return -EINVAL;
1150
1151 key = key & mask;
1152
Thomas Graf4e902c52006-08-17 18:14:52 -07001153 fi = fib_create_info(cfg);
1154 if (IS_ERR(fi)) {
1155 err = PTR_ERR(fi);
Robert Olsson19baf832005-06-21 12:43:18 -07001156 goto err;
Thomas Graf4e902c52006-08-17 18:14:52 -07001157 }
Robert Olsson19baf832005-06-21 12:43:18 -07001158
1159 l = fib_find_node(t, key);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001160 fa = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001161
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001162 if (l) {
Robert Olsson19baf832005-06-21 12:43:18 -07001163 fa_head = get_fa_head(l, plen);
1164 fa = fib_find_alias(fa_head, tos, fi->fib_priority);
1165 }
1166
1167 /* Now fa, if non-NULL, points to the first fib alias
1168 * with the same keys [prefix,tos,priority], if such key already
1169 * exists or to the node before which we will insert new one.
1170 *
1171 * If fa is NULL, we will need to allocate a new one and
1172 * insert to the head of f.
1173 *
1174 * If f is NULL, no fib node matched the destination key
1175 * and we need to allocate a new one of those as well.
1176 */
1177
Olof Johansson91b9a272005-08-09 20:24:39 -07001178 if (fa && fa->fa_info->fib_priority == fi->fib_priority) {
Robert Olsson19baf832005-06-21 12:43:18 -07001179 struct fib_alias *fa_orig;
1180
1181 err = -EEXIST;
Thomas Graf4e902c52006-08-17 18:14:52 -07001182 if (cfg->fc_nlflags & NLM_F_EXCL)
Robert Olsson19baf832005-06-21 12:43:18 -07001183 goto out;
1184
Thomas Graf4e902c52006-08-17 18:14:52 -07001185 if (cfg->fc_nlflags & NLM_F_REPLACE) {
Robert Olsson19baf832005-06-21 12:43:18 -07001186 struct fib_info *fi_drop;
1187 u8 state;
1188
Joonwoo Park67250332008-01-18 03:45:18 -08001189 if (fi->fib_treeref > 1)
1190 goto out;
1191
Robert Olsson2373ce12005-08-25 13:01:29 -07001192 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001193 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001194 if (new_fa == NULL)
1195 goto out;
Robert Olsson19baf832005-06-21 12:43:18 -07001196
1197 fi_drop = fa->fa_info;
Robert Olsson2373ce12005-08-25 13:01:29 -07001198 new_fa->fa_tos = fa->fa_tos;
1199 new_fa->fa_info = fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001200 new_fa->fa_type = cfg->fc_type;
1201 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001202 state = fa->fa_state;
Robert Olsson2373ce12005-08-25 13:01:29 -07001203 new_fa->fa_state &= ~FA_S_ACCESSED;
Robert Olsson19baf832005-06-21 12:43:18 -07001204
Robert Olsson2373ce12005-08-25 13:01:29 -07001205 list_replace_rcu(&fa->fa_list, &new_fa->fa_list);
1206 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001207
1208 fib_release_info(fi_drop);
1209 if (state & FA_S_ACCESSED)
Olof Johansson91b9a272005-08-09 20:24:39 -07001210 rt_cache_flush(-1);
Milan Kocianb8f55832007-05-23 14:55:06 -07001211 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen,
1212 tb->tb_id, &cfg->fc_nlinfo, NLM_F_REPLACE);
Robert Olsson19baf832005-06-21 12:43:18 -07001213
Olof Johansson91b9a272005-08-09 20:24:39 -07001214 goto succeeded;
Robert Olsson19baf832005-06-21 12:43:18 -07001215 }
1216 /* Error if we find a perfect match which
1217 * uses the same scope, type, and nexthop
1218 * information.
1219 */
1220 fa_orig = fa;
1221 list_for_each_entry(fa, fa_orig->fa_list.prev, fa_list) {
1222 if (fa->fa_tos != tos)
1223 break;
1224 if (fa->fa_info->fib_priority != fi->fib_priority)
1225 break;
Thomas Graf4e902c52006-08-17 18:14:52 -07001226 if (fa->fa_type == cfg->fc_type &&
1227 fa->fa_scope == cfg->fc_scope &&
Robert Olsson19baf832005-06-21 12:43:18 -07001228 fa->fa_info == fi) {
1229 goto out;
1230 }
1231 }
Thomas Graf4e902c52006-08-17 18:14:52 -07001232 if (!(cfg->fc_nlflags & NLM_F_APPEND))
Robert Olsson19baf832005-06-21 12:43:18 -07001233 fa = fa_orig;
1234 }
1235 err = -ENOENT;
Thomas Graf4e902c52006-08-17 18:14:52 -07001236 if (!(cfg->fc_nlflags & NLM_F_CREATE))
Robert Olsson19baf832005-06-21 12:43:18 -07001237 goto out;
1238
1239 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001240 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson19baf832005-06-21 12:43:18 -07001241 if (new_fa == NULL)
1242 goto out;
1243
1244 new_fa->fa_info = fi;
1245 new_fa->fa_tos = tos;
Thomas Graf4e902c52006-08-17 18:14:52 -07001246 new_fa->fa_type = cfg->fc_type;
1247 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001248 new_fa->fa_state = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001249 /*
1250 * Insert new entry to the list.
1251 */
1252
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001253 if (!fa_head) {
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001254 fa_head = fib_insert_node(t, key, plen);
1255 if (unlikely(!fa_head)) {
1256 err = -ENOMEM;
Robert Olssonf835e472005-06-28 15:00:39 -07001257 goto out_free_new_fa;
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001258 }
Robert Olssonf835e472005-06-28 15:00:39 -07001259 }
Robert Olsson19baf832005-06-21 12:43:18 -07001260
Robert Olsson2373ce12005-08-25 13:01:29 -07001261 list_add_tail_rcu(&new_fa->fa_list,
1262 (fa ? &fa->fa_list : fa_head));
Robert Olsson19baf832005-06-21 12:43:18 -07001263
1264 rt_cache_flush(-1);
Thomas Graf4e902c52006-08-17 18:14:52 -07001265 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001266 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001267succeeded:
1268 return 0;
Robert Olssonf835e472005-06-28 15:00:39 -07001269
1270out_free_new_fa:
1271 kmem_cache_free(fn_alias_kmem, new_fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001272out:
1273 fib_release_info(fi);
Olof Johansson91b9a272005-08-09 20:24:39 -07001274err:
Robert Olsson19baf832005-06-21 12:43:18 -07001275 return err;
1276}
1277
Robert Olsson2373ce12005-08-25 13:01:29 -07001278
Robert Olsson772cb712005-09-19 15:31:18 -07001279/* should be called with rcu_read_lock */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001280static inline int check_leaf(struct trie *t, struct leaf *l,
1281 t_key key, int *plen, const struct flowi *flp,
Patrick McHardy06c74272005-08-23 22:06:09 -07001282 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001283{
Patrick McHardy06c74272005-08-23 22:06:09 -07001284 int err, i;
Al Viro888454c2006-09-19 13:42:46 -07001285 __be32 mask;
Robert Olsson19baf832005-06-21 12:43:18 -07001286 struct leaf_info *li;
1287 struct hlist_head *hhead = &l->list;
1288 struct hlist_node *node;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001289
Robert Olsson2373ce12005-08-25 13:01:29 -07001290 hlist_for_each_entry_rcu(li, node, hhead, hlist) {
Robert Olsson19baf832005-06-21 12:43:18 -07001291 i = li->plen;
Al Viro888454c2006-09-19 13:42:46 -07001292 mask = inet_make_mask(i);
1293 if (l->key != (key & ntohl(mask)))
Robert Olsson19baf832005-06-21 12:43:18 -07001294 continue;
1295
Al Viro888454c2006-09-19 13:42:46 -07001296 if ((err = fib_semantic_match(&li->falh, flp, res, htonl(l->key), mask, i)) <= 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001297 *plen = i;
1298#ifdef CONFIG_IP_FIB_TRIE_STATS
1299 t->stats.semantic_match_passed++;
1300#endif
Patrick McHardy06c74272005-08-23 22:06:09 -07001301 return err;
Robert Olsson19baf832005-06-21 12:43:18 -07001302 }
1303#ifdef CONFIG_IP_FIB_TRIE_STATS
1304 t->stats.semantic_match_miss++;
1305#endif
1306 }
Patrick McHardy06c74272005-08-23 22:06:09 -07001307 return 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001308}
1309
1310static int
1311fn_trie_lookup(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1312{
1313 struct trie *t = (struct trie *) tb->tb_data;
1314 int plen, ret = 0;
1315 struct node *n;
1316 struct tnode *pn;
1317 int pos, bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001318 t_key key = ntohl(flp->fl4_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001319 int chopped_off;
1320 t_key cindex = 0;
1321 int current_prefix_length = KEYLENGTH;
Olof Johansson91b9a272005-08-09 20:24:39 -07001322 struct tnode *cn;
1323 t_key node_prefix, key_prefix, pref_mismatch;
1324 int mp;
1325
Robert Olsson2373ce12005-08-25 13:01:29 -07001326 rcu_read_lock();
Robert Olsson19baf832005-06-21 12:43:18 -07001327
Robert Olsson2373ce12005-08-25 13:01:29 -07001328 n = rcu_dereference(t->trie);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001329 if (!n)
Robert Olsson19baf832005-06-21 12:43:18 -07001330 goto failed;
1331
1332#ifdef CONFIG_IP_FIB_TRIE_STATS
1333 t->stats.gets++;
1334#endif
1335
1336 /* Just a leaf? */
1337 if (IS_LEAF(n)) {
Patrick McHardy06c74272005-08-23 22:06:09 -07001338 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001339 goto found;
1340 goto failed;
1341 }
1342 pn = (struct tnode *) n;
1343 chopped_off = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001344
Olof Johansson91b9a272005-08-09 20:24:39 -07001345 while (pn) {
Robert Olsson19baf832005-06-21 12:43:18 -07001346 pos = pn->pos;
1347 bits = pn->bits;
1348
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001349 if (!chopped_off)
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001350 cindex = tkey_extract_bits(mask_pfx(key, current_prefix_length),
1351 pos, bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001352
1353 n = tnode_get_child(pn, cindex);
1354
1355 if (n == NULL) {
1356#ifdef CONFIG_IP_FIB_TRIE_STATS
1357 t->stats.null_node_hit++;
1358#endif
1359 goto backtrace;
1360 }
1361
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001362 if (IS_LEAF(n)) {
Patrick McHardy06c74272005-08-23 22:06:09 -07001363 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001364 goto found;
Olof Johansson91b9a272005-08-09 20:24:39 -07001365 else
1366 goto backtrace;
1367 }
1368
1369#define HL_OPTIMIZE
1370#ifdef HL_OPTIMIZE
1371 cn = (struct tnode *)n;
1372
1373 /*
1374 * It's a tnode, and we can do some extra checks here if we
1375 * like, to avoid descending into a dead-end branch.
1376 * This tnode is in the parent's child array at index
1377 * key[p_pos..p_pos+p_bits] but potentially with some bits
1378 * chopped off, so in reality the index may be just a
1379 * subprefix, padded with zero at the end.
1380 * We can also take a look at any skipped bits in this
1381 * tnode - everything up to p_pos is supposed to be ok,
1382 * and the non-chopped bits of the index (se previous
1383 * paragraph) are also guaranteed ok, but the rest is
1384 * considered unknown.
1385 *
1386 * The skipped bits are key[pos+bits..cn->pos].
1387 */
1388
1389 /* If current_prefix_length < pos+bits, we are already doing
1390 * actual prefix matching, which means everything from
1391 * pos+(bits-chopped_off) onward must be zero along some
1392 * branch of this subtree - otherwise there is *no* valid
1393 * prefix present. Here we can only check the skipped
1394 * bits. Remember, since we have already indexed into the
1395 * parent's child array, we know that the bits we chopped of
1396 * *are* zero.
1397 */
1398
1399 /* NOTA BENE: CHECKING ONLY SKIPPED BITS FOR THE NEW NODE HERE */
1400
1401 if (current_prefix_length < pos+bits) {
1402 if (tkey_extract_bits(cn->key, current_prefix_length,
1403 cn->pos - current_prefix_length) != 0 ||
1404 !(cn->child[0]))
1405 goto backtrace;
1406 }
1407
1408 /*
1409 * If chopped_off=0, the index is fully validated and we
1410 * only need to look at the skipped bits for this, the new,
1411 * tnode. What we actually want to do is to find out if
1412 * these skipped bits match our key perfectly, or if we will
1413 * have to count on finding a matching prefix further down,
1414 * because if we do, we would like to have some way of
1415 * verifying the existence of such a prefix at this point.
1416 */
1417
1418 /* The only thing we can do at this point is to verify that
1419 * any such matching prefix can indeed be a prefix to our
1420 * key, and if the bits in the node we are inspecting that
1421 * do not match our key are not ZERO, this cannot be true.
1422 * Thus, find out where there is a mismatch (before cn->pos)
1423 * and verify that all the mismatching bits are zero in the
1424 * new tnode's key.
1425 */
1426
1427 /* Note: We aren't very concerned about the piece of the key
1428 * that precede pn->pos+pn->bits, since these have already been
1429 * checked. The bits after cn->pos aren't checked since these are
1430 * by definition "unknown" at this point. Thus, what we want to
1431 * see is if we are about to enter the "prefix matching" state,
1432 * and in that case verify that the skipped bits that will prevail
1433 * throughout this subtree are zero, as they have to be if we are
1434 * to find a matching prefix.
1435 */
1436
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001437 node_prefix = mask_pfx(cn->key, cn->pos);
1438 key_prefix = mask_pfx(key, cn->pos);
Olof Johansson91b9a272005-08-09 20:24:39 -07001439 pref_mismatch = key_prefix^node_prefix;
1440 mp = 0;
1441
1442 /* In short: If skipped bits in this node do not match the search
1443 * key, enter the "prefix matching" state.directly.
1444 */
1445 if (pref_mismatch) {
1446 while (!(pref_mismatch & (1<<(KEYLENGTH-1)))) {
1447 mp++;
1448 pref_mismatch = pref_mismatch <<1;
1449 }
1450 key_prefix = tkey_extract_bits(cn->key, mp, cn->pos-mp);
1451
1452 if (key_prefix != 0)
1453 goto backtrace;
1454
1455 if (current_prefix_length >= cn->pos)
1456 current_prefix_length = mp;
1457 }
1458#endif
1459 pn = (struct tnode *)n; /* Descend */
1460 chopped_off = 0;
1461 continue;
1462
Robert Olsson19baf832005-06-21 12:43:18 -07001463backtrace:
1464 chopped_off++;
1465
1466 /* As zero don't change the child key (cindex) */
Olof Johansson91b9a272005-08-09 20:24:39 -07001467 while ((chopped_off <= pn->bits) && !(cindex & (1<<(chopped_off-1))))
Robert Olsson19baf832005-06-21 12:43:18 -07001468 chopped_off++;
Robert Olsson19baf832005-06-21 12:43:18 -07001469
1470 /* Decrease current_... with bits chopped off */
1471 if (current_prefix_length > pn->pos + pn->bits - chopped_off)
1472 current_prefix_length = pn->pos + pn->bits - chopped_off;
Olof Johansson91b9a272005-08-09 20:24:39 -07001473
Robert Olsson19baf832005-06-21 12:43:18 -07001474 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001475 * Either we do the actual chop off according or if we have
Robert Olsson19baf832005-06-21 12:43:18 -07001476 * chopped off all bits in this tnode walk up to our parent.
1477 */
1478
Olof Johansson91b9a272005-08-09 20:24:39 -07001479 if (chopped_off <= pn->bits) {
Robert Olsson19baf832005-06-21 12:43:18 -07001480 cindex &= ~(1 << (chopped_off-1));
Olof Johansson91b9a272005-08-09 20:24:39 -07001481 } else {
Stephen Hemminger06801912007-08-10 15:22:13 -07001482 struct tnode *parent = node_parent((struct node *) pn);
1483 if (!parent)
Robert Olsson19baf832005-06-21 12:43:18 -07001484 goto failed;
Olof Johansson91b9a272005-08-09 20:24:39 -07001485
Robert Olsson19baf832005-06-21 12:43:18 -07001486 /* Get Child's index */
Stephen Hemminger06801912007-08-10 15:22:13 -07001487 cindex = tkey_extract_bits(pn->key, parent->pos, parent->bits);
1488 pn = parent;
Robert Olsson19baf832005-06-21 12:43:18 -07001489 chopped_off = 0;
1490
1491#ifdef CONFIG_IP_FIB_TRIE_STATS
1492 t->stats.backtrack++;
1493#endif
1494 goto backtrace;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001495 }
Robert Olsson19baf832005-06-21 12:43:18 -07001496 }
1497failed:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001498 ret = 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001499found:
Robert Olsson2373ce12005-08-25 13:01:29 -07001500 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001501 return ret;
1502}
1503
Robert Olsson2373ce12005-08-25 13:01:29 -07001504/* only called from updater side */
Robert Olsson19baf832005-06-21 12:43:18 -07001505static int trie_leaf_remove(struct trie *t, t_key key)
1506{
1507 t_key cindex;
1508 struct tnode *tp = NULL;
1509 struct node *n = t->trie;
1510 struct leaf *l;
1511
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001512 pr_debug("entering trie_leaf_remove(%p)\n", n);
Robert Olsson19baf832005-06-21 12:43:18 -07001513
1514 /* Note that in the case skipped bits, those bits are *not* checked!
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001515 * When we finish this, we will have NULL or a T_LEAF, and the
Robert Olsson19baf832005-06-21 12:43:18 -07001516 * T_LEAF may or may not match our key.
1517 */
1518
Olof Johansson91b9a272005-08-09 20:24:39 -07001519 while (n != NULL && IS_TNODE(n)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001520 struct tnode *tn = (struct tnode *) n;
1521 check_tnode(tn);
1522 n = tnode_get_child(tn ,tkey_extract_bits(key, tn->pos, tn->bits));
1523
Stephen Hemminger06801912007-08-10 15:22:13 -07001524 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001525 }
Robert Olsson19baf832005-06-21 12:43:18 -07001526 l = (struct leaf *) n;
1527
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001528 if (!n || !tkey_equals(l->key, key))
Robert Olsson19baf832005-06-21 12:43:18 -07001529 return 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001530
1531 /*
1532 * Key found.
1533 * Remove the leaf and rebalance the tree
Robert Olsson19baf832005-06-21 12:43:18 -07001534 */
1535
Robert Olsson19baf832005-06-21 12:43:18 -07001536 t->size--;
1537
Stephen Hemminger06801912007-08-10 15:22:13 -07001538 tp = node_parent(n);
Robert Olsson19baf832005-06-21 12:43:18 -07001539 tnode_free((struct tnode *) n);
1540
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001541 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001542 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1543 put_child(t, (struct tnode *)tp, cindex, NULL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001544 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Olof Johansson91b9a272005-08-09 20:24:39 -07001545 } else
Robert Olsson2373ce12005-08-25 13:01:29 -07001546 rcu_assign_pointer(t->trie, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001547
1548 return 1;
1549}
1550
Robert Olssond562f1f2007-03-26 14:22:22 -07001551/*
1552 * Caller must hold RTNL.
1553 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001554static int fn_trie_delete(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001555{
1556 struct trie *t = (struct trie *) tb->tb_data;
1557 u32 key, mask;
Thomas Graf4e902c52006-08-17 18:14:52 -07001558 int plen = cfg->fc_dst_len;
1559 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001560 struct fib_alias *fa, *fa_to_delete;
1561 struct list_head *fa_head;
1562 struct leaf *l;
Olof Johansson91b9a272005-08-09 20:24:39 -07001563 struct leaf_info *li;
1564
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001565 if (plen > 32)
Robert Olsson19baf832005-06-21 12:43:18 -07001566 return -EINVAL;
1567
Thomas Graf4e902c52006-08-17 18:14:52 -07001568 key = ntohl(cfg->fc_dst);
Olof Johansson91b9a272005-08-09 20:24:39 -07001569 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001570
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001571 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001572 return -EINVAL;
1573
1574 key = key & mask;
1575 l = fib_find_node(t, key);
1576
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001577 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001578 return -ESRCH;
1579
1580 fa_head = get_fa_head(l, plen);
1581 fa = fib_find_alias(fa_head, tos, 0);
1582
1583 if (!fa)
1584 return -ESRCH;
1585
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001586 pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t);
Robert Olsson19baf832005-06-21 12:43:18 -07001587
1588 fa_to_delete = NULL;
1589 fa_head = fa->fa_list.prev;
Robert Olsson2373ce12005-08-25 13:01:29 -07001590
Robert Olsson19baf832005-06-21 12:43:18 -07001591 list_for_each_entry(fa, fa_head, fa_list) {
1592 struct fib_info *fi = fa->fa_info;
1593
1594 if (fa->fa_tos != tos)
1595 break;
1596
Thomas Graf4e902c52006-08-17 18:14:52 -07001597 if ((!cfg->fc_type || fa->fa_type == cfg->fc_type) &&
1598 (cfg->fc_scope == RT_SCOPE_NOWHERE ||
1599 fa->fa_scope == cfg->fc_scope) &&
1600 (!cfg->fc_protocol ||
1601 fi->fib_protocol == cfg->fc_protocol) &&
1602 fib_nh_match(cfg, fi) == 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001603 fa_to_delete = fa;
1604 break;
1605 }
1606 }
1607
Olof Johansson91b9a272005-08-09 20:24:39 -07001608 if (!fa_to_delete)
1609 return -ESRCH;
Robert Olsson19baf832005-06-21 12:43:18 -07001610
Olof Johansson91b9a272005-08-09 20:24:39 -07001611 fa = fa_to_delete;
Thomas Graf4e902c52006-08-17 18:14:52 -07001612 rtmsg_fib(RTM_DELROUTE, htonl(key), fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001613 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001614
Olof Johansson91b9a272005-08-09 20:24:39 -07001615 l = fib_find_node(t, key);
Robert Olsson772cb712005-09-19 15:31:18 -07001616 li = find_leaf_info(l, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001617
Robert Olsson2373ce12005-08-25 13:01:29 -07001618 list_del_rcu(&fa->fa_list);
Robert Olsson19baf832005-06-21 12:43:18 -07001619
Olof Johansson91b9a272005-08-09 20:24:39 -07001620 if (list_empty(fa_head)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001621 hlist_del_rcu(&li->hlist);
Olof Johansson91b9a272005-08-09 20:24:39 -07001622 free_leaf_info(li);
Robert Olsson2373ce12005-08-25 13:01:29 -07001623 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001624
1625 if (hlist_empty(&l->list))
1626 trie_leaf_remove(t, key);
1627
1628 if (fa->fa_state & FA_S_ACCESSED)
1629 rt_cache_flush(-1);
1630
Robert Olsson2373ce12005-08-25 13:01:29 -07001631 fib_release_info(fa->fa_info);
1632 alias_free_mem_rcu(fa);
Olof Johansson91b9a272005-08-09 20:24:39 -07001633 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001634}
1635
1636static int trie_flush_list(struct trie *t, struct list_head *head)
1637{
1638 struct fib_alias *fa, *fa_node;
1639 int found = 0;
1640
1641 list_for_each_entry_safe(fa, fa_node, head, fa_list) {
1642 struct fib_info *fi = fa->fa_info;
Robert Olsson19baf832005-06-21 12:43:18 -07001643
Robert Olsson2373ce12005-08-25 13:01:29 -07001644 if (fi && (fi->fib_flags & RTNH_F_DEAD)) {
1645 list_del_rcu(&fa->fa_list);
1646 fib_release_info(fa->fa_info);
1647 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001648 found++;
1649 }
1650 }
1651 return found;
1652}
1653
1654static int trie_flush_leaf(struct trie *t, struct leaf *l)
1655{
1656 int found = 0;
1657 struct hlist_head *lih = &l->list;
1658 struct hlist_node *node, *tmp;
1659 struct leaf_info *li = NULL;
1660
1661 hlist_for_each_entry_safe(li, node, tmp, lih, hlist) {
Robert Olsson19baf832005-06-21 12:43:18 -07001662 found += trie_flush_list(t, &li->falh);
1663
1664 if (list_empty(&li->falh)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001665 hlist_del_rcu(&li->hlist);
Robert Olsson19baf832005-06-21 12:43:18 -07001666 free_leaf_info(li);
1667 }
1668 }
1669 return found;
1670}
1671
Robert Olsson2373ce12005-08-25 13:01:29 -07001672/* rcu_read_lock needs to be hold by caller from readside */
1673
Robert Olsson19baf832005-06-21 12:43:18 -07001674static struct leaf *nextleaf(struct trie *t, struct leaf *thisleaf)
1675{
1676 struct node *c = (struct node *) thisleaf;
1677 struct tnode *p;
1678 int idx;
Robert Olsson2373ce12005-08-25 13:01:29 -07001679 struct node *trie = rcu_dereference(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -07001680
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001681 if (c == NULL) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001682 if (trie == NULL)
Robert Olsson19baf832005-06-21 12:43:18 -07001683 return NULL;
1684
Robert Olsson2373ce12005-08-25 13:01:29 -07001685 if (IS_LEAF(trie)) /* trie w. just a leaf */
1686 return (struct leaf *) trie;
Robert Olsson19baf832005-06-21 12:43:18 -07001687
Robert Olsson2373ce12005-08-25 13:01:29 -07001688 p = (struct tnode*) trie; /* Start */
Olof Johansson91b9a272005-08-09 20:24:39 -07001689 } else
Stephen Hemminger06801912007-08-10 15:22:13 -07001690 p = node_parent(c);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001691
Robert Olsson19baf832005-06-21 12:43:18 -07001692 while (p) {
1693 int pos, last;
1694
1695 /* Find the next child of the parent */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001696 if (c)
1697 pos = 1 + tkey_extract_bits(c->key, p->pos, p->bits);
1698 else
Robert Olsson19baf832005-06-21 12:43:18 -07001699 pos = 0;
1700
1701 last = 1 << p->bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001702 for (idx = pos; idx < last ; idx++) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001703 c = rcu_dereference(p->child[idx]);
1704
1705 if (!c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001706 continue;
Robert Olsson19baf832005-06-21 12:43:18 -07001707
Olof Johansson91b9a272005-08-09 20:24:39 -07001708 /* Decend if tnode */
Robert Olsson2373ce12005-08-25 13:01:29 -07001709 while (IS_TNODE(c)) {
1710 p = (struct tnode *) c;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09001711 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001712
Olof Johansson91b9a272005-08-09 20:24:39 -07001713 /* Rightmost non-NULL branch */
1714 if (p && IS_TNODE(p))
Robert Olsson2373ce12005-08-25 13:01:29 -07001715 while (!(c = rcu_dereference(p->child[idx]))
1716 && idx < (1<<p->bits)) idx++;
Robert Olsson19baf832005-06-21 12:43:18 -07001717
Olof Johansson91b9a272005-08-09 20:24:39 -07001718 /* Done with this tnode? */
Robert Olsson2373ce12005-08-25 13:01:29 -07001719 if (idx >= (1 << p->bits) || !c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001720 goto up;
Robert Olsson19baf832005-06-21 12:43:18 -07001721 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001722 return (struct leaf *) c;
Robert Olsson19baf832005-06-21 12:43:18 -07001723 }
1724up:
1725 /* No more children go up one step */
Olof Johansson91b9a272005-08-09 20:24:39 -07001726 c = (struct node *) p;
Stephen Hemminger06801912007-08-10 15:22:13 -07001727 p = node_parent(c);
Robert Olsson19baf832005-06-21 12:43:18 -07001728 }
1729 return NULL; /* Ready. Root of trie */
1730}
1731
Robert Olssond562f1f2007-03-26 14:22:22 -07001732/*
1733 * Caller must hold RTNL.
1734 */
Robert Olsson19baf832005-06-21 12:43:18 -07001735static int fn_trie_flush(struct fib_table *tb)
1736{
1737 struct trie *t = (struct trie *) tb->tb_data;
1738 struct leaf *ll = NULL, *l = NULL;
1739 int found = 0, h;
1740
Olof Johansson91b9a272005-08-09 20:24:39 -07001741 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001742 found += trie_flush_leaf(t, l);
1743
1744 if (ll && hlist_empty(&ll->list))
1745 trie_leaf_remove(t, ll->key);
1746 ll = l;
1747 }
1748
1749 if (ll && hlist_empty(&ll->list))
1750 trie_leaf_remove(t, ll->key);
1751
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001752 pr_debug("trie_flush found=%d\n", found);
Robert Olsson19baf832005-06-21 12:43:18 -07001753 return found;
1754}
1755
Robert Olsson19baf832005-06-21 12:43:18 -07001756static void
1757fn_trie_select_default(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1758{
1759 struct trie *t = (struct trie *) tb->tb_data;
1760 int order, last_idx;
1761 struct fib_info *fi = NULL;
1762 struct fib_info *last_resort;
1763 struct fib_alias *fa = NULL;
1764 struct list_head *fa_head;
1765 struct leaf *l;
1766
1767 last_idx = -1;
1768 last_resort = NULL;
1769 order = -1;
1770
Robert Olsson2373ce12005-08-25 13:01:29 -07001771 rcu_read_lock();
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001772
Robert Olsson19baf832005-06-21 12:43:18 -07001773 l = fib_find_node(t, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001774 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001775 goto out;
1776
1777 fa_head = get_fa_head(l, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001778 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001779 goto out;
1780
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001781 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001782 goto out;
1783
Robert Olsson2373ce12005-08-25 13:01:29 -07001784 list_for_each_entry_rcu(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001785 struct fib_info *next_fi = fa->fa_info;
Olof Johansson91b9a272005-08-09 20:24:39 -07001786
Robert Olsson19baf832005-06-21 12:43:18 -07001787 if (fa->fa_scope != res->scope ||
1788 fa->fa_type != RTN_UNICAST)
1789 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -07001790
Robert Olsson19baf832005-06-21 12:43:18 -07001791 if (next_fi->fib_priority > res->fi->fib_priority)
1792 break;
1793 if (!next_fi->fib_nh[0].nh_gw ||
1794 next_fi->fib_nh[0].nh_scope != RT_SCOPE_LINK)
1795 continue;
1796 fa->fa_state |= FA_S_ACCESSED;
Olof Johansson91b9a272005-08-09 20:24:39 -07001797
Robert Olsson19baf832005-06-21 12:43:18 -07001798 if (fi == NULL) {
1799 if (next_fi != res->fi)
1800 break;
1801 } else if (!fib_detect_death(fi, order, &last_resort,
Denis V. Lunev971b8932007-12-08 00:32:23 -08001802 &last_idx, tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001803 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001804 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001805 goto out;
1806 }
1807 fi = next_fi;
1808 order++;
1809 }
1810 if (order <= 0 || fi == NULL) {
Denis V. Lunev971b8932007-12-08 00:32:23 -08001811 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001812 goto out;
1813 }
1814
Denis V. Lunev971b8932007-12-08 00:32:23 -08001815 if (!fib_detect_death(fi, order, &last_resort, &last_idx,
1816 tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001817 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001818 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001819 goto out;
1820 }
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001821 if (last_idx >= 0)
1822 fib_result_assign(res, last_resort);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001823 tb->tb_default = last_idx;
1824out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001825 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001826}
1827
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001828static 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 -07001829 struct sk_buff *skb, struct netlink_callback *cb)
1830{
1831 int i, s_i;
1832 struct fib_alias *fa;
1833
Al Viro32ab5f82006-09-26 22:21:45 -07001834 __be32 xkey = htonl(key);
Robert Olsson19baf832005-06-21 12:43:18 -07001835
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001836 s_i = cb->args[4];
Robert Olsson19baf832005-06-21 12:43:18 -07001837 i = 0;
1838
Robert Olsson2373ce12005-08-25 13:01:29 -07001839 /* rcu_read_lock is hold by caller */
1840
1841 list_for_each_entry_rcu(fa, fah, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001842 if (i < s_i) {
1843 i++;
1844 continue;
1845 }
Stephen Hemminger78c66712005-09-21 00:15:39 -07001846 BUG_ON(!fa->fa_info);
Robert Olsson19baf832005-06-21 12:43:18 -07001847
1848 if (fib_dump_info(skb, NETLINK_CB(cb->skb).pid,
1849 cb->nlh->nlmsg_seq,
1850 RTM_NEWROUTE,
1851 tb->tb_id,
1852 fa->fa_type,
1853 fa->fa_scope,
Thomas Grafbe403ea2006-08-17 18:15:17 -07001854 xkey,
Robert Olsson19baf832005-06-21 12:43:18 -07001855 plen,
1856 fa->fa_tos,
David S. Miller90f66912005-06-21 14:43:28 -07001857 fa->fa_info, 0) < 0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001858 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001859 return -1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001860 }
Robert Olsson19baf832005-06-21 12:43:18 -07001861 i++;
1862 }
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001863 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001864 return skb->len;
1865}
1866
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001867static 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 -07001868 struct netlink_callback *cb)
1869{
1870 int h, s_h;
1871 struct list_head *fa_head;
1872 struct leaf *l = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001873
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001874 s_h = cb->args[3];
Robert Olsson19baf832005-06-21 12:43:18 -07001875
Olof Johansson91b9a272005-08-09 20:24:39 -07001876 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001877 if (h < s_h)
1878 continue;
1879 if (h > s_h)
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001880 memset(&cb->args[4], 0,
1881 sizeof(cb->args) - 4*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001882
1883 fa_head = get_fa_head(l, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001884
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001885 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001886 continue;
1887
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001888 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001889 continue;
1890
1891 if (fn_trie_dump_fa(l->key, plen, fa_head, tb, skb, cb)<0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001892 cb->args[3] = h;
Robert Olsson19baf832005-06-21 12:43:18 -07001893 return -1;
1894 }
1895 }
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001896 cb->args[3] = h;
Robert Olsson19baf832005-06-21 12:43:18 -07001897 return skb->len;
1898}
1899
1900static int fn_trie_dump(struct fib_table *tb, struct sk_buff *skb, struct netlink_callback *cb)
1901{
1902 int m, s_m;
1903 struct trie *t = (struct trie *) tb->tb_data;
1904
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001905 s_m = cb->args[2];
Robert Olsson19baf832005-06-21 12:43:18 -07001906
Robert Olsson2373ce12005-08-25 13:01:29 -07001907 rcu_read_lock();
Olof Johansson91b9a272005-08-09 20:24:39 -07001908 for (m = 0; m <= 32; m++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001909 if (m < s_m)
1910 continue;
1911 if (m > s_m)
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001912 memset(&cb->args[3], 0,
1913 sizeof(cb->args) - 3*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001914
1915 if (fn_trie_dump_plen(t, 32-m, tb, skb, cb)<0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001916 cb->args[2] = m;
Robert Olsson19baf832005-06-21 12:43:18 -07001917 goto out;
1918 }
1919 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001920 rcu_read_unlock();
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001921 cb->args[2] = m;
Robert Olsson19baf832005-06-21 12:43:18 -07001922 return skb->len;
Olof Johansson91b9a272005-08-09 20:24:39 -07001923out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001924 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001925 return -1;
1926}
1927
1928/* Fix more generic FIB names for init later */
1929
Denis V. Lunev7b1a74f2008-01-10 03:22:17 -08001930struct fib_table *fib_hash_init(u32 id)
Robert Olsson19baf832005-06-21 12:43:18 -07001931{
1932 struct fib_table *tb;
1933 struct trie *t;
1934
1935 if (fn_alias_kmem == NULL)
1936 fn_alias_kmem = kmem_cache_create("ip_fib_alias",
1937 sizeof(struct fib_alias),
1938 0, SLAB_HWCACHE_ALIGN,
Paul Mundt20c2df82007-07-20 10:11:58 +09001939 NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001940
1941 tb = kmalloc(sizeof(struct fib_table) + sizeof(struct trie),
1942 GFP_KERNEL);
1943 if (tb == NULL)
1944 return NULL;
1945
1946 tb->tb_id = id;
Denis V. Lunev971b8932007-12-08 00:32:23 -08001947 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001948 tb->tb_lookup = fn_trie_lookup;
1949 tb->tb_insert = fn_trie_insert;
1950 tb->tb_delete = fn_trie_delete;
1951 tb->tb_flush = fn_trie_flush;
1952 tb->tb_select_default = fn_trie_select_default;
1953 tb->tb_dump = fn_trie_dump;
Robert Olsson19baf832005-06-21 12:43:18 -07001954
1955 t = (struct trie *) tb->tb_data;
Stephen Hemmingerc28a1cf2008-01-12 20:49:13 -08001956 memset(t, 0, sizeof(*t));
Robert Olsson19baf832005-06-21 12:43:18 -07001957
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001958 if (id == RT_TABLE_LOCAL)
Stephen Hemminger78c66712005-09-21 00:15:39 -07001959 printk(KERN_INFO "IPv4 FIB: Using LC-trie version %s\n", VERSION);
Robert Olsson19baf832005-06-21 12:43:18 -07001960
1961 return tb;
1962}
1963
Robert Olsson19baf832005-06-21 12:43:18 -07001964#ifdef CONFIG_PROC_FS
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001965/* Depth first Trie walk iterator */
1966struct fib_trie_iter {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08001967 struct seq_net_private p;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08001968 struct trie *trie_local, *trie_main;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001969 struct tnode *tnode;
1970 struct trie *trie;
1971 unsigned index;
1972 unsigned depth;
1973};
Robert Olsson19baf832005-06-21 12:43:18 -07001974
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001975static struct node *fib_trie_get_next(struct fib_trie_iter *iter)
Robert Olsson19baf832005-06-21 12:43:18 -07001976{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001977 struct tnode *tn = iter->tnode;
1978 unsigned cindex = iter->index;
1979 struct tnode *p;
1980
Eric W. Biederman6640e692007-01-24 14:42:04 -08001981 /* A single entry routing table */
1982 if (!tn)
1983 return NULL;
1984
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001985 pr_debug("get_next iter={node=%p index=%d depth=%d}\n",
1986 iter->tnode, iter->index, iter->depth);
1987rescan:
1988 while (cindex < (1<<tn->bits)) {
1989 struct node *n = tnode_get_child(tn, cindex);
1990
1991 if (n) {
1992 if (IS_LEAF(n)) {
1993 iter->tnode = tn;
1994 iter->index = cindex + 1;
1995 } else {
1996 /* push down one level */
1997 iter->tnode = (struct tnode *) n;
1998 iter->index = 0;
1999 ++iter->depth;
2000 }
2001 return n;
2002 }
2003
2004 ++cindex;
2005 }
2006
2007 /* Current node exhausted, pop back up */
Stephen Hemminger06801912007-08-10 15:22:13 -07002008 p = node_parent((struct node *)tn);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002009 if (p) {
2010 cindex = tkey_extract_bits(tn->key, p->pos, p->bits)+1;
2011 tn = p;
2012 --iter->depth;
2013 goto rescan;
2014 }
2015
2016 /* got root? */
Robert Olsson19baf832005-06-21 12:43:18 -07002017 return NULL;
2018}
2019
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002020static struct node *fib_trie_get_first(struct fib_trie_iter *iter,
2021 struct trie *t)
Robert Olsson19baf832005-06-21 12:43:18 -07002022{
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002023 struct node *n ;
2024
Stephen Hemminger132adf52007-03-08 20:44:43 -08002025 if (!t)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002026 return NULL;
2027
2028 n = rcu_dereference(t->trie);
2029
Stephen Hemminger132adf52007-03-08 20:44:43 -08002030 if (!iter)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002031 return NULL;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002032
Eric W. Biederman6640e692007-01-24 14:42:04 -08002033 if (n) {
2034 if (IS_TNODE(n)) {
2035 iter->tnode = (struct tnode *) n;
2036 iter->trie = t;
2037 iter->index = 0;
2038 iter->depth = 1;
2039 } else {
2040 iter->tnode = NULL;
2041 iter->trie = t;
2042 iter->index = 0;
2043 iter->depth = 0;
2044 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002045 return n;
2046 }
Robert Olsson19baf832005-06-21 12:43:18 -07002047 return NULL;
2048}
2049
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002050static void trie_collect_stats(struct trie *t, struct trie_stat *s)
Robert Olsson19baf832005-06-21 12:43:18 -07002051{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002052 struct node *n;
2053 struct fib_trie_iter iter;
Robert Olsson19baf832005-06-21 12:43:18 -07002054
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002055 memset(s, 0, sizeof(*s));
Robert Olsson19baf832005-06-21 12:43:18 -07002056
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002057 rcu_read_lock();
2058 for (n = fib_trie_get_first(&iter, t); n;
2059 n = fib_trie_get_next(&iter)) {
2060 if (IS_LEAF(n)) {
2061 s->leaves++;
2062 s->totdepth += iter.depth;
2063 if (iter.depth > s->maxdepth)
2064 s->maxdepth = iter.depth;
2065 } else {
2066 const struct tnode *tn = (const struct tnode *) n;
2067 int i;
Robert Olsson19baf832005-06-21 12:43:18 -07002068
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002069 s->tnodes++;
Stephen Hemminger132adf52007-03-08 20:44:43 -08002070 if (tn->bits < MAX_STAT_DEPTH)
Robert Olsson06ef9212006-03-20 21:35:01 -08002071 s->nodesizes[tn->bits]++;
2072
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002073 for (i = 0; i < (1<<tn->bits); i++)
2074 if (!tn->child[i])
2075 s->nullpointers++;
2076 }
2077 }
2078 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002079}
2080
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002081/*
Robert Olsson19baf832005-06-21 12:43:18 -07002082 * This outputs /proc/net/fib_triestats
Robert Olsson19baf832005-06-21 12:43:18 -07002083 */
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002084static void trie_show_stats(struct seq_file *seq, struct trie_stat *stat)
Robert Olsson19baf832005-06-21 12:43:18 -07002085{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002086 unsigned i, max, pointers, bytes, avdepth;
Robert Olsson19baf832005-06-21 12:43:18 -07002087
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002088 if (stat->leaves)
2089 avdepth = stat->totdepth*100 / stat->leaves;
2090 else
2091 avdepth = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002092
Stephen Hemminger187b5182008-01-12 20:55:55 -08002093 seq_printf(seq, "\tAver depth: %u.%02d\n", avdepth / 100, avdepth % 100 );
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002094 seq_printf(seq, "\tMax depth: %u\n", stat->maxdepth);
Robert Olsson19baf832005-06-21 12:43:18 -07002095
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002096 seq_printf(seq, "\tLeaves: %u\n", stat->leaves);
Olof Johansson91b9a272005-08-09 20:24:39 -07002097
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002098 bytes = sizeof(struct leaf) * stat->leaves;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002099 seq_printf(seq, "\tInternal nodes: %u\n\t", stat->tnodes);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002100 bytes += sizeof(struct tnode) * stat->tnodes;
Robert Olsson19baf832005-06-21 12:43:18 -07002101
Robert Olsson06ef9212006-03-20 21:35:01 -08002102 max = MAX_STAT_DEPTH;
2103 while (max > 0 && stat->nodesizes[max-1] == 0)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002104 max--;
Robert Olsson19baf832005-06-21 12:43:18 -07002105
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002106 pointers = 0;
2107 for (i = 1; i <= max; i++)
2108 if (stat->nodesizes[i] != 0) {
Stephen Hemminger187b5182008-01-12 20:55:55 -08002109 seq_printf(seq, " %u: %u", i, stat->nodesizes[i]);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002110 pointers += (1<<i) * stat->nodesizes[i];
2111 }
2112 seq_putc(seq, '\n');
Stephen Hemminger187b5182008-01-12 20:55:55 -08002113 seq_printf(seq, "\tPointers: %u\n", pointers);
Robert Olsson19baf832005-06-21 12:43:18 -07002114
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002115 bytes += sizeof(struct node *) * pointers;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002116 seq_printf(seq, "Null ptrs: %u\n", stat->nullpointers);
2117 seq_printf(seq, "Total size: %u kB\n", (bytes + 1023) / 1024);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002118}
Robert Olsson19baf832005-06-21 12:43:18 -07002119
2120#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002121static void trie_show_usage(struct seq_file *seq,
2122 const struct trie_use_stats *stats)
2123{
2124 seq_printf(seq, "\nCounters:\n---------\n");
2125 seq_printf(seq,"gets = %u\n", stats->gets);
2126 seq_printf(seq,"backtracks = %u\n", stats->backtrack);
2127 seq_printf(seq,"semantic match passed = %u\n", stats->semantic_match_passed);
2128 seq_printf(seq,"semantic match miss = %u\n", stats->semantic_match_miss);
2129 seq_printf(seq,"null node hit= %u\n", stats->null_node_hit);
2130 seq_printf(seq,"skipped node resize = %u\n\n", stats->resize_node_skipped);
Robert Olsson19baf832005-06-21 12:43:18 -07002131}
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002132#endif /* CONFIG_IP_FIB_TRIE_STATS */
2133
Robert Olsson19baf832005-06-21 12:43:18 -07002134
2135static int fib_triestat_seq_show(struct seq_file *seq, void *v)
2136{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002137 struct net *net = (struct net *)seq->private;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002138 struct trie *trie_local, *trie_main;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002139 struct trie_stat *stat;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002140 struct fib_table *tb;
2141
2142 trie_local = NULL;
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002143 tb = fib_get_table(net, RT_TABLE_LOCAL);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002144 if (tb)
2145 trie_local = (struct trie *) tb->tb_data;
2146
2147 trie_main = NULL;
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002148 tb = fib_get_table(net, RT_TABLE_MAIN);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002149 if (tb)
2150 trie_main = (struct trie *) tb->tb_data;
2151
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002152
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002153 stat = kmalloc(sizeof(*stat), GFP_KERNEL);
2154 if (!stat)
2155 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002156
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002157 seq_printf(seq, "Basic info: size of leaf: %Zd bytes, size of tnode: %Zd bytes.\n",
2158 sizeof(struct leaf), sizeof(struct tnode));
Olof Johansson91b9a272005-08-09 20:24:39 -07002159
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002160 if (trie_local) {
2161 seq_printf(seq, "Local:\n");
2162 trie_collect_stats(trie_local, stat);
2163 trie_show_stats(seq, stat);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002164#ifdef CONFIG_IP_FIB_TRIE_STATS
2165 trie_show_usage(seq, &trie_local->stats);
2166#endif
Robert Olsson19baf832005-06-21 12:43:18 -07002167 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002168
2169 if (trie_main) {
2170 seq_printf(seq, "Main:\n");
2171 trie_collect_stats(trie_main, stat);
2172 trie_show_stats(seq, stat);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002173#ifdef CONFIG_IP_FIB_TRIE_STATS
2174 trie_show_usage(seq, &trie_main->stats);
2175#endif
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002176 }
2177 kfree(stat);
2178
Robert Olsson19baf832005-06-21 12:43:18 -07002179 return 0;
2180}
2181
Robert Olsson19baf832005-06-21 12:43:18 -07002182static int fib_triestat_seq_open(struct inode *inode, struct file *file)
2183{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002184 int err;
2185 struct net *net;
2186
2187 net = get_proc_net(inode);
2188 if (net == NULL)
2189 return -ENXIO;
2190 err = single_open(file, fib_triestat_seq_show, net);
2191 if (err < 0) {
2192 put_net(net);
2193 return err;
2194 }
2195 return 0;
2196}
2197
2198static int fib_triestat_seq_release(struct inode *ino, struct file *f)
2199{
2200 struct seq_file *seq = f->private_data;
2201 put_net(seq->private);
2202 return single_release(ino, f);
Robert Olsson19baf832005-06-21 12:43:18 -07002203}
2204
Arjan van de Ven9a321442007-02-12 00:55:35 -08002205static const struct file_operations fib_triestat_fops = {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002206 .owner = THIS_MODULE,
2207 .open = fib_triestat_seq_open,
2208 .read = seq_read,
2209 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002210 .release = fib_triestat_seq_release,
Robert Olsson19baf832005-06-21 12:43:18 -07002211};
2212
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002213static struct node *fib_trie_get_idx(struct fib_trie_iter *iter,
2214 loff_t pos)
Robert Olsson19baf832005-06-21 12:43:18 -07002215{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002216 loff_t idx = 0;
2217 struct node *n;
Robert Olsson19baf832005-06-21 12:43:18 -07002218
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002219 for (n = fib_trie_get_first(iter, iter->trie_local);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002220 n; ++idx, n = fib_trie_get_next(iter)) {
2221 if (pos == idx)
2222 return n;
2223 }
Robert Olsson19baf832005-06-21 12:43:18 -07002224
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002225 for (n = fib_trie_get_first(iter, iter->trie_main);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002226 n; ++idx, n = fib_trie_get_next(iter)) {
2227 if (pos == idx)
2228 return n;
2229 }
Robert Olsson19baf832005-06-21 12:43:18 -07002230 return NULL;
2231}
2232
2233static void *fib_trie_seq_start(struct seq_file *seq, loff_t *pos)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002234 __acquires(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002235{
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002236 struct fib_trie_iter *iter = seq->private;
2237 struct fib_table *tb;
2238
2239 if (!iter->trie_local) {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002240 tb = fib_get_table(iter->p.net, RT_TABLE_LOCAL);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002241 if (tb)
2242 iter->trie_local = (struct trie *) tb->tb_data;
2243 }
2244 if (!iter->trie_main) {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002245 tb = fib_get_table(iter->p.net, RT_TABLE_MAIN);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002246 if (tb)
2247 iter->trie_main = (struct trie *) tb->tb_data;
2248 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002249 rcu_read_lock();
2250 if (*pos == 0)
Olof Johansson91b9a272005-08-09 20:24:39 -07002251 return SEQ_START_TOKEN;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002252 return fib_trie_get_idx(iter, *pos - 1);
Robert Olsson19baf832005-06-21 12:43:18 -07002253}
2254
2255static void *fib_trie_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2256{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002257 struct fib_trie_iter *iter = seq->private;
2258 void *l = v;
2259
Robert Olsson19baf832005-06-21 12:43:18 -07002260 ++*pos;
Olof Johansson91b9a272005-08-09 20:24:39 -07002261 if (v == SEQ_START_TOKEN)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002262 return fib_trie_get_idx(iter, 0);
Olof Johansson91b9a272005-08-09 20:24:39 -07002263
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002264 v = fib_trie_get_next(iter);
2265 BUG_ON(v == l);
2266 if (v)
2267 return v;
2268
2269 /* continue scan in next trie */
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002270 if (iter->trie == iter->trie_local)
2271 return fib_trie_get_first(iter, iter->trie_main);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002272
2273 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07002274}
2275
2276static void fib_trie_seq_stop(struct seq_file *seq, void *v)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002277 __releases(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002278{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002279 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002280}
2281
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002282static void seq_indent(struct seq_file *seq, int n)
2283{
2284 while (n-- > 0) seq_puts(seq, " ");
2285}
Robert Olsson19baf832005-06-21 12:43:18 -07002286
Eric Dumazet28d36e32008-01-14 23:09:56 -08002287static inline const char *rtn_scope(char *buf, size_t len, enum rt_scope_t s)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002288{
Stephen Hemminger132adf52007-03-08 20:44:43 -08002289 switch (s) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002290 case RT_SCOPE_UNIVERSE: return "universe";
2291 case RT_SCOPE_SITE: return "site";
2292 case RT_SCOPE_LINK: return "link";
2293 case RT_SCOPE_HOST: return "host";
2294 case RT_SCOPE_NOWHERE: return "nowhere";
2295 default:
Eric Dumazet28d36e32008-01-14 23:09:56 -08002296 snprintf(buf, len, "scope=%d", s);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002297 return buf;
2298 }
2299}
2300
2301static const char *rtn_type_names[__RTN_MAX] = {
2302 [RTN_UNSPEC] = "UNSPEC",
2303 [RTN_UNICAST] = "UNICAST",
2304 [RTN_LOCAL] = "LOCAL",
2305 [RTN_BROADCAST] = "BROADCAST",
2306 [RTN_ANYCAST] = "ANYCAST",
2307 [RTN_MULTICAST] = "MULTICAST",
2308 [RTN_BLACKHOLE] = "BLACKHOLE",
2309 [RTN_UNREACHABLE] = "UNREACHABLE",
2310 [RTN_PROHIBIT] = "PROHIBIT",
2311 [RTN_THROW] = "THROW",
2312 [RTN_NAT] = "NAT",
2313 [RTN_XRESOLVE] = "XRESOLVE",
2314};
2315
Eric Dumazet28d36e32008-01-14 23:09:56 -08002316static inline const char *rtn_type(char *buf, size_t len, unsigned t)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002317{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002318 if (t < __RTN_MAX && rtn_type_names[t])
2319 return rtn_type_names[t];
Eric Dumazet28d36e32008-01-14 23:09:56 -08002320 snprintf(buf, len, "type %u", t);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002321 return buf;
2322}
2323
2324/* Pretty print the trie */
Robert Olsson19baf832005-06-21 12:43:18 -07002325static int fib_trie_seq_show(struct seq_file *seq, void *v)
2326{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002327 const struct fib_trie_iter *iter = seq->private;
2328 struct node *n = v;
Robert Olsson19baf832005-06-21 12:43:18 -07002329
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002330 if (v == SEQ_START_TOKEN)
2331 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002332
Stephen Hemminger06801912007-08-10 15:22:13 -07002333 if (!node_parent(n)) {
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002334 if (iter->trie == iter->trie_local)
Robert Olsson095b8502007-01-26 19:06:01 -08002335 seq_puts(seq, "<local>:\n");
2336 else
2337 seq_puts(seq, "<main>:\n");
2338 }
2339
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002340 if (IS_TNODE(n)) {
2341 struct tnode *tn = (struct tnode *) n;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07002342 __be32 prf = htonl(mask_pfx(tn->key, tn->pos));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002343
Robert Olsson1d25cd62005-09-19 15:29:52 -07002344 seq_indent(seq, iter->depth-1);
2345 seq_printf(seq, " +-- %d.%d.%d.%d/%d %d %d %d\n",
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002346 NIPQUAD(prf), tn->pos, tn->bits, tn->full_children,
Robert Olsson1d25cd62005-09-19 15:29:52 -07002347 tn->empty_children);
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002348
Olof Johansson91b9a272005-08-09 20:24:39 -07002349 } else {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002350 struct leaf *l = (struct leaf *) n;
2351 int i;
Al Viro32ab5f82006-09-26 22:21:45 -07002352 __be32 val = htonl(l->key);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002353
2354 seq_indent(seq, iter->depth);
2355 seq_printf(seq, " |-- %d.%d.%d.%d\n", NIPQUAD(val));
2356 for (i = 32; i >= 0; i--) {
Robert Olsson772cb712005-09-19 15:31:18 -07002357 struct leaf_info *li = find_leaf_info(l, i);
Eric Dumazet28d36e32008-01-14 23:09:56 -08002358
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002359 if (li) {
2360 struct fib_alias *fa;
Eric Dumazet28d36e32008-01-14 23:09:56 -08002361
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002362 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
Eric Dumazet28d36e32008-01-14 23:09:56 -08002363 char buf1[32], buf2[32];
2364
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002365 seq_indent(seq, iter->depth+1);
2366 seq_printf(seq, " /%d %s %s", i,
Eric Dumazet28d36e32008-01-14 23:09:56 -08002367 rtn_scope(buf1, sizeof(buf1),
2368 fa->fa_scope),
2369 rtn_type(buf2, sizeof(buf2),
2370 fa->fa_type));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002371 if (fa->fa_tos)
2372 seq_printf(seq, "tos =%d\n",
2373 fa->fa_tos);
2374 seq_putc(seq, '\n');
2375 }
2376 }
2377 }
Robert Olsson19baf832005-06-21 12:43:18 -07002378 }
2379
2380 return 0;
2381}
2382
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002383static const struct seq_operations fib_trie_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002384 .start = fib_trie_seq_start,
2385 .next = fib_trie_seq_next,
2386 .stop = fib_trie_seq_stop,
2387 .show = fib_trie_seq_show,
Robert Olsson19baf832005-06-21 12:43:18 -07002388};
2389
2390static int fib_trie_seq_open(struct inode *inode, struct file *file)
2391{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002392 return seq_open_net(inode, file, &fib_trie_seq_ops,
2393 sizeof(struct fib_trie_iter));
Robert Olsson19baf832005-06-21 12:43:18 -07002394}
2395
Arjan van de Ven9a321442007-02-12 00:55:35 -08002396static const struct file_operations fib_trie_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002397 .owner = THIS_MODULE,
2398 .open = fib_trie_seq_open,
2399 .read = seq_read,
2400 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002401 .release = seq_release_net,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002402};
2403
Al Viro32ab5f82006-09-26 22:21:45 -07002404static unsigned fib_flag_trans(int type, __be32 mask, const struct fib_info *fi)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002405{
2406 static unsigned type2flags[RTN_MAX + 1] = {
2407 [7] = RTF_REJECT, [8] = RTF_REJECT,
2408 };
2409 unsigned flags = type2flags[type];
2410
2411 if (fi && fi->fib_nh->nh_gw)
2412 flags |= RTF_GATEWAY;
Al Viro32ab5f82006-09-26 22:21:45 -07002413 if (mask == htonl(0xFFFFFFFF))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002414 flags |= RTF_HOST;
2415 flags |= RTF_UP;
2416 return flags;
2417}
2418
2419/*
2420 * This outputs /proc/net/route.
2421 * The format of the file is not supposed to be changed
2422 * and needs to be same as fib_hash output to avoid breaking
2423 * legacy utilities
2424 */
2425static int fib_route_seq_show(struct seq_file *seq, void *v)
2426{
Patrick McHardyc9e53cb2005-11-20 21:09:00 -08002427 const struct fib_trie_iter *iter = seq->private;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002428 struct leaf *l = v;
2429 int i;
2430 char bf[128];
2431
2432 if (v == SEQ_START_TOKEN) {
2433 seq_printf(seq, "%-127s\n", "Iface\tDestination\tGateway "
2434 "\tFlags\tRefCnt\tUse\tMetric\tMask\t\tMTU"
2435 "\tWindow\tIRTT");
2436 return 0;
2437 }
2438
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002439 if (iter->trie == iter->trie_local)
Patrick McHardyc9e53cb2005-11-20 21:09:00 -08002440 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002441 if (IS_TNODE(l))
2442 return 0;
2443
2444 for (i=32; i>=0; i--) {
Robert Olsson772cb712005-09-19 15:31:18 -07002445 struct leaf_info *li = find_leaf_info(l, i);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002446 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07002447 __be32 mask, prefix;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002448
2449 if (!li)
2450 continue;
2451
2452 mask = inet_make_mask(li->plen);
2453 prefix = htonl(l->key);
2454
2455 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
Herbert Xu1371e372005-10-15 09:42:39 +10002456 const struct fib_info *fi = fa->fa_info;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002457 unsigned flags = fib_flag_trans(fa->fa_type, mask, fi);
2458
2459 if (fa->fa_type == RTN_BROADCAST
2460 || fa->fa_type == RTN_MULTICAST)
2461 continue;
2462
2463 if (fi)
2464 snprintf(bf, sizeof(bf),
2465 "%s\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2466 fi->fib_dev ? fi->fib_dev->name : "*",
2467 prefix,
2468 fi->fib_nh->nh_gw, flags, 0, 0,
2469 fi->fib_priority,
2470 mask,
2471 (fi->fib_advmss ? fi->fib_advmss + 40 : 0),
2472 fi->fib_window,
2473 fi->fib_rtt >> 3);
2474 else
2475 snprintf(bf, sizeof(bf),
2476 "*\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2477 prefix, 0, flags, 0, 0, 0,
2478 mask, 0, 0, 0);
2479
2480 seq_printf(seq, "%-127s\n", bf);
2481 }
2482 }
2483
2484 return 0;
2485}
2486
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002487static const struct seq_operations fib_route_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002488 .start = fib_trie_seq_start,
2489 .next = fib_trie_seq_next,
2490 .stop = fib_trie_seq_stop,
2491 .show = fib_route_seq_show,
2492};
2493
2494static int fib_route_seq_open(struct inode *inode, struct file *file)
2495{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002496 return seq_open_net(inode, file, &fib_route_seq_ops,
2497 sizeof(struct fib_trie_iter));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002498}
2499
Arjan van de Ven9a321442007-02-12 00:55:35 -08002500static const struct file_operations fib_route_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002501 .owner = THIS_MODULE,
2502 .open = fib_route_seq_open,
2503 .read = seq_read,
2504 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002505 .release = seq_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002506};
2507
Denis V. Lunev61a02652008-01-10 03:21:09 -08002508int __net_init fib_proc_init(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002509{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002510 if (!proc_net_fops_create(net, "fib_trie", S_IRUGO, &fib_trie_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002511 goto out1;
2512
Denis V. Lunev61a02652008-01-10 03:21:09 -08002513 if (!proc_net_fops_create(net, "fib_triestat", S_IRUGO,
2514 &fib_triestat_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002515 goto out2;
2516
Denis V. Lunev61a02652008-01-10 03:21:09 -08002517 if (!proc_net_fops_create(net, "route", S_IRUGO, &fib_route_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002518 goto out3;
2519
Robert Olsson19baf832005-06-21 12:43:18 -07002520 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002521
2522out3:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002523 proc_net_remove(net, "fib_triestat");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002524out2:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002525 proc_net_remove(net, "fib_trie");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002526out1:
2527 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002528}
2529
Denis V. Lunev61a02652008-01-10 03:21:09 -08002530void __net_exit fib_proc_exit(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002531{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002532 proc_net_remove(net, "fib_trie");
2533 proc_net_remove(net, "fib_triestat");
2534 proc_net_remove(net, "route");
Robert Olsson19baf832005-06-21 12:43:18 -07002535}
2536
2537#endif /* CONFIG_PROC_FS */