geneve.c 38.0 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
/*
 * GENEVE: Generic Network Virtualization Encapsulation
 *
 * Copyright (c) 2015 Red Hat, Inc.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/etherdevice.h>
#include <linux/hash.h>
17
#include <net/dst_metadata.h>
18
#include <net/gro_cells.h>
19 20
#include <net/rtnetlink.h>
#include <net/geneve.h>
21
#include <net/protocol.h>
22 23 24 25 26 27 28 29 30 31 32 33 34 35 36

#define GENEVE_NETDEV_VER	"0.6"

#define GENEVE_UDP_PORT		6081

#define GENEVE_N_VID		(1u << 24)
#define GENEVE_VID_MASK		(GENEVE_N_VID - 1)

#define VNI_HASH_BITS		10
#define VNI_HASH_SIZE		(1<<VNI_HASH_BITS)

static bool log_ecn_error = true;
module_param(log_ecn_error, bool, 0644);
MODULE_PARM_DESC(log_ecn_error, "Log packets received with corrupted ECN");

37 38 39
#define GENEVE_VER 0
#define GENEVE_BASE_HLEN (sizeof(struct udphdr) + sizeof(struct genevehdr))

40 41
/* per-network namespace private data for this module */
struct geneve_net {
42 43
	struct list_head	geneve_list;
	struct list_head	sock_list;
44 45
};

46
static unsigned int geneve_net_id;
47

J
Jiri Benc 已提交
48 49 50 51 52
struct geneve_dev_node {
	struct hlist_node hlist;
	struct geneve_dev *geneve;
};

53 54
/* Pseudo network device */
struct geneve_dev {
J
Jiri Benc 已提交
55 56 57 58
	struct geneve_dev_node hlist4;	/* vni hash table for IPv4 socket */
#if IS_ENABLED(CONFIG_IPV6)
	struct geneve_dev_node hlist6;	/* vni hash table for IPv6 socket */
#endif
59 60
	struct net	   *net;	/* netns for packet i/o */
	struct net_device  *dev;	/* netdev for geneve tunnel */
61
	struct ip_tunnel_info info;
62
	struct geneve_sock __rcu *sock4;	/* IPv4 socket used for geneve tunnel */
63
#if IS_ENABLED(CONFIG_IPV6)
64
	struct geneve_sock __rcu *sock6;	/* IPv6 socket used for geneve tunnel */
65
#endif
66
	struct list_head   next;	/* geneve's per namespace list */
67
	struct gro_cells   gro_cells;
68 69
	bool		   collect_md;
	bool		   use_udp6_rx_checksums;
70 71
};

72 73 74 75 76 77
struct geneve_sock {
	bool			collect_md;
	struct list_head	list;
	struct socket		*sock;
	struct rcu_head		rcu;
	int			refcnt;
78
	struct hlist_head	vni_list[VNI_HASH_SIZE];
79
};
80 81 82 83 84 85 86 87 88

static inline __u32 geneve_net_vni_hash(u8 vni[3])
{
	__u32 vnid;

	vnid = (vni[0] << 16) | (vni[1] << 8) | vni[2];
	return hash_32(vnid, VNI_HASH_BITS);
}

89 90 91 92 93 94 95 96 97 98 99
static __be64 vni_to_tunnel_id(const __u8 *vni)
{
#ifdef __BIG_ENDIAN
	return (vni[0] << 16) | (vni[1] << 8) | vni[2];
#else
	return (__force __be64)(((__force u64)vni[0] << 40) |
				((__force u64)vni[1] << 48) |
				((__force u64)vni[2] << 56));
#endif
}

100 101 102 103 104 105 106 107 108 109 110 111 112 113
/* Convert 64 bit tunnel ID to 24 bit VNI. */
static void tunnel_id_to_vni(__be64 tun_id, __u8 *vni)
{
#ifdef __BIG_ENDIAN
	vni[0] = (__force __u8)(tun_id >> 16);
	vni[1] = (__force __u8)(tun_id >> 8);
	vni[2] = (__force __u8)tun_id;
#else
	vni[0] = (__force __u8)((__force u64)tun_id >> 40);
	vni[1] = (__force __u8)((__force u64)tun_id >> 48);
	vni[2] = (__force __u8)((__force u64)tun_id >> 56);
#endif
}

114 115 116 117 118 119 120 121 122 123 124
static bool eq_tun_id_and_vni(u8 *tun_id, u8 *vni)
{
#ifdef __BIG_ENDIAN
	return (vni[0] == tun_id[2]) &&
	       (vni[1] == tun_id[1]) &&
	       (vni[2] == tun_id[0]);
#else
	return !memcmp(vni, &tun_id[5], 3);
#endif
}

125 126 127 128 129
static sa_family_t geneve_get_sk_family(struct geneve_sock *gs)
{
	return gs->sock->sk->sk_family;
}

130
static struct geneve_dev *geneve_lookup(struct geneve_sock *gs,
131
					__be32 addr, u8 vni[])
132 133
{
	struct hlist_head *vni_list_head;
J
Jiri Benc 已提交
134
	struct geneve_dev_node *node;
135 136 137
	__u32 hash;

	/* Find the device for this VNI */
138
	hash = geneve_net_vni_hash(vni);
139
	vni_list_head = &gs->vni_list[hash];
J
Jiri Benc 已提交
140 141 142 143
	hlist_for_each_entry_rcu(node, vni_list_head, hlist) {
		if (eq_tun_id_and_vni((u8 *)&node->geneve->info.key.tun_id, vni) &&
		    addr == node->geneve->info.key.u.ipv4.dst)
			return node->geneve;
144 145 146 147 148 149 150 151 152
	}
	return NULL;
}

#if IS_ENABLED(CONFIG_IPV6)
static struct geneve_dev *geneve6_lookup(struct geneve_sock *gs,
					 struct in6_addr addr6, u8 vni[])
{
	struct hlist_head *vni_list_head;
J
Jiri Benc 已提交
153
	struct geneve_dev_node *node;
154 155 156 157 158
	__u32 hash;

	/* Find the device for this VNI */
	hash = geneve_net_vni_hash(vni);
	vni_list_head = &gs->vni_list[hash];
J
Jiri Benc 已提交
159 160 161 162
	hlist_for_each_entry_rcu(node, vni_list_head, hlist) {
		if (eq_tun_id_and_vni((u8 *)&node->geneve->info.key.tun_id, vni) &&
		    ipv6_addr_equal(&addr6, &node->geneve->info.key.u.ipv6.dst))
			return node->geneve;
163
	}
164 165
	return NULL;
}
166
#endif
167

168 169 170 171 172
static inline struct genevehdr *geneve_hdr(const struct sk_buff *skb)
{
	return (struct genevehdr *)(udp_hdr(skb) + 1);
}

173 174
static struct geneve_dev *geneve_lookup_skb(struct geneve_sock *gs,
					    struct sk_buff *skb)
175
{
176
	static u8 zero_vni[3];
177
	u8 *vni;
178

179
	if (geneve_get_sk_family(gs) == AF_INET) {
180
		struct iphdr *iph;
181
		__be32 addr;
182

183
		iph = ip_hdr(skb); /* outer IP header... */
184

185 186 187 188
		if (gs->collect_md) {
			vni = zero_vni;
			addr = 0;
		} else {
189
			vni = geneve_hdr(skb)->vni;
190 191 192
			addr = iph->saddr;
		}

193
		return geneve_lookup(gs, addr, vni);
194
#if IS_ENABLED(CONFIG_IPV6)
195
	} else if (geneve_get_sk_family(gs) == AF_INET6) {
196
		static struct in6_addr zero_addr6;
197 198 199
		struct ipv6hdr *ip6h;
		struct in6_addr addr6;

200
		ip6h = ipv6_hdr(skb); /* outer IPv6 header... */
201

202 203 204 205
		if (gs->collect_md) {
			vni = zero_vni;
			addr6 = zero_addr6;
		} else {
206
			vni = geneve_hdr(skb)->vni;
207 208 209
			addr6 = ip6h->saddr;
		}

210
		return geneve6_lookup(gs, addr6, vni);
211 212
#endif
	}
213 214 215 216 217 218 219 220 221 222
	return NULL;
}

/* geneve receive/decap routine */
static void geneve_rx(struct geneve_dev *geneve, struct geneve_sock *gs,
		      struct sk_buff *skb)
{
	struct genevehdr *gnvh = geneve_hdr(skb);
	struct metadata_dst *tun_dst = NULL;
	struct pcpu_sw_netstats *stats;
223
	unsigned int len;
224 225
	int err = 0;
	void *oiph;
226

227
	if (ip_tunnel_collect_metadata() || gs->collect_md) {
228 229 230 231 232 233
		__be16 flags;

		flags = TUNNEL_KEY | TUNNEL_GENEVE_OPT |
			(gnvh->oam ? TUNNEL_OAM : 0) |
			(gnvh->critical ? TUNNEL_CRIT_OPT : 0);

234
		tun_dst = udp_tun_rx_dst(skb, geneve_get_sk_family(gs), flags,
235 236
					 vni_to_tunnel_id(gnvh->vni),
					 gnvh->opt_len * 4);
237 238
		if (!tun_dst) {
			geneve->dev->stats.rx_dropped++;
239
			goto drop;
240
		}
241
		/* Update tunnel dst according to Geneve options. */
242 243
		ip_tunnel_info_opts_set(&tun_dst->u.tun_info,
					gnvh->options, gnvh->opt_len * 4);
244 245 246 247
	} else {
		/* Drop packets w/ critical options,
		 * since we don't support any...
		 */
248 249 250
		if (gnvh->critical) {
			geneve->dev->stats.rx_frame_errors++;
			geneve->dev->stats.rx_errors++;
251
			goto drop;
252
		}
253
	}
254 255 256 257 258

	skb_reset_mac_header(skb);
	skb->protocol = eth_type_trans(skb, geneve->dev);
	skb_postpull_rcsum(skb, eth_hdr(skb), ETH_HLEN);

259 260 261
	if (tun_dst)
		skb_dst_set(skb, &tun_dst->dst);

262
	/* Ignore packet loops (and multicast echo) */
263 264
	if (ether_addr_equal(eth_hdr(skb)->h_source, geneve->dev->dev_addr)) {
		geneve->dev->stats.rx_errors++;
265
		goto drop;
266
	}
267

268
	oiph = skb_network_header(skb);
269 270
	skb_reset_network_header(skb);

271 272
	if (geneve_get_sk_family(gs) == AF_INET)
		err = IP_ECN_decapsulate(oiph, skb);
273
#if IS_ENABLED(CONFIG_IPV6)
274 275
	else
		err = IP6_ECN_decapsulate(oiph, skb);
276
#endif
277 278

	if (unlikely(err)) {
279
		if (log_ecn_error) {
280
			if (geneve_get_sk_family(gs) == AF_INET)
281 282
				net_info_ratelimited("non-ECT from %pI4 "
						     "with TOS=%#x\n",
283 284
						     &((struct iphdr *)oiph)->saddr,
						     ((struct iphdr *)oiph)->tos);
285
#if IS_ENABLED(CONFIG_IPV6)
286
			else
287
				net_info_ratelimited("non-ECT from %pI6\n",
288
						     &((struct ipv6hdr *)oiph)->saddr);
289 290
#endif
		}
291 292 293 294 295 296 297
		if (err > 1) {
			++geneve->dev->stats.rx_frame_errors;
			++geneve->dev->stats.rx_errors;
			goto drop;
		}
	}

298 299 300 301 302 303 304 305 306
	len = skb->len;
	err = gro_cells_receive(&geneve->gro_cells, skb);
	if (likely(err == NET_RX_SUCCESS)) {
		stats = this_cpu_ptr(geneve->dev->tstats);
		u64_stats_update_begin(&stats->syncp);
		stats->rx_packets++;
		stats->rx_bytes += len;
		u64_stats_update_end(&stats->syncp);
	}
307 308 309 310 311 312 313 314 315
	return;
drop:
	/* Consume bad packet */
	kfree_skb(skb);
}

/* Setup stats when device is created */
static int geneve_init(struct net_device *dev)
{
316 317 318
	struct geneve_dev *geneve = netdev_priv(dev);
	int err;

319 320 321
	dev->tstats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
	if (!dev->tstats)
		return -ENOMEM;
322 323 324 325 326 327 328

	err = gro_cells_init(&geneve->gro_cells, dev);
	if (err) {
		free_percpu(dev->tstats);
		return err;
	}

329
	err = dst_cache_init(&geneve->info.dst_cache, GFP_KERNEL);
P
Paolo Abeni 已提交
330 331 332 333 334
	if (err) {
		free_percpu(dev->tstats);
		gro_cells_destroy(&geneve->gro_cells);
		return err;
	}
335 336 337 338 339
	return 0;
}

static void geneve_uninit(struct net_device *dev)
{
340 341
	struct geneve_dev *geneve = netdev_priv(dev);

342
	dst_cache_destroy(&geneve->info.dst_cache);
343
	gro_cells_destroy(&geneve->gro_cells);
344 345 346
	free_percpu(dev->tstats);
}

347 348 349 350
/* Callback from net/ipv4/udp.c to receive packets */
static int geneve_udp_encap_recv(struct sock *sk, struct sk_buff *skb)
{
	struct genevehdr *geneveh;
351
	struct geneve_dev *geneve;
352 353 354
	struct geneve_sock *gs;
	int opts_len;

355
	/* Need UDP and Geneve header to be present */
356
	if (unlikely(!pskb_may_pull(skb, GENEVE_BASE_HLEN)))
357
		goto drop;
358 359 360 361

	/* Return packets with reserved bits set */
	geneveh = geneve_hdr(skb);
	if (unlikely(geneveh->ver != GENEVE_VER))
362
		goto drop;
363 364

	if (unlikely(geneveh->proto_type != htons(ETH_P_TEB)))
365
		goto drop;
366

367 368 369 370 371 372 373 374
	gs = rcu_dereference_sk_user_data(sk);
	if (!gs)
		goto drop;

	geneve = geneve_lookup_skb(gs, skb);
	if (!geneve)
		goto drop;

375 376
	opts_len = geneveh->opt_len * 4;
	if (iptunnel_pull_header(skb, GENEVE_BASE_HLEN + opts_len,
377
				 htons(ETH_P_TEB),
378 379
				 !net_eq(geneve->net, dev_net(geneve->dev)))) {
		geneve->dev->stats.rx_dropped++;
380
		goto drop;
381
	}
382

383
	geneve_rx(geneve, gs, skb);
384 385 386 387 388 389 390 391 392
	return 0;

drop:
	/* Consume bad packet */
	kfree_skb(skb);
	return 0;
}

static struct socket *geneve_create_sock(struct net *net, bool ipv6,
393
					 __be16 port, bool ipv6_rx_csum)
394 395 396 397 398 399 400 401 402
{
	struct socket *sock;
	struct udp_port_cfg udp_conf;
	int err;

	memset(&udp_conf, 0, sizeof(udp_conf));

	if (ipv6) {
		udp_conf.family = AF_INET6;
403
		udp_conf.ipv6_v6only = 1;
404
		udp_conf.use_udp6_rx_checksums = ipv6_rx_csum;
405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424
	} else {
		udp_conf.family = AF_INET;
		udp_conf.local_ip.s_addr = htonl(INADDR_ANY);
	}

	udp_conf.local_udp_port = port;

	/* Open UDP socket */
	err = udp_sock_create(net, &udp_conf, &sock);
	if (err < 0)
		return ERR_PTR(err);

	return sock;
}

static int geneve_hlen(struct genevehdr *gh)
{
	return sizeof(*gh) + gh->opt_len * 4;
}

425 426 427
static struct sk_buff **geneve_gro_receive(struct sock *sk,
					   struct sk_buff **head,
					   struct sk_buff *skb)
428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471
{
	struct sk_buff *p, **pp = NULL;
	struct genevehdr *gh, *gh2;
	unsigned int hlen, gh_len, off_gnv;
	const struct packet_offload *ptype;
	__be16 type;
	int flush = 1;

	off_gnv = skb_gro_offset(skb);
	hlen = off_gnv + sizeof(*gh);
	gh = skb_gro_header_fast(skb, off_gnv);
	if (skb_gro_header_hard(skb, hlen)) {
		gh = skb_gro_header_slow(skb, hlen, off_gnv);
		if (unlikely(!gh))
			goto out;
	}

	if (gh->ver != GENEVE_VER || gh->oam)
		goto out;
	gh_len = geneve_hlen(gh);

	hlen = off_gnv + gh_len;
	if (skb_gro_header_hard(skb, hlen)) {
		gh = skb_gro_header_slow(skb, hlen, off_gnv);
		if (unlikely(!gh))
			goto out;
	}

	for (p = *head; p; p = p->next) {
		if (!NAPI_GRO_CB(p)->same_flow)
			continue;

		gh2 = (struct genevehdr *)(p->data + off_gnv);
		if (gh->opt_len != gh2->opt_len ||
		    memcmp(gh, gh2, gh_len)) {
			NAPI_GRO_CB(p)->same_flow = 0;
			continue;
		}
	}

	type = gh->proto_type;

	rcu_read_lock();
	ptype = gro_find_receive_by_type(type);
472
	if (!ptype)
473 474 475 476
		goto out_unlock;

	skb_gro_pull(skb, gh_len);
	skb_gro_postpull_rcsum(skb, gh, gh_len);
S
Sabrina Dubroca 已提交
477
	pp = call_gro_receive(ptype->callbacks.gro_receive, head, skb);
478
	flush = 0;
479 480 481 482 483 484 485 486 487

out_unlock:
	rcu_read_unlock();
out:
	NAPI_GRO_CB(skb)->flush |= flush;

	return pp;
}

488 489
static int geneve_gro_complete(struct sock *sk, struct sk_buff *skb,
			       int nhoff)
490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506
{
	struct genevehdr *gh;
	struct packet_offload *ptype;
	__be16 type;
	int gh_len;
	int err = -ENOSYS;

	gh = (struct genevehdr *)(skb->data + nhoff);
	gh_len = geneve_hlen(gh);
	type = gh->proto_type;

	rcu_read_lock();
	ptype = gro_find_complete_by_type(type);
	if (ptype)
		err = ptype->callbacks.gro_complete(skb, nhoff + gh_len);

	rcu_read_unlock();
507 508 509

	skb_set_inner_mac_header(skb, nhoff + gh_len);

510 511 512 513 514
	return err;
}

/* Create new listen socket if needed */
static struct geneve_sock *geneve_socket_create(struct net *net, __be16 port,
515
						bool ipv6, bool ipv6_rx_csum)
516 517 518 519 520
{
	struct geneve_net *gn = net_generic(net, geneve_net_id);
	struct geneve_sock *gs;
	struct socket *sock;
	struct udp_tunnel_sock_cfg tunnel_cfg;
521
	int h;
522 523 524 525 526

	gs = kzalloc(sizeof(*gs), GFP_KERNEL);
	if (!gs)
		return ERR_PTR(-ENOMEM);

527
	sock = geneve_create_sock(net, ipv6, port, ipv6_rx_csum);
528 529 530 531 532 533 534
	if (IS_ERR(sock)) {
		kfree(gs);
		return ERR_CAST(sock);
	}

	gs->sock = sock;
	gs->refcnt = 1;
535 536
	for (h = 0; h < VNI_HASH_SIZE; ++h)
		INIT_HLIST_HEAD(&gs->vni_list[h]);
537 538

	/* Initialize the geneve udp offloads structure */
539
	udp_tunnel_notify_add_rx_port(gs->sock, UDP_TUNNEL_TYPE_GENEVE);
540 541

	/* Mark socket as an encapsulation socket */
542
	memset(&tunnel_cfg, 0, sizeof(tunnel_cfg));
543 544
	tunnel_cfg.sk_user_data = gs;
	tunnel_cfg.encap_type = 1;
545 546
	tunnel_cfg.gro_receive = geneve_gro_receive;
	tunnel_cfg.gro_complete = geneve_gro_complete;
547 548 549 550 551 552 553
	tunnel_cfg.encap_rcv = geneve_udp_encap_recv;
	tunnel_cfg.encap_destroy = NULL;
	setup_udp_tunnel_sock(net, sock, &tunnel_cfg);
	list_add(&gs->list, &gn->sock_list);
	return gs;
}

554
static void __geneve_sock_release(struct geneve_sock *gs)
555
{
556
	if (!gs || --gs->refcnt)
557 558 559
		return;

	list_del(&gs->list);
560
	udp_tunnel_notify_del_rx_port(gs->sock, UDP_TUNNEL_TYPE_GENEVE);
561 562 563 564
	udp_tunnel_sock_release(gs->sock);
	kfree_rcu(gs, rcu);
}

565 566
static void geneve_sock_release(struct geneve_dev *geneve)
{
567
	struct geneve_sock *gs4 = rtnl_dereference(geneve->sock4);
568
#if IS_ENABLED(CONFIG_IPV6)
569 570 571 572 573 574 575 576 577 578 579
	struct geneve_sock *gs6 = rtnl_dereference(geneve->sock6);

	rcu_assign_pointer(geneve->sock6, NULL);
#endif

	rcu_assign_pointer(geneve->sock4, NULL);
	synchronize_net();

	__geneve_sock_release(gs4);
#if IS_ENABLED(CONFIG_IPV6)
	__geneve_sock_release(gs6);
580 581 582
#endif
}

583
static struct geneve_sock *geneve_find_sock(struct geneve_net *gn,
584
					    sa_family_t family,
585 586 587 588 589 590
					    __be16 dst_port)
{
	struct geneve_sock *gs;

	list_for_each_entry(gs, &gn->sock_list, list) {
		if (inet_sk(gs->sock->sk)->inet_sport == dst_port &&
591
		    geneve_get_sk_family(gs) == family) {
592 593 594 595 596 597
			return gs;
		}
	}
	return NULL;
}

598
static int geneve_sock_add(struct geneve_dev *geneve, bool ipv6)
599 600
{
	struct net *net = geneve->net;
601
	struct geneve_net *gn = net_generic(net, geneve_net_id);
J
Jiri Benc 已提交
602
	struct geneve_dev_node *node;
603
	struct geneve_sock *gs;
604
	__u8 vni[3];
605
	__u32 hash;
606

607
	gs = geneve_find_sock(gn, ipv6 ? AF_INET6 : AF_INET, geneve->info.key.tp_dst);
608 609 610 611 612
	if (gs) {
		gs->refcnt++;
		goto out;
	}

613 614
	gs = geneve_socket_create(net, geneve->info.key.tp_dst, ipv6,
				  geneve->use_udp6_rx_checksums);
615 616 617
	if (IS_ERR(gs))
		return PTR_ERR(gs);

618 619
out:
	gs->collect_md = geneve->collect_md;
620
#if IS_ENABLED(CONFIG_IPV6)
J
Jiri Benc 已提交
621
	if (ipv6) {
622
		rcu_assign_pointer(geneve->sock6, gs);
J
Jiri Benc 已提交
623 624
		node = &geneve->hlist6;
	} else
625
#endif
J
Jiri Benc 已提交
626
	{
627
		rcu_assign_pointer(geneve->sock4, gs);
J
Jiri Benc 已提交
628 629 630
		node = &geneve->hlist4;
	}
	node->geneve = geneve;
631

632 633
	tunnel_id_to_vni(geneve->info.key.tun_id, vni);
	hash = geneve_net_vni_hash(vni);
J
Jiri Benc 已提交
634
	hlist_add_head_rcu(&node->hlist, &gs->vni_list[hash]);
635 636 637
	return 0;
}

638 639 640
static int geneve_open(struct net_device *dev)
{
	struct geneve_dev *geneve = netdev_priv(dev);
641
	bool ipv6 = !!(geneve->info.mode & IP_TUNNEL_INFO_IPV6);
642 643 644 645 646 647 648 649 650 651 652 653 654 655 656
	bool metadata = geneve->collect_md;
	int ret = 0;

#if IS_ENABLED(CONFIG_IPV6)
	if (ipv6 || metadata)
		ret = geneve_sock_add(geneve, true);
#endif
	if (!ret && (!ipv6 || metadata))
		ret = geneve_sock_add(geneve, false);
	if (ret < 0)
		geneve_sock_release(geneve);

	return ret;
}

657 658 659 660
static int geneve_stop(struct net_device *dev)
{
	struct geneve_dev *geneve = netdev_priv(dev);

J
Jiri Benc 已提交
661 662 663 664
	hlist_del_init_rcu(&geneve->hlist4.hlist);
#if IS_ENABLED(CONFIG_IPV6)
	hlist_del_init_rcu(&geneve->hlist6.hlist);
#endif
665
	geneve_sock_release(geneve);
666 667 668
	return 0;
}

669
static void geneve_build_header(struct genevehdr *geneveh,
670
				const struct ip_tunnel_info *info)
671 672
{
	geneveh->ver = GENEVE_VER;
673 674 675
	geneveh->opt_len = info->options_len / 4;
	geneveh->oam = !!(info->key.tun_flags & TUNNEL_OAM);
	geneveh->critical = !!(info->key.tun_flags & TUNNEL_CRIT_OPT);
676
	geneveh->rsvd1 = 0;
677
	tunnel_id_to_vni(info->key.tun_id, geneveh->vni);
678 679 680
	geneveh->proto_type = htons(ETH_P_TEB);
	geneveh->rsvd2 = 0;

681
	ip_tunnel_info_opts_get(geneveh->options, info);
682 683
}

684 685 686
static int geneve_build_skb(struct dst_entry *dst, struct sk_buff *skb,
			    const struct ip_tunnel_info *info,
			    bool xnet, int ip_hdr_len)
687
{
688
	bool udp_sum = !!(info->key.tun_flags & TUNNEL_CSUM);
689 690 691 692
	struct genevehdr *gnvh;
	int min_headroom;
	int err;

693
	skb_reset_mac_header(skb);
694 695
	skb_scrub_packet(skb, xnet);

696 697
	min_headroom = LL_RESERVED_SPACE(dst->dev) + dst->header_len +
		       GENEVE_BASE_HLEN + info->options_len + ip_hdr_len;
698
	err = skb_cow_head(skb, min_headroom);
699
	if (unlikely(err))
700 701
		goto free_dst;

702
	err = udp_tunnel_handle_offloads(skb, udp_sum);
703
	if (err)
704 705
		goto free_dst;

706
	gnvh = __skb_push(skb, sizeof(*gnvh) + info->options_len);
707
	geneve_build_header(gnvh, info);
708 709 710 711 712 713 714 715 716 717 718
	skb_set_inner_protocol(skb, htons(ETH_P_TEB));
	return 0;

free_dst:
	dst_release(dst);
	return err;
}

static struct rtable *geneve_get_v4_rt(struct sk_buff *skb,
				       struct net_device *dev,
				       struct flowi4 *fl4,
719
				       const struct ip_tunnel_info *info)
720
{
721
	bool use_cache = ip_tunnel_dst_cache_usable(skb, info);
722
	struct geneve_dev *geneve = netdev_priv(dev);
P
Paolo Abeni 已提交
723
	struct dst_cache *dst_cache;
724 725 726
	struct rtable *rt = NULL;
	__u8 tos;

727 728 729
	if (!rcu_dereference(geneve->sock4))
		return ERR_PTR(-EIO);

730 731 732
	memset(fl4, 0, sizeof(*fl4));
	fl4->flowi4_mark = skb->mark;
	fl4->flowi4_proto = IPPROTO_UDP;
733 734
	fl4->daddr = info->key.u.ipv4.dst;
	fl4->saddr = info->key.u.ipv4.src;
735

736 737 738 739
	tos = info->key.tos;
	if ((tos == 1) && !geneve->collect_md) {
		tos = ip_tunnel_get_dsfield(ip_hdr(skb), skb);
		use_cache = false;
P
Paolo Abeni 已提交
740
	}
741
	fl4->flowi4_tos = RT_TOS(tos);
P
Paolo Abeni 已提交
742

743
	dst_cache = (struct dst_cache *)&info->dst_cache;
P
Paolo Abeni 已提交
744 745 746 747
	if (use_cache) {
		rt = dst_cache_get_ip4(dst_cache, &fl4->saddr);
		if (rt)
			return rt;
748 749 750 751
	}
	rt = ip_route_output_key(geneve->net, fl4);
	if (IS_ERR(rt)) {
		netdev_dbg(dev, "no route to %pI4\n", &fl4->daddr);
752
		return ERR_PTR(-ENETUNREACH);
753 754 755 756
	}
	if (rt->dst.dev == dev) { /* is this necessary? */
		netdev_dbg(dev, "circular route to %pI4\n", &fl4->daddr);
		ip_rt_put(rt);
757
		return ERR_PTR(-ELOOP);
758
	}
P
Paolo Abeni 已提交
759 760
	if (use_cache)
		dst_cache_set_ip4(dst_cache, &rt->dst, fl4->saddr);
761 762 763
	return rt;
}

764 765 766 767
#if IS_ENABLED(CONFIG_IPV6)
static struct dst_entry *geneve_get_v6_dst(struct sk_buff *skb,
					   struct net_device *dev,
					   struct flowi6 *fl6,
768
					   const struct ip_tunnel_info *info)
769
{
770
	bool use_cache = ip_tunnel_dst_cache_usable(skb, info);
771 772
	struct geneve_dev *geneve = netdev_priv(dev);
	struct dst_entry *dst = NULL;
P
Paolo Abeni 已提交
773
	struct dst_cache *dst_cache;
774
	struct geneve_sock *gs6;
775
	__u8 prio;
776

777 778 779 780
	gs6 = rcu_dereference(geneve->sock6);
	if (!gs6)
		return ERR_PTR(-EIO);

781 782 783
	memset(fl6, 0, sizeof(*fl6));
	fl6->flowi6_mark = skb->mark;
	fl6->flowi6_proto = IPPROTO_UDP;
784 785 786 787 788 789
	fl6->daddr = info->key.u.ipv6.dst;
	fl6->saddr = info->key.u.ipv6.src;
	prio = info->key.tos;
	if ((prio == 1) && !geneve->collect_md) {
		prio = ip_tunnel_get_dsfield(ip_hdr(skb), skb);
		use_cache = false;
P
Paolo Abeni 已提交
790 791
	}

792 793
	fl6->flowlabel = ip6_make_flowinfo(RT_TOS(prio),
					   info->key.label);
794
	dst_cache = (struct dst_cache *)&info->dst_cache;
P
Paolo Abeni 已提交
795 796 797 798
	if (use_cache) {
		dst = dst_cache_get_ip6(dst_cache, &fl6->saddr);
		if (dst)
			return dst;
799 800 801 802 803 804 805 806 807 808 809
	}
	if (ipv6_stub->ipv6_dst_lookup(geneve->net, gs6->sock->sk, &dst, fl6)) {
		netdev_dbg(dev, "no route to %pI6\n", &fl6->daddr);
		return ERR_PTR(-ENETUNREACH);
	}
	if (dst->dev == dev) { /* is this necessary? */
		netdev_dbg(dev, "circular route to %pI6\n", &fl6->daddr);
		dst_release(dst);
		return ERR_PTR(-ELOOP);
	}

P
Paolo Abeni 已提交
810 811
	if (use_cache)
		dst_cache_set_ip6(dst_cache, dst, &fl6->saddr);
812 813 814 815
	return dst;
}
#endif

816
static int geneve_xmit_skb(struct sk_buff *skb, struct net_device *dev,
817 818
			   struct geneve_dev *geneve,
			   const struct ip_tunnel_info *info)
819
{
820 821 822 823
	bool xnet = !net_eq(geneve->net, dev_net(geneve->dev));
	struct geneve_sock *gs4 = rcu_dereference(geneve->sock4);
	const struct ip_tunnel_key *key = &info->key;
	struct rtable *rt;
824
	struct flowi4 fl4;
825
	__u8 tos, ttl;
826
	__be16 sport;
827
	__be16 df;
828
	int err;
829

830
	rt = geneve_get_v4_rt(skb, dev, &fl4, info);
831 832
	if (IS_ERR(rt))
		return PTR_ERR(rt);
833 834

	sport = udp_flow_src_port(geneve->net, skb, 1, USHRT_MAX, true);
835 836
	if (geneve->collect_md) {
		tos = ip_tunnel_ecn_encap(key->tos, ip_hdr(skb), skb);
837
		ttl = key->ttl;
838
	} else {
839 840
		tos = ip_tunnel_ecn_encap(fl4.flowi4_tos, ip_hdr(skb), skb);
		ttl = key->ttl ? : ip4_dst_hoplimit(&rt->dst);
841
	}
842
	df = key->tun_flags & TUNNEL_DONT_FRAGMENT ? htons(IP_DF) : 0;
843

844
	err = geneve_build_skb(&rt->dst, skb, info, xnet, sizeof(struct iphdr));
845 846
	if (unlikely(err))
		return err;
H
Haishuang Yan 已提交
847

848 849 850 851 852
	udp_tunnel_xmit_skb(rt, gs4->sock->sk, skb, fl4.saddr, fl4.daddr,
			    tos, ttl, df, sport, geneve->info.key.tp_dst,
			    !net_eq(geneve->net, dev_net(geneve->dev)),
			    !(info->key.tun_flags & TUNNEL_CSUM));
	return 0;
853 854
}

855
#if IS_ENABLED(CONFIG_IPV6)
856
static int geneve6_xmit_skb(struct sk_buff *skb, struct net_device *dev,
857 858
			    struct geneve_dev *geneve,
			    const struct ip_tunnel_info *info)
859
{
860 861 862
	bool xnet = !net_eq(geneve->net, dev_net(geneve->dev));
	struct geneve_sock *gs6 = rcu_dereference(geneve->sock6);
	const struct ip_tunnel_key *key = &info->key;
863 864
	struct dst_entry *dst = NULL;
	struct flowi6 fl6;
865
	__u8 prio, ttl;
866
	__be16 sport;
867
	int err;
868 869

	dst = geneve_get_v6_dst(skb, dev, &fl6, info);
870 871
	if (IS_ERR(dst))
		return PTR_ERR(dst);
872 873

	sport = udp_flow_src_port(geneve->net, skb, 1, USHRT_MAX, true);
874 875 876 877 878 879 880 881
	if (geneve->collect_md) {
		prio = ip_tunnel_ecn_encap(key->tos, ip_hdr(skb), skb);
		ttl = key->ttl;
	} else {
		prio = ip_tunnel_ecn_encap(ip6_tclass(fl6.flowlabel),
					   ip_hdr(skb), skb);
		ttl = key->ttl ? : ip6_dst_hoplimit(dst);
	}
882
	err = geneve_build_skb(dst, skb, info, xnet, sizeof(struct ipv6hdr));
883 884
	if (unlikely(err))
		return err;
885

886 887 888 889 890 891 892
	udp_tunnel6_xmit_skb(dst, gs6->sock->sk, skb, dev,
			     &fl6.saddr, &fl6.daddr, prio, ttl,
			     info->key.label, sport, geneve->info.key.tp_dst,
			     !(info->key.tun_flags & TUNNEL_CSUM));
	return 0;
}
#endif
893

894 895 896 897 898
static netdev_tx_t geneve_xmit(struct sk_buff *skb, struct net_device *dev)
{
	struct geneve_dev *geneve = netdev_priv(dev);
	struct ip_tunnel_info *info = NULL;
	int err;
899

900 901 902 903 904
	if (geneve->collect_md) {
		info = skb_tunnel_info(skb);
		if (unlikely(!info || !(info->mode & IP_TUNNEL_INFO_TX))) {
			err = -EINVAL;
			netdev_dbg(dev, "no tunnel metadata\n");
905
			goto tx_error;
906
		}
907
	} else {
908
		info = &geneve->info;
909
	}
910

J
Jakub Kicinski 已提交
911
	rcu_read_lock();
912 913 914 915 916 917
#if IS_ENABLED(CONFIG_IPV6)
	if (info->mode & IP_TUNNEL_INFO_IPV6)
		err = geneve6_xmit_skb(skb, dev, geneve, info);
	else
#endif
		err = geneve_xmit_skb(skb, dev, geneve, info);
J
Jakub Kicinski 已提交
918
	rcu_read_unlock();
919

920 921
	if (likely(!err))
		return NETDEV_TX_OK;
922 923
tx_error:
	dev_kfree_skb(skb);
924

925 926 927 928
	if (err == -ELOOP)
		dev->stats.collisions++;
	else if (err == -ENETUNREACH)
		dev->stats.tx_carrier_errors++;
H
Haishuang Yan 已提交
929 930

	dev->stats.tx_errors++;
931 932 933
	return NETDEV_TX_OK;
}

934
static int geneve_change_mtu(struct net_device *dev, int new_mtu)
D
David Wragg 已提交
935
{
936 937
	/* Only possible if called internally, ndo_change_mtu path's new_mtu
	 * is guaranteed to be between dev->min_mtu and dev->max_mtu.
D
David Wragg 已提交
938
	 */
939 940
	if (new_mtu > dev->max_mtu)
		new_mtu = dev->max_mtu;
D
David Wragg 已提交
941

D
David Wragg 已提交
942 943 944 945
	dev->mtu = new_mtu;
	return 0;
}

946 947 948 949 950
static int geneve_fill_metadata_dst(struct net_device *dev, struct sk_buff *skb)
{
	struct ip_tunnel_info *info = skb_tunnel_info(skb);
	struct geneve_dev *geneve = netdev_priv(dev);

951
	if (ip_tunnel_info_af(info) == AF_INET) {
952 953 954
		struct rtable *rt;
		struct flowi4 fl4;

955 956 957
		rt = geneve_get_v4_rt(skb, dev, &fl4, info);
		if (IS_ERR(rt))
			return PTR_ERR(rt);
958

959 960 961 962
		ip_rt_put(rt);
		info->key.u.ipv4.src = fl4.saddr;
#if IS_ENABLED(CONFIG_IPV6)
	} else if (ip_tunnel_info_af(info) == AF_INET6) {
963 964 965
		struct dst_entry *dst;
		struct flowi6 fl6;

966 967 968 969 970 971 972 973 974 975
		dst = geneve_get_v6_dst(skb, dev, &fl6, info);
		if (IS_ERR(dst))
			return PTR_ERR(dst);

		dst_release(dst);
		info->key.u.ipv6.src = fl6.saddr;
#endif
	} else {
		return -EINVAL;
	}
976 977 978

	info->key.tp_src = udp_flow_src_port(geneve->net, skb,
					     1, USHRT_MAX, true);
979
	info->key.tp_dst = geneve->info.key.tp_dst;
980 981 982
	return 0;
}

983 984 985 986 987 988 989
static const struct net_device_ops geneve_netdev_ops = {
	.ndo_init		= geneve_init,
	.ndo_uninit		= geneve_uninit,
	.ndo_open		= geneve_open,
	.ndo_stop		= geneve_stop,
	.ndo_start_xmit		= geneve_xmit,
	.ndo_get_stats64	= ip_tunnel_get_stats64,
D
David Wragg 已提交
990
	.ndo_change_mtu		= geneve_change_mtu,
991 992
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_set_mac_address	= eth_mac_addr,
993
	.ndo_fill_metadata_dst	= geneve_fill_metadata_dst,
994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012
};

static void geneve_get_drvinfo(struct net_device *dev,
			       struct ethtool_drvinfo *drvinfo)
{
	strlcpy(drvinfo->version, GENEVE_NETDEV_VER, sizeof(drvinfo->version));
	strlcpy(drvinfo->driver, "geneve", sizeof(drvinfo->driver));
}

static const struct ethtool_ops geneve_ethtool_ops = {
	.get_drvinfo	= geneve_get_drvinfo,
	.get_link	= ethtool_op_get_link,
};

/* Info for udev, that this is a virtual tunnel endpoint */
static struct device_type geneve_type = {
	.name = "geneve",
};

1013
/* Calls the ndo_udp_tunnel_add of the caller in order to
1014
 * supply the listening GENEVE udp ports. Callers are expected
1015
 * to implement the ndo_udp_tunnel_add.
1016
 */
1017
static void geneve_push_rx_ports(struct net_device *dev)
1018 1019 1020 1021
{
	struct net *net = dev_net(dev);
	struct geneve_net *gn = net_generic(net, geneve_net_id);
	struct geneve_sock *gs;
1022

1023
	rcu_read_lock();
1024 1025 1026
	list_for_each_entry_rcu(gs, &gn->sock_list, list)
		udp_tunnel_push_rx_port(dev, gs->sock,
					UDP_TUNNEL_TYPE_GENEVE);
1027 1028 1029
	rcu_read_unlock();
}

1030 1031 1032 1033 1034 1035 1036
/* Initialize the device structure. */
static void geneve_setup(struct net_device *dev)
{
	ether_setup(dev);

	dev->netdev_ops = &geneve_netdev_ops;
	dev->ethtool_ops = &geneve_ethtool_ops;
1037
	dev->needs_free_netdev = true;
1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048

	SET_NETDEV_DEVTYPE(dev, &geneve_type);

	dev->features    |= NETIF_F_LLTX;
	dev->features    |= NETIF_F_SG | NETIF_F_HW_CSUM;
	dev->features    |= NETIF_F_RXCSUM;
	dev->features    |= NETIF_F_GSO_SOFTWARE;

	dev->hw_features |= NETIF_F_SG | NETIF_F_HW_CSUM | NETIF_F_RXCSUM;
	dev->hw_features |= NETIF_F_GSO_SOFTWARE;

1049 1050 1051 1052 1053 1054 1055 1056
	/* MTU range: 68 - (something less than 65535) */
	dev->min_mtu = ETH_MIN_MTU;
	/* The max_mtu calculation does not take account of GENEVE
	 * options, to avoid excluding potentially valid
	 * configurations. This will be further reduced by IPvX hdr size.
	 */
	dev->max_mtu = IP_MAX_MTU - GENEVE_BASE_HLEN - dev->hard_header_len;

1057
	netif_keep_dst(dev);
J
Jiri Benc 已提交
1058
	dev->priv_flags &= ~IFF_TX_SKB_SHARING;
1059
	dev->priv_flags |= IFF_LIVE_ADDR_CHANGE | IFF_NO_QUEUE;
1060
	eth_hw_addr_random(dev);
1061 1062 1063 1064 1065
}

static const struct nla_policy geneve_policy[IFLA_GENEVE_MAX + 1] = {
	[IFLA_GENEVE_ID]		= { .type = NLA_U32 },
	[IFLA_GENEVE_REMOTE]		= { .len = FIELD_SIZEOF(struct iphdr, daddr) },
1066
	[IFLA_GENEVE_REMOTE6]		= { .len = sizeof(struct in6_addr) },
1067
	[IFLA_GENEVE_TTL]		= { .type = NLA_U8 },
1068
	[IFLA_GENEVE_TOS]		= { .type = NLA_U8 },
1069
	[IFLA_GENEVE_LABEL]		= { .type = NLA_U32 },
1070
	[IFLA_GENEVE_PORT]		= { .type = NLA_U16 },
1071
	[IFLA_GENEVE_COLLECT_METADATA]	= { .type = NLA_FLAG },
1072 1073 1074
	[IFLA_GENEVE_UDP_CSUM]		= { .type = NLA_U8 },
	[IFLA_GENEVE_UDP_ZERO_CSUM6_TX]	= { .type = NLA_U8 },
	[IFLA_GENEVE_UDP_ZERO_CSUM6_RX]	= { .type = NLA_U8 },
1075 1076
};

1077 1078
static int geneve_validate(struct nlattr *tb[], struct nlattr *data[],
			   struct netlink_ext_ack *extack)
1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093
{
	if (tb[IFLA_ADDRESS]) {
		if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
			return -EINVAL;

		if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
			return -EADDRNOTAVAIL;
	}

	if (!data)
		return -EINVAL;

	if (data[IFLA_GENEVE_ID]) {
		__u32 vni =  nla_get_u32(data[IFLA_GENEVE_ID]);

1094
		if (vni >= GENEVE_N_VID)
1095 1096 1097 1098 1099 1100
			return -ERANGE;
	}

	return 0;
}

1101
static struct geneve_dev *geneve_find_dev(struct geneve_net *gn,
1102
					  const struct ip_tunnel_info *info,
1103 1104 1105
					  bool *tun_on_same_port,
					  bool *tun_collect_md)
{
1106
	struct geneve_dev *geneve, *t = NULL;
1107 1108 1109 1110

	*tun_on_same_port = false;
	*tun_collect_md = false;
	list_for_each_entry(geneve, &gn->geneve_list, next) {
1111
		if (info->key.tp_dst == geneve->info.key.tp_dst) {
1112 1113 1114
			*tun_collect_md = geneve->collect_md;
			*tun_on_same_port = true;
		}
1115 1116 1117
		if (info->key.tun_id == geneve->info.key.tun_id &&
		    info->key.tp_dst == geneve->info.key.tp_dst &&
		    !memcmp(&info->key.u, &geneve->info.key.u, sizeof(info->key.u)))
1118 1119 1120 1121 1122
			t = geneve;
	}
	return t;
}

1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142
static bool is_all_zero(const u8 *fp, size_t size)
{
	int i;

	for (i = 0; i < size; i++)
		if (fp[i])
			return false;
	return true;
}

static bool is_tnl_info_zero(const struct ip_tunnel_info *info)
{
	if (info->key.tun_id || info->key.tun_flags || info->key.tos ||
	    info->key.ttl || info->key.label || info->key.tp_src ||
	    !is_all_zero((const u8 *)&info->key.u, sizeof(info->key.u)))
		return false;
	else
		return true;
}

1143
static int geneve_configure(struct net *net, struct net_device *dev,
1144 1145
			    const struct ip_tunnel_info *info,
			    bool metadata, bool ipv6_rx_csum)
1146 1147
{
	struct geneve_net *gn = net_generic(net, geneve_net_id);
1148 1149
	struct geneve_dev *t, *geneve = netdev_priv(dev);
	bool tun_collect_md, tun_on_same_port;
P
Paolo Abeni 已提交
1150
	int err, encap_len;
1151

1152
	if (metadata && !is_tnl_info_zero(info))
1153
		return -EINVAL;
1154 1155 1156 1157

	geneve->net = net;
	geneve->dev = dev;

1158
	t = geneve_find_dev(gn, info, &tun_on_same_port, &tun_collect_md);
1159 1160 1161
	if (t)
		return -EBUSY;

P
Paolo Abeni 已提交
1162 1163
	/* make enough headroom for basic scenario */
	encap_len = GENEVE_BASE_HLEN + ETH_HLEN;
1164
	if (!metadata && ip_tunnel_info_af(info) == AF_INET) {
P
Paolo Abeni 已提交
1165
		encap_len += sizeof(struct iphdr);
1166 1167
		dev->max_mtu -= sizeof(struct iphdr);
	} else {
P
Paolo Abeni 已提交
1168
		encap_len += sizeof(struct ipv6hdr);
1169 1170
		dev->max_mtu -= sizeof(struct ipv6hdr);
	}
P
Paolo Abeni 已提交
1171 1172
	dev->needed_headroom = encap_len + ETH_HLEN;

1173 1174 1175 1176 1177 1178 1179 1180
	if (metadata) {
		if (tun_on_same_port)
			return -EPERM;
	} else {
		if (tun_collect_md)
			return -EPERM;
	}

1181 1182 1183 1184
	dst_cache_reset(&geneve->info.dst_cache);
	geneve->info = *info;
	geneve->collect_md = metadata;
	geneve->use_udp6_rx_checksums = ipv6_rx_csum;
P
Paolo Abeni 已提交
1185

1186 1187 1188 1189
	err = register_netdevice(dev);
	if (err)
		return err;

1190 1191 1192 1193
	list_add(&geneve->next, &gn->geneve_list);
	return 0;
}

1194 1195 1196 1197 1198 1199
static void init_tnl_info(struct ip_tunnel_info *info, __u16 dst_port)
{
	memset(info, 0, sizeof(*info));
	info->key.tp_dst = htons(dst_port);
}

1200
static int geneve_newlink(struct net *net, struct net_device *dev,
1201 1202
			  struct nlattr *tb[], struct nlattr *data[],
			  struct netlink_ext_ack *extack)
1203
{
1204 1205
	bool use_udp6_rx_checksums = false;
	struct ip_tunnel_info info;
1206
	bool metadata = false;
1207 1208

	init_tnl_info(&info, GENEVE_UDP_PORT);
1209

1210 1211 1212 1213
	if (data[IFLA_GENEVE_REMOTE] && data[IFLA_GENEVE_REMOTE6])
		return -EINVAL;

	if (data[IFLA_GENEVE_REMOTE]) {
1214
		info.key.u.ipv4.dst =
1215
			nla_get_in_addr(data[IFLA_GENEVE_REMOTE]);
1216 1217 1218 1219 1220

		if (IN_MULTICAST(ntohl(info.key.u.ipv4.dst))) {
			netdev_dbg(dev, "multicast remote is unsupported\n");
			return -EINVAL;
		}
1221 1222 1223
	}

	if (data[IFLA_GENEVE_REMOTE6]) {
1224 1225 1226
 #if IS_ENABLED(CONFIG_IPV6)
		info.mode = IP_TUNNEL_INFO_IPV6;
		info.key.u.ipv6.dst =
1227 1228
			nla_get_in6_addr(data[IFLA_GENEVE_REMOTE6]);

1229
		if (ipv6_addr_type(&info.key.u.ipv6.dst) &
1230 1231 1232 1233
		    IPV6_ADDR_LINKLOCAL) {
			netdev_dbg(dev, "link-local remote is unsupported\n");
			return -EINVAL;
		}
1234 1235 1236 1237 1238 1239 1240 1241 1242
		if (ipv6_addr_is_multicast(&info.key.u.ipv6.dst)) {
			netdev_dbg(dev, "multicast remote is unsupported\n");
			return -EINVAL;
		}
		info.key.tun_flags |= TUNNEL_CSUM;
		use_udp6_rx_checksums = true;
#else
		return -EPFNOSUPPORT;
#endif
1243 1244
	}

1245 1246 1247 1248
	if (data[IFLA_GENEVE_ID]) {
		__u32 vni;
		__u8 tvni[3];

1249
		vni = nla_get_u32(data[IFLA_GENEVE_ID]);
1250 1251 1252
		tvni[0] = (vni & 0x00ff0000) >> 16;
		tvni[1] = (vni & 0x0000ff00) >> 8;
		tvni[2] =  vni & 0x000000ff;
1253

1254 1255
		info.key.tun_id = vni_to_tunnel_id(tvni);
	}
1256
	if (data[IFLA_GENEVE_TTL])
1257
		info.key.ttl = nla_get_u8(data[IFLA_GENEVE_TTL]);
1258

1259
	if (data[IFLA_GENEVE_TOS])
1260
		info.key.tos = nla_get_u8(data[IFLA_GENEVE_TOS]);
1261

1262 1263 1264 1265 1266 1267
	if (data[IFLA_GENEVE_LABEL]) {
		info.key.label = nla_get_be32(data[IFLA_GENEVE_LABEL]) &
				  IPV6_FLOWLABEL_MASK;
		if (info.key.label && (!(info.mode & IP_TUNNEL_INFO_IPV6)))
			return -EINVAL;
	}
1268

1269
	if (data[IFLA_GENEVE_PORT])
1270
		info.key.tp_dst = nla_get_be16(data[IFLA_GENEVE_PORT]);
1271

1272 1273
	if (data[IFLA_GENEVE_COLLECT_METADATA])
		metadata = true;
1274

1275
	if (data[IFLA_GENEVE_UDP_CSUM] &&
1276
	    nla_get_u8(data[IFLA_GENEVE_UDP_CSUM]))
1277
		info.key.tun_flags |= TUNNEL_CSUM;
1278 1279 1280

	if (data[IFLA_GENEVE_UDP_ZERO_CSUM6_TX] &&
	    nla_get_u8(data[IFLA_GENEVE_UDP_ZERO_CSUM6_TX]))
1281
		info.key.tun_flags &= ~TUNNEL_CSUM;
1282 1283 1284

	if (data[IFLA_GENEVE_UDP_ZERO_CSUM6_RX] &&
	    nla_get_u8(data[IFLA_GENEVE_UDP_ZERO_CSUM6_RX]))
1285
		use_udp6_rx_checksums = false;
1286

1287
	return geneve_configure(net, dev, &info, metadata, use_udp6_rx_checksums);
1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300
}

static void geneve_dellink(struct net_device *dev, struct list_head *head)
{
	struct geneve_dev *geneve = netdev_priv(dev);

	list_del(&geneve->next);
	unregister_netdevice_queue(dev, head);
}

static size_t geneve_get_size(const struct net_device *dev)
{
	return nla_total_size(sizeof(__u32)) +	/* IFLA_GENEVE_ID */
1301
		nla_total_size(sizeof(struct in6_addr)) + /* IFLA_GENEVE_REMOTE{6} */
1302
		nla_total_size(sizeof(__u8)) +  /* IFLA_GENEVE_TTL */
1303
		nla_total_size(sizeof(__u8)) +  /* IFLA_GENEVE_TOS */
1304
		nla_total_size(sizeof(__be32)) +  /* IFLA_GENEVE_LABEL */
1305
		nla_total_size(sizeof(__be16)) +  /* IFLA_GENEVE_PORT */
1306
		nla_total_size(0) +	 /* IFLA_GENEVE_COLLECT_METADATA */
1307 1308 1309
		nla_total_size(sizeof(__u8)) + /* IFLA_GENEVE_UDP_CSUM */
		nla_total_size(sizeof(__u8)) + /* IFLA_GENEVE_UDP_ZERO_CSUM6_TX */
		nla_total_size(sizeof(__u8)) + /* IFLA_GENEVE_UDP_ZERO_CSUM6_RX */
1310 1311 1312 1313 1314 1315
		0;
}

static int geneve_fill_info(struct sk_buff *skb, const struct net_device *dev)
{
	struct geneve_dev *geneve = netdev_priv(dev);
1316 1317
	struct ip_tunnel_info *info = &geneve->info;
	__u8 tmp_vni[3];
1318 1319
	__u32 vni;

1320 1321
	tunnel_id_to_vni(info->key.tun_id, tmp_vni);
	vni = (tmp_vni[0] << 16) | (tmp_vni[1] << 8) | tmp_vni[2];
1322 1323 1324
	if (nla_put_u32(skb, IFLA_GENEVE_ID, vni))
		goto nla_put_failure;

1325
	if (rtnl_dereference(geneve->sock4)) {
1326
		if (nla_put_in_addr(skb, IFLA_GENEVE_REMOTE,
1327 1328 1329 1330 1331
				    info->key.u.ipv4.dst))
			goto nla_put_failure;

		if (nla_put_u8(skb, IFLA_GENEVE_UDP_CSUM,
			       !!(info->key.tun_flags & TUNNEL_CSUM)))
1332
			goto nla_put_failure;
1333

1334 1335
	}

1336
#if IS_ENABLED(CONFIG_IPV6)
1337
	if (rtnl_dereference(geneve->sock6)) {
1338
		if (nla_put_in6_addr(skb, IFLA_GENEVE_REMOTE6,
1339 1340 1341 1342 1343 1344 1345 1346 1347
				     &info->key.u.ipv6.dst))
			goto nla_put_failure;

		if (nla_put_u8(skb, IFLA_GENEVE_UDP_ZERO_CSUM6_TX,
			       !(info->key.tun_flags & TUNNEL_CSUM)))
			goto nla_put_failure;

		if (nla_put_u8(skb, IFLA_GENEVE_UDP_ZERO_CSUM6_RX,
			       !geneve->use_udp6_rx_checksums))
1348 1349
			goto nla_put_failure;
	}
1350
#endif
1351

1352 1353 1354
	if (nla_put_u8(skb, IFLA_GENEVE_TTL, info->key.ttl) ||
	    nla_put_u8(skb, IFLA_GENEVE_TOS, info->key.tos) ||
	    nla_put_be32(skb, IFLA_GENEVE_LABEL, info->key.label))
1355 1356
		goto nla_put_failure;

1357
	if (nla_put_be16(skb, IFLA_GENEVE_PORT, info->key.tp_dst))
1358 1359
		goto nla_put_failure;

1360 1361 1362 1363
	if (geneve->collect_md) {
		if (nla_put_flag(skb, IFLA_GENEVE_COLLECT_METADATA))
			goto nla_put_failure;
	}
1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382
	return 0;

nla_put_failure:
	return -EMSGSIZE;
}

static struct rtnl_link_ops geneve_link_ops __read_mostly = {
	.kind		= "geneve",
	.maxtype	= IFLA_GENEVE_MAX,
	.policy		= geneve_policy,
	.priv_size	= sizeof(struct geneve_dev),
	.setup		= geneve_setup,
	.validate	= geneve_validate,
	.newlink	= geneve_newlink,
	.dellink	= geneve_dellink,
	.get_size	= geneve_get_size,
	.fill_info	= geneve_fill_info,
};

1383 1384 1385 1386
struct net_device *geneve_dev_create_fb(struct net *net, const char *name,
					u8 name_assign_type, u16 dst_port)
{
	struct nlattr *tb[IFLA_MAX + 1];
1387
	struct ip_tunnel_info info;
1388
	struct net_device *dev;
1389
	LIST_HEAD(list_kill);
1390 1391 1392 1393 1394 1395 1396 1397
	int err;

	memset(tb, 0, sizeof(tb));
	dev = rtnl_create_link(net, name, name_assign_type,
			       &geneve_link_ops, tb);
	if (IS_ERR(dev))
		return dev;

1398 1399
	init_tnl_info(&info, dst_port);
	err = geneve_configure(net, dev, &info, true, true);
1400 1401 1402 1403
	if (err) {
		free_netdev(dev);
		return ERR_PTR(err);
	}
1404 1405 1406 1407

	/* openvswitch users expect packet sizes to be unrestricted,
	 * so set the largest MTU we can.
	 */
1408
	err = geneve_change_mtu(dev, IP_MAX_MTU);
1409 1410 1411
	if (err)
		goto err;

1412 1413 1414 1415
	err = rtnl_configure_link(dev, NULL);
	if (err < 0)
		goto err;

1416
	return dev;
1417
err:
1418 1419
	geneve_dellink(dev, &list_kill);
	unregister_netdevice_many(&list_kill);
1420
	return ERR_PTR(err);
1421 1422 1423
}
EXPORT_SYMBOL_GPL(geneve_dev_create_fb);

1424 1425 1426 1427 1428
static int geneve_netdevice_event(struct notifier_block *unused,
				  unsigned long event, void *ptr)
{
	struct net_device *dev = netdev_notifier_info_to_dev(ptr);

1429
	if (event == NETDEV_UDP_TUNNEL_PUSH_INFO)
1430 1431 1432 1433 1434 1435 1436 1437 1438
		geneve_push_rx_ports(dev);

	return NOTIFY_DONE;
}

static struct notifier_block geneve_notifier_block __read_mostly = {
	.notifier_call = geneve_netdevice_event,
};

1439 1440 1441 1442 1443
static __net_init int geneve_init_net(struct net *net)
{
	struct geneve_net *gn = net_generic(net, geneve_net_id);

	INIT_LIST_HEAD(&gn->geneve_list);
1444
	INIT_LIST_HEAD(&gn->sock_list);
1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490
	return 0;
}

static void __net_exit geneve_exit_net(struct net *net)
{
	struct geneve_net *gn = net_generic(net, geneve_net_id);
	struct geneve_dev *geneve, *next;
	struct net_device *dev, *aux;
	LIST_HEAD(list);

	rtnl_lock();

	/* gather any geneve devices that were moved into this ns */
	for_each_netdev_safe(net, dev, aux)
		if (dev->rtnl_link_ops == &geneve_link_ops)
			unregister_netdevice_queue(dev, &list);

	/* now gather any other geneve devices that were created in this ns */
	list_for_each_entry_safe(geneve, next, &gn->geneve_list, next) {
		/* If geneve->dev is in the same netns, it was already added
		 * to the list by the previous loop.
		 */
		if (!net_eq(dev_net(geneve->dev), net))
			unregister_netdevice_queue(geneve->dev, &list);
	}

	/* unregister the devices gathered above */
	unregister_netdevice_many(&list);
	rtnl_unlock();
}

static struct pernet_operations geneve_net_ops = {
	.init = geneve_init_net,
	.exit = geneve_exit_net,
	.id   = &geneve_net_id,
	.size = sizeof(struct geneve_net),
};

static int __init geneve_init_module(void)
{
	int rc;

	rc = register_pernet_subsys(&geneve_net_ops);
	if (rc)
		goto out1;

1491
	rc = register_netdevice_notifier(&geneve_notifier_block);
1492 1493 1494
	if (rc)
		goto out2;

1495 1496 1497 1498
	rc = rtnl_link_register(&geneve_link_ops);
	if (rc)
		goto out3;

1499
	return 0;
1500 1501
out3:
	unregister_netdevice_notifier(&geneve_notifier_block);
1502 1503 1504 1505 1506 1507 1508 1509 1510 1511
out2:
	unregister_pernet_subsys(&geneve_net_ops);
out1:
	return rc;
}
late_initcall(geneve_init_module);

static void __exit geneve_cleanup_module(void)
{
	rtnl_link_unregister(&geneve_link_ops);
1512
	unregister_netdevice_notifier(&geneve_notifier_block);
1513 1514 1515 1516 1517 1518 1519 1520 1521
	unregister_pernet_subsys(&geneve_net_ops);
}
module_exit(geneve_cleanup_module);

MODULE_LICENSE("GPL");
MODULE_VERSION(GENEVE_NETDEV_VER);
MODULE_AUTHOR("John W. Linville <linville@tuxdriver.com>");
MODULE_DESCRIPTION("Interface driver for GENEVE encapsulated traffic");
MODULE_ALIAS_RTNL_LINK("geneve");