blob: 11d4d28190bddcf462d9e0859745d3bdcbb7bdb8 [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 *
Lucas De Marchi25985ed2011-03-30 22:57:33 -030015 * This work is based on the LPC-trie which is originally described 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.
Justin P. Mattock631dd1a2010-10-18 11:03:14 +020019 * http://www.csc.kth.se/~snilsson/software/dyntrie2/
Robert Olsson19baf832005-06-21 12:43:18 -070020 *
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 *
Robert Olsson19baf832005-06-21 12:43:18 -070025 *
26 * Code from fib_hash has been reused which includes the following header:
27 *
28 *
29 * INET An implementation of the TCP/IP protocol suite for the LINUX
30 * operating system. INET is implemented using the BSD Socket
31 * interface as the means of communication with the user level.
32 *
33 * IPv4 FIB: lookup engine and maintenance routines.
34 *
35 *
36 * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
37 *
38 * This program is free software; you can redistribute it and/or
39 * modify it under the terms of the GNU General Public License
40 * as published by the Free Software Foundation; either version
41 * 2 of the License, or (at your option) any later version.
Robert Olssonfd966252005-12-22 11:25:10 -080042 *
43 * Substantial contributions to this work comes from:
44 *
45 * David S. Miller, <davem@davemloft.net>
46 * Stephen Hemminger <shemminger@osdl.org>
47 * Paul E. McKenney <paulmck@us.ibm.com>
48 * Patrick McHardy <kaber@trash.net>
Robert Olsson19baf832005-06-21 12:43:18 -070049 */
50
Jens Låås80b71b82009-08-28 23:57:15 -070051#define VERSION "0.409"
Robert Olsson19baf832005-06-21 12:43:18 -070052
Robert Olsson19baf832005-06-21 12:43:18 -070053#include <asm/uaccess.h>
54#include <asm/system.h>
Jiri Slaby1977f032007-10-18 23:40:25 -070055#include <linux/bitops.h>
Robert Olsson19baf832005-06-21 12:43:18 -070056#include <linux/types.h>
57#include <linux/kernel.h>
Robert Olsson19baf832005-06-21 12:43:18 -070058#include <linux/mm.h>
59#include <linux/string.h>
60#include <linux/socket.h>
61#include <linux/sockios.h>
62#include <linux/errno.h>
63#include <linux/in.h>
64#include <linux/inet.h>
Stephen Hemmingercd8787a2006-01-03 14:38:34 -080065#include <linux/inetdevice.h>
Robert Olsson19baf832005-06-21 12:43:18 -070066#include <linux/netdevice.h>
67#include <linux/if_arp.h>
68#include <linux/proc_fs.h>
Robert Olsson2373ce12005-08-25 13:01:29 -070069#include <linux/rcupdate.h>
Robert Olsson19baf832005-06-21 12:43:18 -070070#include <linux/skbuff.h>
71#include <linux/netlink.h>
72#include <linux/init.h>
73#include <linux/list.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090074#include <linux/slab.h>
Eric W. Biederman457c4cb2007-09-12 12:01:34 +020075#include <net/net_namespace.h>
Robert Olsson19baf832005-06-21 12:43:18 -070076#include <net/ip.h>
77#include <net/protocol.h>
78#include <net/route.h>
79#include <net/tcp.h>
80#include <net/sock.h>
81#include <net/ip_fib.h>
82#include "fib_lookup.h"
83
Robert Olsson06ef9212006-03-20 21:35:01 -080084#define MAX_STAT_DEPTH 32
Robert Olsson19baf832005-06-21 12:43:18 -070085
Robert Olsson19baf832005-06-21 12:43:18 -070086#define KEYLENGTH (8*sizeof(t_key))
Robert Olsson19baf832005-06-21 12:43:18 -070087
Robert Olsson19baf832005-06-21 12:43:18 -070088typedef unsigned int t_key;
89
90#define T_TNODE 0
91#define T_LEAF 1
92#define NODE_TYPE_MASK 0x1UL
Robert Olsson2373ce12005-08-25 13:01:29 -070093#define NODE_TYPE(node) ((node)->parent & NODE_TYPE_MASK)
94
Olof Johansson91b9a272005-08-09 20:24:39 -070095#define IS_TNODE(n) (!(n->parent & T_LEAF))
96#define IS_LEAF(n) (n->parent & T_LEAF)
Robert Olsson19baf832005-06-21 12:43:18 -070097
David S. Millerb299e4f2011-02-02 20:48:10 -080098struct rt_trie_node {
Olof Johansson91b9a272005-08-09 20:24:39 -070099 unsigned long parent;
Eric Dumazet8d9654442008-01-13 22:31:44 -0800100 t_key key;
Robert Olsson19baf832005-06-21 12:43:18 -0700101};
102
103struct leaf {
Olof Johansson91b9a272005-08-09 20:24:39 -0700104 unsigned long parent;
Eric Dumazet8d9654442008-01-13 22:31:44 -0800105 t_key key;
Robert Olsson19baf832005-06-21 12:43:18 -0700106 struct hlist_head list;
Robert Olsson2373ce12005-08-25 13:01:29 -0700107 struct rcu_head rcu;
Robert Olsson19baf832005-06-21 12:43:18 -0700108};
109
110struct leaf_info {
111 struct hlist_node hlist;
Robert Olsson2373ce12005-08-25 13:01:29 -0700112 struct rcu_head rcu;
Robert Olsson19baf832005-06-21 12:43:18 -0700113 int plen;
114 struct list_head falh;
115};
116
117struct tnode {
Olof Johansson91b9a272005-08-09 20:24:39 -0700118 unsigned long parent;
Eric Dumazet8d9654442008-01-13 22:31:44 -0800119 t_key key;
Eric Dumazet112d8cf2008-01-12 21:27:41 -0800120 unsigned char pos; /* 2log(KEYLENGTH) bits needed */
121 unsigned char bits; /* 2log(KEYLENGTH) bits needed */
Eric Dumazet8d9654442008-01-13 22:31:44 -0800122 unsigned int full_children; /* KEYLENGTH bits needed */
123 unsigned int empty_children; /* KEYLENGTH bits needed */
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700124 union {
125 struct rcu_head rcu;
126 struct work_struct work;
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700127 struct tnode *tnode_free;
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700128 };
David S. Millerb299e4f2011-02-02 20:48:10 -0800129 struct rt_trie_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 {
David S. Millerb299e4f2011-02-02 20:48:10 -0800154 struct rt_trie_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
David S. Millerb299e4f2011-02-02 20:48:10 -0800160static void put_child(struct trie *t, struct tnode *tn, int i, struct rt_trie_node *n);
161static void tnode_put_child_reorg(struct tnode *tn, int i, struct rt_trie_node *n,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800162 int wasfull);
David S. Millerb299e4f2011-02-02 20:48:10 -0800163static struct rt_trie_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);
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700166/* tnodes to free after resize(); protected by RTNL */
167static struct tnode *tnode_free_head;
Jarek Poplawskic3059472009-07-14 08:33:08 +0000168static size_t tnode_free_size;
169
170/*
171 * synchronize_rcu after call_rcu for that many pages; it should be especially
172 * useful before resizing the root node with PREEMPT_NONE configs; the value was
173 * obtained experimentally, aiming to avoid visible slowdown.
174 */
175static const int sync_pages = 128;
Robert Olsson19baf832005-06-21 12:43:18 -0700176
Christoph Lametere18b8902006-12-06 20:33:20 -0800177static struct kmem_cache *fn_alias_kmem __read_mostly;
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -0800178static struct kmem_cache *trie_leaf_kmem __read_mostly;
Robert Olsson19baf832005-06-21 12:43:18 -0700179
David S. Millerb299e4f2011-02-02 20:48:10 -0800180static inline struct tnode *node_parent(struct rt_trie_node *node)
Stephen Hemminger06801912007-08-10 15:22:13 -0700181{
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800182 return (struct tnode *)(node->parent & ~NODE_TYPE_MASK);
183}
Stephen Hemminger06801912007-08-10 15:22:13 -0700184
David S. Millerb299e4f2011-02-02 20:48:10 -0800185static inline struct tnode *node_parent_rcu(struct rt_trie_node *node)
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800186{
187 struct tnode *ret = node_parent(node);
188
Eric Dumazeta034ee32010-09-09 23:32:28 +0000189 return rcu_dereference_rtnl(ret);
Stephen Hemminger06801912007-08-10 15:22:13 -0700190}
191
Stephen Hemminger6440cc92008-03-22 17:59:58 -0700192/* Same as rcu_assign_pointer
193 * but that macro() assumes that value is a pointer.
194 */
David S. Millerb299e4f2011-02-02 20:48:10 -0800195static inline void node_set_parent(struct rt_trie_node *node, struct tnode *ptr)
Stephen Hemminger06801912007-08-10 15:22:13 -0700196{
Stephen Hemminger6440cc92008-03-22 17:59:58 -0700197 smp_wmb();
198 node->parent = (unsigned long)ptr | NODE_TYPE(node);
Stephen Hemminger06801912007-08-10 15:22:13 -0700199}
Robert Olsson2373ce12005-08-25 13:01:29 -0700200
David S. Millerb299e4f2011-02-02 20:48:10 -0800201static inline struct rt_trie_node *tnode_get_child(struct tnode *tn, unsigned int i)
Robert Olsson19baf832005-06-21 12:43:18 -0700202{
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800203 BUG_ON(i >= 1U << tn->bits);
Robert Olsson19baf832005-06-21 12:43:18 -0700204
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800205 return tn->child[i];
206}
207
David S. Millerb299e4f2011-02-02 20:48:10 -0800208static inline struct rt_trie_node *tnode_get_child_rcu(struct tnode *tn, unsigned int i)
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800209{
David S. Millerb299e4f2011-02-02 20:48:10 -0800210 struct rt_trie_node *ret = tnode_get_child(tn, i);
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800211
Eric Dumazeta034ee32010-09-09 23:32:28 +0000212 return rcu_dereference_rtnl(ret);
Robert Olsson19baf832005-06-21 12:43:18 -0700213}
214
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700215static inline int tnode_child_length(const struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700216{
Olof Johansson91b9a272005-08-09 20:24:39 -0700217 return 1 << tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -0700218}
219
David S. Miller3b004562011-02-16 14:56:22 -0800220static inline t_key mask_pfx(t_key k, unsigned int l)
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700221{
222 return (l == 0) ? 0 : k >> (KEYLENGTH-l) << (KEYLENGTH-l);
223}
224
David S. Miller3b004562011-02-16 14:56:22 -0800225static inline t_key tkey_extract_bits(t_key a, unsigned int offset, unsigned int bits)
Robert Olsson19baf832005-06-21 12:43:18 -0700226{
Olof Johansson91b9a272005-08-09 20:24:39 -0700227 if (offset < KEYLENGTH)
Robert Olsson19baf832005-06-21 12:43:18 -0700228 return ((t_key)(a << offset)) >> (KEYLENGTH - bits);
Olof Johansson91b9a272005-08-09 20:24:39 -0700229 else
Robert Olsson19baf832005-06-21 12:43:18 -0700230 return 0;
231}
232
233static inline int tkey_equals(t_key a, t_key b)
234{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700235 return a == b;
Robert Olsson19baf832005-06-21 12:43:18 -0700236}
237
238static inline int tkey_sub_equals(t_key a, int offset, int bits, t_key b)
239{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700240 if (bits == 0 || offset >= KEYLENGTH)
241 return 1;
Olof Johansson91b9a272005-08-09 20:24:39 -0700242 bits = bits > KEYLENGTH ? KEYLENGTH : bits;
243 return ((a ^ b) << offset) >> (KEYLENGTH - bits) == 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700244}
Robert Olsson19baf832005-06-21 12:43:18 -0700245
246static inline int tkey_mismatch(t_key a, int offset, t_key b)
247{
248 t_key diff = a ^ b;
249 int i = offset;
250
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700251 if (!diff)
252 return 0;
253 while ((diff << i) >> (KEYLENGTH-1) == 0)
Robert Olsson19baf832005-06-21 12:43:18 -0700254 i++;
255 return i;
256}
257
Robert Olsson19baf832005-06-21 12:43:18 -0700258/*
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900259 To understand this stuff, an understanding of keys and all their bits is
260 necessary. Every node in the trie has a key associated with it, but not
Robert Olsson19baf832005-06-21 12:43:18 -0700261 all of the bits in that key are significant.
262
263 Consider a node 'n' and its parent 'tp'.
264
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900265 If n is a leaf, every bit in its key is significant. Its presence is
266 necessitated by path compression, since during a tree traversal (when
267 searching for a leaf - unless we are doing an insertion) we will completely
268 ignore all skipped bits we encounter. Thus we need to verify, at the end of
269 a potentially successful search, that we have indeed been walking the
Robert Olsson19baf832005-06-21 12:43:18 -0700270 correct key path.
271
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900272 Note that we can never "miss" the correct key in the tree if present by
273 following the wrong path. Path compression ensures that segments of the key
274 that are the same for all keys with a given prefix are skipped, but the
275 skipped part *is* identical for each node in the subtrie below the skipped
276 bit! trie_insert() in this implementation takes care of that - note the
Robert Olsson19baf832005-06-21 12:43:18 -0700277 call to tkey_sub_equals() in trie_insert().
278
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900279 if n is an internal node - a 'tnode' here, the various parts of its key
Robert Olsson19baf832005-06-21 12:43:18 -0700280 have many different meanings.
281
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900282 Example:
Robert Olsson19baf832005-06-21 12:43:18 -0700283 _________________________________________________________________
284 | i | i | i | i | i | i | i | N | N | N | S | S | S | S | S | C |
285 -----------------------------------------------------------------
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900286 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
Robert Olsson19baf832005-06-21 12:43:18 -0700287
288 _________________________________________________________________
289 | C | C | C | u | u | u | u | u | u | u | u | u | u | u | u | u |
290 -----------------------------------------------------------------
291 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31
292
293 tp->pos = 7
294 tp->bits = 3
295 n->pos = 15
Olof Johansson91b9a272005-08-09 20:24:39 -0700296 n->bits = 4
Robert Olsson19baf832005-06-21 12:43:18 -0700297
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900298 First, let's just ignore the bits that come before the parent tp, that is
299 the bits from 0 to (tp->pos-1). They are *known* but at this point we do
Robert Olsson19baf832005-06-21 12:43:18 -0700300 not use them for anything.
301
302 The bits from (tp->pos) to (tp->pos + tp->bits - 1) - "N", above - are the
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900303 index into the parent's child array. That is, they will be used to find
Robert Olsson19baf832005-06-21 12:43:18 -0700304 'n' among tp's children.
305
306 The bits from (tp->pos + tp->bits) to (n->pos - 1) - "S" - are skipped bits
307 for the node n.
308
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900309 All the bits we have seen so far are significant to the node n. The rest
Robert Olsson19baf832005-06-21 12:43:18 -0700310 of the bits are really not needed or indeed known in n->key.
311
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900312 The bits from (n->pos) to (n->pos + n->bits - 1) - "C" - are the index into
Robert Olsson19baf832005-06-21 12:43:18 -0700313 n's child array, and will of course be different for each child.
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900314
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700315
Robert Olsson19baf832005-06-21 12:43:18 -0700316 The rest of the bits, from (n->pos + n->bits) onward, are completely unknown
317 at this point.
318
319*/
320
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700321static inline void check_tnode(const struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700322{
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700323 WARN_ON(tn && tn->pos+tn->bits > 32);
Robert Olsson19baf832005-06-21 12:43:18 -0700324}
325
Denis V. Lunevf5026fa2007-12-13 09:47:57 -0800326static const int halve_threshold = 25;
327static const int inflate_threshold = 50;
Jarek Poplawski345aa032009-07-07 19:39:16 -0700328static const int halve_threshold_root = 15;
Jens Låås80b71b82009-08-28 23:57:15 -0700329static const int inflate_threshold_root = 30;
Robert Olsson2373ce12005-08-25 13:01:29 -0700330
331static void __alias_free_mem(struct rcu_head *head)
332{
333 struct fib_alias *fa = container_of(head, struct fib_alias, rcu);
334 kmem_cache_free(fn_alias_kmem, fa);
335}
336
337static inline void alias_free_mem_rcu(struct fib_alias *fa)
338{
339 call_rcu(&fa->rcu, __alias_free_mem);
340}
341
342static void __leaf_free_rcu(struct rcu_head *head)
343{
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -0800344 struct leaf *l = container_of(head, struct leaf, rcu);
345 kmem_cache_free(trie_leaf_kmem, l);
Robert Olsson2373ce12005-08-25 13:01:29 -0700346}
347
Stephen Hemminger387a5482008-04-10 03:47:34 -0700348static inline void free_leaf(struct leaf *l)
349{
350 call_rcu_bh(&l->rcu, __leaf_free_rcu);
351}
352
Robert Olsson2373ce12005-08-25 13:01:29 -0700353static inline void free_leaf_info(struct leaf_info *leaf)
354{
Lai Jiangshanbceb0f42011-03-18 11:42:34 +0800355 kfree_rcu(leaf, rcu);
Robert Olsson2373ce12005-08-25 13:01:29 -0700356}
357
Eric Dumazet8d9654442008-01-13 22:31:44 -0800358static struct tnode *tnode_alloc(size_t size)
Robert Olsson2373ce12005-08-25 13:01:29 -0700359{
Robert Olsson2373ce12005-08-25 13:01:29 -0700360 if (size <= PAGE_SIZE)
Eric Dumazet8d9654442008-01-13 22:31:44 -0800361 return kzalloc(size, GFP_KERNEL);
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700362 else
Eric Dumazet7a1c8e52010-11-20 07:46:35 +0000363 return vzalloc(size);
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700364}
Robert Olsson2373ce12005-08-25 13:01:29 -0700365
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700366static void __tnode_vfree(struct work_struct *arg)
367{
368 struct tnode *tn = container_of(arg, struct tnode, work);
369 vfree(tn);
Robert Olsson2373ce12005-08-25 13:01:29 -0700370}
371
372static void __tnode_free_rcu(struct rcu_head *head)
373{
374 struct tnode *tn = container_of(head, struct tnode, rcu);
Eric Dumazet8d9654442008-01-13 22:31:44 -0800375 size_t size = sizeof(struct tnode) +
David S. Millerb299e4f2011-02-02 20:48:10 -0800376 (sizeof(struct rt_trie_node *) << tn->bits);
Robert Olsson2373ce12005-08-25 13:01:29 -0700377
378 if (size <= PAGE_SIZE)
379 kfree(tn);
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700380 else {
381 INIT_WORK(&tn->work, __tnode_vfree);
382 schedule_work(&tn->work);
383 }
Robert Olsson2373ce12005-08-25 13:01:29 -0700384}
385
386static inline void tnode_free(struct tnode *tn)
387{
Stephen Hemminger387a5482008-04-10 03:47:34 -0700388 if (IS_LEAF(tn))
389 free_leaf((struct leaf *) tn);
390 else
Robert Olsson550e29b2006-04-04 12:53:35 -0700391 call_rcu(&tn->rcu, __tnode_free_rcu);
Robert Olsson2373ce12005-08-25 13:01:29 -0700392}
393
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700394static void tnode_free_safe(struct tnode *tn)
395{
396 BUG_ON(IS_LEAF(tn));
Jarek Poplawski7b855762009-06-18 00:28:51 -0700397 tn->tnode_free = tnode_free_head;
398 tnode_free_head = tn;
Jarek Poplawskic3059472009-07-14 08:33:08 +0000399 tnode_free_size += sizeof(struct tnode) +
David S. Millerb299e4f2011-02-02 20:48:10 -0800400 (sizeof(struct rt_trie_node *) << tn->bits);
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700401}
402
403static void tnode_free_flush(void)
404{
405 struct tnode *tn;
406
407 while ((tn = tnode_free_head)) {
408 tnode_free_head = tn->tnode_free;
409 tn->tnode_free = NULL;
410 tnode_free(tn);
411 }
Jarek Poplawskic3059472009-07-14 08:33:08 +0000412
413 if (tnode_free_size >= PAGE_SIZE * sync_pages) {
414 tnode_free_size = 0;
415 synchronize_rcu();
416 }
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700417}
418
Robert Olsson19baf832005-06-21 12:43:18 -0700419static struct leaf *leaf_new(void)
420{
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -0800421 struct leaf *l = kmem_cache_alloc(trie_leaf_kmem, GFP_KERNEL);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700422 if (l) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700423 l->parent = T_LEAF;
Robert Olsson19baf832005-06-21 12:43:18 -0700424 INIT_HLIST_HEAD(&l->list);
425 }
426 return l;
427}
428
429static struct leaf_info *leaf_info_new(int plen)
430{
431 struct leaf_info *li = kmalloc(sizeof(struct leaf_info), GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -0700432 if (li) {
433 li->plen = plen;
434 INIT_LIST_HEAD(&li->falh);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700435 }
Robert Olsson2373ce12005-08-25 13:01:29 -0700436 return li;
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700437}
438
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800439static struct tnode *tnode_new(t_key key, int pos, int bits)
Robert Olsson19baf832005-06-21 12:43:18 -0700440{
David S. Millerb299e4f2011-02-02 20:48:10 -0800441 size_t sz = sizeof(struct tnode) + (sizeof(struct rt_trie_node *) << bits);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700442 struct tnode *tn = tnode_alloc(sz);
Robert Olsson19baf832005-06-21 12:43:18 -0700443
Olof Johansson91b9a272005-08-09 20:24:39 -0700444 if (tn) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700445 tn->parent = T_TNODE;
Robert Olsson19baf832005-06-21 12:43:18 -0700446 tn->pos = pos;
447 tn->bits = bits;
448 tn->key = key;
449 tn->full_children = 0;
450 tn->empty_children = 1<<bits;
451 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700452
Eric Dumazeta034ee32010-09-09 23:32:28 +0000453 pr_debug("AT %p s=%zu %zu\n", tn, sizeof(struct tnode),
David S. Millerb299e4f2011-02-02 20:48:10 -0800454 sizeof(struct rt_trie_node) << bits);
Robert Olsson19baf832005-06-21 12:43:18 -0700455 return tn;
456}
457
Robert Olsson19baf832005-06-21 12:43:18 -0700458/*
459 * Check whether a tnode 'n' is "full", i.e. it is an internal node
460 * and no bits are skipped. See discussion in dyntree paper p. 6
461 */
462
David S. Millerb299e4f2011-02-02 20:48:10 -0800463static inline int tnode_full(const struct tnode *tn, const struct rt_trie_node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700464{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700465 if (n == NULL || IS_LEAF(n))
Robert Olsson19baf832005-06-21 12:43:18 -0700466 return 0;
467
468 return ((struct tnode *) n)->pos == tn->pos + tn->bits;
469}
470
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800471static inline void put_child(struct trie *t, struct tnode *tn, int i,
David S. Millerb299e4f2011-02-02 20:48:10 -0800472 struct rt_trie_node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700473{
474 tnode_put_child_reorg(tn, i, n, -1);
475}
476
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700477 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700478 * Add a child at position i overwriting the old value.
479 * Update the value of full_children and empty_children.
480 */
481
David S. Millerb299e4f2011-02-02 20:48:10 -0800482static void tnode_put_child_reorg(struct tnode *tn, int i, struct rt_trie_node *n,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800483 int wasfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700484{
David S. Millerb299e4f2011-02-02 20:48:10 -0800485 struct rt_trie_node *chi = tn->child[i];
Robert Olsson19baf832005-06-21 12:43:18 -0700486 int isfull;
487
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700488 BUG_ON(i >= 1<<tn->bits);
489
Robert Olsson19baf832005-06-21 12:43:18 -0700490 /* update emptyChildren */
491 if (n == NULL && chi != NULL)
492 tn->empty_children++;
493 else if (n != NULL && chi == NULL)
494 tn->empty_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700495
Robert Olsson19baf832005-06-21 12:43:18 -0700496 /* update fullChildren */
Olof Johansson91b9a272005-08-09 20:24:39 -0700497 if (wasfull == -1)
Robert Olsson19baf832005-06-21 12:43:18 -0700498 wasfull = tnode_full(tn, chi);
499
500 isfull = tnode_full(tn, n);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700501 if (wasfull && !isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700502 tn->full_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700503 else if (!wasfull && isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700504 tn->full_children++;
Olof Johansson91b9a272005-08-09 20:24:39 -0700505
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700506 if (n)
Stephen Hemminger06801912007-08-10 15:22:13 -0700507 node_set_parent(n, tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700508
Robert Olsson2373ce12005-08-25 13:01:29 -0700509 rcu_assign_pointer(tn->child[i], n);
Robert Olsson19baf832005-06-21 12:43:18 -0700510}
511
Jens Låås80b71b82009-08-28 23:57:15 -0700512#define MAX_WORK 10
David S. Millerb299e4f2011-02-02 20:48:10 -0800513static struct rt_trie_node *resize(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700514{
515 int i;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700516 struct tnode *old_tn;
Robert Olssone6308be2005-10-04 13:01:58 -0700517 int inflate_threshold_use;
518 int halve_threshold_use;
Jens Låås80b71b82009-08-28 23:57:15 -0700519 int max_work;
Robert Olsson19baf832005-06-21 12:43:18 -0700520
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900521 if (!tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700522 return NULL;
523
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700524 pr_debug("In tnode_resize %p inflate_threshold=%d threshold=%d\n",
525 tn, inflate_threshold, halve_threshold);
Robert Olsson19baf832005-06-21 12:43:18 -0700526
527 /* No children */
528 if (tn->empty_children == tnode_child_length(tn)) {
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700529 tnode_free_safe(tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700530 return NULL;
531 }
532 /* One child */
533 if (tn->empty_children == tnode_child_length(tn) - 1)
Jens Låås80b71b82009-08-28 23:57:15 -0700534 goto one_child;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700535 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700536 * Double as long as the resulting node has a number of
537 * nonempty nodes that are above the threshold.
538 */
539
540 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700541 * From "Implementing a dynamic compressed trie" by Stefan Nilsson of
542 * the Helsinki University of Technology and Matti Tikkanen of Nokia
Robert Olsson19baf832005-06-21 12:43:18 -0700543 * Telecommunications, page 6:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700544 * "A node is doubled if the ratio of non-empty children to all
Robert Olsson19baf832005-06-21 12:43:18 -0700545 * children in the *doubled* node is at least 'high'."
546 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700547 * 'high' in this instance is the variable 'inflate_threshold'. It
548 * is expressed as a percentage, so we multiply it with
549 * tnode_child_length() and instead of multiplying by 2 (since the
550 * child array will be doubled by inflate()) and multiplying
551 * the left-hand side by 100 (to handle the percentage thing) we
Robert Olsson19baf832005-06-21 12:43:18 -0700552 * multiply the left-hand side by 50.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700553 *
554 * The left-hand side may look a bit weird: tnode_child_length(tn)
555 * - tn->empty_children is of course the number of non-null children
556 * in the current node. tn->full_children is the number of "full"
Robert Olsson19baf832005-06-21 12:43:18 -0700557 * children, that is non-null tnodes with a skip value of 0.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700558 * All of those will be doubled in the resulting inflated tnode, so
Robert Olsson19baf832005-06-21 12:43:18 -0700559 * we just count them one extra time here.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700560 *
Robert Olsson19baf832005-06-21 12:43:18 -0700561 * A clearer way to write this would be:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700562 *
Robert Olsson19baf832005-06-21 12:43:18 -0700563 * to_be_doubled = tn->full_children;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700564 * not_to_be_doubled = tnode_child_length(tn) - tn->empty_children -
Robert Olsson19baf832005-06-21 12:43:18 -0700565 * tn->full_children;
566 *
567 * new_child_length = tnode_child_length(tn) * 2;
568 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700569 * new_fill_factor = 100 * (not_to_be_doubled + 2*to_be_doubled) /
Robert Olsson19baf832005-06-21 12:43:18 -0700570 * new_child_length;
571 * if (new_fill_factor >= inflate_threshold)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700572 *
573 * ...and so on, tho it would mess up the while () loop.
574 *
Robert Olsson19baf832005-06-21 12:43:18 -0700575 * anyway,
576 * 100 * (not_to_be_doubled + 2*to_be_doubled) / new_child_length >=
577 * inflate_threshold
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700578 *
Robert Olsson19baf832005-06-21 12:43:18 -0700579 * avoid a division:
580 * 100 * (not_to_be_doubled + 2*to_be_doubled) >=
581 * inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700582 *
Robert Olsson19baf832005-06-21 12:43:18 -0700583 * expand not_to_be_doubled and to_be_doubled, and shorten:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700584 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700585 * tn->full_children) >= inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700586 *
Robert Olsson19baf832005-06-21 12:43:18 -0700587 * expand new_child_length:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700588 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700589 * tn->full_children) >=
Robert Olsson19baf832005-06-21 12:43:18 -0700590 * inflate_threshold * tnode_child_length(tn) * 2
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700591 *
Robert Olsson19baf832005-06-21 12:43:18 -0700592 * shorten again:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700593 * 50 * (tn->full_children + tnode_child_length(tn) -
Olof Johansson91b9a272005-08-09 20:24:39 -0700594 * tn->empty_children) >= inflate_threshold *
Robert Olsson19baf832005-06-21 12:43:18 -0700595 * tnode_child_length(tn)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700596 *
Robert Olsson19baf832005-06-21 12:43:18 -0700597 */
598
599 check_tnode(tn);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700600
Robert Olssone6308be2005-10-04 13:01:58 -0700601 /* Keep root node larger */
602
David S. Millerb299e4f2011-02-02 20:48:10 -0800603 if (!node_parent((struct rt_trie_node *)tn)) {
Jens Låås80b71b82009-08-28 23:57:15 -0700604 inflate_threshold_use = inflate_threshold_root;
605 halve_threshold_use = halve_threshold_root;
Eric Dumazeta034ee32010-09-09 23:32:28 +0000606 } else {
Robert Olssone6308be2005-10-04 13:01:58 -0700607 inflate_threshold_use = inflate_threshold;
Jens Låås80b71b82009-08-28 23:57:15 -0700608 halve_threshold_use = halve_threshold;
609 }
Robert Olssone6308be2005-10-04 13:01:58 -0700610
Jens Låås80b71b82009-08-28 23:57:15 -0700611 max_work = MAX_WORK;
612 while ((tn->full_children > 0 && max_work-- &&
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800613 50 * (tn->full_children + tnode_child_length(tn)
614 - tn->empty_children)
615 >= inflate_threshold_use * tnode_child_length(tn))) {
Robert Olsson19baf832005-06-21 12:43:18 -0700616
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700617 old_tn = tn;
618 tn = inflate(t, tn);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800619
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700620 if (IS_ERR(tn)) {
621 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700622#ifdef CONFIG_IP_FIB_TRIE_STATS
623 t->stats.resize_node_skipped++;
624#endif
625 break;
626 }
Robert Olsson19baf832005-06-21 12:43:18 -0700627 }
628
629 check_tnode(tn);
630
Jens Låås80b71b82009-08-28 23:57:15 -0700631 /* Return if at least one inflate is run */
Eric Dumazeta034ee32010-09-09 23:32:28 +0000632 if (max_work != MAX_WORK)
David S. Millerb299e4f2011-02-02 20:48:10 -0800633 return (struct rt_trie_node *) tn;
Jens Låås80b71b82009-08-28 23:57:15 -0700634
Robert Olsson19baf832005-06-21 12:43:18 -0700635 /*
636 * Halve as long as the number of empty children in this
637 * node is above threshold.
638 */
Robert Olsson2f368952005-07-05 15:02:40 -0700639
Jens Låås80b71b82009-08-28 23:57:15 -0700640 max_work = MAX_WORK;
641 while (tn->bits > 1 && max_work-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700642 100 * (tnode_child_length(tn) - tn->empty_children) <
Robert Olssone6308be2005-10-04 13:01:58 -0700643 halve_threshold_use * tnode_child_length(tn)) {
Robert Olsson19baf832005-06-21 12:43:18 -0700644
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700645 old_tn = tn;
646 tn = halve(t, tn);
647 if (IS_ERR(tn)) {
648 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700649#ifdef CONFIG_IP_FIB_TRIE_STATS
650 t->stats.resize_node_skipped++;
651#endif
652 break;
653 }
654 }
655
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700656
Robert Olsson19baf832005-06-21 12:43:18 -0700657 /* Only one child remains */
Jens Låås80b71b82009-08-28 23:57:15 -0700658 if (tn->empty_children == tnode_child_length(tn) - 1) {
659one_child:
Robert Olsson19baf832005-06-21 12:43:18 -0700660 for (i = 0; i < tnode_child_length(tn); i++) {
David S. Millerb299e4f2011-02-02 20:48:10 -0800661 struct rt_trie_node *n;
Olof Johansson91b9a272005-08-09 20:24:39 -0700662
Olof Johansson91b9a272005-08-09 20:24:39 -0700663 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700664 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700665 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700666
667 /* compress one level */
668
Stephen Hemminger06801912007-08-10 15:22:13 -0700669 node_set_parent(n, NULL);
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700670 tnode_free_safe(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700671 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700672 }
Jens Låås80b71b82009-08-28 23:57:15 -0700673 }
David S. Millerb299e4f2011-02-02 20:48:10 -0800674 return (struct rt_trie_node *) tn;
Robert Olsson19baf832005-06-21 12:43:18 -0700675}
676
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700677static struct tnode *inflate(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700678{
Robert Olsson19baf832005-06-21 12:43:18 -0700679 struct tnode *oldtnode = tn;
680 int olen = tnode_child_length(tn);
681 int i;
682
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700683 pr_debug("In inflate\n");
Robert Olsson19baf832005-06-21 12:43:18 -0700684
685 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits + 1);
686
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700687 if (!tn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700688 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700689
690 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700691 * Preallocate and store tnodes before the actual work so we
692 * don't get into an inconsistent state if memory allocation
693 * fails. In case of failure we return the oldnode and inflate
Robert Olsson2f368952005-07-05 15:02:40 -0700694 * of tnode is ignored.
695 */
Olof Johansson91b9a272005-08-09 20:24:39 -0700696
697 for (i = 0; i < olen; i++) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800698 struct tnode *inode;
Robert Olsson2f368952005-07-05 15:02:40 -0700699
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800700 inode = (struct tnode *) tnode_get_child(oldtnode, i);
Robert Olsson2f368952005-07-05 15:02:40 -0700701 if (inode &&
702 IS_TNODE(inode) &&
703 inode->pos == oldtnode->pos + oldtnode->bits &&
704 inode->bits > 1) {
705 struct tnode *left, *right;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700706 t_key m = ~0U << (KEYLENGTH - 1) >> inode->pos;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700707
Robert Olsson2f368952005-07-05 15:02:40 -0700708 left = tnode_new(inode->key&(~m), inode->pos + 1,
709 inode->bits - 1);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700710 if (!left)
711 goto nomem;
Olof Johansson91b9a272005-08-09 20:24:39 -0700712
Robert Olsson2f368952005-07-05 15:02:40 -0700713 right = tnode_new(inode->key|m, inode->pos + 1,
714 inode->bits - 1);
715
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900716 if (!right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700717 tnode_free(left);
718 goto nomem;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900719 }
Robert Olsson2f368952005-07-05 15:02:40 -0700720
David S. Millerb299e4f2011-02-02 20:48:10 -0800721 put_child(t, tn, 2*i, (struct rt_trie_node *) left);
722 put_child(t, tn, 2*i+1, (struct rt_trie_node *) right);
Robert Olsson2f368952005-07-05 15:02:40 -0700723 }
724 }
725
Olof Johansson91b9a272005-08-09 20:24:39 -0700726 for (i = 0; i < olen; i++) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -0800727 struct tnode *inode;
David S. Millerb299e4f2011-02-02 20:48:10 -0800728 struct rt_trie_node *node = tnode_get_child(oldtnode, i);
Olof Johansson91b9a272005-08-09 20:24:39 -0700729 struct tnode *left, *right;
730 int size, j;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700731
Robert Olsson19baf832005-06-21 12:43:18 -0700732 /* An empty child */
733 if (node == NULL)
734 continue;
735
736 /* A leaf or an internal node with skipped bits */
737
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700738 if (IS_LEAF(node) || ((struct tnode *) node)->pos >
Robert Olsson19baf832005-06-21 12:43:18 -0700739 tn->pos + tn->bits - 1) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800740 if (tkey_extract_bits(node->key,
741 oldtnode->pos + oldtnode->bits,
742 1) == 0)
Robert Olsson19baf832005-06-21 12:43:18 -0700743 put_child(t, tn, 2*i, node);
744 else
745 put_child(t, tn, 2*i+1, node);
746 continue;
747 }
748
749 /* An internal node with two children */
750 inode = (struct tnode *) node;
751
752 if (inode->bits == 1) {
753 put_child(t, tn, 2*i, inode->child[0]);
754 put_child(t, tn, 2*i+1, inode->child[1]);
755
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700756 tnode_free_safe(inode);
Olof Johansson91b9a272005-08-09 20:24:39 -0700757 continue;
Robert Olsson19baf832005-06-21 12:43:18 -0700758 }
759
Olof Johansson91b9a272005-08-09 20:24:39 -0700760 /* An internal node with more than two children */
Robert Olsson19baf832005-06-21 12:43:18 -0700761
Olof Johansson91b9a272005-08-09 20:24:39 -0700762 /* We will replace this node 'inode' with two new
763 * ones, 'left' and 'right', each with half of the
764 * original children. The two new nodes will have
765 * a position one bit further down the key and this
766 * means that the "significant" part of their keys
767 * (see the discussion near the top of this file)
768 * will differ by one bit, which will be "0" in
769 * left's key and "1" in right's key. Since we are
770 * moving the key position by one step, the bit that
771 * we are moving away from - the bit at position
772 * (inode->pos) - is the one that will differ between
773 * left and right. So... we synthesize that bit in the
774 * two new keys.
775 * The mask 'm' below will be a single "one" bit at
776 * the position (inode->pos)
777 */
Robert Olsson19baf832005-06-21 12:43:18 -0700778
Olof Johansson91b9a272005-08-09 20:24:39 -0700779 /* Use the old key, but set the new significant
780 * bit to zero.
781 */
Robert Olsson19baf832005-06-21 12:43:18 -0700782
Olof Johansson91b9a272005-08-09 20:24:39 -0700783 left = (struct tnode *) tnode_get_child(tn, 2*i);
784 put_child(t, tn, 2*i, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -0700785
Olof Johansson91b9a272005-08-09 20:24:39 -0700786 BUG_ON(!left);
Robert Olsson2f368952005-07-05 15:02:40 -0700787
Olof Johansson91b9a272005-08-09 20:24:39 -0700788 right = (struct tnode *) tnode_get_child(tn, 2*i+1);
789 put_child(t, tn, 2*i+1, NULL);
Robert Olsson2f368952005-07-05 15:02:40 -0700790
Olof Johansson91b9a272005-08-09 20:24:39 -0700791 BUG_ON(!right);
Robert Olsson2f368952005-07-05 15:02:40 -0700792
Olof Johansson91b9a272005-08-09 20:24:39 -0700793 size = tnode_child_length(left);
794 for (j = 0; j < size; j++) {
795 put_child(t, left, j, inode->child[j]);
796 put_child(t, right, j, inode->child[j + size]);
Robert Olsson19baf832005-06-21 12:43:18 -0700797 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700798 put_child(t, tn, 2*i, resize(t, left));
799 put_child(t, tn, 2*i+1, resize(t, right));
800
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700801 tnode_free_safe(inode);
Robert Olsson19baf832005-06-21 12:43:18 -0700802 }
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700803 tnode_free_safe(oldtnode);
Robert Olsson19baf832005-06-21 12:43:18 -0700804 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700805nomem:
806 {
807 int size = tnode_child_length(tn);
808 int j;
809
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700810 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700811 if (tn->child[j])
812 tnode_free((struct tnode *)tn->child[j]);
813
814 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700815
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700816 return ERR_PTR(-ENOMEM);
817 }
Robert Olsson19baf832005-06-21 12:43:18 -0700818}
819
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700820static struct tnode *halve(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700821{
822 struct tnode *oldtnode = tn;
David S. Millerb299e4f2011-02-02 20:48:10 -0800823 struct rt_trie_node *left, *right;
Robert Olsson19baf832005-06-21 12:43:18 -0700824 int i;
825 int olen = tnode_child_length(tn);
826
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700827 pr_debug("In halve\n");
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700828
829 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits - 1);
Robert Olsson19baf832005-06-21 12:43:18 -0700830
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700831 if (!tn)
832 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700833
834 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700835 * Preallocate and store tnodes before the actual work so we
836 * don't get into an inconsistent state if memory allocation
837 * fails. In case of failure we return the oldnode and halve
Robert Olsson2f368952005-07-05 15:02:40 -0700838 * of tnode is ignored.
839 */
840
Olof Johansson91b9a272005-08-09 20:24:39 -0700841 for (i = 0; i < olen; i += 2) {
Robert Olsson2f368952005-07-05 15:02:40 -0700842 left = tnode_get_child(oldtnode, i);
843 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700844
Robert Olsson2f368952005-07-05 15:02:40 -0700845 /* Two nonempty children */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700846 if (left && right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700847 struct tnode *newn;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700848
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700849 newn = tnode_new(left->key, tn->pos + tn->bits, 1);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700850
851 if (!newn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700852 goto nomem;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700853
David S. Millerb299e4f2011-02-02 20:48:10 -0800854 put_child(t, tn, i/2, (struct rt_trie_node *)newn);
Robert Olsson2f368952005-07-05 15:02:40 -0700855 }
Robert Olsson2f368952005-07-05 15:02:40 -0700856
Robert Olsson2f368952005-07-05 15:02:40 -0700857 }
Robert Olsson19baf832005-06-21 12:43:18 -0700858
Olof Johansson91b9a272005-08-09 20:24:39 -0700859 for (i = 0; i < olen; i += 2) {
860 struct tnode *newBinNode;
861
Robert Olsson19baf832005-06-21 12:43:18 -0700862 left = tnode_get_child(oldtnode, i);
863 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700864
Robert Olsson19baf832005-06-21 12:43:18 -0700865 /* At least one of the children is empty */
866 if (left == NULL) {
867 if (right == NULL) /* Both are empty */
868 continue;
869 put_child(t, tn, i/2, right);
Olof Johansson91b9a272005-08-09 20:24:39 -0700870 continue;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700871 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700872
873 if (right == NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700874 put_child(t, tn, i/2, left);
Olof Johansson91b9a272005-08-09 20:24:39 -0700875 continue;
876 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700877
Robert Olsson19baf832005-06-21 12:43:18 -0700878 /* Two nonempty children */
Olof Johansson91b9a272005-08-09 20:24:39 -0700879 newBinNode = (struct tnode *) tnode_get_child(tn, i/2);
880 put_child(t, tn, i/2, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700881 put_child(t, newBinNode, 0, left);
882 put_child(t, newBinNode, 1, right);
883 put_child(t, tn, i/2, resize(t, newBinNode));
Robert Olsson19baf832005-06-21 12:43:18 -0700884 }
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700885 tnode_free_safe(oldtnode);
Robert Olsson19baf832005-06-21 12:43:18 -0700886 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700887nomem:
888 {
889 int size = tnode_child_length(tn);
890 int j;
891
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700892 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700893 if (tn->child[j])
894 tnode_free((struct tnode *)tn->child[j]);
895
896 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700897
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700898 return ERR_PTR(-ENOMEM);
899 }
Robert Olsson19baf832005-06-21 12:43:18 -0700900}
901
Robert Olsson772cb712005-09-19 15:31:18 -0700902/* readside must use rcu_read_lock currently dump routines
Robert Olsson2373ce12005-08-25 13:01:29 -0700903 via get_fa_head and dump */
904
Robert Olsson772cb712005-09-19 15:31:18 -0700905static struct leaf_info *find_leaf_info(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700906{
Robert Olsson772cb712005-09-19 15:31:18 -0700907 struct hlist_head *head = &l->list;
Robert Olsson19baf832005-06-21 12:43:18 -0700908 struct hlist_node *node;
909 struct leaf_info *li;
910
Robert Olsson2373ce12005-08-25 13:01:29 -0700911 hlist_for_each_entry_rcu(li, node, head, hlist)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700912 if (li->plen == plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700913 return li;
Olof Johansson91b9a272005-08-09 20:24:39 -0700914
Robert Olsson19baf832005-06-21 12:43:18 -0700915 return NULL;
916}
917
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800918static inline struct list_head *get_fa_head(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700919{
Robert Olsson772cb712005-09-19 15:31:18 -0700920 struct leaf_info *li = find_leaf_info(l, plen);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700921
Olof Johansson91b9a272005-08-09 20:24:39 -0700922 if (!li)
923 return NULL;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700924
Olof Johansson91b9a272005-08-09 20:24:39 -0700925 return &li->falh;
Robert Olsson19baf832005-06-21 12:43:18 -0700926}
927
928static void insert_leaf_info(struct hlist_head *head, struct leaf_info *new)
929{
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900930 struct leaf_info *li = NULL, *last = NULL;
931 struct hlist_node *node;
Robert Olsson19baf832005-06-21 12:43:18 -0700932
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900933 if (hlist_empty(head)) {
934 hlist_add_head_rcu(&new->hlist, head);
935 } else {
936 hlist_for_each_entry(li, node, head, hlist) {
937 if (new->plen > li->plen)
938 break;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700939
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900940 last = li;
941 }
942 if (last)
943 hlist_add_after_rcu(&last->hlist, &new->hlist);
944 else
945 hlist_add_before_rcu(&new->hlist, &li->hlist);
946 }
Robert Olsson19baf832005-06-21 12:43:18 -0700947}
948
Robert Olsson2373ce12005-08-25 13:01:29 -0700949/* rcu_read_lock needs to be hold by caller from readside */
950
Robert Olsson19baf832005-06-21 12:43:18 -0700951static struct leaf *
952fib_find_node(struct trie *t, u32 key)
953{
954 int pos;
955 struct tnode *tn;
David S. Millerb299e4f2011-02-02 20:48:10 -0800956 struct rt_trie_node *n;
Robert Olsson19baf832005-06-21 12:43:18 -0700957
958 pos = 0;
Eric Dumazeta034ee32010-09-09 23:32:28 +0000959 n = rcu_dereference_rtnl(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -0700960
961 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
962 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -0700963
Robert Olsson19baf832005-06-21 12:43:18 -0700964 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700965
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700966 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700967 pos = tn->pos + tn->bits;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800968 n = tnode_get_child_rcu(tn,
969 tkey_extract_bits(key,
970 tn->pos,
971 tn->bits));
Olof Johansson91b9a272005-08-09 20:24:39 -0700972 } else
Robert Olsson19baf832005-06-21 12:43:18 -0700973 break;
974 }
975 /* Case we have found a leaf. Compare prefixes */
976
Olof Johansson91b9a272005-08-09 20:24:39 -0700977 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key))
978 return (struct leaf *)n;
979
Robert Olsson19baf832005-06-21 12:43:18 -0700980 return NULL;
981}
982
Jarek Poplawski7b855762009-06-18 00:28:51 -0700983static void trie_rebalance(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700984{
Robert Olsson19baf832005-06-21 12:43:18 -0700985 int wasfull;
Robert Olsson3ed18d72009-05-21 15:20:59 -0700986 t_key cindex, key;
Stephen Hemminger06801912007-08-10 15:22:13 -0700987 struct tnode *tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700988
Robert Olsson3ed18d72009-05-21 15:20:59 -0700989 key = tn->key;
990
David S. Millerb299e4f2011-02-02 20:48:10 -0800991 while (tn != NULL && (tp = node_parent((struct rt_trie_node *)tn)) != NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700992 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
993 wasfull = tnode_full(tp, tnode_get_child(tp, cindex));
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800994 tn = (struct tnode *) resize(t, (struct tnode *)tn);
995
996 tnode_put_child_reorg((struct tnode *)tp, cindex,
David S. Millerb299e4f2011-02-02 20:48:10 -0800997 (struct rt_trie_node *)tn, wasfull);
Olof Johansson91b9a272005-08-09 20:24:39 -0700998
David S. Millerb299e4f2011-02-02 20:48:10 -0800999 tp = node_parent((struct rt_trie_node *) tn);
Jarek Poplawski008440e2009-06-30 12:47:19 -07001000 if (!tp)
David S. Millerb299e4f2011-02-02 20:48:10 -08001001 rcu_assign_pointer(t->trie, (struct rt_trie_node *)tn);
Jarek Poplawski008440e2009-06-30 12:47:19 -07001002
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -07001003 tnode_free_flush();
Stephen Hemminger06801912007-08-10 15:22:13 -07001004 if (!tp)
Robert Olsson19baf832005-06-21 12:43:18 -07001005 break;
Stephen Hemminger06801912007-08-10 15:22:13 -07001006 tn = tp;
Robert Olsson19baf832005-06-21 12:43:18 -07001007 }
Stephen Hemminger06801912007-08-10 15:22:13 -07001008
Robert Olsson19baf832005-06-21 12:43:18 -07001009 /* Handle last (top) tnode */
Jarek Poplawski7b855762009-06-18 00:28:51 -07001010 if (IS_TNODE(tn))
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001011 tn = (struct tnode *)resize(t, (struct tnode *)tn);
Robert Olsson19baf832005-06-21 12:43:18 -07001012
David S. Millerb299e4f2011-02-02 20:48:10 -08001013 rcu_assign_pointer(t->trie, (struct rt_trie_node *)tn);
Jarek Poplawski7b855762009-06-18 00:28:51 -07001014 tnode_free_flush();
Robert Olsson19baf832005-06-21 12:43:18 -07001015}
1016
Robert Olsson2373ce12005-08-25 13:01:29 -07001017/* only used from updater-side */
1018
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001019static struct list_head *fib_insert_node(struct trie *t, u32 key, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -07001020{
1021 int pos, newpos;
1022 struct tnode *tp = NULL, *tn = NULL;
David S. Millerb299e4f2011-02-02 20:48:10 -08001023 struct rt_trie_node *n;
Robert Olsson19baf832005-06-21 12:43:18 -07001024 struct leaf *l;
1025 int missbit;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001026 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001027 struct leaf_info *li;
1028 t_key cindex;
1029
1030 pos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001031 n = t->trie;
Robert Olsson19baf832005-06-21 12:43:18 -07001032
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001033 /* If we point to NULL, stop. Either the tree is empty and we should
1034 * just put a new leaf in if, or we have reached an empty child slot,
Robert Olsson19baf832005-06-21 12:43:18 -07001035 * and we should just put our new leaf in that.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001036 * If we point to a T_TNODE, check if it matches our key. Note that
1037 * a T_TNODE might be skipping any number of bits - its 'pos' need
Robert Olsson19baf832005-06-21 12:43:18 -07001038 * not be the parent's 'pos'+'bits'!
1039 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001040 * If it does match the current key, get pos/bits from it, extract
Robert Olsson19baf832005-06-21 12:43:18 -07001041 * the index from our key, push the T_TNODE and walk the tree.
1042 *
1043 * If it doesn't, we have to replace it with a new T_TNODE.
1044 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001045 * If we point to a T_LEAF, it might or might not have the same key
1046 * as we do. If it does, just change the value, update the T_LEAF's
1047 * value, and return it.
Robert Olsson19baf832005-06-21 12:43:18 -07001048 * If it doesn't, we need to replace it with a T_TNODE.
1049 */
1050
1051 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
1052 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -07001053
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001054 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001055
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001056 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001057 tp = tn;
Olof Johansson91b9a272005-08-09 20:24:39 -07001058 pos = tn->pos + tn->bits;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001059 n = tnode_get_child(tn,
1060 tkey_extract_bits(key,
1061 tn->pos,
1062 tn->bits));
Robert Olsson19baf832005-06-21 12:43:18 -07001063
Stephen Hemminger06801912007-08-10 15:22:13 -07001064 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001065 } else
Robert Olsson19baf832005-06-21 12:43:18 -07001066 break;
1067 }
1068
1069 /*
1070 * n ----> NULL, LEAF or TNODE
1071 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001072 * tp is n's (parent) ----> NULL or TNODE
Robert Olsson19baf832005-06-21 12:43:18 -07001073 */
1074
Olof Johansson91b9a272005-08-09 20:24:39 -07001075 BUG_ON(tp && IS_LEAF(tp));
Robert Olsson19baf832005-06-21 12:43:18 -07001076
1077 /* Case 1: n is a leaf. Compare prefixes */
1078
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001079 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key)) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08001080 l = (struct leaf *) n;
Robert Olsson19baf832005-06-21 12:43:18 -07001081 li = leaf_info_new(plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001082
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001083 if (!li)
1084 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001085
1086 fa_head = &li->falh;
1087 insert_leaf_info(&l->list, li);
1088 goto done;
1089 }
Robert Olsson19baf832005-06-21 12:43:18 -07001090 l = leaf_new();
1091
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001092 if (!l)
1093 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001094
1095 l->key = key;
1096 li = leaf_info_new(plen);
1097
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001098 if (!li) {
Stephen Hemminger387a5482008-04-10 03:47:34 -07001099 free_leaf(l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001100 return NULL;
Robert Olssonf835e472005-06-28 15:00:39 -07001101 }
Robert Olsson19baf832005-06-21 12:43:18 -07001102
1103 fa_head = &li->falh;
1104 insert_leaf_info(&l->list, li);
1105
Robert Olsson19baf832005-06-21 12:43:18 -07001106 if (t->trie && n == NULL) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001107 /* Case 2: n is NULL, and will just insert a new leaf */
Robert Olsson19baf832005-06-21 12:43:18 -07001108
David S. Millerb299e4f2011-02-02 20:48:10 -08001109 node_set_parent((struct rt_trie_node *)l, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001110
Olof Johansson91b9a272005-08-09 20:24:39 -07001111 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
David S. Millerb299e4f2011-02-02 20:48:10 -08001112 put_child(t, (struct tnode *)tp, cindex, (struct rt_trie_node *)l);
Olof Johansson91b9a272005-08-09 20:24:39 -07001113 } else {
1114 /* Case 3: n is a LEAF or a TNODE and the key doesn't match. */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001115 /*
1116 * Add a new tnode here
Robert Olsson19baf832005-06-21 12:43:18 -07001117 * first tnode need some special handling
1118 */
1119
1120 if (tp)
Olof Johansson91b9a272005-08-09 20:24:39 -07001121 pos = tp->pos+tp->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001122 else
Olof Johansson91b9a272005-08-09 20:24:39 -07001123 pos = 0;
1124
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001125 if (n) {
Robert Olsson19baf832005-06-21 12:43:18 -07001126 newpos = tkey_mismatch(key, pos, n->key);
1127 tn = tnode_new(n->key, newpos, 1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001128 } else {
Robert Olsson19baf832005-06-21 12:43:18 -07001129 newpos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001130 tn = tnode_new(key, newpos, 1); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001131 }
Robert Olsson19baf832005-06-21 12:43:18 -07001132
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001133 if (!tn) {
Robert Olssonf835e472005-06-28 15:00:39 -07001134 free_leaf_info(li);
Stephen Hemminger387a5482008-04-10 03:47:34 -07001135 free_leaf(l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001136 return NULL;
Olof Johansson91b9a272005-08-09 20:24:39 -07001137 }
1138
David S. Millerb299e4f2011-02-02 20:48:10 -08001139 node_set_parent((struct rt_trie_node *)tn, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001140
Olof Johansson91b9a272005-08-09 20:24:39 -07001141 missbit = tkey_extract_bits(key, newpos, 1);
David S. Millerb299e4f2011-02-02 20:48:10 -08001142 put_child(t, tn, missbit, (struct rt_trie_node *)l);
Robert Olsson19baf832005-06-21 12:43:18 -07001143 put_child(t, tn, 1-missbit, n);
1144
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001145 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001146 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001147 put_child(t, (struct tnode *)tp, cindex,
David S. Millerb299e4f2011-02-02 20:48:10 -08001148 (struct rt_trie_node *)tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001149 } else {
David S. Millerb299e4f2011-02-02 20:48:10 -08001150 rcu_assign_pointer(t->trie, (struct rt_trie_node *)tn);
Robert Olsson19baf832005-06-21 12:43:18 -07001151 tp = tn;
1152 }
1153 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001154
1155 if (tp && tp->pos + tp->bits > 32)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001156 pr_warning("fib_trie"
1157 " tp=%p pos=%d, bits=%d, key=%0x plen=%d\n",
1158 tp, tp->pos, tp->bits, key, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001159
Robert Olsson19baf832005-06-21 12:43:18 -07001160 /* Rebalance the trie */
Robert Olsson2373ce12005-08-25 13:01:29 -07001161
Jarek Poplawski7b855762009-06-18 00:28:51 -07001162 trie_rebalance(t, tp);
Robert Olssonf835e472005-06-28 15:00:39 -07001163done:
Robert Olsson19baf832005-06-21 12:43:18 -07001164 return fa_head;
1165}
1166
Robert Olssond562f1f2007-03-26 14:22:22 -07001167/*
1168 * Caller must hold RTNL.
1169 */
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001170int fib_table_insert(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001171{
1172 struct trie *t = (struct trie *) tb->tb_data;
1173 struct fib_alias *fa, *new_fa;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001174 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001175 struct fib_info *fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001176 int plen = cfg->fc_dst_len;
1177 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001178 u32 key, mask;
1179 int err;
1180 struct leaf *l;
1181
1182 if (plen > 32)
1183 return -EINVAL;
1184
Thomas Graf4e902c52006-08-17 18:14:52 -07001185 key = ntohl(cfg->fc_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001186
Patrick McHardy2dfe55b2006-08-10 23:08:33 -07001187 pr_debug("Insert table=%u %08x/%d\n", tb->tb_id, key, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001188
Olof Johansson91b9a272005-08-09 20:24:39 -07001189 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001190
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001191 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001192 return -EINVAL;
1193
1194 key = key & mask;
1195
Thomas Graf4e902c52006-08-17 18:14:52 -07001196 fi = fib_create_info(cfg);
1197 if (IS_ERR(fi)) {
1198 err = PTR_ERR(fi);
Robert Olsson19baf832005-06-21 12:43:18 -07001199 goto err;
Thomas Graf4e902c52006-08-17 18:14:52 -07001200 }
Robert Olsson19baf832005-06-21 12:43:18 -07001201
1202 l = fib_find_node(t, key);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001203 fa = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001204
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001205 if (l) {
Robert Olsson19baf832005-06-21 12:43:18 -07001206 fa_head = get_fa_head(l, plen);
1207 fa = fib_find_alias(fa_head, tos, fi->fib_priority);
1208 }
1209
1210 /* Now fa, if non-NULL, points to the first fib alias
1211 * with the same keys [prefix,tos,priority], if such key already
1212 * exists or to the node before which we will insert new one.
1213 *
1214 * If fa is NULL, we will need to allocate a new one and
1215 * insert to the head of f.
1216 *
1217 * If f is NULL, no fib node matched the destination key
1218 * and we need to allocate a new one of those as well.
1219 */
1220
Julian Anastasov936f6f82008-01-28 21:18:06 -08001221 if (fa && fa->fa_tos == tos &&
1222 fa->fa_info->fib_priority == fi->fib_priority) {
1223 struct fib_alias *fa_first, *fa_match;
Robert Olsson19baf832005-06-21 12:43:18 -07001224
1225 err = -EEXIST;
Thomas Graf4e902c52006-08-17 18:14:52 -07001226 if (cfg->fc_nlflags & NLM_F_EXCL)
Robert Olsson19baf832005-06-21 12:43:18 -07001227 goto out;
1228
Julian Anastasov936f6f82008-01-28 21:18:06 -08001229 /* We have 2 goals:
1230 * 1. Find exact match for type, scope, fib_info to avoid
1231 * duplicate routes
1232 * 2. Find next 'fa' (or head), NLM_F_APPEND inserts before it
1233 */
1234 fa_match = NULL;
1235 fa_first = fa;
1236 fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list);
1237 list_for_each_entry_continue(fa, fa_head, fa_list) {
1238 if (fa->fa_tos != tos)
1239 break;
1240 if (fa->fa_info->fib_priority != fi->fib_priority)
1241 break;
1242 if (fa->fa_type == cfg->fc_type &&
Julian Anastasov936f6f82008-01-28 21:18:06 -08001243 fa->fa_info == fi) {
1244 fa_match = fa;
1245 break;
1246 }
1247 }
1248
Thomas Graf4e902c52006-08-17 18:14:52 -07001249 if (cfg->fc_nlflags & NLM_F_REPLACE) {
Robert Olsson19baf832005-06-21 12:43:18 -07001250 struct fib_info *fi_drop;
1251 u8 state;
1252
Julian Anastasov936f6f82008-01-28 21:18:06 -08001253 fa = fa_first;
1254 if (fa_match) {
1255 if (fa == fa_match)
1256 err = 0;
Joonwoo Park67250332008-01-18 03:45:18 -08001257 goto out;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001258 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001259 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001260 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001261 if (new_fa == NULL)
1262 goto out;
Robert Olsson19baf832005-06-21 12:43:18 -07001263
1264 fi_drop = fa->fa_info;
Robert Olsson2373ce12005-08-25 13:01:29 -07001265 new_fa->fa_tos = fa->fa_tos;
1266 new_fa->fa_info = fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001267 new_fa->fa_type = cfg->fc_type;
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)
Denis V. Lunev76e6ebf2008-07-05 19:00:44 -07001276 rt_cache_flush(cfg->fc_nlinfo.nl_net, -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;
Robert Olsson19baf832005-06-21 12:43:18 -07001304 new_fa->fa_state = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001305 /*
1306 * Insert new entry to the list.
1307 */
1308
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001309 if (!fa_head) {
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001310 fa_head = fib_insert_node(t, key, plen);
1311 if (unlikely(!fa_head)) {
1312 err = -ENOMEM;
Robert Olssonf835e472005-06-28 15:00:39 -07001313 goto out_free_new_fa;
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001314 }
Robert Olssonf835e472005-06-28 15:00:39 -07001315 }
Robert Olsson19baf832005-06-21 12:43:18 -07001316
Robert Olsson2373ce12005-08-25 13:01:29 -07001317 list_add_tail_rcu(&new_fa->fa_list,
1318 (fa ? &fa->fa_list : fa_head));
Robert Olsson19baf832005-06-21 12:43:18 -07001319
Denis V. Lunev76e6ebf2008-07-05 19:00:44 -07001320 rt_cache_flush(cfg->fc_nlinfo.nl_net, -1);
Thomas Graf4e902c52006-08-17 18:14:52 -07001321 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001322 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001323succeeded:
1324 return 0;
Robert Olssonf835e472005-06-28 15:00:39 -07001325
1326out_free_new_fa:
1327 kmem_cache_free(fn_alias_kmem, new_fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001328out:
1329 fib_release_info(fi);
Olof Johansson91b9a272005-08-09 20:24:39 -07001330err:
Robert Olsson19baf832005-06-21 12:43:18 -07001331 return err;
1332}
1333
Robert Olsson772cb712005-09-19 15:31:18 -07001334/* should be called with rcu_read_lock */
David S. Miller5b470442011-01-31 16:10:03 -08001335static int check_leaf(struct fib_table *tb, struct trie *t, struct leaf *l,
David S. Miller22bd5b92011-03-11 19:54:08 -05001336 t_key key, const struct flowi4 *flp,
Eric Dumazetebc0ffa2010-10-05 10:41:36 +00001337 struct fib_result *res, int fib_flags)
Robert Olsson19baf832005-06-21 12:43:18 -07001338{
Robert Olsson19baf832005-06-21 12:43:18 -07001339 struct leaf_info *li;
1340 struct hlist_head *hhead = &l->list;
1341 struct hlist_node *node;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001342
Robert Olsson2373ce12005-08-25 13:01:29 -07001343 hlist_for_each_entry_rcu(li, node, hhead, hlist) {
David S. Miller3be06862011-03-07 15:01:10 -08001344 struct fib_alias *fa;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001345 int plen = li->plen;
1346 __be32 mask = inet_make_mask(plen);
1347
Al Viro888454c2006-09-19 13:42:46 -07001348 if (l->key != (key & ntohl(mask)))
Robert Olsson19baf832005-06-21 12:43:18 -07001349 continue;
1350
David S. Miller3be06862011-03-07 15:01:10 -08001351 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
1352 struct fib_info *fi = fa->fa_info;
1353 int nhsel, err;
1354
David S. Miller22bd5b92011-03-11 19:54:08 -05001355 if (fa->fa_tos && fa->fa_tos != flp->flowi4_tos)
David S. Miller3be06862011-03-07 15:01:10 -08001356 continue;
David S. Miller37e826c2011-03-24 18:06:47 -07001357 if (fa->fa_info->fib_scope < flp->flowi4_scope)
David S. Miller3be06862011-03-07 15:01:10 -08001358 continue;
1359 fib_alias_accessed(fa);
1360 err = fib_props[fa->fa_type].error;
1361 if (err) {
1362#ifdef CONFIG_IP_FIB_TRIE_STATS
Julian Anastasov1fbc7842011-03-25 20:33:23 -07001363 t->stats.semantic_match_passed++;
David S. Miller3be06862011-03-07 15:01:10 -08001364#endif
Julian Anastasov1fbc7842011-03-25 20:33:23 -07001365 return err;
David S. Miller3be06862011-03-07 15:01:10 -08001366 }
1367 if (fi->fib_flags & RTNH_F_DEAD)
1368 continue;
1369 for (nhsel = 0; nhsel < fi->fib_nhs; nhsel++) {
1370 const struct fib_nh *nh = &fi->fib_nh[nhsel];
1371
1372 if (nh->nh_flags & RTNH_F_DEAD)
1373 continue;
David S. Miller22bd5b92011-03-11 19:54:08 -05001374 if (flp->flowi4_oif && flp->flowi4_oif != nh->nh_oif)
David S. Miller3be06862011-03-07 15:01:10 -08001375 continue;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001376
Robert Olsson19baf832005-06-21 12:43:18 -07001377#ifdef CONFIG_IP_FIB_TRIE_STATS
David S. Miller3be06862011-03-07 15:01:10 -08001378 t->stats.semantic_match_passed++;
Robert Olsson19baf832005-06-21 12:43:18 -07001379#endif
David S. Miller3be06862011-03-07 15:01:10 -08001380 res->prefixlen = plen;
1381 res->nh_sel = nhsel;
1382 res->type = fa->fa_type;
David S. Miller37e826c2011-03-24 18:06:47 -07001383 res->scope = fa->fa_info->fib_scope;
David S. Miller3be06862011-03-07 15:01:10 -08001384 res->fi = fi;
1385 res->table = tb;
1386 res->fa_head = &li->falh;
1387 if (!(fib_flags & FIB_LOOKUP_NOREF))
1388 atomic_inc(&res->fi->fib_clntref);
1389 return 0;
1390 }
1391 }
1392
1393#ifdef CONFIG_IP_FIB_TRIE_STATS
1394 t->stats.semantic_match_miss++;
1395#endif
Robert Olsson19baf832005-06-21 12:43:18 -07001396 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001397
Ben Hutchings2e655572008-07-10 16:52:52 -07001398 return 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001399}
1400
David S. Miller22bd5b92011-03-11 19:54:08 -05001401int fib_table_lookup(struct fib_table *tb, const struct flowi4 *flp,
Eric Dumazetebc0ffa2010-10-05 10:41:36 +00001402 struct fib_result *res, int fib_flags)
Robert Olsson19baf832005-06-21 12:43:18 -07001403{
1404 struct trie *t = (struct trie *) tb->tb_data;
Ben Hutchings2e655572008-07-10 16:52:52 -07001405 int ret;
David S. Millerb299e4f2011-02-02 20:48:10 -08001406 struct rt_trie_node *n;
Robert Olsson19baf832005-06-21 12:43:18 -07001407 struct tnode *pn;
David S. Miller3b004562011-02-16 14:56:22 -08001408 unsigned int pos, bits;
David S. Miller22bd5b92011-03-11 19:54:08 -05001409 t_key key = ntohl(flp->daddr);
David S. Miller3b004562011-02-16 14:56:22 -08001410 unsigned int chopped_off;
Robert Olsson19baf832005-06-21 12:43:18 -07001411 t_key cindex = 0;
David S. Miller3b004562011-02-16 14:56:22 -08001412 unsigned int current_prefix_length = KEYLENGTH;
Olof Johansson91b9a272005-08-09 20:24:39 -07001413 struct tnode *cn;
Eric Dumazet874ffa82010-10-13 06:56:11 +00001414 t_key pref_mismatch;
Olof Johansson91b9a272005-08-09 20:24:39 -07001415
Robert Olsson2373ce12005-08-25 13:01:29 -07001416 rcu_read_lock();
Robert Olsson19baf832005-06-21 12:43:18 -07001417
Robert Olsson2373ce12005-08-25 13:01:29 -07001418 n = rcu_dereference(t->trie);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001419 if (!n)
Robert Olsson19baf832005-06-21 12:43:18 -07001420 goto failed;
1421
1422#ifdef CONFIG_IP_FIB_TRIE_STATS
1423 t->stats.gets++;
1424#endif
1425
1426 /* Just a leaf? */
1427 if (IS_LEAF(n)) {
David S. Miller5b470442011-01-31 16:10:03 -08001428 ret = check_leaf(tb, t, (struct leaf *)n, key, flp, res, fib_flags);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001429 goto found;
Robert Olsson19baf832005-06-21 12:43:18 -07001430 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001431
Robert Olsson19baf832005-06-21 12:43:18 -07001432 pn = (struct tnode *) n;
1433 chopped_off = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001434
Olof Johansson91b9a272005-08-09 20:24:39 -07001435 while (pn) {
Robert Olsson19baf832005-06-21 12:43:18 -07001436 pos = pn->pos;
1437 bits = pn->bits;
1438
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001439 if (!chopped_off)
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001440 cindex = tkey_extract_bits(mask_pfx(key, current_prefix_length),
1441 pos, bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001442
Jarek Poplawskib902e572009-07-14 11:20:32 +00001443 n = tnode_get_child_rcu(pn, cindex);
Robert Olsson19baf832005-06-21 12:43:18 -07001444
1445 if (n == NULL) {
1446#ifdef CONFIG_IP_FIB_TRIE_STATS
1447 t->stats.null_node_hit++;
1448#endif
1449 goto backtrace;
1450 }
1451
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001452 if (IS_LEAF(n)) {
David S. Miller5b470442011-01-31 16:10:03 -08001453 ret = check_leaf(tb, t, (struct leaf *)n, key, flp, res, fib_flags);
Ben Hutchings2e655572008-07-10 16:52:52 -07001454 if (ret > 0)
Olof Johansson91b9a272005-08-09 20:24:39 -07001455 goto backtrace;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001456 goto found;
Olof Johansson91b9a272005-08-09 20:24:39 -07001457 }
1458
Olof Johansson91b9a272005-08-09 20:24:39 -07001459 cn = (struct tnode *)n;
1460
1461 /*
1462 * It's a tnode, and we can do some extra checks here if we
1463 * like, to avoid descending into a dead-end branch.
1464 * This tnode is in the parent's child array at index
1465 * key[p_pos..p_pos+p_bits] but potentially with some bits
1466 * chopped off, so in reality the index may be just a
1467 * subprefix, padded with zero at the end.
1468 * We can also take a look at any skipped bits in this
1469 * tnode - everything up to p_pos is supposed to be ok,
1470 * and the non-chopped bits of the index (se previous
1471 * paragraph) are also guaranteed ok, but the rest is
1472 * considered unknown.
1473 *
1474 * The skipped bits are key[pos+bits..cn->pos].
1475 */
1476
1477 /* If current_prefix_length < pos+bits, we are already doing
1478 * actual prefix matching, which means everything from
1479 * pos+(bits-chopped_off) onward must be zero along some
1480 * branch of this subtree - otherwise there is *no* valid
1481 * prefix present. Here we can only check the skipped
1482 * bits. Remember, since we have already indexed into the
1483 * parent's child array, we know that the bits we chopped of
1484 * *are* zero.
1485 */
1486
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001487 /* NOTA BENE: Checking only skipped bits
1488 for the new node here */
Olof Johansson91b9a272005-08-09 20:24:39 -07001489
1490 if (current_prefix_length < pos+bits) {
1491 if (tkey_extract_bits(cn->key, current_prefix_length,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001492 cn->pos - current_prefix_length)
1493 || !(cn->child[0]))
Olof Johansson91b9a272005-08-09 20:24:39 -07001494 goto backtrace;
1495 }
1496
1497 /*
1498 * If chopped_off=0, the index is fully validated and we
1499 * only need to look at the skipped bits for this, the new,
1500 * tnode. What we actually want to do is to find out if
1501 * these skipped bits match our key perfectly, or if we will
1502 * have to count on finding a matching prefix further down,
1503 * because if we do, we would like to have some way of
1504 * verifying the existence of such a prefix at this point.
1505 */
1506
1507 /* The only thing we can do at this point is to verify that
1508 * any such matching prefix can indeed be a prefix to our
1509 * key, and if the bits in the node we are inspecting that
1510 * do not match our key are not ZERO, this cannot be true.
1511 * Thus, find out where there is a mismatch (before cn->pos)
1512 * and verify that all the mismatching bits are zero in the
1513 * new tnode's key.
1514 */
1515
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001516 /*
1517 * Note: We aren't very concerned about the piece of
1518 * the key that precede pn->pos+pn->bits, since these
1519 * have already been checked. The bits after cn->pos
1520 * aren't checked since these are by definition
1521 * "unknown" at this point. Thus, what we want to see
1522 * is if we are about to enter the "prefix matching"
1523 * state, and in that case verify that the skipped
1524 * bits that will prevail throughout this subtree are
1525 * zero, as they have to be if we are to find a
1526 * matching prefix.
Olof Johansson91b9a272005-08-09 20:24:39 -07001527 */
1528
Eric Dumazet874ffa82010-10-13 06:56:11 +00001529 pref_mismatch = mask_pfx(cn->key ^ key, cn->pos);
Olof Johansson91b9a272005-08-09 20:24:39 -07001530
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001531 /*
1532 * In short: If skipped bits in this node do not match
1533 * the search key, enter the "prefix matching"
1534 * state.directly.
Olof Johansson91b9a272005-08-09 20:24:39 -07001535 */
1536 if (pref_mismatch) {
Eric Dumazet874ffa82010-10-13 06:56:11 +00001537 int mp = KEYLENGTH - fls(pref_mismatch);
Olof Johansson91b9a272005-08-09 20:24:39 -07001538
Eric Dumazet874ffa82010-10-13 06:56:11 +00001539 if (tkey_extract_bits(cn->key, mp, cn->pos - mp) != 0)
Olof Johansson91b9a272005-08-09 20:24:39 -07001540 goto backtrace;
1541
1542 if (current_prefix_length >= cn->pos)
1543 current_prefix_length = mp;
1544 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001545
Olof Johansson91b9a272005-08-09 20:24:39 -07001546 pn = (struct tnode *)n; /* Descend */
1547 chopped_off = 0;
1548 continue;
1549
Robert Olsson19baf832005-06-21 12:43:18 -07001550backtrace:
1551 chopped_off++;
1552
1553 /* As zero don't change the child key (cindex) */
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001554 while ((chopped_off <= pn->bits)
1555 && !(cindex & (1<<(chopped_off-1))))
Robert Olsson19baf832005-06-21 12:43:18 -07001556 chopped_off++;
Robert Olsson19baf832005-06-21 12:43:18 -07001557
1558 /* Decrease current_... with bits chopped off */
1559 if (current_prefix_length > pn->pos + pn->bits - chopped_off)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001560 current_prefix_length = pn->pos + pn->bits
1561 - chopped_off;
Olof Johansson91b9a272005-08-09 20:24:39 -07001562
Robert Olsson19baf832005-06-21 12:43:18 -07001563 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001564 * Either we do the actual chop off according or if we have
Robert Olsson19baf832005-06-21 12:43:18 -07001565 * chopped off all bits in this tnode walk up to our parent.
1566 */
1567
Olof Johansson91b9a272005-08-09 20:24:39 -07001568 if (chopped_off <= pn->bits) {
Robert Olsson19baf832005-06-21 12:43:18 -07001569 cindex &= ~(1 << (chopped_off-1));
Olof Johansson91b9a272005-08-09 20:24:39 -07001570 } else {
David S. Millerb299e4f2011-02-02 20:48:10 -08001571 struct tnode *parent = node_parent_rcu((struct rt_trie_node *) pn);
Stephen Hemminger06801912007-08-10 15:22:13 -07001572 if (!parent)
Robert Olsson19baf832005-06-21 12:43:18 -07001573 goto failed;
Olof Johansson91b9a272005-08-09 20:24:39 -07001574
Robert Olsson19baf832005-06-21 12:43:18 -07001575 /* Get Child's index */
Stephen Hemminger06801912007-08-10 15:22:13 -07001576 cindex = tkey_extract_bits(pn->key, parent->pos, parent->bits);
1577 pn = parent;
Robert Olsson19baf832005-06-21 12:43:18 -07001578 chopped_off = 0;
1579
1580#ifdef CONFIG_IP_FIB_TRIE_STATS
1581 t->stats.backtrack++;
1582#endif
1583 goto backtrace;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001584 }
Robert Olsson19baf832005-06-21 12:43:18 -07001585 }
1586failed:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001587 ret = 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001588found:
Robert Olsson2373ce12005-08-25 13:01:29 -07001589 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001590 return ret;
1591}
1592
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001593/*
1594 * Remove the leaf and return parent.
1595 */
1596static void trie_leaf_remove(struct trie *t, struct leaf *l)
Robert Olsson19baf832005-06-21 12:43:18 -07001597{
David S. Millerb299e4f2011-02-02 20:48:10 -08001598 struct tnode *tp = node_parent((struct rt_trie_node *) l);
Robert Olsson19baf832005-06-21 12:43:18 -07001599
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001600 pr_debug("entering trie_leaf_remove(%p)\n", l);
Robert Olsson19baf832005-06-21 12:43:18 -07001601
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001602 if (tp) {
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001603 t_key cindex = tkey_extract_bits(l->key, tp->pos, tp->bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001604 put_child(t, (struct tnode *)tp, cindex, NULL);
Jarek Poplawski7b855762009-06-18 00:28:51 -07001605 trie_rebalance(t, tp);
Olof Johansson91b9a272005-08-09 20:24:39 -07001606 } else
Robert Olsson2373ce12005-08-25 13:01:29 -07001607 rcu_assign_pointer(t->trie, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001608
Stephen Hemminger387a5482008-04-10 03:47:34 -07001609 free_leaf(l);
Robert Olsson19baf832005-06-21 12:43:18 -07001610}
1611
Robert Olssond562f1f2007-03-26 14:22:22 -07001612/*
1613 * Caller must hold RTNL.
1614 */
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001615int fib_table_delete(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001616{
1617 struct trie *t = (struct trie *) tb->tb_data;
1618 u32 key, mask;
Thomas Graf4e902c52006-08-17 18:14:52 -07001619 int plen = cfg->fc_dst_len;
1620 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001621 struct fib_alias *fa, *fa_to_delete;
1622 struct list_head *fa_head;
1623 struct leaf *l;
Olof Johansson91b9a272005-08-09 20:24:39 -07001624 struct leaf_info *li;
1625
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001626 if (plen > 32)
Robert Olsson19baf832005-06-21 12:43:18 -07001627 return -EINVAL;
1628
Thomas Graf4e902c52006-08-17 18:14:52 -07001629 key = ntohl(cfg->fc_dst);
Olof Johansson91b9a272005-08-09 20:24:39 -07001630 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001631
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001632 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001633 return -EINVAL;
1634
1635 key = key & mask;
1636 l = fib_find_node(t, key);
1637
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001638 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001639 return -ESRCH;
1640
1641 fa_head = get_fa_head(l, plen);
1642 fa = fib_find_alias(fa_head, tos, 0);
1643
1644 if (!fa)
1645 return -ESRCH;
1646
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001647 pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t);
Robert Olsson19baf832005-06-21 12:43:18 -07001648
1649 fa_to_delete = NULL;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001650 fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list);
1651 list_for_each_entry_continue(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001652 struct fib_info *fi = fa->fa_info;
1653
1654 if (fa->fa_tos != tos)
1655 break;
1656
Thomas Graf4e902c52006-08-17 18:14:52 -07001657 if ((!cfg->fc_type || fa->fa_type == cfg->fc_type) &&
1658 (cfg->fc_scope == RT_SCOPE_NOWHERE ||
David S. Miller37e826c2011-03-24 18:06:47 -07001659 fa->fa_info->fib_scope == cfg->fc_scope) &&
Julian Anastasov74cb3c12011-03-19 12:13:46 +00001660 (!cfg->fc_prefsrc ||
1661 fi->fib_prefsrc == cfg->fc_prefsrc) &&
Thomas Graf4e902c52006-08-17 18:14:52 -07001662 (!cfg->fc_protocol ||
1663 fi->fib_protocol == cfg->fc_protocol) &&
1664 fib_nh_match(cfg, fi) == 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001665 fa_to_delete = fa;
1666 break;
1667 }
1668 }
1669
Olof Johansson91b9a272005-08-09 20:24:39 -07001670 if (!fa_to_delete)
1671 return -ESRCH;
Robert Olsson19baf832005-06-21 12:43:18 -07001672
Olof Johansson91b9a272005-08-09 20:24:39 -07001673 fa = fa_to_delete;
Thomas Graf4e902c52006-08-17 18:14:52 -07001674 rtmsg_fib(RTM_DELROUTE, htonl(key), fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001675 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001676
Olof Johansson91b9a272005-08-09 20:24:39 -07001677 l = fib_find_node(t, key);
Robert Olsson772cb712005-09-19 15:31:18 -07001678 li = find_leaf_info(l, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001679
Robert Olsson2373ce12005-08-25 13:01:29 -07001680 list_del_rcu(&fa->fa_list);
Robert Olsson19baf832005-06-21 12:43:18 -07001681
Olof Johansson91b9a272005-08-09 20:24:39 -07001682 if (list_empty(fa_head)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001683 hlist_del_rcu(&li->hlist);
Olof Johansson91b9a272005-08-09 20:24:39 -07001684 free_leaf_info(li);
Robert Olsson2373ce12005-08-25 13:01:29 -07001685 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001686
1687 if (hlist_empty(&l->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001688 trie_leaf_remove(t, l);
Olof Johansson91b9a272005-08-09 20:24:39 -07001689
1690 if (fa->fa_state & FA_S_ACCESSED)
Denis V. Lunev76e6ebf2008-07-05 19:00:44 -07001691 rt_cache_flush(cfg->fc_nlinfo.nl_net, -1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001692
Robert Olsson2373ce12005-08-25 13:01:29 -07001693 fib_release_info(fa->fa_info);
1694 alias_free_mem_rcu(fa);
Olof Johansson91b9a272005-08-09 20:24:39 -07001695 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001696}
1697
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001698static int trie_flush_list(struct list_head *head)
Robert Olsson19baf832005-06-21 12:43:18 -07001699{
1700 struct fib_alias *fa, *fa_node;
1701 int found = 0;
1702
1703 list_for_each_entry_safe(fa, fa_node, head, fa_list) {
1704 struct fib_info *fi = fa->fa_info;
Robert Olsson19baf832005-06-21 12:43:18 -07001705
Robert Olsson2373ce12005-08-25 13:01:29 -07001706 if (fi && (fi->fib_flags & RTNH_F_DEAD)) {
1707 list_del_rcu(&fa->fa_list);
1708 fib_release_info(fa->fa_info);
1709 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001710 found++;
1711 }
1712 }
1713 return found;
1714}
1715
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001716static int trie_flush_leaf(struct leaf *l)
Robert Olsson19baf832005-06-21 12:43:18 -07001717{
1718 int found = 0;
1719 struct hlist_head *lih = &l->list;
1720 struct hlist_node *node, *tmp;
1721 struct leaf_info *li = NULL;
1722
1723 hlist_for_each_entry_safe(li, node, tmp, lih, hlist) {
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001724 found += trie_flush_list(&li->falh);
Robert Olsson19baf832005-06-21 12:43:18 -07001725
1726 if (list_empty(&li->falh)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001727 hlist_del_rcu(&li->hlist);
Robert Olsson19baf832005-06-21 12:43:18 -07001728 free_leaf_info(li);
1729 }
1730 }
1731 return found;
1732}
1733
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001734/*
1735 * Scan for the next right leaf starting at node p->child[idx]
1736 * Since we have back pointer, no recursion necessary.
1737 */
David S. Millerb299e4f2011-02-02 20:48:10 -08001738static struct leaf *leaf_walk_rcu(struct tnode *p, struct rt_trie_node *c)
Robert Olsson19baf832005-06-21 12:43:18 -07001739{
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001740 do {
1741 t_key idx;
Robert Olsson19baf832005-06-21 12:43:18 -07001742
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001743 if (c)
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001744 idx = tkey_extract_bits(c->key, p->pos, p->bits) + 1;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001745 else
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001746 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001747
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001748 while (idx < 1u << p->bits) {
1749 c = tnode_get_child_rcu(p, idx++);
Robert Olsson2373ce12005-08-25 13:01:29 -07001750 if (!c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001751 continue;
Robert Olsson19baf832005-06-21 12:43:18 -07001752
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001753 if (IS_LEAF(c)) {
1754 prefetch(p->child[idx]);
1755 return (struct leaf *) c;
Robert Olsson19baf832005-06-21 12:43:18 -07001756 }
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001757
1758 /* Rescan start scanning in new node */
1759 p = (struct tnode *) c;
1760 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001761 }
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001762
1763 /* Node empty, walk back up to parent */
David S. Millerb299e4f2011-02-02 20:48:10 -08001764 c = (struct rt_trie_node *) p;
Eric Dumazeta034ee32010-09-09 23:32:28 +00001765 } while ((p = node_parent_rcu(c)) != NULL);
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001766
1767 return NULL; /* Root of trie */
1768}
1769
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001770static struct leaf *trie_firstleaf(struct trie *t)
1771{
Eric Dumazeta034ee32010-09-09 23:32:28 +00001772 struct tnode *n = (struct tnode *)rcu_dereference_rtnl(t->trie);
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001773
1774 if (!n)
1775 return NULL;
1776
1777 if (IS_LEAF(n)) /* trie is just a leaf */
1778 return (struct leaf *) n;
1779
1780 return leaf_walk_rcu(n, NULL);
1781}
1782
1783static struct leaf *trie_nextleaf(struct leaf *l)
1784{
David S. Millerb299e4f2011-02-02 20:48:10 -08001785 struct rt_trie_node *c = (struct rt_trie_node *) l;
Jarek Poplawskib902e572009-07-14 11:20:32 +00001786 struct tnode *p = node_parent_rcu(c);
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001787
1788 if (!p)
1789 return NULL; /* trie with just one leaf */
1790
1791 return leaf_walk_rcu(p, c);
Robert Olsson19baf832005-06-21 12:43:18 -07001792}
1793
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001794static struct leaf *trie_leafindex(struct trie *t, int index)
1795{
1796 struct leaf *l = trie_firstleaf(t);
1797
Stephen Hemmingerec28cf72008-02-11 21:12:49 -08001798 while (l && index-- > 0)
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001799 l = trie_nextleaf(l);
Stephen Hemmingerec28cf72008-02-11 21:12:49 -08001800
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001801 return l;
1802}
1803
1804
Robert Olssond562f1f2007-03-26 14:22:22 -07001805/*
1806 * Caller must hold RTNL.
1807 */
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001808int fib_table_flush(struct fib_table *tb)
Robert Olsson19baf832005-06-21 12:43:18 -07001809{
1810 struct trie *t = (struct trie *) tb->tb_data;
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001811 struct leaf *l, *ll = NULL;
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001812 int found = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001813
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001814 for (l = trie_firstleaf(t); l; l = trie_nextleaf(l)) {
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001815 found += trie_flush_leaf(l);
Robert Olsson19baf832005-06-21 12:43:18 -07001816
1817 if (ll && hlist_empty(&ll->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001818 trie_leaf_remove(t, ll);
Robert Olsson19baf832005-06-21 12:43:18 -07001819 ll = l;
1820 }
1821
1822 if (ll && hlist_empty(&ll->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001823 trie_leaf_remove(t, ll);
Robert Olsson19baf832005-06-21 12:43:18 -07001824
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001825 pr_debug("trie_flush found=%d\n", found);
Robert Olsson19baf832005-06-21 12:43:18 -07001826 return found;
1827}
1828
Pavel Emelyanov4aa2c462010-10-28 02:00:43 +00001829void fib_free_table(struct fib_table *tb)
1830{
1831 kfree(tb);
1832}
1833
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001834static int fn_trie_dump_fa(t_key key, int plen, struct list_head *fah,
1835 struct fib_table *tb,
Robert Olsson19baf832005-06-21 12:43:18 -07001836 struct sk_buff *skb, struct netlink_callback *cb)
1837{
1838 int i, s_i;
1839 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07001840 __be32 xkey = htonl(key);
Robert Olsson19baf832005-06-21 12:43:18 -07001841
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001842 s_i = cb->args[5];
Robert Olsson19baf832005-06-21 12:43:18 -07001843 i = 0;
1844
Robert Olsson2373ce12005-08-25 13:01:29 -07001845 /* rcu_read_lock is hold by caller */
1846
1847 list_for_each_entry_rcu(fa, fah, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001848 if (i < s_i) {
1849 i++;
1850 continue;
1851 }
Robert Olsson19baf832005-06-21 12:43:18 -07001852
1853 if (fib_dump_info(skb, NETLINK_CB(cb->skb).pid,
1854 cb->nlh->nlmsg_seq,
1855 RTM_NEWROUTE,
1856 tb->tb_id,
1857 fa->fa_type,
Thomas Grafbe403ea2006-08-17 18:15:17 -07001858 xkey,
Robert Olsson19baf832005-06-21 12:43:18 -07001859 plen,
1860 fa->fa_tos,
Stephen Hemminger64347f72008-01-22 21:55:01 -08001861 fa->fa_info, NLM_F_MULTI) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001862 cb->args[5] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001863 return -1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001864 }
Robert Olsson19baf832005-06-21 12:43:18 -07001865 i++;
1866 }
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001867 cb->args[5] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001868 return skb->len;
1869}
1870
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001871static int fn_trie_dump_leaf(struct leaf *l, struct fib_table *tb,
1872 struct sk_buff *skb, struct netlink_callback *cb)
Robert Olsson19baf832005-06-21 12:43:18 -07001873{
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001874 struct leaf_info *li;
1875 struct hlist_node *node;
1876 int i, s_i;
Robert Olsson19baf832005-06-21 12:43:18 -07001877
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001878 s_i = cb->args[4];
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001879 i = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001880
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001881 /* rcu_read_lock is hold by caller */
1882 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
1883 if (i < s_i) {
1884 i++;
Robert Olsson19baf832005-06-21 12:43:18 -07001885 continue;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001886 }
Robert Olsson19baf832005-06-21 12:43:18 -07001887
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001888 if (i > s_i)
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001889 cb->args[5] = 0;
Olof Johansson91b9a272005-08-09 20:24:39 -07001890
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001891 if (list_empty(&li->falh))
Robert Olsson19baf832005-06-21 12:43:18 -07001892 continue;
1893
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001894 if (fn_trie_dump_fa(l->key, li->plen, &li->falh, tb, skb, cb) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001895 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001896 return -1;
1897 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001898 i++;
Robert Olsson19baf832005-06-21 12:43:18 -07001899 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001900
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001901 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001902 return skb->len;
1903}
1904
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001905int fib_table_dump(struct fib_table *tb, struct sk_buff *skb,
1906 struct netlink_callback *cb)
Robert Olsson19baf832005-06-21 12:43:18 -07001907{
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001908 struct leaf *l;
Robert Olsson19baf832005-06-21 12:43:18 -07001909 struct trie *t = (struct trie *) tb->tb_data;
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001910 t_key key = cb->args[2];
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001911 int count = cb->args[3];
Robert Olsson19baf832005-06-21 12:43:18 -07001912
Robert Olsson2373ce12005-08-25 13:01:29 -07001913 rcu_read_lock();
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001914 /* Dump starting at last key.
1915 * Note: 0.0.0.0/0 (ie default) is first key.
1916 */
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001917 if (count == 0)
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001918 l = trie_firstleaf(t);
1919 else {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001920 /* Normally, continue from last key, but if that is missing
1921 * fallback to using slow rescan
1922 */
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001923 l = fib_find_node(t, key);
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001924 if (!l)
1925 l = trie_leafindex(t, count);
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001926 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001927
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001928 while (l) {
1929 cb->args[2] = l->key;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001930 if (fn_trie_dump_leaf(l, tb, skb, cb) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001931 cb->args[3] = count;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001932 rcu_read_unlock();
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001933 return -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001934 }
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001935
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001936 ++count;
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001937 l = trie_nextleaf(l);
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001938 memset(&cb->args[4], 0,
1939 sizeof(cb->args) - 4*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001940 }
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001941 cb->args[3] = count;
Robert Olsson2373ce12005-08-25 13:01:29 -07001942 rcu_read_unlock();
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001943
Robert Olsson19baf832005-06-21 12:43:18 -07001944 return skb->len;
Robert Olsson19baf832005-06-21 12:43:18 -07001945}
1946
David S. Miller5348ba82011-02-01 15:30:56 -08001947void __init fib_trie_init(void)
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08001948{
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001949 fn_alias_kmem = kmem_cache_create("ip_fib_alias",
1950 sizeof(struct fib_alias),
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -08001951 0, SLAB_PANIC, NULL);
1952
1953 trie_leaf_kmem = kmem_cache_create("ip_fib_trie",
1954 max(sizeof(struct leaf),
1955 sizeof(struct leaf_info)),
1956 0, SLAB_PANIC, NULL);
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08001957}
Robert Olsson19baf832005-06-21 12:43:18 -07001958
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08001959
David S. Miller5348ba82011-02-01 15:30:56 -08001960struct fib_table *fib_trie_table(u32 id)
Robert Olsson19baf832005-06-21 12:43:18 -07001961{
1962 struct fib_table *tb;
1963 struct trie *t;
1964
Robert Olsson19baf832005-06-21 12:43:18 -07001965 tb = kmalloc(sizeof(struct fib_table) + sizeof(struct trie),
1966 GFP_KERNEL);
1967 if (tb == NULL)
1968 return NULL;
1969
1970 tb->tb_id = id;
Denis V. Lunev971b8932007-12-08 00:32:23 -08001971 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001972
1973 t = (struct trie *) tb->tb_data;
Stephen Hemmingerc28a1cf2008-01-12 20:49:13 -08001974 memset(t, 0, sizeof(*t));
Robert Olsson19baf832005-06-21 12:43:18 -07001975
Robert Olsson19baf832005-06-21 12:43:18 -07001976 return tb;
1977}
1978
Robert Olsson19baf832005-06-21 12:43:18 -07001979#ifdef CONFIG_PROC_FS
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001980/* Depth first Trie walk iterator */
1981struct fib_trie_iter {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08001982 struct seq_net_private p;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07001983 struct fib_table *tb;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001984 struct tnode *tnode;
Eric Dumazeta034ee32010-09-09 23:32:28 +00001985 unsigned int index;
1986 unsigned int depth;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001987};
Robert Olsson19baf832005-06-21 12:43:18 -07001988
David S. Millerb299e4f2011-02-02 20:48:10 -08001989static struct rt_trie_node *fib_trie_get_next(struct fib_trie_iter *iter)
Robert Olsson19baf832005-06-21 12:43:18 -07001990{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001991 struct tnode *tn = iter->tnode;
Eric Dumazeta034ee32010-09-09 23:32:28 +00001992 unsigned int cindex = iter->index;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001993 struct tnode *p;
1994
Eric W. Biederman6640e692007-01-24 14:42:04 -08001995 /* A single entry routing table */
1996 if (!tn)
1997 return NULL;
1998
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001999 pr_debug("get_next iter={node=%p index=%d depth=%d}\n",
2000 iter->tnode, iter->index, iter->depth);
2001rescan:
2002 while (cindex < (1<<tn->bits)) {
David S. Millerb299e4f2011-02-02 20:48:10 -08002003 struct rt_trie_node *n = tnode_get_child_rcu(tn, cindex);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002004
2005 if (n) {
2006 if (IS_LEAF(n)) {
2007 iter->tnode = tn;
2008 iter->index = cindex + 1;
2009 } else {
2010 /* push down one level */
2011 iter->tnode = (struct tnode *) n;
2012 iter->index = 0;
2013 ++iter->depth;
2014 }
2015 return n;
2016 }
2017
2018 ++cindex;
2019 }
2020
2021 /* Current node exhausted, pop back up */
David S. Millerb299e4f2011-02-02 20:48:10 -08002022 p = node_parent_rcu((struct rt_trie_node *)tn);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002023 if (p) {
2024 cindex = tkey_extract_bits(tn->key, p->pos, p->bits)+1;
2025 tn = p;
2026 --iter->depth;
2027 goto rescan;
2028 }
2029
2030 /* got root? */
Robert Olsson19baf832005-06-21 12:43:18 -07002031 return NULL;
2032}
2033
David S. Millerb299e4f2011-02-02 20:48:10 -08002034static struct rt_trie_node *fib_trie_get_first(struct fib_trie_iter *iter,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002035 struct trie *t)
Robert Olsson19baf832005-06-21 12:43:18 -07002036{
David S. Millerb299e4f2011-02-02 20:48:10 -08002037 struct rt_trie_node *n;
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002038
Stephen Hemminger132adf52007-03-08 20:44:43 -08002039 if (!t)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002040 return NULL;
2041
2042 n = rcu_dereference(t->trie);
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002043 if (!n)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002044 return NULL;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002045
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002046 if (IS_TNODE(n)) {
2047 iter->tnode = (struct tnode *) n;
2048 iter->index = 0;
2049 iter->depth = 1;
2050 } else {
2051 iter->tnode = NULL;
2052 iter->index = 0;
2053 iter->depth = 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002054 }
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002055
2056 return n;
Robert Olsson19baf832005-06-21 12:43:18 -07002057}
2058
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002059static void trie_collect_stats(struct trie *t, struct trie_stat *s)
Robert Olsson19baf832005-06-21 12:43:18 -07002060{
David S. Millerb299e4f2011-02-02 20:48:10 -08002061 struct rt_trie_node *n;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002062 struct fib_trie_iter iter;
Robert Olsson19baf832005-06-21 12:43:18 -07002063
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002064 memset(s, 0, sizeof(*s));
Robert Olsson19baf832005-06-21 12:43:18 -07002065
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002066 rcu_read_lock();
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002067 for (n = fib_trie_get_first(&iter, t); n; n = fib_trie_get_next(&iter)) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002068 if (IS_LEAF(n)) {
Stephen Hemminger93672292008-01-22 21:54:05 -08002069 struct leaf *l = (struct leaf *)n;
2070 struct leaf_info *li;
2071 struct hlist_node *tmp;
2072
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002073 s->leaves++;
2074 s->totdepth += iter.depth;
2075 if (iter.depth > s->maxdepth)
2076 s->maxdepth = iter.depth;
Stephen Hemminger93672292008-01-22 21:54:05 -08002077
2078 hlist_for_each_entry_rcu(li, tmp, &l->list, hlist)
2079 ++s->prefixes;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002080 } else {
2081 const struct tnode *tn = (const struct tnode *) n;
2082 int i;
Robert Olsson19baf832005-06-21 12:43:18 -07002083
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002084 s->tnodes++;
Stephen Hemminger132adf52007-03-08 20:44:43 -08002085 if (tn->bits < MAX_STAT_DEPTH)
Robert Olsson06ef9212006-03-20 21:35:01 -08002086 s->nodesizes[tn->bits]++;
2087
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002088 for (i = 0; i < (1<<tn->bits); i++)
2089 if (!tn->child[i])
2090 s->nullpointers++;
2091 }
2092 }
2093 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002094}
2095
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002096/*
Robert Olsson19baf832005-06-21 12:43:18 -07002097 * This outputs /proc/net/fib_triestats
Robert Olsson19baf832005-06-21 12:43:18 -07002098 */
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002099static void trie_show_stats(struct seq_file *seq, struct trie_stat *stat)
Robert Olsson19baf832005-06-21 12:43:18 -07002100{
Eric Dumazeta034ee32010-09-09 23:32:28 +00002101 unsigned int i, max, pointers, bytes, avdepth;
Robert Olsson19baf832005-06-21 12:43:18 -07002102
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002103 if (stat->leaves)
2104 avdepth = stat->totdepth*100 / stat->leaves;
2105 else
2106 avdepth = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002107
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002108 seq_printf(seq, "\tAver depth: %u.%02d\n",
2109 avdepth / 100, avdepth % 100);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002110 seq_printf(seq, "\tMax depth: %u\n", stat->maxdepth);
Robert Olsson19baf832005-06-21 12:43:18 -07002111
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002112 seq_printf(seq, "\tLeaves: %u\n", stat->leaves);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002113 bytes = sizeof(struct leaf) * stat->leaves;
Stephen Hemminger93672292008-01-22 21:54:05 -08002114
2115 seq_printf(seq, "\tPrefixes: %u\n", stat->prefixes);
2116 bytes += sizeof(struct leaf_info) * stat->prefixes;
2117
Stephen Hemminger187b5182008-01-12 20:55:55 -08002118 seq_printf(seq, "\tInternal nodes: %u\n\t", stat->tnodes);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002119 bytes += sizeof(struct tnode) * stat->tnodes;
Robert Olsson19baf832005-06-21 12:43:18 -07002120
Robert Olsson06ef9212006-03-20 21:35:01 -08002121 max = MAX_STAT_DEPTH;
2122 while (max > 0 && stat->nodesizes[max-1] == 0)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002123 max--;
Robert Olsson19baf832005-06-21 12:43:18 -07002124
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002125 pointers = 0;
2126 for (i = 1; i <= max; i++)
2127 if (stat->nodesizes[i] != 0) {
Stephen Hemminger187b5182008-01-12 20:55:55 -08002128 seq_printf(seq, " %u: %u", i, stat->nodesizes[i]);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002129 pointers += (1<<i) * stat->nodesizes[i];
2130 }
2131 seq_putc(seq, '\n');
Stephen Hemminger187b5182008-01-12 20:55:55 -08002132 seq_printf(seq, "\tPointers: %u\n", pointers);
Robert Olsson19baf832005-06-21 12:43:18 -07002133
David S. Millerb299e4f2011-02-02 20:48:10 -08002134 bytes += sizeof(struct rt_trie_node *) * pointers;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002135 seq_printf(seq, "Null ptrs: %u\n", stat->nullpointers);
2136 seq_printf(seq, "Total size: %u kB\n", (bytes + 1023) / 1024);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002137}
Robert Olsson19baf832005-06-21 12:43:18 -07002138
2139#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002140static void trie_show_usage(struct seq_file *seq,
2141 const struct trie_use_stats *stats)
2142{
2143 seq_printf(seq, "\nCounters:\n---------\n");
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002144 seq_printf(seq, "gets = %u\n", stats->gets);
2145 seq_printf(seq, "backtracks = %u\n", stats->backtrack);
2146 seq_printf(seq, "semantic match passed = %u\n",
2147 stats->semantic_match_passed);
2148 seq_printf(seq, "semantic match miss = %u\n",
2149 stats->semantic_match_miss);
2150 seq_printf(seq, "null node hit= %u\n", stats->null_node_hit);
2151 seq_printf(seq, "skipped node resize = %u\n\n",
2152 stats->resize_node_skipped);
Robert Olsson19baf832005-06-21 12:43:18 -07002153}
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002154#endif /* CONFIG_IP_FIB_TRIE_STATS */
2155
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002156static void fib_table_print(struct seq_file *seq, struct fib_table *tb)
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002157{
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002158 if (tb->tb_id == RT_TABLE_LOCAL)
2159 seq_puts(seq, "Local:\n");
2160 else if (tb->tb_id == RT_TABLE_MAIN)
2161 seq_puts(seq, "Main:\n");
2162 else
2163 seq_printf(seq, "Id %d:\n", tb->tb_id);
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002164}
Robert Olsson19baf832005-06-21 12:43:18 -07002165
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002166
Robert Olsson19baf832005-06-21 12:43:18 -07002167static int fib_triestat_seq_show(struct seq_file *seq, void *v)
2168{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002169 struct net *net = (struct net *)seq->private;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002170 unsigned int h;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002171
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002172 seq_printf(seq,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002173 "Basic info: size of leaf:"
2174 " %Zd bytes, size of tnode: %Zd bytes.\n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002175 sizeof(struct leaf), sizeof(struct tnode));
Olof Johansson91b9a272005-08-09 20:24:39 -07002176
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002177 for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
2178 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2179 struct hlist_node *node;
2180 struct fib_table *tb;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002181
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002182 hlist_for_each_entry_rcu(tb, node, head, tb_hlist) {
2183 struct trie *t = (struct trie *) tb->tb_data;
2184 struct trie_stat stat;
2185
2186 if (!t)
2187 continue;
2188
2189 fib_table_print(seq, tb);
2190
2191 trie_collect_stats(t, &stat);
2192 trie_show_stats(seq, &stat);
2193#ifdef CONFIG_IP_FIB_TRIE_STATS
2194 trie_show_usage(seq, &t->stats);
2195#endif
2196 }
2197 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002198
Robert Olsson19baf832005-06-21 12:43:18 -07002199 return 0;
2200}
2201
Robert Olsson19baf832005-06-21 12:43:18 -07002202static int fib_triestat_seq_open(struct inode *inode, struct file *file)
2203{
Pavel Emelyanovde05c552008-07-18 04:07:21 -07002204 return single_open_net(inode, file, fib_triestat_seq_show);
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002205}
2206
Arjan van de Ven9a321442007-02-12 00:55:35 -08002207static const struct file_operations fib_triestat_fops = {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002208 .owner = THIS_MODULE,
2209 .open = fib_triestat_seq_open,
2210 .read = seq_read,
2211 .llseek = seq_lseek,
Pavel Emelyanovb6fcbdb2008-07-18 04:07:44 -07002212 .release = single_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002213};
2214
David S. Millerb299e4f2011-02-02 20:48:10 -08002215static struct rt_trie_node *fib_trie_get_idx(struct seq_file *seq, loff_t pos)
Robert Olsson19baf832005-06-21 12:43:18 -07002216{
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002217 struct fib_trie_iter *iter = seq->private;
2218 struct net *net = seq_file_net(seq);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002219 loff_t idx = 0;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002220 unsigned int h;
Robert Olsson19baf832005-06-21 12:43:18 -07002221
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002222 for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
2223 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2224 struct hlist_node *node;
2225 struct fib_table *tb;
2226
2227 hlist_for_each_entry_rcu(tb, node, head, tb_hlist) {
David S. Millerb299e4f2011-02-02 20:48:10 -08002228 struct rt_trie_node *n;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002229
2230 for (n = fib_trie_get_first(iter,
2231 (struct trie *) tb->tb_data);
2232 n; n = fib_trie_get_next(iter))
2233 if (pos == idx++) {
2234 iter->tb = tb;
2235 return n;
2236 }
2237 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002238 }
Robert Olsson19baf832005-06-21 12:43:18 -07002239
Robert Olsson19baf832005-06-21 12:43:18 -07002240 return NULL;
2241}
2242
2243static void *fib_trie_seq_start(struct seq_file *seq, loff_t *pos)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002244 __acquires(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002245{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002246 rcu_read_lock();
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002247 return fib_trie_get_idx(seq, *pos);
Robert Olsson19baf832005-06-21 12:43:18 -07002248}
2249
2250static void *fib_trie_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2251{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002252 struct fib_trie_iter *iter = seq->private;
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002253 struct net *net = seq_file_net(seq);
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002254 struct fib_table *tb = iter->tb;
2255 struct hlist_node *tb_node;
2256 unsigned int h;
David S. Millerb299e4f2011-02-02 20:48:10 -08002257 struct rt_trie_node *n;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002258
Robert Olsson19baf832005-06-21 12:43:18 -07002259 ++*pos;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002260 /* next node in same table */
2261 n = fib_trie_get_next(iter);
2262 if (n)
2263 return n;
Olof Johansson91b9a272005-08-09 20:24:39 -07002264
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002265 /* walk rest of this hash chain */
2266 h = tb->tb_id & (FIB_TABLE_HASHSZ - 1);
2267 while ( (tb_node = rcu_dereference(tb->tb_hlist.next)) ) {
2268 tb = hlist_entry(tb_node, struct fib_table, tb_hlist);
2269 n = fib_trie_get_first(iter, (struct trie *) tb->tb_data);
2270 if (n)
2271 goto found;
2272 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002273
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002274 /* new hash chain */
2275 while (++h < FIB_TABLE_HASHSZ) {
2276 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2277 hlist_for_each_entry_rcu(tb, tb_node, head, tb_hlist) {
2278 n = fib_trie_get_first(iter, (struct trie *) tb->tb_data);
2279 if (n)
2280 goto found;
2281 }
2282 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002283 return NULL;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002284
2285found:
2286 iter->tb = tb;
2287 return n;
Robert Olsson19baf832005-06-21 12:43:18 -07002288}
2289
2290static void fib_trie_seq_stop(struct seq_file *seq, void *v)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002291 __releases(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002292{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002293 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002294}
2295
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002296static void seq_indent(struct seq_file *seq, int n)
2297{
Eric Dumazeta034ee32010-09-09 23:32:28 +00002298 while (n-- > 0)
2299 seq_puts(seq, " ");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002300}
Robert Olsson19baf832005-06-21 12:43:18 -07002301
Eric Dumazet28d36e32008-01-14 23:09:56 -08002302static inline const char *rtn_scope(char *buf, size_t len, enum rt_scope_t s)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002303{
Stephen Hemminger132adf52007-03-08 20:44:43 -08002304 switch (s) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002305 case RT_SCOPE_UNIVERSE: return "universe";
2306 case RT_SCOPE_SITE: return "site";
2307 case RT_SCOPE_LINK: return "link";
2308 case RT_SCOPE_HOST: return "host";
2309 case RT_SCOPE_NOWHERE: return "nowhere";
2310 default:
Eric Dumazet28d36e32008-01-14 23:09:56 -08002311 snprintf(buf, len, "scope=%d", s);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002312 return buf;
2313 }
2314}
2315
Jan Engelhardt36cbd3d2009-08-05 10:42:58 -07002316static const char *const rtn_type_names[__RTN_MAX] = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002317 [RTN_UNSPEC] = "UNSPEC",
2318 [RTN_UNICAST] = "UNICAST",
2319 [RTN_LOCAL] = "LOCAL",
2320 [RTN_BROADCAST] = "BROADCAST",
2321 [RTN_ANYCAST] = "ANYCAST",
2322 [RTN_MULTICAST] = "MULTICAST",
2323 [RTN_BLACKHOLE] = "BLACKHOLE",
2324 [RTN_UNREACHABLE] = "UNREACHABLE",
2325 [RTN_PROHIBIT] = "PROHIBIT",
2326 [RTN_THROW] = "THROW",
2327 [RTN_NAT] = "NAT",
2328 [RTN_XRESOLVE] = "XRESOLVE",
2329};
2330
Eric Dumazeta034ee32010-09-09 23:32:28 +00002331static inline const char *rtn_type(char *buf, size_t len, unsigned int t)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002332{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002333 if (t < __RTN_MAX && rtn_type_names[t])
2334 return rtn_type_names[t];
Eric Dumazet28d36e32008-01-14 23:09:56 -08002335 snprintf(buf, len, "type %u", t);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002336 return buf;
2337}
2338
2339/* Pretty print the trie */
Robert Olsson19baf832005-06-21 12:43:18 -07002340static int fib_trie_seq_show(struct seq_file *seq, void *v)
2341{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002342 const struct fib_trie_iter *iter = seq->private;
David S. Millerb299e4f2011-02-02 20:48:10 -08002343 struct rt_trie_node *n = v;
Robert Olsson19baf832005-06-21 12:43:18 -07002344
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002345 if (!node_parent_rcu(n))
2346 fib_table_print(seq, iter->tb);
Robert Olsson095b8502007-01-26 19:06:01 -08002347
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002348 if (IS_TNODE(n)) {
2349 struct tnode *tn = (struct tnode *) n;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07002350 __be32 prf = htonl(mask_pfx(tn->key, tn->pos));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002351
Robert Olsson1d25cd62005-09-19 15:29:52 -07002352 seq_indent(seq, iter->depth-1);
Harvey Harrison673d57e2008-10-31 00:53:57 -07002353 seq_printf(seq, " +-- %pI4/%d %d %d %d\n",
2354 &prf, tn->pos, tn->bits, tn->full_children,
Robert Olsson1d25cd62005-09-19 15:29:52 -07002355 tn->empty_children);
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002356
Olof Johansson91b9a272005-08-09 20:24:39 -07002357 } else {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002358 struct leaf *l = (struct leaf *) n;
Stephen Hemminger13280422008-01-22 21:54:37 -08002359 struct leaf_info *li;
2360 struct hlist_node *node;
Al Viro32ab5f82006-09-26 22:21:45 -07002361 __be32 val = htonl(l->key);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002362
2363 seq_indent(seq, iter->depth);
Harvey Harrison673d57e2008-10-31 00:53:57 -07002364 seq_printf(seq, " |-- %pI4\n", &val);
Eric Dumazet28d36e32008-01-14 23:09:56 -08002365
Stephen Hemminger13280422008-01-22 21:54:37 -08002366 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
2367 struct fib_alias *fa;
Eric Dumazet28d36e32008-01-14 23:09:56 -08002368
Stephen Hemminger13280422008-01-22 21:54:37 -08002369 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
2370 char buf1[32], buf2[32];
Eric Dumazet28d36e32008-01-14 23:09:56 -08002371
Stephen Hemminger13280422008-01-22 21:54:37 -08002372 seq_indent(seq, iter->depth+1);
2373 seq_printf(seq, " /%d %s %s", li->plen,
2374 rtn_scope(buf1, sizeof(buf1),
David S. Miller37e826c2011-03-24 18:06:47 -07002375 fa->fa_info->fib_scope),
Stephen Hemminger13280422008-01-22 21:54:37 -08002376 rtn_type(buf2, sizeof(buf2),
2377 fa->fa_type));
2378 if (fa->fa_tos)
Denis V. Lunevb9c4d822008-02-05 02:58:45 -08002379 seq_printf(seq, " tos=%d", fa->fa_tos);
Stephen Hemminger13280422008-01-22 21:54:37 -08002380 seq_putc(seq, '\n');
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002381 }
2382 }
Robert Olsson19baf832005-06-21 12:43:18 -07002383 }
2384
2385 return 0;
2386}
2387
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002388static const struct seq_operations fib_trie_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002389 .start = fib_trie_seq_start,
2390 .next = fib_trie_seq_next,
2391 .stop = fib_trie_seq_stop,
2392 .show = fib_trie_seq_show,
Robert Olsson19baf832005-06-21 12:43:18 -07002393};
2394
2395static int fib_trie_seq_open(struct inode *inode, struct file *file)
2396{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002397 return seq_open_net(inode, file, &fib_trie_seq_ops,
2398 sizeof(struct fib_trie_iter));
Robert Olsson19baf832005-06-21 12:43:18 -07002399}
2400
Arjan van de Ven9a321442007-02-12 00:55:35 -08002401static const struct file_operations fib_trie_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002402 .owner = THIS_MODULE,
2403 .open = fib_trie_seq_open,
2404 .read = seq_read,
2405 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002406 .release = seq_release_net,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002407};
2408
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002409struct fib_route_iter {
2410 struct seq_net_private p;
2411 struct trie *main_trie;
2412 loff_t pos;
2413 t_key key;
2414};
2415
2416static struct leaf *fib_route_get_idx(struct fib_route_iter *iter, loff_t pos)
2417{
2418 struct leaf *l = NULL;
2419 struct trie *t = iter->main_trie;
2420
2421 /* use cache location of last found key */
2422 if (iter->pos > 0 && pos >= iter->pos && (l = fib_find_node(t, iter->key)))
2423 pos -= iter->pos;
2424 else {
2425 iter->pos = 0;
2426 l = trie_firstleaf(t);
2427 }
2428
2429 while (l && pos-- > 0) {
2430 iter->pos++;
2431 l = trie_nextleaf(l);
2432 }
2433
2434 if (l)
2435 iter->key = pos; /* remember it */
2436 else
2437 iter->pos = 0; /* forget it */
2438
2439 return l;
2440}
2441
2442static void *fib_route_seq_start(struct seq_file *seq, loff_t *pos)
2443 __acquires(RCU)
2444{
2445 struct fib_route_iter *iter = seq->private;
2446 struct fib_table *tb;
2447
2448 rcu_read_lock();
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002449 tb = fib_get_table(seq_file_net(seq), RT_TABLE_MAIN);
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002450 if (!tb)
2451 return NULL;
2452
2453 iter->main_trie = (struct trie *) tb->tb_data;
2454 if (*pos == 0)
2455 return SEQ_START_TOKEN;
2456 else
2457 return fib_route_get_idx(iter, *pos - 1);
2458}
2459
2460static void *fib_route_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2461{
2462 struct fib_route_iter *iter = seq->private;
2463 struct leaf *l = v;
2464
2465 ++*pos;
2466 if (v == SEQ_START_TOKEN) {
2467 iter->pos = 0;
2468 l = trie_firstleaf(iter->main_trie);
2469 } else {
2470 iter->pos++;
2471 l = trie_nextleaf(l);
2472 }
2473
2474 if (l)
2475 iter->key = l->key;
2476 else
2477 iter->pos = 0;
2478 return l;
2479}
2480
2481static void fib_route_seq_stop(struct seq_file *seq, void *v)
2482 __releases(RCU)
2483{
2484 rcu_read_unlock();
2485}
2486
Eric Dumazeta034ee32010-09-09 23:32:28 +00002487static unsigned int fib_flag_trans(int type, __be32 mask, const struct fib_info *fi)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002488{
Eric Dumazeta034ee32010-09-09 23:32:28 +00002489 unsigned int flags = 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002490
Eric Dumazeta034ee32010-09-09 23:32:28 +00002491 if (type == RTN_UNREACHABLE || type == RTN_PROHIBIT)
2492 flags = RTF_REJECT;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002493 if (fi && fi->fib_nh->nh_gw)
2494 flags |= RTF_GATEWAY;
Al Viro32ab5f82006-09-26 22:21:45 -07002495 if (mask == htonl(0xFFFFFFFF))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002496 flags |= RTF_HOST;
2497 flags |= RTF_UP;
2498 return flags;
2499}
2500
2501/*
2502 * This outputs /proc/net/route.
2503 * The format of the file is not supposed to be changed
Eric Dumazeta034ee32010-09-09 23:32:28 +00002504 * and needs to be same as fib_hash output to avoid breaking
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002505 * legacy utilities
2506 */
2507static int fib_route_seq_show(struct seq_file *seq, void *v)
2508{
2509 struct leaf *l = v;
Stephen Hemminger13280422008-01-22 21:54:37 -08002510 struct leaf_info *li;
2511 struct hlist_node *node;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002512
2513 if (v == SEQ_START_TOKEN) {
2514 seq_printf(seq, "%-127s\n", "Iface\tDestination\tGateway "
2515 "\tFlags\tRefCnt\tUse\tMetric\tMask\t\tMTU"
2516 "\tWindow\tIRTT");
2517 return 0;
2518 }
2519
Stephen Hemminger13280422008-01-22 21:54:37 -08002520 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002521 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07002522 __be32 mask, prefix;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002523
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002524 mask = inet_make_mask(li->plen);
2525 prefix = htonl(l->key);
2526
2527 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
Herbert Xu1371e372005-10-15 09:42:39 +10002528 const struct fib_info *fi = fa->fa_info;
Eric Dumazeta034ee32010-09-09 23:32:28 +00002529 unsigned int flags = fib_flag_trans(fa->fa_type, mask, fi);
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002530 int len;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002531
2532 if (fa->fa_type == RTN_BROADCAST
2533 || fa->fa_type == RTN_MULTICAST)
2534 continue;
2535
2536 if (fi)
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002537 seq_printf(seq,
2538 "%s\t%08X\t%08X\t%04X\t%d\t%u\t"
2539 "%d\t%08X\t%d\t%u\t%u%n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002540 fi->fib_dev ? fi->fib_dev->name : "*",
2541 prefix,
2542 fi->fib_nh->nh_gw, flags, 0, 0,
2543 fi->fib_priority,
2544 mask,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002545 (fi->fib_advmss ?
2546 fi->fib_advmss + 40 : 0),
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002547 fi->fib_window,
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002548 fi->fib_rtt >> 3, &len);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002549 else
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002550 seq_printf(seq,
2551 "*\t%08X\t%08X\t%04X\t%d\t%u\t"
2552 "%d\t%08X\t%d\t%u\t%u%n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002553 prefix, 0, flags, 0, 0, 0,
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002554 mask, 0, 0, 0, &len);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002555
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002556 seq_printf(seq, "%*s\n", 127 - len, "");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002557 }
2558 }
2559
2560 return 0;
2561}
2562
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002563static const struct seq_operations fib_route_seq_ops = {
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002564 .start = fib_route_seq_start,
2565 .next = fib_route_seq_next,
2566 .stop = fib_route_seq_stop,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002567 .show = fib_route_seq_show,
2568};
2569
2570static int fib_route_seq_open(struct inode *inode, struct file *file)
2571{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002572 return seq_open_net(inode, file, &fib_route_seq_ops,
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002573 sizeof(struct fib_route_iter));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002574}
2575
Arjan van de Ven9a321442007-02-12 00:55:35 -08002576static const struct file_operations fib_route_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002577 .owner = THIS_MODULE,
2578 .open = fib_route_seq_open,
2579 .read = seq_read,
2580 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002581 .release = seq_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002582};
2583
Denis V. Lunev61a02652008-01-10 03:21:09 -08002584int __net_init fib_proc_init(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002585{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002586 if (!proc_net_fops_create(net, "fib_trie", S_IRUGO, &fib_trie_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002587 goto out1;
2588
Denis V. Lunev61a02652008-01-10 03:21:09 -08002589 if (!proc_net_fops_create(net, "fib_triestat", S_IRUGO,
2590 &fib_triestat_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002591 goto out2;
2592
Denis V. Lunev61a02652008-01-10 03:21:09 -08002593 if (!proc_net_fops_create(net, "route", S_IRUGO, &fib_route_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002594 goto out3;
2595
Robert Olsson19baf832005-06-21 12:43:18 -07002596 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002597
2598out3:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002599 proc_net_remove(net, "fib_triestat");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002600out2:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002601 proc_net_remove(net, "fib_trie");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002602out1:
2603 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002604}
2605
Denis V. Lunev61a02652008-01-10 03:21:09 -08002606void __net_exit fib_proc_exit(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002607{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002608 proc_net_remove(net, "fib_trie");
2609 proc_net_remove(net, "fib_triestat");
2610 proc_net_remove(net, "route");
Robert Olsson19baf832005-06-21 12:43:18 -07002611}
2612
2613#endif /* CONFIG_PROC_FS */