blob: 9e491e70e8552fa213d826333c4ff31088ca5fe0 [file] [log] [blame]
Robert Olsson19baf832005-06-21 12:43:18 -07001/*
2 * This program is free software; you can redistribute it and/or
3 * modify it under the terms of the GNU General Public License
4 * as published by the Free Software Foundation; either version
5 * 2 of the License, or (at your option) any later version.
6 *
7 * Robert Olsson <robert.olsson@its.uu.se> Uppsala Universitet
8 * & Swedish University of Agricultural Sciences.
9 *
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090010 * Jens Laas <jens.laas@data.slu.se> Swedish University of
Robert Olsson19baf832005-06-21 12:43:18 -070011 * Agricultural Sciences.
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090012 *
Robert Olsson19baf832005-06-21 12:43:18 -070013 * Hans Liss <hans.liss@its.uu.se> Uppsala Universitet
14 *
15 * This work is based on the LPC-trie which is originally descibed in:
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +090016 *
Robert Olsson19baf832005-06-21 12:43:18 -070017 * An experimental study of compression methods for dynamic tries
18 * Stefan Nilsson and Matti Tikkanen. Algorithmica, 33(1):19-33, 2002.
19 * http://www.nada.kth.se/~snilsson/public/papers/dyntrie2/
20 *
21 *
22 * IP-address lookup using LC-tries. Stefan Nilsson and Gunnar Karlsson
23 * IEEE Journal on Selected Areas in Communications, 17(6):1083-1092, June 1999
24 *
25 * Version: $Id: fib_trie.c,v 1.3 2005/06/08 14:20:01 robert Exp $
26 *
27 *
28 * Code from fib_hash has been reused which includes the following header:
29 *
30 *
31 * INET An implementation of the TCP/IP protocol suite for the LINUX
32 * operating system. INET is implemented using the BSD Socket
33 * interface as the means of communication with the user level.
34 *
35 * IPv4 FIB: lookup engine and maintenance routines.
36 *
37 *
38 * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
39 *
40 * This program is free software; you can redistribute it and/or
41 * modify it under the terms of the GNU General Public License
42 * as published by the Free Software Foundation; either version
43 * 2 of the License, or (at your option) any later version.
Robert Olssonfd966252005-12-22 11:25:10 -080044 *
45 * Substantial contributions to this work comes from:
46 *
47 * David S. Miller, <davem@davemloft.net>
48 * Stephen Hemminger <shemminger@osdl.org>
49 * Paul E. McKenney <paulmck@us.ibm.com>
50 * Patrick McHardy <kaber@trash.net>
Robert Olsson19baf832005-06-21 12:43:18 -070051 */
52
Robert Olsson05eee482007-03-19 16:27:37 -070053#define VERSION "0.408"
Robert Olsson19baf832005-06-21 12:43:18 -070054
Robert Olsson19baf832005-06-21 12:43:18 -070055#include <asm/uaccess.h>
56#include <asm/system.h>
Jiri Slaby1977f032007-10-18 23:40:25 -070057#include <linux/bitops.h>
Robert Olsson19baf832005-06-21 12:43:18 -070058#include <linux/types.h>
59#include <linux/kernel.h>
Robert Olsson19baf832005-06-21 12:43:18 -070060#include <linux/mm.h>
61#include <linux/string.h>
62#include <linux/socket.h>
63#include <linux/sockios.h>
64#include <linux/errno.h>
65#include <linux/in.h>
66#include <linux/inet.h>
Stephen Hemmingercd8787a2006-01-03 14:38:34 -080067#include <linux/inetdevice.h>
Robert Olsson19baf832005-06-21 12:43:18 -070068#include <linux/netdevice.h>
69#include <linux/if_arp.h>
70#include <linux/proc_fs.h>
Robert Olsson2373ce12005-08-25 13:01:29 -070071#include <linux/rcupdate.h>
Robert Olsson19baf832005-06-21 12:43:18 -070072#include <linux/skbuff.h>
73#include <linux/netlink.h>
74#include <linux/init.h>
75#include <linux/list.h>
Eric W. Biederman457c4cb2007-09-12 12:01:34 +020076#include <net/net_namespace.h>
Robert Olsson19baf832005-06-21 12:43:18 -070077#include <net/ip.h>
78#include <net/protocol.h>
79#include <net/route.h>
80#include <net/tcp.h>
81#include <net/sock.h>
82#include <net/ip_fib.h>
83#include "fib_lookup.h"
84
Robert Olsson06ef9212006-03-20 21:35:01 -080085#define MAX_STAT_DEPTH 32
Robert Olsson19baf832005-06-21 12:43:18 -070086
Robert Olsson19baf832005-06-21 12:43:18 -070087#define KEYLENGTH (8*sizeof(t_key))
Robert Olsson19baf832005-06-21 12:43:18 -070088
Robert Olsson19baf832005-06-21 12:43:18 -070089typedef unsigned int t_key;
90
91#define T_TNODE 0
92#define T_LEAF 1
93#define NODE_TYPE_MASK 0x1UL
Robert Olsson2373ce12005-08-25 13:01:29 -070094#define NODE_TYPE(node) ((node)->parent & NODE_TYPE_MASK)
95
Olof Johansson91b9a272005-08-09 20:24:39 -070096#define IS_TNODE(n) (!(n->parent & T_LEAF))
97#define IS_LEAF(n) (n->parent & T_LEAF)
Robert Olsson19baf832005-06-21 12:43:18 -070098
99struct node {
Olof Johansson91b9a272005-08-09 20:24:39 -0700100 unsigned long parent;
Eric Dumazet8d965442008-01-13 22:31:44 -0800101 t_key key;
Robert Olsson19baf832005-06-21 12:43:18 -0700102};
103
104struct leaf {
Olof Johansson91b9a272005-08-09 20:24:39 -0700105 unsigned long parent;
Eric Dumazet8d965442008-01-13 22:31:44 -0800106 t_key key;
Robert Olsson19baf832005-06-21 12:43:18 -0700107 struct hlist_head list;
Robert Olsson2373ce12005-08-25 13:01:29 -0700108 struct rcu_head rcu;
Robert Olsson19baf832005-06-21 12:43:18 -0700109};
110
111struct leaf_info {
112 struct hlist_node hlist;
Robert Olsson2373ce12005-08-25 13:01:29 -0700113 struct rcu_head rcu;
Robert Olsson19baf832005-06-21 12:43:18 -0700114 int plen;
115 struct list_head falh;
116};
117
118struct tnode {
Olof Johansson91b9a272005-08-09 20:24:39 -0700119 unsigned long parent;
Eric Dumazet8d965442008-01-13 22:31:44 -0800120 t_key key;
Eric Dumazet112d8cf2008-01-12 21:27:41 -0800121 unsigned char pos; /* 2log(KEYLENGTH) bits needed */
122 unsigned char bits; /* 2log(KEYLENGTH) bits needed */
Eric Dumazet8d965442008-01-13 22:31:44 -0800123 unsigned int full_children; /* KEYLENGTH bits needed */
124 unsigned int empty_children; /* KEYLENGTH bits needed */
Robert Olsson2373ce12005-08-25 13:01:29 -0700125 struct rcu_head rcu;
Olof Johansson91b9a272005-08-09 20:24:39 -0700126 struct node *child[0];
Robert Olsson19baf832005-06-21 12:43:18 -0700127};
128
129#ifdef CONFIG_IP_FIB_TRIE_STATS
130struct trie_use_stats {
131 unsigned int gets;
132 unsigned int backtrack;
133 unsigned int semantic_match_passed;
134 unsigned int semantic_match_miss;
135 unsigned int null_node_hit;
Robert Olsson2f368952005-07-05 15:02:40 -0700136 unsigned int resize_node_skipped;
Robert Olsson19baf832005-06-21 12:43:18 -0700137};
138#endif
139
140struct trie_stat {
141 unsigned int totdepth;
142 unsigned int maxdepth;
143 unsigned int tnodes;
144 unsigned int leaves;
145 unsigned int nullpointers;
Stephen Hemminger93672292008-01-22 21:54:05 -0800146 unsigned int prefixes;
Robert Olsson06ef9212006-03-20 21:35:01 -0800147 unsigned int nodesizes[MAX_STAT_DEPTH];
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700148};
Robert Olsson19baf832005-06-21 12:43:18 -0700149
150struct trie {
Olof Johansson91b9a272005-08-09 20:24:39 -0700151 struct node *trie;
Robert Olsson19baf832005-06-21 12:43:18 -0700152#ifdef CONFIG_IP_FIB_TRIE_STATS
153 struct trie_use_stats stats;
154#endif
Robert Olsson19baf832005-06-21 12:43:18 -0700155};
156
Robert Olsson19baf832005-06-21 12:43:18 -0700157static void put_child(struct trie *t, struct tnode *tn, int i, struct node *n);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800158static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n,
159 int wasfull);
Robert Olsson19baf832005-06-21 12:43:18 -0700160static struct node *resize(struct trie *t, struct tnode *tn);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700161static struct tnode *inflate(struct trie *t, struct tnode *tn);
162static struct tnode *halve(struct trie *t, struct tnode *tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700163static void tnode_free(struct tnode *tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700164
Christoph Lametere18b8902006-12-06 20:33:20 -0800165static struct kmem_cache *fn_alias_kmem __read_mostly;
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -0800166static struct kmem_cache *trie_leaf_kmem __read_mostly;
Robert Olsson19baf832005-06-21 12:43:18 -0700167
Stephen Hemminger06801912007-08-10 15:22:13 -0700168static inline struct tnode *node_parent(struct node *node)
169{
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800170 return (struct tnode *)(node->parent & ~NODE_TYPE_MASK);
171}
Stephen Hemminger06801912007-08-10 15:22:13 -0700172
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800173static inline struct tnode *node_parent_rcu(struct node *node)
174{
175 struct tnode *ret = node_parent(node);
176
Stephen Hemminger06801912007-08-10 15:22:13 -0700177 return rcu_dereference(ret);
178}
179
Stephen Hemminger6440cc92008-03-22 17:59:58 -0700180/* Same as rcu_assign_pointer
181 * but that macro() assumes that value is a pointer.
182 */
Stephen Hemminger06801912007-08-10 15:22:13 -0700183static inline void node_set_parent(struct node *node, struct tnode *ptr)
184{
Stephen Hemminger6440cc92008-03-22 17:59:58 -0700185 smp_wmb();
186 node->parent = (unsigned long)ptr | NODE_TYPE(node);
Stephen Hemminger06801912007-08-10 15:22:13 -0700187}
Robert Olsson2373ce12005-08-25 13:01:29 -0700188
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800189static inline struct node *tnode_get_child(struct tnode *tn, unsigned int i)
Robert Olsson19baf832005-06-21 12:43:18 -0700190{
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800191 BUG_ON(i >= 1U << tn->bits);
Robert Olsson19baf832005-06-21 12:43:18 -0700192
Eric Dumazetb59cfbf2008-01-18 03:31:36 -0800193 return tn->child[i];
194}
195
196static inline struct node *tnode_get_child_rcu(struct tnode *tn, unsigned int i)
197{
198 struct node *ret = tnode_get_child(tn, i);
199
200 return rcu_dereference(ret);
Robert Olsson19baf832005-06-21 12:43:18 -0700201}
202
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700203static inline int tnode_child_length(const struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700204{
Olof Johansson91b9a272005-08-09 20:24:39 -0700205 return 1 << tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -0700206}
207
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700208static inline t_key mask_pfx(t_key k, unsigned short l)
209{
210 return (l == 0) ? 0 : k >> (KEYLENGTH-l) << (KEYLENGTH-l);
211}
212
Robert Olsson19baf832005-06-21 12:43:18 -0700213static inline t_key tkey_extract_bits(t_key a, int offset, int bits)
214{
Olof Johansson91b9a272005-08-09 20:24:39 -0700215 if (offset < KEYLENGTH)
Robert Olsson19baf832005-06-21 12:43:18 -0700216 return ((t_key)(a << offset)) >> (KEYLENGTH - bits);
Olof Johansson91b9a272005-08-09 20:24:39 -0700217 else
Robert Olsson19baf832005-06-21 12:43:18 -0700218 return 0;
219}
220
221static inline int tkey_equals(t_key a, t_key b)
222{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700223 return a == b;
Robert Olsson19baf832005-06-21 12:43:18 -0700224}
225
226static inline int tkey_sub_equals(t_key a, int offset, int bits, t_key b)
227{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700228 if (bits == 0 || offset >= KEYLENGTH)
229 return 1;
Olof Johansson91b9a272005-08-09 20:24:39 -0700230 bits = bits > KEYLENGTH ? KEYLENGTH : bits;
231 return ((a ^ b) << offset) >> (KEYLENGTH - bits) == 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700232}
Robert Olsson19baf832005-06-21 12:43:18 -0700233
234static inline int tkey_mismatch(t_key a, int offset, t_key b)
235{
236 t_key diff = a ^ b;
237 int i = offset;
238
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700239 if (!diff)
240 return 0;
241 while ((diff << i) >> (KEYLENGTH-1) == 0)
Robert Olsson19baf832005-06-21 12:43:18 -0700242 i++;
243 return i;
244}
245
Robert Olsson19baf832005-06-21 12:43:18 -0700246/*
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900247 To understand this stuff, an understanding of keys and all their bits is
248 necessary. Every node in the trie has a key associated with it, but not
Robert Olsson19baf832005-06-21 12:43:18 -0700249 all of the bits in that key are significant.
250
251 Consider a node 'n' and its parent 'tp'.
252
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900253 If n is a leaf, every bit in its key is significant. Its presence is
254 necessitated by path compression, since during a tree traversal (when
255 searching for a leaf - unless we are doing an insertion) we will completely
256 ignore all skipped bits we encounter. Thus we need to verify, at the end of
257 a potentially successful search, that we have indeed been walking the
Robert Olsson19baf832005-06-21 12:43:18 -0700258 correct key path.
259
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900260 Note that we can never "miss" the correct key in the tree if present by
261 following the wrong path. Path compression ensures that segments of the key
262 that are the same for all keys with a given prefix are skipped, but the
263 skipped part *is* identical for each node in the subtrie below the skipped
264 bit! trie_insert() in this implementation takes care of that - note the
Robert Olsson19baf832005-06-21 12:43:18 -0700265 call to tkey_sub_equals() in trie_insert().
266
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900267 if n is an internal node - a 'tnode' here, the various parts of its key
Robert Olsson19baf832005-06-21 12:43:18 -0700268 have many different meanings.
269
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900270 Example:
Robert Olsson19baf832005-06-21 12:43:18 -0700271 _________________________________________________________________
272 | i | i | i | i | i | i | i | N | N | N | S | S | S | S | S | C |
273 -----------------------------------------------------------------
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900274 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
Robert Olsson19baf832005-06-21 12:43:18 -0700275
276 _________________________________________________________________
277 | C | C | C | u | u | u | u | u | u | u | u | u | u | u | u | u |
278 -----------------------------------------------------------------
279 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31
280
281 tp->pos = 7
282 tp->bits = 3
283 n->pos = 15
Olof Johansson91b9a272005-08-09 20:24:39 -0700284 n->bits = 4
Robert Olsson19baf832005-06-21 12:43:18 -0700285
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900286 First, let's just ignore the bits that come before the parent tp, that is
287 the bits from 0 to (tp->pos-1). They are *known* but at this point we do
Robert Olsson19baf832005-06-21 12:43:18 -0700288 not use them for anything.
289
290 The bits from (tp->pos) to (tp->pos + tp->bits - 1) - "N", above - are the
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900291 index into the parent's child array. That is, they will be used to find
Robert Olsson19baf832005-06-21 12:43:18 -0700292 'n' among tp's children.
293
294 The bits from (tp->pos + tp->bits) to (n->pos - 1) - "S" - are skipped bits
295 for the node n.
296
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900297 All the bits we have seen so far are significant to the node n. The rest
Robert Olsson19baf832005-06-21 12:43:18 -0700298 of the bits are really not needed or indeed known in n->key.
299
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900300 The bits from (n->pos) to (n->pos + n->bits - 1) - "C" - are the index into
Robert Olsson19baf832005-06-21 12:43:18 -0700301 n's child array, and will of course be different for each child.
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900302
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700303
Robert Olsson19baf832005-06-21 12:43:18 -0700304 The rest of the bits, from (n->pos + n->bits) onward, are completely unknown
305 at this point.
306
307*/
308
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700309static inline void check_tnode(const struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700310{
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700311 WARN_ON(tn && tn->pos+tn->bits > 32);
Robert Olsson19baf832005-06-21 12:43:18 -0700312}
313
Denis V. Lunevf5026fa2007-12-13 09:47:57 -0800314static const int halve_threshold = 25;
315static const int inflate_threshold = 50;
316static const int halve_threshold_root = 8;
317static const int inflate_threshold_root = 15;
Robert Olsson19baf832005-06-21 12:43:18 -0700318
Robert Olsson2373ce12005-08-25 13:01:29 -0700319
320static void __alias_free_mem(struct rcu_head *head)
321{
322 struct fib_alias *fa = container_of(head, struct fib_alias, rcu);
323 kmem_cache_free(fn_alias_kmem, fa);
324}
325
326static inline void alias_free_mem_rcu(struct fib_alias *fa)
327{
328 call_rcu(&fa->rcu, __alias_free_mem);
329}
330
331static void __leaf_free_rcu(struct rcu_head *head)
332{
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -0800333 struct leaf *l = container_of(head, struct leaf, rcu);
334 kmem_cache_free(trie_leaf_kmem, l);
Robert Olsson2373ce12005-08-25 13:01:29 -0700335}
336
Robert Olsson2373ce12005-08-25 13:01:29 -0700337static void __leaf_info_free_rcu(struct rcu_head *head)
338{
339 kfree(container_of(head, struct leaf_info, rcu));
340}
341
342static inline void free_leaf_info(struct leaf_info *leaf)
343{
344 call_rcu(&leaf->rcu, __leaf_info_free_rcu);
345}
346
Eric Dumazet8d965442008-01-13 22:31:44 -0800347static struct tnode *tnode_alloc(size_t size)
Robert Olsson2373ce12005-08-25 13:01:29 -0700348{
349 struct page *pages;
350
351 if (size <= PAGE_SIZE)
Eric Dumazet8d965442008-01-13 22:31:44 -0800352 return kzalloc(size, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -0700353
354 pages = alloc_pages(GFP_KERNEL|__GFP_ZERO, get_order(size));
355 if (!pages)
356 return NULL;
357
358 return page_address(pages);
359}
360
361static void __tnode_free_rcu(struct rcu_head *head)
362{
363 struct tnode *tn = container_of(head, struct tnode, rcu);
Eric Dumazet8d965442008-01-13 22:31:44 -0800364 size_t size = sizeof(struct tnode) +
365 (sizeof(struct node *) << tn->bits);
Robert Olsson2373ce12005-08-25 13:01:29 -0700366
367 if (size <= PAGE_SIZE)
368 kfree(tn);
369 else
370 free_pages((unsigned long)tn, get_order(size));
371}
372
373static inline void tnode_free(struct tnode *tn)
374{
Stephen Hemminger132adf52007-03-08 20:44:43 -0800375 if (IS_LEAF(tn)) {
Robert Olsson550e29b2006-04-04 12:53:35 -0700376 struct leaf *l = (struct leaf *) tn;
377 call_rcu_bh(&l->rcu, __leaf_free_rcu);
Stephen Hemminger132adf52007-03-08 20:44:43 -0800378 } else
Robert Olsson550e29b2006-04-04 12:53:35 -0700379 call_rcu(&tn->rcu, __tnode_free_rcu);
Robert Olsson2373ce12005-08-25 13:01:29 -0700380}
381
Robert Olsson19baf832005-06-21 12:43:18 -0700382static struct leaf *leaf_new(void)
383{
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -0800384 struct leaf *l = kmem_cache_alloc(trie_leaf_kmem, GFP_KERNEL);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700385 if (l) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700386 l->parent = T_LEAF;
Robert Olsson19baf832005-06-21 12:43:18 -0700387 INIT_HLIST_HEAD(&l->list);
388 }
389 return l;
390}
391
392static struct leaf_info *leaf_info_new(int plen)
393{
394 struct leaf_info *li = kmalloc(sizeof(struct leaf_info), GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -0700395 if (li) {
396 li->plen = plen;
397 INIT_LIST_HEAD(&li->falh);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700398 }
Robert Olsson2373ce12005-08-25 13:01:29 -0700399 return li;
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700400}
401
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800402static struct tnode *tnode_new(t_key key, int pos, int bits)
Robert Olsson19baf832005-06-21 12:43:18 -0700403{
Eric Dumazet8d965442008-01-13 22:31:44 -0800404 size_t sz = sizeof(struct tnode) + (sizeof(struct node *) << bits);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700405 struct tnode *tn = tnode_alloc(sz);
Robert Olsson19baf832005-06-21 12:43:18 -0700406
Olof Johansson91b9a272005-08-09 20:24:39 -0700407 if (tn) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700408 tn->parent = T_TNODE;
Robert Olsson19baf832005-06-21 12:43:18 -0700409 tn->pos = pos;
410 tn->bits = bits;
411 tn->key = key;
412 tn->full_children = 0;
413 tn->empty_children = 1<<bits;
414 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700415
Eric Dumazet8d965442008-01-13 22:31:44 -0800416 pr_debug("AT %p s=%u %lu\n", tn, (unsigned int) sizeof(struct tnode),
417 (unsigned long) (sizeof(struct node) << bits));
Robert Olsson19baf832005-06-21 12:43:18 -0700418 return tn;
419}
420
Robert Olsson19baf832005-06-21 12:43:18 -0700421/*
422 * Check whether a tnode 'n' is "full", i.e. it is an internal node
423 * and no bits are skipped. See discussion in dyntree paper p. 6
424 */
425
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700426static inline int tnode_full(const struct tnode *tn, const struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700427{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700428 if (n == NULL || IS_LEAF(n))
Robert Olsson19baf832005-06-21 12:43:18 -0700429 return 0;
430
431 return ((struct tnode *) n)->pos == tn->pos + tn->bits;
432}
433
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800434static inline void put_child(struct trie *t, struct tnode *tn, int i,
435 struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700436{
437 tnode_put_child_reorg(tn, i, n, -1);
438}
439
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700440 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700441 * Add a child at position i overwriting the old value.
442 * Update the value of full_children and empty_children.
443 */
444
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800445static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n,
446 int wasfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700447{
Robert Olsson2373ce12005-08-25 13:01:29 -0700448 struct node *chi = tn->child[i];
Robert Olsson19baf832005-06-21 12:43:18 -0700449 int isfull;
450
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700451 BUG_ON(i >= 1<<tn->bits);
452
Robert Olsson19baf832005-06-21 12:43:18 -0700453 /* update emptyChildren */
454 if (n == NULL && chi != NULL)
455 tn->empty_children++;
456 else if (n != NULL && chi == NULL)
457 tn->empty_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700458
Robert Olsson19baf832005-06-21 12:43:18 -0700459 /* update fullChildren */
Olof Johansson91b9a272005-08-09 20:24:39 -0700460 if (wasfull == -1)
Robert Olsson19baf832005-06-21 12:43:18 -0700461 wasfull = tnode_full(tn, chi);
462
463 isfull = tnode_full(tn, n);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700464 if (wasfull && !isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700465 tn->full_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700466 else if (!wasfull && isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700467 tn->full_children++;
Olof Johansson91b9a272005-08-09 20:24:39 -0700468
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700469 if (n)
Stephen Hemminger06801912007-08-10 15:22:13 -0700470 node_set_parent(n, tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700471
Robert Olsson2373ce12005-08-25 13:01:29 -0700472 rcu_assign_pointer(tn->child[i], n);
Robert Olsson19baf832005-06-21 12:43:18 -0700473}
474
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700475static struct node *resize(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700476{
477 int i;
Robert Olsson2f368952005-07-05 15:02:40 -0700478 int err = 0;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700479 struct tnode *old_tn;
Robert Olssone6308be2005-10-04 13:01:58 -0700480 int inflate_threshold_use;
481 int halve_threshold_use;
Robert Olsson05eee482007-03-19 16:27:37 -0700482 int max_resize;
Robert Olsson19baf832005-06-21 12:43:18 -0700483
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900484 if (!tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700485 return NULL;
486
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700487 pr_debug("In tnode_resize %p inflate_threshold=%d threshold=%d\n",
488 tn, inflate_threshold, halve_threshold);
Robert Olsson19baf832005-06-21 12:43:18 -0700489
490 /* No children */
491 if (tn->empty_children == tnode_child_length(tn)) {
492 tnode_free(tn);
493 return NULL;
494 }
495 /* One child */
496 if (tn->empty_children == tnode_child_length(tn) - 1)
497 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700498 struct node *n;
Robert Olsson19baf832005-06-21 12:43:18 -0700499
Olof Johansson91b9a272005-08-09 20:24:39 -0700500 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700501 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700502 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700503
504 /* compress one level */
Stephen Hemminger06801912007-08-10 15:22:13 -0700505 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700506 tnode_free(tn);
507 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700508 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700509 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700510 * Double as long as the resulting node has a number of
511 * nonempty nodes that are above the threshold.
512 */
513
514 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700515 * From "Implementing a dynamic compressed trie" by Stefan Nilsson of
516 * the Helsinki University of Technology and Matti Tikkanen of Nokia
Robert Olsson19baf832005-06-21 12:43:18 -0700517 * Telecommunications, page 6:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700518 * "A node is doubled if the ratio of non-empty children to all
Robert Olsson19baf832005-06-21 12:43:18 -0700519 * children in the *doubled* node is at least 'high'."
520 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700521 * 'high' in this instance is the variable 'inflate_threshold'. It
522 * is expressed as a percentage, so we multiply it with
523 * tnode_child_length() and instead of multiplying by 2 (since the
524 * child array will be doubled by inflate()) and multiplying
525 * the left-hand side by 100 (to handle the percentage thing) we
Robert Olsson19baf832005-06-21 12:43:18 -0700526 * multiply the left-hand side by 50.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700527 *
528 * The left-hand side may look a bit weird: tnode_child_length(tn)
529 * - tn->empty_children is of course the number of non-null children
530 * in the current node. tn->full_children is the number of "full"
Robert Olsson19baf832005-06-21 12:43:18 -0700531 * children, that is non-null tnodes with a skip value of 0.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700532 * All of those will be doubled in the resulting inflated tnode, so
Robert Olsson19baf832005-06-21 12:43:18 -0700533 * we just count them one extra time here.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700534 *
Robert Olsson19baf832005-06-21 12:43:18 -0700535 * A clearer way to write this would be:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700536 *
Robert Olsson19baf832005-06-21 12:43:18 -0700537 * to_be_doubled = tn->full_children;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700538 * not_to_be_doubled = tnode_child_length(tn) - tn->empty_children -
Robert Olsson19baf832005-06-21 12:43:18 -0700539 * tn->full_children;
540 *
541 * new_child_length = tnode_child_length(tn) * 2;
542 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700543 * new_fill_factor = 100 * (not_to_be_doubled + 2*to_be_doubled) /
Robert Olsson19baf832005-06-21 12:43:18 -0700544 * new_child_length;
545 * if (new_fill_factor >= inflate_threshold)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700546 *
547 * ...and so on, tho it would mess up the while () loop.
548 *
Robert Olsson19baf832005-06-21 12:43:18 -0700549 * anyway,
550 * 100 * (not_to_be_doubled + 2*to_be_doubled) / new_child_length >=
551 * inflate_threshold
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700552 *
Robert Olsson19baf832005-06-21 12:43:18 -0700553 * avoid a division:
554 * 100 * (not_to_be_doubled + 2*to_be_doubled) >=
555 * inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700556 *
Robert Olsson19baf832005-06-21 12:43:18 -0700557 * expand not_to_be_doubled and to_be_doubled, and shorten:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700558 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700559 * tn->full_children) >= inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700560 *
Robert Olsson19baf832005-06-21 12:43:18 -0700561 * expand new_child_length:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700562 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700563 * tn->full_children) >=
Robert Olsson19baf832005-06-21 12:43:18 -0700564 * inflate_threshold * tnode_child_length(tn) * 2
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700565 *
Robert Olsson19baf832005-06-21 12:43:18 -0700566 * shorten again:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700567 * 50 * (tn->full_children + tnode_child_length(tn) -
Olof Johansson91b9a272005-08-09 20:24:39 -0700568 * tn->empty_children) >= inflate_threshold *
Robert Olsson19baf832005-06-21 12:43:18 -0700569 * tnode_child_length(tn)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700570 *
Robert Olsson19baf832005-06-21 12:43:18 -0700571 */
572
573 check_tnode(tn);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700574
Robert Olssone6308be2005-10-04 13:01:58 -0700575 /* Keep root node larger */
576
Stephen Hemminger132adf52007-03-08 20:44:43 -0800577 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700578 inflate_threshold_use = inflate_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900579 else
Robert Olssone6308be2005-10-04 13:01:58 -0700580 inflate_threshold_use = inflate_threshold;
581
Robert Olsson2f368952005-07-05 15:02:40 -0700582 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700583 max_resize = 10;
584 while ((tn->full_children > 0 && max_resize-- &&
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800585 50 * (tn->full_children + tnode_child_length(tn)
586 - tn->empty_children)
587 >= inflate_threshold_use * tnode_child_length(tn))) {
Robert Olsson19baf832005-06-21 12:43:18 -0700588
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700589 old_tn = tn;
590 tn = inflate(t, tn);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800591
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700592 if (IS_ERR(tn)) {
593 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700594#ifdef CONFIG_IP_FIB_TRIE_STATS
595 t->stats.resize_node_skipped++;
596#endif
597 break;
598 }
Robert Olsson19baf832005-06-21 12:43:18 -0700599 }
600
Robert Olsson05eee482007-03-19 16:27:37 -0700601 if (max_resize < 0) {
602 if (!tn->parent)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800603 pr_warning("Fix inflate_threshold_root."
604 " Now=%d size=%d bits\n",
605 inflate_threshold_root, tn->bits);
Robert Olsson05eee482007-03-19 16:27:37 -0700606 else
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800607 pr_warning("Fix inflate_threshold."
608 " Now=%d size=%d bits\n",
609 inflate_threshold, tn->bits);
Robert Olsson05eee482007-03-19 16:27:37 -0700610 }
611
Robert Olsson19baf832005-06-21 12:43:18 -0700612 check_tnode(tn);
613
614 /*
615 * Halve as long as the number of empty children in this
616 * node is above threshold.
617 */
Robert Olsson2f368952005-07-05 15:02:40 -0700618
Robert Olssone6308be2005-10-04 13:01:58 -0700619
620 /* Keep root node larger */
621
Stephen Hemminger132adf52007-03-08 20:44:43 -0800622 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700623 halve_threshold_use = halve_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900624 else
Robert Olssone6308be2005-10-04 13:01:58 -0700625 halve_threshold_use = halve_threshold;
626
Robert Olsson2f368952005-07-05 15:02:40 -0700627 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700628 max_resize = 10;
629 while (tn->bits > 1 && max_resize-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700630 100 * (tnode_child_length(tn) - tn->empty_children) <
Robert Olssone6308be2005-10-04 13:01:58 -0700631 halve_threshold_use * tnode_child_length(tn)) {
Robert Olsson19baf832005-06-21 12:43:18 -0700632
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700633 old_tn = tn;
634 tn = halve(t, tn);
635 if (IS_ERR(tn)) {
636 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700637#ifdef CONFIG_IP_FIB_TRIE_STATS
638 t->stats.resize_node_skipped++;
639#endif
640 break;
641 }
642 }
643
Robert Olsson05eee482007-03-19 16:27:37 -0700644 if (max_resize < 0) {
645 if (!tn->parent)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800646 pr_warning("Fix halve_threshold_root."
647 " Now=%d size=%d bits\n",
648 halve_threshold_root, tn->bits);
Robert Olsson05eee482007-03-19 16:27:37 -0700649 else
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800650 pr_warning("Fix halve_threshold."
651 " Now=%d size=%d bits\n",
652 halve_threshold, tn->bits);
Robert Olsson05eee482007-03-19 16:27:37 -0700653 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700654
Robert Olsson19baf832005-06-21 12:43:18 -0700655 /* Only one child remains */
Robert Olsson19baf832005-06-21 12:43:18 -0700656 if (tn->empty_children == tnode_child_length(tn) - 1)
657 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700658 struct node *n;
659
Olof Johansson91b9a272005-08-09 20:24:39 -0700660 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700661 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700662 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700663
664 /* compress one level */
665
Stephen Hemminger06801912007-08-10 15:22:13 -0700666 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700667 tnode_free(tn);
668 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700669 }
670
671 return (struct node *) tn;
672}
673
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700674static struct tnode *inflate(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700675{
Robert Olsson19baf832005-06-21 12:43:18 -0700676 struct tnode *oldtnode = tn;
677 int olen = tnode_child_length(tn);
678 int i;
679
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700680 pr_debug("In inflate\n");
Robert Olsson19baf832005-06-21 12:43:18 -0700681
682 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits + 1);
683
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700684 if (!tn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700685 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700686
687 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700688 * Preallocate and store tnodes before the actual work so we
689 * don't get into an inconsistent state if memory allocation
690 * fails. In case of failure we return the oldnode and inflate
Robert Olsson2f368952005-07-05 15:02:40 -0700691 * of tnode is ignored.
692 */
Olof Johansson91b9a272005-08-09 20:24:39 -0700693
694 for (i = 0; i < olen; i++) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800695 struct tnode *inode;
Robert Olsson2f368952005-07-05 15:02:40 -0700696
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800697 inode = (struct tnode *) tnode_get_child(oldtnode, i);
Robert Olsson2f368952005-07-05 15:02:40 -0700698 if (inode &&
699 IS_TNODE(inode) &&
700 inode->pos == oldtnode->pos + oldtnode->bits &&
701 inode->bits > 1) {
702 struct tnode *left, *right;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700703 t_key m = ~0U << (KEYLENGTH - 1) >> inode->pos;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700704
Robert Olsson2f368952005-07-05 15:02:40 -0700705 left = tnode_new(inode->key&(~m), inode->pos + 1,
706 inode->bits - 1);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700707 if (!left)
708 goto nomem;
Olof Johansson91b9a272005-08-09 20:24:39 -0700709
Robert Olsson2f368952005-07-05 15:02:40 -0700710 right = tnode_new(inode->key|m, inode->pos + 1,
711 inode->bits - 1);
712
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900713 if (!right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700714 tnode_free(left);
715 goto nomem;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900716 }
Robert Olsson2f368952005-07-05 15:02:40 -0700717
718 put_child(t, tn, 2*i, (struct node *) left);
719 put_child(t, tn, 2*i+1, (struct node *) right);
720 }
721 }
722
Olof Johansson91b9a272005-08-09 20:24:39 -0700723 for (i = 0; i < olen; i++) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -0800724 struct tnode *inode;
Robert Olsson19baf832005-06-21 12:43:18 -0700725 struct node *node = tnode_get_child(oldtnode, i);
Olof Johansson91b9a272005-08-09 20:24:39 -0700726 struct tnode *left, *right;
727 int size, j;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700728
Robert Olsson19baf832005-06-21 12:43:18 -0700729 /* An empty child */
730 if (node == NULL)
731 continue;
732
733 /* A leaf or an internal node with skipped bits */
734
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700735 if (IS_LEAF(node) || ((struct tnode *) node)->pos >
Robert Olsson19baf832005-06-21 12:43:18 -0700736 tn->pos + tn->bits - 1) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800737 if (tkey_extract_bits(node->key,
738 oldtnode->pos + oldtnode->bits,
739 1) == 0)
Robert Olsson19baf832005-06-21 12:43:18 -0700740 put_child(t, tn, 2*i, node);
741 else
742 put_child(t, tn, 2*i+1, node);
743 continue;
744 }
745
746 /* An internal node with two children */
747 inode = (struct tnode *) node;
748
749 if (inode->bits == 1) {
750 put_child(t, tn, 2*i, inode->child[0]);
751 put_child(t, tn, 2*i+1, inode->child[1]);
752
753 tnode_free(inode);
Olof Johansson91b9a272005-08-09 20:24:39 -0700754 continue;
Robert Olsson19baf832005-06-21 12:43:18 -0700755 }
756
Olof Johansson91b9a272005-08-09 20:24:39 -0700757 /* An internal node with more than two children */
Robert Olsson19baf832005-06-21 12:43:18 -0700758
Olof Johansson91b9a272005-08-09 20:24:39 -0700759 /* We will replace this node 'inode' with two new
760 * ones, 'left' and 'right', each with half of the
761 * original children. The two new nodes will have
762 * a position one bit further down the key and this
763 * means that the "significant" part of their keys
764 * (see the discussion near the top of this file)
765 * will differ by one bit, which will be "0" in
766 * left's key and "1" in right's key. Since we are
767 * moving the key position by one step, the bit that
768 * we are moving away from - the bit at position
769 * (inode->pos) - is the one that will differ between
770 * left and right. So... we synthesize that bit in the
771 * two new keys.
772 * The mask 'm' below will be a single "one" bit at
773 * the position (inode->pos)
774 */
Robert Olsson19baf832005-06-21 12:43:18 -0700775
Olof Johansson91b9a272005-08-09 20:24:39 -0700776 /* Use the old key, but set the new significant
777 * bit to zero.
778 */
Robert Olsson19baf832005-06-21 12:43:18 -0700779
Olof Johansson91b9a272005-08-09 20:24:39 -0700780 left = (struct tnode *) tnode_get_child(tn, 2*i);
781 put_child(t, tn, 2*i, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -0700782
Olof Johansson91b9a272005-08-09 20:24:39 -0700783 BUG_ON(!left);
Robert Olsson2f368952005-07-05 15:02:40 -0700784
Olof Johansson91b9a272005-08-09 20:24:39 -0700785 right = (struct tnode *) tnode_get_child(tn, 2*i+1);
786 put_child(t, tn, 2*i+1, NULL);
Robert Olsson2f368952005-07-05 15:02:40 -0700787
Olof Johansson91b9a272005-08-09 20:24:39 -0700788 BUG_ON(!right);
Robert Olsson2f368952005-07-05 15:02:40 -0700789
Olof Johansson91b9a272005-08-09 20:24:39 -0700790 size = tnode_child_length(left);
791 for (j = 0; j < size; j++) {
792 put_child(t, left, j, inode->child[j]);
793 put_child(t, right, j, inode->child[j + size]);
Robert Olsson19baf832005-06-21 12:43:18 -0700794 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700795 put_child(t, tn, 2*i, resize(t, left));
796 put_child(t, tn, 2*i+1, resize(t, right));
797
798 tnode_free(inode);
Robert Olsson19baf832005-06-21 12:43:18 -0700799 }
800 tnode_free(oldtnode);
801 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700802nomem:
803 {
804 int size = tnode_child_length(tn);
805 int j;
806
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700807 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700808 if (tn->child[j])
809 tnode_free((struct tnode *)tn->child[j]);
810
811 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700812
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700813 return ERR_PTR(-ENOMEM);
814 }
Robert Olsson19baf832005-06-21 12:43:18 -0700815}
816
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700817static struct tnode *halve(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700818{
819 struct tnode *oldtnode = tn;
820 struct node *left, *right;
821 int i;
822 int olen = tnode_child_length(tn);
823
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700824 pr_debug("In halve\n");
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700825
826 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits - 1);
Robert Olsson19baf832005-06-21 12:43:18 -0700827
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700828 if (!tn)
829 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700830
831 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700832 * Preallocate and store tnodes before the actual work so we
833 * don't get into an inconsistent state if memory allocation
834 * fails. In case of failure we return the oldnode and halve
Robert Olsson2f368952005-07-05 15:02:40 -0700835 * of tnode is ignored.
836 */
837
Olof Johansson91b9a272005-08-09 20:24:39 -0700838 for (i = 0; i < olen; i += 2) {
Robert Olsson2f368952005-07-05 15:02:40 -0700839 left = tnode_get_child(oldtnode, i);
840 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700841
Robert Olsson2f368952005-07-05 15:02:40 -0700842 /* Two nonempty children */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700843 if (left && right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700844 struct tnode *newn;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700845
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700846 newn = tnode_new(left->key, tn->pos + tn->bits, 1);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700847
848 if (!newn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700849 goto nomem;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700850
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700851 put_child(t, tn, i/2, (struct node *)newn);
Robert Olsson2f368952005-07-05 15:02:40 -0700852 }
Robert Olsson2f368952005-07-05 15:02:40 -0700853
Robert Olsson2f368952005-07-05 15:02:40 -0700854 }
Robert Olsson19baf832005-06-21 12:43:18 -0700855
Olof Johansson91b9a272005-08-09 20:24:39 -0700856 for (i = 0; i < olen; i += 2) {
857 struct tnode *newBinNode;
858
Robert Olsson19baf832005-06-21 12:43:18 -0700859 left = tnode_get_child(oldtnode, i);
860 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700861
Robert Olsson19baf832005-06-21 12:43:18 -0700862 /* At least one of the children is empty */
863 if (left == NULL) {
864 if (right == NULL) /* Both are empty */
865 continue;
866 put_child(t, tn, i/2, right);
Olof Johansson91b9a272005-08-09 20:24:39 -0700867 continue;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700868 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700869
870 if (right == NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700871 put_child(t, tn, i/2, left);
Olof Johansson91b9a272005-08-09 20:24:39 -0700872 continue;
873 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700874
Robert Olsson19baf832005-06-21 12:43:18 -0700875 /* Two nonempty children */
Olof Johansson91b9a272005-08-09 20:24:39 -0700876 newBinNode = (struct tnode *) tnode_get_child(tn, i/2);
877 put_child(t, tn, i/2, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700878 put_child(t, newBinNode, 0, left);
879 put_child(t, newBinNode, 1, right);
880 put_child(t, tn, i/2, resize(t, newBinNode));
Robert Olsson19baf832005-06-21 12:43:18 -0700881 }
882 tnode_free(oldtnode);
883 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700884nomem:
885 {
886 int size = tnode_child_length(tn);
887 int j;
888
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700889 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700890 if (tn->child[j])
891 tnode_free((struct tnode *)tn->child[j]);
892
893 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700894
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700895 return ERR_PTR(-ENOMEM);
896 }
Robert Olsson19baf832005-06-21 12:43:18 -0700897}
898
Robert Olsson772cb712005-09-19 15:31:18 -0700899/* readside must use rcu_read_lock currently dump routines
Robert Olsson2373ce12005-08-25 13:01:29 -0700900 via get_fa_head and dump */
901
Robert Olsson772cb712005-09-19 15:31:18 -0700902static struct leaf_info *find_leaf_info(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700903{
Robert Olsson772cb712005-09-19 15:31:18 -0700904 struct hlist_head *head = &l->list;
Robert Olsson19baf832005-06-21 12:43:18 -0700905 struct hlist_node *node;
906 struct leaf_info *li;
907
Robert Olsson2373ce12005-08-25 13:01:29 -0700908 hlist_for_each_entry_rcu(li, node, head, hlist)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700909 if (li->plen == plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700910 return li;
Olof Johansson91b9a272005-08-09 20:24:39 -0700911
Robert Olsson19baf832005-06-21 12:43:18 -0700912 return NULL;
913}
914
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800915static inline struct list_head *get_fa_head(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700916{
Robert Olsson772cb712005-09-19 15:31:18 -0700917 struct leaf_info *li = find_leaf_info(l, plen);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700918
Olof Johansson91b9a272005-08-09 20:24:39 -0700919 if (!li)
920 return NULL;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700921
Olof Johansson91b9a272005-08-09 20:24:39 -0700922 return &li->falh;
Robert Olsson19baf832005-06-21 12:43:18 -0700923}
924
925static void insert_leaf_info(struct hlist_head *head, struct leaf_info *new)
926{
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900927 struct leaf_info *li = NULL, *last = NULL;
928 struct hlist_node *node;
Robert Olsson19baf832005-06-21 12:43:18 -0700929
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900930 if (hlist_empty(head)) {
931 hlist_add_head_rcu(&new->hlist, head);
932 } else {
933 hlist_for_each_entry(li, node, head, hlist) {
934 if (new->plen > li->plen)
935 break;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700936
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900937 last = li;
938 }
939 if (last)
940 hlist_add_after_rcu(&last->hlist, &new->hlist);
941 else
942 hlist_add_before_rcu(&new->hlist, &li->hlist);
943 }
Robert Olsson19baf832005-06-21 12:43:18 -0700944}
945
Robert Olsson2373ce12005-08-25 13:01:29 -0700946/* rcu_read_lock needs to be hold by caller from readside */
947
Robert Olsson19baf832005-06-21 12:43:18 -0700948static struct leaf *
949fib_find_node(struct trie *t, u32 key)
950{
951 int pos;
952 struct tnode *tn;
953 struct node *n;
954
955 pos = 0;
Robert Olsson2373ce12005-08-25 13:01:29 -0700956 n = rcu_dereference(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -0700957
958 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
959 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -0700960
Robert Olsson19baf832005-06-21 12:43:18 -0700961 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700962
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700963 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700964 pos = tn->pos + tn->bits;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800965 n = tnode_get_child_rcu(tn,
966 tkey_extract_bits(key,
967 tn->pos,
968 tn->bits));
Olof Johansson91b9a272005-08-09 20:24:39 -0700969 } else
Robert Olsson19baf832005-06-21 12:43:18 -0700970 break;
971 }
972 /* Case we have found a leaf. Compare prefixes */
973
Olof Johansson91b9a272005-08-09 20:24:39 -0700974 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key))
975 return (struct leaf *)n;
976
Robert Olsson19baf832005-06-21 12:43:18 -0700977 return NULL;
978}
979
980static struct node *trie_rebalance(struct trie *t, struct tnode *tn)
981{
Robert Olsson19baf832005-06-21 12:43:18 -0700982 int wasfull;
Stephen Hemminger06801912007-08-10 15:22:13 -0700983 t_key cindex, key = tn->key;
984 struct tnode *tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700985
Stephen Hemminger06801912007-08-10 15:22:13 -0700986 while (tn != NULL && (tp = node_parent((struct node *)tn)) != NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700987 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
988 wasfull = tnode_full(tp, tnode_get_child(tp, cindex));
Stephen Hemmingera07f5f52008-01-22 21:53:36 -0800989 tn = (struct tnode *) resize(t, (struct tnode *)tn);
990
991 tnode_put_child_reorg((struct tnode *)tp, cindex,
992 (struct node *)tn, wasfull);
Olof Johansson91b9a272005-08-09 20:24:39 -0700993
Stephen Hemminger06801912007-08-10 15:22:13 -0700994 tp = node_parent((struct node *) tn);
995 if (!tp)
Robert Olsson19baf832005-06-21 12:43:18 -0700996 break;
Stephen Hemminger06801912007-08-10 15:22:13 -0700997 tn = tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700998 }
Stephen Hemminger06801912007-08-10 15:22:13 -0700999
Robert Olsson19baf832005-06-21 12:43:18 -07001000 /* Handle last (top) tnode */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001001 if (IS_TNODE(tn))
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001002 tn = (struct tnode *)resize(t, (struct tnode *)tn);
Robert Olsson19baf832005-06-21 12:43:18 -07001003
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001004 return (struct node *)tn;
Robert Olsson19baf832005-06-21 12:43:18 -07001005}
1006
Robert Olsson2373ce12005-08-25 13:01:29 -07001007/* only used from updater-side */
1008
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001009static struct list_head *fib_insert_node(struct trie *t, u32 key, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -07001010{
1011 int pos, newpos;
1012 struct tnode *tp = NULL, *tn = NULL;
1013 struct node *n;
1014 struct leaf *l;
1015 int missbit;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001016 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001017 struct leaf_info *li;
1018 t_key cindex;
1019
1020 pos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001021 n = t->trie;
Robert Olsson19baf832005-06-21 12:43:18 -07001022
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001023 /* If we point to NULL, stop. Either the tree is empty and we should
1024 * just put a new leaf in if, or we have reached an empty child slot,
Robert Olsson19baf832005-06-21 12:43:18 -07001025 * and we should just put our new leaf in that.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001026 * If we point to a T_TNODE, check if it matches our key. Note that
1027 * a T_TNODE might be skipping any number of bits - its 'pos' need
Robert Olsson19baf832005-06-21 12:43:18 -07001028 * not be the parent's 'pos'+'bits'!
1029 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001030 * If it does match the current key, get pos/bits from it, extract
Robert Olsson19baf832005-06-21 12:43:18 -07001031 * the index from our key, push the T_TNODE and walk the tree.
1032 *
1033 * If it doesn't, we have to replace it with a new T_TNODE.
1034 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001035 * If we point to a T_LEAF, it might or might not have the same key
1036 * as we do. If it does, just change the value, update the T_LEAF's
1037 * value, and return it.
Robert Olsson19baf832005-06-21 12:43:18 -07001038 * If it doesn't, we need to replace it with a T_TNODE.
1039 */
1040
1041 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
1042 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -07001043
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001044 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001045
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001046 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001047 tp = tn;
Olof Johansson91b9a272005-08-09 20:24:39 -07001048 pos = tn->pos + tn->bits;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001049 n = tnode_get_child(tn,
1050 tkey_extract_bits(key,
1051 tn->pos,
1052 tn->bits));
Robert Olsson19baf832005-06-21 12:43:18 -07001053
Stephen Hemminger06801912007-08-10 15:22:13 -07001054 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001055 } else
Robert Olsson19baf832005-06-21 12:43:18 -07001056 break;
1057 }
1058
1059 /*
1060 * n ----> NULL, LEAF or TNODE
1061 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001062 * tp is n's (parent) ----> NULL or TNODE
Robert Olsson19baf832005-06-21 12:43:18 -07001063 */
1064
Olof Johansson91b9a272005-08-09 20:24:39 -07001065 BUG_ON(tp && IS_LEAF(tp));
Robert Olsson19baf832005-06-21 12:43:18 -07001066
1067 /* Case 1: n is a leaf. Compare prefixes */
1068
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001069 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key)) {
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08001070 l = (struct leaf *) n;
Robert Olsson19baf832005-06-21 12:43:18 -07001071 li = leaf_info_new(plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001072
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001073 if (!li)
1074 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001075
1076 fa_head = &li->falh;
1077 insert_leaf_info(&l->list, li);
1078 goto done;
1079 }
Robert Olsson19baf832005-06-21 12:43:18 -07001080 l = leaf_new();
1081
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001082 if (!l)
1083 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001084
1085 l->key = key;
1086 li = leaf_info_new(plen);
1087
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001088 if (!li) {
Robert Olssonf835e472005-06-28 15:00:39 -07001089 tnode_free((struct tnode *) l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001090 return NULL;
Robert Olssonf835e472005-06-28 15:00:39 -07001091 }
Robert Olsson19baf832005-06-21 12:43:18 -07001092
1093 fa_head = &li->falh;
1094 insert_leaf_info(&l->list, li);
1095
Robert Olsson19baf832005-06-21 12:43:18 -07001096 if (t->trie && n == NULL) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001097 /* Case 2: n is NULL, and will just insert a new leaf */
Robert Olsson19baf832005-06-21 12:43:18 -07001098
Stephen Hemminger06801912007-08-10 15:22:13 -07001099 node_set_parent((struct node *)l, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001100
Olof Johansson91b9a272005-08-09 20:24:39 -07001101 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1102 put_child(t, (struct tnode *)tp, cindex, (struct node *)l);
1103 } else {
1104 /* Case 3: n is a LEAF or a TNODE and the key doesn't match. */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001105 /*
1106 * Add a new tnode here
Robert Olsson19baf832005-06-21 12:43:18 -07001107 * first tnode need some special handling
1108 */
1109
1110 if (tp)
Olof Johansson91b9a272005-08-09 20:24:39 -07001111 pos = tp->pos+tp->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001112 else
Olof Johansson91b9a272005-08-09 20:24:39 -07001113 pos = 0;
1114
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001115 if (n) {
Robert Olsson19baf832005-06-21 12:43:18 -07001116 newpos = tkey_mismatch(key, pos, n->key);
1117 tn = tnode_new(n->key, newpos, 1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001118 } else {
Robert Olsson19baf832005-06-21 12:43:18 -07001119 newpos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001120 tn = tnode_new(key, newpos, 1); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001121 }
Robert Olsson19baf832005-06-21 12:43:18 -07001122
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001123 if (!tn) {
Robert Olssonf835e472005-06-28 15:00:39 -07001124 free_leaf_info(li);
1125 tnode_free((struct tnode *) l);
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001126 return NULL;
Olof Johansson91b9a272005-08-09 20:24:39 -07001127 }
1128
Stephen Hemminger06801912007-08-10 15:22:13 -07001129 node_set_parent((struct node *)tn, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001130
Olof Johansson91b9a272005-08-09 20:24:39 -07001131 missbit = tkey_extract_bits(key, newpos, 1);
Robert Olsson19baf832005-06-21 12:43:18 -07001132 put_child(t, tn, missbit, (struct node *)l);
1133 put_child(t, tn, 1-missbit, n);
1134
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001135 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001136 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001137 put_child(t, (struct tnode *)tp, cindex,
1138 (struct node *)tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001139 } else {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001140 rcu_assign_pointer(t->trie, (struct node *)tn);
Robert Olsson19baf832005-06-21 12:43:18 -07001141 tp = tn;
1142 }
1143 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001144
1145 if (tp && tp->pos + tp->bits > 32)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001146 pr_warning("fib_trie"
1147 " tp=%p pos=%d, bits=%d, key=%0x plen=%d\n",
1148 tp, tp->pos, tp->bits, key, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001149
Robert Olsson19baf832005-06-21 12:43:18 -07001150 /* Rebalance the trie */
Robert Olsson2373ce12005-08-25 13:01:29 -07001151
1152 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Robert Olssonf835e472005-06-28 15:00:39 -07001153done:
Robert Olsson19baf832005-06-21 12:43:18 -07001154 return fa_head;
1155}
1156
Robert Olssond562f1f2007-03-26 14:22:22 -07001157/*
1158 * Caller must hold RTNL.
1159 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001160static int fn_trie_insert(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001161{
1162 struct trie *t = (struct trie *) tb->tb_data;
1163 struct fib_alias *fa, *new_fa;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001164 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001165 struct fib_info *fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001166 int plen = cfg->fc_dst_len;
1167 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001168 u32 key, mask;
1169 int err;
1170 struct leaf *l;
1171
1172 if (plen > 32)
1173 return -EINVAL;
1174
Thomas Graf4e902c52006-08-17 18:14:52 -07001175 key = ntohl(cfg->fc_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001176
Patrick McHardy2dfe55b2006-08-10 23:08:33 -07001177 pr_debug("Insert table=%u %08x/%d\n", tb->tb_id, key, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001178
Olof Johansson91b9a272005-08-09 20:24:39 -07001179 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001180
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001181 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001182 return -EINVAL;
1183
1184 key = key & mask;
1185
Thomas Graf4e902c52006-08-17 18:14:52 -07001186 fi = fib_create_info(cfg);
1187 if (IS_ERR(fi)) {
1188 err = PTR_ERR(fi);
Robert Olsson19baf832005-06-21 12:43:18 -07001189 goto err;
Thomas Graf4e902c52006-08-17 18:14:52 -07001190 }
Robert Olsson19baf832005-06-21 12:43:18 -07001191
1192 l = fib_find_node(t, key);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001193 fa = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001194
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001195 if (l) {
Robert Olsson19baf832005-06-21 12:43:18 -07001196 fa_head = get_fa_head(l, plen);
1197 fa = fib_find_alias(fa_head, tos, fi->fib_priority);
1198 }
1199
1200 /* Now fa, if non-NULL, points to the first fib alias
1201 * with the same keys [prefix,tos,priority], if such key already
1202 * exists or to the node before which we will insert new one.
1203 *
1204 * If fa is NULL, we will need to allocate a new one and
1205 * insert to the head of f.
1206 *
1207 * If f is NULL, no fib node matched the destination key
1208 * and we need to allocate a new one of those as well.
1209 */
1210
Julian Anastasov936f6f82008-01-28 21:18:06 -08001211 if (fa && fa->fa_tos == tos &&
1212 fa->fa_info->fib_priority == fi->fib_priority) {
1213 struct fib_alias *fa_first, *fa_match;
Robert Olsson19baf832005-06-21 12:43:18 -07001214
1215 err = -EEXIST;
Thomas Graf4e902c52006-08-17 18:14:52 -07001216 if (cfg->fc_nlflags & NLM_F_EXCL)
Robert Olsson19baf832005-06-21 12:43:18 -07001217 goto out;
1218
Julian Anastasov936f6f82008-01-28 21:18:06 -08001219 /* We have 2 goals:
1220 * 1. Find exact match for type, scope, fib_info to avoid
1221 * duplicate routes
1222 * 2. Find next 'fa' (or head), NLM_F_APPEND inserts before it
1223 */
1224 fa_match = NULL;
1225 fa_first = fa;
1226 fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list);
1227 list_for_each_entry_continue(fa, fa_head, fa_list) {
1228 if (fa->fa_tos != tos)
1229 break;
1230 if (fa->fa_info->fib_priority != fi->fib_priority)
1231 break;
1232 if (fa->fa_type == cfg->fc_type &&
1233 fa->fa_scope == cfg->fc_scope &&
1234 fa->fa_info == fi) {
1235 fa_match = fa;
1236 break;
1237 }
1238 }
1239
Thomas Graf4e902c52006-08-17 18:14:52 -07001240 if (cfg->fc_nlflags & NLM_F_REPLACE) {
Robert Olsson19baf832005-06-21 12:43:18 -07001241 struct fib_info *fi_drop;
1242 u8 state;
1243
Julian Anastasov936f6f82008-01-28 21:18:06 -08001244 fa = fa_first;
1245 if (fa_match) {
1246 if (fa == fa_match)
1247 err = 0;
Joonwoo Park67250332008-01-18 03:45:18 -08001248 goto out;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001249 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001250 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001251 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001252 if (new_fa == NULL)
1253 goto out;
Robert Olsson19baf832005-06-21 12:43:18 -07001254
1255 fi_drop = fa->fa_info;
Robert Olsson2373ce12005-08-25 13:01:29 -07001256 new_fa->fa_tos = fa->fa_tos;
1257 new_fa->fa_info = fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001258 new_fa->fa_type = cfg->fc_type;
1259 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001260 state = fa->fa_state;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001261 new_fa->fa_state = state & ~FA_S_ACCESSED;
Robert Olsson19baf832005-06-21 12:43:18 -07001262
Robert Olsson2373ce12005-08-25 13:01:29 -07001263 list_replace_rcu(&fa->fa_list, &new_fa->fa_list);
1264 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001265
1266 fib_release_info(fi_drop);
1267 if (state & FA_S_ACCESSED)
Olof Johansson91b9a272005-08-09 20:24:39 -07001268 rt_cache_flush(-1);
Milan Kocianb8f55832007-05-23 14:55:06 -07001269 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen,
1270 tb->tb_id, &cfg->fc_nlinfo, NLM_F_REPLACE);
Robert Olsson19baf832005-06-21 12:43:18 -07001271
Olof Johansson91b9a272005-08-09 20:24:39 -07001272 goto succeeded;
Robert Olsson19baf832005-06-21 12:43:18 -07001273 }
1274 /* Error if we find a perfect match which
1275 * uses the same scope, type, and nexthop
1276 * information.
1277 */
Julian Anastasov936f6f82008-01-28 21:18:06 -08001278 if (fa_match)
1279 goto out;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001280
Thomas Graf4e902c52006-08-17 18:14:52 -07001281 if (!(cfg->fc_nlflags & NLM_F_APPEND))
Julian Anastasov936f6f82008-01-28 21:18:06 -08001282 fa = fa_first;
Robert Olsson19baf832005-06-21 12:43:18 -07001283 }
1284 err = -ENOENT;
Thomas Graf4e902c52006-08-17 18:14:52 -07001285 if (!(cfg->fc_nlflags & NLM_F_CREATE))
Robert Olsson19baf832005-06-21 12:43:18 -07001286 goto out;
1287
1288 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001289 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson19baf832005-06-21 12:43:18 -07001290 if (new_fa == NULL)
1291 goto out;
1292
1293 new_fa->fa_info = fi;
1294 new_fa->fa_tos = tos;
Thomas Graf4e902c52006-08-17 18:14:52 -07001295 new_fa->fa_type = cfg->fc_type;
1296 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001297 new_fa->fa_state = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001298 /*
1299 * Insert new entry to the list.
1300 */
1301
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001302 if (!fa_head) {
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001303 fa_head = fib_insert_node(t, key, plen);
1304 if (unlikely(!fa_head)) {
1305 err = -ENOMEM;
Robert Olssonf835e472005-06-28 15:00:39 -07001306 goto out_free_new_fa;
Stephen Hemmingerfea86ad2008-01-12 20:57:07 -08001307 }
Robert Olssonf835e472005-06-28 15:00:39 -07001308 }
Robert Olsson19baf832005-06-21 12:43:18 -07001309
Robert Olsson2373ce12005-08-25 13:01:29 -07001310 list_add_tail_rcu(&new_fa->fa_list,
1311 (fa ? &fa->fa_list : fa_head));
Robert Olsson19baf832005-06-21 12:43:18 -07001312
1313 rt_cache_flush(-1);
Thomas Graf4e902c52006-08-17 18:14:52 -07001314 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001315 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001316succeeded:
1317 return 0;
Robert Olssonf835e472005-06-28 15:00:39 -07001318
1319out_free_new_fa:
1320 kmem_cache_free(fn_alias_kmem, new_fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001321out:
1322 fib_release_info(fi);
Olof Johansson91b9a272005-08-09 20:24:39 -07001323err:
Robert Olsson19baf832005-06-21 12:43:18 -07001324 return err;
1325}
1326
Robert Olsson772cb712005-09-19 15:31:18 -07001327/* should be called with rcu_read_lock */
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001328static int check_leaf(struct trie *t, struct leaf *l,
1329 t_key key, const struct flowi *flp,
1330 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001331{
Robert Olsson19baf832005-06-21 12:43:18 -07001332 struct leaf_info *li;
1333 struct hlist_head *hhead = &l->list;
1334 struct hlist_node *node;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001335
Robert Olsson2373ce12005-08-25 13:01:29 -07001336 hlist_for_each_entry_rcu(li, node, hhead, hlist) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001337 int err;
1338 int plen = li->plen;
1339 __be32 mask = inet_make_mask(plen);
1340
Al Viro888454c2006-09-19 13:42:46 -07001341 if (l->key != (key & ntohl(mask)))
Robert Olsson19baf832005-06-21 12:43:18 -07001342 continue;
1343
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001344 err = fib_semantic_match(&li->falh, flp, res,
1345 htonl(l->key), mask, plen);
1346
Robert Olsson19baf832005-06-21 12:43:18 -07001347#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001348 if (err <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001349 t->stats.semantic_match_passed++;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001350 else
1351 t->stats.semantic_match_miss++;
Robert Olsson19baf832005-06-21 12:43:18 -07001352#endif
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001353 if (err <= 0)
1354 return plen;
Robert Olsson19baf832005-06-21 12:43:18 -07001355 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001356
1357 return -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001358}
1359
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001360static int fn_trie_lookup(struct fib_table *tb, const struct flowi *flp,
1361 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001362{
1363 struct trie *t = (struct trie *) tb->tb_data;
1364 int plen, ret = 0;
1365 struct node *n;
1366 struct tnode *pn;
1367 int pos, bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001368 t_key key = ntohl(flp->fl4_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001369 int chopped_off;
1370 t_key cindex = 0;
1371 int current_prefix_length = KEYLENGTH;
Olof Johansson91b9a272005-08-09 20:24:39 -07001372 struct tnode *cn;
1373 t_key node_prefix, key_prefix, pref_mismatch;
1374 int mp;
1375
Robert Olsson2373ce12005-08-25 13:01:29 -07001376 rcu_read_lock();
Robert Olsson19baf832005-06-21 12:43:18 -07001377
Robert Olsson2373ce12005-08-25 13:01:29 -07001378 n = rcu_dereference(t->trie);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001379 if (!n)
Robert Olsson19baf832005-06-21 12:43:18 -07001380 goto failed;
1381
1382#ifdef CONFIG_IP_FIB_TRIE_STATS
1383 t->stats.gets++;
1384#endif
1385
1386 /* Just a leaf? */
1387 if (IS_LEAF(n)) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001388 plen = check_leaf(t, (struct leaf *)n, key, flp, res);
1389 if (plen < 0)
1390 goto failed;
1391 ret = 0;
1392 goto found;
Robert Olsson19baf832005-06-21 12:43:18 -07001393 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001394
Robert Olsson19baf832005-06-21 12:43:18 -07001395 pn = (struct tnode *) n;
1396 chopped_off = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001397
Olof Johansson91b9a272005-08-09 20:24:39 -07001398 while (pn) {
Robert Olsson19baf832005-06-21 12:43:18 -07001399 pos = pn->pos;
1400 bits = pn->bits;
1401
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001402 if (!chopped_off)
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001403 cindex = tkey_extract_bits(mask_pfx(key, current_prefix_length),
1404 pos, bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001405
1406 n = tnode_get_child(pn, cindex);
1407
1408 if (n == NULL) {
1409#ifdef CONFIG_IP_FIB_TRIE_STATS
1410 t->stats.null_node_hit++;
1411#endif
1412 goto backtrace;
1413 }
1414
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001415 if (IS_LEAF(n)) {
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001416 plen = check_leaf(t, (struct leaf *)n, key, flp, res);
1417 if (plen < 0)
Olof Johansson91b9a272005-08-09 20:24:39 -07001418 goto backtrace;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001419
1420 ret = 0;
1421 goto found;
Olof Johansson91b9a272005-08-09 20:24:39 -07001422 }
1423
Olof Johansson91b9a272005-08-09 20:24:39 -07001424 cn = (struct tnode *)n;
1425
1426 /*
1427 * It's a tnode, and we can do some extra checks here if we
1428 * like, to avoid descending into a dead-end branch.
1429 * This tnode is in the parent's child array at index
1430 * key[p_pos..p_pos+p_bits] but potentially with some bits
1431 * chopped off, so in reality the index may be just a
1432 * subprefix, padded with zero at the end.
1433 * We can also take a look at any skipped bits in this
1434 * tnode - everything up to p_pos is supposed to be ok,
1435 * and the non-chopped bits of the index (se previous
1436 * paragraph) are also guaranteed ok, but the rest is
1437 * considered unknown.
1438 *
1439 * The skipped bits are key[pos+bits..cn->pos].
1440 */
1441
1442 /* If current_prefix_length < pos+bits, we are already doing
1443 * actual prefix matching, which means everything from
1444 * pos+(bits-chopped_off) onward must be zero along some
1445 * branch of this subtree - otherwise there is *no* valid
1446 * prefix present. Here we can only check the skipped
1447 * bits. Remember, since we have already indexed into the
1448 * parent's child array, we know that the bits we chopped of
1449 * *are* zero.
1450 */
1451
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001452 /* NOTA BENE: Checking only skipped bits
1453 for the new node here */
Olof Johansson91b9a272005-08-09 20:24:39 -07001454
1455 if (current_prefix_length < pos+bits) {
1456 if (tkey_extract_bits(cn->key, current_prefix_length,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001457 cn->pos - current_prefix_length)
1458 || !(cn->child[0]))
Olof Johansson91b9a272005-08-09 20:24:39 -07001459 goto backtrace;
1460 }
1461
1462 /*
1463 * If chopped_off=0, the index is fully validated and we
1464 * only need to look at the skipped bits for this, the new,
1465 * tnode. What we actually want to do is to find out if
1466 * these skipped bits match our key perfectly, or if we will
1467 * have to count on finding a matching prefix further down,
1468 * because if we do, we would like to have some way of
1469 * verifying the existence of such a prefix at this point.
1470 */
1471
1472 /* The only thing we can do at this point is to verify that
1473 * any such matching prefix can indeed be a prefix to our
1474 * key, and if the bits in the node we are inspecting that
1475 * do not match our key are not ZERO, this cannot be true.
1476 * Thus, find out where there is a mismatch (before cn->pos)
1477 * and verify that all the mismatching bits are zero in the
1478 * new tnode's key.
1479 */
1480
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001481 /*
1482 * Note: We aren't very concerned about the piece of
1483 * the key that precede pn->pos+pn->bits, since these
1484 * have already been checked. The bits after cn->pos
1485 * aren't checked since these are by definition
1486 * "unknown" at this point. Thus, what we want to see
1487 * is if we are about to enter the "prefix matching"
1488 * state, and in that case verify that the skipped
1489 * bits that will prevail throughout this subtree are
1490 * zero, as they have to be if we are to find a
1491 * matching prefix.
Olof Johansson91b9a272005-08-09 20:24:39 -07001492 */
1493
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001494 node_prefix = mask_pfx(cn->key, cn->pos);
1495 key_prefix = mask_pfx(key, cn->pos);
Olof Johansson91b9a272005-08-09 20:24:39 -07001496 pref_mismatch = key_prefix^node_prefix;
1497 mp = 0;
1498
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001499 /*
1500 * In short: If skipped bits in this node do not match
1501 * the search key, enter the "prefix matching"
1502 * state.directly.
Olof Johansson91b9a272005-08-09 20:24:39 -07001503 */
1504 if (pref_mismatch) {
1505 while (!(pref_mismatch & (1<<(KEYLENGTH-1)))) {
1506 mp++;
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001507 pref_mismatch = pref_mismatch << 1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001508 }
1509 key_prefix = tkey_extract_bits(cn->key, mp, cn->pos-mp);
1510
1511 if (key_prefix != 0)
1512 goto backtrace;
1513
1514 if (current_prefix_length >= cn->pos)
1515 current_prefix_length = mp;
1516 }
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001517
Olof Johansson91b9a272005-08-09 20:24:39 -07001518 pn = (struct tnode *)n; /* Descend */
1519 chopped_off = 0;
1520 continue;
1521
Robert Olsson19baf832005-06-21 12:43:18 -07001522backtrace:
1523 chopped_off++;
1524
1525 /* As zero don't change the child key (cindex) */
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001526 while ((chopped_off <= pn->bits)
1527 && !(cindex & (1<<(chopped_off-1))))
Robert Olsson19baf832005-06-21 12:43:18 -07001528 chopped_off++;
Robert Olsson19baf832005-06-21 12:43:18 -07001529
1530 /* Decrease current_... with bits chopped off */
1531 if (current_prefix_length > pn->pos + pn->bits - chopped_off)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001532 current_prefix_length = pn->pos + pn->bits
1533 - chopped_off;
Olof Johansson91b9a272005-08-09 20:24:39 -07001534
Robert Olsson19baf832005-06-21 12:43:18 -07001535 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001536 * Either we do the actual chop off according or if we have
Robert Olsson19baf832005-06-21 12:43:18 -07001537 * chopped off all bits in this tnode walk up to our parent.
1538 */
1539
Olof Johansson91b9a272005-08-09 20:24:39 -07001540 if (chopped_off <= pn->bits) {
Robert Olsson19baf832005-06-21 12:43:18 -07001541 cindex &= ~(1 << (chopped_off-1));
Olof Johansson91b9a272005-08-09 20:24:39 -07001542 } else {
Stephen Hemminger06801912007-08-10 15:22:13 -07001543 struct tnode *parent = node_parent((struct node *) pn);
1544 if (!parent)
Robert Olsson19baf832005-06-21 12:43:18 -07001545 goto failed;
Olof Johansson91b9a272005-08-09 20:24:39 -07001546
Robert Olsson19baf832005-06-21 12:43:18 -07001547 /* Get Child's index */
Stephen Hemminger06801912007-08-10 15:22:13 -07001548 cindex = tkey_extract_bits(pn->key, parent->pos, parent->bits);
1549 pn = parent;
Robert Olsson19baf832005-06-21 12:43:18 -07001550 chopped_off = 0;
1551
1552#ifdef CONFIG_IP_FIB_TRIE_STATS
1553 t->stats.backtrack++;
1554#endif
1555 goto backtrace;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001556 }
Robert Olsson19baf832005-06-21 12:43:18 -07001557 }
1558failed:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001559 ret = 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001560found:
Robert Olsson2373ce12005-08-25 13:01:29 -07001561 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001562 return ret;
1563}
1564
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001565/*
1566 * Remove the leaf and return parent.
1567 */
1568static void trie_leaf_remove(struct trie *t, struct leaf *l)
Robert Olsson19baf832005-06-21 12:43:18 -07001569{
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001570 struct tnode *tp = node_parent((struct node *) l);
Robert Olsson19baf832005-06-21 12:43:18 -07001571
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001572 pr_debug("entering trie_leaf_remove(%p)\n", l);
Robert Olsson19baf832005-06-21 12:43:18 -07001573
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001574 if (tp) {
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001575 t_key cindex = tkey_extract_bits(l->key, tp->pos, tp->bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001576 put_child(t, (struct tnode *)tp, cindex, NULL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001577 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Olof Johansson91b9a272005-08-09 20:24:39 -07001578 } else
Robert Olsson2373ce12005-08-25 13:01:29 -07001579 rcu_assign_pointer(t->trie, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001580
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001581 tnode_free((struct tnode *) l);
Robert Olsson19baf832005-06-21 12:43:18 -07001582}
1583
Robert Olssond562f1f2007-03-26 14:22:22 -07001584/*
1585 * Caller must hold RTNL.
1586 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001587static int fn_trie_delete(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001588{
1589 struct trie *t = (struct trie *) tb->tb_data;
1590 u32 key, mask;
Thomas Graf4e902c52006-08-17 18:14:52 -07001591 int plen = cfg->fc_dst_len;
1592 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001593 struct fib_alias *fa, *fa_to_delete;
1594 struct list_head *fa_head;
1595 struct leaf *l;
Olof Johansson91b9a272005-08-09 20:24:39 -07001596 struct leaf_info *li;
1597
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001598 if (plen > 32)
Robert Olsson19baf832005-06-21 12:43:18 -07001599 return -EINVAL;
1600
Thomas Graf4e902c52006-08-17 18:14:52 -07001601 key = ntohl(cfg->fc_dst);
Olof Johansson91b9a272005-08-09 20:24:39 -07001602 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001603
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001604 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001605 return -EINVAL;
1606
1607 key = key & mask;
1608 l = fib_find_node(t, key);
1609
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001610 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001611 return -ESRCH;
1612
1613 fa_head = get_fa_head(l, plen);
1614 fa = fib_find_alias(fa_head, tos, 0);
1615
1616 if (!fa)
1617 return -ESRCH;
1618
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001619 pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t);
Robert Olsson19baf832005-06-21 12:43:18 -07001620
1621 fa_to_delete = NULL;
Julian Anastasov936f6f82008-01-28 21:18:06 -08001622 fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list);
1623 list_for_each_entry_continue(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001624 struct fib_info *fi = fa->fa_info;
1625
1626 if (fa->fa_tos != tos)
1627 break;
1628
Thomas Graf4e902c52006-08-17 18:14:52 -07001629 if ((!cfg->fc_type || fa->fa_type == cfg->fc_type) &&
1630 (cfg->fc_scope == RT_SCOPE_NOWHERE ||
1631 fa->fa_scope == cfg->fc_scope) &&
1632 (!cfg->fc_protocol ||
1633 fi->fib_protocol == cfg->fc_protocol) &&
1634 fib_nh_match(cfg, fi) == 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001635 fa_to_delete = fa;
1636 break;
1637 }
1638 }
1639
Olof Johansson91b9a272005-08-09 20:24:39 -07001640 if (!fa_to_delete)
1641 return -ESRCH;
Robert Olsson19baf832005-06-21 12:43:18 -07001642
Olof Johansson91b9a272005-08-09 20:24:39 -07001643 fa = fa_to_delete;
Thomas Graf4e902c52006-08-17 18:14:52 -07001644 rtmsg_fib(RTM_DELROUTE, htonl(key), fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001645 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001646
Olof Johansson91b9a272005-08-09 20:24:39 -07001647 l = fib_find_node(t, key);
Robert Olsson772cb712005-09-19 15:31:18 -07001648 li = find_leaf_info(l, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001649
Robert Olsson2373ce12005-08-25 13:01:29 -07001650 list_del_rcu(&fa->fa_list);
Robert Olsson19baf832005-06-21 12:43:18 -07001651
Olof Johansson91b9a272005-08-09 20:24:39 -07001652 if (list_empty(fa_head)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001653 hlist_del_rcu(&li->hlist);
Olof Johansson91b9a272005-08-09 20:24:39 -07001654 free_leaf_info(li);
Robert Olsson2373ce12005-08-25 13:01:29 -07001655 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001656
1657 if (hlist_empty(&l->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001658 trie_leaf_remove(t, l);
Olof Johansson91b9a272005-08-09 20:24:39 -07001659
1660 if (fa->fa_state & FA_S_ACCESSED)
1661 rt_cache_flush(-1);
1662
Robert Olsson2373ce12005-08-25 13:01:29 -07001663 fib_release_info(fa->fa_info);
1664 alias_free_mem_rcu(fa);
Olof Johansson91b9a272005-08-09 20:24:39 -07001665 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001666}
1667
1668static int trie_flush_list(struct trie *t, struct list_head *head)
1669{
1670 struct fib_alias *fa, *fa_node;
1671 int found = 0;
1672
1673 list_for_each_entry_safe(fa, fa_node, head, fa_list) {
1674 struct fib_info *fi = fa->fa_info;
Robert Olsson19baf832005-06-21 12:43:18 -07001675
Robert Olsson2373ce12005-08-25 13:01:29 -07001676 if (fi && (fi->fib_flags & RTNH_F_DEAD)) {
1677 list_del_rcu(&fa->fa_list);
1678 fib_release_info(fa->fa_info);
1679 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001680 found++;
1681 }
1682 }
1683 return found;
1684}
1685
1686static int trie_flush_leaf(struct trie *t, struct leaf *l)
1687{
1688 int found = 0;
1689 struct hlist_head *lih = &l->list;
1690 struct hlist_node *node, *tmp;
1691 struct leaf_info *li = NULL;
1692
1693 hlist_for_each_entry_safe(li, node, tmp, lih, hlist) {
Robert Olsson19baf832005-06-21 12:43:18 -07001694 found += trie_flush_list(t, &li->falh);
1695
1696 if (list_empty(&li->falh)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001697 hlist_del_rcu(&li->hlist);
Robert Olsson19baf832005-06-21 12:43:18 -07001698 free_leaf_info(li);
1699 }
1700 }
1701 return found;
1702}
1703
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001704/*
1705 * Scan for the next right leaf starting at node p->child[idx]
1706 * Since we have back pointer, no recursion necessary.
1707 */
1708static struct leaf *leaf_walk_rcu(struct tnode *p, struct node *c)
Robert Olsson19baf832005-06-21 12:43:18 -07001709{
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001710 do {
1711 t_key idx;
Robert Olsson19baf832005-06-21 12:43:18 -07001712
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001713 if (c)
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001714 idx = tkey_extract_bits(c->key, p->pos, p->bits) + 1;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001715 else
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001716 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001717
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001718 while (idx < 1u << p->bits) {
1719 c = tnode_get_child_rcu(p, idx++);
Robert Olsson2373ce12005-08-25 13:01:29 -07001720 if (!c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001721 continue;
Robert Olsson19baf832005-06-21 12:43:18 -07001722
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001723 if (IS_LEAF(c)) {
1724 prefetch(p->child[idx]);
1725 return (struct leaf *) c;
Robert Olsson19baf832005-06-21 12:43:18 -07001726 }
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001727
1728 /* Rescan start scanning in new node */
1729 p = (struct tnode *) c;
1730 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001731 }
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001732
1733 /* Node empty, walk back up to parent */
Olof Johansson91b9a272005-08-09 20:24:39 -07001734 c = (struct node *) p;
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001735 } while ( (p = node_parent_rcu(c)) != NULL);
1736
1737 return NULL; /* Root of trie */
1738}
1739
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001740static struct leaf *trie_firstleaf(struct trie *t)
1741{
1742 struct tnode *n = (struct tnode *) rcu_dereference(t->trie);
1743
1744 if (!n)
1745 return NULL;
1746
1747 if (IS_LEAF(n)) /* trie is just a leaf */
1748 return (struct leaf *) n;
1749
1750 return leaf_walk_rcu(n, NULL);
1751}
1752
1753static struct leaf *trie_nextleaf(struct leaf *l)
1754{
1755 struct node *c = (struct node *) l;
1756 struct tnode *p = node_parent(c);
1757
1758 if (!p)
1759 return NULL; /* trie with just one leaf */
1760
1761 return leaf_walk_rcu(p, c);
Robert Olsson19baf832005-06-21 12:43:18 -07001762}
1763
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001764static struct leaf *trie_leafindex(struct trie *t, int index)
1765{
1766 struct leaf *l = trie_firstleaf(t);
1767
Stephen Hemmingerec28cf72008-02-11 21:12:49 -08001768 while (l && index-- > 0)
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001769 l = trie_nextleaf(l);
Stephen Hemmingerec28cf72008-02-11 21:12:49 -08001770
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001771 return l;
1772}
1773
1774
Robert Olssond562f1f2007-03-26 14:22:22 -07001775/*
1776 * Caller must hold RTNL.
1777 */
Robert Olsson19baf832005-06-21 12:43:18 -07001778static int fn_trie_flush(struct fib_table *tb)
1779{
1780 struct trie *t = (struct trie *) tb->tb_data;
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001781 struct leaf *l, *ll = NULL;
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001782 int found = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001783
Stephen Hemminger82cfbb02008-01-22 21:55:32 -08001784 for (l = trie_firstleaf(t); l; l = trie_nextleaf(l)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001785 found += trie_flush_leaf(t, l);
1786
1787 if (ll && hlist_empty(&ll->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001788 trie_leaf_remove(t, ll);
Robert Olsson19baf832005-06-21 12:43:18 -07001789 ll = l;
1790 }
1791
1792 if (ll && hlist_empty(&ll->list))
Stephen Hemminger9195bef2008-01-22 21:56:34 -08001793 trie_leaf_remove(t, ll);
Robert Olsson19baf832005-06-21 12:43:18 -07001794
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001795 pr_debug("trie_flush found=%d\n", found);
Robert Olsson19baf832005-06-21 12:43:18 -07001796 return found;
1797}
1798
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001799static void fn_trie_select_default(struct fib_table *tb,
1800 const struct flowi *flp,
1801 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001802{
1803 struct trie *t = (struct trie *) tb->tb_data;
1804 int order, last_idx;
1805 struct fib_info *fi = NULL;
1806 struct fib_info *last_resort;
1807 struct fib_alias *fa = NULL;
1808 struct list_head *fa_head;
1809 struct leaf *l;
1810
1811 last_idx = -1;
1812 last_resort = NULL;
1813 order = -1;
1814
Robert Olsson2373ce12005-08-25 13:01:29 -07001815 rcu_read_lock();
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001816
Robert Olsson19baf832005-06-21 12:43:18 -07001817 l = fib_find_node(t, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001818 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001819 goto out;
1820
1821 fa_head = get_fa_head(l, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001822 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001823 goto out;
1824
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001825 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001826 goto out;
1827
Robert Olsson2373ce12005-08-25 13:01:29 -07001828 list_for_each_entry_rcu(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001829 struct fib_info *next_fi = fa->fa_info;
Olof Johansson91b9a272005-08-09 20:24:39 -07001830
Robert Olsson19baf832005-06-21 12:43:18 -07001831 if (fa->fa_scope != res->scope ||
1832 fa->fa_type != RTN_UNICAST)
1833 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -07001834
Robert Olsson19baf832005-06-21 12:43:18 -07001835 if (next_fi->fib_priority > res->fi->fib_priority)
1836 break;
1837 if (!next_fi->fib_nh[0].nh_gw ||
1838 next_fi->fib_nh[0].nh_scope != RT_SCOPE_LINK)
1839 continue;
1840 fa->fa_state |= FA_S_ACCESSED;
Olof Johansson91b9a272005-08-09 20:24:39 -07001841
Robert Olsson19baf832005-06-21 12:43:18 -07001842 if (fi == NULL) {
1843 if (next_fi != res->fi)
1844 break;
1845 } else if (!fib_detect_death(fi, order, &last_resort,
Denis V. Lunev971b8932007-12-08 00:32:23 -08001846 &last_idx, tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001847 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001848 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001849 goto out;
1850 }
1851 fi = next_fi;
1852 order++;
1853 }
1854 if (order <= 0 || fi == NULL) {
Denis V. Lunev971b8932007-12-08 00:32:23 -08001855 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001856 goto out;
1857 }
1858
Denis V. Lunev971b8932007-12-08 00:32:23 -08001859 if (!fib_detect_death(fi, order, &last_resort, &last_idx,
1860 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 }
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001865 if (last_idx >= 0)
1866 fib_result_assign(res, last_resort);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001867 tb->tb_default = last_idx;
1868out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001869 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001870}
1871
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001872static int fn_trie_dump_fa(t_key key, int plen, struct list_head *fah,
1873 struct fib_table *tb,
Robert Olsson19baf832005-06-21 12:43:18 -07001874 struct sk_buff *skb, struct netlink_callback *cb)
1875{
1876 int i, s_i;
1877 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07001878 __be32 xkey = htonl(key);
Robert Olsson19baf832005-06-21 12:43:18 -07001879
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001880 s_i = cb->args[5];
Robert Olsson19baf832005-06-21 12:43:18 -07001881 i = 0;
1882
Robert Olsson2373ce12005-08-25 13:01:29 -07001883 /* rcu_read_lock is hold by caller */
1884
1885 list_for_each_entry_rcu(fa, fah, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001886 if (i < s_i) {
1887 i++;
1888 continue;
1889 }
Robert Olsson19baf832005-06-21 12:43:18 -07001890
1891 if (fib_dump_info(skb, NETLINK_CB(cb->skb).pid,
1892 cb->nlh->nlmsg_seq,
1893 RTM_NEWROUTE,
1894 tb->tb_id,
1895 fa->fa_type,
1896 fa->fa_scope,
Thomas Grafbe403ea2006-08-17 18:15:17 -07001897 xkey,
Robert Olsson19baf832005-06-21 12:43:18 -07001898 plen,
1899 fa->fa_tos,
Stephen Hemminger64347f72008-01-22 21:55:01 -08001900 fa->fa_info, NLM_F_MULTI) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001901 cb->args[5] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001902 return -1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001903 }
Robert Olsson19baf832005-06-21 12:43:18 -07001904 i++;
1905 }
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001906 cb->args[5] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001907 return skb->len;
1908}
1909
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001910static int fn_trie_dump_leaf(struct leaf *l, struct fib_table *tb,
1911 struct sk_buff *skb, struct netlink_callback *cb)
Robert Olsson19baf832005-06-21 12:43:18 -07001912{
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001913 struct leaf_info *li;
1914 struct hlist_node *node;
1915 int i, s_i;
Robert Olsson19baf832005-06-21 12:43:18 -07001916
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001917 s_i = cb->args[4];
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001918 i = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001919
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001920 /* rcu_read_lock is hold by caller */
1921 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
1922 if (i < s_i) {
1923 i++;
Robert Olsson19baf832005-06-21 12:43:18 -07001924 continue;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001925 }
Robert Olsson19baf832005-06-21 12:43:18 -07001926
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001927 if (i > s_i)
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001928 cb->args[5] = 0;
Olof Johansson91b9a272005-08-09 20:24:39 -07001929
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001930 if (list_empty(&li->falh))
Robert Olsson19baf832005-06-21 12:43:18 -07001931 continue;
1932
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001933 if (fn_trie_dump_fa(l->key, li->plen, &li->falh, tb, skb, cb) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001934 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001935 return -1;
1936 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001937 i++;
Robert Olsson19baf832005-06-21 12:43:18 -07001938 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001939
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001940 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001941 return skb->len;
1942}
1943
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001944static int fn_trie_dump(struct fib_table *tb, struct sk_buff *skb,
1945 struct netlink_callback *cb)
Robert Olsson19baf832005-06-21 12:43:18 -07001946{
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001947 struct leaf *l;
Robert Olsson19baf832005-06-21 12:43:18 -07001948 struct trie *t = (struct trie *) tb->tb_data;
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001949 t_key key = cb->args[2];
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001950 int count = cb->args[3];
Robert Olsson19baf832005-06-21 12:43:18 -07001951
Robert Olsson2373ce12005-08-25 13:01:29 -07001952 rcu_read_lock();
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001953 /* Dump starting at last key.
1954 * Note: 0.0.0.0/0 (ie default) is first key.
1955 */
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001956 if (count == 0)
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001957 l = trie_firstleaf(t);
1958 else {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001959 /* Normally, continue from last key, but if that is missing
1960 * fallback to using slow rescan
1961 */
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001962 l = fib_find_node(t, key);
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001963 if (!l)
1964 l = trie_leafindex(t, count);
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001965 }
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001966
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001967 while (l) {
1968 cb->args[2] = l->key;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001969 if (fn_trie_dump_leaf(l, tb, skb, cb) < 0) {
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001970 cb->args[3] = count;
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001971 rcu_read_unlock();
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001972 return -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001973 }
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001974
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001975 ++count;
Stephen Hemmingerd5ce8a02008-01-22 21:57:22 -08001976 l = trie_nextleaf(l);
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001977 memset(&cb->args[4], 0,
1978 sizeof(cb->args) - 4*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001979 }
Stephen Hemminger71d67e62008-01-31 16:45:47 -08001980 cb->args[3] = count;
Robert Olsson2373ce12005-08-25 13:01:29 -07001981 rcu_read_unlock();
Stephen Hemmingera88ee222008-01-22 21:56:11 -08001982
Robert Olsson19baf832005-06-21 12:43:18 -07001983 return skb->len;
Robert Olsson19baf832005-06-21 12:43:18 -07001984}
1985
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08001986void __init fib_hash_init(void)
1987{
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08001988 fn_alias_kmem = kmem_cache_create("ip_fib_alias",
1989 sizeof(struct fib_alias),
Stephen Hemmingerbc3c8c12008-01-22 21:51:50 -08001990 0, SLAB_PANIC, NULL);
1991
1992 trie_leaf_kmem = kmem_cache_create("ip_fib_trie",
1993 max(sizeof(struct leaf),
1994 sizeof(struct leaf_info)),
1995 0, SLAB_PANIC, NULL);
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08001996}
Robert Olsson19baf832005-06-21 12:43:18 -07001997
Stephen Hemminger7f9b8052008-01-14 23:14:20 -08001998
1999/* Fix more generic FIB names for init later */
2000struct fib_table *fib_hash_table(u32 id)
Robert Olsson19baf832005-06-21 12:43:18 -07002001{
2002 struct fib_table *tb;
2003 struct trie *t;
2004
Robert Olsson19baf832005-06-21 12:43:18 -07002005 tb = kmalloc(sizeof(struct fib_table) + sizeof(struct trie),
2006 GFP_KERNEL);
2007 if (tb == NULL)
2008 return NULL;
2009
2010 tb->tb_id = id;
Denis V. Lunev971b8932007-12-08 00:32:23 -08002011 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07002012 tb->tb_lookup = fn_trie_lookup;
2013 tb->tb_insert = fn_trie_insert;
2014 tb->tb_delete = fn_trie_delete;
2015 tb->tb_flush = fn_trie_flush;
2016 tb->tb_select_default = fn_trie_select_default;
2017 tb->tb_dump = fn_trie_dump;
Robert Olsson19baf832005-06-21 12:43:18 -07002018
2019 t = (struct trie *) tb->tb_data;
Stephen Hemmingerc28a1cf2008-01-12 20:49:13 -08002020 memset(t, 0, sizeof(*t));
Robert Olsson19baf832005-06-21 12:43:18 -07002021
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002022 if (id == RT_TABLE_LOCAL)
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002023 pr_info("IPv4 FIB: Using LC-trie version %s\n", VERSION);
Robert Olsson19baf832005-06-21 12:43:18 -07002024
2025 return tb;
2026}
2027
Robert Olsson19baf832005-06-21 12:43:18 -07002028#ifdef CONFIG_PROC_FS
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002029/* Depth first Trie walk iterator */
2030struct fib_trie_iter {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002031 struct seq_net_private p;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002032 struct fib_table *tb;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002033 struct tnode *tnode;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002034 unsigned index;
2035 unsigned depth;
2036};
Robert Olsson19baf832005-06-21 12:43:18 -07002037
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002038static struct node *fib_trie_get_next(struct fib_trie_iter *iter)
Robert Olsson19baf832005-06-21 12:43:18 -07002039{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002040 struct tnode *tn = iter->tnode;
2041 unsigned cindex = iter->index;
2042 struct tnode *p;
2043
Eric W. Biederman6640e692007-01-24 14:42:04 -08002044 /* A single entry routing table */
2045 if (!tn)
2046 return NULL;
2047
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002048 pr_debug("get_next iter={node=%p index=%d depth=%d}\n",
2049 iter->tnode, iter->index, iter->depth);
2050rescan:
2051 while (cindex < (1<<tn->bits)) {
Eric Dumazetb59cfbf2008-01-18 03:31:36 -08002052 struct node *n = tnode_get_child_rcu(tn, cindex);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002053
2054 if (n) {
2055 if (IS_LEAF(n)) {
2056 iter->tnode = tn;
2057 iter->index = cindex + 1;
2058 } else {
2059 /* push down one level */
2060 iter->tnode = (struct tnode *) n;
2061 iter->index = 0;
2062 ++iter->depth;
2063 }
2064 return n;
2065 }
2066
2067 ++cindex;
2068 }
2069
2070 /* Current node exhausted, pop back up */
Eric Dumazetb59cfbf2008-01-18 03:31:36 -08002071 p = node_parent_rcu((struct node *)tn);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002072 if (p) {
2073 cindex = tkey_extract_bits(tn->key, p->pos, p->bits)+1;
2074 tn = p;
2075 --iter->depth;
2076 goto rescan;
2077 }
2078
2079 /* got root? */
Robert Olsson19baf832005-06-21 12:43:18 -07002080 return NULL;
2081}
2082
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002083static struct node *fib_trie_get_first(struct fib_trie_iter *iter,
2084 struct trie *t)
Robert Olsson19baf832005-06-21 12:43:18 -07002085{
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002086 struct node *n;
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002087
Stephen Hemminger132adf52007-03-08 20:44:43 -08002088 if (!t)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002089 return NULL;
2090
2091 n = rcu_dereference(t->trie);
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002092 if (!n)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002093 return NULL;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002094
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002095 if (IS_TNODE(n)) {
2096 iter->tnode = (struct tnode *) n;
2097 iter->index = 0;
2098 iter->depth = 1;
2099 } else {
2100 iter->tnode = NULL;
2101 iter->index = 0;
2102 iter->depth = 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002103 }
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002104
2105 return n;
Robert Olsson19baf832005-06-21 12:43:18 -07002106}
2107
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002108static void trie_collect_stats(struct trie *t, struct trie_stat *s)
Robert Olsson19baf832005-06-21 12:43:18 -07002109{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002110 struct node *n;
2111 struct fib_trie_iter iter;
Robert Olsson19baf832005-06-21 12:43:18 -07002112
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002113 memset(s, 0, sizeof(*s));
Robert Olsson19baf832005-06-21 12:43:18 -07002114
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002115 rcu_read_lock();
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002116 for (n = fib_trie_get_first(&iter, t); n; n = fib_trie_get_next(&iter)) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002117 if (IS_LEAF(n)) {
Stephen Hemminger93672292008-01-22 21:54:05 -08002118 struct leaf *l = (struct leaf *)n;
2119 struct leaf_info *li;
2120 struct hlist_node *tmp;
2121
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002122 s->leaves++;
2123 s->totdepth += iter.depth;
2124 if (iter.depth > s->maxdepth)
2125 s->maxdepth = iter.depth;
Stephen Hemminger93672292008-01-22 21:54:05 -08002126
2127 hlist_for_each_entry_rcu(li, tmp, &l->list, hlist)
2128 ++s->prefixes;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002129 } else {
2130 const struct tnode *tn = (const struct tnode *) n;
2131 int i;
Robert Olsson19baf832005-06-21 12:43:18 -07002132
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002133 s->tnodes++;
Stephen Hemminger132adf52007-03-08 20:44:43 -08002134 if (tn->bits < MAX_STAT_DEPTH)
Robert Olsson06ef9212006-03-20 21:35:01 -08002135 s->nodesizes[tn->bits]++;
2136
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002137 for (i = 0; i < (1<<tn->bits); i++)
2138 if (!tn->child[i])
2139 s->nullpointers++;
2140 }
2141 }
2142 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002143}
2144
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002145/*
Robert Olsson19baf832005-06-21 12:43:18 -07002146 * This outputs /proc/net/fib_triestats
Robert Olsson19baf832005-06-21 12:43:18 -07002147 */
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002148static void trie_show_stats(struct seq_file *seq, struct trie_stat *stat)
Robert Olsson19baf832005-06-21 12:43:18 -07002149{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002150 unsigned i, max, pointers, bytes, avdepth;
Robert Olsson19baf832005-06-21 12:43:18 -07002151
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002152 if (stat->leaves)
2153 avdepth = stat->totdepth*100 / stat->leaves;
2154 else
2155 avdepth = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002156
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002157 seq_printf(seq, "\tAver depth: %u.%02d\n",
2158 avdepth / 100, avdepth % 100);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002159 seq_printf(seq, "\tMax depth: %u\n", stat->maxdepth);
Robert Olsson19baf832005-06-21 12:43:18 -07002160
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002161 seq_printf(seq, "\tLeaves: %u\n", stat->leaves);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002162 bytes = sizeof(struct leaf) * stat->leaves;
Stephen Hemminger93672292008-01-22 21:54:05 -08002163
2164 seq_printf(seq, "\tPrefixes: %u\n", stat->prefixes);
2165 bytes += sizeof(struct leaf_info) * stat->prefixes;
2166
Stephen Hemminger187b5182008-01-12 20:55:55 -08002167 seq_printf(seq, "\tInternal nodes: %u\n\t", stat->tnodes);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002168 bytes += sizeof(struct tnode) * stat->tnodes;
Robert Olsson19baf832005-06-21 12:43:18 -07002169
Robert Olsson06ef9212006-03-20 21:35:01 -08002170 max = MAX_STAT_DEPTH;
2171 while (max > 0 && stat->nodesizes[max-1] == 0)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002172 max--;
Robert Olsson19baf832005-06-21 12:43:18 -07002173
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002174 pointers = 0;
2175 for (i = 1; i <= max; i++)
2176 if (stat->nodesizes[i] != 0) {
Stephen Hemminger187b5182008-01-12 20:55:55 -08002177 seq_printf(seq, " %u: %u", i, stat->nodesizes[i]);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002178 pointers += (1<<i) * stat->nodesizes[i];
2179 }
2180 seq_putc(seq, '\n');
Stephen Hemminger187b5182008-01-12 20:55:55 -08002181 seq_printf(seq, "\tPointers: %u\n", pointers);
Robert Olsson19baf832005-06-21 12:43:18 -07002182
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002183 bytes += sizeof(struct node *) * pointers;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002184 seq_printf(seq, "Null ptrs: %u\n", stat->nullpointers);
2185 seq_printf(seq, "Total size: %u kB\n", (bytes + 1023) / 1024);
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002186}
Robert Olsson19baf832005-06-21 12:43:18 -07002187
2188#ifdef CONFIG_IP_FIB_TRIE_STATS
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002189static void trie_show_usage(struct seq_file *seq,
2190 const struct trie_use_stats *stats)
2191{
2192 seq_printf(seq, "\nCounters:\n---------\n");
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002193 seq_printf(seq, "gets = %u\n", stats->gets);
2194 seq_printf(seq, "backtracks = %u\n", stats->backtrack);
2195 seq_printf(seq, "semantic match passed = %u\n",
2196 stats->semantic_match_passed);
2197 seq_printf(seq, "semantic match miss = %u\n",
2198 stats->semantic_match_miss);
2199 seq_printf(seq, "null node hit= %u\n", stats->null_node_hit);
2200 seq_printf(seq, "skipped node resize = %u\n\n",
2201 stats->resize_node_skipped);
Robert Olsson19baf832005-06-21 12:43:18 -07002202}
Stephen Hemminger66a2f7f2008-01-12 21:23:17 -08002203#endif /* CONFIG_IP_FIB_TRIE_STATS */
2204
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002205static void fib_table_print(struct seq_file *seq, struct fib_table *tb)
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002206{
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002207 if (tb->tb_id == RT_TABLE_LOCAL)
2208 seq_puts(seq, "Local:\n");
2209 else if (tb->tb_id == RT_TABLE_MAIN)
2210 seq_puts(seq, "Main:\n");
2211 else
2212 seq_printf(seq, "Id %d:\n", tb->tb_id);
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002213}
Robert Olsson19baf832005-06-21 12:43:18 -07002214
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002215
Robert Olsson19baf832005-06-21 12:43:18 -07002216static int fib_triestat_seq_show(struct seq_file *seq, void *v)
2217{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002218 struct net *net = (struct net *)seq->private;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002219 unsigned int h;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002220
Stephen Hemmingerd717a9a2008-01-14 23:11:54 -08002221 seq_printf(seq,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002222 "Basic info: size of leaf:"
2223 " %Zd bytes, size of tnode: %Zd bytes.\n",
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002224 sizeof(struct leaf), sizeof(struct tnode));
Olof Johansson91b9a272005-08-09 20:24:39 -07002225
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002226 for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
2227 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2228 struct hlist_node *node;
2229 struct fib_table *tb;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002230
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002231 hlist_for_each_entry_rcu(tb, node, head, tb_hlist) {
2232 struct trie *t = (struct trie *) tb->tb_data;
2233 struct trie_stat stat;
2234
2235 if (!t)
2236 continue;
2237
2238 fib_table_print(seq, tb);
2239
2240 trie_collect_stats(t, &stat);
2241 trie_show_stats(seq, &stat);
2242#ifdef CONFIG_IP_FIB_TRIE_STATS
2243 trie_show_usage(seq, &t->stats);
2244#endif
2245 }
2246 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002247
Robert Olsson19baf832005-06-21 12:43:18 -07002248 return 0;
2249}
2250
Robert Olsson19baf832005-06-21 12:43:18 -07002251static int fib_triestat_seq_open(struct inode *inode, struct file *file)
2252{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002253 int err;
2254 struct net *net;
2255
2256 net = get_proc_net(inode);
2257 if (net == NULL)
2258 return -ENXIO;
2259 err = single_open(file, fib_triestat_seq_show, net);
2260 if (err < 0) {
2261 put_net(net);
2262 return err;
2263 }
2264 return 0;
2265}
2266
2267static int fib_triestat_seq_release(struct inode *ino, struct file *f)
2268{
2269 struct seq_file *seq = f->private_data;
2270 put_net(seq->private);
2271 return single_release(ino, f);
Robert Olsson19baf832005-06-21 12:43:18 -07002272}
2273
Arjan van de Ven9a321442007-02-12 00:55:35 -08002274static const struct file_operations fib_triestat_fops = {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002275 .owner = THIS_MODULE,
2276 .open = fib_triestat_seq_open,
2277 .read = seq_read,
2278 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002279 .release = fib_triestat_seq_release,
Robert Olsson19baf832005-06-21 12:43:18 -07002280};
2281
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002282static struct node *fib_trie_get_idx(struct seq_file *seq, loff_t pos)
Robert Olsson19baf832005-06-21 12:43:18 -07002283{
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002284 struct fib_trie_iter *iter = seq->private;
2285 struct net *net = seq_file_net(seq);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002286 loff_t idx = 0;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002287 unsigned int h;
Robert Olsson19baf832005-06-21 12:43:18 -07002288
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002289 for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
2290 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2291 struct hlist_node *node;
2292 struct fib_table *tb;
2293
2294 hlist_for_each_entry_rcu(tb, node, head, tb_hlist) {
2295 struct node *n;
2296
2297 for (n = fib_trie_get_first(iter,
2298 (struct trie *) tb->tb_data);
2299 n; n = fib_trie_get_next(iter))
2300 if (pos == idx++) {
2301 iter->tb = tb;
2302 return n;
2303 }
2304 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002305 }
Robert Olsson19baf832005-06-21 12:43:18 -07002306
Robert Olsson19baf832005-06-21 12:43:18 -07002307 return NULL;
2308}
2309
2310static void *fib_trie_seq_start(struct seq_file *seq, loff_t *pos)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002311 __acquires(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002312{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002313 rcu_read_lock();
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002314 return fib_trie_get_idx(seq, *pos);
Robert Olsson19baf832005-06-21 12:43:18 -07002315}
2316
2317static void *fib_trie_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2318{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002319 struct fib_trie_iter *iter = seq->private;
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002320 struct net *net = seq_file_net(seq);
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002321 struct fib_table *tb = iter->tb;
2322 struct hlist_node *tb_node;
2323 unsigned int h;
2324 struct node *n;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002325
Robert Olsson19baf832005-06-21 12:43:18 -07002326 ++*pos;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002327 /* next node in same table */
2328 n = fib_trie_get_next(iter);
2329 if (n)
2330 return n;
Olof Johansson91b9a272005-08-09 20:24:39 -07002331
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002332 /* walk rest of this hash chain */
2333 h = tb->tb_id & (FIB_TABLE_HASHSZ - 1);
2334 while ( (tb_node = rcu_dereference(tb->tb_hlist.next)) ) {
2335 tb = hlist_entry(tb_node, struct fib_table, tb_hlist);
2336 n = fib_trie_get_first(iter, (struct trie *) tb->tb_data);
2337 if (n)
2338 goto found;
2339 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002340
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002341 /* new hash chain */
2342 while (++h < FIB_TABLE_HASHSZ) {
2343 struct hlist_head *head = &net->ipv4.fib_table_hash[h];
2344 hlist_for_each_entry_rcu(tb, tb_node, head, tb_hlist) {
2345 n = fib_trie_get_first(iter, (struct trie *) tb->tb_data);
2346 if (n)
2347 goto found;
2348 }
2349 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002350 return NULL;
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002351
2352found:
2353 iter->tb = tb;
2354 return n;
Robert Olsson19baf832005-06-21 12:43:18 -07002355}
2356
2357static void fib_trie_seq_stop(struct seq_file *seq, void *v)
Stephen Hemmingerc95aaf92008-01-12 21:25:02 -08002358 __releases(RCU)
Robert Olsson19baf832005-06-21 12:43:18 -07002359{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002360 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002361}
2362
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002363static void seq_indent(struct seq_file *seq, int n)
2364{
2365 while (n-- > 0) seq_puts(seq, " ");
2366}
Robert Olsson19baf832005-06-21 12:43:18 -07002367
Eric Dumazet28d36e32008-01-14 23:09:56 -08002368static inline const char *rtn_scope(char *buf, size_t len, enum rt_scope_t s)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002369{
Stephen Hemminger132adf52007-03-08 20:44:43 -08002370 switch (s) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002371 case RT_SCOPE_UNIVERSE: return "universe";
2372 case RT_SCOPE_SITE: return "site";
2373 case RT_SCOPE_LINK: return "link";
2374 case RT_SCOPE_HOST: return "host";
2375 case RT_SCOPE_NOWHERE: return "nowhere";
2376 default:
Eric Dumazet28d36e32008-01-14 23:09:56 -08002377 snprintf(buf, len, "scope=%d", s);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002378 return buf;
2379 }
2380}
2381
2382static const char *rtn_type_names[__RTN_MAX] = {
2383 [RTN_UNSPEC] = "UNSPEC",
2384 [RTN_UNICAST] = "UNICAST",
2385 [RTN_LOCAL] = "LOCAL",
2386 [RTN_BROADCAST] = "BROADCAST",
2387 [RTN_ANYCAST] = "ANYCAST",
2388 [RTN_MULTICAST] = "MULTICAST",
2389 [RTN_BLACKHOLE] = "BLACKHOLE",
2390 [RTN_UNREACHABLE] = "UNREACHABLE",
2391 [RTN_PROHIBIT] = "PROHIBIT",
2392 [RTN_THROW] = "THROW",
2393 [RTN_NAT] = "NAT",
2394 [RTN_XRESOLVE] = "XRESOLVE",
2395};
2396
Eric Dumazet28d36e32008-01-14 23:09:56 -08002397static inline const char *rtn_type(char *buf, size_t len, unsigned t)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002398{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002399 if (t < __RTN_MAX && rtn_type_names[t])
2400 return rtn_type_names[t];
Eric Dumazet28d36e32008-01-14 23:09:56 -08002401 snprintf(buf, len, "type %u", t);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002402 return buf;
2403}
2404
2405/* Pretty print the trie */
Robert Olsson19baf832005-06-21 12:43:18 -07002406static int fib_trie_seq_show(struct seq_file *seq, void *v)
2407{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002408 const struct fib_trie_iter *iter = seq->private;
2409 struct node *n = v;
Robert Olsson19baf832005-06-21 12:43:18 -07002410
Stephen Hemminger3d3b2d22008-03-23 22:43:56 -07002411 if (!node_parent_rcu(n))
2412 fib_table_print(seq, iter->tb);
Robert Olsson095b8502007-01-26 19:06:01 -08002413
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002414 if (IS_TNODE(n)) {
2415 struct tnode *tn = (struct tnode *) n;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07002416 __be32 prf = htonl(mask_pfx(tn->key, tn->pos));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002417
Robert Olsson1d25cd62005-09-19 15:29:52 -07002418 seq_indent(seq, iter->depth-1);
2419 seq_printf(seq, " +-- %d.%d.%d.%d/%d %d %d %d\n",
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002420 NIPQUAD(prf), tn->pos, tn->bits, tn->full_children,
Robert Olsson1d25cd62005-09-19 15:29:52 -07002421 tn->empty_children);
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002422
Olof Johansson91b9a272005-08-09 20:24:39 -07002423 } else {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002424 struct leaf *l = (struct leaf *) n;
Stephen Hemminger13280422008-01-22 21:54:37 -08002425 struct leaf_info *li;
2426 struct hlist_node *node;
Al Viro32ab5f82006-09-26 22:21:45 -07002427 __be32 val = htonl(l->key);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002428
2429 seq_indent(seq, iter->depth);
2430 seq_printf(seq, " |-- %d.%d.%d.%d\n", NIPQUAD(val));
Eric Dumazet28d36e32008-01-14 23:09:56 -08002431
Stephen Hemminger13280422008-01-22 21:54:37 -08002432 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
2433 struct fib_alias *fa;
Eric Dumazet28d36e32008-01-14 23:09:56 -08002434
Stephen Hemminger13280422008-01-22 21:54:37 -08002435 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
2436 char buf1[32], buf2[32];
Eric Dumazet28d36e32008-01-14 23:09:56 -08002437
Stephen Hemminger13280422008-01-22 21:54:37 -08002438 seq_indent(seq, iter->depth+1);
2439 seq_printf(seq, " /%d %s %s", li->plen,
2440 rtn_scope(buf1, sizeof(buf1),
2441 fa->fa_scope),
2442 rtn_type(buf2, sizeof(buf2),
2443 fa->fa_type));
2444 if (fa->fa_tos)
Denis V. Lunevb9c4d822008-02-05 02:58:45 -08002445 seq_printf(seq, " tos=%d", fa->fa_tos);
Stephen Hemminger13280422008-01-22 21:54:37 -08002446 seq_putc(seq, '\n');
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002447 }
2448 }
Robert Olsson19baf832005-06-21 12:43:18 -07002449 }
2450
2451 return 0;
2452}
2453
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002454static const struct seq_operations fib_trie_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002455 .start = fib_trie_seq_start,
2456 .next = fib_trie_seq_next,
2457 .stop = fib_trie_seq_stop,
2458 .show = fib_trie_seq_show,
Robert Olsson19baf832005-06-21 12:43:18 -07002459};
2460
2461static int fib_trie_seq_open(struct inode *inode, struct file *file)
2462{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002463 return seq_open_net(inode, file, &fib_trie_seq_ops,
2464 sizeof(struct fib_trie_iter));
Robert Olsson19baf832005-06-21 12:43:18 -07002465}
2466
Arjan van de Ven9a321442007-02-12 00:55:35 -08002467static const struct file_operations fib_trie_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002468 .owner = THIS_MODULE,
2469 .open = fib_trie_seq_open,
2470 .read = seq_read,
2471 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002472 .release = seq_release_net,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002473};
2474
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002475struct fib_route_iter {
2476 struct seq_net_private p;
2477 struct trie *main_trie;
2478 loff_t pos;
2479 t_key key;
2480};
2481
2482static struct leaf *fib_route_get_idx(struct fib_route_iter *iter, loff_t pos)
2483{
2484 struct leaf *l = NULL;
2485 struct trie *t = iter->main_trie;
2486
2487 /* use cache location of last found key */
2488 if (iter->pos > 0 && pos >= iter->pos && (l = fib_find_node(t, iter->key)))
2489 pos -= iter->pos;
2490 else {
2491 iter->pos = 0;
2492 l = trie_firstleaf(t);
2493 }
2494
2495 while (l && pos-- > 0) {
2496 iter->pos++;
2497 l = trie_nextleaf(l);
2498 }
2499
2500 if (l)
2501 iter->key = pos; /* remember it */
2502 else
2503 iter->pos = 0; /* forget it */
2504
2505 return l;
2506}
2507
2508static void *fib_route_seq_start(struct seq_file *seq, loff_t *pos)
2509 __acquires(RCU)
2510{
2511 struct fib_route_iter *iter = seq->private;
2512 struct fib_table *tb;
2513
2514 rcu_read_lock();
YOSHIFUJI Hideaki12188542008-03-26 02:36:06 +09002515 tb = fib_get_table(seq_file_net(seq), RT_TABLE_MAIN);
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002516 if (!tb)
2517 return NULL;
2518
2519 iter->main_trie = (struct trie *) tb->tb_data;
2520 if (*pos == 0)
2521 return SEQ_START_TOKEN;
2522 else
2523 return fib_route_get_idx(iter, *pos - 1);
2524}
2525
2526static void *fib_route_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2527{
2528 struct fib_route_iter *iter = seq->private;
2529 struct leaf *l = v;
2530
2531 ++*pos;
2532 if (v == SEQ_START_TOKEN) {
2533 iter->pos = 0;
2534 l = trie_firstleaf(iter->main_trie);
2535 } else {
2536 iter->pos++;
2537 l = trie_nextleaf(l);
2538 }
2539
2540 if (l)
2541 iter->key = l->key;
2542 else
2543 iter->pos = 0;
2544 return l;
2545}
2546
2547static void fib_route_seq_stop(struct seq_file *seq, void *v)
2548 __releases(RCU)
2549{
2550 rcu_read_unlock();
2551}
2552
Al Viro32ab5f82006-09-26 22:21:45 -07002553static unsigned fib_flag_trans(int type, __be32 mask, const struct fib_info *fi)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002554{
2555 static unsigned type2flags[RTN_MAX + 1] = {
2556 [7] = RTF_REJECT, [8] = RTF_REJECT,
2557 };
2558 unsigned flags = type2flags[type];
2559
2560 if (fi && fi->fib_nh->nh_gw)
2561 flags |= RTF_GATEWAY;
Al Viro32ab5f82006-09-26 22:21:45 -07002562 if (mask == htonl(0xFFFFFFFF))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002563 flags |= RTF_HOST;
2564 flags |= RTF_UP;
2565 return flags;
2566}
2567
2568/*
2569 * This outputs /proc/net/route.
2570 * The format of the file is not supposed to be changed
2571 * and needs to be same as fib_hash output to avoid breaking
2572 * legacy utilities
2573 */
2574static int fib_route_seq_show(struct seq_file *seq, void *v)
2575{
2576 struct leaf *l = v;
Stephen Hemminger13280422008-01-22 21:54:37 -08002577 struct leaf_info *li;
2578 struct hlist_node *node;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002579
2580 if (v == SEQ_START_TOKEN) {
2581 seq_printf(seq, "%-127s\n", "Iface\tDestination\tGateway "
2582 "\tFlags\tRefCnt\tUse\tMetric\tMask\t\tMTU"
2583 "\tWindow\tIRTT");
2584 return 0;
2585 }
2586
Stephen Hemminger13280422008-01-22 21:54:37 -08002587 hlist_for_each_entry_rcu(li, node, &l->list, hlist) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002588 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07002589 __be32 mask, prefix;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002590
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002591 mask = inet_make_mask(li->plen);
2592 prefix = htonl(l->key);
2593
2594 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
Herbert Xu1371e372005-10-15 09:42:39 +10002595 const struct fib_info *fi = fa->fa_info;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002596 unsigned flags = fib_flag_trans(fa->fa_type, mask, fi);
Stephen Hemminger13280422008-01-22 21:54:37 -08002597 char bf[128];
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002598
2599 if (fa->fa_type == RTN_BROADCAST
2600 || fa->fa_type == RTN_MULTICAST)
2601 continue;
2602
2603 if (fi)
2604 snprintf(bf, sizeof(bf),
2605 "%s\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2606 fi->fib_dev ? fi->fib_dev->name : "*",
2607 prefix,
2608 fi->fib_nh->nh_gw, flags, 0, 0,
2609 fi->fib_priority,
2610 mask,
Stephen Hemmingera07f5f52008-01-22 21:53:36 -08002611 (fi->fib_advmss ?
2612 fi->fib_advmss + 40 : 0),
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002613 fi->fib_window,
2614 fi->fib_rtt >> 3);
2615 else
2616 snprintf(bf, sizeof(bf),
2617 "*\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2618 prefix, 0, flags, 0, 0, 0,
2619 mask, 0, 0, 0);
2620
2621 seq_printf(seq, "%-127s\n", bf);
2622 }
2623 }
2624
2625 return 0;
2626}
2627
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002628static const struct seq_operations fib_route_seq_ops = {
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002629 .start = fib_route_seq_start,
2630 .next = fib_route_seq_next,
2631 .stop = fib_route_seq_stop,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002632 .show = fib_route_seq_show,
2633};
2634
2635static int fib_route_seq_open(struct inode *inode, struct file *file)
2636{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002637 return seq_open_net(inode, file, &fib_route_seq_ops,
Stephen Hemminger8315f5d2008-02-11 21:14:39 -08002638 sizeof(struct fib_route_iter));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002639}
2640
Arjan van de Ven9a321442007-02-12 00:55:35 -08002641static const struct file_operations fib_route_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002642 .owner = THIS_MODULE,
2643 .open = fib_route_seq_open,
2644 .read = seq_read,
2645 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002646 .release = seq_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002647};
2648
Denis V. Lunev61a02652008-01-10 03:21:09 -08002649int __net_init fib_proc_init(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002650{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002651 if (!proc_net_fops_create(net, "fib_trie", S_IRUGO, &fib_trie_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002652 goto out1;
2653
Denis V. Lunev61a02652008-01-10 03:21:09 -08002654 if (!proc_net_fops_create(net, "fib_triestat", S_IRUGO,
2655 &fib_triestat_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002656 goto out2;
2657
Denis V. Lunev61a02652008-01-10 03:21:09 -08002658 if (!proc_net_fops_create(net, "route", S_IRUGO, &fib_route_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002659 goto out3;
2660
Robert Olsson19baf832005-06-21 12:43:18 -07002661 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002662
2663out3:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002664 proc_net_remove(net, "fib_triestat");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002665out2:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002666 proc_net_remove(net, "fib_trie");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002667out1:
2668 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002669}
2670
Denis V. Lunev61a02652008-01-10 03:21:09 -08002671void __net_exit fib_proc_exit(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002672{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002673 proc_net_remove(net, "fib_trie");
2674 proc_net_remove(net, "fib_triestat");
2675 proc_net_remove(net, "route");
Robert Olsson19baf832005-06-21 12:43:18 -07002676}
2677
2678#endif /* CONFIG_PROC_FS */