blob: 59a838795e3e6cf93ba919676ae68804c8b8a00a [file] [log] [blame]
Robert Olsson19baf832005-06-21 12:43:18 -07001/*
2 * This program is free software; you can redistribute it and/or
3 * modify it under the terms of the GNU General Public License
4 * as published by the Free Software Foundation; either version
5 * 2 of the License, or (at your option) any later version.
6 *
7 * Robert Olsson <robert.olsson@its.uu.se> Uppsala Universitet
8 * & Swedish University of Agricultural Sciences.
9 *
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090010 * Jens Laas <jens.laas@data.slu.se> Swedish University of
Robert Olsson19baf832005-06-21 12:43:18 -070011 * Agricultural Sciences.
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090012 *
Robert Olsson19baf832005-06-21 12:43:18 -070013 * Hans Liss <hans.liss@its.uu.se> Uppsala Universitet
14 *
15 * This work is based on the LPC-trie which is originally descibed in:
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090016 *
Robert Olsson19baf832005-06-21 12:43:18 -070017 * An experimental study of compression methods for dynamic tries
18 * Stefan Nilsson and Matti Tikkanen. Algorithmica, 33(1):19-33, 2002.
19 * http://www.nada.kth.se/~snilsson/public/papers/dyntrie2/
20 *
21 *
22 * IP-address lookup using LC-tries. Stefan Nilsson and Gunnar Karlsson
23 * IEEE Journal on Selected Areas in Communications, 17(6):1083-1092, June 1999
24 *
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
98struct 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 };
Olof Johansson91b9a272005-08-09 20:24:39 -0700129 struct node *child[0];
Robert Olsson19baf832005-06-21 12:43:18 -0700130};
131
132#ifdef CONFIG_IP_FIB_TRIE_STATS
133struct trie_use_stats {
134 unsigned int gets;
135 unsigned int backtrack;
136 unsigned int semantic_match_passed;
137 unsigned int semantic_match_miss;
138 unsigned int null_node_hit;
Robert Olsson2f368952005-07-05 15:02:40 -0700139 unsigned int resize_node_skipped;
Robert Olsson19baf832005-06-21 12:43:18 -0700140};
141#endif
142
143struct trie_stat {
144 unsigned int totdepth;
145 unsigned int maxdepth;
146 unsigned int tnodes;
147 unsigned int leaves;
148 unsigned int nullpointers;
Stephen Hemminger93672292008-01-22 21:54:05 -0800149 unsigned int prefixes;
Robert Olsson06ef9212006-03-20 21:35:01 -0800150 unsigned int nodesizes[MAX_STAT_DEPTH];
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700151};
Robert Olsson19baf832005-06-21 12:43:18 -0700152
153struct trie {
Olof Johansson91b9a272005-08-09 20:24:39 -0700154 struct node *trie;
Robert Olsson19baf832005-06-21 12:43:18 -0700155#ifdef CONFIG_IP_FIB_TRIE_STATS
156 struct trie_use_stats stats;
157#endif
Robert Olsson19baf832005-06-21 12:43:18 -0700158};
159
Robert Olsson19baf832005-06-21 12:43:18 -0700160static void put_child(struct trie *t, struct tnode *tn, int i, struct node *n);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800161static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n,
162 int wasfull);
Robert Olsson19baf832005-06-21 12:43:18 -0700163static struct node *resize(struct trie *t, struct tnode *tn);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700164static struct tnode *inflate(struct trie *t, struct tnode *tn);
165static struct tnode *halve(struct trie *t, struct tnode *tn);
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
Stephen Hemminger06801912007-08-10 15:22:13 -0700180static inline struct tnode *node_parent(struct node *node)
181{
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
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800185static inline struct tnode *node_parent_rcu(struct node *node)
186{
187 struct tnode *ret = node_parent(node);
188
Stephen Hemminger06801912007-08-10 15:22:13 -0700189 return rcu_dereference(ret);
190}
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 */
Stephen Hemminger06801912007-08-10 15:22:13 -0700195static inline void node_set_parent(struct node *node, struct tnode *ptr)
196{
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
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800201static inline struct 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
208static inline struct node *tnode_get_child_rcu(struct tnode *tn, unsigned int i)
209{
210 struct node *ret = tnode_get_child(tn, i);
211
212 return rcu_dereference(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
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700220static inline t_key mask_pfx(t_key k, unsigned short l)
221{
222 return (l == 0) ? 0 : k >> (KEYLENGTH-l) << (KEYLENGTH-l);
223}
224
Robert Olsson19baf832005-06-21 12:43:18 -0700225static inline t_key tkey_extract_bits(t_key a, int offset, int bits)
226{
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
368 return __vmalloc(size, GFP_KERNEL | __GFP_ZERO, PAGE_KERNEL);
369}
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) +
381 (sizeof(struct 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) +
405 (sizeof(struct 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{
Eric Dumazet8d965442008-01-13 22:31:44 -0800446 size_t sz = sizeof(struct tnode) + (sizeof(struct 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 Dumazet8d965442008-01-13 22:31:44 -0800458 pr_debug("AT %p s=%u %lu\n", tn, (unsigned int) sizeof(struct tnode),
459 (unsigned long) (sizeof(struct 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
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700468static inline int tnode_full(const struct tnode *tn, const struct 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,
477 struct 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
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800487static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n,
488 int wasfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700489{
Robert Olsson2373ce12005-08-25 13:01:29 -0700490 struct 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
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700518static struct 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
Jens Låås80b71b82009-08-28 23:57:15 -0700608 if (!node_parent((struct node*) tn)) {
609 inflate_threshold_use = inflate_threshold_root;
610 halve_threshold_use = halve_threshold_root;
611 }
612 else {
Robert Olssone6308be2005-10-04 13:01:58 -0700613 inflate_threshold_use = inflate_threshold;
Jens Låås80b71b82009-08-28 23:57:15 -0700614 halve_threshold_use = halve_threshold;
615 }
Robert Olssone6308be2005-10-04 13:01:58 -0700616
Jens Låås80b71b82009-08-28 23:57:15 -0700617 max_work = MAX_WORK;
618 while ((tn->full_children > 0 && max_work-- &&
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800619 50 * (tn->full_children + tnode_child_length(tn)
620 - tn->empty_children)
621 >= inflate_threshold_use * tnode_child_length(tn))) {
Robert Olsson19baf832005-06-21 12:43:18 -0700622
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700623 old_tn = tn;
624 tn = inflate(t, tn);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800625
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700626 if (IS_ERR(tn)) {
627 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700628#ifdef CONFIG_IP_FIB_TRIE_STATS
629 t->stats.resize_node_skipped++;
630#endif
631 break;
632 }
Robert Olsson19baf832005-06-21 12:43:18 -0700633 }
634
635 check_tnode(tn);
636
Jens Låås80b71b82009-08-28 23:57:15 -0700637 /* Return if at least one inflate is run */
638 if( max_work != MAX_WORK)
639 return (struct node *) tn;
640
Robert Olsson19baf832005-06-21 12:43:18 -0700641 /*
642 * Halve as long as the number of empty children in this
643 * node is above threshold.
644 */
Robert Olsson2f368952005-07-05 15:02:40 -0700645
Jens Låås80b71b82009-08-28 23:57:15 -0700646 max_work = MAX_WORK;
647 while (tn->bits > 1 && max_work-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700648 100 * (tnode_child_length(tn) - tn->empty_children) <
Robert Olssone6308be2005-10-04 13:01:58 -0700649 halve_threshold_use * tnode_child_length(tn)) {
Robert Olsson19baf832005-06-21 12:43:18 -0700650
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700651 old_tn = tn;
652 tn = halve(t, tn);
653 if (IS_ERR(tn)) {
654 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700655#ifdef CONFIG_IP_FIB_TRIE_STATS
656 t->stats.resize_node_skipped++;
657#endif
658 break;
659 }
660 }
661
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700662
Robert Olsson19baf832005-06-21 12:43:18 -0700663 /* Only one child remains */
Jens Låås80b71b82009-08-28 23:57:15 -0700664 if (tn->empty_children == tnode_child_length(tn) - 1) {
665one_child:
Robert Olsson19baf832005-06-21 12:43:18 -0700666 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700667 struct node *n;
668
Olof Johansson91b9a272005-08-09 20:24:39 -0700669 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700670 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700671 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700672
673 /* compress one level */
674
Stephen Hemminger06801912007-08-10 15:22:13 -0700675 node_set_parent(n, NULL);
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700676 tnode_free_safe(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700677 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700678 }
Jens Låås80b71b82009-08-28 23:57:15 -0700679 }
Robert Olsson19baf832005-06-21 12:43:18 -0700680 return (struct node *) tn;
681}
682
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700683static struct tnode *inflate(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700684{
Robert Olsson19baf832005-06-21 12:43:18 -0700685 struct tnode *oldtnode = tn;
686 int olen = tnode_child_length(tn);
687 int i;
688
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700689 pr_debug("In inflate\n");
Robert Olsson19baf832005-06-21 12:43:18 -0700690
691 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits + 1);
692
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700693 if (!tn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700694 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700695
696 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700697 * Preallocate and store tnodes before the actual work so we
698 * don't get into an inconsistent state if memory allocation
699 * fails. In case of failure we return the oldnode and inflate
Robert Olsson2f368952005-07-05 15:02:40 -0700700 * of tnode is ignored.
701 */
Olof Johansson91b9a272005-08-09 20:24:39 -0700702
703 for (i = 0; i < olen; i++) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800704 struct tnode *inode;
Robert Olsson2f368952005-07-05 15:02:40 -0700705
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800706 inode = (struct tnode *) tnode_get_child(oldtnode, i);
Robert Olsson2f368952005-07-05 15:02:40 -0700707 if (inode &&
708 IS_TNODE(inode) &&
709 inode->pos == oldtnode->pos + oldtnode->bits &&
710 inode->bits > 1) {
711 struct tnode *left, *right;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700712 t_key m = ~0U << (KEYLENGTH - 1) >> inode->pos;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700713
Robert Olsson2f368952005-07-05 15:02:40 -0700714 left = tnode_new(inode->key&(~m), inode->pos + 1,
715 inode->bits - 1);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700716 if (!left)
717 goto nomem;
Olof Johansson91b9a272005-08-09 20:24:39 -0700718
Robert Olsson2f368952005-07-05 15:02:40 -0700719 right = tnode_new(inode->key|m, inode->pos + 1,
720 inode->bits - 1);
721
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900722 if (!right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700723 tnode_free(left);
724 goto nomem;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900725 }
Robert Olsson2f368952005-07-05 15:02:40 -0700726
727 put_child(t, tn, 2*i, (struct node *) left);
728 put_child(t, tn, 2*i+1, (struct node *) right);
729 }
730 }
731
Olof Johansson91b9a272005-08-09 20:24:39 -0700732 for (i = 0; i < olen; i++) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -0800733 struct tnode *inode;
Robert Olsson19baf832005-06-21 12:43:18 -0700734 struct node *node = tnode_get_child(oldtnode, i);
Olof Johansson91b9a272005-08-09 20:24:39 -0700735 struct tnode *left, *right;
736 int size, j;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700737
Robert Olsson19baf832005-06-21 12:43:18 -0700738 /* An empty child */
739 if (node == NULL)
740 continue;
741
742 /* A leaf or an internal node with skipped bits */
743
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700744 if (IS_LEAF(node) || ((struct tnode *) node)->pos >
Robert Olsson19baf832005-06-21 12:43:18 -0700745 tn->pos + tn->bits - 1) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800746 if (tkey_extract_bits(node->key,
747 oldtnode->pos + oldtnode->bits,
748 1) == 0)
Robert Olsson19baf832005-06-21 12:43:18 -0700749 put_child(t, tn, 2*i, node);
750 else
751 put_child(t, tn, 2*i+1, node);
752 continue;
753 }
754
755 /* An internal node with two children */
756 inode = (struct tnode *) node;
757
758 if (inode->bits == 1) {
759 put_child(t, tn, 2*i, inode->child[0]);
760 put_child(t, tn, 2*i+1, inode->child[1]);
761
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700762 tnode_free_safe(inode);
Olof Johansson91b9a272005-08-09 20:24:39 -0700763 continue;
Robert Olsson19baf832005-06-21 12:43:18 -0700764 }
765
Olof Johansson91b9a272005-08-09 20:24:39 -0700766 /* An internal node with more than two children */
Robert Olsson19baf832005-06-21 12:43:18 -0700767
Olof Johansson91b9a272005-08-09 20:24:39 -0700768 /* We will replace this node 'inode' with two new
769 * ones, 'left' and 'right', each with half of the
770 * original children. The two new nodes will have
771 * a position one bit further down the key and this
772 * means that the "significant" part of their keys
773 * (see the discussion near the top of this file)
774 * will differ by one bit, which will be "0" in
775 * left's key and "1" in right's key. Since we are
776 * moving the key position by one step, the bit that
777 * we are moving away from - the bit at position
778 * (inode->pos) - is the one that will differ between
779 * left and right. So... we synthesize that bit in the
780 * two new keys.
781 * The mask 'm' below will be a single "one" bit at
782 * the position (inode->pos)
783 */
Robert Olsson19baf832005-06-21 12:43:18 -0700784
Olof Johansson91b9a272005-08-09 20:24:39 -0700785 /* Use the old key, but set the new significant
786 * bit to zero.
787 */
Robert Olsson19baf832005-06-21 12:43:18 -0700788
Olof Johansson91b9a272005-08-09 20:24:39 -0700789 left = (struct tnode *) tnode_get_child(tn, 2*i);
790 put_child(t, tn, 2*i, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -0700791
Olof Johansson91b9a272005-08-09 20:24:39 -0700792 BUG_ON(!left);
Robert Olsson2f368952005-07-05 15:02:40 -0700793
Olof Johansson91b9a272005-08-09 20:24:39 -0700794 right = (struct tnode *) tnode_get_child(tn, 2*i+1);
795 put_child(t, tn, 2*i+1, NULL);
Robert Olsson2f368952005-07-05 15:02:40 -0700796
Olof Johansson91b9a272005-08-09 20:24:39 -0700797 BUG_ON(!right);
Robert Olsson2f368952005-07-05 15:02:40 -0700798
Olof Johansson91b9a272005-08-09 20:24:39 -0700799 size = tnode_child_length(left);
800 for (j = 0; j < size; j++) {
801 put_child(t, left, j, inode->child[j]);
802 put_child(t, right, j, inode->child[j + size]);
Robert Olsson19baf832005-06-21 12:43:18 -0700803 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700804 put_child(t, tn, 2*i, resize(t, left));
805 put_child(t, tn, 2*i+1, resize(t, right));
806
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700807 tnode_free_safe(inode);
Robert Olsson19baf832005-06-21 12:43:18 -0700808 }
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700809 tnode_free_safe(oldtnode);
Robert Olsson19baf832005-06-21 12:43:18 -0700810 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700811nomem:
812 {
813 int size = tnode_child_length(tn);
814 int j;
815
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700816 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700817 if (tn->child[j])
818 tnode_free((struct tnode *)tn->child[j]);
819
820 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700821
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700822 return ERR_PTR(-ENOMEM);
823 }
Robert Olsson19baf832005-06-21 12:43:18 -0700824}
825
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700826static struct tnode *halve(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700827{
828 struct tnode *oldtnode = tn;
829 struct node *left, *right;
830 int i;
831 int olen = tnode_child_length(tn);
832
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700833 pr_debug("In halve\n");
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700834
835 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits - 1);
Robert Olsson19baf832005-06-21 12:43:18 -0700836
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700837 if (!tn)
838 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700839
840 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700841 * Preallocate and store tnodes before the actual work so we
842 * don't get into an inconsistent state if memory allocation
843 * fails. In case of failure we return the oldnode and halve
Robert Olsson2f368952005-07-05 15:02:40 -0700844 * of tnode is ignored.
845 */
846
Olof Johansson91b9a272005-08-09 20:24:39 -0700847 for (i = 0; i < olen; i += 2) {
Robert Olsson2f368952005-07-05 15:02:40 -0700848 left = tnode_get_child(oldtnode, i);
849 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700850
Robert Olsson2f368952005-07-05 15:02:40 -0700851 /* Two nonempty children */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700852 if (left && right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700853 struct tnode *newn;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700854
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700855 newn = tnode_new(left->key, tn->pos + tn->bits, 1);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700856
857 if (!newn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700858 goto nomem;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700859
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700860 put_child(t, tn, i/2, (struct node *)newn);
Robert Olsson2f368952005-07-05 15:02:40 -0700861 }
Robert Olsson2f368952005-07-05 15:02:40 -0700862
Robert Olsson2f368952005-07-05 15:02:40 -0700863 }
Robert Olsson19baf832005-06-21 12:43:18 -0700864
Olof Johansson91b9a272005-08-09 20:24:39 -0700865 for (i = 0; i < olen; i += 2) {
866 struct tnode *newBinNode;
867
Robert Olsson19baf832005-06-21 12:43:18 -0700868 left = tnode_get_child(oldtnode, i);
869 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700870
Robert Olsson19baf832005-06-21 12:43:18 -0700871 /* At least one of the children is empty */
872 if (left == NULL) {
873 if (right == NULL) /* Both are empty */
874 continue;
875 put_child(t, tn, i/2, right);
Olof Johansson91b9a272005-08-09 20:24:39 -0700876 continue;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700877 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700878
879 if (right == NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700880 put_child(t, tn, i/2, left);
Olof Johansson91b9a272005-08-09 20:24:39 -0700881 continue;
882 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700883
Robert Olsson19baf832005-06-21 12:43:18 -0700884 /* Two nonempty children */
Olof Johansson91b9a272005-08-09 20:24:39 -0700885 newBinNode = (struct tnode *) tnode_get_child(tn, i/2);
886 put_child(t, tn, i/2, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700887 put_child(t, newBinNode, 0, left);
888 put_child(t, newBinNode, 1, right);
889 put_child(t, tn, i/2, resize(t, newBinNode));
Robert Olsson19baf832005-06-21 12:43:18 -0700890 }
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -0700891 tnode_free_safe(oldtnode);
Robert Olsson19baf832005-06-21 12:43:18 -0700892 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700893nomem:
894 {
895 int size = tnode_child_length(tn);
896 int j;
897
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700898 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700899 if (tn->child[j])
900 tnode_free((struct tnode *)tn->child[j]);
901
902 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700903
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700904 return ERR_PTR(-ENOMEM);
905 }
Robert Olsson19baf832005-06-21 12:43:18 -0700906}
907
Robert Olsson772cb712005-09-19 15:31:18 -0700908/* readside must use rcu_read_lock currently dump routines
Robert Olsson2373ce12005-08-25 13:01:29 -0700909 via get_fa_head and dump */
910
Robert Olsson772cb712005-09-19 15:31:18 -0700911static struct leaf_info *find_leaf_info(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700912{
Robert Olsson772cb712005-09-19 15:31:18 -0700913 struct hlist_head *head = &l->list;
Robert Olsson19baf832005-06-21 12:43:18 -0700914 struct hlist_node *node;
915 struct leaf_info *li;
916
Robert Olsson2373ce12005-08-25 13:01:29 -0700917 hlist_for_each_entry_rcu(li, node, head, hlist)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700918 if (li->plen == plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700919 return li;
Olof Johansson91b9a272005-08-09 20:24:39 -0700920
Robert Olsson19baf832005-06-21 12:43:18 -0700921 return NULL;
922}
923
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800924static inline struct list_head *get_fa_head(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700925{
Robert Olsson772cb712005-09-19 15:31:18 -0700926 struct leaf_info *li = find_leaf_info(l, plen);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700927
Olof Johansson91b9a272005-08-09 20:24:39 -0700928 if (!li)
929 return NULL;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700930
Olof Johansson91b9a272005-08-09 20:24:39 -0700931 return &li->falh;
Robert Olsson19baf832005-06-21 12:43:18 -0700932}
933
934static void insert_leaf_info(struct hlist_head *head, struct leaf_info *new)
935{
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900936 struct leaf_info *li = NULL, *last = NULL;
937 struct hlist_node *node;
Robert Olsson19baf832005-06-21 12:43:18 -0700938
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900939 if (hlist_empty(head)) {
940 hlist_add_head_rcu(&new->hlist, head);
941 } else {
942 hlist_for_each_entry(li, node, head, hlist) {
943 if (new->plen > li->plen)
944 break;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700945
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900946 last = li;
947 }
948 if (last)
949 hlist_add_after_rcu(&last->hlist, &new->hlist);
950 else
951 hlist_add_before_rcu(&new->hlist, &li->hlist);
952 }
Robert Olsson19baf832005-06-21 12:43:18 -0700953}
954
Robert Olsson2373ce12005-08-25 13:01:29 -0700955/* rcu_read_lock needs to be hold by caller from readside */
956
Robert Olsson19baf832005-06-21 12:43:18 -0700957static struct leaf *
958fib_find_node(struct trie *t, u32 key)
959{
960 int pos;
961 struct tnode *tn;
962 struct node *n;
963
964 pos = 0;
Paul E. McKenney634a4b22010-03-21 18:01:05 -0700965 n = rcu_dereference_check(t->trie,
966 rcu_read_lock_held() ||
967 lockdep_rtnl_is_held());
Robert Olsson19baf832005-06-21 12:43:18 -0700968
969 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
970 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -0700971
Robert Olsson19baf832005-06-21 12:43:18 -0700972 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700973
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700974 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700975 pos = tn->pos + tn->bits;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800976 n = tnode_get_child_rcu(tn,
977 tkey_extract_bits(key,
978 tn->pos,
979 tn->bits));
Olof Johansson91b9a272005-08-09 20:24:39 -0700980 } else
Robert Olsson19baf832005-06-21 12:43:18 -0700981 break;
982 }
983 /* Case we have found a leaf. Compare prefixes */
984
Olof Johansson91b9a272005-08-09 20:24:39 -0700985 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key))
986 return (struct leaf *)n;
987
Robert Olsson19baf832005-06-21 12:43:18 -0700988 return NULL;
989}
990
Jarek Poplawski7b855762009-06-18 00:28:51 -0700991static void trie_rebalance(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700992{
Robert Olsson19baf832005-06-21 12:43:18 -0700993 int wasfull;
Robert Olsson3ed18d72009-05-21 15:20:59 -0700994 t_key cindex, key;
Stephen Hemminger06801912007-08-10 15:22:13 -0700995 struct tnode *tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700996
Robert Olsson3ed18d72009-05-21 15:20:59 -0700997 key = tn->key;
998
Stephen Hemminger06801912007-08-10 15:22:13 -0700999 while (tn != NULL && (tp = node_parent((struct node *)tn)) != NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -07001000 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1001 wasfull = tnode_full(tp, tnode_get_child(tp, cindex));
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001002 tn = (struct tnode *) resize(t, (struct tnode *)tn);
1003
1004 tnode_put_child_reorg((struct tnode *)tp, cindex,
1005 (struct node *)tn, wasfull);
Olof Johansson91b9a272005-08-09 20:24:39 -07001006
Stephen Hemminger06801912007-08-10 15:22:13 -07001007 tp = node_parent((struct node *) tn);
Jarek Poplawski008440e2009-06-30 12:47:19 -07001008 if (!tp)
1009 rcu_assign_pointer(t->trie, (struct node *)tn);
1010
Jarek Poplawskie0f7cb82009-06-15 02:31:29 -07001011 tnode_free_flush();
Stephen Hemminger06801912007-08-10 15:22:13 -07001012 if (!tp)
Robert Olsson19baf832005-06-21 12:43:18 -07001013 break;
Stephen Hemminger06801912007-08-10 15:22:13 -07001014 tn = tp;
Robert Olsson19baf832005-06-21 12:43:18 -07001015 }
Stephen Hemminger06801912007-08-10 15:22:13 -07001016
Robert Olsson19baf832005-06-21 12:43:18 -07001017 /* Handle last (top) tnode */
Jarek Poplawski7b855762009-06-18 00:28:51 -07001018 if (IS_TNODE(tn))
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001019 tn = (struct tnode *)resize(t, (struct tnode *)tn);
Robert Olsson19baf832005-06-21 12:43:18 -07001020
Jarek Poplawski7b855762009-06-18 00:28:51 -07001021 rcu_assign_pointer(t->trie, (struct node *)tn);
1022 tnode_free_flush();
1023
1024 return;
Robert Olsson19baf832005-06-21 12:43:18 -07001025}
1026
Robert Olsson2373ce12005-08-25 13:01:29 -07001027/* only used from updater-side */
1028
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001029static struct list_head *fib_insert_node(struct trie *t, u32 key, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -07001030{
1031 int pos, newpos;
1032 struct tnode *tp = NULL, *tn = NULL;
1033 struct node *n;
1034 struct leaf *l;
1035 int missbit;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001036 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001037 struct leaf_info *li;
1038 t_key cindex;
1039
1040 pos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001041 n = t->trie;
Robert Olsson19baf832005-06-21 12:43:18 -07001042
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001043 /* If we point to NULL, stop. Either the tree is empty and we should
1044 * just put a new leaf in if, or we have reached an empty child slot,
Robert Olsson19baf832005-06-21 12:43:18 -07001045 * and we should just put our new leaf in that.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001046 * If we point to a T_TNODE, check if it matches our key. Note that
1047 * a T_TNODE might be skipping any number of bits - its 'pos' need
Robert Olsson19baf832005-06-21 12:43:18 -07001048 * not be the parent's 'pos'+'bits'!
1049 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001050 * If it does match the current key, get pos/bits from it, extract
Robert Olsson19baf832005-06-21 12:43:18 -07001051 * the index from our key, push the T_TNODE and walk the tree.
1052 *
1053 * If it doesn't, we have to replace it with a new T_TNODE.
1054 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001055 * If we point to a T_LEAF, it might or might not have the same key
1056 * as we do. If it does, just change the value, update the T_LEAF's
1057 * value, and return it.
Robert Olsson19baf832005-06-21 12:43:18 -07001058 * If it doesn't, we need to replace it with a T_TNODE.
1059 */
1060
1061 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
1062 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -07001063
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001064 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001065
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001066 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001067 tp = tn;
Olof Johansson91b9a272005-08-09 20:24:39 -07001068 pos = tn->pos + tn->bits;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001069 n = tnode_get_child(tn,
1070 tkey_extract_bits(key,
1071 tn->pos,
1072 tn->bits));
Robert Olsson19baf832005-06-21 12:43:18 -07001073
Stephen Hemminger06801912007-08-10 15:22:13 -07001074 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001075 } else
Robert Olsson19baf832005-06-21 12:43:18 -07001076 break;
1077 }
1078
1079 /*
1080 * n ----> NULL, LEAF or TNODE
1081 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001082 * tp is n's (parent) ----> NULL or TNODE
Robert Olsson19baf832005-06-21 12:43:18 -07001083 */
1084
Olof Johansson91b9a272005-08-09 20:24:39 -07001085 BUG_ON(tp && IS_LEAF(tp));
Robert Olsson19baf832005-06-21 12:43:18 -07001086
1087 /* Case 1: n is a leaf. Compare prefixes */
1088
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001089 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key)) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08001090 l = (struct leaf *) n;
Robert Olsson19baf832005-06-21 12:43:18 -07001091 li = leaf_info_new(plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001092
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001093 if (!li)
1094 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001095
1096 fa_head = &li->falh;
1097 insert_leaf_info(&l->list, li);
1098 goto done;
1099 }
Robert Olsson19baf832005-06-21 12:43:18 -07001100 l = leaf_new();
1101
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001102 if (!l)
1103 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001104
1105 l->key = key;
1106 li = leaf_info_new(plen);
1107
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001108 if (!li) {
Stephen Hemminger387a5482008-04-10 03:47:34 -07001109 free_leaf(l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001110 return NULL;
Robert Olssonf835e472005-06-28 15:00:39 -07001111 }
Robert Olsson19baf832005-06-21 12:43:18 -07001112
1113 fa_head = &li->falh;
1114 insert_leaf_info(&l->list, li);
1115
Robert Olsson19baf832005-06-21 12:43:18 -07001116 if (t->trie && n == NULL) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001117 /* Case 2: n is NULL, and will just insert a new leaf */
Robert Olsson19baf832005-06-21 12:43:18 -07001118
Stephen Hemminger06801912007-08-10 15:22:13 -07001119 node_set_parent((struct node *)l, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001120
Olof Johansson91b9a272005-08-09 20:24:39 -07001121 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1122 put_child(t, (struct tnode *)tp, cindex, (struct node *)l);
1123 } else {
1124 /* Case 3: n is a LEAF or a TNODE and the key doesn't match. */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001125 /*
1126 * Add a new tnode here
Robert Olsson19baf832005-06-21 12:43:18 -07001127 * first tnode need some special handling
1128 */
1129
1130 if (tp)
Olof Johansson91b9a272005-08-09 20:24:39 -07001131 pos = tp->pos+tp->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001132 else
Olof Johansson91b9a272005-08-09 20:24:39 -07001133 pos = 0;
1134
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001135 if (n) {
Robert Olsson19baf832005-06-21 12:43:18 -07001136 newpos = tkey_mismatch(key, pos, n->key);
1137 tn = tnode_new(n->key, newpos, 1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001138 } else {
Robert Olsson19baf832005-06-21 12:43:18 -07001139 newpos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001140 tn = tnode_new(key, newpos, 1); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001141 }
Robert Olsson19baf832005-06-21 12:43:18 -07001142
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001143 if (!tn) {
Robert Olssonf835e472005-06-28 15:00:39 -07001144 free_leaf_info(li);
Stephen Hemminger387a5482008-04-10 03:47:34 -07001145 free_leaf(l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001146 return NULL;
Olof Johansson91b9a272005-08-09 20:24:39 -07001147 }
1148
Stephen Hemminger06801912007-08-10 15:22:13 -07001149 node_set_parent((struct node *)tn, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001150
Olof Johansson91b9a272005-08-09 20:24:39 -07001151 missbit = tkey_extract_bits(key, newpos, 1);
Robert Olsson19baf832005-06-21 12:43:18 -07001152 put_child(t, tn, missbit, (struct node *)l);
1153 put_child(t, tn, 1-missbit, n);
1154
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001155 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001156 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001157 put_child(t, (struct tnode *)tp, cindex,
1158 (struct node *)tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001159 } else {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001160 rcu_assign_pointer(t->trie, (struct node *)tn);
Robert Olsson19baf832005-06-21 12:43:18 -07001161 tp = tn;
1162 }
1163 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001164
1165 if (tp && tp->pos + tp->bits > 32)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001166 pr_warning("fib_trie"
1167 " tp=%p pos=%d, bits=%d, key=%0x plen=%d\n",
1168 tp, tp->pos, tp->bits, key, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001169
Robert Olsson19baf832005-06-21 12:43:18 -07001170 /* Rebalance the trie */
Robert Olsson2373ce12005-08-25 13:01:29 -07001171
Jarek Poplawski7b855762009-06-18 00:28:51 -07001172 trie_rebalance(t, tp);
Robert Olssonf835e472005-06-28 15:00:39 -07001173done:
Robert Olsson19baf832005-06-21 12:43:18 -07001174 return fa_head;
1175}
1176
Robert Olssond562f1f2007-03-26 14:22:22 -07001177/*
1178 * Caller must hold RTNL.
1179 */
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001180int fib_table_insert(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001181{
1182 struct trie *t = (struct trie *) tb->tb_data;
1183 struct fib_alias *fa, *new_fa;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001184 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001185 struct fib_info *fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001186 int plen = cfg->fc_dst_len;
1187 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001188 u32 key, mask;
1189 int err;
1190 struct leaf *l;
1191
1192 if (plen > 32)
1193 return -EINVAL;
1194
Thomas Graf4e902c52006-08-17 18:14:52 -07001195 key = ntohl(cfg->fc_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001196
Patrick McHardy2dfe55b2006-08-10 23:08:33 -07001197 pr_debug("Insert table=%u %08x/%d\n", tb->tb_id, key, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001198
Olof Johansson91b9a272005-08-09 20:24:39 -07001199 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001200
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001201 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001202 return -EINVAL;
1203
1204 key = key & mask;
1205
Thomas Graf4e902c52006-08-17 18:14:52 -07001206 fi = fib_create_info(cfg);
1207 if (IS_ERR(fi)) {
1208 err = PTR_ERR(fi);
Robert Olsson19baf832005-06-21 12:43:18 -07001209 goto err;
Thomas Graf4e902c52006-08-17 18:14:52 -07001210 }
Robert Olsson19baf832005-06-21 12:43:18 -07001211
1212 l = fib_find_node(t, key);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001213 fa = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001214
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001215 if (l) {
Robert Olsson19baf832005-06-21 12:43:18 -07001216 fa_head = get_fa_head(l, plen);
1217 fa = fib_find_alias(fa_head, tos, fi->fib_priority);
1218 }
1219
1220 /* Now fa, if non-NULL, points to the first fib alias
1221 * with the same keys [prefix,tos,priority], if such key already
1222 * exists or to the node before which we will insert new one.
1223 *
1224 * If fa is NULL, we will need to allocate a new one and
1225 * insert to the head of f.
1226 *
1227 * If f is NULL, no fib node matched the destination key
1228 * and we need to allocate a new one of those as well.
1229 */
1230
Julian Anastasov936f6f82008-01-28 21:18:06 -08001231 if (fa && fa->fa_tos == tos &&
1232 fa->fa_info->fib_priority == fi->fib_priority) {
1233 struct fib_alias *fa_first, *fa_match;
Robert Olsson19baf832005-06-21 12:43:18 -07001234
1235 err = -EEXIST;
Thomas Graf4e902c52006-08-17 18:14:52 -07001236 if (cfg->fc_nlflags & NLM_F_EXCL)
Robert Olsson19baf832005-06-21 12:43:18 -07001237 goto out;
1238
Julian Anastasov936f6f82008-01-28 21:18:06 -08001239 /* We have 2 goals:
1240 * 1. Find exact match for type, scope, fib_info to avoid
1241 * duplicate routes
1242 * 2. Find next 'fa' (or head), NLM_F_APPEND inserts before it
1243 */
1244 fa_match = NULL;
1245 fa_first = fa;
1246 fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list);
1247 list_for_each_entry_continue(fa, fa_head, fa_list) {
1248 if (fa->fa_tos != tos)
1249 break;
1250 if (fa->fa_info->fib_priority != fi->fib_priority)
1251 break;
1252 if (fa->fa_type == cfg->fc_type &&
1253 fa->fa_scope == cfg->fc_scope &&
1254 fa->fa_info == fi) {
1255 fa_match = fa;
1256 break;
1257 }
1258 }
1259
Thomas Graf4e902c52006-08-17 18:14:52 -07001260 if (cfg->fc_nlflags & NLM_F_REPLACE) {
Robert Olsson19baf832005-06-21 12:43:18 -07001261 struct fib_info *fi_drop;
1262 u8 state;
1263
Julian Anastasov936f6f82008-01-28 21:18:06 -08001264 fa = fa_first;
1265 if (fa_match) {
1266 if (fa == fa_match)
1267 err = 0;
Joonwoo Park67250332008-01-18 03:45:18 -08001268 goto out;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001269 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001270 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001271 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001272 if (new_fa == NULL)
1273 goto out;
Robert Olsson19baf832005-06-21 12:43:18 -07001274
1275 fi_drop = fa->fa_info;
Robert Olsson2373ce12005-08-25 13:01:29 -07001276 new_fa->fa_tos = fa->fa_tos;
1277 new_fa->fa_info = fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001278 new_fa->fa_type = cfg->fc_type;
1279 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001280 state = fa->fa_state;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001281 new_fa->fa_state = state & ~FA_S_ACCESSED;
Robert Olsson19baf832005-06-21 12:43:18 -07001282
Robert Olsson2373ce12005-08-25 13:01:29 -07001283 list_replace_rcu(&fa->fa_list, &new_fa->fa_list);
1284 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001285
1286 fib_release_info(fi_drop);
1287 if (state & FA_S_ACCESSED)
Denis V. Lunev76e6ebf2008-07-05 19:00:44 -07001288 rt_cache_flush(cfg->fc_nlinfo.nl_net, -1);
Milan Kocianb8f55832007-05-23 14:55:06 -07001289 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen,
1290 tb->tb_id, &cfg->fc_nlinfo, NLM_F_REPLACE);
Robert Olsson19baf832005-06-21 12:43:18 -07001291
Olof Johansson91b9a272005-08-09 20:24:39 -07001292 goto succeeded;
Robert Olsson19baf832005-06-21 12:43:18 -07001293 }
1294 /* Error if we find a perfect match which
1295 * uses the same scope, type, and nexthop
1296 * information.
1297 */
Julian Anastasov936f6f82008-01-28 21:18:06 -08001298 if (fa_match)
1299 goto out;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001300
Thomas Graf4e902c52006-08-17 18:14:52 -07001301 if (!(cfg->fc_nlflags & NLM_F_APPEND))
Julian Anastasov936f6f82008-01-28 21:18:06 -08001302 fa = fa_first;
Robert Olsson19baf832005-06-21 12:43:18 -07001303 }
1304 err = -ENOENT;
Thomas Graf4e902c52006-08-17 18:14:52 -07001305 if (!(cfg->fc_nlflags & NLM_F_CREATE))
Robert Olsson19baf832005-06-21 12:43:18 -07001306 goto out;
1307
1308 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001309 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson19baf832005-06-21 12:43:18 -07001310 if (new_fa == NULL)
1311 goto out;
1312
1313 new_fa->fa_info = fi;
1314 new_fa->fa_tos = tos;
Thomas Graf4e902c52006-08-17 18:14:52 -07001315 new_fa->fa_type = cfg->fc_type;
1316 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001317 new_fa->fa_state = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001318 /*
1319 * Insert new entry to the list.
1320 */
1321
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001322 if (!fa_head) {
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001323 fa_head = fib_insert_node(t, key, plen);
1324 if (unlikely(!fa_head)) {
1325 err = -ENOMEM;
Robert Olssonf835e472005-06-28 15:00:39 -07001326 goto out_free_new_fa;
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001327 }
Robert Olssonf835e472005-06-28 15:00:39 -07001328 }
Robert Olsson19baf832005-06-21 12:43:18 -07001329
Robert Olsson2373ce12005-08-25 13:01:29 -07001330 list_add_tail_rcu(&new_fa->fa_list,
1331 (fa ? &fa->fa_list : fa_head));
Robert Olsson19baf832005-06-21 12:43:18 -07001332
Denis V. Lunev76e6ebf2008-07-05 19:00:44 -07001333 rt_cache_flush(cfg->fc_nlinfo.nl_net, -1);
Thomas Graf4e902c52006-08-17 18:14:52 -07001334 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001335 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001336succeeded:
1337 return 0;
Robert Olssonf835e472005-06-28 15:00:39 -07001338
1339out_free_new_fa:
1340 kmem_cache_free(fn_alias_kmem, new_fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001341out:
1342 fib_release_info(fi);
Olof Johansson91b9a272005-08-09 20:24:39 -07001343err:
Robert Olsson19baf832005-06-21 12:43:18 -07001344 return err;
1345}
1346
Robert Olsson772cb712005-09-19 15:31:18 -07001347/* should be called with rcu_read_lock */
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001348static int check_leaf(struct trie *t, struct leaf *l,
1349 t_key key, const struct flowi *flp,
1350 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001351{
Robert Olsson19baf832005-06-21 12:43:18 -07001352 struct leaf_info *li;
1353 struct hlist_head *hhead = &l->list;
1354 struct hlist_node *node;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001355
Robert Olsson2373ce12005-08-25 13:01:29 -07001356 hlist_for_each_entry_rcu(li, node, hhead, hlist) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001357 int err;
1358 int plen = li->plen;
1359 __be32 mask = inet_make_mask(plen);
1360
Al Viro888454c2006-09-19 13:42:46 -07001361 if (l->key != (key & ntohl(mask)))
Robert Olsson19baf832005-06-21 12:43:18 -07001362 continue;
1363
Rami Rosene204a342009-05-18 01:19:12 +00001364 err = fib_semantic_match(&li->falh, flp, res, plen);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001365
Robert Olsson19baf832005-06-21 12:43:18 -07001366#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001367 if (err <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001368 t->stats.semantic_match_passed++;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001369 else
1370 t->stats.semantic_match_miss++;
Robert Olsson19baf832005-06-21 12:43:18 -07001371#endif
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001372 if (err <= 0)
Ben Hutchings2e655572008-07-10 16:52:52 -07001373 return err;
Robert Olsson19baf832005-06-21 12:43:18 -07001374 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001375
Ben Hutchings2e655572008-07-10 16:52:52 -07001376 return 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001377}
1378
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001379int fib_table_lookup(struct fib_table *tb, const struct flowi *flp,
1380 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001381{
1382 struct trie *t = (struct trie *) tb->tb_data;
Ben Hutchings2e655572008-07-10 16:52:52 -07001383 int ret;
Robert Olsson19baf832005-06-21 12:43:18 -07001384 struct node *n;
1385 struct tnode *pn;
1386 int pos, bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001387 t_key key = ntohl(flp->fl4_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001388 int chopped_off;
1389 t_key cindex = 0;
1390 int current_prefix_length = KEYLENGTH;
Olof Johansson91b9a272005-08-09 20:24:39 -07001391 struct tnode *cn;
1392 t_key node_prefix, key_prefix, pref_mismatch;
1393 int mp;
1394
Robert Olsson2373ce12005-08-25 13:01:29 -07001395 rcu_read_lock();
Robert Olsson19baf832005-06-21 12:43:18 -07001396
Robert Olsson2373ce12005-08-25 13:01:29 -07001397 n = rcu_dereference(t->trie);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001398 if (!n)
Robert Olsson19baf832005-06-21 12:43:18 -07001399 goto failed;
1400
1401#ifdef CONFIG_IP_FIB_TRIE_STATS
1402 t->stats.gets++;
1403#endif
1404
1405 /* Just a leaf? */
1406 if (IS_LEAF(n)) {
Ben Hutchings2e655572008-07-10 16:52:52 -07001407 ret = check_leaf(t, (struct leaf *)n, key, flp, res);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001408 goto found;
Robert Olsson19baf832005-06-21 12:43:18 -07001409 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001410
Robert Olsson19baf832005-06-21 12:43:18 -07001411 pn = (struct tnode *) n;
1412 chopped_off = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001413
Olof Johansson91b9a272005-08-09 20:24:39 -07001414 while (pn) {
Robert Olsson19baf832005-06-21 12:43:18 -07001415 pos = pn->pos;
1416 bits = pn->bits;
1417
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001418 if (!chopped_off)
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001419 cindex = tkey_extract_bits(mask_pfx(key, current_prefix_length),
1420 pos, bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001421
Jarek Poplawskib902e572009-07-14 11:20:32 +00001422 n = tnode_get_child_rcu(pn, cindex);
Robert Olsson19baf832005-06-21 12:43:18 -07001423
1424 if (n == NULL) {
1425#ifdef CONFIG_IP_FIB_TRIE_STATS
1426 t->stats.null_node_hit++;
1427#endif
1428 goto backtrace;
1429 }
1430
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001431 if (IS_LEAF(n)) {
Ben Hutchings2e655572008-07-10 16:52:52 -07001432 ret = check_leaf(t, (struct leaf *)n, key, flp, res);
1433 if (ret > 0)
Olof Johansson91b9a272005-08-09 20:24:39 -07001434 goto backtrace;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001435 goto found;
Olof Johansson91b9a272005-08-09 20:24:39 -07001436 }
1437
Olof Johansson91b9a272005-08-09 20:24:39 -07001438 cn = (struct tnode *)n;
1439
1440 /*
1441 * It's a tnode, and we can do some extra checks here if we
1442 * like, to avoid descending into a dead-end branch.
1443 * This tnode is in the parent's child array at index
1444 * key[p_pos..p_pos+p_bits] but potentially with some bits
1445 * chopped off, so in reality the index may be just a
1446 * subprefix, padded with zero at the end.
1447 * We can also take a look at any skipped bits in this
1448 * tnode - everything up to p_pos is supposed to be ok,
1449 * and the non-chopped bits of the index (se previous
1450 * paragraph) are also guaranteed ok, but the rest is
1451 * considered unknown.
1452 *
1453 * The skipped bits are key[pos+bits..cn->pos].
1454 */
1455
1456 /* If current_prefix_length < pos+bits, we are already doing
1457 * actual prefix matching, which means everything from
1458 * pos+(bits-chopped_off) onward must be zero along some
1459 * branch of this subtree - otherwise there is *no* valid
1460 * prefix present. Here we can only check the skipped
1461 * bits. Remember, since we have already indexed into the
1462 * parent's child array, we know that the bits we chopped of
1463 * *are* zero.
1464 */
1465
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001466 /* NOTA BENE: Checking only skipped bits
1467 for the new node here */
Olof Johansson91b9a272005-08-09 20:24:39 -07001468
1469 if (current_prefix_length < pos+bits) {
1470 if (tkey_extract_bits(cn->key, current_prefix_length,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001471 cn->pos - current_prefix_length)
1472 || !(cn->child[0]))
Olof Johansson91b9a272005-08-09 20:24:39 -07001473 goto backtrace;
1474 }
1475
1476 /*
1477 * If chopped_off=0, the index is fully validated and we
1478 * only need to look at the skipped bits for this, the new,
1479 * tnode. What we actually want to do is to find out if
1480 * these skipped bits match our key perfectly, or if we will
1481 * have to count on finding a matching prefix further down,
1482 * because if we do, we would like to have some way of
1483 * verifying the existence of such a prefix at this point.
1484 */
1485
1486 /* The only thing we can do at this point is to verify that
1487 * any such matching prefix can indeed be a prefix to our
1488 * key, and if the bits in the node we are inspecting that
1489 * do not match our key are not ZERO, this cannot be true.
1490 * Thus, find out where there is a mismatch (before cn->pos)
1491 * and verify that all the mismatching bits are zero in the
1492 * new tnode's key.
1493 */
1494
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001495 /*
1496 * Note: We aren't very concerned about the piece of
1497 * the key that precede pn->pos+pn->bits, since these
1498 * have already been checked. The bits after cn->pos
1499 * aren't checked since these are by definition
1500 * "unknown" at this point. Thus, what we want to see
1501 * is if we are about to enter the "prefix matching"
1502 * state, and in that case verify that the skipped
1503 * bits that will prevail throughout this subtree are
1504 * zero, as they have to be if we are to find a
1505 * matching prefix.
Olof Johansson91b9a272005-08-09 20:24:39 -07001506 */
1507
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001508 node_prefix = mask_pfx(cn->key, cn->pos);
1509 key_prefix = mask_pfx(key, cn->pos);
Olof Johansson91b9a272005-08-09 20:24:39 -07001510 pref_mismatch = key_prefix^node_prefix;
1511 mp = 0;
1512
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001513 /*
1514 * In short: If skipped bits in this node do not match
1515 * the search key, enter the "prefix matching"
1516 * state.directly.
Olof Johansson91b9a272005-08-09 20:24:39 -07001517 */
1518 if (pref_mismatch) {
1519 while (!(pref_mismatch & (1<<(KEYLENGTH-1)))) {
1520 mp++;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001521 pref_mismatch = pref_mismatch << 1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001522 }
1523 key_prefix = tkey_extract_bits(cn->key, mp, cn->pos-mp);
1524
1525 if (key_prefix != 0)
1526 goto backtrace;
1527
1528 if (current_prefix_length >= cn->pos)
1529 current_prefix_length = mp;
1530 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001531
Olof Johansson91b9a272005-08-09 20:24:39 -07001532 pn = (struct tnode *)n; /* Descend */
1533 chopped_off = 0;
1534 continue;
1535
Robert Olsson19baf832005-06-21 12:43:18 -07001536backtrace:
1537 chopped_off++;
1538
1539 /* As zero don't change the child key (cindex) */
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001540 while ((chopped_off <= pn->bits)
1541 && !(cindex & (1<<(chopped_off-1))))
Robert Olsson19baf832005-06-21 12:43:18 -07001542 chopped_off++;
Robert Olsson19baf832005-06-21 12:43:18 -07001543
1544 /* Decrease current_... with bits chopped off */
1545 if (current_prefix_length > pn->pos + pn->bits - chopped_off)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001546 current_prefix_length = pn->pos + pn->bits
1547 - chopped_off;
Olof Johansson91b9a272005-08-09 20:24:39 -07001548
Robert Olsson19baf832005-06-21 12:43:18 -07001549 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001550 * Either we do the actual chop off according or if we have
Robert Olsson19baf832005-06-21 12:43:18 -07001551 * chopped off all bits in this tnode walk up to our parent.
1552 */
1553
Olof Johansson91b9a272005-08-09 20:24:39 -07001554 if (chopped_off <= pn->bits) {
Robert Olsson19baf832005-06-21 12:43:18 -07001555 cindex &= ~(1 << (chopped_off-1));
Olof Johansson91b9a272005-08-09 20:24:39 -07001556 } else {
Jarek Poplawskib902e572009-07-14 11:20:32 +00001557 struct tnode *parent = node_parent_rcu((struct node *) pn);
Stephen Hemminger06801912007-08-10 15:22:13 -07001558 if (!parent)
Robert Olsson19baf832005-06-21 12:43:18 -07001559 goto failed;
Olof Johansson91b9a272005-08-09 20:24:39 -07001560
Robert Olsson19baf832005-06-21 12:43:18 -07001561 /* Get Child's index */
Stephen Hemminger06801912007-08-10 15:22:13 -07001562 cindex = tkey_extract_bits(pn->key, parent->pos, parent->bits);
1563 pn = parent;
Robert Olsson19baf832005-06-21 12:43:18 -07001564 chopped_off = 0;
1565
1566#ifdef CONFIG_IP_FIB_TRIE_STATS
1567 t->stats.backtrack++;
1568#endif
1569 goto backtrace;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001570 }
Robert Olsson19baf832005-06-21 12:43:18 -07001571 }
1572failed:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001573 ret = 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001574found:
Robert Olsson2373ce12005-08-25 13:01:29 -07001575 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001576 return ret;
1577}
1578
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001579/*
1580 * Remove the leaf and return parent.
1581 */
1582static void trie_leaf_remove(struct trie *t, struct leaf *l)
Robert Olsson19baf832005-06-21 12:43:18 -07001583{
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001584 struct tnode *tp = node_parent((struct node *) l);
Robert Olsson19baf832005-06-21 12:43:18 -07001585
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001586 pr_debug("entering trie_leaf_remove(%p)\n", l);
Robert Olsson19baf832005-06-21 12:43:18 -07001587
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001588 if (tp) {
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001589 t_key cindex = tkey_extract_bits(l->key, tp->pos, tp->bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001590 put_child(t, (struct tnode *)tp, cindex, NULL);
Jarek Poplawski7b855762009-06-18 00:28:51 -07001591 trie_rebalance(t, tp);
Olof Johansson91b9a272005-08-09 20:24:39 -07001592 } else
Robert Olsson2373ce12005-08-25 13:01:29 -07001593 rcu_assign_pointer(t->trie, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001594
Stephen Hemminger387a5482008-04-10 03:47:34 -07001595 free_leaf(l);
Robert Olsson19baf832005-06-21 12:43:18 -07001596}
1597
Robert Olssond562f1f2007-03-26 14:22:22 -07001598/*
1599 * Caller must hold RTNL.
1600 */
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001601int fib_table_delete(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001602{
1603 struct trie *t = (struct trie *) tb->tb_data;
1604 u32 key, mask;
Thomas Graf4e902c52006-08-17 18:14:52 -07001605 int plen = cfg->fc_dst_len;
1606 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001607 struct fib_alias *fa, *fa_to_delete;
1608 struct list_head *fa_head;
1609 struct leaf *l;
Olof Johansson91b9a272005-08-09 20:24:39 -07001610 struct leaf_info *li;
1611
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001612 if (plen > 32)
Robert Olsson19baf832005-06-21 12:43:18 -07001613 return -EINVAL;
1614
Thomas Graf4e902c52006-08-17 18:14:52 -07001615 key = ntohl(cfg->fc_dst);
Olof Johansson91b9a272005-08-09 20:24:39 -07001616 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001617
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001618 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001619 return -EINVAL;
1620
1621 key = key & mask;
1622 l = fib_find_node(t, key);
1623
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001624 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001625 return -ESRCH;
1626
1627 fa_head = get_fa_head(l, plen);
1628 fa = fib_find_alias(fa_head, tos, 0);
1629
1630 if (!fa)
1631 return -ESRCH;
1632
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001633 pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t);
Robert Olsson19baf832005-06-21 12:43:18 -07001634
1635 fa_to_delete = NULL;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001636 fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list);
1637 list_for_each_entry_continue(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001638 struct fib_info *fi = fa->fa_info;
1639
1640 if (fa->fa_tos != tos)
1641 break;
1642
Thomas Graf4e902c52006-08-17 18:14:52 -07001643 if ((!cfg->fc_type || fa->fa_type == cfg->fc_type) &&
1644 (cfg->fc_scope == RT_SCOPE_NOWHERE ||
1645 fa->fa_scope == cfg->fc_scope) &&
1646 (!cfg->fc_protocol ||
1647 fi->fib_protocol == cfg->fc_protocol) &&
1648 fib_nh_match(cfg, fi) == 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001649 fa_to_delete = fa;
1650 break;
1651 }
1652 }
1653
Olof Johansson91b9a272005-08-09 20:24:39 -07001654 if (!fa_to_delete)
1655 return -ESRCH;
Robert Olsson19baf832005-06-21 12:43:18 -07001656
Olof Johansson91b9a272005-08-09 20:24:39 -07001657 fa = fa_to_delete;
Thomas Graf4e902c52006-08-17 18:14:52 -07001658 rtmsg_fib(RTM_DELROUTE, htonl(key), fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001659 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001660
Olof Johansson91b9a272005-08-09 20:24:39 -07001661 l = fib_find_node(t, key);
Robert Olsson772cb712005-09-19 15:31:18 -07001662 li = find_leaf_info(l, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001663
Robert Olsson2373ce12005-08-25 13:01:29 -07001664 list_del_rcu(&fa->fa_list);
Robert Olsson19baf832005-06-21 12:43:18 -07001665
Olof Johansson91b9a272005-08-09 20:24:39 -07001666 if (list_empty(fa_head)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001667 hlist_del_rcu(&li->hlist);
Olof Johansson91b9a272005-08-09 20:24:39 -07001668 free_leaf_info(li);
Robert Olsson2373ce12005-08-25 13:01:29 -07001669 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001670
1671 if (hlist_empty(&l->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001672 trie_leaf_remove(t, l);
Olof Johansson91b9a272005-08-09 20:24:39 -07001673
1674 if (fa->fa_state & FA_S_ACCESSED)
Denis V. Lunev76e6ebf2008-07-05 19:00:44 -07001675 rt_cache_flush(cfg->fc_nlinfo.nl_net, -1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001676
Robert Olsson2373ce12005-08-25 13:01:29 -07001677 fib_release_info(fa->fa_info);
1678 alias_free_mem_rcu(fa);
Olof Johansson91b9a272005-08-09 20:24:39 -07001679 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001680}
1681
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001682static int trie_flush_list(struct list_head *head)
Robert Olsson19baf832005-06-21 12:43:18 -07001683{
1684 struct fib_alias *fa, *fa_node;
1685 int found = 0;
1686
1687 list_for_each_entry_safe(fa, fa_node, head, fa_list) {
1688 struct fib_info *fi = fa->fa_info;
Robert Olsson19baf832005-06-21 12:43:18 -07001689
Robert Olsson2373ce12005-08-25 13:01:29 -07001690 if (fi && (fi->fib_flags & RTNH_F_DEAD)) {
1691 list_del_rcu(&fa->fa_list);
1692 fib_release_info(fa->fa_info);
1693 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001694 found++;
1695 }
1696 }
1697 return found;
1698}
1699
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001700static int trie_flush_leaf(struct leaf *l)
Robert Olsson19baf832005-06-21 12:43:18 -07001701{
1702 int found = 0;
1703 struct hlist_head *lih = &l->list;
1704 struct hlist_node *node, *tmp;
1705 struct leaf_info *li = NULL;
1706
1707 hlist_for_each_entry_safe(li, node, tmp, lih, hlist) {
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001708 found += trie_flush_list(&li->falh);
Robert Olsson19baf832005-06-21 12:43:18 -07001709
1710 if (list_empty(&li->falh)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001711 hlist_del_rcu(&li->hlist);
Robert Olsson19baf832005-06-21 12:43:18 -07001712 free_leaf_info(li);
1713 }
1714 }
1715 return found;
1716}
1717
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001718/*
1719 * Scan for the next right leaf starting at node p->child[idx]
1720 * Since we have back pointer, no recursion necessary.
1721 */
1722static struct leaf *leaf_walk_rcu(struct tnode *p, struct node *c)
Robert Olsson19baf832005-06-21 12:43:18 -07001723{
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001724 do {
1725 t_key idx;
Robert Olsson19baf832005-06-21 12:43:18 -07001726
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001727 if (c)
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001728 idx = tkey_extract_bits(c->key, p->pos, p->bits) + 1;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001729 else
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001730 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001731
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001732 while (idx < 1u << p->bits) {
1733 c = tnode_get_child_rcu(p, idx++);
Robert Olsson2373ce12005-08-25 13:01:29 -07001734 if (!c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001735 continue;
Robert Olsson19baf832005-06-21 12:43:18 -07001736
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001737 if (IS_LEAF(c)) {
1738 prefetch(p->child[idx]);
1739 return (struct leaf *) c;
Robert Olsson19baf832005-06-21 12:43:18 -07001740 }
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001741
1742 /* Rescan start scanning in new node */
1743 p = (struct tnode *) c;
1744 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001745 }
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001746
1747 /* Node empty, walk back up to parent */
Olof Johansson91b9a272005-08-09 20:24:39 -07001748 c = (struct node *) p;
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001749 } while ( (p = node_parent_rcu(c)) != NULL);
1750
1751 return NULL; /* Root of trie */
1752}
1753
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001754static struct leaf *trie_firstleaf(struct trie *t)
1755{
1756 struct tnode *n = (struct tnode *) rcu_dereference(t->trie);
1757
1758 if (!n)
1759 return NULL;
1760
1761 if (IS_LEAF(n)) /* trie is just a leaf */
1762 return (struct leaf *) n;
1763
1764 return leaf_walk_rcu(n, NULL);
1765}
1766
1767static struct leaf *trie_nextleaf(struct leaf *l)
1768{
1769 struct node *c = (struct node *) l;
Jarek Poplawskib902e572009-07-14 11:20:32 +00001770 struct tnode *p = node_parent_rcu(c);
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001771
1772 if (!p)
1773 return NULL; /* trie with just one leaf */
1774
1775 return leaf_walk_rcu(p, c);
Robert Olsson19baf832005-06-21 12:43:18 -07001776}
1777
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001778static struct leaf *trie_leafindex(struct trie *t, int index)
1779{
1780 struct leaf *l = trie_firstleaf(t);
1781
Stephen Hemmingerec28cf72008-02-11 21:12:49 -08001782 while (l && index-- > 0)
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001783 l = trie_nextleaf(l);
Stephen Hemmingerec28cf72008-02-11 21:12:49 -08001784
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001785 return l;
1786}
1787
1788
Robert Olssond562f1f2007-03-26 14:22:22 -07001789/*
1790 * Caller must hold RTNL.
1791 */
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001792int fib_table_flush(struct fib_table *tb)
Robert Olsson19baf832005-06-21 12:43:18 -07001793{
1794 struct trie *t = (struct trie *) tb->tb_data;
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001795 struct leaf *l, *ll = NULL;
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001796 int found = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001797
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001798 for (l = trie_firstleaf(t); l; l = trie_nextleaf(l)) {
Stephen Hemmingeref3660c2008-04-10 03:46:12 -07001799 found += trie_flush_leaf(l);
Robert Olsson19baf832005-06-21 12:43:18 -07001800
1801 if (ll && hlist_empty(&ll->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001802 trie_leaf_remove(t, ll);
Robert Olsson19baf832005-06-21 12:43:18 -07001803 ll = l;
1804 }
1805
1806 if (ll && hlist_empty(&ll->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001807 trie_leaf_remove(t, ll);
Robert Olsson19baf832005-06-21 12:43:18 -07001808
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001809 pr_debug("trie_flush found=%d\n", found);
Robert Olsson19baf832005-06-21 12:43:18 -07001810 return found;
1811}
1812
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001813void fib_table_select_default(struct fib_table *tb,
1814 const struct flowi *flp,
1815 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001816{
1817 struct trie *t = (struct trie *) tb->tb_data;
1818 int order, last_idx;
1819 struct fib_info *fi = NULL;
1820 struct fib_info *last_resort;
1821 struct fib_alias *fa = NULL;
1822 struct list_head *fa_head;
1823 struct leaf *l;
1824
1825 last_idx = -1;
1826 last_resort = NULL;
1827 order = -1;
1828
Robert Olsson2373ce12005-08-25 13:01:29 -07001829 rcu_read_lock();
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001830
Robert Olsson19baf832005-06-21 12:43:18 -07001831 l = fib_find_node(t, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001832 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001833 goto out;
1834
1835 fa_head = get_fa_head(l, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001836 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001837 goto out;
1838
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001839 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001840 goto out;
1841
Robert Olsson2373ce12005-08-25 13:01:29 -07001842 list_for_each_entry_rcu(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001843 struct fib_info *next_fi = fa->fa_info;
Olof Johansson91b9a272005-08-09 20:24:39 -07001844
Robert Olsson19baf832005-06-21 12:43:18 -07001845 if (fa->fa_scope != res->scope ||
1846 fa->fa_type != RTN_UNICAST)
1847 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -07001848
Robert Olsson19baf832005-06-21 12:43:18 -07001849 if (next_fi->fib_priority > res->fi->fib_priority)
1850 break;
1851 if (!next_fi->fib_nh[0].nh_gw ||
1852 next_fi->fib_nh[0].nh_scope != RT_SCOPE_LINK)
1853 continue;
1854 fa->fa_state |= FA_S_ACCESSED;
Olof Johansson91b9a272005-08-09 20:24:39 -07001855
Robert Olsson19baf832005-06-21 12:43:18 -07001856 if (fi == NULL) {
1857 if (next_fi != res->fi)
1858 break;
1859 } else if (!fib_detect_death(fi, order, &last_resort,
Denis V. Lunev971b8932007-12-08 00:32:23 -08001860 &last_idx, tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001861 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001862 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001863 goto out;
1864 }
1865 fi = next_fi;
1866 order++;
1867 }
1868 if (order <= 0 || fi == NULL) {
Denis V. Lunev971b8932007-12-08 00:32:23 -08001869 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001870 goto out;
1871 }
1872
Denis V. Lunev971b8932007-12-08 00:32:23 -08001873 if (!fib_detect_death(fi, order, &last_resort, &last_idx,
1874 tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001875 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001876 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001877 goto out;
1878 }
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001879 if (last_idx >= 0)
1880 fib_result_assign(res, last_resort);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001881 tb->tb_default = last_idx;
1882out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001883 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001884}
1885
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001886static int fn_trie_dump_fa(t_key key, int plen, struct list_head *fah,
1887 struct fib_table *tb,
Robert Olsson19baf832005-06-21 12:43:18 -07001888 struct sk_buff *skb, struct netlink_callback *cb)
1889{
1890 int i, s_i;
1891 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07001892 __be32 xkey = htonl(key);
Robert Olsson19baf832005-06-21 12:43:18 -07001893
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001894 s_i = cb->args[5];
Robert Olsson19baf832005-06-21 12:43:18 -07001895 i = 0;
1896
Robert Olsson2373ce12005-08-25 13:01:29 -07001897 /* rcu_read_lock is hold by caller */
1898
1899 list_for_each_entry_rcu(fa, fah, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001900 if (i < s_i) {
1901 i++;
1902 continue;
1903 }
Robert Olsson19baf832005-06-21 12:43:18 -07001904
1905 if (fib_dump_info(skb, NETLINK_CB(cb->skb).pid,
1906 cb->nlh->nlmsg_seq,
1907 RTM_NEWROUTE,
1908 tb->tb_id,
1909 fa->fa_type,
1910 fa->fa_scope,
Thomas Grafbe403ea2006-08-17 18:15:17 -07001911 xkey,
Robert Olsson19baf832005-06-21 12:43:18 -07001912 plen,
1913 fa->fa_tos,
Stephen Hemminger64347f72008-01-22 21:55:01 -08001914 fa->fa_info, NLM_F_MULTI) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001915 cb->args[5] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001916 return -1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001917 }
Robert Olsson19baf832005-06-21 12:43:18 -07001918 i++;
1919 }
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001920 cb->args[5] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001921 return skb->len;
1922}
1923
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001924static int fn_trie_dump_leaf(struct leaf *l, struct fib_table *tb,
1925 struct sk_buff *skb, struct netlink_callback *cb)
Robert Olsson19baf832005-06-21 12:43:18 -07001926{
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001927 struct leaf_info *li;
1928 struct hlist_node *node;
1929 int i, s_i;
Robert Olsson19baf832005-06-21 12:43:18 -07001930
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001931 s_i = cb->args[4];
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001932 i = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001933
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001934 /* rcu_read_lock is hold by caller */
1935 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
1936 if (i < s_i) {
1937 i++;
Robert Olsson19baf832005-06-21 12:43:18 -07001938 continue;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001939 }
Robert Olsson19baf832005-06-21 12:43:18 -07001940
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001941 if (i > s_i)
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001942 cb->args[5] = 0;
Olof Johansson91b9a272005-08-09 20:24:39 -07001943
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001944 if (list_empty(&li->falh))
Robert Olsson19baf832005-06-21 12:43:18 -07001945 continue;
1946
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001947 if (fn_trie_dump_fa(l->key, li->plen, &li->falh, tb, skb, cb) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001948 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001949 return -1;
1950 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001951 i++;
Robert Olsson19baf832005-06-21 12:43:18 -07001952 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001953
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001954 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001955 return skb->len;
1956}
1957
Stephen Hemminger16c6cf82009-09-20 10:35:36 +00001958int fib_table_dump(struct fib_table *tb, struct sk_buff *skb,
1959 struct netlink_callback *cb)
Robert Olsson19baf832005-06-21 12:43:18 -07001960{
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001961 struct leaf *l;
Robert Olsson19baf832005-06-21 12:43:18 -07001962 struct trie *t = (struct trie *) tb->tb_data;
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001963 t_key key = cb->args[2];
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001964 int count = cb->args[3];
Robert Olsson19baf832005-06-21 12:43:18 -07001965
Robert Olsson2373ce12005-08-25 13:01:29 -07001966 rcu_read_lock();
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001967 /* Dump starting at last key.
1968 * Note: 0.0.0.0/0 (ie default) is first key.
1969 */
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001970 if (count == 0)
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001971 l = trie_firstleaf(t);
1972 else {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001973 /* Normally, continue from last key, but if that is missing
1974 * fallback to using slow rescan
1975 */
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001976 l = fib_find_node(t, key);
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001977 if (!l)
1978 l = trie_leafindex(t, count);
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001979 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001980
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001981 while (l) {
1982 cb->args[2] = l->key;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001983 if (fn_trie_dump_leaf(l, tb, skb, cb) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001984 cb->args[3] = count;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001985 rcu_read_unlock();
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001986 return -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001987 }
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001988
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001989 ++count;
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001990 l = trie_nextleaf(l);
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001991 memset(&cb->args[4], 0,
1992 sizeof(cb->args) - 4*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001993 }
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001994 cb->args[3] = count;
Robert Olsson2373ce12005-08-25 13:01:29 -07001995 rcu_read_unlock();
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001996
Robert Olsson19baf832005-06-21 12:43:18 -07001997 return skb->len;
Robert Olsson19baf832005-06-21 12:43:18 -07001998}
1999
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08002000void __init fib_hash_init(void)
2001{
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002002 fn_alias_kmem = kmem_cache_create("ip_fib_alias",
2003 sizeof(struct fib_alias),
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -08002004 0, SLAB_PANIC, NULL);
2005
2006 trie_leaf_kmem = kmem_cache_create("ip_fib_trie",
2007 max(sizeof(struct leaf),
2008 sizeof(struct leaf_info)),
2009 0, SLAB_PANIC, NULL);
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08002010}
Robert Olsson19baf832005-06-21 12:43:18 -07002011
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08002012
2013/* Fix more generic FIB names for init later */
2014struct fib_table *fib_hash_table(u32 id)
Robert Olsson19baf832005-06-21 12:43:18 -07002015{
2016 struct fib_table *tb;
2017 struct trie *t;
2018
Robert Olsson19baf832005-06-21 12:43:18 -07002019 tb = kmalloc(sizeof(struct fib_table) + sizeof(struct trie),
2020 GFP_KERNEL);
2021 if (tb == NULL)
2022 return NULL;
2023
2024 tb->tb_id = id;
Denis V. Lunev971b8932007-12-08 00:32:23 -08002025 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07002026
2027 t = (struct trie *) tb->tb_data;
Stephen Hemmingerc28a1cf2008-01-12 20:49:13 -08002028 memset(t, 0, sizeof(*t));
Robert Olsson19baf832005-06-21 12:43:18 -07002029
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002030 if (id == RT_TABLE_LOCAL)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002031 pr_info("IPv4 FIB: Using LC-trie version %s\n", VERSION);
Robert Olsson19baf832005-06-21 12:43:18 -07002032
2033 return tb;
2034}
2035
Robert Olsson19baf832005-06-21 12:43:18 -07002036#ifdef CONFIG_PROC_FS
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002037/* Depth first Trie walk iterator */
2038struct fib_trie_iter {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002039 struct seq_net_private p;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002040 struct fib_table *tb;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002041 struct tnode *tnode;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002042 unsigned index;
2043 unsigned depth;
2044};
Robert Olsson19baf832005-06-21 12:43:18 -07002045
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002046static struct node *fib_trie_get_next(struct fib_trie_iter *iter)
Robert Olsson19baf832005-06-21 12:43:18 -07002047{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002048 struct tnode *tn = iter->tnode;
2049 unsigned cindex = iter->index;
2050 struct tnode *p;
2051
Eric W. Biederman6640e692007-01-24 14:42:04 -08002052 /* A single entry routing table */
2053 if (!tn)
2054 return NULL;
2055
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002056 pr_debug("get_next iter={node=%p index=%d depth=%d}\n",
2057 iter->tnode, iter->index, iter->depth);
2058rescan:
2059 while (cindex < (1<<tn->bits)) {
Eric Dumazetb59cfbf2008-01-18 03:31:36 -08002060 struct node *n = tnode_get_child_rcu(tn, cindex);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002061
2062 if (n) {
2063 if (IS_LEAF(n)) {
2064 iter->tnode = tn;
2065 iter->index = cindex + 1;
2066 } else {
2067 /* push down one level */
2068 iter->tnode = (struct tnode *) n;
2069 iter->index = 0;
2070 ++iter->depth;
2071 }
2072 return n;
2073 }
2074
2075 ++cindex;
2076 }
2077
2078 /* Current node exhausted, pop back up */
Eric Dumazetb59cfbf2008-01-18 03:31:36 -08002079 p = node_parent_rcu((struct node *)tn);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002080 if (p) {
2081 cindex = tkey_extract_bits(tn->key, p->pos, p->bits)+1;
2082 tn = p;
2083 --iter->depth;
2084 goto rescan;
2085 }
2086
2087 /* got root? */
Robert Olsson19baf832005-06-21 12:43:18 -07002088 return NULL;
2089}
2090
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002091static struct node *fib_trie_get_first(struct fib_trie_iter *iter,
2092 struct trie *t)
Robert Olsson19baf832005-06-21 12:43:18 -07002093{
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002094 struct node *n;
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002095
Stephen Hemminger132adf52007-03-08 20:44:43 -08002096 if (!t)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002097 return NULL;
2098
2099 n = rcu_dereference(t->trie);
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002100 if (!n)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002101 return NULL;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002102
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002103 if (IS_TNODE(n)) {
2104 iter->tnode = (struct tnode *) n;
2105 iter->index = 0;
2106 iter->depth = 1;
2107 } else {
2108 iter->tnode = NULL;
2109 iter->index = 0;
2110 iter->depth = 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002111 }
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002112
2113 return n;
Robert Olsson19baf832005-06-21 12:43:18 -07002114}
2115
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002116static void trie_collect_stats(struct trie *t, struct trie_stat *s)
Robert Olsson19baf832005-06-21 12:43:18 -07002117{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002118 struct node *n;
2119 struct fib_trie_iter iter;
Robert Olsson19baf832005-06-21 12:43:18 -07002120
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002121 memset(s, 0, sizeof(*s));
Robert Olsson19baf832005-06-21 12:43:18 -07002122
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002123 rcu_read_lock();
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002124 for (n = fib_trie_get_first(&iter, t); n; n = fib_trie_get_next(&iter)) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002125 if (IS_LEAF(n)) {
Stephen Hemminger93672292008-01-22 21:54:05 -08002126 struct leaf *l = (struct leaf *)n;
2127 struct leaf_info *li;
2128 struct hlist_node *tmp;
2129
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002130 s->leaves++;
2131 s->totdepth += iter.depth;
2132 if (iter.depth > s->maxdepth)
2133 s->maxdepth = iter.depth;
Stephen Hemminger93672292008-01-22 21:54:05 -08002134
2135 hlist_for_each_entry_rcu(li, tmp, &l->list, hlist)
2136 ++s->prefixes;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002137 } else {
2138 const struct tnode *tn = (const struct tnode *) n;
2139 int i;
Robert Olsson19baf832005-06-21 12:43:18 -07002140
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002141 s->tnodes++;
Stephen Hemminger132adf52007-03-08 20:44:43 -08002142 if (tn->bits < MAX_STAT_DEPTH)
Robert Olsson06ef9212006-03-20 21:35:01 -08002143 s->nodesizes[tn->bits]++;
2144
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002145 for (i = 0; i < (1<<tn->bits); i++)
2146 if (!tn->child[i])
2147 s->nullpointers++;
2148 }
2149 }
2150 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002151}
2152
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002153/*
Robert Olsson19baf832005-06-21 12:43:18 -07002154 * This outputs /proc/net/fib_triestats
Robert Olsson19baf832005-06-21 12:43:18 -07002155 */
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002156static void trie_show_stats(struct seq_file *seq, struct trie_stat *stat)
Robert Olsson19baf832005-06-21 12:43:18 -07002157{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002158 unsigned i, max, pointers, bytes, avdepth;
Robert Olsson19baf832005-06-21 12:43:18 -07002159
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002160 if (stat->leaves)
2161 avdepth = stat->totdepth*100 / stat->leaves;
2162 else
2163 avdepth = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002164
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002165 seq_printf(seq, "\tAver depth: %u.%02d\n",
2166 avdepth / 100, avdepth % 100);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002167 seq_printf(seq, "\tMax depth: %u\n", stat->maxdepth);
Robert Olsson19baf832005-06-21 12:43:18 -07002168
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002169 seq_printf(seq, "\tLeaves: %u\n", stat->leaves);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002170 bytes = sizeof(struct leaf) * stat->leaves;
Stephen Hemminger93672292008-01-22 21:54:05 -08002171
2172 seq_printf(seq, "\tPrefixes: %u\n", stat->prefixes);
2173 bytes += sizeof(struct leaf_info) * stat->prefixes;
2174
Stephen Hemminger187b5182008-01-12 20:55:55 -08002175 seq_printf(seq, "\tInternal nodes: %u\n\t", stat->tnodes);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002176 bytes += sizeof(struct tnode) * stat->tnodes;
Robert Olsson19baf832005-06-21 12:43:18 -07002177
Robert Olsson06ef9212006-03-20 21:35:01 -08002178 max = MAX_STAT_DEPTH;
2179 while (max > 0 && stat->nodesizes[max-1] == 0)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002180 max--;
Robert Olsson19baf832005-06-21 12:43:18 -07002181
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002182 pointers = 0;
2183 for (i = 1; i <= max; i++)
2184 if (stat->nodesizes[i] != 0) {
Stephen Hemminger187b5182008-01-12 20:55:55 -08002185 seq_printf(seq, " %u: %u", i, stat->nodesizes[i]);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002186 pointers += (1<<i) * stat->nodesizes[i];
2187 }
2188 seq_putc(seq, '\n');
Stephen Hemminger187b5182008-01-12 20:55:55 -08002189 seq_printf(seq, "\tPointers: %u\n", pointers);
Robert Olsson19baf832005-06-21 12:43:18 -07002190
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002191 bytes += sizeof(struct node *) * pointers;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002192 seq_printf(seq, "Null ptrs: %u\n", stat->nullpointers);
2193 seq_printf(seq, "Total size: %u kB\n", (bytes + 1023) / 1024);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002194}
Robert Olsson19baf832005-06-21 12:43:18 -07002195
2196#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002197static void trie_show_usage(struct seq_file *seq,
2198 const struct trie_use_stats *stats)
2199{
2200 seq_printf(seq, "\nCounters:\n---------\n");
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002201 seq_printf(seq, "gets = %u\n", stats->gets);
2202 seq_printf(seq, "backtracks = %u\n", stats->backtrack);
2203 seq_printf(seq, "semantic match passed = %u\n",
2204 stats->semantic_match_passed);
2205 seq_printf(seq, "semantic match miss = %u\n",
2206 stats->semantic_match_miss);
2207 seq_printf(seq, "null node hit= %u\n", stats->null_node_hit);
2208 seq_printf(seq, "skipped node resize = %u\n\n",
2209 stats->resize_node_skipped);
Robert Olsson19baf832005-06-21 12:43:18 -07002210}
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002211#endif /* CONFIG_IP_FIB_TRIE_STATS */
2212
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002213static void fib_table_print(struct seq_file *seq, struct fib_table *tb)
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002214{
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002215 if (tb->tb_id == RT_TABLE_LOCAL)
2216 seq_puts(seq, "Local:\n");
2217 else if (tb->tb_id == RT_TABLE_MAIN)
2218 seq_puts(seq, "Main:\n");
2219 else
2220 seq_printf(seq, "Id %d:\n", tb->tb_id);
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002221}
Robert Olsson19baf832005-06-21 12:43:18 -07002222
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002223
Robert Olsson19baf832005-06-21 12:43:18 -07002224static int fib_triestat_seq_show(struct seq_file *seq, void *v)
2225{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002226 struct net *net = (struct net *)seq->private;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002227 unsigned int h;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002228
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002229 seq_printf(seq,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002230 "Basic info: size of leaf:"
2231 " %Zd bytes, size of tnode: %Zd bytes.\n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002232 sizeof(struct leaf), sizeof(struct tnode));
Olof Johansson91b9a272005-08-09 20:24:39 -07002233
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002234 for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
2235 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2236 struct hlist_node *node;
2237 struct fib_table *tb;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002238
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002239 hlist_for_each_entry_rcu(tb, node, head, tb_hlist) {
2240 struct trie *t = (struct trie *) tb->tb_data;
2241 struct trie_stat stat;
2242
2243 if (!t)
2244 continue;
2245
2246 fib_table_print(seq, tb);
2247
2248 trie_collect_stats(t, &stat);
2249 trie_show_stats(seq, &stat);
2250#ifdef CONFIG_IP_FIB_TRIE_STATS
2251 trie_show_usage(seq, &t->stats);
2252#endif
2253 }
2254 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002255
Robert Olsson19baf832005-06-21 12:43:18 -07002256 return 0;
2257}
2258
Robert Olsson19baf832005-06-21 12:43:18 -07002259static int fib_triestat_seq_open(struct inode *inode, struct file *file)
2260{
Pavel Emelyanovde05c552008-07-18 04:07:21 -07002261 return single_open_net(inode, file, fib_triestat_seq_show);
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002262}
2263
Arjan van de Ven9a321442007-02-12 00:55:35 -08002264static const struct file_operations fib_triestat_fops = {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002265 .owner = THIS_MODULE,
2266 .open = fib_triestat_seq_open,
2267 .read = seq_read,
2268 .llseek = seq_lseek,
Pavel Emelyanovb6fcbdb2008-07-18 04:07:44 -07002269 .release = single_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002270};
2271
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002272static struct node *fib_trie_get_idx(struct seq_file *seq, loff_t pos)
Robert Olsson19baf832005-06-21 12:43:18 -07002273{
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002274 struct fib_trie_iter *iter = seq->private;
2275 struct net *net = seq_file_net(seq);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002276 loff_t idx = 0;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002277 unsigned int h;
Robert Olsson19baf832005-06-21 12:43:18 -07002278
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002279 for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
2280 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2281 struct hlist_node *node;
2282 struct fib_table *tb;
2283
2284 hlist_for_each_entry_rcu(tb, node, head, tb_hlist) {
2285 struct node *n;
2286
2287 for (n = fib_trie_get_first(iter,
2288 (struct trie *) tb->tb_data);
2289 n; n = fib_trie_get_next(iter))
2290 if (pos == idx++) {
2291 iter->tb = tb;
2292 return n;
2293 }
2294 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002295 }
Robert Olsson19baf832005-06-21 12:43:18 -07002296
Robert Olsson19baf832005-06-21 12:43:18 -07002297 return NULL;
2298}
2299
2300static void *fib_trie_seq_start(struct seq_file *seq, loff_t *pos)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002301 __acquires(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002302{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002303 rcu_read_lock();
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002304 return fib_trie_get_idx(seq, *pos);
Robert Olsson19baf832005-06-21 12:43:18 -07002305}
2306
2307static void *fib_trie_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2308{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002309 struct fib_trie_iter *iter = seq->private;
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002310 struct net *net = seq_file_net(seq);
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002311 struct fib_table *tb = iter->tb;
2312 struct hlist_node *tb_node;
2313 unsigned int h;
2314 struct node *n;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002315
Robert Olsson19baf832005-06-21 12:43:18 -07002316 ++*pos;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002317 /* next node in same table */
2318 n = fib_trie_get_next(iter);
2319 if (n)
2320 return n;
Olof Johansson91b9a272005-08-09 20:24:39 -07002321
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002322 /* walk rest of this hash chain */
2323 h = tb->tb_id & (FIB_TABLE_HASHSZ - 1);
2324 while ( (tb_node = rcu_dereference(tb->tb_hlist.next)) ) {
2325 tb = hlist_entry(tb_node, struct fib_table, tb_hlist);
2326 n = fib_trie_get_first(iter, (struct trie *) tb->tb_data);
2327 if (n)
2328 goto found;
2329 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002330
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002331 /* new hash chain */
2332 while (++h < FIB_TABLE_HASHSZ) {
2333 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2334 hlist_for_each_entry_rcu(tb, tb_node, head, tb_hlist) {
2335 n = fib_trie_get_first(iter, (struct trie *) tb->tb_data);
2336 if (n)
2337 goto found;
2338 }
2339 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002340 return NULL;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002341
2342found:
2343 iter->tb = tb;
2344 return n;
Robert Olsson19baf832005-06-21 12:43:18 -07002345}
2346
2347static void fib_trie_seq_stop(struct seq_file *seq, void *v)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002348 __releases(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002349{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002350 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002351}
2352
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002353static void seq_indent(struct seq_file *seq, int n)
2354{
2355 while (n-- > 0) seq_puts(seq, " ");
2356}
Robert Olsson19baf832005-06-21 12:43:18 -07002357
Eric Dumazet28d36e32008-01-14 23:09:56 -08002358static inline const char *rtn_scope(char *buf, size_t len, enum rt_scope_t s)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002359{
Stephen Hemminger132adf52007-03-08 20:44:43 -08002360 switch (s) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002361 case RT_SCOPE_UNIVERSE: return "universe";
2362 case RT_SCOPE_SITE: return "site";
2363 case RT_SCOPE_LINK: return "link";
2364 case RT_SCOPE_HOST: return "host";
2365 case RT_SCOPE_NOWHERE: return "nowhere";
2366 default:
Eric Dumazet28d36e32008-01-14 23:09:56 -08002367 snprintf(buf, len, "scope=%d", s);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002368 return buf;
2369 }
2370}
2371
Jan Engelhardt36cbd3d2009-08-05 10:42:58 -07002372static const char *const rtn_type_names[__RTN_MAX] = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002373 [RTN_UNSPEC] = "UNSPEC",
2374 [RTN_UNICAST] = "UNICAST",
2375 [RTN_LOCAL] = "LOCAL",
2376 [RTN_BROADCAST] = "BROADCAST",
2377 [RTN_ANYCAST] = "ANYCAST",
2378 [RTN_MULTICAST] = "MULTICAST",
2379 [RTN_BLACKHOLE] = "BLACKHOLE",
2380 [RTN_UNREACHABLE] = "UNREACHABLE",
2381 [RTN_PROHIBIT] = "PROHIBIT",
2382 [RTN_THROW] = "THROW",
2383 [RTN_NAT] = "NAT",
2384 [RTN_XRESOLVE] = "XRESOLVE",
2385};
2386
Eric Dumazet28d36e32008-01-14 23:09:56 -08002387static inline const char *rtn_type(char *buf, size_t len, unsigned t)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002388{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002389 if (t < __RTN_MAX && rtn_type_names[t])
2390 return rtn_type_names[t];
Eric Dumazet28d36e32008-01-14 23:09:56 -08002391 snprintf(buf, len, "type %u", t);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002392 return buf;
2393}
2394
2395/* Pretty print the trie */
Robert Olsson19baf832005-06-21 12:43:18 -07002396static int fib_trie_seq_show(struct seq_file *seq, void *v)
2397{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002398 const struct fib_trie_iter *iter = seq->private;
2399 struct node *n = v;
Robert Olsson19baf832005-06-21 12:43:18 -07002400
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002401 if (!node_parent_rcu(n))
2402 fib_table_print(seq, iter->tb);
Robert Olsson095b8502007-01-26 19:06:01 -08002403
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002404 if (IS_TNODE(n)) {
2405 struct tnode *tn = (struct tnode *) n;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07002406 __be32 prf = htonl(mask_pfx(tn->key, tn->pos));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002407
Robert Olsson1d25cd62005-09-19 15:29:52 -07002408 seq_indent(seq, iter->depth-1);
Harvey Harrison673d57e2008-10-31 00:53:57 -07002409 seq_printf(seq, " +-- %pI4/%d %d %d %d\n",
2410 &prf, tn->pos, tn->bits, tn->full_children,
Robert Olsson1d25cd62005-09-19 15:29:52 -07002411 tn->empty_children);
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002412
Olof Johansson91b9a272005-08-09 20:24:39 -07002413 } else {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002414 struct leaf *l = (struct leaf *) n;
Stephen Hemminger13280422008-01-22 21:54:37 -08002415 struct leaf_info *li;
2416 struct hlist_node *node;
Al Viro32ab5f82006-09-26 22:21:45 -07002417 __be32 val = htonl(l->key);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002418
2419 seq_indent(seq, iter->depth);
Harvey Harrison673d57e2008-10-31 00:53:57 -07002420 seq_printf(seq, " |-- %pI4\n", &val);
Eric Dumazet28d36e32008-01-14 23:09:56 -08002421
Stephen Hemminger13280422008-01-22 21:54:37 -08002422 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
2423 struct fib_alias *fa;
Eric Dumazet28d36e32008-01-14 23:09:56 -08002424
Stephen Hemminger13280422008-01-22 21:54:37 -08002425 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
2426 char buf1[32], buf2[32];
Eric Dumazet28d36e32008-01-14 23:09:56 -08002427
Stephen Hemminger13280422008-01-22 21:54:37 -08002428 seq_indent(seq, iter->depth+1);
2429 seq_printf(seq, " /%d %s %s", li->plen,
2430 rtn_scope(buf1, sizeof(buf1),
2431 fa->fa_scope),
2432 rtn_type(buf2, sizeof(buf2),
2433 fa->fa_type));
2434 if (fa->fa_tos)
Denis V. Lunevb9c4d822008-02-05 02:58:45 -08002435 seq_printf(seq, " tos=%d", fa->fa_tos);
Stephen Hemminger13280422008-01-22 21:54:37 -08002436 seq_putc(seq, '\n');
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002437 }
2438 }
Robert Olsson19baf832005-06-21 12:43:18 -07002439 }
2440
2441 return 0;
2442}
2443
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002444static const struct seq_operations fib_trie_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002445 .start = fib_trie_seq_start,
2446 .next = fib_trie_seq_next,
2447 .stop = fib_trie_seq_stop,
2448 .show = fib_trie_seq_show,
Robert Olsson19baf832005-06-21 12:43:18 -07002449};
2450
2451static int fib_trie_seq_open(struct inode *inode, struct file *file)
2452{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002453 return seq_open_net(inode, file, &fib_trie_seq_ops,
2454 sizeof(struct fib_trie_iter));
Robert Olsson19baf832005-06-21 12:43:18 -07002455}
2456
Arjan van de Ven9a321442007-02-12 00:55:35 -08002457static const struct file_operations fib_trie_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002458 .owner = THIS_MODULE,
2459 .open = fib_trie_seq_open,
2460 .read = seq_read,
2461 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002462 .release = seq_release_net,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002463};
2464
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002465struct fib_route_iter {
2466 struct seq_net_private p;
2467 struct trie *main_trie;
2468 loff_t pos;
2469 t_key key;
2470};
2471
2472static struct leaf *fib_route_get_idx(struct fib_route_iter *iter, loff_t pos)
2473{
2474 struct leaf *l = NULL;
2475 struct trie *t = iter->main_trie;
2476
2477 /* use cache location of last found key */
2478 if (iter->pos > 0 && pos >= iter->pos && (l = fib_find_node(t, iter->key)))
2479 pos -= iter->pos;
2480 else {
2481 iter->pos = 0;
2482 l = trie_firstleaf(t);
2483 }
2484
2485 while (l && pos-- > 0) {
2486 iter->pos++;
2487 l = trie_nextleaf(l);
2488 }
2489
2490 if (l)
2491 iter->key = pos; /* remember it */
2492 else
2493 iter->pos = 0; /* forget it */
2494
2495 return l;
2496}
2497
2498static void *fib_route_seq_start(struct seq_file *seq, loff_t *pos)
2499 __acquires(RCU)
2500{
2501 struct fib_route_iter *iter = seq->private;
2502 struct fib_table *tb;
2503
2504 rcu_read_lock();
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002505 tb = fib_get_table(seq_file_net(seq), RT_TABLE_MAIN);
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002506 if (!tb)
2507 return NULL;
2508
2509 iter->main_trie = (struct trie *) tb->tb_data;
2510 if (*pos == 0)
2511 return SEQ_START_TOKEN;
2512 else
2513 return fib_route_get_idx(iter, *pos - 1);
2514}
2515
2516static void *fib_route_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2517{
2518 struct fib_route_iter *iter = seq->private;
2519 struct leaf *l = v;
2520
2521 ++*pos;
2522 if (v == SEQ_START_TOKEN) {
2523 iter->pos = 0;
2524 l = trie_firstleaf(iter->main_trie);
2525 } else {
2526 iter->pos++;
2527 l = trie_nextleaf(l);
2528 }
2529
2530 if (l)
2531 iter->key = l->key;
2532 else
2533 iter->pos = 0;
2534 return l;
2535}
2536
2537static void fib_route_seq_stop(struct seq_file *seq, void *v)
2538 __releases(RCU)
2539{
2540 rcu_read_unlock();
2541}
2542
Al Viro32ab5f82006-09-26 22:21:45 -07002543static unsigned fib_flag_trans(int type, __be32 mask, const struct fib_info *fi)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002544{
2545 static unsigned type2flags[RTN_MAX + 1] = {
2546 [7] = RTF_REJECT, [8] = RTF_REJECT,
2547 };
2548 unsigned flags = type2flags[type];
2549
2550 if (fi && fi->fib_nh->nh_gw)
2551 flags |= RTF_GATEWAY;
Al Viro32ab5f82006-09-26 22:21:45 -07002552 if (mask == htonl(0xFFFFFFFF))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002553 flags |= RTF_HOST;
2554 flags |= RTF_UP;
2555 return flags;
2556}
2557
2558/*
2559 * This outputs /proc/net/route.
2560 * The format of the file is not supposed to be changed
2561 * and needs to be same as fib_hash output to avoid breaking
2562 * legacy utilities
2563 */
2564static int fib_route_seq_show(struct seq_file *seq, void *v)
2565{
2566 struct leaf *l = v;
Stephen Hemminger13280422008-01-22 21:54:37 -08002567 struct leaf_info *li;
2568 struct hlist_node *node;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002569
2570 if (v == SEQ_START_TOKEN) {
2571 seq_printf(seq, "%-127s\n", "Iface\tDestination\tGateway "
2572 "\tFlags\tRefCnt\tUse\tMetric\tMask\t\tMTU"
2573 "\tWindow\tIRTT");
2574 return 0;
2575 }
2576
Stephen Hemminger13280422008-01-22 21:54:37 -08002577 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002578 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07002579 __be32 mask, prefix;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002580
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002581 mask = inet_make_mask(li->plen);
2582 prefix = htonl(l->key);
2583
2584 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
Herbert Xu1371e372005-10-15 09:42:39 +10002585 const struct fib_info *fi = fa->fa_info;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002586 unsigned flags = fib_flag_trans(fa->fa_type, mask, fi);
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002587 int len;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002588
2589 if (fa->fa_type == RTN_BROADCAST
2590 || fa->fa_type == RTN_MULTICAST)
2591 continue;
2592
2593 if (fi)
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002594 seq_printf(seq,
2595 "%s\t%08X\t%08X\t%04X\t%d\t%u\t"
2596 "%d\t%08X\t%d\t%u\t%u%n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002597 fi->fib_dev ? fi->fib_dev->name : "*",
2598 prefix,
2599 fi->fib_nh->nh_gw, flags, 0, 0,
2600 fi->fib_priority,
2601 mask,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002602 (fi->fib_advmss ?
2603 fi->fib_advmss + 40 : 0),
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002604 fi->fib_window,
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002605 fi->fib_rtt >> 3, &len);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002606 else
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002607 seq_printf(seq,
2608 "*\t%08X\t%08X\t%04X\t%d\t%u\t"
2609 "%d\t%08X\t%d\t%u\t%u%n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002610 prefix, 0, flags, 0, 0, 0,
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002611 mask, 0, 0, 0, &len);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002612
Pavel Emelyanov5e659e42008-04-24 01:02:16 -07002613 seq_printf(seq, "%*s\n", 127 - len, "");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002614 }
2615 }
2616
2617 return 0;
2618}
2619
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002620static const struct seq_operations fib_route_seq_ops = {
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002621 .start = fib_route_seq_start,
2622 .next = fib_route_seq_next,
2623 .stop = fib_route_seq_stop,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002624 .show = fib_route_seq_show,
2625};
2626
2627static int fib_route_seq_open(struct inode *inode, struct file *file)
2628{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002629 return seq_open_net(inode, file, &fib_route_seq_ops,
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002630 sizeof(struct fib_route_iter));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002631}
2632
Arjan van de Ven9a321442007-02-12 00:55:35 -08002633static const struct file_operations fib_route_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002634 .owner = THIS_MODULE,
2635 .open = fib_route_seq_open,
2636 .read = seq_read,
2637 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002638 .release = seq_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002639};
2640
Denis V. Lunev61a02652008-01-10 03:21:09 -08002641int __net_init fib_proc_init(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002642{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002643 if (!proc_net_fops_create(net, "fib_trie", S_IRUGO, &fib_trie_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002644 goto out1;
2645
Denis V. Lunev61a02652008-01-10 03:21:09 -08002646 if (!proc_net_fops_create(net, "fib_triestat", S_IRUGO,
2647 &fib_triestat_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002648 goto out2;
2649
Denis V. Lunev61a02652008-01-10 03:21:09 -08002650 if (!proc_net_fops_create(net, "route", S_IRUGO, &fib_route_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002651 goto out3;
2652
Robert Olsson19baf832005-06-21 12:43:18 -07002653 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002654
2655out3:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002656 proc_net_remove(net, "fib_triestat");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002657out2:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002658 proc_net_remove(net, "fib_trie");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002659out1:
2660 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002661}
2662
Denis V. Lunev61a02652008-01-10 03:21:09 -08002663void __net_exit fib_proc_exit(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002664{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002665 proc_net_remove(net, "fib_trie");
2666 proc_net_remove(net, "fib_triestat");
2667 proc_net_remove(net, "route");
Robert Olsson19baf832005-06-21 12:43:18 -07002668}
2669
2670#endif /* CONFIG_PROC_FS */