blob: a796fc7cbc3542972eaa19bbc3d3dc07a428ff1c [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * DECnet An implementation of the DECnet protocol suite for the LINUX
3 * operating system. DECnet is implemented using the BSD Socket
4 * interface as the means of communication with the user level.
5 *
6 * DECnet Routing Forwarding Information Base (Glue/Info List)
7 *
8 * Author: Steve Whitehouse <SteveW@ACM.org>
9 *
10 *
11 * Changes:
12 * Alexey Kuznetsov : SMP locking changes
13 * Steve Whitehouse : Rewrote it... Well to be more correct, I
14 * copied most of it from the ipv4 fib code.
15 * Steve Whitehouse : Updated it in style and fixed a few bugs
16 * which were fixed in the ipv4 code since
17 * this code was copied from it.
18 *
19 */
Linus Torvalds1da177e2005-04-16 15:20:36 -070020#include <linux/string.h>
21#include <linux/net.h>
22#include <linux/socket.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090023#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070024#include <linux/sockios.h>
25#include <linux/init.h>
26#include <linux/skbuff.h>
27#include <linux/netlink.h>
28#include <linux/rtnetlink.h>
29#include <linux/proc_fs.h>
30#include <linux/netdevice.h>
31#include <linux/timer.h>
32#include <linux/spinlock.h>
Arun Sharma600634972011-07-26 16:09:06 -070033#include <linux/atomic.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034#include <asm/uaccess.h>
35#include <net/neighbour.h>
36#include <net/dst.h>
37#include <net/flow.h>
Steven Whitehousea8731cb2006-08-09 15:56:46 -070038#include <net/fib_rules.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070039#include <net/dn.h>
40#include <net/dn_route.h>
41#include <net/dn_fib.h>
42#include <net/dn_neigh.h>
43#include <net/dn_dev.h>
Vegard Nossumab582982016-07-05 21:12:53 +020044#include <net/nexthop.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070045
46#define RT_MIN_TABLE 1
47
48#define for_fib_info() { struct dn_fib_info *fi;\
49 for(fi = dn_fib_info_list; fi; fi = fi->fib_next)
50#define endfor_fib_info() }
51
52#define for_nexthops(fi) { int nhsel; const struct dn_fib_nh *nh;\
53 for(nhsel = 0, nh = (fi)->fib_nh; nhsel < (fi)->fib_nhs; nh++, nhsel++)
54
55#define change_nexthops(fi) { int nhsel; struct dn_fib_nh *nh;\
56 for(nhsel = 0, nh = (struct dn_fib_nh *)((fi)->fib_nh); nhsel < (fi)->fib_nhs; nh++, nhsel++)
57
58#define endfor_nexthops(fi) }
59
Linus Torvalds1da177e2005-04-16 15:20:36 -070060static DEFINE_SPINLOCK(dn_fib_multipath_lock);
61static struct dn_fib_info *dn_fib_info_list;
Steven Whitehousea22ec362006-08-09 16:00:57 -070062static DEFINE_SPINLOCK(dn_fib_info_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -070063
64static struct
65{
66 int error;
67 u8 scope;
Thomas Grafa9791012007-03-24 20:33:27 -070068} dn_fib_props[RTN_MAX+1] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -070069 [RTN_UNSPEC] = { .error = 0, .scope = RT_SCOPE_NOWHERE },
70 [RTN_UNICAST] = { .error = 0, .scope = RT_SCOPE_UNIVERSE },
71 [RTN_LOCAL] = { .error = 0, .scope = RT_SCOPE_HOST },
72 [RTN_BROADCAST] = { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
73 [RTN_ANYCAST] = { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
74 [RTN_MULTICAST] = { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
75 [RTN_BLACKHOLE] = { .error = -EINVAL, .scope = RT_SCOPE_UNIVERSE },
76 [RTN_UNREACHABLE] = { .error = -EHOSTUNREACH, .scope = RT_SCOPE_UNIVERSE },
77 [RTN_PROHIBIT] = { .error = -EACCES, .scope = RT_SCOPE_UNIVERSE },
78 [RTN_THROW] = { .error = -EAGAIN, .scope = RT_SCOPE_UNIVERSE },
79 [RTN_NAT] = { .error = 0, .scope = RT_SCOPE_NOWHERE },
80 [RTN_XRESOLVE] = { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE },
81};
82
Adrian Bunk2aa7f362006-08-14 23:55:20 -070083static int dn_fib_sync_down(__le16 local, struct net_device *dev, int force);
84static int dn_fib_sync_up(struct net_device *dev);
85
Linus Torvalds1da177e2005-04-16 15:20:36 -070086void dn_fib_free_info(struct dn_fib_info *fi)
87{
88 if (fi->fib_dead == 0) {
89 printk(KERN_DEBUG "DECnet: BUG! Attempt to free alive dn_fib_info\n");
90 return;
91 }
92
93 change_nexthops(fi) {
94 if (nh->nh_dev)
95 dev_put(nh->nh_dev);
96 nh->nh_dev = NULL;
97 } endfor_nexthops(fi);
98 kfree(fi);
99}
100
101void dn_fib_release_info(struct dn_fib_info *fi)
102{
Steven Whitehousea22ec362006-08-09 16:00:57 -0700103 spin_lock(&dn_fib_info_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700104 if (fi && --fi->fib_treeref == 0) {
105 if (fi->fib_next)
106 fi->fib_next->fib_prev = fi->fib_prev;
107 if (fi->fib_prev)
108 fi->fib_prev->fib_next = fi->fib_next;
109 if (fi == dn_fib_info_list)
110 dn_fib_info_list = fi->fib_next;
111 fi->fib_dead = 1;
112 dn_fib_info_put(fi);
113 }
Steven Whitehousea22ec362006-08-09 16:00:57 -0700114 spin_unlock(&dn_fib_info_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700115}
116
117static inline int dn_fib_nh_comp(const struct dn_fib_info *fi, const struct dn_fib_info *ofi)
118{
119 const struct dn_fib_nh *onh = ofi->fib_nh;
120
121 for_nexthops(fi) {
122 if (nh->nh_oif != onh->nh_oif ||
123 nh->nh_gw != onh->nh_gw ||
124 nh->nh_scope != onh->nh_scope ||
125 nh->nh_weight != onh->nh_weight ||
126 ((nh->nh_flags^onh->nh_flags)&~RTNH_F_DEAD))
127 return -1;
128 onh++;
129 } endfor_nexthops(fi);
130 return 0;
131}
132
133static inline struct dn_fib_info *dn_fib_find_info(const struct dn_fib_info *nfi)
134{
135 for_fib_info() {
136 if (fi->fib_nhs != nfi->fib_nhs)
137 continue;
138 if (nfi->fib_protocol == fi->fib_protocol &&
139 nfi->fib_prefsrc == fi->fib_prefsrc &&
140 nfi->fib_priority == fi->fib_priority &&
141 memcmp(nfi->fib_metrics, fi->fib_metrics, sizeof(fi->fib_metrics)) == 0 &&
142 ((nfi->fib_flags^fi->fib_flags)&~RTNH_F_DEAD) == 0 &&
143 (nfi->fib_nhs == 0 || dn_fib_nh_comp(fi, nfi) == 0))
144 return fi;
145 } endfor_fib_info();
146 return NULL;
147}
148
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000149static int dn_fib_count_nhs(const struct nlattr *attr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150{
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000151 struct rtnexthop *nhp = nla_data(attr);
152 int nhs = 0, nhlen = nla_len(attr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153
Vegard Nossumab582982016-07-05 21:12:53 +0200154 while (rtnh_ok(nhp, nhlen)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155 nhs++;
Vegard Nossumab582982016-07-05 21:12:53 +0200156 nhp = rtnh_next(nhp, &nhlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157 }
158
Vegard Nossumab582982016-07-05 21:12:53 +0200159 /* leftover implies invalid nexthop configuration, discard it */
160 return nhlen > 0 ? 0 : nhs;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700161}
162
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000163static int dn_fib_get_nhs(struct dn_fib_info *fi, const struct nlattr *attr,
164 const struct rtmsg *r)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165{
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000166 struct rtnexthop *nhp = nla_data(attr);
167 int nhlen = nla_len(attr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700168
169 change_nexthops(fi) {
Vegard Nossumab582982016-07-05 21:12:53 +0200170 int attrlen;
171
172 if (!rtnh_ok(nhp, nhlen))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700173 return -EINVAL;
174
175 nh->nh_flags = (r->rtm_flags&~0xFF) | nhp->rtnh_flags;
176 nh->nh_oif = nhp->rtnh_ifindex;
177 nh->nh_weight = nhp->rtnh_hops + 1;
178
Vegard Nossumab582982016-07-05 21:12:53 +0200179 attrlen = rtnh_attrlen(nhp);
180 if (attrlen > 0) {
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000181 struct nlattr *gw_attr;
182
183 gw_attr = nla_find((struct nlattr *) (nhp + 1), attrlen, RTA_GATEWAY);
184 nh->nh_gw = gw_attr ? nla_get_le16(gw_attr) : 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185 }
Vegard Nossumab582982016-07-05 21:12:53 +0200186
187 nhp = rtnh_next(nhp, &nhlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188 } endfor_nexthops(fi);
189
190 return 0;
191}
192
193
194static int dn_fib_check_nh(const struct rtmsg *r, struct dn_fib_info *fi, struct dn_fib_nh *nh)
195{
196 int err;
197
198 if (nh->nh_gw) {
David S. Millerbef55ae2011-03-12 17:17:10 -0500199 struct flowidn fld;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700200 struct dn_fib_res res;
201
Linus Torvalds1da177e2005-04-16 15:20:36 -0700202 if (nh->nh_flags&RTNH_F_ONLINK) {
203 struct net_device *dev;
204
205 if (r->rtm_scope >= RT_SCOPE_LINK)
206 return -EINVAL;
207 if (dnet_addr_type(nh->nh_gw) != RTN_UNICAST)
208 return -EINVAL;
Eric W. Biederman881d9662007-09-17 11:56:21 -0700209 if ((dev = __dev_get_by_index(&init_net, nh->nh_oif)) == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210 return -ENODEV;
211 if (!(dev->flags&IFF_UP))
212 return -ENETDOWN;
213 nh->nh_dev = dev;
214 dev_hold(dev);
215 nh->nh_scope = RT_SCOPE_LINK;
216 return 0;
217 }
218
David S. Millerbef55ae2011-03-12 17:17:10 -0500219 memset(&fld, 0, sizeof(fld));
220 fld.daddr = nh->nh_gw;
221 fld.flowidn_oif = nh->nh_oif;
222 fld.flowidn_scope = r->rtm_scope + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223
David S. Millerbef55ae2011-03-12 17:17:10 -0500224 if (fld.flowidn_scope < RT_SCOPE_LINK)
225 fld.flowidn_scope = RT_SCOPE_LINK;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700226
David S. Millerbef55ae2011-03-12 17:17:10 -0500227 if ((err = dn_fib_lookup(&fld, &res)) != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 return err;
229
230 err = -EINVAL;
231 if (res.type != RTN_UNICAST && res.type != RTN_LOCAL)
232 goto out;
233 nh->nh_scope = res.scope;
234 nh->nh_oif = DN_FIB_RES_OIF(res);
235 nh->nh_dev = DN_FIB_RES_DEV(res);
236 if (nh->nh_dev == NULL)
237 goto out;
238 dev_hold(nh->nh_dev);
239 err = -ENETDOWN;
240 if (!(nh->nh_dev->flags & IFF_UP))
241 goto out;
242 err = 0;
243out:
244 dn_fib_res_put(&res);
245 return err;
246 } else {
247 struct net_device *dev;
248
249 if (nh->nh_flags&(RTNH_F_PERVASIVE|RTNH_F_ONLINK))
250 return -EINVAL;
251
Eric W. Biederman881d9662007-09-17 11:56:21 -0700252 dev = __dev_get_by_index(&init_net, nh->nh_oif);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700253 if (dev == NULL || dev->dn_ptr == NULL)
254 return -ENODEV;
255 if (!(dev->flags&IFF_UP))
256 return -ENETDOWN;
257 nh->nh_dev = dev;
258 dev_hold(nh->nh_dev);
259 nh->nh_scope = RT_SCOPE_HOST;
260 }
261
262 return 0;
263}
264
265
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000266struct dn_fib_info *dn_fib_create_info(const struct rtmsg *r, struct nlattr *attrs[],
267 const struct nlmsghdr *nlh, int *errp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700268{
269 int err;
270 struct dn_fib_info *fi = NULL;
271 struct dn_fib_info *ofi;
272 int nhs = 1;
273
Thomas Grafa9791012007-03-24 20:33:27 -0700274 if (r->rtm_type > RTN_MAX)
275 goto err_inval;
276
Linus Torvalds1da177e2005-04-16 15:20:36 -0700277 if (dn_fib_props[r->rtm_type].scope > r->rtm_scope)
278 goto err_inval;
279
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000280 if (attrs[RTA_MULTIPATH] &&
281 (nhs = dn_fib_count_nhs(attrs[RTA_MULTIPATH])) == 0)
282 goto err_inval;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283
Panagiotis Issaris0da974f2006-07-21 14:51:30 -0700284 fi = kzalloc(sizeof(*fi)+nhs*sizeof(struct dn_fib_nh), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285 err = -ENOBUFS;
286 if (fi == NULL)
287 goto failure;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700288
289 fi->fib_protocol = r->rtm_protocol;
290 fi->fib_nhs = nhs;
291 fi->fib_flags = r->rtm_flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000293 if (attrs[RTA_PRIORITY])
294 fi->fib_priority = nla_get_u32(attrs[RTA_PRIORITY]);
Eric Dumazet95c96172012-04-15 05:58:06 +0000295
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000296 if (attrs[RTA_METRICS]) {
297 struct nlattr *attr;
298 int rem;
299
300 nla_for_each_nested(attr, attrs[RTA_METRICS], rem) {
301 int type = nla_type(attr);
302
303 if (type) {
Daniel Borkmannea697632015-01-05 23:57:47 +0100304 if (type > RTAX_MAX || type == RTAX_CC_ALGO ||
305 nla_len(attr) < 4)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306 goto err_inval;
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000307
308 fi->fib_metrics[type-1] = nla_get_u32(attr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310 }
311 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700312
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000313 if (attrs[RTA_PREFSRC])
314 fi->fib_prefsrc = nla_get_le16(attrs[RTA_PREFSRC]);
315
316 if (attrs[RTA_MULTIPATH]) {
317 if ((err = dn_fib_get_nhs(fi, attrs[RTA_MULTIPATH], r)) != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700318 goto failure;
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000319
320 if (attrs[RTA_OIF] &&
321 fi->fib_nh->nh_oif != nla_get_u32(attrs[RTA_OIF]))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322 goto err_inval;
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000323
324 if (attrs[RTA_GATEWAY] &&
325 fi->fib_nh->nh_gw != nla_get_le16(attrs[RTA_GATEWAY]))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700326 goto err_inval;
327 } else {
328 struct dn_fib_nh *nh = fi->fib_nh;
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000329
330 if (attrs[RTA_OIF])
331 nh->nh_oif = nla_get_u32(attrs[RTA_OIF]);
332
333 if (attrs[RTA_GATEWAY])
334 nh->nh_gw = nla_get_le16(attrs[RTA_GATEWAY]);
335
Linus Torvalds1da177e2005-04-16 15:20:36 -0700336 nh->nh_flags = r->rtm_flags;
337 nh->nh_weight = 1;
338 }
339
340 if (r->rtm_type == RTN_NAT) {
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000341 if (!attrs[RTA_GATEWAY] || nhs != 1 || attrs[RTA_OIF])
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342 goto err_inval;
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000343
344 fi->fib_nh->nh_gw = nla_get_le16(attrs[RTA_GATEWAY]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 goto link_it;
346 }
347
348 if (dn_fib_props[r->rtm_type].error) {
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000349 if (attrs[RTA_GATEWAY] || attrs[RTA_OIF] || attrs[RTA_MULTIPATH])
Linus Torvalds1da177e2005-04-16 15:20:36 -0700350 goto err_inval;
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000351
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352 goto link_it;
353 }
354
355 if (r->rtm_scope > RT_SCOPE_HOST)
356 goto err_inval;
357
358 if (r->rtm_scope == RT_SCOPE_HOST) {
359 struct dn_fib_nh *nh = fi->fib_nh;
360
361 /* Local address is added */
362 if (nhs != 1 || nh->nh_gw)
363 goto err_inval;
364 nh->nh_scope = RT_SCOPE_NOWHERE;
Eric W. Biederman881d9662007-09-17 11:56:21 -0700365 nh->nh_dev = dev_get_by_index(&init_net, fi->fib_nh->nh_oif);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700366 err = -ENODEV;
367 if (nh->nh_dev == NULL)
368 goto failure;
369 } else {
370 change_nexthops(fi) {
371 if ((err = dn_fib_check_nh(r, fi, nh)) != 0)
372 goto failure;
373 } endfor_nexthops(fi)
374 }
375
376 if (fi->fib_prefsrc) {
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000377 if (r->rtm_type != RTN_LOCAL || !attrs[RTA_DST] ||
378 fi->fib_prefsrc != nla_get_le16(attrs[RTA_DST]))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379 if (dnet_addr_type(fi->fib_prefsrc) != RTN_LOCAL)
380 goto err_inval;
381 }
382
383link_it:
384 if ((ofi = dn_fib_find_info(fi)) != NULL) {
385 fi->fib_dead = 1;
386 dn_fib_free_info(fi);
387 ofi->fib_treeref++;
388 return ofi;
389 }
390
391 fi->fib_treeref++;
392 atomic_inc(&fi->fib_clntref);
Steven Whitehousea22ec362006-08-09 16:00:57 -0700393 spin_lock(&dn_fib_info_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700394 fi->fib_next = dn_fib_info_list;
395 fi->fib_prev = NULL;
396 if (dn_fib_info_list)
397 dn_fib_info_list->fib_prev = fi;
398 dn_fib_info_list = fi;
Steven Whitehousea22ec362006-08-09 16:00:57 -0700399 spin_unlock(&dn_fib_info_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700400 return fi;
401
402err_inval:
403 err = -EINVAL;
404
405failure:
406 *errp = err;
407 if (fi) {
408 fi->fib_dead = 1;
409 dn_fib_free_info(fi);
410 }
411
412 return NULL;
413}
414
David S. Millerbef55ae2011-03-12 17:17:10 -0500415int dn_fib_semantic_match(int type, struct dn_fib_info *fi, const struct flowidn *fld, struct dn_fib_res *res)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416{
417 int err = dn_fib_props[type].error;
418
419 if (err == 0) {
420 if (fi->fib_flags & RTNH_F_DEAD)
421 return 1;
422
423 res->fi = fi;
424
Joe Perches06f8fe12011-07-01 09:43:03 +0000425 switch (type) {
426 case RTN_NAT:
427 DN_FIB_RES_RESET(*res);
428 atomic_inc(&fi->fib_clntref);
429 return 0;
430 case RTN_UNICAST:
431 case RTN_LOCAL:
432 for_nexthops(fi) {
433 if (nh->nh_flags & RTNH_F_DEAD)
434 continue;
435 if (!fld->flowidn_oif ||
436 fld->flowidn_oif == nh->nh_oif)
437 break;
438 }
439 if (nhsel < fi->fib_nhs) {
440 res->nh_sel = nhsel;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700441 atomic_inc(&fi->fib_clntref);
442 return 0;
Joe Perches06f8fe12011-07-01 09:43:03 +0000443 }
444 endfor_nexthops(fi);
445 res->fi = NULL;
446 return 1;
447 default:
Joe Perchese87cc472012-05-13 21:56:26 +0000448 net_err_ratelimited("DECnet: impossible routing event : dn_fib_semantic_match type=%d\n",
449 type);
Joe Perches06f8fe12011-07-01 09:43:03 +0000450 res->fi = NULL;
451 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452 }
453 }
454 return err;
455}
456
David S. Millerbef55ae2011-03-12 17:17:10 -0500457void dn_fib_select_multipath(const struct flowidn *fld, struct dn_fib_res *res)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700458{
459 struct dn_fib_info *fi = res->fi;
460 int w;
461
462 spin_lock_bh(&dn_fib_multipath_lock);
463 if (fi->fib_power <= 0) {
464 int power = 0;
465 change_nexthops(fi) {
466 if (!(nh->nh_flags&RTNH_F_DEAD)) {
467 power += nh->nh_weight;
468 nh->nh_power = nh->nh_weight;
469 }
470 } endfor_nexthops(fi);
471 fi->fib_power = power;
472 if (power < 0) {
473 spin_unlock_bh(&dn_fib_multipath_lock);
474 res->nh_sel = 0;
475 return;
476 }
477 }
478
479 w = jiffies % fi->fib_power;
480
481 change_nexthops(fi) {
482 if (!(nh->nh_flags&RTNH_F_DEAD) && nh->nh_power) {
483 if ((w -= nh->nh_power) <= 0) {
484 nh->nh_power--;
485 fi->fib_power--;
486 res->nh_sel = nhsel;
487 spin_unlock_bh(&dn_fib_multipath_lock);
488 return;
489 }
490 }
491 } endfor_nexthops(fi);
492 res->nh_sel = 0;
493 spin_unlock_bh(&dn_fib_multipath_lock);
494}
495
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000496static inline u32 rtm_get_table(struct nlattr *attrs[], u8 table)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497{
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000498 if (attrs[RTA_TABLE])
499 table = nla_get_u32(attrs[RTA_TABLE]);
Thomas Graf4c3af032012-06-26 23:36:16 +0000500
501 return table;
502}
503
Thomas Graf661d2962013-03-21 07:45:29 +0000504static int dn_fib_rtm_delroute(struct sk_buff *skb, struct nlmsghdr *nlh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505{
YOSHIFUJI Hideaki3b1e0a62008-03-26 02:26:21 +0900506 struct net *net = sock_net(skb->sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507 struct dn_fib_table *tb;
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000508 struct rtmsg *r = nlmsg_data(nlh);
509 struct nlattr *attrs[RTA_MAX+1];
510 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511
Eric W. Biederman90f62cf2014-04-23 14:29:27 -0700512 if (!netlink_capable(skb, CAP_NET_ADMIN))
Eric W. Biedermandfc47ef2012-11-16 03:03:00 +0000513 return -EPERM;
514
Octavian Purdila09ad9bc2009-11-25 15:14:13 -0800515 if (!net_eq(net, &init_net))
Denis V. Lunevb8542722007-12-01 00:21:31 +1100516 return -EINVAL;
517
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000518 err = nlmsg_parse(nlh, sizeof(*r), attrs, RTA_MAX, rtm_dn_policy);
519 if (err < 0)
520 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000522 tb = dn_fib_get_table(rtm_get_table(attrs, r->rtm_table), 0);
523 if (!tb)
524 return -ESRCH;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700525
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000526 return tb->delete(tb, r, attrs, nlh, &NETLINK_CB(skb));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527}
528
Thomas Graf661d2962013-03-21 07:45:29 +0000529static int dn_fib_rtm_newroute(struct sk_buff *skb, struct nlmsghdr *nlh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700530{
YOSHIFUJI Hideaki3b1e0a62008-03-26 02:26:21 +0900531 struct net *net = sock_net(skb->sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 struct dn_fib_table *tb;
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000533 struct rtmsg *r = nlmsg_data(nlh);
534 struct nlattr *attrs[RTA_MAX+1];
535 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536
Eric W. Biederman90f62cf2014-04-23 14:29:27 -0700537 if (!netlink_capable(skb, CAP_NET_ADMIN))
Eric W. Biedermandfc47ef2012-11-16 03:03:00 +0000538 return -EPERM;
539
Octavian Purdila09ad9bc2009-11-25 15:14:13 -0800540 if (!net_eq(net, &init_net))
Denis V. Lunevb8542722007-12-01 00:21:31 +1100541 return -EINVAL;
542
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000543 err = nlmsg_parse(nlh, sizeof(*r), attrs, RTA_MAX, rtm_dn_policy);
544 if (err < 0)
545 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700546
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000547 tb = dn_fib_get_table(rtm_get_table(attrs, r->rtm_table), 1);
548 if (!tb)
549 return -ENOBUFS;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000551 return tb->insert(tb, r, attrs, nlh, &NETLINK_CB(skb));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552}
553
Steven Whitehousec4ea94a2006-03-20 22:42:39 -0800554static void fib_magic(int cmd, int type, __le16 dst, int dst_len, struct dn_ifaddr *ifa)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700555{
556 struct dn_fib_table *tb;
557 struct {
558 struct nlmsghdr nlh;
559 struct rtmsg rtm;
560 } req;
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000561 struct {
562 struct nlattr hdr;
563 __le16 dst;
564 } dst_attr = {
565 .dst = dst,
566 };
567 struct {
568 struct nlattr hdr;
569 __le16 prefsrc;
570 } prefsrc_attr = {
571 .prefsrc = ifa->ifa_local,
572 };
573 struct {
574 struct nlattr hdr;
575 u32 oif;
576 } oif_attr = {
577 .oif = ifa->ifa_dev->dev->ifindex,
578 };
579 struct nlattr *attrs[RTA_MAX+1] = {
580 [RTA_DST] = (struct nlattr *) &dst_attr,
581 [RTA_PREFSRC] = (struct nlattr * ) &prefsrc_attr,
582 [RTA_OIF] = (struct nlattr *) &oif_attr,
583 };
Linus Torvalds1da177e2005-04-16 15:20:36 -0700584
585 memset(&req.rtm, 0, sizeof(req.rtm));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700586
587 if (type == RTN_UNICAST)
588 tb = dn_fib_get_table(RT_MIN_TABLE, 1);
589 else
590 tb = dn_fib_get_table(RT_TABLE_LOCAL, 1);
591
592 if (tb == NULL)
593 return;
594
595 req.nlh.nlmsg_len = sizeof(req);
596 req.nlh.nlmsg_type = cmd;
597 req.nlh.nlmsg_flags = NLM_F_REQUEST|NLM_F_CREATE|NLM_F_APPEND;
598 req.nlh.nlmsg_pid = 0;
599 req.nlh.nlmsg_seq = 0;
600
601 req.rtm.rtm_dst_len = dst_len;
602 req.rtm.rtm_table = tb->n;
603 req.rtm.rtm_protocol = RTPROT_KERNEL;
604 req.rtm.rtm_scope = (type != RTN_LOCAL ? RT_SCOPE_LINK : RT_SCOPE_HOST);
605 req.rtm.rtm_type = type;
606
Linus Torvalds1da177e2005-04-16 15:20:36 -0700607 if (cmd == RTM_NEWROUTE)
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000608 tb->insert(tb, &req.rtm, attrs, &req.nlh, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609 else
Thomas Graf58d7d8f2013-03-21 07:45:28 +0000610 tb->delete(tb, &req.rtm, attrs, &req.nlh, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611}
612
613static void dn_fib_add_ifaddr(struct dn_ifaddr *ifa)
614{
615
616 fib_magic(RTM_NEWROUTE, RTN_LOCAL, ifa->ifa_local, 16, ifa);
617
618#if 0
619 if (!(dev->flags&IFF_UP))
620 return;
621 /* In the future, we will want to add default routes here */
622
623#endif
624}
625
626static void dn_fib_del_ifaddr(struct dn_ifaddr *ifa)
627{
628 int found_it = 0;
629 struct net_device *dev;
630 struct dn_dev *dn_db;
631 struct dn_ifaddr *ifa2;
632
633 ASSERT_RTNL();
634
635 /* Scan device list */
Eric Dumazetc6d14c82009-11-04 05:43:23 -0800636 rcu_read_lock();
637 for_each_netdev_rcu(&init_net, dev) {
Eric Dumazetfc766e4c2010-10-29 03:09:24 +0000638 dn_db = rcu_dereference(dev->dn_ptr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700639 if (dn_db == NULL)
640 continue;
Eric Dumazetfc766e4c2010-10-29 03:09:24 +0000641 for (ifa2 = rcu_dereference(dn_db->ifa_list);
642 ifa2 != NULL;
643 ifa2 = rcu_dereference(ifa2->ifa_next)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644 if (ifa2->ifa_local == ifa->ifa_local) {
645 found_it = 1;
646 break;
647 }
648 }
649 }
Eric Dumazetc6d14c82009-11-04 05:43:23 -0800650 rcu_read_unlock();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700651
652 if (found_it == 0) {
653 fib_magic(RTM_DELROUTE, RTN_LOCAL, ifa->ifa_local, 16, ifa);
654
655 if (dnet_addr_type(ifa->ifa_local) != RTN_LOCAL) {
656 if (dn_fib_sync_down(ifa->ifa_local, NULL, 0))
657 dn_fib_flush();
658 }
659 }
660}
661
662static void dn_fib_disable_addr(struct net_device *dev, int force)
663{
664 if (dn_fib_sync_down(0, dev, force))
665 dn_fib_flush();
666 dn_rt_cache_flush(0);
667 neigh_ifdown(&dn_neigh_table, dev);
668}
669
670static int dn_fib_dnaddr_event(struct notifier_block *this, unsigned long event, void *ptr)
671{
672 struct dn_ifaddr *ifa = (struct dn_ifaddr *)ptr;
673
Joe Perches06f8fe12011-07-01 09:43:03 +0000674 switch (event) {
675 case NETDEV_UP:
676 dn_fib_add_ifaddr(ifa);
677 dn_fib_sync_up(ifa->ifa_dev->dev);
678 dn_rt_cache_flush(-1);
679 break;
680 case NETDEV_DOWN:
681 dn_fib_del_ifaddr(ifa);
682 if (ifa->ifa_dev && ifa->ifa_dev->ifa_list == NULL) {
683 dn_fib_disable_addr(ifa->ifa_dev->dev, 1);
684 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700685 dn_rt_cache_flush(-1);
Joe Perches06f8fe12011-07-01 09:43:03 +0000686 }
687 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700688 }
689 return NOTIFY_DONE;
690}
691
Adrian Bunk2aa7f362006-08-14 23:55:20 -0700692static int dn_fib_sync_down(__le16 local, struct net_device *dev, int force)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693{
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900694 int ret = 0;
695 int scope = RT_SCOPE_NOWHERE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900697 if (force)
698 scope = -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700699
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900700 for_fib_info() {
701 /*
702 * This makes no sense for DECnet.... we will almost
703 * certainly have more than one local address the same
704 * over all our interfaces. It needs thinking about
705 * some more.
706 */
707 if (local && fi->fib_prefsrc == local) {
708 fi->fib_flags |= RTNH_F_DEAD;
709 ret++;
710 } else if (dev && fi->fib_nhs) {
711 int dead = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700712
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900713 change_nexthops(fi) {
714 if (nh->nh_flags&RTNH_F_DEAD)
715 dead++;
716 else if (nh->nh_dev == dev &&
717 nh->nh_scope != scope) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700718 spin_lock_bh(&dn_fib_multipath_lock);
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900719 nh->nh_flags |= RTNH_F_DEAD;
720 fi->fib_power -= nh->nh_power;
721 nh->nh_power = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700722 spin_unlock_bh(&dn_fib_multipath_lock);
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900723 dead++;
724 }
725 } endfor_nexthops(fi)
726 if (dead == fi->fib_nhs) {
727 fi->fib_flags |= RTNH_F_DEAD;
728 ret++;
729 }
730 }
731 } endfor_fib_info();
732 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700733}
734
735
Adrian Bunk2aa7f362006-08-14 23:55:20 -0700736static int dn_fib_sync_up(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700737{
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900738 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700739
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900740 if (!(dev->flags&IFF_UP))
741 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900743 for_fib_info() {
744 int alive = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700745
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900746 change_nexthops(fi) {
747 if (!(nh->nh_flags&RTNH_F_DEAD)) {
748 alive++;
749 continue;
750 }
751 if (nh->nh_dev == NULL || !(nh->nh_dev->flags&IFF_UP))
752 continue;
753 if (nh->nh_dev != dev || dev->dn_ptr == NULL)
754 continue;
755 alive++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700756 spin_lock_bh(&dn_fib_multipath_lock);
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900757 nh->nh_power = 0;
758 nh->nh_flags &= ~RTNH_F_DEAD;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700759 spin_unlock_bh(&dn_fib_multipath_lock);
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900760 } endfor_nexthops(fi);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761
YOSHIFUJI Hideaki429eb0f2007-02-09 23:24:40 +0900762 if (alive > 0) {
763 fi->fib_flags &= ~RTNH_F_DEAD;
764 ret++;
765 }
766 } endfor_fib_info();
767 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700768}
769
Linus Torvalds1da177e2005-04-16 15:20:36 -0700770static struct notifier_block dn_fib_dnaddr_notifier = {
771 .notifier_call = dn_fib_dnaddr_event,
772};
773
774void __exit dn_fib_cleanup(void)
775{
776 dn_fib_table_cleanup();
777 dn_fib_rules_cleanup();
778
779 unregister_dnaddr_notifier(&dn_fib_dnaddr_notifier);
780}
781
782
783void __init dn_fib_init(void)
784{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700785 dn_fib_table_init();
786 dn_fib_rules_init();
787
788 register_dnaddr_notifier(&dn_fib_dnaddr_notifier);
Thomas Graffa34ddd2007-03-22 11:57:46 -0700789
Greg Rosec7ac8672011-06-10 01:27:09 +0000790 rtnl_register(PF_DECnet, RTM_NEWROUTE, dn_fib_rtm_newroute, NULL, NULL);
791 rtnl_register(PF_DECnet, RTM_DELROUTE, dn_fib_rtm_delroute, NULL, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700792}
793
794