fib_semantics.c 41.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
/*
 * INET		An implementation of the TCP/IP protocol suite for the LINUX
 *		operating system.  INET is implemented using the  BSD Socket
 *		interface as the means of communication with the user level.
 *
 *		IPv4 Forwarding Information Base: semantics.
 *
 * Authors:	Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
 *
 *		This program is free software; you can redistribute it and/or
 *		modify it under the terms of the GNU General Public License
 *		as published by the Free Software Foundation; either version
 *		2 of the License, or (at your option) any later version.
 */

16
#include <linux/uaccess.h>
L
Linus Torvalds 已提交
17 18 19 20 21 22 23 24 25 26 27
#include <linux/bitops.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/jiffies.h>
#include <linux/mm.h>
#include <linux/string.h>
#include <linux/socket.h>
#include <linux/sockios.h>
#include <linux/errno.h>
#include <linux/in.h>
#include <linux/inet.h>
28
#include <linux/inetdevice.h>
L
Linus Torvalds 已提交
29 30 31 32 33
#include <linux/netdevice.h>
#include <linux/if_arp.h>
#include <linux/proc_fs.h>
#include <linux/skbuff.h>
#include <linux/init.h>
34
#include <linux/slab.h>
35
#include <linux/netlink.h>
L
Linus Torvalds 已提交
36

37
#include <net/arp.h>
L
Linus Torvalds 已提交
38 39 40 41 42 43
#include <net/ip.h>
#include <net/protocol.h>
#include <net/route.h>
#include <net/tcp.h>
#include <net/sock.h>
#include <net/ip_fib.h>
44
#include <net/netlink.h>
45
#include <net/nexthop.h>
46
#include <net/lwtunnel.h>
L
Linus Torvalds 已提交
47 48 49

#include "fib_lookup.h"

50
static DEFINE_SPINLOCK(fib_info_lock);
L
Linus Torvalds 已提交
51 52
static struct hlist_head *fib_info_hash;
static struct hlist_head *fib_info_laddrhash;
53
static unsigned int fib_info_hash_size;
L
Linus Torvalds 已提交
54 55 56 57 58 59 60 61
static unsigned int fib_info_cnt;

#define DEVINDEX_HASHBITS 8
#define DEVINDEX_HASHSIZE (1U << DEVINDEX_HASHBITS)
static struct hlist_head fib_info_devhash[DEVINDEX_HASHSIZE];

#ifdef CONFIG_IP_ROUTE_MULTIPATH

E
Eric Dumazet 已提交
62 63 64 65 66 67 68 69 70 71 72
#define for_nexthops(fi) {						\
	int nhsel; const struct fib_nh *nh;				\
	for (nhsel = 0, nh = (fi)->fib_nh;				\
	     nhsel < (fi)->fib_nhs;					\
	     nh++, nhsel++)

#define change_nexthops(fi) {						\
	int nhsel; struct fib_nh *nexthop_nh;				\
	for (nhsel = 0,	nexthop_nh = (struct fib_nh *)((fi)->fib_nh);	\
	     nhsel < (fi)->fib_nhs;					\
	     nexthop_nh++, nhsel++)
L
Linus Torvalds 已提交
73 74 75 76 77

#else /* CONFIG_IP_ROUTE_MULTIPATH */

/* Hope, that gcc will optimize it to get rid of dummy loop */

E
Eric Dumazet 已提交
78 79 80
#define for_nexthops(fi) {						\
	int nhsel; const struct fib_nh *nh = (fi)->fib_nh;		\
	for (nhsel = 0; nhsel < 1; nhsel++)
L
Linus Torvalds 已提交
81

E
Eric Dumazet 已提交
82 83 84 85
#define change_nexthops(fi) {						\
	int nhsel;							\
	struct fib_nh *nexthop_nh = (struct fib_nh *)((fi)->fib_nh);	\
	for (nhsel = 0; nhsel < 1; nhsel++)
L
Linus Torvalds 已提交
86 87 88 89 90 91

#endif /* CONFIG_IP_ROUTE_MULTIPATH */

#define endfor_nexthops(fi) }


92
const struct fib_prop fib_props[RTN_MAX + 1] = {
E
Eric Dumazet 已提交
93
	[RTN_UNSPEC] = {
L
Linus Torvalds 已提交
94 95
		.error	= 0,
		.scope	= RT_SCOPE_NOWHERE,
E
Eric Dumazet 已提交
96 97
	},
	[RTN_UNICAST] = {
L
Linus Torvalds 已提交
98 99
		.error	= 0,
		.scope	= RT_SCOPE_UNIVERSE,
E
Eric Dumazet 已提交
100 101
	},
	[RTN_LOCAL] = {
L
Linus Torvalds 已提交
102 103
		.error	= 0,
		.scope	= RT_SCOPE_HOST,
E
Eric Dumazet 已提交
104 105
	},
	[RTN_BROADCAST] = {
L
Linus Torvalds 已提交
106 107
		.error	= 0,
		.scope	= RT_SCOPE_LINK,
E
Eric Dumazet 已提交
108 109
	},
	[RTN_ANYCAST] = {
L
Linus Torvalds 已提交
110 111
		.error	= 0,
		.scope	= RT_SCOPE_LINK,
E
Eric Dumazet 已提交
112 113
	},
	[RTN_MULTICAST] = {
L
Linus Torvalds 已提交
114 115
		.error	= 0,
		.scope	= RT_SCOPE_UNIVERSE,
E
Eric Dumazet 已提交
116 117
	},
	[RTN_BLACKHOLE] = {
L
Linus Torvalds 已提交
118 119
		.error	= -EINVAL,
		.scope	= RT_SCOPE_UNIVERSE,
E
Eric Dumazet 已提交
120 121
	},
	[RTN_UNREACHABLE] = {
L
Linus Torvalds 已提交
122 123
		.error	= -EHOSTUNREACH,
		.scope	= RT_SCOPE_UNIVERSE,
E
Eric Dumazet 已提交
124 125
	},
	[RTN_PROHIBIT] = {
L
Linus Torvalds 已提交
126 127
		.error	= -EACCES,
		.scope	= RT_SCOPE_UNIVERSE,
E
Eric Dumazet 已提交
128 129
	},
	[RTN_THROW] = {
L
Linus Torvalds 已提交
130 131
		.error	= -EAGAIN,
		.scope	= RT_SCOPE_UNIVERSE,
E
Eric Dumazet 已提交
132 133
	},
	[RTN_NAT] = {
L
Linus Torvalds 已提交
134 135
		.error	= -EINVAL,
		.scope	= RT_SCOPE_NOWHERE,
E
Eric Dumazet 已提交
136 137
	},
	[RTN_XRESOLVE] = {
L
Linus Torvalds 已提交
138 139
		.error	= -EINVAL,
		.scope	= RT_SCOPE_NOWHERE,
E
Eric Dumazet 已提交
140
	},
L
Linus Torvalds 已提交
141 142
};

143 144 145 146 147 148 149 150 151 152 153 154 155 156 157
static void rt_fibinfo_free(struct rtable __rcu **rtp)
{
	struct rtable *rt = rcu_dereference_protected(*rtp, 1);

	if (!rt)
		return;

	/* Not even needed : RCU_INIT_POINTER(*rtp, NULL);
	 * because we waited an RCU grace period before calling
	 * free_fib_info_rcu()
	 */

	dst_free(&rt->dst);
}

158 159
static void free_nh_exceptions(struct fib_nh *nh)
{
160
	struct fnhe_hash_bucket *hash;
161 162
	int i;

163 164 165
	hash = rcu_dereference_protected(nh->nh_exceptions, 1);
	if (!hash)
		return;
166 167 168
	for (i = 0; i < FNHE_HASH_SIZE; i++) {
		struct fib_nh_exception *fnhe;

E
Eric Dumazet 已提交
169
		fnhe = rcu_dereference_protected(hash[i].chain, 1);
170 171 172
		while (fnhe) {
			struct fib_nh_exception *next;
			
E
Eric Dumazet 已提交
173
			next = rcu_dereference_protected(fnhe->fnhe_next, 1);
174

175 176
			rt_fibinfo_free(&fnhe->fnhe_rth_input);
			rt_fibinfo_free(&fnhe->fnhe_rth_output);
177

178 179 180 181 182 183 184 185
			kfree(fnhe);

			fnhe = next;
		}
	}
	kfree(hash);
}

186
static void rt_fibinfo_free_cpus(struct rtable __rcu * __percpu *rtp)
E
Eric Dumazet 已提交
187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202
{
	int cpu;

	if (!rtp)
		return;

	for_each_possible_cpu(cpu) {
		struct rtable *rt;

		rt = rcu_dereference_protected(*per_cpu_ptr(rtp, cpu), 1);
		if (rt)
			dst_free(&rt->dst);
	}
	free_percpu(rtp);
}

L
Linus Torvalds 已提交
203
/* Release a nexthop info record */
204 205 206
static void free_fib_info_rcu(struct rcu_head *head)
{
	struct fib_info *fi = container_of(head, struct fib_info, rcu);
207
	struct dst_metrics *m;
208

209 210 211
	change_nexthops(fi) {
		if (nexthop_nh->nh_dev)
			dev_put(nexthop_nh->nh_dev);
212
		lwtstate_put(nexthop_nh->nh_lwtstate);
213
		free_nh_exceptions(nexthop_nh);
214 215
		rt_fibinfo_free_cpus(nexthop_nh->nh_pcpu_rth_output);
		rt_fibinfo_free(&nexthop_nh->nh_rth_input);
216 217
	} endfor_nexthops(fi);

218 219 220
	m = fi->fib_metrics;
	if (m != &dst_default_metrics && atomic_dec_and_test(&m->refcnt))
		kfree(m);
221 222
	kfree(fi);
}
L
Linus Torvalds 已提交
223 224 225 226

void free_fib_info(struct fib_info *fi)
{
	if (fi->fib_dead == 0) {
J
Joe Perches 已提交
227
		pr_warn("Freeing alive fib_info %p\n", fi);
L
Linus Torvalds 已提交
228 229 230
		return;
	}
	fib_info_cnt--;
231 232 233
#ifdef CONFIG_IP_ROUTE_CLASSID
	change_nexthops(fi) {
		if (nexthop_nh->nh_tclassid)
234
			fi->fib_net->ipv4.fib_num_tclassid_users--;
235 236
	} endfor_nexthops(fi);
#endif
237
	call_rcu(&fi->rcu, free_fib_info_rcu);
L
Linus Torvalds 已提交
238
}
I
Ido Schimmel 已提交
239
EXPORT_SYMBOL_GPL(free_fib_info);
L
Linus Torvalds 已提交
240 241 242

void fib_release_info(struct fib_info *fi)
{
243
	spin_lock_bh(&fib_info_lock);
L
Linus Torvalds 已提交
244 245 246 247 248
	if (fi && --fi->fib_treeref == 0) {
		hlist_del(&fi->fib_hash);
		if (fi->fib_prefsrc)
			hlist_del(&fi->fib_lhash);
		change_nexthops(fi) {
249
			if (!nexthop_nh->nh_dev)
L
Linus Torvalds 已提交
250
				continue;
251
			hlist_del(&nexthop_nh->nh_hash);
L
Linus Torvalds 已提交
252 253 254 255
		} endfor_nexthops(fi)
		fi->fib_dead = 1;
		fib_info_put(fi);
	}
256
	spin_unlock_bh(&fib_info_lock);
L
Linus Torvalds 已提交
257 258
}

E
Eric Dumazet 已提交
259
static inline int nh_comp(const struct fib_info *fi, const struct fib_info *ofi)
L
Linus Torvalds 已提交
260 261 262 263 264 265 266 267 268 269
{
	const struct fib_nh *onh = ofi->fib_nh;

	for_nexthops(fi) {
		if (nh->nh_oif != onh->nh_oif ||
		    nh->nh_gw  != onh->nh_gw ||
		    nh->nh_scope != onh->nh_scope ||
#ifdef CONFIG_IP_ROUTE_MULTIPATH
		    nh->nh_weight != onh->nh_weight ||
#endif
270
#ifdef CONFIG_IP_ROUTE_CLASSID
L
Linus Torvalds 已提交
271 272
		    nh->nh_tclassid != onh->nh_tclassid ||
#endif
273
		    lwtunnel_cmp_encap(nh->nh_lwtstate, onh->nh_lwtstate) ||
274
		    ((nh->nh_flags ^ onh->nh_flags) & ~RTNH_COMPARE_MASK))
L
Linus Torvalds 已提交
275 276 277 278 279 280
			return -1;
		onh++;
	} endfor_nexthops(fi);
	return 0;
}

281 282 283 284 285 286 287 288 289
static inline unsigned int fib_devindex_hashfn(unsigned int val)
{
	unsigned int mask = DEVINDEX_HASHSIZE - 1;

	return (val ^
		(val >> DEVINDEX_HASHBITS) ^
		(val >> (DEVINDEX_HASHBITS * 2))) & mask;
}

L
Linus Torvalds 已提交
290 291
static inline unsigned int fib_info_hashfn(const struct fib_info *fi)
{
292
	unsigned int mask = (fib_info_hash_size - 1);
L
Linus Torvalds 已提交
293 294
	unsigned int val = fi->fib_nhs;

295
	val ^= (fi->fib_protocol << 8) | fi->fib_scope;
A
Al Viro 已提交
296
	val ^= (__force u32)fi->fib_prefsrc;
L
Linus Torvalds 已提交
297
	val ^= fi->fib_priority;
298 299 300
	for_nexthops(fi) {
		val ^= fib_devindex_hashfn(nh->nh_oif);
	} endfor_nexthops(fi)
L
Linus Torvalds 已提交
301 302 303 304 305 306 307 308 309 310 311 312 313

	return (val ^ (val >> 7) ^ (val >> 12)) & mask;
}

static struct fib_info *fib_find_info(const struct fib_info *nfi)
{
	struct hlist_head *head;
	struct fib_info *fi;
	unsigned int hash;

	hash = fib_info_hashfn(nfi);
	head = &fib_info_hash[hash];

314
	hlist_for_each_entry(fi, head, fib_hash) {
O
Octavian Purdila 已提交
315
		if (!net_eq(fi->fib_net, nfi->fib_net))
316
			continue;
L
Linus Torvalds 已提交
317 318 319
		if (fi->fib_nhs != nfi->fib_nhs)
			continue;
		if (nfi->fib_protocol == fi->fib_protocol &&
320
		    nfi->fib_scope == fi->fib_scope &&
L
Linus Torvalds 已提交
321 322
		    nfi->fib_prefsrc == fi->fib_prefsrc &&
		    nfi->fib_priority == fi->fib_priority &&
E
Eric Dumazet 已提交
323
		    nfi->fib_type == fi->fib_type &&
L
Linus Torvalds 已提交
324
		    memcmp(nfi->fib_metrics, fi->fib_metrics,
E
Eric Dumazet 已提交
325
			   sizeof(u32) * RTAX_MAX) == 0 &&
326
		    !((nfi->fib_flags ^ fi->fib_flags) & ~RTNH_COMPARE_MASK) &&
L
Linus Torvalds 已提交
327 328 329 330 331 332 333 334
		    (nfi->fib_nhs == 0 || nh_comp(fi, nfi) == 0))
			return fi;
	}

	return NULL;
}

/* Check, that the gateway is already configured.
E
Eric Dumazet 已提交
335
 * Used only by redirect accept routine.
L
Linus Torvalds 已提交
336
 */
337
int ip_fib_check_default(__be32 gw, struct net_device *dev)
L
Linus Torvalds 已提交
338 339 340 341 342
{
	struct hlist_head *head;
	struct fib_nh *nh;
	unsigned int hash;

343
	spin_lock(&fib_info_lock);
L
Linus Torvalds 已提交
344 345 346

	hash = fib_devindex_hashfn(dev->ifindex);
	head = &fib_info_devhash[hash];
347
	hlist_for_each_entry(nh, head, nh_hash) {
L
Linus Torvalds 已提交
348 349
		if (nh->nh_dev == dev &&
		    nh->nh_gw == gw &&
E
Eric Dumazet 已提交
350
		    !(nh->nh_flags & RTNH_F_DEAD)) {
351
			spin_unlock(&fib_info_lock);
L
Linus Torvalds 已提交
352 353 354 355
			return 0;
		}
	}

356
	spin_unlock(&fib_info_lock);
L
Linus Torvalds 已提交
357 358 359 360

	return -1;
}

361 362 363 364 365 366
static inline size_t fib_nlmsg_size(struct fib_info *fi)
{
	size_t payload = NLMSG_ALIGN(sizeof(struct rtmsg))
			 + nla_total_size(4) /* RTA_TABLE */
			 + nla_total_size(4) /* RTA_DST */
			 + nla_total_size(4) /* RTA_PRIORITY */
367 368
			 + nla_total_size(4) /* RTA_PREFSRC */
			 + nla_total_size(TCP_CA_NAME_MAX); /* RTAX_CC_ALGO */
369 370 371 372 373

	/* space for nested metrics */
	payload += nla_total_size((RTAX_MAX * nla_total_size(4)));

	if (fi->fib_nhs) {
374
		size_t nh_encapsize = 0;
375 376 377 378 379 380 381 382
		/* Also handles the special case fib_nhs == 1 */

		/* each nexthop is packed in an attribute */
		size_t nhsize = nla_total_size(sizeof(struct rtnexthop));

		/* may contain flow and gateway attribute */
		nhsize += 2 * nla_total_size(4);

383 384 385 386 387 388 389 390 391 392 393
		/* grab encap info */
		for_nexthops(fi) {
			if (nh->nh_lwtstate) {
				/* RTA_ENCAP_TYPE */
				nh_encapsize += lwtunnel_get_encap_size(
						nh->nh_lwtstate);
				/* RTA_ENCAP */
				nh_encapsize +=  nla_total_size(2);
			}
		} endfor_nexthops(fi);

394
		/* all nexthops are packed in a nested attribute */
395 396 397
		payload += nla_total_size((fi->fib_nhs * nhsize) +
					  nh_encapsize);

398 399 400 401 402
	}

	return payload;
}

A
Al Viro 已提交
403
void rtmsg_fib(int event, __be32 key, struct fib_alias *fa,
404
	       int dst_len, u32 tb_id, const struct nl_info *info,
405
	       unsigned int nlm_flags)
L
Linus Torvalds 已提交
406 407
{
	struct sk_buff *skb;
408
	u32 seq = info->nlh ? info->nlh->nlmsg_seq : 0;
409
	int err = -ENOBUFS;
L
Linus Torvalds 已提交
410

411
	skb = nlmsg_new(fib_nlmsg_size(fa->fa_info), GFP_KERNEL);
412
	if (!skb)
413
		goto errout;
L
Linus Torvalds 已提交
414

415
	err = fib_dump_info(skb, info->portid, seq, event, tb_id,
416
			    fa->fa_type, key, dst_len,
417
			    fa->fa_tos, fa->fa_info, nlm_flags);
418 419 420 421 422 423
	if (err < 0) {
		/* -EMSGSIZE implies BUG in fib_nlmsg_size() */
		WARN_ON(err == -EMSGSIZE);
		kfree_skb(skb);
		goto errout;
	}
424
	rtnl_notify(skb, info->nl_net, info->portid, RTNLGRP_IPV4_ROUTE,
425 426
		    info->nlh, GFP_KERNEL);
	return;
427 428
errout:
	if (err < 0)
429
		rtnl_set_sk_err(info->nl_net, RTNLGRP_IPV4_ROUTE, err);
L
Linus Torvalds 已提交
430 431
}

432 433 434
static int fib_detect_death(struct fib_info *fi, int order,
			    struct fib_info **last_resort, int *last_idx,
			    int dflt)
L
Linus Torvalds 已提交
435 436 437 438 439 440 441 442
{
	struct neighbour *n;
	int state = NUD_NONE;

	n = neigh_lookup(&arp_tbl, &fi->fib_nh[0].nh_gw, fi->fib_dev);
	if (n) {
		state = n->nud_state;
		neigh_release(n);
443 444
	} else {
		return 0;
L
Linus Torvalds 已提交
445
	}
446
	if (state == NUD_REACHABLE)
L
Linus Torvalds 已提交
447
		return 0;
E
Eric Dumazet 已提交
448
	if ((state & NUD_VALID) && order != dflt)
L
Linus Torvalds 已提交
449
		return 0;
E
Eric Dumazet 已提交
450
	if ((state & NUD_VALID) ||
451
	    (*last_idx < 0 && order > dflt && state != NUD_INCOMPLETE)) {
L
Linus Torvalds 已提交
452 453 454 455 456 457 458 459
		*last_resort = fi;
		*last_idx = order;
	}
	return 1;
}

#ifdef CONFIG_IP_ROUTE_MULTIPATH

460 461
static int fib_count_nexthops(struct rtnexthop *rtnh, int remaining,
			      struct netlink_ext_ack *extack)
L
Linus Torvalds 已提交
462 463 464
{
	int nhs = 0;

465
	while (rtnh_ok(rtnh, remaining)) {
L
Linus Torvalds 已提交
466
		nhs++;
467 468 469 470
		rtnh = rtnh_next(rtnh, &remaining);
	}

	/* leftover implies invalid nexthop configuration, discard it */
471 472 473 474 475 476 477
	if (remaining > 0) {
		NL_SET_ERR_MSG(extack,
			       "Invalid nexthop configuration - extra data after nexthops");
		nhs = 0;
	}

	return nhs;
L
Linus Torvalds 已提交
478 479
}

480
static int fib_get_nhs(struct fib_info *fi, struct rtnexthop *rtnh,
481 482
		       int remaining, struct fib_config *cfg,
		       struct netlink_ext_ack *extack)
L
Linus Torvalds 已提交
483
{
484 485
	int ret;

L
Linus Torvalds 已提交
486
	change_nexthops(fi) {
487 488
		int attrlen;

489 490 491
		if (!rtnh_ok(rtnh, remaining)) {
			NL_SET_ERR_MSG(extack,
				       "Invalid nexthop configuration - extra data after nexthop");
L
Linus Torvalds 已提交
492
			return -EINVAL;
493
		}
494

495 496 497
		if (rtnh->rtnh_flags & (RTNH_F_DEAD | RTNH_F_LINKDOWN)) {
			NL_SET_ERR_MSG(extack,
				       "Invalid flags for nexthop - can not contain DEAD or LINKDOWN");
498
			return -EINVAL;
499
		}
500

501 502 503 504
		nexthop_nh->nh_flags =
			(cfg->fc_flags & ~0xFF) | rtnh->rtnh_flags;
		nexthop_nh->nh_oif = rtnh->rtnh_ifindex;
		nexthop_nh->nh_weight = rtnh->rtnh_hops + 1;
505 506 507 508 509 510

		attrlen = rtnh_attrlen(rtnh);
		if (attrlen > 0) {
			struct nlattr *nla, *attrs = rtnh_attrs(rtnh);

			nla = nla_find(attrs, attrlen, RTA_GATEWAY);
511
			nexthop_nh->nh_gw = nla ? nla_get_in_addr(nla) : 0;
512
#ifdef CONFIG_IP_ROUTE_CLASSID
513
			nla = nla_find(attrs, attrlen, RTA_FLOW);
514
			nexthop_nh->nh_tclassid = nla ? nla_get_u32(nla) : 0;
515
			if (nexthop_nh->nh_tclassid)
516
				fi->fib_net->ipv4.fib_num_tclassid_users++;
L
Linus Torvalds 已提交
517
#endif
518 519 520 521 522 523 524
			nla = nla_find(attrs, attrlen, RTA_ENCAP);
			if (nla) {
				struct lwtunnel_state *lwtstate;
				struct nlattr *nla_entype;

				nla_entype = nla_find(attrs, attrlen,
						      RTA_ENCAP_TYPE);
525 526 527 528
				if (!nla_entype) {
					NL_SET_BAD_ATTR(extack, nla);
					NL_SET_ERR_MSG(extack,
						       "Encap type is missing");
529
					goto err_inval;
530
				}
531 532

				ret = lwtunnel_build_state(nla_get_u16(
533
							   nla_entype),
534 535
							   nla,  AF_INET, cfg,
							   &lwtstate);
536 537
				if (ret)
					goto errout;
538 539
				nexthop_nh->nh_lwtstate =
					lwtstate_get(lwtstate);
540
			}
L
Linus Torvalds 已提交
541
		}
542 543

		rtnh = rtnh_next(rtnh, &remaining);
L
Linus Torvalds 已提交
544
	} endfor_nexthops(fi);
545

L
Linus Torvalds 已提交
546
	return 0;
547 548 549 550 551 552

err_inval:
	ret = -EINVAL;

errout:
	return ret;
L
Linus Torvalds 已提交
553 554
}

P
Peter Nørlund 已提交
555 556 557 558 559 560 561 562 563 564 565 566 567 568
static void fib_rebalance(struct fib_info *fi)
{
	int total;
	int w;
	struct in_device *in_dev;

	if (fi->fib_nhs < 2)
		return;

	total = 0;
	for_nexthops(fi) {
		if (nh->nh_flags & RTNH_F_DEAD)
			continue;

569
		in_dev = __in_dev_get_rtnl(nh->nh_dev);
P
Peter Nørlund 已提交
570 571 572 573 574 575 576 577 578 579 580 581 582

		if (in_dev &&
		    IN_DEV_IGNORE_ROUTES_WITH_LINKDOWN(in_dev) &&
		    nh->nh_flags & RTNH_F_LINKDOWN)
			continue;

		total += nh->nh_weight;
	} endfor_nexthops(fi);

	w = 0;
	change_nexthops(fi) {
		int upper_bound;

583
		in_dev = __in_dev_get_rtnl(nexthop_nh->nh_dev);
P
Peter Nørlund 已提交
584 585 586 587 588 589 590 591 592

		if (nexthop_nh->nh_flags & RTNH_F_DEAD) {
			upper_bound = -1;
		} else if (in_dev &&
			   IN_DEV_IGNORE_ROUTES_WITH_LINKDOWN(in_dev) &&
			   nexthop_nh->nh_flags & RTNH_F_LINKDOWN) {
			upper_bound = -1;
		} else {
			w += nexthop_nh->nh_weight;
593 594
			upper_bound = DIV_ROUND_CLOSEST_ULL((u64)w << 31,
							    total) - 1;
P
Peter Nørlund 已提交
595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612
		}

		atomic_set(&nexthop_nh->nh_upper_bound, upper_bound);
	} endfor_nexthops(fi);
}

static inline void fib_add_weight(struct fib_info *fi,
				  const struct fib_nh *nh)
{
	fi->fib_weight += nh->nh_weight;
}

#else /* CONFIG_IP_ROUTE_MULTIPATH */

#define fib_rebalance(fi) do { } while (0)
#define fib_add_weight(fi, nh) do { } while (0)

#endif /* CONFIG_IP_ROUTE_MULTIPATH */
L
Linus Torvalds 已提交
613

614
static int fib_encap_match(u16 encap_type,
Y
Ying Xue 已提交
615
			   struct nlattr *encap,
616
			   const struct fib_nh *nh,
617
			   const struct fib_config *cfg)
618 619
{
	struct lwtunnel_state *lwtstate;
J
Jiri Benc 已提交
620
	int ret, result = 0;
621 622 623 624

	if (encap_type == LWTUNNEL_ENCAP_NONE)
		return 0;

625
	ret = lwtunnel_build_state(encap_type, encap,
626
				   AF_INET, cfg, &lwtstate);
J
Jiri Benc 已提交
627 628 629 630
	if (!ret) {
		result = lwtunnel_cmp_encap(lwtstate, nh->nh_lwtstate);
		lwtstate_free(lwtstate);
	}
631

J
Jiri Benc 已提交
632
	return result;
633 634
}

635
int fib_nh_match(struct fib_config *cfg, struct fib_info *fi)
L
Linus Torvalds 已提交
636 637
{
#ifdef CONFIG_IP_ROUTE_MULTIPATH
638 639
	struct rtnexthop *rtnh;
	int remaining;
L
Linus Torvalds 已提交
640 641
#endif

642
	if (cfg->fc_priority && cfg->fc_priority != fi->fib_priority)
L
Linus Torvalds 已提交
643 644
		return 1;

645
	if (cfg->fc_oif || cfg->fc_gw) {
646
		if (cfg->fc_encap) {
647 648
			if (fib_encap_match(cfg->fc_encap_type,
					    cfg->fc_encap, fi->fib_nh, cfg))
649 650
			    return 1;
		}
651 652
		if ((!cfg->fc_oif || cfg->fc_oif == fi->fib_nh->nh_oif) &&
		    (!cfg->fc_gw  || cfg->fc_gw == fi->fib_nh->nh_gw))
L
Linus Torvalds 已提交
653 654 655 656 657
			return 0;
		return 1;
	}

#ifdef CONFIG_IP_ROUTE_MULTIPATH
658
	if (!cfg->fc_mp)
L
Linus Torvalds 已提交
659
		return 0;
660 661 662

	rtnh = cfg->fc_mp;
	remaining = cfg->fc_mp_len;
663

L
Linus Torvalds 已提交
664
	for_nexthops(fi) {
665
		int attrlen;
L
Linus Torvalds 已提交
666

667
		if (!rtnh_ok(rtnh, remaining))
L
Linus Torvalds 已提交
668
			return -EINVAL;
669 670

		if (rtnh->rtnh_ifindex && rtnh->rtnh_ifindex != nh->nh_oif)
L
Linus Torvalds 已提交
671
			return 1;
672 673

		attrlen = rtnh_attrlen(rtnh);
674
		if (attrlen > 0) {
675 676 677
			struct nlattr *nla, *attrs = rtnh_attrs(rtnh);

			nla = nla_find(attrs, attrlen, RTA_GATEWAY);
678
			if (nla && nla_get_in_addr(nla) != nh->nh_gw)
L
Linus Torvalds 已提交
679
				return 1;
680
#ifdef CONFIG_IP_ROUTE_CLASSID
681 682
			nla = nla_find(attrs, attrlen, RTA_FLOW);
			if (nla && nla_get_u32(nla) != nh->nh_tclassid)
L
Linus Torvalds 已提交
683 684 685
				return 1;
#endif
		}
686 687

		rtnh = rtnh_next(rtnh, &remaining);
L
Linus Torvalds 已提交
688 689 690 691 692 693 694
	} endfor_nexthops(fi);
#endif
	return 0;
}


/*
E
Eric Dumazet 已提交
695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735
 * Picture
 * -------
 *
 * Semantics of nexthop is very messy by historical reasons.
 * We have to take into account, that:
 * a) gateway can be actually local interface address,
 *    so that gatewayed route is direct.
 * b) gateway must be on-link address, possibly
 *    described not by an ifaddr, but also by a direct route.
 * c) If both gateway and interface are specified, they should not
 *    contradict.
 * d) If we use tunnel routes, gateway could be not on-link.
 *
 * Attempt to reconcile all of these (alas, self-contradictory) conditions
 * results in pretty ugly and hairy code with obscure logic.
 *
 * I chose to generalized it instead, so that the size
 * of code does not increase practically, but it becomes
 * much more general.
 * Every prefix is assigned a "scope" value: "host" is local address,
 * "link" is direct route,
 * [ ... "site" ... "interior" ... ]
 * and "universe" is true gateway route with global meaning.
 *
 * Every prefix refers to a set of "nexthop"s (gw, oif),
 * where gw must have narrower scope. This recursion stops
 * when gw has LOCAL scope or if "nexthop" is declared ONLINK,
 * which means that gw is forced to be on link.
 *
 * Code is still hairy, but now it is apparently logically
 * consistent and very flexible. F.e. as by-product it allows
 * to co-exists in peace independent exterior and interior
 * routing processes.
 *
 * Normally it looks as following.
 *
 * {universe prefix}  -> (gw, oif) [scope link]
 *		  |
 *		  |-> {link prefix} -> (gw, oif) [scope local]
 *					|
 *					|-> {local prefix} (terminal node)
L
Linus Torvalds 已提交
736
 */
737
static int fib_check_nh(struct fib_config *cfg, struct fib_info *fi,
738
			struct fib_nh *nh, struct netlink_ext_ack *extack)
L
Linus Torvalds 已提交
739
{
740
	int err = 0;
741
	struct net *net;
E
Eric Dumazet 已提交
742
	struct net_device *dev;
L
Linus Torvalds 已提交
743

744
	net = cfg->fc_nlinfo.nl_net;
L
Linus Torvalds 已提交
745 746 747
	if (nh->nh_gw) {
		struct fib_result res;

E
Eric Dumazet 已提交
748
		if (nh->nh_flags & RTNH_F_ONLINK) {
D
David Ahern 已提交
749
			unsigned int addr_type;
L
Linus Torvalds 已提交
750

751 752 753
			if (cfg->fc_scope >= RT_SCOPE_LINK) {
				NL_SET_ERR_MSG(extack,
					       "Nexthop has invalid scope");
L
Linus Torvalds 已提交
754
				return -EINVAL;
755
			}
E
Eric Dumazet 已提交
756 757
			dev = __dev_get_by_index(net, nh->nh_oif);
			if (!dev)
L
Linus Torvalds 已提交
758
				return -ENODEV;
759 760 761
			if (!(dev->flags & IFF_UP)) {
				NL_SET_ERR_MSG(extack,
					       "Nexthop device is not up");
L
Linus Torvalds 已提交
762
				return -ENETDOWN;
763
			}
D
David Ahern 已提交
764
			addr_type = inet_addr_type_dev_table(net, dev, nh->nh_gw);
765 766 767
			if (addr_type != RTN_UNICAST) {
				NL_SET_ERR_MSG(extack,
					       "Nexthop has invalid gateway");
D
David Ahern 已提交
768
				return -EINVAL;
769
			}
770 771
			if (!netif_carrier_ok(dev))
				nh->nh_flags |= RTNH_F_LINKDOWN;
L
Linus Torvalds 已提交
772 773 774 775 776
			nh->nh_dev = dev;
			dev_hold(dev);
			nh->nh_scope = RT_SCOPE_LINK;
			return 0;
		}
E
Eric Dumazet 已提交
777
		rcu_read_lock();
L
Linus Torvalds 已提交
778
		{
779
			struct fib_table *tbl = NULL;
D
David S. Miller 已提交
780 781 782 783
			struct flowi4 fl4 = {
				.daddr = nh->nh_gw,
				.flowi4_scope = cfg->fc_scope + 1,
				.flowi4_oif = nh->nh_oif,
784
				.flowi4_iif = LOOPBACK_IFINDEX,
785
			};
L
Linus Torvalds 已提交
786 787

			/* It is not necessary, but requires a bit of thinking */
D
David S. Miller 已提交
788 789
			if (fl4.flowi4_scope < RT_SCOPE_LINK)
				fl4.flowi4_scope = RT_SCOPE_LINK;
790 791 792 793 794 795

			if (cfg->fc_table)
				tbl = fib_get_table(net, cfg->fc_table);

			if (tbl)
				err = fib_table_lookup(tbl, &fl4, &res,
796 797
						       FIB_LOOKUP_IGNORE_LINKSTATE |
						       FIB_LOOKUP_NOREF);
D
David Ahern 已提交
798 799 800 801 802 803

			/* on error or if no table given do full lookup. This
			 * is needed for example when nexthops are in the local
			 * table rather than the given table
			 */
			if (!tbl || err) {
804 805
				err = fib_lookup(net, &fl4, &res,
						 FIB_LOOKUP_IGNORE_LINKSTATE);
D
David Ahern 已提交
806 807
			}

E
Eric Dumazet 已提交
808
			if (err) {
809 810
				NL_SET_ERR_MSG(extack,
					       "Nexthop has invalid gateway");
E
Eric Dumazet 已提交
811
				rcu_read_unlock();
L
Linus Torvalds 已提交
812
				return err;
E
Eric Dumazet 已提交
813
			}
L
Linus Torvalds 已提交
814 815
		}
		err = -EINVAL;
816 817
		if (res.type != RTN_UNICAST && res.type != RTN_LOCAL) {
			NL_SET_ERR_MSG(extack, "Nexthop has invalid gateway");
L
Linus Torvalds 已提交
818
			goto out;
819
		}
L
Linus Torvalds 已提交
820 821
		nh->nh_scope = res.scope;
		nh->nh_oif = FIB_RES_OIF(res);
E
Eric Dumazet 已提交
822
		nh->nh_dev = dev = FIB_RES_DEV(res);
823 824 825
		if (!dev) {
			NL_SET_ERR_MSG(extack,
				       "No egress device for nexthop gateway");
L
Linus Torvalds 已提交
826
			goto out;
827
		}
E
Eric Dumazet 已提交
828
		dev_hold(dev);
829 830
		if (!netif_carrier_ok(dev))
			nh->nh_flags |= RTNH_F_LINKDOWN;
831
		err = (dev->flags & IFF_UP) ? 0 : -ENETDOWN;
L
Linus Torvalds 已提交
832 833 834
	} else {
		struct in_device *in_dev;

835 836 837
		if (nh->nh_flags & (RTNH_F_PERVASIVE | RTNH_F_ONLINK)) {
			NL_SET_ERR_MSG(extack,
				       "Invalid flags for nexthop - PERVASIVE and ONLINK can not be set");
L
Linus Torvalds 已提交
838
			return -EINVAL;
839
		}
840 841
		rcu_read_lock();
		err = -ENODEV;
842
		in_dev = inetdev_by_index(net, nh->nh_oif);
843
		if (!in_dev)
844 845
			goto out;
		err = -ENETDOWN;
846 847
		if (!(in_dev->dev->flags & IFF_UP)) {
			NL_SET_ERR_MSG(extack, "Device for nexthop is not up");
848
			goto out;
849
		}
L
Linus Torvalds 已提交
850 851 852
		nh->nh_dev = in_dev->dev;
		dev_hold(nh->nh_dev);
		nh->nh_scope = RT_SCOPE_HOST;
853 854
		if (!netif_carrier_ok(nh->nh_dev))
			nh->nh_flags |= RTNH_F_LINKDOWN;
855
		err = 0;
L
Linus Torvalds 已提交
856
	}
857 858 859
out:
	rcu_read_unlock();
	return err;
L
Linus Torvalds 已提交
860 861
}

A
Al Viro 已提交
862
static inline unsigned int fib_laddr_hashfn(__be32 val)
L
Linus Torvalds 已提交
863
{
864
	unsigned int mask = (fib_info_hash_size - 1);
L
Linus Torvalds 已提交
865

E
Eric Dumazet 已提交
866 867 868
	return ((__force u32)val ^
		((__force u32)val >> 7) ^
		((__force u32)val >> 14)) & mask;
L
Linus Torvalds 已提交
869 870
}

871
static struct hlist_head *fib_info_hash_alloc(int bytes)
L
Linus Torvalds 已提交
872 873
{
	if (bytes <= PAGE_SIZE)
874
		return kzalloc(bytes, GFP_KERNEL);
L
Linus Torvalds 已提交
875 876
	else
		return (struct hlist_head *)
E
Eric Dumazet 已提交
877 878
			__get_free_pages(GFP_KERNEL | __GFP_ZERO,
					 get_order(bytes));
L
Linus Torvalds 已提交
879 880
}

881
static void fib_info_hash_free(struct hlist_head *hash, int bytes)
L
Linus Torvalds 已提交
882 883 884 885 886 887 888 889 890 891
{
	if (!hash)
		return;

	if (bytes <= PAGE_SIZE)
		kfree(hash);
	else
		free_pages((unsigned long) hash, get_order(bytes));
}

892 893 894
static void fib_info_hash_move(struct hlist_head *new_info_hash,
			       struct hlist_head *new_laddrhash,
			       unsigned int new_size)
L
Linus Torvalds 已提交
895
{
896
	struct hlist_head *old_info_hash, *old_laddrhash;
897
	unsigned int old_size = fib_info_hash_size;
898
	unsigned int i, bytes;
L
Linus Torvalds 已提交
899

900
	spin_lock_bh(&fib_info_lock);
901 902
	old_info_hash = fib_info_hash;
	old_laddrhash = fib_info_laddrhash;
903
	fib_info_hash_size = new_size;
L
Linus Torvalds 已提交
904 905 906

	for (i = 0; i < old_size; i++) {
		struct hlist_head *head = &fib_info_hash[i];
907
		struct hlist_node *n;
L
Linus Torvalds 已提交
908 909
		struct fib_info *fi;

910
		hlist_for_each_entry_safe(fi, n, head, fib_hash) {
L
Linus Torvalds 已提交
911 912 913 914 915 916 917 918 919 920 921 922
			struct hlist_head *dest;
			unsigned int new_hash;

			new_hash = fib_info_hashfn(fi);
			dest = &new_info_hash[new_hash];
			hlist_add_head(&fi->fib_hash, dest);
		}
	}
	fib_info_hash = new_info_hash;

	for (i = 0; i < old_size; i++) {
		struct hlist_head *lhead = &fib_info_laddrhash[i];
923
		struct hlist_node *n;
L
Linus Torvalds 已提交
924 925
		struct fib_info *fi;

926
		hlist_for_each_entry_safe(fi, n, lhead, fib_lhash) {
L
Linus Torvalds 已提交
927 928 929 930 931 932 933 934 935 936
			struct hlist_head *ldest;
			unsigned int new_hash;

			new_hash = fib_laddr_hashfn(fi->fib_prefsrc);
			ldest = &new_laddrhash[new_hash];
			hlist_add_head(&fi->fib_lhash, ldest);
		}
	}
	fib_info_laddrhash = new_laddrhash;

937
	spin_unlock_bh(&fib_info_lock);
938 939

	bytes = old_size * sizeof(struct hlist_head *);
940 941
	fib_info_hash_free(old_info_hash, bytes);
	fib_info_hash_free(old_laddrhash, bytes);
L
Linus Torvalds 已提交
942 943
}

944 945 946 947
__be32 fib_info_update_nh_saddr(struct net *net, struct fib_nh *nh)
{
	nh->nh_saddr = inet_select_addr(nh->nh_dev,
					nh->nh_gw,
948
					nh->nh_parent->fib_scope);
949 950 951 952 953
	nh->nh_saddr_genid = atomic_read(&net->ipv4.dev_addr_genid);

	return nh->nh_saddr;
}

954 955 956 957
static bool fib_valid_prefsrc(struct fib_config *cfg, __be32 fib_prefsrc)
{
	if (cfg->fc_type != RTN_LOCAL || !cfg->fc_dst ||
	    fib_prefsrc != cfg->fc_dst) {
D
David Ahern 已提交
958
		u32 tb_id = cfg->fc_table;
D
David Ahern 已提交
959
		int rc;
960 961 962 963

		if (tb_id == RT_TABLE_MAIN)
			tb_id = RT_TABLE_LOCAL;

D
David Ahern 已提交
964 965 966 967 968 969
		rc = inet_addr_type_table(cfg->fc_nlinfo.nl_net,
					  fib_prefsrc, tb_id);

		if (rc != RTN_LOCAL && tb_id != RT_TABLE_LOCAL) {
			rc = inet_addr_type_table(cfg->fc_nlinfo.nl_net,
						  fib_prefsrc, RT_TABLE_LOCAL);
970
		}
D
David Ahern 已提交
971 972 973

		if (rc != RTN_LOCAL)
			return false;
974 975 976 977
	}
	return true;
}

978 979 980
static int
fib_convert_metrics(struct fib_info *fi, const struct fib_config *cfg)
{
981
	bool ecn_ca = false;
982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000
	struct nlattr *nla;
	int remaining;

	if (!cfg->fc_mx)
		return 0;

	nla_for_each_attr(nla, cfg->fc_mx, cfg->fc_mx_len, remaining) {
		int type = nla_type(nla);
		u32 val;

		if (!type)
			continue;
		if (type > RTAX_MAX)
			return -EINVAL;

		if (type == RTAX_CC_ALGO) {
			char tmp[TCP_CA_NAME_MAX];

			nla_strlcpy(tmp, nla, sizeof(tmp));
1001
			val = tcp_ca_get_key_by_name(tmp, &ecn_ca);
1002 1003 1004 1005 1006 1007 1008 1009 1010
			if (val == TCP_CA_UNSPEC)
				return -EINVAL;
		} else {
			val = nla_get_u32(nla);
		}
		if (type == RTAX_ADVMSS && val > 65535 - 40)
			val = 65535 - 40;
		if (type == RTAX_MTU && val > 65535 - 15)
			val = 65535 - 15;
1011 1012
		if (type == RTAX_HOPLIMIT && val > 255)
			val = 255;
1013 1014
		if (type == RTAX_FEATURES && (val & ~RTAX_FEATURE_MASK))
			return -EINVAL;
1015
		fi->fib_metrics->metrics[type - 1] = val;
1016 1017
	}

1018
	if (ecn_ca)
1019
		fi->fib_metrics->metrics[RTAX_FEATURES - 1] |= DST_FEATURE_ECN_CA;
1020

1021 1022 1023
	return 0;
}

1024 1025
struct fib_info *fib_create_info(struct fib_config *cfg,
				 struct netlink_ext_ack *extack)
L
Linus Torvalds 已提交
1026 1027 1028 1029 1030
{
	int err;
	struct fib_info *fi = NULL;
	struct fib_info *ofi;
	int nhs = 1;
1031
	struct net *net = cfg->fc_nlinfo.nl_net;
L
Linus Torvalds 已提交
1032

1033 1034 1035
	if (cfg->fc_type > RTN_MAX)
		goto err_inval;

L
Linus Torvalds 已提交
1036
	/* Fast check to catch the most weird cases */
1037 1038
	if (fib_props[cfg->fc_type].scope > cfg->fc_scope) {
		NL_SET_ERR_MSG(extack, "Invalid scope");
L
Linus Torvalds 已提交
1039
		goto err_inval;
1040
	}
L
Linus Torvalds 已提交
1041

1042 1043 1044
	if (cfg->fc_flags & (RTNH_F_DEAD | RTNH_F_LINKDOWN)) {
		NL_SET_ERR_MSG(extack,
			       "Invalid rtm_flags - can not contain DEAD or LINKDOWN");
1045
		goto err_inval;
1046
	}
1047

L
Linus Torvalds 已提交
1048
#ifdef CONFIG_IP_ROUTE_MULTIPATH
1049
	if (cfg->fc_mp) {
1050
		nhs = fib_count_nexthops(cfg->fc_mp, cfg->fc_mp_len, extack);
L
Linus Torvalds 已提交
1051 1052 1053 1054 1055 1056
		if (nhs == 0)
			goto err_inval;
	}
#endif

	err = -ENOBUFS;
1057 1058
	if (fib_info_cnt >= fib_info_hash_size) {
		unsigned int new_size = fib_info_hash_size << 1;
L
Linus Torvalds 已提交
1059 1060 1061 1062 1063
		struct hlist_head *new_info_hash;
		struct hlist_head *new_laddrhash;
		unsigned int bytes;

		if (!new_size)
1064
			new_size = 16;
L
Linus Torvalds 已提交
1065
		bytes = new_size * sizeof(struct hlist_head *);
1066 1067
		new_info_hash = fib_info_hash_alloc(bytes);
		new_laddrhash = fib_info_hash_alloc(bytes);
L
Linus Torvalds 已提交
1068
		if (!new_info_hash || !new_laddrhash) {
1069 1070
			fib_info_hash_free(new_info_hash, bytes);
			fib_info_hash_free(new_laddrhash, bytes);
1071
		} else
1072
			fib_info_hash_move(new_info_hash, new_laddrhash, new_size);
L
Linus Torvalds 已提交
1073

1074
		if (!fib_info_hash_size)
L
Linus Torvalds 已提交
1075 1076 1077
			goto failure;
	}

1078
	fi = kzalloc(sizeof(*fi)+nhs*sizeof(struct fib_nh), GFP_KERNEL);
1079
	if (!fi)
L
Linus Torvalds 已提交
1080
		goto failure;
1081
	fib_info_cnt++;
1082
	if (cfg->fc_mx) {
1083
		fi->fib_metrics = kzalloc(sizeof(*fi->fib_metrics), GFP_KERNEL);
1084 1085
		if (!fi->fib_metrics)
			goto failure;
1086
		atomic_set(&fi->fib_metrics->refcnt, 1);
1087
	} else
1088
		fi->fib_metrics = (struct dst_metrics *)&dst_default_metrics;
L
Linus Torvalds 已提交
1089

1090
	fi->fib_net = net;
1091
	fi->fib_protocol = cfg->fc_protocol;
1092
	fi->fib_scope = cfg->fc_scope;
1093 1094 1095
	fi->fib_flags = cfg->fc_flags;
	fi->fib_priority = cfg->fc_priority;
	fi->fib_prefsrc = cfg->fc_prefsrc;
E
Eric Dumazet 已提交
1096
	fi->fib_type = cfg->fc_type;
1097
	fi->fib_tb_id = cfg->fc_table;
L
Linus Torvalds 已提交
1098 1099 1100

	fi->fib_nhs = nhs;
	change_nexthops(fi) {
1101
		nexthop_nh->nh_parent = fi;
E
Eric Dumazet 已提交
1102
		nexthop_nh->nh_pcpu_rth_output = alloc_percpu(struct rtable __rcu *);
1103 1104
		if (!nexthop_nh->nh_pcpu_rth_output)
			goto failure;
L
Linus Torvalds 已提交
1105 1106
	} endfor_nexthops(fi)

1107 1108 1109
	err = fib_convert_metrics(fi, cfg);
	if (err)
		goto failure;
L
Linus Torvalds 已提交
1110

1111
	if (cfg->fc_mp) {
L
Linus Torvalds 已提交
1112
#ifdef CONFIG_IP_ROUTE_MULTIPATH
1113
		err = fib_get_nhs(fi, cfg->fc_mp, cfg->fc_mp_len, cfg, extack);
1114
		if (err != 0)
L
Linus Torvalds 已提交
1115
			goto failure;
1116 1117 1118
		if (cfg->fc_oif && fi->fib_nh->nh_oif != cfg->fc_oif) {
			NL_SET_ERR_MSG(extack,
				       "Nexthop device index does not match RTA_OIF");
L
Linus Torvalds 已提交
1119
			goto err_inval;
1120 1121 1122 1123
		}
		if (cfg->fc_gw && fi->fib_nh->nh_gw != cfg->fc_gw) {
			NL_SET_ERR_MSG(extack,
				       "Nexthop gateway does not match RTA_GATEWAY");
L
Linus Torvalds 已提交
1124
			goto err_inval;
1125
		}
1126
#ifdef CONFIG_IP_ROUTE_CLASSID
1127 1128 1129
		if (cfg->fc_flow && fi->fib_nh->nh_tclassid != cfg->fc_flow) {
			NL_SET_ERR_MSG(extack,
				       "Nexthop class id does not match RTA_FLOW");
L
Linus Torvalds 已提交
1130
			goto err_inval;
1131
		}
L
Linus Torvalds 已提交
1132 1133
#endif
#else
1134 1135
		NL_SET_ERR_MSG(extack,
			       "Multipath support not enabled in kernel");
L
Linus Torvalds 已提交
1136 1137 1138 1139
		goto err_inval;
#endif
	} else {
		struct fib_nh *nh = fi->fib_nh;
1140

1141 1142 1143
		if (cfg->fc_encap) {
			struct lwtunnel_state *lwtstate;

1144 1145 1146
			if (cfg->fc_encap_type == LWTUNNEL_ENCAP_NONE) {
				NL_SET_ERR_MSG(extack,
					       "LWT encap type not specified");
1147
				goto err_inval;
1148
			}
1149
			err = lwtunnel_build_state(cfg->fc_encap_type,
1150 1151
						   cfg->fc_encap, AF_INET, cfg,
						   &lwtstate);
1152 1153 1154
			if (err)
				goto failure;

1155
			nh->nh_lwtstate = lwtstate_get(lwtstate);
1156
		}
1157 1158 1159
		nh->nh_oif = cfg->fc_oif;
		nh->nh_gw = cfg->fc_gw;
		nh->nh_flags = cfg->fc_flags;
1160
#ifdef CONFIG_IP_ROUTE_CLASSID
1161
		nh->nh_tclassid = cfg->fc_flow;
1162
		if (nh->nh_tclassid)
1163
			fi->fib_net->ipv4.fib_num_tclassid_users++;
L
Linus Torvalds 已提交
1164 1165 1166 1167 1168 1169
#endif
#ifdef CONFIG_IP_ROUTE_MULTIPATH
		nh->nh_weight = 1;
#endif
	}

1170
	if (fib_props[cfg->fc_type].error) {
1171 1172 1173
		if (cfg->fc_gw || cfg->fc_oif || cfg->fc_mp) {
			NL_SET_ERR_MSG(extack,
				       "Gateway, device and multipath can not be specified for this route type");
L
Linus Torvalds 已提交
1174
			goto err_inval;
1175
		}
L
Linus Torvalds 已提交
1176
		goto link_it;
1177 1178 1179 1180 1181 1182 1183 1184 1185
	} else {
		switch (cfg->fc_type) {
		case RTN_UNICAST:
		case RTN_LOCAL:
		case RTN_BROADCAST:
		case RTN_ANYCAST:
		case RTN_MULTICAST:
			break;
		default:
1186
			NL_SET_ERR_MSG(extack, "Invalid route type");
1187 1188
			goto err_inval;
		}
L
Linus Torvalds 已提交
1189 1190
	}

1191 1192
	if (cfg->fc_scope > RT_SCOPE_HOST) {
		NL_SET_ERR_MSG(extack, "Invalid scope");
L
Linus Torvalds 已提交
1193
		goto err_inval;
1194
	}
L
Linus Torvalds 已提交
1195

1196
	if (cfg->fc_scope == RT_SCOPE_HOST) {
L
Linus Torvalds 已提交
1197 1198 1199
		struct fib_nh *nh = fi->fib_nh;

		/* Local address is added. */
1200 1201 1202
		if (nhs != 1) {
			NL_SET_ERR_MSG(extack,
				       "Route with host scope can not have multiple nexthops");
1203
			goto err_inval;
1204 1205 1206 1207
		}
		if (nh->nh_gw) {
			NL_SET_ERR_MSG(extack,
				       "Route with host scope can not have a gateway");
L
Linus Torvalds 已提交
1208
			goto err_inval;
1209
		}
L
Linus Torvalds 已提交
1210
		nh->nh_scope = RT_SCOPE_NOWHERE;
1211
		nh->nh_dev = dev_get_by_index(net, fi->fib_nh->nh_oif);
L
Linus Torvalds 已提交
1212
		err = -ENODEV;
1213
		if (!nh->nh_dev)
L
Linus Torvalds 已提交
1214 1215
			goto failure;
	} else {
1216 1217
		int linkdown = 0;

L
Linus Torvalds 已提交
1218
		change_nexthops(fi) {
1219
			err = fib_check_nh(cfg, fi, nexthop_nh, extack);
E
Eric Dumazet 已提交
1220
			if (err != 0)
L
Linus Torvalds 已提交
1221
				goto failure;
1222 1223
			if (nexthop_nh->nh_flags & RTNH_F_LINKDOWN)
				linkdown++;
L
Linus Torvalds 已提交
1224
		} endfor_nexthops(fi)
1225 1226
		if (linkdown == fi->fib_nhs)
			fi->fib_flags |= RTNH_F_LINKDOWN;
L
Linus Torvalds 已提交
1227 1228
	}

1229 1230
	if (fi->fib_prefsrc && !fib_valid_prefsrc(cfg, fi->fib_prefsrc)) {
		NL_SET_ERR_MSG(extack, "Invalid prefsrc address");
1231
		goto err_inval;
1232
	}
L
Linus Torvalds 已提交
1233

1234
	change_nexthops(fi) {
1235
		fib_info_update_nh_saddr(net, nexthop_nh);
P
Peter Nørlund 已提交
1236
		fib_add_weight(fi, nexthop_nh);
1237 1238
	} endfor_nexthops(fi)

P
Peter Nørlund 已提交
1239 1240
	fib_rebalance(fi);

L
Linus Torvalds 已提交
1241
link_it:
E
Eric Dumazet 已提交
1242 1243
	ofi = fib_find_info(fi);
	if (ofi) {
L
Linus Torvalds 已提交
1244 1245 1246 1247 1248 1249 1250 1251
		fi->fib_dead = 1;
		free_fib_info(fi);
		ofi->fib_treeref++;
		return ofi;
	}

	fi->fib_treeref++;
	atomic_inc(&fi->fib_clntref);
1252
	spin_lock_bh(&fib_info_lock);
L
Linus Torvalds 已提交
1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264
	hlist_add_head(&fi->fib_hash,
		       &fib_info_hash[fib_info_hashfn(fi)]);
	if (fi->fib_prefsrc) {
		struct hlist_head *head;

		head = &fib_info_laddrhash[fib_laddr_hashfn(fi->fib_prefsrc)];
		hlist_add_head(&fi->fib_lhash, head);
	}
	change_nexthops(fi) {
		struct hlist_head *head;
		unsigned int hash;

1265
		if (!nexthop_nh->nh_dev)
L
Linus Torvalds 已提交
1266
			continue;
1267
		hash = fib_devindex_hashfn(nexthop_nh->nh_dev->ifindex);
L
Linus Torvalds 已提交
1268
		head = &fib_info_devhash[hash];
1269
		hlist_add_head(&nexthop_nh->nh_hash, head);
L
Linus Torvalds 已提交
1270
	} endfor_nexthops(fi)
1271
	spin_unlock_bh(&fib_info_lock);
L
Linus Torvalds 已提交
1272 1273 1274 1275 1276 1277
	return fi;

err_inval:
	err = -EINVAL;

failure:
1278
	if (fi) {
L
Linus Torvalds 已提交
1279 1280 1281
		fi->fib_dead = 1;
		free_fib_info(fi);
	}
1282 1283

	return ERR_PTR(err);
L
Linus Torvalds 已提交
1284 1285
}

1286
int fib_dump_info(struct sk_buff *skb, u32 portid, u32 seq, int event,
1287
		  u32 tb_id, u8 type, __be32 dst, int dst_len, u8 tos,
1288
		  struct fib_info *fi, unsigned int flags)
L
Linus Torvalds 已提交
1289
{
1290
	struct nlmsghdr *nlh;
L
Linus Torvalds 已提交
1291 1292
	struct rtmsg *rtm;

1293
	nlh = nlmsg_put(skb, portid, seq, event, sizeof(*rtm), flags);
1294
	if (!nlh)
1295
		return -EMSGSIZE;
1296 1297

	rtm = nlmsg_data(nlh);
L
Linus Torvalds 已提交
1298 1299 1300 1301
	rtm->rtm_family = AF_INET;
	rtm->rtm_dst_len = dst_len;
	rtm->rtm_src_len = 0;
	rtm->rtm_tos = tos;
1302 1303 1304 1305
	if (tb_id < 256)
		rtm->rtm_table = tb_id;
	else
		rtm->rtm_table = RT_TABLE_COMPAT;
D
David S. Miller 已提交
1306 1307
	if (nla_put_u32(skb, RTA_TABLE, tb_id))
		goto nla_put_failure;
L
Linus Torvalds 已提交
1308 1309
	rtm->rtm_type = type;
	rtm->rtm_flags = fi->fib_flags;
1310
	rtm->rtm_scope = fi->fib_scope;
L
Linus Torvalds 已提交
1311
	rtm->rtm_protocol = fi->fib_protocol;
1312

D
David S. Miller 已提交
1313
	if (rtm->rtm_dst_len &&
1314
	    nla_put_in_addr(skb, RTA_DST, dst))
D
David S. Miller 已提交
1315 1316 1317 1318
		goto nla_put_failure;
	if (fi->fib_priority &&
	    nla_put_u32(skb, RTA_PRIORITY, fi->fib_priority))
		goto nla_put_failure;
1319
	if (rtnetlink_put_metrics(skb, fi->fib_metrics->metrics) < 0)
1320 1321
		goto nla_put_failure;

D
David S. Miller 已提交
1322
	if (fi->fib_prefsrc &&
1323
	    nla_put_in_addr(skb, RTA_PREFSRC, fi->fib_prefsrc))
D
David S. Miller 已提交
1324
		goto nla_put_failure;
L
Linus Torvalds 已提交
1325
	if (fi->fib_nhs == 1) {
1326 1327
		struct in_device *in_dev;

D
David S. Miller 已提交
1328
		if (fi->fib_nh->nh_gw &&
1329
		    nla_put_in_addr(skb, RTA_GATEWAY, fi->fib_nh->nh_gw))
D
David S. Miller 已提交
1330 1331 1332 1333
			goto nla_put_failure;
		if (fi->fib_nh->nh_oif &&
		    nla_put_u32(skb, RTA_OIF, fi->fib_nh->nh_oif))
			goto nla_put_failure;
1334
		if (fi->fib_nh->nh_flags & RTNH_F_LINKDOWN) {
1335
			in_dev = __in_dev_get_rtnl(fi->fib_nh->nh_dev);
1336 1337 1338 1339
			if (in_dev &&
			    IN_DEV_IGNORE_ROUTES_WITH_LINKDOWN(in_dev))
				rtm->rtm_flags |= RTNH_F_DEAD;
		}
1340
#ifdef CONFIG_IP_ROUTE_CLASSID
D
David S. Miller 已提交
1341 1342 1343
		if (fi->fib_nh[0].nh_tclassid &&
		    nla_put_u32(skb, RTA_FLOW, fi->fib_nh[0].nh_tclassid))
			goto nla_put_failure;
1344
#endif
1345 1346 1347
		if (fi->fib_nh->nh_lwtstate &&
		    lwtunnel_fill_encap(skb, fi->fib_nh->nh_lwtstate) < 0)
			goto nla_put_failure;
L
Linus Torvalds 已提交
1348 1349 1350
	}
#ifdef CONFIG_IP_ROUTE_MULTIPATH
	if (fi->fib_nhs > 1) {
1351 1352 1353 1354
		struct rtnexthop *rtnh;
		struct nlattr *mp;

		mp = nla_nest_start(skb, RTA_MULTIPATH);
1355
		if (!mp)
1356
			goto nla_put_failure;
L
Linus Torvalds 已提交
1357 1358

		for_nexthops(fi) {
1359 1360
			struct in_device *in_dev;

1361
			rtnh = nla_reserve_nohdr(skb, sizeof(*rtnh));
1362
			if (!rtnh)
1363 1364 1365
				goto nla_put_failure;

			rtnh->rtnh_flags = nh->nh_flags & 0xFF;
1366
			if (nh->nh_flags & RTNH_F_LINKDOWN) {
1367
				in_dev = __in_dev_get_rtnl(nh->nh_dev);
1368 1369 1370 1371
				if (in_dev &&
				    IN_DEV_IGNORE_ROUTES_WITH_LINKDOWN(in_dev))
					rtnh->rtnh_flags |= RTNH_F_DEAD;
			}
1372 1373 1374
			rtnh->rtnh_hops = nh->nh_weight - 1;
			rtnh->rtnh_ifindex = nh->nh_oif;

D
David S. Miller 已提交
1375
			if (nh->nh_gw &&
1376
			    nla_put_in_addr(skb, RTA_GATEWAY, nh->nh_gw))
D
David S. Miller 已提交
1377
				goto nla_put_failure;
1378
#ifdef CONFIG_IP_ROUTE_CLASSID
D
David S. Miller 已提交
1379 1380 1381
			if (nh->nh_tclassid &&
			    nla_put_u32(skb, RTA_FLOW, nh->nh_tclassid))
				goto nla_put_failure;
1382
#endif
1383 1384 1385 1386
			if (nh->nh_lwtstate &&
			    lwtunnel_fill_encap(skb, nh->nh_lwtstate) < 0)
				goto nla_put_failure;

1387 1388
			/* length of rtnetlink header + attributes */
			rtnh->rtnh_len = nlmsg_get_pos(skb) - (void *) rtnh;
L
Linus Torvalds 已提交
1389
		} endfor_nexthops(fi);
1390 1391

		nla_nest_end(skb, mp);
L
Linus Torvalds 已提交
1392 1393
	}
#endif
1394 1395
	nlmsg_end(skb, nlh);
	return 0;
L
Linus Torvalds 已提交
1396

1397
nla_put_failure:
1398 1399
	nlmsg_cancel(skb, nlh);
	return -EMSGSIZE;
L
Linus Torvalds 已提交
1400 1401 1402
}

/*
E
Eric Dumazet 已提交
1403 1404 1405 1406
 * Update FIB if:
 * - local address disappeared -> we must delete all the entries
 *   referring to it.
 * - device went down -> we must shutdown all nexthops going via it.
L
Linus Torvalds 已提交
1407
 */
1408
int fib_sync_down_addr(struct net_device *dev, __be32 local)
L
Linus Torvalds 已提交
1409 1410
{
	int ret = 0;
D
Denis V. Lunev 已提交
1411 1412
	unsigned int hash = fib_laddr_hashfn(local);
	struct hlist_head *head = &fib_info_laddrhash[hash];
1413 1414
	struct net *net = dev_net(dev);
	int tb_id = l3mdev_fib_table(dev);
D
Denis V. Lunev 已提交
1415
	struct fib_info *fi;
L
Linus Torvalds 已提交
1416

1417
	if (!fib_info_laddrhash || local == 0)
D
Denis V. Lunev 已提交
1418
		return 0;
L
Linus Torvalds 已提交
1419

1420
	hlist_for_each_entry(fi, head, fib_lhash) {
1421 1422
		if (!net_eq(fi->fib_net, net) ||
		    fi->fib_tb_id != tb_id)
1423
			continue;
D
Denis V. Lunev 已提交
1424 1425 1426
		if (fi->fib_prefsrc == local) {
			fi->fib_flags |= RTNH_F_DEAD;
			ret++;
L
Linus Torvalds 已提交
1427 1428
		}
	}
D
Denis V. Lunev 已提交
1429 1430 1431
	return ret;
}

1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461
static int call_fib_nh_notifiers(struct fib_nh *fib_nh,
				 enum fib_event_type event_type)
{
	struct in_device *in_dev = __in_dev_get_rtnl(fib_nh->nh_dev);
	struct fib_nh_notifier_info info = {
		.fib_nh = fib_nh,
	};

	switch (event_type) {
	case FIB_EVENT_NH_ADD:
		if (fib_nh->nh_flags & RTNH_F_DEAD)
			break;
		if (IN_DEV_IGNORE_ROUTES_WITH_LINKDOWN(in_dev) &&
		    fib_nh->nh_flags & RTNH_F_LINKDOWN)
			break;
		return call_fib_notifiers(dev_net(fib_nh->nh_dev), event_type,
					  &info.info);
	case FIB_EVENT_NH_DEL:
		if ((IN_DEV_IGNORE_ROUTES_WITH_LINKDOWN(in_dev) &&
		     fib_nh->nh_flags & RTNH_F_LINKDOWN) ||
		    (fib_nh->nh_flags & RTNH_F_DEAD))
			return call_fib_notifiers(dev_net(fib_nh->nh_dev),
						  event_type, &info.info);
	default:
		break;
	}

	return NOTIFY_DONE;
}

1462 1463 1464 1465 1466 1467 1468
/* Event              force Flags           Description
 * NETDEV_CHANGE      0     LINKDOWN        Carrier OFF, not for scope host
 * NETDEV_DOWN        0     LINKDOWN|DEAD   Link down, not for scope host
 * NETDEV_DOWN        1     LINKDOWN|DEAD   Last address removed
 * NETDEV_UNREGISTER  1     LINKDOWN|DEAD   Device removed
 */
int fib_sync_down_dev(struct net_device *dev, unsigned long event, bool force)
D
Denis V. Lunev 已提交
1469 1470 1471 1472 1473 1474 1475
{
	int ret = 0;
	int scope = RT_SCOPE_NOWHERE;
	struct fib_info *prev_fi = NULL;
	unsigned int hash = fib_devindex_hashfn(dev->ifindex);
	struct hlist_head *head = &fib_info_devhash[hash];
	struct fib_nh *nh;
L
Linus Torvalds 已提交
1476

1477
	if (force)
D
Denis V. Lunev 已提交
1478
		scope = -1;
L
Linus Torvalds 已提交
1479

1480
	hlist_for_each_entry(nh, head, nh_hash) {
D
Denis V. Lunev 已提交
1481 1482
		struct fib_info *fi = nh->nh_parent;
		int dead;
L
Linus Torvalds 已提交
1483

D
Denis V. Lunev 已提交
1484 1485 1486 1487 1488 1489
		BUG_ON(!fi->fib_nhs);
		if (nh->nh_dev != dev || fi == prev_fi)
			continue;
		prev_fi = fi;
		dead = 0;
		change_nexthops(fi) {
E
Eric Dumazet 已提交
1490
			if (nexthop_nh->nh_flags & RTNH_F_DEAD)
D
Denis V. Lunev 已提交
1491
				dead++;
1492 1493
			else if (nexthop_nh->nh_dev == dev &&
				 nexthop_nh->nh_scope != scope) {
1494 1495 1496 1497 1498 1499 1500 1501 1502
				switch (event) {
				case NETDEV_DOWN:
				case NETDEV_UNREGISTER:
					nexthop_nh->nh_flags |= RTNH_F_DEAD;
					/* fall through */
				case NETDEV_CHANGE:
					nexthop_nh->nh_flags |= RTNH_F_LINKDOWN;
					break;
				}
1503 1504
				call_fib_nh_notifiers(nexthop_nh,
						      FIB_EVENT_NH_DEL);
D
Denis V. Lunev 已提交
1505 1506
				dead++;
			}
L
Linus Torvalds 已提交
1507
#ifdef CONFIG_IP_ROUTE_MULTIPATH
1508 1509
			if (event == NETDEV_UNREGISTER &&
			    nexthop_nh->nh_dev == dev) {
D
Denis V. Lunev 已提交
1510 1511
				dead = fi->fib_nhs;
				break;
L
Linus Torvalds 已提交
1512
			}
D
Denis V. Lunev 已提交
1513 1514 1515
#endif
		} endfor_nexthops(fi)
		if (dead == fi->fib_nhs) {
1516 1517 1518 1519 1520 1521 1522 1523 1524
			switch (event) {
			case NETDEV_DOWN:
			case NETDEV_UNREGISTER:
				fi->fib_flags |= RTNH_F_DEAD;
				/* fall through */
			case NETDEV_CHANGE:
				fi->fib_flags |= RTNH_F_LINKDOWN;
				break;
			}
D
Denis V. Lunev 已提交
1525
			ret++;
L
Linus Torvalds 已提交
1526
		}
P
Peter Nørlund 已提交
1527 1528

		fib_rebalance(fi);
L
Linus Torvalds 已提交
1529 1530 1531 1532 1533
	}

	return ret;
}

1534
/* Must be invoked inside of an RCU protected region.  */
1535
static void fib_select_default(const struct flowi4 *flp, struct fib_result *res)
1536 1537
{
	struct fib_info *fi = NULL, *last_resort = NULL;
1538
	struct hlist_head *fa_head = res->fa_head;
1539
	struct fib_table *tb = res->table;
1540
	u8 slen = 32 - res->prefixlen;
1541
	int order = -1, last_idx = -1;
1542 1543 1544
	struct fib_alias *fa, *fa1 = NULL;
	u32 last_prio = res->fi->fib_priority;
	u8 last_tos = 0;
1545

1546
	hlist_for_each_entry_rcu(fa, fa_head, fa_list) {
1547 1548
		struct fib_info *next_fi = fa->fa_info;

1549 1550
		if (fa->fa_slen != slen)
			continue;
1551 1552
		if (fa->fa_tos && fa->fa_tos != flp->flowi4_tos)
			continue;
1553 1554
		if (fa->tb_id != tb->tb_id)
			continue;
1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565
		if (next_fi->fib_priority > last_prio &&
		    fa->fa_tos == last_tos) {
			if (last_tos)
				continue;
			break;
		}
		if (next_fi->fib_flags & RTNH_F_DEAD)
			continue;
		last_tos = fa->fa_tos;
		last_prio = next_fi->fib_priority;

1566
		if (next_fi->fib_scope != res->scope ||
1567 1568 1569 1570 1571 1572 1573 1574
		    fa->fa_type != RTN_UNICAST)
			continue;
		if (!next_fi->fib_nh[0].nh_gw ||
		    next_fi->fib_nh[0].nh_scope != RT_SCOPE_LINK)
			continue;

		fib_alias_accessed(fa);

1575
		if (!fi) {
1576 1577
			if (next_fi != res->fi)
				break;
1578
			fa1 = fa;
1579
		} else if (!fib_detect_death(fi, order, &last_resort,
1580
					     &last_idx, fa1->fa_default)) {
1581
			fib_result_assign(res, fi);
1582
			fa1->fa_default = order;
1583 1584 1585 1586 1587 1588
			goto out;
		}
		fi = next_fi;
		order++;
	}

1589
	if (order <= 0 || !fi) {
1590 1591
		if (fa1)
			fa1->fa_default = -1;
1592 1593 1594 1595
		goto out;
	}

	if (!fib_detect_death(fi, order, &last_resort, &last_idx,
1596
			      fa1->fa_default)) {
1597
		fib_result_assign(res, fi);
1598
		fa1->fa_default = order;
1599 1600 1601 1602 1603
		goto out;
	}

	if (last_idx >= 0)
		fib_result_assign(res, last_resort);
1604
	fa1->fa_default = last_idx;
1605
out:
1606
	return;
1607 1608
}

L
Linus Torvalds 已提交
1609
/*
E
Eric Dumazet 已提交
1610 1611
 * Dead device goes up. We wake up dead nexthops.
 * It takes sense only on multipath routes.
L
Linus Torvalds 已提交
1612
 */
1613
int fib_sync_up(struct net_device *dev, unsigned int nh_flags)
L
Linus Torvalds 已提交
1614 1615 1616 1617 1618 1619 1620
{
	struct fib_info *prev_fi;
	unsigned int hash;
	struct hlist_head *head;
	struct fib_nh *nh;
	int ret;

E
Eric Dumazet 已提交
1621
	if (!(dev->flags & IFF_UP))
L
Linus Torvalds 已提交
1622 1623
		return 0;

1624 1625 1626 1627 1628 1629 1630
	if (nh_flags & RTNH_F_DEAD) {
		unsigned int flags = dev_get_flags(dev);

		if (flags & (IFF_RUNNING | IFF_LOWER_UP))
			nh_flags |= RTNH_F_LINKDOWN;
	}

L
Linus Torvalds 已提交
1631 1632 1633 1634 1635
	prev_fi = NULL;
	hash = fib_devindex_hashfn(dev->ifindex);
	head = &fib_info_devhash[hash];
	ret = 0;

1636
	hlist_for_each_entry(nh, head, nh_hash) {
L
Linus Torvalds 已提交
1637 1638 1639 1640 1641 1642 1643 1644 1645 1646
		struct fib_info *fi = nh->nh_parent;
		int alive;

		BUG_ON(!fi->fib_nhs);
		if (nh->nh_dev != dev || fi == prev_fi)
			continue;

		prev_fi = fi;
		alive = 0;
		change_nexthops(fi) {
1647
			if (!(nexthop_nh->nh_flags & nh_flags)) {
L
Linus Torvalds 已提交
1648 1649 1650
				alive++;
				continue;
			}
1651
			if (!nexthop_nh->nh_dev ||
E
Eric Dumazet 已提交
1652
			    !(nexthop_nh->nh_dev->flags & IFF_UP))
L
Linus Torvalds 已提交
1653
				continue;
1654 1655
			if (nexthop_nh->nh_dev != dev ||
			    !__in_dev_get_rtnl(dev))
L
Linus Torvalds 已提交
1656 1657
				continue;
			alive++;
1658
			nexthop_nh->nh_flags &= ~nh_flags;
1659
			call_fib_nh_notifiers(nexthop_nh, FIB_EVENT_NH_ADD);
L
Linus Torvalds 已提交
1660 1661 1662
		} endfor_nexthops(fi)

		if (alive > 0) {
1663
			fi->fib_flags &= ~nh_flags;
L
Linus Torvalds 已提交
1664 1665
			ret++;
		}
P
Peter Nørlund 已提交
1666 1667

		fib_rebalance(fi);
L
Linus Torvalds 已提交
1668 1669 1670 1671 1672
	}

	return ret;
}

1673
#ifdef CONFIG_IP_ROUTE_MULTIPATH
1674 1675 1676 1677 1678 1679 1680 1681 1682
static bool fib_good_nh(const struct fib_nh *nh)
{
	int state = NUD_REACHABLE;

	if (nh->nh_scope == RT_SCOPE_LINK) {
		struct neighbour *n;

		rcu_read_lock_bh();

1683 1684
		n = __ipv4_neigh_lookup_noref(nh->nh_dev,
					      (__force u32)nh->nh_gw);
1685 1686 1687 1688 1689 1690 1691 1692
		if (n)
			state = n->nud_state;

		rcu_read_unlock_bh();
	}

	return !!(state & NUD_VALID);
}
1693

P
Peter Nørlund 已提交
1694
void fib_select_multipath(struct fib_result *res, int hash)
L
Linus Torvalds 已提交
1695 1696
{
	struct fib_info *fi = res->fi;
1697 1698
	struct net *net = fi->fib_net;
	bool first = false;
L
Linus Torvalds 已提交
1699

P
Peter Nørlund 已提交
1700 1701 1702
	for_nexthops(fi) {
		if (hash > atomic_read(&nh->nh_upper_bound))
			continue;
L
Linus Torvalds 已提交
1703

1704 1705 1706 1707 1708 1709 1710 1711 1712
		if (!net->ipv4.sysctl_fib_multipath_use_neigh ||
		    fib_good_nh(nh)) {
			res->nh_sel = nhsel;
			return;
		}
		if (!first) {
			res->nh_sel = nhsel;
			first = true;
		}
L
Linus Torvalds 已提交
1713 1714 1715
	} endfor_nexthops(fi);
}
#endif
1716 1717

void fib_select_path(struct net *net, struct fib_result *res,
1718
		     struct flowi4 *fl4, const struct sk_buff *skb)
1719
{
1720 1721 1722 1723 1724
	bool oif_check;

	oif_check = (fl4->flowi4_oif == 0 ||
		     fl4->flowi4_flags & FLOWI_FLAG_SKIP_NH_OIF);

1725
#ifdef CONFIG_IP_ROUTE_MULTIPATH
1726
	if (res->fi->fib_nhs > 1 && oif_check) {
1727
		int h = fib_multipath_hash(res->fi, fl4, skb);
1728

1729
		fib_select_multipath(res, h);
1730 1731 1732 1733 1734
	}
	else
#endif
	if (!res->prefixlen &&
	    res->table->tb_num_default > 1 &&
1735
	    res->type == RTN_UNICAST && oif_check)
1736 1737 1738 1739 1740 1741
		fib_select_default(fl4, res);

	if (!fl4->saddr)
		fl4->saddr = FIB_RES_PREFSRC(net, *res);
}
EXPORT_SYMBOL_GPL(fib_select_path);