xref: /OK3568_Linux_fs/kernel/net/ipv4/fib_frontend.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * INET		An implementation of the TCP/IP protocol suite for the LINUX
4*4882a593Smuzhiyun  *		operating system.  INET is implemented using the  BSD Socket
5*4882a593Smuzhiyun  *		interface as the means of communication with the user level.
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  *		IPv4 Forwarding Information Base: FIB frontend.
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * Authors:	Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include <linux/module.h>
13*4882a593Smuzhiyun #include <linux/uaccess.h>
14*4882a593Smuzhiyun #include <linux/bitops.h>
15*4882a593Smuzhiyun #include <linux/capability.h>
16*4882a593Smuzhiyun #include <linux/types.h>
17*4882a593Smuzhiyun #include <linux/kernel.h>
18*4882a593Smuzhiyun #include <linux/mm.h>
19*4882a593Smuzhiyun #include <linux/string.h>
20*4882a593Smuzhiyun #include <linux/socket.h>
21*4882a593Smuzhiyun #include <linux/sockios.h>
22*4882a593Smuzhiyun #include <linux/errno.h>
23*4882a593Smuzhiyun #include <linux/in.h>
24*4882a593Smuzhiyun #include <linux/inet.h>
25*4882a593Smuzhiyun #include <linux/inetdevice.h>
26*4882a593Smuzhiyun #include <linux/netdevice.h>
27*4882a593Smuzhiyun #include <linux/if_addr.h>
28*4882a593Smuzhiyun #include <linux/if_arp.h>
29*4882a593Smuzhiyun #include <linux/skbuff.h>
30*4882a593Smuzhiyun #include <linux/cache.h>
31*4882a593Smuzhiyun #include <linux/init.h>
32*4882a593Smuzhiyun #include <linux/list.h>
33*4882a593Smuzhiyun #include <linux/slab.h>
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun #include <net/ip.h>
36*4882a593Smuzhiyun #include <net/protocol.h>
37*4882a593Smuzhiyun #include <net/route.h>
38*4882a593Smuzhiyun #include <net/tcp.h>
39*4882a593Smuzhiyun #include <net/sock.h>
40*4882a593Smuzhiyun #include <net/arp.h>
41*4882a593Smuzhiyun #include <net/ip_fib.h>
42*4882a593Smuzhiyun #include <net/nexthop.h>
43*4882a593Smuzhiyun #include <net/rtnetlink.h>
44*4882a593Smuzhiyun #include <net/xfrm.h>
45*4882a593Smuzhiyun #include <net/l3mdev.h>
46*4882a593Smuzhiyun #include <net/lwtunnel.h>
47*4882a593Smuzhiyun #include <trace/events/fib.h>
48*4882a593Smuzhiyun 
49*4882a593Smuzhiyun #ifndef CONFIG_IP_MULTIPLE_TABLES
50*4882a593Smuzhiyun 
fib4_rules_init(struct net * net)51*4882a593Smuzhiyun static int __net_init fib4_rules_init(struct net *net)
52*4882a593Smuzhiyun {
53*4882a593Smuzhiyun 	struct fib_table *local_table, *main_table;
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun 	main_table  = fib_trie_table(RT_TABLE_MAIN, NULL);
56*4882a593Smuzhiyun 	if (!main_table)
57*4882a593Smuzhiyun 		return -ENOMEM;
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun 	local_table = fib_trie_table(RT_TABLE_LOCAL, main_table);
60*4882a593Smuzhiyun 	if (!local_table)
61*4882a593Smuzhiyun 		goto fail;
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun 	hlist_add_head_rcu(&local_table->tb_hlist,
64*4882a593Smuzhiyun 				&net->ipv4.fib_table_hash[TABLE_LOCAL_INDEX]);
65*4882a593Smuzhiyun 	hlist_add_head_rcu(&main_table->tb_hlist,
66*4882a593Smuzhiyun 				&net->ipv4.fib_table_hash[TABLE_MAIN_INDEX]);
67*4882a593Smuzhiyun 	return 0;
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun fail:
70*4882a593Smuzhiyun 	fib_free_table(main_table);
71*4882a593Smuzhiyun 	return -ENOMEM;
72*4882a593Smuzhiyun }
73*4882a593Smuzhiyun #else
74*4882a593Smuzhiyun 
fib_new_table(struct net * net,u32 id)75*4882a593Smuzhiyun struct fib_table *fib_new_table(struct net *net, u32 id)
76*4882a593Smuzhiyun {
77*4882a593Smuzhiyun 	struct fib_table *tb, *alias = NULL;
78*4882a593Smuzhiyun 	unsigned int h;
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun 	if (id == 0)
81*4882a593Smuzhiyun 		id = RT_TABLE_MAIN;
82*4882a593Smuzhiyun 	tb = fib_get_table(net, id);
83*4882a593Smuzhiyun 	if (tb)
84*4882a593Smuzhiyun 		return tb;
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun 	if (id == RT_TABLE_LOCAL && !net->ipv4.fib_has_custom_rules)
87*4882a593Smuzhiyun 		alias = fib_new_table(net, RT_TABLE_MAIN);
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun 	tb = fib_trie_table(id, alias);
90*4882a593Smuzhiyun 	if (!tb)
91*4882a593Smuzhiyun 		return NULL;
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun 	switch (id) {
94*4882a593Smuzhiyun 	case RT_TABLE_MAIN:
95*4882a593Smuzhiyun 		rcu_assign_pointer(net->ipv4.fib_main, tb);
96*4882a593Smuzhiyun 		break;
97*4882a593Smuzhiyun 	case RT_TABLE_DEFAULT:
98*4882a593Smuzhiyun 		rcu_assign_pointer(net->ipv4.fib_default, tb);
99*4882a593Smuzhiyun 		break;
100*4882a593Smuzhiyun 	default:
101*4882a593Smuzhiyun 		break;
102*4882a593Smuzhiyun 	}
103*4882a593Smuzhiyun 
104*4882a593Smuzhiyun 	h = id & (FIB_TABLE_HASHSZ - 1);
105*4882a593Smuzhiyun 	hlist_add_head_rcu(&tb->tb_hlist, &net->ipv4.fib_table_hash[h]);
106*4882a593Smuzhiyun 	return tb;
107*4882a593Smuzhiyun }
108*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(fib_new_table);
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun /* caller must hold either rtnl or rcu read lock */
fib_get_table(struct net * net,u32 id)111*4882a593Smuzhiyun struct fib_table *fib_get_table(struct net *net, u32 id)
112*4882a593Smuzhiyun {
113*4882a593Smuzhiyun 	struct fib_table *tb;
114*4882a593Smuzhiyun 	struct hlist_head *head;
115*4882a593Smuzhiyun 	unsigned int h;
116*4882a593Smuzhiyun 
117*4882a593Smuzhiyun 	if (id == 0)
118*4882a593Smuzhiyun 		id = RT_TABLE_MAIN;
119*4882a593Smuzhiyun 	h = id & (FIB_TABLE_HASHSZ - 1);
120*4882a593Smuzhiyun 
121*4882a593Smuzhiyun 	head = &net->ipv4.fib_table_hash[h];
122*4882a593Smuzhiyun 	hlist_for_each_entry_rcu(tb, head, tb_hlist,
123*4882a593Smuzhiyun 				 lockdep_rtnl_is_held()) {
124*4882a593Smuzhiyun 		if (tb->tb_id == id)
125*4882a593Smuzhiyun 			return tb;
126*4882a593Smuzhiyun 	}
127*4882a593Smuzhiyun 	return NULL;
128*4882a593Smuzhiyun }
129*4882a593Smuzhiyun #endif /* CONFIG_IP_MULTIPLE_TABLES */
130*4882a593Smuzhiyun 
fib_replace_table(struct net * net,struct fib_table * old,struct fib_table * new)131*4882a593Smuzhiyun static void fib_replace_table(struct net *net, struct fib_table *old,
132*4882a593Smuzhiyun 			      struct fib_table *new)
133*4882a593Smuzhiyun {
134*4882a593Smuzhiyun #ifdef CONFIG_IP_MULTIPLE_TABLES
135*4882a593Smuzhiyun 	switch (new->tb_id) {
136*4882a593Smuzhiyun 	case RT_TABLE_MAIN:
137*4882a593Smuzhiyun 		rcu_assign_pointer(net->ipv4.fib_main, new);
138*4882a593Smuzhiyun 		break;
139*4882a593Smuzhiyun 	case RT_TABLE_DEFAULT:
140*4882a593Smuzhiyun 		rcu_assign_pointer(net->ipv4.fib_default, new);
141*4882a593Smuzhiyun 		break;
142*4882a593Smuzhiyun 	default:
143*4882a593Smuzhiyun 		break;
144*4882a593Smuzhiyun 	}
145*4882a593Smuzhiyun 
146*4882a593Smuzhiyun #endif
147*4882a593Smuzhiyun 	/* replace the old table in the hlist */
148*4882a593Smuzhiyun 	hlist_replace_rcu(&old->tb_hlist, &new->tb_hlist);
149*4882a593Smuzhiyun }
150*4882a593Smuzhiyun 
fib_unmerge(struct net * net)151*4882a593Smuzhiyun int fib_unmerge(struct net *net)
152*4882a593Smuzhiyun {
153*4882a593Smuzhiyun 	struct fib_table *old, *new, *main_table;
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun 	/* attempt to fetch local table if it has been allocated */
156*4882a593Smuzhiyun 	old = fib_get_table(net, RT_TABLE_LOCAL);
157*4882a593Smuzhiyun 	if (!old)
158*4882a593Smuzhiyun 		return 0;
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun 	new = fib_trie_unmerge(old);
161*4882a593Smuzhiyun 	if (!new)
162*4882a593Smuzhiyun 		return -ENOMEM;
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun 	/* table is already unmerged */
165*4882a593Smuzhiyun 	if (new == old)
166*4882a593Smuzhiyun 		return 0;
167*4882a593Smuzhiyun 
168*4882a593Smuzhiyun 	/* replace merged table with clean table */
169*4882a593Smuzhiyun 	fib_replace_table(net, old, new);
170*4882a593Smuzhiyun 	fib_free_table(old);
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 	/* attempt to fetch main table if it has been allocated */
173*4882a593Smuzhiyun 	main_table = fib_get_table(net, RT_TABLE_MAIN);
174*4882a593Smuzhiyun 	if (!main_table)
175*4882a593Smuzhiyun 		return 0;
176*4882a593Smuzhiyun 
177*4882a593Smuzhiyun 	/* flush local entries from main table */
178*4882a593Smuzhiyun 	fib_table_flush_external(main_table);
179*4882a593Smuzhiyun 
180*4882a593Smuzhiyun 	return 0;
181*4882a593Smuzhiyun }
182*4882a593Smuzhiyun 
fib_flush(struct net * net)183*4882a593Smuzhiyun void fib_flush(struct net *net)
184*4882a593Smuzhiyun {
185*4882a593Smuzhiyun 	int flushed = 0;
186*4882a593Smuzhiyun 	unsigned int h;
187*4882a593Smuzhiyun 
188*4882a593Smuzhiyun 	for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
189*4882a593Smuzhiyun 		struct hlist_head *head = &net->ipv4.fib_table_hash[h];
190*4882a593Smuzhiyun 		struct hlist_node *tmp;
191*4882a593Smuzhiyun 		struct fib_table *tb;
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun 		hlist_for_each_entry_safe(tb, tmp, head, tb_hlist)
194*4882a593Smuzhiyun 			flushed += fib_table_flush(net, tb, false);
195*4882a593Smuzhiyun 	}
196*4882a593Smuzhiyun 
197*4882a593Smuzhiyun 	if (flushed)
198*4882a593Smuzhiyun 		rt_cache_flush(net);
199*4882a593Smuzhiyun }
200*4882a593Smuzhiyun 
201*4882a593Smuzhiyun /*
202*4882a593Smuzhiyun  * Find address type as if only "dev" was present in the system. If
203*4882a593Smuzhiyun  * on_dev is NULL then all interfaces are taken into consideration.
204*4882a593Smuzhiyun  */
__inet_dev_addr_type(struct net * net,const struct net_device * dev,__be32 addr,u32 tb_id)205*4882a593Smuzhiyun static inline unsigned int __inet_dev_addr_type(struct net *net,
206*4882a593Smuzhiyun 						const struct net_device *dev,
207*4882a593Smuzhiyun 						__be32 addr, u32 tb_id)
208*4882a593Smuzhiyun {
209*4882a593Smuzhiyun 	struct flowi4		fl4 = { .daddr = addr };
210*4882a593Smuzhiyun 	struct fib_result	res;
211*4882a593Smuzhiyun 	unsigned int ret = RTN_BROADCAST;
212*4882a593Smuzhiyun 	struct fib_table *table;
213*4882a593Smuzhiyun 
214*4882a593Smuzhiyun 	if (ipv4_is_zeronet(addr) || ipv4_is_lbcast(addr))
215*4882a593Smuzhiyun 		return RTN_BROADCAST;
216*4882a593Smuzhiyun 	if (ipv4_is_multicast(addr))
217*4882a593Smuzhiyun 		return RTN_MULTICAST;
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 	rcu_read_lock();
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun 	table = fib_get_table(net, tb_id);
222*4882a593Smuzhiyun 	if (table) {
223*4882a593Smuzhiyun 		ret = RTN_UNICAST;
224*4882a593Smuzhiyun 		if (!fib_table_lookup(table, &fl4, &res, FIB_LOOKUP_NOREF)) {
225*4882a593Smuzhiyun 			struct fib_nh_common *nhc = fib_info_nhc(res.fi, 0);
226*4882a593Smuzhiyun 
227*4882a593Smuzhiyun 			if (!dev || dev == nhc->nhc_dev)
228*4882a593Smuzhiyun 				ret = res.type;
229*4882a593Smuzhiyun 		}
230*4882a593Smuzhiyun 	}
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 	rcu_read_unlock();
233*4882a593Smuzhiyun 	return ret;
234*4882a593Smuzhiyun }
235*4882a593Smuzhiyun 
inet_addr_type_table(struct net * net,__be32 addr,u32 tb_id)236*4882a593Smuzhiyun unsigned int inet_addr_type_table(struct net *net, __be32 addr, u32 tb_id)
237*4882a593Smuzhiyun {
238*4882a593Smuzhiyun 	return __inet_dev_addr_type(net, NULL, addr, tb_id);
239*4882a593Smuzhiyun }
240*4882a593Smuzhiyun EXPORT_SYMBOL(inet_addr_type_table);
241*4882a593Smuzhiyun 
inet_addr_type(struct net * net,__be32 addr)242*4882a593Smuzhiyun unsigned int inet_addr_type(struct net *net, __be32 addr)
243*4882a593Smuzhiyun {
244*4882a593Smuzhiyun 	return __inet_dev_addr_type(net, NULL, addr, RT_TABLE_LOCAL);
245*4882a593Smuzhiyun }
246*4882a593Smuzhiyun EXPORT_SYMBOL(inet_addr_type);
247*4882a593Smuzhiyun 
inet_dev_addr_type(struct net * net,const struct net_device * dev,__be32 addr)248*4882a593Smuzhiyun unsigned int inet_dev_addr_type(struct net *net, const struct net_device *dev,
249*4882a593Smuzhiyun 				__be32 addr)
250*4882a593Smuzhiyun {
251*4882a593Smuzhiyun 	u32 rt_table = l3mdev_fib_table(dev) ? : RT_TABLE_LOCAL;
252*4882a593Smuzhiyun 
253*4882a593Smuzhiyun 	return __inet_dev_addr_type(net, dev, addr, rt_table);
254*4882a593Smuzhiyun }
255*4882a593Smuzhiyun EXPORT_SYMBOL(inet_dev_addr_type);
256*4882a593Smuzhiyun 
257*4882a593Smuzhiyun /* inet_addr_type with dev == NULL but using the table from a dev
258*4882a593Smuzhiyun  * if one is associated
259*4882a593Smuzhiyun  */
inet_addr_type_dev_table(struct net * net,const struct net_device * dev,__be32 addr)260*4882a593Smuzhiyun unsigned int inet_addr_type_dev_table(struct net *net,
261*4882a593Smuzhiyun 				      const struct net_device *dev,
262*4882a593Smuzhiyun 				      __be32 addr)
263*4882a593Smuzhiyun {
264*4882a593Smuzhiyun 	u32 rt_table = l3mdev_fib_table(dev) ? : RT_TABLE_LOCAL;
265*4882a593Smuzhiyun 
266*4882a593Smuzhiyun 	return __inet_dev_addr_type(net, NULL, addr, rt_table);
267*4882a593Smuzhiyun }
268*4882a593Smuzhiyun EXPORT_SYMBOL(inet_addr_type_dev_table);
269*4882a593Smuzhiyun 
fib_compute_spec_dst(struct sk_buff * skb)270*4882a593Smuzhiyun __be32 fib_compute_spec_dst(struct sk_buff *skb)
271*4882a593Smuzhiyun {
272*4882a593Smuzhiyun 	struct net_device *dev = skb->dev;
273*4882a593Smuzhiyun 	struct in_device *in_dev;
274*4882a593Smuzhiyun 	struct fib_result res;
275*4882a593Smuzhiyun 	struct rtable *rt;
276*4882a593Smuzhiyun 	struct net *net;
277*4882a593Smuzhiyun 	int scope;
278*4882a593Smuzhiyun 
279*4882a593Smuzhiyun 	rt = skb_rtable(skb);
280*4882a593Smuzhiyun 	if ((rt->rt_flags & (RTCF_BROADCAST | RTCF_MULTICAST | RTCF_LOCAL)) ==
281*4882a593Smuzhiyun 	    RTCF_LOCAL)
282*4882a593Smuzhiyun 		return ip_hdr(skb)->daddr;
283*4882a593Smuzhiyun 
284*4882a593Smuzhiyun 	in_dev = __in_dev_get_rcu(dev);
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	net = dev_net(dev);
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun 	scope = RT_SCOPE_UNIVERSE;
289*4882a593Smuzhiyun 	if (!ipv4_is_zeronet(ip_hdr(skb)->saddr)) {
290*4882a593Smuzhiyun 		bool vmark = in_dev && IN_DEV_SRC_VMARK(in_dev);
291*4882a593Smuzhiyun 		struct flowi4 fl4 = {
292*4882a593Smuzhiyun 			.flowi4_iif = LOOPBACK_IFINDEX,
293*4882a593Smuzhiyun 			.flowi4_oif = l3mdev_master_ifindex_rcu(dev),
294*4882a593Smuzhiyun 			.daddr = ip_hdr(skb)->saddr,
295*4882a593Smuzhiyun 			.flowi4_tos = ip_hdr(skb)->tos & IPTOS_RT_MASK,
296*4882a593Smuzhiyun 			.flowi4_scope = scope,
297*4882a593Smuzhiyun 			.flowi4_mark = vmark ? skb->mark : 0,
298*4882a593Smuzhiyun 		};
299*4882a593Smuzhiyun 		if (!fib_lookup(net, &fl4, &res, 0))
300*4882a593Smuzhiyun 			return fib_result_prefsrc(net, &res);
301*4882a593Smuzhiyun 	} else {
302*4882a593Smuzhiyun 		scope = RT_SCOPE_LINK;
303*4882a593Smuzhiyun 	}
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun 	return inet_select_addr(dev, ip_hdr(skb)->saddr, scope);
306*4882a593Smuzhiyun }
307*4882a593Smuzhiyun 
fib_info_nh_uses_dev(struct fib_info * fi,const struct net_device * dev)308*4882a593Smuzhiyun bool fib_info_nh_uses_dev(struct fib_info *fi, const struct net_device *dev)
309*4882a593Smuzhiyun {
310*4882a593Smuzhiyun 	bool dev_match = false;
311*4882a593Smuzhiyun #ifdef CONFIG_IP_ROUTE_MULTIPATH
312*4882a593Smuzhiyun 	if (unlikely(fi->nh)) {
313*4882a593Smuzhiyun 		dev_match = nexthop_uses_dev(fi->nh, dev);
314*4882a593Smuzhiyun 	} else {
315*4882a593Smuzhiyun 		int ret;
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun 		for (ret = 0; ret < fib_info_num_path(fi); ret++) {
318*4882a593Smuzhiyun 			const struct fib_nh_common *nhc = fib_info_nhc(fi, ret);
319*4882a593Smuzhiyun 
320*4882a593Smuzhiyun 			if (nhc_l3mdev_matches_dev(nhc, dev)) {
321*4882a593Smuzhiyun 				dev_match = true;
322*4882a593Smuzhiyun 				break;
323*4882a593Smuzhiyun 			}
324*4882a593Smuzhiyun 		}
325*4882a593Smuzhiyun 	}
326*4882a593Smuzhiyun #else
327*4882a593Smuzhiyun 	if (fib_info_nhc(fi, 0)->nhc_dev == dev)
328*4882a593Smuzhiyun 		dev_match = true;
329*4882a593Smuzhiyun #endif
330*4882a593Smuzhiyun 
331*4882a593Smuzhiyun 	return dev_match;
332*4882a593Smuzhiyun }
333*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(fib_info_nh_uses_dev);
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun /* Given (packet source, input interface) and optional (dst, oif, tos):
336*4882a593Smuzhiyun  * - (main) check, that source is valid i.e. not broadcast or our local
337*4882a593Smuzhiyun  *   address.
338*4882a593Smuzhiyun  * - figure out what "logical" interface this packet arrived
339*4882a593Smuzhiyun  *   and calculate "specific destination" address.
340*4882a593Smuzhiyun  * - check, that packet arrived from expected physical interface.
341*4882a593Smuzhiyun  * called with rcu_read_lock()
342*4882a593Smuzhiyun  */
__fib_validate_source(struct sk_buff * skb,__be32 src,__be32 dst,u8 tos,int oif,struct net_device * dev,int rpf,struct in_device * idev,u32 * itag)343*4882a593Smuzhiyun static int __fib_validate_source(struct sk_buff *skb, __be32 src, __be32 dst,
344*4882a593Smuzhiyun 				 u8 tos, int oif, struct net_device *dev,
345*4882a593Smuzhiyun 				 int rpf, struct in_device *idev, u32 *itag)
346*4882a593Smuzhiyun {
347*4882a593Smuzhiyun 	struct net *net = dev_net(dev);
348*4882a593Smuzhiyun 	struct flow_keys flkeys;
349*4882a593Smuzhiyun 	int ret, no_addr;
350*4882a593Smuzhiyun 	struct fib_result res;
351*4882a593Smuzhiyun 	struct flowi4 fl4;
352*4882a593Smuzhiyun 	bool dev_match;
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun 	fl4.flowi4_oif = 0;
355*4882a593Smuzhiyun 	fl4.flowi4_iif = l3mdev_master_ifindex_rcu(dev);
356*4882a593Smuzhiyun 	if (!fl4.flowi4_iif)
357*4882a593Smuzhiyun 		fl4.flowi4_iif = oif ? : LOOPBACK_IFINDEX;
358*4882a593Smuzhiyun 	fl4.daddr = src;
359*4882a593Smuzhiyun 	fl4.saddr = dst;
360*4882a593Smuzhiyun 	fl4.flowi4_tos = tos;
361*4882a593Smuzhiyun 	fl4.flowi4_scope = RT_SCOPE_UNIVERSE;
362*4882a593Smuzhiyun 	fl4.flowi4_tun_key.tun_id = 0;
363*4882a593Smuzhiyun 	fl4.flowi4_flags = 0;
364*4882a593Smuzhiyun 	fl4.flowi4_uid = sock_net_uid(net, NULL);
365*4882a593Smuzhiyun 	fl4.flowi4_multipath_hash = 0;
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 	no_addr = idev->ifa_list == NULL;
368*4882a593Smuzhiyun 
369*4882a593Smuzhiyun 	fl4.flowi4_mark = IN_DEV_SRC_VMARK(idev) ? skb->mark : 0;
370*4882a593Smuzhiyun 	if (!fib4_rules_early_flow_dissect(net, skb, &fl4, &flkeys)) {
371*4882a593Smuzhiyun 		fl4.flowi4_proto = 0;
372*4882a593Smuzhiyun 		fl4.fl4_sport = 0;
373*4882a593Smuzhiyun 		fl4.fl4_dport = 0;
374*4882a593Smuzhiyun 	} else {
375*4882a593Smuzhiyun 		swap(fl4.fl4_sport, fl4.fl4_dport);
376*4882a593Smuzhiyun 	}
377*4882a593Smuzhiyun 
378*4882a593Smuzhiyun 	if (fib_lookup(net, &fl4, &res, 0))
379*4882a593Smuzhiyun 		goto last_resort;
380*4882a593Smuzhiyun 	if (res.type != RTN_UNICAST &&
381*4882a593Smuzhiyun 	    (res.type != RTN_LOCAL || !IN_DEV_ACCEPT_LOCAL(idev)))
382*4882a593Smuzhiyun 		goto e_inval;
383*4882a593Smuzhiyun 	fib_combine_itag(itag, &res);
384*4882a593Smuzhiyun 
385*4882a593Smuzhiyun 	dev_match = fib_info_nh_uses_dev(res.fi, dev);
386*4882a593Smuzhiyun 	/* This is not common, loopback packets retain skb_dst so normally they
387*4882a593Smuzhiyun 	 * would not even hit this slow path.
388*4882a593Smuzhiyun 	 */
389*4882a593Smuzhiyun 	dev_match = dev_match || (res.type == RTN_LOCAL &&
390*4882a593Smuzhiyun 				  dev == net->loopback_dev);
391*4882a593Smuzhiyun 	if (dev_match) {
392*4882a593Smuzhiyun 		ret = FIB_RES_NHC(res)->nhc_scope >= RT_SCOPE_LINK;
393*4882a593Smuzhiyun 		return ret;
394*4882a593Smuzhiyun 	}
395*4882a593Smuzhiyun 	if (no_addr)
396*4882a593Smuzhiyun 		goto last_resort;
397*4882a593Smuzhiyun 	if (rpf == 1)
398*4882a593Smuzhiyun 		goto e_rpf;
399*4882a593Smuzhiyun 	fl4.flowi4_oif = dev->ifindex;
400*4882a593Smuzhiyun 
401*4882a593Smuzhiyun 	ret = 0;
402*4882a593Smuzhiyun 	if (fib_lookup(net, &fl4, &res, FIB_LOOKUP_IGNORE_LINKSTATE) == 0) {
403*4882a593Smuzhiyun 		if (res.type == RTN_UNICAST)
404*4882a593Smuzhiyun 			ret = FIB_RES_NHC(res)->nhc_scope >= RT_SCOPE_LINK;
405*4882a593Smuzhiyun 	}
406*4882a593Smuzhiyun 	return ret;
407*4882a593Smuzhiyun 
408*4882a593Smuzhiyun last_resort:
409*4882a593Smuzhiyun 	if (rpf)
410*4882a593Smuzhiyun 		goto e_rpf;
411*4882a593Smuzhiyun 	*itag = 0;
412*4882a593Smuzhiyun 	return 0;
413*4882a593Smuzhiyun 
414*4882a593Smuzhiyun e_inval:
415*4882a593Smuzhiyun 	return -EINVAL;
416*4882a593Smuzhiyun e_rpf:
417*4882a593Smuzhiyun 	return -EXDEV;
418*4882a593Smuzhiyun }
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun /* Ignore rp_filter for packets protected by IPsec. */
fib_validate_source(struct sk_buff * skb,__be32 src,__be32 dst,u8 tos,int oif,struct net_device * dev,struct in_device * idev,u32 * itag)421*4882a593Smuzhiyun int fib_validate_source(struct sk_buff *skb, __be32 src, __be32 dst,
422*4882a593Smuzhiyun 			u8 tos, int oif, struct net_device *dev,
423*4882a593Smuzhiyun 			struct in_device *idev, u32 *itag)
424*4882a593Smuzhiyun {
425*4882a593Smuzhiyun 	int r = secpath_exists(skb) ? 0 : IN_DEV_RPFILTER(idev);
426*4882a593Smuzhiyun 	struct net *net = dev_net(dev);
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun 	if (!r && !fib_num_tclassid_users(net) &&
429*4882a593Smuzhiyun 	    (dev->ifindex != oif || !IN_DEV_TX_REDIRECTS(idev))) {
430*4882a593Smuzhiyun 		if (IN_DEV_ACCEPT_LOCAL(idev))
431*4882a593Smuzhiyun 			goto ok;
432*4882a593Smuzhiyun 		/* with custom local routes in place, checking local addresses
433*4882a593Smuzhiyun 		 * only will be too optimistic, with custom rules, checking
434*4882a593Smuzhiyun 		 * local addresses only can be too strict, e.g. due to vrf
435*4882a593Smuzhiyun 		 */
436*4882a593Smuzhiyun 		if (net->ipv4.fib_has_custom_local_routes ||
437*4882a593Smuzhiyun 		    fib4_has_custom_rules(net))
438*4882a593Smuzhiyun 			goto full_check;
439*4882a593Smuzhiyun 		if (inet_lookup_ifaddr_rcu(net, src))
440*4882a593Smuzhiyun 			return -EINVAL;
441*4882a593Smuzhiyun 
442*4882a593Smuzhiyun ok:
443*4882a593Smuzhiyun 		*itag = 0;
444*4882a593Smuzhiyun 		return 0;
445*4882a593Smuzhiyun 	}
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun full_check:
448*4882a593Smuzhiyun 	return __fib_validate_source(skb, src, dst, tos, oif, dev, r, idev, itag);
449*4882a593Smuzhiyun }
450*4882a593Smuzhiyun 
sk_extract_addr(struct sockaddr * addr)451*4882a593Smuzhiyun static inline __be32 sk_extract_addr(struct sockaddr *addr)
452*4882a593Smuzhiyun {
453*4882a593Smuzhiyun 	return ((struct sockaddr_in *) addr)->sin_addr.s_addr;
454*4882a593Smuzhiyun }
455*4882a593Smuzhiyun 
put_rtax(struct nlattr * mx,int len,int type,u32 value)456*4882a593Smuzhiyun static int put_rtax(struct nlattr *mx, int len, int type, u32 value)
457*4882a593Smuzhiyun {
458*4882a593Smuzhiyun 	struct nlattr *nla;
459*4882a593Smuzhiyun 
460*4882a593Smuzhiyun 	nla = (struct nlattr *) ((char *) mx + len);
461*4882a593Smuzhiyun 	nla->nla_type = type;
462*4882a593Smuzhiyun 	nla->nla_len = nla_attr_size(4);
463*4882a593Smuzhiyun 	*(u32 *) nla_data(nla) = value;
464*4882a593Smuzhiyun 
465*4882a593Smuzhiyun 	return len + nla_total_size(4);
466*4882a593Smuzhiyun }
467*4882a593Smuzhiyun 
rtentry_to_fib_config(struct net * net,int cmd,struct rtentry * rt,struct fib_config * cfg)468*4882a593Smuzhiyun static int rtentry_to_fib_config(struct net *net, int cmd, struct rtentry *rt,
469*4882a593Smuzhiyun 				 struct fib_config *cfg)
470*4882a593Smuzhiyun {
471*4882a593Smuzhiyun 	__be32 addr;
472*4882a593Smuzhiyun 	int plen;
473*4882a593Smuzhiyun 
474*4882a593Smuzhiyun 	memset(cfg, 0, sizeof(*cfg));
475*4882a593Smuzhiyun 	cfg->fc_nlinfo.nl_net = net;
476*4882a593Smuzhiyun 
477*4882a593Smuzhiyun 	if (rt->rt_dst.sa_family != AF_INET)
478*4882a593Smuzhiyun 		return -EAFNOSUPPORT;
479*4882a593Smuzhiyun 
480*4882a593Smuzhiyun 	/*
481*4882a593Smuzhiyun 	 * Check mask for validity:
482*4882a593Smuzhiyun 	 * a) it must be contiguous.
483*4882a593Smuzhiyun 	 * b) destination must have all host bits clear.
484*4882a593Smuzhiyun 	 * c) if application forgot to set correct family (AF_INET),
485*4882a593Smuzhiyun 	 *    reject request unless it is absolutely clear i.e.
486*4882a593Smuzhiyun 	 *    both family and mask are zero.
487*4882a593Smuzhiyun 	 */
488*4882a593Smuzhiyun 	plen = 32;
489*4882a593Smuzhiyun 	addr = sk_extract_addr(&rt->rt_dst);
490*4882a593Smuzhiyun 	if (!(rt->rt_flags & RTF_HOST)) {
491*4882a593Smuzhiyun 		__be32 mask = sk_extract_addr(&rt->rt_genmask);
492*4882a593Smuzhiyun 
493*4882a593Smuzhiyun 		if (rt->rt_genmask.sa_family != AF_INET) {
494*4882a593Smuzhiyun 			if (mask || rt->rt_genmask.sa_family)
495*4882a593Smuzhiyun 				return -EAFNOSUPPORT;
496*4882a593Smuzhiyun 		}
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 		if (bad_mask(mask, addr))
499*4882a593Smuzhiyun 			return -EINVAL;
500*4882a593Smuzhiyun 
501*4882a593Smuzhiyun 		plen = inet_mask_len(mask);
502*4882a593Smuzhiyun 	}
503*4882a593Smuzhiyun 
504*4882a593Smuzhiyun 	cfg->fc_dst_len = plen;
505*4882a593Smuzhiyun 	cfg->fc_dst = addr;
506*4882a593Smuzhiyun 
507*4882a593Smuzhiyun 	if (cmd != SIOCDELRT) {
508*4882a593Smuzhiyun 		cfg->fc_nlflags = NLM_F_CREATE;
509*4882a593Smuzhiyun 		cfg->fc_protocol = RTPROT_BOOT;
510*4882a593Smuzhiyun 	}
511*4882a593Smuzhiyun 
512*4882a593Smuzhiyun 	if (rt->rt_metric)
513*4882a593Smuzhiyun 		cfg->fc_priority = rt->rt_metric - 1;
514*4882a593Smuzhiyun 
515*4882a593Smuzhiyun 	if (rt->rt_flags & RTF_REJECT) {
516*4882a593Smuzhiyun 		cfg->fc_scope = RT_SCOPE_HOST;
517*4882a593Smuzhiyun 		cfg->fc_type = RTN_UNREACHABLE;
518*4882a593Smuzhiyun 		return 0;
519*4882a593Smuzhiyun 	}
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun 	cfg->fc_scope = RT_SCOPE_NOWHERE;
522*4882a593Smuzhiyun 	cfg->fc_type = RTN_UNICAST;
523*4882a593Smuzhiyun 
524*4882a593Smuzhiyun 	if (rt->rt_dev) {
525*4882a593Smuzhiyun 		char *colon;
526*4882a593Smuzhiyun 		struct net_device *dev;
527*4882a593Smuzhiyun 		char devname[IFNAMSIZ];
528*4882a593Smuzhiyun 
529*4882a593Smuzhiyun 		if (copy_from_user(devname, rt->rt_dev, IFNAMSIZ-1))
530*4882a593Smuzhiyun 			return -EFAULT;
531*4882a593Smuzhiyun 
532*4882a593Smuzhiyun 		devname[IFNAMSIZ-1] = 0;
533*4882a593Smuzhiyun 		colon = strchr(devname, ':');
534*4882a593Smuzhiyun 		if (colon)
535*4882a593Smuzhiyun 			*colon = 0;
536*4882a593Smuzhiyun 		dev = __dev_get_by_name(net, devname);
537*4882a593Smuzhiyun 		if (!dev)
538*4882a593Smuzhiyun 			return -ENODEV;
539*4882a593Smuzhiyun 		cfg->fc_oif = dev->ifindex;
540*4882a593Smuzhiyun 		cfg->fc_table = l3mdev_fib_table(dev);
541*4882a593Smuzhiyun 		if (colon) {
542*4882a593Smuzhiyun 			const struct in_ifaddr *ifa;
543*4882a593Smuzhiyun 			struct in_device *in_dev;
544*4882a593Smuzhiyun 
545*4882a593Smuzhiyun 			in_dev = __in_dev_get_rtnl(dev);
546*4882a593Smuzhiyun 			if (!in_dev)
547*4882a593Smuzhiyun 				return -ENODEV;
548*4882a593Smuzhiyun 
549*4882a593Smuzhiyun 			*colon = ':';
550*4882a593Smuzhiyun 
551*4882a593Smuzhiyun 			rcu_read_lock();
552*4882a593Smuzhiyun 			in_dev_for_each_ifa_rcu(ifa, in_dev) {
553*4882a593Smuzhiyun 				if (strcmp(ifa->ifa_label, devname) == 0)
554*4882a593Smuzhiyun 					break;
555*4882a593Smuzhiyun 			}
556*4882a593Smuzhiyun 			rcu_read_unlock();
557*4882a593Smuzhiyun 
558*4882a593Smuzhiyun 			if (!ifa)
559*4882a593Smuzhiyun 				return -ENODEV;
560*4882a593Smuzhiyun 			cfg->fc_prefsrc = ifa->ifa_local;
561*4882a593Smuzhiyun 		}
562*4882a593Smuzhiyun 	}
563*4882a593Smuzhiyun 
564*4882a593Smuzhiyun 	addr = sk_extract_addr(&rt->rt_gateway);
565*4882a593Smuzhiyun 	if (rt->rt_gateway.sa_family == AF_INET && addr) {
566*4882a593Smuzhiyun 		unsigned int addr_type;
567*4882a593Smuzhiyun 
568*4882a593Smuzhiyun 		cfg->fc_gw4 = addr;
569*4882a593Smuzhiyun 		cfg->fc_gw_family = AF_INET;
570*4882a593Smuzhiyun 		addr_type = inet_addr_type_table(net, addr, cfg->fc_table);
571*4882a593Smuzhiyun 		if (rt->rt_flags & RTF_GATEWAY &&
572*4882a593Smuzhiyun 		    addr_type == RTN_UNICAST)
573*4882a593Smuzhiyun 			cfg->fc_scope = RT_SCOPE_UNIVERSE;
574*4882a593Smuzhiyun 	}
575*4882a593Smuzhiyun 
576*4882a593Smuzhiyun 	if (cmd == SIOCDELRT)
577*4882a593Smuzhiyun 		return 0;
578*4882a593Smuzhiyun 
579*4882a593Smuzhiyun 	if (rt->rt_flags & RTF_GATEWAY && !cfg->fc_gw_family)
580*4882a593Smuzhiyun 		return -EINVAL;
581*4882a593Smuzhiyun 
582*4882a593Smuzhiyun 	if (cfg->fc_scope == RT_SCOPE_NOWHERE)
583*4882a593Smuzhiyun 		cfg->fc_scope = RT_SCOPE_LINK;
584*4882a593Smuzhiyun 
585*4882a593Smuzhiyun 	if (rt->rt_flags & (RTF_MTU | RTF_WINDOW | RTF_IRTT)) {
586*4882a593Smuzhiyun 		struct nlattr *mx;
587*4882a593Smuzhiyun 		int len = 0;
588*4882a593Smuzhiyun 
589*4882a593Smuzhiyun 		mx = kcalloc(3, nla_total_size(4), GFP_KERNEL);
590*4882a593Smuzhiyun 		if (!mx)
591*4882a593Smuzhiyun 			return -ENOMEM;
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 		if (rt->rt_flags & RTF_MTU)
594*4882a593Smuzhiyun 			len = put_rtax(mx, len, RTAX_ADVMSS, rt->rt_mtu - 40);
595*4882a593Smuzhiyun 
596*4882a593Smuzhiyun 		if (rt->rt_flags & RTF_WINDOW)
597*4882a593Smuzhiyun 			len = put_rtax(mx, len, RTAX_WINDOW, rt->rt_window);
598*4882a593Smuzhiyun 
599*4882a593Smuzhiyun 		if (rt->rt_flags & RTF_IRTT)
600*4882a593Smuzhiyun 			len = put_rtax(mx, len, RTAX_RTT, rt->rt_irtt << 3);
601*4882a593Smuzhiyun 
602*4882a593Smuzhiyun 		cfg->fc_mx = mx;
603*4882a593Smuzhiyun 		cfg->fc_mx_len = len;
604*4882a593Smuzhiyun 	}
605*4882a593Smuzhiyun 
606*4882a593Smuzhiyun 	return 0;
607*4882a593Smuzhiyun }
608*4882a593Smuzhiyun 
609*4882a593Smuzhiyun /*
610*4882a593Smuzhiyun  * Handle IP routing ioctl calls.
611*4882a593Smuzhiyun  * These are used to manipulate the routing tables
612*4882a593Smuzhiyun  */
ip_rt_ioctl(struct net * net,unsigned int cmd,struct rtentry * rt)613*4882a593Smuzhiyun int ip_rt_ioctl(struct net *net, unsigned int cmd, struct rtentry *rt)
614*4882a593Smuzhiyun {
615*4882a593Smuzhiyun 	struct fib_config cfg;
616*4882a593Smuzhiyun 	int err;
617*4882a593Smuzhiyun 
618*4882a593Smuzhiyun 	switch (cmd) {
619*4882a593Smuzhiyun 	case SIOCADDRT:		/* Add a route */
620*4882a593Smuzhiyun 	case SIOCDELRT:		/* Delete a route */
621*4882a593Smuzhiyun 		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
622*4882a593Smuzhiyun 			return -EPERM;
623*4882a593Smuzhiyun 
624*4882a593Smuzhiyun 		rtnl_lock();
625*4882a593Smuzhiyun 		err = rtentry_to_fib_config(net, cmd, rt, &cfg);
626*4882a593Smuzhiyun 		if (err == 0) {
627*4882a593Smuzhiyun 			struct fib_table *tb;
628*4882a593Smuzhiyun 
629*4882a593Smuzhiyun 			if (cmd == SIOCDELRT) {
630*4882a593Smuzhiyun 				tb = fib_get_table(net, cfg.fc_table);
631*4882a593Smuzhiyun 				if (tb)
632*4882a593Smuzhiyun 					err = fib_table_delete(net, tb, &cfg,
633*4882a593Smuzhiyun 							       NULL);
634*4882a593Smuzhiyun 				else
635*4882a593Smuzhiyun 					err = -ESRCH;
636*4882a593Smuzhiyun 			} else {
637*4882a593Smuzhiyun 				tb = fib_new_table(net, cfg.fc_table);
638*4882a593Smuzhiyun 				if (tb)
639*4882a593Smuzhiyun 					err = fib_table_insert(net, tb,
640*4882a593Smuzhiyun 							       &cfg, NULL);
641*4882a593Smuzhiyun 				else
642*4882a593Smuzhiyun 					err = -ENOBUFS;
643*4882a593Smuzhiyun 			}
644*4882a593Smuzhiyun 
645*4882a593Smuzhiyun 			/* allocated by rtentry_to_fib_config() */
646*4882a593Smuzhiyun 			kfree(cfg.fc_mx);
647*4882a593Smuzhiyun 		}
648*4882a593Smuzhiyun 		rtnl_unlock();
649*4882a593Smuzhiyun 		return err;
650*4882a593Smuzhiyun 	}
651*4882a593Smuzhiyun 	return -EINVAL;
652*4882a593Smuzhiyun }
653*4882a593Smuzhiyun 
654*4882a593Smuzhiyun const struct nla_policy rtm_ipv4_policy[RTA_MAX + 1] = {
655*4882a593Smuzhiyun 	[RTA_UNSPEC]		= { .strict_start_type = RTA_DPORT + 1 },
656*4882a593Smuzhiyun 	[RTA_DST]		= { .type = NLA_U32 },
657*4882a593Smuzhiyun 	[RTA_SRC]		= { .type = NLA_U32 },
658*4882a593Smuzhiyun 	[RTA_IIF]		= { .type = NLA_U32 },
659*4882a593Smuzhiyun 	[RTA_OIF]		= { .type = NLA_U32 },
660*4882a593Smuzhiyun 	[RTA_GATEWAY]		= { .type = NLA_U32 },
661*4882a593Smuzhiyun 	[RTA_PRIORITY]		= { .type = NLA_U32 },
662*4882a593Smuzhiyun 	[RTA_PREFSRC]		= { .type = NLA_U32 },
663*4882a593Smuzhiyun 	[RTA_METRICS]		= { .type = NLA_NESTED },
664*4882a593Smuzhiyun 	[RTA_MULTIPATH]		= { .len = sizeof(struct rtnexthop) },
665*4882a593Smuzhiyun 	[RTA_FLOW]		= { .type = NLA_U32 },
666*4882a593Smuzhiyun 	[RTA_ENCAP_TYPE]	= { .type = NLA_U16 },
667*4882a593Smuzhiyun 	[RTA_ENCAP]		= { .type = NLA_NESTED },
668*4882a593Smuzhiyun 	[RTA_UID]		= { .type = NLA_U32 },
669*4882a593Smuzhiyun 	[RTA_MARK]		= { .type = NLA_U32 },
670*4882a593Smuzhiyun 	[RTA_TABLE]		= { .type = NLA_U32 },
671*4882a593Smuzhiyun 	[RTA_IP_PROTO]		= { .type = NLA_U8 },
672*4882a593Smuzhiyun 	[RTA_SPORT]		= { .type = NLA_U16 },
673*4882a593Smuzhiyun 	[RTA_DPORT]		= { .type = NLA_U16 },
674*4882a593Smuzhiyun 	[RTA_NH_ID]		= { .type = NLA_U32 },
675*4882a593Smuzhiyun };
676*4882a593Smuzhiyun 
fib_gw_from_via(struct fib_config * cfg,struct nlattr * nla,struct netlink_ext_ack * extack)677*4882a593Smuzhiyun int fib_gw_from_via(struct fib_config *cfg, struct nlattr *nla,
678*4882a593Smuzhiyun 		    struct netlink_ext_ack *extack)
679*4882a593Smuzhiyun {
680*4882a593Smuzhiyun 	struct rtvia *via;
681*4882a593Smuzhiyun 	int alen;
682*4882a593Smuzhiyun 
683*4882a593Smuzhiyun 	if (nla_len(nla) < offsetof(struct rtvia, rtvia_addr)) {
684*4882a593Smuzhiyun 		NL_SET_ERR_MSG(extack, "Invalid attribute length for RTA_VIA");
685*4882a593Smuzhiyun 		return -EINVAL;
686*4882a593Smuzhiyun 	}
687*4882a593Smuzhiyun 
688*4882a593Smuzhiyun 	via = nla_data(nla);
689*4882a593Smuzhiyun 	alen = nla_len(nla) - offsetof(struct rtvia, rtvia_addr);
690*4882a593Smuzhiyun 
691*4882a593Smuzhiyun 	switch (via->rtvia_family) {
692*4882a593Smuzhiyun 	case AF_INET:
693*4882a593Smuzhiyun 		if (alen != sizeof(__be32)) {
694*4882a593Smuzhiyun 			NL_SET_ERR_MSG(extack, "Invalid IPv4 address in RTA_VIA");
695*4882a593Smuzhiyun 			return -EINVAL;
696*4882a593Smuzhiyun 		}
697*4882a593Smuzhiyun 		cfg->fc_gw_family = AF_INET;
698*4882a593Smuzhiyun 		cfg->fc_gw4 = *((__be32 *)via->rtvia_addr);
699*4882a593Smuzhiyun 		break;
700*4882a593Smuzhiyun 	case AF_INET6:
701*4882a593Smuzhiyun #if IS_ENABLED(CONFIG_IPV6)
702*4882a593Smuzhiyun 		if (alen != sizeof(struct in6_addr)) {
703*4882a593Smuzhiyun 			NL_SET_ERR_MSG(extack, "Invalid IPv6 address in RTA_VIA");
704*4882a593Smuzhiyun 			return -EINVAL;
705*4882a593Smuzhiyun 		}
706*4882a593Smuzhiyun 		cfg->fc_gw_family = AF_INET6;
707*4882a593Smuzhiyun 		cfg->fc_gw6 = *((struct in6_addr *)via->rtvia_addr);
708*4882a593Smuzhiyun #else
709*4882a593Smuzhiyun 		NL_SET_ERR_MSG(extack, "IPv6 support not enabled in kernel");
710*4882a593Smuzhiyun 		return -EINVAL;
711*4882a593Smuzhiyun #endif
712*4882a593Smuzhiyun 		break;
713*4882a593Smuzhiyun 	default:
714*4882a593Smuzhiyun 		NL_SET_ERR_MSG(extack, "Unsupported address family in RTA_VIA");
715*4882a593Smuzhiyun 		return -EINVAL;
716*4882a593Smuzhiyun 	}
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun 	return 0;
719*4882a593Smuzhiyun }
720*4882a593Smuzhiyun 
rtm_to_fib_config(struct net * net,struct sk_buff * skb,struct nlmsghdr * nlh,struct fib_config * cfg,struct netlink_ext_ack * extack)721*4882a593Smuzhiyun static int rtm_to_fib_config(struct net *net, struct sk_buff *skb,
722*4882a593Smuzhiyun 			     struct nlmsghdr *nlh, struct fib_config *cfg,
723*4882a593Smuzhiyun 			     struct netlink_ext_ack *extack)
724*4882a593Smuzhiyun {
725*4882a593Smuzhiyun 	bool has_gw = false, has_via = false;
726*4882a593Smuzhiyun 	struct nlattr *attr;
727*4882a593Smuzhiyun 	int err, remaining;
728*4882a593Smuzhiyun 	struct rtmsg *rtm;
729*4882a593Smuzhiyun 
730*4882a593Smuzhiyun 	err = nlmsg_validate_deprecated(nlh, sizeof(*rtm), RTA_MAX,
731*4882a593Smuzhiyun 					rtm_ipv4_policy, extack);
732*4882a593Smuzhiyun 	if (err < 0)
733*4882a593Smuzhiyun 		goto errout;
734*4882a593Smuzhiyun 
735*4882a593Smuzhiyun 	memset(cfg, 0, sizeof(*cfg));
736*4882a593Smuzhiyun 
737*4882a593Smuzhiyun 	rtm = nlmsg_data(nlh);
738*4882a593Smuzhiyun 	cfg->fc_dst_len = rtm->rtm_dst_len;
739*4882a593Smuzhiyun 	cfg->fc_tos = rtm->rtm_tos;
740*4882a593Smuzhiyun 	cfg->fc_table = rtm->rtm_table;
741*4882a593Smuzhiyun 	cfg->fc_protocol = rtm->rtm_protocol;
742*4882a593Smuzhiyun 	cfg->fc_scope = rtm->rtm_scope;
743*4882a593Smuzhiyun 	cfg->fc_type = rtm->rtm_type;
744*4882a593Smuzhiyun 	cfg->fc_flags = rtm->rtm_flags;
745*4882a593Smuzhiyun 	cfg->fc_nlflags = nlh->nlmsg_flags;
746*4882a593Smuzhiyun 
747*4882a593Smuzhiyun 	cfg->fc_nlinfo.portid = NETLINK_CB(skb).portid;
748*4882a593Smuzhiyun 	cfg->fc_nlinfo.nlh = nlh;
749*4882a593Smuzhiyun 	cfg->fc_nlinfo.nl_net = net;
750*4882a593Smuzhiyun 
751*4882a593Smuzhiyun 	if (cfg->fc_type > RTN_MAX) {
752*4882a593Smuzhiyun 		NL_SET_ERR_MSG(extack, "Invalid route type");
753*4882a593Smuzhiyun 		err = -EINVAL;
754*4882a593Smuzhiyun 		goto errout;
755*4882a593Smuzhiyun 	}
756*4882a593Smuzhiyun 
757*4882a593Smuzhiyun 	nlmsg_for_each_attr(attr, nlh, sizeof(struct rtmsg), remaining) {
758*4882a593Smuzhiyun 		switch (nla_type(attr)) {
759*4882a593Smuzhiyun 		case RTA_DST:
760*4882a593Smuzhiyun 			cfg->fc_dst = nla_get_be32(attr);
761*4882a593Smuzhiyun 			break;
762*4882a593Smuzhiyun 		case RTA_OIF:
763*4882a593Smuzhiyun 			cfg->fc_oif = nla_get_u32(attr);
764*4882a593Smuzhiyun 			break;
765*4882a593Smuzhiyun 		case RTA_GATEWAY:
766*4882a593Smuzhiyun 			has_gw = true;
767*4882a593Smuzhiyun 			cfg->fc_gw4 = nla_get_be32(attr);
768*4882a593Smuzhiyun 			if (cfg->fc_gw4)
769*4882a593Smuzhiyun 				cfg->fc_gw_family = AF_INET;
770*4882a593Smuzhiyun 			break;
771*4882a593Smuzhiyun 		case RTA_VIA:
772*4882a593Smuzhiyun 			has_via = true;
773*4882a593Smuzhiyun 			err = fib_gw_from_via(cfg, attr, extack);
774*4882a593Smuzhiyun 			if (err)
775*4882a593Smuzhiyun 				goto errout;
776*4882a593Smuzhiyun 			break;
777*4882a593Smuzhiyun 		case RTA_PRIORITY:
778*4882a593Smuzhiyun 			cfg->fc_priority = nla_get_u32(attr);
779*4882a593Smuzhiyun 			break;
780*4882a593Smuzhiyun 		case RTA_PREFSRC:
781*4882a593Smuzhiyun 			cfg->fc_prefsrc = nla_get_be32(attr);
782*4882a593Smuzhiyun 			break;
783*4882a593Smuzhiyun 		case RTA_METRICS:
784*4882a593Smuzhiyun 			cfg->fc_mx = nla_data(attr);
785*4882a593Smuzhiyun 			cfg->fc_mx_len = nla_len(attr);
786*4882a593Smuzhiyun 			break;
787*4882a593Smuzhiyun 		case RTA_MULTIPATH:
788*4882a593Smuzhiyun 			err = lwtunnel_valid_encap_type_attr(nla_data(attr),
789*4882a593Smuzhiyun 							     nla_len(attr),
790*4882a593Smuzhiyun 							     extack);
791*4882a593Smuzhiyun 			if (err < 0)
792*4882a593Smuzhiyun 				goto errout;
793*4882a593Smuzhiyun 			cfg->fc_mp = nla_data(attr);
794*4882a593Smuzhiyun 			cfg->fc_mp_len = nla_len(attr);
795*4882a593Smuzhiyun 			break;
796*4882a593Smuzhiyun 		case RTA_FLOW:
797*4882a593Smuzhiyun 			cfg->fc_flow = nla_get_u32(attr);
798*4882a593Smuzhiyun 			break;
799*4882a593Smuzhiyun 		case RTA_TABLE:
800*4882a593Smuzhiyun 			cfg->fc_table = nla_get_u32(attr);
801*4882a593Smuzhiyun 			break;
802*4882a593Smuzhiyun 		case RTA_ENCAP:
803*4882a593Smuzhiyun 			cfg->fc_encap = attr;
804*4882a593Smuzhiyun 			break;
805*4882a593Smuzhiyun 		case RTA_ENCAP_TYPE:
806*4882a593Smuzhiyun 			cfg->fc_encap_type = nla_get_u16(attr);
807*4882a593Smuzhiyun 			err = lwtunnel_valid_encap_type(cfg->fc_encap_type,
808*4882a593Smuzhiyun 							extack);
809*4882a593Smuzhiyun 			if (err < 0)
810*4882a593Smuzhiyun 				goto errout;
811*4882a593Smuzhiyun 			break;
812*4882a593Smuzhiyun 		case RTA_NH_ID:
813*4882a593Smuzhiyun 			cfg->fc_nh_id = nla_get_u32(attr);
814*4882a593Smuzhiyun 			break;
815*4882a593Smuzhiyun 		}
816*4882a593Smuzhiyun 	}
817*4882a593Smuzhiyun 
818*4882a593Smuzhiyun 	if (cfg->fc_nh_id) {
819*4882a593Smuzhiyun 		if (cfg->fc_oif || cfg->fc_gw_family ||
820*4882a593Smuzhiyun 		    cfg->fc_encap || cfg->fc_mp) {
821*4882a593Smuzhiyun 			NL_SET_ERR_MSG(extack,
822*4882a593Smuzhiyun 				       "Nexthop specification and nexthop id are mutually exclusive");
823*4882a593Smuzhiyun 			return -EINVAL;
824*4882a593Smuzhiyun 		}
825*4882a593Smuzhiyun 	}
826*4882a593Smuzhiyun 
827*4882a593Smuzhiyun 	if (has_gw && has_via) {
828*4882a593Smuzhiyun 		NL_SET_ERR_MSG(extack,
829*4882a593Smuzhiyun 			       "Nexthop configuration can not contain both GATEWAY and VIA");
830*4882a593Smuzhiyun 		return -EINVAL;
831*4882a593Smuzhiyun 	}
832*4882a593Smuzhiyun 
833*4882a593Smuzhiyun 	if (!cfg->fc_table)
834*4882a593Smuzhiyun 		cfg->fc_table = RT_TABLE_MAIN;
835*4882a593Smuzhiyun 
836*4882a593Smuzhiyun 	return 0;
837*4882a593Smuzhiyun errout:
838*4882a593Smuzhiyun 	return err;
839*4882a593Smuzhiyun }
840*4882a593Smuzhiyun 
inet_rtm_delroute(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)841*4882a593Smuzhiyun static int inet_rtm_delroute(struct sk_buff *skb, struct nlmsghdr *nlh,
842*4882a593Smuzhiyun 			     struct netlink_ext_ack *extack)
843*4882a593Smuzhiyun {
844*4882a593Smuzhiyun 	struct net *net = sock_net(skb->sk);
845*4882a593Smuzhiyun 	struct fib_config cfg;
846*4882a593Smuzhiyun 	struct fib_table *tb;
847*4882a593Smuzhiyun 	int err;
848*4882a593Smuzhiyun 
849*4882a593Smuzhiyun 	err = rtm_to_fib_config(net, skb, nlh, &cfg, extack);
850*4882a593Smuzhiyun 	if (err < 0)
851*4882a593Smuzhiyun 		goto errout;
852*4882a593Smuzhiyun 
853*4882a593Smuzhiyun 	if (cfg.fc_nh_id && !nexthop_find_by_id(net, cfg.fc_nh_id)) {
854*4882a593Smuzhiyun 		NL_SET_ERR_MSG(extack, "Nexthop id does not exist");
855*4882a593Smuzhiyun 		err = -EINVAL;
856*4882a593Smuzhiyun 		goto errout;
857*4882a593Smuzhiyun 	}
858*4882a593Smuzhiyun 
859*4882a593Smuzhiyun 	tb = fib_get_table(net, cfg.fc_table);
860*4882a593Smuzhiyun 	if (!tb) {
861*4882a593Smuzhiyun 		NL_SET_ERR_MSG(extack, "FIB table does not exist");
862*4882a593Smuzhiyun 		err = -ESRCH;
863*4882a593Smuzhiyun 		goto errout;
864*4882a593Smuzhiyun 	}
865*4882a593Smuzhiyun 
866*4882a593Smuzhiyun 	err = fib_table_delete(net, tb, &cfg, extack);
867*4882a593Smuzhiyun errout:
868*4882a593Smuzhiyun 	return err;
869*4882a593Smuzhiyun }
870*4882a593Smuzhiyun 
inet_rtm_newroute(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)871*4882a593Smuzhiyun static int inet_rtm_newroute(struct sk_buff *skb, struct nlmsghdr *nlh,
872*4882a593Smuzhiyun 			     struct netlink_ext_ack *extack)
873*4882a593Smuzhiyun {
874*4882a593Smuzhiyun 	struct net *net = sock_net(skb->sk);
875*4882a593Smuzhiyun 	struct fib_config cfg;
876*4882a593Smuzhiyun 	struct fib_table *tb;
877*4882a593Smuzhiyun 	int err;
878*4882a593Smuzhiyun 
879*4882a593Smuzhiyun 	err = rtm_to_fib_config(net, skb, nlh, &cfg, extack);
880*4882a593Smuzhiyun 	if (err < 0)
881*4882a593Smuzhiyun 		goto errout;
882*4882a593Smuzhiyun 
883*4882a593Smuzhiyun 	tb = fib_new_table(net, cfg.fc_table);
884*4882a593Smuzhiyun 	if (!tb) {
885*4882a593Smuzhiyun 		err = -ENOBUFS;
886*4882a593Smuzhiyun 		goto errout;
887*4882a593Smuzhiyun 	}
888*4882a593Smuzhiyun 
889*4882a593Smuzhiyun 	err = fib_table_insert(net, tb, &cfg, extack);
890*4882a593Smuzhiyun 	if (!err && cfg.fc_type == RTN_LOCAL)
891*4882a593Smuzhiyun 		net->ipv4.fib_has_custom_local_routes = true;
892*4882a593Smuzhiyun errout:
893*4882a593Smuzhiyun 	return err;
894*4882a593Smuzhiyun }
895*4882a593Smuzhiyun 
ip_valid_fib_dump_req(struct net * net,const struct nlmsghdr * nlh,struct fib_dump_filter * filter,struct netlink_callback * cb)896*4882a593Smuzhiyun int ip_valid_fib_dump_req(struct net *net, const struct nlmsghdr *nlh,
897*4882a593Smuzhiyun 			  struct fib_dump_filter *filter,
898*4882a593Smuzhiyun 			  struct netlink_callback *cb)
899*4882a593Smuzhiyun {
900*4882a593Smuzhiyun 	struct netlink_ext_ack *extack = cb->extack;
901*4882a593Smuzhiyun 	struct nlattr *tb[RTA_MAX + 1];
902*4882a593Smuzhiyun 	struct rtmsg *rtm;
903*4882a593Smuzhiyun 	int err, i;
904*4882a593Smuzhiyun 
905*4882a593Smuzhiyun 	ASSERT_RTNL();
906*4882a593Smuzhiyun 
907*4882a593Smuzhiyun 	if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*rtm))) {
908*4882a593Smuzhiyun 		NL_SET_ERR_MSG(extack, "Invalid header for FIB dump request");
909*4882a593Smuzhiyun 		return -EINVAL;
910*4882a593Smuzhiyun 	}
911*4882a593Smuzhiyun 
912*4882a593Smuzhiyun 	rtm = nlmsg_data(nlh);
913*4882a593Smuzhiyun 	if (rtm->rtm_dst_len || rtm->rtm_src_len  || rtm->rtm_tos   ||
914*4882a593Smuzhiyun 	    rtm->rtm_scope) {
915*4882a593Smuzhiyun 		NL_SET_ERR_MSG(extack, "Invalid values in header for FIB dump request");
916*4882a593Smuzhiyun 		return -EINVAL;
917*4882a593Smuzhiyun 	}
918*4882a593Smuzhiyun 
919*4882a593Smuzhiyun 	if (rtm->rtm_flags & ~(RTM_F_CLONED | RTM_F_PREFIX)) {
920*4882a593Smuzhiyun 		NL_SET_ERR_MSG(extack, "Invalid flags for FIB dump request");
921*4882a593Smuzhiyun 		return -EINVAL;
922*4882a593Smuzhiyun 	}
923*4882a593Smuzhiyun 	if (rtm->rtm_flags & RTM_F_CLONED)
924*4882a593Smuzhiyun 		filter->dump_routes = false;
925*4882a593Smuzhiyun 	else
926*4882a593Smuzhiyun 		filter->dump_exceptions = false;
927*4882a593Smuzhiyun 
928*4882a593Smuzhiyun 	filter->flags    = rtm->rtm_flags;
929*4882a593Smuzhiyun 	filter->protocol = rtm->rtm_protocol;
930*4882a593Smuzhiyun 	filter->rt_type  = rtm->rtm_type;
931*4882a593Smuzhiyun 	filter->table_id = rtm->rtm_table;
932*4882a593Smuzhiyun 
933*4882a593Smuzhiyun 	err = nlmsg_parse_deprecated_strict(nlh, sizeof(*rtm), tb, RTA_MAX,
934*4882a593Smuzhiyun 					    rtm_ipv4_policy, extack);
935*4882a593Smuzhiyun 	if (err < 0)
936*4882a593Smuzhiyun 		return err;
937*4882a593Smuzhiyun 
938*4882a593Smuzhiyun 	for (i = 0; i <= RTA_MAX; ++i) {
939*4882a593Smuzhiyun 		int ifindex;
940*4882a593Smuzhiyun 
941*4882a593Smuzhiyun 		if (!tb[i])
942*4882a593Smuzhiyun 			continue;
943*4882a593Smuzhiyun 
944*4882a593Smuzhiyun 		switch (i) {
945*4882a593Smuzhiyun 		case RTA_TABLE:
946*4882a593Smuzhiyun 			filter->table_id = nla_get_u32(tb[i]);
947*4882a593Smuzhiyun 			break;
948*4882a593Smuzhiyun 		case RTA_OIF:
949*4882a593Smuzhiyun 			ifindex = nla_get_u32(tb[i]);
950*4882a593Smuzhiyun 			filter->dev = __dev_get_by_index(net, ifindex);
951*4882a593Smuzhiyun 			if (!filter->dev)
952*4882a593Smuzhiyun 				return -ENODEV;
953*4882a593Smuzhiyun 			break;
954*4882a593Smuzhiyun 		default:
955*4882a593Smuzhiyun 			NL_SET_ERR_MSG(extack, "Unsupported attribute in dump request");
956*4882a593Smuzhiyun 			return -EINVAL;
957*4882a593Smuzhiyun 		}
958*4882a593Smuzhiyun 	}
959*4882a593Smuzhiyun 
960*4882a593Smuzhiyun 	if (filter->flags || filter->protocol || filter->rt_type ||
961*4882a593Smuzhiyun 	    filter->table_id || filter->dev) {
962*4882a593Smuzhiyun 		filter->filter_set = 1;
963*4882a593Smuzhiyun 		cb->answer_flags = NLM_F_DUMP_FILTERED;
964*4882a593Smuzhiyun 	}
965*4882a593Smuzhiyun 
966*4882a593Smuzhiyun 	return 0;
967*4882a593Smuzhiyun }
968*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(ip_valid_fib_dump_req);
969*4882a593Smuzhiyun 
inet_dump_fib(struct sk_buff * skb,struct netlink_callback * cb)970*4882a593Smuzhiyun static int inet_dump_fib(struct sk_buff *skb, struct netlink_callback *cb)
971*4882a593Smuzhiyun {
972*4882a593Smuzhiyun 	struct fib_dump_filter filter = { .dump_routes = true,
973*4882a593Smuzhiyun 					  .dump_exceptions = true };
974*4882a593Smuzhiyun 	const struct nlmsghdr *nlh = cb->nlh;
975*4882a593Smuzhiyun 	struct net *net = sock_net(skb->sk);
976*4882a593Smuzhiyun 	unsigned int h, s_h;
977*4882a593Smuzhiyun 	unsigned int e = 0, s_e;
978*4882a593Smuzhiyun 	struct fib_table *tb;
979*4882a593Smuzhiyun 	struct hlist_head *head;
980*4882a593Smuzhiyun 	int dumped = 0, err;
981*4882a593Smuzhiyun 
982*4882a593Smuzhiyun 	if (cb->strict_check) {
983*4882a593Smuzhiyun 		err = ip_valid_fib_dump_req(net, nlh, &filter, cb);
984*4882a593Smuzhiyun 		if (err < 0)
985*4882a593Smuzhiyun 			return err;
986*4882a593Smuzhiyun 	} else if (nlmsg_len(nlh) >= sizeof(struct rtmsg)) {
987*4882a593Smuzhiyun 		struct rtmsg *rtm = nlmsg_data(nlh);
988*4882a593Smuzhiyun 
989*4882a593Smuzhiyun 		filter.flags = rtm->rtm_flags & (RTM_F_PREFIX | RTM_F_CLONED);
990*4882a593Smuzhiyun 	}
991*4882a593Smuzhiyun 
992*4882a593Smuzhiyun 	/* ipv4 does not use prefix flag */
993*4882a593Smuzhiyun 	if (filter.flags & RTM_F_PREFIX)
994*4882a593Smuzhiyun 		return skb->len;
995*4882a593Smuzhiyun 
996*4882a593Smuzhiyun 	if (filter.table_id) {
997*4882a593Smuzhiyun 		tb = fib_get_table(net, filter.table_id);
998*4882a593Smuzhiyun 		if (!tb) {
999*4882a593Smuzhiyun 			if (rtnl_msg_family(cb->nlh) != PF_INET)
1000*4882a593Smuzhiyun 				return skb->len;
1001*4882a593Smuzhiyun 
1002*4882a593Smuzhiyun 			NL_SET_ERR_MSG(cb->extack, "ipv4: FIB table does not exist");
1003*4882a593Smuzhiyun 			return -ENOENT;
1004*4882a593Smuzhiyun 		}
1005*4882a593Smuzhiyun 
1006*4882a593Smuzhiyun 		rcu_read_lock();
1007*4882a593Smuzhiyun 		err = fib_table_dump(tb, skb, cb, &filter);
1008*4882a593Smuzhiyun 		rcu_read_unlock();
1009*4882a593Smuzhiyun 		return skb->len ? : err;
1010*4882a593Smuzhiyun 	}
1011*4882a593Smuzhiyun 
1012*4882a593Smuzhiyun 	s_h = cb->args[0];
1013*4882a593Smuzhiyun 	s_e = cb->args[1];
1014*4882a593Smuzhiyun 
1015*4882a593Smuzhiyun 	rcu_read_lock();
1016*4882a593Smuzhiyun 
1017*4882a593Smuzhiyun 	for (h = s_h; h < FIB_TABLE_HASHSZ; h++, s_e = 0) {
1018*4882a593Smuzhiyun 		e = 0;
1019*4882a593Smuzhiyun 		head = &net->ipv4.fib_table_hash[h];
1020*4882a593Smuzhiyun 		hlist_for_each_entry_rcu(tb, head, tb_hlist) {
1021*4882a593Smuzhiyun 			if (e < s_e)
1022*4882a593Smuzhiyun 				goto next;
1023*4882a593Smuzhiyun 			if (dumped)
1024*4882a593Smuzhiyun 				memset(&cb->args[2], 0, sizeof(cb->args) -
1025*4882a593Smuzhiyun 						 2 * sizeof(cb->args[0]));
1026*4882a593Smuzhiyun 			err = fib_table_dump(tb, skb, cb, &filter);
1027*4882a593Smuzhiyun 			if (err < 0) {
1028*4882a593Smuzhiyun 				if (likely(skb->len))
1029*4882a593Smuzhiyun 					goto out;
1030*4882a593Smuzhiyun 
1031*4882a593Smuzhiyun 				goto out_err;
1032*4882a593Smuzhiyun 			}
1033*4882a593Smuzhiyun 			dumped = 1;
1034*4882a593Smuzhiyun next:
1035*4882a593Smuzhiyun 			e++;
1036*4882a593Smuzhiyun 		}
1037*4882a593Smuzhiyun 	}
1038*4882a593Smuzhiyun out:
1039*4882a593Smuzhiyun 	err = skb->len;
1040*4882a593Smuzhiyun out_err:
1041*4882a593Smuzhiyun 	rcu_read_unlock();
1042*4882a593Smuzhiyun 
1043*4882a593Smuzhiyun 	cb->args[1] = e;
1044*4882a593Smuzhiyun 	cb->args[0] = h;
1045*4882a593Smuzhiyun 
1046*4882a593Smuzhiyun 	return err;
1047*4882a593Smuzhiyun }
1048*4882a593Smuzhiyun 
1049*4882a593Smuzhiyun /* Prepare and feed intra-kernel routing request.
1050*4882a593Smuzhiyun  * Really, it should be netlink message, but :-( netlink
1051*4882a593Smuzhiyun  * can be not configured, so that we feed it directly
1052*4882a593Smuzhiyun  * to fib engine. It is legal, because all events occur
1053*4882a593Smuzhiyun  * only when netlink is already locked.
1054*4882a593Smuzhiyun  */
fib_magic(int cmd,int type,__be32 dst,int dst_len,struct in_ifaddr * ifa,u32 rt_priority)1055*4882a593Smuzhiyun static void fib_magic(int cmd, int type, __be32 dst, int dst_len,
1056*4882a593Smuzhiyun 		      struct in_ifaddr *ifa, u32 rt_priority)
1057*4882a593Smuzhiyun {
1058*4882a593Smuzhiyun 	struct net *net = dev_net(ifa->ifa_dev->dev);
1059*4882a593Smuzhiyun 	u32 tb_id = l3mdev_fib_table(ifa->ifa_dev->dev);
1060*4882a593Smuzhiyun 	struct fib_table *tb;
1061*4882a593Smuzhiyun 	struct fib_config cfg = {
1062*4882a593Smuzhiyun 		.fc_protocol = RTPROT_KERNEL,
1063*4882a593Smuzhiyun 		.fc_type = type,
1064*4882a593Smuzhiyun 		.fc_dst = dst,
1065*4882a593Smuzhiyun 		.fc_dst_len = dst_len,
1066*4882a593Smuzhiyun 		.fc_priority = rt_priority,
1067*4882a593Smuzhiyun 		.fc_prefsrc = ifa->ifa_local,
1068*4882a593Smuzhiyun 		.fc_oif = ifa->ifa_dev->dev->ifindex,
1069*4882a593Smuzhiyun 		.fc_nlflags = NLM_F_CREATE | NLM_F_APPEND,
1070*4882a593Smuzhiyun 		.fc_nlinfo = {
1071*4882a593Smuzhiyun 			.nl_net = net,
1072*4882a593Smuzhiyun 		},
1073*4882a593Smuzhiyun 	};
1074*4882a593Smuzhiyun 
1075*4882a593Smuzhiyun 	if (!tb_id)
1076*4882a593Smuzhiyun 		tb_id = (type == RTN_UNICAST) ? RT_TABLE_MAIN : RT_TABLE_LOCAL;
1077*4882a593Smuzhiyun 
1078*4882a593Smuzhiyun 	tb = fib_new_table(net, tb_id);
1079*4882a593Smuzhiyun 	if (!tb)
1080*4882a593Smuzhiyun 		return;
1081*4882a593Smuzhiyun 
1082*4882a593Smuzhiyun 	cfg.fc_table = tb->tb_id;
1083*4882a593Smuzhiyun 
1084*4882a593Smuzhiyun 	if (type != RTN_LOCAL)
1085*4882a593Smuzhiyun 		cfg.fc_scope = RT_SCOPE_LINK;
1086*4882a593Smuzhiyun 	else
1087*4882a593Smuzhiyun 		cfg.fc_scope = RT_SCOPE_HOST;
1088*4882a593Smuzhiyun 
1089*4882a593Smuzhiyun 	if (cmd == RTM_NEWROUTE)
1090*4882a593Smuzhiyun 		fib_table_insert(net, tb, &cfg, NULL);
1091*4882a593Smuzhiyun 	else
1092*4882a593Smuzhiyun 		fib_table_delete(net, tb, &cfg, NULL);
1093*4882a593Smuzhiyun }
1094*4882a593Smuzhiyun 
fib_add_ifaddr(struct in_ifaddr * ifa)1095*4882a593Smuzhiyun void fib_add_ifaddr(struct in_ifaddr *ifa)
1096*4882a593Smuzhiyun {
1097*4882a593Smuzhiyun 	struct in_device *in_dev = ifa->ifa_dev;
1098*4882a593Smuzhiyun 	struct net_device *dev = in_dev->dev;
1099*4882a593Smuzhiyun 	struct in_ifaddr *prim = ifa;
1100*4882a593Smuzhiyun 	__be32 mask = ifa->ifa_mask;
1101*4882a593Smuzhiyun 	__be32 addr = ifa->ifa_local;
1102*4882a593Smuzhiyun 	__be32 prefix = ifa->ifa_address & mask;
1103*4882a593Smuzhiyun 
1104*4882a593Smuzhiyun 	if (ifa->ifa_flags & IFA_F_SECONDARY) {
1105*4882a593Smuzhiyun 		prim = inet_ifa_byprefix(in_dev, prefix, mask);
1106*4882a593Smuzhiyun 		if (!prim) {
1107*4882a593Smuzhiyun 			pr_warn("%s: bug: prim == NULL\n", __func__);
1108*4882a593Smuzhiyun 			return;
1109*4882a593Smuzhiyun 		}
1110*4882a593Smuzhiyun 	}
1111*4882a593Smuzhiyun 
1112*4882a593Smuzhiyun 	fib_magic(RTM_NEWROUTE, RTN_LOCAL, addr, 32, prim, 0);
1113*4882a593Smuzhiyun 
1114*4882a593Smuzhiyun 	if (!(dev->flags & IFF_UP))
1115*4882a593Smuzhiyun 		return;
1116*4882a593Smuzhiyun 
1117*4882a593Smuzhiyun 	/* Add broadcast address, if it is explicitly assigned. */
1118*4882a593Smuzhiyun 	if (ifa->ifa_broadcast && ifa->ifa_broadcast != htonl(0xFFFFFFFF)) {
1119*4882a593Smuzhiyun 		fib_magic(RTM_NEWROUTE, RTN_BROADCAST, ifa->ifa_broadcast, 32,
1120*4882a593Smuzhiyun 			  prim, 0);
1121*4882a593Smuzhiyun 		arp_invalidate(dev, ifa->ifa_broadcast, false);
1122*4882a593Smuzhiyun 	}
1123*4882a593Smuzhiyun 
1124*4882a593Smuzhiyun 	if (!ipv4_is_zeronet(prefix) && !(ifa->ifa_flags & IFA_F_SECONDARY) &&
1125*4882a593Smuzhiyun 	    (prefix != addr || ifa->ifa_prefixlen < 32)) {
1126*4882a593Smuzhiyun 		if (!(ifa->ifa_flags & IFA_F_NOPREFIXROUTE))
1127*4882a593Smuzhiyun 			fib_magic(RTM_NEWROUTE,
1128*4882a593Smuzhiyun 				  dev->flags & IFF_LOOPBACK ? RTN_LOCAL : RTN_UNICAST,
1129*4882a593Smuzhiyun 				  prefix, ifa->ifa_prefixlen, prim,
1130*4882a593Smuzhiyun 				  ifa->ifa_rt_priority);
1131*4882a593Smuzhiyun 
1132*4882a593Smuzhiyun 		/* Add network specific broadcasts, when it takes a sense */
1133*4882a593Smuzhiyun 		if (ifa->ifa_prefixlen < 31) {
1134*4882a593Smuzhiyun 			fib_magic(RTM_NEWROUTE, RTN_BROADCAST, prefix, 32,
1135*4882a593Smuzhiyun 				  prim, 0);
1136*4882a593Smuzhiyun 			fib_magic(RTM_NEWROUTE, RTN_BROADCAST, prefix | ~mask,
1137*4882a593Smuzhiyun 				  32, prim, 0);
1138*4882a593Smuzhiyun 			arp_invalidate(dev, prefix | ~mask, false);
1139*4882a593Smuzhiyun 		}
1140*4882a593Smuzhiyun 	}
1141*4882a593Smuzhiyun }
1142*4882a593Smuzhiyun 
fib_modify_prefix_metric(struct in_ifaddr * ifa,u32 new_metric)1143*4882a593Smuzhiyun void fib_modify_prefix_metric(struct in_ifaddr *ifa, u32 new_metric)
1144*4882a593Smuzhiyun {
1145*4882a593Smuzhiyun 	__be32 prefix = ifa->ifa_address & ifa->ifa_mask;
1146*4882a593Smuzhiyun 	struct in_device *in_dev = ifa->ifa_dev;
1147*4882a593Smuzhiyun 	struct net_device *dev = in_dev->dev;
1148*4882a593Smuzhiyun 
1149*4882a593Smuzhiyun 	if (!(dev->flags & IFF_UP) ||
1150*4882a593Smuzhiyun 	    ifa->ifa_flags & (IFA_F_SECONDARY | IFA_F_NOPREFIXROUTE) ||
1151*4882a593Smuzhiyun 	    ipv4_is_zeronet(prefix) ||
1152*4882a593Smuzhiyun 	    (prefix == ifa->ifa_local && ifa->ifa_prefixlen == 32))
1153*4882a593Smuzhiyun 		return;
1154*4882a593Smuzhiyun 
1155*4882a593Smuzhiyun 	/* add the new */
1156*4882a593Smuzhiyun 	fib_magic(RTM_NEWROUTE,
1157*4882a593Smuzhiyun 		  dev->flags & IFF_LOOPBACK ? RTN_LOCAL : RTN_UNICAST,
1158*4882a593Smuzhiyun 		  prefix, ifa->ifa_prefixlen, ifa, new_metric);
1159*4882a593Smuzhiyun 
1160*4882a593Smuzhiyun 	/* delete the old */
1161*4882a593Smuzhiyun 	fib_magic(RTM_DELROUTE,
1162*4882a593Smuzhiyun 		  dev->flags & IFF_LOOPBACK ? RTN_LOCAL : RTN_UNICAST,
1163*4882a593Smuzhiyun 		  prefix, ifa->ifa_prefixlen, ifa, ifa->ifa_rt_priority);
1164*4882a593Smuzhiyun }
1165*4882a593Smuzhiyun 
1166*4882a593Smuzhiyun /* Delete primary or secondary address.
1167*4882a593Smuzhiyun  * Optionally, on secondary address promotion consider the addresses
1168*4882a593Smuzhiyun  * from subnet iprim as deleted, even if they are in device list.
1169*4882a593Smuzhiyun  * In this case the secondary ifa can be in device list.
1170*4882a593Smuzhiyun  */
fib_del_ifaddr(struct in_ifaddr * ifa,struct in_ifaddr * iprim)1171*4882a593Smuzhiyun void fib_del_ifaddr(struct in_ifaddr *ifa, struct in_ifaddr *iprim)
1172*4882a593Smuzhiyun {
1173*4882a593Smuzhiyun 	struct in_device *in_dev = ifa->ifa_dev;
1174*4882a593Smuzhiyun 	struct net_device *dev = in_dev->dev;
1175*4882a593Smuzhiyun 	struct in_ifaddr *ifa1;
1176*4882a593Smuzhiyun 	struct in_ifaddr *prim = ifa, *prim1 = NULL;
1177*4882a593Smuzhiyun 	__be32 brd = ifa->ifa_address | ~ifa->ifa_mask;
1178*4882a593Smuzhiyun 	__be32 any = ifa->ifa_address & ifa->ifa_mask;
1179*4882a593Smuzhiyun #define LOCAL_OK	1
1180*4882a593Smuzhiyun #define BRD_OK		2
1181*4882a593Smuzhiyun #define BRD0_OK		4
1182*4882a593Smuzhiyun #define BRD1_OK		8
1183*4882a593Smuzhiyun 	unsigned int ok = 0;
1184*4882a593Smuzhiyun 	int subnet = 0;		/* Primary network */
1185*4882a593Smuzhiyun 	int gone = 1;		/* Address is missing */
1186*4882a593Smuzhiyun 	int same_prefsrc = 0;	/* Another primary with same IP */
1187*4882a593Smuzhiyun 
1188*4882a593Smuzhiyun 	if (ifa->ifa_flags & IFA_F_SECONDARY) {
1189*4882a593Smuzhiyun 		prim = inet_ifa_byprefix(in_dev, any, ifa->ifa_mask);
1190*4882a593Smuzhiyun 		if (!prim) {
1191*4882a593Smuzhiyun 			/* if the device has been deleted, we don't perform
1192*4882a593Smuzhiyun 			 * address promotion
1193*4882a593Smuzhiyun 			 */
1194*4882a593Smuzhiyun 			if (!in_dev->dead)
1195*4882a593Smuzhiyun 				pr_warn("%s: bug: prim == NULL\n", __func__);
1196*4882a593Smuzhiyun 			return;
1197*4882a593Smuzhiyun 		}
1198*4882a593Smuzhiyun 		if (iprim && iprim != prim) {
1199*4882a593Smuzhiyun 			pr_warn("%s: bug: iprim != prim\n", __func__);
1200*4882a593Smuzhiyun 			return;
1201*4882a593Smuzhiyun 		}
1202*4882a593Smuzhiyun 	} else if (!ipv4_is_zeronet(any) &&
1203*4882a593Smuzhiyun 		   (any != ifa->ifa_local || ifa->ifa_prefixlen < 32)) {
1204*4882a593Smuzhiyun 		if (!(ifa->ifa_flags & IFA_F_NOPREFIXROUTE))
1205*4882a593Smuzhiyun 			fib_magic(RTM_DELROUTE,
1206*4882a593Smuzhiyun 				  dev->flags & IFF_LOOPBACK ? RTN_LOCAL : RTN_UNICAST,
1207*4882a593Smuzhiyun 				  any, ifa->ifa_prefixlen, prim, 0);
1208*4882a593Smuzhiyun 		subnet = 1;
1209*4882a593Smuzhiyun 	}
1210*4882a593Smuzhiyun 
1211*4882a593Smuzhiyun 	if (in_dev->dead)
1212*4882a593Smuzhiyun 		goto no_promotions;
1213*4882a593Smuzhiyun 
1214*4882a593Smuzhiyun 	/* Deletion is more complicated than add.
1215*4882a593Smuzhiyun 	 * We should take care of not to delete too much :-)
1216*4882a593Smuzhiyun 	 *
1217*4882a593Smuzhiyun 	 * Scan address list to be sure that addresses are really gone.
1218*4882a593Smuzhiyun 	 */
1219*4882a593Smuzhiyun 	rcu_read_lock();
1220*4882a593Smuzhiyun 	in_dev_for_each_ifa_rcu(ifa1, in_dev) {
1221*4882a593Smuzhiyun 		if (ifa1 == ifa) {
1222*4882a593Smuzhiyun 			/* promotion, keep the IP */
1223*4882a593Smuzhiyun 			gone = 0;
1224*4882a593Smuzhiyun 			continue;
1225*4882a593Smuzhiyun 		}
1226*4882a593Smuzhiyun 		/* Ignore IFAs from our subnet */
1227*4882a593Smuzhiyun 		if (iprim && ifa1->ifa_mask == iprim->ifa_mask &&
1228*4882a593Smuzhiyun 		    inet_ifa_match(ifa1->ifa_address, iprim))
1229*4882a593Smuzhiyun 			continue;
1230*4882a593Smuzhiyun 
1231*4882a593Smuzhiyun 		/* Ignore ifa1 if it uses different primary IP (prefsrc) */
1232*4882a593Smuzhiyun 		if (ifa1->ifa_flags & IFA_F_SECONDARY) {
1233*4882a593Smuzhiyun 			/* Another address from our subnet? */
1234*4882a593Smuzhiyun 			if (ifa1->ifa_mask == prim->ifa_mask &&
1235*4882a593Smuzhiyun 			    inet_ifa_match(ifa1->ifa_address, prim))
1236*4882a593Smuzhiyun 				prim1 = prim;
1237*4882a593Smuzhiyun 			else {
1238*4882a593Smuzhiyun 				/* We reached the secondaries, so
1239*4882a593Smuzhiyun 				 * same_prefsrc should be determined.
1240*4882a593Smuzhiyun 				 */
1241*4882a593Smuzhiyun 				if (!same_prefsrc)
1242*4882a593Smuzhiyun 					continue;
1243*4882a593Smuzhiyun 				/* Search new prim1 if ifa1 is not
1244*4882a593Smuzhiyun 				 * using the current prim1
1245*4882a593Smuzhiyun 				 */
1246*4882a593Smuzhiyun 				if (!prim1 ||
1247*4882a593Smuzhiyun 				    ifa1->ifa_mask != prim1->ifa_mask ||
1248*4882a593Smuzhiyun 				    !inet_ifa_match(ifa1->ifa_address, prim1))
1249*4882a593Smuzhiyun 					prim1 = inet_ifa_byprefix(in_dev,
1250*4882a593Smuzhiyun 							ifa1->ifa_address,
1251*4882a593Smuzhiyun 							ifa1->ifa_mask);
1252*4882a593Smuzhiyun 				if (!prim1)
1253*4882a593Smuzhiyun 					continue;
1254*4882a593Smuzhiyun 				if (prim1->ifa_local != prim->ifa_local)
1255*4882a593Smuzhiyun 					continue;
1256*4882a593Smuzhiyun 			}
1257*4882a593Smuzhiyun 		} else {
1258*4882a593Smuzhiyun 			if (prim->ifa_local != ifa1->ifa_local)
1259*4882a593Smuzhiyun 				continue;
1260*4882a593Smuzhiyun 			prim1 = ifa1;
1261*4882a593Smuzhiyun 			if (prim != prim1)
1262*4882a593Smuzhiyun 				same_prefsrc = 1;
1263*4882a593Smuzhiyun 		}
1264*4882a593Smuzhiyun 		if (ifa->ifa_local == ifa1->ifa_local)
1265*4882a593Smuzhiyun 			ok |= LOCAL_OK;
1266*4882a593Smuzhiyun 		if (ifa->ifa_broadcast == ifa1->ifa_broadcast)
1267*4882a593Smuzhiyun 			ok |= BRD_OK;
1268*4882a593Smuzhiyun 		if (brd == ifa1->ifa_broadcast)
1269*4882a593Smuzhiyun 			ok |= BRD1_OK;
1270*4882a593Smuzhiyun 		if (any == ifa1->ifa_broadcast)
1271*4882a593Smuzhiyun 			ok |= BRD0_OK;
1272*4882a593Smuzhiyun 		/* primary has network specific broadcasts */
1273*4882a593Smuzhiyun 		if (prim1 == ifa1 && ifa1->ifa_prefixlen < 31) {
1274*4882a593Smuzhiyun 			__be32 brd1 = ifa1->ifa_address | ~ifa1->ifa_mask;
1275*4882a593Smuzhiyun 			__be32 any1 = ifa1->ifa_address & ifa1->ifa_mask;
1276*4882a593Smuzhiyun 
1277*4882a593Smuzhiyun 			if (!ipv4_is_zeronet(any1)) {
1278*4882a593Smuzhiyun 				if (ifa->ifa_broadcast == brd1 ||
1279*4882a593Smuzhiyun 				    ifa->ifa_broadcast == any1)
1280*4882a593Smuzhiyun 					ok |= BRD_OK;
1281*4882a593Smuzhiyun 				if (brd == brd1 || brd == any1)
1282*4882a593Smuzhiyun 					ok |= BRD1_OK;
1283*4882a593Smuzhiyun 				if (any == brd1 || any == any1)
1284*4882a593Smuzhiyun 					ok |= BRD0_OK;
1285*4882a593Smuzhiyun 			}
1286*4882a593Smuzhiyun 		}
1287*4882a593Smuzhiyun 	}
1288*4882a593Smuzhiyun 	rcu_read_unlock();
1289*4882a593Smuzhiyun 
1290*4882a593Smuzhiyun no_promotions:
1291*4882a593Smuzhiyun 	if (!(ok & BRD_OK))
1292*4882a593Smuzhiyun 		fib_magic(RTM_DELROUTE, RTN_BROADCAST, ifa->ifa_broadcast, 32,
1293*4882a593Smuzhiyun 			  prim, 0);
1294*4882a593Smuzhiyun 	if (subnet && ifa->ifa_prefixlen < 31) {
1295*4882a593Smuzhiyun 		if (!(ok & BRD1_OK))
1296*4882a593Smuzhiyun 			fib_magic(RTM_DELROUTE, RTN_BROADCAST, brd, 32,
1297*4882a593Smuzhiyun 				  prim, 0);
1298*4882a593Smuzhiyun 		if (!(ok & BRD0_OK))
1299*4882a593Smuzhiyun 			fib_magic(RTM_DELROUTE, RTN_BROADCAST, any, 32,
1300*4882a593Smuzhiyun 				  prim, 0);
1301*4882a593Smuzhiyun 	}
1302*4882a593Smuzhiyun 	if (!(ok & LOCAL_OK)) {
1303*4882a593Smuzhiyun 		unsigned int addr_type;
1304*4882a593Smuzhiyun 
1305*4882a593Smuzhiyun 		fib_magic(RTM_DELROUTE, RTN_LOCAL, ifa->ifa_local, 32, prim, 0);
1306*4882a593Smuzhiyun 
1307*4882a593Smuzhiyun 		/* Check, that this local address finally disappeared. */
1308*4882a593Smuzhiyun 		addr_type = inet_addr_type_dev_table(dev_net(dev), dev,
1309*4882a593Smuzhiyun 						     ifa->ifa_local);
1310*4882a593Smuzhiyun 		if (gone && addr_type != RTN_LOCAL) {
1311*4882a593Smuzhiyun 			/* And the last, but not the least thing.
1312*4882a593Smuzhiyun 			 * We must flush stray FIB entries.
1313*4882a593Smuzhiyun 			 *
1314*4882a593Smuzhiyun 			 * First of all, we scan fib_info list searching
1315*4882a593Smuzhiyun 			 * for stray nexthop entries, then ignite fib_flush.
1316*4882a593Smuzhiyun 			 */
1317*4882a593Smuzhiyun 			if (fib_sync_down_addr(dev, ifa->ifa_local))
1318*4882a593Smuzhiyun 				fib_flush(dev_net(dev));
1319*4882a593Smuzhiyun 		}
1320*4882a593Smuzhiyun 	}
1321*4882a593Smuzhiyun #undef LOCAL_OK
1322*4882a593Smuzhiyun #undef BRD_OK
1323*4882a593Smuzhiyun #undef BRD0_OK
1324*4882a593Smuzhiyun #undef BRD1_OK
1325*4882a593Smuzhiyun }
1326*4882a593Smuzhiyun 
nl_fib_lookup(struct net * net,struct fib_result_nl * frn)1327*4882a593Smuzhiyun static void nl_fib_lookup(struct net *net, struct fib_result_nl *frn)
1328*4882a593Smuzhiyun {
1329*4882a593Smuzhiyun 
1330*4882a593Smuzhiyun 	struct fib_result       res;
1331*4882a593Smuzhiyun 	struct flowi4           fl4 = {
1332*4882a593Smuzhiyun 		.flowi4_mark = frn->fl_mark,
1333*4882a593Smuzhiyun 		.daddr = frn->fl_addr,
1334*4882a593Smuzhiyun 		.flowi4_tos = frn->fl_tos,
1335*4882a593Smuzhiyun 		.flowi4_scope = frn->fl_scope,
1336*4882a593Smuzhiyun 	};
1337*4882a593Smuzhiyun 	struct fib_table *tb;
1338*4882a593Smuzhiyun 
1339*4882a593Smuzhiyun 	rcu_read_lock();
1340*4882a593Smuzhiyun 
1341*4882a593Smuzhiyun 	tb = fib_get_table(net, frn->tb_id_in);
1342*4882a593Smuzhiyun 
1343*4882a593Smuzhiyun 	frn->err = -ENOENT;
1344*4882a593Smuzhiyun 	if (tb) {
1345*4882a593Smuzhiyun 		local_bh_disable();
1346*4882a593Smuzhiyun 
1347*4882a593Smuzhiyun 		frn->tb_id = tb->tb_id;
1348*4882a593Smuzhiyun 		frn->err = fib_table_lookup(tb, &fl4, &res, FIB_LOOKUP_NOREF);
1349*4882a593Smuzhiyun 
1350*4882a593Smuzhiyun 		if (!frn->err) {
1351*4882a593Smuzhiyun 			frn->prefixlen = res.prefixlen;
1352*4882a593Smuzhiyun 			frn->nh_sel = res.nh_sel;
1353*4882a593Smuzhiyun 			frn->type = res.type;
1354*4882a593Smuzhiyun 			frn->scope = res.scope;
1355*4882a593Smuzhiyun 		}
1356*4882a593Smuzhiyun 		local_bh_enable();
1357*4882a593Smuzhiyun 	}
1358*4882a593Smuzhiyun 
1359*4882a593Smuzhiyun 	rcu_read_unlock();
1360*4882a593Smuzhiyun }
1361*4882a593Smuzhiyun 
nl_fib_input(struct sk_buff * skb)1362*4882a593Smuzhiyun static void nl_fib_input(struct sk_buff *skb)
1363*4882a593Smuzhiyun {
1364*4882a593Smuzhiyun 	struct net *net;
1365*4882a593Smuzhiyun 	struct fib_result_nl *frn;
1366*4882a593Smuzhiyun 	struct nlmsghdr *nlh;
1367*4882a593Smuzhiyun 	u32 portid;
1368*4882a593Smuzhiyun 
1369*4882a593Smuzhiyun 	net = sock_net(skb->sk);
1370*4882a593Smuzhiyun 	nlh = nlmsg_hdr(skb);
1371*4882a593Smuzhiyun 	if (skb->len < nlmsg_total_size(sizeof(*frn)) ||
1372*4882a593Smuzhiyun 	    skb->len < nlh->nlmsg_len ||
1373*4882a593Smuzhiyun 	    nlmsg_len(nlh) < sizeof(*frn))
1374*4882a593Smuzhiyun 		return;
1375*4882a593Smuzhiyun 
1376*4882a593Smuzhiyun 	skb = netlink_skb_clone(skb, GFP_KERNEL);
1377*4882a593Smuzhiyun 	if (!skb)
1378*4882a593Smuzhiyun 		return;
1379*4882a593Smuzhiyun 	nlh = nlmsg_hdr(skb);
1380*4882a593Smuzhiyun 
1381*4882a593Smuzhiyun 	frn = (struct fib_result_nl *) nlmsg_data(nlh);
1382*4882a593Smuzhiyun 	nl_fib_lookup(net, frn);
1383*4882a593Smuzhiyun 
1384*4882a593Smuzhiyun 	portid = NETLINK_CB(skb).portid;      /* netlink portid */
1385*4882a593Smuzhiyun 	NETLINK_CB(skb).portid = 0;        /* from kernel */
1386*4882a593Smuzhiyun 	NETLINK_CB(skb).dst_group = 0;  /* unicast */
1387*4882a593Smuzhiyun 	netlink_unicast(net->ipv4.fibnl, skb, portid, MSG_DONTWAIT);
1388*4882a593Smuzhiyun }
1389*4882a593Smuzhiyun 
nl_fib_lookup_init(struct net * net)1390*4882a593Smuzhiyun static int __net_init nl_fib_lookup_init(struct net *net)
1391*4882a593Smuzhiyun {
1392*4882a593Smuzhiyun 	struct sock *sk;
1393*4882a593Smuzhiyun 	struct netlink_kernel_cfg cfg = {
1394*4882a593Smuzhiyun 		.input	= nl_fib_input,
1395*4882a593Smuzhiyun 	};
1396*4882a593Smuzhiyun 
1397*4882a593Smuzhiyun 	sk = netlink_kernel_create(net, NETLINK_FIB_LOOKUP, &cfg);
1398*4882a593Smuzhiyun 	if (!sk)
1399*4882a593Smuzhiyun 		return -EAFNOSUPPORT;
1400*4882a593Smuzhiyun 	net->ipv4.fibnl = sk;
1401*4882a593Smuzhiyun 	return 0;
1402*4882a593Smuzhiyun }
1403*4882a593Smuzhiyun 
nl_fib_lookup_exit(struct net * net)1404*4882a593Smuzhiyun static void nl_fib_lookup_exit(struct net *net)
1405*4882a593Smuzhiyun {
1406*4882a593Smuzhiyun 	netlink_kernel_release(net->ipv4.fibnl);
1407*4882a593Smuzhiyun 	net->ipv4.fibnl = NULL;
1408*4882a593Smuzhiyun }
1409*4882a593Smuzhiyun 
fib_disable_ip(struct net_device * dev,unsigned long event,bool force)1410*4882a593Smuzhiyun static void fib_disable_ip(struct net_device *dev, unsigned long event,
1411*4882a593Smuzhiyun 			   bool force)
1412*4882a593Smuzhiyun {
1413*4882a593Smuzhiyun 	if (fib_sync_down_dev(dev, event, force))
1414*4882a593Smuzhiyun 		fib_flush(dev_net(dev));
1415*4882a593Smuzhiyun 	else
1416*4882a593Smuzhiyun 		rt_cache_flush(dev_net(dev));
1417*4882a593Smuzhiyun 	arp_ifdown(dev);
1418*4882a593Smuzhiyun }
1419*4882a593Smuzhiyun 
fib_inetaddr_event(struct notifier_block * this,unsigned long event,void * ptr)1420*4882a593Smuzhiyun static int fib_inetaddr_event(struct notifier_block *this, unsigned long event, void *ptr)
1421*4882a593Smuzhiyun {
1422*4882a593Smuzhiyun 	struct in_ifaddr *ifa = (struct in_ifaddr *)ptr;
1423*4882a593Smuzhiyun 	struct net_device *dev = ifa->ifa_dev->dev;
1424*4882a593Smuzhiyun 	struct net *net = dev_net(dev);
1425*4882a593Smuzhiyun 
1426*4882a593Smuzhiyun 	switch (event) {
1427*4882a593Smuzhiyun 	case NETDEV_UP:
1428*4882a593Smuzhiyun 		fib_add_ifaddr(ifa);
1429*4882a593Smuzhiyun #ifdef CONFIG_IP_ROUTE_MULTIPATH
1430*4882a593Smuzhiyun 		fib_sync_up(dev, RTNH_F_DEAD);
1431*4882a593Smuzhiyun #endif
1432*4882a593Smuzhiyun 		atomic_inc(&net->ipv4.dev_addr_genid);
1433*4882a593Smuzhiyun 		rt_cache_flush(dev_net(dev));
1434*4882a593Smuzhiyun 		break;
1435*4882a593Smuzhiyun 	case NETDEV_DOWN:
1436*4882a593Smuzhiyun 		fib_del_ifaddr(ifa, NULL);
1437*4882a593Smuzhiyun 		atomic_inc(&net->ipv4.dev_addr_genid);
1438*4882a593Smuzhiyun 		if (!ifa->ifa_dev->ifa_list) {
1439*4882a593Smuzhiyun 			/* Last address was deleted from this interface.
1440*4882a593Smuzhiyun 			 * Disable IP.
1441*4882a593Smuzhiyun 			 */
1442*4882a593Smuzhiyun 			fib_disable_ip(dev, event, true);
1443*4882a593Smuzhiyun 		} else {
1444*4882a593Smuzhiyun 			rt_cache_flush(dev_net(dev));
1445*4882a593Smuzhiyun 		}
1446*4882a593Smuzhiyun 		break;
1447*4882a593Smuzhiyun 	}
1448*4882a593Smuzhiyun 	return NOTIFY_DONE;
1449*4882a593Smuzhiyun }
1450*4882a593Smuzhiyun 
fib_netdev_event(struct notifier_block * this,unsigned long event,void * ptr)1451*4882a593Smuzhiyun static int fib_netdev_event(struct notifier_block *this, unsigned long event, void *ptr)
1452*4882a593Smuzhiyun {
1453*4882a593Smuzhiyun 	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
1454*4882a593Smuzhiyun 	struct netdev_notifier_changeupper_info *upper_info = ptr;
1455*4882a593Smuzhiyun 	struct netdev_notifier_info_ext *info_ext = ptr;
1456*4882a593Smuzhiyun 	struct in_device *in_dev;
1457*4882a593Smuzhiyun 	struct net *net = dev_net(dev);
1458*4882a593Smuzhiyun 	struct in_ifaddr *ifa;
1459*4882a593Smuzhiyun 	unsigned int flags;
1460*4882a593Smuzhiyun 
1461*4882a593Smuzhiyun 	if (event == NETDEV_UNREGISTER) {
1462*4882a593Smuzhiyun 		fib_disable_ip(dev, event, true);
1463*4882a593Smuzhiyun 		rt_flush_dev(dev);
1464*4882a593Smuzhiyun 		return NOTIFY_DONE;
1465*4882a593Smuzhiyun 	}
1466*4882a593Smuzhiyun 
1467*4882a593Smuzhiyun 	in_dev = __in_dev_get_rtnl(dev);
1468*4882a593Smuzhiyun 	if (!in_dev)
1469*4882a593Smuzhiyun 		return NOTIFY_DONE;
1470*4882a593Smuzhiyun 
1471*4882a593Smuzhiyun 	switch (event) {
1472*4882a593Smuzhiyun 	case NETDEV_UP:
1473*4882a593Smuzhiyun 		in_dev_for_each_ifa_rtnl(ifa, in_dev) {
1474*4882a593Smuzhiyun 			fib_add_ifaddr(ifa);
1475*4882a593Smuzhiyun 		}
1476*4882a593Smuzhiyun #ifdef CONFIG_IP_ROUTE_MULTIPATH
1477*4882a593Smuzhiyun 		fib_sync_up(dev, RTNH_F_DEAD);
1478*4882a593Smuzhiyun #endif
1479*4882a593Smuzhiyun 		atomic_inc(&net->ipv4.dev_addr_genid);
1480*4882a593Smuzhiyun 		rt_cache_flush(net);
1481*4882a593Smuzhiyun 		break;
1482*4882a593Smuzhiyun 	case NETDEV_DOWN:
1483*4882a593Smuzhiyun 		fib_disable_ip(dev, event, false);
1484*4882a593Smuzhiyun 		break;
1485*4882a593Smuzhiyun 	case NETDEV_CHANGE:
1486*4882a593Smuzhiyun 		flags = dev_get_flags(dev);
1487*4882a593Smuzhiyun 		if (flags & (IFF_RUNNING | IFF_LOWER_UP))
1488*4882a593Smuzhiyun 			fib_sync_up(dev, RTNH_F_LINKDOWN);
1489*4882a593Smuzhiyun 		else
1490*4882a593Smuzhiyun 			fib_sync_down_dev(dev, event, false);
1491*4882a593Smuzhiyun 		rt_cache_flush(net);
1492*4882a593Smuzhiyun 		break;
1493*4882a593Smuzhiyun 	case NETDEV_CHANGEMTU:
1494*4882a593Smuzhiyun 		fib_sync_mtu(dev, info_ext->ext.mtu);
1495*4882a593Smuzhiyun 		rt_cache_flush(net);
1496*4882a593Smuzhiyun 		break;
1497*4882a593Smuzhiyun 	case NETDEV_CHANGEUPPER:
1498*4882a593Smuzhiyun 		upper_info = ptr;
1499*4882a593Smuzhiyun 		/* flush all routes if dev is linked to or unlinked from
1500*4882a593Smuzhiyun 		 * an L3 master device (e.g., VRF)
1501*4882a593Smuzhiyun 		 */
1502*4882a593Smuzhiyun 		if (upper_info->upper_dev &&
1503*4882a593Smuzhiyun 		    netif_is_l3_master(upper_info->upper_dev))
1504*4882a593Smuzhiyun 			fib_disable_ip(dev, NETDEV_DOWN, true);
1505*4882a593Smuzhiyun 		break;
1506*4882a593Smuzhiyun 	}
1507*4882a593Smuzhiyun 	return NOTIFY_DONE;
1508*4882a593Smuzhiyun }
1509*4882a593Smuzhiyun 
1510*4882a593Smuzhiyun static struct notifier_block fib_inetaddr_notifier = {
1511*4882a593Smuzhiyun 	.notifier_call = fib_inetaddr_event,
1512*4882a593Smuzhiyun };
1513*4882a593Smuzhiyun 
1514*4882a593Smuzhiyun static struct notifier_block fib_netdev_notifier = {
1515*4882a593Smuzhiyun 	.notifier_call = fib_netdev_event,
1516*4882a593Smuzhiyun };
1517*4882a593Smuzhiyun 
ip_fib_net_init(struct net * net)1518*4882a593Smuzhiyun static int __net_init ip_fib_net_init(struct net *net)
1519*4882a593Smuzhiyun {
1520*4882a593Smuzhiyun 	int err;
1521*4882a593Smuzhiyun 	size_t size = sizeof(struct hlist_head) * FIB_TABLE_HASHSZ;
1522*4882a593Smuzhiyun 
1523*4882a593Smuzhiyun 	err = fib4_notifier_init(net);
1524*4882a593Smuzhiyun 	if (err)
1525*4882a593Smuzhiyun 		return err;
1526*4882a593Smuzhiyun 
1527*4882a593Smuzhiyun 	/* Avoid false sharing : Use at least a full cache line */
1528*4882a593Smuzhiyun 	size = max_t(size_t, size, L1_CACHE_BYTES);
1529*4882a593Smuzhiyun 
1530*4882a593Smuzhiyun 	net->ipv4.fib_table_hash = kzalloc(size, GFP_KERNEL);
1531*4882a593Smuzhiyun 	if (!net->ipv4.fib_table_hash) {
1532*4882a593Smuzhiyun 		err = -ENOMEM;
1533*4882a593Smuzhiyun 		goto err_table_hash_alloc;
1534*4882a593Smuzhiyun 	}
1535*4882a593Smuzhiyun 
1536*4882a593Smuzhiyun 	err = fib4_rules_init(net);
1537*4882a593Smuzhiyun 	if (err < 0)
1538*4882a593Smuzhiyun 		goto err_rules_init;
1539*4882a593Smuzhiyun 	return 0;
1540*4882a593Smuzhiyun 
1541*4882a593Smuzhiyun err_rules_init:
1542*4882a593Smuzhiyun 	kfree(net->ipv4.fib_table_hash);
1543*4882a593Smuzhiyun err_table_hash_alloc:
1544*4882a593Smuzhiyun 	fib4_notifier_exit(net);
1545*4882a593Smuzhiyun 	return err;
1546*4882a593Smuzhiyun }
1547*4882a593Smuzhiyun 
ip_fib_net_exit(struct net * net)1548*4882a593Smuzhiyun static void ip_fib_net_exit(struct net *net)
1549*4882a593Smuzhiyun {
1550*4882a593Smuzhiyun 	int i;
1551*4882a593Smuzhiyun 
1552*4882a593Smuzhiyun 	rtnl_lock();
1553*4882a593Smuzhiyun #ifdef CONFIG_IP_MULTIPLE_TABLES
1554*4882a593Smuzhiyun 	RCU_INIT_POINTER(net->ipv4.fib_main, NULL);
1555*4882a593Smuzhiyun 	RCU_INIT_POINTER(net->ipv4.fib_default, NULL);
1556*4882a593Smuzhiyun #endif
1557*4882a593Smuzhiyun 	/* Destroy the tables in reverse order to guarantee that the
1558*4882a593Smuzhiyun 	 * local table, ID 255, is destroyed before the main table, ID
1559*4882a593Smuzhiyun 	 * 254. This is necessary as the local table may contain
1560*4882a593Smuzhiyun 	 * references to data contained in the main table.
1561*4882a593Smuzhiyun 	 */
1562*4882a593Smuzhiyun 	for (i = FIB_TABLE_HASHSZ - 1; i >= 0; i--) {
1563*4882a593Smuzhiyun 		struct hlist_head *head = &net->ipv4.fib_table_hash[i];
1564*4882a593Smuzhiyun 		struct hlist_node *tmp;
1565*4882a593Smuzhiyun 		struct fib_table *tb;
1566*4882a593Smuzhiyun 
1567*4882a593Smuzhiyun 		hlist_for_each_entry_safe(tb, tmp, head, tb_hlist) {
1568*4882a593Smuzhiyun 			hlist_del(&tb->tb_hlist);
1569*4882a593Smuzhiyun 			fib_table_flush(net, tb, true);
1570*4882a593Smuzhiyun 			fib_free_table(tb);
1571*4882a593Smuzhiyun 		}
1572*4882a593Smuzhiyun 	}
1573*4882a593Smuzhiyun 
1574*4882a593Smuzhiyun #ifdef CONFIG_IP_MULTIPLE_TABLES
1575*4882a593Smuzhiyun 	fib4_rules_exit(net);
1576*4882a593Smuzhiyun #endif
1577*4882a593Smuzhiyun 	rtnl_unlock();
1578*4882a593Smuzhiyun 	kfree(net->ipv4.fib_table_hash);
1579*4882a593Smuzhiyun 	fib4_notifier_exit(net);
1580*4882a593Smuzhiyun }
1581*4882a593Smuzhiyun 
fib_net_init(struct net * net)1582*4882a593Smuzhiyun static int __net_init fib_net_init(struct net *net)
1583*4882a593Smuzhiyun {
1584*4882a593Smuzhiyun 	int error;
1585*4882a593Smuzhiyun 
1586*4882a593Smuzhiyun #ifdef CONFIG_IP_ROUTE_CLASSID
1587*4882a593Smuzhiyun 	atomic_set(&net->ipv4.fib_num_tclassid_users, 0);
1588*4882a593Smuzhiyun #endif
1589*4882a593Smuzhiyun 	error = ip_fib_net_init(net);
1590*4882a593Smuzhiyun 	if (error < 0)
1591*4882a593Smuzhiyun 		goto out;
1592*4882a593Smuzhiyun 	error = nl_fib_lookup_init(net);
1593*4882a593Smuzhiyun 	if (error < 0)
1594*4882a593Smuzhiyun 		goto out_nlfl;
1595*4882a593Smuzhiyun 	error = fib_proc_init(net);
1596*4882a593Smuzhiyun 	if (error < 0)
1597*4882a593Smuzhiyun 		goto out_proc;
1598*4882a593Smuzhiyun out:
1599*4882a593Smuzhiyun 	return error;
1600*4882a593Smuzhiyun 
1601*4882a593Smuzhiyun out_proc:
1602*4882a593Smuzhiyun 	nl_fib_lookup_exit(net);
1603*4882a593Smuzhiyun out_nlfl:
1604*4882a593Smuzhiyun 	ip_fib_net_exit(net);
1605*4882a593Smuzhiyun 	goto out;
1606*4882a593Smuzhiyun }
1607*4882a593Smuzhiyun 
fib_net_exit(struct net * net)1608*4882a593Smuzhiyun static void __net_exit fib_net_exit(struct net *net)
1609*4882a593Smuzhiyun {
1610*4882a593Smuzhiyun 	fib_proc_exit(net);
1611*4882a593Smuzhiyun 	nl_fib_lookup_exit(net);
1612*4882a593Smuzhiyun 	ip_fib_net_exit(net);
1613*4882a593Smuzhiyun }
1614*4882a593Smuzhiyun 
1615*4882a593Smuzhiyun static struct pernet_operations fib_net_ops = {
1616*4882a593Smuzhiyun 	.init = fib_net_init,
1617*4882a593Smuzhiyun 	.exit = fib_net_exit,
1618*4882a593Smuzhiyun };
1619*4882a593Smuzhiyun 
ip_fib_init(void)1620*4882a593Smuzhiyun void __init ip_fib_init(void)
1621*4882a593Smuzhiyun {
1622*4882a593Smuzhiyun 	fib_trie_init();
1623*4882a593Smuzhiyun 
1624*4882a593Smuzhiyun 	register_pernet_subsys(&fib_net_ops);
1625*4882a593Smuzhiyun 
1626*4882a593Smuzhiyun 	register_netdevice_notifier(&fib_netdev_notifier);
1627*4882a593Smuzhiyun 	register_inetaddr_notifier(&fib_inetaddr_notifier);
1628*4882a593Smuzhiyun 
1629*4882a593Smuzhiyun 	rtnl_register(PF_INET, RTM_NEWROUTE, inet_rtm_newroute, NULL, 0);
1630*4882a593Smuzhiyun 	rtnl_register(PF_INET, RTM_DELROUTE, inet_rtm_delroute, NULL, 0);
1631*4882a593Smuzhiyun 	rtnl_register(PF_INET, RTM_GETROUTE, NULL, inet_dump_fib, 0);
1632*4882a593Smuzhiyun }
1633