blob: e1600ad8fb0e44fbd33657589ba84040b0ac8333 [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 */
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700125 union {
126 struct rcu_head rcu;
127 struct work_struct work;
128 };
Olof Johansson91b9a272005-08-09 20:24:39 -0700129 struct node *child[0];
Robert Olsson19baf832005-06-21 12:43:18 -0700130};
131
132#ifdef CONFIG_IP_FIB_TRIE_STATS
133struct trie_use_stats {
134 unsigned int gets;
135 unsigned int backtrack;
136 unsigned int semantic_match_passed;
137 unsigned int semantic_match_miss;
138 unsigned int null_node_hit;
Robert Olsson2f368952005-07-05 15:02:40 -0700139 unsigned int resize_node_skipped;
Robert Olsson19baf832005-06-21 12:43:18 -0700140};
141#endif
142
143struct trie_stat {
144 unsigned int totdepth;
145 unsigned int maxdepth;
146 unsigned int tnodes;
147 unsigned int leaves;
148 unsigned int nullpointers;
Stephen Hemminger93672292008-01-22 21:54:05 -0800149 unsigned int prefixes;
Robert Olsson06ef9212006-03-20 21:35:01 -0800150 unsigned int nodesizes[MAX_STAT_DEPTH];
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700151};
Robert Olsson19baf832005-06-21 12:43:18 -0700152
153struct trie {
Olof Johansson91b9a272005-08-09 20:24:39 -0700154 struct node *trie;
Robert Olsson19baf832005-06-21 12:43:18 -0700155#ifdef CONFIG_IP_FIB_TRIE_STATS
156 struct trie_use_stats stats;
157#endif
Robert Olsson19baf832005-06-21 12:43:18 -0700158};
159
Robert Olsson19baf832005-06-21 12:43:18 -0700160static void put_child(struct trie *t, struct tnode *tn, int i, struct node *n);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800161static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n,
162 int wasfull);
Robert Olsson19baf832005-06-21 12:43:18 -0700163static struct node *resize(struct trie *t, struct tnode *tn);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700164static struct tnode *inflate(struct trie *t, struct tnode *tn);
165static struct tnode *halve(struct trie *t, struct tnode *tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700166
Christoph Lametere18b8902006-12-06 20:33:20 -0800167static struct kmem_cache *fn_alias_kmem __read_mostly;
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -0800168static struct kmem_cache *trie_leaf_kmem __read_mostly;
Robert Olsson19baf832005-06-21 12:43:18 -0700169
Stephen Hemminger06801912007-08-10 15:22:13 -0700170static inline struct tnode *node_parent(struct node *node)
171{
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800172 return (struct tnode *)(node->parent & ~NODE_TYPE_MASK);
173}
Stephen Hemminger06801912007-08-10 15:22:13 -0700174
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800175static inline struct tnode *node_parent_rcu(struct node *node)
176{
177 struct tnode *ret = node_parent(node);
178
Stephen Hemminger06801912007-08-10 15:22:13 -0700179 return rcu_dereference(ret);
180}
181
Stephen Hemminger6440cc92008-03-22 17:59:58 -0700182/* Same as rcu_assign_pointer
183 * but that macro() assumes that value is a pointer.
184 */
Stephen Hemminger06801912007-08-10 15:22:13 -0700185static inline void node_set_parent(struct node *node, struct tnode *ptr)
186{
Stephen Hemminger6440cc92008-03-22 17:59:58 -0700187 smp_wmb();
188 node->parent = (unsigned long)ptr | NODE_TYPE(node);
Stephen Hemminger06801912007-08-10 15:22:13 -0700189}
Robert Olsson2373ce12005-08-25 13:01:29 -0700190
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800191static inline struct node *tnode_get_child(struct tnode *tn, unsigned int i)
Robert Olsson19baf832005-06-21 12:43:18 -0700192{
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800193 BUG_ON(i >= 1U << tn->bits);
Robert Olsson19baf832005-06-21 12:43:18 -0700194
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800195 return tn->child[i];
196}
197
198static inline struct node *tnode_get_child_rcu(struct tnode *tn, unsigned int i)
199{
200 struct node *ret = tnode_get_child(tn, i);
201
202 return rcu_dereference(ret);
Robert Olsson19baf832005-06-21 12:43:18 -0700203}
204
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700205static inline int tnode_child_length(const struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700206{
Olof Johansson91b9a272005-08-09 20:24:39 -0700207 return 1 << tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -0700208}
209
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700210static inline t_key mask_pfx(t_key k, unsigned short l)
211{
212 return (l == 0) ? 0 : k >> (KEYLENGTH-l) << (KEYLENGTH-l);
213}
214
Robert Olsson19baf832005-06-21 12:43:18 -0700215static inline t_key tkey_extract_bits(t_key a, int offset, int bits)
216{
Olof Johansson91b9a272005-08-09 20:24:39 -0700217 if (offset < KEYLENGTH)
Robert Olsson19baf832005-06-21 12:43:18 -0700218 return ((t_key)(a << offset)) >> (KEYLENGTH - bits);
Olof Johansson91b9a272005-08-09 20:24:39 -0700219 else
Robert Olsson19baf832005-06-21 12:43:18 -0700220 return 0;
221}
222
223static inline int tkey_equals(t_key a, t_key b)
224{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700225 return a == b;
Robert Olsson19baf832005-06-21 12:43:18 -0700226}
227
228static inline int tkey_sub_equals(t_key a, int offset, int bits, t_key b)
229{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700230 if (bits == 0 || offset >= KEYLENGTH)
231 return 1;
Olof Johansson91b9a272005-08-09 20:24:39 -0700232 bits = bits > KEYLENGTH ? KEYLENGTH : bits;
233 return ((a ^ b) << offset) >> (KEYLENGTH - bits) == 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700234}
Robert Olsson19baf832005-06-21 12:43:18 -0700235
236static inline int tkey_mismatch(t_key a, int offset, t_key b)
237{
238 t_key diff = a ^ b;
239 int i = offset;
240
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700241 if (!diff)
242 return 0;
243 while ((diff << i) >> (KEYLENGTH-1) == 0)
Robert Olsson19baf832005-06-21 12:43:18 -0700244 i++;
245 return i;
246}
247
Robert Olsson19baf832005-06-21 12:43:18 -0700248/*
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900249 To understand this stuff, an understanding of keys and all their bits is
250 necessary. Every node in the trie has a key associated with it, but not
Robert Olsson19baf832005-06-21 12:43:18 -0700251 all of the bits in that key are significant.
252
253 Consider a node 'n' and its parent 'tp'.
254
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900255 If n is a leaf, every bit in its key is significant. Its presence is
256 necessitated by path compression, since during a tree traversal (when
257 searching for a leaf - unless we are doing an insertion) we will completely
258 ignore all skipped bits we encounter. Thus we need to verify, at the end of
259 a potentially successful search, that we have indeed been walking the
Robert Olsson19baf832005-06-21 12:43:18 -0700260 correct key path.
261
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900262 Note that we can never "miss" the correct key in the tree if present by
263 following the wrong path. Path compression ensures that segments of the key
264 that are the same for all keys with a given prefix are skipped, but the
265 skipped part *is* identical for each node in the subtrie below the skipped
266 bit! trie_insert() in this implementation takes care of that - note the
Robert Olsson19baf832005-06-21 12:43:18 -0700267 call to tkey_sub_equals() in trie_insert().
268
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900269 if n is an internal node - a 'tnode' here, the various parts of its key
Robert Olsson19baf832005-06-21 12:43:18 -0700270 have many different meanings.
271
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900272 Example:
Robert Olsson19baf832005-06-21 12:43:18 -0700273 _________________________________________________________________
274 | i | i | i | i | i | i | i | N | N | N | S | S | S | S | S | C |
275 -----------------------------------------------------------------
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900276 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
Robert Olsson19baf832005-06-21 12:43:18 -0700277
278 _________________________________________________________________
279 | C | C | C | u | u | u | u | u | u | u | u | u | u | u | u | u |
280 -----------------------------------------------------------------
281 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31
282
283 tp->pos = 7
284 tp->bits = 3
285 n->pos = 15
Olof Johansson91b9a272005-08-09 20:24:39 -0700286 n->bits = 4
Robert Olsson19baf832005-06-21 12:43:18 -0700287
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900288 First, let's just ignore the bits that come before the parent tp, that is
289 the bits from 0 to (tp->pos-1). They are *known* but at this point we do
Robert Olsson19baf832005-06-21 12:43:18 -0700290 not use them for anything.
291
292 The bits from (tp->pos) to (tp->pos + tp->bits - 1) - "N", above - are the
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900293 index into the parent's child array. That is, they will be used to find
Robert Olsson19baf832005-06-21 12:43:18 -0700294 'n' among tp's children.
295
296 The bits from (tp->pos + tp->bits) to (n->pos - 1) - "S" - are skipped bits
297 for the node n.
298
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900299 All the bits we have seen so far are significant to the node n. The rest
Robert Olsson19baf832005-06-21 12:43:18 -0700300 of the bits are really not needed or indeed known in n->key.
301
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900302 The bits from (n->pos) to (n->pos + n->bits - 1) - "C" - are the index into
Robert Olsson19baf832005-06-21 12:43:18 -0700303 n's child array, and will of course be different for each child.
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900304
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700305
Robert Olsson19baf832005-06-21 12:43:18 -0700306 The rest of the bits, from (n->pos + n->bits) onward, are completely unknown
307 at this point.
308
309*/
310
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700311static inline void check_tnode(const struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700312{
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700313 WARN_ON(tn && tn->pos+tn->bits > 32);
Robert Olsson19baf832005-06-21 12:43:18 -0700314}
315
Denis V. Lunevf5026fa2007-12-13 09:47:57 -0800316static const int halve_threshold = 25;
317static const int inflate_threshold = 50;
318static const int halve_threshold_root = 8;
319static const int inflate_threshold_root = 15;
Robert Olsson19baf832005-06-21 12:43:18 -0700320
Robert Olsson2373ce12005-08-25 13:01:29 -0700321
322static void __alias_free_mem(struct rcu_head *head)
323{
324 struct fib_alias *fa = container_of(head, struct fib_alias, rcu);
325 kmem_cache_free(fn_alias_kmem, fa);
326}
327
328static inline void alias_free_mem_rcu(struct fib_alias *fa)
329{
330 call_rcu(&fa->rcu, __alias_free_mem);
331}
332
333static void __leaf_free_rcu(struct rcu_head *head)
334{
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -0800335 struct leaf *l = container_of(head, struct leaf, rcu);
336 kmem_cache_free(trie_leaf_kmem, l);
Robert Olsson2373ce12005-08-25 13:01:29 -0700337}
338
Stephen Hemminger387a5482008-04-10 03:47:34 -0700339static inline void free_leaf(struct leaf *l)
340{
341 call_rcu_bh(&l->rcu, __leaf_free_rcu);
342}
343
Robert Olsson2373ce12005-08-25 13:01:29 -0700344static void __leaf_info_free_rcu(struct rcu_head *head)
345{
346 kfree(container_of(head, struct leaf_info, rcu));
347}
348
349static inline void free_leaf_info(struct leaf_info *leaf)
350{
351 call_rcu(&leaf->rcu, __leaf_info_free_rcu);
352}
353
Eric Dumazet8d965442008-01-13 22:31:44 -0800354static struct tnode *tnode_alloc(size_t size)
Robert Olsson2373ce12005-08-25 13:01:29 -0700355{
Robert Olsson2373ce12005-08-25 13:01:29 -0700356 if (size <= PAGE_SIZE)
Eric Dumazet8d965442008-01-13 22:31:44 -0800357 return kzalloc(size, GFP_KERNEL);
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700358 else
359 return __vmalloc(size, GFP_KERNEL | __GFP_ZERO, PAGE_KERNEL);
360}
Robert Olsson2373ce12005-08-25 13:01:29 -0700361
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700362static void __tnode_vfree(struct work_struct *arg)
363{
364 struct tnode *tn = container_of(arg, struct tnode, work);
365 vfree(tn);
Robert Olsson2373ce12005-08-25 13:01:29 -0700366}
367
368static void __tnode_free_rcu(struct rcu_head *head)
369{
370 struct tnode *tn = container_of(head, struct tnode, rcu);
Eric Dumazet8d965442008-01-13 22:31:44 -0800371 size_t size = sizeof(struct tnode) +
372 (sizeof(struct node *) << tn->bits);
Robert Olsson2373ce12005-08-25 13:01:29 -0700373
374 if (size <= PAGE_SIZE)
375 kfree(tn);
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700376 else {
377 INIT_WORK(&tn->work, __tnode_vfree);
378 schedule_work(&tn->work);
379 }
Robert Olsson2373ce12005-08-25 13:01:29 -0700380}
381
382static inline void tnode_free(struct tnode *tn)
383{
Stephen Hemminger387a5482008-04-10 03:47:34 -0700384 if (IS_LEAF(tn))
385 free_leaf((struct leaf *) tn);
386 else
Robert Olsson550e29b2006-04-04 12:53:35 -0700387 call_rcu(&tn->rcu, __tnode_free_rcu);
Robert Olsson2373ce12005-08-25 13:01:29 -0700388}
389
Robert Olsson19baf832005-06-21 12:43:18 -0700390static struct leaf *leaf_new(void)
391{
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -0800392 struct leaf *l = kmem_cache_alloc(trie_leaf_kmem, GFP_KERNEL);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700393 if (l) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700394 l->parent = T_LEAF;
Robert Olsson19baf832005-06-21 12:43:18 -0700395 INIT_HLIST_HEAD(&l->list);
396 }
397 return l;
398}
399
400static struct leaf_info *leaf_info_new(int plen)
401{
402 struct leaf_info *li = kmalloc(sizeof(struct leaf_info), GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -0700403 if (li) {
404 li->plen = plen;
405 INIT_LIST_HEAD(&li->falh);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700406 }
Robert Olsson2373ce12005-08-25 13:01:29 -0700407 return li;
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700408}
409
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800410static struct tnode *tnode_new(t_key key, int pos, int bits)
Robert Olsson19baf832005-06-21 12:43:18 -0700411{
Eric Dumazet8d965442008-01-13 22:31:44 -0800412 size_t sz = sizeof(struct tnode) + (sizeof(struct node *) << bits);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700413 struct tnode *tn = tnode_alloc(sz);
Robert Olsson19baf832005-06-21 12:43:18 -0700414
Olof Johansson91b9a272005-08-09 20:24:39 -0700415 if (tn) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700416 tn->parent = T_TNODE;
Robert Olsson19baf832005-06-21 12:43:18 -0700417 tn->pos = pos;
418 tn->bits = bits;
419 tn->key = key;
420 tn->full_children = 0;
421 tn->empty_children = 1<<bits;
422 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700423
Eric Dumazet8d965442008-01-13 22:31:44 -0800424 pr_debug("AT %p s=%u %lu\n", tn, (unsigned int) sizeof(struct tnode),
425 (unsigned long) (sizeof(struct node) << bits));
Robert Olsson19baf832005-06-21 12:43:18 -0700426 return tn;
427}
428
Robert Olsson19baf832005-06-21 12:43:18 -0700429/*
430 * Check whether a tnode 'n' is "full", i.e. it is an internal node
431 * and no bits are skipped. See discussion in dyntree paper p. 6
432 */
433
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700434static inline int tnode_full(const struct tnode *tn, const struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700435{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700436 if (n == NULL || IS_LEAF(n))
Robert Olsson19baf832005-06-21 12:43:18 -0700437 return 0;
438
439 return ((struct tnode *) n)->pos == tn->pos + tn->bits;
440}
441
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800442static inline void put_child(struct trie *t, struct tnode *tn, int i,
443 struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700444{
445 tnode_put_child_reorg(tn, i, n, -1);
446}
447
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700448 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700449 * Add a child at position i overwriting the old value.
450 * Update the value of full_children and empty_children.
451 */
452
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800453static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n,
454 int wasfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700455{
Robert Olsson2373ce12005-08-25 13:01:29 -0700456 struct node *chi = tn->child[i];
Robert Olsson19baf832005-06-21 12:43:18 -0700457 int isfull;
458
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700459 BUG_ON(i >= 1<<tn->bits);
460
Robert Olsson19baf832005-06-21 12:43:18 -0700461 /* update emptyChildren */
462 if (n == NULL && chi != NULL)
463 tn->empty_children++;
464 else if (n != NULL && chi == NULL)
465 tn->empty_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700466
Robert Olsson19baf832005-06-21 12:43:18 -0700467 /* update fullChildren */
Olof Johansson91b9a272005-08-09 20:24:39 -0700468 if (wasfull == -1)
Robert Olsson19baf832005-06-21 12:43:18 -0700469 wasfull = tnode_full(tn, chi);
470
471 isfull = tnode_full(tn, n);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700472 if (wasfull && !isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700473 tn->full_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700474 else if (!wasfull && isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700475 tn->full_children++;
Olof Johansson91b9a272005-08-09 20:24:39 -0700476
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700477 if (n)
Stephen Hemminger06801912007-08-10 15:22:13 -0700478 node_set_parent(n, tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700479
Robert Olsson2373ce12005-08-25 13:01:29 -0700480 rcu_assign_pointer(tn->child[i], n);
Robert Olsson19baf832005-06-21 12:43:18 -0700481}
482
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700483static struct node *resize(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700484{
485 int i;
Robert Olsson2f368952005-07-05 15:02:40 -0700486 int err = 0;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700487 struct tnode *old_tn;
Robert Olssone6308be2005-10-04 13:01:58 -0700488 int inflate_threshold_use;
489 int halve_threshold_use;
Robert Olsson05eee482007-03-19 16:27:37 -0700490 int max_resize;
Robert Olsson19baf832005-06-21 12:43:18 -0700491
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900492 if (!tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700493 return NULL;
494
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700495 pr_debug("In tnode_resize %p inflate_threshold=%d threshold=%d\n",
496 tn, inflate_threshold, halve_threshold);
Robert Olsson19baf832005-06-21 12:43:18 -0700497
498 /* No children */
499 if (tn->empty_children == tnode_child_length(tn)) {
500 tnode_free(tn);
501 return NULL;
502 }
503 /* One child */
504 if (tn->empty_children == tnode_child_length(tn) - 1)
505 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700506 struct node *n;
Robert Olsson19baf832005-06-21 12:43:18 -0700507
Olof Johansson91b9a272005-08-09 20:24:39 -0700508 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700509 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700510 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700511
512 /* compress one level */
Stephen Hemminger06801912007-08-10 15:22:13 -0700513 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700514 tnode_free(tn);
515 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700516 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700517 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700518 * Double as long as the resulting node has a number of
519 * nonempty nodes that are above the threshold.
520 */
521
522 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700523 * From "Implementing a dynamic compressed trie" by Stefan Nilsson of
524 * the Helsinki University of Technology and Matti Tikkanen of Nokia
Robert Olsson19baf832005-06-21 12:43:18 -0700525 * Telecommunications, page 6:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700526 * "A node is doubled if the ratio of non-empty children to all
Robert Olsson19baf832005-06-21 12:43:18 -0700527 * children in the *doubled* node is at least 'high'."
528 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700529 * 'high' in this instance is the variable 'inflate_threshold'. It
530 * is expressed as a percentage, so we multiply it with
531 * tnode_child_length() and instead of multiplying by 2 (since the
532 * child array will be doubled by inflate()) and multiplying
533 * the left-hand side by 100 (to handle the percentage thing) we
Robert Olsson19baf832005-06-21 12:43:18 -0700534 * multiply the left-hand side by 50.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700535 *
536 * The left-hand side may look a bit weird: tnode_child_length(tn)
537 * - tn->empty_children is of course the number of non-null children
538 * in the current node. tn->full_children is the number of "full"
Robert Olsson19baf832005-06-21 12:43:18 -0700539 * children, that is non-null tnodes with a skip value of 0.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700540 * All of those will be doubled in the resulting inflated tnode, so
Robert Olsson19baf832005-06-21 12:43:18 -0700541 * we just count them one extra time here.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700542 *
Robert Olsson19baf832005-06-21 12:43:18 -0700543 * A clearer way to write this would be:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700544 *
Robert Olsson19baf832005-06-21 12:43:18 -0700545 * to_be_doubled = tn->full_children;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700546 * not_to_be_doubled = tnode_child_length(tn) - tn->empty_children -
Robert Olsson19baf832005-06-21 12:43:18 -0700547 * tn->full_children;
548 *
549 * new_child_length = tnode_child_length(tn) * 2;
550 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700551 * new_fill_factor = 100 * (not_to_be_doubled + 2*to_be_doubled) /
Robert Olsson19baf832005-06-21 12:43:18 -0700552 * new_child_length;
553 * if (new_fill_factor >= inflate_threshold)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700554 *
555 * ...and so on, tho it would mess up the while () loop.
556 *
Robert Olsson19baf832005-06-21 12:43:18 -0700557 * anyway,
558 * 100 * (not_to_be_doubled + 2*to_be_doubled) / new_child_length >=
559 * inflate_threshold
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700560 *
Robert Olsson19baf832005-06-21 12:43:18 -0700561 * avoid a division:
562 * 100 * (not_to_be_doubled + 2*to_be_doubled) >=
563 * inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700564 *
Robert Olsson19baf832005-06-21 12:43:18 -0700565 * expand not_to_be_doubled and to_be_doubled, and shorten:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700566 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700567 * tn->full_children) >= inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700568 *
Robert Olsson19baf832005-06-21 12:43:18 -0700569 * expand new_child_length:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700570 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700571 * tn->full_children) >=
Robert Olsson19baf832005-06-21 12:43:18 -0700572 * inflate_threshold * tnode_child_length(tn) * 2
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700573 *
Robert Olsson19baf832005-06-21 12:43:18 -0700574 * shorten again:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700575 * 50 * (tn->full_children + tnode_child_length(tn) -
Olof Johansson91b9a272005-08-09 20:24:39 -0700576 * tn->empty_children) >= inflate_threshold *
Robert Olsson19baf832005-06-21 12:43:18 -0700577 * tnode_child_length(tn)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700578 *
Robert Olsson19baf832005-06-21 12:43:18 -0700579 */
580
581 check_tnode(tn);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700582
Robert Olssone6308be2005-10-04 13:01:58 -0700583 /* Keep root node larger */
584
Stephen Hemminger132adf52007-03-08 20:44:43 -0800585 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700586 inflate_threshold_use = inflate_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900587 else
Robert Olssone6308be2005-10-04 13:01:58 -0700588 inflate_threshold_use = inflate_threshold;
589
Robert Olsson2f368952005-07-05 15:02:40 -0700590 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700591 max_resize = 10;
592 while ((tn->full_children > 0 && max_resize-- &&
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800593 50 * (tn->full_children + tnode_child_length(tn)
594 - tn->empty_children)
595 >= inflate_threshold_use * tnode_child_length(tn))) {
Robert Olsson19baf832005-06-21 12:43:18 -0700596
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700597 old_tn = tn;
598 tn = inflate(t, tn);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800599
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700600 if (IS_ERR(tn)) {
601 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700602#ifdef CONFIG_IP_FIB_TRIE_STATS
603 t->stats.resize_node_skipped++;
604#endif
605 break;
606 }
Robert Olsson19baf832005-06-21 12:43:18 -0700607 }
608
Robert Olsson05eee482007-03-19 16:27:37 -0700609 if (max_resize < 0) {
610 if (!tn->parent)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800611 pr_warning("Fix inflate_threshold_root."
612 " Now=%d size=%d bits\n",
613 inflate_threshold_root, tn->bits);
Robert Olsson05eee482007-03-19 16:27:37 -0700614 else
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800615 pr_warning("Fix inflate_threshold."
616 " Now=%d size=%d bits\n",
617 inflate_threshold, tn->bits);
Robert Olsson05eee482007-03-19 16:27:37 -0700618 }
619
Robert Olsson19baf832005-06-21 12:43:18 -0700620 check_tnode(tn);
621
622 /*
623 * Halve as long as the number of empty children in this
624 * node is above threshold.
625 */
Robert Olsson2f368952005-07-05 15:02:40 -0700626
Robert Olssone6308be2005-10-04 13:01:58 -0700627
628 /* Keep root node larger */
629
Stephen Hemminger132adf52007-03-08 20:44:43 -0800630 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700631 halve_threshold_use = halve_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900632 else
Robert Olssone6308be2005-10-04 13:01:58 -0700633 halve_threshold_use = halve_threshold;
634
Robert Olsson2f368952005-07-05 15:02:40 -0700635 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700636 max_resize = 10;
637 while (tn->bits > 1 && max_resize-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700638 100 * (tnode_child_length(tn) - tn->empty_children) <
Robert Olssone6308be2005-10-04 13:01:58 -0700639 halve_threshold_use * tnode_child_length(tn)) {
Robert Olsson19baf832005-06-21 12:43:18 -0700640
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700641 old_tn = tn;
642 tn = halve(t, tn);
643 if (IS_ERR(tn)) {
644 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700645#ifdef CONFIG_IP_FIB_TRIE_STATS
646 t->stats.resize_node_skipped++;
647#endif
648 break;
649 }
650 }
651
Robert Olsson05eee482007-03-19 16:27:37 -0700652 if (max_resize < 0) {
653 if (!tn->parent)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800654 pr_warning("Fix halve_threshold_root."
655 " Now=%d size=%d bits\n",
656 halve_threshold_root, tn->bits);
Robert Olsson05eee482007-03-19 16:27:37 -0700657 else
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800658 pr_warning("Fix halve_threshold."
659 " Now=%d size=%d bits\n",
660 halve_threshold, tn->bits);
Robert Olsson05eee482007-03-19 16:27:37 -0700661 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700662
Robert Olsson19baf832005-06-21 12:43:18 -0700663 /* Only one child remains */
Robert Olsson19baf832005-06-21 12:43:18 -0700664 if (tn->empty_children == tnode_child_length(tn) - 1)
665 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700666 struct node *n;
667
Olof Johansson91b9a272005-08-09 20:24:39 -0700668 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700669 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700670 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700671
672 /* compress one level */
673
Stephen Hemminger06801912007-08-10 15:22:13 -0700674 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700675 tnode_free(tn);
676 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700677 }
678
679 return (struct node *) tn;
680}
681
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700682static struct tnode *inflate(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700683{
Robert Olsson19baf832005-06-21 12:43:18 -0700684 struct tnode *oldtnode = tn;
685 int olen = tnode_child_length(tn);
686 int i;
687
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700688 pr_debug("In inflate\n");
Robert Olsson19baf832005-06-21 12:43:18 -0700689
690 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits + 1);
691
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700692 if (!tn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700693 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700694
695 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700696 * Preallocate and store tnodes before the actual work so we
697 * don't get into an inconsistent state if memory allocation
698 * fails. In case of failure we return the oldnode and inflate
Robert Olsson2f368952005-07-05 15:02:40 -0700699 * of tnode is ignored.
700 */
Olof Johansson91b9a272005-08-09 20:24:39 -0700701
702 for (i = 0; i < olen; i++) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800703 struct tnode *inode;
Robert Olsson2f368952005-07-05 15:02:40 -0700704
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800705 inode = (struct tnode *) tnode_get_child(oldtnode, i);
Robert Olsson2f368952005-07-05 15:02:40 -0700706 if (inode &&
707 IS_TNODE(inode) &&
708 inode->pos == oldtnode->pos + oldtnode->bits &&
709 inode->bits > 1) {
710 struct tnode *left, *right;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700711 t_key m = ~0U << (KEYLENGTH - 1) >> inode->pos;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700712
Robert Olsson2f368952005-07-05 15:02:40 -0700713 left = tnode_new(inode->key&(~m), inode->pos + 1,
714 inode->bits - 1);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700715 if (!left)
716 goto nomem;
Olof Johansson91b9a272005-08-09 20:24:39 -0700717
Robert Olsson2f368952005-07-05 15:02:40 -0700718 right = tnode_new(inode->key|m, inode->pos + 1,
719 inode->bits - 1);
720
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900721 if (!right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700722 tnode_free(left);
723 goto nomem;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900724 }
Robert Olsson2f368952005-07-05 15:02:40 -0700725
726 put_child(t, tn, 2*i, (struct node *) left);
727 put_child(t, tn, 2*i+1, (struct node *) right);
728 }
729 }
730
Olof Johansson91b9a272005-08-09 20:24:39 -0700731 for (i = 0; i < olen; i++) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -0800732 struct tnode *inode;
Robert Olsson19baf832005-06-21 12:43:18 -0700733 struct node *node = tnode_get_child(oldtnode, i);
Olof Johansson91b9a272005-08-09 20:24:39 -0700734 struct tnode *left, *right;
735 int size, j;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700736
Robert Olsson19baf832005-06-21 12:43:18 -0700737 /* An empty child */
738 if (node == NULL)
739 continue;
740
741 /* A leaf or an internal node with skipped bits */
742
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700743 if (IS_LEAF(node) || ((struct tnode *) node)->pos >
Robert Olsson19baf832005-06-21 12:43:18 -0700744 tn->pos + tn->bits - 1) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800745 if (tkey_extract_bits(node->key,
746 oldtnode->pos + oldtnode->bits,
747 1) == 0)
Robert Olsson19baf832005-06-21 12:43:18 -0700748 put_child(t, tn, 2*i, node);
749 else
750 put_child(t, tn, 2*i+1, node);
751 continue;
752 }
753
754 /* An internal node with two children */
755 inode = (struct tnode *) node;
756
757 if (inode->bits == 1) {
758 put_child(t, tn, 2*i, inode->child[0]);
759 put_child(t, tn, 2*i+1, inode->child[1]);
760
761 tnode_free(inode);
Olof Johansson91b9a272005-08-09 20:24:39 -0700762 continue;
Robert Olsson19baf832005-06-21 12:43:18 -0700763 }
764
Olof Johansson91b9a272005-08-09 20:24:39 -0700765 /* An internal node with more than two children */
Robert Olsson19baf832005-06-21 12:43:18 -0700766
Olof Johansson91b9a272005-08-09 20:24:39 -0700767 /* We will replace this node 'inode' with two new
768 * ones, 'left' and 'right', each with half of the
769 * original children. The two new nodes will have
770 * a position one bit further down the key and this
771 * means that the "significant" part of their keys
772 * (see the discussion near the top of this file)
773 * will differ by one bit, which will be "0" in
774 * left's key and "1" in right's key. Since we are
775 * moving the key position by one step, the bit that
776 * we are moving away from - the bit at position
777 * (inode->pos) - is the one that will differ between
778 * left and right. So... we synthesize that bit in the
779 * two new keys.
780 * The mask 'm' below will be a single "one" bit at
781 * the position (inode->pos)
782 */
Robert Olsson19baf832005-06-21 12:43:18 -0700783
Olof Johansson91b9a272005-08-09 20:24:39 -0700784 /* Use the old key, but set the new significant
785 * bit to zero.
786 */
Robert Olsson19baf832005-06-21 12:43:18 -0700787
Olof Johansson91b9a272005-08-09 20:24:39 -0700788 left = (struct tnode *) tnode_get_child(tn, 2*i);
789 put_child(t, tn, 2*i, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -0700790
Olof Johansson91b9a272005-08-09 20:24:39 -0700791 BUG_ON(!left);
Robert Olsson2f368952005-07-05 15:02:40 -0700792
Olof Johansson91b9a272005-08-09 20:24:39 -0700793 right = (struct tnode *) tnode_get_child(tn, 2*i+1);
794 put_child(t, tn, 2*i+1, NULL);
Robert Olsson2f368952005-07-05 15:02:40 -0700795
Olof Johansson91b9a272005-08-09 20:24:39 -0700796 BUG_ON(!right);
Robert Olsson2f368952005-07-05 15:02:40 -0700797
Olof Johansson91b9a272005-08-09 20:24:39 -0700798 size = tnode_child_length(left);
799 for (j = 0; j < size; j++) {
800 put_child(t, left, j, inode->child[j]);
801 put_child(t, right, j, inode->child[j + size]);
Robert Olsson19baf832005-06-21 12:43:18 -0700802 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700803 put_child(t, tn, 2*i, resize(t, left));
804 put_child(t, tn, 2*i+1, resize(t, right));
805
806 tnode_free(inode);
Robert Olsson19baf832005-06-21 12:43:18 -0700807 }
808 tnode_free(oldtnode);
809 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700810nomem:
811 {
812 int size = tnode_child_length(tn);
813 int j;
814
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700815 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700816 if (tn->child[j])
817 tnode_free((struct tnode *)tn->child[j]);
818
819 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700820
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700821 return ERR_PTR(-ENOMEM);
822 }
Robert Olsson19baf832005-06-21 12:43:18 -0700823}
824
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700825static struct tnode *halve(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700826{
827 struct tnode *oldtnode = tn;
828 struct node *left, *right;
829 int i;
830 int olen = tnode_child_length(tn);
831
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700832 pr_debug("In halve\n");
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700833
834 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits - 1);
Robert Olsson19baf832005-06-21 12:43:18 -0700835
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700836 if (!tn)
837 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700838
839 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700840 * Preallocate and store tnodes before the actual work so we
841 * don't get into an inconsistent state if memory allocation
842 * fails. In case of failure we return the oldnode and halve
Robert Olsson2f368952005-07-05 15:02:40 -0700843 * of tnode is ignored.
844 */
845
Olof Johansson91b9a272005-08-09 20:24:39 -0700846 for (i = 0; i < olen; i += 2) {
Robert Olsson2f368952005-07-05 15:02:40 -0700847 left = tnode_get_child(oldtnode, i);
848 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700849
Robert Olsson2f368952005-07-05 15:02:40 -0700850 /* Two nonempty children */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700851 if (left && right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700852 struct tnode *newn;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700853
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700854 newn = tnode_new(left->key, tn->pos + tn->bits, 1);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700855
856 if (!newn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700857 goto nomem;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700858
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700859 put_child(t, tn, i/2, (struct node *)newn);
Robert Olsson2f368952005-07-05 15:02:40 -0700860 }
Robert Olsson2f368952005-07-05 15:02:40 -0700861
Robert Olsson2f368952005-07-05 15:02:40 -0700862 }
Robert Olsson19baf832005-06-21 12:43:18 -0700863
Olof Johansson91b9a272005-08-09 20:24:39 -0700864 for (i = 0; i < olen; i += 2) {
865 struct tnode *newBinNode;
866
Robert Olsson19baf832005-06-21 12:43:18 -0700867 left = tnode_get_child(oldtnode, i);
868 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700869
Robert Olsson19baf832005-06-21 12:43:18 -0700870 /* At least one of the children is empty */
871 if (left == NULL) {
872 if (right == NULL) /* Both are empty */
873 continue;
874 put_child(t, tn, i/2, right);
Olof Johansson91b9a272005-08-09 20:24:39 -0700875 continue;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700876 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700877
878 if (right == NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700879 put_child(t, tn, i/2, left);
Olof Johansson91b9a272005-08-09 20:24:39 -0700880 continue;
881 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700882
Robert Olsson19baf832005-06-21 12:43:18 -0700883 /* Two nonempty children */
Olof Johansson91b9a272005-08-09 20:24:39 -0700884 newBinNode = (struct tnode *) tnode_get_child(tn, i/2);
885 put_child(t, tn, i/2, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700886 put_child(t, newBinNode, 0, left);
887 put_child(t, newBinNode, 1, right);
888 put_child(t, tn, i/2, resize(t, newBinNode));
Robert Olsson19baf832005-06-21 12:43:18 -0700889 }
890 tnode_free(oldtnode);
891 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700892nomem:
893 {
894 int size = tnode_child_length(tn);
895 int j;
896
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700897 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700898 if (tn->child[j])
899 tnode_free((struct tnode *)tn->child[j]);
900
901 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700902
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700903 return ERR_PTR(-ENOMEM);
904 }
Robert Olsson19baf832005-06-21 12:43:18 -0700905}
906
Robert Olsson772cb712005-09-19 15:31:18 -0700907/* readside must use rcu_read_lock currently dump routines
Robert Olsson2373ce12005-08-25 13:01:29 -0700908 via get_fa_head and dump */
909
Robert Olsson772cb712005-09-19 15:31:18 -0700910static struct leaf_info *find_leaf_info(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700911{
Robert Olsson772cb712005-09-19 15:31:18 -0700912 struct hlist_head *head = &l->list;
Robert Olsson19baf832005-06-21 12:43:18 -0700913 struct hlist_node *node;
914 struct leaf_info *li;
915
Robert Olsson2373ce12005-08-25 13:01:29 -0700916 hlist_for_each_entry_rcu(li, node, head, hlist)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700917 if (li->plen == plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700918 return li;
Olof Johansson91b9a272005-08-09 20:24:39 -0700919
Robert Olsson19baf832005-06-21 12:43:18 -0700920 return NULL;
921}
922
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800923static inline struct list_head *get_fa_head(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700924{
Robert Olsson772cb712005-09-19 15:31:18 -0700925 struct leaf_info *li = find_leaf_info(l, plen);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700926
Olof Johansson91b9a272005-08-09 20:24:39 -0700927 if (!li)
928 return NULL;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700929
Olof Johansson91b9a272005-08-09 20:24:39 -0700930 return &li->falh;
Robert Olsson19baf832005-06-21 12:43:18 -0700931}
932
933static void insert_leaf_info(struct hlist_head *head, struct leaf_info *new)
934{
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900935 struct leaf_info *li = NULL, *last = NULL;
936 struct hlist_node *node;
Robert Olsson19baf832005-06-21 12:43:18 -0700937
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900938 if (hlist_empty(head)) {
939 hlist_add_head_rcu(&new->hlist, head);
940 } else {
941 hlist_for_each_entry(li, node, head, hlist) {
942 if (new->plen > li->plen)
943 break;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700944
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900945 last = li;
946 }
947 if (last)
948 hlist_add_after_rcu(&last->hlist, &new->hlist);
949 else
950 hlist_add_before_rcu(&new->hlist, &li->hlist);
951 }
Robert Olsson19baf832005-06-21 12:43:18 -0700952}
953
Robert Olsson2373ce12005-08-25 13:01:29 -0700954/* rcu_read_lock needs to be hold by caller from readside */
955
Robert Olsson19baf832005-06-21 12:43:18 -0700956static struct leaf *
957fib_find_node(struct trie *t, u32 key)
958{
959 int pos;
960 struct tnode *tn;
961 struct node *n;
962
963 pos = 0;
Robert Olsson2373ce12005-08-25 13:01:29 -0700964 n = rcu_dereference(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -0700965
966 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
967 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -0700968
Robert Olsson19baf832005-06-21 12:43:18 -0700969 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700970
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700971 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700972 pos = tn->pos + tn->bits;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800973 n = tnode_get_child_rcu(tn,
974 tkey_extract_bits(key,
975 tn->pos,
976 tn->bits));
Olof Johansson91b9a272005-08-09 20:24:39 -0700977 } else
Robert Olsson19baf832005-06-21 12:43:18 -0700978 break;
979 }
980 /* Case we have found a leaf. Compare prefixes */
981
Olof Johansson91b9a272005-08-09 20:24:39 -0700982 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key))
983 return (struct leaf *)n;
984
Robert Olsson19baf832005-06-21 12:43:18 -0700985 return NULL;
986}
987
988static struct node *trie_rebalance(struct trie *t, struct tnode *tn)
989{
Robert Olsson19baf832005-06-21 12:43:18 -0700990 int wasfull;
Stephen Hemminger06801912007-08-10 15:22:13 -0700991 t_key cindex, key = tn->key;
992 struct tnode *tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700993
Stephen Hemminger06801912007-08-10 15:22:13 -0700994 while (tn != NULL && (tp = node_parent((struct node *)tn)) != NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700995 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
996 wasfull = tnode_full(tp, tnode_get_child(tp, cindex));
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800997 tn = (struct tnode *) resize(t, (struct tnode *)tn);
998
999 tnode_put_child_reorg((struct tnode *)tp, cindex,
1000 (struct node *)tn, wasfull);
Olof Johansson91b9a272005-08-09 20:24:39 -07001001
Stephen Hemminger06801912007-08-10 15:22:13 -07001002 tp = node_parent((struct node *) tn);
1003 if (!tp)
Robert Olsson19baf832005-06-21 12:43:18 -07001004 break;
Stephen Hemminger06801912007-08-10 15:22:13 -07001005 tn = tp;
Robert Olsson19baf832005-06-21 12:43:18 -07001006 }
Stephen Hemminger06801912007-08-10 15:22:13 -07001007
Robert Olsson19baf832005-06-21 12:43:18 -07001008 /* Handle last (top) tnode */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001009 if (IS_TNODE(tn))
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001010 tn = (struct tnode *)resize(t, (struct tnode *)tn);
Robert Olsson19baf832005-06-21 12:43:18 -07001011
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001012 return (struct node *)tn;
Robert Olsson19baf832005-06-21 12:43:18 -07001013}
1014
Robert Olsson2373ce12005-08-25 13:01:29 -07001015/* only used from updater-side */
1016
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001017static struct list_head *fib_insert_node(struct trie *t, u32 key, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -07001018{
1019 int pos, newpos;
1020 struct tnode *tp = NULL, *tn = NULL;
1021 struct node *n;
1022 struct leaf *l;
1023 int missbit;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001024 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001025 struct leaf_info *li;
1026 t_key cindex;
1027
1028 pos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001029 n = t->trie;
Robert Olsson19baf832005-06-21 12:43:18 -07001030
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001031 /* If we point to NULL, stop. Either the tree is empty and we should
1032 * just put a new leaf in if, or we have reached an empty child slot,
Robert Olsson19baf832005-06-21 12:43:18 -07001033 * and we should just put our new leaf in that.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001034 * If we point to a T_TNODE, check if it matches our key. Note that
1035 * a T_TNODE might be skipping any number of bits - its 'pos' need
Robert Olsson19baf832005-06-21 12:43:18 -07001036 * not be the parent's 'pos'+'bits'!
1037 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001038 * If it does match the current key, get pos/bits from it, extract
Robert Olsson19baf832005-06-21 12:43:18 -07001039 * the index from our key, push the T_TNODE and walk the tree.
1040 *
1041 * If it doesn't, we have to replace it with a new T_TNODE.
1042 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001043 * If we point to a T_LEAF, it might or might not have the same key
1044 * as we do. If it does, just change the value, update the T_LEAF's
1045 * value, and return it.
Robert Olsson19baf832005-06-21 12:43:18 -07001046 * If it doesn't, we need to replace it with a T_TNODE.
1047 */
1048
1049 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
1050 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -07001051
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001052 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001053
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001054 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001055 tp = tn;
Olof Johansson91b9a272005-08-09 20:24:39 -07001056 pos = tn->pos + tn->bits;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001057 n = tnode_get_child(tn,
1058 tkey_extract_bits(key,
1059 tn->pos,
1060 tn->bits));
Robert Olsson19baf832005-06-21 12:43:18 -07001061
Stephen Hemminger06801912007-08-10 15:22:13 -07001062 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001063 } else
Robert Olsson19baf832005-06-21 12:43:18 -07001064 break;
1065 }
1066
1067 /*
1068 * n ----> NULL, LEAF or TNODE
1069 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001070 * tp is n's (parent) ----> NULL or TNODE
Robert Olsson19baf832005-06-21 12:43:18 -07001071 */
1072
Olof Johansson91b9a272005-08-09 20:24:39 -07001073 BUG_ON(tp && IS_LEAF(tp));
Robert Olsson19baf832005-06-21 12:43:18 -07001074
1075 /* Case 1: n is a leaf. Compare prefixes */
1076
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001077 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key)) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08001078 l = (struct leaf *) n;
Robert Olsson19baf832005-06-21 12:43:18 -07001079 li = leaf_info_new(plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001080
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001081 if (!li)
1082 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001083
1084 fa_head = &li->falh;
1085 insert_leaf_info(&l->list, li);
1086 goto done;
1087 }
Robert Olsson19baf832005-06-21 12:43:18 -07001088 l = leaf_new();
1089
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001090 if (!l)
1091 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001092
1093 l->key = key;
1094 li = leaf_info_new(plen);
1095
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001096 if (!li) {
Stephen Hemminger387a5482008-04-10 03:47:34 -07001097 free_leaf(l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001098 return NULL;
Robert Olssonf835e472005-06-28 15:00:39 -07001099 }
Robert Olsson19baf832005-06-21 12:43:18 -07001100
1101 fa_head = &li->falh;
1102 insert_leaf_info(&l->list, li);
1103
Robert Olsson19baf832005-06-21 12:43:18 -07001104 if (t->trie && n == NULL) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001105 /* Case 2: n is NULL, and will just insert a new leaf */
Robert Olsson19baf832005-06-21 12:43:18 -07001106
Stephen Hemminger06801912007-08-10 15:22:13 -07001107 node_set_parent((struct node *)l, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001108
Olof Johansson91b9a272005-08-09 20:24:39 -07001109 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1110 put_child(t, (struct tnode *)tp, cindex, (struct node *)l);
1111 } else {
1112 /* Case 3: n is a LEAF or a TNODE and the key doesn't match. */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001113 /*
1114 * Add a new tnode here
Robert Olsson19baf832005-06-21 12:43:18 -07001115 * first tnode need some special handling
1116 */
1117
1118 if (tp)
Olof Johansson91b9a272005-08-09 20:24:39 -07001119 pos = tp->pos+tp->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001120 else
Olof Johansson91b9a272005-08-09 20:24:39 -07001121 pos = 0;
1122
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001123 if (n) {
Robert Olsson19baf832005-06-21 12:43:18 -07001124 newpos = tkey_mismatch(key, pos, n->key);
1125 tn = tnode_new(n->key, newpos, 1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001126 } else {
Robert Olsson19baf832005-06-21 12:43:18 -07001127 newpos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001128 tn = tnode_new(key, newpos, 1); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001129 }
Robert Olsson19baf832005-06-21 12:43:18 -07001130
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001131 if (!tn) {
Robert Olssonf835e472005-06-28 15:00:39 -07001132 free_leaf_info(li);
Stephen Hemminger387a5482008-04-10 03:47:34 -07001133 free_leaf(l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001134 return NULL;
Olof Johansson91b9a272005-08-09 20:24:39 -07001135 }
1136
Stephen Hemminger06801912007-08-10 15:22:13 -07001137 node_set_parent((struct node *)tn, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001138
Olof Johansson91b9a272005-08-09 20:24:39 -07001139 missbit = tkey_extract_bits(key, newpos, 1);
Robert Olsson19baf832005-06-21 12:43:18 -07001140 put_child(t, tn, missbit, (struct node *)l);
1141 put_child(t, tn, 1-missbit, n);
1142
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001143 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001144 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001145 put_child(t, (struct tnode *)tp, cindex,
1146 (struct node *)tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001147 } else {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001148 rcu_assign_pointer(t->trie, (struct node *)tn);
Robert Olsson19baf832005-06-21 12:43:18 -07001149 tp = tn;
1150 }
1151 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001152
1153 if (tp && tp->pos + tp->bits > 32)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001154 pr_warning("fib_trie"
1155 " tp=%p pos=%d, bits=%d, key=%0x plen=%d\n",
1156 tp, tp->pos, tp->bits, key, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001157
Robert Olsson19baf832005-06-21 12:43:18 -07001158 /* Rebalance the trie */
Robert Olsson2373ce12005-08-25 13:01:29 -07001159
1160 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Robert Olssonf835e472005-06-28 15:00:39 -07001161done:
Robert Olsson19baf832005-06-21 12:43:18 -07001162 return fa_head;
1163}
1164
Robert Olssond562f1f2007-03-26 14:22:22 -07001165/*
1166 * Caller must hold RTNL.
1167 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001168static int fn_trie_insert(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001169{
1170 struct trie *t = (struct trie *) tb->tb_data;
1171 struct fib_alias *fa, *new_fa;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001172 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001173 struct fib_info *fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001174 int plen = cfg->fc_dst_len;
1175 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001176 u32 key, mask;
1177 int err;
1178 struct leaf *l;
1179
1180 if (plen > 32)
1181 return -EINVAL;
1182
Thomas Graf4e902c52006-08-17 18:14:52 -07001183 key = ntohl(cfg->fc_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001184
Patrick McHardy2dfe55b2006-08-10 23:08:33 -07001185 pr_debug("Insert table=%u %08x/%d\n", tb->tb_id, key, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001186
Olof Johansson91b9a272005-08-09 20:24:39 -07001187 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001188
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001189 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001190 return -EINVAL;
1191
1192 key = key & mask;
1193
Thomas Graf4e902c52006-08-17 18:14:52 -07001194 fi = fib_create_info(cfg);
1195 if (IS_ERR(fi)) {
1196 err = PTR_ERR(fi);
Robert Olsson19baf832005-06-21 12:43:18 -07001197 goto err;
Thomas Graf4e902c52006-08-17 18:14:52 -07001198 }
Robert Olsson19baf832005-06-21 12:43:18 -07001199
1200 l = fib_find_node(t, key);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001201 fa = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001202
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001203 if (l) {
Robert Olsson19baf832005-06-21 12:43:18 -07001204 fa_head = get_fa_head(l, plen);
1205 fa = fib_find_alias(fa_head, tos, fi->fib_priority);
1206 }
1207
1208 /* Now fa, if non-NULL, points to the first fib alias
1209 * with the same keys [prefix,tos,priority], if such key already
1210 * exists or to the node before which we will insert new one.
1211 *
1212 * If fa is NULL, we will need to allocate a new one and
1213 * insert to the head of f.
1214 *
1215 * If f is NULL, no fib node matched the destination key
1216 * and we need to allocate a new one of those as well.
1217 */
1218
Julian Anastasov936f6f82008-01-28 21:18:06 -08001219 if (fa && fa->fa_tos == tos &&
1220 fa->fa_info->fib_priority == fi->fib_priority) {
1221 struct fib_alias *fa_first, *fa_match;
Robert Olsson19baf832005-06-21 12:43:18 -07001222
1223 err = -EEXIST;
Thomas Graf4e902c52006-08-17 18:14:52 -07001224 if (cfg->fc_nlflags & NLM_F_EXCL)
Robert Olsson19baf832005-06-21 12:43:18 -07001225 goto out;
1226
Julian Anastasov936f6f82008-01-28 21:18:06 -08001227 /* We have 2 goals:
1228 * 1. Find exact match for type, scope, fib_info to avoid
1229 * duplicate routes
1230 * 2. Find next 'fa' (or head), NLM_F_APPEND inserts before it
1231 */
1232 fa_match = NULL;
1233 fa_first = fa;
1234 fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list);
1235 list_for_each_entry_continue(fa, fa_head, fa_list) {
1236 if (fa->fa_tos != tos)
1237 break;
1238 if (fa->fa_info->fib_priority != fi->fib_priority)
1239 break;
1240 if (fa->fa_type == cfg->fc_type &&
1241 fa->fa_scope == cfg->fc_scope &&
1242 fa->fa_info == fi) {
1243 fa_match = fa;
1244 break;
1245 }
1246 }
1247
Thomas Graf4e902c52006-08-17 18:14:52 -07001248 if (cfg->fc_nlflags & NLM_F_REPLACE) {
Robert Olsson19baf832005-06-21 12:43:18 -07001249 struct fib_info *fi_drop;
1250 u8 state;
1251
Julian Anastasov936f6f82008-01-28 21:18:06 -08001252 fa = fa_first;
1253 if (fa_match) {
1254 if (fa == fa_match)
1255 err = 0;
Joonwoo Park67250332008-01-18 03:45:18 -08001256 goto out;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001257 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001258 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001259 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001260 if (new_fa == NULL)
1261 goto out;
Robert Olsson19baf832005-06-21 12:43:18 -07001262
1263 fi_drop = fa->fa_info;
Robert Olsson2373ce12005-08-25 13:01:29 -07001264 new_fa->fa_tos = fa->fa_tos;
1265 new_fa->fa_info = fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001266 new_fa->fa_type = cfg->fc_type;
1267 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001268 state = fa->fa_state;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001269 new_fa->fa_state = state & ~FA_S_ACCESSED;
Robert Olsson19baf832005-06-21 12:43:18 -07001270
Robert Olsson2373ce12005-08-25 13:01:29 -07001271 list_replace_rcu(&fa->fa_list, &new_fa->fa_list);
1272 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001273
1274 fib_release_info(fi_drop);
1275 if (state & FA_S_ACCESSED)
Olof Johansson91b9a272005-08-09 20:24:39 -07001276 rt_cache_flush(-1);
Milan Kocianb8f55832007-05-23 14:55:06 -07001277 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen,
1278 tb->tb_id, &cfg->fc_nlinfo, NLM_F_REPLACE);
Robert Olsson19baf832005-06-21 12:43:18 -07001279
Olof Johansson91b9a272005-08-09 20:24:39 -07001280 goto succeeded;
Robert Olsson19baf832005-06-21 12:43:18 -07001281 }
1282 /* Error if we find a perfect match which
1283 * uses the same scope, type, and nexthop
1284 * information.
1285 */
Julian Anastasov936f6f82008-01-28 21:18:06 -08001286 if (fa_match)
1287 goto out;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001288
Thomas Graf4e902c52006-08-17 18:14:52 -07001289 if (!(cfg->fc_nlflags & NLM_F_APPEND))
Julian Anastasov936f6f82008-01-28 21:18:06 -08001290 fa = fa_first;
Robert Olsson19baf832005-06-21 12:43:18 -07001291 }
1292 err = -ENOENT;
Thomas Graf4e902c52006-08-17 18:14:52 -07001293 if (!(cfg->fc_nlflags & NLM_F_CREATE))
Robert Olsson19baf832005-06-21 12:43:18 -07001294 goto out;
1295
1296 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001297 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson19baf832005-06-21 12:43:18 -07001298 if (new_fa == NULL)
1299 goto out;
1300
1301 new_fa->fa_info = fi;
1302 new_fa->fa_tos = tos;
Thomas Graf4e902c52006-08-17 18:14:52 -07001303 new_fa->fa_type = cfg->fc_type;
1304 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001305 new_fa->fa_state = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001306 /*
1307 * Insert new entry to the list.
1308 */
1309
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001310 if (!fa_head) {
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001311 fa_head = fib_insert_node(t, key, plen);
1312 if (unlikely(!fa_head)) {
1313 err = -ENOMEM;
Robert Olssonf835e472005-06-28 15:00:39 -07001314 goto out_free_new_fa;
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001315 }
Robert Olssonf835e472005-06-28 15:00:39 -07001316 }
Robert Olsson19baf832005-06-21 12:43:18 -07001317
Robert Olsson2373ce12005-08-25 13:01:29 -07001318 list_add_tail_rcu(&new_fa->fa_list,
1319 (fa ? &fa->fa_list : fa_head));
Robert Olsson19baf832005-06-21 12:43:18 -07001320
1321 rt_cache_flush(-1);
Thomas Graf4e902c52006-08-17 18:14:52 -07001322 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001323 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001324succeeded:
1325 return 0;
Robert Olssonf835e472005-06-28 15:00:39 -07001326
1327out_free_new_fa:
1328 kmem_cache_free(fn_alias_kmem, new_fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001329out:
1330 fib_release_info(fi);
Olof Johansson91b9a272005-08-09 20:24:39 -07001331err:
Robert Olsson19baf832005-06-21 12:43:18 -07001332 return err;
1333}
1334
Robert Olsson772cb712005-09-19 15:31:18 -07001335/* should be called with rcu_read_lock */
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001336static int check_leaf(struct trie *t, struct leaf *l,
1337 t_key key, const struct flowi *flp,
1338 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001339{
Robert Olsson19baf832005-06-21 12:43:18 -07001340 struct leaf_info *li;
1341 struct hlist_head *hhead = &l->list;
1342 struct hlist_node *node;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001343
Robert Olsson2373ce12005-08-25 13:01:29 -07001344 hlist_for_each_entry_rcu(li, node, hhead, hlist) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001345 int err;
1346 int plen = li->plen;
1347 __be32 mask = inet_make_mask(plen);
1348
Al Viro888454c2006-09-19 13:42:46 -07001349 if (l->key != (key & ntohl(mask)))
Robert Olsson19baf832005-06-21 12:43:18 -07001350 continue;
1351
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001352 err = fib_semantic_match(&li->falh, flp, res,
1353 htonl(l->key), mask, plen);
1354
Robert Olsson19baf832005-06-21 12:43:18 -07001355#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001356 if (err <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001357 t->stats.semantic_match_passed++;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001358 else
1359 t->stats.semantic_match_miss++;
Robert Olsson19baf832005-06-21 12:43:18 -07001360#endif
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001361 if (err <= 0)
Ben Hutchings2e655572008-07-10 16:52:52 -07001362 return err;
Robert Olsson19baf832005-06-21 12:43:18 -07001363 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001364
Ben Hutchings2e655572008-07-10 16:52:52 -07001365 return 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001366}
1367
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001368static int fn_trie_lookup(struct fib_table *tb, const struct flowi *flp,
1369 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001370{
1371 struct trie *t = (struct trie *) tb->tb_data;
Ben Hutchings2e655572008-07-10 16:52:52 -07001372 int ret;
Robert Olsson19baf832005-06-21 12:43:18 -07001373 struct node *n;
1374 struct tnode *pn;
1375 int pos, bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001376 t_key key = ntohl(flp->fl4_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001377 int chopped_off;
1378 t_key cindex = 0;
1379 int current_prefix_length = KEYLENGTH;
Olof Johansson91b9a272005-08-09 20:24:39 -07001380 struct tnode *cn;
1381 t_key node_prefix, key_prefix, pref_mismatch;
1382 int mp;
1383
Robert Olsson2373ce12005-08-25 13:01:29 -07001384 rcu_read_lock();
Robert Olsson19baf832005-06-21 12:43:18 -07001385
Robert Olsson2373ce12005-08-25 13:01:29 -07001386 n = rcu_dereference(t->trie);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001387 if (!n)
Robert Olsson19baf832005-06-21 12:43:18 -07001388 goto failed;
1389
1390#ifdef CONFIG_IP_FIB_TRIE_STATS
1391 t->stats.gets++;
1392#endif
1393
1394 /* Just a leaf? */
1395 if (IS_LEAF(n)) {
Ben Hutchings2e655572008-07-10 16:52:52 -07001396 ret = check_leaf(t, (struct leaf *)n, key, flp, res);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001397 goto found;
Robert Olsson19baf832005-06-21 12:43:18 -07001398 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001399
Robert Olsson19baf832005-06-21 12:43:18 -07001400 pn = (struct tnode *) n;
1401 chopped_off = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001402
Olof Johansson91b9a272005-08-09 20:24:39 -07001403 while (pn) {
Robert Olsson19baf832005-06-21 12:43:18 -07001404 pos = pn->pos;
1405 bits = pn->bits;
1406
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001407 if (!chopped_off)
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001408 cindex = tkey_extract_bits(mask_pfx(key, current_prefix_length),
1409 pos, bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001410
1411 n = tnode_get_child(pn, cindex);
1412
1413 if (n == NULL) {
1414#ifdef CONFIG_IP_FIB_TRIE_STATS
1415 t->stats.null_node_hit++;
1416#endif
1417 goto backtrace;
1418 }
1419
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001420 if (IS_LEAF(n)) {
Ben Hutchings2e655572008-07-10 16:52:52 -07001421 ret = check_leaf(t, (struct leaf *)n, key, flp, res);
1422 if (ret > 0)
Olof Johansson91b9a272005-08-09 20:24:39 -07001423 goto backtrace;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001424 goto found;
Olof Johansson91b9a272005-08-09 20:24:39 -07001425 }
1426
Olof Johansson91b9a272005-08-09 20:24:39 -07001427 cn = (struct tnode *)n;
1428
1429 /*
1430 * It's a tnode, and we can do some extra checks here if we
1431 * like, to avoid descending into a dead-end branch.
1432 * This tnode is in the parent's child array at index
1433 * key[p_pos..p_pos+p_bits] but potentially with some bits
1434 * chopped off, so in reality the index may be just a
1435 * subprefix, padded with zero at the end.
1436 * We can also take a look at any skipped bits in this
1437 * tnode - everything up to p_pos is supposed to be ok,
1438 * and the non-chopped bits of the index (se previous
1439 * paragraph) are also guaranteed ok, but the rest is
1440 * considered unknown.
1441 *
1442 * The skipped bits are key[pos+bits..cn->pos].
1443 */
1444
1445 /* If current_prefix_length < pos+bits, we are already doing
1446 * actual prefix matching, which means everything from
1447 * pos+(bits-chopped_off) onward must be zero along some
1448 * branch of this subtree - otherwise there is *no* valid
1449 * prefix present. Here we can only check the skipped
1450 * bits. Remember, since we have already indexed into the
1451 * parent's child array, we know that the bits we chopped of
1452 * *are* zero.
1453 */
1454
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001455 /* NOTA BENE: Checking only skipped bits
1456 for the new node here */
Olof Johansson91b9a272005-08-09 20:24:39 -07001457
1458 if (current_prefix_length < pos+bits) {
1459 if (tkey_extract_bits(cn->key, current_prefix_length,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001460 cn->pos - current_prefix_length)
1461 || !(cn->child[0]))
Olof Johansson91b9a272005-08-09 20:24:39 -07001462 goto backtrace;
1463 }
1464
1465 /*
1466 * If chopped_off=0, the index is fully validated and we
1467 * only need to look at the skipped bits for this, the new,
1468 * tnode. What we actually want to do is to find out if
1469 * these skipped bits match our key perfectly, or if we will
1470 * have to count on finding a matching prefix further down,
1471 * because if we do, we would like to have some way of
1472 * verifying the existence of such a prefix at this point.
1473 */
1474
1475 /* The only thing we can do at this point is to verify that
1476 * any such matching prefix can indeed be a prefix to our
1477 * key, and if the bits in the node we are inspecting that
1478 * do not match our key are not ZERO, this cannot be true.
1479 * Thus, find out where there is a mismatch (before cn->pos)
1480 * and verify that all the mismatching bits are zero in the
1481 * new tnode's key.
1482 */
1483
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001484 /*
1485 * Note: We aren't very concerned about the piece of
1486 * the key that precede pn->pos+pn->bits, since these
1487 * have already been checked. The bits after cn->pos
1488 * aren't checked since these are by definition
1489 * "unknown" at this point. Thus, what we want to see
1490 * is if we are about to enter the "prefix matching"
1491 * state, and in that case verify that the skipped
1492 * bits that will prevail throughout this subtree are
1493 * zero, as they have to be if we are to find a
1494 * matching prefix.
Olof Johansson91b9a272005-08-09 20:24:39 -07001495 */
1496
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001497 node_prefix = mask_pfx(cn->key, cn->pos);
1498 key_prefix = mask_pfx(key, cn->pos);
Olof Johansson91b9a272005-08-09 20:24:39 -07001499 pref_mismatch = key_prefix^node_prefix;
1500 mp = 0;
1501
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001502 /*
1503 * In short: If skipped bits in this node do not match
1504 * the search key, enter the "prefix matching"
1505 * state.directly.
Olof Johansson91b9a272005-08-09 20:24:39 -07001506 */
1507 if (pref_mismatch) {
1508 while (!(pref_mismatch & (1<<(KEYLENGTH-1)))) {
1509 mp++;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001510 pref_mismatch = pref_mismatch << 1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001511 }
1512 key_prefix = tkey_extract_bits(cn->key, mp, cn->pos-mp);
1513
1514 if (key_prefix != 0)
1515 goto backtrace;
1516
1517 if (current_prefix_length >= cn->pos)
1518 current_prefix_length = mp;
1519 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001520
Olof Johansson91b9a272005-08-09 20:24:39 -07001521 pn = (struct tnode *)n; /* Descend */
1522 chopped_off = 0;
1523 continue;
1524
Robert Olsson19baf832005-06-21 12:43:18 -07001525backtrace:
1526 chopped_off++;
1527
1528 /* As zero don't change the child key (cindex) */
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001529 while ((chopped_off <= pn->bits)
1530 && !(cindex & (1<<(chopped_off-1))))
Robert Olsson19baf832005-06-21 12:43:18 -07001531 chopped_off++;
Robert Olsson19baf832005-06-21 12:43:18 -07001532
1533 /* Decrease current_... with bits chopped off */
1534 if (current_prefix_length > pn->pos + pn->bits - chopped_off)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001535 current_prefix_length = pn->pos + pn->bits
1536 - chopped_off;
Olof Johansson91b9a272005-08-09 20:24:39 -07001537
Robert Olsson19baf832005-06-21 12:43:18 -07001538 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001539 * Either we do the actual chop off according or if we have
Robert Olsson19baf832005-06-21 12:43:18 -07001540 * chopped off all bits in this tnode walk up to our parent.
1541 */
1542
Olof Johansson91b9a272005-08-09 20:24:39 -07001543 if (chopped_off <= pn->bits) {
Robert Olsson19baf832005-06-21 12:43:18 -07001544 cindex &= ~(1 << (chopped_off-1));
Olof Johansson91b9a272005-08-09 20:24:39 -07001545 } else {
Stephen Hemminger06801912007-08-10 15:22:13 -07001546 struct tnode *parent = node_parent((struct node *) pn);
1547 if (!parent)
Robert Olsson19baf832005-06-21 12:43:18 -07001548 goto failed;
Olof Johansson91b9a272005-08-09 20:24:39 -07001549
Robert Olsson19baf832005-06-21 12:43:18 -07001550 /* Get Child's index */
Stephen Hemminger06801912007-08-10 15:22:13 -07001551 cindex = tkey_extract_bits(pn->key, parent->pos, parent->bits);
1552 pn = parent;
Robert Olsson19baf832005-06-21 12:43:18 -07001553 chopped_off = 0;
1554
1555#ifdef CONFIG_IP_FIB_TRIE_STATS
1556 t->stats.backtrack++;
1557#endif
1558 goto backtrace;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001559 }
Robert Olsson19baf832005-06-21 12:43:18 -07001560 }
1561failed:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001562 ret = 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001563found:
Robert Olsson2373ce12005-08-25 13:01:29 -07001564 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001565 return ret;
1566}
1567
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001568/*
1569 * Remove the leaf and return parent.
1570 */
1571static void trie_leaf_remove(struct trie *t, struct leaf *l)
Robert Olsson19baf832005-06-21 12:43:18 -07001572{
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001573 struct tnode *tp = node_parent((struct node *) l);
Robert Olsson19baf832005-06-21 12:43:18 -07001574
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001575 pr_debug("entering trie_leaf_remove(%p)\n", l);
Robert Olsson19baf832005-06-21 12:43:18 -07001576
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001577 if (tp) {
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001578 t_key cindex = tkey_extract_bits(l->key, tp->pos, tp->bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001579 put_child(t, (struct tnode *)tp, cindex, NULL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001580 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Olof Johansson91b9a272005-08-09 20:24:39 -07001581 } else
Robert Olsson2373ce12005-08-25 13:01:29 -07001582 rcu_assign_pointer(t->trie, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001583
Stephen Hemminger387a5482008-04-10 03:47:34 -07001584 free_leaf(l);
Robert Olsson19baf832005-06-21 12:43:18 -07001585}
1586
Robert Olssond562f1f2007-03-26 14:22:22 -07001587/*
1588 * Caller must hold RTNL.
1589 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001590static int fn_trie_delete(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001591{
1592 struct trie *t = (struct trie *) tb->tb_data;
1593 u32 key, mask;
Thomas Graf4e902c52006-08-17 18:14:52 -07001594 int plen = cfg->fc_dst_len;
1595 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001596 struct fib_alias *fa, *fa_to_delete;
1597 struct list_head *fa_head;
1598 struct leaf *l;
Olof Johansson91b9a272005-08-09 20:24:39 -07001599 struct leaf_info *li;
1600
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001601 if (plen > 32)
Robert Olsson19baf832005-06-21 12:43:18 -07001602 return -EINVAL;
1603
Thomas Graf4e902c52006-08-17 18:14:52 -07001604 key = ntohl(cfg->fc_dst);
Olof Johansson91b9a272005-08-09 20:24:39 -07001605 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001606
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001607 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001608 return -EINVAL;
1609
1610 key = key & mask;
1611 l = fib_find_node(t, key);
1612
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001613 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001614 return -ESRCH;
1615
1616 fa_head = get_fa_head(l, plen);
1617 fa = fib_find_alias(fa_head, tos, 0);
1618
1619 if (!fa)
1620 return -ESRCH;
1621
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001622 pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t);
Robert Olsson19baf832005-06-21 12:43:18 -07001623
1624 fa_to_delete = NULL;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001625 fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list);
1626 list_for_each_entry_continue(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001627 struct fib_info *fi = fa->fa_info;
1628
1629 if (fa->fa_tos != tos)
1630 break;
1631
Thomas Graf4e902c52006-08-17 18:14:52 -07001632 if ((!cfg->fc_type || fa->fa_type == cfg->fc_type) &&
1633 (cfg->fc_scope == RT_SCOPE_NOWHERE ||
1634 fa->fa_scope == cfg->fc_scope) &&
1635 (!cfg->fc_protocol ||
1636 fi->fib_protocol == cfg->fc_protocol) &&
1637 fib_nh_match(cfg, fi) == 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001638 fa_to_delete = fa;
1639 break;
1640 }
1641 }
1642
Olof Johansson91b9a272005-08-09 20:24:39 -07001643 if (!fa_to_delete)
1644 return -ESRCH;
Robert Olsson19baf832005-06-21 12:43:18 -07001645
Olof Johansson91b9a272005-08-09 20:24:39 -07001646 fa = fa_to_delete;
Thomas Graf4e902c52006-08-17 18:14:52 -07001647 rtmsg_fib(RTM_DELROUTE, htonl(key), fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001648 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001649
Olof Johansson91b9a272005-08-09 20:24:39 -07001650 l = fib_find_node(t, key);
Robert Olsson772cb712005-09-19 15:31:18 -07001651 li = find_leaf_info(l, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001652
Robert Olsson2373ce12005-08-25 13:01:29 -07001653 list_del_rcu(&fa->fa_list);
Robert Olsson19baf832005-06-21 12:43:18 -07001654
Olof Johansson91b9a272005-08-09 20:24:39 -07001655 if (list_empty(fa_head)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001656 hlist_del_rcu(&li->hlist);
Olof Johansson91b9a272005-08-09 20:24:39 -07001657 free_leaf_info(li);
Robert Olsson2373ce12005-08-25 13:01:29 -07001658 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001659
1660 if (hlist_empty(&l->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001661 trie_leaf_remove(t, l);
Olof Johansson91b9a272005-08-09 20:24:39 -07001662
1663 if (fa->fa_state & FA_S_ACCESSED)
1664 rt_cache_flush(-1);
1665
Robert Olsson2373ce12005-08-25 13:01:29 -07001666 fib_release_info(fa->fa_info);
1667 alias_free_mem_rcu(fa);
Olof Johansson91b9a272005-08-09 20:24:39 -07001668 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001669}
1670
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001671static int trie_flush_list(struct list_head *head)
Robert Olsson19baf832005-06-21 12:43:18 -07001672{
1673 struct fib_alias *fa, *fa_node;
1674 int found = 0;
1675
1676 list_for_each_entry_safe(fa, fa_node, head, fa_list) {
1677 struct fib_info *fi = fa->fa_info;
Robert Olsson19baf832005-06-21 12:43:18 -07001678
Robert Olsson2373ce12005-08-25 13:01:29 -07001679 if (fi && (fi->fib_flags & RTNH_F_DEAD)) {
1680 list_del_rcu(&fa->fa_list);
1681 fib_release_info(fa->fa_info);
1682 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001683 found++;
1684 }
1685 }
1686 return found;
1687}
1688
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001689static int trie_flush_leaf(struct leaf *l)
Robert Olsson19baf832005-06-21 12:43:18 -07001690{
1691 int found = 0;
1692 struct hlist_head *lih = &l->list;
1693 struct hlist_node *node, *tmp;
1694 struct leaf_info *li = NULL;
1695
1696 hlist_for_each_entry_safe(li, node, tmp, lih, hlist) {
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001697 found += trie_flush_list(&li->falh);
Robert Olsson19baf832005-06-21 12:43:18 -07001698
1699 if (list_empty(&li->falh)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001700 hlist_del_rcu(&li->hlist);
Robert Olsson19baf832005-06-21 12:43:18 -07001701 free_leaf_info(li);
1702 }
1703 }
1704 return found;
1705}
1706
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001707/*
1708 * Scan for the next right leaf starting at node p->child[idx]
1709 * Since we have back pointer, no recursion necessary.
1710 */
1711static struct leaf *leaf_walk_rcu(struct tnode *p, struct node *c)
Robert Olsson19baf832005-06-21 12:43:18 -07001712{
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001713 do {
1714 t_key idx;
Robert Olsson19baf832005-06-21 12:43:18 -07001715
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001716 if (c)
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001717 idx = tkey_extract_bits(c->key, p->pos, p->bits) + 1;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001718 else
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001719 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001720
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001721 while (idx < 1u << p->bits) {
1722 c = tnode_get_child_rcu(p, idx++);
Robert Olsson2373ce12005-08-25 13:01:29 -07001723 if (!c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001724 continue;
Robert Olsson19baf832005-06-21 12:43:18 -07001725
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001726 if (IS_LEAF(c)) {
1727 prefetch(p->child[idx]);
1728 return (struct leaf *) c;
Robert Olsson19baf832005-06-21 12:43:18 -07001729 }
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001730
1731 /* Rescan start scanning in new node */
1732 p = (struct tnode *) c;
1733 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001734 }
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001735
1736 /* Node empty, walk back up to parent */
Olof Johansson91b9a272005-08-09 20:24:39 -07001737 c = (struct node *) p;
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001738 } while ( (p = node_parent_rcu(c)) != NULL);
1739
1740 return NULL; /* Root of trie */
1741}
1742
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001743static struct leaf *trie_firstleaf(struct trie *t)
1744{
1745 struct tnode *n = (struct tnode *) rcu_dereference(t->trie);
1746
1747 if (!n)
1748 return NULL;
1749
1750 if (IS_LEAF(n)) /* trie is just a leaf */
1751 return (struct leaf *) n;
1752
1753 return leaf_walk_rcu(n, NULL);
1754}
1755
1756static struct leaf *trie_nextleaf(struct leaf *l)
1757{
1758 struct node *c = (struct node *) l;
1759 struct tnode *p = node_parent(c);
1760
1761 if (!p)
1762 return NULL; /* trie with just one leaf */
1763
1764 return leaf_walk_rcu(p, c);
Robert Olsson19baf832005-06-21 12:43:18 -07001765}
1766
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001767static struct leaf *trie_leafindex(struct trie *t, int index)
1768{
1769 struct leaf *l = trie_firstleaf(t);
1770
Stephen Hemmingerec28cf72008-02-11 21:12:49 -08001771 while (l && index-- > 0)
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001772 l = trie_nextleaf(l);
Stephen Hemmingerec28cf72008-02-11 21:12:49 -08001773
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001774 return l;
1775}
1776
1777
Robert Olssond562f1f2007-03-26 14:22:22 -07001778/*
1779 * Caller must hold RTNL.
1780 */
Robert Olsson19baf832005-06-21 12:43:18 -07001781static int fn_trie_flush(struct fib_table *tb)
1782{
1783 struct trie *t = (struct trie *) tb->tb_data;
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001784 struct leaf *l, *ll = NULL;
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001785 int found = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001786
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001787 for (l = trie_firstleaf(t); l; l = trie_nextleaf(l)) {
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001788 found += trie_flush_leaf(l);
Robert Olsson19baf832005-06-21 12:43:18 -07001789
1790 if (ll && hlist_empty(&ll->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001791 trie_leaf_remove(t, ll);
Robert Olsson19baf832005-06-21 12:43:18 -07001792 ll = l;
1793 }
1794
1795 if (ll && hlist_empty(&ll->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001796 trie_leaf_remove(t, ll);
Robert Olsson19baf832005-06-21 12:43:18 -07001797
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001798 pr_debug("trie_flush found=%d\n", found);
Robert Olsson19baf832005-06-21 12:43:18 -07001799 return found;
1800}
1801
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001802static void fn_trie_select_default(struct fib_table *tb,
1803 const struct flowi *flp,
1804 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001805{
1806 struct trie *t = (struct trie *) tb->tb_data;
1807 int order, last_idx;
1808 struct fib_info *fi = NULL;
1809 struct fib_info *last_resort;
1810 struct fib_alias *fa = NULL;
1811 struct list_head *fa_head;
1812 struct leaf *l;
1813
1814 last_idx = -1;
1815 last_resort = NULL;
1816 order = -1;
1817
Robert Olsson2373ce12005-08-25 13:01:29 -07001818 rcu_read_lock();
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001819
Robert Olsson19baf832005-06-21 12:43:18 -07001820 l = fib_find_node(t, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001821 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001822 goto out;
1823
1824 fa_head = get_fa_head(l, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001825 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001826 goto out;
1827
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001828 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001829 goto out;
1830
Robert Olsson2373ce12005-08-25 13:01:29 -07001831 list_for_each_entry_rcu(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001832 struct fib_info *next_fi = fa->fa_info;
Olof Johansson91b9a272005-08-09 20:24:39 -07001833
Robert Olsson19baf832005-06-21 12:43:18 -07001834 if (fa->fa_scope != res->scope ||
1835 fa->fa_type != RTN_UNICAST)
1836 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -07001837
Robert Olsson19baf832005-06-21 12:43:18 -07001838 if (next_fi->fib_priority > res->fi->fib_priority)
1839 break;
1840 if (!next_fi->fib_nh[0].nh_gw ||
1841 next_fi->fib_nh[0].nh_scope != RT_SCOPE_LINK)
1842 continue;
1843 fa->fa_state |= FA_S_ACCESSED;
Olof Johansson91b9a272005-08-09 20:24:39 -07001844
Robert Olsson19baf832005-06-21 12:43:18 -07001845 if (fi == NULL) {
1846 if (next_fi != res->fi)
1847 break;
1848 } else if (!fib_detect_death(fi, order, &last_resort,
Denis V. Lunev971b8932007-12-08 00:32:23 -08001849 &last_idx, tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001850 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001851 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001852 goto out;
1853 }
1854 fi = next_fi;
1855 order++;
1856 }
1857 if (order <= 0 || fi == NULL) {
Denis V. Lunev971b8932007-12-08 00:32:23 -08001858 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001859 goto out;
1860 }
1861
Denis V. Lunev971b8932007-12-08 00:32:23 -08001862 if (!fib_detect_death(fi, order, &last_resort, &last_idx,
1863 tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001864 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001865 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001866 goto out;
1867 }
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001868 if (last_idx >= 0)
1869 fib_result_assign(res, last_resort);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001870 tb->tb_default = last_idx;
1871out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001872 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001873}
1874
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001875static int fn_trie_dump_fa(t_key key, int plen, struct list_head *fah,
1876 struct fib_table *tb,
Robert Olsson19baf832005-06-21 12:43:18 -07001877 struct sk_buff *skb, struct netlink_callback *cb)
1878{
1879 int i, s_i;
1880 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07001881 __be32 xkey = htonl(key);
Robert Olsson19baf832005-06-21 12:43:18 -07001882
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001883 s_i = cb->args[5];
Robert Olsson19baf832005-06-21 12:43:18 -07001884 i = 0;
1885
Robert Olsson2373ce12005-08-25 13:01:29 -07001886 /* rcu_read_lock is hold by caller */
1887
1888 list_for_each_entry_rcu(fa, fah, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001889 if (i < s_i) {
1890 i++;
1891 continue;
1892 }
Robert Olsson19baf832005-06-21 12:43:18 -07001893
1894 if (fib_dump_info(skb, NETLINK_CB(cb->skb).pid,
1895 cb->nlh->nlmsg_seq,
1896 RTM_NEWROUTE,
1897 tb->tb_id,
1898 fa->fa_type,
1899 fa->fa_scope,
Thomas Grafbe403ea2006-08-17 18:15:17 -07001900 xkey,
Robert Olsson19baf832005-06-21 12:43:18 -07001901 plen,
1902 fa->fa_tos,
Stephen Hemminger64347f72008-01-22 21:55:01 -08001903 fa->fa_info, NLM_F_MULTI) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001904 cb->args[5] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001905 return -1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001906 }
Robert Olsson19baf832005-06-21 12:43:18 -07001907 i++;
1908 }
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001909 cb->args[5] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001910 return skb->len;
1911}
1912
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001913static int fn_trie_dump_leaf(struct leaf *l, struct fib_table *tb,
1914 struct sk_buff *skb, struct netlink_callback *cb)
Robert Olsson19baf832005-06-21 12:43:18 -07001915{
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001916 struct leaf_info *li;
1917 struct hlist_node *node;
1918 int i, s_i;
Robert Olsson19baf832005-06-21 12:43:18 -07001919
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001920 s_i = cb->args[4];
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001921 i = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001922
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001923 /* rcu_read_lock is hold by caller */
1924 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
1925 if (i < s_i) {
1926 i++;
Robert Olsson19baf832005-06-21 12:43:18 -07001927 continue;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001928 }
Robert Olsson19baf832005-06-21 12:43:18 -07001929
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001930 if (i > s_i)
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001931 cb->args[5] = 0;
Olof Johansson91b9a272005-08-09 20:24:39 -07001932
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001933 if (list_empty(&li->falh))
Robert Olsson19baf832005-06-21 12:43:18 -07001934 continue;
1935
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001936 if (fn_trie_dump_fa(l->key, li->plen, &li->falh, tb, skb, cb) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001937 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001938 return -1;
1939 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001940 i++;
Robert Olsson19baf832005-06-21 12:43:18 -07001941 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001942
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001943 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001944 return skb->len;
1945}
1946
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001947static int fn_trie_dump(struct fib_table *tb, struct sk_buff *skb,
1948 struct netlink_callback *cb)
Robert Olsson19baf832005-06-21 12:43:18 -07001949{
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001950 struct leaf *l;
Robert Olsson19baf832005-06-21 12:43:18 -07001951 struct trie *t = (struct trie *) tb->tb_data;
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001952 t_key key = cb->args[2];
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001953 int count = cb->args[3];
Robert Olsson19baf832005-06-21 12:43:18 -07001954
Robert Olsson2373ce12005-08-25 13:01:29 -07001955 rcu_read_lock();
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001956 /* Dump starting at last key.
1957 * Note: 0.0.0.0/0 (ie default) is first key.
1958 */
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001959 if (count == 0)
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001960 l = trie_firstleaf(t);
1961 else {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001962 /* Normally, continue from last key, but if that is missing
1963 * fallback to using slow rescan
1964 */
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001965 l = fib_find_node(t, key);
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001966 if (!l)
1967 l = trie_leafindex(t, count);
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001968 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001969
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001970 while (l) {
1971 cb->args[2] = l->key;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001972 if (fn_trie_dump_leaf(l, tb, skb, cb) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001973 cb->args[3] = count;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001974 rcu_read_unlock();
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001975 return -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001976 }
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001977
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001978 ++count;
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001979 l = trie_nextleaf(l);
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001980 memset(&cb->args[4], 0,
1981 sizeof(cb->args) - 4*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001982 }
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001983 cb->args[3] = count;
Robert Olsson2373ce12005-08-25 13:01:29 -07001984 rcu_read_unlock();
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001985
Robert Olsson19baf832005-06-21 12:43:18 -07001986 return skb->len;
Robert Olsson19baf832005-06-21 12:43:18 -07001987}
1988
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08001989void __init fib_hash_init(void)
1990{
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001991 fn_alias_kmem = kmem_cache_create("ip_fib_alias",
1992 sizeof(struct fib_alias),
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -08001993 0, SLAB_PANIC, NULL);
1994
1995 trie_leaf_kmem = kmem_cache_create("ip_fib_trie",
1996 max(sizeof(struct leaf),
1997 sizeof(struct leaf_info)),
1998 0, SLAB_PANIC, NULL);
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08001999}
Robert Olsson19baf832005-06-21 12:43:18 -07002000
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08002001
2002/* Fix more generic FIB names for init later */
2003struct fib_table *fib_hash_table(u32 id)
Robert Olsson19baf832005-06-21 12:43:18 -07002004{
2005 struct fib_table *tb;
2006 struct trie *t;
2007
Robert Olsson19baf832005-06-21 12:43:18 -07002008 tb = kmalloc(sizeof(struct fib_table) + sizeof(struct trie),
2009 GFP_KERNEL);
2010 if (tb == NULL)
2011 return NULL;
2012
2013 tb->tb_id = id;
Denis V. Lunev971b8932007-12-08 00:32:23 -08002014 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07002015 tb->tb_lookup = fn_trie_lookup;
2016 tb->tb_insert = fn_trie_insert;
2017 tb->tb_delete = fn_trie_delete;
2018 tb->tb_flush = fn_trie_flush;
2019 tb->tb_select_default = fn_trie_select_default;
2020 tb->tb_dump = fn_trie_dump;
Robert Olsson19baf832005-06-21 12:43:18 -07002021
2022 t = (struct trie *) tb->tb_data;
Stephen Hemmingerc28a1cf2008-01-12 20:49:13 -08002023 memset(t, 0, sizeof(*t));
Robert Olsson19baf832005-06-21 12:43:18 -07002024
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002025 if (id == RT_TABLE_LOCAL)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002026 pr_info("IPv4 FIB: Using LC-trie version %s\n", VERSION);
Robert Olsson19baf832005-06-21 12:43:18 -07002027
2028 return tb;
2029}
2030
Robert Olsson19baf832005-06-21 12:43:18 -07002031#ifdef CONFIG_PROC_FS
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002032/* Depth first Trie walk iterator */
2033struct fib_trie_iter {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002034 struct seq_net_private p;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002035 struct fib_table *tb;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002036 struct tnode *tnode;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002037 unsigned index;
2038 unsigned depth;
2039};
Robert Olsson19baf832005-06-21 12:43:18 -07002040
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002041static struct node *fib_trie_get_next(struct fib_trie_iter *iter)
Robert Olsson19baf832005-06-21 12:43:18 -07002042{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002043 struct tnode *tn = iter->tnode;
2044 unsigned cindex = iter->index;
2045 struct tnode *p;
2046
Eric W. Biederman6640e692007-01-24 14:42:04 -08002047 /* A single entry routing table */
2048 if (!tn)
2049 return NULL;
2050
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002051 pr_debug("get_next iter={node=%p index=%d depth=%d}\n",
2052 iter->tnode, iter->index, iter->depth);
2053rescan:
2054 while (cindex < (1<<tn->bits)) {
Eric Dumazetb59cfbf2008-01-18 03:31:36 -08002055 struct node *n = tnode_get_child_rcu(tn, cindex);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002056
2057 if (n) {
2058 if (IS_LEAF(n)) {
2059 iter->tnode = tn;
2060 iter->index = cindex + 1;
2061 } else {
2062 /* push down one level */
2063 iter->tnode = (struct tnode *) n;
2064 iter->index = 0;
2065 ++iter->depth;
2066 }
2067 return n;
2068 }
2069
2070 ++cindex;
2071 }
2072
2073 /* Current node exhausted, pop back up */
Eric Dumazetb59cfbf2008-01-18 03:31:36 -08002074 p = node_parent_rcu((struct node *)tn);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002075 if (p) {
2076 cindex = tkey_extract_bits(tn->key, p->pos, p->bits)+1;
2077 tn = p;
2078 --iter->depth;
2079 goto rescan;
2080 }
2081
2082 /* got root? */
Robert Olsson19baf832005-06-21 12:43:18 -07002083 return NULL;
2084}
2085
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002086static struct node *fib_trie_get_first(struct fib_trie_iter *iter,
2087 struct trie *t)
Robert Olsson19baf832005-06-21 12:43:18 -07002088{
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002089 struct node *n;
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002090
Stephen Hemminger132adf52007-03-08 20:44:43 -08002091 if (!t)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002092 return NULL;
2093
2094 n = rcu_dereference(t->trie);
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002095 if (!n)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002096 return NULL;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002097
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002098 if (IS_TNODE(n)) {
2099 iter->tnode = (struct tnode *) n;
2100 iter->index = 0;
2101 iter->depth = 1;
2102 } else {
2103 iter->tnode = NULL;
2104 iter->index = 0;
2105 iter->depth = 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002106 }
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002107
2108 return n;
Robert Olsson19baf832005-06-21 12:43:18 -07002109}
2110
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002111static void trie_collect_stats(struct trie *t, struct trie_stat *s)
Robert Olsson19baf832005-06-21 12:43:18 -07002112{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002113 struct node *n;
2114 struct fib_trie_iter iter;
Robert Olsson19baf832005-06-21 12:43:18 -07002115
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002116 memset(s, 0, sizeof(*s));
Robert Olsson19baf832005-06-21 12:43:18 -07002117
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002118 rcu_read_lock();
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002119 for (n = fib_trie_get_first(&iter, t); n; n = fib_trie_get_next(&iter)) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002120 if (IS_LEAF(n)) {
Stephen Hemminger93672292008-01-22 21:54:05 -08002121 struct leaf *l = (struct leaf *)n;
2122 struct leaf_info *li;
2123 struct hlist_node *tmp;
2124
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002125 s->leaves++;
2126 s->totdepth += iter.depth;
2127 if (iter.depth > s->maxdepth)
2128 s->maxdepth = iter.depth;
Stephen Hemminger93672292008-01-22 21:54:05 -08002129
2130 hlist_for_each_entry_rcu(li, tmp, &l->list, hlist)
2131 ++s->prefixes;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002132 } else {
2133 const struct tnode *tn = (const struct tnode *) n;
2134 int i;
Robert Olsson19baf832005-06-21 12:43:18 -07002135
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002136 s->tnodes++;
Stephen Hemminger132adf52007-03-08 20:44:43 -08002137 if (tn->bits < MAX_STAT_DEPTH)
Robert Olsson06ef9212006-03-20 21:35:01 -08002138 s->nodesizes[tn->bits]++;
2139
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002140 for (i = 0; i < (1<<tn->bits); i++)
2141 if (!tn->child[i])
2142 s->nullpointers++;
2143 }
2144 }
2145 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002146}
2147
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002148/*
Robert Olsson19baf832005-06-21 12:43:18 -07002149 * This outputs /proc/net/fib_triestats
Robert Olsson19baf832005-06-21 12:43:18 -07002150 */
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002151static void trie_show_stats(struct seq_file *seq, struct trie_stat *stat)
Robert Olsson19baf832005-06-21 12:43:18 -07002152{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002153 unsigned i, max, pointers, bytes, avdepth;
Robert Olsson19baf832005-06-21 12:43:18 -07002154
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002155 if (stat->leaves)
2156 avdepth = stat->totdepth*100 / stat->leaves;
2157 else
2158 avdepth = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002159
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002160 seq_printf(seq, "\tAver depth: %u.%02d\n",
2161 avdepth / 100, avdepth % 100);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002162 seq_printf(seq, "\tMax depth: %u\n", stat->maxdepth);
Robert Olsson19baf832005-06-21 12:43:18 -07002163
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002164 seq_printf(seq, "\tLeaves: %u\n", stat->leaves);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002165 bytes = sizeof(struct leaf) * stat->leaves;
Stephen Hemminger93672292008-01-22 21:54:05 -08002166
2167 seq_printf(seq, "\tPrefixes: %u\n", stat->prefixes);
2168 bytes += sizeof(struct leaf_info) * stat->prefixes;
2169
Stephen Hemminger187b5182008-01-12 20:55:55 -08002170 seq_printf(seq, "\tInternal nodes: %u\n\t", stat->tnodes);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002171 bytes += sizeof(struct tnode) * stat->tnodes;
Robert Olsson19baf832005-06-21 12:43:18 -07002172
Robert Olsson06ef9212006-03-20 21:35:01 -08002173 max = MAX_STAT_DEPTH;
2174 while (max > 0 && stat->nodesizes[max-1] == 0)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002175 max--;
Robert Olsson19baf832005-06-21 12:43:18 -07002176
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002177 pointers = 0;
2178 for (i = 1; i <= max; i++)
2179 if (stat->nodesizes[i] != 0) {
Stephen Hemminger187b5182008-01-12 20:55:55 -08002180 seq_printf(seq, " %u: %u", i, stat->nodesizes[i]);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002181 pointers += (1<<i) * stat->nodesizes[i];
2182 }
2183 seq_putc(seq, '\n');
Stephen Hemminger187b5182008-01-12 20:55:55 -08002184 seq_printf(seq, "\tPointers: %u\n", pointers);
Robert Olsson19baf832005-06-21 12:43:18 -07002185
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002186 bytes += sizeof(struct node *) * pointers;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002187 seq_printf(seq, "Null ptrs: %u\n", stat->nullpointers);
2188 seq_printf(seq, "Total size: %u kB\n", (bytes + 1023) / 1024);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002189}
Robert Olsson19baf832005-06-21 12:43:18 -07002190
2191#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002192static void trie_show_usage(struct seq_file *seq,
2193 const struct trie_use_stats *stats)
2194{
2195 seq_printf(seq, "\nCounters:\n---------\n");
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002196 seq_printf(seq, "gets = %u\n", stats->gets);
2197 seq_printf(seq, "backtracks = %u\n", stats->backtrack);
2198 seq_printf(seq, "semantic match passed = %u\n",
2199 stats->semantic_match_passed);
2200 seq_printf(seq, "semantic match miss = %u\n",
2201 stats->semantic_match_miss);
2202 seq_printf(seq, "null node hit= %u\n", stats->null_node_hit);
2203 seq_printf(seq, "skipped node resize = %u\n\n",
2204 stats->resize_node_skipped);
Robert Olsson19baf832005-06-21 12:43:18 -07002205}
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002206#endif /* CONFIG_IP_FIB_TRIE_STATS */
2207
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002208static void fib_table_print(struct seq_file *seq, struct fib_table *tb)
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002209{
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002210 if (tb->tb_id == RT_TABLE_LOCAL)
2211 seq_puts(seq, "Local:\n");
2212 else if (tb->tb_id == RT_TABLE_MAIN)
2213 seq_puts(seq, "Main:\n");
2214 else
2215 seq_printf(seq, "Id %d:\n", tb->tb_id);
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002216}
Robert Olsson19baf832005-06-21 12:43:18 -07002217
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002218
Robert Olsson19baf832005-06-21 12:43:18 -07002219static int fib_triestat_seq_show(struct seq_file *seq, void *v)
2220{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002221 struct net *net = (struct net *)seq->private;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002222 unsigned int h;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002223
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002224 seq_printf(seq,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002225 "Basic info: size of leaf:"
2226 " %Zd bytes, size of tnode: %Zd bytes.\n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002227 sizeof(struct leaf), sizeof(struct tnode));
Olof Johansson91b9a272005-08-09 20:24:39 -07002228
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002229 for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
2230 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2231 struct hlist_node *node;
2232 struct fib_table *tb;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002233
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002234 hlist_for_each_entry_rcu(tb, node, head, tb_hlist) {
2235 struct trie *t = (struct trie *) tb->tb_data;
2236 struct trie_stat stat;
2237
2238 if (!t)
2239 continue;
2240
2241 fib_table_print(seq, tb);
2242
2243 trie_collect_stats(t, &stat);
2244 trie_show_stats(seq, &stat);
2245#ifdef CONFIG_IP_FIB_TRIE_STATS
2246 trie_show_usage(seq, &t->stats);
2247#endif
2248 }
2249 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002250
Robert Olsson19baf832005-06-21 12:43:18 -07002251 return 0;
2252}
2253
Robert Olsson19baf832005-06-21 12:43:18 -07002254static int fib_triestat_seq_open(struct inode *inode, struct file *file)
2255{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002256 int err;
2257 struct net *net;
2258
2259 net = get_proc_net(inode);
2260 if (net == NULL)
2261 return -ENXIO;
2262 err = single_open(file, fib_triestat_seq_show, net);
2263 if (err < 0) {
2264 put_net(net);
2265 return err;
2266 }
2267 return 0;
2268}
2269
2270static int fib_triestat_seq_release(struct inode *ino, struct file *f)
2271{
2272 struct seq_file *seq = f->private_data;
2273 put_net(seq->private);
2274 return single_release(ino, f);
Robert Olsson19baf832005-06-21 12:43:18 -07002275}
2276
Arjan van de Ven9a321442007-02-12 00:55:35 -08002277static const struct file_operations fib_triestat_fops = {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002278 .owner = THIS_MODULE,
2279 .open = fib_triestat_seq_open,
2280 .read = seq_read,
2281 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002282 .release = fib_triestat_seq_release,
Robert Olsson19baf832005-06-21 12:43:18 -07002283};
2284
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002285static struct node *fib_trie_get_idx(struct seq_file *seq, loff_t pos)
Robert Olsson19baf832005-06-21 12:43:18 -07002286{
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002287 struct fib_trie_iter *iter = seq->private;
2288 struct net *net = seq_file_net(seq);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002289 loff_t idx = 0;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002290 unsigned int h;
Robert Olsson19baf832005-06-21 12:43:18 -07002291
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002292 for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
2293 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2294 struct hlist_node *node;
2295 struct fib_table *tb;
2296
2297 hlist_for_each_entry_rcu(tb, node, head, tb_hlist) {
2298 struct node *n;
2299
2300 for (n = fib_trie_get_first(iter,
2301 (struct trie *) tb->tb_data);
2302 n; n = fib_trie_get_next(iter))
2303 if (pos == idx++) {
2304 iter->tb = tb;
2305 return n;
2306 }
2307 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002308 }
Robert Olsson19baf832005-06-21 12:43:18 -07002309
Robert Olsson19baf832005-06-21 12:43:18 -07002310 return NULL;
2311}
2312
2313static void *fib_trie_seq_start(struct seq_file *seq, loff_t *pos)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002314 __acquires(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002315{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002316 rcu_read_lock();
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002317 return fib_trie_get_idx(seq, *pos);
Robert Olsson19baf832005-06-21 12:43:18 -07002318}
2319
2320static void *fib_trie_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2321{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002322 struct fib_trie_iter *iter = seq->private;
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002323 struct net *net = seq_file_net(seq);
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002324 struct fib_table *tb = iter->tb;
2325 struct hlist_node *tb_node;
2326 unsigned int h;
2327 struct node *n;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002328
Robert Olsson19baf832005-06-21 12:43:18 -07002329 ++*pos;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002330 /* next node in same table */
2331 n = fib_trie_get_next(iter);
2332 if (n)
2333 return n;
Olof Johansson91b9a272005-08-09 20:24:39 -07002334
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002335 /* walk rest of this hash chain */
2336 h = tb->tb_id & (FIB_TABLE_HASHSZ - 1);
2337 while ( (tb_node = rcu_dereference(tb->tb_hlist.next)) ) {
2338 tb = hlist_entry(tb_node, struct fib_table, tb_hlist);
2339 n = fib_trie_get_first(iter, (struct trie *) tb->tb_data);
2340 if (n)
2341 goto found;
2342 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002343
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002344 /* new hash chain */
2345 while (++h < FIB_TABLE_HASHSZ) {
2346 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2347 hlist_for_each_entry_rcu(tb, tb_node, head, tb_hlist) {
2348 n = fib_trie_get_first(iter, (struct trie *) tb->tb_data);
2349 if (n)
2350 goto found;
2351 }
2352 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002353 return NULL;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002354
2355found:
2356 iter->tb = tb;
2357 return n;
Robert Olsson19baf832005-06-21 12:43:18 -07002358}
2359
2360static void fib_trie_seq_stop(struct seq_file *seq, void *v)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002361 __releases(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002362{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002363 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002364}
2365
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002366static void seq_indent(struct seq_file *seq, int n)
2367{
2368 while (n-- > 0) seq_puts(seq, " ");
2369}
Robert Olsson19baf832005-06-21 12:43:18 -07002370
Eric Dumazet28d36e32008-01-14 23:09:56 -08002371static inline const char *rtn_scope(char *buf, size_t len, enum rt_scope_t s)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002372{
Stephen Hemminger132adf52007-03-08 20:44:43 -08002373 switch (s) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002374 case RT_SCOPE_UNIVERSE: return "universe";
2375 case RT_SCOPE_SITE: return "site";
2376 case RT_SCOPE_LINK: return "link";
2377 case RT_SCOPE_HOST: return "host";
2378 case RT_SCOPE_NOWHERE: return "nowhere";
2379 default:
Eric Dumazet28d36e32008-01-14 23:09:56 -08002380 snprintf(buf, len, "scope=%d", s);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002381 return buf;
2382 }
2383}
2384
2385static const char *rtn_type_names[__RTN_MAX] = {
2386 [RTN_UNSPEC] = "UNSPEC",
2387 [RTN_UNICAST] = "UNICAST",
2388 [RTN_LOCAL] = "LOCAL",
2389 [RTN_BROADCAST] = "BROADCAST",
2390 [RTN_ANYCAST] = "ANYCAST",
2391 [RTN_MULTICAST] = "MULTICAST",
2392 [RTN_BLACKHOLE] = "BLACKHOLE",
2393 [RTN_UNREACHABLE] = "UNREACHABLE",
2394 [RTN_PROHIBIT] = "PROHIBIT",
2395 [RTN_THROW] = "THROW",
2396 [RTN_NAT] = "NAT",
2397 [RTN_XRESOLVE] = "XRESOLVE",
2398};
2399
Eric Dumazet28d36e32008-01-14 23:09:56 -08002400static inline const char *rtn_type(char *buf, size_t len, unsigned t)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002401{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002402 if (t < __RTN_MAX && rtn_type_names[t])
2403 return rtn_type_names[t];
Eric Dumazet28d36e32008-01-14 23:09:56 -08002404 snprintf(buf, len, "type %u", t);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002405 return buf;
2406}
2407
2408/* Pretty print the trie */
Robert Olsson19baf832005-06-21 12:43:18 -07002409static int fib_trie_seq_show(struct seq_file *seq, void *v)
2410{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002411 const struct fib_trie_iter *iter = seq->private;
2412 struct node *n = v;
Robert Olsson19baf832005-06-21 12:43:18 -07002413
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002414 if (!node_parent_rcu(n))
2415 fib_table_print(seq, iter->tb);
Robert Olsson095b8502007-01-26 19:06:01 -08002416
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002417 if (IS_TNODE(n)) {
2418 struct tnode *tn = (struct tnode *) n;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07002419 __be32 prf = htonl(mask_pfx(tn->key, tn->pos));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002420
Robert Olsson1d25cd62005-09-19 15:29:52 -07002421 seq_indent(seq, iter->depth-1);
YOSHIFUJI Hideakia7d632b2008-04-14 04:09:00 -07002422 seq_printf(seq, " +-- " NIPQUAD_FMT "/%d %d %d %d\n",
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002423 NIPQUAD(prf), tn->pos, tn->bits, tn->full_children,
Robert Olsson1d25cd62005-09-19 15:29:52 -07002424 tn->empty_children);
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002425
Olof Johansson91b9a272005-08-09 20:24:39 -07002426 } else {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002427 struct leaf *l = (struct leaf *) n;
Stephen Hemminger13280422008-01-22 21:54:37 -08002428 struct leaf_info *li;
2429 struct hlist_node *node;
Al Viro32ab5f82006-09-26 22:21:45 -07002430 __be32 val = htonl(l->key);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002431
2432 seq_indent(seq, iter->depth);
YOSHIFUJI Hideakia7d632b2008-04-14 04:09:00 -07002433 seq_printf(seq, " |-- " NIPQUAD_FMT "\n", NIPQUAD(val));
Eric Dumazet28d36e32008-01-14 23:09:56 -08002434
Stephen Hemminger13280422008-01-22 21:54:37 -08002435 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
2436 struct fib_alias *fa;
Eric Dumazet28d36e32008-01-14 23:09:56 -08002437
Stephen Hemminger13280422008-01-22 21:54:37 -08002438 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
2439 char buf1[32], buf2[32];
Eric Dumazet28d36e32008-01-14 23:09:56 -08002440
Stephen Hemminger13280422008-01-22 21:54:37 -08002441 seq_indent(seq, iter->depth+1);
2442 seq_printf(seq, " /%d %s %s", li->plen,
2443 rtn_scope(buf1, sizeof(buf1),
2444 fa->fa_scope),
2445 rtn_type(buf2, sizeof(buf2),
2446 fa->fa_type));
2447 if (fa->fa_tos)
Denis V. Lunevb9c4d822008-02-05 02:58:45 -08002448 seq_printf(seq, " tos=%d", fa->fa_tos);
Stephen Hemminger13280422008-01-22 21:54:37 -08002449 seq_putc(seq, '\n');
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002450 }
2451 }
Robert Olsson19baf832005-06-21 12:43:18 -07002452 }
2453
2454 return 0;
2455}
2456
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002457static const struct seq_operations fib_trie_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002458 .start = fib_trie_seq_start,
2459 .next = fib_trie_seq_next,
2460 .stop = fib_trie_seq_stop,
2461 .show = fib_trie_seq_show,
Robert Olsson19baf832005-06-21 12:43:18 -07002462};
2463
2464static int fib_trie_seq_open(struct inode *inode, struct file *file)
2465{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002466 return seq_open_net(inode, file, &fib_trie_seq_ops,
2467 sizeof(struct fib_trie_iter));
Robert Olsson19baf832005-06-21 12:43:18 -07002468}
2469
Arjan van de Ven9a321442007-02-12 00:55:35 -08002470static const struct file_operations fib_trie_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002471 .owner = THIS_MODULE,
2472 .open = fib_trie_seq_open,
2473 .read = seq_read,
2474 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002475 .release = seq_release_net,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002476};
2477
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002478struct fib_route_iter {
2479 struct seq_net_private p;
2480 struct trie *main_trie;
2481 loff_t pos;
2482 t_key key;
2483};
2484
2485static struct leaf *fib_route_get_idx(struct fib_route_iter *iter, loff_t pos)
2486{
2487 struct leaf *l = NULL;
2488 struct trie *t = iter->main_trie;
2489
2490 /* use cache location of last found key */
2491 if (iter->pos > 0 && pos >= iter->pos && (l = fib_find_node(t, iter->key)))
2492 pos -= iter->pos;
2493 else {
2494 iter->pos = 0;
2495 l = trie_firstleaf(t);
2496 }
2497
2498 while (l && pos-- > 0) {
2499 iter->pos++;
2500 l = trie_nextleaf(l);
2501 }
2502
2503 if (l)
2504 iter->key = pos; /* remember it */
2505 else
2506 iter->pos = 0; /* forget it */
2507
2508 return l;
2509}
2510
2511static void *fib_route_seq_start(struct seq_file *seq, loff_t *pos)
2512 __acquires(RCU)
2513{
2514 struct fib_route_iter *iter = seq->private;
2515 struct fib_table *tb;
2516
2517 rcu_read_lock();
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002518 tb = fib_get_table(seq_file_net(seq), RT_TABLE_MAIN);
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002519 if (!tb)
2520 return NULL;
2521
2522 iter->main_trie = (struct trie *) tb->tb_data;
2523 if (*pos == 0)
2524 return SEQ_START_TOKEN;
2525 else
2526 return fib_route_get_idx(iter, *pos - 1);
2527}
2528
2529static void *fib_route_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2530{
2531 struct fib_route_iter *iter = seq->private;
2532 struct leaf *l = v;
2533
2534 ++*pos;
2535 if (v == SEQ_START_TOKEN) {
2536 iter->pos = 0;
2537 l = trie_firstleaf(iter->main_trie);
2538 } else {
2539 iter->pos++;
2540 l = trie_nextleaf(l);
2541 }
2542
2543 if (l)
2544 iter->key = l->key;
2545 else
2546 iter->pos = 0;
2547 return l;
2548}
2549
2550static void fib_route_seq_stop(struct seq_file *seq, void *v)
2551 __releases(RCU)
2552{
2553 rcu_read_unlock();
2554}
2555
Al Viro32ab5f82006-09-26 22:21:45 -07002556static unsigned fib_flag_trans(int type, __be32 mask, const struct fib_info *fi)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002557{
2558 static unsigned type2flags[RTN_MAX + 1] = {
2559 [7] = RTF_REJECT, [8] = RTF_REJECT,
2560 };
2561 unsigned flags = type2flags[type];
2562
2563 if (fi && fi->fib_nh->nh_gw)
2564 flags |= RTF_GATEWAY;
Al Viro32ab5f82006-09-26 22:21:45 -07002565 if (mask == htonl(0xFFFFFFFF))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002566 flags |= RTF_HOST;
2567 flags |= RTF_UP;
2568 return flags;
2569}
2570
2571/*
2572 * This outputs /proc/net/route.
2573 * The format of the file is not supposed to be changed
2574 * and needs to be same as fib_hash output to avoid breaking
2575 * legacy utilities
2576 */
2577static int fib_route_seq_show(struct seq_file *seq, void *v)
2578{
2579 struct leaf *l = v;
Stephen Hemminger13280422008-01-22 21:54:37 -08002580 struct leaf_info *li;
2581 struct hlist_node *node;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002582
2583 if (v == SEQ_START_TOKEN) {
2584 seq_printf(seq, "%-127s\n", "Iface\tDestination\tGateway "
2585 "\tFlags\tRefCnt\tUse\tMetric\tMask\t\tMTU"
2586 "\tWindow\tIRTT");
2587 return 0;
2588 }
2589
Stephen Hemminger13280422008-01-22 21:54:37 -08002590 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002591 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07002592 __be32 mask, prefix;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002593
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002594 mask = inet_make_mask(li->plen);
2595 prefix = htonl(l->key);
2596
2597 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
Herbert Xu1371e372005-10-15 09:42:39 +10002598 const struct fib_info *fi = fa->fa_info;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002599 unsigned flags = fib_flag_trans(fa->fa_type, mask, fi);
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002600 int len;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002601
2602 if (fa->fa_type == RTN_BROADCAST
2603 || fa->fa_type == RTN_MULTICAST)
2604 continue;
2605
2606 if (fi)
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002607 seq_printf(seq,
2608 "%s\t%08X\t%08X\t%04X\t%d\t%u\t"
2609 "%d\t%08X\t%d\t%u\t%u%n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002610 fi->fib_dev ? fi->fib_dev->name : "*",
2611 prefix,
2612 fi->fib_nh->nh_gw, flags, 0, 0,
2613 fi->fib_priority,
2614 mask,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002615 (fi->fib_advmss ?
2616 fi->fib_advmss + 40 : 0),
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002617 fi->fib_window,
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002618 fi->fib_rtt >> 3, &len);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002619 else
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002620 seq_printf(seq,
2621 "*\t%08X\t%08X\t%04X\t%d\t%u\t"
2622 "%d\t%08X\t%d\t%u\t%u%n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002623 prefix, 0, flags, 0, 0, 0,
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002624 mask, 0, 0, 0, &len);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002625
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002626 seq_printf(seq, "%*s\n", 127 - len, "");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002627 }
2628 }
2629
2630 return 0;
2631}
2632
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002633static const struct seq_operations fib_route_seq_ops = {
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002634 .start = fib_route_seq_start,
2635 .next = fib_route_seq_next,
2636 .stop = fib_route_seq_stop,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002637 .show = fib_route_seq_show,
2638};
2639
2640static int fib_route_seq_open(struct inode *inode, struct file *file)
2641{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002642 return seq_open_net(inode, file, &fib_route_seq_ops,
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002643 sizeof(struct fib_route_iter));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002644}
2645
Arjan van de Ven9a321442007-02-12 00:55:35 -08002646static const struct file_operations fib_route_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002647 .owner = THIS_MODULE,
2648 .open = fib_route_seq_open,
2649 .read = seq_read,
2650 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002651 .release = seq_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002652};
2653
Denis V. Lunev61a02652008-01-10 03:21:09 -08002654int __net_init fib_proc_init(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002655{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002656 if (!proc_net_fops_create(net, "fib_trie", S_IRUGO, &fib_trie_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002657 goto out1;
2658
Denis V. Lunev61a02652008-01-10 03:21:09 -08002659 if (!proc_net_fops_create(net, "fib_triestat", S_IRUGO,
2660 &fib_triestat_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002661 goto out2;
2662
Denis V. Lunev61a02652008-01-10 03:21:09 -08002663 if (!proc_net_fops_create(net, "route", S_IRUGO, &fib_route_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002664 goto out3;
2665
Robert Olsson19baf832005-06-21 12:43:18 -07002666 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002667
2668out3:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002669 proc_net_remove(net, "fib_triestat");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002670out2:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002671 proc_net_remove(net, "fib_trie");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002672out1:
2673 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002674}
2675
Denis V. Lunev61a02652008-01-10 03:21:09 -08002676void __net_exit fib_proc_exit(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002677{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002678 proc_net_remove(net, "fib_trie");
2679 proc_net_remove(net, "fib_triestat");
2680 proc_net_remove(net, "route");
Robert Olsson19baf832005-06-21 12:43:18 -07002681}
2682
2683#endif /* CONFIG_PROC_FS */