datapath.c 59.3 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
unsigned int ovs_net_id __read_mostly;
62

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

67 68
static const struct nla_policy flow_policy[];

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

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

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

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

90
static void ovs_notify(struct genl_family *family,
91
		       struct sk_buff *skb, struct genl_info *info)
92
{
J
Jiri Benc 已提交
93
	genl_notify(family, skb, info, 0, GFP_KERNEL);
94 95
}

96 97 98
/**
 * DOC: Locking:
 *
99 100 101 102
 * 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.
103 104 105 106 107 108
 *
 * 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.
109 110
 *
 * The RTNL lock nests inside ovs_mutex.
111 112
 */

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;
}
#endif

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

145
/* Must be called with rcu_read_lock or ovs_mutex. */
146
const char *ovs_dp_name(const struct datapath *dp)
147
{
148
	struct vport *vport = ovs_vport_ovsl_rcu(dp, OVSP_LOCAL);
149
	return ovs_vport_name(vport);
150 151
}

152
static int get_dpifindex(const struct datapath *dp)
153 154 155 156 157 158
{
	struct vport *local;
	int ifindex;

	rcu_read_lock();

159
	local = ovs_vport_rcu(dp, OVSP_LOCAL);
160
	if (local)
161
		ifindex = local->dev->ifindex;
162 163 164 165 166 167 168 169 170 171 172 173
	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);

174
	ovs_flow_tbl_destroy(&dp->table);
175
	free_percpu(dp->stats_percpu);
176
	kfree(dp->ports);
177 178 179
	kfree(dp);
}

180 181 182 183 184 185
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 已提交
186
/* Called with ovs_mutex or RCU read lock. */
187 188 189 190 191 192
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);
193
	hlist_for_each_entry_rcu(vport, head, dp_hash_node) {
194 195 196 197 198 199
		if (vport->port_no == port_no)
			return vport;
	}
	return NULL;
}

200
/* Called with ovs_mutex. */
201 202 203 204 205 206 207
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;
208
		struct hlist_head *head = vport_hash_bucket(dp, vport->port_no);
209

210
		hlist_add_head_rcu(&vport->dp_hash_node, head);
211 212 213 214 215 216
	}
	return vport;
}

void ovs_dp_detach_port(struct vport *p)
{
217
	ASSERT_OVSL();
218 219

	/* First drop references to device. */
220
	hlist_del_rcu(&p->dp_hash_node);
221 222 223 224 225 226

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

/* Must be called with rcu_read_lock. */
227
void ovs_dp_process_packet(struct sk_buff *skb, struct sw_flow_key *key)
228
{
229
	const struct vport *p = OVS_CB(skb)->input_vport;
230 231
	struct datapath *dp = p->dp;
	struct sw_flow *flow;
232
	struct sw_flow_actions *sf_acts;
233 234
	struct dp_stats_percpu *stats;
	u64 *stats_counter;
235
	u32 n_mask_hit;
236

237
	stats = this_cpu_ptr(dp->stats_percpu);
238 239

	/* Look up flow. */
240
	flow = ovs_flow_tbl_lookup_stats(&dp->table, key, &n_mask_hit);
241 242
	if (unlikely(!flow)) {
		struct dp_upcall_info upcall;
243
		int error;
244

245
		memset(&upcall, 0, sizeof(upcall));
246
		upcall.cmd = OVS_PACKET_CMD_MISS;
247
		upcall.portid = ovs_vport_find_upcall_portid(p, skb);
J
Joe Stringer 已提交
248
		upcall.mru = OVS_CB(skb)->mru;
249
		error = ovs_dp_upcall(dp, skb, key, &upcall, 0);
250 251 252 253
		if (unlikely(error))
			kfree_skb(skb);
		else
			consume_skb(skb);
254 255 256 257
		stats_counter = &stats->n_missed;
		goto out;
	}

258 259 260
	ovs_flow_stats_update(flow, key->tp.flags, skb);
	sf_acts = rcu_dereference(flow->sf_acts);
	ovs_execute_actions(dp, skb, sf_acts, key);
261

262
	stats_counter = &stats->n_hit;
263 264 265

out:
	/* Update datapath statistics. */
266
	u64_stats_update_begin(&stats->syncp);
267
	(*stats_counter)++;
268
	stats->n_mask_hit += n_mask_hit;
269
	u64_stats_update_end(&stats->syncp);
270 271 272
}

int ovs_dp_upcall(struct datapath *dp, struct sk_buff *skb,
273
		  const struct sw_flow_key *key,
274 275
		  const struct dp_upcall_info *upcall_info,
		  uint32_t cutlen)
276 277 278 279
{
	struct dp_stats_percpu *stats;
	int err;

280
	if (upcall_info->portid == 0) {
281 282 283 284 285
		err = -ENOTCONN;
		goto err;
	}

	if (!skb_is_gso(skb))
286
		err = queue_userspace_packet(dp, skb, key, upcall_info, cutlen);
287
	else
288
		err = queue_gso_packets(dp, skb, key, upcall_info, cutlen);
289 290 291 292 293 294
	if (err)
		goto err;

	return 0;

err:
295
	stats = this_cpu_ptr(dp->stats_percpu);
296

297
	u64_stats_update_begin(&stats->syncp);
298
	stats->n_lost++;
299
	u64_stats_update_end(&stats->syncp);
300 301 302 303

	return err;
}

304
static int queue_gso_packets(struct datapath *dp, struct sk_buff *skb,
305
			     const struct sw_flow_key *key,
306 307
			     const struct dp_upcall_info *upcall_info,
				 uint32_t cutlen)
308 309 310 311
{
	struct sk_buff *segs, *nskb;
	int err;

312
	BUILD_BUG_ON(sizeof(*OVS_CB(skb)) > SKB_SGO_CB_OFFSET);
313
	segs = __skb_gso_segment(skb, NETIF_F_SG, false);
314 315
	if (IS_ERR(segs))
		return PTR_ERR(segs);
316 317
	if (segs == NULL)
		return -EINVAL;
318 319 320 321

	/* Queue all of the segments. */
	skb = segs;
	do {
322
		err = queue_userspace_packet(dp, skb, key, upcall_info, cutlen);
323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339
		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;
}

340
static size_t upcall_msg_size(const struct dp_upcall_info *upcall_info,
341
			      unsigned int hdrlen, int actions_attrlen)
342 343
{
	size_t size = NLMSG_ALIGN(sizeof(struct ovs_header))
344
		+ nla_total_size(hdrlen) /* OVS_PACKET_ATTR_PACKET */
345 346
		+ nla_total_size(ovs_key_attr_size()) /* OVS_PACKET_ATTR_KEY */
		+ nla_total_size(sizeof(unsigned int)); /* OVS_PACKET_ATTR_LEN */
347 348

	/* OVS_PACKET_ATTR_USERDATA */
349 350 351 352 353 354
	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());
355

356 357
	/* OVS_PACKET_ATTR_ACTIONS */
	if (upcall_info->actions_len)
358
		size += nla_total_size(actions_attrlen);
359

J
Joe Stringer 已提交
360 361 362 363
	/* OVS_PACKET_ATTR_MRU */
	if (upcall_info->mru)
		size += nla_total_size(sizeof(upcall_info->mru));

364 365 366
	return size;
}

J
Joe Stringer 已提交
367 368 369 370 371 372
static void pad_packet(struct datapath *dp, struct sk_buff *skb)
{
	if (!(dp->user_features & OVS_DP_F_UNALIGNED)) {
		size_t plen = NLA_ALIGN(skb->len) - skb->len;

		if (plen > 0)
373
			skb_put_zero(skb, plen);
J
Joe Stringer 已提交
374 375 376
	}
}

377
static int queue_userspace_packet(struct datapath *dp, struct sk_buff *skb,
378
				  const struct sw_flow_key *key,
379 380
				  const struct dp_upcall_info *upcall_info,
				  uint32_t cutlen)
381 382 383
{
	struct ovs_header *upcall;
	struct sk_buff *nskb = NULL;
L
Li RongQing 已提交
384
	struct sk_buff *user_skb = NULL; /* to be queued to userspace */
385
	struct nlattr *nla;
386
	size_t len;
387
	unsigned int hlen;
388 389 390 391 392
	int err, dp_ifindex;

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

394
	if (skb_vlan_tag_present(skb)) {
395 396 397 398
		nskb = skb_clone(skb, GFP_ATOMIC);
		if (!nskb)
			return -ENOMEM;

399
		nskb = __vlan_hwaccel_push_inside(nskb);
400
		if (!nskb)
401 402 403 404 405 406 407 408 409 410
			return -ENOMEM;

		skb = nskb;
	}

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

411 412
	/* Complete checksum if needed */
	if (skb->ip_summed == CHECKSUM_PARTIAL &&
413
	    (err = skb_csum_hwoffload_help(skb, 0)))
414 415 416 417 418 419 420 421 422 423 424
		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;

425 426
	len = upcall_msg_size(upcall_info, hlen - cutlen,
			      OVS_CB(skb)->acts_origlen);
427
	user_skb = genlmsg_new(len, GFP_ATOMIC);
428 429 430 431 432 433 434 435 436
	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;

437
	err = ovs_nla_put_key(key, key, OVS_PACKET_ATTR_KEY, false, user_skb);
438
	BUG_ON(err);
439 440

	if (upcall_info->userdata)
441 442 443
		__nla_put(user_skb, OVS_PACKET_ATTR_USERDATA,
			  nla_len(upcall_info->userdata),
			  nla_data(upcall_info->userdata));
444

445 446
	if (upcall_info->egress_tun_info) {
		nla = nla_nest_start(user_skb, OVS_PACKET_ATTR_EGRESS_TUN_KEY);
447 448
		err = ovs_nla_put_tunnel_info(user_skb,
					      upcall_info->egress_tun_info);
449 450 451 452
		BUG_ON(err);
		nla_nest_end(user_skb, nla);
	}

453 454 455 456 457 458 459 460 461 462 463
	if (upcall_info->actions_len) {
		nla = nla_nest_start(user_skb, OVS_PACKET_ATTR_ACTIONS);
		err = ovs_nla_put_actions(upcall_info->actions,
					  upcall_info->actions_len,
					  user_skb);
		if (!err)
			nla_nest_end(user_skb, nla);
		else
			nla_nest_cancel(user_skb, nla);
	}

J
Joe Stringer 已提交
464 465 466 467 468 469 470 471 472 473
	/* Add OVS_PACKET_ATTR_MRU */
	if (upcall_info->mru) {
		if (nla_put_u16(user_skb, OVS_PACKET_ATTR_MRU,
				upcall_info->mru)) {
			err = -ENOBUFS;
			goto out;
		}
		pad_packet(dp, user_skb);
	}

474 475 476 477 478 479 480 481 482 483
	/* Add OVS_PACKET_ATTR_LEN when packet is truncated */
	if (cutlen > 0) {
		if (nla_put_u32(user_skb, OVS_PACKET_ATTR_LEN,
				skb->len)) {
			err = -ENOBUFS;
			goto out;
		}
		pad_packet(dp, user_skb);
	}

484 485 486 487 488 489
	/* 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;
	}
490
	nla->nla_len = nla_attr_size(skb->len - cutlen);
491

492
	err = skb_zerocopy(user_skb, skb, skb->len - cutlen, hlen);
493 494
	if (err)
		goto out;
495

496
	/* Pad OVS_PACKET_ATTR_PACKET if linear copy was performed */
J
Joe Stringer 已提交
497
	pad_packet(dp, user_skb);
498

499
	((struct nlmsghdr *) user_skb->data)->nlmsg_len = user_skb->len;
500

501
	err = genlmsg_unicast(ovs_dp_get_net(dp), user_skb, upcall_info->portid);
L
Li RongQing 已提交
502
	user_skb = NULL;
503
out:
504 505
	if (err)
		skb_tx_error(skb);
L
Li RongQing 已提交
506
	kfree_skb(user_skb);
507 508 509 510 511 512 513
	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;
J
Joe Stringer 已提交
514
	struct net *net = sock_net(skb->sk);
515 516 517 518
	struct nlattr **a = info->attrs;
	struct sw_flow_actions *acts;
	struct sk_buff *packet;
	struct sw_flow *flow;
519
	struct sw_flow_actions *sf_acts;
520
	struct datapath *dp;
521
	struct vport *input_vport;
J
Joe Stringer 已提交
522
	u16 mru = 0;
523 524
	int len;
	int err;
525
	bool log = !a[OVS_PACKET_ATTR_PROBE];
526 527 528

	err = -EINVAL;
	if (!a[OVS_PACKET_ATTR_PACKET] || !a[OVS_PACKET_ATTR_KEY] ||
529
	    !a[OVS_PACKET_ATTR_ACTIONS])
530 531 532 533 534 535 536 537 538
		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);

539
	nla_memcpy(__skb_put(packet, len), a[OVS_PACKET_ATTR_PACKET], len);
540

J
Joe Stringer 已提交
541 542 543 544 545 546 547
	/* Set packet's mru */
	if (a[OVS_PACKET_ATTR_MRU]) {
		mru = nla_get_u16(a[OVS_PACKET_ATTR_MRU]);
		packet->ignore_df = 1;
	}
	OVS_CB(packet)->mru = mru;

548
	/* Build an sw_flow for sending this packet. */
549
	flow = ovs_flow_alloc();
550 551 552 553
	err = PTR_ERR(flow);
	if (IS_ERR(flow))
		goto err_kfree_skb;

554 555
	err = ovs_flow_key_extract_userspace(net, a[OVS_PACKET_ATTR_KEY],
					     packet, &flow->key, log);
556 557 558
	if (err)
		goto err_flow_free;

J
Joe Stringer 已提交
559
	err = ovs_nla_copy_actions(net, a[OVS_PACKET_ATTR_ACTIONS],
560
				   &flow->key, &acts, log);
561 562
	if (err)
		goto err_flow_free;
563

564
	rcu_assign_pointer(flow->sf_acts, acts);
565
	packet->priority = flow->key.phy.priority;
566
	packet->mark = flow->key.phy.skb_mark;
567 568

	rcu_read_lock();
J
Joe Stringer 已提交
569
	dp = get_dp_rcu(net, ovs_header->dp_ifindex);
570 571 572 573
	err = -ENODEV;
	if (!dp)
		goto err_unlock;

574 575 576 577 578 579 580
	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;

J
Joe Stringer 已提交
581
	packet->dev = input_vport->dev;
582
	OVS_CB(packet)->input_vport = input_vport;
583
	sf_acts = rcu_dereference(flow->sf_acts);
584

585
	local_bh_disable();
586
	err = ovs_execute_actions(dp, packet, sf_acts, &flow->key);
587 588 589
	local_bh_enable();
	rcu_read_unlock();

590
	ovs_flow_free(flow, false);
591 592 593 594 595
	return err;

err_unlock:
	rcu_read_unlock();
err_flow_free:
596
	ovs_flow_free(flow, false);
597 598 599 600 601 602 603
err_kfree_skb:
	kfree_skb(packet);
err:
	return err;
}

static const struct nla_policy packet_policy[OVS_PACKET_ATTR_MAX + 1] = {
604
	[OVS_PACKET_ATTR_PACKET] = { .len = ETH_HLEN },
605 606
	[OVS_PACKET_ATTR_KEY] = { .type = NLA_NESTED },
	[OVS_PACKET_ATTR_ACTIONS] = { .type = NLA_NESTED },
607
	[OVS_PACKET_ATTR_PROBE] = { .type = NLA_FLAG },
J
Joe Stringer 已提交
608
	[OVS_PACKET_ATTR_MRU] = { .type = NLA_U16 },
609 610
};

611
static const struct genl_ops dp_packet_genl_ops[] = {
612
	{ .cmd = OVS_PACKET_CMD_EXECUTE,
613
	  .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
614 615 616 617 618
	  .policy = packet_policy,
	  .doit = ovs_packet_cmd_execute
	}
};

619
static struct genl_family dp_packet_genl_family __ro_after_init = {
620 621 622 623 624 625 626 627
	.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),
628
	.module = THIS_MODULE,
629 630
};

631
static void get_dp_stats(const struct datapath *dp, struct ovs_dp_stats *stats,
632
			 struct ovs_dp_megaflow_stats *mega_stats)
633 634 635
{
	int i;

636 637
	memset(mega_stats, 0, sizeof(*mega_stats));

638
	stats->n_flows = ovs_flow_tbl_count(&dp->table);
639
	mega_stats->n_masks = ovs_flow_tbl_num_masks(&dp->table);
640 641

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

643 644 645 646 647 648 649 650
	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 {
651
			start = u64_stats_fetch_begin_irq(&percpu_stats->syncp);
652
			local_stats = *percpu_stats;
653
		} while (u64_stats_fetch_retry_irq(&percpu_stats->syncp, start));
654 655 656 657

		stats->n_hit += local_stats.n_hit;
		stats->n_missed += local_stats.n_missed;
		stats->n_lost += local_stats.n_lost;
658
		mega_stats->n_mask_hit += local_stats.n_mask_hit;
659 660 661
	}
}

662 663 664 665 666 667 668 669 670 671 672 673
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)
674
{
675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697
	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))
698
		len += nla_total_size(acts->orig_len);
699 700

	return len
701
		+ nla_total_size_64bit(sizeof(struct ovs_flow_stats)) /* OVS_FLOW_ATTR_STATS */
702
		+ nla_total_size(1) /* OVS_FLOW_ATTR_TCP_FLAGS */
703
		+ nla_total_size_64bit(8); /* OVS_FLOW_ATTR_USED */
704 705
}

706 707 708 709 710 711 712
/* 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;
713

714
	ovs_flow_stats_get(flow, &stats, &used, &tcp_flags);
715

716
	if (used &&
N
Nicolas Dichtel 已提交
717 718
	    nla_put_u64_64bit(skb, OVS_FLOW_ATTR_USED, ovs_flow_used_time(used),
			      OVS_FLOW_ATTR_PAD))
719
		return -EMSGSIZE;
720

721
	if (stats.n_packets &&
722 723 724
	    nla_put_64bit(skb, OVS_FLOW_ATTR_STATS,
			  sizeof(struct ovs_flow_stats), &stats,
			  OVS_FLOW_ATTR_PAD))
725
		return -EMSGSIZE;
726

727 728
	if ((u8)ntohs(tcp_flags) &&
	     nla_put_u8(skb, OVS_FLOW_ATTR_TCP_FLAGS, (u8)ntohs(tcp_flags)))
729 730 731 732 733 734 735 736 737 738 739
		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;
740 741 742 743 744 745 746 747 748 749 750

	/* 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.
	 */
751 752
	start = nla_nest_start(skb, OVS_FLOW_ATTR_ACTIONS);
	if (start) {
753 754
		const struct sw_flow_actions *sf_acts;

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

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

			nla_nest_cancel(skb, start);
		}
767 768 769 770 771 772 773 774 775 776
	} 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,
777
				  u32 seq, u32 flags, u8 cmd, u32 ufid_flags)
778 779 780 781 782 783 784 785 786 787 788 789
{
	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;

790
	err = ovs_nla_put_identifier(flow, skb);
791 792 793
	if (err)
		goto error;

794 795 796 797 798 799 800 801 802 803 804
	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;
	}
805 806 807 808 809

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

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

816 817
	genlmsg_end(skb, ovs_header);
	return 0;
818 819 820 821 822 823

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

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

834
	if (!always && !ovs_must_notify(&dp_flow_genl_family, info, 0))
835 836
		return NULL;

837
	len = ovs_flow_cmd_msg_size(acts, sfid, ufid_flags);
838
	skb = genlmsg_new(len, GFP_KERNEL);
839 840 841 842
	if (!skb)
		return ERR_PTR(-ENOMEM);

	return skb;
843 844
}

845 846 847 848
/* 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,
849
					       bool always, u32 ufid_flags)
850 851 852 853
{
	struct sk_buff *skb;
	int retval;

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

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

866
static int ovs_flow_cmd_new(struct sk_buff *skb, struct genl_info *info)
867
{
J
Joe Stringer 已提交
868
	struct net *net = sock_net(skb->sk);
869 870
	struct nlattr **a = info->attrs;
	struct ovs_header *ovs_header = info->userhdr;
871
	struct sw_flow *flow = NULL, *new_flow;
872
	struct sw_flow_mask mask;
873 874
	struct sk_buff *reply;
	struct datapath *dp;
875
	struct sw_flow_actions *acts;
876
	struct sw_flow_match match;
877
	u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
878
	int error;
879
	bool log = !a[OVS_FLOW_ATTR_PROBE];
880

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

892 893 894 895 896 897 898 899 900 901
	/* 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. */
902
	ovs_match_init(&match, &new_flow->key, false, &mask);
903
	error = ovs_nla_get_match(net, &match, a[OVS_FLOW_ATTR_KEY],
904
				  a[OVS_FLOW_ATTR_MASK], log);
905
	if (error)
906
		goto err_kfree_flow;
907

908 909
	/* Extract flow identifier. */
	error = ovs_nla_get_identifier(&new_flow->id, a[OVS_FLOW_ATTR_UFID],
910
				       &new_flow->key, log);
911 912
	if (error)
		goto err_kfree_flow;
913

914 915 916 917 918 919
	/* unmasked key is needed to match when ufid is not used. */
	if (ovs_identifier_is_key(&new_flow->id))
		match.key = new_flow->id.unmasked_key;

	ovs_flow_mask_key(&new_flow->key, &new_flow->key, true, &mask);

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

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

935
	ovs_lock();
J
Joe Stringer 已提交
936
	dp = get_dp(net, ovs_header->dp_ifindex);
937 938
	if (unlikely(!dp)) {
		error = -ENODEV;
939
		goto err_unlock_ovs;
940
	}
941

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

		/* Put flow in bucket. */
951 952
		error = ovs_flow_tbl_insert(&dp->table, new_flow, &mask);
		if (unlikely(error)) {
953
			acts = NULL;
954 955 956 957 958 959 960 961
			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,
962 963
						       OVS_FLOW_CMD_NEW,
						       ufid_flags);
964
			BUG_ON(error < 0);
965
		}
966
		ovs_unlock();
967
	} else {
968 969
		struct sw_flow_actions *old_acts;

970 971 972 973 974 975
		/* 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.
		 */
976 977 978
		if (unlikely(info->nlhdr->nlmsg_flags & (NLM_F_CREATE
							 | NLM_F_EXCL))) {
			error = -EEXIST;
979
			goto err_unlock_ovs;
980
		}
981 982 983 984 985 986 987 988 989
		/* 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;
990 991 992 993
			if (!flow) {
				error = -ENOENT;
				goto err_unlock_ovs;
			}
994
		}
995 996 997 998
		/* Update actions. */
		old_acts = ovsl_dereference(flow->sf_acts);
		rcu_assign_pointer(flow->sf_acts, acts);

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

1010
		ovs_nla_free_flow_actions_rcu(old_acts);
1011
		ovs_flow_free(new_flow, false);
1012
	}
1013 1014 1015

	if (reply)
		ovs_notify(&dp_flow_genl_family, reply, info);
1016 1017 1018 1019
	return 0;

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

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

1040
	ovs_flow_mask_key(&masked_key, key, true, mask);
J
Joe Stringer 已提交
1041
	error = ovs_nla_copy_actions(net, a, &masked_key, &acts, log);
1042
	if (error) {
1043 1044
		OVS_NLERR(log,
			  "Actions may not be safe on all matching packets");
1045 1046 1047 1048 1049 1050
		return ERR_PTR(error);
	}

	return acts;
}

1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085
/* Factor out match-init and action-copy to avoid
 * "Wframe-larger-than=1024" warning. Because mask is only
 * used to get actions, we new a function to save some
 * stack space.
 *
 * If there are not key and action attrs, we return 0
 * directly. In the case, the caller will also not use the
 * match as before. If there is action attr, we try to get
 * actions and save them to *acts. Before returning from
 * the function, we reset the match->mask pointer. Because
 * we should not to return match object with dangling reference
 * to mask.
 * */
static int ovs_nla_init_match_and_action(struct net *net,
					 struct sw_flow_match *match,
					 struct sw_flow_key *key,
					 struct nlattr **a,
					 struct sw_flow_actions **acts,
					 bool log)
{
	struct sw_flow_mask mask;
	int error = 0;

	if (a[OVS_FLOW_ATTR_KEY]) {
		ovs_match_init(match, key, true, &mask);
		error = ovs_nla_get_match(net, match, a[OVS_FLOW_ATTR_KEY],
					  a[OVS_FLOW_ATTR_MASK], log);
		if (error)
			goto error;
	}

	if (a[OVS_FLOW_ATTR_ACTIONS]) {
		if (!a[OVS_FLOW_ATTR_KEY]) {
			OVS_NLERR(log,
				  "Flow key attribute not present in set flow.");
1086 1087
			error = -EINVAL;
			goto error;
1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103
		}

		*acts = get_flow_actions(net, a[OVS_FLOW_ATTR_ACTIONS], key,
					 &mask, log);
		if (IS_ERR(*acts)) {
			error = PTR_ERR(*acts);
			goto error;
		}
	}

	/* On success, error is 0. */
error:
	match->mask = NULL;
	return error;
}

1104 1105
static int ovs_flow_cmd_set(struct sk_buff *skb, struct genl_info *info)
{
J
Joe Stringer 已提交
1106
	struct net *net = sock_net(skb->sk);
1107 1108
	struct nlattr **a = info->attrs;
	struct ovs_header *ovs_header = info->userhdr;
1109
	struct sw_flow_key key;
1110 1111 1112
	struct sw_flow *flow;
	struct sk_buff *reply = NULL;
	struct datapath *dp;
1113
	struct sw_flow_actions *old_acts = NULL, *acts = NULL;
1114
	struct sw_flow_match match;
1115 1116
	struct sw_flow_id sfid;
	u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
1117
	int error = 0;
1118
	bool log = !a[OVS_FLOW_ATTR_PROBE];
1119
	bool ufid_present;
1120

1121
	ufid_present = ovs_nla_get_ufid(&sfid, a[OVS_FLOW_ATTR_UFID], log);
1122
	if (!a[OVS_FLOW_ATTR_KEY] && !ufid_present) {
1123 1124
		OVS_NLERR(log,
			  "Flow set message rejected, Key attribute missing.");
1125
		return -EINVAL;
1126
	}
1127 1128 1129

	error = ovs_nla_init_match_and_action(net, &match, &key, a,
					      &acts, log);
1130 1131 1132
	if (error)
		goto error;

1133
	if (acts) {
1134
		/* Can allocate before locking if have acts. */
1135 1136
		reply = ovs_flow_cmd_alloc_info(acts, &sfid, info, false,
						ufid_flags);
1137 1138 1139
		if (IS_ERR(reply)) {
			error = PTR_ERR(reply);
			goto err_kfree_acts;
1140
		}
1141
	}
1142

1143
	ovs_lock();
J
Joe Stringer 已提交
1144
	dp = get_dp(net, ovs_header->dp_ifindex);
1145 1146
	if (unlikely(!dp)) {
		error = -ENODEV;
1147
		goto err_unlock_ovs;
1148
	}
1149
	/* Check that the flow exists. */
1150 1151 1152 1153
	if (ufid_present)
		flow = ovs_flow_tbl_lookup_ufid(&dp->table, &sfid);
	else
		flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
1154 1155
	if (unlikely(!flow)) {
		error = -ENOENT;
1156
		goto err_unlock_ovs;
1157
	}
1158

1159
	/* Update actions, if present. */
1160
	if (likely(acts)) {
1161 1162
		old_acts = ovsl_dereference(flow->sf_acts);
		rcu_assign_pointer(flow->sf_acts, acts);
1163 1164 1165 1166 1167 1168

		if (unlikely(reply)) {
			error = ovs_flow_cmd_fill_info(flow,
						       ovs_header->dp_ifindex,
						       reply, info->snd_portid,
						       info->snd_seq, 0,
1169 1170
						       OVS_FLOW_CMD_NEW,
						       ufid_flags);
1171 1172 1173 1174 1175
			BUG_ON(error < 0);
		}
	} else {
		/* Could not alloc without acts before locking. */
		reply = ovs_flow_cmd_build_info(flow, ovs_header->dp_ifindex,
1176 1177 1178
						info, OVS_FLOW_CMD_NEW, false,
						ufid_flags);

1179
		if (IS_ERR(reply)) {
1180 1181 1182
			error = PTR_ERR(reply);
			goto err_unlock_ovs;
		}
1183
	}
1184 1185 1186 1187

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

1190 1191 1192
	if (reply)
		ovs_notify(&dp_flow_genl_family, reply, info);
	if (old_acts)
1193
		ovs_nla_free_flow_actions_rcu(old_acts);
1194

1195 1196
	return 0;

1197 1198
err_unlock_ovs:
	ovs_unlock();
1199 1200
	kfree_skb(reply);
err_kfree_acts:
1201
	ovs_nla_free_flow_actions(acts);
1202 1203 1204 1205 1206 1207 1208 1209
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;
1210
	struct net *net = sock_net(skb->sk);
1211 1212 1213 1214
	struct sw_flow_key key;
	struct sk_buff *reply;
	struct sw_flow *flow;
	struct datapath *dp;
1215
	struct sw_flow_match match;
1216 1217 1218
	struct sw_flow_id ufid;
	u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
	int err = 0;
1219
	bool log = !a[OVS_FLOW_ATTR_PROBE];
1220
	bool ufid_present;
1221

1222 1223
	ufid_present = ovs_nla_get_ufid(&ufid, a[OVS_FLOW_ATTR_UFID], log);
	if (a[OVS_FLOW_ATTR_KEY]) {
1224
		ovs_match_init(&match, &key, true, NULL);
1225
		err = ovs_nla_get_match(net, &match, a[OVS_FLOW_ATTR_KEY], NULL,
1226 1227
					log);
	} else if (!ufid_present) {
1228 1229
		OVS_NLERR(log,
			  "Flow get message rejected, Key attribute missing.");
1230
		err = -EINVAL;
1231
	}
1232 1233 1234
	if (err)
		return err;

1235
	ovs_lock();
1236
	dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1237 1238 1239 1240
	if (!dp) {
		err = -ENODEV;
		goto unlock;
	}
1241

1242 1243 1244 1245
	if (ufid_present)
		flow = ovs_flow_tbl_lookup_ufid(&dp->table, &ufid);
	else
		flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
1246
	if (!flow) {
1247 1248 1249
		err = -ENOENT;
		goto unlock;
	}
1250

1251
	reply = ovs_flow_cmd_build_info(flow, ovs_header->dp_ifindex, info,
1252
					OVS_FLOW_CMD_NEW, true, ufid_flags);
1253 1254 1255 1256
	if (IS_ERR(reply)) {
		err = PTR_ERR(reply);
		goto unlock;
	}
1257

1258
	ovs_unlock();
1259
	return genlmsg_reply(reply, info);
1260 1261 1262
unlock:
	ovs_unlock();
	return err;
1263 1264 1265 1266 1267 1268
}

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;
1269
	struct net *net = sock_net(skb->sk);
1270 1271
	struct sw_flow_key key;
	struct sk_buff *reply;
1272
	struct sw_flow *flow = NULL;
1273
	struct datapath *dp;
1274
	struct sw_flow_match match;
1275 1276
	struct sw_flow_id ufid;
	u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
1277
	int err;
1278
	bool log = !a[OVS_FLOW_ATTR_PROBE];
1279
	bool ufid_present;
1280

1281 1282
	ufid_present = ovs_nla_get_ufid(&ufid, a[OVS_FLOW_ATTR_UFID], log);
	if (a[OVS_FLOW_ATTR_KEY]) {
1283
		ovs_match_init(&match, &key, true, NULL);
1284 1285
		err = ovs_nla_get_match(net, &match, a[OVS_FLOW_ATTR_KEY],
					NULL, log);
1286 1287 1288 1289
		if (unlikely(err))
			return err;
	}

1290
	ovs_lock();
1291
	dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1292
	if (unlikely(!dp)) {
1293 1294 1295
		err = -ENODEV;
		goto unlock;
	}
1296

1297
	if (unlikely(!a[OVS_FLOW_ATTR_KEY] && !ufid_present)) {
1298
		err = ovs_flow_tbl_flush(&dp->table);
1299 1300
		goto unlock;
	}
1301

1302 1303 1304 1305
	if (ufid_present)
		flow = ovs_flow_tbl_lookup_ufid(&dp->table, &ufid);
	else
		flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
1306
	if (unlikely(!flow)) {
1307 1308 1309
		err = -ENOENT;
		goto unlock;
	}
1310

1311
	ovs_flow_tbl_remove(&dp->table, flow);
1312
	ovs_unlock();
1313

1314
	reply = ovs_flow_cmd_alloc_info((const struct sw_flow_actions __force *) flow->sf_acts,
1315
					&flow->id, info, false, ufid_flags);
1316 1317 1318 1319 1320 1321
	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,
1322 1323
						     OVS_FLOW_CMD_DEL,
						     ufid_flags);
1324 1325 1326 1327 1328 1329 1330
			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));
		}
1331
	}
1332

1333
	ovs_flow_free(flow, true);
1334
	return 0;
1335 1336 1337
unlock:
	ovs_unlock();
	return err;
1338 1339 1340 1341
}

static int ovs_flow_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
1342
	struct nlattr *a[__OVS_FLOW_ATTR_MAX];
1343
	struct ovs_header *ovs_header = genlmsg_data(nlmsg_data(cb->nlh));
1344
	struct table_instance *ti;
1345
	struct datapath *dp;
1346 1347 1348 1349
	u32 ufid_flags;
	int err;

	err = genlmsg_parse(cb->nlh, &dp_flow_genl_family, a,
1350
			    OVS_FLOW_ATTR_MAX, flow_policy, NULL);
1351 1352 1353
	if (err)
		return err;
	ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
1354

1355
	rcu_read_lock();
1356
	dp = get_dp_rcu(sock_net(skb->sk), ovs_header->dp_ifindex);
1357
	if (!dp) {
1358
		rcu_read_unlock();
1359
		return -ENODEV;
1360
	}
1361

1362
	ti = rcu_dereference(dp->table.ti);
1363 1364 1365 1366 1367 1368
	for (;;) {
		struct sw_flow *flow;
		u32 bucket, obj;

		bucket = cb->args[0];
		obj = cb->args[1];
1369
		flow = ovs_flow_tbl_dump_next(ti, &bucket, &obj);
1370 1371 1372
		if (!flow)
			break;

1373
		if (ovs_flow_cmd_fill_info(flow, ovs_header->dp_ifindex, skb,
1374
					   NETLINK_CB(cb->skb).portid,
1375
					   cb->nlh->nlmsg_seq, NLM_F_MULTI,
1376
					   OVS_FLOW_CMD_NEW, ufid_flags) < 0)
1377 1378 1379 1380 1381
			break;

		cb->args[0] = bucket;
		cb->args[1] = obj;
	}
1382
	rcu_read_unlock();
1383 1384 1385
	return skb->len;
}

1386 1387
static const struct nla_policy flow_policy[OVS_FLOW_ATTR_MAX + 1] = {
	[OVS_FLOW_ATTR_KEY] = { .type = NLA_NESTED },
1388
	[OVS_FLOW_ATTR_MASK] = { .type = NLA_NESTED },
1389 1390
	[OVS_FLOW_ATTR_ACTIONS] = { .type = NLA_NESTED },
	[OVS_FLOW_ATTR_CLEAR] = { .type = NLA_FLAG },
1391
	[OVS_FLOW_ATTR_PROBE] = { .type = NLA_FLAG },
1392 1393
	[OVS_FLOW_ATTR_UFID] = { .type = NLA_UNSPEC, .len = 1 },
	[OVS_FLOW_ATTR_UFID_FLAGS] = { .type = NLA_U32 },
1394 1395
};

1396
static const struct genl_ops dp_flow_genl_ops[] = {
1397
	{ .cmd = OVS_FLOW_CMD_NEW,
1398
	  .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1399
	  .policy = flow_policy,
1400
	  .doit = ovs_flow_cmd_new
1401 1402
	},
	{ .cmd = OVS_FLOW_CMD_DEL,
1403
	  .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1404 1405 1406 1407 1408 1409 1410 1411 1412 1413
	  .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,
1414
	  .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1415
	  .policy = flow_policy,
1416
	  .doit = ovs_flow_cmd_set,
1417 1418 1419
	},
};

1420
static struct genl_family dp_flow_genl_family __ro_after_init = {
1421
	.hdrsize = sizeof(struct ovs_header),
1422 1423 1424
	.name = OVS_FLOW_FAMILY,
	.version = OVS_FLOW_VERSION,
	.maxattr = OVS_FLOW_ATTR_MAX,
1425 1426
	.netnsok = true,
	.parallel_ops = true,
1427 1428 1429 1430
	.ops = dp_flow_genl_ops,
	.n_ops = ARRAY_SIZE(dp_flow_genl_ops),
	.mcgrps = &ovs_dp_flow_multicast_group,
	.n_mcgrps = 1,
1431
	.module = THIS_MODULE,
1432 1433
};

1434 1435 1436 1437 1438
static size_t ovs_dp_cmd_msg_size(void)
{
	size_t msgsize = NLMSG_ALIGN(sizeof(struct ovs_header));

	msgsize += nla_total_size(IFNAMSIZ);
1439 1440
	msgsize += nla_total_size_64bit(sizeof(struct ovs_dp_stats));
	msgsize += nla_total_size_64bit(sizeof(struct ovs_dp_megaflow_stats));
1441
	msgsize += nla_total_size(sizeof(u32)); /* OVS_DP_ATTR_USER_FEATURES */
1442 1443 1444 1445

	return msgsize;
}

1446
/* Called with ovs_mutex. */
1447
static int ovs_dp_cmd_fill_info(struct datapath *dp, struct sk_buff *skb,
1448
				u32 portid, u32 seq, u32 flags, u8 cmd)
1449 1450 1451
{
	struct ovs_header *ovs_header;
	struct ovs_dp_stats dp_stats;
1452
	struct ovs_dp_megaflow_stats dp_megaflow_stats;
1453 1454
	int err;

1455
	ovs_header = genlmsg_put(skb, portid, seq, &dp_datapath_genl_family,
1456 1457 1458 1459 1460 1461 1462 1463 1464 1465
				   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;

1466
	get_dp_stats(dp, &dp_stats, &dp_megaflow_stats);
1467 1468
	if (nla_put_64bit(skb, OVS_DP_ATTR_STATS, sizeof(struct ovs_dp_stats),
			  &dp_stats, OVS_DP_ATTR_PAD))
1469 1470
		goto nla_put_failure;

1471 1472 1473
	if (nla_put_64bit(skb, OVS_DP_ATTR_MEGAFLOW_STATS,
			  sizeof(struct ovs_dp_megaflow_stats),
			  &dp_megaflow_stats, OVS_DP_ATTR_PAD))
1474
		goto nla_put_failure;
1475

1476 1477 1478
	if (nla_put_u32(skb, OVS_DP_ATTR_USER_FEATURES, dp->user_features))
		goto nla_put_failure;

1479 1480
	genlmsg_end(skb, ovs_header);
	return 0;
1481 1482 1483 1484 1485 1486 1487

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

1488
static struct sk_buff *ovs_dp_cmd_alloc_info(void)
1489
{
1490
	return genlmsg_new(ovs_dp_cmd_msg_size(), GFP_KERNEL);
1491 1492
}

J
Jarno Rajahalme 已提交
1493
/* Called with rcu_read_lock or ovs_mutex. */
1494
static struct datapath *lookup_datapath(struct net *net,
1495
					const struct ovs_header *ovs_header,
1496 1497 1498 1499 1500
					struct nlattr *a[OVS_DP_ATTR_MAX + 1])
{
	struct datapath *dp;

	if (!a[OVS_DP_ATTR_NAME])
1501
		dp = get_dp(net, ovs_header->dp_ifindex);
1502 1503 1504
	else {
		struct vport *vport;

1505
		vport = ovs_vport_locate(net, nla_data(a[OVS_DP_ATTR_NAME]));
1506 1507 1508 1509 1510
		dp = vport && vport->port_no == OVSP_LOCAL ? vport->dp : NULL;
	}
	return dp ? dp : ERR_PTR(-ENODEV);
}

1511 1512 1513 1514 1515
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);
1516
	if (IS_ERR(dp))
1517 1518 1519 1520 1521 1522
		return;

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

1523
static void ovs_dp_change(struct datapath *dp, struct nlattr *a[])
1524 1525 1526 1527 1528
{
	if (a[OVS_DP_ATTR_USER_FEATURES])
		dp->user_features = nla_get_u32(a[OVS_DP_ATTR_USER_FEATURES]);
}

1529 1530 1531 1532 1533 1534 1535
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;
1536
	struct ovs_net *ovs_net;
1537
	int err, i;
1538 1539 1540 1541 1542

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

1543
	reply = ovs_dp_cmd_alloc_info();
1544 1545
	if (!reply)
		return -ENOMEM;
1546 1547 1548 1549

	err = -ENOMEM;
	dp = kzalloc(sizeof(*dp), GFP_KERNEL);
	if (dp == NULL)
1550
		goto err_free_reply;
1551

1552
	ovs_dp_set_net(dp, sock_net(skb->sk));
1553 1554

	/* Allocate table. */
1555 1556
	err = ovs_flow_tbl_init(&dp->table);
	if (err)
1557 1558
		goto err_free_dp;

1559
	dp->stats_percpu = netdev_alloc_pcpu_stats(struct dp_stats_percpu);
1560 1561 1562 1563 1564
	if (!dp->stats_percpu) {
		err = -ENOMEM;
		goto err_destroy_table;
	}

1565
	dp->ports = kmalloc(DP_VPORT_HASH_BUCKETS * sizeof(struct hlist_head),
1566
			    GFP_KERNEL);
1567 1568 1569 1570 1571 1572 1573 1574
	if (!dp->ports) {
		err = -ENOMEM;
		goto err_destroy_percpu;
	}

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

1575 1576 1577 1578 1579 1580
	/* 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;
1581
	parms.upcall_portids = a[OVS_DP_ATTR_UPCALL_PID];
1582

1583 1584
	ovs_dp_change(dp, a);

1585 1586 1587
	/* So far only local changes have been made, now need the lock. */
	ovs_lock();

1588 1589 1590 1591 1592 1593
	vport = new_vport(&parms);
	if (IS_ERR(vport)) {
		err = PTR_ERR(vport);
		if (err == -EBUSY)
			err = -EEXIST;

1594 1595 1596 1597 1598 1599 1600 1601 1602
		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);
		}

1603
		goto err_destroy_ports_array;
1604 1605
	}

1606 1607 1608
	err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
				   info->snd_seq, 0, OVS_DP_CMD_NEW);
	BUG_ON(err < 0);
1609

1610
	ovs_net = net_generic(ovs_dp_get_net(dp), ovs_net_id);
1611
	list_add_tail_rcu(&dp->list_node, &ovs_net->dps);
1612 1613

	ovs_unlock();
1614

1615
	ovs_notify(&dp_datapath_genl_family, reply, info);
1616 1617
	return 0;

1618
err_destroy_ports_array:
1619
	ovs_unlock();
1620
	kfree(dp->ports);
1621 1622 1623
err_destroy_percpu:
	free_percpu(dp->stats_percpu);
err_destroy_table:
1624
	ovs_flow_tbl_destroy(&dp->table);
1625 1626
err_free_dp:
	kfree(dp);
1627 1628
err_free_reply:
	kfree_skb(reply);
1629 1630 1631 1632
err:
	return err;
}

1633
/* Called with ovs_mutex. */
1634
static void __dp_destroy(struct datapath *dp)
1635
{
1636
	int i;
1637

1638 1639
	for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++) {
		struct vport *vport;
1640
		struct hlist_node *n;
1641

1642
		hlist_for_each_entry_safe(vport, n, &dp->ports[i], dp_hash_node)
1643 1644 1645
			if (vport->port_no != OVSP_LOCAL)
				ovs_dp_detach_port(vport);
	}
1646

1647
	list_del_rcu(&dp->list_node);
1648

1649
	/* OVSP_LOCAL is datapath internal port. We need to make sure that
1650
	 * all ports in datapath are destroyed first before freeing datapath.
1651
	 */
1652
	ovs_dp_detach_port(ovs_vport_ovsl(dp, OVSP_LOCAL));
1653

1654
	/* RCU destroy the flow table */
1655
	call_rcu(&dp->rcu, destroy_dp_rcu);
1656 1657 1658 1659 1660 1661 1662 1663
}

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

1664
	reply = ovs_dp_cmd_alloc_info();
1665 1666 1667
	if (!reply)
		return -ENOMEM;

1668
	ovs_lock();
1669 1670 1671
	dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
	err = PTR_ERR(dp);
	if (IS_ERR(dp))
1672
		goto err_unlock_free;
1673

1674 1675 1676
	err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
				   info->snd_seq, 0, OVS_DP_CMD_DEL);
	BUG_ON(err < 0);
1677 1678

	__dp_destroy(dp);
1679
	ovs_unlock();
1680

1681
	ovs_notify(&dp_datapath_genl_family, reply, info);
1682 1683

	return 0;
1684 1685

err_unlock_free:
1686
	ovs_unlock();
1687
	kfree_skb(reply);
1688
	return err;
1689 1690 1691 1692 1693 1694 1695 1696
}

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

1697
	reply = ovs_dp_cmd_alloc_info();
1698 1699 1700
	if (!reply)
		return -ENOMEM;

1701
	ovs_lock();
1702
	dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1703
	err = PTR_ERR(dp);
1704
	if (IS_ERR(dp))
1705
		goto err_unlock_free;
1706

1707 1708
	ovs_dp_change(dp, info->attrs);

1709 1710 1711
	err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
				   info->snd_seq, 0, OVS_DP_CMD_NEW);
	BUG_ON(err < 0);
1712

1713
	ovs_unlock();
1714
	ovs_notify(&dp_datapath_genl_family, reply, info);
1715 1716

	return 0;
1717 1718

err_unlock_free:
1719
	ovs_unlock();
1720
	kfree_skb(reply);
1721
	return err;
1722 1723 1724 1725 1726 1727
}

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

1730
	reply = ovs_dp_cmd_alloc_info();
1731 1732 1733
	if (!reply)
		return -ENOMEM;

1734
	ovs_lock();
1735
	dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1736 1737
	if (IS_ERR(dp)) {
		err = PTR_ERR(dp);
1738
		goto err_unlock_free;
1739
	}
1740 1741 1742
	err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
				   info->snd_seq, 0, OVS_DP_CMD_NEW);
	BUG_ON(err < 0);
1743
	ovs_unlock();
1744 1745

	return genlmsg_reply(reply, info);
1746

1747
err_unlock_free:
1748
	ovs_unlock();
1749
	kfree_skb(reply);
1750
	return err;
1751 1752 1753 1754
}

static int ovs_dp_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
1755
	struct ovs_net *ovs_net = net_generic(sock_net(skb->sk), ovs_net_id);
1756 1757 1758 1759
	struct datapath *dp;
	int skip = cb->args[0];
	int i = 0;

1760 1761
	ovs_lock();
	list_for_each_entry(dp, &ovs_net->dps, list_node) {
1762
		if (i >= skip &&
1763
		    ovs_dp_cmd_fill_info(dp, skb, NETLINK_CB(cb->skb).portid,
1764 1765 1766 1767 1768
					 cb->nlh->nlmsg_seq, NLM_F_MULTI,
					 OVS_DP_CMD_NEW) < 0)
			break;
		i++;
	}
1769
	ovs_unlock();
1770 1771 1772 1773 1774 1775

	cb->args[0] = i;

	return skb->len;
}

1776 1777 1778 1779 1780 1781
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 },
};

1782
static const struct genl_ops dp_datapath_genl_ops[] = {
1783
	{ .cmd = OVS_DP_CMD_NEW,
1784
	  .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1785 1786 1787 1788
	  .policy = datapath_policy,
	  .doit = ovs_dp_cmd_new
	},
	{ .cmd = OVS_DP_CMD_DEL,
1789
	  .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1790 1791 1792 1793 1794 1795 1796 1797 1798 1799
	  .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,
1800
	  .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1801 1802 1803 1804 1805
	  .policy = datapath_policy,
	  .doit = ovs_dp_cmd_set,
	},
};

1806
static struct genl_family dp_datapath_genl_family __ro_after_init = {
1807
	.hdrsize = sizeof(struct ovs_header),
1808 1809 1810
	.name = OVS_DATAPATH_FAMILY,
	.version = OVS_DATAPATH_VERSION,
	.maxattr = OVS_DP_ATTR_MAX,
1811 1812
	.netnsok = true,
	.parallel_ops = true,
1813 1814 1815 1816
	.ops = dp_datapath_genl_ops,
	.n_ops = ARRAY_SIZE(dp_datapath_genl_ops),
	.mcgrps = &ovs_dp_datapath_multicast_group,
	.n_mcgrps = 1,
1817
	.module = THIS_MODULE,
1818 1819
};

1820
/* Called with ovs_mutex or RCU read lock. */
1821
static int ovs_vport_cmd_fill_info(struct vport *vport, struct sk_buff *skb,
1822 1823
				   struct net *net, u32 portid, u32 seq,
				   u32 flags, u8 cmd)
1824 1825 1826 1827 1828
{
	struct ovs_header *ovs_header;
	struct ovs_vport_stats vport_stats;
	int err;

1829
	ovs_header = genlmsg_put(skb, portid, seq, &dp_vport_genl_family,
1830 1831 1832 1833 1834 1835
				 flags, cmd);
	if (!ovs_header)
		return -EMSGSIZE;

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

1836 1837
	if (nla_put_u32(skb, OVS_VPORT_ATTR_PORT_NO, vport->port_no) ||
	    nla_put_u32(skb, OVS_VPORT_ATTR_TYPE, vport->ops->type) ||
1838
	    nla_put_string(skb, OVS_VPORT_ATTR_NAME,
1839 1840
			   ovs_vport_name(vport)) ||
	    nla_put_u32(skb, OVS_VPORT_ATTR_IFINDEX, vport->dev->ifindex))
1841
		goto nla_put_failure;
1842

1843 1844 1845 1846 1847 1848 1849
	if (!net_eq(net, dev_net(vport->dev))) {
		int id = peernet2id_alloc(net, dev_net(vport->dev));

		if (nla_put_s32(skb, OVS_VPORT_ATTR_NETNSID, id))
			goto nla_put_failure;
	}

1850
	ovs_vport_get_stats(vport, &vport_stats);
1851 1852 1853
	if (nla_put_64bit(skb, OVS_VPORT_ATTR_STATS,
			  sizeof(struct ovs_vport_stats), &vport_stats,
			  OVS_VPORT_ATTR_PAD))
1854
		goto nla_put_failure;
1855

1856 1857 1858
	if (ovs_vport_get_upcall_portids(vport, skb))
		goto nla_put_failure;

1859 1860 1861 1862
	err = ovs_vport_get_options(vport, skb);
	if (err == -EMSGSIZE)
		goto error;

1863 1864
	genlmsg_end(skb, ovs_header);
	return 0;
1865 1866 1867 1868 1869 1870 1871 1872

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

1873 1874 1875 1876 1877 1878
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(). */
1879 1880
struct sk_buff *ovs_vport_cmd_build_info(struct vport *vport, struct net *net,
					 u32 portid, u32 seq, u8 cmd)
1881 1882 1883 1884 1885 1886 1887 1888
{
	struct sk_buff *skb;
	int retval;

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

1889
	retval = ovs_vport_cmd_fill_info(vport, skb, net, portid, seq, 0, cmd);
1890 1891
	BUG_ON(retval < 0);

1892 1893 1894
	return skb;
}

1895
/* Called with ovs_mutex or RCU read lock. */
1896
static struct vport *lookup_vport(struct net *net,
1897
				  const struct ovs_header *ovs_header,
1898 1899 1900 1901 1902
				  struct nlattr *a[OVS_VPORT_ATTR_MAX + 1])
{
	struct datapath *dp;
	struct vport *vport;

1903 1904
	if (a[OVS_VPORT_ATTR_IFINDEX])
		return ERR_PTR(-EOPNOTSUPP);
1905
	if (a[OVS_VPORT_ATTR_NAME]) {
1906
		vport = ovs_vport_locate(net, nla_data(a[OVS_VPORT_ATTR_NAME]));
1907 1908
		if (!vport)
			return ERR_PTR(-ENODEV);
1909 1910 1911
		if (ovs_header->dp_ifindex &&
		    ovs_header->dp_ifindex != get_dpifindex(vport->dp))
			return ERR_PTR(-ENODEV);
1912 1913 1914 1915 1916 1917 1918
		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);

1919
		dp = get_dp(net, ovs_header->dp_ifindex);
1920 1921 1922
		if (!dp)
			return ERR_PTR(-ENODEV);

1923
		vport = ovs_vport_ovsl_rcu(dp, port_no);
1924
		if (!vport)
1925
			return ERR_PTR(-ENODEV);
1926 1927 1928
		return vport;
	} else
		return ERR_PTR(-EINVAL);
1929

1930 1931
}

1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954
/* Called with ovs_mutex */
static void update_headroom(struct datapath *dp)
{
	unsigned dev_headroom, max_headroom = 0;
	struct net_device *dev;
	struct vport *vport;
	int i;

	for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++) {
		hlist_for_each_entry_rcu(vport, &dp->ports[i], dp_hash_node) {
			dev = vport->dev;
			dev_headroom = netdev_get_fwd_headroom(dev);
			if (dev_headroom > max_headroom)
				max_headroom = dev_headroom;
		}
	}

	dp->max_headroom = max_headroom;
	for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++)
		hlist_for_each_entry_rcu(vport, &dp->ports[i], dp_hash_node)
			netdev_set_rx_headroom(vport->dev, max_headroom);
}

1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967
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])
1968
		return -EINVAL;
1969 1970
	if (a[OVS_VPORT_ATTR_IFINDEX])
		return -EOPNOTSUPP;
1971 1972 1973 1974 1975 1976 1977 1978 1979

	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;
1980

1981
	ovs_lock();
1982
restart:
1983
	dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1984 1985
	err = -ENODEV;
	if (!dp)
1986
		goto exit_unlock_free;
1987

1988
	if (port_no) {
1989
		vport = ovs_vport_ovsl(dp, port_no);
1990 1991
		err = -EBUSY;
		if (vport)
1992
			goto exit_unlock_free;
1993 1994 1995 1996
	} else {
		for (port_no = 1; ; port_no++) {
			if (port_no >= DP_MAX_PORTS) {
				err = -EFBIG;
1997
				goto exit_unlock_free;
1998
			}
1999
			vport = ovs_vport_ovsl(dp, port_no);
2000 2001 2002 2003 2004 2005 2006 2007 2008 2009
			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;
2010
	parms.upcall_portids = a[OVS_VPORT_ATTR_UPCALL_PID];
2011 2012 2013

	vport = new_vport(&parms);
	err = PTR_ERR(vport);
2014 2015 2016
	if (IS_ERR(vport)) {
		if (err == -EAGAIN)
			goto restart;
2017
		goto exit_unlock_free;
2018
	}
2019

2020 2021 2022
	err = ovs_vport_cmd_fill_info(vport, reply, genl_info_net(info),
				      info->snd_portid, info->snd_seq, 0,
				      OVS_VPORT_CMD_NEW);
2023 2024 2025 2026 2027 2028

	if (netdev_get_fwd_headroom(vport->dev) > dp->max_headroom)
		update_headroom(dp);
	else
		netdev_set_rx_headroom(vport->dev, dp->max_headroom);

2029 2030
	BUG_ON(err < 0);
	ovs_unlock();
2031

2032
	ovs_notify(&dp_vport_genl_family, reply, info);
2033
	return 0;
2034

2035
exit_unlock_free:
2036
	ovs_unlock();
2037
	kfree_skb(reply);
2038 2039 2040 2041 2042 2043 2044 2045 2046 2047
	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;

2048 2049 2050 2051
	reply = ovs_vport_cmd_alloc_info();
	if (!reply)
		return -ENOMEM;

2052
	ovs_lock();
2053
	vport = lookup_vport(sock_net(skb->sk), info->userhdr, a);
2054 2055
	err = PTR_ERR(vport);
	if (IS_ERR(vport))
2056
		goto exit_unlock_free;
2057 2058

	if (a[OVS_VPORT_ATTR_TYPE] &&
2059
	    nla_get_u32(a[OVS_VPORT_ATTR_TYPE]) != vport->ops->type) {
2060
		err = -EINVAL;
2061
		goto exit_unlock_free;
2062 2063
	}

2064
	if (a[OVS_VPORT_ATTR_OPTIONS]) {
2065
		err = ovs_vport_set_options(vport, a[OVS_VPORT_ATTR_OPTIONS]);
2066
		if (err)
2067
			goto exit_unlock_free;
2068
	}
2069

2070 2071 2072 2073 2074 2075 2076 2077

	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;
	}
2078

2079 2080 2081
	err = ovs_vport_cmd_fill_info(vport, reply, genl_info_net(info),
				      info->snd_portid, info->snd_seq, 0,
				      OVS_VPORT_CMD_NEW);
2082
	BUG_ON(err < 0);
2083

2084
	ovs_unlock();
2085
	ovs_notify(&dp_vport_genl_family, reply, info);
2086
	return 0;
2087

2088
exit_unlock_free:
2089
	ovs_unlock();
2090
	kfree_skb(reply);
2091 2092 2093 2094 2095
	return err;
}

static int ovs_vport_cmd_del(struct sk_buff *skb, struct genl_info *info)
{
2096
	bool must_update_headroom = false;
2097 2098
	struct nlattr **a = info->attrs;
	struct sk_buff *reply;
2099
	struct datapath *dp;
2100 2101 2102
	struct vport *vport;
	int err;

2103 2104 2105 2106
	reply = ovs_vport_cmd_alloc_info();
	if (!reply)
		return -ENOMEM;

2107
	ovs_lock();
2108
	vport = lookup_vport(sock_net(skb->sk), info->userhdr, a);
2109 2110
	err = PTR_ERR(vport);
	if (IS_ERR(vport))
2111
		goto exit_unlock_free;
2112 2113 2114

	if (vport->port_no == OVSP_LOCAL) {
		err = -EINVAL;
2115
		goto exit_unlock_free;
2116 2117
	}

2118 2119 2120
	err = ovs_vport_cmd_fill_info(vport, reply, genl_info_net(info),
				      info->snd_portid, info->snd_seq, 0,
				      OVS_VPORT_CMD_DEL);
2121
	BUG_ON(err < 0);
2122 2123 2124 2125 2126 2127

	/* the vport deletion may trigger dp headroom update */
	dp = vport->dp;
	if (netdev_get_fwd_headroom(vport->dev) == dp->max_headroom)
		must_update_headroom = true;
	netdev_reset_rx_headroom(vport->dev);
2128
	ovs_dp_detach_port(vport);
2129 2130 2131

	if (must_update_headroom)
		update_headroom(dp);
2132
	ovs_unlock();
2133

2134
	ovs_notify(&dp_vport_genl_family, reply, info);
2135
	return 0;
2136

2137
exit_unlock_free:
2138
	ovs_unlock();
2139
	kfree_skb(reply);
2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150
	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;

2151 2152 2153 2154
	reply = ovs_vport_cmd_alloc_info();
	if (!reply)
		return -ENOMEM;

2155
	rcu_read_lock();
2156
	vport = lookup_vport(sock_net(skb->sk), ovs_header, a);
2157 2158
	err = PTR_ERR(vport);
	if (IS_ERR(vport))
2159
		goto exit_unlock_free;
2160 2161 2162
	err = ovs_vport_cmd_fill_info(vport, reply, genl_info_net(info),
				      info->snd_portid, info->snd_seq, 0,
				      OVS_VPORT_CMD_NEW);
2163
	BUG_ON(err < 0);
2164 2165 2166 2167
	rcu_read_unlock();

	return genlmsg_reply(reply, info);

2168
exit_unlock_free:
2169
	rcu_read_unlock();
2170
	kfree_skb(reply);
2171 2172 2173 2174 2175 2176 2177
	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;
2178 2179
	int bucket = cb->args[0], skip = cb->args[1];
	int i, j = 0;
2180

J
Jarno Rajahalme 已提交
2181
	rcu_read_lock();
2182
	dp = get_dp_rcu(sock_net(skb->sk), ovs_header->dp_ifindex);
J
Jarno Rajahalme 已提交
2183 2184
	if (!dp) {
		rcu_read_unlock();
2185
		return -ENODEV;
J
Jarno Rajahalme 已提交
2186
	}
2187
	for (i = bucket; i < DP_VPORT_HASH_BUCKETS; i++) {
2188
		struct vport *vport;
2189 2190

		j = 0;
2191
		hlist_for_each_entry_rcu(vport, &dp->ports[i], dp_hash_node) {
2192 2193
			if (j >= skip &&
			    ovs_vport_cmd_fill_info(vport, skb,
2194
						    sock_net(skb->sk),
2195
						    NETLINK_CB(cb->skb).portid,
2196 2197 2198 2199 2200 2201 2202 2203
						    cb->nlh->nlmsg_seq,
						    NLM_F_MULTI,
						    OVS_VPORT_CMD_NEW) < 0)
				goto out;

			j++;
		}
		skip = 0;
2204
	}
2205
out:
2206 2207
	rcu_read_unlock();

2208 2209
	cb->args[0] = i;
	cb->args[1] = j;
2210

2211
	return skb->len;
2212 2213
}

2214 2215 2216 2217 2218 2219 2220
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 },
2221 2222
	[OVS_VPORT_ATTR_IFINDEX] = { .type = NLA_U32 },
	[OVS_VPORT_ATTR_NETNSID] = { .type = NLA_S32 },
2223 2224
};

2225
static const struct genl_ops dp_vport_genl_ops[] = {
2226
	{ .cmd = OVS_VPORT_CMD_NEW,
2227
	  .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
2228 2229 2230 2231
	  .policy = vport_policy,
	  .doit = ovs_vport_cmd_new
	},
	{ .cmd = OVS_VPORT_CMD_DEL,
2232
	  .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
2233 2234 2235 2236 2237 2238 2239 2240 2241 2242
	  .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,
2243
	  .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
2244 2245 2246 2247 2248
	  .policy = vport_policy,
	  .doit = ovs_vport_cmd_set,
	},
};

2249
struct genl_family dp_vport_genl_family __ro_after_init = {
2250 2251 2252 2253 2254 2255 2256 2257 2258 2259
	.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,
2260
	.module = THIS_MODULE,
2261 2262
};

2263 2264 2265 2266 2267
static struct genl_family * const dp_genl_families[] = {
	&dp_datapath_genl_family,
	&dp_vport_genl_family,
	&dp_flow_genl_family,
	&dp_packet_genl_family,
2268 2269 2270 2271 2272 2273 2274
};

static void dp_unregister_genl(int n_families)
{
	int i;

	for (i = 0; i < n_families; i++)
2275
		genl_unregister_family(dp_genl_families[i]);
2276 2277
}

2278
static int __init dp_register_genl(void)
2279 2280 2281 2282 2283 2284
{
	int err;
	int i;

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

2285
		err = genl_register_family(dp_genl_families[i]);
2286 2287 2288 2289 2290 2291 2292
		if (err)
			goto error;
	}

	return 0;

error:
2293
	dp_unregister_genl(i);
2294 2295 2296
	return err;
}

2297 2298 2299 2300 2301
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);
2302
	INIT_WORK(&ovs_net->dp_notify_work, ovs_dp_notify_wq);
2303
	ovs_ct_init(net);
2304 2305 2306
	return 0;
}

P
Pravin B Shelar 已提交
2307 2308
static void __net_exit list_vports_from_net(struct net *net, struct net *dnet,
					    struct list_head *head)
2309
{
2310
	struct ovs_net *ovs_net = net_generic(net, ovs_net_id);
P
Pravin B Shelar 已提交
2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322
	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) {
				if (vport->ops->type != OVS_VPORT_TYPE_INTERNAL)
					continue;

2323
				if (dev_net(vport->dev) == dnet)
P
Pravin B Shelar 已提交
2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336
					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);
2337

2338
	ovs_ct_exit(dnet);
2339
	ovs_lock();
2340 2341
	list_for_each_entry_safe(dp, dp_next, &ovs_net->dps, list_node)
		__dp_destroy(dp);
P
Pravin B Shelar 已提交
2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353

	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);
	}

2354 2355 2356
	ovs_unlock();

	cancel_work_sync(&ovs_net->dp_notify_work);
2357 2358 2359 2360 2361 2362 2363 2364 2365
}

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

2366 2367 2368 2369
static int __init dp_init(void)
{
	int err;

2370
	BUILD_BUG_ON(sizeof(struct ovs_skb_cb) > FIELD_SIZEOF(struct sk_buff, cb));
2371 2372 2373

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

2374
	err = action_fifos_init();
2375 2376 2377
	if (err)
		goto error;

2378 2379 2380 2381
	err = ovs_internal_dev_rtnl_link_register();
	if (err)
		goto error_action_fifos_exit;

2382 2383 2384 2385
	err = ovs_flow_init();
	if (err)
		goto error_unreg_rtnl_link;

2386 2387 2388 2389
	err = ovs_vport_init();
	if (err)
		goto error_flow_exit;

2390
	err = register_pernet_device(&ovs_net_ops);
2391 2392 2393
	if (err)
		goto error_vport_exit;

2394 2395 2396 2397
	err = register_netdevice_notifier(&ovs_dp_device_notifier);
	if (err)
		goto error_netns_exit;

2398 2399 2400 2401
	err = ovs_netdev_init();
	if (err)
		goto error_unreg_notifier;

2402 2403
	err = dp_register_genl();
	if (err < 0)
2404
		goto error_unreg_netdev;
2405 2406 2407

	return 0;

2408 2409
error_unreg_netdev:
	ovs_netdev_exit();
2410 2411
error_unreg_notifier:
	unregister_netdevice_notifier(&ovs_dp_device_notifier);
2412 2413
error_netns_exit:
	unregister_pernet_device(&ovs_net_ops);
2414 2415 2416 2417
error_vport_exit:
	ovs_vport_exit();
error_flow_exit:
	ovs_flow_exit();
2418 2419
error_unreg_rtnl_link:
	ovs_internal_dev_rtnl_link_unregister();
2420 2421
error_action_fifos_exit:
	action_fifos_exit();
2422 2423 2424 2425 2426 2427 2428
error:
	return err;
}

static void dp_cleanup(void)
{
	dp_unregister_genl(ARRAY_SIZE(dp_genl_families));
2429
	ovs_netdev_exit();
2430
	unregister_netdevice_notifier(&ovs_dp_device_notifier);
2431 2432
	unregister_pernet_device(&ovs_net_ops);
	rcu_barrier();
2433 2434
	ovs_vport_exit();
	ovs_flow_exit();
2435
	ovs_internal_dev_rtnl_link_unregister();
2436
	action_fifos_exit();
2437 2438 2439 2440 2441 2442 2443
}

module_init(dp_init);
module_exit(dp_cleanup);

MODULE_DESCRIPTION("Open vSwitch switching datapath");
MODULE_LICENSE("GPL");
2444 2445 2446 2447
MODULE_ALIAS_GENL_FAMILY(OVS_DATAPATH_FAMILY);
MODULE_ALIAS_GENL_FAMILY(OVS_VPORT_FAMILY);
MODULE_ALIAS_GENL_FAMILY(OVS_FLOW_FAMILY);
MODULE_ALIAS_GENL_FAMILY(OVS_PACKET_FAMILY);