datapath.c 56.0 KB
Newer Older
1
/*
2
 * Copyright (c) 2007-2014 Nicira, Inc.
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of version 2 of the GNU General Public
 * License as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
 * 02110-1301, USA
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/init.h>
#include <linux/module.h>
#include <linux/if_arp.h>
#include <linux/if_vlan.h>
#include <linux/in.h>
#include <linux/ip.h>
#include <linux/jhash.h>
#include <linux/delay.h>
#include <linux/time.h>
#include <linux/etherdevice.h>
#include <linux/genetlink.h>
#include <linux/kernel.h>
#include <linux/kthread.h>
#include <linux/mutex.h>
#include <linux/percpu.h>
#include <linux/rcupdate.h>
#include <linux/tcp.h>
#include <linux/udp.h>
#include <linux/ethtool.h>
#include <linux/wait.h>
#include <asm/div64.h>
#include <linux/highmem.h>
#include <linux/netfilter_bridge.h>
#include <linux/netfilter_ipv4.h>
#include <linux/inetdevice.h>
#include <linux/list.h>
#include <linux/openvswitch.h>
#include <linux/rculist.h>
#include <linux/dmi.h>
#include <net/genetlink.h>
51 52
#include <net/net_namespace.h>
#include <net/netns/generic.h>
53 54 55

#include "datapath.h"
#include "flow.h"
56
#include "flow_table.h"
57
#include "flow_netlink.h"
58
#include "vport-internal_dev.h"
59
#include "vport-netdev.h"
60

61
int ovs_net_id __read_mostly;
62
EXPORT_SYMBOL_GPL(ovs_net_id);
63

64 65 66 67
static struct genl_family dp_packet_genl_family;
static struct genl_family dp_flow_genl_family;
static struct genl_family dp_datapath_genl_family;

68 69
static const struct nla_policy flow_policy[];

70 71
static const struct genl_multicast_group ovs_dp_flow_multicast_group = {
	.name = OVS_FLOW_MCGROUP,
72 73
};

74 75
static const struct genl_multicast_group ovs_dp_datapath_multicast_group = {
	.name = OVS_DATAPATH_MCGROUP,
76 77
};

78 79
static const struct genl_multicast_group ovs_dp_vport_multicast_group = {
	.name = OVS_VPORT_MCGROUP,
80 81
};

82 83
/* Check if need to build a reply message.
 * OVS userspace sets the NLM_F_ECHO flag if it needs the reply. */
84 85
static bool ovs_must_notify(struct genl_family *family, struct genl_info *info,
			    unsigned int group)
86 87
{
	return info->nlhdr->nlmsg_flags & NLM_F_ECHO ||
88
	       genl_has_listeners(family, genl_info_net(info), group);
89 90
}

91
static void ovs_notify(struct genl_family *family,
92
		       struct sk_buff *skb, struct genl_info *info)
93
{
94
	genl_notify(family, skb, genl_info_net(info), info->snd_portid,
95
		    0, info->nlhdr, GFP_KERNEL);
96 97
}

98 99 100
/**
 * DOC: Locking:
 *
101 102 103 104
 * All writes e.g. Writes to device state (add/remove datapath, port, set
 * operations on vports, etc.), Writes to other state (flow table
 * modifications, set miscellaneous datapath parameters, etc.) are protected
 * by ovs_lock.
105 106 107 108 109 110
 *
 * Reads are protected by RCU.
 *
 * There are a few special cases (mostly stats) that have their own
 * synchronization but they nest under all of above and don't interact with
 * each other.
111 112
 *
 * The RTNL lock nests inside ovs_mutex.
113 114
 */

115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134
static DEFINE_MUTEX(ovs_mutex);

void ovs_lock(void)
{
	mutex_lock(&ovs_mutex);
}

void ovs_unlock(void)
{
	mutex_unlock(&ovs_mutex);
}

#ifdef CONFIG_LOCKDEP
int lockdep_ovsl_is_held(void)
{
	if (debug_locks)
		return lockdep_is_held(&ovs_mutex);
	else
		return 1;
}
135
EXPORT_SYMBOL_GPL(lockdep_ovsl_is_held);
136 137
#endif

138
static struct vport *new_vport(const struct vport_parms *);
139
static int queue_gso_packets(struct datapath *dp, struct sk_buff *,
140
			     const struct sw_flow_key *,
141
			     const struct dp_upcall_info *);
142
static int queue_userspace_packet(struct datapath *dp, struct sk_buff *,
143
				  const struct sw_flow_key *,
144 145
				  const struct dp_upcall_info *);

146 147
/* Must be called with rcu_read_lock. */
static struct datapath *get_dp_rcu(struct net *net, int dp_ifindex)
148
{
149
	struct net_device *dev = dev_get_by_index_rcu(net, dp_ifindex);
150 151 152 153

	if (dev) {
		struct vport *vport = ovs_internal_dev_get_vport(dev);
		if (vport)
154
			return vport->dp;
155
	}
156 157 158 159 160 161 162 163 164 165 166 167 168 169

	return NULL;
}

/* The caller must hold either ovs_mutex or rcu_read_lock to keep the
 * returned dp pointer valid.
 */
static inline struct datapath *get_dp(struct net *net, int dp_ifindex)
{
	struct datapath *dp;

	WARN_ON_ONCE(!rcu_read_lock_held() && !lockdep_ovsl_is_held());
	rcu_read_lock();
	dp = get_dp_rcu(net, dp_ifindex);
170 171 172 173 174
	rcu_read_unlock();

	return dp;
}

175
/* Must be called with rcu_read_lock or ovs_mutex. */
176
const char *ovs_dp_name(const struct datapath *dp)
177
{
178
	struct vport *vport = ovs_vport_ovsl_rcu(dp, OVSP_LOCAL);
179 180 181
	return vport->ops->get_name(vport);
}

182
static int get_dpifindex(const struct datapath *dp)
183 184 185 186 187 188
{
	struct vport *local;
	int ifindex;

	rcu_read_lock();

189
	local = ovs_vport_rcu(dp, OVSP_LOCAL);
190
	if (local)
191
		ifindex = netdev_vport_priv(local)->dev->ifindex;
192 193 194 195 196 197 198 199 200 201 202 203
	else
		ifindex = 0;

	rcu_read_unlock();

	return ifindex;
}

static void destroy_dp_rcu(struct rcu_head *rcu)
{
	struct datapath *dp = container_of(rcu, struct datapath, rcu);

204
	ovs_flow_tbl_destroy(&dp->table);
205
	free_percpu(dp->stats_percpu);
206
	release_net(ovs_dp_get_net(dp));
207
	kfree(dp->ports);
208 209 210
	kfree(dp);
}

211 212 213 214 215 216
static struct hlist_head *vport_hash_bucket(const struct datapath *dp,
					    u16 port_no)
{
	return &dp->ports[port_no & (DP_VPORT_HASH_BUCKETS - 1)];
}

J
Jarno Rajahalme 已提交
217
/* Called with ovs_mutex or RCU read lock. */
218 219 220 221 222 223
struct vport *ovs_lookup_vport(const struct datapath *dp, u16 port_no)
{
	struct vport *vport;
	struct hlist_head *head;

	head = vport_hash_bucket(dp, port_no);
224
	hlist_for_each_entry_rcu(vport, head, dp_hash_node) {
225 226 227 228 229 230
		if (vport->port_no == port_no)
			return vport;
	}
	return NULL;
}

231
/* Called with ovs_mutex. */
232 233 234 235 236 237 238
static struct vport *new_vport(const struct vport_parms *parms)
{
	struct vport *vport;

	vport = ovs_vport_add(parms);
	if (!IS_ERR(vport)) {
		struct datapath *dp = parms->dp;
239
		struct hlist_head *head = vport_hash_bucket(dp, vport->port_no);
240

241
		hlist_add_head_rcu(&vport->dp_hash_node, head);
242 243 244 245 246 247
	}
	return vport;
}

void ovs_dp_detach_port(struct vport *p)
{
248
	ASSERT_OVSL();
249 250

	/* First drop references to device. */
251
	hlist_del_rcu(&p->dp_hash_node);
252 253 254 255 256 257

	/* Then destroy it. */
	ovs_vport_del(p);
}

/* Must be called with rcu_read_lock. */
258
void ovs_dp_process_packet(struct sk_buff *skb, struct sw_flow_key *key)
259
{
260
	const struct vport *p = OVS_CB(skb)->input_vport;
261 262
	struct datapath *dp = p->dp;
	struct sw_flow *flow;
263
	struct sw_flow_actions *sf_acts;
264 265
	struct dp_stats_percpu *stats;
	u64 *stats_counter;
266
	u32 n_mask_hit;
267

268
	stats = this_cpu_ptr(dp->stats_percpu);
269 270

	/* Look up flow. */
271
	flow = ovs_flow_tbl_lookup_stats(&dp->table, key, &n_mask_hit);
272 273
	if (unlikely(!flow)) {
		struct dp_upcall_info upcall;
274
		int error;
275 276 277

		upcall.cmd = OVS_PACKET_CMD_MISS;
		upcall.userdata = NULL;
278
		upcall.portid = ovs_vport_find_upcall_portid(p, skb);
279
		upcall.egress_tun_info = NULL;
280
		error = ovs_dp_upcall(dp, skb, key, &upcall);
281 282 283 284
		if (unlikely(error))
			kfree_skb(skb);
		else
			consume_skb(skb);
285 286 287 288
		stats_counter = &stats->n_missed;
		goto out;
	}

289 290 291
	ovs_flow_stats_update(flow, key->tp.flags, skb);
	sf_acts = rcu_dereference(flow->sf_acts);
	ovs_execute_actions(dp, skb, sf_acts, key);
292

293
	stats_counter = &stats->n_hit;
294 295 296

out:
	/* Update datapath statistics. */
297
	u64_stats_update_begin(&stats->syncp);
298
	(*stats_counter)++;
299
	stats->n_mask_hit += n_mask_hit;
300
	u64_stats_update_end(&stats->syncp);
301 302 303
}

int ovs_dp_upcall(struct datapath *dp, struct sk_buff *skb,
304
		  const struct sw_flow_key *key,
305
		  const struct dp_upcall_info *upcall_info)
306 307 308 309
{
	struct dp_stats_percpu *stats;
	int err;

310
	if (upcall_info->portid == 0) {
311 312 313 314 315
		err = -ENOTCONN;
		goto err;
	}

	if (!skb_is_gso(skb))
316
		err = queue_userspace_packet(dp, skb, key, upcall_info);
317
	else
318
		err = queue_gso_packets(dp, skb, key, upcall_info);
319 320 321 322 323 324
	if (err)
		goto err;

	return 0;

err:
325
	stats = this_cpu_ptr(dp->stats_percpu);
326

327
	u64_stats_update_begin(&stats->syncp);
328
	stats->n_lost++;
329
	u64_stats_update_end(&stats->syncp);
330 331 332 333

	return err;
}

334
static int queue_gso_packets(struct datapath *dp, struct sk_buff *skb,
335
			     const struct sw_flow_key *key,
336 337
			     const struct dp_upcall_info *upcall_info)
{
338
	unsigned short gso_type = skb_shinfo(skb)->gso_type;
339 340
	struct sw_flow_key later_key;
	struct sk_buff *segs, *nskb;
341
	struct ovs_skb_cb ovs_cb;
342 343
	int err;

344
	ovs_cb = *OVS_CB(skb);
345
	segs = __skb_gso_segment(skb, NETIF_F_SG, false);
346
	*OVS_CB(skb) = ovs_cb;
347 348
	if (IS_ERR(segs))
		return PTR_ERR(segs);
349 350
	if (segs == NULL)
		return -EINVAL;
351

352 353 354 355 356 357 358 359 360
	if (gso_type & SKB_GSO_UDP) {
		/* The initial flow key extracted by ovs_flow_key_extract()
		 * in this case is for a first fragment, so we need to
		 * properly mark later fragments.
		 */
		later_key = *key;
		later_key.ip.frag = OVS_FRAG_TYPE_LATER;
	}

361 362 363
	/* Queue all of the segments. */
	skb = segs;
	do {
364 365 366 367 368
		*OVS_CB(skb) = ovs_cb;
		if (gso_type & SKB_GSO_UDP && skb != segs)
			key = &later_key;

		err = queue_userspace_packet(dp, skb, key, upcall_info);
369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385
		if (err)
			break;

	} while ((skb = skb->next));

	/* Free all of the segments. */
	skb = segs;
	do {
		nskb = skb->next;
		if (err)
			kfree_skb(skb);
		else
			consume_skb(skb);
	} while ((skb = nskb));
	return err;
}

386
static size_t upcall_msg_size(const struct dp_upcall_info *upcall_info,
387
			      unsigned int hdrlen)
388 389
{
	size_t size = NLMSG_ALIGN(sizeof(struct ovs_header))
390
		+ nla_total_size(hdrlen) /* OVS_PACKET_ATTR_PACKET */
391
		+ nla_total_size(ovs_key_attr_size()); /* OVS_PACKET_ATTR_KEY */
392 393

	/* OVS_PACKET_ATTR_USERDATA */
394 395 396 397 398 399
	if (upcall_info->userdata)
		size += NLA_ALIGN(upcall_info->userdata->nla_len);

	/* OVS_PACKET_ATTR_EGRESS_TUN_KEY */
	if (upcall_info->egress_tun_info)
		size += nla_total_size(ovs_tun_key_attr_size());
400 401 402 403

	return size;
}

404
static int queue_userspace_packet(struct datapath *dp, struct sk_buff *skb,
405
				  const struct sw_flow_key *key,
406 407 408 409
				  const struct dp_upcall_info *upcall_info)
{
	struct ovs_header *upcall;
	struct sk_buff *nskb = NULL;
L
Li RongQing 已提交
410
	struct sk_buff *user_skb = NULL; /* to be queued to userspace */
411
	struct nlattr *nla;
412
	struct genl_info info = {
413
		.dst_sk = ovs_dp_get_net(dp)->genl_sock,
414 415 416
		.snd_portid = upcall_info->portid,
	};
	size_t len;
417
	unsigned int hlen;
418 419 420 421 422
	int err, dp_ifindex;

	dp_ifindex = get_dpifindex(dp);
	if (!dp_ifindex)
		return -ENODEV;
423

424
	if (skb_vlan_tag_present(skb)) {
425 426 427 428
		nskb = skb_clone(skb, GFP_ATOMIC);
		if (!nskb)
			return -ENOMEM;

429
		nskb = __vlan_hwaccel_push_inside(nskb);
430
		if (!nskb)
431 432 433 434 435 436 437 438 439 440
			return -ENOMEM;

		skb = nskb;
	}

	if (nla_attr_size(skb->len) > USHRT_MAX) {
		err = -EFBIG;
		goto out;
	}

441 442 443 444 445 446 447 448 449 450 451 452 453 454
	/* Complete checksum if needed */
	if (skb->ip_summed == CHECKSUM_PARTIAL &&
	    (err = skb_checksum_help(skb)))
		goto out;

	/* Older versions of OVS user space enforce alignment of the last
	 * Netlink attribute to NLA_ALIGNTO which would require extensive
	 * padding logic. Only perform zerocopy if padding is not required.
	 */
	if (dp->user_features & OVS_DP_F_UNALIGNED)
		hlen = skb_zerocopy_headlen(skb);
	else
		hlen = skb->len;

455
	len = upcall_msg_size(upcall_info, hlen);
456
	user_skb = genlmsg_new_unicast(len, &info, GFP_ATOMIC);
457 458 459 460 461 462 463 464 465
	if (!user_skb) {
		err = -ENOMEM;
		goto out;
	}

	upcall = genlmsg_put(user_skb, 0, 0, &dp_packet_genl_family,
			     0, upcall_info->cmd);
	upcall->dp_ifindex = dp_ifindex;

466
	err = ovs_nla_put_key(key, key, OVS_PACKET_ATTR_KEY, false, user_skb);
467
	BUG_ON(err);
468 469

	if (upcall_info->userdata)
470 471 472
		__nla_put(user_skb, OVS_PACKET_ATTR_USERDATA,
			  nla_len(upcall_info->userdata),
			  nla_data(upcall_info->userdata));
473

474 475 476 477 478 479 480 481
	if (upcall_info->egress_tun_info) {
		nla = nla_nest_start(user_skb, OVS_PACKET_ATTR_EGRESS_TUN_KEY);
		err = ovs_nla_put_egress_tunnel_key(user_skb,
						    upcall_info->egress_tun_info);
		BUG_ON(err);
		nla_nest_end(user_skb, nla);
	}

482 483 484 485 486 487 488
	/* Only reserve room for attribute header, packet data is added
	 * in skb_zerocopy() */
	if (!(nla = nla_reserve(user_skb, OVS_PACKET_ATTR_PACKET, 0))) {
		err = -ENOBUFS;
		goto out;
	}
	nla->nla_len = nla_attr_size(skb->len);
489

490 491 492
	err = skb_zerocopy(user_skb, skb, skb->len, hlen);
	if (err)
		goto out;
493

494 495 496 497 498 499 500 501
	/* Pad OVS_PACKET_ATTR_PACKET if linear copy was performed */
	if (!(dp->user_features & OVS_DP_F_UNALIGNED)) {
		size_t plen = NLA_ALIGN(user_skb->len) - user_skb->len;

		if (plen > 0)
			memset(skb_put(user_skb, plen), 0, plen);
	}

502
	((struct nlmsghdr *) user_skb->data)->nlmsg_len = user_skb->len;
503

504
	err = genlmsg_unicast(ovs_dp_get_net(dp), user_skb, upcall_info->portid);
L
Li RongQing 已提交
505
	user_skb = NULL;
506
out:
507 508
	if (err)
		skb_tx_error(skb);
L
Li RongQing 已提交
509
	kfree_skb(user_skb);
510 511 512 513 514 515 516 517 518 519 520
	kfree_skb(nskb);
	return err;
}

static int ovs_packet_cmd_execute(struct sk_buff *skb, struct genl_info *info)
{
	struct ovs_header *ovs_header = info->userhdr;
	struct nlattr **a = info->attrs;
	struct sw_flow_actions *acts;
	struct sk_buff *packet;
	struct sw_flow *flow;
521
	struct sw_flow_actions *sf_acts;
522 523
	struct datapath *dp;
	struct ethhdr *eth;
524
	struct vport *input_vport;
525 526
	int len;
	int err;
527
	bool log = !a[OVS_PACKET_ATTR_PROBE];
528 529 530

	err = -EINVAL;
	if (!a[OVS_PACKET_ATTR_PACKET] || !a[OVS_PACKET_ATTR_KEY] ||
531
	    !a[OVS_PACKET_ATTR_ACTIONS])
532 533 534 535 536 537 538 539 540
		goto err;

	len = nla_len(a[OVS_PACKET_ATTR_PACKET]);
	packet = __dev_alloc_skb(NET_IP_ALIGN + len, GFP_KERNEL);
	err = -ENOMEM;
	if (!packet)
		goto err;
	skb_reserve(packet, NET_IP_ALIGN);

541
	nla_memcpy(__skb_put(packet, len), a[OVS_PACKET_ATTR_PACKET], len);
542 543 544 545 546 547 548

	skb_reset_mac_header(packet);
	eth = eth_hdr(packet);

	/* Normally, setting the skb 'protocol' field would be handled by a
	 * call to eth_type_trans(), but it assumes there's a sending
	 * device, which we may not have. */
S
Simon Horman 已提交
549
	if (ntohs(eth->h_proto) >= ETH_P_802_3_MIN)
550 551 552 553 554
		packet->protocol = eth->h_proto;
	else
		packet->protocol = htons(ETH_P_802_2);

	/* Build an sw_flow for sending this packet. */
555
	flow = ovs_flow_alloc();
556 557 558 559
	err = PTR_ERR(flow);
	if (IS_ERR(flow))
		goto err_kfree_skb;

560
	err = ovs_flow_key_extract_userspace(a[OVS_PACKET_ATTR_KEY], packet,
561
					     &flow->key, log);
562 563 564
	if (err)
		goto err_flow_free;

565
	err = ovs_nla_copy_actions(a[OVS_PACKET_ATTR_ACTIONS],
566
				   &flow->key, &acts, log);
567 568
	if (err)
		goto err_flow_free;
569

570 571
	rcu_assign_pointer(flow->sf_acts, acts);
	OVS_CB(packet)->egress_tun_info = NULL;
572
	packet->priority = flow->key.phy.priority;
573
	packet->mark = flow->key.phy.skb_mark;
574 575

	rcu_read_lock();
576
	dp = get_dp_rcu(sock_net(skb->sk), ovs_header->dp_ifindex);
577 578 579 580
	err = -ENODEV;
	if (!dp)
		goto err_unlock;

581 582 583 584 585 586 587 588
	input_vport = ovs_vport_rcu(dp, flow->key.phy.in_port);
	if (!input_vport)
		input_vport = ovs_vport_rcu(dp, OVSP_LOCAL);

	if (!input_vport)
		goto err_unlock;

	OVS_CB(packet)->input_vport = input_vport;
589
	sf_acts = rcu_dereference(flow->sf_acts);
590

591
	local_bh_disable();
592
	err = ovs_execute_actions(dp, packet, sf_acts, &flow->key);
593 594 595
	local_bh_enable();
	rcu_read_unlock();

596
	ovs_flow_free(flow, false);
597 598 599 600 601
	return err;

err_unlock:
	rcu_read_unlock();
err_flow_free:
602
	ovs_flow_free(flow, false);
603 604 605 606 607 608 609
err_kfree_skb:
	kfree_skb(packet);
err:
	return err;
}

static const struct nla_policy packet_policy[OVS_PACKET_ATTR_MAX + 1] = {
610
	[OVS_PACKET_ATTR_PACKET] = { .len = ETH_HLEN },
611 612
	[OVS_PACKET_ATTR_KEY] = { .type = NLA_NESTED },
	[OVS_PACKET_ATTR_ACTIONS] = { .type = NLA_NESTED },
613
	[OVS_PACKET_ATTR_PROBE] = { .type = NLA_FLAG },
614 615
};

616
static const struct genl_ops dp_packet_genl_ops[] = {
617 618 619 620 621 622 623
	{ .cmd = OVS_PACKET_CMD_EXECUTE,
	  .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
	  .policy = packet_policy,
	  .doit = ovs_packet_cmd_execute
	}
};

624 625 626 627 628 629 630 631 632 633 634 635
static struct genl_family dp_packet_genl_family = {
	.id = GENL_ID_GENERATE,
	.hdrsize = sizeof(struct ovs_header),
	.name = OVS_PACKET_FAMILY,
	.version = OVS_PACKET_VERSION,
	.maxattr = OVS_PACKET_ATTR_MAX,
	.netnsok = true,
	.parallel_ops = true,
	.ops = dp_packet_genl_ops,
	.n_ops = ARRAY_SIZE(dp_packet_genl_ops),
};

636
static void get_dp_stats(const struct datapath *dp, struct ovs_dp_stats *stats,
637
			 struct ovs_dp_megaflow_stats *mega_stats)
638 639 640
{
	int i;

641 642
	memset(mega_stats, 0, sizeof(*mega_stats));

643
	stats->n_flows = ovs_flow_tbl_count(&dp->table);
644
	mega_stats->n_masks = ovs_flow_tbl_num_masks(&dp->table);
645 646

	stats->n_hit = stats->n_missed = stats->n_lost = 0;
647

648 649 650 651 652 653 654 655
	for_each_possible_cpu(i) {
		const struct dp_stats_percpu *percpu_stats;
		struct dp_stats_percpu local_stats;
		unsigned int start;

		percpu_stats = per_cpu_ptr(dp->stats_percpu, i);

		do {
656
			start = u64_stats_fetch_begin_irq(&percpu_stats->syncp);
657
			local_stats = *percpu_stats;
658
		} while (u64_stats_fetch_retry_irq(&percpu_stats->syncp, start));
659 660 661 662

		stats->n_hit += local_stats.n_hit;
		stats->n_missed += local_stats.n_missed;
		stats->n_lost += local_stats.n_lost;
663
		mega_stats->n_mask_hit += local_stats.n_mask_hit;
664 665 666
	}
}

667 668 669 670 671 672 673 674 675 676 677 678
static bool should_fill_key(const struct sw_flow_id *sfid, uint32_t ufid_flags)
{
	return ovs_identifier_is_ufid(sfid) &&
	       !(ufid_flags & OVS_UFID_F_OMIT_KEY);
}

static bool should_fill_mask(uint32_t ufid_flags)
{
	return !(ufid_flags & OVS_UFID_F_OMIT_MASK);
}

static bool should_fill_actions(uint32_t ufid_flags)
679
{
680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705
	return !(ufid_flags & OVS_UFID_F_OMIT_ACTIONS);
}

static size_t ovs_flow_cmd_msg_size(const struct sw_flow_actions *acts,
				    const struct sw_flow_id *sfid,
				    uint32_t ufid_flags)
{
	size_t len = NLMSG_ALIGN(sizeof(struct ovs_header));

	/* OVS_FLOW_ATTR_UFID */
	if (sfid && ovs_identifier_is_ufid(sfid))
		len += nla_total_size(sfid->ufid_len);

	/* OVS_FLOW_ATTR_KEY */
	if (!sfid || should_fill_key(sfid, ufid_flags))
		len += nla_total_size(ovs_key_attr_size());

	/* OVS_FLOW_ATTR_MASK */
	if (should_fill_mask(ufid_flags))
		len += nla_total_size(ovs_key_attr_size());

	/* OVS_FLOW_ATTR_ACTIONS */
	if (should_fill_actions(ufid_flags))
		len += nla_total_size(acts->actions_len);

	return len
706 707
		+ nla_total_size(sizeof(struct ovs_flow_stats)) /* OVS_FLOW_ATTR_STATS */
		+ nla_total_size(1) /* OVS_FLOW_ATTR_TCP_FLAGS */
708
		+ nla_total_size(8); /* OVS_FLOW_ATTR_USED */
709 710
}

711 712 713 714 715 716 717
/* Called with ovs_mutex or RCU read lock. */
static int ovs_flow_cmd_fill_stats(const struct sw_flow *flow,
				   struct sk_buff *skb)
{
	struct ovs_flow_stats stats;
	__be16 tcp_flags;
	unsigned long used;
718

719
	ovs_flow_stats_get(flow, &stats, &used, &tcp_flags);
720

721 722
	if (used &&
	    nla_put_u64(skb, OVS_FLOW_ATTR_USED, ovs_flow_used_time(used)))
723
		return -EMSGSIZE;
724

725
	if (stats.n_packets &&
726
	    nla_put(skb, OVS_FLOW_ATTR_STATS, sizeof(struct ovs_flow_stats), &stats))
727
		return -EMSGSIZE;
728

729 730
	if ((u8)ntohs(tcp_flags) &&
	     nla_put_u8(skb, OVS_FLOW_ATTR_TCP_FLAGS, (u8)ntohs(tcp_flags)))
731 732 733 734 735 736 737 738 739 740 741
		return -EMSGSIZE;

	return 0;
}

/* Called with ovs_mutex or RCU read lock. */
static int ovs_flow_cmd_fill_actions(const struct sw_flow *flow,
				     struct sk_buff *skb, int skb_orig_len)
{
	struct nlattr *start;
	int err;
742 743 744 745 746 747 748 749 750 751 752

	/* If OVS_FLOW_ATTR_ACTIONS doesn't fit, skip dumping the actions if
	 * this is the first flow to be dumped into 'skb'.  This is unusual for
	 * Netlink but individual action lists can be longer than
	 * NLMSG_GOODSIZE and thus entirely undumpable if we didn't do this.
	 * The userspace caller can always fetch the actions separately if it
	 * really wants them.  (Most userspace callers in fact don't care.)
	 *
	 * This can only fail for dump operations because the skb is always
	 * properly sized for single flows.
	 */
753 754
	start = nla_nest_start(skb, OVS_FLOW_ATTR_ACTIONS);
	if (start) {
755 756
		const struct sw_flow_actions *sf_acts;

757
		sf_acts = rcu_dereference_ovsl(flow->sf_acts);
758 759
		err = ovs_nla_put_actions(sf_acts->actions,
					  sf_acts->actions_len, skb);
760

761 762 763 764
		if (!err)
			nla_nest_end(skb, start);
		else {
			if (skb_orig_len)
765
				return err;
766 767 768

			nla_nest_cancel(skb, start);
		}
769 770 771 772 773 774 775 776 777 778
	} else if (skb_orig_len) {
		return -EMSGSIZE;
	}

	return 0;
}

/* Called with ovs_mutex or RCU read lock. */
static int ovs_flow_cmd_fill_info(const struct sw_flow *flow, int dp_ifindex,
				  struct sk_buff *skb, u32 portid,
779
				  u32 seq, u32 flags, u8 cmd, u32 ufid_flags)
780 781 782 783 784 785 786 787 788 789 790 791
{
	const int skb_orig_len = skb->len;
	struct ovs_header *ovs_header;
	int err;

	ovs_header = genlmsg_put(skb, portid, seq, &dp_flow_genl_family,
				 flags, cmd);
	if (!ovs_header)
		return -EMSGSIZE;

	ovs_header->dp_ifindex = dp_ifindex;

792
	err = ovs_nla_put_identifier(flow, skb);
793 794 795
	if (err)
		goto error;

796 797 798 799 800 801 802 803 804 805 806
	if (should_fill_key(&flow->id, ufid_flags)) {
		err = ovs_nla_put_masked_key(flow, skb);
		if (err)
			goto error;
	}

	if (should_fill_mask(ufid_flags)) {
		err = ovs_nla_put_mask(flow, skb);
		if (err)
			goto error;
	}
807 808 809 810 811

	err = ovs_flow_cmd_fill_stats(flow, skb);
	if (err)
		goto error;

812 813 814 815 816
	if (should_fill_actions(ufid_flags)) {
		err = ovs_flow_cmd_fill_actions(flow, skb, skb_orig_len);
		if (err)
			goto error;
	}
817

818 819
	genlmsg_end(skb, ovs_header);
	return 0;
820 821 822 823 824 825

error:
	genlmsg_cancel(skb, ovs_header);
	return err;
}

826 827
/* May not be called with RCU read lock. */
static struct sk_buff *ovs_flow_cmd_alloc_info(const struct sw_flow_actions *acts,
828
					       const struct sw_flow_id *sfid,
829
					       struct genl_info *info,
830 831
					       bool always,
					       uint32_t ufid_flags)
832
{
833
	struct sk_buff *skb;
834
	size_t len;
835

836
	if (!always && !ovs_must_notify(&dp_flow_genl_family, info, 0))
837 838
		return NULL;

839 840
	len = ovs_flow_cmd_msg_size(acts, sfid, ufid_flags);
	skb = genlmsg_new_unicast(len, info, GFP_KERNEL);
841 842 843 844
	if (!skb)
		return ERR_PTR(-ENOMEM);

	return skb;
845 846
}

847 848 849 850
/* Called with ovs_mutex. */
static struct sk_buff *ovs_flow_cmd_build_info(const struct sw_flow *flow,
					       int dp_ifindex,
					       struct genl_info *info, u8 cmd,
851
					       bool always, u32 ufid_flags)
852 853 854 855
{
	struct sk_buff *skb;
	int retval;

856 857
	skb = ovs_flow_cmd_alloc_info(ovsl_dereference(flow->sf_acts),
				      &flow->id, info, always, ufid_flags);
858
	if (IS_ERR_OR_NULL(skb))
859
		return skb;
860

861 862
	retval = ovs_flow_cmd_fill_info(flow, dp_ifindex, skb,
					info->snd_portid, info->snd_seq, 0,
863
					cmd, ufid_flags);
864 865 866 867
	BUG_ON(retval < 0);
	return skb;
}

868
static int ovs_flow_cmd_new(struct sk_buff *skb, struct genl_info *info)
869 870 871
{
	struct nlattr **a = info->attrs;
	struct ovs_header *ovs_header = info->userhdr;
872
	struct sw_flow *flow = NULL, *new_flow;
873
	struct sw_flow_mask mask;
874 875
	struct sk_buff *reply;
	struct datapath *dp;
876
	struct sw_flow_key key;
877
	struct sw_flow_actions *acts;
878
	struct sw_flow_match match;
879
	u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
880
	int error;
881
	bool log = !a[OVS_FLOW_ATTR_PROBE];
882

883
	/* Must have key and actions. */
884
	error = -EINVAL;
885
	if (!a[OVS_FLOW_ATTR_KEY]) {
886
		OVS_NLERR(log, "Flow key attr not present in new flow.");
887
		goto error;
888 889
	}
	if (!a[OVS_FLOW_ATTR_ACTIONS]) {
890
		OVS_NLERR(log, "Flow actions attr not present in new flow.");
891
		goto error;
892
	}
893

894 895 896 897 898 899 900 901 902 903
	/* Most of the time we need to allocate a new flow, do it before
	 * locking.
	 */
	new_flow = ovs_flow_alloc();
	if (IS_ERR(new_flow)) {
		error = PTR_ERR(new_flow);
		goto error;
	}

	/* Extract key. */
904
	ovs_match_init(&match, &key, &mask);
905 906
	error = ovs_nla_get_match(&match, a[OVS_FLOW_ATTR_KEY],
				  a[OVS_FLOW_ATTR_MASK], log);
907
	if (error)
908
		goto err_kfree_flow;
909

910 911 912 913 914 915 916
	ovs_flow_mask_key(&new_flow->key, &key, &mask);

	/* Extract flow identifier. */
	error = ovs_nla_get_identifier(&new_flow->id, a[OVS_FLOW_ATTR_UFID],
				       &key, log);
	if (error)
		goto err_kfree_flow;
917

918 919
	/* Validate actions. */
	error = ovs_nla_copy_actions(a[OVS_FLOW_ATTR_ACTIONS], &new_flow->key,
920
				     &acts, log);
921
	if (error) {
922
		OVS_NLERR(log, "Flow actions may not be safe on all matching packets.");
923
		goto err_kfree_flow;
924 925
	}

926 927
	reply = ovs_flow_cmd_alloc_info(acts, &new_flow->id, info, false,
					ufid_flags);
928 929 930
	if (IS_ERR(reply)) {
		error = PTR_ERR(reply);
		goto err_kfree_acts;
931 932
	}

933
	ovs_lock();
934
	dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
935 936
	if (unlikely(!dp)) {
		error = -ENODEV;
937
		goto err_unlock_ovs;
938
	}
939

940
	/* Check if this is a duplicate flow */
941 942 943 944
	if (ovs_identifier_is_ufid(&new_flow->id))
		flow = ovs_flow_tbl_lookup_ufid(&dp->table, &new_flow->id);
	if (!flow)
		flow = ovs_flow_tbl_lookup(&dp->table, &key);
945 946
	if (likely(!flow)) {
		rcu_assign_pointer(new_flow->sf_acts, acts);
947 948

		/* Put flow in bucket. */
949 950
		error = ovs_flow_tbl_insert(&dp->table, new_flow, &mask);
		if (unlikely(error)) {
951
			acts = NULL;
952 953 954 955 956 957 958 959
			goto err_unlock_ovs;
		}

		if (unlikely(reply)) {
			error = ovs_flow_cmd_fill_info(new_flow,
						       ovs_header->dp_ifindex,
						       reply, info->snd_portid,
						       info->snd_seq, 0,
960 961
						       OVS_FLOW_CMD_NEW,
						       ufid_flags);
962
			BUG_ON(error < 0);
963
		}
964
		ovs_unlock();
965
	} else {
966 967
		struct sw_flow_actions *old_acts;

968 969 970 971 972 973
		/* Bail out if we're not allowed to modify an existing flow.
		 * We accept NLM_F_CREATE in place of the intended NLM_F_EXCL
		 * because Generic Netlink treats the latter as a dump
		 * request.  We also accept NLM_F_EXCL in case that bug ever
		 * gets fixed.
		 */
974 975 976
		if (unlikely(info->nlhdr->nlmsg_flags & (NLM_F_CREATE
							 | NLM_F_EXCL))) {
			error = -EEXIST;
977
			goto err_unlock_ovs;
978
		}
979 980 981 982 983 984 985 986 987
		/* The flow identifier has to be the same for flow updates.
		 * Look for any overlapping flow.
		 */
		if (unlikely(!ovs_flow_cmp(flow, &match))) {
			if (ovs_identifier_is_key(&flow->id))
				flow = ovs_flow_tbl_lookup_exact(&dp->table,
								 &match);
			else /* UFID matches but key is different */
				flow = NULL;
988 989 990 991
			if (!flow) {
				error = -ENOENT;
				goto err_unlock_ovs;
			}
992
		}
993 994 995 996
		/* Update actions. */
		old_acts = ovsl_dereference(flow->sf_acts);
		rcu_assign_pointer(flow->sf_acts, acts);

997 998 999 1000 1001
		if (unlikely(reply)) {
			error = ovs_flow_cmd_fill_info(flow,
						       ovs_header->dp_ifindex,
						       reply, info->snd_portid,
						       info->snd_seq, 0,
1002 1003
						       OVS_FLOW_CMD_NEW,
						       ufid_flags);
1004 1005 1006
			BUG_ON(error < 0);
		}
		ovs_unlock();
1007

1008 1009
		ovs_nla_free_flow_actions(old_acts);
		ovs_flow_free(new_flow, false);
1010
	}
1011 1012 1013

	if (reply)
		ovs_notify(&dp_flow_genl_family, reply, info);
1014 1015 1016 1017
	return 0;

err_unlock_ovs:
	ovs_unlock();
1018 1019
	kfree_skb(reply);
err_kfree_acts:
1020
	kfree(acts);
1021 1022
err_kfree_flow:
	ovs_flow_free(new_flow, false);
1023 1024 1025
error:
	return error;
}
1026

1027
/* Factor out action copy to avoid "Wframe-larger-than=1024" warning. */
1028 1029
static struct sw_flow_actions *get_flow_actions(const struct nlattr *a,
						const struct sw_flow_key *key,
1030 1031
						const struct sw_flow_mask *mask,
						bool log)
1032 1033 1034 1035 1036 1037
{
	struct sw_flow_actions *acts;
	struct sw_flow_key masked_key;
	int error;

	ovs_flow_mask_key(&masked_key, key, mask);
1038
	error = ovs_nla_copy_actions(a, &masked_key, &acts, log);
1039
	if (error) {
1040 1041
		OVS_NLERR(log,
			  "Actions may not be safe on all matching packets");
1042 1043 1044 1045 1046 1047
		return ERR_PTR(error);
	}

	return acts;
}

1048 1049 1050 1051
static int ovs_flow_cmd_set(struct sk_buff *skb, struct genl_info *info)
{
	struct nlattr **a = info->attrs;
	struct ovs_header *ovs_header = info->userhdr;
1052
	struct sw_flow_key key;
1053 1054 1055 1056
	struct sw_flow *flow;
	struct sw_flow_mask mask;
	struct sk_buff *reply = NULL;
	struct datapath *dp;
1057
	struct sw_flow_actions *old_acts = NULL, *acts = NULL;
1058
	struct sw_flow_match match;
1059 1060
	struct sw_flow_id sfid;
	u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
1061
	int error;
1062
	bool log = !a[OVS_FLOW_ATTR_PROBE];
1063
	bool ufid_present;
1064 1065 1066

	/* Extract key. */
	error = -EINVAL;
1067
	if (!a[OVS_FLOW_ATTR_KEY]) {
1068
		OVS_NLERR(log, "Flow key attribute not present in set flow.");
1069
		goto error;
1070
	}
1071

1072
	ufid_present = ovs_nla_get_ufid(&sfid, a[OVS_FLOW_ATTR_UFID], log);
1073
	ovs_match_init(&match, &key, &mask);
1074 1075
	error = ovs_nla_get_match(&match, a[OVS_FLOW_ATTR_KEY],
				  a[OVS_FLOW_ATTR_MASK], log);
1076 1077 1078 1079 1080
	if (error)
		goto error;

	/* Validate actions. */
	if (a[OVS_FLOW_ATTR_ACTIONS]) {
1081 1082
		acts = get_flow_actions(a[OVS_FLOW_ATTR_ACTIONS], &key, &mask,
					log);
1083 1084
		if (IS_ERR(acts)) {
			error = PTR_ERR(acts);
1085
			goto error;
1086 1087
		}

1088
		/* Can allocate before locking if have acts. */
1089 1090
		reply = ovs_flow_cmd_alloc_info(acts, &sfid, info, false,
						ufid_flags);
1091 1092 1093
		if (IS_ERR(reply)) {
			error = PTR_ERR(reply);
			goto err_kfree_acts;
1094
		}
1095
	}
1096

1097 1098
	ovs_lock();
	dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1099 1100
	if (unlikely(!dp)) {
		error = -ENODEV;
1101
		goto err_unlock_ovs;
1102
	}
1103
	/* Check that the flow exists. */
1104 1105 1106 1107
	if (ufid_present)
		flow = ovs_flow_tbl_lookup_ufid(&dp->table, &sfid);
	else
		flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
1108 1109
	if (unlikely(!flow)) {
		error = -ENOENT;
1110
		goto err_unlock_ovs;
1111
	}
1112

1113
	/* Update actions, if present. */
1114
	if (likely(acts)) {
1115 1116
		old_acts = ovsl_dereference(flow->sf_acts);
		rcu_assign_pointer(flow->sf_acts, acts);
1117 1118 1119 1120 1121 1122

		if (unlikely(reply)) {
			error = ovs_flow_cmd_fill_info(flow,
						       ovs_header->dp_ifindex,
						       reply, info->snd_portid,
						       info->snd_seq, 0,
1123 1124
						       OVS_FLOW_CMD_NEW,
						       ufid_flags);
1125 1126 1127 1128 1129
			BUG_ON(error < 0);
		}
	} else {
		/* Could not alloc without acts before locking. */
		reply = ovs_flow_cmd_build_info(flow, ovs_header->dp_ifindex,
1130 1131 1132
						info, OVS_FLOW_CMD_NEW, false,
						ufid_flags);

1133 1134 1135 1136
		if (unlikely(IS_ERR(reply))) {
			error = PTR_ERR(reply);
			goto err_unlock_ovs;
		}
1137
	}
1138 1139 1140 1141

	/* Clear stats. */
	if (a[OVS_FLOW_ATTR_CLEAR])
		ovs_flow_stats_clear(flow);
1142
	ovs_unlock();
1143

1144 1145 1146 1147
	if (reply)
		ovs_notify(&dp_flow_genl_family, reply, info);
	if (old_acts)
		ovs_nla_free_flow_actions(old_acts);
1148

1149 1150
	return 0;

1151 1152
err_unlock_ovs:
	ovs_unlock();
1153 1154
	kfree_skb(reply);
err_kfree_acts:
1155
	kfree(acts);
1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167
error:
	return error;
}

static int ovs_flow_cmd_get(struct sk_buff *skb, struct genl_info *info)
{
	struct nlattr **a = info->attrs;
	struct ovs_header *ovs_header = info->userhdr;
	struct sw_flow_key key;
	struct sk_buff *reply;
	struct sw_flow *flow;
	struct datapath *dp;
1168
	struct sw_flow_match match;
1169 1170 1171
	struct sw_flow_id ufid;
	u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
	int err = 0;
1172
	bool log = !a[OVS_FLOW_ATTR_PROBE];
1173
	bool ufid_present;
1174

1175 1176 1177 1178 1179 1180
	ufid_present = ovs_nla_get_ufid(&ufid, a[OVS_FLOW_ATTR_UFID], log);
	if (a[OVS_FLOW_ATTR_KEY]) {
		ovs_match_init(&match, &key, NULL);
		err = ovs_nla_get_match(&match, a[OVS_FLOW_ATTR_KEY], NULL,
					log);
	} else if (!ufid_present) {
1181 1182
		OVS_NLERR(log,
			  "Flow get message rejected, Key attribute missing.");
1183
		err = -EINVAL;
1184
	}
1185 1186 1187
	if (err)
		return err;

1188
	ovs_lock();
1189
	dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1190 1191 1192 1193
	if (!dp) {
		err = -ENODEV;
		goto unlock;
	}
1194

1195 1196 1197 1198
	if (ufid_present)
		flow = ovs_flow_tbl_lookup_ufid(&dp->table, &ufid);
	else
		flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
1199
	if (!flow) {
1200 1201 1202
		err = -ENOENT;
		goto unlock;
	}
1203

1204
	reply = ovs_flow_cmd_build_info(flow, ovs_header->dp_ifindex, info,
1205
					OVS_FLOW_CMD_NEW, true, ufid_flags);
1206 1207 1208 1209
	if (IS_ERR(reply)) {
		err = PTR_ERR(reply);
		goto unlock;
	}
1210

1211
	ovs_unlock();
1212
	return genlmsg_reply(reply, info);
1213 1214 1215
unlock:
	ovs_unlock();
	return err;
1216 1217 1218 1219 1220 1221 1222 1223
}

static int ovs_flow_cmd_del(struct sk_buff *skb, struct genl_info *info)
{
	struct nlattr **a = info->attrs;
	struct ovs_header *ovs_header = info->userhdr;
	struct sw_flow_key key;
	struct sk_buff *reply;
1224
	struct sw_flow *flow = NULL;
1225
	struct datapath *dp;
1226
	struct sw_flow_match match;
1227 1228
	struct sw_flow_id ufid;
	u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
1229
	int err;
1230
	bool log = !a[OVS_FLOW_ATTR_PROBE];
1231
	bool ufid_present;
1232

1233 1234
	ufid_present = ovs_nla_get_ufid(&ufid, a[OVS_FLOW_ATTR_UFID], log);
	if (a[OVS_FLOW_ATTR_KEY]) {
1235
		ovs_match_init(&match, &key, NULL);
1236 1237
		err = ovs_nla_get_match(&match, a[OVS_FLOW_ATTR_KEY], NULL,
					log);
1238 1239 1240 1241
		if (unlikely(err))
			return err;
	}

1242
	ovs_lock();
1243
	dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1244
	if (unlikely(!dp)) {
1245 1246 1247
		err = -ENODEV;
		goto unlock;
	}
1248

1249
	if (unlikely(!a[OVS_FLOW_ATTR_KEY] && !ufid_present)) {
1250
		err = ovs_flow_tbl_flush(&dp->table);
1251 1252
		goto unlock;
	}
1253

1254 1255 1256 1257
	if (ufid_present)
		flow = ovs_flow_tbl_lookup_ufid(&dp->table, &ufid);
	else
		flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
1258
	if (unlikely(!flow)) {
1259 1260 1261
		err = -ENOENT;
		goto unlock;
	}
1262

1263
	ovs_flow_tbl_remove(&dp->table, flow);
1264
	ovs_unlock();
1265

1266
	reply = ovs_flow_cmd_alloc_info((const struct sw_flow_actions __force *) flow->sf_acts,
1267
					&flow->id, info, false, ufid_flags);
1268 1269 1270 1271 1272 1273
	if (likely(reply)) {
		if (likely(!IS_ERR(reply))) {
			rcu_read_lock();	/*To keep RCU checker happy. */
			err = ovs_flow_cmd_fill_info(flow, ovs_header->dp_ifindex,
						     reply, info->snd_portid,
						     info->snd_seq, 0,
1274 1275
						     OVS_FLOW_CMD_DEL,
						     ufid_flags);
1276 1277 1278 1279 1280 1281 1282
			rcu_read_unlock();
			BUG_ON(err < 0);

			ovs_notify(&dp_flow_genl_family, reply, info);
		} else {
			netlink_set_err(sock_net(skb->sk)->genl_sock, 0, 0, PTR_ERR(reply));
		}
1283
	}
1284

1285
	ovs_flow_free(flow, true);
1286
	return 0;
1287 1288 1289
unlock:
	ovs_unlock();
	return err;
1290 1291 1292 1293
}

static int ovs_flow_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
1294
	struct nlattr *a[__OVS_FLOW_ATTR_MAX];
1295
	struct ovs_header *ovs_header = genlmsg_data(nlmsg_data(cb->nlh));
1296
	struct table_instance *ti;
1297
	struct datapath *dp;
1298 1299 1300 1301 1302 1303 1304 1305
	u32 ufid_flags;
	int err;

	err = genlmsg_parse(cb->nlh, &dp_flow_genl_family, a,
			    OVS_FLOW_ATTR_MAX, flow_policy);
	if (err)
		return err;
	ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
1306

1307
	rcu_read_lock();
1308
	dp = get_dp_rcu(sock_net(skb->sk), ovs_header->dp_ifindex);
1309
	if (!dp) {
1310
		rcu_read_unlock();
1311
		return -ENODEV;
1312
	}
1313

1314
	ti = rcu_dereference(dp->table.ti);
1315 1316 1317 1318 1319 1320
	for (;;) {
		struct sw_flow *flow;
		u32 bucket, obj;

		bucket = cb->args[0];
		obj = cb->args[1];
1321
		flow = ovs_flow_tbl_dump_next(ti, &bucket, &obj);
1322 1323 1324
		if (!flow)
			break;

1325
		if (ovs_flow_cmd_fill_info(flow, ovs_header->dp_ifindex, skb,
1326
					   NETLINK_CB(cb->skb).portid,
1327
					   cb->nlh->nlmsg_seq, NLM_F_MULTI,
1328
					   OVS_FLOW_CMD_NEW, ufid_flags) < 0)
1329 1330 1331 1332 1333
			break;

		cb->args[0] = bucket;
		cb->args[1] = obj;
	}
1334
	rcu_read_unlock();
1335 1336 1337
	return skb->len;
}

1338 1339
static const struct nla_policy flow_policy[OVS_FLOW_ATTR_MAX + 1] = {
	[OVS_FLOW_ATTR_KEY] = { .type = NLA_NESTED },
1340
	[OVS_FLOW_ATTR_MASK] = { .type = NLA_NESTED },
1341 1342
	[OVS_FLOW_ATTR_ACTIONS] = { .type = NLA_NESTED },
	[OVS_FLOW_ATTR_CLEAR] = { .type = NLA_FLAG },
1343
	[OVS_FLOW_ATTR_PROBE] = { .type = NLA_FLAG },
1344 1345
	[OVS_FLOW_ATTR_UFID] = { .type = NLA_UNSPEC, .len = 1 },
	[OVS_FLOW_ATTR_UFID_FLAGS] = { .type = NLA_U32 },
1346 1347
};

1348
static const struct genl_ops dp_flow_genl_ops[] = {
1349 1350 1351
	{ .cmd = OVS_FLOW_CMD_NEW,
	  .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
	  .policy = flow_policy,
1352
	  .doit = ovs_flow_cmd_new
1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367
	},
	{ .cmd = OVS_FLOW_CMD_DEL,
	  .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
	  .policy = flow_policy,
	  .doit = ovs_flow_cmd_del
	},
	{ .cmd = OVS_FLOW_CMD_GET,
	  .flags = 0,		    /* OK for unprivileged users. */
	  .policy = flow_policy,
	  .doit = ovs_flow_cmd_get,
	  .dumpit = ovs_flow_cmd_dump
	},
	{ .cmd = OVS_FLOW_CMD_SET,
	  .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
	  .policy = flow_policy,
1368
	  .doit = ovs_flow_cmd_set,
1369 1370 1371
	},
};

1372
static struct genl_family dp_flow_genl_family = {
1373 1374
	.id = GENL_ID_GENERATE,
	.hdrsize = sizeof(struct ovs_header),
1375 1376 1377
	.name = OVS_FLOW_FAMILY,
	.version = OVS_FLOW_VERSION,
	.maxattr = OVS_FLOW_ATTR_MAX,
1378 1379
	.netnsok = true,
	.parallel_ops = true,
1380 1381 1382 1383
	.ops = dp_flow_genl_ops,
	.n_ops = ARRAY_SIZE(dp_flow_genl_ops),
	.mcgrps = &ovs_dp_flow_multicast_group,
	.n_mcgrps = 1,
1384 1385
};

1386 1387 1388 1389 1390 1391
static size_t ovs_dp_cmd_msg_size(void)
{
	size_t msgsize = NLMSG_ALIGN(sizeof(struct ovs_header));

	msgsize += nla_total_size(IFNAMSIZ);
	msgsize += nla_total_size(sizeof(struct ovs_dp_stats));
1392
	msgsize += nla_total_size(sizeof(struct ovs_dp_megaflow_stats));
1393
	msgsize += nla_total_size(sizeof(u32)); /* OVS_DP_ATTR_USER_FEATURES */
1394 1395 1396 1397

	return msgsize;
}

1398
/* Called with ovs_mutex. */
1399
static int ovs_dp_cmd_fill_info(struct datapath *dp, struct sk_buff *skb,
1400
				u32 portid, u32 seq, u32 flags, u8 cmd)
1401 1402 1403
{
	struct ovs_header *ovs_header;
	struct ovs_dp_stats dp_stats;
1404
	struct ovs_dp_megaflow_stats dp_megaflow_stats;
1405 1406
	int err;

1407
	ovs_header = genlmsg_put(skb, portid, seq, &dp_datapath_genl_family,
1408 1409 1410 1411 1412 1413 1414 1415 1416 1417
				   flags, cmd);
	if (!ovs_header)
		goto error;

	ovs_header->dp_ifindex = get_dpifindex(dp);

	err = nla_put_string(skb, OVS_DP_ATTR_NAME, ovs_dp_name(dp));
	if (err)
		goto nla_put_failure;

1418 1419 1420 1421 1422 1423 1424 1425
	get_dp_stats(dp, &dp_stats, &dp_megaflow_stats);
	if (nla_put(skb, OVS_DP_ATTR_STATS, sizeof(struct ovs_dp_stats),
			&dp_stats))
		goto nla_put_failure;

	if (nla_put(skb, OVS_DP_ATTR_MEGAFLOW_STATS,
			sizeof(struct ovs_dp_megaflow_stats),
			&dp_megaflow_stats))
1426
		goto nla_put_failure;
1427

1428 1429 1430
	if (nla_put_u32(skb, OVS_DP_ATTR_USER_FEATURES, dp->user_features))
		goto nla_put_failure;

1431 1432
	genlmsg_end(skb, ovs_header);
	return 0;
1433 1434 1435 1436 1437 1438 1439

nla_put_failure:
	genlmsg_cancel(skb, ovs_header);
error:
	return -EMSGSIZE;
}

1440
static struct sk_buff *ovs_dp_cmd_alloc_info(struct genl_info *info)
1441
{
1442
	return genlmsg_new_unicast(ovs_dp_cmd_msg_size(), info, GFP_KERNEL);
1443 1444
}

J
Jarno Rajahalme 已提交
1445
/* Called with rcu_read_lock or ovs_mutex. */
1446
static struct datapath *lookup_datapath(struct net *net,
1447
					const struct ovs_header *ovs_header,
1448 1449 1450 1451 1452
					struct nlattr *a[OVS_DP_ATTR_MAX + 1])
{
	struct datapath *dp;

	if (!a[OVS_DP_ATTR_NAME])
1453
		dp = get_dp(net, ovs_header->dp_ifindex);
1454 1455 1456
	else {
		struct vport *vport;

1457
		vport = ovs_vport_locate(net, nla_data(a[OVS_DP_ATTR_NAME]));
1458 1459 1460 1461 1462
		dp = vport && vport->port_no == OVSP_LOCAL ? vport->dp : NULL;
	}
	return dp ? dp : ERR_PTR(-ENODEV);
}

1463 1464 1465 1466 1467
static void ovs_dp_reset_user_features(struct sk_buff *skb, struct genl_info *info)
{
	struct datapath *dp;

	dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1468
	if (IS_ERR(dp))
1469 1470 1471 1472 1473 1474
		return;

	WARN(dp->user_features, "Dropping previously announced user features\n");
	dp->user_features = 0;
}

1475
static void ovs_dp_change(struct datapath *dp, struct nlattr *a[])
1476 1477 1478 1479 1480
{
	if (a[OVS_DP_ATTR_USER_FEATURES])
		dp->user_features = nla_get_u32(a[OVS_DP_ATTR_USER_FEATURES]);
}

1481 1482 1483 1484 1485 1486 1487
static int ovs_dp_cmd_new(struct sk_buff *skb, struct genl_info *info)
{
	struct nlattr **a = info->attrs;
	struct vport_parms parms;
	struct sk_buff *reply;
	struct datapath *dp;
	struct vport *vport;
1488
	struct ovs_net *ovs_net;
1489
	int err, i;
1490 1491 1492 1493 1494

	err = -EINVAL;
	if (!a[OVS_DP_ATTR_NAME] || !a[OVS_DP_ATTR_UPCALL_PID])
		goto err;

1495 1496 1497
	reply = ovs_dp_cmd_alloc_info(info);
	if (!reply)
		return -ENOMEM;
1498 1499 1500 1501

	err = -ENOMEM;
	dp = kzalloc(sizeof(*dp), GFP_KERNEL);
	if (dp == NULL)
1502
		goto err_free_reply;
1503 1504

	ovs_dp_set_net(dp, hold_net(sock_net(skb->sk)));
1505 1506

	/* Allocate table. */
1507 1508
	err = ovs_flow_tbl_init(&dp->table);
	if (err)
1509 1510
		goto err_free_dp;

1511
	dp->stats_percpu = netdev_alloc_pcpu_stats(struct dp_stats_percpu);
1512 1513 1514 1515 1516
	if (!dp->stats_percpu) {
		err = -ENOMEM;
		goto err_destroy_table;
	}

1517
	dp->ports = kmalloc(DP_VPORT_HASH_BUCKETS * sizeof(struct hlist_head),
1518
			    GFP_KERNEL);
1519 1520 1521 1522 1523 1524 1525 1526
	if (!dp->ports) {
		err = -ENOMEM;
		goto err_destroy_percpu;
	}

	for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++)
		INIT_HLIST_HEAD(&dp->ports[i]);

1527 1528 1529 1530 1531 1532
	/* Set up our datapath device. */
	parms.name = nla_data(a[OVS_DP_ATTR_NAME]);
	parms.type = OVS_VPORT_TYPE_INTERNAL;
	parms.options = NULL;
	parms.dp = dp;
	parms.port_no = OVSP_LOCAL;
1533
	parms.upcall_portids = a[OVS_DP_ATTR_UPCALL_PID];
1534

1535 1536
	ovs_dp_change(dp, a);

1537 1538 1539
	/* So far only local changes have been made, now need the lock. */
	ovs_lock();

1540 1541 1542 1543 1544 1545
	vport = new_vport(&parms);
	if (IS_ERR(vport)) {
		err = PTR_ERR(vport);
		if (err == -EBUSY)
			err = -EEXIST;

1546 1547 1548 1549 1550 1551 1552 1553 1554
		if (err == -EEXIST) {
			/* An outdated user space instance that does not understand
			 * the concept of user_features has attempted to create a new
			 * datapath and is likely to reuse it. Drop all user features.
			 */
			if (info->genlhdr->version < OVS_DP_VER_FEATURES)
				ovs_dp_reset_user_features(skb, info);
		}

1555
		goto err_destroy_ports_array;
1556 1557
	}

1558 1559 1560
	err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
				   info->snd_seq, 0, OVS_DP_CMD_NEW);
	BUG_ON(err < 0);
1561

1562
	ovs_net = net_generic(ovs_dp_get_net(dp), ovs_net_id);
1563
	list_add_tail_rcu(&dp->list_node, &ovs_net->dps);
1564 1565

	ovs_unlock();
1566

1567
	ovs_notify(&dp_datapath_genl_family, reply, info);
1568 1569
	return 0;

1570
err_destroy_ports_array:
1571
	ovs_unlock();
1572
	kfree(dp->ports);
1573 1574 1575
err_destroy_percpu:
	free_percpu(dp->stats_percpu);
err_destroy_table:
1576
	ovs_flow_tbl_destroy(&dp->table);
1577
err_free_dp:
1578
	release_net(ovs_dp_get_net(dp));
1579
	kfree(dp);
1580 1581
err_free_reply:
	kfree_skb(reply);
1582 1583 1584 1585
err:
	return err;
}

1586
/* Called with ovs_mutex. */
1587
static void __dp_destroy(struct datapath *dp)
1588
{
1589
	int i;
1590

1591 1592
	for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++) {
		struct vport *vport;
1593
		struct hlist_node *n;
1594

1595
		hlist_for_each_entry_safe(vport, n, &dp->ports[i], dp_hash_node)
1596 1597 1598
			if (vport->port_no != OVSP_LOCAL)
				ovs_dp_detach_port(vport);
	}
1599

1600
	list_del_rcu(&dp->list_node);
1601

1602
	/* OVSP_LOCAL is datapath internal port. We need to make sure that
1603
	 * all ports in datapath are destroyed first before freeing datapath.
1604
	 */
1605
	ovs_dp_detach_port(ovs_vport_ovsl(dp, OVSP_LOCAL));
1606

1607
	/* RCU destroy the flow table */
1608
	call_rcu(&dp->rcu, destroy_dp_rcu);
1609 1610 1611 1612 1613 1614 1615 1616
}

static int ovs_dp_cmd_del(struct sk_buff *skb, struct genl_info *info)
{
	struct sk_buff *reply;
	struct datapath *dp;
	int err;

1617 1618 1619 1620
	reply = ovs_dp_cmd_alloc_info(info);
	if (!reply)
		return -ENOMEM;

1621
	ovs_lock();
1622 1623 1624
	dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
	err = PTR_ERR(dp);
	if (IS_ERR(dp))
1625
		goto err_unlock_free;
1626

1627 1628 1629
	err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
				   info->snd_seq, 0, OVS_DP_CMD_DEL);
	BUG_ON(err < 0);
1630 1631

	__dp_destroy(dp);
1632
	ovs_unlock();
1633

1634
	ovs_notify(&dp_datapath_genl_family, reply, info);
1635 1636

	return 0;
1637 1638

err_unlock_free:
1639
	ovs_unlock();
1640
	kfree_skb(reply);
1641
	return err;
1642 1643 1644 1645 1646 1647 1648 1649
}

static int ovs_dp_cmd_set(struct sk_buff *skb, struct genl_info *info)
{
	struct sk_buff *reply;
	struct datapath *dp;
	int err;

1650 1651 1652 1653
	reply = ovs_dp_cmd_alloc_info(info);
	if (!reply)
		return -ENOMEM;

1654
	ovs_lock();
1655
	dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1656
	err = PTR_ERR(dp);
1657
	if (IS_ERR(dp))
1658
		goto err_unlock_free;
1659

1660 1661
	ovs_dp_change(dp, info->attrs);

1662 1663 1664
	err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
				   info->snd_seq, 0, OVS_DP_CMD_NEW);
	BUG_ON(err < 0);
1665

1666
	ovs_unlock();
1667
	ovs_notify(&dp_datapath_genl_family, reply, info);
1668 1669

	return 0;
1670 1671

err_unlock_free:
1672
	ovs_unlock();
1673
	kfree_skb(reply);
1674
	return err;
1675 1676 1677 1678 1679 1680
}

static int ovs_dp_cmd_get(struct sk_buff *skb, struct genl_info *info)
{
	struct sk_buff *reply;
	struct datapath *dp;
1681
	int err;
1682

1683 1684 1685 1686
	reply = ovs_dp_cmd_alloc_info(info);
	if (!reply)
		return -ENOMEM;

1687
	ovs_lock();
1688
	dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1689 1690
	if (IS_ERR(dp)) {
		err = PTR_ERR(dp);
1691
		goto err_unlock_free;
1692
	}
1693 1694 1695
	err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
				   info->snd_seq, 0, OVS_DP_CMD_NEW);
	BUG_ON(err < 0);
1696
	ovs_unlock();
1697 1698

	return genlmsg_reply(reply, info);
1699

1700
err_unlock_free:
1701
	ovs_unlock();
1702
	kfree_skb(reply);
1703
	return err;
1704 1705 1706 1707
}

static int ovs_dp_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
1708
	struct ovs_net *ovs_net = net_generic(sock_net(skb->sk), ovs_net_id);
1709 1710 1711 1712
	struct datapath *dp;
	int skip = cb->args[0];
	int i = 0;

1713 1714
	ovs_lock();
	list_for_each_entry(dp, &ovs_net->dps, list_node) {
1715
		if (i >= skip &&
1716
		    ovs_dp_cmd_fill_info(dp, skb, NETLINK_CB(cb->skb).portid,
1717 1718 1719 1720 1721
					 cb->nlh->nlmsg_seq, NLM_F_MULTI,
					 OVS_DP_CMD_NEW) < 0)
			break;
		i++;
	}
1722
	ovs_unlock();
1723 1724 1725 1726 1727 1728

	cb->args[0] = i;

	return skb->len;
}

1729 1730 1731 1732 1733 1734
static const struct nla_policy datapath_policy[OVS_DP_ATTR_MAX + 1] = {
	[OVS_DP_ATTR_NAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ - 1 },
	[OVS_DP_ATTR_UPCALL_PID] = { .type = NLA_U32 },
	[OVS_DP_ATTR_USER_FEATURES] = { .type = NLA_U32 },
};

1735
static const struct genl_ops dp_datapath_genl_ops[] = {
1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758
	{ .cmd = OVS_DP_CMD_NEW,
	  .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
	  .policy = datapath_policy,
	  .doit = ovs_dp_cmd_new
	},
	{ .cmd = OVS_DP_CMD_DEL,
	  .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
	  .policy = datapath_policy,
	  .doit = ovs_dp_cmd_del
	},
	{ .cmd = OVS_DP_CMD_GET,
	  .flags = 0,		    /* OK for unprivileged users. */
	  .policy = datapath_policy,
	  .doit = ovs_dp_cmd_get,
	  .dumpit = ovs_dp_cmd_dump
	},
	{ .cmd = OVS_DP_CMD_SET,
	  .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
	  .policy = datapath_policy,
	  .doit = ovs_dp_cmd_set,
	},
};

1759
static struct genl_family dp_datapath_genl_family = {
1760 1761
	.id = GENL_ID_GENERATE,
	.hdrsize = sizeof(struct ovs_header),
1762 1763 1764
	.name = OVS_DATAPATH_FAMILY,
	.version = OVS_DATAPATH_VERSION,
	.maxattr = OVS_DP_ATTR_MAX,
1765 1766
	.netnsok = true,
	.parallel_ops = true,
1767 1768 1769 1770
	.ops = dp_datapath_genl_ops,
	.n_ops = ARRAY_SIZE(dp_datapath_genl_ops),
	.mcgrps = &ovs_dp_datapath_multicast_group,
	.n_mcgrps = 1,
1771 1772
};

1773
/* Called with ovs_mutex or RCU read lock. */
1774
static int ovs_vport_cmd_fill_info(struct vport *vport, struct sk_buff *skb,
1775
				   u32 portid, u32 seq, u32 flags, u8 cmd)
1776 1777 1778 1779 1780
{
	struct ovs_header *ovs_header;
	struct ovs_vport_stats vport_stats;
	int err;

1781
	ovs_header = genlmsg_put(skb, portid, seq, &dp_vport_genl_family,
1782 1783 1784 1785 1786 1787
				 flags, cmd);
	if (!ovs_header)
		return -EMSGSIZE;

	ovs_header->dp_ifindex = get_dpifindex(vport->dp);

1788 1789
	if (nla_put_u32(skb, OVS_VPORT_ATTR_PORT_NO, vport->port_no) ||
	    nla_put_u32(skb, OVS_VPORT_ATTR_TYPE, vport->ops->type) ||
1790 1791
	    nla_put_string(skb, OVS_VPORT_ATTR_NAME,
			   vport->ops->get_name(vport)))
1792
		goto nla_put_failure;
1793 1794

	ovs_vport_get_stats(vport, &vport_stats);
1795 1796 1797
	if (nla_put(skb, OVS_VPORT_ATTR_STATS, sizeof(struct ovs_vport_stats),
		    &vport_stats))
		goto nla_put_failure;
1798

1799 1800 1801
	if (ovs_vport_get_upcall_portids(vport, skb))
		goto nla_put_failure;

1802 1803 1804 1805
	err = ovs_vport_get_options(vport, skb);
	if (err == -EMSGSIZE)
		goto error;

1806 1807
	genlmsg_end(skb, ovs_header);
	return 0;
1808 1809 1810 1811 1812 1813 1814 1815

nla_put_failure:
	err = -EMSGSIZE;
error:
	genlmsg_cancel(skb, ovs_header);
	return err;
}

1816 1817 1818 1819 1820 1821
static struct sk_buff *ovs_vport_cmd_alloc_info(void)
{
	return nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
}

/* Called with ovs_mutex, only via ovs_dp_notify_wq(). */
1822
struct sk_buff *ovs_vport_cmd_build_info(struct vport *vport, u32 portid,
1823 1824 1825 1826 1827 1828 1829 1830 1831
					 u32 seq, u8 cmd)
{
	struct sk_buff *skb;
	int retval;

	skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
	if (!skb)
		return ERR_PTR(-ENOMEM);

1832
	retval = ovs_vport_cmd_fill_info(vport, skb, portid, seq, 0, cmd);
1833 1834
	BUG_ON(retval < 0);

1835 1836 1837
	return skb;
}

1838
/* Called with ovs_mutex or RCU read lock. */
1839
static struct vport *lookup_vport(struct net *net,
1840
				  const struct ovs_header *ovs_header,
1841 1842 1843 1844 1845 1846
				  struct nlattr *a[OVS_VPORT_ATTR_MAX + 1])
{
	struct datapath *dp;
	struct vport *vport;

	if (a[OVS_VPORT_ATTR_NAME]) {
1847
		vport = ovs_vport_locate(net, nla_data(a[OVS_VPORT_ATTR_NAME]));
1848 1849
		if (!vport)
			return ERR_PTR(-ENODEV);
1850 1851 1852
		if (ovs_header->dp_ifindex &&
		    ovs_header->dp_ifindex != get_dpifindex(vport->dp))
			return ERR_PTR(-ENODEV);
1853 1854 1855 1856 1857 1858 1859
		return vport;
	} else if (a[OVS_VPORT_ATTR_PORT_NO]) {
		u32 port_no = nla_get_u32(a[OVS_VPORT_ATTR_PORT_NO]);

		if (port_no >= DP_MAX_PORTS)
			return ERR_PTR(-EFBIG);

1860
		dp = get_dp(net, ovs_header->dp_ifindex);
1861 1862 1863
		if (!dp)
			return ERR_PTR(-ENODEV);

1864
		vport = ovs_vport_ovsl_rcu(dp, port_no);
1865
		if (!vport)
1866
			return ERR_PTR(-ENODEV);
1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884
		return vport;
	} else
		return ERR_PTR(-EINVAL);
}

static int ovs_vport_cmd_new(struct sk_buff *skb, struct genl_info *info)
{
	struct nlattr **a = info->attrs;
	struct ovs_header *ovs_header = info->userhdr;
	struct vport_parms parms;
	struct sk_buff *reply;
	struct vport *vport;
	struct datapath *dp;
	u32 port_no;
	int err;

	if (!a[OVS_VPORT_ATTR_NAME] || !a[OVS_VPORT_ATTR_TYPE] ||
	    !a[OVS_VPORT_ATTR_UPCALL_PID])
1885 1886 1887 1888 1889 1890 1891 1892 1893 1894
		return -EINVAL;

	port_no = a[OVS_VPORT_ATTR_PORT_NO]
		? nla_get_u32(a[OVS_VPORT_ATTR_PORT_NO]) : 0;
	if (port_no >= DP_MAX_PORTS)
		return -EFBIG;

	reply = ovs_vport_cmd_alloc_info();
	if (!reply)
		return -ENOMEM;
1895

1896
	ovs_lock();
1897
restart:
1898
	dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1899 1900
	err = -ENODEV;
	if (!dp)
1901
		goto exit_unlock_free;
1902

1903
	if (port_no) {
1904
		vport = ovs_vport_ovsl(dp, port_no);
1905 1906
		err = -EBUSY;
		if (vport)
1907
			goto exit_unlock_free;
1908 1909 1910 1911
	} else {
		for (port_no = 1; ; port_no++) {
			if (port_no >= DP_MAX_PORTS) {
				err = -EFBIG;
1912
				goto exit_unlock_free;
1913
			}
1914
			vport = ovs_vport_ovsl(dp, port_no);
1915 1916 1917 1918 1919 1920 1921 1922 1923 1924
			if (!vport)
				break;
		}
	}

	parms.name = nla_data(a[OVS_VPORT_ATTR_NAME]);
	parms.type = nla_get_u32(a[OVS_VPORT_ATTR_TYPE]);
	parms.options = a[OVS_VPORT_ATTR_OPTIONS];
	parms.dp = dp;
	parms.port_no = port_no;
1925
	parms.upcall_portids = a[OVS_VPORT_ATTR_UPCALL_PID];
1926 1927 1928

	vport = new_vport(&parms);
	err = PTR_ERR(vport);
1929 1930 1931
	if (IS_ERR(vport)) {
		if (err == -EAGAIN)
			goto restart;
1932
		goto exit_unlock_free;
1933
	}
1934

1935 1936 1937 1938
	err = ovs_vport_cmd_fill_info(vport, reply, info->snd_portid,
				      info->snd_seq, 0, OVS_VPORT_CMD_NEW);
	BUG_ON(err < 0);
	ovs_unlock();
1939

1940
	ovs_notify(&dp_vport_genl_family, reply, info);
1941
	return 0;
1942

1943
exit_unlock_free:
1944
	ovs_unlock();
1945
	kfree_skb(reply);
1946 1947 1948 1949 1950 1951 1952 1953 1954 1955
	return err;
}

static int ovs_vport_cmd_set(struct sk_buff *skb, struct genl_info *info)
{
	struct nlattr **a = info->attrs;
	struct sk_buff *reply;
	struct vport *vport;
	int err;

1956 1957 1958 1959
	reply = ovs_vport_cmd_alloc_info();
	if (!reply)
		return -ENOMEM;

1960
	ovs_lock();
1961
	vport = lookup_vport(sock_net(skb->sk), info->userhdr, a);
1962 1963
	err = PTR_ERR(vport);
	if (IS_ERR(vport))
1964
		goto exit_unlock_free;
1965 1966

	if (a[OVS_VPORT_ATTR_TYPE] &&
1967
	    nla_get_u32(a[OVS_VPORT_ATTR_TYPE]) != vport->ops->type) {
1968
		err = -EINVAL;
1969
		goto exit_unlock_free;
1970 1971
	}

1972
	if (a[OVS_VPORT_ATTR_OPTIONS]) {
1973
		err = ovs_vport_set_options(vport, a[OVS_VPORT_ATTR_OPTIONS]);
1974
		if (err)
1975
			goto exit_unlock_free;
1976
	}
1977

1978 1979 1980 1981 1982 1983 1984 1985

	if (a[OVS_VPORT_ATTR_UPCALL_PID]) {
		struct nlattr *ids = a[OVS_VPORT_ATTR_UPCALL_PID];

		err = ovs_vport_set_upcall_portids(vport, ids);
		if (err)
			goto exit_unlock_free;
	}
1986

1987 1988 1989
	err = ovs_vport_cmd_fill_info(vport, reply, info->snd_portid,
				      info->snd_seq, 0, OVS_VPORT_CMD_NEW);
	BUG_ON(err < 0);
1990

1991
	ovs_unlock();
1992
	ovs_notify(&dp_vport_genl_family, reply, info);
1993
	return 0;
1994

1995
exit_unlock_free:
1996
	ovs_unlock();
1997
	kfree_skb(reply);
1998 1999 2000 2001 2002 2003 2004 2005 2006 2007
	return err;
}

static int ovs_vport_cmd_del(struct sk_buff *skb, struct genl_info *info)
{
	struct nlattr **a = info->attrs;
	struct sk_buff *reply;
	struct vport *vport;
	int err;

2008 2009 2010 2011
	reply = ovs_vport_cmd_alloc_info();
	if (!reply)
		return -ENOMEM;

2012
	ovs_lock();
2013
	vport = lookup_vport(sock_net(skb->sk), info->userhdr, a);
2014 2015
	err = PTR_ERR(vport);
	if (IS_ERR(vport))
2016
		goto exit_unlock_free;
2017 2018 2019

	if (vport->port_no == OVSP_LOCAL) {
		err = -EINVAL;
2020
		goto exit_unlock_free;
2021 2022
	}

2023 2024 2025
	err = ovs_vport_cmd_fill_info(vport, reply, info->snd_portid,
				      info->snd_seq, 0, OVS_VPORT_CMD_DEL);
	BUG_ON(err < 0);
2026
	ovs_dp_detach_port(vport);
2027
	ovs_unlock();
2028

2029
	ovs_notify(&dp_vport_genl_family, reply, info);
2030
	return 0;
2031

2032
exit_unlock_free:
2033
	ovs_unlock();
2034
	kfree_skb(reply);
2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045
	return err;
}

static int ovs_vport_cmd_get(struct sk_buff *skb, struct genl_info *info)
{
	struct nlattr **a = info->attrs;
	struct ovs_header *ovs_header = info->userhdr;
	struct sk_buff *reply;
	struct vport *vport;
	int err;

2046 2047 2048 2049
	reply = ovs_vport_cmd_alloc_info();
	if (!reply)
		return -ENOMEM;

2050
	rcu_read_lock();
2051
	vport = lookup_vport(sock_net(skb->sk), ovs_header, a);
2052 2053
	err = PTR_ERR(vport);
	if (IS_ERR(vport))
2054 2055 2056 2057
		goto exit_unlock_free;
	err = ovs_vport_cmd_fill_info(vport, reply, info->snd_portid,
				      info->snd_seq, 0, OVS_VPORT_CMD_NEW);
	BUG_ON(err < 0);
2058 2059 2060 2061
	rcu_read_unlock();

	return genlmsg_reply(reply, info);

2062
exit_unlock_free:
2063
	rcu_read_unlock();
2064
	kfree_skb(reply);
2065 2066 2067 2068 2069 2070 2071
	return err;
}

static int ovs_vport_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
	struct ovs_header *ovs_header = genlmsg_data(nlmsg_data(cb->nlh));
	struct datapath *dp;
2072 2073
	int bucket = cb->args[0], skip = cb->args[1];
	int i, j = 0;
2074

J
Jarno Rajahalme 已提交
2075
	rcu_read_lock();
2076
	dp = get_dp_rcu(sock_net(skb->sk), ovs_header->dp_ifindex);
J
Jarno Rajahalme 已提交
2077 2078
	if (!dp) {
		rcu_read_unlock();
2079
		return -ENODEV;
J
Jarno Rajahalme 已提交
2080
	}
2081
	for (i = bucket; i < DP_VPORT_HASH_BUCKETS; i++) {
2082
		struct vport *vport;
2083 2084

		j = 0;
2085
		hlist_for_each_entry_rcu(vport, &dp->ports[i], dp_hash_node) {
2086 2087
			if (j >= skip &&
			    ovs_vport_cmd_fill_info(vport, skb,
2088
						    NETLINK_CB(cb->skb).portid,
2089 2090 2091 2092 2093 2094 2095 2096
						    cb->nlh->nlmsg_seq,
						    NLM_F_MULTI,
						    OVS_VPORT_CMD_NEW) < 0)
				goto out;

			j++;
		}
		skip = 0;
2097
	}
2098
out:
2099 2100
	rcu_read_unlock();

2101 2102
	cb->args[0] = i;
	cb->args[1] = j;
2103

2104
	return skb->len;
2105 2106
}

2107 2108 2109 2110 2111 2112 2113 2114 2115
static const struct nla_policy vport_policy[OVS_VPORT_ATTR_MAX + 1] = {
	[OVS_VPORT_ATTR_NAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ - 1 },
	[OVS_VPORT_ATTR_STATS] = { .len = sizeof(struct ovs_vport_stats) },
	[OVS_VPORT_ATTR_PORT_NO] = { .type = NLA_U32 },
	[OVS_VPORT_ATTR_TYPE] = { .type = NLA_U32 },
	[OVS_VPORT_ATTR_UPCALL_PID] = { .type = NLA_U32 },
	[OVS_VPORT_ATTR_OPTIONS] = { .type = NLA_NESTED },
};

2116
static const struct genl_ops dp_vport_genl_ops[] = {
2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139
	{ .cmd = OVS_VPORT_CMD_NEW,
	  .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
	  .policy = vport_policy,
	  .doit = ovs_vport_cmd_new
	},
	{ .cmd = OVS_VPORT_CMD_DEL,
	  .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
	  .policy = vport_policy,
	  .doit = ovs_vport_cmd_del
	},
	{ .cmd = OVS_VPORT_CMD_GET,
	  .flags = 0,		    /* OK for unprivileged users. */
	  .policy = vport_policy,
	  .doit = ovs_vport_cmd_get,
	  .dumpit = ovs_vport_cmd_dump
	},
	{ .cmd = OVS_VPORT_CMD_SET,
	  .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
	  .policy = vport_policy,
	  .doit = ovs_vport_cmd_set,
	},
};

2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151
struct genl_family dp_vport_genl_family = {
	.id = GENL_ID_GENERATE,
	.hdrsize = sizeof(struct ovs_header),
	.name = OVS_VPORT_FAMILY,
	.version = OVS_VPORT_VERSION,
	.maxattr = OVS_VPORT_ATTR_MAX,
	.netnsok = true,
	.parallel_ops = true,
	.ops = dp_vport_genl_ops,
	.n_ops = ARRAY_SIZE(dp_vport_genl_ops),
	.mcgrps = &ovs_dp_vport_multicast_group,
	.n_mcgrps = 1,
2152 2153
};

2154 2155 2156 2157 2158
static struct genl_family * const dp_genl_families[] = {
	&dp_datapath_genl_family,
	&dp_vport_genl_family,
	&dp_flow_genl_family,
	&dp_packet_genl_family,
2159 2160 2161 2162 2163 2164 2165
};

static void dp_unregister_genl(int n_families)
{
	int i;

	for (i = 0; i < n_families; i++)
2166
		genl_unregister_family(dp_genl_families[i]);
2167 2168 2169 2170 2171 2172 2173 2174 2175
}

static int dp_register_genl(void)
{
	int err;
	int i;

	for (i = 0; i < ARRAY_SIZE(dp_genl_families); i++) {

2176
		err = genl_register_family(dp_genl_families[i]);
2177 2178 2179 2180 2181 2182 2183
		if (err)
			goto error;
	}

	return 0;

error:
2184
	dp_unregister_genl(i);
2185 2186 2187
	return err;
}

2188 2189 2190 2191 2192
static int __net_init ovs_init_net(struct net *net)
{
	struct ovs_net *ovs_net = net_generic(net, ovs_net_id);

	INIT_LIST_HEAD(&ovs_net->dps);
2193
	INIT_WORK(&ovs_net->dp_notify_work, ovs_dp_notify_wq);
2194 2195 2196
	return 0;
}

P
Pravin B Shelar 已提交
2197 2198
static void __net_exit list_vports_from_net(struct net *net, struct net *dnet,
					    struct list_head *head)
2199
{
2200
	struct ovs_net *ovs_net = net_generic(net, ovs_net_id);
P
Pravin B Shelar 已提交
2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229
	struct datapath *dp;

	list_for_each_entry(dp, &ovs_net->dps, list_node) {
		int i;

		for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++) {
			struct vport *vport;

			hlist_for_each_entry(vport, &dp->ports[i], dp_hash_node) {
				struct netdev_vport *netdev_vport;

				if (vport->ops->type != OVS_VPORT_TYPE_INTERNAL)
					continue;

				netdev_vport = netdev_vport_priv(vport);
				if (dev_net(netdev_vport->dev) == dnet)
					list_add(&vport->detach_list, head);
			}
		}
	}
}

static void __net_exit ovs_exit_net(struct net *dnet)
{
	struct datapath *dp, *dp_next;
	struct ovs_net *ovs_net = net_generic(dnet, ovs_net_id);
	struct vport *vport, *vport_next;
	struct net *net;
	LIST_HEAD(head);
2230

2231
	ovs_lock();
2232 2233
	list_for_each_entry_safe(dp, dp_next, &ovs_net->dps, list_node)
		__dp_destroy(dp);
P
Pravin B Shelar 已提交
2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245

	rtnl_lock();
	for_each_net(net)
		list_vports_from_net(net, dnet, &head);
	rtnl_unlock();

	/* Detach all vports from given namespace. */
	list_for_each_entry_safe(vport, vport_next, &head, detach_list) {
		list_del(&vport->detach_list);
		ovs_dp_detach_port(vport);
	}

2246 2247 2248
	ovs_unlock();

	cancel_work_sync(&ovs_net->dp_notify_work);
2249 2250 2251 2252 2253 2254 2255 2256 2257
}

static struct pernet_operations ovs_net_ops = {
	.init = ovs_init_net,
	.exit = ovs_exit_net,
	.id   = &ovs_net_id,
	.size = sizeof(struct ovs_net),
};

2258 2259 2260 2261
static int __init dp_init(void)
{
	int err;

2262
	BUILD_BUG_ON(sizeof(struct ovs_skb_cb) > FIELD_SIZEOF(struct sk_buff, cb));
2263 2264 2265

	pr_info("Open vSwitch switching datapath\n");

2266
	err = action_fifos_init();
2267 2268 2269
	if (err)
		goto error;

2270 2271 2272 2273
	err = ovs_internal_dev_rtnl_link_register();
	if (err)
		goto error_action_fifos_exit;

2274 2275 2276 2277
	err = ovs_flow_init();
	if (err)
		goto error_unreg_rtnl_link;

2278 2279 2280 2281
	err = ovs_vport_init();
	if (err)
		goto error_flow_exit;

2282
	err = register_pernet_device(&ovs_net_ops);
2283 2284 2285
	if (err)
		goto error_vport_exit;

2286 2287 2288 2289
	err = register_netdevice_notifier(&ovs_dp_device_notifier);
	if (err)
		goto error_netns_exit;

2290 2291 2292 2293
	err = ovs_netdev_init();
	if (err)
		goto error_unreg_notifier;

2294 2295
	err = dp_register_genl();
	if (err < 0)
2296
		goto error_unreg_netdev;
2297 2298 2299

	return 0;

2300 2301
error_unreg_netdev:
	ovs_netdev_exit();
2302 2303
error_unreg_notifier:
	unregister_netdevice_notifier(&ovs_dp_device_notifier);
2304 2305
error_netns_exit:
	unregister_pernet_device(&ovs_net_ops);
2306 2307 2308 2309
error_vport_exit:
	ovs_vport_exit();
error_flow_exit:
	ovs_flow_exit();
2310 2311
error_unreg_rtnl_link:
	ovs_internal_dev_rtnl_link_unregister();
2312 2313
error_action_fifos_exit:
	action_fifos_exit();
2314 2315 2316 2317 2318 2319 2320
error:
	return err;
}

static void dp_cleanup(void)
{
	dp_unregister_genl(ARRAY_SIZE(dp_genl_families));
2321
	ovs_netdev_exit();
2322
	unregister_netdevice_notifier(&ovs_dp_device_notifier);
2323 2324
	unregister_pernet_device(&ovs_net_ops);
	rcu_barrier();
2325 2326
	ovs_vport_exit();
	ovs_flow_exit();
2327
	ovs_internal_dev_rtnl_link_unregister();
2328
	action_fifos_exit();
2329 2330 2331 2332 2333 2334 2335
}

module_init(dp_init);
module_exit(dp_cleanup);

MODULE_DESCRIPTION("Open vSwitch switching datapath");
MODULE_LICENSE("GPL");