xref: /linux/drivers/net/bareudp.c (revision c46a49a4)
1571912c6SMartin Varghese // SPDX-License-Identifier: GPL-2.0
2571912c6SMartin Varghese /* Bareudp: UDP  tunnel encasulation for different Payload types like
3571912c6SMartin Varghese  * MPLS, NSH, IP, etc.
4571912c6SMartin Varghese  * Copyright (c) 2019 Nokia, Inc.
5571912c6SMartin Varghese  * Authors:  Martin Varghese, <martin.varghese@nokia.com>
6571912c6SMartin Varghese  */
7571912c6SMartin Varghese 
8571912c6SMartin Varghese #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
9571912c6SMartin Varghese 
10571912c6SMartin Varghese #include <linux/kernel.h>
11571912c6SMartin Varghese #include <linux/module.h>
12571912c6SMartin Varghese #include <linux/etherdevice.h>
13571912c6SMartin Varghese #include <linux/hash.h>
14571912c6SMartin Varghese #include <net/dst_metadata.h>
15571912c6SMartin Varghese #include <net/gro_cells.h>
16571912c6SMartin Varghese #include <net/rtnetlink.h>
17571912c6SMartin Varghese #include <net/protocol.h>
18571912c6SMartin Varghese #include <net/ip6_tunnel.h>
19571912c6SMartin Varghese #include <net/ip_tunnels.h>
20571912c6SMartin Varghese #include <net/udp_tunnel.h>
21571912c6SMartin Varghese #include <net/bareudp.h>
22571912c6SMartin Varghese 
23571912c6SMartin Varghese #define BAREUDP_BASE_HLEN sizeof(struct udphdr)
24571912c6SMartin Varghese #define BAREUDP_IPV4_HLEN (sizeof(struct iphdr) + \
25571912c6SMartin Varghese 			   sizeof(struct udphdr))
26571912c6SMartin Varghese #define BAREUDP_IPV6_HLEN (sizeof(struct ipv6hdr) + \
27571912c6SMartin Varghese 			   sizeof(struct udphdr))
28571912c6SMartin Varghese 
29571912c6SMartin Varghese static bool log_ecn_error = true;
30571912c6SMartin Varghese module_param(log_ecn_error, bool, 0644);
31571912c6SMartin Varghese MODULE_PARM_DESC(log_ecn_error, "Log packets received with corrupted ECN");
32571912c6SMartin Varghese 
33571912c6SMartin Varghese /* per-network namespace private data for this module */
34571912c6SMartin Varghese 
35571912c6SMartin Varghese static unsigned int bareudp_net_id;
36571912c6SMartin Varghese 
37571912c6SMartin Varghese struct bareudp_net {
38571912c6SMartin Varghese 	struct list_head        bareudp_list;
39571912c6SMartin Varghese };
40571912c6SMartin Varghese 
41571912c6SMartin Varghese /* Pseudo network device */
42571912c6SMartin Varghese struct bareudp_dev {
43571912c6SMartin Varghese 	struct net         *net;        /* netns for packet i/o */
44571912c6SMartin Varghese 	struct net_device  *dev;        /* netdev for bareudp tunnel */
45571912c6SMartin Varghese 	__be16		   ethertype;
46571912c6SMartin Varghese 	__be16             port;
47571912c6SMartin Varghese 	u16	           sport_min;
484b5f6723SMartin Varghese 	bool               multi_proto_mode;
49571912c6SMartin Varghese 	struct socket      __rcu *sock;
50571912c6SMartin Varghese 	struct list_head   next;        /* bareudp node  on namespace list */
51571912c6SMartin Varghese 	struct gro_cells   gro_cells;
52571912c6SMartin Varghese };
53571912c6SMartin Varghese 
54571912c6SMartin Varghese static int bareudp_udp_encap_recv(struct sock *sk, struct sk_buff *skb)
55571912c6SMartin Varghese {
56571912c6SMartin Varghese 	struct metadata_dst *tun_dst = NULL;
57571912c6SMartin Varghese 	struct pcpu_sw_netstats *stats;
58571912c6SMartin Varghese 	struct bareudp_dev *bareudp;
59571912c6SMartin Varghese 	unsigned short family;
60571912c6SMartin Varghese 	unsigned int len;
61571912c6SMartin Varghese 	__be16 proto;
62571912c6SMartin Varghese 	void *oiph;
63571912c6SMartin Varghese 	int err;
64571912c6SMartin Varghese 
65571912c6SMartin Varghese 	bareudp = rcu_dereference_sk_user_data(sk);
66571912c6SMartin Varghese 	if (!bareudp)
67571912c6SMartin Varghese 		goto drop;
68571912c6SMartin Varghese 
69571912c6SMartin Varghese 	if (skb->protocol ==  htons(ETH_P_IP))
70571912c6SMartin Varghese 		family = AF_INET;
71571912c6SMartin Varghese 	else
72571912c6SMartin Varghese 		family = AF_INET6;
73571912c6SMartin Varghese 
744b5f6723SMartin Varghese 	if (bareudp->ethertype == htons(ETH_P_IP)) {
754b5f6723SMartin Varghese 		struct iphdr *iphdr;
764b5f6723SMartin Varghese 
774b5f6723SMartin Varghese 		iphdr = (struct iphdr *)(skb->data + BAREUDP_BASE_HLEN);
784b5f6723SMartin Varghese 		if (iphdr->version == 4) {
79571912c6SMartin Varghese 			proto = bareudp->ethertype;
804b5f6723SMartin Varghese 		} else if (bareudp->multi_proto_mode && (iphdr->version == 6)) {
814b5f6723SMartin Varghese 			proto = htons(ETH_P_IPV6);
824b5f6723SMartin Varghese 		} else {
834b5f6723SMartin Varghese 			bareudp->dev->stats.rx_dropped++;
844b5f6723SMartin Varghese 			goto drop;
854b5f6723SMartin Varghese 		}
864b5f6723SMartin Varghese 	} else if (bareudp->ethertype == htons(ETH_P_MPLS_UC)) {
874b5f6723SMartin Varghese 		struct iphdr *tunnel_hdr;
884b5f6723SMartin Varghese 
894b5f6723SMartin Varghese 		tunnel_hdr = (struct iphdr *)skb_network_header(skb);
904b5f6723SMartin Varghese 		if (tunnel_hdr->version == 4) {
914b5f6723SMartin Varghese 			if (!ipv4_is_multicast(tunnel_hdr->daddr)) {
924b5f6723SMartin Varghese 				proto = bareudp->ethertype;
934b5f6723SMartin Varghese 			} else if (bareudp->multi_proto_mode &&
944b5f6723SMartin Varghese 				   ipv4_is_multicast(tunnel_hdr->daddr)) {
954b5f6723SMartin Varghese 				proto = htons(ETH_P_MPLS_MC);
964b5f6723SMartin Varghese 			} else {
974b5f6723SMartin Varghese 				bareudp->dev->stats.rx_dropped++;
984b5f6723SMartin Varghese 				goto drop;
994b5f6723SMartin Varghese 			}
1004b5f6723SMartin Varghese 		} else {
1014b5f6723SMartin Varghese 			int addr_type;
1024b5f6723SMartin Varghese 			struct ipv6hdr *tunnel_hdr_v6;
1034b5f6723SMartin Varghese 
1044b5f6723SMartin Varghese 			tunnel_hdr_v6 = (struct ipv6hdr *)skb_network_header(skb);
1054b5f6723SMartin Varghese 			addr_type =
1064b5f6723SMartin Varghese 			ipv6_addr_type((struct in6_addr *)&tunnel_hdr_v6->daddr);
1074b5f6723SMartin Varghese 			if (!(addr_type & IPV6_ADDR_MULTICAST)) {
1084b5f6723SMartin Varghese 				proto = bareudp->ethertype;
1094b5f6723SMartin Varghese 			} else if (bareudp->multi_proto_mode &&
1104b5f6723SMartin Varghese 				   (addr_type & IPV6_ADDR_MULTICAST)) {
1114b5f6723SMartin Varghese 				proto = htons(ETH_P_MPLS_MC);
1124b5f6723SMartin Varghese 			} else {
1134b5f6723SMartin Varghese 				bareudp->dev->stats.rx_dropped++;
1144b5f6723SMartin Varghese 				goto drop;
1154b5f6723SMartin Varghese 			}
1164b5f6723SMartin Varghese 		}
1174b5f6723SMartin Varghese 	} else {
1184b5f6723SMartin Varghese 		proto = bareudp->ethertype;
1194b5f6723SMartin Varghese 	}
120571912c6SMartin Varghese 
121571912c6SMartin Varghese 	if (iptunnel_pull_header(skb, BAREUDP_BASE_HLEN,
122571912c6SMartin Varghese 				 proto,
123571912c6SMartin Varghese 				 !net_eq(bareudp->net,
124571912c6SMartin Varghese 				 dev_net(bareudp->dev)))) {
125571912c6SMartin Varghese 		bareudp->dev->stats.rx_dropped++;
126571912c6SMartin Varghese 		goto drop;
127571912c6SMartin Varghese 	}
128571912c6SMartin Varghese 
129571912c6SMartin Varghese 	tun_dst = udp_tun_rx_dst(skb, family, TUNNEL_KEY, 0, 0);
130571912c6SMartin Varghese 	if (!tun_dst) {
131571912c6SMartin Varghese 		bareudp->dev->stats.rx_dropped++;
132571912c6SMartin Varghese 		goto drop;
133571912c6SMartin Varghese 	}
134571912c6SMartin Varghese 	skb_dst_set(skb, &tun_dst->dst);
135571912c6SMartin Varghese 	skb->dev = bareudp->dev;
136571912c6SMartin Varghese 	oiph = skb_network_header(skb);
137571912c6SMartin Varghese 	skb_reset_network_header(skb);
138571912c6SMartin Varghese 
139571912c6SMartin Varghese 	if (family == AF_INET)
140571912c6SMartin Varghese 		err = IP_ECN_decapsulate(oiph, skb);
141571912c6SMartin Varghese #if IS_ENABLED(CONFIG_IPV6)
142571912c6SMartin Varghese 	else
143571912c6SMartin Varghese 		err = IP6_ECN_decapsulate(oiph, skb);
144571912c6SMartin Varghese #endif
145571912c6SMartin Varghese 
146571912c6SMartin Varghese 	if (unlikely(err)) {
147571912c6SMartin Varghese 		if (log_ecn_error) {
148571912c6SMartin Varghese 			if  (family == AF_INET)
149571912c6SMartin Varghese 				net_info_ratelimited("non-ECT from %pI4 "
150571912c6SMartin Varghese 						     "with TOS=%#x\n",
151571912c6SMartin Varghese 						     &((struct iphdr *)oiph)->saddr,
152571912c6SMartin Varghese 						     ((struct iphdr *)oiph)->tos);
153571912c6SMartin Varghese #if IS_ENABLED(CONFIG_IPV6)
154571912c6SMartin Varghese 			else
155571912c6SMartin Varghese 				net_info_ratelimited("non-ECT from %pI6\n",
156571912c6SMartin Varghese 						     &((struct ipv6hdr *)oiph)->saddr);
157571912c6SMartin Varghese #endif
158571912c6SMartin Varghese 		}
159571912c6SMartin Varghese 		if (err > 1) {
160571912c6SMartin Varghese 			++bareudp->dev->stats.rx_frame_errors;
161571912c6SMartin Varghese 			++bareudp->dev->stats.rx_errors;
162571912c6SMartin Varghese 			goto drop;
163571912c6SMartin Varghese 		}
164571912c6SMartin Varghese 	}
165571912c6SMartin Varghese 
166571912c6SMartin Varghese 	len = skb->len;
167571912c6SMartin Varghese 	err = gro_cells_receive(&bareudp->gro_cells, skb);
168571912c6SMartin Varghese 	if (likely(err == NET_RX_SUCCESS)) {
169571912c6SMartin Varghese 		stats = this_cpu_ptr(bareudp->dev->tstats);
170571912c6SMartin Varghese 		u64_stats_update_begin(&stats->syncp);
171571912c6SMartin Varghese 		stats->rx_packets++;
172571912c6SMartin Varghese 		stats->rx_bytes += len;
173571912c6SMartin Varghese 		u64_stats_update_end(&stats->syncp);
174571912c6SMartin Varghese 	}
175571912c6SMartin Varghese 	return 0;
176571912c6SMartin Varghese drop:
177571912c6SMartin Varghese 	/* Consume bad packet */
178571912c6SMartin Varghese 	kfree_skb(skb);
179571912c6SMartin Varghese 
180571912c6SMartin Varghese 	return 0;
181571912c6SMartin Varghese }
182571912c6SMartin Varghese 
183571912c6SMartin Varghese static int bareudp_err_lookup(struct sock *sk, struct sk_buff *skb)
184571912c6SMartin Varghese {
185571912c6SMartin Varghese 	return 0;
186571912c6SMartin Varghese }
187571912c6SMartin Varghese 
188571912c6SMartin Varghese static int bareudp_init(struct net_device *dev)
189571912c6SMartin Varghese {
190571912c6SMartin Varghese 	struct bareudp_dev *bareudp = netdev_priv(dev);
191571912c6SMartin Varghese 	int err;
192571912c6SMartin Varghese 
193571912c6SMartin Varghese 	dev->tstats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
194571912c6SMartin Varghese 	if (!dev->tstats)
195571912c6SMartin Varghese 		return -ENOMEM;
196571912c6SMartin Varghese 
197571912c6SMartin Varghese 	err = gro_cells_init(&bareudp->gro_cells, dev);
198571912c6SMartin Varghese 	if (err) {
199571912c6SMartin Varghese 		free_percpu(dev->tstats);
200571912c6SMartin Varghese 		return err;
201571912c6SMartin Varghese 	}
202571912c6SMartin Varghese 	return 0;
203571912c6SMartin Varghese }
204571912c6SMartin Varghese 
205571912c6SMartin Varghese static void bareudp_uninit(struct net_device *dev)
206571912c6SMartin Varghese {
207571912c6SMartin Varghese 	struct bareudp_dev *bareudp = netdev_priv(dev);
208571912c6SMartin Varghese 
209571912c6SMartin Varghese 	gro_cells_destroy(&bareudp->gro_cells);
210571912c6SMartin Varghese 	free_percpu(dev->tstats);
211571912c6SMartin Varghese }
212571912c6SMartin Varghese 
213571912c6SMartin Varghese static struct socket *bareudp_create_sock(struct net *net, __be16 port)
214571912c6SMartin Varghese {
215571912c6SMartin Varghese 	struct udp_port_cfg udp_conf;
216571912c6SMartin Varghese 	struct socket *sock;
217571912c6SMartin Varghese 	int err;
218571912c6SMartin Varghese 
219571912c6SMartin Varghese 	memset(&udp_conf, 0, sizeof(udp_conf));
220571912c6SMartin Varghese #if IS_ENABLED(CONFIG_IPV6)
221571912c6SMartin Varghese 	udp_conf.family = AF_INET6;
222571912c6SMartin Varghese #else
223571912c6SMartin Varghese 	udp_conf.family = AF_INET;
224571912c6SMartin Varghese #endif
225571912c6SMartin Varghese 	udp_conf.local_udp_port = port;
226571912c6SMartin Varghese 	/* Open UDP socket */
227571912c6SMartin Varghese 	err = udp_sock_create(net, &udp_conf, &sock);
228571912c6SMartin Varghese 	if (err < 0)
229571912c6SMartin Varghese 		return ERR_PTR(err);
230571912c6SMartin Varghese 
231571912c6SMartin Varghese 	return sock;
232571912c6SMartin Varghese }
233571912c6SMartin Varghese 
234571912c6SMartin Varghese /* Create new listen socket if needed */
235571912c6SMartin Varghese static int bareudp_socket_create(struct bareudp_dev *bareudp, __be16 port)
236571912c6SMartin Varghese {
237571912c6SMartin Varghese 	struct udp_tunnel_sock_cfg tunnel_cfg;
238571912c6SMartin Varghese 	struct socket *sock;
239571912c6SMartin Varghese 
240571912c6SMartin Varghese 	sock = bareudp_create_sock(bareudp->net, port);
241571912c6SMartin Varghese 	if (IS_ERR(sock))
242571912c6SMartin Varghese 		return PTR_ERR(sock);
243571912c6SMartin Varghese 
244571912c6SMartin Varghese 	/* Mark socket as an encapsulation socket */
245571912c6SMartin Varghese 	memset(&tunnel_cfg, 0, sizeof(tunnel_cfg));
246571912c6SMartin Varghese 	tunnel_cfg.sk_user_data = bareudp;
247571912c6SMartin Varghese 	tunnel_cfg.encap_type = 1;
248571912c6SMartin Varghese 	tunnel_cfg.encap_rcv = bareudp_udp_encap_recv;
249571912c6SMartin Varghese 	tunnel_cfg.encap_err_lookup = bareudp_err_lookup;
250571912c6SMartin Varghese 	tunnel_cfg.encap_destroy = NULL;
251571912c6SMartin Varghese 	setup_udp_tunnel_sock(bareudp->net, sock, &tunnel_cfg);
252571912c6SMartin Varghese 
253571912c6SMartin Varghese 	if (sock->sk->sk_family == AF_INET6)
254571912c6SMartin Varghese 		udp_encap_enable();
255571912c6SMartin Varghese 
256571912c6SMartin Varghese 	rcu_assign_pointer(bareudp->sock, sock);
257571912c6SMartin Varghese 	return 0;
258571912c6SMartin Varghese }
259571912c6SMartin Varghese 
260571912c6SMartin Varghese static int bareudp_open(struct net_device *dev)
261571912c6SMartin Varghese {
262571912c6SMartin Varghese 	struct bareudp_dev *bareudp = netdev_priv(dev);
263571912c6SMartin Varghese 	int ret = 0;
264571912c6SMartin Varghese 
265571912c6SMartin Varghese 	ret =  bareudp_socket_create(bareudp, bareudp->port);
266571912c6SMartin Varghese 	return ret;
267571912c6SMartin Varghese }
268571912c6SMartin Varghese 
269571912c6SMartin Varghese static void bareudp_sock_release(struct bareudp_dev *bareudp)
270571912c6SMartin Varghese {
271571912c6SMartin Varghese 	struct socket *sock;
272571912c6SMartin Varghese 
273571912c6SMartin Varghese 	sock = bareudp->sock;
274571912c6SMartin Varghese 	rcu_assign_pointer(bareudp->sock, NULL);
275571912c6SMartin Varghese 	synchronize_net();
276571912c6SMartin Varghese 	udp_tunnel_sock_release(sock);
277571912c6SMartin Varghese }
278571912c6SMartin Varghese 
279571912c6SMartin Varghese static int bareudp_stop(struct net_device *dev)
280571912c6SMartin Varghese {
281571912c6SMartin Varghese 	struct bareudp_dev *bareudp = netdev_priv(dev);
282571912c6SMartin Varghese 
283571912c6SMartin Varghese 	bareudp_sock_release(bareudp);
284571912c6SMartin Varghese 	return 0;
285571912c6SMartin Varghese }
286571912c6SMartin Varghese 
287571912c6SMartin Varghese static int bareudp_xmit_skb(struct sk_buff *skb, struct net_device *dev,
288571912c6SMartin Varghese 			    struct bareudp_dev *bareudp,
289571912c6SMartin Varghese 			    const struct ip_tunnel_info *info)
290571912c6SMartin Varghese {
291571912c6SMartin Varghese 	bool xnet = !net_eq(bareudp->net, dev_net(bareudp->dev));
292571912c6SMartin Varghese 	bool use_cache = ip_tunnel_dst_cache_usable(skb, info);
293571912c6SMartin Varghese 	struct socket *sock = rcu_dereference(bareudp->sock);
294571912c6SMartin Varghese 	bool udp_sum = !!(info->key.tun_flags & TUNNEL_CSUM);
295571912c6SMartin Varghese 	const struct ip_tunnel_key *key = &info->key;
296571912c6SMartin Varghese 	struct rtable *rt;
297571912c6SMartin Varghese 	__be16 sport, df;
298571912c6SMartin Varghese 	int min_headroom;
299571912c6SMartin Varghese 	__u8 tos, ttl;
300571912c6SMartin Varghese 	__be32 saddr;
301571912c6SMartin Varghese 	int err;
302571912c6SMartin Varghese 
303571912c6SMartin Varghese 	if (!sock)
304571912c6SMartin Varghese 		return -ESHUTDOWN;
305571912c6SMartin Varghese 
306571912c6SMartin Varghese 	rt = ip_route_output_tunnel(skb, dev, bareudp->net, &saddr, info,
307571912c6SMartin Varghese 				    IPPROTO_UDP, use_cache);
308571912c6SMartin Varghese 
309571912c6SMartin Varghese 	if (IS_ERR(rt))
310571912c6SMartin Varghese 		return PTR_ERR(rt);
311571912c6SMartin Varghese 
312571912c6SMartin Varghese 	skb_tunnel_check_pmtu(skb, &rt->dst,
313571912c6SMartin Varghese 			      BAREUDP_IPV4_HLEN + info->options_len);
314571912c6SMartin Varghese 
315571912c6SMartin Varghese 	sport = udp_flow_src_port(bareudp->net, skb,
316571912c6SMartin Varghese 				  bareudp->sport_min, USHRT_MAX,
317571912c6SMartin Varghese 				  true);
318571912c6SMartin Varghese 	tos = ip_tunnel_ecn_encap(key->tos, ip_hdr(skb), skb);
319571912c6SMartin Varghese 	ttl = key->ttl;
320571912c6SMartin Varghese 	df = key->tun_flags & TUNNEL_DONT_FRAGMENT ? htons(IP_DF) : 0;
321571912c6SMartin Varghese 	skb_scrub_packet(skb, xnet);
322571912c6SMartin Varghese 
323c102b6fdSDavid S. Miller 	err = -ENOSPC;
324571912c6SMartin Varghese 	if (!skb_pull(skb, skb_network_offset(skb)))
325571912c6SMartin Varghese 		goto free_dst;
326571912c6SMartin Varghese 
327571912c6SMartin Varghese 	min_headroom = LL_RESERVED_SPACE(rt->dst.dev) + rt->dst.header_len +
328571912c6SMartin Varghese 		BAREUDP_BASE_HLEN + info->options_len + sizeof(struct iphdr);
329571912c6SMartin Varghese 
330571912c6SMartin Varghese 	err = skb_cow_head(skb, min_headroom);
331571912c6SMartin Varghese 	if (unlikely(err))
332571912c6SMartin Varghese 		goto free_dst;
333571912c6SMartin Varghese 
334571912c6SMartin Varghese 	err = udp_tunnel_handle_offloads(skb, udp_sum);
335571912c6SMartin Varghese 	if (err)
336571912c6SMartin Varghese 		goto free_dst;
337571912c6SMartin Varghese 
338571912c6SMartin Varghese 	skb_set_inner_protocol(skb, bareudp->ethertype);
339571912c6SMartin Varghese 	udp_tunnel_xmit_skb(rt, sock->sk, skb, saddr, info->key.u.ipv4.dst,
340571912c6SMartin Varghese 			    tos, ttl, df, sport, bareudp->port,
341571912c6SMartin Varghese 			    !net_eq(bareudp->net, dev_net(bareudp->dev)),
342571912c6SMartin Varghese 			    !(info->key.tun_flags & TUNNEL_CSUM));
343571912c6SMartin Varghese 	return 0;
344571912c6SMartin Varghese 
345571912c6SMartin Varghese free_dst:
346571912c6SMartin Varghese 	dst_release(&rt->dst);
347571912c6SMartin Varghese 	return err;
348571912c6SMartin Varghese }
349571912c6SMartin Varghese 
350571912c6SMartin Varghese #if IS_ENABLED(CONFIG_IPV6)
351571912c6SMartin Varghese static int bareudp6_xmit_skb(struct sk_buff *skb, struct net_device *dev,
352571912c6SMartin Varghese 			     struct bareudp_dev *bareudp,
353571912c6SMartin Varghese 			     const struct ip_tunnel_info *info)
354571912c6SMartin Varghese {
355571912c6SMartin Varghese 	bool xnet = !net_eq(bareudp->net, dev_net(bareudp->dev));
356571912c6SMartin Varghese 	bool use_cache = ip_tunnel_dst_cache_usable(skb, info);
357571912c6SMartin Varghese 	struct socket *sock  = rcu_dereference(bareudp->sock);
358571912c6SMartin Varghese 	bool udp_sum = !!(info->key.tun_flags & TUNNEL_CSUM);
359571912c6SMartin Varghese 	const struct ip_tunnel_key *key = &info->key;
360571912c6SMartin Varghese 	struct dst_entry *dst = NULL;
361571912c6SMartin Varghese 	struct in6_addr saddr, daddr;
362571912c6SMartin Varghese 	int min_headroom;
363571912c6SMartin Varghese 	__u8 prio, ttl;
364571912c6SMartin Varghese 	__be16 sport;
365571912c6SMartin Varghese 	int err;
366571912c6SMartin Varghese 
367571912c6SMartin Varghese 	if (!sock)
368571912c6SMartin Varghese 		return -ESHUTDOWN;
369571912c6SMartin Varghese 
370571912c6SMartin Varghese 	dst = ip6_dst_lookup_tunnel(skb, dev, bareudp->net, sock, &saddr, info,
371571912c6SMartin Varghese 				    IPPROTO_UDP, use_cache);
372571912c6SMartin Varghese 	if (IS_ERR(dst))
373571912c6SMartin Varghese 		return PTR_ERR(dst);
374571912c6SMartin Varghese 
375571912c6SMartin Varghese 	skb_tunnel_check_pmtu(skb, dst, BAREUDP_IPV6_HLEN + info->options_len);
376571912c6SMartin Varghese 
377571912c6SMartin Varghese 	sport = udp_flow_src_port(bareudp->net, skb,
378571912c6SMartin Varghese 				  bareudp->sport_min, USHRT_MAX,
379571912c6SMartin Varghese 				  true);
380571912c6SMartin Varghese 	prio = ip_tunnel_ecn_encap(key->tos, ip_hdr(skb), skb);
381571912c6SMartin Varghese 	ttl = key->ttl;
382571912c6SMartin Varghese 
383571912c6SMartin Varghese 	skb_scrub_packet(skb, xnet);
384571912c6SMartin Varghese 
385c102b6fdSDavid S. Miller 	err = -ENOSPC;
386571912c6SMartin Varghese 	if (!skb_pull(skb, skb_network_offset(skb)))
387571912c6SMartin Varghese 		goto free_dst;
388571912c6SMartin Varghese 
389571912c6SMartin Varghese 	min_headroom = LL_RESERVED_SPACE(dst->dev) + dst->header_len +
390571912c6SMartin Varghese 		BAREUDP_BASE_HLEN + info->options_len + sizeof(struct iphdr);
391571912c6SMartin Varghese 
392571912c6SMartin Varghese 	err = skb_cow_head(skb, min_headroom);
393571912c6SMartin Varghese 	if (unlikely(err))
394571912c6SMartin Varghese 		goto free_dst;
395571912c6SMartin Varghese 
396571912c6SMartin Varghese 	err = udp_tunnel_handle_offloads(skb, udp_sum);
397571912c6SMartin Varghese 	if (err)
398571912c6SMartin Varghese 		goto free_dst;
399571912c6SMartin Varghese 
400571912c6SMartin Varghese 	daddr = info->key.u.ipv6.dst;
401571912c6SMartin Varghese 	udp_tunnel6_xmit_skb(dst, sock->sk, skb, dev,
402571912c6SMartin Varghese 			     &saddr, &daddr, prio, ttl,
403571912c6SMartin Varghese 			     info->key.label, sport, bareudp->port,
404571912c6SMartin Varghese 			     !(info->key.tun_flags & TUNNEL_CSUM));
405571912c6SMartin Varghese 	return 0;
406571912c6SMartin Varghese 
407571912c6SMartin Varghese free_dst:
408571912c6SMartin Varghese 	dst_release(dst);
409571912c6SMartin Varghese 	return err;
410571912c6SMartin Varghese }
411571912c6SMartin Varghese #endif
412571912c6SMartin Varghese 
413571912c6SMartin Varghese static netdev_tx_t bareudp_xmit(struct sk_buff *skb, struct net_device *dev)
414571912c6SMartin Varghese {
415571912c6SMartin Varghese 	struct bareudp_dev *bareudp = netdev_priv(dev);
416571912c6SMartin Varghese 	struct ip_tunnel_info *info = NULL;
417571912c6SMartin Varghese 	int err;
418571912c6SMartin Varghese 
419571912c6SMartin Varghese 	if (skb->protocol != bareudp->ethertype) {
4204b5f6723SMartin Varghese 		if (!bareudp->multi_proto_mode ||
4214b5f6723SMartin Varghese 		    (skb->protocol !=  htons(ETH_P_MPLS_MC) &&
4224b5f6723SMartin Varghese 		     skb->protocol !=  htons(ETH_P_IPV6))) {
423571912c6SMartin Varghese 			err = -EINVAL;
424571912c6SMartin Varghese 			goto tx_error;
425571912c6SMartin Varghese 		}
4264b5f6723SMartin Varghese 	}
427571912c6SMartin Varghese 
428571912c6SMartin Varghese 	info = skb_tunnel_info(skb);
429571912c6SMartin Varghese 	if (unlikely(!info || !(info->mode & IP_TUNNEL_INFO_TX))) {
430571912c6SMartin Varghese 		err = -EINVAL;
431571912c6SMartin Varghese 		goto tx_error;
432571912c6SMartin Varghese 	}
433571912c6SMartin Varghese 
434571912c6SMartin Varghese 	rcu_read_lock();
435571912c6SMartin Varghese #if IS_ENABLED(CONFIG_IPV6)
436571912c6SMartin Varghese 	if (info->mode & IP_TUNNEL_INFO_IPV6)
437571912c6SMartin Varghese 		err = bareudp6_xmit_skb(skb, dev, bareudp, info);
438571912c6SMartin Varghese 	else
439571912c6SMartin Varghese #endif
440571912c6SMartin Varghese 		err = bareudp_xmit_skb(skb, dev, bareudp, info);
441571912c6SMartin Varghese 
442571912c6SMartin Varghese 	rcu_read_unlock();
443571912c6SMartin Varghese 
444571912c6SMartin Varghese 	if (likely(!err))
445571912c6SMartin Varghese 		return NETDEV_TX_OK;
446571912c6SMartin Varghese tx_error:
447571912c6SMartin Varghese 	dev_kfree_skb(skb);
448571912c6SMartin Varghese 
449571912c6SMartin Varghese 	if (err == -ELOOP)
450571912c6SMartin Varghese 		dev->stats.collisions++;
451571912c6SMartin Varghese 	else if (err == -ENETUNREACH)
452571912c6SMartin Varghese 		dev->stats.tx_carrier_errors++;
453571912c6SMartin Varghese 
454571912c6SMartin Varghese 	dev->stats.tx_errors++;
455571912c6SMartin Varghese 	return NETDEV_TX_OK;
456571912c6SMartin Varghese }
457571912c6SMartin Varghese 
458571912c6SMartin Varghese static int bareudp_fill_metadata_dst(struct net_device *dev,
459571912c6SMartin Varghese 				     struct sk_buff *skb)
460571912c6SMartin Varghese {
461571912c6SMartin Varghese 	struct ip_tunnel_info *info = skb_tunnel_info(skb);
462571912c6SMartin Varghese 	struct bareudp_dev *bareudp = netdev_priv(dev);
463571912c6SMartin Varghese 	bool use_cache;
464571912c6SMartin Varghese 
465571912c6SMartin Varghese 	use_cache = ip_tunnel_dst_cache_usable(skb, info);
466571912c6SMartin Varghese 
467571912c6SMartin Varghese 	if (ip_tunnel_info_af(info) == AF_INET) {
468571912c6SMartin Varghese 		struct rtable *rt;
469571912c6SMartin Varghese 		__be32 saddr;
470571912c6SMartin Varghese 
471571912c6SMartin Varghese 		rt = ip_route_output_tunnel(skb, dev, bareudp->net, &saddr,
472571912c6SMartin Varghese 					    info, IPPROTO_UDP, use_cache);
473571912c6SMartin Varghese 		if (IS_ERR(rt))
474571912c6SMartin Varghese 			return PTR_ERR(rt);
475571912c6SMartin Varghese 
476571912c6SMartin Varghese 		ip_rt_put(rt);
477571912c6SMartin Varghese 		info->key.u.ipv4.src = saddr;
478571912c6SMartin Varghese #if IS_ENABLED(CONFIG_IPV6)
479571912c6SMartin Varghese 	} else if (ip_tunnel_info_af(info) == AF_INET6) {
480571912c6SMartin Varghese 		struct dst_entry *dst;
481571912c6SMartin Varghese 		struct in6_addr saddr;
482571912c6SMartin Varghese 		struct socket *sock = rcu_dereference(bareudp->sock);
483571912c6SMartin Varghese 
484571912c6SMartin Varghese 		dst = ip6_dst_lookup_tunnel(skb, dev, bareudp->net, sock,
485571912c6SMartin Varghese 					    &saddr, info, IPPROTO_UDP,
486571912c6SMartin Varghese 					    use_cache);
487571912c6SMartin Varghese 		if (IS_ERR(dst))
488571912c6SMartin Varghese 			return PTR_ERR(dst);
489571912c6SMartin Varghese 
490571912c6SMartin Varghese 		dst_release(dst);
491571912c6SMartin Varghese 		info->key.u.ipv6.src = saddr;
492571912c6SMartin Varghese #endif
493571912c6SMartin Varghese 	} else {
494571912c6SMartin Varghese 		return -EINVAL;
495571912c6SMartin Varghese 	}
496571912c6SMartin Varghese 
497571912c6SMartin Varghese 	info->key.tp_src = udp_flow_src_port(bareudp->net, skb,
498571912c6SMartin Varghese 					     bareudp->sport_min,
499571912c6SMartin Varghese 			USHRT_MAX, true);
500571912c6SMartin Varghese 	info->key.tp_dst = bareudp->port;
501571912c6SMartin Varghese 	return 0;
502571912c6SMartin Varghese }
503571912c6SMartin Varghese 
504571912c6SMartin Varghese static const struct net_device_ops bareudp_netdev_ops = {
505571912c6SMartin Varghese 	.ndo_init               = bareudp_init,
506571912c6SMartin Varghese 	.ndo_uninit             = bareudp_uninit,
507571912c6SMartin Varghese 	.ndo_open               = bareudp_open,
508571912c6SMartin Varghese 	.ndo_stop               = bareudp_stop,
509571912c6SMartin Varghese 	.ndo_start_xmit         = bareudp_xmit,
510571912c6SMartin Varghese 	.ndo_get_stats64        = ip_tunnel_get_stats64,
511571912c6SMartin Varghese 	.ndo_fill_metadata_dst  = bareudp_fill_metadata_dst,
512571912c6SMartin Varghese };
513571912c6SMartin Varghese 
514571912c6SMartin Varghese static const struct nla_policy bareudp_policy[IFLA_BAREUDP_MAX + 1] = {
515571912c6SMartin Varghese 	[IFLA_BAREUDP_PORT]                = { .type = NLA_U16 },
516571912c6SMartin Varghese 	[IFLA_BAREUDP_ETHERTYPE]	   = { .type = NLA_U16 },
517571912c6SMartin Varghese 	[IFLA_BAREUDP_SRCPORT_MIN]         = { .type = NLA_U16 },
5184b5f6723SMartin Varghese 	[IFLA_BAREUDP_MULTIPROTO_MODE]     = { .type = NLA_FLAG },
519571912c6SMartin Varghese };
520571912c6SMartin Varghese 
521571912c6SMartin Varghese /* Info for udev, that this is a virtual tunnel endpoint */
522571912c6SMartin Varghese static struct device_type bareudp_type = {
523571912c6SMartin Varghese 	.name = "bareudp",
524571912c6SMartin Varghese };
525571912c6SMartin Varghese 
526571912c6SMartin Varghese /* Initialize the device structure. */
527571912c6SMartin Varghese static void bareudp_setup(struct net_device *dev)
528571912c6SMartin Varghese {
529571912c6SMartin Varghese 	dev->netdev_ops = &bareudp_netdev_ops;
530571912c6SMartin Varghese 	dev->needs_free_netdev = true;
531571912c6SMartin Varghese 	SET_NETDEV_DEVTYPE(dev, &bareudp_type);
532571912c6SMartin Varghese 	dev->features    |= NETIF_F_SG | NETIF_F_HW_CSUM;
533571912c6SMartin Varghese 	dev->features    |= NETIF_F_RXCSUM;
534571912c6SMartin Varghese 	dev->features    |= NETIF_F_GSO_SOFTWARE;
535571912c6SMartin Varghese 	dev->hw_features |= NETIF_F_SG | NETIF_F_HW_CSUM | NETIF_F_RXCSUM;
536571912c6SMartin Varghese 	dev->hw_features |= NETIF_F_GSO_SOFTWARE;
537571912c6SMartin Varghese 	dev->hard_header_len = 0;
538571912c6SMartin Varghese 	dev->addr_len = 0;
539571912c6SMartin Varghese 	dev->mtu = ETH_DATA_LEN;
540571912c6SMartin Varghese 	dev->min_mtu = IPV4_MIN_MTU;
541571912c6SMartin Varghese 	dev->max_mtu = IP_MAX_MTU - BAREUDP_BASE_HLEN;
542571912c6SMartin Varghese 	dev->type = ARPHRD_NONE;
543571912c6SMartin Varghese 	netif_keep_dst(dev);
544571912c6SMartin Varghese 	dev->priv_flags |= IFF_NO_QUEUE;
545571912c6SMartin Varghese 	dev->flags = IFF_POINTOPOINT | IFF_NOARP | IFF_MULTICAST;
546571912c6SMartin Varghese }
547571912c6SMartin Varghese 
548571912c6SMartin Varghese static int bareudp_validate(struct nlattr *tb[], struct nlattr *data[],
549571912c6SMartin Varghese 			    struct netlink_ext_ack *extack)
550571912c6SMartin Varghese {
551571912c6SMartin Varghese 	if (!data) {
552571912c6SMartin Varghese 		NL_SET_ERR_MSG(extack,
553571912c6SMartin Varghese 			       "Not enough attributes provided to perform the operation");
554571912c6SMartin Varghese 		return -EINVAL;
555571912c6SMartin Varghese 	}
556571912c6SMartin Varghese 	return 0;
557571912c6SMartin Varghese }
558571912c6SMartin Varghese 
559*c46a49a4STaehee Yoo static int bareudp2info(struct nlattr *data[], struct bareudp_conf *conf,
560*c46a49a4STaehee Yoo 			struct netlink_ext_ack *extack)
561571912c6SMartin Varghese {
562*c46a49a4STaehee Yoo 	if (!data[IFLA_BAREUDP_PORT]) {
563*c46a49a4STaehee Yoo 		NL_SET_ERR_MSG(extack, "port not specified");
564571912c6SMartin Varghese 		return -EINVAL;
565*c46a49a4STaehee Yoo 	}
566*c46a49a4STaehee Yoo 	if (!data[IFLA_BAREUDP_ETHERTYPE]) {
567*c46a49a4STaehee Yoo 		NL_SET_ERR_MSG(extack, "ethertype not specified");
568*c46a49a4STaehee Yoo 		return -EINVAL;
569*c46a49a4STaehee Yoo 	}
570571912c6SMartin Varghese 
571571912c6SMartin Varghese 	if (data[IFLA_BAREUDP_PORT])
572571912c6SMartin Varghese 		conf->port =  nla_get_u16(data[IFLA_BAREUDP_PORT]);
573571912c6SMartin Varghese 
574571912c6SMartin Varghese 	if (data[IFLA_BAREUDP_ETHERTYPE])
575571912c6SMartin Varghese 		conf->ethertype =  nla_get_u16(data[IFLA_BAREUDP_ETHERTYPE]);
576571912c6SMartin Varghese 
577571912c6SMartin Varghese 	if (data[IFLA_BAREUDP_SRCPORT_MIN])
578571912c6SMartin Varghese 		conf->sport_min =  nla_get_u16(data[IFLA_BAREUDP_SRCPORT_MIN]);
579571912c6SMartin Varghese 
580571912c6SMartin Varghese 	return 0;
581571912c6SMartin Varghese }
582571912c6SMartin Varghese 
583571912c6SMartin Varghese static struct bareudp_dev *bareudp_find_dev(struct bareudp_net *bn,
584571912c6SMartin Varghese 					    const struct bareudp_conf *conf)
585571912c6SMartin Varghese {
586571912c6SMartin Varghese 	struct bareudp_dev *bareudp, *t = NULL;
587571912c6SMartin Varghese 
588571912c6SMartin Varghese 	list_for_each_entry(bareudp, &bn->bareudp_list, next) {
589571912c6SMartin Varghese 		if (conf->port == bareudp->port)
590571912c6SMartin Varghese 			t = bareudp;
591571912c6SMartin Varghese 	}
592571912c6SMartin Varghese 	return t;
593571912c6SMartin Varghese }
594571912c6SMartin Varghese 
595571912c6SMartin Varghese static int bareudp_configure(struct net *net, struct net_device *dev,
596571912c6SMartin Varghese 			     struct bareudp_conf *conf)
597571912c6SMartin Varghese {
598571912c6SMartin Varghese 	struct bareudp_net *bn = net_generic(net, bareudp_net_id);
599571912c6SMartin Varghese 	struct bareudp_dev *t, *bareudp = netdev_priv(dev);
600571912c6SMartin Varghese 	int err;
601571912c6SMartin Varghese 
602571912c6SMartin Varghese 	bareudp->net = net;
603571912c6SMartin Varghese 	bareudp->dev = dev;
604571912c6SMartin Varghese 	t = bareudp_find_dev(bn, conf);
605571912c6SMartin Varghese 	if (t)
606571912c6SMartin Varghese 		return -EBUSY;
607571912c6SMartin Varghese 
6084b5f6723SMartin Varghese 	if (conf->multi_proto_mode &&
6094b5f6723SMartin Varghese 	    (conf->ethertype != htons(ETH_P_MPLS_UC) &&
6104b5f6723SMartin Varghese 	     conf->ethertype != htons(ETH_P_IP)))
6114b5f6723SMartin Varghese 		return -EINVAL;
6124b5f6723SMartin Varghese 
613571912c6SMartin Varghese 	bareudp->port = conf->port;
614571912c6SMartin Varghese 	bareudp->ethertype = conf->ethertype;
615571912c6SMartin Varghese 	bareudp->sport_min = conf->sport_min;
6164b5f6723SMartin Varghese 	bareudp->multi_proto_mode = conf->multi_proto_mode;
617571912c6SMartin Varghese 	err = register_netdevice(dev);
618571912c6SMartin Varghese 	if (err)
619571912c6SMartin Varghese 		return err;
620571912c6SMartin Varghese 
621571912c6SMartin Varghese 	list_add(&bareudp->next, &bn->bareudp_list);
622571912c6SMartin Varghese 	return 0;
623571912c6SMartin Varghese }
624571912c6SMartin Varghese 
625571912c6SMartin Varghese static int bareudp_link_config(struct net_device *dev,
626571912c6SMartin Varghese 			       struct nlattr *tb[])
627571912c6SMartin Varghese {
628571912c6SMartin Varghese 	int err;
629571912c6SMartin Varghese 
630571912c6SMartin Varghese 	if (tb[IFLA_MTU]) {
631571912c6SMartin Varghese 		err = dev_set_mtu(dev, nla_get_u32(tb[IFLA_MTU]));
632571912c6SMartin Varghese 		if (err)
633571912c6SMartin Varghese 			return err;
634571912c6SMartin Varghese 	}
635571912c6SMartin Varghese 	return 0;
636571912c6SMartin Varghese }
637571912c6SMartin Varghese 
638571912c6SMartin Varghese static int bareudp_newlink(struct net *net, struct net_device *dev,
639571912c6SMartin Varghese 			   struct nlattr *tb[], struct nlattr *data[],
640571912c6SMartin Varghese 			   struct netlink_ext_ack *extack)
641571912c6SMartin Varghese {
642571912c6SMartin Varghese 	struct bareudp_conf conf;
643571912c6SMartin Varghese 	int err;
644571912c6SMartin Varghese 
645*c46a49a4STaehee Yoo 	err = bareudp2info(data, &conf, extack);
646571912c6SMartin Varghese 	if (err)
647571912c6SMartin Varghese 		return err;
648571912c6SMartin Varghese 
649571912c6SMartin Varghese 	err = bareudp_configure(net, dev, &conf);
650571912c6SMartin Varghese 	if (err)
651571912c6SMartin Varghese 		return err;
652571912c6SMartin Varghese 
653571912c6SMartin Varghese 	err = bareudp_link_config(dev, tb);
654571912c6SMartin Varghese 	if (err)
655571912c6SMartin Varghese 		return err;
656571912c6SMartin Varghese 
657571912c6SMartin Varghese 	return 0;
658571912c6SMartin Varghese }
659571912c6SMartin Varghese 
660571912c6SMartin Varghese static void bareudp_dellink(struct net_device *dev, struct list_head *head)
661571912c6SMartin Varghese {
662571912c6SMartin Varghese 	struct bareudp_dev *bareudp = netdev_priv(dev);
663571912c6SMartin Varghese 
664571912c6SMartin Varghese 	list_del(&bareudp->next);
665571912c6SMartin Varghese 	unregister_netdevice_queue(dev, head);
666571912c6SMartin Varghese }
667571912c6SMartin Varghese 
668571912c6SMartin Varghese static size_t bareudp_get_size(const struct net_device *dev)
669571912c6SMartin Varghese {
670571912c6SMartin Varghese 	return  nla_total_size(sizeof(__be16)) +  /* IFLA_BAREUDP_PORT */
671571912c6SMartin Varghese 		nla_total_size(sizeof(__be16)) +  /* IFLA_BAREUDP_ETHERTYPE */
672571912c6SMartin Varghese 		nla_total_size(sizeof(__u16))  +  /* IFLA_BAREUDP_SRCPORT_MIN */
6734b5f6723SMartin Varghese 		nla_total_size(0)              +  /* IFLA_BAREUDP_MULTIPROTO_MODE */
674571912c6SMartin Varghese 		0;
675571912c6SMartin Varghese }
676571912c6SMartin Varghese 
677571912c6SMartin Varghese static int bareudp_fill_info(struct sk_buff *skb, const struct net_device *dev)
678571912c6SMartin Varghese {
679571912c6SMartin Varghese 	struct bareudp_dev *bareudp = netdev_priv(dev);
680571912c6SMartin Varghese 
681571912c6SMartin Varghese 	if (nla_put_be16(skb, IFLA_BAREUDP_PORT, bareudp->port))
682571912c6SMartin Varghese 		goto nla_put_failure;
683571912c6SMartin Varghese 	if (nla_put_be16(skb, IFLA_BAREUDP_ETHERTYPE, bareudp->ethertype))
684571912c6SMartin Varghese 		goto nla_put_failure;
685571912c6SMartin Varghese 	if (nla_put_u16(skb, IFLA_BAREUDP_SRCPORT_MIN, bareudp->sport_min))
686571912c6SMartin Varghese 		goto nla_put_failure;
6874b5f6723SMartin Varghese 	if (bareudp->multi_proto_mode &&
6884b5f6723SMartin Varghese 	    nla_put_flag(skb, IFLA_BAREUDP_MULTIPROTO_MODE))
6894b5f6723SMartin Varghese 		goto nla_put_failure;
690571912c6SMartin Varghese 
691571912c6SMartin Varghese 	return 0;
692571912c6SMartin Varghese 
693571912c6SMartin Varghese nla_put_failure:
694571912c6SMartin Varghese 	return -EMSGSIZE;
695571912c6SMartin Varghese }
696571912c6SMartin Varghese 
697571912c6SMartin Varghese static struct rtnl_link_ops bareudp_link_ops __read_mostly = {
698571912c6SMartin Varghese 	.kind           = "bareudp",
699571912c6SMartin Varghese 	.maxtype        = IFLA_BAREUDP_MAX,
700571912c6SMartin Varghese 	.policy         = bareudp_policy,
701571912c6SMartin Varghese 	.priv_size      = sizeof(struct bareudp_dev),
702571912c6SMartin Varghese 	.setup          = bareudp_setup,
703571912c6SMartin Varghese 	.validate       = bareudp_validate,
704571912c6SMartin Varghese 	.newlink        = bareudp_newlink,
705571912c6SMartin Varghese 	.dellink        = bareudp_dellink,
706571912c6SMartin Varghese 	.get_size       = bareudp_get_size,
707571912c6SMartin Varghese 	.fill_info      = bareudp_fill_info,
708571912c6SMartin Varghese };
709571912c6SMartin Varghese 
710571912c6SMartin Varghese struct net_device *bareudp_dev_create(struct net *net, const char *name,
711571912c6SMartin Varghese 				      u8 name_assign_type,
712571912c6SMartin Varghese 				      struct bareudp_conf *conf)
713571912c6SMartin Varghese {
714571912c6SMartin Varghese 	struct nlattr *tb[IFLA_MAX + 1];
715571912c6SMartin Varghese 	struct net_device *dev;
716571912c6SMartin Varghese 	LIST_HEAD(list_kill);
717571912c6SMartin Varghese 	int err;
718571912c6SMartin Varghese 
719571912c6SMartin Varghese 	memset(tb, 0, sizeof(tb));
720571912c6SMartin Varghese 	dev = rtnl_create_link(net, name, name_assign_type,
721571912c6SMartin Varghese 			       &bareudp_link_ops, tb, NULL);
722571912c6SMartin Varghese 	if (IS_ERR(dev))
723571912c6SMartin Varghese 		return dev;
724571912c6SMartin Varghese 
725571912c6SMartin Varghese 	err = bareudp_configure(net, dev, conf);
726571912c6SMartin Varghese 	if (err) {
727571912c6SMartin Varghese 		free_netdev(dev);
728571912c6SMartin Varghese 		return ERR_PTR(err);
729571912c6SMartin Varghese 	}
730571912c6SMartin Varghese 	err = dev_set_mtu(dev, IP_MAX_MTU - BAREUDP_BASE_HLEN);
731571912c6SMartin Varghese 	if (err)
732571912c6SMartin Varghese 		goto err;
733571912c6SMartin Varghese 
734571912c6SMartin Varghese 	err = rtnl_configure_link(dev, NULL);
735571912c6SMartin Varghese 	if (err < 0)
736571912c6SMartin Varghese 		goto err;
737571912c6SMartin Varghese 
738571912c6SMartin Varghese 	return dev;
739571912c6SMartin Varghese err:
740571912c6SMartin Varghese 	bareudp_dellink(dev, &list_kill);
741571912c6SMartin Varghese 	unregister_netdevice_many(&list_kill);
742571912c6SMartin Varghese 	return ERR_PTR(err);
743571912c6SMartin Varghese }
744571912c6SMartin Varghese EXPORT_SYMBOL_GPL(bareudp_dev_create);
745571912c6SMartin Varghese 
746571912c6SMartin Varghese static __net_init int bareudp_init_net(struct net *net)
747571912c6SMartin Varghese {
748571912c6SMartin Varghese 	struct bareudp_net *bn = net_generic(net, bareudp_net_id);
749571912c6SMartin Varghese 
750571912c6SMartin Varghese 	INIT_LIST_HEAD(&bn->bareudp_list);
751571912c6SMartin Varghese 	return 0;
752571912c6SMartin Varghese }
753571912c6SMartin Varghese 
754571912c6SMartin Varghese static void bareudp_destroy_tunnels(struct net *net, struct list_head *head)
755571912c6SMartin Varghese {
756571912c6SMartin Varghese 	struct bareudp_net *bn = net_generic(net, bareudp_net_id);
757571912c6SMartin Varghese 	struct bareudp_dev *bareudp, *next;
758571912c6SMartin Varghese 
759571912c6SMartin Varghese 	list_for_each_entry_safe(bareudp, next, &bn->bareudp_list, next)
760571912c6SMartin Varghese 		unregister_netdevice_queue(bareudp->dev, head);
761571912c6SMartin Varghese }
762571912c6SMartin Varghese 
763571912c6SMartin Varghese static void __net_exit bareudp_exit_batch_net(struct list_head *net_list)
764571912c6SMartin Varghese {
765571912c6SMartin Varghese 	struct net *net;
766571912c6SMartin Varghese 	LIST_HEAD(list);
767571912c6SMartin Varghese 
768571912c6SMartin Varghese 	rtnl_lock();
769571912c6SMartin Varghese 	list_for_each_entry(net, net_list, exit_list)
770571912c6SMartin Varghese 		bareudp_destroy_tunnels(net, &list);
771571912c6SMartin Varghese 
772571912c6SMartin Varghese 	/* unregister the devices gathered above */
773571912c6SMartin Varghese 	unregister_netdevice_many(&list);
774571912c6SMartin Varghese 	rtnl_unlock();
775571912c6SMartin Varghese }
776571912c6SMartin Varghese 
777571912c6SMartin Varghese static struct pernet_operations bareudp_net_ops = {
778571912c6SMartin Varghese 	.init = bareudp_init_net,
779571912c6SMartin Varghese 	.exit_batch = bareudp_exit_batch_net,
780571912c6SMartin Varghese 	.id   = &bareudp_net_id,
781571912c6SMartin Varghese 	.size = sizeof(struct bareudp_net),
782571912c6SMartin Varghese };
783571912c6SMartin Varghese 
784571912c6SMartin Varghese static int __init bareudp_init_module(void)
785571912c6SMartin Varghese {
786571912c6SMartin Varghese 	int rc;
787571912c6SMartin Varghese 
788571912c6SMartin Varghese 	rc = register_pernet_subsys(&bareudp_net_ops);
789571912c6SMartin Varghese 	if (rc)
790571912c6SMartin Varghese 		goto out1;
791571912c6SMartin Varghese 
792571912c6SMartin Varghese 	rc = rtnl_link_register(&bareudp_link_ops);
793571912c6SMartin Varghese 	if (rc)
794571912c6SMartin Varghese 		goto out2;
795571912c6SMartin Varghese 
796571912c6SMartin Varghese 	return 0;
797571912c6SMartin Varghese out2:
798571912c6SMartin Varghese 	unregister_pernet_subsys(&bareudp_net_ops);
799571912c6SMartin Varghese out1:
800571912c6SMartin Varghese 	return rc;
801571912c6SMartin Varghese }
802571912c6SMartin Varghese late_initcall(bareudp_init_module);
803571912c6SMartin Varghese 
804571912c6SMartin Varghese static void __exit bareudp_cleanup_module(void)
805571912c6SMartin Varghese {
806571912c6SMartin Varghese 	rtnl_link_unregister(&bareudp_link_ops);
807571912c6SMartin Varghese 	unregister_pernet_subsys(&bareudp_net_ops);
808571912c6SMartin Varghese }
809571912c6SMartin Varghese module_exit(bareudp_cleanup_module);
810571912c6SMartin Varghese 
811eea45da4STaehee Yoo MODULE_ALIAS_RTNL_LINK("bareudp");
812571912c6SMartin Varghese MODULE_LICENSE("GPL");
813571912c6SMartin Varghese MODULE_AUTHOR("Martin Varghese <martin.varghese@nokia.com>");
814571912c6SMartin Varghese MODULE_DESCRIPTION("Interface driver for UDP encapsulated traffic");
815