blob: f5c046b517e4f6db9a294c4a48b59fb949658653 [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
85#undef CONFIG_IP_FIB_TRIE_STATS
Robert Olsson06ef9212006-03-20 21:35:01 -080086#define MAX_STAT_DEPTH 32
Robert Olsson19baf832005-06-21 12:43:18 -070087
Robert Olsson19baf832005-06-21 12:43:18 -070088#define KEYLENGTH (8*sizeof(t_key))
Robert Olsson19baf832005-06-21 12:43:18 -070089
Robert Olsson19baf832005-06-21 12:43:18 -070090typedef unsigned int t_key;
91
92#define T_TNODE 0
93#define T_LEAF 1
94#define NODE_TYPE_MASK 0x1UL
Robert Olsson2373ce12005-08-25 13:01:29 -070095#define NODE_TYPE(node) ((node)->parent & NODE_TYPE_MASK)
96
Olof Johansson91b9a272005-08-09 20:24:39 -070097#define IS_TNODE(n) (!(n->parent & T_LEAF))
98#define IS_LEAF(n) (n->parent & T_LEAF)
Robert Olsson19baf832005-06-21 12:43:18 -070099
100struct node {
Olof Johansson91b9a272005-08-09 20:24:39 -0700101 t_key key;
102 unsigned long parent;
Robert Olsson19baf832005-06-21 12:43:18 -0700103};
104
105struct leaf {
Olof Johansson91b9a272005-08-09 20:24:39 -0700106 t_key key;
107 unsigned long parent;
Robert Olsson19baf832005-06-21 12:43:18 -0700108 struct hlist_head list;
Robert Olsson2373ce12005-08-25 13:01:29 -0700109 struct rcu_head rcu;
Robert Olsson19baf832005-06-21 12:43:18 -0700110};
111
112struct leaf_info {
113 struct hlist_node hlist;
Robert Olsson2373ce12005-08-25 13:01:29 -0700114 struct rcu_head rcu;
Robert Olsson19baf832005-06-21 12:43:18 -0700115 int plen;
116 struct list_head falh;
117};
118
119struct tnode {
Olof Johansson91b9a272005-08-09 20:24:39 -0700120 t_key key;
121 unsigned long parent;
122 unsigned short pos:5; /* 2log(KEYLENGTH) bits needed */
123 unsigned short bits:5; /* 2log(KEYLENGTH) bits needed */
124 unsigned short full_children; /* KEYLENGTH bits needed */
125 unsigned short empty_children; /* KEYLENGTH bits needed */
Robert Olsson2373ce12005-08-25 13:01:29 -0700126 struct rcu_head rcu;
Olof Johansson91b9a272005-08-09 20:24:39 -0700127 struct node *child[0];
Robert Olsson19baf832005-06-21 12:43:18 -0700128};
129
130#ifdef CONFIG_IP_FIB_TRIE_STATS
131struct trie_use_stats {
132 unsigned int gets;
133 unsigned int backtrack;
134 unsigned int semantic_match_passed;
135 unsigned int semantic_match_miss;
136 unsigned int null_node_hit;
Robert Olsson2f368952005-07-05 15:02:40 -0700137 unsigned int resize_node_skipped;
Robert Olsson19baf832005-06-21 12:43:18 -0700138};
139#endif
140
141struct trie_stat {
142 unsigned int totdepth;
143 unsigned int maxdepth;
144 unsigned int tnodes;
145 unsigned int leaves;
146 unsigned int nullpointers;
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
Olof Johansson91b9a272005-08-09 20:24:39 -0700155 int size;
Robert Olsson19baf832005-06-21 12:43:18 -0700156};
157
Robert Olsson19baf832005-06-21 12:43:18 -0700158static void put_child(struct trie *t, struct tnode *tn, int i, struct node *n);
159static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n, 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;
Robert Olsson19baf832005-06-21 12:43:18 -0700166
Stephen Hemminger06801912007-08-10 15:22:13 -0700167static inline struct tnode *node_parent(struct node *node)
168{
169 struct tnode *ret;
170
171 ret = (struct tnode *)(node->parent & ~NODE_TYPE_MASK);
172 return rcu_dereference(ret);
173}
174
175static inline void node_set_parent(struct node *node, struct tnode *ptr)
176{
177 rcu_assign_pointer(node->parent,
178 (unsigned long)ptr | NODE_TYPE(node));
179}
Robert Olsson2373ce12005-08-25 13:01:29 -0700180
181/* rcu_read_lock needs to be hold by caller from readside */
182
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700183static inline struct node *tnode_get_child(struct tnode *tn, int i)
Robert Olsson19baf832005-06-21 12:43:18 -0700184{
Olof Johansson91b9a272005-08-09 20:24:39 -0700185 BUG_ON(i >= 1 << tn->bits);
Robert Olsson19baf832005-06-21 12:43:18 -0700186
Robert Olsson2373ce12005-08-25 13:01:29 -0700187 return rcu_dereference(tn->child[i]);
Robert Olsson19baf832005-06-21 12:43:18 -0700188}
189
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700190static inline int tnode_child_length(const struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700191{
Olof Johansson91b9a272005-08-09 20:24:39 -0700192 return 1 << tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -0700193}
194
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700195static inline t_key mask_pfx(t_key k, unsigned short l)
196{
197 return (l == 0) ? 0 : k >> (KEYLENGTH-l) << (KEYLENGTH-l);
198}
199
Robert Olsson19baf832005-06-21 12:43:18 -0700200static inline t_key tkey_extract_bits(t_key a, int offset, int bits)
201{
Olof Johansson91b9a272005-08-09 20:24:39 -0700202 if (offset < KEYLENGTH)
Robert Olsson19baf832005-06-21 12:43:18 -0700203 return ((t_key)(a << offset)) >> (KEYLENGTH - bits);
Olof Johansson91b9a272005-08-09 20:24:39 -0700204 else
Robert Olsson19baf832005-06-21 12:43:18 -0700205 return 0;
206}
207
208static inline int tkey_equals(t_key a, t_key b)
209{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700210 return a == b;
Robert Olsson19baf832005-06-21 12:43:18 -0700211}
212
213static inline int tkey_sub_equals(t_key a, int offset, int bits, t_key b)
214{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700215 if (bits == 0 || offset >= KEYLENGTH)
216 return 1;
Olof Johansson91b9a272005-08-09 20:24:39 -0700217 bits = bits > KEYLENGTH ? KEYLENGTH : bits;
218 return ((a ^ b) << offset) >> (KEYLENGTH - bits) == 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700219}
Robert Olsson19baf832005-06-21 12:43:18 -0700220
221static inline int tkey_mismatch(t_key a, int offset, t_key b)
222{
223 t_key diff = a ^ b;
224 int i = offset;
225
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700226 if (!diff)
227 return 0;
228 while ((diff << i) >> (KEYLENGTH-1) == 0)
Robert Olsson19baf832005-06-21 12:43:18 -0700229 i++;
230 return i;
231}
232
Robert Olsson19baf832005-06-21 12:43:18 -0700233/*
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900234 To understand this stuff, an understanding of keys and all their bits is
235 necessary. Every node in the trie has a key associated with it, but not
Robert Olsson19baf832005-06-21 12:43:18 -0700236 all of the bits in that key are significant.
237
238 Consider a node 'n' and its parent 'tp'.
239
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900240 If n is a leaf, every bit in its key is significant. Its presence is
241 necessitated by path compression, since during a tree traversal (when
242 searching for a leaf - unless we are doing an insertion) we will completely
243 ignore all skipped bits we encounter. Thus we need to verify, at the end of
244 a potentially successful search, that we have indeed been walking the
Robert Olsson19baf832005-06-21 12:43:18 -0700245 correct key path.
246
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900247 Note that we can never "miss" the correct key in the tree if present by
248 following the wrong path. Path compression ensures that segments of the key
249 that are the same for all keys with a given prefix are skipped, but the
250 skipped part *is* identical for each node in the subtrie below the skipped
251 bit! trie_insert() in this implementation takes care of that - note the
Robert Olsson19baf832005-06-21 12:43:18 -0700252 call to tkey_sub_equals() in trie_insert().
253
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900254 if n is an internal node - a 'tnode' here, the various parts of its key
Robert Olsson19baf832005-06-21 12:43:18 -0700255 have many different meanings.
256
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900257 Example:
Robert Olsson19baf832005-06-21 12:43:18 -0700258 _________________________________________________________________
259 | i | i | i | i | i | i | i | N | N | N | S | S | S | S | S | C |
260 -----------------------------------------------------------------
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900261 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
Robert Olsson19baf832005-06-21 12:43:18 -0700262
263 _________________________________________________________________
264 | C | C | C | u | u | u | u | u | u | u | u | u | u | u | u | u |
265 -----------------------------------------------------------------
266 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31
267
268 tp->pos = 7
269 tp->bits = 3
270 n->pos = 15
Olof Johansson91b9a272005-08-09 20:24:39 -0700271 n->bits = 4
Robert Olsson19baf832005-06-21 12:43:18 -0700272
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900273 First, let's just ignore the bits that come before the parent tp, that is
274 the bits from 0 to (tp->pos-1). They are *known* but at this point we do
Robert Olsson19baf832005-06-21 12:43:18 -0700275 not use them for anything.
276
277 The bits from (tp->pos) to (tp->pos + tp->bits - 1) - "N", above - are the
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900278 index into the parent's child array. That is, they will be used to find
Robert Olsson19baf832005-06-21 12:43:18 -0700279 'n' among tp's children.
280
281 The bits from (tp->pos + tp->bits) to (n->pos - 1) - "S" - are skipped bits
282 for the node n.
283
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900284 All the bits we have seen so far are significant to the node n. The rest
Robert Olsson19baf832005-06-21 12:43:18 -0700285 of the bits are really not needed or indeed known in n->key.
286
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900287 The bits from (n->pos) to (n->pos + n->bits - 1) - "C" - are the index into
Robert Olsson19baf832005-06-21 12:43:18 -0700288 n's child array, and will of course be different for each child.
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900289
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700290
Robert Olsson19baf832005-06-21 12:43:18 -0700291 The rest of the bits, from (n->pos + n->bits) onward, are completely unknown
292 at this point.
293
294*/
295
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700296static inline void check_tnode(const struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700297{
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700298 WARN_ON(tn && tn->pos+tn->bits > 32);
Robert Olsson19baf832005-06-21 12:43:18 -0700299}
300
Denis V. Lunevf5026fa2007-12-13 09:47:57 -0800301static const int halve_threshold = 25;
302static const int inflate_threshold = 50;
303static const int halve_threshold_root = 8;
304static const int inflate_threshold_root = 15;
Robert Olsson19baf832005-06-21 12:43:18 -0700305
Robert Olsson2373ce12005-08-25 13:01:29 -0700306
307static void __alias_free_mem(struct rcu_head *head)
308{
309 struct fib_alias *fa = container_of(head, struct fib_alias, rcu);
310 kmem_cache_free(fn_alias_kmem, fa);
311}
312
313static inline void alias_free_mem_rcu(struct fib_alias *fa)
314{
315 call_rcu(&fa->rcu, __alias_free_mem);
316}
317
318static void __leaf_free_rcu(struct rcu_head *head)
319{
320 kfree(container_of(head, struct leaf, rcu));
321}
322
Robert Olsson2373ce12005-08-25 13:01:29 -0700323static void __leaf_info_free_rcu(struct rcu_head *head)
324{
325 kfree(container_of(head, struct leaf_info, rcu));
326}
327
328static inline void free_leaf_info(struct leaf_info *leaf)
329{
330 call_rcu(&leaf->rcu, __leaf_info_free_rcu);
331}
332
333static struct tnode *tnode_alloc(unsigned int size)
334{
335 struct page *pages;
336
337 if (size <= PAGE_SIZE)
338 return kcalloc(size, 1, GFP_KERNEL);
339
340 pages = alloc_pages(GFP_KERNEL|__GFP_ZERO, get_order(size));
341 if (!pages)
342 return NULL;
343
344 return page_address(pages);
345}
346
347static void __tnode_free_rcu(struct rcu_head *head)
348{
349 struct tnode *tn = container_of(head, struct tnode, rcu);
350 unsigned int size = sizeof(struct tnode) +
351 (1 << tn->bits) * sizeof(struct node *);
352
353 if (size <= PAGE_SIZE)
354 kfree(tn);
355 else
356 free_pages((unsigned long)tn, get_order(size));
357}
358
359static inline void tnode_free(struct tnode *tn)
360{
Stephen Hemminger132adf52007-03-08 20:44:43 -0800361 if (IS_LEAF(tn)) {
Robert Olsson550e29b2006-04-04 12:53:35 -0700362 struct leaf *l = (struct leaf *) tn;
363 call_rcu_bh(&l->rcu, __leaf_free_rcu);
Stephen Hemminger132adf52007-03-08 20:44:43 -0800364 } else
Robert Olsson550e29b2006-04-04 12:53:35 -0700365 call_rcu(&tn->rcu, __tnode_free_rcu);
Robert Olsson2373ce12005-08-25 13:01:29 -0700366}
367
Robert Olsson19baf832005-06-21 12:43:18 -0700368static struct leaf *leaf_new(void)
369{
370 struct leaf *l = kmalloc(sizeof(struct leaf), GFP_KERNEL);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700371 if (l) {
Robert Olsson2373ce12005-08-25 13:01:29 -0700372 l->parent = T_LEAF;
Robert Olsson19baf832005-06-21 12:43:18 -0700373 INIT_HLIST_HEAD(&l->list);
374 }
375 return l;
376}
377
378static struct leaf_info *leaf_info_new(int plen)
379{
380 struct leaf_info *li = kmalloc(sizeof(struct leaf_info), GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -0700381 if (li) {
382 li->plen = plen;
383 INIT_LIST_HEAD(&li->falh);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700384 }
Robert Olsson2373ce12005-08-25 13:01:29 -0700385 return li;
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700386}
387
Robert Olsson19baf832005-06-21 12:43:18 -0700388static struct tnode* tnode_new(t_key key, int pos, int bits)
389{
390 int nchildren = 1<<bits;
391 int sz = sizeof(struct tnode) + nchildren * sizeof(struct node *);
Patrick McHardyf0e36f82005-07-05 14:44:55 -0700392 struct tnode *tn = tnode_alloc(sz);
Robert Olsson19baf832005-06-21 12:43:18 -0700393
Olof Johansson91b9a272005-08-09 20:24:39 -0700394 if (tn) {
Robert Olsson19baf832005-06-21 12:43:18 -0700395 memset(tn, 0, sz);
Robert Olsson2373ce12005-08-25 13:01:29 -0700396 tn->parent = T_TNODE;
Robert Olsson19baf832005-06-21 12:43:18 -0700397 tn->pos = pos;
398 tn->bits = bits;
399 tn->key = key;
400 tn->full_children = 0;
401 tn->empty_children = 1<<bits;
402 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700403
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700404 pr_debug("AT %p s=%u %u\n", tn, (unsigned int) sizeof(struct tnode),
405 (unsigned int) (sizeof(struct node) * 1<<bits));
Robert Olsson19baf832005-06-21 12:43:18 -0700406 return tn;
407}
408
Robert Olsson19baf832005-06-21 12:43:18 -0700409/*
410 * Check whether a tnode 'n' is "full", i.e. it is an internal node
411 * and no bits are skipped. See discussion in dyntree paper p. 6
412 */
413
Stephen Hemmignerbb435b82005-08-09 20:25:39 -0700414static inline int tnode_full(const struct tnode *tn, const struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700415{
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700416 if (n == NULL || IS_LEAF(n))
Robert Olsson19baf832005-06-21 12:43:18 -0700417 return 0;
418
419 return ((struct tnode *) n)->pos == tn->pos + tn->bits;
420}
421
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700422static inline void put_child(struct trie *t, struct tnode *tn, int i, struct node *n)
Robert Olsson19baf832005-06-21 12:43:18 -0700423{
424 tnode_put_child_reorg(tn, i, n, -1);
425}
426
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700427 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700428 * Add a child at position i overwriting the old value.
429 * Update the value of full_children and empty_children.
430 */
431
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700432static void tnode_put_child_reorg(struct tnode *tn, int i, struct node *n, int wasfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700433{
Robert Olsson2373ce12005-08-25 13:01:29 -0700434 struct node *chi = tn->child[i];
Robert Olsson19baf832005-06-21 12:43:18 -0700435 int isfull;
436
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700437 BUG_ON(i >= 1<<tn->bits);
438
Robert Olsson19baf832005-06-21 12:43:18 -0700439
440 /* update emptyChildren */
441 if (n == NULL && chi != NULL)
442 tn->empty_children++;
443 else if (n != NULL && chi == NULL)
444 tn->empty_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700445
Robert Olsson19baf832005-06-21 12:43:18 -0700446 /* update fullChildren */
Olof Johansson91b9a272005-08-09 20:24:39 -0700447 if (wasfull == -1)
Robert Olsson19baf832005-06-21 12:43:18 -0700448 wasfull = tnode_full(tn, chi);
449
450 isfull = tnode_full(tn, n);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700451 if (wasfull && !isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700452 tn->full_children--;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700453 else if (!wasfull && isfull)
Robert Olsson19baf832005-06-21 12:43:18 -0700454 tn->full_children++;
Olof Johansson91b9a272005-08-09 20:24:39 -0700455
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700456 if (n)
Stephen Hemminger06801912007-08-10 15:22:13 -0700457 node_set_parent(n, tn);
Robert Olsson19baf832005-06-21 12:43:18 -0700458
Robert Olsson2373ce12005-08-25 13:01:29 -0700459 rcu_assign_pointer(tn->child[i], n);
Robert Olsson19baf832005-06-21 12:43:18 -0700460}
461
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700462static struct node *resize(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700463{
464 int i;
Robert Olsson2f368952005-07-05 15:02:40 -0700465 int err = 0;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700466 struct tnode *old_tn;
Robert Olssone6308be2005-10-04 13:01:58 -0700467 int inflate_threshold_use;
468 int halve_threshold_use;
Robert Olsson05eee482007-03-19 16:27:37 -0700469 int max_resize;
Robert Olsson19baf832005-06-21 12:43:18 -0700470
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900471 if (!tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700472 return NULL;
473
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700474 pr_debug("In tnode_resize %p inflate_threshold=%d threshold=%d\n",
475 tn, inflate_threshold, halve_threshold);
Robert Olsson19baf832005-06-21 12:43:18 -0700476
477 /* No children */
478 if (tn->empty_children == tnode_child_length(tn)) {
479 tnode_free(tn);
480 return NULL;
481 }
482 /* One child */
483 if (tn->empty_children == tnode_child_length(tn) - 1)
484 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700485 struct node *n;
Robert Olsson19baf832005-06-21 12:43:18 -0700486
Olof Johansson91b9a272005-08-09 20:24:39 -0700487 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700488 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700489 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700490
491 /* compress one level */
Stephen Hemminger06801912007-08-10 15:22:13 -0700492 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700493 tnode_free(tn);
494 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700495 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700496 /*
Robert Olsson19baf832005-06-21 12:43:18 -0700497 * Double as long as the resulting node has a number of
498 * nonempty nodes that are above the threshold.
499 */
500
501 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700502 * From "Implementing a dynamic compressed trie" by Stefan Nilsson of
503 * the Helsinki University of Technology and Matti Tikkanen of Nokia
Robert Olsson19baf832005-06-21 12:43:18 -0700504 * Telecommunications, page 6:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700505 * "A node is doubled if the ratio of non-empty children to all
Robert Olsson19baf832005-06-21 12:43:18 -0700506 * children in the *doubled* node is at least 'high'."
507 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700508 * 'high' in this instance is the variable 'inflate_threshold'. It
509 * is expressed as a percentage, so we multiply it with
510 * tnode_child_length() and instead of multiplying by 2 (since the
511 * child array will be doubled by inflate()) and multiplying
512 * the left-hand side by 100 (to handle the percentage thing) we
Robert Olsson19baf832005-06-21 12:43:18 -0700513 * multiply the left-hand side by 50.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700514 *
515 * The left-hand side may look a bit weird: tnode_child_length(tn)
516 * - tn->empty_children is of course the number of non-null children
517 * in the current node. tn->full_children is the number of "full"
Robert Olsson19baf832005-06-21 12:43:18 -0700518 * children, that is non-null tnodes with a skip value of 0.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700519 * All of those will be doubled in the resulting inflated tnode, so
Robert Olsson19baf832005-06-21 12:43:18 -0700520 * we just count them one extra time here.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700521 *
Robert Olsson19baf832005-06-21 12:43:18 -0700522 * A clearer way to write this would be:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700523 *
Robert Olsson19baf832005-06-21 12:43:18 -0700524 * to_be_doubled = tn->full_children;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700525 * not_to_be_doubled = tnode_child_length(tn) - tn->empty_children -
Robert Olsson19baf832005-06-21 12:43:18 -0700526 * tn->full_children;
527 *
528 * new_child_length = tnode_child_length(tn) * 2;
529 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700530 * new_fill_factor = 100 * (not_to_be_doubled + 2*to_be_doubled) /
Robert Olsson19baf832005-06-21 12:43:18 -0700531 * new_child_length;
532 * if (new_fill_factor >= inflate_threshold)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700533 *
534 * ...and so on, tho it would mess up the while () loop.
535 *
Robert Olsson19baf832005-06-21 12:43:18 -0700536 * anyway,
537 * 100 * (not_to_be_doubled + 2*to_be_doubled) / new_child_length >=
538 * inflate_threshold
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700539 *
Robert Olsson19baf832005-06-21 12:43:18 -0700540 * avoid a division:
541 * 100 * (not_to_be_doubled + 2*to_be_doubled) >=
542 * inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700543 *
Robert Olsson19baf832005-06-21 12:43:18 -0700544 * expand not_to_be_doubled and to_be_doubled, and shorten:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700545 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700546 * tn->full_children) >= inflate_threshold * new_child_length
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700547 *
Robert Olsson19baf832005-06-21 12:43:18 -0700548 * expand new_child_length:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700549 * 100 * (tnode_child_length(tn) - tn->empty_children +
Olof Johansson91b9a272005-08-09 20:24:39 -0700550 * tn->full_children) >=
Robert Olsson19baf832005-06-21 12:43:18 -0700551 * inflate_threshold * tnode_child_length(tn) * 2
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700552 *
Robert Olsson19baf832005-06-21 12:43:18 -0700553 * shorten again:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700554 * 50 * (tn->full_children + tnode_child_length(tn) -
Olof Johansson91b9a272005-08-09 20:24:39 -0700555 * tn->empty_children) >= inflate_threshold *
Robert Olsson19baf832005-06-21 12:43:18 -0700556 * tnode_child_length(tn)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700557 *
Robert Olsson19baf832005-06-21 12:43:18 -0700558 */
559
560 check_tnode(tn);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700561
Robert Olssone6308be2005-10-04 13:01:58 -0700562 /* Keep root node larger */
563
Stephen Hemminger132adf52007-03-08 20:44:43 -0800564 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700565 inflate_threshold_use = inflate_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900566 else
Robert Olssone6308be2005-10-04 13:01:58 -0700567 inflate_threshold_use = inflate_threshold;
568
Robert Olsson2f368952005-07-05 15:02:40 -0700569 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700570 max_resize = 10;
571 while ((tn->full_children > 0 && max_resize-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700572 50 * (tn->full_children + tnode_child_length(tn) - tn->empty_children) >=
Robert Olssone6308be2005-10-04 13:01:58 -0700573 inflate_threshold_use * tnode_child_length(tn))) {
Robert Olsson19baf832005-06-21 12:43:18 -0700574
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700575 old_tn = tn;
576 tn = inflate(t, tn);
577 if (IS_ERR(tn)) {
578 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700579#ifdef CONFIG_IP_FIB_TRIE_STATS
580 t->stats.resize_node_skipped++;
581#endif
582 break;
583 }
Robert Olsson19baf832005-06-21 12:43:18 -0700584 }
585
Robert Olsson05eee482007-03-19 16:27:37 -0700586 if (max_resize < 0) {
587 if (!tn->parent)
588 printk(KERN_WARNING "Fix inflate_threshold_root. Now=%d size=%d bits\n",
589 inflate_threshold_root, tn->bits);
590 else
591 printk(KERN_WARNING "Fix inflate_threshold. Now=%d size=%d bits\n",
592 inflate_threshold, tn->bits);
593 }
594
Robert Olsson19baf832005-06-21 12:43:18 -0700595 check_tnode(tn);
596
597 /*
598 * Halve as long as the number of empty children in this
599 * node is above threshold.
600 */
Robert Olsson2f368952005-07-05 15:02:40 -0700601
Robert Olssone6308be2005-10-04 13:01:58 -0700602
603 /* Keep root node larger */
604
Stephen Hemminger132adf52007-03-08 20:44:43 -0800605 if (!tn->parent)
Robert Olssone6308be2005-10-04 13:01:58 -0700606 halve_threshold_use = halve_threshold_root;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900607 else
Robert Olssone6308be2005-10-04 13:01:58 -0700608 halve_threshold_use = halve_threshold;
609
Robert Olsson2f368952005-07-05 15:02:40 -0700610 err = 0;
Robert Olsson05eee482007-03-19 16:27:37 -0700611 max_resize = 10;
612 while (tn->bits > 1 && max_resize-- &&
Robert Olsson19baf832005-06-21 12:43:18 -0700613 100 * (tnode_child_length(tn) - tn->empty_children) <
Robert Olssone6308be2005-10-04 13:01:58 -0700614 halve_threshold_use * tnode_child_length(tn)) {
Robert Olsson19baf832005-06-21 12:43:18 -0700615
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700616 old_tn = tn;
617 tn = halve(t, tn);
618 if (IS_ERR(tn)) {
619 tn = old_tn;
Robert Olsson2f368952005-07-05 15:02:40 -0700620#ifdef CONFIG_IP_FIB_TRIE_STATS
621 t->stats.resize_node_skipped++;
622#endif
623 break;
624 }
625 }
626
Robert Olsson05eee482007-03-19 16:27:37 -0700627 if (max_resize < 0) {
628 if (!tn->parent)
629 printk(KERN_WARNING "Fix halve_threshold_root. Now=%d size=%d bits\n",
630 halve_threshold_root, tn->bits);
631 else
632 printk(KERN_WARNING "Fix halve_threshold. Now=%d size=%d bits\n",
633 halve_threshold, tn->bits);
634 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700635
Robert Olsson19baf832005-06-21 12:43:18 -0700636 /* Only one child remains */
Robert Olsson19baf832005-06-21 12:43:18 -0700637 if (tn->empty_children == tnode_child_length(tn) - 1)
638 for (i = 0; i < tnode_child_length(tn); i++) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700639 struct node *n;
640
Olof Johansson91b9a272005-08-09 20:24:39 -0700641 n = tn->child[i];
Robert Olsson2373ce12005-08-25 13:01:29 -0700642 if (!n)
Olof Johansson91b9a272005-08-09 20:24:39 -0700643 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -0700644
645 /* compress one level */
646
Stephen Hemminger06801912007-08-10 15:22:13 -0700647 node_set_parent(n, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700648 tnode_free(tn);
649 return n;
Robert Olsson19baf832005-06-21 12:43:18 -0700650 }
651
652 return (struct node *) tn;
653}
654
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700655static struct tnode *inflate(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700656{
657 struct tnode *inode;
658 struct tnode *oldtnode = tn;
659 int olen = tnode_child_length(tn);
660 int i;
661
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700662 pr_debug("In inflate\n");
Robert Olsson19baf832005-06-21 12:43:18 -0700663
664 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits + 1);
665
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700666 if (!tn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700667 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700668
669 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700670 * Preallocate and store tnodes before the actual work so we
671 * don't get into an inconsistent state if memory allocation
672 * fails. In case of failure we return the oldnode and inflate
Robert Olsson2f368952005-07-05 15:02:40 -0700673 * of tnode is ignored.
674 */
Olof Johansson91b9a272005-08-09 20:24:39 -0700675
676 for (i = 0; i < olen; i++) {
Robert Olsson2f368952005-07-05 15:02:40 -0700677 struct tnode *inode = (struct tnode *) tnode_get_child(oldtnode, i);
678
679 if (inode &&
680 IS_TNODE(inode) &&
681 inode->pos == oldtnode->pos + oldtnode->bits &&
682 inode->bits > 1) {
683 struct tnode *left, *right;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -0700684 t_key m = ~0U << (KEYLENGTH - 1) >> inode->pos;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700685
Robert Olsson2f368952005-07-05 15:02:40 -0700686 left = tnode_new(inode->key&(~m), inode->pos + 1,
687 inode->bits - 1);
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700688 if (!left)
689 goto nomem;
Olof Johansson91b9a272005-08-09 20:24:39 -0700690
Robert Olsson2f368952005-07-05 15:02:40 -0700691 right = tnode_new(inode->key|m, inode->pos + 1,
692 inode->bits - 1);
693
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900694 if (!right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700695 tnode_free(left);
696 goto nomem;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900697 }
Robert Olsson2f368952005-07-05 15:02:40 -0700698
699 put_child(t, tn, 2*i, (struct node *) left);
700 put_child(t, tn, 2*i+1, (struct node *) right);
701 }
702 }
703
Olof Johansson91b9a272005-08-09 20:24:39 -0700704 for (i = 0; i < olen; i++) {
Robert Olsson19baf832005-06-21 12:43:18 -0700705 struct node *node = tnode_get_child(oldtnode, i);
Olof Johansson91b9a272005-08-09 20:24:39 -0700706 struct tnode *left, *right;
707 int size, j;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700708
Robert Olsson19baf832005-06-21 12:43:18 -0700709 /* An empty child */
710 if (node == NULL)
711 continue;
712
713 /* A leaf or an internal node with skipped bits */
714
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700715 if (IS_LEAF(node) || ((struct tnode *) node)->pos >
Robert Olsson19baf832005-06-21 12:43:18 -0700716 tn->pos + tn->bits - 1) {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700717 if (tkey_extract_bits(node->key, oldtnode->pos + oldtnode->bits,
Robert Olsson19baf832005-06-21 12:43:18 -0700718 1) == 0)
719 put_child(t, tn, 2*i, node);
720 else
721 put_child(t, tn, 2*i+1, node);
722 continue;
723 }
724
725 /* An internal node with two children */
726 inode = (struct tnode *) node;
727
728 if (inode->bits == 1) {
729 put_child(t, tn, 2*i, inode->child[0]);
730 put_child(t, tn, 2*i+1, inode->child[1]);
731
732 tnode_free(inode);
Olof Johansson91b9a272005-08-09 20:24:39 -0700733 continue;
Robert Olsson19baf832005-06-21 12:43:18 -0700734 }
735
Olof Johansson91b9a272005-08-09 20:24:39 -0700736 /* An internal node with more than two children */
Robert Olsson19baf832005-06-21 12:43:18 -0700737
Olof Johansson91b9a272005-08-09 20:24:39 -0700738 /* We will replace this node 'inode' with two new
739 * ones, 'left' and 'right', each with half of the
740 * original children. The two new nodes will have
741 * a position one bit further down the key and this
742 * means that the "significant" part of their keys
743 * (see the discussion near the top of this file)
744 * will differ by one bit, which will be "0" in
745 * left's key and "1" in right's key. Since we are
746 * moving the key position by one step, the bit that
747 * we are moving away from - the bit at position
748 * (inode->pos) - is the one that will differ between
749 * left and right. So... we synthesize that bit in the
750 * two new keys.
751 * The mask 'm' below will be a single "one" bit at
752 * the position (inode->pos)
753 */
Robert Olsson19baf832005-06-21 12:43:18 -0700754
Olof Johansson91b9a272005-08-09 20:24:39 -0700755 /* Use the old key, but set the new significant
756 * bit to zero.
757 */
Robert Olsson19baf832005-06-21 12:43:18 -0700758
Olof Johansson91b9a272005-08-09 20:24:39 -0700759 left = (struct tnode *) tnode_get_child(tn, 2*i);
760 put_child(t, tn, 2*i, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -0700761
Olof Johansson91b9a272005-08-09 20:24:39 -0700762 BUG_ON(!left);
Robert Olsson2f368952005-07-05 15:02:40 -0700763
Olof Johansson91b9a272005-08-09 20:24:39 -0700764 right = (struct tnode *) tnode_get_child(tn, 2*i+1);
765 put_child(t, tn, 2*i+1, NULL);
Robert Olsson2f368952005-07-05 15:02:40 -0700766
Olof Johansson91b9a272005-08-09 20:24:39 -0700767 BUG_ON(!right);
Robert Olsson2f368952005-07-05 15:02:40 -0700768
Olof Johansson91b9a272005-08-09 20:24:39 -0700769 size = tnode_child_length(left);
770 for (j = 0; j < size; j++) {
771 put_child(t, left, j, inode->child[j]);
772 put_child(t, right, j, inode->child[j + size]);
Robert Olsson19baf832005-06-21 12:43:18 -0700773 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700774 put_child(t, tn, 2*i, resize(t, left));
775 put_child(t, tn, 2*i+1, resize(t, right));
776
777 tnode_free(inode);
Robert Olsson19baf832005-06-21 12:43:18 -0700778 }
779 tnode_free(oldtnode);
780 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700781nomem:
782 {
783 int size = tnode_child_length(tn);
784 int j;
785
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700786 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700787 if (tn->child[j])
788 tnode_free((struct tnode *)tn->child[j]);
789
790 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700791
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700792 return ERR_PTR(-ENOMEM);
793 }
Robert Olsson19baf832005-06-21 12:43:18 -0700794}
795
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700796static struct tnode *halve(struct trie *t, struct tnode *tn)
Robert Olsson19baf832005-06-21 12:43:18 -0700797{
798 struct tnode *oldtnode = tn;
799 struct node *left, *right;
800 int i;
801 int olen = tnode_child_length(tn);
802
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700803 pr_debug("In halve\n");
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700804
805 tn = tnode_new(oldtnode->key, oldtnode->pos, oldtnode->bits - 1);
Robert Olsson19baf832005-06-21 12:43:18 -0700806
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700807 if (!tn)
808 return ERR_PTR(-ENOMEM);
Robert Olsson2f368952005-07-05 15:02:40 -0700809
810 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700811 * Preallocate and store tnodes before the actual work so we
812 * don't get into an inconsistent state if memory allocation
813 * fails. In case of failure we return the oldnode and halve
Robert Olsson2f368952005-07-05 15:02:40 -0700814 * of tnode is ignored.
815 */
816
Olof Johansson91b9a272005-08-09 20:24:39 -0700817 for (i = 0; i < olen; i += 2) {
Robert Olsson2f368952005-07-05 15:02:40 -0700818 left = tnode_get_child(oldtnode, i);
819 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700820
Robert Olsson2f368952005-07-05 15:02:40 -0700821 /* Two nonempty children */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700822 if (left && right) {
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700823 struct tnode *newn;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700824
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700825 newn = tnode_new(left->key, tn->pos + tn->bits, 1);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700826
827 if (!newn)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700828 goto nomem;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700829
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700830 put_child(t, tn, i/2, (struct node *)newn);
Robert Olsson2f368952005-07-05 15:02:40 -0700831 }
Robert Olsson2f368952005-07-05 15:02:40 -0700832
Robert Olsson2f368952005-07-05 15:02:40 -0700833 }
Robert Olsson19baf832005-06-21 12:43:18 -0700834
Olof Johansson91b9a272005-08-09 20:24:39 -0700835 for (i = 0; i < olen; i += 2) {
836 struct tnode *newBinNode;
837
Robert Olsson19baf832005-06-21 12:43:18 -0700838 left = tnode_get_child(oldtnode, i);
839 right = tnode_get_child(oldtnode, i+1);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700840
Robert Olsson19baf832005-06-21 12:43:18 -0700841 /* At least one of the children is empty */
842 if (left == NULL) {
843 if (right == NULL) /* Both are empty */
844 continue;
845 put_child(t, tn, i/2, right);
Olof Johansson91b9a272005-08-09 20:24:39 -0700846 continue;
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700847 }
Olof Johansson91b9a272005-08-09 20:24:39 -0700848
849 if (right == NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700850 put_child(t, tn, i/2, left);
Olof Johansson91b9a272005-08-09 20:24:39 -0700851 continue;
852 }
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700853
Robert Olsson19baf832005-06-21 12:43:18 -0700854 /* Two nonempty children */
Olof Johansson91b9a272005-08-09 20:24:39 -0700855 newBinNode = (struct tnode *) tnode_get_child(tn, i/2);
856 put_child(t, tn, i/2, NULL);
Olof Johansson91b9a272005-08-09 20:24:39 -0700857 put_child(t, newBinNode, 0, left);
858 put_child(t, newBinNode, 1, right);
859 put_child(t, tn, i/2, resize(t, newBinNode));
Robert Olsson19baf832005-06-21 12:43:18 -0700860 }
861 tnode_free(oldtnode);
862 return tn;
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700863nomem:
864 {
865 int size = tnode_child_length(tn);
866 int j;
867
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700868 for (j = 0; j < size; j++)
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700869 if (tn->child[j])
870 tnode_free((struct tnode *)tn->child[j]);
871
872 tnode_free(tn);
Stephen Hemminger0c7770c2005-08-23 21:59:41 -0700873
Robert Olsson2f80b3c2005-08-09 20:25:06 -0700874 return ERR_PTR(-ENOMEM);
875 }
Robert Olsson19baf832005-06-21 12:43:18 -0700876}
877
Robert Olsson772cb712005-09-19 15:31:18 -0700878/* readside must use rcu_read_lock currently dump routines
Robert Olsson2373ce12005-08-25 13:01:29 -0700879 via get_fa_head and dump */
880
Robert Olsson772cb712005-09-19 15:31:18 -0700881static struct leaf_info *find_leaf_info(struct leaf *l, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700882{
Robert Olsson772cb712005-09-19 15:31:18 -0700883 struct hlist_head *head = &l->list;
Robert Olsson19baf832005-06-21 12:43:18 -0700884 struct hlist_node *node;
885 struct leaf_info *li;
886
Robert Olsson2373ce12005-08-25 13:01:29 -0700887 hlist_for_each_entry_rcu(li, node, head, hlist)
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700888 if (li->plen == plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700889 return li;
Olof Johansson91b9a272005-08-09 20:24:39 -0700890
Robert Olsson19baf832005-06-21 12:43:18 -0700891 return NULL;
892}
893
894static inline struct list_head * get_fa_head(struct leaf *l, int plen)
895{
Robert Olsson772cb712005-09-19 15:31:18 -0700896 struct leaf_info *li = find_leaf_info(l, plen);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700897
Olof Johansson91b9a272005-08-09 20:24:39 -0700898 if (!li)
899 return NULL;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700900
Olof Johansson91b9a272005-08-09 20:24:39 -0700901 return &li->falh;
Robert Olsson19baf832005-06-21 12:43:18 -0700902}
903
904static void insert_leaf_info(struct hlist_head *head, struct leaf_info *new)
905{
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900906 struct leaf_info *li = NULL, *last = NULL;
907 struct hlist_node *node;
Robert Olsson19baf832005-06-21 12:43:18 -0700908
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900909 if (hlist_empty(head)) {
910 hlist_add_head_rcu(&new->hlist, head);
911 } else {
912 hlist_for_each_entry(li, node, head, hlist) {
913 if (new->plen > li->plen)
914 break;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700915
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +0900916 last = li;
917 }
918 if (last)
919 hlist_add_after_rcu(&last->hlist, &new->hlist);
920 else
921 hlist_add_before_rcu(&new->hlist, &li->hlist);
922 }
Robert Olsson19baf832005-06-21 12:43:18 -0700923}
924
Robert Olsson2373ce12005-08-25 13:01:29 -0700925/* rcu_read_lock needs to be hold by caller from readside */
926
Robert Olsson19baf832005-06-21 12:43:18 -0700927static struct leaf *
928fib_find_node(struct trie *t, u32 key)
929{
930 int pos;
931 struct tnode *tn;
932 struct node *n;
933
934 pos = 0;
Robert Olsson2373ce12005-08-25 13:01:29 -0700935 n = rcu_dereference(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -0700936
937 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
938 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -0700939
Robert Olsson19baf832005-06-21 12:43:18 -0700940 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -0700941
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700942 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Olof Johansson91b9a272005-08-09 20:24:39 -0700943 pos = tn->pos + tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -0700944 n = tnode_get_child(tn, tkey_extract_bits(key, tn->pos, tn->bits));
Olof Johansson91b9a272005-08-09 20:24:39 -0700945 } else
Robert Olsson19baf832005-06-21 12:43:18 -0700946 break;
947 }
948 /* Case we have found a leaf. Compare prefixes */
949
Olof Johansson91b9a272005-08-09 20:24:39 -0700950 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key))
951 return (struct leaf *)n;
952
Robert Olsson19baf832005-06-21 12:43:18 -0700953 return NULL;
954}
955
956static struct node *trie_rebalance(struct trie *t, struct tnode *tn)
957{
Robert Olsson19baf832005-06-21 12:43:18 -0700958 int wasfull;
Stephen Hemminger06801912007-08-10 15:22:13 -0700959 t_key cindex, key = tn->key;
960 struct tnode *tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700961
Stephen Hemminger06801912007-08-10 15:22:13 -0700962 while (tn != NULL && (tp = node_parent((struct node *)tn)) != NULL) {
Robert Olsson19baf832005-06-21 12:43:18 -0700963 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
964 wasfull = tnode_full(tp, tnode_get_child(tp, cindex));
965 tn = (struct tnode *) resize (t, (struct tnode *)tn);
966 tnode_put_child_reorg((struct tnode *)tp, cindex,(struct node*)tn, wasfull);
Olof Johansson91b9a272005-08-09 20:24:39 -0700967
Stephen Hemminger06801912007-08-10 15:22:13 -0700968 tp = node_parent((struct node *) tn);
969 if (!tp)
Robert Olsson19baf832005-06-21 12:43:18 -0700970 break;
Stephen Hemminger06801912007-08-10 15:22:13 -0700971 tn = tp;
Robert Olsson19baf832005-06-21 12:43:18 -0700972 }
Stephen Hemminger06801912007-08-10 15:22:13 -0700973
Robert Olsson19baf832005-06-21 12:43:18 -0700974 /* Handle last (top) tnode */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700975 if (IS_TNODE(tn))
Robert Olsson19baf832005-06-21 12:43:18 -0700976 tn = (struct tnode*) resize(t, (struct tnode *)tn);
977
978 return (struct node*) tn;
979}
980
Robert Olsson2373ce12005-08-25 13:01:29 -0700981/* only used from updater-side */
982
Robert Olssonf835e472005-06-28 15:00:39 -0700983static struct list_head *
984fib_insert_node(struct trie *t, int *err, u32 key, int plen)
Robert Olsson19baf832005-06-21 12:43:18 -0700985{
986 int pos, newpos;
987 struct tnode *tp = NULL, *tn = NULL;
988 struct node *n;
989 struct leaf *l;
990 int missbit;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700991 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -0700992 struct leaf_info *li;
993 t_key cindex;
994
995 pos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700996 n = t->trie;
Robert Olsson19baf832005-06-21 12:43:18 -0700997
Stephen Hemmingerc877efb2005-07-19 14:01:51 -0700998 /* If we point to NULL, stop. Either the tree is empty and we should
999 * just put a new leaf in if, or we have reached an empty child slot,
Robert Olsson19baf832005-06-21 12:43:18 -07001000 * and we should just put our new leaf in that.
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001001 * If we point to a T_TNODE, check if it matches our key. Note that
1002 * a T_TNODE might be skipping any number of bits - its 'pos' need
Robert Olsson19baf832005-06-21 12:43:18 -07001003 * not be the parent's 'pos'+'bits'!
1004 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001005 * If it does match the current key, get pos/bits from it, extract
Robert Olsson19baf832005-06-21 12:43:18 -07001006 * the index from our key, push the T_TNODE and walk the tree.
1007 *
1008 * If it doesn't, we have to replace it with a new T_TNODE.
1009 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001010 * If we point to a T_LEAF, it might or might not have the same key
1011 * as we do. If it does, just change the value, update the T_LEAF's
1012 * value, and return it.
Robert Olsson19baf832005-06-21 12:43:18 -07001013 * If it doesn't, we need to replace it with a T_TNODE.
1014 */
1015
1016 while (n != NULL && NODE_TYPE(n) == T_TNODE) {
1017 tn = (struct tnode *) n;
Olof Johansson91b9a272005-08-09 20:24:39 -07001018
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001019 check_tnode(tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001020
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001021 if (tkey_sub_equals(tn->key, pos, tn->pos-pos, key)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001022 tp = tn;
Olof Johansson91b9a272005-08-09 20:24:39 -07001023 pos = tn->pos + tn->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001024 n = tnode_get_child(tn, tkey_extract_bits(key, tn->pos, tn->bits));
1025
Stephen Hemminger06801912007-08-10 15:22:13 -07001026 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001027 } else
Robert Olsson19baf832005-06-21 12:43:18 -07001028 break;
1029 }
1030
1031 /*
1032 * n ----> NULL, LEAF or TNODE
1033 *
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001034 * tp is n's (parent) ----> NULL or TNODE
Robert Olsson19baf832005-06-21 12:43:18 -07001035 */
1036
Olof Johansson91b9a272005-08-09 20:24:39 -07001037 BUG_ON(tp && IS_LEAF(tp));
Robert Olsson19baf832005-06-21 12:43:18 -07001038
1039 /* Case 1: n is a leaf. Compare prefixes */
1040
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001041 if (n != NULL && IS_LEAF(n) && tkey_equals(key, n->key)) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001042 struct leaf *l = (struct leaf *) n;
1043
Robert Olsson19baf832005-06-21 12:43:18 -07001044 li = leaf_info_new(plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001045
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001046 if (!li) {
Robert Olssonf835e472005-06-28 15:00:39 -07001047 *err = -ENOMEM;
Stephen Hemminger93e43082008-01-12 20:50:23 -08001048 goto done;
Robert Olssonf835e472005-06-28 15:00:39 -07001049 }
Robert Olsson19baf832005-06-21 12:43:18 -07001050
1051 fa_head = &li->falh;
1052 insert_leaf_info(&l->list, li);
1053 goto done;
1054 }
1055 t->size++;
1056 l = leaf_new();
1057
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001058 if (!l) {
Robert Olssonf835e472005-06-28 15:00:39 -07001059 *err = -ENOMEM;
Stephen Hemminger93e43082008-01-12 20:50:23 -08001060 goto done;
Robert Olssonf835e472005-06-28 15:00:39 -07001061 }
Robert Olsson19baf832005-06-21 12:43:18 -07001062
1063 l->key = key;
1064 li = leaf_info_new(plen);
1065
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001066 if (!li) {
Robert Olssonf835e472005-06-28 15:00:39 -07001067 tnode_free((struct tnode *) l);
1068 *err = -ENOMEM;
Stephen Hemminger93e43082008-01-12 20:50:23 -08001069 goto done;
Robert Olssonf835e472005-06-28 15:00:39 -07001070 }
Robert Olsson19baf832005-06-21 12:43:18 -07001071
1072 fa_head = &li->falh;
1073 insert_leaf_info(&l->list, li);
1074
Robert Olsson19baf832005-06-21 12:43:18 -07001075 if (t->trie && n == NULL) {
Olof Johansson91b9a272005-08-09 20:24:39 -07001076 /* Case 2: n is NULL, and will just insert a new leaf */
Robert Olsson19baf832005-06-21 12:43:18 -07001077
Stephen Hemminger06801912007-08-10 15:22:13 -07001078 node_set_parent((struct node *)l, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001079
Olof Johansson91b9a272005-08-09 20:24:39 -07001080 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1081 put_child(t, (struct tnode *)tp, cindex, (struct node *)l);
1082 } else {
1083 /* Case 3: n is a LEAF or a TNODE and the key doesn't match. */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001084 /*
1085 * Add a new tnode here
Robert Olsson19baf832005-06-21 12:43:18 -07001086 * first tnode need some special handling
1087 */
1088
1089 if (tp)
Olof Johansson91b9a272005-08-09 20:24:39 -07001090 pos = tp->pos+tp->bits;
Robert Olsson19baf832005-06-21 12:43:18 -07001091 else
Olof Johansson91b9a272005-08-09 20:24:39 -07001092 pos = 0;
1093
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001094 if (n) {
Robert Olsson19baf832005-06-21 12:43:18 -07001095 newpos = tkey_mismatch(key, pos, n->key);
1096 tn = tnode_new(n->key, newpos, 1);
Olof Johansson91b9a272005-08-09 20:24:39 -07001097 } else {
Robert Olsson19baf832005-06-21 12:43:18 -07001098 newpos = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001099 tn = tnode_new(key, newpos, 1); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001100 }
Robert Olsson19baf832005-06-21 12:43:18 -07001101
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001102 if (!tn) {
Robert Olssonf835e472005-06-28 15:00:39 -07001103 free_leaf_info(li);
1104 tnode_free((struct tnode *) l);
1105 *err = -ENOMEM;
Stephen Hemminger93e43082008-01-12 20:50:23 -08001106 goto done;
Olof Johansson91b9a272005-08-09 20:24:39 -07001107 }
1108
Stephen Hemminger06801912007-08-10 15:22:13 -07001109 node_set_parent((struct node *)tn, tp);
Robert Olsson19baf832005-06-21 12:43:18 -07001110
Olof Johansson91b9a272005-08-09 20:24:39 -07001111 missbit = tkey_extract_bits(key, newpos, 1);
Robert Olsson19baf832005-06-21 12:43:18 -07001112 put_child(t, tn, missbit, (struct node *)l);
1113 put_child(t, tn, 1-missbit, n);
1114
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001115 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001116 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1117 put_child(t, (struct tnode *)tp, cindex, (struct node *)tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001118 } else {
Robert Olsson2373ce12005-08-25 13:01:29 -07001119 rcu_assign_pointer(t->trie, (struct node *)tn); /* First tnode */
Robert Olsson19baf832005-06-21 12:43:18 -07001120 tp = tn;
1121 }
1122 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001123
1124 if (tp && tp->pos + tp->bits > 32)
Stephen Hemminger78c66712005-09-21 00:15:39 -07001125 printk(KERN_WARNING "fib_trie tp=%p pos=%d, bits=%d, key=%0x plen=%d\n",
Robert Olsson19baf832005-06-21 12:43:18 -07001126 tp, tp->pos, tp->bits, key, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001127
Robert Olsson19baf832005-06-21 12:43:18 -07001128 /* Rebalance the trie */
Robert Olsson2373ce12005-08-25 13:01:29 -07001129
1130 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Robert Olssonf835e472005-06-28 15:00:39 -07001131done:
Robert Olsson19baf832005-06-21 12:43:18 -07001132 return fa_head;
1133}
1134
Robert Olssond562f1f2007-03-26 14:22:22 -07001135/*
1136 * Caller must hold RTNL.
1137 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001138static int fn_trie_insert(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001139{
1140 struct trie *t = (struct trie *) tb->tb_data;
1141 struct fib_alias *fa, *new_fa;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001142 struct list_head *fa_head = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001143 struct fib_info *fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001144 int plen = cfg->fc_dst_len;
1145 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001146 u32 key, mask;
1147 int err;
1148 struct leaf *l;
1149
1150 if (plen > 32)
1151 return -EINVAL;
1152
Thomas Graf4e902c52006-08-17 18:14:52 -07001153 key = ntohl(cfg->fc_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001154
Patrick McHardy2dfe55b2006-08-10 23:08:33 -07001155 pr_debug("Insert table=%u %08x/%d\n", tb->tb_id, key, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001156
Olof Johansson91b9a272005-08-09 20:24:39 -07001157 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001158
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001159 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001160 return -EINVAL;
1161
1162 key = key & mask;
1163
Thomas Graf4e902c52006-08-17 18:14:52 -07001164 fi = fib_create_info(cfg);
1165 if (IS_ERR(fi)) {
1166 err = PTR_ERR(fi);
Robert Olsson19baf832005-06-21 12:43:18 -07001167 goto err;
Thomas Graf4e902c52006-08-17 18:14:52 -07001168 }
Robert Olsson19baf832005-06-21 12:43:18 -07001169
1170 l = fib_find_node(t, key);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001171 fa = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001172
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001173 if (l) {
Robert Olsson19baf832005-06-21 12:43:18 -07001174 fa_head = get_fa_head(l, plen);
1175 fa = fib_find_alias(fa_head, tos, fi->fib_priority);
1176 }
1177
1178 /* Now fa, if non-NULL, points to the first fib alias
1179 * with the same keys [prefix,tos,priority], if such key already
1180 * exists or to the node before which we will insert new one.
1181 *
1182 * If fa is NULL, we will need to allocate a new one and
1183 * insert to the head of f.
1184 *
1185 * If f is NULL, no fib node matched the destination key
1186 * and we need to allocate a new one of those as well.
1187 */
1188
Olof Johansson91b9a272005-08-09 20:24:39 -07001189 if (fa && fa->fa_info->fib_priority == fi->fib_priority) {
Robert Olsson19baf832005-06-21 12:43:18 -07001190 struct fib_alias *fa_orig;
1191
1192 err = -EEXIST;
Thomas Graf4e902c52006-08-17 18:14:52 -07001193 if (cfg->fc_nlflags & NLM_F_EXCL)
Robert Olsson19baf832005-06-21 12:43:18 -07001194 goto out;
1195
Thomas Graf4e902c52006-08-17 18:14:52 -07001196 if (cfg->fc_nlflags & NLM_F_REPLACE) {
Robert Olsson19baf832005-06-21 12:43:18 -07001197 struct fib_info *fi_drop;
1198 u8 state;
1199
Joonwoo Park67250332008-01-18 03:45:18 -08001200 if (fi->fib_treeref > 1)
1201 goto out;
1202
Robert Olsson2373ce12005-08-25 13:01:29 -07001203 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001204 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001205 if (new_fa == NULL)
1206 goto out;
Robert Olsson19baf832005-06-21 12:43:18 -07001207
1208 fi_drop = fa->fa_info;
Robert Olsson2373ce12005-08-25 13:01:29 -07001209 new_fa->fa_tos = fa->fa_tos;
1210 new_fa->fa_info = fi;
Thomas Graf4e902c52006-08-17 18:14:52 -07001211 new_fa->fa_type = cfg->fc_type;
1212 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001213 state = fa->fa_state;
Robert Olsson2373ce12005-08-25 13:01:29 -07001214 new_fa->fa_state &= ~FA_S_ACCESSED;
Robert Olsson19baf832005-06-21 12:43:18 -07001215
Robert Olsson2373ce12005-08-25 13:01:29 -07001216 list_replace_rcu(&fa->fa_list, &new_fa->fa_list);
1217 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001218
1219 fib_release_info(fi_drop);
1220 if (state & FA_S_ACCESSED)
Olof Johansson91b9a272005-08-09 20:24:39 -07001221 rt_cache_flush(-1);
Milan Kocianb8f55832007-05-23 14:55:06 -07001222 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen,
1223 tb->tb_id, &cfg->fc_nlinfo, NLM_F_REPLACE);
Robert Olsson19baf832005-06-21 12:43:18 -07001224
Olof Johansson91b9a272005-08-09 20:24:39 -07001225 goto succeeded;
Robert Olsson19baf832005-06-21 12:43:18 -07001226 }
1227 /* Error if we find a perfect match which
1228 * uses the same scope, type, and nexthop
1229 * information.
1230 */
1231 fa_orig = fa;
1232 list_for_each_entry(fa, fa_orig->fa_list.prev, fa_list) {
1233 if (fa->fa_tos != tos)
1234 break;
1235 if (fa->fa_info->fib_priority != fi->fib_priority)
1236 break;
Thomas Graf4e902c52006-08-17 18:14:52 -07001237 if (fa->fa_type == cfg->fc_type &&
1238 fa->fa_scope == cfg->fc_scope &&
Robert Olsson19baf832005-06-21 12:43:18 -07001239 fa->fa_info == fi) {
1240 goto out;
1241 }
1242 }
Thomas Graf4e902c52006-08-17 18:14:52 -07001243 if (!(cfg->fc_nlflags & NLM_F_APPEND))
Robert Olsson19baf832005-06-21 12:43:18 -07001244 fa = fa_orig;
1245 }
1246 err = -ENOENT;
Thomas Graf4e902c52006-08-17 18:14:52 -07001247 if (!(cfg->fc_nlflags & NLM_F_CREATE))
Robert Olsson19baf832005-06-21 12:43:18 -07001248 goto out;
1249
1250 err = -ENOBUFS;
Christoph Lametere94b1762006-12-06 20:33:17 -08001251 new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL);
Robert Olsson19baf832005-06-21 12:43:18 -07001252 if (new_fa == NULL)
1253 goto out;
1254
1255 new_fa->fa_info = fi;
1256 new_fa->fa_tos = tos;
Thomas Graf4e902c52006-08-17 18:14:52 -07001257 new_fa->fa_type = cfg->fc_type;
1258 new_fa->fa_scope = cfg->fc_scope;
Robert Olsson19baf832005-06-21 12:43:18 -07001259 new_fa->fa_state = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001260 /*
1261 * Insert new entry to the list.
1262 */
1263
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001264 if (!fa_head) {
Robert Olssonf835e472005-06-28 15:00:39 -07001265 err = 0;
Herbert Xub47b2ec2006-07-12 13:29:56 -07001266 fa_head = fib_insert_node(t, &err, key, plen);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001267 if (err)
Robert Olssonf835e472005-06-28 15:00:39 -07001268 goto out_free_new_fa;
1269 }
Robert Olsson19baf832005-06-21 12:43:18 -07001270
Robert Olsson2373ce12005-08-25 13:01:29 -07001271 list_add_tail_rcu(&new_fa->fa_list,
1272 (fa ? &fa->fa_list : fa_head));
Robert Olsson19baf832005-06-21 12:43:18 -07001273
1274 rt_cache_flush(-1);
Thomas Graf4e902c52006-08-17 18:14:52 -07001275 rtmsg_fib(RTM_NEWROUTE, htonl(key), new_fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001276 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001277succeeded:
1278 return 0;
Robert Olssonf835e472005-06-28 15:00:39 -07001279
1280out_free_new_fa:
1281 kmem_cache_free(fn_alias_kmem, new_fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001282out:
1283 fib_release_info(fi);
Olof Johansson91b9a272005-08-09 20:24:39 -07001284err:
Robert Olsson19baf832005-06-21 12:43:18 -07001285 return err;
1286}
1287
Robert Olsson2373ce12005-08-25 13:01:29 -07001288
Robert Olsson772cb712005-09-19 15:31:18 -07001289/* should be called with rcu_read_lock */
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001290static inline int check_leaf(struct trie *t, struct leaf *l,
1291 t_key key, int *plen, const struct flowi *flp,
Patrick McHardy06c74272005-08-23 22:06:09 -07001292 struct fib_result *res)
Robert Olsson19baf832005-06-21 12:43:18 -07001293{
Patrick McHardy06c74272005-08-23 22:06:09 -07001294 int err, i;
Al Viro888454c2006-09-19 13:42:46 -07001295 __be32 mask;
Robert Olsson19baf832005-06-21 12:43:18 -07001296 struct leaf_info *li;
1297 struct hlist_head *hhead = &l->list;
1298 struct hlist_node *node;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001299
Robert Olsson2373ce12005-08-25 13:01:29 -07001300 hlist_for_each_entry_rcu(li, node, hhead, hlist) {
Robert Olsson19baf832005-06-21 12:43:18 -07001301 i = li->plen;
Al Viro888454c2006-09-19 13:42:46 -07001302 mask = inet_make_mask(i);
1303 if (l->key != (key & ntohl(mask)))
Robert Olsson19baf832005-06-21 12:43:18 -07001304 continue;
1305
Al Viro888454c2006-09-19 13:42:46 -07001306 if ((err = fib_semantic_match(&li->falh, flp, res, htonl(l->key), mask, i)) <= 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001307 *plen = i;
1308#ifdef CONFIG_IP_FIB_TRIE_STATS
1309 t->stats.semantic_match_passed++;
1310#endif
Patrick McHardy06c74272005-08-23 22:06:09 -07001311 return err;
Robert Olsson19baf832005-06-21 12:43:18 -07001312 }
1313#ifdef CONFIG_IP_FIB_TRIE_STATS
1314 t->stats.semantic_match_miss++;
1315#endif
1316 }
Patrick McHardy06c74272005-08-23 22:06:09 -07001317 return 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001318}
1319
1320static int
1321fn_trie_lookup(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1322{
1323 struct trie *t = (struct trie *) tb->tb_data;
1324 int plen, ret = 0;
1325 struct node *n;
1326 struct tnode *pn;
1327 int pos, bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001328 t_key key = ntohl(flp->fl4_dst);
Robert Olsson19baf832005-06-21 12:43:18 -07001329 int chopped_off;
1330 t_key cindex = 0;
1331 int current_prefix_length = KEYLENGTH;
Olof Johansson91b9a272005-08-09 20:24:39 -07001332 struct tnode *cn;
1333 t_key node_prefix, key_prefix, pref_mismatch;
1334 int mp;
1335
Robert Olsson2373ce12005-08-25 13:01:29 -07001336 rcu_read_lock();
Robert Olsson19baf832005-06-21 12:43:18 -07001337
Robert Olsson2373ce12005-08-25 13:01:29 -07001338 n = rcu_dereference(t->trie);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001339 if (!n)
Robert Olsson19baf832005-06-21 12:43:18 -07001340 goto failed;
1341
1342#ifdef CONFIG_IP_FIB_TRIE_STATS
1343 t->stats.gets++;
1344#endif
1345
1346 /* Just a leaf? */
1347 if (IS_LEAF(n)) {
Patrick McHardy06c74272005-08-23 22:06:09 -07001348 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001349 goto found;
1350 goto failed;
1351 }
1352 pn = (struct tnode *) n;
1353 chopped_off = 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001354
Olof Johansson91b9a272005-08-09 20:24:39 -07001355 while (pn) {
Robert Olsson19baf832005-06-21 12:43:18 -07001356 pos = pn->pos;
1357 bits = pn->bits;
1358
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001359 if (!chopped_off)
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001360 cindex = tkey_extract_bits(mask_pfx(key, current_prefix_length),
1361 pos, bits);
Robert Olsson19baf832005-06-21 12:43:18 -07001362
1363 n = tnode_get_child(pn, cindex);
1364
1365 if (n == NULL) {
1366#ifdef CONFIG_IP_FIB_TRIE_STATS
1367 t->stats.null_node_hit++;
1368#endif
1369 goto backtrace;
1370 }
1371
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001372 if (IS_LEAF(n)) {
Patrick McHardy06c74272005-08-23 22:06:09 -07001373 if ((ret = check_leaf(t, (struct leaf *)n, key, &plen, flp, res)) <= 0)
Robert Olsson19baf832005-06-21 12:43:18 -07001374 goto found;
Olof Johansson91b9a272005-08-09 20:24:39 -07001375 else
1376 goto backtrace;
1377 }
1378
1379#define HL_OPTIMIZE
1380#ifdef HL_OPTIMIZE
1381 cn = (struct tnode *)n;
1382
1383 /*
1384 * It's a tnode, and we can do some extra checks here if we
1385 * like, to avoid descending into a dead-end branch.
1386 * This tnode is in the parent's child array at index
1387 * key[p_pos..p_pos+p_bits] but potentially with some bits
1388 * chopped off, so in reality the index may be just a
1389 * subprefix, padded with zero at the end.
1390 * We can also take a look at any skipped bits in this
1391 * tnode - everything up to p_pos is supposed to be ok,
1392 * and the non-chopped bits of the index (se previous
1393 * paragraph) are also guaranteed ok, but the rest is
1394 * considered unknown.
1395 *
1396 * The skipped bits are key[pos+bits..cn->pos].
1397 */
1398
1399 /* If current_prefix_length < pos+bits, we are already doing
1400 * actual prefix matching, which means everything from
1401 * pos+(bits-chopped_off) onward must be zero along some
1402 * branch of this subtree - otherwise there is *no* valid
1403 * prefix present. Here we can only check the skipped
1404 * bits. Remember, since we have already indexed into the
1405 * parent's child array, we know that the bits we chopped of
1406 * *are* zero.
1407 */
1408
1409 /* NOTA BENE: CHECKING ONLY SKIPPED BITS FOR THE NEW NODE HERE */
1410
1411 if (current_prefix_length < pos+bits) {
1412 if (tkey_extract_bits(cn->key, current_prefix_length,
1413 cn->pos - current_prefix_length) != 0 ||
1414 !(cn->child[0]))
1415 goto backtrace;
1416 }
1417
1418 /*
1419 * If chopped_off=0, the index is fully validated and we
1420 * only need to look at the skipped bits for this, the new,
1421 * tnode. What we actually want to do is to find out if
1422 * these skipped bits match our key perfectly, or if we will
1423 * have to count on finding a matching prefix further down,
1424 * because if we do, we would like to have some way of
1425 * verifying the existence of such a prefix at this point.
1426 */
1427
1428 /* The only thing we can do at this point is to verify that
1429 * any such matching prefix can indeed be a prefix to our
1430 * key, and if the bits in the node we are inspecting that
1431 * do not match our key are not ZERO, this cannot be true.
1432 * Thus, find out where there is a mismatch (before cn->pos)
1433 * and verify that all the mismatching bits are zero in the
1434 * new tnode's key.
1435 */
1436
1437 /* Note: We aren't very concerned about the piece of the key
1438 * that precede pn->pos+pn->bits, since these have already been
1439 * checked. The bits after cn->pos aren't checked since these are
1440 * by definition "unknown" at this point. Thus, what we want to
1441 * see is if we are about to enter the "prefix matching" state,
1442 * and in that case verify that the skipped bits that will prevail
1443 * throughout this subtree are zero, as they have to be if we are
1444 * to find a matching prefix.
1445 */
1446
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07001447 node_prefix = mask_pfx(cn->key, cn->pos);
1448 key_prefix = mask_pfx(key, cn->pos);
Olof Johansson91b9a272005-08-09 20:24:39 -07001449 pref_mismatch = key_prefix^node_prefix;
1450 mp = 0;
1451
1452 /* In short: If skipped bits in this node do not match the search
1453 * key, enter the "prefix matching" state.directly.
1454 */
1455 if (pref_mismatch) {
1456 while (!(pref_mismatch & (1<<(KEYLENGTH-1)))) {
1457 mp++;
1458 pref_mismatch = pref_mismatch <<1;
1459 }
1460 key_prefix = tkey_extract_bits(cn->key, mp, cn->pos-mp);
1461
1462 if (key_prefix != 0)
1463 goto backtrace;
1464
1465 if (current_prefix_length >= cn->pos)
1466 current_prefix_length = mp;
1467 }
1468#endif
1469 pn = (struct tnode *)n; /* Descend */
1470 chopped_off = 0;
1471 continue;
1472
Robert Olsson19baf832005-06-21 12:43:18 -07001473backtrace:
1474 chopped_off++;
1475
1476 /* As zero don't change the child key (cindex) */
Olof Johansson91b9a272005-08-09 20:24:39 -07001477 while ((chopped_off <= pn->bits) && !(cindex & (1<<(chopped_off-1))))
Robert Olsson19baf832005-06-21 12:43:18 -07001478 chopped_off++;
Robert Olsson19baf832005-06-21 12:43:18 -07001479
1480 /* Decrease current_... with bits chopped off */
1481 if (current_prefix_length > pn->pos + pn->bits - chopped_off)
1482 current_prefix_length = pn->pos + pn->bits - chopped_off;
Olof Johansson91b9a272005-08-09 20:24:39 -07001483
Robert Olsson19baf832005-06-21 12:43:18 -07001484 /*
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001485 * Either we do the actual chop off according or if we have
Robert Olsson19baf832005-06-21 12:43:18 -07001486 * chopped off all bits in this tnode walk up to our parent.
1487 */
1488
Olof Johansson91b9a272005-08-09 20:24:39 -07001489 if (chopped_off <= pn->bits) {
Robert Olsson19baf832005-06-21 12:43:18 -07001490 cindex &= ~(1 << (chopped_off-1));
Olof Johansson91b9a272005-08-09 20:24:39 -07001491 } else {
Stephen Hemminger06801912007-08-10 15:22:13 -07001492 struct tnode *parent = node_parent((struct node *) pn);
1493 if (!parent)
Robert Olsson19baf832005-06-21 12:43:18 -07001494 goto failed;
Olof Johansson91b9a272005-08-09 20:24:39 -07001495
Robert Olsson19baf832005-06-21 12:43:18 -07001496 /* Get Child's index */
Stephen Hemminger06801912007-08-10 15:22:13 -07001497 cindex = tkey_extract_bits(pn->key, parent->pos, parent->bits);
1498 pn = parent;
Robert Olsson19baf832005-06-21 12:43:18 -07001499 chopped_off = 0;
1500
1501#ifdef CONFIG_IP_FIB_TRIE_STATS
1502 t->stats.backtrack++;
1503#endif
1504 goto backtrace;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001505 }
Robert Olsson19baf832005-06-21 12:43:18 -07001506 }
1507failed:
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001508 ret = 1;
Robert Olsson19baf832005-06-21 12:43:18 -07001509found:
Robert Olsson2373ce12005-08-25 13:01:29 -07001510 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001511 return ret;
1512}
1513
Robert Olsson2373ce12005-08-25 13:01:29 -07001514/* only called from updater side */
Robert Olsson19baf832005-06-21 12:43:18 -07001515static int trie_leaf_remove(struct trie *t, t_key key)
1516{
1517 t_key cindex;
1518 struct tnode *tp = NULL;
1519 struct node *n = t->trie;
1520 struct leaf *l;
1521
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001522 pr_debug("entering trie_leaf_remove(%p)\n", n);
Robert Olsson19baf832005-06-21 12:43:18 -07001523
1524 /* Note that in the case skipped bits, those bits are *not* checked!
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001525 * When we finish this, we will have NULL or a T_LEAF, and the
Robert Olsson19baf832005-06-21 12:43:18 -07001526 * T_LEAF may or may not match our key.
1527 */
1528
Olof Johansson91b9a272005-08-09 20:24:39 -07001529 while (n != NULL && IS_TNODE(n)) {
Robert Olsson19baf832005-06-21 12:43:18 -07001530 struct tnode *tn = (struct tnode *) n;
1531 check_tnode(tn);
1532 n = tnode_get_child(tn ,tkey_extract_bits(key, tn->pos, tn->bits));
1533
Stephen Hemminger06801912007-08-10 15:22:13 -07001534 BUG_ON(n && node_parent(n) != tn);
Olof Johansson91b9a272005-08-09 20:24:39 -07001535 }
Robert Olsson19baf832005-06-21 12:43:18 -07001536 l = (struct leaf *) n;
1537
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001538 if (!n || !tkey_equals(l->key, key))
Robert Olsson19baf832005-06-21 12:43:18 -07001539 return 0;
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001540
1541 /*
1542 * Key found.
1543 * Remove the leaf and rebalance the tree
Robert Olsson19baf832005-06-21 12:43:18 -07001544 */
1545
Robert Olsson19baf832005-06-21 12:43:18 -07001546 t->size--;
1547
Stephen Hemminger06801912007-08-10 15:22:13 -07001548 tp = node_parent(n);
Robert Olsson19baf832005-06-21 12:43:18 -07001549 tnode_free((struct tnode *) n);
1550
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001551 if (tp) {
Robert Olsson19baf832005-06-21 12:43:18 -07001552 cindex = tkey_extract_bits(key, tp->pos, tp->bits);
1553 put_child(t, (struct tnode *)tp, cindex, NULL);
Robert Olsson2373ce12005-08-25 13:01:29 -07001554 rcu_assign_pointer(t->trie, trie_rebalance(t, tp));
Olof Johansson91b9a272005-08-09 20:24:39 -07001555 } else
Robert Olsson2373ce12005-08-25 13:01:29 -07001556 rcu_assign_pointer(t->trie, NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001557
1558 return 1;
1559}
1560
Robert Olssond562f1f2007-03-26 14:22:22 -07001561/*
1562 * Caller must hold RTNL.
1563 */
Thomas Graf4e902c52006-08-17 18:14:52 -07001564static int fn_trie_delete(struct fib_table *tb, struct fib_config *cfg)
Robert Olsson19baf832005-06-21 12:43:18 -07001565{
1566 struct trie *t = (struct trie *) tb->tb_data;
1567 u32 key, mask;
Thomas Graf4e902c52006-08-17 18:14:52 -07001568 int plen = cfg->fc_dst_len;
1569 u8 tos = cfg->fc_tos;
Robert Olsson19baf832005-06-21 12:43:18 -07001570 struct fib_alias *fa, *fa_to_delete;
1571 struct list_head *fa_head;
1572 struct leaf *l;
Olof Johansson91b9a272005-08-09 20:24:39 -07001573 struct leaf_info *li;
1574
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001575 if (plen > 32)
Robert Olsson19baf832005-06-21 12:43:18 -07001576 return -EINVAL;
1577
Thomas Graf4e902c52006-08-17 18:14:52 -07001578 key = ntohl(cfg->fc_dst);
Olof Johansson91b9a272005-08-09 20:24:39 -07001579 mask = ntohl(inet_make_mask(plen));
Robert Olsson19baf832005-06-21 12:43:18 -07001580
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001581 if (key & ~mask)
Robert Olsson19baf832005-06-21 12:43:18 -07001582 return -EINVAL;
1583
1584 key = key & mask;
1585 l = fib_find_node(t, key);
1586
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001587 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001588 return -ESRCH;
1589
1590 fa_head = get_fa_head(l, plen);
1591 fa = fib_find_alias(fa_head, tos, 0);
1592
1593 if (!fa)
1594 return -ESRCH;
1595
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001596 pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t);
Robert Olsson19baf832005-06-21 12:43:18 -07001597
1598 fa_to_delete = NULL;
1599 fa_head = fa->fa_list.prev;
Robert Olsson2373ce12005-08-25 13:01:29 -07001600
Robert Olsson19baf832005-06-21 12:43:18 -07001601 list_for_each_entry(fa, fa_head, fa_list) {
1602 struct fib_info *fi = fa->fa_info;
1603
1604 if (fa->fa_tos != tos)
1605 break;
1606
Thomas Graf4e902c52006-08-17 18:14:52 -07001607 if ((!cfg->fc_type || fa->fa_type == cfg->fc_type) &&
1608 (cfg->fc_scope == RT_SCOPE_NOWHERE ||
1609 fa->fa_scope == cfg->fc_scope) &&
1610 (!cfg->fc_protocol ||
1611 fi->fib_protocol == cfg->fc_protocol) &&
1612 fib_nh_match(cfg, fi) == 0) {
Robert Olsson19baf832005-06-21 12:43:18 -07001613 fa_to_delete = fa;
1614 break;
1615 }
1616 }
1617
Olof Johansson91b9a272005-08-09 20:24:39 -07001618 if (!fa_to_delete)
1619 return -ESRCH;
Robert Olsson19baf832005-06-21 12:43:18 -07001620
Olof Johansson91b9a272005-08-09 20:24:39 -07001621 fa = fa_to_delete;
Thomas Graf4e902c52006-08-17 18:14:52 -07001622 rtmsg_fib(RTM_DELROUTE, htonl(key), fa, plen, tb->tb_id,
Milan Kocianb8f55832007-05-23 14:55:06 -07001623 &cfg->fc_nlinfo, 0);
Robert Olsson19baf832005-06-21 12:43:18 -07001624
Olof Johansson91b9a272005-08-09 20:24:39 -07001625 l = fib_find_node(t, key);
Robert Olsson772cb712005-09-19 15:31:18 -07001626 li = find_leaf_info(l, plen);
Robert Olsson19baf832005-06-21 12:43:18 -07001627
Robert Olsson2373ce12005-08-25 13:01:29 -07001628 list_del_rcu(&fa->fa_list);
Robert Olsson19baf832005-06-21 12:43:18 -07001629
Olof Johansson91b9a272005-08-09 20:24:39 -07001630 if (list_empty(fa_head)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001631 hlist_del_rcu(&li->hlist);
Olof Johansson91b9a272005-08-09 20:24:39 -07001632 free_leaf_info(li);
Robert Olsson2373ce12005-08-25 13:01:29 -07001633 }
Olof Johansson91b9a272005-08-09 20:24:39 -07001634
1635 if (hlist_empty(&l->list))
1636 trie_leaf_remove(t, key);
1637
1638 if (fa->fa_state & FA_S_ACCESSED)
1639 rt_cache_flush(-1);
1640
Robert Olsson2373ce12005-08-25 13:01:29 -07001641 fib_release_info(fa->fa_info);
1642 alias_free_mem_rcu(fa);
Olof Johansson91b9a272005-08-09 20:24:39 -07001643 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001644}
1645
1646static int trie_flush_list(struct trie *t, struct list_head *head)
1647{
1648 struct fib_alias *fa, *fa_node;
1649 int found = 0;
1650
1651 list_for_each_entry_safe(fa, fa_node, head, fa_list) {
1652 struct fib_info *fi = fa->fa_info;
Robert Olsson19baf832005-06-21 12:43:18 -07001653
Robert Olsson2373ce12005-08-25 13:01:29 -07001654 if (fi && (fi->fib_flags & RTNH_F_DEAD)) {
1655 list_del_rcu(&fa->fa_list);
1656 fib_release_info(fa->fa_info);
1657 alias_free_mem_rcu(fa);
Robert Olsson19baf832005-06-21 12:43:18 -07001658 found++;
1659 }
1660 }
1661 return found;
1662}
1663
1664static int trie_flush_leaf(struct trie *t, struct leaf *l)
1665{
1666 int found = 0;
1667 struct hlist_head *lih = &l->list;
1668 struct hlist_node *node, *tmp;
1669 struct leaf_info *li = NULL;
1670
1671 hlist_for_each_entry_safe(li, node, tmp, lih, hlist) {
Robert Olsson19baf832005-06-21 12:43:18 -07001672 found += trie_flush_list(t, &li->falh);
1673
1674 if (list_empty(&li->falh)) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001675 hlist_del_rcu(&li->hlist);
Robert Olsson19baf832005-06-21 12:43:18 -07001676 free_leaf_info(li);
1677 }
1678 }
1679 return found;
1680}
1681
Robert Olsson2373ce12005-08-25 13:01:29 -07001682/* rcu_read_lock needs to be hold by caller from readside */
1683
Robert Olsson19baf832005-06-21 12:43:18 -07001684static struct leaf *nextleaf(struct trie *t, struct leaf *thisleaf)
1685{
1686 struct node *c = (struct node *) thisleaf;
1687 struct tnode *p;
1688 int idx;
Robert Olsson2373ce12005-08-25 13:01:29 -07001689 struct node *trie = rcu_dereference(t->trie);
Robert Olsson19baf832005-06-21 12:43:18 -07001690
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001691 if (c == NULL) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001692 if (trie == NULL)
Robert Olsson19baf832005-06-21 12:43:18 -07001693 return NULL;
1694
Robert Olsson2373ce12005-08-25 13:01:29 -07001695 if (IS_LEAF(trie)) /* trie w. just a leaf */
1696 return (struct leaf *) trie;
Robert Olsson19baf832005-06-21 12:43:18 -07001697
Robert Olsson2373ce12005-08-25 13:01:29 -07001698 p = (struct tnode*) trie; /* Start */
Olof Johansson91b9a272005-08-09 20:24:39 -07001699 } else
Stephen Hemminger06801912007-08-10 15:22:13 -07001700 p = node_parent(c);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001701
Robert Olsson19baf832005-06-21 12:43:18 -07001702 while (p) {
1703 int pos, last;
1704
1705 /* Find the next child of the parent */
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001706 if (c)
1707 pos = 1 + tkey_extract_bits(c->key, p->pos, p->bits);
1708 else
Robert Olsson19baf832005-06-21 12:43:18 -07001709 pos = 0;
1710
1711 last = 1 << p->bits;
Olof Johansson91b9a272005-08-09 20:24:39 -07001712 for (idx = pos; idx < last ; idx++) {
Robert Olsson2373ce12005-08-25 13:01:29 -07001713 c = rcu_dereference(p->child[idx]);
1714
1715 if (!c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001716 continue;
Robert Olsson19baf832005-06-21 12:43:18 -07001717
Olof Johansson91b9a272005-08-09 20:24:39 -07001718 /* Decend if tnode */
Robert Olsson2373ce12005-08-25 13:01:29 -07001719 while (IS_TNODE(c)) {
1720 p = (struct tnode *) c;
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09001721 idx = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07001722
Olof Johansson91b9a272005-08-09 20:24:39 -07001723 /* Rightmost non-NULL branch */
1724 if (p && IS_TNODE(p))
Robert Olsson2373ce12005-08-25 13:01:29 -07001725 while (!(c = rcu_dereference(p->child[idx]))
1726 && idx < (1<<p->bits)) idx++;
Robert Olsson19baf832005-06-21 12:43:18 -07001727
Olof Johansson91b9a272005-08-09 20:24:39 -07001728 /* Done with this tnode? */
Robert Olsson2373ce12005-08-25 13:01:29 -07001729 if (idx >= (1 << p->bits) || !c)
Olof Johansson91b9a272005-08-09 20:24:39 -07001730 goto up;
Robert Olsson19baf832005-06-21 12:43:18 -07001731 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001732 return (struct leaf *) c;
Robert Olsson19baf832005-06-21 12:43:18 -07001733 }
1734up:
1735 /* No more children go up one step */
Olof Johansson91b9a272005-08-09 20:24:39 -07001736 c = (struct node *) p;
Stephen Hemminger06801912007-08-10 15:22:13 -07001737 p = node_parent(c);
Robert Olsson19baf832005-06-21 12:43:18 -07001738 }
1739 return NULL; /* Ready. Root of trie */
1740}
1741
Robert Olssond562f1f2007-03-26 14:22:22 -07001742/*
1743 * Caller must hold RTNL.
1744 */
Robert Olsson19baf832005-06-21 12:43:18 -07001745static int fn_trie_flush(struct fib_table *tb)
1746{
1747 struct trie *t = (struct trie *) tb->tb_data;
1748 struct leaf *ll = NULL, *l = NULL;
1749 int found = 0, h;
1750
Olof Johansson91b9a272005-08-09 20:24:39 -07001751 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001752 found += trie_flush_leaf(t, l);
1753
1754 if (ll && hlist_empty(&ll->list))
1755 trie_leaf_remove(t, ll->key);
1756 ll = l;
1757 }
1758
1759 if (ll && hlist_empty(&ll->list))
1760 trie_leaf_remove(t, ll->key);
1761
Stephen Hemminger0c7770c2005-08-23 21:59:41 -07001762 pr_debug("trie_flush found=%d\n", found);
Robert Olsson19baf832005-06-21 12:43:18 -07001763 return found;
1764}
1765
Robert Olsson19baf832005-06-21 12:43:18 -07001766static void
1767fn_trie_select_default(struct fib_table *tb, const struct flowi *flp, struct fib_result *res)
1768{
1769 struct trie *t = (struct trie *) tb->tb_data;
1770 int order, last_idx;
1771 struct fib_info *fi = NULL;
1772 struct fib_info *last_resort;
1773 struct fib_alias *fa = NULL;
1774 struct list_head *fa_head;
1775 struct leaf *l;
1776
1777 last_idx = -1;
1778 last_resort = NULL;
1779 order = -1;
1780
Robert Olsson2373ce12005-08-25 13:01:29 -07001781 rcu_read_lock();
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001782
Robert Olsson19baf832005-06-21 12:43:18 -07001783 l = fib_find_node(t, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001784 if (!l)
Robert Olsson19baf832005-06-21 12:43:18 -07001785 goto out;
1786
1787 fa_head = get_fa_head(l, 0);
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001788 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001789 goto out;
1790
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001791 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001792 goto out;
1793
Robert Olsson2373ce12005-08-25 13:01:29 -07001794 list_for_each_entry_rcu(fa, fa_head, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001795 struct fib_info *next_fi = fa->fa_info;
Olof Johansson91b9a272005-08-09 20:24:39 -07001796
Robert Olsson19baf832005-06-21 12:43:18 -07001797 if (fa->fa_scope != res->scope ||
1798 fa->fa_type != RTN_UNICAST)
1799 continue;
Olof Johansson91b9a272005-08-09 20:24:39 -07001800
Robert Olsson19baf832005-06-21 12:43:18 -07001801 if (next_fi->fib_priority > res->fi->fib_priority)
1802 break;
1803 if (!next_fi->fib_nh[0].nh_gw ||
1804 next_fi->fib_nh[0].nh_scope != RT_SCOPE_LINK)
1805 continue;
1806 fa->fa_state |= FA_S_ACCESSED;
Olof Johansson91b9a272005-08-09 20:24:39 -07001807
Robert Olsson19baf832005-06-21 12:43:18 -07001808 if (fi == NULL) {
1809 if (next_fi != res->fi)
1810 break;
1811 } else if (!fib_detect_death(fi, order, &last_resort,
Denis V. Lunev971b8932007-12-08 00:32:23 -08001812 &last_idx, tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001813 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001814 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001815 goto out;
1816 }
1817 fi = next_fi;
1818 order++;
1819 }
1820 if (order <= 0 || fi == NULL) {
Denis V. Lunev971b8932007-12-08 00:32:23 -08001821 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001822 goto out;
1823 }
1824
Denis V. Lunev971b8932007-12-08 00:32:23 -08001825 if (!fib_detect_death(fi, order, &last_resort, &last_idx,
1826 tb->tb_default)) {
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001827 fib_result_assign(res, fi);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001828 tb->tb_default = order;
Robert Olsson19baf832005-06-21 12:43:18 -07001829 goto out;
1830 }
Denis V. Luneva2bbe682007-12-08 00:31:44 -08001831 if (last_idx >= 0)
1832 fib_result_assign(res, last_resort);
Denis V. Lunev971b8932007-12-08 00:32:23 -08001833 tb->tb_default = last_idx;
1834out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001835 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001836}
1837
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001838static int fn_trie_dump_fa(t_key key, int plen, struct list_head *fah, struct fib_table *tb,
Robert Olsson19baf832005-06-21 12:43:18 -07001839 struct sk_buff *skb, struct netlink_callback *cb)
1840{
1841 int i, s_i;
1842 struct fib_alias *fa;
1843
Al Viro32ab5f82006-09-26 22:21:45 -07001844 __be32 xkey = htonl(key);
Robert Olsson19baf832005-06-21 12:43:18 -07001845
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001846 s_i = cb->args[4];
Robert Olsson19baf832005-06-21 12:43:18 -07001847 i = 0;
1848
Robert Olsson2373ce12005-08-25 13:01:29 -07001849 /* rcu_read_lock is hold by caller */
1850
1851 list_for_each_entry_rcu(fa, fah, fa_list) {
Robert Olsson19baf832005-06-21 12:43:18 -07001852 if (i < s_i) {
1853 i++;
1854 continue;
1855 }
Stephen Hemminger78c66712005-09-21 00:15:39 -07001856 BUG_ON(!fa->fa_info);
Robert Olsson19baf832005-06-21 12:43:18 -07001857
1858 if (fib_dump_info(skb, NETLINK_CB(cb->skb).pid,
1859 cb->nlh->nlmsg_seq,
1860 RTM_NEWROUTE,
1861 tb->tb_id,
1862 fa->fa_type,
1863 fa->fa_scope,
Thomas Grafbe403ea2006-08-17 18:15:17 -07001864 xkey,
Robert Olsson19baf832005-06-21 12:43:18 -07001865 plen,
1866 fa->fa_tos,
David S. Miller90f66912005-06-21 14:43:28 -07001867 fa->fa_info, 0) < 0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001868 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001869 return -1;
Olof Johansson91b9a272005-08-09 20:24:39 -07001870 }
Robert Olsson19baf832005-06-21 12:43:18 -07001871 i++;
1872 }
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001873 cb->args[4] = i;
Robert Olsson19baf832005-06-21 12:43:18 -07001874 return skb->len;
1875}
1876
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001877static int fn_trie_dump_plen(struct trie *t, int plen, struct fib_table *tb, struct sk_buff *skb,
Robert Olsson19baf832005-06-21 12:43:18 -07001878 struct netlink_callback *cb)
1879{
1880 int h, s_h;
1881 struct list_head *fa_head;
1882 struct leaf *l = NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07001883
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001884 s_h = cb->args[3];
Robert Olsson19baf832005-06-21 12:43:18 -07001885
Olof Johansson91b9a272005-08-09 20:24:39 -07001886 for (h = 0; (l = nextleaf(t, l)) != NULL; h++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001887 if (h < s_h)
1888 continue;
1889 if (h > s_h)
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001890 memset(&cb->args[4], 0,
1891 sizeof(cb->args) - 4*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001892
1893 fa_head = get_fa_head(l, plen);
Olof Johansson91b9a272005-08-09 20:24:39 -07001894
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001895 if (!fa_head)
Robert Olsson19baf832005-06-21 12:43:18 -07001896 continue;
1897
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001898 if (list_empty(fa_head))
Robert Olsson19baf832005-06-21 12:43:18 -07001899 continue;
1900
1901 if (fn_trie_dump_fa(l->key, plen, fa_head, tb, skb, cb)<0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001902 cb->args[3] = h;
Robert Olsson19baf832005-06-21 12:43:18 -07001903 return -1;
1904 }
1905 }
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001906 cb->args[3] = h;
Robert Olsson19baf832005-06-21 12:43:18 -07001907 return skb->len;
1908}
1909
1910static int fn_trie_dump(struct fib_table *tb, struct sk_buff *skb, struct netlink_callback *cb)
1911{
1912 int m, s_m;
1913 struct trie *t = (struct trie *) tb->tb_data;
1914
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001915 s_m = cb->args[2];
Robert Olsson19baf832005-06-21 12:43:18 -07001916
Robert Olsson2373ce12005-08-25 13:01:29 -07001917 rcu_read_lock();
Olof Johansson91b9a272005-08-09 20:24:39 -07001918 for (m = 0; m <= 32; m++) {
Robert Olsson19baf832005-06-21 12:43:18 -07001919 if (m < s_m)
1920 continue;
1921 if (m > s_m)
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001922 memset(&cb->args[3], 0,
1923 sizeof(cb->args) - 3*sizeof(cb->args[0]));
Robert Olsson19baf832005-06-21 12:43:18 -07001924
1925 if (fn_trie_dump_plen(t, 32-m, tb, skb, cb)<0) {
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001926 cb->args[2] = m;
Robert Olsson19baf832005-06-21 12:43:18 -07001927 goto out;
1928 }
1929 }
Robert Olsson2373ce12005-08-25 13:01:29 -07001930 rcu_read_unlock();
Patrick McHardy1af5a8c2006-08-10 23:10:46 -07001931 cb->args[2] = m;
Robert Olsson19baf832005-06-21 12:43:18 -07001932 return skb->len;
Olof Johansson91b9a272005-08-09 20:24:39 -07001933out:
Robert Olsson2373ce12005-08-25 13:01:29 -07001934 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07001935 return -1;
1936}
1937
1938/* Fix more generic FIB names for init later */
1939
Denis V. Lunev7b1a74f2008-01-10 03:22:17 -08001940struct fib_table *fib_hash_init(u32 id)
Robert Olsson19baf832005-06-21 12:43:18 -07001941{
1942 struct fib_table *tb;
1943 struct trie *t;
1944
1945 if (fn_alias_kmem == NULL)
1946 fn_alias_kmem = kmem_cache_create("ip_fib_alias",
1947 sizeof(struct fib_alias),
1948 0, SLAB_HWCACHE_ALIGN,
Paul Mundt20c2df82007-07-20 10:11:58 +09001949 NULL);
Robert Olsson19baf832005-06-21 12:43:18 -07001950
1951 tb = kmalloc(sizeof(struct fib_table) + sizeof(struct trie),
1952 GFP_KERNEL);
1953 if (tb == NULL)
1954 return NULL;
1955
1956 tb->tb_id = id;
Denis V. Lunev971b8932007-12-08 00:32:23 -08001957 tb->tb_default = -1;
Robert Olsson19baf832005-06-21 12:43:18 -07001958 tb->tb_lookup = fn_trie_lookup;
1959 tb->tb_insert = fn_trie_insert;
1960 tb->tb_delete = fn_trie_delete;
1961 tb->tb_flush = fn_trie_flush;
1962 tb->tb_select_default = fn_trie_select_default;
1963 tb->tb_dump = fn_trie_dump;
Robert Olsson19baf832005-06-21 12:43:18 -07001964
1965 t = (struct trie *) tb->tb_data;
Stephen Hemmingerc28a1cf2008-01-12 20:49:13 -08001966 memset(t, 0, sizeof(*t));
Robert Olsson19baf832005-06-21 12:43:18 -07001967
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07001968 if (id == RT_TABLE_LOCAL)
Stephen Hemminger78c66712005-09-21 00:15:39 -07001969 printk(KERN_INFO "IPv4 FIB: Using LC-trie version %s\n", VERSION);
Robert Olsson19baf832005-06-21 12:43:18 -07001970
1971 return tb;
1972}
1973
Robert Olsson19baf832005-06-21 12:43:18 -07001974#ifdef CONFIG_PROC_FS
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001975/* Depth first Trie walk iterator */
1976struct fib_trie_iter {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08001977 struct seq_net_private p;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08001978 struct trie *trie_local, *trie_main;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001979 struct tnode *tnode;
1980 struct trie *trie;
1981 unsigned index;
1982 unsigned depth;
1983};
Robert Olsson19baf832005-06-21 12:43:18 -07001984
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001985static struct node *fib_trie_get_next(struct fib_trie_iter *iter)
Robert Olsson19baf832005-06-21 12:43:18 -07001986{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001987 struct tnode *tn = iter->tnode;
1988 unsigned cindex = iter->index;
1989 struct tnode *p;
1990
Eric W. Biederman6640e692007-01-24 14:42:04 -08001991 /* A single entry routing table */
1992 if (!tn)
1993 return NULL;
1994
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07001995 pr_debug("get_next iter={node=%p index=%d depth=%d}\n",
1996 iter->tnode, iter->index, iter->depth);
1997rescan:
1998 while (cindex < (1<<tn->bits)) {
1999 struct node *n = tnode_get_child(tn, cindex);
2000
2001 if (n) {
2002 if (IS_LEAF(n)) {
2003 iter->tnode = tn;
2004 iter->index = cindex + 1;
2005 } else {
2006 /* push down one level */
2007 iter->tnode = (struct tnode *) n;
2008 iter->index = 0;
2009 ++iter->depth;
2010 }
2011 return n;
2012 }
2013
2014 ++cindex;
2015 }
2016
2017 /* Current node exhausted, pop back up */
Stephen Hemminger06801912007-08-10 15:22:13 -07002018 p = node_parent((struct node *)tn);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002019 if (p) {
2020 cindex = tkey_extract_bits(tn->key, p->pos, p->bits)+1;
2021 tn = p;
2022 --iter->depth;
2023 goto rescan;
2024 }
2025
2026 /* got root? */
Robert Olsson19baf832005-06-21 12:43:18 -07002027 return NULL;
2028}
2029
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002030static struct node *fib_trie_get_first(struct fib_trie_iter *iter,
2031 struct trie *t)
Robert Olsson19baf832005-06-21 12:43:18 -07002032{
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002033 struct node *n ;
2034
Stephen Hemminger132adf52007-03-08 20:44:43 -08002035 if (!t)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002036 return NULL;
2037
2038 n = rcu_dereference(t->trie);
2039
Stephen Hemminger132adf52007-03-08 20:44:43 -08002040 if (!iter)
Robert Olsson5ddf0eb2006-03-20 21:34:12 -08002041 return NULL;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002042
Eric W. Biederman6640e692007-01-24 14:42:04 -08002043 if (n) {
2044 if (IS_TNODE(n)) {
2045 iter->tnode = (struct tnode *) n;
2046 iter->trie = t;
2047 iter->index = 0;
2048 iter->depth = 1;
2049 } else {
2050 iter->tnode = NULL;
2051 iter->trie = t;
2052 iter->index = 0;
2053 iter->depth = 0;
2054 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002055 return n;
2056 }
Robert Olsson19baf832005-06-21 12:43:18 -07002057 return NULL;
2058}
2059
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002060static void trie_collect_stats(struct trie *t, struct trie_stat *s)
Robert Olsson19baf832005-06-21 12:43:18 -07002061{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002062 struct node *n;
2063 struct fib_trie_iter iter;
Robert Olsson19baf832005-06-21 12:43:18 -07002064
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002065 memset(s, 0, sizeof(*s));
Robert Olsson19baf832005-06-21 12:43:18 -07002066
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002067 rcu_read_lock();
2068 for (n = fib_trie_get_first(&iter, t); n;
2069 n = fib_trie_get_next(&iter)) {
2070 if (IS_LEAF(n)) {
2071 s->leaves++;
2072 s->totdepth += iter.depth;
2073 if (iter.depth > s->maxdepth)
2074 s->maxdepth = iter.depth;
2075 } else {
2076 const struct tnode *tn = (const struct tnode *) n;
2077 int i;
Robert Olsson19baf832005-06-21 12:43:18 -07002078
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002079 s->tnodes++;
Stephen Hemminger132adf52007-03-08 20:44:43 -08002080 if (tn->bits < MAX_STAT_DEPTH)
Robert Olsson06ef9212006-03-20 21:35:01 -08002081 s->nodesizes[tn->bits]++;
2082
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002083 for (i = 0; i < (1<<tn->bits); i++)
2084 if (!tn->child[i])
2085 s->nullpointers++;
2086 }
2087 }
2088 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002089}
2090
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002091/*
Robert Olsson19baf832005-06-21 12:43:18 -07002092 * This outputs /proc/net/fib_triestats
Robert Olsson19baf832005-06-21 12:43:18 -07002093 */
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002094static void trie_show_stats(struct seq_file *seq, struct trie_stat *stat)
Robert Olsson19baf832005-06-21 12:43:18 -07002095{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002096 unsigned i, max, pointers, bytes, avdepth;
Robert Olsson19baf832005-06-21 12:43:18 -07002097
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002098 if (stat->leaves)
2099 avdepth = stat->totdepth*100 / stat->leaves;
2100 else
2101 avdepth = 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002102
Stephen Hemminger187b5182008-01-12 20:55:55 -08002103 seq_printf(seq, "\tAver depth: %u.%02d\n", avdepth / 100, avdepth % 100 );
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002104 seq_printf(seq, "\tMax depth: %u\n", stat->maxdepth);
Robert Olsson19baf832005-06-21 12:43:18 -07002105
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002106 seq_printf(seq, "\tLeaves: %u\n", stat->leaves);
Olof Johansson91b9a272005-08-09 20:24:39 -07002107
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002108 bytes = sizeof(struct leaf) * stat->leaves;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002109 seq_printf(seq, "\tInternal nodes: %u\n\t", stat->tnodes);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002110 bytes += sizeof(struct tnode) * stat->tnodes;
Robert Olsson19baf832005-06-21 12:43:18 -07002111
Robert Olsson06ef9212006-03-20 21:35:01 -08002112 max = MAX_STAT_DEPTH;
2113 while (max > 0 && stat->nodesizes[max-1] == 0)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002114 max--;
Robert Olsson19baf832005-06-21 12:43:18 -07002115
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002116 pointers = 0;
2117 for (i = 1; i <= max; i++)
2118 if (stat->nodesizes[i] != 0) {
Stephen Hemminger187b5182008-01-12 20:55:55 -08002119 seq_printf(seq, " %u: %u", i, stat->nodesizes[i]);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002120 pointers += (1<<i) * stat->nodesizes[i];
2121 }
2122 seq_putc(seq, '\n');
Stephen Hemminger187b5182008-01-12 20:55:55 -08002123 seq_printf(seq, "\tPointers: %u\n", pointers);
Robert Olsson19baf832005-06-21 12:43:18 -07002124
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002125 bytes += sizeof(struct node *) * pointers;
Stephen Hemminger187b5182008-01-12 20:55:55 -08002126 seq_printf(seq, "Null ptrs: %u\n", stat->nullpointers);
2127 seq_printf(seq, "Total size: %u kB\n", (bytes + 1023) / 1024);
Robert Olsson19baf832005-06-21 12:43:18 -07002128
2129#ifdef CONFIG_IP_FIB_TRIE_STATS
2130 seq_printf(seq, "Counters:\n---------\n");
2131 seq_printf(seq,"gets = %d\n", t->stats.gets);
2132 seq_printf(seq,"backtracks = %d\n", t->stats.backtrack);
2133 seq_printf(seq,"semantic match passed = %d\n", t->stats.semantic_match_passed);
2134 seq_printf(seq,"semantic match miss = %d\n", t->stats.semantic_match_miss);
2135 seq_printf(seq,"null node hit= %d\n", t->stats.null_node_hit);
Robert Olsson2f368952005-07-05 15:02:40 -07002136 seq_printf(seq,"skipped node resize = %d\n", t->stats.resize_node_skipped);
Robert Olsson19baf832005-06-21 12:43:18 -07002137#ifdef CLEAR_STATS
2138 memset(&(t->stats), 0, sizeof(t->stats));
2139#endif
2140#endif /* CONFIG_IP_FIB_TRIE_STATS */
2141}
2142
2143static int fib_triestat_seq_show(struct seq_file *seq, void *v)
2144{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002145 struct net *net = (struct net *)seq->private;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002146 struct trie *trie_local, *trie_main;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002147 struct trie_stat *stat;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002148 struct fib_table *tb;
2149
2150 trie_local = NULL;
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002151 tb = fib_get_table(net, RT_TABLE_LOCAL);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002152 if (tb)
2153 trie_local = (struct trie *) tb->tb_data;
2154
2155 trie_main = NULL;
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002156 tb = fib_get_table(net, RT_TABLE_MAIN);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002157 if (tb)
2158 trie_main = (struct trie *) tb->tb_data;
2159
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002160
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002161 stat = kmalloc(sizeof(*stat), GFP_KERNEL);
2162 if (!stat)
2163 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002164
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002165 seq_printf(seq, "Basic info: size of leaf: %Zd bytes, size of tnode: %Zd bytes.\n",
2166 sizeof(struct leaf), sizeof(struct tnode));
Olof Johansson91b9a272005-08-09 20:24:39 -07002167
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002168 if (trie_local) {
2169 seq_printf(seq, "Local:\n");
2170 trie_collect_stats(trie_local, stat);
2171 trie_show_stats(seq, stat);
Robert Olsson19baf832005-06-21 12:43:18 -07002172 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002173
2174 if (trie_main) {
2175 seq_printf(seq, "Main:\n");
2176 trie_collect_stats(trie_main, stat);
2177 trie_show_stats(seq, stat);
2178 }
2179 kfree(stat);
2180
Robert Olsson19baf832005-06-21 12:43:18 -07002181 return 0;
2182}
2183
Robert Olsson19baf832005-06-21 12:43:18 -07002184static int fib_triestat_seq_open(struct inode *inode, struct file *file)
2185{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002186 int err;
2187 struct net *net;
2188
2189 net = get_proc_net(inode);
2190 if (net == NULL)
2191 return -ENXIO;
2192 err = single_open(file, fib_triestat_seq_show, net);
2193 if (err < 0) {
2194 put_net(net);
2195 return err;
2196 }
2197 return 0;
2198}
2199
2200static int fib_triestat_seq_release(struct inode *ino, struct file *f)
2201{
2202 struct seq_file *seq = f->private_data;
2203 put_net(seq->private);
2204 return single_release(ino, f);
Robert Olsson19baf832005-06-21 12:43:18 -07002205}
2206
Arjan van de Ven9a321442007-02-12 00:55:35 -08002207static const struct file_operations fib_triestat_fops = {
Stephen Hemmingerc877efb2005-07-19 14:01:51 -07002208 .owner = THIS_MODULE,
2209 .open = fib_triestat_seq_open,
2210 .read = seq_read,
2211 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002212 .release = fib_triestat_seq_release,
Robert Olsson19baf832005-06-21 12:43:18 -07002213};
2214
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002215static struct node *fib_trie_get_idx(struct fib_trie_iter *iter,
2216 loff_t pos)
Robert Olsson19baf832005-06-21 12:43:18 -07002217{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002218 loff_t idx = 0;
2219 struct node *n;
Robert Olsson19baf832005-06-21 12:43:18 -07002220
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002221 for (n = fib_trie_get_first(iter, iter->trie_local);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002222 n; ++idx, n = fib_trie_get_next(iter)) {
2223 if (pos == idx)
2224 return n;
2225 }
Robert Olsson19baf832005-06-21 12:43:18 -07002226
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002227 for (n = fib_trie_get_first(iter, iter->trie_main);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002228 n; ++idx, n = fib_trie_get_next(iter)) {
2229 if (pos == idx)
2230 return n;
2231 }
Robert Olsson19baf832005-06-21 12:43:18 -07002232 return NULL;
2233}
2234
2235static void *fib_trie_seq_start(struct seq_file *seq, loff_t *pos)
2236{
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002237 struct fib_trie_iter *iter = seq->private;
2238 struct fib_table *tb;
2239
2240 if (!iter->trie_local) {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002241 tb = fib_get_table(iter->p.net, RT_TABLE_LOCAL);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002242 if (tb)
2243 iter->trie_local = (struct trie *) tb->tb_data;
2244 }
2245 if (!iter->trie_main) {
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002246 tb = fib_get_table(iter->p.net, RT_TABLE_MAIN);
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002247 if (tb)
2248 iter->trie_main = (struct trie *) tb->tb_data;
2249 }
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002250 rcu_read_lock();
2251 if (*pos == 0)
Olof Johansson91b9a272005-08-09 20:24:39 -07002252 return SEQ_START_TOKEN;
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002253 return fib_trie_get_idx(iter, *pos - 1);
Robert Olsson19baf832005-06-21 12:43:18 -07002254}
2255
2256static void *fib_trie_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2257{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002258 struct fib_trie_iter *iter = seq->private;
2259 void *l = v;
2260
Robert Olsson19baf832005-06-21 12:43:18 -07002261 ++*pos;
Olof Johansson91b9a272005-08-09 20:24:39 -07002262 if (v == SEQ_START_TOKEN)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002263 return fib_trie_get_idx(iter, 0);
Olof Johansson91b9a272005-08-09 20:24:39 -07002264
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002265 v = fib_trie_get_next(iter);
2266 BUG_ON(v == l);
2267 if (v)
2268 return v;
2269
2270 /* continue scan in next trie */
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002271 if (iter->trie == iter->trie_local)
2272 return fib_trie_get_first(iter, iter->trie_main);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002273
2274 return NULL;
Robert Olsson19baf832005-06-21 12:43:18 -07002275}
2276
2277static void fib_trie_seq_stop(struct seq_file *seq, void *v)
2278{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002279 rcu_read_unlock();
Robert Olsson19baf832005-06-21 12:43:18 -07002280}
2281
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002282static void seq_indent(struct seq_file *seq, int n)
2283{
2284 while (n-- > 0) seq_puts(seq, " ");
2285}
Robert Olsson19baf832005-06-21 12:43:18 -07002286
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002287static inline const char *rtn_scope(enum rt_scope_t s)
2288{
2289 static char buf[32];
2290
Stephen Hemminger132adf52007-03-08 20:44:43 -08002291 switch (s) {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002292 case RT_SCOPE_UNIVERSE: return "universe";
2293 case RT_SCOPE_SITE: return "site";
2294 case RT_SCOPE_LINK: return "link";
2295 case RT_SCOPE_HOST: return "host";
2296 case RT_SCOPE_NOWHERE: return "nowhere";
2297 default:
2298 snprintf(buf, sizeof(buf), "scope=%d", s);
2299 return buf;
2300 }
2301}
2302
2303static const char *rtn_type_names[__RTN_MAX] = {
2304 [RTN_UNSPEC] = "UNSPEC",
2305 [RTN_UNICAST] = "UNICAST",
2306 [RTN_LOCAL] = "LOCAL",
2307 [RTN_BROADCAST] = "BROADCAST",
2308 [RTN_ANYCAST] = "ANYCAST",
2309 [RTN_MULTICAST] = "MULTICAST",
2310 [RTN_BLACKHOLE] = "BLACKHOLE",
2311 [RTN_UNREACHABLE] = "UNREACHABLE",
2312 [RTN_PROHIBIT] = "PROHIBIT",
2313 [RTN_THROW] = "THROW",
2314 [RTN_NAT] = "NAT",
2315 [RTN_XRESOLVE] = "XRESOLVE",
2316};
2317
2318static inline const char *rtn_type(unsigned t)
2319{
2320 static char buf[32];
2321
2322 if (t < __RTN_MAX && rtn_type_names[t])
2323 return rtn_type_names[t];
Stephen Hemminger187b5182008-01-12 20:55:55 -08002324 snprintf(buf, sizeof(buf), "type %u", t);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002325 return buf;
2326}
2327
2328/* Pretty print the trie */
Robert Olsson19baf832005-06-21 12:43:18 -07002329static int fib_trie_seq_show(struct seq_file *seq, void *v)
2330{
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002331 const struct fib_trie_iter *iter = seq->private;
2332 struct node *n = v;
Robert Olsson19baf832005-06-21 12:43:18 -07002333
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002334 if (v == SEQ_START_TOKEN)
2335 return 0;
Robert Olsson19baf832005-06-21 12:43:18 -07002336
Stephen Hemminger06801912007-08-10 15:22:13 -07002337 if (!node_parent(n)) {
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002338 if (iter->trie == iter->trie_local)
Robert Olsson095b8502007-01-26 19:06:01 -08002339 seq_puts(seq, "<local>:\n");
2340 else
2341 seq_puts(seq, "<main>:\n");
2342 }
2343
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002344 if (IS_TNODE(n)) {
2345 struct tnode *tn = (struct tnode *) n;
Stephen Hemmingerab66b4a2007-08-10 15:22:58 -07002346 __be32 prf = htonl(mask_pfx(tn->key, tn->pos));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002347
Robert Olsson1d25cd62005-09-19 15:29:52 -07002348 seq_indent(seq, iter->depth-1);
2349 seq_printf(seq, " +-- %d.%d.%d.%d/%d %d %d %d\n",
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002350 NIPQUAD(prf), tn->pos, tn->bits, tn->full_children,
Robert Olsson1d25cd62005-09-19 15:29:52 -07002351 tn->empty_children);
YOSHIFUJI Hideakie905a9e2007-02-09 23:24:47 +09002352
Olof Johansson91b9a272005-08-09 20:24:39 -07002353 } else {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002354 struct leaf *l = (struct leaf *) n;
2355 int i;
Al Viro32ab5f82006-09-26 22:21:45 -07002356 __be32 val = htonl(l->key);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002357
2358 seq_indent(seq, iter->depth);
2359 seq_printf(seq, " |-- %d.%d.%d.%d\n", NIPQUAD(val));
2360 for (i = 32; i >= 0; i--) {
Robert Olsson772cb712005-09-19 15:31:18 -07002361 struct leaf_info *li = find_leaf_info(l, i);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002362 if (li) {
2363 struct fib_alias *fa;
2364 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
2365 seq_indent(seq, iter->depth+1);
2366 seq_printf(seq, " /%d %s %s", i,
2367 rtn_scope(fa->fa_scope),
2368 rtn_type(fa->fa_type));
2369 if (fa->fa_tos)
2370 seq_printf(seq, "tos =%d\n",
2371 fa->fa_tos);
2372 seq_putc(seq, '\n');
2373 }
2374 }
2375 }
Robert Olsson19baf832005-06-21 12:43:18 -07002376 }
2377
2378 return 0;
2379}
2380
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002381static const struct seq_operations fib_trie_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002382 .start = fib_trie_seq_start,
2383 .next = fib_trie_seq_next,
2384 .stop = fib_trie_seq_stop,
2385 .show = fib_trie_seq_show,
Robert Olsson19baf832005-06-21 12:43:18 -07002386};
2387
2388static int fib_trie_seq_open(struct inode *inode, struct file *file)
2389{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002390 return seq_open_net(inode, file, &fib_trie_seq_ops,
2391 sizeof(struct fib_trie_iter));
Robert Olsson19baf832005-06-21 12:43:18 -07002392}
2393
Arjan van de Ven9a321442007-02-12 00:55:35 -08002394static const struct file_operations fib_trie_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002395 .owner = THIS_MODULE,
2396 .open = fib_trie_seq_open,
2397 .read = seq_read,
2398 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002399 .release = seq_release_net,
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002400};
2401
Al Viro32ab5f82006-09-26 22:21:45 -07002402static unsigned fib_flag_trans(int type, __be32 mask, const struct fib_info *fi)
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002403{
2404 static unsigned type2flags[RTN_MAX + 1] = {
2405 [7] = RTF_REJECT, [8] = RTF_REJECT,
2406 };
2407 unsigned flags = type2flags[type];
2408
2409 if (fi && fi->fib_nh->nh_gw)
2410 flags |= RTF_GATEWAY;
Al Viro32ab5f82006-09-26 22:21:45 -07002411 if (mask == htonl(0xFFFFFFFF))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002412 flags |= RTF_HOST;
2413 flags |= RTF_UP;
2414 return flags;
2415}
2416
2417/*
2418 * This outputs /proc/net/route.
2419 * The format of the file is not supposed to be changed
2420 * and needs to be same as fib_hash output to avoid breaking
2421 * legacy utilities
2422 */
2423static int fib_route_seq_show(struct seq_file *seq, void *v)
2424{
Patrick McHardyc9e53cb2005-11-20 21:09:00 -08002425 const struct fib_trie_iter *iter = seq->private;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002426 struct leaf *l = v;
2427 int i;
2428 char bf[128];
2429
2430 if (v == SEQ_START_TOKEN) {
2431 seq_printf(seq, "%-127s\n", "Iface\tDestination\tGateway "
2432 "\tFlags\tRefCnt\tUse\tMetric\tMask\t\tMTU"
2433 "\tWindow\tIRTT");
2434 return 0;
2435 }
2436
Eric W. Biederman877a9bf2007-12-07 00:47:47 -08002437 if (iter->trie == iter->trie_local)
Patrick McHardyc9e53cb2005-11-20 21:09:00 -08002438 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002439 if (IS_TNODE(l))
2440 return 0;
2441
2442 for (i=32; i>=0; i--) {
Robert Olsson772cb712005-09-19 15:31:18 -07002443 struct leaf_info *li = find_leaf_info(l, i);
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002444 struct fib_alias *fa;
Al Viro32ab5f82006-09-26 22:21:45 -07002445 __be32 mask, prefix;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002446
2447 if (!li)
2448 continue;
2449
2450 mask = inet_make_mask(li->plen);
2451 prefix = htonl(l->key);
2452
2453 list_for_each_entry_rcu(fa, &li->falh, fa_list) {
Herbert Xu1371e372005-10-15 09:42:39 +10002454 const struct fib_info *fi = fa->fa_info;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002455 unsigned flags = fib_flag_trans(fa->fa_type, mask, fi);
2456
2457 if (fa->fa_type == RTN_BROADCAST
2458 || fa->fa_type == RTN_MULTICAST)
2459 continue;
2460
2461 if (fi)
2462 snprintf(bf, sizeof(bf),
2463 "%s\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2464 fi->fib_dev ? fi->fib_dev->name : "*",
2465 prefix,
2466 fi->fib_nh->nh_gw, flags, 0, 0,
2467 fi->fib_priority,
2468 mask,
2469 (fi->fib_advmss ? fi->fib_advmss + 40 : 0),
2470 fi->fib_window,
2471 fi->fib_rtt >> 3);
2472 else
2473 snprintf(bf, sizeof(bf),
2474 "*\t%08X\t%08X\t%04X\t%d\t%u\t%d\t%08X\t%d\t%u\t%u",
2475 prefix, 0, flags, 0, 0, 0,
2476 mask, 0, 0, 0);
2477
2478 seq_printf(seq, "%-127s\n", bf);
2479 }
2480 }
2481
2482 return 0;
2483}
2484
Stephen Hemmingerf6908082007-03-12 14:34:29 -07002485static const struct seq_operations fib_route_seq_ops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002486 .start = fib_trie_seq_start,
2487 .next = fib_trie_seq_next,
2488 .stop = fib_trie_seq_stop,
2489 .show = fib_route_seq_show,
2490};
2491
2492static int fib_route_seq_open(struct inode *inode, struct file *file)
2493{
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002494 return seq_open_net(inode, file, &fib_route_seq_ops,
2495 sizeof(struct fib_trie_iter));
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002496}
2497
Arjan van de Ven9a321442007-02-12 00:55:35 -08002498static const struct file_operations fib_route_fops = {
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002499 .owner = THIS_MODULE,
2500 .open = fib_route_seq_open,
2501 .read = seq_read,
2502 .llseek = seq_lseek,
Denis V. Lunev1c340b22008-01-10 03:27:17 -08002503 .release = seq_release_net,
Robert Olsson19baf832005-06-21 12:43:18 -07002504};
2505
Denis V. Lunev61a02652008-01-10 03:21:09 -08002506int __net_init fib_proc_init(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002507{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002508 if (!proc_net_fops_create(net, "fib_trie", S_IRUGO, &fib_trie_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002509 goto out1;
2510
Denis V. Lunev61a02652008-01-10 03:21:09 -08002511 if (!proc_net_fops_create(net, "fib_triestat", S_IRUGO,
2512 &fib_triestat_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002513 goto out2;
2514
Denis V. Lunev61a02652008-01-10 03:21:09 -08002515 if (!proc_net_fops_create(net, "route", S_IRUGO, &fib_route_fops))
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002516 goto out3;
2517
Robert Olsson19baf832005-06-21 12:43:18 -07002518 return 0;
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002519
2520out3:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002521 proc_net_remove(net, "fib_triestat");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002522out2:
Denis V. Lunev61a02652008-01-10 03:21:09 -08002523 proc_net_remove(net, "fib_trie");
Stephen Hemmingercb7b5932005-09-09 13:35:42 -07002524out1:
2525 return -ENOMEM;
Robert Olsson19baf832005-06-21 12:43:18 -07002526}
2527
Denis V. Lunev61a02652008-01-10 03:21:09 -08002528void __net_exit fib_proc_exit(struct net *net)
Robert Olsson19baf832005-06-21 12:43:18 -07002529{
Denis V. Lunev61a02652008-01-10 03:21:09 -08002530 proc_net_remove(net, "fib_trie");
2531 proc_net_remove(net, "fib_triestat");
2532 proc_net_remove(net, "route");
Robert Olsson19baf832005-06-21 12:43:18 -07002533}
2534
2535#endif /* CONFIG_PROC_FS */