blob: 90a3ff605591d8f84d1cad72bae9f7bc7c172d8e [file] [log] [blame]
Robert Olsson19baf832005-06-21 12:43:18 -07001/*
2 * This program is free software; you can redistribute it and/or
3 * modify it under the terms of the GNU General Public License
4 * as published by the Free Software Foundation; either version
5 * 2 of the License, or (at your option) any later version.
6 *
7 * Robert Olsson <robert.olsson@its.uu.se> Uppsala Universitet
8 * & Swedish University of Agricultural Sciences.
9 *
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090010 * Jens Laas <jens.laas@data.slu.se> Swedish University of
Robert Olsson19baf832005-06-21 12:43:18 -070011 * Agricultural Sciences.
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090012 *
Robert Olsson19baf832005-06-21 12:43:18 -070013 * Hans Liss <hans.liss@its.uu.se> Uppsala Universitet
14 *
15 * This work is based on the LPC-trie which is originally descibed in:
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090016 *
Robert Olsson19baf832005-06-21 12:43:18 -070017 * An experimental study of compression methods for dynamic tries
18 * Stefan Nilsson and Matti Tikkanen. Algorithmica, 33(1):19-33, 2002.
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 Dumazet8d965442008-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 Dumazet8d965442008-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 Dumazet8d965442008-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 Dumazet8d965442008-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 void __leaf_info_free_rcu(struct rcu_head *head)
354{
355 kfree(container_of(head, struct leaf_info, rcu));
356}
357
358static inline void free_leaf_info(struct leaf_info *leaf)
359{
360 call_rcu(&leaf->rcu, __leaf_info_free_rcu);
361}
362
Eric Dumazet8d965442008-01-13 22:31:44 -0800363static struct tnode *tnode_alloc(size_t size)
Robert Olsson2373ce12005-08-25 13:01:29 -0700364{
Robert Olsson2373ce12005-08-25 13:01:29 -0700365 if (size <= PAGE_SIZE)
Eric Dumazet8d965442008-01-13 22:31:44 -0800366 return kzalloc(size, GFP_KERNEL);
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700367 else
Eric Dumazet7a1c8e52010-11-20 07:46:35 +0000368 return vzalloc(size);
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700369}
Robert Olsson2373ce12005-08-25 13:01:29 -0700370
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700371static void __tnode_vfree(struct work_struct *arg)
372{
373 struct tnode *tn = container_of(arg, struct tnode, work);
374 vfree(tn);
Robert Olsson2373ce12005-08-25 13:01:29 -0700375}
376
377static void __tnode_free_rcu(struct rcu_head *head)
378{
379 struct tnode *tn = container_of(head, struct tnode, rcu);
Eric Dumazet8d965442008-01-13 22:31:44 -0800380 size_t size = sizeof(struct tnode) +
David S. Millerb299e4f2011-02-02 20:48:10 -0800381 (sizeof(struct rt_trie_node *) << tn->bits);
Robert Olsson2373ce12005-08-25 13:01:29 -0700382
383 if (size <= PAGE_SIZE)
384 kfree(tn);
Stephen Hemminger15be75c2008-04-10 02:56:38 -0700385 else {
386 INIT_WORK(&tn->work, __tnode_vfree);
387 schedule_work(&tn->work);
388 }
Robert Olsson2373ce12005-08-25 13:01:29 -0700389}
390
391static inline void tnode_free(struct tnode *tn)
392{
Stephen Hemminger387a5482008-04-10 03:47:34 -0700393 if (IS_LEAF(tn))
394 free_leaf((struct leaf *) tn);
395 else
Robert Olsson550e29b2006-04-04 12:53:35 -0700396 call_rcu(&tn->rcu, __tnode_free_rcu);
Robert Olsson2373ce12005-08-25 13:01:29 -0700397}
398
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700399static void tnode_free_safe(struct tnode *tn)
400{
401 BUG_ON(IS_LEAF(tn));
Jarek Poplawski7b855762009-06-18 00:28:51 -0700402 tn->tnode_free = tnode_free_head;
403 tnode_free_head = tn;
Jarek Poplawskic3059472009-07-14 08:33:08 +0000404 tnode_free_size += sizeof(struct tnode) +
David S. Millerb299e4f2011-02-02 20:48:10 -0800405 (sizeof(struct rt_trie_node *) << tn->bits);
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700406}
407
408static void tnode_free_flush(void)
409{
410 struct tnode *tn;
411
412 while ((tn = tnode_free_head)) {
413 tnode_free_head = tn->tnode_free;
414 tn->tnode_free = NULL;
415 tnode_free(tn);
416 }
Jarek Poplawskic3059472009-07-14 08:33:08 +0000417
418 if (tnode_free_size >= PAGE_SIZE * sync_pages) {
419 tnode_free_size = 0;
420 synchronize_rcu();
421 }
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700422}
423
Robert Olsson19baf832005-06-21 12:43:18 -0700424static struct leaf *leaf_new(void)
425{
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -0800426 struct leaf *l = kmem_cache_alloc(trie_leaf_kmem, GFP_KERNEL);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700427 if (l) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700428 l->parent = T_LEAF;
Robert Olsson19baf832005-06-21 12:43:18 -0700429 INIT_HLIST_HEAD(&l->list);
430 }
431 return l;
432}
433
434static struct leaf_info *leaf_info_new(int plen)
435{
436 struct leaf_info *li = kmalloc(sizeof(struct leaf_info), GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -0700437 if (li) {
438 li->plen = plen;
439 INIT_LIST_HEAD(&li->falh);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700440 }
Robert Olsson2373ce12005-08-25 13:01:29 -0700441 return li;
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700442}
443
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800444static struct tnode *tnode_new(t_key key, int pos, int bits)
Robert Olsson19baf832005-06-21 12:43:18 -0700445{
David S. Millerb299e4f2011-02-02 20:48:10 -0800446 size_t sz = sizeof(struct tnode) + (sizeof(struct rt_trie_node *) << bits);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700447 struct tnode *tn = tnode_alloc(sz);
Robert Olsson19baf832005-06-21 12:43:18 -0700448
Olof Johansson91b9a272005-08-09 20:24:39 -0700449 if (tn) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700450 tn->parent = T_TNODE;
Robert Olsson19baf832005-06-21 12:43:18 -0700451 tn->pos = pos;
452 tn->bits = bits;
453 tn->key = key;
454 tn->full_children = 0;
455 tn->empty_children = 1<<bits;
456 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700457
Eric Dumazeta034ee32010-09-09 23:32:28 +0000458 pr_debug("AT %p s=%zu %zu\n", tn, sizeof(struct tnode),
David S. Millerb299e4f2011-02-02 20:48:10 -0800459 sizeof(struct rt_trie_node) << bits);
Robert Olsson19baf832005-06-21 12:43:18 -0700460 return tn;
461}
462
Robert Olsson19baf832005-06-21 12:43:18 -0700463/*
464 * Check whether a tnode 'n' is "full", i.e. it is an internal node
465 * and no bits are skipped. See discussion in dyntree paper p. 6
466 */
467
David S. Millerb299e4f2011-02-02 20:48:10 -0800468static inline int tnode_full(const struct tnode *tn, const struct rt_trie_node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700469{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700470 if (n == NULL || IS_LEAF(n))
Robert Olsson19baf832005-06-21 12:43:18 -0700471 return 0;
472
473 return ((struct tnode *) n)->pos == tn->pos + tn->bits;
474}
475
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800476static inline void put_child(struct trie *t, struct tnode *tn, int i,
David S. Millerb299e4f2011-02-02 20:48:10 -0800477 struct rt_trie_node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700478{
479 tnode_put_child_reorg(tn, i, n, -1);
480}
481
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700482 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700483 * Add a child at position i overwriting the old value.
484 * Update the value of full_children and empty_children.
485 */
486
David S. Millerb299e4f2011-02-02 20:48:10 -0800487static void tnode_put_child_reorg(struct tnode *tn, int i, struct rt_trie_node *n,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800488 int wasfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700489{
David S. Millerb299e4f2011-02-02 20:48:10 -0800490 struct rt_trie_node *chi = tn->child[i];
Robert Olsson19baf832005-06-21 12:43:18 -0700491 int isfull;
492
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700493 BUG_ON(i >= 1<<tn->bits);
494
Robert Olsson19baf832005-06-21 12:43:18 -0700495 /* update emptyChildren */
496 if (n == NULL && chi != NULL)
497 tn->empty_children++;
498 else if (n != NULL && chi == NULL)
499 tn->empty_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700500
Robert Olsson19baf832005-06-21 12:43:18 -0700501 /* update fullChildren */
Olof Johansson91b9a272005-08-09 20:24:39 -0700502 if (wasfull == -1)
Robert Olsson19baf832005-06-21 12:43:18 -0700503 wasfull = tnode_full(tn, chi);
504
505 isfull = tnode_full(tn, n);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700506 if (wasfull && !isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700507 tn->full_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700508 else if (!wasfull && isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700509 tn->full_children++;
Olof Johansson91b9a272005-08-09 20:24:39 -0700510
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700511 if (n)
Stephen Hemminger06801912007-08-10 15:22:13 -0700512 node_set_parent(n, tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700513
Robert Olsson2373ce12005-08-25 13:01:29 -0700514 rcu_assign_pointer(tn->child[i], n);
Robert Olsson19baf832005-06-21 12:43:18 -0700515}
516
Jens Låås80b71b82009-08-28 23:57:15 -0700517#define MAX_WORK 10
David S. Millerb299e4f2011-02-02 20:48:10 -0800518static struct rt_trie_node *resize(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700519{
520 int i;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700521 struct tnode *old_tn;
Robert Olssone6308be2005-10-04 13:01:58 -0700522 int inflate_threshold_use;
523 int halve_threshold_use;
Jens Låås80b71b82009-08-28 23:57:15 -0700524 int max_work;
Robert Olsson19baf832005-06-21 12:43:18 -0700525
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900526 if (!tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700527 return NULL;
528
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700529 pr_debug("In tnode_resize %p inflate_threshold=%d threshold=%d\n",
530 tn, inflate_threshold, halve_threshold);
Robert Olsson19baf832005-06-21 12:43:18 -0700531
532 /* No children */
533 if (tn->empty_children == tnode_child_length(tn)) {
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700534 tnode_free_safe(tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700535 return NULL;
536 }
537 /* One child */
538 if (tn->empty_children == tnode_child_length(tn) - 1)
Jens Låås80b71b82009-08-28 23:57:15 -0700539 goto one_child;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700540 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700541 * Double as long as the resulting node has a number of
542 * nonempty nodes that are above the threshold.
543 */
544
545 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700546 * From "Implementing a dynamic compressed trie" by Stefan Nilsson of
547 * the Helsinki University of Technology and Matti Tikkanen of Nokia
Robert Olsson19baf832005-06-21 12:43:18 -0700548 * Telecommunications, page 6:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700549 * "A node is doubled if the ratio of non-empty children to all
Robert Olsson19baf832005-06-21 12:43:18 -0700550 * children in the *doubled* node is at least 'high'."
551 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700552 * 'high' in this instance is the variable 'inflate_threshold'. It
553 * is expressed as a percentage, so we multiply it with
554 * tnode_child_length() and instead of multiplying by 2 (since the
555 * child array will be doubled by inflate()) and multiplying
556 * the left-hand side by 100 (to handle the percentage thing) we
Robert Olsson19baf832005-06-21 12:43:18 -0700557 * multiply the left-hand side by 50.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700558 *
559 * The left-hand side may look a bit weird: tnode_child_length(tn)
560 * - tn->empty_children is of course the number of non-null children
561 * in the current node. tn->full_children is the number of "full"
Robert Olsson19baf832005-06-21 12:43:18 -0700562 * children, that is non-null tnodes with a skip value of 0.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700563 * All of those will be doubled in the resulting inflated tnode, so
Robert Olsson19baf832005-06-21 12:43:18 -0700564 * we just count them one extra time here.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700565 *
Robert Olsson19baf832005-06-21 12:43:18 -0700566 * A clearer way to write this would be:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700567 *
Robert Olsson19baf832005-06-21 12:43:18 -0700568 * to_be_doubled = tn->full_children;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700569 * not_to_be_doubled = tnode_child_length(tn) - tn->empty_children -
Robert Olsson19baf832005-06-21 12:43:18 -0700570 * tn->full_children;
571 *
572 * new_child_length = tnode_child_length(tn) * 2;
573 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700574 * new_fill_factor = 100 * (not_to_be_doubled + 2*to_be_doubled) /
Robert Olsson19baf832005-06-21 12:43:18 -0700575 * new_child_length;
576 * if (new_fill_factor >= inflate_threshold)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700577 *
578 * ...and so on, tho it would mess up the while () loop.
579 *
Robert Olsson19baf832005-06-21 12:43:18 -0700580 * anyway,
581 * 100 * (not_to_be_doubled + 2*to_be_doubled) / new_child_length >=
582 * inflate_threshold
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700583 *
Robert Olsson19baf832005-06-21 12:43:18 -0700584 * avoid a division:
585 * 100 * (not_to_be_doubled + 2*to_be_doubled) >=
586 * inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700587 *
Robert Olsson19baf832005-06-21 12:43:18 -0700588 * expand not_to_be_doubled and to_be_doubled, and shorten:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700589 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700590 * tn->full_children) >= inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700591 *
Robert Olsson19baf832005-06-21 12:43:18 -0700592 * expand new_child_length:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700593 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700594 * tn->full_children) >=
Robert Olsson19baf832005-06-21 12:43:18 -0700595 * inflate_threshold * tnode_child_length(tn) * 2
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700596 *
Robert Olsson19baf832005-06-21 12:43:18 -0700597 * shorten again:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700598 * 50 * (tn->full_children + tnode_child_length(tn) -
Olof Johansson91b9a272005-08-09 20:24:39 -0700599 * tn->empty_children) >= inflate_threshold *
Robert Olsson19baf832005-06-21 12:43:18 -0700600 * tnode_child_length(tn)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700601 *
Robert Olsson19baf832005-06-21 12:43:18 -0700602 */
603
604 check_tnode(tn);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700605
Robert Olssone6308be2005-10-04 13:01:58 -0700606 /* Keep root node larger */
607
David S. Millerb299e4f2011-02-02 20:48:10 -0800608 if (!node_parent((struct rt_trie_node *)tn)) {
Jens Låås80b71b82009-08-28 23:57:15 -0700609 inflate_threshold_use = inflate_threshold_root;
610 halve_threshold_use = halve_threshold_root;
Eric Dumazeta034ee32010-09-09 23:32:28 +0000611 } else {
Robert Olssone6308be2005-10-04 13:01:58 -0700612 inflate_threshold_use = inflate_threshold;
Jens Låås80b71b82009-08-28 23:57:15 -0700613 halve_threshold_use = halve_threshold;
614 }
Robert Olssone6308be2005-10-04 13:01:58 -0700615
Jens Låås80b71b82009-08-28 23:57:15 -0700616 max_work = MAX_WORK;
617 while ((tn->full_children > 0 && max_work-- &&
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800618 50 * (tn->full_children + tnode_child_length(tn)
619 - tn->empty_children)
620 >= inflate_threshold_use * tnode_child_length(tn))) {
Robert Olsson19baf832005-06-21 12:43:18 -0700621
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700622 old_tn = tn;
623 tn = inflate(t, tn);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800624
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700625 if (IS_ERR(tn)) {
626 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700627#ifdef CONFIG_IP_FIB_TRIE_STATS
628 t->stats.resize_node_skipped++;
629#endif
630 break;
631 }
Robert Olsson19baf832005-06-21 12:43:18 -0700632 }
633
634 check_tnode(tn);
635
Jens Låås80b71b82009-08-28 23:57:15 -0700636 /* Return if at least one inflate is run */
Eric Dumazeta034ee32010-09-09 23:32:28 +0000637 if (max_work != MAX_WORK)
David S. Millerb299e4f2011-02-02 20:48:10 -0800638 return (struct rt_trie_node *) tn;
Jens Låås80b71b82009-08-28 23:57:15 -0700639
Robert Olsson19baf832005-06-21 12:43:18 -0700640 /*
641 * Halve as long as the number of empty children in this
642 * node is above threshold.
643 */
Robert Olsson2f368952005-07-05 15:02:40 -0700644
Jens Låås80b71b82009-08-28 23:57:15 -0700645 max_work = MAX_WORK;
646 while (tn->bits > 1 && max_work-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700647 100 * (tnode_child_length(tn) - tn->empty_children) <
Robert Olssone6308be2005-10-04 13:01:58 -0700648 halve_threshold_use * tnode_child_length(tn)) {
Robert Olsson19baf832005-06-21 12:43:18 -0700649
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700650 old_tn = tn;
651 tn = halve(t, tn);
652 if (IS_ERR(tn)) {
653 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700654#ifdef CONFIG_IP_FIB_TRIE_STATS
655 t->stats.resize_node_skipped++;
656#endif
657 break;
658 }
659 }
660
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700661
Robert Olsson19baf832005-06-21 12:43:18 -0700662 /* Only one child remains */
Jens Låås80b71b82009-08-28 23:57:15 -0700663 if (tn->empty_children == tnode_child_length(tn) - 1) {
664one_child:
Robert Olsson19baf832005-06-21 12:43:18 -0700665 for (i = 0; i < tnode_child_length(tn); i++) {
David S. Millerb299e4f2011-02-02 20:48:10 -0800666 struct rt_trie_node *n;
Olof Johansson91b9a272005-08-09 20:24:39 -0700667
Olof Johansson91b9a272005-08-09 20:24:39 -0700668 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700669 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700670 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700671
672 /* compress one level */
673
Stephen Hemminger06801912007-08-10 15:22:13 -0700674 node_set_parent(n, NULL);
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700675 tnode_free_safe(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700676 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700677 }
Jens Låås80b71b82009-08-28 23:57:15 -0700678 }
David S. Millerb299e4f2011-02-02 20:48:10 -0800679 return (struct rt_trie_node *) tn;
Robert Olsson19baf832005-06-21 12:43:18 -0700680}
681
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700682static struct tnode *inflate(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700683{
Robert Olsson19baf832005-06-21 12:43:18 -0700684 struct tnode *oldtnode = tn;
685 int olen = tnode_child_length(tn);
686 int i;
687
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700688 pr_debug("In inflate\n");
Robert Olsson19baf832005-06-21 12:43:18 -0700689
690 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits + 1);
691
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700692 if (!tn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700693 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700694
695 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700696 * Preallocate and store tnodes before the actual work so we
697 * don't get into an inconsistent state if memory allocation
698 * fails. In case of failure we return the oldnode and inflate
Robert Olsson2f368952005-07-05 15:02:40 -0700699 * of tnode is ignored.
700 */
Olof Johansson91b9a272005-08-09 20:24:39 -0700701
702 for (i = 0; i < olen; i++) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800703 struct tnode *inode;
Robert Olsson2f368952005-07-05 15:02:40 -0700704
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800705 inode = (struct tnode *) tnode_get_child(oldtnode, i);
Robert Olsson2f368952005-07-05 15:02:40 -0700706 if (inode &&
707 IS_TNODE(inode) &&
708 inode->pos == oldtnode->pos + oldtnode->bits &&
709 inode->bits > 1) {
710 struct tnode *left, *right;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700711 t_key m = ~0U << (KEYLENGTH - 1) >> inode->pos;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700712
Robert Olsson2f368952005-07-05 15:02:40 -0700713 left = tnode_new(inode->key&(~m), inode->pos + 1,
714 inode->bits - 1);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700715 if (!left)
716 goto nomem;
Olof Johansson91b9a272005-08-09 20:24:39 -0700717
Robert Olsson2f368952005-07-05 15:02:40 -0700718 right = tnode_new(inode->key|m, inode->pos + 1,
719 inode->bits - 1);
720
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900721 if (!right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700722 tnode_free(left);
723 goto nomem;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900724 }
Robert Olsson2f368952005-07-05 15:02:40 -0700725
David S. Millerb299e4f2011-02-02 20:48:10 -0800726 put_child(t, tn, 2*i, (struct rt_trie_node *) left);
727 put_child(t, tn, 2*i+1, (struct rt_trie_node *) right);
Robert Olsson2f368952005-07-05 15:02:40 -0700728 }
729 }
730
Olof Johansson91b9a272005-08-09 20:24:39 -0700731 for (i = 0; i < olen; i++) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -0800732 struct tnode *inode;
David S. Millerb299e4f2011-02-02 20:48:10 -0800733 struct rt_trie_node *node = tnode_get_child(oldtnode, i);
Olof Johansson91b9a272005-08-09 20:24:39 -0700734 struct tnode *left, *right;
735 int size, j;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700736
Robert Olsson19baf832005-06-21 12:43:18 -0700737 /* An empty child */
738 if (node == NULL)
739 continue;
740
741 /* A leaf or an internal node with skipped bits */
742
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700743 if (IS_LEAF(node) || ((struct tnode *) node)->pos >
Robert Olsson19baf832005-06-21 12:43:18 -0700744 tn->pos + tn->bits - 1) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800745 if (tkey_extract_bits(node->key,
746 oldtnode->pos + oldtnode->bits,
747 1) == 0)
Robert Olsson19baf832005-06-21 12:43:18 -0700748 put_child(t, tn, 2*i, node);
749 else
750 put_child(t, tn, 2*i+1, node);
751 continue;
752 }
753
754 /* An internal node with two children */
755 inode = (struct tnode *) node;
756
757 if (inode->bits == 1) {
758 put_child(t, tn, 2*i, inode->child[0]);
759 put_child(t, tn, 2*i+1, inode->child[1]);
760
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700761 tnode_free_safe(inode);
Olof Johansson91b9a272005-08-09 20:24:39 -0700762 continue;
Robert Olsson19baf832005-06-21 12:43:18 -0700763 }
764
Olof Johansson91b9a272005-08-09 20:24:39 -0700765 /* An internal node with more than two children */
Robert Olsson19baf832005-06-21 12:43:18 -0700766
Olof Johansson91b9a272005-08-09 20:24:39 -0700767 /* We will replace this node 'inode' with two new
768 * ones, 'left' and 'right', each with half of the
769 * original children. The two new nodes will have
770 * a position one bit further down the key and this
771 * means that the "significant" part of their keys
772 * (see the discussion near the top of this file)
773 * will differ by one bit, which will be "0" in
774 * left's key and "1" in right's key. Since we are
775 * moving the key position by one step, the bit that
776 * we are moving away from - the bit at position
777 * (inode->pos) - is the one that will differ between
778 * left and right. So... we synthesize that bit in the
779 * two new keys.
780 * The mask 'm' below will be a single "one" bit at
781 * the position (inode->pos)
782 */
Robert Olsson19baf832005-06-21 12:43:18 -0700783
Olof Johansson91b9a272005-08-09 20:24:39 -0700784 /* Use the old key, but set the new significant
785 * bit to zero.
786 */
Robert Olsson19baf832005-06-21 12:43:18 -0700787
Olof Johansson91b9a272005-08-09 20:24:39 -0700788 left = (struct tnode *) tnode_get_child(tn, 2*i);
789 put_child(t, tn, 2*i, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -0700790
Olof Johansson91b9a272005-08-09 20:24:39 -0700791 BUG_ON(!left);
Robert Olsson2f368952005-07-05 15:02:40 -0700792
Olof Johansson91b9a272005-08-09 20:24:39 -0700793 right = (struct tnode *) tnode_get_child(tn, 2*i+1);
794 put_child(t, tn, 2*i+1, NULL);
Robert Olsson2f368952005-07-05 15:02:40 -0700795
Olof Johansson91b9a272005-08-09 20:24:39 -0700796 BUG_ON(!right);
Robert Olsson2f368952005-07-05 15:02:40 -0700797
Olof Johansson91b9a272005-08-09 20:24:39 -0700798 size = tnode_child_length(left);
799 for (j = 0; j < size; j++) {
800 put_child(t, left, j, inode->child[j]);
801 put_child(t, right, j, inode->child[j + size]);
Robert Olsson19baf832005-06-21 12:43:18 -0700802 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700803 put_child(t, tn, 2*i, resize(t, left));
804 put_child(t, tn, 2*i+1, resize(t, right));
805
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700806 tnode_free_safe(inode);
Robert Olsson19baf832005-06-21 12:43:18 -0700807 }
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700808 tnode_free_safe(oldtnode);
Robert Olsson19baf832005-06-21 12:43:18 -0700809 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700810nomem:
811 {
812 int size = tnode_child_length(tn);
813 int j;
814
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700815 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700816 if (tn->child[j])
817 tnode_free((struct tnode *)tn->child[j]);
818
819 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700820
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700821 return ERR_PTR(-ENOMEM);
822 }
Robert Olsson19baf832005-06-21 12:43:18 -0700823}
824
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700825static struct tnode *halve(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700826{
827 struct tnode *oldtnode = tn;
David S. Millerb299e4f2011-02-02 20:48:10 -0800828 struct rt_trie_node *left, *right;
Robert Olsson19baf832005-06-21 12:43:18 -0700829 int i;
830 int olen = tnode_child_length(tn);
831
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700832 pr_debug("In halve\n");
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700833
834 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits - 1);
Robert Olsson19baf832005-06-21 12:43:18 -0700835
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700836 if (!tn)
837 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700838
839 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700840 * Preallocate and store tnodes before the actual work so we
841 * don't get into an inconsistent state if memory allocation
842 * fails. In case of failure we return the oldnode and halve
Robert Olsson2f368952005-07-05 15:02:40 -0700843 * of tnode is ignored.
844 */
845
Olof Johansson91b9a272005-08-09 20:24:39 -0700846 for (i = 0; i < olen; i += 2) {
Robert Olsson2f368952005-07-05 15:02:40 -0700847 left = tnode_get_child(oldtnode, i);
848 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700849
Robert Olsson2f368952005-07-05 15:02:40 -0700850 /* Two nonempty children */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700851 if (left && right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700852 struct tnode *newn;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700853
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700854 newn = tnode_new(left->key, tn->pos + tn->bits, 1);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700855
856 if (!newn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700857 goto nomem;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700858
David S. Millerb299e4f2011-02-02 20:48:10 -0800859 put_child(t, tn, i/2, (struct rt_trie_node *)newn);
Robert Olsson2f368952005-07-05 15:02:40 -0700860 }
Robert Olsson2f368952005-07-05 15:02:40 -0700861
Robert Olsson2f368952005-07-05 15:02:40 -0700862 }
Robert Olsson19baf832005-06-21 12:43:18 -0700863
Olof Johansson91b9a272005-08-09 20:24:39 -0700864 for (i = 0; i < olen; i += 2) {
865 struct tnode *newBinNode;
866
Robert Olsson19baf832005-06-21 12:43:18 -0700867 left = tnode_get_child(oldtnode, i);
868 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700869
Robert Olsson19baf832005-06-21 12:43:18 -0700870 /* At least one of the children is empty */
871 if (left == NULL) {
872 if (right == NULL) /* Both are empty */
873 continue;
874 put_child(t, tn, i/2, right);
Olof Johansson91b9a272005-08-09 20:24:39 -0700875 continue;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700876 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700877
878 if (right == NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700879 put_child(t, tn, i/2, left);
Olof Johansson91b9a272005-08-09 20:24:39 -0700880 continue;
881 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700882
Robert Olsson19baf832005-06-21 12:43:18 -0700883 /* Two nonempty children */
Olof Johansson91b9a272005-08-09 20:24:39 -0700884 newBinNode = (struct tnode *) tnode_get_child(tn, i/2);
885 put_child(t, tn, i/2, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700886 put_child(t, newBinNode, 0, left);
887 put_child(t, newBinNode, 1, right);
888 put_child(t, tn, i/2, resize(t, newBinNode));
Robert Olsson19baf832005-06-21 12:43:18 -0700889 }
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700890 tnode_free_safe(oldtnode);
Robert Olsson19baf832005-06-21 12:43:18 -0700891 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700892nomem:
893 {
894 int size = tnode_child_length(tn);
895 int j;
896
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700897 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700898 if (tn->child[j])
899 tnode_free((struct tnode *)tn->child[j]);
900
901 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700902
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700903 return ERR_PTR(-ENOMEM);
904 }
Robert Olsson19baf832005-06-21 12:43:18 -0700905}
906
Robert Olsson772cb712005-09-19 15:31:18 -0700907/* readside must use rcu_read_lock currently dump routines
Robert Olsson2373ce12005-08-25 13:01:29 -0700908 via get_fa_head and dump */
909
Robert Olsson772cb712005-09-19 15:31:18 -0700910static struct leaf_info *find_leaf_info(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700911{
Robert Olsson772cb712005-09-19 15:31:18 -0700912 struct hlist_head *head = &l->list;
Robert Olsson19baf832005-06-21 12:43:18 -0700913 struct hlist_node *node;
914 struct leaf_info *li;
915
Robert Olsson2373ce12005-08-25 13:01:29 -0700916 hlist_for_each_entry_rcu(li, node, head, hlist)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700917 if (li->plen == plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700918 return li;
Olof Johansson91b9a272005-08-09 20:24:39 -0700919
Robert Olsson19baf832005-06-21 12:43:18 -0700920 return NULL;
921}
922
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800923static inline struct list_head *get_fa_head(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700924{
Robert Olsson772cb712005-09-19 15:31:18 -0700925 struct leaf_info *li = find_leaf_info(l, plen);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700926
Olof Johansson91b9a272005-08-09 20:24:39 -0700927 if (!li)
928 return NULL;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700929
Olof Johansson91b9a272005-08-09 20:24:39 -0700930 return &li->falh;
Robert Olsson19baf832005-06-21 12:43:18 -0700931}
932
933static void insert_leaf_info(struct hlist_head *head, struct leaf_info *new)
934{
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900935 struct leaf_info *li = NULL, *last = NULL;
936 struct hlist_node *node;
Robert Olsson19baf832005-06-21 12:43:18 -0700937
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900938 if (hlist_empty(head)) {
939 hlist_add_head_rcu(&new->hlist, head);
940 } else {
941 hlist_for_each_entry(li, node, head, hlist) {
942 if (new->plen > li->plen)
943 break;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700944
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900945 last = li;
946 }
947 if (last)
948 hlist_add_after_rcu(&last->hlist, &new->hlist);
949 else
950 hlist_add_before_rcu(&new->hlist, &li->hlist);
951 }
Robert Olsson19baf832005-06-21 12:43:18 -0700952}
953
Robert Olsson2373ce12005-08-25 13:01:29 -0700954/* rcu_read_lock needs to be hold by caller from readside */
955
Robert Olsson19baf832005-06-21 12:43:18 -0700956static struct leaf *
957fib_find_node(struct trie *t, u32 key)
958{
959 int pos;
960 struct tnode *tn;
David S. Millerb299e4f2011-02-02 20:48:10 -0800961 struct rt_trie_node *n;
Robert Olsson19baf832005-06-21 12:43:18 -0700962
963 pos = 0;
Eric Dumazeta034ee32010-09-09 23:32:28 +0000964 n = rcu_dereference_rtnl(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -0700965
966 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
967 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -0700968
Robert Olsson19baf832005-06-21 12:43:18 -0700969 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700970
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700971 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700972 pos = tn->pos + tn->bits;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800973 n = tnode_get_child_rcu(tn,
974 tkey_extract_bits(key,
975 tn->pos,
976 tn->bits));
Olof Johansson91b9a272005-08-09 20:24:39 -0700977 } else
Robert Olsson19baf832005-06-21 12:43:18 -0700978 break;
979 }
980 /* Case we have found a leaf. Compare prefixes */
981
Olof Johansson91b9a272005-08-09 20:24:39 -0700982 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key))
983 return (struct leaf *)n;
984
Robert Olsson19baf832005-06-21 12:43:18 -0700985 return NULL;
986}
987
Jarek Poplawski7b855762009-06-18 00:28:51 -0700988static void trie_rebalance(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700989{
Robert Olsson19baf832005-06-21 12:43:18 -0700990 int wasfull;
Robert Olsson3ed18d72009-05-21 15:20:59 -0700991 t_key cindex, key;
Stephen Hemminger06801912007-08-10 15:22:13 -0700992 struct tnode *tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700993
Robert Olsson3ed18d72009-05-21 15:20:59 -0700994 key = tn->key;
995
David S. Millerb299e4f2011-02-02 20:48:10 -0800996 while (tn != NULL && (tp = node_parent((struct rt_trie_node *)tn)) != NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700997 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
998 wasfull = tnode_full(tp, tnode_get_child(tp, cindex));
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800999 tn = (struct tnode *) resize(t, (struct tnode *)tn);
1000
1001 tnode_put_child_reorg((struct tnode *)tp, cindex,
David S. Millerb299e4f2011-02-02 20:48:10 -08001002 (struct rt_trie_node *)tn, wasfull);
Olof Johansson91b9a272005-08-09 20:24:39 -07001003
David S. Millerb299e4f2011-02-02 20:48:10 -08001004 tp = node_parent((struct rt_trie_node *) tn);
Jarek Poplawski008440e2009-06-30 12:47:19 -07001005 if (!tp)
David S. Millerb299e4f2011-02-02 20:48:10 -08001006 rcu_assign_pointer(t->trie, (struct rt_trie_node *)tn);
Jarek Poplawski008440e2009-06-30 12:47:19 -07001007
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -07001008 tnode_free_flush();
Stephen Hemminger06801912007-08-10 15:22:13 -07001009 if (!tp)
Robert Olsson19baf832005-06-21 12:43:18 -07001010 break;
Stephen Hemminger06801912007-08-10 15:22:13 -07001011 tn = tp;
Robert Olsson19baf832005-06-21 12:43:18 -07001012 }
Stephen Hemminger06801912007-08-10 15:22:13 -07001013
Robert Olsson19baf832005-06-21 12:43:18 -07001014 /* Handle last (top) tnode */
Jarek Poplawski7b855762009-06-18 00:28:51 -07001015 if (IS_TNODE(tn))
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001016 tn = (struct tnode *)resize(t, (struct tnode *)tn);
Robert Olsson19baf832005-06-21 12:43:18 -07001017
David S. Millerb299e4f2011-02-02 20:48:10 -08001018 rcu_assign_pointer(t->trie, (struct rt_trie_node *)tn);
Jarek Poplawski7b855762009-06-18 00:28:51 -07001019 tnode_free_flush();
Robert Olsson19baf832005-06-21 12:43:18 -07001020}
1021
Robert Olsson2373ce12005-08-25 13:01:29 -07001022/* only used from updater-side */
1023
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001024static struct list_head *fib_insert_node(struct trie *t, u32 key, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -07001025{
1026 int pos, newpos;
1027 struct tnode *tp = NULL, *tn = NULL;
David S. Millerb299e4f2011-02-02 20:48:10 -08001028 struct rt_trie_node *n;
Robert Olsson19baf832005-06-21 12:43:18 -07001029 struct leaf *l;
1030 int missbit;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001031 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001032 struct leaf_info *li;
1033 t_key cindex;
1034
1035 pos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001036 n = t->trie;
Robert Olsson19baf832005-06-21 12:43:18 -07001037
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001038 /* If we point to NULL, stop. Either the tree is empty and we should
1039 * just put a new leaf in if, or we have reached an empty child slot,
Robert Olsson19baf832005-06-21 12:43:18 -07001040 * and we should just put our new leaf in that.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001041 * If we point to a T_TNODE, check if it matches our key. Note that
1042 * a T_TNODE might be skipping any number of bits - its 'pos' need
Robert Olsson19baf832005-06-21 12:43:18 -07001043 * not be the parent's 'pos'+'bits'!
1044 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001045 * If it does match the current key, get pos/bits from it, extract
Robert Olsson19baf832005-06-21 12:43:18 -07001046 * the index from our key, push the T_TNODE and walk the tree.
1047 *
1048 * If it doesn't, we have to replace it with a new T_TNODE.
1049 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001050 * If we point to a T_LEAF, it might or might not have the same key
1051 * as we do. If it does, just change the value, update the T_LEAF's
1052 * value, and return it.
Robert Olsson19baf832005-06-21 12:43:18 -07001053 * If it doesn't, we need to replace it with a T_TNODE.
1054 */
1055
1056 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
1057 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -07001058
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001059 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001060
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001061 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001062 tp = tn;
Olof Johansson91b9a272005-08-09 20:24:39 -07001063 pos = tn->pos + tn->bits;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001064 n = tnode_get_child(tn,
1065 tkey_extract_bits(key,
1066 tn->pos,
1067 tn->bits));
Robert Olsson19baf832005-06-21 12:43:18 -07001068
Stephen Hemminger06801912007-08-10 15:22:13 -07001069 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001070 } else
Robert Olsson19baf832005-06-21 12:43:18 -07001071 break;
1072 }
1073
1074 /*
1075 * n ----> NULL, LEAF or TNODE
1076 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001077 * tp is n's (parent) ----> NULL or TNODE
Robert Olsson19baf832005-06-21 12:43:18 -07001078 */
1079
Olof Johansson91b9a272005-08-09 20:24:39 -07001080 BUG_ON(tp && IS_LEAF(tp));
Robert Olsson19baf832005-06-21 12:43:18 -07001081
1082 /* Case 1: n is a leaf. Compare prefixes */
1083
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001084 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key)) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08001085 l = (struct leaf *) n;
Robert Olsson19baf832005-06-21 12:43:18 -07001086 li = leaf_info_new(plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001087
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001088 if (!li)
1089 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001090
1091 fa_head = &li->falh;
1092 insert_leaf_info(&l->list, li);
1093 goto done;
1094 }
Robert Olsson19baf832005-06-21 12:43:18 -07001095 l = leaf_new();
1096
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001097 if (!l)
1098 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001099
1100 l->key = key;
1101 li = leaf_info_new(plen);
1102
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001103 if (!li) {
Stephen Hemminger387a5482008-04-10 03:47:34 -07001104 free_leaf(l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001105 return NULL;
Robert Olssonf835e472005-06-28 15:00:39 -07001106 }
Robert Olsson19baf832005-06-21 12:43:18 -07001107
1108 fa_head = &li->falh;
1109 insert_leaf_info(&l->list, li);
1110
Robert Olsson19baf832005-06-21 12:43:18 -07001111 if (t->trie && n == NULL) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001112 /* Case 2: n is NULL, and will just insert a new leaf */
Robert Olsson19baf832005-06-21 12:43:18 -07001113
David S. Millerb299e4f2011-02-02 20:48:10 -08001114 node_set_parent((struct rt_trie_node *)l, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001115
Olof Johansson91b9a272005-08-09 20:24:39 -07001116 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
David S. Millerb299e4f2011-02-02 20:48:10 -08001117 put_child(t, (struct tnode *)tp, cindex, (struct rt_trie_node *)l);
Olof Johansson91b9a272005-08-09 20:24:39 -07001118 } else {
1119 /* Case 3: n is a LEAF or a TNODE and the key doesn't match. */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001120 /*
1121 * Add a new tnode here
Robert Olsson19baf832005-06-21 12:43:18 -07001122 * first tnode need some special handling
1123 */
1124
1125 if (tp)
Olof Johansson91b9a272005-08-09 20:24:39 -07001126 pos = tp->pos+tp->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001127 else
Olof Johansson91b9a272005-08-09 20:24:39 -07001128 pos = 0;
1129
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001130 if (n) {
Robert Olsson19baf832005-06-21 12:43:18 -07001131 newpos = tkey_mismatch(key, pos, n->key);
1132 tn = tnode_new(n->key, newpos, 1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001133 } else {
Robert Olsson19baf832005-06-21 12:43:18 -07001134 newpos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001135 tn = tnode_new(key, newpos, 1); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001136 }
Robert Olsson19baf832005-06-21 12:43:18 -07001137
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001138 if (!tn) {
Robert Olssonf835e472005-06-28 15:00:39 -07001139 free_leaf_info(li);
Stephen Hemminger387a5482008-04-10 03:47:34 -07001140 free_leaf(l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001141 return NULL;
Olof Johansson91b9a272005-08-09 20:24:39 -07001142 }
1143
David S. Millerb299e4f2011-02-02 20:48:10 -08001144 node_set_parent((struct rt_trie_node *)tn, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001145
Olof Johansson91b9a272005-08-09 20:24:39 -07001146 missbit = tkey_extract_bits(key, newpos, 1);
David S. Millerb299e4f2011-02-02 20:48:10 -08001147 put_child(t, tn, missbit, (struct rt_trie_node *)l);
Robert Olsson19baf832005-06-21 12:43:18 -07001148 put_child(t, tn, 1-missbit, n);
1149
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001150 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001151 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001152 put_child(t, (struct tnode *)tp, cindex,
David S. Millerb299e4f2011-02-02 20:48:10 -08001153 (struct rt_trie_node *)tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001154 } else {
David S. Millerb299e4f2011-02-02 20:48:10 -08001155 rcu_assign_pointer(t->trie, (struct rt_trie_node *)tn);
Robert Olsson19baf832005-06-21 12:43:18 -07001156 tp = tn;
1157 }
1158 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001159
1160 if (tp && tp->pos + tp->bits > 32)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001161 pr_warning("fib_trie"
1162 " tp=%p pos=%d, bits=%d, key=%0x plen=%d\n",
1163 tp, tp->pos, tp->bits, key, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001164
Robert Olsson19baf832005-06-21 12:43:18 -07001165 /* Rebalance the trie */
Robert Olsson2373ce12005-08-25 13:01:29 -07001166
Jarek Poplawski7b855762009-06-18 00:28:51 -07001167 trie_rebalance(t, tp);
Robert Olssonf835e472005-06-28 15:00:39 -07001168done:
Robert Olsson19baf832005-06-21 12:43:18 -07001169 return fa_head;
1170}
1171
Robert Olssond562f1f2007-03-26 14:22:22 -07001172/*
1173 * Caller must hold RTNL.
1174 */
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001175int fib_table_insert(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001176{
1177 struct trie *t = (struct trie *) tb->tb_data;
1178 struct fib_alias *fa, *new_fa;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001179 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001180 struct fib_info *fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001181 int plen = cfg->fc_dst_len;
1182 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001183 u32 key, mask;
1184 int err;
1185 struct leaf *l;
1186
1187 if (plen > 32)
1188 return -EINVAL;
1189
Thomas Graf4e902c52006-08-17 18:14:52 -07001190 key = ntohl(cfg->fc_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001191
Patrick McHardy2dfe55b2006-08-10 23:08:33 -07001192 pr_debug("Insert table=%u %08x/%d\n", tb->tb_id, key, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001193
Olof Johansson91b9a272005-08-09 20:24:39 -07001194 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001195
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001196 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001197 return -EINVAL;
1198
1199 key = key & mask;
1200
Thomas Graf4e902c52006-08-17 18:14:52 -07001201 fi = fib_create_info(cfg);
1202 if (IS_ERR(fi)) {
1203 err = PTR_ERR(fi);
Robert Olsson19baf832005-06-21 12:43:18 -07001204 goto err;
Thomas Graf4e902c52006-08-17 18:14:52 -07001205 }
Robert Olsson19baf832005-06-21 12:43:18 -07001206
1207 l = fib_find_node(t, key);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001208 fa = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001209
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001210 if (l) {
Robert Olsson19baf832005-06-21 12:43:18 -07001211 fa_head = get_fa_head(l, plen);
1212 fa = fib_find_alias(fa_head, tos, fi->fib_priority);
1213 }
1214
1215 /* Now fa, if non-NULL, points to the first fib alias
1216 * with the same keys [prefix,tos,priority], if such key already
1217 * exists or to the node before which we will insert new one.
1218 *
1219 * If fa is NULL, we will need to allocate a new one and
1220 * insert to the head of f.
1221 *
1222 * If f is NULL, no fib node matched the destination key
1223 * and we need to allocate a new one of those as well.
1224 */
1225
Julian Anastasov936f6f82008-01-28 21:18:06 -08001226 if (fa && fa->fa_tos == tos &&
1227 fa->fa_info->fib_priority == fi->fib_priority) {
1228 struct fib_alias *fa_first, *fa_match;
Robert Olsson19baf832005-06-21 12:43:18 -07001229
1230 err = -EEXIST;
Thomas Graf4e902c52006-08-17 18:14:52 -07001231 if (cfg->fc_nlflags & NLM_F_EXCL)
Robert Olsson19baf832005-06-21 12:43:18 -07001232 goto out;
1233
Julian Anastasov936f6f82008-01-28 21:18:06 -08001234 /* We have 2 goals:
1235 * 1. Find exact match for type, scope, fib_info to avoid
1236 * duplicate routes
1237 * 2. Find next 'fa' (or head), NLM_F_APPEND inserts before it
1238 */
1239 fa_match = NULL;
1240 fa_first = fa;
1241 fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list);
1242 list_for_each_entry_continue(fa, fa_head, fa_list) {
1243 if (fa->fa_tos != tos)
1244 break;
1245 if (fa->fa_info->fib_priority != fi->fib_priority)
1246 break;
1247 if (fa->fa_type == cfg->fc_type &&
Julian Anastasov936f6f82008-01-28 21:18:06 -08001248 fa->fa_info == fi) {
1249 fa_match = fa;
1250 break;
1251 }
1252 }
1253
Thomas Graf4e902c52006-08-17 18:14:52 -07001254 if (cfg->fc_nlflags & NLM_F_REPLACE) {
Robert Olsson19baf832005-06-21 12:43:18 -07001255 struct fib_info *fi_drop;
1256 u8 state;
1257
Julian Anastasov936f6f82008-01-28 21:18:06 -08001258 fa = fa_first;
1259 if (fa_match) {
1260 if (fa == fa_match)
1261 err = 0;
Joonwoo Park67250332008-01-18 03:45:18 -08001262 goto out;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001263 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001264 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001265 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001266 if (new_fa == NULL)
1267 goto out;
Robert Olsson19baf832005-06-21 12:43:18 -07001268
1269 fi_drop = fa->fa_info;
Robert Olsson2373ce12005-08-25 13:01:29 -07001270 new_fa->fa_tos = fa->fa_tos;
1271 new_fa->fa_info = fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001272 new_fa->fa_type = cfg->fc_type;
Robert Olsson19baf832005-06-21 12:43:18 -07001273 state = fa->fa_state;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001274 new_fa->fa_state = state & ~FA_S_ACCESSED;
Robert Olsson19baf832005-06-21 12:43:18 -07001275
Robert Olsson2373ce12005-08-25 13:01:29 -07001276 list_replace_rcu(&fa->fa_list, &new_fa->fa_list);
1277 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001278
1279 fib_release_info(fi_drop);
1280 if (state & FA_S_ACCESSED)
Denis V. Lunev76e6ebf2008-07-05 19:00:44 -07001281 rt_cache_flush(cfg->fc_nlinfo.nl_net, -1);
Milan Kocianb8f55832007-05-23 14:55:06 -07001282 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen,
1283 tb->tb_id, &cfg->fc_nlinfo, NLM_F_REPLACE);
Robert Olsson19baf832005-06-21 12:43:18 -07001284
Olof Johansson91b9a272005-08-09 20:24:39 -07001285 goto succeeded;
Robert Olsson19baf832005-06-21 12:43:18 -07001286 }
1287 /* Error if we find a perfect match which
1288 * uses the same scope, type, and nexthop
1289 * information.
1290 */
Julian Anastasov936f6f82008-01-28 21:18:06 -08001291 if (fa_match)
1292 goto out;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001293
Thomas Graf4e902c52006-08-17 18:14:52 -07001294 if (!(cfg->fc_nlflags & NLM_F_APPEND))
Julian Anastasov936f6f82008-01-28 21:18:06 -08001295 fa = fa_first;
Robert Olsson19baf832005-06-21 12:43:18 -07001296 }
1297 err = -ENOENT;
Thomas Graf4e902c52006-08-17 18:14:52 -07001298 if (!(cfg->fc_nlflags & NLM_F_CREATE))
Robert Olsson19baf832005-06-21 12:43:18 -07001299 goto out;
1300
1301 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001302 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson19baf832005-06-21 12:43:18 -07001303 if (new_fa == NULL)
1304 goto out;
1305
1306 new_fa->fa_info = fi;
1307 new_fa->fa_tos = tos;
Thomas Graf4e902c52006-08-17 18:14:52 -07001308 new_fa->fa_type = cfg->fc_type;
Robert Olsson19baf832005-06-21 12:43:18 -07001309 new_fa->fa_state = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001310 /*
1311 * Insert new entry to the list.
1312 */
1313
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001314 if (!fa_head) {
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001315 fa_head = fib_insert_node(t, key, plen);
1316 if (unlikely(!fa_head)) {
1317 err = -ENOMEM;
Robert Olssonf835e472005-06-28 15:00:39 -07001318 goto out_free_new_fa;
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001319 }
Robert Olssonf835e472005-06-28 15:00:39 -07001320 }
Robert Olsson19baf832005-06-21 12:43:18 -07001321
Robert Olsson2373ce12005-08-25 13:01:29 -07001322 list_add_tail_rcu(&new_fa->fa_list,
1323 (fa ? &fa->fa_list : fa_head));
Robert Olsson19baf832005-06-21 12:43:18 -07001324
Denis V. Lunev76e6ebf2008-07-05 19:00:44 -07001325 rt_cache_flush(cfg->fc_nlinfo.nl_net, -1);
Thomas Graf4e902c52006-08-17 18:14:52 -07001326 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001327 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001328succeeded:
1329 return 0;
Robert Olssonf835e472005-06-28 15:00:39 -07001330
1331out_free_new_fa:
1332 kmem_cache_free(fn_alias_kmem, new_fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001333out:
1334 fib_release_info(fi);
Olof Johansson91b9a272005-08-09 20:24:39 -07001335err:
Robert Olsson19baf832005-06-21 12:43:18 -07001336 return err;
1337}
1338
Robert Olsson772cb712005-09-19 15:31:18 -07001339/* should be called with rcu_read_lock */
David S. Miller5b470442011-01-31 16:10:03 -08001340static int check_leaf(struct fib_table *tb, struct trie *t, struct leaf *l,
David S. Miller22bd5b92011-03-11 19:54:08 -05001341 t_key key, const struct flowi4 *flp,
Eric Dumazetebc0ffa2010-10-05 10:41:36 +00001342 struct fib_result *res, int fib_flags)
Robert Olsson19baf832005-06-21 12:43:18 -07001343{
Robert Olsson19baf832005-06-21 12:43:18 -07001344 struct leaf_info *li;
1345 struct hlist_head *hhead = &l->list;
1346 struct hlist_node *node;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001347
Robert Olsson2373ce12005-08-25 13:01:29 -07001348 hlist_for_each_entry_rcu(li, node, hhead, hlist) {
David S. Miller3be06862011-03-07 15:01:10 -08001349 struct fib_alias *fa;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001350 int plen = li->plen;
1351 __be32 mask = inet_make_mask(plen);
1352
Al Viro888454c2006-09-19 13:42:46 -07001353 if (l->key != (key & ntohl(mask)))
Robert Olsson19baf832005-06-21 12:43:18 -07001354 continue;
1355
David S. Miller3be06862011-03-07 15:01:10 -08001356 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
1357 struct fib_info *fi = fa->fa_info;
1358 int nhsel, err;
1359
David S. Miller22bd5b92011-03-11 19:54:08 -05001360 if (fa->fa_tos && fa->fa_tos != flp->flowi4_tos)
David S. Miller3be06862011-03-07 15:01:10 -08001361 continue;
David S. Miller37e826c2011-03-24 18:06:47 -07001362 if (fa->fa_info->fib_scope < flp->flowi4_scope)
David S. Miller3be06862011-03-07 15:01:10 -08001363 continue;
1364 fib_alias_accessed(fa);
1365 err = fib_props[fa->fa_type].error;
1366 if (err) {
1367#ifdef CONFIG_IP_FIB_TRIE_STATS
1368 t->stats.semantic_match_miss++;
1369#endif
1370 return 1;
1371 }
1372 if (fi->fib_flags & RTNH_F_DEAD)
1373 continue;
1374 for (nhsel = 0; nhsel < fi->fib_nhs; nhsel++) {
1375 const struct fib_nh *nh = &fi->fib_nh[nhsel];
1376
1377 if (nh->nh_flags & RTNH_F_DEAD)
1378 continue;
David S. Miller22bd5b92011-03-11 19:54:08 -05001379 if (flp->flowi4_oif && flp->flowi4_oif != nh->nh_oif)
David S. Miller3be06862011-03-07 15:01:10 -08001380 continue;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001381
Robert Olsson19baf832005-06-21 12:43:18 -07001382#ifdef CONFIG_IP_FIB_TRIE_STATS
David S. Miller3be06862011-03-07 15:01:10 -08001383 t->stats.semantic_match_passed++;
Robert Olsson19baf832005-06-21 12:43:18 -07001384#endif
David S. Miller3be06862011-03-07 15:01:10 -08001385 res->prefixlen = plen;
1386 res->nh_sel = nhsel;
1387 res->type = fa->fa_type;
David S. Miller37e826c2011-03-24 18:06:47 -07001388 res->scope = fa->fa_info->fib_scope;
David S. Miller3be06862011-03-07 15:01:10 -08001389 res->fi = fi;
1390 res->table = tb;
1391 res->fa_head = &li->falh;
1392 if (!(fib_flags & FIB_LOOKUP_NOREF))
1393 atomic_inc(&res->fi->fib_clntref);
1394 return 0;
1395 }
1396 }
1397
1398#ifdef CONFIG_IP_FIB_TRIE_STATS
1399 t->stats.semantic_match_miss++;
1400#endif
Robert Olsson19baf832005-06-21 12:43:18 -07001401 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001402
Ben Hutchings2e655572008-07-10 16:52:52 -07001403 return 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001404}
1405
David S. Miller22bd5b92011-03-11 19:54:08 -05001406int fib_table_lookup(struct fib_table *tb, const struct flowi4 *flp,
Eric Dumazetebc0ffa2010-10-05 10:41:36 +00001407 struct fib_result *res, int fib_flags)
Robert Olsson19baf832005-06-21 12:43:18 -07001408{
1409 struct trie *t = (struct trie *) tb->tb_data;
Ben Hutchings2e655572008-07-10 16:52:52 -07001410 int ret;
David S. Millerb299e4f2011-02-02 20:48:10 -08001411 struct rt_trie_node *n;
Robert Olsson19baf832005-06-21 12:43:18 -07001412 struct tnode *pn;
David S. Miller3b004562011-02-16 14:56:22 -08001413 unsigned int pos, bits;
David S. Miller22bd5b92011-03-11 19:54:08 -05001414 t_key key = ntohl(flp->daddr);
David S. Miller3b004562011-02-16 14:56:22 -08001415 unsigned int chopped_off;
Robert Olsson19baf832005-06-21 12:43:18 -07001416 t_key cindex = 0;
David S. Miller3b004562011-02-16 14:56:22 -08001417 unsigned int current_prefix_length = KEYLENGTH;
Olof Johansson91b9a272005-08-09 20:24:39 -07001418 struct tnode *cn;
Eric Dumazet874ffa82010-10-13 06:56:11 +00001419 t_key pref_mismatch;
Olof Johansson91b9a272005-08-09 20:24:39 -07001420
Robert Olsson2373ce12005-08-25 13:01:29 -07001421 rcu_read_lock();
Robert Olsson19baf832005-06-21 12:43:18 -07001422
Robert Olsson2373ce12005-08-25 13:01:29 -07001423 n = rcu_dereference(t->trie);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001424 if (!n)
Robert Olsson19baf832005-06-21 12:43:18 -07001425 goto failed;
1426
1427#ifdef CONFIG_IP_FIB_TRIE_STATS
1428 t->stats.gets++;
1429#endif
1430
1431 /* Just a leaf? */
1432 if (IS_LEAF(n)) {
David S. Miller5b470442011-01-31 16:10:03 -08001433 ret = check_leaf(tb, t, (struct leaf *)n, key, flp, res, fib_flags);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001434 goto found;
Robert Olsson19baf832005-06-21 12:43:18 -07001435 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001436
Robert Olsson19baf832005-06-21 12:43:18 -07001437 pn = (struct tnode *) n;
1438 chopped_off = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001439
Olof Johansson91b9a272005-08-09 20:24:39 -07001440 while (pn) {
Robert Olsson19baf832005-06-21 12:43:18 -07001441 pos = pn->pos;
1442 bits = pn->bits;
1443
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001444 if (!chopped_off)
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001445 cindex = tkey_extract_bits(mask_pfx(key, current_prefix_length),
1446 pos, bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001447
Jarek Poplawskib902e572009-07-14 11:20:32 +00001448 n = tnode_get_child_rcu(pn, cindex);
Robert Olsson19baf832005-06-21 12:43:18 -07001449
1450 if (n == NULL) {
1451#ifdef CONFIG_IP_FIB_TRIE_STATS
1452 t->stats.null_node_hit++;
1453#endif
1454 goto backtrace;
1455 }
1456
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001457 if (IS_LEAF(n)) {
David S. Miller5b470442011-01-31 16:10:03 -08001458 ret = check_leaf(tb, t, (struct leaf *)n, key, flp, res, fib_flags);
Ben Hutchings2e655572008-07-10 16:52:52 -07001459 if (ret > 0)
Olof Johansson91b9a272005-08-09 20:24:39 -07001460 goto backtrace;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001461 goto found;
Olof Johansson91b9a272005-08-09 20:24:39 -07001462 }
1463
Olof Johansson91b9a272005-08-09 20:24:39 -07001464 cn = (struct tnode *)n;
1465
1466 /*
1467 * It's a tnode, and we can do some extra checks here if we
1468 * like, to avoid descending into a dead-end branch.
1469 * This tnode is in the parent's child array at index
1470 * key[p_pos..p_pos+p_bits] but potentially with some bits
1471 * chopped off, so in reality the index may be just a
1472 * subprefix, padded with zero at the end.
1473 * We can also take a look at any skipped bits in this
1474 * tnode - everything up to p_pos is supposed to be ok,
1475 * and the non-chopped bits of the index (se previous
1476 * paragraph) are also guaranteed ok, but the rest is
1477 * considered unknown.
1478 *
1479 * The skipped bits are key[pos+bits..cn->pos].
1480 */
1481
1482 /* If current_prefix_length < pos+bits, we are already doing
1483 * actual prefix matching, which means everything from
1484 * pos+(bits-chopped_off) onward must be zero along some
1485 * branch of this subtree - otherwise there is *no* valid
1486 * prefix present. Here we can only check the skipped
1487 * bits. Remember, since we have already indexed into the
1488 * parent's child array, we know that the bits we chopped of
1489 * *are* zero.
1490 */
1491
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001492 /* NOTA BENE: Checking only skipped bits
1493 for the new node here */
Olof Johansson91b9a272005-08-09 20:24:39 -07001494
1495 if (current_prefix_length < pos+bits) {
1496 if (tkey_extract_bits(cn->key, current_prefix_length,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001497 cn->pos - current_prefix_length)
1498 || !(cn->child[0]))
Olof Johansson91b9a272005-08-09 20:24:39 -07001499 goto backtrace;
1500 }
1501
1502 /*
1503 * If chopped_off=0, the index is fully validated and we
1504 * only need to look at the skipped bits for this, the new,
1505 * tnode. What we actually want to do is to find out if
1506 * these skipped bits match our key perfectly, or if we will
1507 * have to count on finding a matching prefix further down,
1508 * because if we do, we would like to have some way of
1509 * verifying the existence of such a prefix at this point.
1510 */
1511
1512 /* The only thing we can do at this point is to verify that
1513 * any such matching prefix can indeed be a prefix to our
1514 * key, and if the bits in the node we are inspecting that
1515 * do not match our key are not ZERO, this cannot be true.
1516 * Thus, find out where there is a mismatch (before cn->pos)
1517 * and verify that all the mismatching bits are zero in the
1518 * new tnode's key.
1519 */
1520
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001521 /*
1522 * Note: We aren't very concerned about the piece of
1523 * the key that precede pn->pos+pn->bits, since these
1524 * have already been checked. The bits after cn->pos
1525 * aren't checked since these are by definition
1526 * "unknown" at this point. Thus, what we want to see
1527 * is if we are about to enter the "prefix matching"
1528 * state, and in that case verify that the skipped
1529 * bits that will prevail throughout this subtree are
1530 * zero, as they have to be if we are to find a
1531 * matching prefix.
Olof Johansson91b9a272005-08-09 20:24:39 -07001532 */
1533
Eric Dumazet874ffa82010-10-13 06:56:11 +00001534 pref_mismatch = mask_pfx(cn->key ^ key, cn->pos);
Olof Johansson91b9a272005-08-09 20:24:39 -07001535
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001536 /*
1537 * In short: If skipped bits in this node do not match
1538 * the search key, enter the "prefix matching"
1539 * state.directly.
Olof Johansson91b9a272005-08-09 20:24:39 -07001540 */
1541 if (pref_mismatch) {
Eric Dumazet874ffa82010-10-13 06:56:11 +00001542 int mp = KEYLENGTH - fls(pref_mismatch);
Olof Johansson91b9a272005-08-09 20:24:39 -07001543
Eric Dumazet874ffa82010-10-13 06:56:11 +00001544 if (tkey_extract_bits(cn->key, mp, cn->pos - mp) != 0)
Olof Johansson91b9a272005-08-09 20:24:39 -07001545 goto backtrace;
1546
1547 if (current_prefix_length >= cn->pos)
1548 current_prefix_length = mp;
1549 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001550
Olof Johansson91b9a272005-08-09 20:24:39 -07001551 pn = (struct tnode *)n; /* Descend */
1552 chopped_off = 0;
1553 continue;
1554
Robert Olsson19baf832005-06-21 12:43:18 -07001555backtrace:
1556 chopped_off++;
1557
1558 /* As zero don't change the child key (cindex) */
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001559 while ((chopped_off <= pn->bits)
1560 && !(cindex & (1<<(chopped_off-1))))
Robert Olsson19baf832005-06-21 12:43:18 -07001561 chopped_off++;
Robert Olsson19baf832005-06-21 12:43:18 -07001562
1563 /* Decrease current_... with bits chopped off */
1564 if (current_prefix_length > pn->pos + pn->bits - chopped_off)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001565 current_prefix_length = pn->pos + pn->bits
1566 - chopped_off;
Olof Johansson91b9a272005-08-09 20:24:39 -07001567
Robert Olsson19baf832005-06-21 12:43:18 -07001568 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001569 * Either we do the actual chop off according or if we have
Robert Olsson19baf832005-06-21 12:43:18 -07001570 * chopped off all bits in this tnode walk up to our parent.
1571 */
1572
Olof Johansson91b9a272005-08-09 20:24:39 -07001573 if (chopped_off <= pn->bits) {
Robert Olsson19baf832005-06-21 12:43:18 -07001574 cindex &= ~(1 << (chopped_off-1));
Olof Johansson91b9a272005-08-09 20:24:39 -07001575 } else {
David S. Millerb299e4f2011-02-02 20:48:10 -08001576 struct tnode *parent = node_parent_rcu((struct rt_trie_node *) pn);
Stephen Hemminger06801912007-08-10 15:22:13 -07001577 if (!parent)
Robert Olsson19baf832005-06-21 12:43:18 -07001578 goto failed;
Olof Johansson91b9a272005-08-09 20:24:39 -07001579
Robert Olsson19baf832005-06-21 12:43:18 -07001580 /* Get Child's index */
Stephen Hemminger06801912007-08-10 15:22:13 -07001581 cindex = tkey_extract_bits(pn->key, parent->pos, parent->bits);
1582 pn = parent;
Robert Olsson19baf832005-06-21 12:43:18 -07001583 chopped_off = 0;
1584
1585#ifdef CONFIG_IP_FIB_TRIE_STATS
1586 t->stats.backtrack++;
1587#endif
1588 goto backtrace;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001589 }
Robert Olsson19baf832005-06-21 12:43:18 -07001590 }
1591failed:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001592 ret = 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001593found:
Robert Olsson2373ce12005-08-25 13:01:29 -07001594 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001595 return ret;
1596}
1597
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001598/*
1599 * Remove the leaf and return parent.
1600 */
1601static void trie_leaf_remove(struct trie *t, struct leaf *l)
Robert Olsson19baf832005-06-21 12:43:18 -07001602{
David S. Millerb299e4f2011-02-02 20:48:10 -08001603 struct tnode *tp = node_parent((struct rt_trie_node *) l);
Robert Olsson19baf832005-06-21 12:43:18 -07001604
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001605 pr_debug("entering trie_leaf_remove(%p)\n", l);
Robert Olsson19baf832005-06-21 12:43:18 -07001606
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001607 if (tp) {
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001608 t_key cindex = tkey_extract_bits(l->key, tp->pos, tp->bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001609 put_child(t, (struct tnode *)tp, cindex, NULL);
Jarek Poplawski7b855762009-06-18 00:28:51 -07001610 trie_rebalance(t, tp);
Olof Johansson91b9a272005-08-09 20:24:39 -07001611 } else
Robert Olsson2373ce12005-08-25 13:01:29 -07001612 rcu_assign_pointer(t->trie, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001613
Stephen Hemminger387a5482008-04-10 03:47:34 -07001614 free_leaf(l);
Robert Olsson19baf832005-06-21 12:43:18 -07001615}
1616
Robert Olssond562f1f2007-03-26 14:22:22 -07001617/*
1618 * Caller must hold RTNL.
1619 */
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001620int fib_table_delete(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001621{
1622 struct trie *t = (struct trie *) tb->tb_data;
1623 u32 key, mask;
Thomas Graf4e902c52006-08-17 18:14:52 -07001624 int plen = cfg->fc_dst_len;
1625 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001626 struct fib_alias *fa, *fa_to_delete;
1627 struct list_head *fa_head;
1628 struct leaf *l;
Olof Johansson91b9a272005-08-09 20:24:39 -07001629 struct leaf_info *li;
1630
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001631 if (plen > 32)
Robert Olsson19baf832005-06-21 12:43:18 -07001632 return -EINVAL;
1633
Thomas Graf4e902c52006-08-17 18:14:52 -07001634 key = ntohl(cfg->fc_dst);
Olof Johansson91b9a272005-08-09 20:24:39 -07001635 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001636
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001637 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001638 return -EINVAL;
1639
1640 key = key & mask;
1641 l = fib_find_node(t, key);
1642
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001643 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001644 return -ESRCH;
1645
1646 fa_head = get_fa_head(l, plen);
1647 fa = fib_find_alias(fa_head, tos, 0);
1648
1649 if (!fa)
1650 return -ESRCH;
1651
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001652 pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t);
Robert Olsson19baf832005-06-21 12:43:18 -07001653
1654 fa_to_delete = NULL;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001655 fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list);
1656 list_for_each_entry_continue(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001657 struct fib_info *fi = fa->fa_info;
1658
1659 if (fa->fa_tos != tos)
1660 break;
1661
Thomas Graf4e902c52006-08-17 18:14:52 -07001662 if ((!cfg->fc_type || fa->fa_type == cfg->fc_type) &&
1663 (cfg->fc_scope == RT_SCOPE_NOWHERE ||
David S. Miller37e826c2011-03-24 18:06:47 -07001664 fa->fa_info->fib_scope == cfg->fc_scope) &&
Julian Anastasov74cb3c12011-03-19 12:13:46 +00001665 (!cfg->fc_prefsrc ||
1666 fi->fib_prefsrc == cfg->fc_prefsrc) &&
Thomas Graf4e902c52006-08-17 18:14:52 -07001667 (!cfg->fc_protocol ||
1668 fi->fib_protocol == cfg->fc_protocol) &&
1669 fib_nh_match(cfg, fi) == 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001670 fa_to_delete = fa;
1671 break;
1672 }
1673 }
1674
Olof Johansson91b9a272005-08-09 20:24:39 -07001675 if (!fa_to_delete)
1676 return -ESRCH;
Robert Olsson19baf832005-06-21 12:43:18 -07001677
Olof Johansson91b9a272005-08-09 20:24:39 -07001678 fa = fa_to_delete;
Thomas Graf4e902c52006-08-17 18:14:52 -07001679 rtmsg_fib(RTM_DELROUTE, htonl(key), fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001680 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001681
Olof Johansson91b9a272005-08-09 20:24:39 -07001682 l = fib_find_node(t, key);
Robert Olsson772cb712005-09-19 15:31:18 -07001683 li = find_leaf_info(l, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001684
Robert Olsson2373ce12005-08-25 13:01:29 -07001685 list_del_rcu(&fa->fa_list);
Robert Olsson19baf832005-06-21 12:43:18 -07001686
Olof Johansson91b9a272005-08-09 20:24:39 -07001687 if (list_empty(fa_head)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001688 hlist_del_rcu(&li->hlist);
Olof Johansson91b9a272005-08-09 20:24:39 -07001689 free_leaf_info(li);
Robert Olsson2373ce12005-08-25 13:01:29 -07001690 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001691
1692 if (hlist_empty(&l->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001693 trie_leaf_remove(t, l);
Olof Johansson91b9a272005-08-09 20:24:39 -07001694
1695 if (fa->fa_state & FA_S_ACCESSED)
Denis V. Lunev76e6ebf2008-07-05 19:00:44 -07001696 rt_cache_flush(cfg->fc_nlinfo.nl_net, -1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001697
Robert Olsson2373ce12005-08-25 13:01:29 -07001698 fib_release_info(fa->fa_info);
1699 alias_free_mem_rcu(fa);
Olof Johansson91b9a272005-08-09 20:24:39 -07001700 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001701}
1702
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001703static int trie_flush_list(struct list_head *head)
Robert Olsson19baf832005-06-21 12:43:18 -07001704{
1705 struct fib_alias *fa, *fa_node;
1706 int found = 0;
1707
1708 list_for_each_entry_safe(fa, fa_node, head, fa_list) {
1709 struct fib_info *fi = fa->fa_info;
Robert Olsson19baf832005-06-21 12:43:18 -07001710
Robert Olsson2373ce12005-08-25 13:01:29 -07001711 if (fi && (fi->fib_flags & RTNH_F_DEAD)) {
1712 list_del_rcu(&fa->fa_list);
1713 fib_release_info(fa->fa_info);
1714 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001715 found++;
1716 }
1717 }
1718 return found;
1719}
1720
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001721static int trie_flush_leaf(struct leaf *l)
Robert Olsson19baf832005-06-21 12:43:18 -07001722{
1723 int found = 0;
1724 struct hlist_head *lih = &l->list;
1725 struct hlist_node *node, *tmp;
1726 struct leaf_info *li = NULL;
1727
1728 hlist_for_each_entry_safe(li, node, tmp, lih, hlist) {
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001729 found += trie_flush_list(&li->falh);
Robert Olsson19baf832005-06-21 12:43:18 -07001730
1731 if (list_empty(&li->falh)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001732 hlist_del_rcu(&li->hlist);
Robert Olsson19baf832005-06-21 12:43:18 -07001733 free_leaf_info(li);
1734 }
1735 }
1736 return found;
1737}
1738
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001739/*
1740 * Scan for the next right leaf starting at node p->child[idx]
1741 * Since we have back pointer, no recursion necessary.
1742 */
David S. Millerb299e4f2011-02-02 20:48:10 -08001743static struct leaf *leaf_walk_rcu(struct tnode *p, struct rt_trie_node *c)
Robert Olsson19baf832005-06-21 12:43:18 -07001744{
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001745 do {
1746 t_key idx;
Robert Olsson19baf832005-06-21 12:43:18 -07001747
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001748 if (c)
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001749 idx = tkey_extract_bits(c->key, p->pos, p->bits) + 1;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001750 else
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001751 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001752
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001753 while (idx < 1u << p->bits) {
1754 c = tnode_get_child_rcu(p, idx++);
Robert Olsson2373ce12005-08-25 13:01:29 -07001755 if (!c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001756 continue;
Robert Olsson19baf832005-06-21 12:43:18 -07001757
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001758 if (IS_LEAF(c)) {
1759 prefetch(p->child[idx]);
1760 return (struct leaf *) c;
Robert Olsson19baf832005-06-21 12:43:18 -07001761 }
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001762
1763 /* Rescan start scanning in new node */
1764 p = (struct tnode *) c;
1765 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001766 }
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001767
1768 /* Node empty, walk back up to parent */
David S. Millerb299e4f2011-02-02 20:48:10 -08001769 c = (struct rt_trie_node *) p;
Eric Dumazeta034ee32010-09-09 23:32:28 +00001770 } while ((p = node_parent_rcu(c)) != NULL);
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001771
1772 return NULL; /* Root of trie */
1773}
1774
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001775static struct leaf *trie_firstleaf(struct trie *t)
1776{
Eric Dumazeta034ee32010-09-09 23:32:28 +00001777 struct tnode *n = (struct tnode *)rcu_dereference_rtnl(t->trie);
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001778
1779 if (!n)
1780 return NULL;
1781
1782 if (IS_LEAF(n)) /* trie is just a leaf */
1783 return (struct leaf *) n;
1784
1785 return leaf_walk_rcu(n, NULL);
1786}
1787
1788static struct leaf *trie_nextleaf(struct leaf *l)
1789{
David S. Millerb299e4f2011-02-02 20:48:10 -08001790 struct rt_trie_node *c = (struct rt_trie_node *) l;
Jarek Poplawskib902e572009-07-14 11:20:32 +00001791 struct tnode *p = node_parent_rcu(c);
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001792
1793 if (!p)
1794 return NULL; /* trie with just one leaf */
1795
1796 return leaf_walk_rcu(p, c);
Robert Olsson19baf832005-06-21 12:43:18 -07001797}
1798
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001799static struct leaf *trie_leafindex(struct trie *t, int index)
1800{
1801 struct leaf *l = trie_firstleaf(t);
1802
Stephen Hemmingerec28cf72008-02-11 21:12:49 -08001803 while (l && index-- > 0)
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001804 l = trie_nextleaf(l);
Stephen Hemmingerec28cf72008-02-11 21:12:49 -08001805
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001806 return l;
1807}
1808
1809
Robert Olssond562f1f2007-03-26 14:22:22 -07001810/*
1811 * Caller must hold RTNL.
1812 */
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001813int fib_table_flush(struct fib_table *tb)
Robert Olsson19baf832005-06-21 12:43:18 -07001814{
1815 struct trie *t = (struct trie *) tb->tb_data;
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001816 struct leaf *l, *ll = NULL;
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001817 int found = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001818
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001819 for (l = trie_firstleaf(t); l; l = trie_nextleaf(l)) {
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001820 found += trie_flush_leaf(l);
Robert Olsson19baf832005-06-21 12:43:18 -07001821
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 ll = l;
1825 }
1826
1827 if (ll && hlist_empty(&ll->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001828 trie_leaf_remove(t, ll);
Robert Olsson19baf832005-06-21 12:43:18 -07001829
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001830 pr_debug("trie_flush found=%d\n", found);
Robert Olsson19baf832005-06-21 12:43:18 -07001831 return found;
1832}
1833
Pavel Emelyanov4aa2c462010-10-28 02:00:43 +00001834void fib_free_table(struct fib_table *tb)
1835{
1836 kfree(tb);
1837}
1838
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001839static int fn_trie_dump_fa(t_key key, int plen, struct list_head *fah,
1840 struct fib_table *tb,
Robert Olsson19baf832005-06-21 12:43:18 -07001841 struct sk_buff *skb, struct netlink_callback *cb)
1842{
1843 int i, s_i;
1844 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07001845 __be32 xkey = htonl(key);
Robert Olsson19baf832005-06-21 12:43:18 -07001846
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001847 s_i = cb->args[5];
Robert Olsson19baf832005-06-21 12:43:18 -07001848 i = 0;
1849
Robert Olsson2373ce12005-08-25 13:01:29 -07001850 /* rcu_read_lock is hold by caller */
1851
1852 list_for_each_entry_rcu(fa, fah, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001853 if (i < s_i) {
1854 i++;
1855 continue;
1856 }
Robert Olsson19baf832005-06-21 12:43:18 -07001857
1858 if (fib_dump_info(skb, NETLINK_CB(cb->skb).pid,
1859 cb->nlh->nlmsg_seq,
1860 RTM_NEWROUTE,
1861 tb->tb_id,
1862 fa->fa_type,
Thomas Grafbe403ea2006-08-17 18:15:17 -07001863 xkey,
Robert Olsson19baf832005-06-21 12:43:18 -07001864 plen,
1865 fa->fa_tos,
Stephen Hemminger64347f72008-01-22 21:55:01 -08001866 fa->fa_info, NLM_F_MULTI) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001867 cb->args[5] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001868 return -1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001869 }
Robert Olsson19baf832005-06-21 12:43:18 -07001870 i++;
1871 }
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001872 cb->args[5] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001873 return skb->len;
1874}
1875
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001876static int fn_trie_dump_leaf(struct leaf *l, struct fib_table *tb,
1877 struct sk_buff *skb, struct netlink_callback *cb)
Robert Olsson19baf832005-06-21 12:43:18 -07001878{
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001879 struct leaf_info *li;
1880 struct hlist_node *node;
1881 int i, s_i;
Robert Olsson19baf832005-06-21 12:43:18 -07001882
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001883 s_i = cb->args[4];
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001884 i = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001885
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001886 /* rcu_read_lock is hold by caller */
1887 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
1888 if (i < s_i) {
1889 i++;
Robert Olsson19baf832005-06-21 12:43:18 -07001890 continue;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001891 }
Robert Olsson19baf832005-06-21 12:43:18 -07001892
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001893 if (i > s_i)
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001894 cb->args[5] = 0;
Olof Johansson91b9a272005-08-09 20:24:39 -07001895
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001896 if (list_empty(&li->falh))
Robert Olsson19baf832005-06-21 12:43:18 -07001897 continue;
1898
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001899 if (fn_trie_dump_fa(l->key, li->plen, &li->falh, tb, skb, cb) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001900 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001901 return -1;
1902 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001903 i++;
Robert Olsson19baf832005-06-21 12:43:18 -07001904 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001905
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001906 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001907 return skb->len;
1908}
1909
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001910int fib_table_dump(struct fib_table *tb, struct sk_buff *skb,
1911 struct netlink_callback *cb)
Robert Olsson19baf832005-06-21 12:43:18 -07001912{
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001913 struct leaf *l;
Robert Olsson19baf832005-06-21 12:43:18 -07001914 struct trie *t = (struct trie *) tb->tb_data;
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001915 t_key key = cb->args[2];
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001916 int count = cb->args[3];
Robert Olsson19baf832005-06-21 12:43:18 -07001917
Robert Olsson2373ce12005-08-25 13:01:29 -07001918 rcu_read_lock();
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001919 /* Dump starting at last key.
1920 * Note: 0.0.0.0/0 (ie default) is first key.
1921 */
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001922 if (count == 0)
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001923 l = trie_firstleaf(t);
1924 else {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001925 /* Normally, continue from last key, but if that is missing
1926 * fallback to using slow rescan
1927 */
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001928 l = fib_find_node(t, key);
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001929 if (!l)
1930 l = trie_leafindex(t, count);
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001931 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001932
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001933 while (l) {
1934 cb->args[2] = l->key;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001935 if (fn_trie_dump_leaf(l, tb, skb, cb) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001936 cb->args[3] = count;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001937 rcu_read_unlock();
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001938 return -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001939 }
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001940
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001941 ++count;
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001942 l = trie_nextleaf(l);
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001943 memset(&cb->args[4], 0,
1944 sizeof(cb->args) - 4*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001945 }
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001946 cb->args[3] = count;
Robert Olsson2373ce12005-08-25 13:01:29 -07001947 rcu_read_unlock();
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001948
Robert Olsson19baf832005-06-21 12:43:18 -07001949 return skb->len;
Robert Olsson19baf832005-06-21 12:43:18 -07001950}
1951
David S. Miller5348ba82011-02-01 15:30:56 -08001952void __init fib_trie_init(void)
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08001953{
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001954 fn_alias_kmem = kmem_cache_create("ip_fib_alias",
1955 sizeof(struct fib_alias),
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -08001956 0, SLAB_PANIC, NULL);
1957
1958 trie_leaf_kmem = kmem_cache_create("ip_fib_trie",
1959 max(sizeof(struct leaf),
1960 sizeof(struct leaf_info)),
1961 0, SLAB_PANIC, NULL);
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08001962}
Robert Olsson19baf832005-06-21 12:43:18 -07001963
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08001964
David S. Miller5348ba82011-02-01 15:30:56 -08001965struct fib_table *fib_trie_table(u32 id)
Robert Olsson19baf832005-06-21 12:43:18 -07001966{
1967 struct fib_table *tb;
1968 struct trie *t;
1969
Robert Olsson19baf832005-06-21 12:43:18 -07001970 tb = kmalloc(sizeof(struct fib_table) + sizeof(struct trie),
1971 GFP_KERNEL);
1972 if (tb == NULL)
1973 return NULL;
1974
1975 tb->tb_id = id;
Denis V. Lunev971b8932007-12-08 00:32:23 -08001976 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001977
1978 t = (struct trie *) tb->tb_data;
Stephen Hemmingerc28a1cf2008-01-12 20:49:13 -08001979 memset(t, 0, sizeof(*t));
Robert Olsson19baf832005-06-21 12:43:18 -07001980
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001981 if (id == RT_TABLE_LOCAL)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001982 pr_info("IPv4 FIB: Using LC-trie version %s\n", VERSION);
Robert Olsson19baf832005-06-21 12:43:18 -07001983
1984 return tb;
1985}
1986
Robert Olsson19baf832005-06-21 12:43:18 -07001987#ifdef CONFIG_PROC_FS
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001988/* Depth first Trie walk iterator */
1989struct fib_trie_iter {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08001990 struct seq_net_private p;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07001991 struct fib_table *tb;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001992 struct tnode *tnode;
Eric Dumazeta034ee32010-09-09 23:32:28 +00001993 unsigned int index;
1994 unsigned int depth;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001995};
Robert Olsson19baf832005-06-21 12:43:18 -07001996
David S. Millerb299e4f2011-02-02 20:48:10 -08001997static struct rt_trie_node *fib_trie_get_next(struct fib_trie_iter *iter)
Robert Olsson19baf832005-06-21 12:43:18 -07001998{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001999 struct tnode *tn = iter->tnode;
Eric Dumazeta034ee32010-09-09 23:32:28 +00002000 unsigned int cindex = iter->index;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002001 struct tnode *p;
2002
Eric W. Biederman6640e692007-01-24 14:42:04 -08002003 /* A single entry routing table */
2004 if (!tn)
2005 return NULL;
2006
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002007 pr_debug("get_next iter={node=%p index=%d depth=%d}\n",
2008 iter->tnode, iter->index, iter->depth);
2009rescan:
2010 while (cindex < (1<<tn->bits)) {
David S. Millerb299e4f2011-02-02 20:48:10 -08002011 struct rt_trie_node *n = tnode_get_child_rcu(tn, cindex);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002012
2013 if (n) {
2014 if (IS_LEAF(n)) {
2015 iter->tnode = tn;
2016 iter->index = cindex + 1;
2017 } else {
2018 /* push down one level */
2019 iter->tnode = (struct tnode *) n;
2020 iter->index = 0;
2021 ++iter->depth;
2022 }
2023 return n;
2024 }
2025
2026 ++cindex;
2027 }
2028
2029 /* Current node exhausted, pop back up */
David S. Millerb299e4f2011-02-02 20:48:10 -08002030 p = node_parent_rcu((struct rt_trie_node *)tn);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002031 if (p) {
2032 cindex = tkey_extract_bits(tn->key, p->pos, p->bits)+1;
2033 tn = p;
2034 --iter->depth;
2035 goto rescan;
2036 }
2037
2038 /* got root? */
Robert Olsson19baf832005-06-21 12:43:18 -07002039 return NULL;
2040}
2041
David S. Millerb299e4f2011-02-02 20:48:10 -08002042static struct rt_trie_node *fib_trie_get_first(struct fib_trie_iter *iter,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002043 struct trie *t)
Robert Olsson19baf832005-06-21 12:43:18 -07002044{
David S. Millerb299e4f2011-02-02 20:48:10 -08002045 struct rt_trie_node *n;
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002046
Stephen Hemminger132adf52007-03-08 20:44:43 -08002047 if (!t)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002048 return NULL;
2049
2050 n = rcu_dereference(t->trie);
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002051 if (!n)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002052 return NULL;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002053
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002054 if (IS_TNODE(n)) {
2055 iter->tnode = (struct tnode *) n;
2056 iter->index = 0;
2057 iter->depth = 1;
2058 } else {
2059 iter->tnode = NULL;
2060 iter->index = 0;
2061 iter->depth = 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002062 }
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002063
2064 return n;
Robert Olsson19baf832005-06-21 12:43:18 -07002065}
2066
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002067static void trie_collect_stats(struct trie *t, struct trie_stat *s)
Robert Olsson19baf832005-06-21 12:43:18 -07002068{
David S. Millerb299e4f2011-02-02 20:48:10 -08002069 struct rt_trie_node *n;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002070 struct fib_trie_iter iter;
Robert Olsson19baf832005-06-21 12:43:18 -07002071
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002072 memset(s, 0, sizeof(*s));
Robert Olsson19baf832005-06-21 12:43:18 -07002073
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002074 rcu_read_lock();
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002075 for (n = fib_trie_get_first(&iter, t); n; n = fib_trie_get_next(&iter)) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002076 if (IS_LEAF(n)) {
Stephen Hemminger93672292008-01-22 21:54:05 -08002077 struct leaf *l = (struct leaf *)n;
2078 struct leaf_info *li;
2079 struct hlist_node *tmp;
2080
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002081 s->leaves++;
2082 s->totdepth += iter.depth;
2083 if (iter.depth > s->maxdepth)
2084 s->maxdepth = iter.depth;
Stephen Hemminger93672292008-01-22 21:54:05 -08002085
2086 hlist_for_each_entry_rcu(li, tmp, &l->list, hlist)
2087 ++s->prefixes;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002088 } else {
2089 const struct tnode *tn = (const struct tnode *) n;
2090 int i;
Robert Olsson19baf832005-06-21 12:43:18 -07002091
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002092 s->tnodes++;
Stephen Hemminger132adf52007-03-08 20:44:43 -08002093 if (tn->bits < MAX_STAT_DEPTH)
Robert Olsson06ef9212006-03-20 21:35:01 -08002094 s->nodesizes[tn->bits]++;
2095
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002096 for (i = 0; i < (1<<tn->bits); i++)
2097 if (!tn->child[i])
2098 s->nullpointers++;
2099 }
2100 }
2101 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002102}
2103
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002104/*
Robert Olsson19baf832005-06-21 12:43:18 -07002105 * This outputs /proc/net/fib_triestats
Robert Olsson19baf832005-06-21 12:43:18 -07002106 */
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002107static void trie_show_stats(struct seq_file *seq, struct trie_stat *stat)
Robert Olsson19baf832005-06-21 12:43:18 -07002108{
Eric Dumazeta034ee32010-09-09 23:32:28 +00002109 unsigned int i, max, pointers, bytes, avdepth;
Robert Olsson19baf832005-06-21 12:43:18 -07002110
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002111 if (stat->leaves)
2112 avdepth = stat->totdepth*100 / stat->leaves;
2113 else
2114 avdepth = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002115
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002116 seq_printf(seq, "\tAver depth: %u.%02d\n",
2117 avdepth / 100, avdepth % 100);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002118 seq_printf(seq, "\tMax depth: %u\n", stat->maxdepth);
Robert Olsson19baf832005-06-21 12:43:18 -07002119
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002120 seq_printf(seq, "\tLeaves: %u\n", stat->leaves);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002121 bytes = sizeof(struct leaf) * stat->leaves;
Stephen Hemminger93672292008-01-22 21:54:05 -08002122
2123 seq_printf(seq, "\tPrefixes: %u\n", stat->prefixes);
2124 bytes += sizeof(struct leaf_info) * stat->prefixes;
2125
Stephen Hemminger187b5182008-01-12 20:55:55 -08002126 seq_printf(seq, "\tInternal nodes: %u\n\t", stat->tnodes);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002127 bytes += sizeof(struct tnode) * stat->tnodes;
Robert Olsson19baf832005-06-21 12:43:18 -07002128
Robert Olsson06ef9212006-03-20 21:35:01 -08002129 max = MAX_STAT_DEPTH;
2130 while (max > 0 && stat->nodesizes[max-1] == 0)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002131 max--;
Robert Olsson19baf832005-06-21 12:43:18 -07002132
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002133 pointers = 0;
2134 for (i = 1; i <= max; i++)
2135 if (stat->nodesizes[i] != 0) {
Stephen Hemminger187b5182008-01-12 20:55:55 -08002136 seq_printf(seq, " %u: %u", i, stat->nodesizes[i]);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002137 pointers += (1<<i) * stat->nodesizes[i];
2138 }
2139 seq_putc(seq, '\n');
Stephen Hemminger187b5182008-01-12 20:55:55 -08002140 seq_printf(seq, "\tPointers: %u\n", pointers);
Robert Olsson19baf832005-06-21 12:43:18 -07002141
David S. Millerb299e4f2011-02-02 20:48:10 -08002142 bytes += sizeof(struct rt_trie_node *) * pointers;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002143 seq_printf(seq, "Null ptrs: %u\n", stat->nullpointers);
2144 seq_printf(seq, "Total size: %u kB\n", (bytes + 1023) / 1024);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002145}
Robert Olsson19baf832005-06-21 12:43:18 -07002146
2147#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002148static void trie_show_usage(struct seq_file *seq,
2149 const struct trie_use_stats *stats)
2150{
2151 seq_printf(seq, "\nCounters:\n---------\n");
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002152 seq_printf(seq, "gets = %u\n", stats->gets);
2153 seq_printf(seq, "backtracks = %u\n", stats->backtrack);
2154 seq_printf(seq, "semantic match passed = %u\n",
2155 stats->semantic_match_passed);
2156 seq_printf(seq, "semantic match miss = %u\n",
2157 stats->semantic_match_miss);
2158 seq_printf(seq, "null node hit= %u\n", stats->null_node_hit);
2159 seq_printf(seq, "skipped node resize = %u\n\n",
2160 stats->resize_node_skipped);
Robert Olsson19baf832005-06-21 12:43:18 -07002161}
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002162#endif /* CONFIG_IP_FIB_TRIE_STATS */
2163
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002164static void fib_table_print(struct seq_file *seq, struct fib_table *tb)
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002165{
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002166 if (tb->tb_id == RT_TABLE_LOCAL)
2167 seq_puts(seq, "Local:\n");
2168 else if (tb->tb_id == RT_TABLE_MAIN)
2169 seq_puts(seq, "Main:\n");
2170 else
2171 seq_printf(seq, "Id %d:\n", tb->tb_id);
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002172}
Robert Olsson19baf832005-06-21 12:43:18 -07002173
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002174
Robert Olsson19baf832005-06-21 12:43:18 -07002175static int fib_triestat_seq_show(struct seq_file *seq, void *v)
2176{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002177 struct net *net = (struct net *)seq->private;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002178 unsigned int h;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002179
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002180 seq_printf(seq,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002181 "Basic info: size of leaf:"
2182 " %Zd bytes, size of tnode: %Zd bytes.\n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002183 sizeof(struct leaf), sizeof(struct tnode));
Olof Johansson91b9a272005-08-09 20:24:39 -07002184
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002185 for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
2186 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2187 struct hlist_node *node;
2188 struct fib_table *tb;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002189
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002190 hlist_for_each_entry_rcu(tb, node, head, tb_hlist) {
2191 struct trie *t = (struct trie *) tb->tb_data;
2192 struct trie_stat stat;
2193
2194 if (!t)
2195 continue;
2196
2197 fib_table_print(seq, tb);
2198
2199 trie_collect_stats(t, &stat);
2200 trie_show_stats(seq, &stat);
2201#ifdef CONFIG_IP_FIB_TRIE_STATS
2202 trie_show_usage(seq, &t->stats);
2203#endif
2204 }
2205 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002206
Robert Olsson19baf832005-06-21 12:43:18 -07002207 return 0;
2208}
2209
Robert Olsson19baf832005-06-21 12:43:18 -07002210static int fib_triestat_seq_open(struct inode *inode, struct file *file)
2211{
Pavel Emelyanovde05c552008-07-18 04:07:21 -07002212 return single_open_net(inode, file, fib_triestat_seq_show);
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002213}
2214
Arjan van de Ven9a321442007-02-12 00:55:35 -08002215static const struct file_operations fib_triestat_fops = {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002216 .owner = THIS_MODULE,
2217 .open = fib_triestat_seq_open,
2218 .read = seq_read,
2219 .llseek = seq_lseek,
Pavel Emelyanovb6fcbdb2008-07-18 04:07:44 -07002220 .release = single_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002221};
2222
David S. Millerb299e4f2011-02-02 20:48:10 -08002223static struct rt_trie_node *fib_trie_get_idx(struct seq_file *seq, loff_t pos)
Robert Olsson19baf832005-06-21 12:43:18 -07002224{
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002225 struct fib_trie_iter *iter = seq->private;
2226 struct net *net = seq_file_net(seq);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002227 loff_t idx = 0;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002228 unsigned int h;
Robert Olsson19baf832005-06-21 12:43:18 -07002229
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002230 for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
2231 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2232 struct hlist_node *node;
2233 struct fib_table *tb;
2234
2235 hlist_for_each_entry_rcu(tb, node, head, tb_hlist) {
David S. Millerb299e4f2011-02-02 20:48:10 -08002236 struct rt_trie_node *n;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002237
2238 for (n = fib_trie_get_first(iter,
2239 (struct trie *) tb->tb_data);
2240 n; n = fib_trie_get_next(iter))
2241 if (pos == idx++) {
2242 iter->tb = tb;
2243 return n;
2244 }
2245 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002246 }
Robert Olsson19baf832005-06-21 12:43:18 -07002247
Robert Olsson19baf832005-06-21 12:43:18 -07002248 return NULL;
2249}
2250
2251static void *fib_trie_seq_start(struct seq_file *seq, loff_t *pos)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002252 __acquires(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002253{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002254 rcu_read_lock();
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002255 return fib_trie_get_idx(seq, *pos);
Robert Olsson19baf832005-06-21 12:43:18 -07002256}
2257
2258static void *fib_trie_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2259{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002260 struct fib_trie_iter *iter = seq->private;
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002261 struct net *net = seq_file_net(seq);
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002262 struct fib_table *tb = iter->tb;
2263 struct hlist_node *tb_node;
2264 unsigned int h;
David S. Millerb299e4f2011-02-02 20:48:10 -08002265 struct rt_trie_node *n;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002266
Robert Olsson19baf832005-06-21 12:43:18 -07002267 ++*pos;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002268 /* next node in same table */
2269 n = fib_trie_get_next(iter);
2270 if (n)
2271 return n;
Olof Johansson91b9a272005-08-09 20:24:39 -07002272
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002273 /* walk rest of this hash chain */
2274 h = tb->tb_id & (FIB_TABLE_HASHSZ - 1);
2275 while ( (tb_node = rcu_dereference(tb->tb_hlist.next)) ) {
2276 tb = hlist_entry(tb_node, struct fib_table, tb_hlist);
2277 n = fib_trie_get_first(iter, (struct trie *) tb->tb_data);
2278 if (n)
2279 goto found;
2280 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002281
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002282 /* new hash chain */
2283 while (++h < FIB_TABLE_HASHSZ) {
2284 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2285 hlist_for_each_entry_rcu(tb, tb_node, head, tb_hlist) {
2286 n = fib_trie_get_first(iter, (struct trie *) tb->tb_data);
2287 if (n)
2288 goto found;
2289 }
2290 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002291 return NULL;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002292
2293found:
2294 iter->tb = tb;
2295 return n;
Robert Olsson19baf832005-06-21 12:43:18 -07002296}
2297
2298static void fib_trie_seq_stop(struct seq_file *seq, void *v)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002299 __releases(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002300{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002301 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002302}
2303
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002304static void seq_indent(struct seq_file *seq, int n)
2305{
Eric Dumazeta034ee32010-09-09 23:32:28 +00002306 while (n-- > 0)
2307 seq_puts(seq, " ");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002308}
Robert Olsson19baf832005-06-21 12:43:18 -07002309
Eric Dumazet28d36e32008-01-14 23:09:56 -08002310static inline const char *rtn_scope(char *buf, size_t len, enum rt_scope_t s)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002311{
Stephen Hemminger132adf52007-03-08 20:44:43 -08002312 switch (s) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002313 case RT_SCOPE_UNIVERSE: return "universe";
2314 case RT_SCOPE_SITE: return "site";
2315 case RT_SCOPE_LINK: return "link";
2316 case RT_SCOPE_HOST: return "host";
2317 case RT_SCOPE_NOWHERE: return "nowhere";
2318 default:
Eric Dumazet28d36e32008-01-14 23:09:56 -08002319 snprintf(buf, len, "scope=%d", s);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002320 return buf;
2321 }
2322}
2323
Jan Engelhardt36cbd3d2009-08-05 10:42:58 -07002324static const char *const rtn_type_names[__RTN_MAX] = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002325 [RTN_UNSPEC] = "UNSPEC",
2326 [RTN_UNICAST] = "UNICAST",
2327 [RTN_LOCAL] = "LOCAL",
2328 [RTN_BROADCAST] = "BROADCAST",
2329 [RTN_ANYCAST] = "ANYCAST",
2330 [RTN_MULTICAST] = "MULTICAST",
2331 [RTN_BLACKHOLE] = "BLACKHOLE",
2332 [RTN_UNREACHABLE] = "UNREACHABLE",
2333 [RTN_PROHIBIT] = "PROHIBIT",
2334 [RTN_THROW] = "THROW",
2335 [RTN_NAT] = "NAT",
2336 [RTN_XRESOLVE] = "XRESOLVE",
2337};
2338
Eric Dumazeta034ee32010-09-09 23:32:28 +00002339static inline const char *rtn_type(char *buf, size_t len, unsigned int t)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002340{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002341 if (t < __RTN_MAX && rtn_type_names[t])
2342 return rtn_type_names[t];
Eric Dumazet28d36e32008-01-14 23:09:56 -08002343 snprintf(buf, len, "type %u", t);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002344 return buf;
2345}
2346
2347/* Pretty print the trie */
Robert Olsson19baf832005-06-21 12:43:18 -07002348static int fib_trie_seq_show(struct seq_file *seq, void *v)
2349{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002350 const struct fib_trie_iter *iter = seq->private;
David S. Millerb299e4f2011-02-02 20:48:10 -08002351 struct rt_trie_node *n = v;
Robert Olsson19baf832005-06-21 12:43:18 -07002352
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002353 if (!node_parent_rcu(n))
2354 fib_table_print(seq, iter->tb);
Robert Olsson095b8502007-01-26 19:06:01 -08002355
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002356 if (IS_TNODE(n)) {
2357 struct tnode *tn = (struct tnode *) n;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07002358 __be32 prf = htonl(mask_pfx(tn->key, tn->pos));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002359
Robert Olsson1d25cd62005-09-19 15:29:52 -07002360 seq_indent(seq, iter->depth-1);
Harvey Harrison673d57e2008-10-31 00:53:57 -07002361 seq_printf(seq, " +-- %pI4/%d %d %d %d\n",
2362 &prf, tn->pos, tn->bits, tn->full_children,
Robert Olsson1d25cd62005-09-19 15:29:52 -07002363 tn->empty_children);
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002364
Olof Johansson91b9a272005-08-09 20:24:39 -07002365 } else {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002366 struct leaf *l = (struct leaf *) n;
Stephen Hemminger13280422008-01-22 21:54:37 -08002367 struct leaf_info *li;
2368 struct hlist_node *node;
Al Viro32ab5f82006-09-26 22:21:45 -07002369 __be32 val = htonl(l->key);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002370
2371 seq_indent(seq, iter->depth);
Harvey Harrison673d57e2008-10-31 00:53:57 -07002372 seq_printf(seq, " |-- %pI4\n", &val);
Eric Dumazet28d36e32008-01-14 23:09:56 -08002373
Stephen Hemminger13280422008-01-22 21:54:37 -08002374 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
2375 struct fib_alias *fa;
Eric Dumazet28d36e32008-01-14 23:09:56 -08002376
Stephen Hemminger13280422008-01-22 21:54:37 -08002377 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
2378 char buf1[32], buf2[32];
Eric Dumazet28d36e32008-01-14 23:09:56 -08002379
Stephen Hemminger13280422008-01-22 21:54:37 -08002380 seq_indent(seq, iter->depth+1);
2381 seq_printf(seq, " /%d %s %s", li->plen,
2382 rtn_scope(buf1, sizeof(buf1),
David S. Miller37e826c2011-03-24 18:06:47 -07002383 fa->fa_info->fib_scope),
Stephen Hemminger13280422008-01-22 21:54:37 -08002384 rtn_type(buf2, sizeof(buf2),
2385 fa->fa_type));
2386 if (fa->fa_tos)
Denis V. Lunevb9c4d822008-02-05 02:58:45 -08002387 seq_printf(seq, " tos=%d", fa->fa_tos);
Stephen Hemminger13280422008-01-22 21:54:37 -08002388 seq_putc(seq, '\n');
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002389 }
2390 }
Robert Olsson19baf832005-06-21 12:43:18 -07002391 }
2392
2393 return 0;
2394}
2395
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002396static const struct seq_operations fib_trie_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002397 .start = fib_trie_seq_start,
2398 .next = fib_trie_seq_next,
2399 .stop = fib_trie_seq_stop,
2400 .show = fib_trie_seq_show,
Robert Olsson19baf832005-06-21 12:43:18 -07002401};
2402
2403static int fib_trie_seq_open(struct inode *inode, struct file *file)
2404{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002405 return seq_open_net(inode, file, &fib_trie_seq_ops,
2406 sizeof(struct fib_trie_iter));
Robert Olsson19baf832005-06-21 12:43:18 -07002407}
2408
Arjan van de Ven9a321442007-02-12 00:55:35 -08002409static const struct file_operations fib_trie_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002410 .owner = THIS_MODULE,
2411 .open = fib_trie_seq_open,
2412 .read = seq_read,
2413 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002414 .release = seq_release_net,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002415};
2416
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002417struct fib_route_iter {
2418 struct seq_net_private p;
2419 struct trie *main_trie;
2420 loff_t pos;
2421 t_key key;
2422};
2423
2424static struct leaf *fib_route_get_idx(struct fib_route_iter *iter, loff_t pos)
2425{
2426 struct leaf *l = NULL;
2427 struct trie *t = iter->main_trie;
2428
2429 /* use cache location of last found key */
2430 if (iter->pos > 0 && pos >= iter->pos && (l = fib_find_node(t, iter->key)))
2431 pos -= iter->pos;
2432 else {
2433 iter->pos = 0;
2434 l = trie_firstleaf(t);
2435 }
2436
2437 while (l && pos-- > 0) {
2438 iter->pos++;
2439 l = trie_nextleaf(l);
2440 }
2441
2442 if (l)
2443 iter->key = pos; /* remember it */
2444 else
2445 iter->pos = 0; /* forget it */
2446
2447 return l;
2448}
2449
2450static void *fib_route_seq_start(struct seq_file *seq, loff_t *pos)
2451 __acquires(RCU)
2452{
2453 struct fib_route_iter *iter = seq->private;
2454 struct fib_table *tb;
2455
2456 rcu_read_lock();
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002457 tb = fib_get_table(seq_file_net(seq), RT_TABLE_MAIN);
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002458 if (!tb)
2459 return NULL;
2460
2461 iter->main_trie = (struct trie *) tb->tb_data;
2462 if (*pos == 0)
2463 return SEQ_START_TOKEN;
2464 else
2465 return fib_route_get_idx(iter, *pos - 1);
2466}
2467
2468static void *fib_route_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2469{
2470 struct fib_route_iter *iter = seq->private;
2471 struct leaf *l = v;
2472
2473 ++*pos;
2474 if (v == SEQ_START_TOKEN) {
2475 iter->pos = 0;
2476 l = trie_firstleaf(iter->main_trie);
2477 } else {
2478 iter->pos++;
2479 l = trie_nextleaf(l);
2480 }
2481
2482 if (l)
2483 iter->key = l->key;
2484 else
2485 iter->pos = 0;
2486 return l;
2487}
2488
2489static void fib_route_seq_stop(struct seq_file *seq, void *v)
2490 __releases(RCU)
2491{
2492 rcu_read_unlock();
2493}
2494
Eric Dumazeta034ee32010-09-09 23:32:28 +00002495static unsigned int fib_flag_trans(int type, __be32 mask, const struct fib_info *fi)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002496{
Eric Dumazeta034ee32010-09-09 23:32:28 +00002497 unsigned int flags = 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002498
Eric Dumazeta034ee32010-09-09 23:32:28 +00002499 if (type == RTN_UNREACHABLE || type == RTN_PROHIBIT)
2500 flags = RTF_REJECT;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002501 if (fi && fi->fib_nh->nh_gw)
2502 flags |= RTF_GATEWAY;
Al Viro32ab5f82006-09-26 22:21:45 -07002503 if (mask == htonl(0xFFFFFFFF))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002504 flags |= RTF_HOST;
2505 flags |= RTF_UP;
2506 return flags;
2507}
2508
2509/*
2510 * This outputs /proc/net/route.
2511 * The format of the file is not supposed to be changed
Eric Dumazeta034ee32010-09-09 23:32:28 +00002512 * and needs to be same as fib_hash output to avoid breaking
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002513 * legacy utilities
2514 */
2515static int fib_route_seq_show(struct seq_file *seq, void *v)
2516{
2517 struct leaf *l = v;
Stephen Hemminger13280422008-01-22 21:54:37 -08002518 struct leaf_info *li;
2519 struct hlist_node *node;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002520
2521 if (v == SEQ_START_TOKEN) {
2522 seq_printf(seq, "%-127s\n", "Iface\tDestination\tGateway "
2523 "\tFlags\tRefCnt\tUse\tMetric\tMask\t\tMTU"
2524 "\tWindow\tIRTT");
2525 return 0;
2526 }
2527
Stephen Hemminger13280422008-01-22 21:54:37 -08002528 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002529 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07002530 __be32 mask, prefix;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002531
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002532 mask = inet_make_mask(li->plen);
2533 prefix = htonl(l->key);
2534
2535 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
Herbert Xu1371e372005-10-15 09:42:39 +10002536 const struct fib_info *fi = fa->fa_info;
Eric Dumazeta034ee32010-09-09 23:32:28 +00002537 unsigned int flags = fib_flag_trans(fa->fa_type, mask, fi);
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002538 int len;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002539
2540 if (fa->fa_type == RTN_BROADCAST
2541 || fa->fa_type == RTN_MULTICAST)
2542 continue;
2543
2544 if (fi)
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002545 seq_printf(seq,
2546 "%s\t%08X\t%08X\t%04X\t%d\t%u\t"
2547 "%d\t%08X\t%d\t%u\t%u%n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002548 fi->fib_dev ? fi->fib_dev->name : "*",
2549 prefix,
2550 fi->fib_nh->nh_gw, flags, 0, 0,
2551 fi->fib_priority,
2552 mask,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002553 (fi->fib_advmss ?
2554 fi->fib_advmss + 40 : 0),
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002555 fi->fib_window,
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002556 fi->fib_rtt >> 3, &len);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002557 else
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002558 seq_printf(seq,
2559 "*\t%08X\t%08X\t%04X\t%d\t%u\t"
2560 "%d\t%08X\t%d\t%u\t%u%n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002561 prefix, 0, flags, 0, 0, 0,
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002562 mask, 0, 0, 0, &len);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002563
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002564 seq_printf(seq, "%*s\n", 127 - len, "");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002565 }
2566 }
2567
2568 return 0;
2569}
2570
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002571static const struct seq_operations fib_route_seq_ops = {
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002572 .start = fib_route_seq_start,
2573 .next = fib_route_seq_next,
2574 .stop = fib_route_seq_stop,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002575 .show = fib_route_seq_show,
2576};
2577
2578static int fib_route_seq_open(struct inode *inode, struct file *file)
2579{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002580 return seq_open_net(inode, file, &fib_route_seq_ops,
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002581 sizeof(struct fib_route_iter));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002582}
2583
Arjan van de Ven9a321442007-02-12 00:55:35 -08002584static const struct file_operations fib_route_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002585 .owner = THIS_MODULE,
2586 .open = fib_route_seq_open,
2587 .read = seq_read,
2588 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002589 .release = seq_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002590};
2591
Denis V. Lunev61a02652008-01-10 03:21:09 -08002592int __net_init fib_proc_init(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002593{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002594 if (!proc_net_fops_create(net, "fib_trie", S_IRUGO, &fib_trie_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002595 goto out1;
2596
Denis V. Lunev61a02652008-01-10 03:21:09 -08002597 if (!proc_net_fops_create(net, "fib_triestat", S_IRUGO,
2598 &fib_triestat_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002599 goto out2;
2600
Denis V. Lunev61a02652008-01-10 03:21:09 -08002601 if (!proc_net_fops_create(net, "route", S_IRUGO, &fib_route_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002602 goto out3;
2603
Robert Olsson19baf832005-06-21 12:43:18 -07002604 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002605
2606out3:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002607 proc_net_remove(net, "fib_triestat");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002608out2:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002609 proc_net_remove(net, "fib_trie");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002610out1:
2611 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002612}
2613
Denis V. Lunev61a02652008-01-10 03:21:09 -08002614void __net_exit fib_proc_exit(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002615{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002616 proc_net_remove(net, "fib_trie");
2617 proc_net_remove(net, "fib_triestat");
2618 proc_net_remove(net, "route");
Robert Olsson19baf832005-06-21 12:43:18 -07002619}
2620
2621#endif /* CONFIG_PROC_FS */