xref: /linux/net/ipv4/fib_semantics.c (revision ca73b68aca4a242d71a86818789640ca3b53744a)
12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
21da177e4SLinus Torvalds /*
31da177e4SLinus Torvalds  * INET		An implementation of the TCP/IP protocol suite for the LINUX
41da177e4SLinus Torvalds  *		operating system.  INET is implemented using the  BSD Socket
51da177e4SLinus Torvalds  *		interface as the means of communication with the user level.
61da177e4SLinus Torvalds  *
71da177e4SLinus Torvalds  *		IPv4 Forwarding Information Base: semantics.
81da177e4SLinus Torvalds  *
91da177e4SLinus Torvalds  * Authors:	Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
101da177e4SLinus Torvalds  */
111da177e4SLinus Torvalds 
127c0f6ba6SLinus Torvalds #include <linux/uaccess.h>
131da177e4SLinus Torvalds #include <linux/bitops.h>
141da177e4SLinus Torvalds #include <linux/types.h>
151da177e4SLinus Torvalds #include <linux/kernel.h>
161da177e4SLinus Torvalds #include <linux/jiffies.h>
171da177e4SLinus Torvalds #include <linux/mm.h>
181da177e4SLinus Torvalds #include <linux/string.h>
191da177e4SLinus Torvalds #include <linux/socket.h>
201da177e4SLinus Torvalds #include <linux/sockios.h>
211da177e4SLinus Torvalds #include <linux/errno.h>
221da177e4SLinus Torvalds #include <linux/in.h>
231da177e4SLinus Torvalds #include <linux/inet.h>
2414c85021SArnaldo Carvalho de Melo #include <linux/inetdevice.h>
251da177e4SLinus Torvalds #include <linux/netdevice.h>
261da177e4SLinus Torvalds #include <linux/if_arp.h>
271da177e4SLinus Torvalds #include <linux/proc_fs.h>
281da177e4SLinus Torvalds #include <linux/skbuff.h>
291da177e4SLinus Torvalds #include <linux/init.h>
305a0e3ad6STejun Heo #include <linux/slab.h>
31c3ab2b4eSDavid Ahern #include <linux/netlink.h>
32d07418afSEric Dumazet #include <linux/hash.h>
331da177e4SLinus Torvalds 
3414c85021SArnaldo Carvalho de Melo #include <net/arp.h>
351da177e4SLinus Torvalds #include <net/ip.h>
361da177e4SLinus Torvalds #include <net/protocol.h>
371da177e4SLinus Torvalds #include <net/route.h>
381da177e4SLinus Torvalds #include <net/tcp.h>
391da177e4SLinus Torvalds #include <net/sock.h>
401da177e4SLinus Torvalds #include <net/ip_fib.h>
41717a8f5bSDavid Ahern #include <net/ip6_fib.h>
425481d73fSDavid Ahern #include <net/nexthop.h>
43f21c7bc5SThomas Graf #include <net/netlink.h>
443c618c1dSDavid Ahern #include <net/rtnh.h>
45571e7226SRoopa Prabhu #include <net/lwtunnel.h>
4604b1d4e5SIdo Schimmel #include <net/fib_notifier.h>
47c0a72077SDavid Ahern #include <net/addrconf.h>
481da177e4SLinus Torvalds 
491da177e4SLinus Torvalds #include "fib_lookup.h"
501da177e4SLinus Torvalds 
51832b4c5eSStephen Hemminger static DEFINE_SPINLOCK(fib_info_lock);
521da177e4SLinus Torvalds static struct hlist_head *fib_info_hash;
531da177e4SLinus Torvalds static struct hlist_head *fib_info_laddrhash;
54123b9731SDavid S. Miller static unsigned int fib_info_hash_size;
5579eb15daSEric Dumazet static unsigned int fib_info_hash_bits;
561da177e4SLinus Torvalds static unsigned int fib_info_cnt;
571da177e4SLinus Torvalds 
581da177e4SLinus Torvalds #define DEVINDEX_HASHBITS 8
591da177e4SLinus Torvalds #define DEVINDEX_HASHSIZE (1U << DEVINDEX_HASHBITS)
601da177e4SLinus Torvalds static struct hlist_head fib_info_devhash[DEVINDEX_HASHSIZE];
611da177e4SLinus Torvalds 
62dcb1ecb5SDavid Ahern /* for_nexthops and change_nexthops only used when nexthop object
63dcb1ecb5SDavid Ahern  * is not set in a fib_info. The logic within can reference fib_nh.
64dcb1ecb5SDavid Ahern  */
651da177e4SLinus Torvalds #ifdef CONFIG_IP_ROUTE_MULTIPATH
661da177e4SLinus Torvalds 
676a31d2a9SEric Dumazet #define for_nexthops(fi) {						\
686a31d2a9SEric Dumazet 	int nhsel; const struct fib_nh *nh;				\
696a31d2a9SEric Dumazet 	for (nhsel = 0, nh = (fi)->fib_nh;				\
705481d73fSDavid Ahern 	     nhsel < fib_info_num_path((fi));				\
716a31d2a9SEric Dumazet 	     nh++, nhsel++)
721da177e4SLinus Torvalds 
736a31d2a9SEric Dumazet #define change_nexthops(fi) {						\
746a31d2a9SEric Dumazet 	int nhsel; struct fib_nh *nexthop_nh;				\
756a31d2a9SEric Dumazet 	for (nhsel = 0,	nexthop_nh = (struct fib_nh *)((fi)->fib_nh);	\
765481d73fSDavid Ahern 	     nhsel < fib_info_num_path((fi));				\
776a31d2a9SEric Dumazet 	     nexthop_nh++, nhsel++)
781da177e4SLinus Torvalds 
791da177e4SLinus Torvalds #else /* CONFIG_IP_ROUTE_MULTIPATH */
801da177e4SLinus Torvalds 
811da177e4SLinus Torvalds /* Hope, that gcc will optimize it to get rid of dummy loop */
821da177e4SLinus Torvalds 
836a31d2a9SEric Dumazet #define for_nexthops(fi) {						\
846a31d2a9SEric Dumazet 	int nhsel; const struct fib_nh *nh = (fi)->fib_nh;		\
851da177e4SLinus Torvalds 	for (nhsel = 0; nhsel < 1; nhsel++)
861da177e4SLinus Torvalds 
876a31d2a9SEric Dumazet #define change_nexthops(fi) {						\
886a31d2a9SEric Dumazet 	int nhsel;							\
896a31d2a9SEric Dumazet 	struct fib_nh *nexthop_nh = (struct fib_nh *)((fi)->fib_nh);	\
901da177e4SLinus Torvalds 	for (nhsel = 0; nhsel < 1; nhsel++)
911da177e4SLinus Torvalds 
921da177e4SLinus Torvalds #endif /* CONFIG_IP_ROUTE_MULTIPATH */
931da177e4SLinus Torvalds 
941da177e4SLinus Torvalds #define endfor_nexthops(fi) }
951da177e4SLinus Torvalds 
961da177e4SLinus Torvalds 
973be0686bSDavid S. Miller const struct fib_prop fib_props[RTN_MAX + 1] = {
986a31d2a9SEric Dumazet 	[RTN_UNSPEC] = {
991da177e4SLinus Torvalds 		.error	= 0,
1001da177e4SLinus Torvalds 		.scope	= RT_SCOPE_NOWHERE,
1016a31d2a9SEric Dumazet 	},
1026a31d2a9SEric Dumazet 	[RTN_UNICAST] = {
1031da177e4SLinus Torvalds 		.error	= 0,
1041da177e4SLinus Torvalds 		.scope	= RT_SCOPE_UNIVERSE,
1056a31d2a9SEric Dumazet 	},
1066a31d2a9SEric Dumazet 	[RTN_LOCAL] = {
1071da177e4SLinus Torvalds 		.error	= 0,
1081da177e4SLinus Torvalds 		.scope	= RT_SCOPE_HOST,
1096a31d2a9SEric Dumazet 	},
1106a31d2a9SEric Dumazet 	[RTN_BROADCAST] = {
1111da177e4SLinus Torvalds 		.error	= 0,
1121da177e4SLinus Torvalds 		.scope	= RT_SCOPE_LINK,
1136a31d2a9SEric Dumazet 	},
1146a31d2a9SEric Dumazet 	[RTN_ANYCAST] = {
1151da177e4SLinus Torvalds 		.error	= 0,
1161da177e4SLinus Torvalds 		.scope	= RT_SCOPE_LINK,
1176a31d2a9SEric Dumazet 	},
1186a31d2a9SEric Dumazet 	[RTN_MULTICAST] = {
1191da177e4SLinus Torvalds 		.error	= 0,
1201da177e4SLinus Torvalds 		.scope	= RT_SCOPE_UNIVERSE,
1216a31d2a9SEric Dumazet 	},
1226a31d2a9SEric Dumazet 	[RTN_BLACKHOLE] = {
1231da177e4SLinus Torvalds 		.error	= -EINVAL,
1241da177e4SLinus Torvalds 		.scope	= RT_SCOPE_UNIVERSE,
1256a31d2a9SEric Dumazet 	},
1266a31d2a9SEric Dumazet 	[RTN_UNREACHABLE] = {
1271da177e4SLinus Torvalds 		.error	= -EHOSTUNREACH,
1281da177e4SLinus Torvalds 		.scope	= RT_SCOPE_UNIVERSE,
1296a31d2a9SEric Dumazet 	},
1306a31d2a9SEric Dumazet 	[RTN_PROHIBIT] = {
1311da177e4SLinus Torvalds 		.error	= -EACCES,
1321da177e4SLinus Torvalds 		.scope	= RT_SCOPE_UNIVERSE,
1336a31d2a9SEric Dumazet 	},
1346a31d2a9SEric Dumazet 	[RTN_THROW] = {
1351da177e4SLinus Torvalds 		.error	= -EAGAIN,
1361da177e4SLinus Torvalds 		.scope	= RT_SCOPE_UNIVERSE,
1376a31d2a9SEric Dumazet 	},
1386a31d2a9SEric Dumazet 	[RTN_NAT] = {
1391da177e4SLinus Torvalds 		.error	= -EINVAL,
1401da177e4SLinus Torvalds 		.scope	= RT_SCOPE_NOWHERE,
1416a31d2a9SEric Dumazet 	},
1426a31d2a9SEric Dumazet 	[RTN_XRESOLVE] = {
1431da177e4SLinus Torvalds 		.error	= -EINVAL,
1441da177e4SLinus Torvalds 		.scope	= RT_SCOPE_NOWHERE,
1456a31d2a9SEric Dumazet 	},
1461da177e4SLinus Torvalds };
1471da177e4SLinus Torvalds 
148c5038a83SDavid S. Miller static void rt_fibinfo_free(struct rtable __rcu **rtp)
14954764bb6SEric Dumazet {
15054764bb6SEric Dumazet 	struct rtable *rt = rcu_dereference_protected(*rtp, 1);
15154764bb6SEric Dumazet 
15254764bb6SEric Dumazet 	if (!rt)
15354764bb6SEric Dumazet 		return;
15454764bb6SEric Dumazet 
15554764bb6SEric Dumazet 	/* Not even needed : RCU_INIT_POINTER(*rtp, NULL);
15654764bb6SEric Dumazet 	 * because we waited an RCU grace period before calling
15754764bb6SEric Dumazet 	 * free_fib_info_rcu()
15854764bb6SEric Dumazet 	 */
15954764bb6SEric Dumazet 
16095c47f9cSWei Wang 	dst_dev_put(&rt->dst);
161b838d5e1SWei Wang 	dst_release_immediate(&rt->dst);
16254764bb6SEric Dumazet }
16354764bb6SEric Dumazet 
164a5995e71SDavid Ahern static void free_nh_exceptions(struct fib_nh_common *nhc)
165c5038a83SDavid S. Miller {
166caa41527SEric Dumazet 	struct fnhe_hash_bucket *hash;
167c5038a83SDavid S. Miller 	int i;
168c5038a83SDavid S. Miller 
169a5995e71SDavid Ahern 	hash = rcu_dereference_protected(nhc->nhc_exceptions, 1);
170caa41527SEric Dumazet 	if (!hash)
171caa41527SEric Dumazet 		return;
172c5038a83SDavid S. Miller 	for (i = 0; i < FNHE_HASH_SIZE; i++) {
173c5038a83SDavid S. Miller 		struct fib_nh_exception *fnhe;
174c5038a83SDavid S. Miller 
175c5038a83SDavid S. Miller 		fnhe = rcu_dereference_protected(hash[i].chain, 1);
176c5038a83SDavid S. Miller 		while (fnhe) {
177c5038a83SDavid S. Miller 			struct fib_nh_exception *next;
178c5038a83SDavid S. Miller 
179c5038a83SDavid S. Miller 			next = rcu_dereference_protected(fnhe->fnhe_next, 1);
180c5038a83SDavid S. Miller 
1812ffae99dSTimo Teräs 			rt_fibinfo_free(&fnhe->fnhe_rth_input);
1822ffae99dSTimo Teräs 			rt_fibinfo_free(&fnhe->fnhe_rth_output);
183c5038a83SDavid S. Miller 
184c5038a83SDavid S. Miller 			kfree(fnhe);
185c5038a83SDavid S. Miller 
186c5038a83SDavid S. Miller 			fnhe = next;
187c5038a83SDavid S. Miller 		}
188c5038a83SDavid S. Miller 	}
189c5038a83SDavid S. Miller 	kfree(hash);
190c5038a83SDavid S. Miller }
191c5038a83SDavid S. Miller 
192c5038a83SDavid S. Miller static void rt_fibinfo_free_cpus(struct rtable __rcu * __percpu *rtp)
193d26b3a7cSEric Dumazet {
194d26b3a7cSEric Dumazet 	int cpu;
195d26b3a7cSEric Dumazet 
196d26b3a7cSEric Dumazet 	if (!rtp)
197d26b3a7cSEric Dumazet 		return;
198d26b3a7cSEric Dumazet 
199d26b3a7cSEric Dumazet 	for_each_possible_cpu(cpu) {
200d26b3a7cSEric Dumazet 		struct rtable *rt;
201d26b3a7cSEric Dumazet 
202d26b3a7cSEric Dumazet 		rt = rcu_dereference_protected(*per_cpu_ptr(rtp, cpu), 1);
2030830106cSWei Wang 		if (rt) {
20495c47f9cSWei Wang 			dst_dev_put(&rt->dst);
205b838d5e1SWei Wang 			dst_release_immediate(&rt->dst);
206d26b3a7cSEric Dumazet 		}
2070830106cSWei Wang 	}
208d26b3a7cSEric Dumazet 	free_percpu(rtp);
209d26b3a7cSEric Dumazet }
210d26b3a7cSEric Dumazet 
211979e276eSDavid Ahern void fib_nh_common_release(struct fib_nh_common *nhc)
212979e276eSDavid Ahern {
213e44b14ebSEric Dumazet 	dev_put_track(nhc->nhc_dev, &nhc->nhc_dev_tracker);
214979e276eSDavid Ahern 	lwtstate_put(nhc->nhc_lwtstate);
2150f457a36SDavid Ahern 	rt_fibinfo_free_cpus(nhc->nhc_pcpu_rth_output);
2160f457a36SDavid Ahern 	rt_fibinfo_free(&nhc->nhc_rth_input);
217a5995e71SDavid Ahern 	free_nh_exceptions(nhc);
218979e276eSDavid Ahern }
219979e276eSDavid Ahern EXPORT_SYMBOL_GPL(fib_nh_common_release);
220979e276eSDavid Ahern 
221faa041a4SDavid Ahern void fib_nh_release(struct net *net, struct fib_nh *fib_nh)
222faa041a4SDavid Ahern {
223faa041a4SDavid Ahern #ifdef CONFIG_IP_ROUTE_CLASSID
224faa041a4SDavid Ahern 	if (fib_nh->nh_tclassid)
225213f5f8fSEric Dumazet 		atomic_dec(&net->ipv4.fib_num_tclassid_users);
226faa041a4SDavid Ahern #endif
227979e276eSDavid Ahern 	fib_nh_common_release(&fib_nh->nh_common);
228faa041a4SDavid Ahern }
229faa041a4SDavid Ahern 
2301da177e4SLinus Torvalds /* Release a nexthop info record */
23119c1ea14SYan, Zheng static void free_fib_info_rcu(struct rcu_head *head)
23219c1ea14SYan, Zheng {
23319c1ea14SYan, Zheng 	struct fib_info *fi = container_of(head, struct fib_info, rcu);
23419c1ea14SYan, Zheng 
2354c7e8084SDavid Ahern 	if (fi->nh) {
2364c7e8084SDavid Ahern 		nexthop_put(fi->nh);
2374c7e8084SDavid Ahern 	} else {
238e49cc0daSYanmin Zhang 		change_nexthops(fi) {
239faa041a4SDavid Ahern 			fib_nh_release(fi->fib_net, nexthop_nh);
240e49cc0daSYanmin Zhang 		} endfor_nexthops(fi);
2414c7e8084SDavid Ahern 	}
242e49cc0daSYanmin Zhang 
243cc5f0eb2SDavid Ahern 	ip_fib_metrics_put(fi->fib_metrics);
244cc5f0eb2SDavid Ahern 
24519c1ea14SYan, Zheng 	kfree(fi);
24619c1ea14SYan, Zheng }
2471da177e4SLinus Torvalds 
2481da177e4SLinus Torvalds void free_fib_info(struct fib_info *fi)
2491da177e4SLinus Torvalds {
2501da177e4SLinus Torvalds 	if (fi->fib_dead == 0) {
251058bd4d2SJoe Perches 		pr_warn("Freeing alive fib_info %p\n", fi);
2521da177e4SLinus Torvalds 		return;
2531da177e4SLinus Torvalds 	}
254faa041a4SDavid Ahern 
25519c1ea14SYan, Zheng 	call_rcu(&fi->rcu, free_fib_info_rcu);
2561da177e4SLinus Torvalds }
257b423cb10SIdo Schimmel EXPORT_SYMBOL_GPL(free_fib_info);
2581da177e4SLinus Torvalds 
2591da177e4SLinus Torvalds void fib_release_info(struct fib_info *fi)
2601da177e4SLinus Torvalds {
261832b4c5eSStephen Hemminger 	spin_lock_bh(&fib_info_lock);
26279976892SYajun Deng 	if (fi && refcount_dec_and_test(&fi->fib_treeref)) {
2631da177e4SLinus Torvalds 		hlist_del(&fi->fib_hash);
2640a6e6b3cSEric Dumazet 
2650a6e6b3cSEric Dumazet 		/* Paired with READ_ONCE() in fib_create_info(). */
2660a6e6b3cSEric Dumazet 		WRITE_ONCE(fib_info_cnt, fib_info_cnt - 1);
2670a6e6b3cSEric Dumazet 
2681da177e4SLinus Torvalds 		if (fi->fib_prefsrc)
2691da177e4SLinus Torvalds 			hlist_del(&fi->fib_lhash);
2704c7e8084SDavid Ahern 		if (fi->nh) {
2714c7e8084SDavid Ahern 			list_del(&fi->nh_list);
2724c7e8084SDavid Ahern 		} else {
2731da177e4SLinus Torvalds 			change_nexthops(fi) {
274b75ed8b1SDavid Ahern 				if (!nexthop_nh->fib_nh_dev)
2751da177e4SLinus Torvalds 					continue;
27671fceff0SDavid S. Miller 				hlist_del(&nexthop_nh->nh_hash);
2771da177e4SLinus Torvalds 			} endfor_nexthops(fi)
2784c7e8084SDavid Ahern 		}
2791da177e4SLinus Torvalds 		fi->fib_dead = 1;
2801da177e4SLinus Torvalds 		fib_info_put(fi);
2811da177e4SLinus Torvalds 	}
282832b4c5eSStephen Hemminger 	spin_unlock_bh(&fib_info_lock);
2831da177e4SLinus Torvalds }
2841da177e4SLinus Torvalds 
2855481d73fSDavid Ahern static inline int nh_comp(struct fib_info *fi, struct fib_info *ofi)
2861da177e4SLinus Torvalds {
2875481d73fSDavid Ahern 	const struct fib_nh *onh;
2881da177e4SLinus Torvalds 
2894c7e8084SDavid Ahern 	if (fi->nh || ofi->nh)
2904c7e8084SDavid Ahern 		return nexthop_cmp(fi->nh, ofi->nh) ? 0 : -1;
2914c7e8084SDavid Ahern 
2924c7e8084SDavid Ahern 	if (ofi->fib_nhs == 0)
2934c7e8084SDavid Ahern 		return 0;
2944c7e8084SDavid Ahern 
2951da177e4SLinus Torvalds 	for_nexthops(fi) {
2965481d73fSDavid Ahern 		onh = fib_info_nh(ofi, nhsel);
2975481d73fSDavid Ahern 
298b75ed8b1SDavid Ahern 		if (nh->fib_nh_oif != onh->fib_nh_oif ||
299a4ea5d43SDavid Ahern 		    nh->fib_nh_gw_family != onh->fib_nh_gw_family ||
300b75ed8b1SDavid Ahern 		    nh->fib_nh_scope != onh->fib_nh_scope ||
3011da177e4SLinus Torvalds #ifdef CONFIG_IP_ROUTE_MULTIPATH
302b75ed8b1SDavid Ahern 		    nh->fib_nh_weight != onh->fib_nh_weight ||
3031da177e4SLinus Torvalds #endif
304c7066f70SPatrick McHardy #ifdef CONFIG_IP_ROUTE_CLASSID
3051da177e4SLinus Torvalds 		    nh->nh_tclassid != onh->nh_tclassid ||
3061da177e4SLinus Torvalds #endif
307b75ed8b1SDavid Ahern 		    lwtunnel_cmp_encap(nh->fib_nh_lws, onh->fib_nh_lws) ||
308b75ed8b1SDavid Ahern 		    ((nh->fib_nh_flags ^ onh->fib_nh_flags) & ~RTNH_COMPARE_MASK))
3091da177e4SLinus Torvalds 			return -1;
310a4ea5d43SDavid Ahern 
311a4ea5d43SDavid Ahern 		if (nh->fib_nh_gw_family == AF_INET &&
312a4ea5d43SDavid Ahern 		    nh->fib_nh_gw4 != onh->fib_nh_gw4)
313a4ea5d43SDavid Ahern 			return -1;
314a4ea5d43SDavid Ahern 
315a4ea5d43SDavid Ahern 		if (nh->fib_nh_gw_family == AF_INET6 &&
316a4ea5d43SDavid Ahern 		    ipv6_addr_cmp(&nh->fib_nh_gw6, &onh->fib_nh_gw6))
317a4ea5d43SDavid Ahern 			return -1;
3181da177e4SLinus Torvalds 	} endfor_nexthops(fi);
3191da177e4SLinus Torvalds 	return 0;
3201da177e4SLinus Torvalds }
3211da177e4SLinus Torvalds 
32288ebc72fSDavid S. Miller static inline unsigned int fib_devindex_hashfn(unsigned int val)
32388ebc72fSDavid S. Miller {
324d07418afSEric Dumazet 	return hash_32(val, DEVINDEX_HASHBITS);
325d07418afSEric Dumazet }
32688ebc72fSDavid S. Miller 
327d07418afSEric Dumazet static struct hlist_head *
328d07418afSEric Dumazet fib_info_devhash_bucket(const struct net_device *dev)
329d07418afSEric Dumazet {
330d07418afSEric Dumazet 	u32 val = net_hash_mix(dev_net(dev)) ^ dev->ifindex;
331d07418afSEric Dumazet 
332d07418afSEric Dumazet 	return &fib_info_devhash[fib_devindex_hashfn(val)];
33388ebc72fSDavid S. Miller }
33488ebc72fSDavid S. Miller 
3356c48ea5fSDavid Ahern static unsigned int fib_info_hashfn_1(int init_val, u8 protocol, u8 scope,
3366c48ea5fSDavid Ahern 				      u32 prefsrc, u32 priority)
3376c48ea5fSDavid Ahern {
3386c48ea5fSDavid Ahern 	unsigned int val = init_val;
3396c48ea5fSDavid Ahern 
3406c48ea5fSDavid Ahern 	val ^= (protocol << 8) | scope;
3416c48ea5fSDavid Ahern 	val ^= prefsrc;
3426c48ea5fSDavid Ahern 	val ^= priority;
3436c48ea5fSDavid Ahern 
3446c48ea5fSDavid Ahern 	return val;
3456c48ea5fSDavid Ahern }
3466c48ea5fSDavid Ahern 
3476c48ea5fSDavid Ahern static unsigned int fib_info_hashfn_result(unsigned int val)
3481da177e4SLinus Torvalds {
349123b9731SDavid S. Miller 	unsigned int mask = (fib_info_hash_size - 1);
3501da177e4SLinus Torvalds 
3516c48ea5fSDavid Ahern 	return (val ^ (val >> 7) ^ (val >> 12)) & mask;
3526c48ea5fSDavid Ahern }
3536c48ea5fSDavid Ahern 
3546c48ea5fSDavid Ahern static inline unsigned int fib_info_hashfn(struct fib_info *fi)
3556c48ea5fSDavid Ahern {
3566c48ea5fSDavid Ahern 	unsigned int val;
3576c48ea5fSDavid Ahern 
3586c48ea5fSDavid Ahern 	val = fib_info_hashfn_1(fi->fib_nhs, fi->fib_protocol,
3596c48ea5fSDavid Ahern 				fi->fib_scope, (__force u32)fi->fib_prefsrc,
3606c48ea5fSDavid Ahern 				fi->fib_priority);
3614c7e8084SDavid Ahern 
3624c7e8084SDavid Ahern 	if (fi->nh) {
3634c7e8084SDavid Ahern 		val ^= fib_devindex_hashfn(fi->nh->id);
3644c7e8084SDavid Ahern 	} else {
36588ebc72fSDavid S. Miller 		for_nexthops(fi) {
366b75ed8b1SDavid Ahern 			val ^= fib_devindex_hashfn(nh->fib_nh_oif);
36788ebc72fSDavid S. Miller 		} endfor_nexthops(fi)
3684c7e8084SDavid Ahern 	}
3691da177e4SLinus Torvalds 
3706c48ea5fSDavid Ahern 	return fib_info_hashfn_result(val);
3716c48ea5fSDavid Ahern }
3726c48ea5fSDavid Ahern 
3736c48ea5fSDavid Ahern /* no metrics, only nexthop id */
3746c48ea5fSDavid Ahern static struct fib_info *fib_find_info_nh(struct net *net,
3756c48ea5fSDavid Ahern 					 const struct fib_config *cfg)
3766c48ea5fSDavid Ahern {
3776c48ea5fSDavid Ahern 	struct hlist_head *head;
3786c48ea5fSDavid Ahern 	struct fib_info *fi;
3796c48ea5fSDavid Ahern 	unsigned int hash;
3806c48ea5fSDavid Ahern 
3816c48ea5fSDavid Ahern 	hash = fib_info_hashfn_1(fib_devindex_hashfn(cfg->fc_nh_id),
3826c48ea5fSDavid Ahern 				 cfg->fc_protocol, cfg->fc_scope,
3836c48ea5fSDavid Ahern 				 (__force u32)cfg->fc_prefsrc,
3846c48ea5fSDavid Ahern 				 cfg->fc_priority);
3856c48ea5fSDavid Ahern 	hash = fib_info_hashfn_result(hash);
3866c48ea5fSDavid Ahern 	head = &fib_info_hash[hash];
3876c48ea5fSDavid Ahern 
3886c48ea5fSDavid Ahern 	hlist_for_each_entry(fi, head, fib_hash) {
3896c48ea5fSDavid Ahern 		if (!net_eq(fi->fib_net, net))
3906c48ea5fSDavid Ahern 			continue;
3916c48ea5fSDavid Ahern 		if (!fi->nh || fi->nh->id != cfg->fc_nh_id)
3926c48ea5fSDavid Ahern 			continue;
3936c48ea5fSDavid Ahern 		if (cfg->fc_protocol == fi->fib_protocol &&
3946c48ea5fSDavid Ahern 		    cfg->fc_scope == fi->fib_scope &&
3956c48ea5fSDavid Ahern 		    cfg->fc_prefsrc == fi->fib_prefsrc &&
3966c48ea5fSDavid Ahern 		    cfg->fc_priority == fi->fib_priority &&
3976c48ea5fSDavid Ahern 		    cfg->fc_type == fi->fib_type &&
3986c48ea5fSDavid Ahern 		    cfg->fc_table == fi->fib_tb_id &&
3996c48ea5fSDavid Ahern 		    !((cfg->fc_flags ^ fi->fib_flags) & ~RTNH_COMPARE_MASK))
4006c48ea5fSDavid Ahern 			return fi;
4016c48ea5fSDavid Ahern 	}
4026c48ea5fSDavid Ahern 
4036c48ea5fSDavid Ahern 	return NULL;
4041da177e4SLinus Torvalds }
4051da177e4SLinus Torvalds 
4065481d73fSDavid Ahern static struct fib_info *fib_find_info(struct fib_info *nfi)
4071da177e4SLinus Torvalds {
4081da177e4SLinus Torvalds 	struct hlist_head *head;
4091da177e4SLinus Torvalds 	struct fib_info *fi;
4101da177e4SLinus Torvalds 	unsigned int hash;
4111da177e4SLinus Torvalds 
4121da177e4SLinus Torvalds 	hash = fib_info_hashfn(nfi);
4131da177e4SLinus Torvalds 	head = &fib_info_hash[hash];
4141da177e4SLinus Torvalds 
415b67bfe0dSSasha Levin 	hlist_for_each_entry(fi, head, fib_hash) {
41609ad9bc7SOctavian Purdila 		if (!net_eq(fi->fib_net, nfi->fib_net))
4174814bdbdSDenis V. Lunev 			continue;
4181da177e4SLinus Torvalds 		if (fi->fib_nhs != nfi->fib_nhs)
4191da177e4SLinus Torvalds 			continue;
4201da177e4SLinus Torvalds 		if (nfi->fib_protocol == fi->fib_protocol &&
42137e826c5SDavid S. Miller 		    nfi->fib_scope == fi->fib_scope &&
4221da177e4SLinus Torvalds 		    nfi->fib_prefsrc == fi->fib_prefsrc &&
4231da177e4SLinus Torvalds 		    nfi->fib_priority == fi->fib_priority &&
424f4ef85bbSEric Dumazet 		    nfi->fib_type == fi->fib_type &&
4251da177e4SLinus Torvalds 		    memcmp(nfi->fib_metrics, fi->fib_metrics,
426fcd13f42SEric Dumazet 			   sizeof(u32) * RTAX_MAX) == 0 &&
4278a3d0316SAndy Gospodarek 		    !((nfi->fib_flags ^ fi->fib_flags) & ~RTNH_COMPARE_MASK) &&
4284c7e8084SDavid Ahern 		    nh_comp(fi, nfi) == 0)
4291da177e4SLinus Torvalds 			return fi;
4301da177e4SLinus Torvalds 	}
4311da177e4SLinus Torvalds 
4321da177e4SLinus Torvalds 	return NULL;
4331da177e4SLinus Torvalds }
4341da177e4SLinus Torvalds 
4351da177e4SLinus Torvalds /* Check, that the gateway is already configured.
4366a31d2a9SEric Dumazet  * Used only by redirect accept routine.
4371da177e4SLinus Torvalds  */
438d878e72eSAl Viro int ip_fib_check_default(__be32 gw, struct net_device *dev)
4391da177e4SLinus Torvalds {
4401da177e4SLinus Torvalds 	struct hlist_head *head;
4411da177e4SLinus Torvalds 	struct fib_nh *nh;
4421da177e4SLinus Torvalds 
443832b4c5eSStephen Hemminger 	spin_lock(&fib_info_lock);
4441da177e4SLinus Torvalds 
445d07418afSEric Dumazet 	head = fib_info_devhash_bucket(dev);
446d07418afSEric Dumazet 
447b67bfe0dSSasha Levin 	hlist_for_each_entry(nh, head, nh_hash) {
448b75ed8b1SDavid Ahern 		if (nh->fib_nh_dev == dev &&
449b75ed8b1SDavid Ahern 		    nh->fib_nh_gw4 == gw &&
450b75ed8b1SDavid Ahern 		    !(nh->fib_nh_flags & RTNH_F_DEAD)) {
451832b4c5eSStephen Hemminger 			spin_unlock(&fib_info_lock);
4521da177e4SLinus Torvalds 			return 0;
4531da177e4SLinus Torvalds 		}
4541da177e4SLinus Torvalds 	}
4551da177e4SLinus Torvalds 
456832b4c5eSStephen Hemminger 	spin_unlock(&fib_info_lock);
4571da177e4SLinus Torvalds 
4581da177e4SLinus Torvalds 	return -1;
4591da177e4SLinus Torvalds }
4601da177e4SLinus Torvalds 
4611e7bdec6SAmit Cohen size_t fib_nlmsg_size(struct fib_info *fi)
462339bf98fSThomas Graf {
463339bf98fSThomas Graf 	size_t payload = NLMSG_ALIGN(sizeof(struct rtmsg))
464339bf98fSThomas Graf 			 + nla_total_size(4) /* RTA_TABLE */
465339bf98fSThomas Graf 			 + nla_total_size(4) /* RTA_DST */
466339bf98fSThomas Graf 			 + nla_total_size(4) /* RTA_PRIORITY */
467ea697639SDaniel Borkmann 			 + nla_total_size(4) /* RTA_PREFSRC */
468ea697639SDaniel Borkmann 			 + nla_total_size(TCP_CA_NAME_MAX); /* RTAX_CC_ALGO */
4695481d73fSDavid Ahern 	unsigned int nhs = fib_info_num_path(fi);
470339bf98fSThomas Graf 
471339bf98fSThomas Graf 	/* space for nested metrics */
472339bf98fSThomas Graf 	payload += nla_total_size((RTAX_MAX * nla_total_size(4)));
473339bf98fSThomas Graf 
4744c7e8084SDavid Ahern 	if (fi->nh)
4754c7e8084SDavid Ahern 		payload += nla_total_size(4); /* RTA_NH_ID */
4764c7e8084SDavid Ahern 
4775481d73fSDavid Ahern 	if (nhs) {
478571e7226SRoopa Prabhu 		size_t nh_encapsize = 0;
4795481d73fSDavid Ahern 		/* Also handles the special case nhs == 1 */
480339bf98fSThomas Graf 
481339bf98fSThomas Graf 		/* each nexthop is packed in an attribute */
482339bf98fSThomas Graf 		size_t nhsize = nla_total_size(sizeof(struct rtnexthop));
483dcb1ecb5SDavid Ahern 		unsigned int i;
484339bf98fSThomas Graf 
485339bf98fSThomas Graf 		/* may contain flow and gateway attribute */
486339bf98fSThomas Graf 		nhsize += 2 * nla_total_size(4);
487339bf98fSThomas Graf 
488571e7226SRoopa Prabhu 		/* grab encap info */
489dcb1ecb5SDavid Ahern 		for (i = 0; i < fib_info_num_path(fi); i++) {
490dcb1ecb5SDavid Ahern 			struct fib_nh_common *nhc = fib_info_nhc(fi, i);
491dcb1ecb5SDavid Ahern 
492dcb1ecb5SDavid Ahern 			if (nhc->nhc_lwtstate) {
493571e7226SRoopa Prabhu 				/* RTA_ENCAP_TYPE */
494571e7226SRoopa Prabhu 				nh_encapsize += lwtunnel_get_encap_size(
495dcb1ecb5SDavid Ahern 						nhc->nhc_lwtstate);
496571e7226SRoopa Prabhu 				/* RTA_ENCAP */
497571e7226SRoopa Prabhu 				nh_encapsize +=  nla_total_size(2);
498571e7226SRoopa Prabhu 			}
499dcb1ecb5SDavid Ahern 		}
500571e7226SRoopa Prabhu 
501339bf98fSThomas Graf 		/* all nexthops are packed in a nested attribute */
5025481d73fSDavid Ahern 		payload += nla_total_size((nhs * nhsize) + nh_encapsize);
503571e7226SRoopa Prabhu 
504339bf98fSThomas Graf 	}
505339bf98fSThomas Graf 
506339bf98fSThomas Graf 	return payload;
507339bf98fSThomas Graf }
508339bf98fSThomas Graf 
50981f7bf6cSAl Viro void rtmsg_fib(int event, __be32 key, struct fib_alias *fa,
5109877b253SJoe Perches 	       int dst_len, u32 tb_id, const struct nl_info *info,
511b8f55831SMilan Kocian 	       unsigned int nlm_flags)
5121da177e4SLinus Torvalds {
5131e301fd0SIdo Schimmel 	struct fib_rt_info fri;
5141da177e4SLinus Torvalds 	struct sk_buff *skb;
5154e902c57SThomas Graf 	u32 seq = info->nlh ? info->nlh->nlmsg_seq : 0;
516f21c7bc5SThomas Graf 	int err = -ENOBUFS;
5171da177e4SLinus Torvalds 
518339bf98fSThomas Graf 	skb = nlmsg_new(fib_nlmsg_size(fa->fa_info), GFP_KERNEL);
51951456b29SIan Morris 	if (!skb)
520f21c7bc5SThomas Graf 		goto errout;
5211da177e4SLinus Torvalds 
5221e301fd0SIdo Schimmel 	fri.fi = fa->fa_info;
5231e301fd0SIdo Schimmel 	fri.tb_id = tb_id;
5241e301fd0SIdo Schimmel 	fri.dst = key;
5251e301fd0SIdo Schimmel 	fri.dst_len = dst_len;
5261e301fd0SIdo Schimmel 	fri.tos = fa->fa_tos;
5271e301fd0SIdo Schimmel 	fri.type = fa->fa_type;
52890b93f1bSIdo Schimmel 	fri.offload = fa->offload;
52990b93f1bSIdo Schimmel 	fri.trap = fa->trap;
53036c5100eSAmit Cohen 	fri.offload_failed = fa->offload_failed;
5311e301fd0SIdo Schimmel 	err = fib_dump_info(skb, info->portid, seq, event, &fri, nlm_flags);
53226932566SPatrick McHardy 	if (err < 0) {
53326932566SPatrick McHardy 		/* -EMSGSIZE implies BUG in fib_nlmsg_size() */
53426932566SPatrick McHardy 		WARN_ON(err == -EMSGSIZE);
53526932566SPatrick McHardy 		kfree_skb(skb);
53626932566SPatrick McHardy 		goto errout;
53726932566SPatrick McHardy 	}
53815e47304SEric W. Biederman 	rtnl_notify(skb, info->nl_net, info->portid, RTNLGRP_IPV4_ROUTE,
5394e902c57SThomas Graf 		    info->nlh, GFP_KERNEL);
5401ce85fe4SPablo Neira Ayuso 	return;
541f21c7bc5SThomas Graf errout:
542f21c7bc5SThomas Graf 	if (err < 0)
5434d1169c1SDenis V. Lunev 		rtnl_set_sk_err(info->nl_net, RTNLGRP_IPV4_ROUTE, err);
5441da177e4SLinus Torvalds }
5451da177e4SLinus Torvalds 
546c9cb6b6eSStephen Hemminger static int fib_detect_death(struct fib_info *fi, int order,
547c9cb6b6eSStephen Hemminger 			    struct fib_info **last_resort, int *last_idx,
548c9cb6b6eSStephen Hemminger 			    int dflt)
5491da177e4SLinus Torvalds {
550619d1826SDavid Ahern 	const struct fib_nh_common *nhc = fib_info_nhc(fi, 0);
5511da177e4SLinus Torvalds 	struct neighbour *n;
5521da177e4SLinus Torvalds 	int state = NUD_NONE;
5531da177e4SLinus Torvalds 
554619d1826SDavid Ahern 	if (likely(nhc->nhc_gw_family == AF_INET))
555619d1826SDavid Ahern 		n = neigh_lookup(&arp_tbl, &nhc->nhc_gw.ipv4, nhc->nhc_dev);
556619d1826SDavid Ahern 	else if (nhc->nhc_gw_family == AF_INET6)
557619d1826SDavid Ahern 		n = neigh_lookup(ipv6_stub->nd_tbl, &nhc->nhc_gw.ipv6,
558619d1826SDavid Ahern 				 nhc->nhc_dev);
559619d1826SDavid Ahern 	else
560619d1826SDavid Ahern 		n = NULL;
561619d1826SDavid Ahern 
5621da177e4SLinus Torvalds 	if (n) {
5631da177e4SLinus Torvalds 		state = n->nud_state;
5641da177e4SLinus Torvalds 		neigh_release(n);
56588f64320SJulian Anastasov 	} else {
56688f64320SJulian Anastasov 		return 0;
5671da177e4SLinus Torvalds 	}
5681da177e4SLinus Torvalds 	if (state == NUD_REACHABLE)
5691da177e4SLinus Torvalds 		return 0;
570c17860a0SDenis V. Lunev 	if ((state & NUD_VALID) && order != dflt)
5711da177e4SLinus Torvalds 		return 0;
5721da177e4SLinus Torvalds 	if ((state & NUD_VALID) ||
57388f64320SJulian Anastasov 	    (*last_idx < 0 && order > dflt && state != NUD_INCOMPLETE)) {
5741da177e4SLinus Torvalds 		*last_resort = fi;
5751da177e4SLinus Torvalds 		*last_idx = order;
5761da177e4SLinus Torvalds 	}
5771da177e4SLinus Torvalds 	return 1;
5781da177e4SLinus Torvalds }
5791da177e4SLinus Torvalds 
580faee6769SAlexander Aring int fib_nh_common_init(struct net *net, struct fib_nh_common *nhc,
581faee6769SAlexander Aring 		       struct nlattr *encap, u16 encap_type,
582faee6769SAlexander Aring 		       void *cfg, gfp_t gfp_flags,
583979e276eSDavid Ahern 		       struct netlink_ext_ack *extack)
584979e276eSDavid Ahern {
5850f457a36SDavid Ahern 	int err;
5860f457a36SDavid Ahern 
5870f457a36SDavid Ahern 	nhc->nhc_pcpu_rth_output = alloc_percpu_gfp(struct rtable __rcu *,
5880f457a36SDavid Ahern 						    gfp_flags);
5890f457a36SDavid Ahern 	if (!nhc->nhc_pcpu_rth_output)
5900f457a36SDavid Ahern 		return -ENOMEM;
5910f457a36SDavid Ahern 
592979e276eSDavid Ahern 	if (encap) {
593979e276eSDavid Ahern 		struct lwtunnel_state *lwtstate;
594979e276eSDavid Ahern 
595979e276eSDavid Ahern 		if (encap_type == LWTUNNEL_ENCAP_NONE) {
596979e276eSDavid Ahern 			NL_SET_ERR_MSG(extack, "LWT encap type not specified");
5970f457a36SDavid Ahern 			err = -EINVAL;
5980f457a36SDavid Ahern 			goto lwt_failure;
599979e276eSDavid Ahern 		}
600faee6769SAlexander Aring 		err = lwtunnel_build_state(net, encap_type, encap,
601faee6769SAlexander Aring 					   nhc->nhc_family, cfg, &lwtstate,
602faee6769SAlexander Aring 					   extack);
603979e276eSDavid Ahern 		if (err)
6040f457a36SDavid Ahern 			goto lwt_failure;
605979e276eSDavid Ahern 
606979e276eSDavid Ahern 		nhc->nhc_lwtstate = lwtstate_get(lwtstate);
607979e276eSDavid Ahern 	}
608979e276eSDavid Ahern 
609979e276eSDavid Ahern 	return 0;
6100f457a36SDavid Ahern 
6110f457a36SDavid Ahern lwt_failure:
6120f457a36SDavid Ahern 	rt_fibinfo_free_cpus(nhc->nhc_pcpu_rth_output);
6130f457a36SDavid Ahern 	nhc->nhc_pcpu_rth_output = NULL;
6140f457a36SDavid Ahern 	return err;
615979e276eSDavid Ahern }
616979e276eSDavid Ahern EXPORT_SYMBOL_GPL(fib_nh_common_init);
617979e276eSDavid Ahern 
618e4516ef6SDavid Ahern int fib_nh_init(struct net *net, struct fib_nh *nh,
619e4516ef6SDavid Ahern 		struct fib_config *cfg, int nh_weight,
620e4516ef6SDavid Ahern 		struct netlink_ext_ack *extack)
621e4516ef6SDavid Ahern {
6220f457a36SDavid Ahern 	int err;
623e4516ef6SDavid Ahern 
624f1741730SDavid Ahern 	nh->fib_nh_family = AF_INET;
625f1741730SDavid Ahern 
626faee6769SAlexander Aring 	err = fib_nh_common_init(net, &nh->nh_common, cfg->fc_encap,
627979e276eSDavid Ahern 				 cfg->fc_encap_type, cfg, GFP_KERNEL, extack);
628e4516ef6SDavid Ahern 	if (err)
6290f457a36SDavid Ahern 		return err;
630e4516ef6SDavid Ahern 
631b75ed8b1SDavid Ahern 	nh->fib_nh_oif = cfg->fc_oif;
632a4ea5d43SDavid Ahern 	nh->fib_nh_gw_family = cfg->fc_gw_family;
633a4ea5d43SDavid Ahern 	if (cfg->fc_gw_family == AF_INET)
634f35b794bSDavid Ahern 		nh->fib_nh_gw4 = cfg->fc_gw4;
635a4ea5d43SDavid Ahern 	else if (cfg->fc_gw_family == AF_INET6)
636a4ea5d43SDavid Ahern 		nh->fib_nh_gw6 = cfg->fc_gw6;
637a4ea5d43SDavid Ahern 
638b75ed8b1SDavid Ahern 	nh->fib_nh_flags = cfg->fc_flags;
639e4516ef6SDavid Ahern 
640e4516ef6SDavid Ahern #ifdef CONFIG_IP_ROUTE_CLASSID
641e4516ef6SDavid Ahern 	nh->nh_tclassid = cfg->fc_flow;
642e4516ef6SDavid Ahern 	if (nh->nh_tclassid)
643213f5f8fSEric Dumazet 		atomic_inc(&net->ipv4.fib_num_tclassid_users);
644e4516ef6SDavid Ahern #endif
645e4516ef6SDavid Ahern #ifdef CONFIG_IP_ROUTE_MULTIPATH
646b75ed8b1SDavid Ahern 	nh->fib_nh_weight = nh_weight;
647e4516ef6SDavid Ahern #endif
648e4516ef6SDavid Ahern 	return 0;
649e4516ef6SDavid Ahern }
650e4516ef6SDavid Ahern 
6511da177e4SLinus Torvalds #ifdef CONFIG_IP_ROUTE_MULTIPATH
6521da177e4SLinus Torvalds 
6536d8422a1SDavid Ahern static int fib_count_nexthops(struct rtnexthop *rtnh, int remaining,
6546d8422a1SDavid Ahern 			      struct netlink_ext_ack *extack)
6551da177e4SLinus Torvalds {
6561da177e4SLinus Torvalds 	int nhs = 0;
6571da177e4SLinus Torvalds 
6584e902c57SThomas Graf 	while (rtnh_ok(rtnh, remaining)) {
6591da177e4SLinus Torvalds 		nhs++;
6604e902c57SThomas Graf 		rtnh = rtnh_next(rtnh, &remaining);
6611da177e4SLinus Torvalds 	}
6621da177e4SLinus Torvalds 
6634e902c57SThomas Graf 	/* leftover implies invalid nexthop configuration, discard it */
664c3ab2b4eSDavid Ahern 	if (remaining > 0) {
665c3ab2b4eSDavid Ahern 		NL_SET_ERR_MSG(extack,
666c3ab2b4eSDavid Ahern 			       "Invalid nexthop configuration - extra data after nexthops");
667c3ab2b4eSDavid Ahern 		nhs = 0;
668c3ab2b4eSDavid Ahern 	}
669c3ab2b4eSDavid Ahern 
670c3ab2b4eSDavid Ahern 	return nhs;
6714e902c57SThomas Graf }
6721da177e4SLinus Torvalds 
6737a3429baSDavid Ahern static int fib_gw_from_attr(__be32 *gw, struct nlattr *nla,
6747a3429baSDavid Ahern 			    struct netlink_ext_ack *extack)
6757a3429baSDavid Ahern {
6767a3429baSDavid Ahern 	if (nla_len(nla) < sizeof(*gw)) {
6777a3429baSDavid Ahern 		NL_SET_ERR_MSG(extack, "Invalid IPv4 address in RTA_GATEWAY");
6787a3429baSDavid Ahern 		return -EINVAL;
6797a3429baSDavid Ahern 	}
6807a3429baSDavid Ahern 
6817a3429baSDavid Ahern 	*gw = nla_get_in_addr(nla);
6827a3429baSDavid Ahern 
6837a3429baSDavid Ahern 	return 0;
6847a3429baSDavid Ahern }
6857a3429baSDavid Ahern 
6864c7e8084SDavid Ahern /* only called when fib_nh is integrated into fib_info */
6874e902c57SThomas Graf static int fib_get_nhs(struct fib_info *fi, struct rtnexthop *rtnh,
6886d8422a1SDavid Ahern 		       int remaining, struct fib_config *cfg,
6896d8422a1SDavid Ahern 		       struct netlink_ext_ack *extack)
6904e902c57SThomas Graf {
691e4516ef6SDavid Ahern 	struct net *net = fi->fib_net;
692e4516ef6SDavid Ahern 	struct fib_config fib_cfg;
6935481d73fSDavid Ahern 	struct fib_nh *nh;
694571e7226SRoopa Prabhu 	int ret;
695571e7226SRoopa Prabhu 
6961da177e4SLinus Torvalds 	change_nexthops(fi) {
6974e902c57SThomas Graf 		int attrlen;
6984e902c57SThomas Graf 
699e4516ef6SDavid Ahern 		memset(&fib_cfg, 0, sizeof(fib_cfg));
700e4516ef6SDavid Ahern 
701c3ab2b4eSDavid Ahern 		if (!rtnh_ok(rtnh, remaining)) {
702c3ab2b4eSDavid Ahern 			NL_SET_ERR_MSG(extack,
703c3ab2b4eSDavid Ahern 				       "Invalid nexthop configuration - extra data after nexthop");
7041da177e4SLinus Torvalds 			return -EINVAL;
705c3ab2b4eSDavid Ahern 		}
7064e902c57SThomas Graf 
707c3ab2b4eSDavid Ahern 		if (rtnh->rtnh_flags & (RTNH_F_DEAD | RTNH_F_LINKDOWN)) {
708c3ab2b4eSDavid Ahern 			NL_SET_ERR_MSG(extack,
709c3ab2b4eSDavid Ahern 				       "Invalid flags for nexthop - can not contain DEAD or LINKDOWN");
71080610229SJulian Anastasov 			return -EINVAL;
711c3ab2b4eSDavid Ahern 		}
71280610229SJulian Anastasov 
713e4516ef6SDavid Ahern 		fib_cfg.fc_flags = (cfg->fc_flags & ~0xFF) | rtnh->rtnh_flags;
714e4516ef6SDavid Ahern 		fib_cfg.fc_oif = rtnh->rtnh_ifindex;
7154e902c57SThomas Graf 
7164e902c57SThomas Graf 		attrlen = rtnh_attrlen(rtnh);
7174e902c57SThomas Graf 		if (attrlen > 0) {
718d1566268SDavid Ahern 			struct nlattr *nla, *nlav, *attrs = rtnh_attrs(rtnh);
7194e902c57SThomas Graf 
7204e902c57SThomas Graf 			nla = nla_find(attrs, attrlen, RTA_GATEWAY);
721d1566268SDavid Ahern 			nlav = nla_find(attrs, attrlen, RTA_VIA);
722d1566268SDavid Ahern 			if (nla && nlav) {
723d1566268SDavid Ahern 				NL_SET_ERR_MSG(extack,
724d1566268SDavid Ahern 					       "Nexthop configuration can not contain both GATEWAY and VIA");
725d1566268SDavid Ahern 				return -EINVAL;
726d1566268SDavid Ahern 			}
727f35b794bSDavid Ahern 			if (nla) {
7287a3429baSDavid Ahern 				ret = fib_gw_from_attr(&fib_cfg.fc_gw4, nla,
7297a3429baSDavid Ahern 						       extack);
7307a3429baSDavid Ahern 				if (ret)
7317a3429baSDavid Ahern 					goto errout;
7327a3429baSDavid Ahern 
733d73f80f9SDavid Ahern 				if (fib_cfg.fc_gw4)
734d73f80f9SDavid Ahern 					fib_cfg.fc_gw_family = AF_INET;
735d1566268SDavid Ahern 			} else if (nlav) {
736d1566268SDavid Ahern 				ret = fib_gw_from_via(&fib_cfg, nlav, extack);
737d1566268SDavid Ahern 				if (ret)
738d1566268SDavid Ahern 					goto errout;
739f35b794bSDavid Ahern 			}
740571e7226SRoopa Prabhu 
741e4516ef6SDavid Ahern 			nla = nla_find(attrs, attrlen, RTA_FLOW);
742664b9c4bSDavid Ahern 			if (nla) {
743664b9c4bSDavid Ahern 				if (nla_len(nla) < sizeof(u32)) {
744664b9c4bSDavid Ahern 					NL_SET_ERR_MSG(extack, "Invalid RTA_FLOW");
745664b9c4bSDavid Ahern 					return -EINVAL;
746664b9c4bSDavid Ahern 				}
747e4516ef6SDavid Ahern 				fib_cfg.fc_flow = nla_get_u32(nla);
748664b9c4bSDavid Ahern 			}
749e4516ef6SDavid Ahern 
750e4516ef6SDavid Ahern 			fib_cfg.fc_encap = nla_find(attrs, attrlen, RTA_ENCAP);
7518bda81a4SDavid Ahern 			/* RTA_ENCAP_TYPE length checked in
7528bda81a4SDavid Ahern 			 * lwtunnel_valid_encap_type_attr
7538bda81a4SDavid Ahern 			 */
754e4516ef6SDavid Ahern 			nla = nla_find(attrs, attrlen, RTA_ENCAP_TYPE);
755e4516ef6SDavid Ahern 			if (nla)
756e4516ef6SDavid Ahern 				fib_cfg.fc_encap_type = nla_get_u16(nla);
757c3ab2b4eSDavid Ahern 		}
75830357d7dSDavid Ahern 
759e4516ef6SDavid Ahern 		ret = fib_nh_init(net, nexthop_nh, &fib_cfg,
760e4516ef6SDavid Ahern 				  rtnh->rtnh_hops + 1, extack);
761571e7226SRoopa Prabhu 		if (ret)
762571e7226SRoopa Prabhu 			goto errout;
7634e902c57SThomas Graf 
7644e902c57SThomas Graf 		rtnh = rtnh_next(rtnh, &remaining);
7651da177e4SLinus Torvalds 	} endfor_nexthops(fi);
7664e902c57SThomas Graf 
767571e7226SRoopa Prabhu 	ret = -EINVAL;
7685481d73fSDavid Ahern 	nh = fib_info_nh(fi, 0);
7695481d73fSDavid Ahern 	if (cfg->fc_oif && nh->fib_nh_oif != cfg->fc_oif) {
770e4516ef6SDavid Ahern 		NL_SET_ERR_MSG(extack,
771e4516ef6SDavid Ahern 			       "Nexthop device index does not match RTA_OIF");
772e4516ef6SDavid Ahern 		goto errout;
773e4516ef6SDavid Ahern 	}
774f35b794bSDavid Ahern 	if (cfg->fc_gw_family) {
7755481d73fSDavid Ahern 		if (cfg->fc_gw_family != nh->fib_nh_gw_family ||
776f35b794bSDavid Ahern 		    (cfg->fc_gw_family == AF_INET &&
7775481d73fSDavid Ahern 		     nh->fib_nh_gw4 != cfg->fc_gw4) ||
778a4ea5d43SDavid Ahern 		    (cfg->fc_gw_family == AF_INET6 &&
7795481d73fSDavid Ahern 		     ipv6_addr_cmp(&nh->fib_nh_gw6, &cfg->fc_gw6))) {
780e4516ef6SDavid Ahern 			NL_SET_ERR_MSG(extack,
781a4ea5d43SDavid Ahern 				       "Nexthop gateway does not match RTA_GATEWAY or RTA_VIA");
782e4516ef6SDavid Ahern 			goto errout;
783e4516ef6SDavid Ahern 		}
784f35b794bSDavid Ahern 	}
785e4516ef6SDavid Ahern #ifdef CONFIG_IP_ROUTE_CLASSID
7865481d73fSDavid Ahern 	if (cfg->fc_flow && nh->nh_tclassid != cfg->fc_flow) {
787e4516ef6SDavid Ahern 		NL_SET_ERR_MSG(extack,
788e4516ef6SDavid Ahern 			       "Nexthop class id does not match RTA_FLOW");
789e4516ef6SDavid Ahern 		goto errout;
790e4516ef6SDavid Ahern 	}
791e4516ef6SDavid Ahern #endif
792e4516ef6SDavid Ahern 	ret = 0;
793571e7226SRoopa Prabhu errout:
794571e7226SRoopa Prabhu 	return ret;
7951da177e4SLinus Torvalds }
7961da177e4SLinus Torvalds 
7974c7e8084SDavid Ahern /* only called when fib_nh is integrated into fib_info */
7980e884c78SPeter Nørlund static void fib_rebalance(struct fib_info *fi)
7990e884c78SPeter Nørlund {
8000e884c78SPeter Nørlund 	int total;
8010e884c78SPeter Nørlund 	int w;
8020e884c78SPeter Nørlund 
8035481d73fSDavid Ahern 	if (fib_info_num_path(fi) < 2)
8040e884c78SPeter Nørlund 		return;
8050e884c78SPeter Nørlund 
8060e884c78SPeter Nørlund 	total = 0;
8070e884c78SPeter Nørlund 	for_nexthops(fi) {
808b75ed8b1SDavid Ahern 		if (nh->fib_nh_flags & RTNH_F_DEAD)
8090e884c78SPeter Nørlund 			continue;
8100e884c78SPeter Nørlund 
811b75ed8b1SDavid Ahern 		if (ip_ignore_linkdown(nh->fib_nh_dev) &&
812b75ed8b1SDavid Ahern 		    nh->fib_nh_flags & RTNH_F_LINKDOWN)
8130e884c78SPeter Nørlund 			continue;
8140e884c78SPeter Nørlund 
815b75ed8b1SDavid Ahern 		total += nh->fib_nh_weight;
8160e884c78SPeter Nørlund 	} endfor_nexthops(fi);
8170e884c78SPeter Nørlund 
8180e884c78SPeter Nørlund 	w = 0;
8190e884c78SPeter Nørlund 	change_nexthops(fi) {
8200e884c78SPeter Nørlund 		int upper_bound;
8210e884c78SPeter Nørlund 
822b75ed8b1SDavid Ahern 		if (nexthop_nh->fib_nh_flags & RTNH_F_DEAD) {
8230e884c78SPeter Nørlund 			upper_bound = -1;
824b75ed8b1SDavid Ahern 		} else if (ip_ignore_linkdown(nexthop_nh->fib_nh_dev) &&
825b75ed8b1SDavid Ahern 			   nexthop_nh->fib_nh_flags & RTNH_F_LINKDOWN) {
8260e884c78SPeter Nørlund 			upper_bound = -1;
8270e884c78SPeter Nørlund 		} else {
828b75ed8b1SDavid Ahern 			w += nexthop_nh->fib_nh_weight;
8290a837fe4SPeter Nørlund 			upper_bound = DIV_ROUND_CLOSEST_ULL((u64)w << 31,
8300e884c78SPeter Nørlund 							    total) - 1;
8310e884c78SPeter Nørlund 		}
8320e884c78SPeter Nørlund 
833b75ed8b1SDavid Ahern 		atomic_set(&nexthop_nh->fib_nh_upper_bound, upper_bound);
8340e884c78SPeter Nørlund 	} endfor_nexthops(fi);
8350e884c78SPeter Nørlund }
8360e884c78SPeter Nørlund #else /* CONFIG_IP_ROUTE_MULTIPATH */
8370e884c78SPeter Nørlund 
8388373c6c8SDavid Ahern static int fib_get_nhs(struct fib_info *fi, struct rtnexthop *rtnh,
8398373c6c8SDavid Ahern 		       int remaining, struct fib_config *cfg,
8408373c6c8SDavid Ahern 		       struct netlink_ext_ack *extack)
8418373c6c8SDavid Ahern {
8428373c6c8SDavid Ahern 	NL_SET_ERR_MSG(extack, "Multipath support not enabled in kernel");
8438373c6c8SDavid Ahern 
8448373c6c8SDavid Ahern 	return -EINVAL;
8458373c6c8SDavid Ahern }
8468373c6c8SDavid Ahern 
8470e884c78SPeter Nørlund #define fib_rebalance(fi) do { } while (0)
8480e884c78SPeter Nørlund 
8490e884c78SPeter Nørlund #endif /* CONFIG_IP_ROUTE_MULTIPATH */
8501da177e4SLinus Torvalds 
851faee6769SAlexander Aring static int fib_encap_match(struct net *net, u16 encap_type,
852571e7226SRoopa Prabhu 			   struct nlattr *encap,
85330357d7dSDavid Ahern 			   const struct fib_nh *nh,
8549ae28727SDavid Ahern 			   const struct fib_config *cfg,
8559ae28727SDavid Ahern 			   struct netlink_ext_ack *extack)
856571e7226SRoopa Prabhu {
857571e7226SRoopa Prabhu 	struct lwtunnel_state *lwtstate;
858df383e62SJiri Benc 	int ret, result = 0;
859571e7226SRoopa Prabhu 
860571e7226SRoopa Prabhu 	if (encap_type == LWTUNNEL_ENCAP_NONE)
861571e7226SRoopa Prabhu 		return 0;
862571e7226SRoopa Prabhu 
863faee6769SAlexander Aring 	ret = lwtunnel_build_state(net, encap_type, encap, AF_INET,
8649ae28727SDavid Ahern 				   cfg, &lwtstate, extack);
865df383e62SJiri Benc 	if (!ret) {
866b75ed8b1SDavid Ahern 		result = lwtunnel_cmp_encap(lwtstate, nh->fib_nh_lws);
867df383e62SJiri Benc 		lwtstate_free(lwtstate);
868df383e62SJiri Benc 	}
869571e7226SRoopa Prabhu 
870df383e62SJiri Benc 	return result;
871571e7226SRoopa Prabhu }
872571e7226SRoopa Prabhu 
873faee6769SAlexander Aring int fib_nh_match(struct net *net, struct fib_config *cfg, struct fib_info *fi,
8749ae28727SDavid Ahern 		 struct netlink_ext_ack *extack)
8751da177e4SLinus Torvalds {
8761da177e4SLinus Torvalds #ifdef CONFIG_IP_ROUTE_MULTIPATH
8774e902c57SThomas Graf 	struct rtnexthop *rtnh;
8784e902c57SThomas Graf 	int remaining;
8791da177e4SLinus Torvalds #endif
8801da177e4SLinus Torvalds 
8814e902c57SThomas Graf 	if (cfg->fc_priority && cfg->fc_priority != fi->fib_priority)
8821da177e4SLinus Torvalds 		return 1;
8831da177e4SLinus Torvalds 
884493ced1aSDavid Ahern 	if (cfg->fc_nh_id) {
885493ced1aSDavid Ahern 		if (fi->nh && cfg->fc_nh_id == fi->nh->id)
886493ced1aSDavid Ahern 			return 0;
887493ced1aSDavid Ahern 		return 1;
888493ced1aSDavid Ahern 	}
889493ced1aSDavid Ahern 
890f35b794bSDavid Ahern 	if (cfg->fc_oif || cfg->fc_gw_family) {
8915481d73fSDavid Ahern 		struct fib_nh *nh = fib_info_nh(fi, 0);
8925481d73fSDavid Ahern 
893571e7226SRoopa Prabhu 		if (cfg->fc_encap) {
894faee6769SAlexander Aring 			if (fib_encap_match(net, cfg->fc_encap_type,
895faee6769SAlexander Aring 					    cfg->fc_encap, nh, cfg, extack))
896571e7226SRoopa Prabhu 				return 1;
897571e7226SRoopa Prabhu 		}
898a8c6db1dSStefano Brivio #ifdef CONFIG_IP_ROUTE_CLASSID
899a8c6db1dSStefano Brivio 		if (cfg->fc_flow &&
9005481d73fSDavid Ahern 		    cfg->fc_flow != nh->nh_tclassid)
901a8c6db1dSStefano Brivio 			return 1;
902a8c6db1dSStefano Brivio #endif
9035481d73fSDavid Ahern 		if ((cfg->fc_oif && cfg->fc_oif != nh->fib_nh_oif) ||
904f35b794bSDavid Ahern 		    (cfg->fc_gw_family &&
9055481d73fSDavid Ahern 		     cfg->fc_gw_family != nh->fib_nh_gw_family))
9061da177e4SLinus Torvalds 			return 1;
907f35b794bSDavid Ahern 
908f35b794bSDavid Ahern 		if (cfg->fc_gw_family == AF_INET &&
9095481d73fSDavid Ahern 		    cfg->fc_gw4 != nh->fib_nh_gw4)
910f35b794bSDavid Ahern 			return 1;
911f35b794bSDavid Ahern 
912a4ea5d43SDavid Ahern 		if (cfg->fc_gw_family == AF_INET6 &&
9135481d73fSDavid Ahern 		    ipv6_addr_cmp(&cfg->fc_gw6, &nh->fib_nh_gw6))
914a4ea5d43SDavid Ahern 			return 1;
915a4ea5d43SDavid Ahern 
916f35b794bSDavid Ahern 		return 0;
9171da177e4SLinus Torvalds 	}
9181da177e4SLinus Torvalds 
9191da177e4SLinus Torvalds #ifdef CONFIG_IP_ROUTE_MULTIPATH
92051456b29SIan Morris 	if (!cfg->fc_mp)
9211da177e4SLinus Torvalds 		return 0;
9224e902c57SThomas Graf 
9234e902c57SThomas Graf 	rtnh = cfg->fc_mp;
9244e902c57SThomas Graf 	remaining = cfg->fc_mp_len;
9251da177e4SLinus Torvalds 
9261da177e4SLinus Torvalds 	for_nexthops(fi) {
9274e902c57SThomas Graf 		int attrlen;
9281da177e4SLinus Torvalds 
9294e902c57SThomas Graf 		if (!rtnh_ok(rtnh, remaining))
9301da177e4SLinus Torvalds 			return -EINVAL;
9314e902c57SThomas Graf 
932b75ed8b1SDavid Ahern 		if (rtnh->rtnh_ifindex && rtnh->rtnh_ifindex != nh->fib_nh_oif)
9331da177e4SLinus Torvalds 			return 1;
9344e902c57SThomas Graf 
9354e902c57SThomas Graf 		attrlen = rtnh_attrlen(rtnh);
936f76936d0SJiri Pirko 		if (attrlen > 0) {
937d1566268SDavid Ahern 			struct nlattr *nla, *nlav, *attrs = rtnh_attrs(rtnh);
9387a3429baSDavid Ahern 			int err;
9394e902c57SThomas Graf 
9404e902c57SThomas Graf 			nla = nla_find(attrs, attrlen, RTA_GATEWAY);
941d1566268SDavid Ahern 			nlav = nla_find(attrs, attrlen, RTA_VIA);
942d1566268SDavid Ahern 			if (nla && nlav) {
943d1566268SDavid Ahern 				NL_SET_ERR_MSG(extack,
944d1566268SDavid Ahern 					       "Nexthop configuration can not contain both GATEWAY and VIA");
945d1566268SDavid Ahern 				return -EINVAL;
946d1566268SDavid Ahern 			}
947d1566268SDavid Ahern 
948d1566268SDavid Ahern 			if (nla) {
9497a3429baSDavid Ahern 				__be32 gw;
9507a3429baSDavid Ahern 
9517a3429baSDavid Ahern 				err = fib_gw_from_attr(&gw, nla, extack);
9527a3429baSDavid Ahern 				if (err)
9537a3429baSDavid Ahern 					return err;
9547a3429baSDavid Ahern 
955d1566268SDavid Ahern 				if (nh->fib_nh_gw_family != AF_INET ||
9567a3429baSDavid Ahern 				    gw != nh->fib_nh_gw4)
9571da177e4SLinus Torvalds 					return 1;
958d1566268SDavid Ahern 			} else if (nlav) {
959d1566268SDavid Ahern 				struct fib_config cfg2;
960d1566268SDavid Ahern 
961d1566268SDavid Ahern 				err = fib_gw_from_via(&cfg2, nlav, extack);
962d1566268SDavid Ahern 				if (err)
963d1566268SDavid Ahern 					return err;
964d1566268SDavid Ahern 
965d1566268SDavid Ahern 				switch (nh->fib_nh_gw_family) {
966d1566268SDavid Ahern 				case AF_INET:
967d1566268SDavid Ahern 					if (cfg2.fc_gw_family != AF_INET ||
968d1566268SDavid Ahern 					    cfg2.fc_gw4 != nh->fib_nh_gw4)
969d1566268SDavid Ahern 						return 1;
970d1566268SDavid Ahern 					break;
971d1566268SDavid Ahern 				case AF_INET6:
972d1566268SDavid Ahern 					if (cfg2.fc_gw_family != AF_INET6 ||
973d1566268SDavid Ahern 					    ipv6_addr_cmp(&cfg2.fc_gw6,
974d1566268SDavid Ahern 							  &nh->fib_nh_gw6))
975d1566268SDavid Ahern 						return 1;
976d1566268SDavid Ahern 					break;
977d1566268SDavid Ahern 				}
978d1566268SDavid Ahern 			}
979d1566268SDavid Ahern 
980c7066f70SPatrick McHardy #ifdef CONFIG_IP_ROUTE_CLASSID
9814e902c57SThomas Graf 			nla = nla_find(attrs, attrlen, RTA_FLOW);
982664b9c4bSDavid Ahern 			if (nla) {
983664b9c4bSDavid Ahern 				if (nla_len(nla) < sizeof(u32)) {
984664b9c4bSDavid Ahern 					NL_SET_ERR_MSG(extack, "Invalid RTA_FLOW");
985664b9c4bSDavid Ahern 					return -EINVAL;
986664b9c4bSDavid Ahern 				}
987664b9c4bSDavid Ahern 				if (nla_get_u32(nla) != nh->nh_tclassid)
9881da177e4SLinus Torvalds 					return 1;
989664b9c4bSDavid Ahern 			}
9901da177e4SLinus Torvalds #endif
9911da177e4SLinus Torvalds 		}
9924e902c57SThomas Graf 
9934e902c57SThomas Graf 		rtnh = rtnh_next(rtnh, &remaining);
9941da177e4SLinus Torvalds 	} endfor_nexthops(fi);
9951da177e4SLinus Torvalds #endif
9961da177e4SLinus Torvalds 	return 0;
9971da177e4SLinus Torvalds }
9981da177e4SLinus Torvalds 
9995f9ae3d9SXin Long bool fib_metrics_match(struct fib_config *cfg, struct fib_info *fi)
10005f9ae3d9SXin Long {
10015f9ae3d9SXin Long 	struct nlattr *nla;
10025f9ae3d9SXin Long 	int remaining;
10035f9ae3d9SXin Long 
10045f9ae3d9SXin Long 	if (!cfg->fc_mx)
10055f9ae3d9SXin Long 		return true;
10065f9ae3d9SXin Long 
10075f9ae3d9SXin Long 	nla_for_each_attr(nla, cfg->fc_mx, cfg->fc_mx_len, remaining) {
10085f9ae3d9SXin Long 		int type = nla_type(nla);
1009d03a4557SPhil Sutter 		u32 fi_val, val;
10105f9ae3d9SXin Long 
10115f9ae3d9SXin Long 		if (!type)
10125f9ae3d9SXin Long 			continue;
10135f9ae3d9SXin Long 		if (type > RTAX_MAX)
10145f9ae3d9SXin Long 			return false;
10155f9ae3d9SXin Long 
10165f9ae3d9SXin Long 		if (type == RTAX_CC_ALGO) {
10175f9ae3d9SXin Long 			char tmp[TCP_CA_NAME_MAX];
10185f9ae3d9SXin Long 			bool ecn_ca = false;
10195f9ae3d9SXin Long 
1020872f6903SFrancis Laniel 			nla_strscpy(tmp, nla, sizeof(tmp));
10216670e152SStephen Hemminger 			val = tcp_ca_get_key_by_name(fi->fib_net, tmp, &ecn_ca);
10225f9ae3d9SXin Long 		} else {
10235b5e7a0dSEric Dumazet 			if (nla_len(nla) != sizeof(u32))
10245b5e7a0dSEric Dumazet 				return false;
10255f9ae3d9SXin Long 			val = nla_get_u32(nla);
10265f9ae3d9SXin Long 		}
10275f9ae3d9SXin Long 
1028d03a4557SPhil Sutter 		fi_val = fi->fib_metrics->metrics[type - 1];
1029d03a4557SPhil Sutter 		if (type == RTAX_FEATURES)
1030d03a4557SPhil Sutter 			fi_val &= ~DST_FEATURE_ECN_CA;
1031d03a4557SPhil Sutter 
1032d03a4557SPhil Sutter 		if (fi_val != val)
10335f9ae3d9SXin Long 			return false;
10345f9ae3d9SXin Long 	}
10355f9ae3d9SXin Long 
10365f9ae3d9SXin Long 	return true;
10375f9ae3d9SXin Long }
10385f9ae3d9SXin Long 
1039717a8f5bSDavid Ahern static int fib_check_nh_v6_gw(struct net *net, struct fib_nh *nh,
1040717a8f5bSDavid Ahern 			      u32 table, struct netlink_ext_ack *extack)
1041717a8f5bSDavid Ahern {
1042717a8f5bSDavid Ahern 	struct fib6_config cfg = {
1043717a8f5bSDavid Ahern 		.fc_table = table,
1044717a8f5bSDavid Ahern 		.fc_flags = nh->fib_nh_flags | RTF_GATEWAY,
1045717a8f5bSDavid Ahern 		.fc_ifindex = nh->fib_nh_oif,
1046717a8f5bSDavid Ahern 		.fc_gateway = nh->fib_nh_gw6,
1047717a8f5bSDavid Ahern 	};
1048717a8f5bSDavid Ahern 	struct fib6_nh fib6_nh = {};
1049717a8f5bSDavid Ahern 	int err;
1050717a8f5bSDavid Ahern 
1051717a8f5bSDavid Ahern 	err = ipv6_stub->fib6_nh_init(net, &fib6_nh, &cfg, GFP_KERNEL, extack);
1052717a8f5bSDavid Ahern 	if (!err) {
1053717a8f5bSDavid Ahern 		nh->fib_nh_dev = fib6_nh.fib_nh_dev;
1054e44b14ebSEric Dumazet 		dev_hold_track(nh->fib_nh_dev, &nh->fib_nh_dev_tracker, GFP_KERNEL);
1055717a8f5bSDavid Ahern 		nh->fib_nh_oif = nh->fib_nh_dev->ifindex;
1056717a8f5bSDavid Ahern 		nh->fib_nh_scope = RT_SCOPE_LINK;
1057717a8f5bSDavid Ahern 
1058717a8f5bSDavid Ahern 		ipv6_stub->fib6_nh_release(&fib6_nh);
1059717a8f5bSDavid Ahern 	}
1060717a8f5bSDavid Ahern 
1061717a8f5bSDavid Ahern 	return err;
1062717a8f5bSDavid Ahern }
10631da177e4SLinus Torvalds 
10641da177e4SLinus Torvalds /*
10656a31d2a9SEric Dumazet  * Picture
10666a31d2a9SEric Dumazet  * -------
10676a31d2a9SEric Dumazet  *
10686a31d2a9SEric Dumazet  * Semantics of nexthop is very messy by historical reasons.
10696a31d2a9SEric Dumazet  * We have to take into account, that:
10706a31d2a9SEric Dumazet  * a) gateway can be actually local interface address,
10716a31d2a9SEric Dumazet  *    so that gatewayed route is direct.
10726a31d2a9SEric Dumazet  * b) gateway must be on-link address, possibly
10736a31d2a9SEric Dumazet  *    described not by an ifaddr, but also by a direct route.
10746a31d2a9SEric Dumazet  * c) If both gateway and interface are specified, they should not
10756a31d2a9SEric Dumazet  *    contradict.
10766a31d2a9SEric Dumazet  * d) If we use tunnel routes, gateway could be not on-link.
10776a31d2a9SEric Dumazet  *
10786a31d2a9SEric Dumazet  * Attempt to reconcile all of these (alas, self-contradictory) conditions
10796a31d2a9SEric Dumazet  * results in pretty ugly and hairy code with obscure logic.
10806a31d2a9SEric Dumazet  *
10816a31d2a9SEric Dumazet  * I chose to generalized it instead, so that the size
10826a31d2a9SEric Dumazet  * of code does not increase practically, but it becomes
10836a31d2a9SEric Dumazet  * much more general.
10846a31d2a9SEric Dumazet  * Every prefix is assigned a "scope" value: "host" is local address,
10856a31d2a9SEric Dumazet  * "link" is direct route,
10866a31d2a9SEric Dumazet  * [ ... "site" ... "interior" ... ]
10876a31d2a9SEric Dumazet  * and "universe" is true gateway route with global meaning.
10886a31d2a9SEric Dumazet  *
10896a31d2a9SEric Dumazet  * Every prefix refers to a set of "nexthop"s (gw, oif),
10906a31d2a9SEric Dumazet  * where gw must have narrower scope. This recursion stops
10916a31d2a9SEric Dumazet  * when gw has LOCAL scope or if "nexthop" is declared ONLINK,
10926a31d2a9SEric Dumazet  * which means that gw is forced to be on link.
10936a31d2a9SEric Dumazet  *
10946a31d2a9SEric Dumazet  * Code is still hairy, but now it is apparently logically
10956a31d2a9SEric Dumazet  * consistent and very flexible. F.e. as by-product it allows
10966a31d2a9SEric Dumazet  * to co-exists in peace independent exterior and interior
10976a31d2a9SEric Dumazet  * routing processes.
10986a31d2a9SEric Dumazet  *
10996a31d2a9SEric Dumazet  * Normally it looks as following.
11006a31d2a9SEric Dumazet  *
11016a31d2a9SEric Dumazet  * {universe prefix}  -> (gw, oif) [scope link]
11026a31d2a9SEric Dumazet  *		  |
11036a31d2a9SEric Dumazet  *		  |-> {link prefix} -> (gw, oif) [scope local]
11046a31d2a9SEric Dumazet  *					|
11056a31d2a9SEric Dumazet  *					|-> {local prefix} (terminal node)
11061da177e4SLinus Torvalds  */
1107448d7248SDavid Ahern static int fib_check_nh_v4_gw(struct net *net, struct fib_nh *nh, u32 table,
1108448d7248SDavid Ahern 			      u8 scope, struct netlink_ext_ack *extack)
11091da177e4SLinus Torvalds {
11106a31d2a9SEric Dumazet 	struct net_device *dev;
11111da177e4SLinus Torvalds 	struct fib_result res;
1112c3fee640SEnrico Weigelt 	int err = 0;
11131da177e4SLinus Torvalds 
1114b75ed8b1SDavid Ahern 	if (nh->fib_nh_flags & RTNH_F_ONLINK) {
111530bbaa19SDavid Ahern 		unsigned int addr_type;
11161da177e4SLinus Torvalds 
1117448d7248SDavid Ahern 		if (scope >= RT_SCOPE_LINK) {
1118448d7248SDavid Ahern 			NL_SET_ERR_MSG(extack, "Nexthop has invalid scope");
11191da177e4SLinus Torvalds 			return -EINVAL;
1120c3ab2b4eSDavid Ahern 		}
1121b75ed8b1SDavid Ahern 		dev = __dev_get_by_index(net, nh->fib_nh_oif);
1122066b1030SDavid Ahern 		if (!dev) {
1123066b1030SDavid Ahern 			NL_SET_ERR_MSG(extack, "Nexthop device required for onlink");
11241da177e4SLinus Torvalds 			return -ENODEV;
1125066b1030SDavid Ahern 		}
1126c3ab2b4eSDavid Ahern 		if (!(dev->flags & IFF_UP)) {
1127448d7248SDavid Ahern 			NL_SET_ERR_MSG(extack, "Nexthop device is not up");
11281da177e4SLinus Torvalds 			return -ENETDOWN;
1129c3ab2b4eSDavid Ahern 		}
1130448d7248SDavid Ahern 		addr_type = inet_addr_type_dev_table(net, dev, nh->fib_nh_gw4);
1131c3ab2b4eSDavid Ahern 		if (addr_type != RTN_UNICAST) {
1132448d7248SDavid Ahern 			NL_SET_ERR_MSG(extack, "Nexthop has invalid gateway");
113330bbaa19SDavid Ahern 			return -EINVAL;
1134c3ab2b4eSDavid Ahern 		}
11358a3d0316SAndy Gospodarek 		if (!netif_carrier_ok(dev))
1136b75ed8b1SDavid Ahern 			nh->fib_nh_flags |= RTNH_F_LINKDOWN;
1137b75ed8b1SDavid Ahern 		nh->fib_nh_dev = dev;
1138e44b14ebSEric Dumazet 		dev_hold_track(dev, &nh->fib_nh_dev_tracker, GFP_ATOMIC);
1139b75ed8b1SDavid Ahern 		nh->fib_nh_scope = RT_SCOPE_LINK;
11401da177e4SLinus Torvalds 		return 0;
11411da177e4SLinus Torvalds 	}
1142ebc0ffaeSEric Dumazet 	rcu_read_lock();
11431da177e4SLinus Torvalds 	{
11443bfd8472SDavid Ahern 		struct fib_table *tbl = NULL;
11459ade2286SDavid S. Miller 		struct flowi4 fl4 = {
1146b75ed8b1SDavid Ahern 			.daddr = nh->fib_nh_gw4,
1147448d7248SDavid Ahern 			.flowi4_scope = scope + 1,
1148b75ed8b1SDavid Ahern 			.flowi4_oif = nh->fib_nh_oif,
11496a662719SCong Wang 			.flowi4_iif = LOOPBACK_IFINDEX,
11504e902c57SThomas Graf 		};
11511da177e4SLinus Torvalds 
11521da177e4SLinus Torvalds 		/* It is not necessary, but requires a bit of thinking */
11539ade2286SDavid S. Miller 		if (fl4.flowi4_scope < RT_SCOPE_LINK)
11549ade2286SDavid S. Miller 			fl4.flowi4_scope = RT_SCOPE_LINK;
11553bfd8472SDavid Ahern 
11565eea3a63Sguodeqing 		if (table && table != RT_TABLE_MAIN)
1157448d7248SDavid Ahern 			tbl = fib_get_table(net, table);
11583bfd8472SDavid Ahern 
11593bfd8472SDavid Ahern 		if (tbl)
11603bfd8472SDavid Ahern 			err = fib_table_lookup(tbl, &fl4, &res,
11611e313678SEric Dumazet 					       FIB_LOOKUP_IGNORE_LINKSTATE |
11621e313678SEric Dumazet 					       FIB_LOOKUP_NOREF);
11634c9bcd11SDavid Ahern 
11644c9bcd11SDavid Ahern 		/* on error or if no table given do full lookup. This
11654c9bcd11SDavid Ahern 		 * is needed for example when nexthops are in the local
11664c9bcd11SDavid Ahern 		 * table rather than the given table
11674c9bcd11SDavid Ahern 		 */
11684c9bcd11SDavid Ahern 		if (!tbl || err) {
11690eeb075fSAndy Gospodarek 			err = fib_lookup(net, &fl4, &res,
11700eeb075fSAndy Gospodarek 					 FIB_LOOKUP_IGNORE_LINKSTATE);
11714c9bcd11SDavid Ahern 		}
11724c9bcd11SDavid Ahern 
1173ebc0ffaeSEric Dumazet 		if (err) {
1174448d7248SDavid Ahern 			NL_SET_ERR_MSG(extack, "Nexthop has invalid gateway");
1175448d7248SDavid Ahern 			goto out;
11761da177e4SLinus Torvalds 		}
1177ebc0ffaeSEric Dumazet 	}
1178448d7248SDavid Ahern 
11791da177e4SLinus Torvalds 	err = -EINVAL;
1180c3ab2b4eSDavid Ahern 	if (res.type != RTN_UNICAST && res.type != RTN_LOCAL) {
1181c3ab2b4eSDavid Ahern 		NL_SET_ERR_MSG(extack, "Nexthop has invalid gateway");
11821da177e4SLinus Torvalds 		goto out;
1183c3ab2b4eSDavid Ahern 	}
1184b75ed8b1SDavid Ahern 	nh->fib_nh_scope = res.scope;
1185b75ed8b1SDavid Ahern 	nh->fib_nh_oif = FIB_RES_OIF(res);
1186b75ed8b1SDavid Ahern 	nh->fib_nh_dev = dev = FIB_RES_DEV(res);
1187c3ab2b4eSDavid Ahern 	if (!dev) {
1188c3ab2b4eSDavid Ahern 		NL_SET_ERR_MSG(extack,
1189c3ab2b4eSDavid Ahern 			       "No egress device for nexthop gateway");
11901da177e4SLinus Torvalds 		goto out;
1191c3ab2b4eSDavid Ahern 	}
1192e44b14ebSEric Dumazet 	dev_hold_track(dev, &nh->fib_nh_dev_tracker, GFP_ATOMIC);
11938a3d0316SAndy Gospodarek 	if (!netif_carrier_ok(dev))
1194b75ed8b1SDavid Ahern 		nh->fib_nh_flags |= RTNH_F_LINKDOWN;
11958723e1b4SEric Dumazet 	err = (dev->flags & IFF_UP) ? 0 : -ENETDOWN;
1196448d7248SDavid Ahern out:
1197448d7248SDavid Ahern 	rcu_read_unlock();
1198448d7248SDavid Ahern 	return err;
1199448d7248SDavid Ahern }
1200448d7248SDavid Ahern 
1201448d7248SDavid Ahern static int fib_check_nh_nongw(struct net *net, struct fib_nh *nh,
1202448d7248SDavid Ahern 			      struct netlink_ext_ack *extack)
1203448d7248SDavid Ahern {
12041da177e4SLinus Torvalds 	struct in_device *in_dev;
1205448d7248SDavid Ahern 	int err;
12061da177e4SLinus Torvalds 
1207b75ed8b1SDavid Ahern 	if (nh->fib_nh_flags & (RTNH_F_PERVASIVE | RTNH_F_ONLINK)) {
1208c3ab2b4eSDavid Ahern 		NL_SET_ERR_MSG(extack,
1209c3ab2b4eSDavid Ahern 			       "Invalid flags for nexthop - PERVASIVE and ONLINK can not be set");
12101da177e4SLinus Torvalds 		return -EINVAL;
1211c3ab2b4eSDavid Ahern 	}
1212448d7248SDavid Ahern 
12138723e1b4SEric Dumazet 	rcu_read_lock();
1214448d7248SDavid Ahern 
12158723e1b4SEric Dumazet 	err = -ENODEV;
1216b75ed8b1SDavid Ahern 	in_dev = inetdev_by_index(net, nh->fib_nh_oif);
121751456b29SIan Morris 	if (!in_dev)
12188723e1b4SEric Dumazet 		goto out;
12198723e1b4SEric Dumazet 	err = -ENETDOWN;
1220c3ab2b4eSDavid Ahern 	if (!(in_dev->dev->flags & IFF_UP)) {
1221c3ab2b4eSDavid Ahern 		NL_SET_ERR_MSG(extack, "Device for nexthop is not up");
12228723e1b4SEric Dumazet 		goto out;
1223c3ab2b4eSDavid Ahern 	}
1224448d7248SDavid Ahern 
1225b75ed8b1SDavid Ahern 	nh->fib_nh_dev = in_dev->dev;
1226e44b14ebSEric Dumazet 	dev_hold_track(nh->fib_nh_dev, &nh->fib_nh_dev_tracker, GFP_ATOMIC);
1227b75ed8b1SDavid Ahern 	nh->fib_nh_scope = RT_SCOPE_HOST;
1228b75ed8b1SDavid Ahern 	if (!netif_carrier_ok(nh->fib_nh_dev))
1229b75ed8b1SDavid Ahern 		nh->fib_nh_flags |= RTNH_F_LINKDOWN;
12308723e1b4SEric Dumazet 	err = 0;
12318723e1b4SEric Dumazet out:
12328723e1b4SEric Dumazet 	rcu_read_unlock();
12338723e1b4SEric Dumazet 	return err;
12341da177e4SLinus Torvalds }
12351da177e4SLinus Torvalds 
1236ac1fab2dSDavid Ahern int fib_check_nh(struct net *net, struct fib_nh *nh, u32 table, u8 scope,
1237448d7248SDavid Ahern 		 struct netlink_ext_ack *extack)
1238448d7248SDavid Ahern {
1239448d7248SDavid Ahern 	int err;
1240448d7248SDavid Ahern 
1241448d7248SDavid Ahern 	if (nh->fib_nh_gw_family == AF_INET)
1242ac1fab2dSDavid Ahern 		err = fib_check_nh_v4_gw(net, nh, table, scope, extack);
1243717a8f5bSDavid Ahern 	else if (nh->fib_nh_gw_family == AF_INET6)
1244717a8f5bSDavid Ahern 		err = fib_check_nh_v6_gw(net, nh, table, extack);
1245448d7248SDavid Ahern 	else
1246448d7248SDavid Ahern 		err = fib_check_nh_nongw(net, nh, extack);
1247448d7248SDavid Ahern 
1248448d7248SDavid Ahern 	return err;
1249448d7248SDavid Ahern }
1250448d7248SDavid Ahern 
125179eb15daSEric Dumazet static struct hlist_head *
125279eb15daSEric Dumazet fib_info_laddrhash_bucket(const struct net *net, __be32 val)
12531da177e4SLinus Torvalds {
125479eb15daSEric Dumazet 	u32 slot = hash_32(net_hash_mix(net) ^ (__force u32)val,
125579eb15daSEric Dumazet 			   fib_info_hash_bits);
12561da177e4SLinus Torvalds 
125779eb15daSEric Dumazet 	return &fib_info_laddrhash[slot];
12581da177e4SLinus Torvalds }
12591da177e4SLinus Torvalds 
1260123b9731SDavid S. Miller static void fib_info_hash_move(struct hlist_head *new_info_hash,
12611da177e4SLinus Torvalds 			       struct hlist_head *new_laddrhash,
12621da177e4SLinus Torvalds 			       unsigned int new_size)
12631da177e4SLinus Torvalds {
1264b7656e7fSDavid S. Miller 	struct hlist_head *old_info_hash, *old_laddrhash;
1265123b9731SDavid S. Miller 	unsigned int old_size = fib_info_hash_size;
1266*ca73b68aSEric Dumazet 	unsigned int i;
12671da177e4SLinus Torvalds 
1268832b4c5eSStephen Hemminger 	spin_lock_bh(&fib_info_lock);
1269b7656e7fSDavid S. Miller 	old_info_hash = fib_info_hash;
1270b7656e7fSDavid S. Miller 	old_laddrhash = fib_info_laddrhash;
1271123b9731SDavid S. Miller 	fib_info_hash_size = new_size;
127279eb15daSEric Dumazet 	fib_info_hash_bits = ilog2(new_size);
12731da177e4SLinus Torvalds 
12741da177e4SLinus Torvalds 	for (i = 0; i < old_size; i++) {
12751da177e4SLinus Torvalds 		struct hlist_head *head = &fib_info_hash[i];
1276b67bfe0dSSasha Levin 		struct hlist_node *n;
12771da177e4SLinus Torvalds 		struct fib_info *fi;
12781da177e4SLinus Torvalds 
1279b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(fi, n, head, fib_hash) {
12801da177e4SLinus Torvalds 			struct hlist_head *dest;
12811da177e4SLinus Torvalds 			unsigned int new_hash;
12821da177e4SLinus Torvalds 
12831da177e4SLinus Torvalds 			new_hash = fib_info_hashfn(fi);
12841da177e4SLinus Torvalds 			dest = &new_info_hash[new_hash];
12851da177e4SLinus Torvalds 			hlist_add_head(&fi->fib_hash, dest);
12861da177e4SLinus Torvalds 		}
12871da177e4SLinus Torvalds 	}
12881da177e4SLinus Torvalds 	fib_info_hash = new_info_hash;
12891da177e4SLinus Torvalds 
129079eb15daSEric Dumazet 	fib_info_laddrhash = new_laddrhash;
12911da177e4SLinus Torvalds 	for (i = 0; i < old_size; i++) {
129279eb15daSEric Dumazet 		struct hlist_head *lhead = &old_laddrhash[i];
1293b67bfe0dSSasha Levin 		struct hlist_node *n;
12941da177e4SLinus Torvalds 		struct fib_info *fi;
12951da177e4SLinus Torvalds 
1296b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(fi, n, lhead, fib_lhash) {
12971da177e4SLinus Torvalds 			struct hlist_head *ldest;
12981da177e4SLinus Torvalds 
129979eb15daSEric Dumazet 			ldest = fib_info_laddrhash_bucket(fi->fib_net,
130079eb15daSEric Dumazet 							  fi->fib_prefsrc);
13011da177e4SLinus Torvalds 			hlist_add_head(&fi->fib_lhash, ldest);
13021da177e4SLinus Torvalds 		}
13031da177e4SLinus Torvalds 	}
13041da177e4SLinus Torvalds 
1305832b4c5eSStephen Hemminger 	spin_unlock_bh(&fib_info_lock);
1306b7656e7fSDavid S. Miller 
1307*ca73b68aSEric Dumazet 	kvfree(old_info_hash);
1308*ca73b68aSEric Dumazet 	kvfree(old_laddrhash);
13091da177e4SLinus Torvalds }
13101da177e4SLinus Torvalds 
1311dcb1ecb5SDavid Ahern __be32 fib_info_update_nhc_saddr(struct net *net, struct fib_nh_common *nhc,
1312c3669486SDavid Ahern 				 unsigned char scope)
1313436c3b66SDavid S. Miller {
1314dcb1ecb5SDavid Ahern 	struct fib_nh *nh;
1315dcb1ecb5SDavid Ahern 
1316dcb1ecb5SDavid Ahern 	if (nhc->nhc_family != AF_INET)
1317dcb1ecb5SDavid Ahern 		return inet_select_addr(nhc->nhc_dev, 0, scope);
1318dcb1ecb5SDavid Ahern 
1319dcb1ecb5SDavid Ahern 	nh = container_of(nhc, struct fib_nh, nh_common);
1320c3669486SDavid Ahern 	nh->nh_saddr = inet_select_addr(nh->fib_nh_dev, nh->fib_nh_gw4, scope);
1321436c3b66SDavid S. Miller 	nh->nh_saddr_genid = atomic_read(&net->ipv4.dev_addr_genid);
1322436c3b66SDavid S. Miller 
1323436c3b66SDavid S. Miller 	return nh->nh_saddr;
1324436c3b66SDavid S. Miller }
1325436c3b66SDavid S. Miller 
1326eba618abSDavid Ahern __be32 fib_result_prefsrc(struct net *net, struct fib_result *res)
1327eba618abSDavid Ahern {
1328eba618abSDavid Ahern 	struct fib_nh_common *nhc = res->nhc;
1329eba618abSDavid Ahern 
1330eba618abSDavid Ahern 	if (res->fi->fib_prefsrc)
1331eba618abSDavid Ahern 		return res->fi->fib_prefsrc;
1332eba618abSDavid Ahern 
1333dcb1ecb5SDavid Ahern 	if (nhc->nhc_family == AF_INET) {
1334dcb1ecb5SDavid Ahern 		struct fib_nh *nh;
1335dcb1ecb5SDavid Ahern 
1336eba618abSDavid Ahern 		nh = container_of(nhc, struct fib_nh, nh_common);
1337eba618abSDavid Ahern 		if (nh->nh_saddr_genid == atomic_read(&net->ipv4.dev_addr_genid))
1338eba618abSDavid Ahern 			return nh->nh_saddr;
1339dcb1ecb5SDavid Ahern 	}
1340eba618abSDavid Ahern 
1341dcb1ecb5SDavid Ahern 	return fib_info_update_nhc_saddr(net, nhc, res->fi->fib_scope);
1342eba618abSDavid Ahern }
1343eba618abSDavid Ahern 
1344021dd3b8SDavid Ahern static bool fib_valid_prefsrc(struct fib_config *cfg, __be32 fib_prefsrc)
1345021dd3b8SDavid Ahern {
1346021dd3b8SDavid Ahern 	if (cfg->fc_type != RTN_LOCAL || !cfg->fc_dst ||
1347021dd3b8SDavid Ahern 	    fib_prefsrc != cfg->fc_dst) {
13489b8ff518SDavid Ahern 		u32 tb_id = cfg->fc_table;
1349e1b8d903SDavid Ahern 		int rc;
1350021dd3b8SDavid Ahern 
1351021dd3b8SDavid Ahern 		if (tb_id == RT_TABLE_MAIN)
1352021dd3b8SDavid Ahern 			tb_id = RT_TABLE_LOCAL;
1353021dd3b8SDavid Ahern 
1354e1b8d903SDavid Ahern 		rc = inet_addr_type_table(cfg->fc_nlinfo.nl_net,
1355e1b8d903SDavid Ahern 					  fib_prefsrc, tb_id);
1356e1b8d903SDavid Ahern 
1357e1b8d903SDavid Ahern 		if (rc != RTN_LOCAL && tb_id != RT_TABLE_LOCAL) {
1358e1b8d903SDavid Ahern 			rc = inet_addr_type_table(cfg->fc_nlinfo.nl_net,
1359e1b8d903SDavid Ahern 						  fib_prefsrc, RT_TABLE_LOCAL);
1360021dd3b8SDavid Ahern 		}
1361e1b8d903SDavid Ahern 
1362e1b8d903SDavid Ahern 		if (rc != RTN_LOCAL)
1363e1b8d903SDavid Ahern 			return false;
1364021dd3b8SDavid Ahern 	}
1365021dd3b8SDavid Ahern 	return true;
1366021dd3b8SDavid Ahern }
1367021dd3b8SDavid Ahern 
13686d8422a1SDavid Ahern struct fib_info *fib_create_info(struct fib_config *cfg,
13696d8422a1SDavid Ahern 				 struct netlink_ext_ack *extack)
13701da177e4SLinus Torvalds {
13711da177e4SLinus Torvalds 	int err;
13721da177e4SLinus Torvalds 	struct fib_info *fi = NULL;
13734c7e8084SDavid Ahern 	struct nexthop *nh = NULL;
13741da177e4SLinus Torvalds 	struct fib_info *ofi;
13751da177e4SLinus Torvalds 	int nhs = 1;
13767462bd74SDenis V. Lunev 	struct net *net = cfg->fc_nlinfo.nl_net;
13771da177e4SLinus Torvalds 
13784c8237cdSDavid S. Miller 	if (cfg->fc_type > RTN_MAX)
13794c8237cdSDavid S. Miller 		goto err_inval;
13804c8237cdSDavid S. Miller 
13811da177e4SLinus Torvalds 	/* Fast check to catch the most weird cases */
1382c3ab2b4eSDavid Ahern 	if (fib_props[cfg->fc_type].scope > cfg->fc_scope) {
1383c3ab2b4eSDavid Ahern 		NL_SET_ERR_MSG(extack, "Invalid scope");
13841da177e4SLinus Torvalds 		goto err_inval;
1385c3ab2b4eSDavid Ahern 	}
13861da177e4SLinus Torvalds 
1387c3ab2b4eSDavid Ahern 	if (cfg->fc_flags & (RTNH_F_DEAD | RTNH_F_LINKDOWN)) {
1388c3ab2b4eSDavid Ahern 		NL_SET_ERR_MSG(extack,
1389c3ab2b4eSDavid Ahern 			       "Invalid rtm_flags - can not contain DEAD or LINKDOWN");
139080610229SJulian Anastasov 		goto err_inval;
1391c3ab2b4eSDavid Ahern 	}
139280610229SJulian Anastasov 
1393493ced1aSDavid Ahern 	if (cfg->fc_nh_id) {
13946c48ea5fSDavid Ahern 		if (!cfg->fc_mx) {
13956c48ea5fSDavid Ahern 			fi = fib_find_info_nh(net, cfg);
13966c48ea5fSDavid Ahern 			if (fi) {
139779976892SYajun Deng 				refcount_inc(&fi->fib_treeref);
13986c48ea5fSDavid Ahern 				return fi;
13996c48ea5fSDavid Ahern 			}
14006c48ea5fSDavid Ahern 		}
14016c48ea5fSDavid Ahern 
1402493ced1aSDavid Ahern 		nh = nexthop_find_by_id(net, cfg->fc_nh_id);
1403493ced1aSDavid Ahern 		if (!nh) {
1404493ced1aSDavid Ahern 			NL_SET_ERR_MSG(extack, "Nexthop id does not exist");
1405493ced1aSDavid Ahern 			goto err_inval;
1406493ced1aSDavid Ahern 		}
1407493ced1aSDavid Ahern 		nhs = 0;
1408493ced1aSDavid Ahern 	}
1409493ced1aSDavid Ahern 
14101da177e4SLinus Torvalds #ifdef CONFIG_IP_ROUTE_MULTIPATH
14114e902c57SThomas Graf 	if (cfg->fc_mp) {
14126d8422a1SDavid Ahern 		nhs = fib_count_nexthops(cfg->fc_mp, cfg->fc_mp_len, extack);
14131da177e4SLinus Torvalds 		if (nhs == 0)
14141da177e4SLinus Torvalds 			goto err_inval;
14151da177e4SLinus Torvalds 	}
14161da177e4SLinus Torvalds #endif
14171da177e4SLinus Torvalds 
14181da177e4SLinus Torvalds 	err = -ENOBUFS;
14190a6e6b3cSEric Dumazet 
14200a6e6b3cSEric Dumazet 	/* Paired with WRITE_ONCE() in fib_release_info() */
14210a6e6b3cSEric Dumazet 	if (READ_ONCE(fib_info_cnt) >= fib_info_hash_size) {
1422123b9731SDavid S. Miller 		unsigned int new_size = fib_info_hash_size << 1;
14231da177e4SLinus Torvalds 		struct hlist_head *new_info_hash;
14241da177e4SLinus Torvalds 		struct hlist_head *new_laddrhash;
1425*ca73b68aSEric Dumazet 		size_t bytes;
14261da177e4SLinus Torvalds 
14271da177e4SLinus Torvalds 		if (!new_size)
1428d94ce9b2SEric Dumazet 			new_size = 16;
1429*ca73b68aSEric Dumazet 		bytes = (size_t)new_size * sizeof(struct hlist_head *);
1430*ca73b68aSEric Dumazet 		new_info_hash = kvzalloc(bytes, GFP_KERNEL);
1431*ca73b68aSEric Dumazet 		new_laddrhash = kvzalloc(bytes, GFP_KERNEL);
14321da177e4SLinus Torvalds 		if (!new_info_hash || !new_laddrhash) {
1433*ca73b68aSEric Dumazet 			kvfree(new_info_hash);
1434*ca73b68aSEric Dumazet 			kvfree(new_laddrhash);
1435*ca73b68aSEric Dumazet 		} else {
1436123b9731SDavid S. Miller 			fib_info_hash_move(new_info_hash, new_laddrhash, new_size);
1437*ca73b68aSEric Dumazet 		}
1438123b9731SDavid S. Miller 		if (!fib_info_hash_size)
14391da177e4SLinus Torvalds 			goto failure;
14401da177e4SLinus Torvalds 	}
14411da177e4SLinus Torvalds 
14421f533ba6SGustavo A. R. Silva 	fi = kzalloc(struct_size(fi, fib_nh, nhs), GFP_KERNEL);
144351456b29SIan Morris 	if (!fi)
14441da177e4SLinus Torvalds 		goto failure;
1445767a2217SDavid Ahern 	fi->fib_metrics = ip_fib_metrics_init(fi->fib_net, cfg->fc_mx,
1446d7e774f3SDavid Ahern 					      cfg->fc_mx_len, extack);
144788e235b8SEnrico Weigelt 	if (IS_ERR(fi->fib_metrics)) {
1448767a2217SDavid Ahern 		err = PTR_ERR(fi->fib_metrics);
1449187e5b3aSEric Dumazet 		kfree(fi);
1450187e5b3aSEric Dumazet 		return ERR_PTR(err);
1451187e5b3aSEric Dumazet 	}
1452767a2217SDavid Ahern 
1453efd7ef1cSEric W. Biederman 	fi->fib_net = net;
14544e902c57SThomas Graf 	fi->fib_protocol = cfg->fc_protocol;
145537e826c5SDavid S. Miller 	fi->fib_scope = cfg->fc_scope;
14564e902c57SThomas Graf 	fi->fib_flags = cfg->fc_flags;
14574e902c57SThomas Graf 	fi->fib_priority = cfg->fc_priority;
14584e902c57SThomas Graf 	fi->fib_prefsrc = cfg->fc_prefsrc;
1459f4ef85bbSEric Dumazet 	fi->fib_type = cfg->fc_type;
14605a56a0b3SMark Tomlinson 	fi->fib_tb_id = cfg->fc_table;
14611da177e4SLinus Torvalds 
14621da177e4SLinus Torvalds 	fi->fib_nhs = nhs;
14634c7e8084SDavid Ahern 	if (nh) {
14644c7e8084SDavid Ahern 		if (!nexthop_get(nh)) {
14654c7e8084SDavid Ahern 			NL_SET_ERR_MSG(extack, "Nexthop has been deleted");
14664c7e8084SDavid Ahern 			err = -EINVAL;
14674c7e8084SDavid Ahern 		} else {
14684c7e8084SDavid Ahern 			err = 0;
14694c7e8084SDavid Ahern 			fi->nh = nh;
14704c7e8084SDavid Ahern 		}
14714c7e8084SDavid Ahern 	} else {
14721da177e4SLinus Torvalds 		change_nexthops(fi) {
147371fceff0SDavid S. Miller 			nexthop_nh->nh_parent = fi;
14741da177e4SLinus Torvalds 		} endfor_nexthops(fi)
14751da177e4SLinus Torvalds 
1476e4516ef6SDavid Ahern 		if (cfg->fc_mp)
14774c7e8084SDavid Ahern 			err = fib_get_nhs(fi, cfg->fc_mp, cfg->fc_mp_len, cfg,
14784c7e8084SDavid Ahern 					  extack);
1479e4516ef6SDavid Ahern 		else
1480e4516ef6SDavid Ahern 			err = fib_nh_init(net, fi->fib_nh, cfg, 1, extack);
14814c7e8084SDavid Ahern 	}
1482e4516ef6SDavid Ahern 
14834e902c57SThomas Graf 	if (err != 0)
14841da177e4SLinus Torvalds 		goto failure;
14851da177e4SLinus Torvalds 
14864e902c57SThomas Graf 	if (fib_props[cfg->fc_type].error) {
1487f35b794bSDavid Ahern 		if (cfg->fc_gw_family || cfg->fc_oif || cfg->fc_mp) {
1488c3ab2b4eSDavid Ahern 			NL_SET_ERR_MSG(extack,
1489c3ab2b4eSDavid Ahern 				       "Gateway, device and multipath can not be specified for this route type");
14901da177e4SLinus Torvalds 			goto err_inval;
1491c3ab2b4eSDavid Ahern 		}
14921da177e4SLinus Torvalds 		goto link_it;
14934c8237cdSDavid S. Miller 	} else {
14944c8237cdSDavid S. Miller 		switch (cfg->fc_type) {
14954c8237cdSDavid S. Miller 		case RTN_UNICAST:
14964c8237cdSDavid S. Miller 		case RTN_LOCAL:
14974c8237cdSDavid S. Miller 		case RTN_BROADCAST:
14984c8237cdSDavid S. Miller 		case RTN_ANYCAST:
14994c8237cdSDavid S. Miller 		case RTN_MULTICAST:
15004c8237cdSDavid S. Miller 			break;
15014c8237cdSDavid S. Miller 		default:
1502c3ab2b4eSDavid Ahern 			NL_SET_ERR_MSG(extack, "Invalid route type");
15034c8237cdSDavid S. Miller 			goto err_inval;
15044c8237cdSDavid S. Miller 		}
15051da177e4SLinus Torvalds 	}
15061da177e4SLinus Torvalds 
1507c3ab2b4eSDavid Ahern 	if (cfg->fc_scope > RT_SCOPE_HOST) {
1508c3ab2b4eSDavid Ahern 		NL_SET_ERR_MSG(extack, "Invalid scope");
15091da177e4SLinus Torvalds 		goto err_inval;
1510c3ab2b4eSDavid Ahern 	}
15111da177e4SLinus Torvalds 
15124c7e8084SDavid Ahern 	if (fi->nh) {
15134c7e8084SDavid Ahern 		err = fib_check_nexthop(fi->nh, cfg->fc_scope, extack);
15144c7e8084SDavid Ahern 		if (err)
15154c7e8084SDavid Ahern 			goto failure;
15164c7e8084SDavid Ahern 	} else if (cfg->fc_scope == RT_SCOPE_HOST) {
15171da177e4SLinus Torvalds 		struct fib_nh *nh = fi->fib_nh;
15181da177e4SLinus Torvalds 
15191da177e4SLinus Torvalds 		/* Local address is added. */
1520c3ab2b4eSDavid Ahern 		if (nhs != 1) {
1521c3ab2b4eSDavid Ahern 			NL_SET_ERR_MSG(extack,
1522c3ab2b4eSDavid Ahern 				       "Route with host scope can not have multiple nexthops");
15236d8422a1SDavid Ahern 			goto err_inval;
1524c3ab2b4eSDavid Ahern 		}
1525bdf00467SDavid Ahern 		if (nh->fib_nh_gw_family) {
1526c3ab2b4eSDavid Ahern 			NL_SET_ERR_MSG(extack,
1527c3ab2b4eSDavid Ahern 				       "Route with host scope can not have a gateway");
15281da177e4SLinus Torvalds 			goto err_inval;
1529c3ab2b4eSDavid Ahern 		}
1530b75ed8b1SDavid Ahern 		nh->fib_nh_scope = RT_SCOPE_NOWHERE;
15315481d73fSDavid Ahern 		nh->fib_nh_dev = dev_get_by_index(net, nh->fib_nh_oif);
15321da177e4SLinus Torvalds 		err = -ENODEV;
1533b75ed8b1SDavid Ahern 		if (!nh->fib_nh_dev)
15341da177e4SLinus Torvalds 			goto failure;
1535e44b14ebSEric Dumazet 		netdev_tracker_alloc(nh->fib_nh_dev, &nh->fib_nh_dev_tracker,
1536e44b14ebSEric Dumazet 				     GFP_KERNEL);
15371da177e4SLinus Torvalds 	} else {
15388a3d0316SAndy Gospodarek 		int linkdown = 0;
15398a3d0316SAndy Gospodarek 
15401da177e4SLinus Torvalds 		change_nexthops(fi) {
1541ac1fab2dSDavid Ahern 			err = fib_check_nh(cfg->fc_nlinfo.nl_net, nexthop_nh,
1542ac1fab2dSDavid Ahern 					   cfg->fc_table, cfg->fc_scope,
1543ac1fab2dSDavid Ahern 					   extack);
15446a31d2a9SEric Dumazet 			if (err != 0)
15451da177e4SLinus Torvalds 				goto failure;
1546b75ed8b1SDavid Ahern 			if (nexthop_nh->fib_nh_flags & RTNH_F_LINKDOWN)
15478a3d0316SAndy Gospodarek 				linkdown++;
15481da177e4SLinus Torvalds 		} endfor_nexthops(fi)
15498a3d0316SAndy Gospodarek 		if (linkdown == fi->fib_nhs)
15508a3d0316SAndy Gospodarek 			fi->fib_flags |= RTNH_F_LINKDOWN;
15511da177e4SLinus Torvalds 	}
15521da177e4SLinus Torvalds 
1553c3ab2b4eSDavid Ahern 	if (fi->fib_prefsrc && !fib_valid_prefsrc(cfg, fi->fib_prefsrc)) {
1554c3ab2b4eSDavid Ahern 		NL_SET_ERR_MSG(extack, "Invalid prefsrc address");
15551da177e4SLinus Torvalds 		goto err_inval;
1556c3ab2b4eSDavid Ahern 	}
15571da177e4SLinus Torvalds 
15584c7e8084SDavid Ahern 	if (!fi->nh) {
15591fc050a1SDavid S. Miller 		change_nexthops(fi) {
1560dcb1ecb5SDavid Ahern 			fib_info_update_nhc_saddr(net, &nexthop_nh->nh_common,
1561dcb1ecb5SDavid Ahern 						  fi->fib_scope);
156219a9d136SDavid Ahern 			if (nexthop_nh->fib_nh_gw_family == AF_INET6)
156319a9d136SDavid Ahern 				fi->fib_nh_is_v6 = true;
15641fc050a1SDavid S. Miller 		} endfor_nexthops(fi)
15651fc050a1SDavid S. Miller 
15660e884c78SPeter Nørlund 		fib_rebalance(fi);
15674c7e8084SDavid Ahern 	}
15680e884c78SPeter Nørlund 
15691da177e4SLinus Torvalds link_it:
15706a31d2a9SEric Dumazet 	ofi = fib_find_info(fi);
15716a31d2a9SEric Dumazet 	if (ofi) {
15721da177e4SLinus Torvalds 		fi->fib_dead = 1;
15731da177e4SLinus Torvalds 		free_fib_info(fi);
157479976892SYajun Deng 		refcount_inc(&ofi->fib_treeref);
15751da177e4SLinus Torvalds 		return ofi;
15761da177e4SLinus Torvalds 	}
15771da177e4SLinus Torvalds 
157828814cd1SDavid Ahern 	refcount_set(&fi->fib_treeref, 1);
15790029c0deSReshetova, Elena 	refcount_set(&fi->fib_clntref, 1);
1580832b4c5eSStephen Hemminger 	spin_lock_bh(&fib_info_lock);
15810a6e6b3cSEric Dumazet 	fib_info_cnt++;
15821da177e4SLinus Torvalds 	hlist_add_head(&fi->fib_hash,
15831da177e4SLinus Torvalds 		       &fib_info_hash[fib_info_hashfn(fi)]);
15841da177e4SLinus Torvalds 	if (fi->fib_prefsrc) {
15851da177e4SLinus Torvalds 		struct hlist_head *head;
15861da177e4SLinus Torvalds 
158779eb15daSEric Dumazet 		head = fib_info_laddrhash_bucket(net, fi->fib_prefsrc);
15881da177e4SLinus Torvalds 		hlist_add_head(&fi->fib_lhash, head);
15891da177e4SLinus Torvalds 	}
15904c7e8084SDavid Ahern 	if (fi->nh) {
15914c7e8084SDavid Ahern 		list_add(&fi->nh_list, &nh->fi_list);
15924c7e8084SDavid Ahern 	} else {
15931da177e4SLinus Torvalds 		change_nexthops(fi) {
15941da177e4SLinus Torvalds 			struct hlist_head *head;
15951da177e4SLinus Torvalds 
1596b75ed8b1SDavid Ahern 			if (!nexthop_nh->fib_nh_dev)
15971da177e4SLinus Torvalds 				continue;
1598d07418afSEric Dumazet 			head = fib_info_devhash_bucket(nexthop_nh->fib_nh_dev);
159971fceff0SDavid S. Miller 			hlist_add_head(&nexthop_nh->nh_hash, head);
16001da177e4SLinus Torvalds 		} endfor_nexthops(fi)
16014c7e8084SDavid Ahern 	}
1602832b4c5eSStephen Hemminger 	spin_unlock_bh(&fib_info_lock);
16031da177e4SLinus Torvalds 	return fi;
16041da177e4SLinus Torvalds 
16051da177e4SLinus Torvalds err_inval:
16061da177e4SLinus Torvalds 	err = -EINVAL;
16071da177e4SLinus Torvalds 
16081da177e4SLinus Torvalds failure:
16091da177e4SLinus Torvalds 	if (fi) {
16101da177e4SLinus Torvalds 		fi->fib_dead = 1;
16111da177e4SLinus Torvalds 		free_fib_info(fi);
16121da177e4SLinus Torvalds 	}
16134e902c57SThomas Graf 
16144e902c57SThomas Graf 	return ERR_PTR(err);
16151da177e4SLinus Torvalds }
16161da177e4SLinus Torvalds 
1617c0a72077SDavid Ahern int fib_nexthop_info(struct sk_buff *skb, const struct fib_nh_common *nhc,
16187bdf4de1SDonald Sharp 		     u8 rt_family, unsigned char *flags, bool skip_oif)
1619b0f60193SDavid Ahern {
1620c2364199SDavid Ahern 	if (nhc->nhc_flags & RTNH_F_DEAD)
1621b0f60193SDavid Ahern 		*flags |= RTNH_F_DEAD;
1622b0f60193SDavid Ahern 
1623c2364199SDavid Ahern 	if (nhc->nhc_flags & RTNH_F_LINKDOWN) {
1624b0f60193SDavid Ahern 		*flags |= RTNH_F_LINKDOWN;
1625b0f60193SDavid Ahern 
1626b0f60193SDavid Ahern 		rcu_read_lock();
1627c2364199SDavid Ahern 		switch (nhc->nhc_family) {
1628c2364199SDavid Ahern 		case AF_INET:
1629c2364199SDavid Ahern 			if (ip_ignore_linkdown(nhc->nhc_dev))
1630b0f60193SDavid Ahern 				*flags |= RTNH_F_DEAD;
1631c2364199SDavid Ahern 			break;
1632c0a72077SDavid Ahern 		case AF_INET6:
1633c0a72077SDavid Ahern 			if (ip6_ignore_linkdown(nhc->nhc_dev))
1634c0a72077SDavid Ahern 				*flags |= RTNH_F_DEAD;
1635c0a72077SDavid Ahern 			break;
1636c2364199SDavid Ahern 		}
1637b0f60193SDavid Ahern 		rcu_read_unlock();
1638b0f60193SDavid Ahern 	}
1639b0f60193SDavid Ahern 
1640bdf00467SDavid Ahern 	switch (nhc->nhc_gw_family) {
1641c2364199SDavid Ahern 	case AF_INET:
1642c2364199SDavid Ahern 		if (nla_put_in_addr(skb, RTA_GATEWAY, nhc->nhc_gw.ipv4))
1643b0f60193SDavid Ahern 			goto nla_put_failure;
1644c2364199SDavid Ahern 		break;
1645c0a72077SDavid Ahern 	case AF_INET6:
1646d1566268SDavid Ahern 		/* if gateway family does not match nexthop family
1647d1566268SDavid Ahern 		 * gateway is encoded as RTA_VIA
1648d1566268SDavid Ahern 		 */
16497bdf4de1SDonald Sharp 		if (rt_family != nhc->nhc_gw_family) {
1650d1566268SDavid Ahern 			int alen = sizeof(struct in6_addr);
1651d1566268SDavid Ahern 			struct nlattr *nla;
1652d1566268SDavid Ahern 			struct rtvia *via;
1653d1566268SDavid Ahern 
1654d1566268SDavid Ahern 			nla = nla_reserve(skb, RTA_VIA, alen + 2);
1655d1566268SDavid Ahern 			if (!nla)
1656c0a72077SDavid Ahern 				goto nla_put_failure;
1657d1566268SDavid Ahern 
1658d1566268SDavid Ahern 			via = nla_data(nla);
1659d1566268SDavid Ahern 			via->rtvia_family = AF_INET6;
1660d1566268SDavid Ahern 			memcpy(via->rtvia_addr, &nhc->nhc_gw.ipv6, alen);
1661d1566268SDavid Ahern 		} else if (nla_put_in6_addr(skb, RTA_GATEWAY,
1662d1566268SDavid Ahern 					    &nhc->nhc_gw.ipv6) < 0) {
1663d1566268SDavid Ahern 			goto nla_put_failure;
1664d1566268SDavid Ahern 		}
1665c0a72077SDavid Ahern 		break;
1666c2364199SDavid Ahern 	}
1667b0f60193SDavid Ahern 
1668ca787e0bSIdo Schimmel 	*flags |= (nhc->nhc_flags &
1669ca787e0bSIdo Schimmel 		   (RTNH_F_ONLINK | RTNH_F_OFFLOAD | RTNH_F_TRAP));
1670b0f60193SDavid Ahern 
1671c2364199SDavid Ahern 	if (!skip_oif && nhc->nhc_dev &&
1672c2364199SDavid Ahern 	    nla_put_u32(skb, RTA_OIF, nhc->nhc_dev->ifindex))
1673b0f60193SDavid Ahern 		goto nla_put_failure;
1674b0f60193SDavid Ahern 
1675c2364199SDavid Ahern 	if (nhc->nhc_lwtstate &&
1676ffa8ce54SDavid Ahern 	    lwtunnel_fill_encap(skb, nhc->nhc_lwtstate,
1677ffa8ce54SDavid Ahern 				RTA_ENCAP, RTA_ENCAP_TYPE) < 0)
1678b0f60193SDavid Ahern 		goto nla_put_failure;
1679b0f60193SDavid Ahern 
1680b0f60193SDavid Ahern 	return 0;
1681b0f60193SDavid Ahern 
1682b0f60193SDavid Ahern nla_put_failure:
1683b0f60193SDavid Ahern 	return -EMSGSIZE;
1684b0f60193SDavid Ahern }
1685c0a72077SDavid Ahern EXPORT_SYMBOL_GPL(fib_nexthop_info);
1686b0f60193SDavid Ahern 
1687c0a72077SDavid Ahern #if IS_ENABLED(CONFIG_IP_ROUTE_MULTIPATH) || IS_ENABLED(CONFIG_IPV6)
1688c0a72077SDavid Ahern int fib_add_nexthop(struct sk_buff *skb, const struct fib_nh_common *nhc,
1689597aa16cSXiao Liang 		    int nh_weight, u8 rt_family, u32 nh_tclassid)
1690b0f60193SDavid Ahern {
1691c2364199SDavid Ahern 	const struct net_device *dev = nhc->nhc_dev;
1692b0f60193SDavid Ahern 	struct rtnexthop *rtnh;
1693ecc5663cSDavid Ahern 	unsigned char flags = 0;
1694b0f60193SDavid Ahern 
1695b0f60193SDavid Ahern 	rtnh = nla_reserve_nohdr(skb, sizeof(*rtnh));
1696b0f60193SDavid Ahern 	if (!rtnh)
1697b0f60193SDavid Ahern 		goto nla_put_failure;
1698b0f60193SDavid Ahern 
1699c2364199SDavid Ahern 	rtnh->rtnh_hops = nh_weight - 1;
1700b0f60193SDavid Ahern 	rtnh->rtnh_ifindex = dev ? dev->ifindex : 0;
1701b0f60193SDavid Ahern 
17027bdf4de1SDonald Sharp 	if (fib_nexthop_info(skb, nhc, rt_family, &flags, true) < 0)
1703b0f60193SDavid Ahern 		goto nla_put_failure;
1704b0f60193SDavid Ahern 
1705b0f60193SDavid Ahern 	rtnh->rtnh_flags = flags;
1706b0f60193SDavid Ahern 
1707597aa16cSXiao Liang 	if (nh_tclassid && nla_put_u32(skb, RTA_FLOW, nh_tclassid))
1708597aa16cSXiao Liang 		goto nla_put_failure;
1709597aa16cSXiao Liang 
1710b0f60193SDavid Ahern 	/* length of rtnetlink header + attributes */
1711b0f60193SDavid Ahern 	rtnh->rtnh_len = nlmsg_get_pos(skb) - (void *)rtnh;
1712b0f60193SDavid Ahern 
1713b0f60193SDavid Ahern 	return 0;
1714b0f60193SDavid Ahern 
1715b0f60193SDavid Ahern nla_put_failure:
1716b0f60193SDavid Ahern 	return -EMSGSIZE;
1717b0f60193SDavid Ahern }
1718c0a72077SDavid Ahern EXPORT_SYMBOL_GPL(fib_add_nexthop);
1719c2364199SDavid Ahern #endif
1720b0f60193SDavid Ahern 
1721c2364199SDavid Ahern #ifdef CONFIG_IP_ROUTE_MULTIPATH
1722b0f60193SDavid Ahern static int fib_add_multipath(struct sk_buff *skb, struct fib_info *fi)
1723b0f60193SDavid Ahern {
1724b0f60193SDavid Ahern 	struct nlattr *mp;
1725b0f60193SDavid Ahern 
1726ae0be8deSMichal Kubecek 	mp = nla_nest_start_noflag(skb, RTA_MULTIPATH);
1727b0f60193SDavid Ahern 	if (!mp)
1728b0f60193SDavid Ahern 		goto nla_put_failure;
1729b0f60193SDavid Ahern 
17304c7e8084SDavid Ahern 	if (unlikely(fi->nh)) {
17317bdf4de1SDonald Sharp 		if (nexthop_mpath_fill_node(skb, fi->nh, AF_INET) < 0)
17324c7e8084SDavid Ahern 			goto nla_put_failure;
17334c7e8084SDavid Ahern 		goto mp_end;
17344c7e8084SDavid Ahern 	}
17354c7e8084SDavid Ahern 
1736b0f60193SDavid Ahern 	for_nexthops(fi) {
1737597aa16cSXiao Liang 		u32 nh_tclassid = 0;
1738b0f60193SDavid Ahern #ifdef CONFIG_IP_ROUTE_CLASSID
1739597aa16cSXiao Liang 		nh_tclassid = nh->nh_tclassid;
1740b0f60193SDavid Ahern #endif
1741597aa16cSXiao Liang 		if (fib_add_nexthop(skb, &nh->nh_common, nh->fib_nh_weight,
1742597aa16cSXiao Liang 				    AF_INET, nh_tclassid) < 0)
1743597aa16cSXiao Liang 			goto nla_put_failure;
1744b0f60193SDavid Ahern 	} endfor_nexthops(fi);
1745b0f60193SDavid Ahern 
17464c7e8084SDavid Ahern mp_end:
1747b0f60193SDavid Ahern 	nla_nest_end(skb, mp);
1748b0f60193SDavid Ahern 
1749b0f60193SDavid Ahern 	return 0;
1750b0f60193SDavid Ahern 
1751b0f60193SDavid Ahern nla_put_failure:
1752b0f60193SDavid Ahern 	return -EMSGSIZE;
1753b0f60193SDavid Ahern }
1754b0f60193SDavid Ahern #else
1755b0f60193SDavid Ahern static int fib_add_multipath(struct sk_buff *skb, struct fib_info *fi)
1756b0f60193SDavid Ahern {
1757b0f60193SDavid Ahern 	return 0;
1758b0f60193SDavid Ahern }
1759b0f60193SDavid Ahern #endif
1760b0f60193SDavid Ahern 
176115e47304SEric W. Biederman int fib_dump_info(struct sk_buff *skb, u32 portid, u32 seq, int event,
176208554789SAmit Cohen 		  const struct fib_rt_info *fri, unsigned int flags)
17631da177e4SLinus Torvalds {
17641e301fd0SIdo Schimmel 	unsigned int nhs = fib_info_num_path(fri->fi);
17651e301fd0SIdo Schimmel 	struct fib_info *fi = fri->fi;
17661e301fd0SIdo Schimmel 	u32 tb_id = fri->tb_id;
17671da177e4SLinus Torvalds 	struct nlmsghdr *nlh;
1768be403ea1SThomas Graf 	struct rtmsg *rtm;
17691da177e4SLinus Torvalds 
177015e47304SEric W. Biederman 	nlh = nlmsg_put(skb, portid, seq, event, sizeof(*rtm), flags);
177151456b29SIan Morris 	if (!nlh)
177226932566SPatrick McHardy 		return -EMSGSIZE;
1773be403ea1SThomas Graf 
1774be403ea1SThomas Graf 	rtm = nlmsg_data(nlh);
17751da177e4SLinus Torvalds 	rtm->rtm_family = AF_INET;
17761e301fd0SIdo Schimmel 	rtm->rtm_dst_len = fri->dst_len;
17771da177e4SLinus Torvalds 	rtm->rtm_src_len = 0;
17781e301fd0SIdo Schimmel 	rtm->rtm_tos = fri->tos;
1779709772e6SKrzysztof Piotr Oledzki 	if (tb_id < 256)
17801da177e4SLinus Torvalds 		rtm->rtm_table = tb_id;
1781709772e6SKrzysztof Piotr Oledzki 	else
1782709772e6SKrzysztof Piotr Oledzki 		rtm->rtm_table = RT_TABLE_COMPAT;
1783f3756b79SDavid S. Miller 	if (nla_put_u32(skb, RTA_TABLE, tb_id))
1784f3756b79SDavid S. Miller 		goto nla_put_failure;
17851e301fd0SIdo Schimmel 	rtm->rtm_type = fri->type;
17861da177e4SLinus Torvalds 	rtm->rtm_flags = fi->fib_flags;
178737e826c5SDavid S. Miller 	rtm->rtm_scope = fi->fib_scope;
17881da177e4SLinus Torvalds 	rtm->rtm_protocol = fi->fib_protocol;
1789be403ea1SThomas Graf 
1790f3756b79SDavid S. Miller 	if (rtm->rtm_dst_len &&
17911e301fd0SIdo Schimmel 	    nla_put_in_addr(skb, RTA_DST, fri->dst))
1792f3756b79SDavid S. Miller 		goto nla_put_failure;
1793f3756b79SDavid S. Miller 	if (fi->fib_priority &&
1794f3756b79SDavid S. Miller 	    nla_put_u32(skb, RTA_PRIORITY, fi->fib_priority))
1795f3756b79SDavid S. Miller 		goto nla_put_failure;
17963fb07dafSEric Dumazet 	if (rtnetlink_put_metrics(skb, fi->fib_metrics->metrics) < 0)
1797be403ea1SThomas Graf 		goto nla_put_failure;
1798be403ea1SThomas Graf 
1799f3756b79SDavid S. Miller 	if (fi->fib_prefsrc &&
1800930345eaSJiri Benc 	    nla_put_in_addr(skb, RTA_PREFSRC, fi->fib_prefsrc))
1801f3756b79SDavid S. Miller 		goto nla_put_failure;
18024c7e8084SDavid Ahern 
18034c7e8084SDavid Ahern 	if (fi->nh) {
18044c7e8084SDavid Ahern 		if (nla_put_u32(skb, RTA_NH_ID, fi->nh->id))
18054c7e8084SDavid Ahern 			goto nla_put_failure;
18064c7e8084SDavid Ahern 		if (nexthop_is_blackhole(fi->nh))
18074c7e8084SDavid Ahern 			rtm->rtm_type = RTN_BLACKHOLE;
18084f80116dSRoopa Prabhu 		if (!fi->fib_net->ipv4.sysctl_nexthop_compat_mode)
18094f80116dSRoopa Prabhu 			goto offload;
18104c7e8084SDavid Ahern 	}
18114c7e8084SDavid Ahern 
18125481d73fSDavid Ahern 	if (nhs == 1) {
1813dcb1ecb5SDavid Ahern 		const struct fib_nh_common *nhc = fib_info_nhc(fi, 0);
1814ecc5663cSDavid Ahern 		unsigned char flags = 0;
1815be403ea1SThomas Graf 
18167bdf4de1SDonald Sharp 		if (fib_nexthop_info(skb, nhc, AF_INET, &flags, false) < 0)
1817be403ea1SThomas Graf 			goto nla_put_failure;
18181da177e4SLinus Torvalds 
1819b0f60193SDavid Ahern 		rtm->rtm_flags = flags;
1820c7066f70SPatrick McHardy #ifdef CONFIG_IP_ROUTE_CLASSID
1821dcb1ecb5SDavid Ahern 		if (nhc->nhc_family == AF_INET) {
1822dcb1ecb5SDavid Ahern 			struct fib_nh *nh;
1823dcb1ecb5SDavid Ahern 
1824dcb1ecb5SDavid Ahern 			nh = container_of(nhc, struct fib_nh, nh_common);
1825f3756b79SDavid S. Miller 			if (nh->nh_tclassid &&
1826f3756b79SDavid S. Miller 			    nla_put_u32(skb, RTA_FLOW, nh->nh_tclassid))
1827f3756b79SDavid S. Miller 				goto nla_put_failure;
1828dcb1ecb5SDavid Ahern 		}
18298265abc0SPatrick McHardy #endif
1830b0f60193SDavid Ahern 	} else {
1831b0f60193SDavid Ahern 		if (fib_add_multipath(skb, fi) < 0)
1832ea7a8085SDavid Ahern 			goto nla_put_failure;
18331da177e4SLinus Torvalds 	}
1834b0f60193SDavid Ahern 
18354f80116dSRoopa Prabhu offload:
183690b93f1bSIdo Schimmel 	if (fri->offload)
183790b93f1bSIdo Schimmel 		rtm->rtm_flags |= RTM_F_OFFLOAD;
183890b93f1bSIdo Schimmel 	if (fri->trap)
183990b93f1bSIdo Schimmel 		rtm->rtm_flags |= RTM_F_TRAP;
184036c5100eSAmit Cohen 	if (fri->offload_failed)
184136c5100eSAmit Cohen 		rtm->rtm_flags |= RTM_F_OFFLOAD_FAILED;
184290b93f1bSIdo Schimmel 
1843053c095aSJohannes Berg 	nlmsg_end(skb, nlh);
1844053c095aSJohannes Berg 	return 0;
18451da177e4SLinus Torvalds 
1846be403ea1SThomas Graf nla_put_failure:
184726932566SPatrick McHardy 	nlmsg_cancel(skb, nlh);
184826932566SPatrick McHardy 	return -EMSGSIZE;
18491da177e4SLinus Torvalds }
18501da177e4SLinus Torvalds 
18511da177e4SLinus Torvalds /*
18526a31d2a9SEric Dumazet  * Update FIB if:
18536a31d2a9SEric Dumazet  * - local address disappeared -> we must delete all the entries
18546a31d2a9SEric Dumazet  *   referring to it.
18556a31d2a9SEric Dumazet  * - device went down -> we must shutdown all nexthops going via it.
18561da177e4SLinus Torvalds  */
18575a56a0b3SMark Tomlinson int fib_sync_down_addr(struct net_device *dev, __be32 local)
18581da177e4SLinus Torvalds {
1859e0a31262SDavid Ahern 	int tb_id = l3mdev_fib_table(dev) ? : RT_TABLE_MAIN;
18605a56a0b3SMark Tomlinson 	struct net *net = dev_net(dev);
186179eb15daSEric Dumazet 	struct hlist_head *head;
18621da177e4SLinus Torvalds 	struct fib_info *fi;
186379eb15daSEric Dumazet 	int ret = 0;
18641da177e4SLinus Torvalds 
186551456b29SIan Morris 	if (!fib_info_laddrhash || local == 0)
186685326fa5SDenis V. Lunev 		return 0;
186785326fa5SDenis V. Lunev 
186879eb15daSEric Dumazet 	head = fib_info_laddrhash_bucket(net, local);
1869b67bfe0dSSasha Levin 	hlist_for_each_entry(fi, head, fib_lhash) {
18705a56a0b3SMark Tomlinson 		if (!net_eq(fi->fib_net, net) ||
18715a56a0b3SMark Tomlinson 		    fi->fib_tb_id != tb_id)
18724814bdbdSDenis V. Lunev 			continue;
18731da177e4SLinus Torvalds 		if (fi->fib_prefsrc == local) {
18741da177e4SLinus Torvalds 			fi->fib_flags |= RTNH_F_DEAD;
18751da177e4SLinus Torvalds 			ret++;
18761da177e4SLinus Torvalds 		}
18771da177e4SLinus Torvalds 	}
187885326fa5SDenis V. Lunev 	return ret;
18791da177e4SLinus Torvalds }
18801da177e4SLinus Torvalds 
1881b75ed8b1SDavid Ahern static int call_fib_nh_notifiers(struct fib_nh *nh,
1882982acb97SIdo Schimmel 				 enum fib_event_type event_type)
1883982acb97SIdo Schimmel {
1884b75ed8b1SDavid Ahern 	bool ignore_link_down = ip_ignore_linkdown(nh->fib_nh_dev);
1885982acb97SIdo Schimmel 	struct fib_nh_notifier_info info = {
1886b75ed8b1SDavid Ahern 		.fib_nh = nh,
1887982acb97SIdo Schimmel 	};
1888982acb97SIdo Schimmel 
1889982acb97SIdo Schimmel 	switch (event_type) {
1890982acb97SIdo Schimmel 	case FIB_EVENT_NH_ADD:
1891b75ed8b1SDavid Ahern 		if (nh->fib_nh_flags & RTNH_F_DEAD)
1892982acb97SIdo Schimmel 			break;
1893b75ed8b1SDavid Ahern 		if (ignore_link_down && nh->fib_nh_flags & RTNH_F_LINKDOWN)
1894982acb97SIdo Schimmel 			break;
1895b75ed8b1SDavid Ahern 		return call_fib4_notifiers(dev_net(nh->fib_nh_dev), event_type,
1896982acb97SIdo Schimmel 					   &info.info);
1897982acb97SIdo Schimmel 	case FIB_EVENT_NH_DEL:
1898b75ed8b1SDavid Ahern 		if ((ignore_link_down && nh->fib_nh_flags & RTNH_F_LINKDOWN) ||
1899b75ed8b1SDavid Ahern 		    (nh->fib_nh_flags & RTNH_F_DEAD))
1900b75ed8b1SDavid Ahern 			return call_fib4_notifiers(dev_net(nh->fib_nh_dev),
1901982acb97SIdo Schimmel 						   event_type, &info.info);
190279121184SGustavo A. R. Silva 		break;
1903982acb97SIdo Schimmel 	default:
1904982acb97SIdo Schimmel 		break;
1905982acb97SIdo Schimmel 	}
1906982acb97SIdo Schimmel 
1907982acb97SIdo Schimmel 	return NOTIFY_DONE;
1908982acb97SIdo Schimmel }
1909982acb97SIdo Schimmel 
1910af7d6cceSSabrina Dubroca /* Update the PMTU of exceptions when:
1911af7d6cceSSabrina Dubroca  * - the new MTU of the first hop becomes smaller than the PMTU
1912af7d6cceSSabrina Dubroca  * - the old MTU was the same as the PMTU, and it limited discovery of
1913af7d6cceSSabrina Dubroca  *   larger MTUs on the path. With that limit raised, we can now
1914af7d6cceSSabrina Dubroca  *   discover larger MTUs
1915af7d6cceSSabrina Dubroca  * A special case is locked exceptions, for which the PMTU is smaller
1916af7d6cceSSabrina Dubroca  * than the minimal accepted PMTU:
1917af7d6cceSSabrina Dubroca  * - if the new MTU is greater than the PMTU, don't make any change
1918af7d6cceSSabrina Dubroca  * - otherwise, unlock and set PMTU
1919af7d6cceSSabrina Dubroca  */
192006c77c3eSDavid Ahern void fib_nhc_update_mtu(struct fib_nh_common *nhc, u32 new, u32 orig)
1921af7d6cceSSabrina Dubroca {
1922af7d6cceSSabrina Dubroca 	struct fnhe_hash_bucket *bucket;
1923af7d6cceSSabrina Dubroca 	int i;
1924af7d6cceSSabrina Dubroca 
1925a5995e71SDavid Ahern 	bucket = rcu_dereference_protected(nhc->nhc_exceptions, 1);
1926af7d6cceSSabrina Dubroca 	if (!bucket)
1927af7d6cceSSabrina Dubroca 		return;
1928af7d6cceSSabrina Dubroca 
1929af7d6cceSSabrina Dubroca 	for (i = 0; i < FNHE_HASH_SIZE; i++) {
1930af7d6cceSSabrina Dubroca 		struct fib_nh_exception *fnhe;
1931af7d6cceSSabrina Dubroca 
1932af7d6cceSSabrina Dubroca 		for (fnhe = rcu_dereference_protected(bucket[i].chain, 1);
1933af7d6cceSSabrina Dubroca 		     fnhe;
1934af7d6cceSSabrina Dubroca 		     fnhe = rcu_dereference_protected(fnhe->fnhe_next, 1)) {
1935af7d6cceSSabrina Dubroca 			if (fnhe->fnhe_mtu_locked) {
1936af7d6cceSSabrina Dubroca 				if (new <= fnhe->fnhe_pmtu) {
1937af7d6cceSSabrina Dubroca 					fnhe->fnhe_pmtu = new;
1938af7d6cceSSabrina Dubroca 					fnhe->fnhe_mtu_locked = false;
1939af7d6cceSSabrina Dubroca 				}
1940af7d6cceSSabrina Dubroca 			} else if (new < fnhe->fnhe_pmtu ||
1941af7d6cceSSabrina Dubroca 				   orig == fnhe->fnhe_pmtu) {
1942af7d6cceSSabrina Dubroca 				fnhe->fnhe_pmtu = new;
1943af7d6cceSSabrina Dubroca 			}
1944af7d6cceSSabrina Dubroca 		}
1945af7d6cceSSabrina Dubroca 	}
1946af7d6cceSSabrina Dubroca }
1947af7d6cceSSabrina Dubroca 
1948af7d6cceSSabrina Dubroca void fib_sync_mtu(struct net_device *dev, u32 orig_mtu)
1949af7d6cceSSabrina Dubroca {
1950d07418afSEric Dumazet 	struct hlist_head *head = fib_info_devhash_bucket(dev);
1951af7d6cceSSabrina Dubroca 	struct fib_nh *nh;
1952af7d6cceSSabrina Dubroca 
1953af7d6cceSSabrina Dubroca 	hlist_for_each_entry(nh, head, nh_hash) {
1954b75ed8b1SDavid Ahern 		if (nh->fib_nh_dev == dev)
195506c77c3eSDavid Ahern 			fib_nhc_update_mtu(&nh->nh_common, dev->mtu, orig_mtu);
1956af7d6cceSSabrina Dubroca 	}
1957af7d6cceSSabrina Dubroca }
1958af7d6cceSSabrina Dubroca 
19594f823defSJulian Anastasov /* Event              force Flags           Description
19604f823defSJulian Anastasov  * NETDEV_CHANGE      0     LINKDOWN        Carrier OFF, not for scope host
19614f823defSJulian Anastasov  * NETDEV_DOWN        0     LINKDOWN|DEAD   Link down, not for scope host
19624f823defSJulian Anastasov  * NETDEV_DOWN        1     LINKDOWN|DEAD   Last address removed
19634f823defSJulian Anastasov  * NETDEV_UNREGISTER  1     LINKDOWN|DEAD   Device removed
19644c7e8084SDavid Ahern  *
19654c7e8084SDavid Ahern  * only used when fib_nh is built into fib_info
19664f823defSJulian Anastasov  */
19674f823defSJulian Anastasov int fib_sync_down_dev(struct net_device *dev, unsigned long event, bool force)
196885326fa5SDenis V. Lunev {
1969d07418afSEric Dumazet 	struct hlist_head *head = fib_info_devhash_bucket(dev);
19701da177e4SLinus Torvalds 	struct fib_info *prev_fi = NULL;
1971d07418afSEric Dumazet 	int scope = RT_SCOPE_NOWHERE;
19721da177e4SLinus Torvalds 	struct fib_nh *nh;
1973d07418afSEric Dumazet 	int ret = 0;
19741da177e4SLinus Torvalds 
19754f823defSJulian Anastasov 	if (force)
197685326fa5SDenis V. Lunev 		scope = -1;
197785326fa5SDenis V. Lunev 
1978b67bfe0dSSasha Levin 	hlist_for_each_entry(nh, head, nh_hash) {
19791da177e4SLinus Torvalds 		struct fib_info *fi = nh->nh_parent;
19801da177e4SLinus Torvalds 		int dead;
19811da177e4SLinus Torvalds 
19821da177e4SLinus Torvalds 		BUG_ON(!fi->fib_nhs);
1983b75ed8b1SDavid Ahern 		if (nh->fib_nh_dev != dev || fi == prev_fi)
19841da177e4SLinus Torvalds 			continue;
19851da177e4SLinus Torvalds 		prev_fi = fi;
19861da177e4SLinus Torvalds 		dead = 0;
19871da177e4SLinus Torvalds 		change_nexthops(fi) {
1988b75ed8b1SDavid Ahern 			if (nexthop_nh->fib_nh_flags & RTNH_F_DEAD)
19891da177e4SLinus Torvalds 				dead++;
1990b75ed8b1SDavid Ahern 			else if (nexthop_nh->fib_nh_dev == dev &&
1991b75ed8b1SDavid Ahern 				 nexthop_nh->fib_nh_scope != scope) {
19928a3d0316SAndy Gospodarek 				switch (event) {
19938a3d0316SAndy Gospodarek 				case NETDEV_DOWN:
19948a3d0316SAndy Gospodarek 				case NETDEV_UNREGISTER:
1995b75ed8b1SDavid Ahern 					nexthop_nh->fib_nh_flags |= RTNH_F_DEAD;
1996a8eceea8SJoe Perches 					fallthrough;
19978a3d0316SAndy Gospodarek 				case NETDEV_CHANGE:
1998b75ed8b1SDavid Ahern 					nexthop_nh->fib_nh_flags |= RTNH_F_LINKDOWN;
19998a3d0316SAndy Gospodarek 					break;
20008a3d0316SAndy Gospodarek 				}
2001982acb97SIdo Schimmel 				call_fib_nh_notifiers(nexthop_nh,
2002982acb97SIdo Schimmel 						      FIB_EVENT_NH_DEL);
20031da177e4SLinus Torvalds 				dead++;
20041da177e4SLinus Torvalds 			}
20051da177e4SLinus Torvalds #ifdef CONFIG_IP_ROUTE_MULTIPATH
20068a3d0316SAndy Gospodarek 			if (event == NETDEV_UNREGISTER &&
2007b75ed8b1SDavid Ahern 			    nexthop_nh->fib_nh_dev == dev) {
20081da177e4SLinus Torvalds 				dead = fi->fib_nhs;
20091da177e4SLinus Torvalds 				break;
20101da177e4SLinus Torvalds 			}
20111da177e4SLinus Torvalds #endif
20121da177e4SLinus Torvalds 		} endfor_nexthops(fi)
20131da177e4SLinus Torvalds 		if (dead == fi->fib_nhs) {
20148a3d0316SAndy Gospodarek 			switch (event) {
20158a3d0316SAndy Gospodarek 			case NETDEV_DOWN:
20168a3d0316SAndy Gospodarek 			case NETDEV_UNREGISTER:
20171da177e4SLinus Torvalds 				fi->fib_flags |= RTNH_F_DEAD;
2018a8eceea8SJoe Perches 				fallthrough;
20198a3d0316SAndy Gospodarek 			case NETDEV_CHANGE:
20208a3d0316SAndy Gospodarek 				fi->fib_flags |= RTNH_F_LINKDOWN;
20218a3d0316SAndy Gospodarek 				break;
20228a3d0316SAndy Gospodarek 			}
20231da177e4SLinus Torvalds 			ret++;
20241da177e4SLinus Torvalds 		}
20250e884c78SPeter Nørlund 
20260e884c78SPeter Nørlund 		fib_rebalance(fi);
20271da177e4SLinus Torvalds 	}
20281da177e4SLinus Torvalds 
20291da177e4SLinus Torvalds 	return ret;
20301da177e4SLinus Torvalds }
20311da177e4SLinus Torvalds 
20320c838ff1SDavid S. Miller /* Must be invoked inside of an RCU protected region.  */
2033c7b371e3SDavid Ahern static void fib_select_default(const struct flowi4 *flp, struct fib_result *res)
20340c838ff1SDavid S. Miller {
20350c838ff1SDavid S. Miller 	struct fib_info *fi = NULL, *last_resort = NULL;
203656315f9eSAlexander Duyck 	struct hlist_head *fa_head = res->fa_head;
20370c838ff1SDavid S. Miller 	struct fib_table *tb = res->table;
203818a912e9SJulian Anastasov 	u8 slen = 32 - res->prefixlen;
20390c838ff1SDavid S. Miller 	int order = -1, last_idx = -1;
20402392debcSJulian Anastasov 	struct fib_alias *fa, *fa1 = NULL;
20412392debcSJulian Anastasov 	u32 last_prio = res->fi->fib_priority;
20422392debcSJulian Anastasov 	u8 last_tos = 0;
20430c838ff1SDavid S. Miller 
204456315f9eSAlexander Duyck 	hlist_for_each_entry_rcu(fa, fa_head, fa_list) {
20450c838ff1SDavid S. Miller 		struct fib_info *next_fi = fa->fa_info;
20467c74b0beSDavid Ahern 		struct fib_nh_common *nhc;
20470c838ff1SDavid S. Miller 
204818a912e9SJulian Anastasov 		if (fa->fa_slen != slen)
204918a912e9SJulian Anastasov 			continue;
20502392debcSJulian Anastasov 		if (fa->fa_tos && fa->fa_tos != flp->flowi4_tos)
20512392debcSJulian Anastasov 			continue;
205218a912e9SJulian Anastasov 		if (fa->tb_id != tb->tb_id)
205318a912e9SJulian Anastasov 			continue;
20542392debcSJulian Anastasov 		if (next_fi->fib_priority > last_prio &&
20552392debcSJulian Anastasov 		    fa->fa_tos == last_tos) {
20562392debcSJulian Anastasov 			if (last_tos)
20572392debcSJulian Anastasov 				continue;
20582392debcSJulian Anastasov 			break;
20592392debcSJulian Anastasov 		}
20602392debcSJulian Anastasov 		if (next_fi->fib_flags & RTNH_F_DEAD)
20612392debcSJulian Anastasov 			continue;
20622392debcSJulian Anastasov 		last_tos = fa->fa_tos;
20632392debcSJulian Anastasov 		last_prio = next_fi->fib_priority;
20642392debcSJulian Anastasov 
206537e826c5SDavid S. Miller 		if (next_fi->fib_scope != res->scope ||
20660c838ff1SDavid S. Miller 		    fa->fa_type != RTN_UNICAST)
20670c838ff1SDavid S. Miller 			continue;
20685481d73fSDavid Ahern 
20697c74b0beSDavid Ahern 		nhc = fib_info_nhc(next_fi, 0);
20707c74b0beSDavid Ahern 		if (!nhc->nhc_gw_family || nhc->nhc_scope != RT_SCOPE_LINK)
20710c838ff1SDavid S. Miller 			continue;
20720c838ff1SDavid S. Miller 
20730c838ff1SDavid S. Miller 		fib_alias_accessed(fa);
20740c838ff1SDavid S. Miller 
207551456b29SIan Morris 		if (!fi) {
20760c838ff1SDavid S. Miller 			if (next_fi != res->fi)
20770c838ff1SDavid S. Miller 				break;
20782392debcSJulian Anastasov 			fa1 = fa;
20790c838ff1SDavid S. Miller 		} else if (!fib_detect_death(fi, order, &last_resort,
20802392debcSJulian Anastasov 					     &last_idx, fa1->fa_default)) {
20810c838ff1SDavid S. Miller 			fib_result_assign(res, fi);
20822392debcSJulian Anastasov 			fa1->fa_default = order;
20830c838ff1SDavid S. Miller 			goto out;
20840c838ff1SDavid S. Miller 		}
20850c838ff1SDavid S. Miller 		fi = next_fi;
20860c838ff1SDavid S. Miller 		order++;
20870c838ff1SDavid S. Miller 	}
20880c838ff1SDavid S. Miller 
208951456b29SIan Morris 	if (order <= 0 || !fi) {
20902392debcSJulian Anastasov 		if (fa1)
20912392debcSJulian Anastasov 			fa1->fa_default = -1;
20920c838ff1SDavid S. Miller 		goto out;
20930c838ff1SDavid S. Miller 	}
20940c838ff1SDavid S. Miller 
20950c838ff1SDavid S. Miller 	if (!fib_detect_death(fi, order, &last_resort, &last_idx,
20962392debcSJulian Anastasov 			      fa1->fa_default)) {
20970c838ff1SDavid S. Miller 		fib_result_assign(res, fi);
20982392debcSJulian Anastasov 		fa1->fa_default = order;
20990c838ff1SDavid S. Miller 		goto out;
21000c838ff1SDavid S. Miller 	}
21010c838ff1SDavid S. Miller 
21020c838ff1SDavid S. Miller 	if (last_idx >= 0)
21030c838ff1SDavid S. Miller 		fib_result_assign(res, last_resort);
21042392debcSJulian Anastasov 	fa1->fa_default = last_idx;
21050c838ff1SDavid S. Miller out:
210631d40937SEric Dumazet 	return;
21070c838ff1SDavid S. Miller }
21080c838ff1SDavid S. Miller 
21091da177e4SLinus Torvalds /*
21106a31d2a9SEric Dumazet  * Dead device goes up. We wake up dead nexthops.
21116a31d2a9SEric Dumazet  * It takes sense only on multipath routes.
21124c7e8084SDavid Ahern  *
21134c7e8084SDavid Ahern  * only used when fib_nh is built into fib_info
21141da177e4SLinus Torvalds  */
2115ecc5663cSDavid Ahern int fib_sync_up(struct net_device *dev, unsigned char nh_flags)
21161da177e4SLinus Torvalds {
21171da177e4SLinus Torvalds 	struct fib_info *prev_fi;
21181da177e4SLinus Torvalds 	struct hlist_head *head;
21191da177e4SLinus Torvalds 	struct fib_nh *nh;
21201da177e4SLinus Torvalds 	int ret;
21211da177e4SLinus Torvalds 
21221da177e4SLinus Torvalds 	if (!(dev->flags & IFF_UP))
21231da177e4SLinus Torvalds 		return 0;
21241da177e4SLinus Torvalds 
2125c9b3292eSJulian Anastasov 	if (nh_flags & RTNH_F_DEAD) {
2126c9b3292eSJulian Anastasov 		unsigned int flags = dev_get_flags(dev);
2127c9b3292eSJulian Anastasov 
2128c9b3292eSJulian Anastasov 		if (flags & (IFF_RUNNING | IFF_LOWER_UP))
2129c9b3292eSJulian Anastasov 			nh_flags |= RTNH_F_LINKDOWN;
2130c9b3292eSJulian Anastasov 	}
2131c9b3292eSJulian Anastasov 
21321da177e4SLinus Torvalds 	prev_fi = NULL;
2133d07418afSEric Dumazet 	head = fib_info_devhash_bucket(dev);
21341da177e4SLinus Torvalds 	ret = 0;
21351da177e4SLinus Torvalds 
2136b67bfe0dSSasha Levin 	hlist_for_each_entry(nh, head, nh_hash) {
21371da177e4SLinus Torvalds 		struct fib_info *fi = nh->nh_parent;
21381da177e4SLinus Torvalds 		int alive;
21391da177e4SLinus Torvalds 
21401da177e4SLinus Torvalds 		BUG_ON(!fi->fib_nhs);
2141b75ed8b1SDavid Ahern 		if (nh->fib_nh_dev != dev || fi == prev_fi)
21421da177e4SLinus Torvalds 			continue;
21431da177e4SLinus Torvalds 
21441da177e4SLinus Torvalds 		prev_fi = fi;
21451da177e4SLinus Torvalds 		alive = 0;
21461da177e4SLinus Torvalds 		change_nexthops(fi) {
2147b75ed8b1SDavid Ahern 			if (!(nexthop_nh->fib_nh_flags & nh_flags)) {
21481da177e4SLinus Torvalds 				alive++;
21491da177e4SLinus Torvalds 				continue;
21501da177e4SLinus Torvalds 			}
2151b75ed8b1SDavid Ahern 			if (!nexthop_nh->fib_nh_dev ||
2152b75ed8b1SDavid Ahern 			    !(nexthop_nh->fib_nh_dev->flags & IFF_UP))
21531da177e4SLinus Torvalds 				continue;
2154b75ed8b1SDavid Ahern 			if (nexthop_nh->fib_nh_dev != dev ||
215571fceff0SDavid S. Miller 			    !__in_dev_get_rtnl(dev))
21561da177e4SLinus Torvalds 				continue;
21571da177e4SLinus Torvalds 			alive++;
2158b75ed8b1SDavid Ahern 			nexthop_nh->fib_nh_flags &= ~nh_flags;
2159982acb97SIdo Schimmel 			call_fib_nh_notifiers(nexthop_nh, FIB_EVENT_NH_ADD);
21601da177e4SLinus Torvalds 		} endfor_nexthops(fi)
21611da177e4SLinus Torvalds 
21621da177e4SLinus Torvalds 		if (alive > 0) {
21638a3d0316SAndy Gospodarek 			fi->fib_flags &= ~nh_flags;
21641da177e4SLinus Torvalds 			ret++;
21651da177e4SLinus Torvalds 		}
21660e884c78SPeter Nørlund 
21670e884c78SPeter Nørlund 		fib_rebalance(fi);
21681da177e4SLinus Torvalds 	}
21691da177e4SLinus Torvalds 
21701da177e4SLinus Torvalds 	return ret;
21711da177e4SLinus Torvalds }
21721da177e4SLinus Torvalds 
21738a3d0316SAndy Gospodarek #ifdef CONFIG_IP_ROUTE_MULTIPATH
2174a6db4494SDavid Ahern static bool fib_good_nh(const struct fib_nh *nh)
2175a6db4494SDavid Ahern {
2176a6db4494SDavid Ahern 	int state = NUD_REACHABLE;
2177a6db4494SDavid Ahern 
2178b75ed8b1SDavid Ahern 	if (nh->fib_nh_scope == RT_SCOPE_LINK) {
2179a6db4494SDavid Ahern 		struct neighbour *n;
2180a6db4494SDavid Ahern 
2181a6db4494SDavid Ahern 		rcu_read_lock_bh();
2182a6db4494SDavid Ahern 
21831a38c43dSDavid Ahern 		if (likely(nh->fib_nh_gw_family == AF_INET))
2184b75ed8b1SDavid Ahern 			n = __ipv4_neigh_lookup_noref(nh->fib_nh_dev,
2185b75ed8b1SDavid Ahern 						   (__force u32)nh->fib_nh_gw4);
21861a38c43dSDavid Ahern 		else if (nh->fib_nh_gw_family == AF_INET6)
21871a38c43dSDavid Ahern 			n = __ipv6_neigh_lookup_noref_stub(nh->fib_nh_dev,
21881a38c43dSDavid Ahern 							   &nh->fib_nh_gw6);
21891a38c43dSDavid Ahern 		else
21901a38c43dSDavid Ahern 			n = NULL;
2191a6db4494SDavid Ahern 		if (n)
2192a6db4494SDavid Ahern 			state = n->nud_state;
2193a6db4494SDavid Ahern 
2194a6db4494SDavid Ahern 		rcu_read_unlock_bh();
2195a6db4494SDavid Ahern 	}
2196a6db4494SDavid Ahern 
2197a6db4494SDavid Ahern 	return !!(state & NUD_VALID);
2198a6db4494SDavid Ahern }
21998a3d0316SAndy Gospodarek 
22000e884c78SPeter Nørlund void fib_select_multipath(struct fib_result *res, int hash)
22011da177e4SLinus Torvalds {
22021da177e4SLinus Torvalds 	struct fib_info *fi = res->fi;
2203a6db4494SDavid Ahern 	struct net *net = fi->fib_net;
2204a6db4494SDavid Ahern 	bool first = false;
22051da177e4SLinus Torvalds 
22064c7e8084SDavid Ahern 	if (unlikely(res->fi->nh)) {
22074c7e8084SDavid Ahern 		nexthop_path_fib_result(res, hash);
22084c7e8084SDavid Ahern 		return;
22094c7e8084SDavid Ahern 	}
22104c7e8084SDavid Ahern 
2211eba618abSDavid Ahern 	change_nexthops(fi) {
22126174a30dSXin Long 		if (net->ipv4.sysctl_fib_multipath_use_neigh) {
2213eba618abSDavid Ahern 			if (!fib_good_nh(nexthop_nh))
22140eeb075fSAndy Gospodarek 				continue;
2215a6db4494SDavid Ahern 			if (!first) {
2216a6db4494SDavid Ahern 				res->nh_sel = nhsel;
2217eba618abSDavid Ahern 				res->nhc = &nexthop_nh->nh_common;
2218a6db4494SDavid Ahern 				first = true;
2219a6db4494SDavid Ahern 			}
22206174a30dSXin Long 		}
22216174a30dSXin Long 
2222eba618abSDavid Ahern 		if (hash > atomic_read(&nexthop_nh->fib_nh_upper_bound))
22236174a30dSXin Long 			continue;
22246174a30dSXin Long 
22256174a30dSXin Long 		res->nh_sel = nhsel;
2226eba618abSDavid Ahern 		res->nhc = &nexthop_nh->nh_common;
22276174a30dSXin Long 		return;
22281da177e4SLinus Torvalds 	} endfor_nexthops(fi);
22291da177e4SLinus Torvalds }
22301da177e4SLinus Torvalds #endif
22313ce58d84SDavid Ahern 
22323ce58d84SDavid Ahern void fib_select_path(struct net *net, struct fib_result *res,
2233bf4e0a3dSNikolay Aleksandrov 		     struct flowi4 *fl4, const struct sk_buff *skb)
22343ce58d84SDavid Ahern {
22350d876f2cSDavid Ahern 	if (fl4->flowi4_oif && !(fl4->flowi4_flags & FLOWI_FLAG_SKIP_NH_OIF))
22360d876f2cSDavid Ahern 		goto check_saddr;
22377a18c5b9SDavid Ahern 
22383ce58d84SDavid Ahern #ifdef CONFIG_IP_ROUTE_MULTIPATH
22395481d73fSDavid Ahern 	if (fib_info_num_path(res->fi) > 1) {
22407efc0b6bSDavid Ahern 		int h = fib_multipath_hash(net, fl4, skb, NULL);
22419920e48bSPaolo Abeni 
2242bf4e0a3dSNikolay Aleksandrov 		fib_select_multipath(res, h);
22433ce58d84SDavid Ahern 	}
22443ce58d84SDavid Ahern 	else
22453ce58d84SDavid Ahern #endif
22463ce58d84SDavid Ahern 	if (!res->prefixlen &&
22473ce58d84SDavid Ahern 	    res->table->tb_num_default > 1 &&
22480d876f2cSDavid Ahern 	    res->type == RTN_UNICAST)
22493ce58d84SDavid Ahern 		fib_select_default(fl4, res);
22503ce58d84SDavid Ahern 
22510d876f2cSDavid Ahern check_saddr:
22523ce58d84SDavid Ahern 	if (!fl4->saddr)
2253eba618abSDavid Ahern 		fl4->saddr = fib_result_prefsrc(net, res);
22543ce58d84SDavid Ahern }
2255