xref: /openbmc/linux/net/openvswitch/flow_table.c (revision 0a3e01371db17d753dd92ec4d0fc6247412d3b01)
1c9422999SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2e6445719SPravin B Shelar /*
39b996e54SPravin B Shelar  * Copyright (c) 2007-2014 Nicira, Inc.
4e6445719SPravin B Shelar  */
5e6445719SPravin B Shelar 
6e6445719SPravin B Shelar #include "flow.h"
7e6445719SPravin B Shelar #include "datapath.h"
834ae932aSThomas Graf #include "flow_netlink.h"
9e6445719SPravin B Shelar #include <linux/uaccess.h>
10e6445719SPravin B Shelar #include <linux/netdevice.h>
11e6445719SPravin B Shelar #include <linux/etherdevice.h>
12e6445719SPravin B Shelar #include <linux/if_ether.h>
13e6445719SPravin B Shelar #include <linux/if_vlan.h>
14e6445719SPravin B Shelar #include <net/llc_pdu.h>
15e6445719SPravin B Shelar #include <linux/kernel.h>
1687545899SDaniel Borkmann #include <linux/jhash.h>
17e6445719SPravin B Shelar #include <linux/jiffies.h>
18e6445719SPravin B Shelar #include <linux/llc.h>
19e6445719SPravin B Shelar #include <linux/module.h>
20e6445719SPravin B Shelar #include <linux/in.h>
21e6445719SPravin B Shelar #include <linux/rcupdate.h>
22db74a333SThadeu Lima de Souza Cascardo #include <linux/cpumask.h>
23e6445719SPravin B Shelar #include <linux/if_arp.h>
24e6445719SPravin B Shelar #include <linux/ip.h>
25e6445719SPravin B Shelar #include <linux/ipv6.h>
26e6445719SPravin B Shelar #include <linux/sctp.h>
27e6445719SPravin B Shelar #include <linux/tcp.h>
28e6445719SPravin B Shelar #include <linux/udp.h>
29e6445719SPravin B Shelar #include <linux/icmp.h>
30e6445719SPravin B Shelar #include <linux/icmpv6.h>
31e6445719SPravin B Shelar #include <linux/rculist.h>
32e6445719SPravin B Shelar #include <net/ip.h>
33e6445719SPravin B Shelar #include <net/ipv6.h>
34e6445719SPravin B Shelar #include <net/ndisc.h>
35e6445719SPravin B Shelar 
36b637e498SPravin B Shelar #define TBL_MIN_BUCKETS		1024
374bc63b1bSTonghao Zhang #define MASK_ARRAY_SIZE_MIN	16
38b637e498SPravin B Shelar #define REHASH_INTERVAL		(10 * 60 * HZ)
39b637e498SPravin B Shelar 
4004b7d136STonghao Zhang #define MC_HASH_SHIFT		8
4104b7d136STonghao Zhang #define MC_HASH_ENTRIES		(1u << MC_HASH_SHIFT)
4204b7d136STonghao Zhang #define MC_HASH_SEGS		((sizeof(uint32_t) * 8) / MC_HASH_SHIFT)
4304b7d136STonghao Zhang 
44e6445719SPravin B Shelar static struct kmem_cache *flow_cache;
4563e7959cSJarno Rajahalme struct kmem_cache *flow_stats_cache __read_mostly;
46e6445719SPravin B Shelar 
47e6445719SPravin B Shelar static u16 range_n_bytes(const struct sw_flow_key_range *range)
48e6445719SPravin B Shelar {
49e6445719SPravin B Shelar 	return range->end - range->start;
50e6445719SPravin B Shelar }
51e6445719SPravin B Shelar 
52e6445719SPravin B Shelar void ovs_flow_mask_key(struct sw_flow_key *dst, const struct sw_flow_key *src,
53ae5f2fb1SJesse Gross 		       bool full, const struct sw_flow_mask *mask)
54e6445719SPravin B Shelar {
55ae5f2fb1SJesse Gross 	int start = full ? 0 : mask->range.start;
56ae5f2fb1SJesse Gross 	int len = full ? sizeof *dst : range_n_bytes(&mask->range);
57ae5f2fb1SJesse Gross 	const long *m = (const long *)((const u8 *)&mask->key + start);
58ae5f2fb1SJesse Gross 	const long *s = (const long *)((const u8 *)src + start);
59ae5f2fb1SJesse Gross 	long *d = (long *)((u8 *)dst + start);
60e6445719SPravin B Shelar 	int i;
61e6445719SPravin B Shelar 
62ae5f2fb1SJesse Gross 	/* If 'full' is true then all of 'dst' is fully initialized. Otherwise,
63ae5f2fb1SJesse Gross 	 * if 'full' is false the memory outside of the 'mask->range' is left
64ae5f2fb1SJesse Gross 	 * uninitialized. This can be used as an optimization when further
65ae5f2fb1SJesse Gross 	 * operations on 'dst' only use contents within 'mask->range'.
66e6445719SPravin B Shelar 	 */
67ae5f2fb1SJesse Gross 	for (i = 0; i < len; i += sizeof(long))
68e6445719SPravin B Shelar 		*d++ = *s++ & *m++;
69e6445719SPravin B Shelar }
70e6445719SPravin B Shelar 
7123dabf88SJarno Rajahalme struct sw_flow *ovs_flow_alloc(void)
72e6445719SPravin B Shelar {
73e6445719SPravin B Shelar 	struct sw_flow *flow;
74aef833c5SPablo Neira Ayuso 	struct sw_flow_stats *stats;
75e6445719SPravin B Shelar 
76db74a333SThadeu Lima de Souza Cascardo 	flow = kmem_cache_zalloc(flow_cache, GFP_KERNEL);
77e6445719SPravin B Shelar 	if (!flow)
78e6445719SPravin B Shelar 		return ERR_PTR(-ENOMEM);
79e6445719SPravin B Shelar 
80db74a333SThadeu Lima de Souza Cascardo 	flow->stats_last_writer = -1;
81e6445719SPravin B Shelar 
8263e7959cSJarno Rajahalme 	/* Initialize the default stat node. */
8363e7959cSJarno Rajahalme 	stats = kmem_cache_alloc_node(flow_stats_cache,
84598c12d0SKonstantin Khlebnikov 				      GFP_KERNEL | __GFP_ZERO,
85598c12d0SKonstantin Khlebnikov 				      node_online(0) ? 0 : NUMA_NO_NODE);
8663e7959cSJarno Rajahalme 	if (!stats)
87e298e505SPravin B Shelar 		goto err;
88e298e505SPravin B Shelar 
8963e7959cSJarno Rajahalme 	spin_lock_init(&stats->lock);
90e298e505SPravin B Shelar 
9163e7959cSJarno Rajahalme 	RCU_INIT_POINTER(flow->stats[0], stats);
9263e7959cSJarno Rajahalme 
93c4b2bf6bSTonghao Zhang 	cpumask_set_cpu(0, &flow->cpu_used_mask);
94c4b2bf6bSTonghao Zhang 
95e6445719SPravin B Shelar 	return flow;
96e298e505SPravin B Shelar err:
97ece37c87SWei Yongjun 	kmem_cache_free(flow_cache, flow);
98e298e505SPravin B Shelar 	return ERR_PTR(-ENOMEM);
99e6445719SPravin B Shelar }
100e6445719SPravin B Shelar 
10112eb18f7SThomas Graf int ovs_flow_tbl_count(const struct flow_table *table)
102b637e498SPravin B Shelar {
103b637e498SPravin B Shelar 	return table->count;
104b637e498SPravin B Shelar }
105b637e498SPravin B Shelar 
106e6445719SPravin B Shelar static void flow_free(struct sw_flow *flow)
107e6445719SPravin B Shelar {
108db74a333SThadeu Lima de Souza Cascardo 	int cpu;
10963e7959cSJarno Rajahalme 
11074ed7ab9SJoe Stringer 	if (ovs_identifier_is_key(&flow->id))
11174ed7ab9SJoe Stringer 		kfree(flow->id.unmasked_key);
11234ae932aSThomas Graf 	if (flow->sf_acts)
11334ae932aSThomas Graf 		ovs_nla_free_flow_actions((struct sw_flow_actions __force *)flow->sf_acts);
114db74a333SThadeu Lima de Souza Cascardo 	/* We open code this to make sure cpu 0 is always considered */
115c4b2bf6bSTonghao Zhang 	for (cpu = 0; cpu < nr_cpu_ids; cpu = cpumask_next(cpu, &flow->cpu_used_mask))
116db74a333SThadeu Lima de Souza Cascardo 		if (flow->stats[cpu])
11763e7959cSJarno Rajahalme 			kmem_cache_free(flow_stats_cache,
118aef833c5SPablo Neira Ayuso 					(struct sw_flow_stats __force *)flow->stats[cpu]);
119e6445719SPravin B Shelar 	kmem_cache_free(flow_cache, flow);
120e6445719SPravin B Shelar }
121e6445719SPravin B Shelar 
122e6445719SPravin B Shelar static void rcu_free_flow_callback(struct rcu_head *rcu)
123e6445719SPravin B Shelar {
124e6445719SPravin B Shelar 	struct sw_flow *flow = container_of(rcu, struct sw_flow, rcu);
125e6445719SPravin B Shelar 
126e6445719SPravin B Shelar 	flow_free(flow);
127e6445719SPravin B Shelar }
128e6445719SPravin B Shelar 
129e80857ccSAndy Zhou void ovs_flow_free(struct sw_flow *flow, bool deferred)
130618ed0c8SPravin B Shelar {
131e80857ccSAndy Zhou 	if (!flow)
132618ed0c8SPravin B Shelar 		return;
133618ed0c8SPravin B Shelar 
134e6445719SPravin B Shelar 	if (deferred)
135e6445719SPravin B Shelar 		call_rcu(&flow->rcu, rcu_free_flow_callback);
136e6445719SPravin B Shelar 	else
137e6445719SPravin B Shelar 		flow_free(flow);
138e6445719SPravin B Shelar }
139e6445719SPravin B Shelar 
140b637e498SPravin B Shelar static void __table_instance_destroy(struct table_instance *ti)
141e6445719SPravin B Shelar {
142ee9c5e67SKent Overstreet 	kvfree(ti->buckets);
143b637e498SPravin B Shelar 	kfree(ti);
144e6445719SPravin B Shelar }
145e6445719SPravin B Shelar 
146b637e498SPravin B Shelar static struct table_instance *table_instance_alloc(int new_size)
147e6445719SPravin B Shelar {
148b637e498SPravin B Shelar 	struct table_instance *ti = kmalloc(sizeof(*ti), GFP_KERNEL);
149ee9c5e67SKent Overstreet 	int i;
150e6445719SPravin B Shelar 
151b637e498SPravin B Shelar 	if (!ti)
152e6445719SPravin B Shelar 		return NULL;
153e6445719SPravin B Shelar 
154ee9c5e67SKent Overstreet 	ti->buckets = kvmalloc_array(new_size, sizeof(struct hlist_head),
155ee9c5e67SKent Overstreet 				     GFP_KERNEL);
156b637e498SPravin B Shelar 	if (!ti->buckets) {
157b637e498SPravin B Shelar 		kfree(ti);
158e6445719SPravin B Shelar 		return NULL;
159e6445719SPravin B Shelar 	}
160ee9c5e67SKent Overstreet 
161ee9c5e67SKent Overstreet 	for (i = 0; i < new_size; i++)
162ee9c5e67SKent Overstreet 		INIT_HLIST_HEAD(&ti->buckets[i]);
163ee9c5e67SKent Overstreet 
164b637e498SPravin B Shelar 	ti->n_buckets = new_size;
165b637e498SPravin B Shelar 	ti->node_ver = 0;
166b637e498SPravin B Shelar 	ti->keep_flows = false;
167b637e498SPravin B Shelar 	get_random_bytes(&ti->hash_seed, sizeof(u32));
168b637e498SPravin B Shelar 
169b637e498SPravin B Shelar 	return ti;
170b637e498SPravin B Shelar }
171b637e498SPravin B Shelar 
1724bc63b1bSTonghao Zhang static struct mask_array *tbl_mask_array_alloc(int size)
1734bc63b1bSTonghao Zhang {
1744bc63b1bSTonghao Zhang 	struct mask_array *new;
1754bc63b1bSTonghao Zhang 
1764bc63b1bSTonghao Zhang 	size = max(MASK_ARRAY_SIZE_MIN, size);
1774bc63b1bSTonghao Zhang 	new = kzalloc(sizeof(struct mask_array) +
1784bc63b1bSTonghao Zhang 		      sizeof(struct sw_flow_mask *) * size, GFP_KERNEL);
1794bc63b1bSTonghao Zhang 	if (!new)
1804bc63b1bSTonghao Zhang 		return NULL;
1814bc63b1bSTonghao Zhang 
1824bc63b1bSTonghao Zhang 	new->count = 0;
1834bc63b1bSTonghao Zhang 	new->max = size;
1844bc63b1bSTonghao Zhang 
1854bc63b1bSTonghao Zhang 	return new;
1864bc63b1bSTonghao Zhang }
1874bc63b1bSTonghao Zhang 
1884bc63b1bSTonghao Zhang static int tbl_mask_array_realloc(struct flow_table *tbl, int size)
1894bc63b1bSTonghao Zhang {
1904bc63b1bSTonghao Zhang 	struct mask_array *old;
1914bc63b1bSTonghao Zhang 	struct mask_array *new;
1924bc63b1bSTonghao Zhang 
1934bc63b1bSTonghao Zhang 	new = tbl_mask_array_alloc(size);
1944bc63b1bSTonghao Zhang 	if (!new)
1954bc63b1bSTonghao Zhang 		return -ENOMEM;
1964bc63b1bSTonghao Zhang 
1974bc63b1bSTonghao Zhang 	old = ovsl_dereference(tbl->mask_array);
1984bc63b1bSTonghao Zhang 	if (old) {
1994bc63b1bSTonghao Zhang 		int i;
2004bc63b1bSTonghao Zhang 
2014bc63b1bSTonghao Zhang 		for (i = 0; i < old->max; i++) {
2024bc63b1bSTonghao Zhang 			if (ovsl_dereference(old->masks[i]))
2034bc63b1bSTonghao Zhang 				new->masks[new->count++] = old->masks[i];
2044bc63b1bSTonghao Zhang 		}
2054bc63b1bSTonghao Zhang 	}
2064bc63b1bSTonghao Zhang 
2074bc63b1bSTonghao Zhang 	rcu_assign_pointer(tbl->mask_array, new);
2084bc63b1bSTonghao Zhang 	kfree_rcu(old, rcu);
2094bc63b1bSTonghao Zhang 
2104bc63b1bSTonghao Zhang 	return 0;
2114bc63b1bSTonghao Zhang }
2124bc63b1bSTonghao Zhang 
213b637e498SPravin B Shelar int ovs_flow_tbl_init(struct flow_table *table)
214b637e498SPravin B Shelar {
21574ed7ab9SJoe Stringer 	struct table_instance *ti, *ufid_ti;
2164bc63b1bSTonghao Zhang 	struct mask_array *ma;
217b637e498SPravin B Shelar 
21804b7d136STonghao Zhang 	table->mask_cache = __alloc_percpu(sizeof(struct mask_cache_entry) *
21904b7d136STonghao Zhang 					   MC_HASH_ENTRIES,
22004b7d136STonghao Zhang 					   __alignof__(struct mask_cache_entry));
22104b7d136STonghao Zhang 	if (!table->mask_cache)
222b637e498SPravin B Shelar 		return -ENOMEM;
223b637e498SPravin B Shelar 
2244bc63b1bSTonghao Zhang 	ma = tbl_mask_array_alloc(MASK_ARRAY_SIZE_MIN);
2254bc63b1bSTonghao Zhang 	if (!ma)
2264bc63b1bSTonghao Zhang 		goto free_mask_cache;
2274bc63b1bSTonghao Zhang 
22804b7d136STonghao Zhang 	ti = table_instance_alloc(TBL_MIN_BUCKETS);
22904b7d136STonghao Zhang 	if (!ti)
2304bc63b1bSTonghao Zhang 		goto free_mask_array;
23104b7d136STonghao Zhang 
23274ed7ab9SJoe Stringer 	ufid_ti = table_instance_alloc(TBL_MIN_BUCKETS);
23374ed7ab9SJoe Stringer 	if (!ufid_ti)
23474ed7ab9SJoe Stringer 		goto free_ti;
23574ed7ab9SJoe Stringer 
236b637e498SPravin B Shelar 	rcu_assign_pointer(table->ti, ti);
23774ed7ab9SJoe Stringer 	rcu_assign_pointer(table->ufid_ti, ufid_ti);
2384bc63b1bSTonghao Zhang 	rcu_assign_pointer(table->mask_array, ma);
239b637e498SPravin B Shelar 	table->last_rehash = jiffies;
240e6445719SPravin B Shelar 	table->count = 0;
24174ed7ab9SJoe Stringer 	table->ufid_count = 0;
242b637e498SPravin B Shelar 	return 0;
24374ed7ab9SJoe Stringer 
24474ed7ab9SJoe Stringer free_ti:
24574ed7ab9SJoe Stringer 	__table_instance_destroy(ti);
2464bc63b1bSTonghao Zhang free_mask_array:
2474bc63b1bSTonghao Zhang 	kfree(ma);
24804b7d136STonghao Zhang free_mask_cache:
24904b7d136STonghao Zhang 	free_percpu(table->mask_cache);
25074ed7ab9SJoe Stringer 	return -ENOMEM;
251e6445719SPravin B Shelar }
252e6445719SPravin B Shelar 
253e6445719SPravin B Shelar static void flow_tbl_destroy_rcu_cb(struct rcu_head *rcu)
254e6445719SPravin B Shelar {
255b637e498SPravin B Shelar 	struct table_instance *ti = container_of(rcu, struct table_instance, rcu);
256e6445719SPravin B Shelar 
257b637e498SPravin B Shelar 	__table_instance_destroy(ti);
258b637e498SPravin B Shelar }
259b637e498SPravin B Shelar 
26074ed7ab9SJoe Stringer static void table_instance_destroy(struct table_instance *ti,
26174ed7ab9SJoe Stringer 				   struct table_instance *ufid_ti,
26274ed7ab9SJoe Stringer 				   bool deferred)
263b637e498SPravin B Shelar {
264e80857ccSAndy Zhou 	int i;
265e80857ccSAndy Zhou 
266b637e498SPravin B Shelar 	if (!ti)
267b637e498SPravin B Shelar 		return;
268b637e498SPravin B Shelar 
26974ed7ab9SJoe Stringer 	BUG_ON(!ufid_ti);
270e80857ccSAndy Zhou 	if (ti->keep_flows)
271e80857ccSAndy Zhou 		goto skip_flows;
272e80857ccSAndy Zhou 
273e80857ccSAndy Zhou 	for (i = 0; i < ti->n_buckets; i++) {
274e80857ccSAndy Zhou 		struct sw_flow *flow;
275ee9c5e67SKent Overstreet 		struct hlist_head *head = &ti->buckets[i];
276e80857ccSAndy Zhou 		struct hlist_node *n;
277e80857ccSAndy Zhou 		int ver = ti->node_ver;
27874ed7ab9SJoe Stringer 		int ufid_ver = ufid_ti->node_ver;
279e80857ccSAndy Zhou 
28074ed7ab9SJoe Stringer 		hlist_for_each_entry_safe(flow, n, head, flow_table.node[ver]) {
28174ed7ab9SJoe Stringer 			hlist_del_rcu(&flow->flow_table.node[ver]);
28274ed7ab9SJoe Stringer 			if (ovs_identifier_is_ufid(&flow->id))
28374ed7ab9SJoe Stringer 				hlist_del_rcu(&flow->ufid_table.node[ufid_ver]);
284e80857ccSAndy Zhou 			ovs_flow_free(flow, deferred);
285e80857ccSAndy Zhou 		}
286e80857ccSAndy Zhou 	}
287e80857ccSAndy Zhou 
288e80857ccSAndy Zhou skip_flows:
28974ed7ab9SJoe Stringer 	if (deferred) {
290b637e498SPravin B Shelar 		call_rcu(&ti->rcu, flow_tbl_destroy_rcu_cb);
29174ed7ab9SJoe Stringer 		call_rcu(&ufid_ti->rcu, flow_tbl_destroy_rcu_cb);
29274ed7ab9SJoe Stringer 	} else {
293b637e498SPravin B Shelar 		__table_instance_destroy(ti);
29474ed7ab9SJoe Stringer 		__table_instance_destroy(ufid_ti);
29574ed7ab9SJoe Stringer 	}
296e6445719SPravin B Shelar }
297e6445719SPravin B Shelar 
2989b996e54SPravin B Shelar /* No need for locking this function is called from RCU callback or
2999b996e54SPravin B Shelar  * error path.
3009b996e54SPravin B Shelar  */
3019b996e54SPravin B Shelar void ovs_flow_tbl_destroy(struct flow_table *table)
302e6445719SPravin B Shelar {
3039b996e54SPravin B Shelar 	struct table_instance *ti = rcu_dereference_raw(table->ti);
30474ed7ab9SJoe Stringer 	struct table_instance *ufid_ti = rcu_dereference_raw(table->ufid_ti);
305e6445719SPravin B Shelar 
30604b7d136STonghao Zhang 	free_percpu(table->mask_cache);
3074bc63b1bSTonghao Zhang 	kfree_rcu(rcu_dereference_raw(table->mask_array), rcu);
30874ed7ab9SJoe Stringer 	table_instance_destroy(ti, ufid_ti, false);
309e6445719SPravin B Shelar }
310e6445719SPravin B Shelar 
311b637e498SPravin B Shelar struct sw_flow *ovs_flow_tbl_dump_next(struct table_instance *ti,
312e6445719SPravin B Shelar 				       u32 *bucket, u32 *last)
313e6445719SPravin B Shelar {
314e6445719SPravin B Shelar 	struct sw_flow *flow;
315e6445719SPravin B Shelar 	struct hlist_head *head;
316e6445719SPravin B Shelar 	int ver;
317e6445719SPravin B Shelar 	int i;
318e6445719SPravin B Shelar 
319b637e498SPravin B Shelar 	ver = ti->node_ver;
320b637e498SPravin B Shelar 	while (*bucket < ti->n_buckets) {
321e6445719SPravin B Shelar 		i = 0;
322ee9c5e67SKent Overstreet 		head = &ti->buckets[*bucket];
32374ed7ab9SJoe Stringer 		hlist_for_each_entry_rcu(flow, head, flow_table.node[ver]) {
324e6445719SPravin B Shelar 			if (i < *last) {
325e6445719SPravin B Shelar 				i++;
326e6445719SPravin B Shelar 				continue;
327e6445719SPravin B Shelar 			}
328e6445719SPravin B Shelar 			*last = i + 1;
329e6445719SPravin B Shelar 			return flow;
330e6445719SPravin B Shelar 		}
331e6445719SPravin B Shelar 		(*bucket)++;
332e6445719SPravin B Shelar 		*last = 0;
333e6445719SPravin B Shelar 	}
334e6445719SPravin B Shelar 
335e6445719SPravin B Shelar 	return NULL;
336e6445719SPravin B Shelar }
337e6445719SPravin B Shelar 
338b637e498SPravin B Shelar static struct hlist_head *find_bucket(struct table_instance *ti, u32 hash)
339e6445719SPravin B Shelar {
340b637e498SPravin B Shelar 	hash = jhash_1word(hash, ti->hash_seed);
341ee9c5e67SKent Overstreet 	return &ti->buckets[hash & (ti->n_buckets - 1)];
342e6445719SPravin B Shelar }
343e6445719SPravin B Shelar 
34474ed7ab9SJoe Stringer static void table_instance_insert(struct table_instance *ti,
34574ed7ab9SJoe Stringer 				  struct sw_flow *flow)
346e6445719SPravin B Shelar {
347e6445719SPravin B Shelar 	struct hlist_head *head;
348e6445719SPravin B Shelar 
34974ed7ab9SJoe Stringer 	head = find_bucket(ti, flow->flow_table.hash);
35074ed7ab9SJoe Stringer 	hlist_add_head_rcu(&flow->flow_table.node[ti->node_ver], head);
35174ed7ab9SJoe Stringer }
35274ed7ab9SJoe Stringer 
35374ed7ab9SJoe Stringer static void ufid_table_instance_insert(struct table_instance *ti,
35474ed7ab9SJoe Stringer 				       struct sw_flow *flow)
35574ed7ab9SJoe Stringer {
35674ed7ab9SJoe Stringer 	struct hlist_head *head;
35774ed7ab9SJoe Stringer 
35874ed7ab9SJoe Stringer 	head = find_bucket(ti, flow->ufid_table.hash);
35974ed7ab9SJoe Stringer 	hlist_add_head_rcu(&flow->ufid_table.node[ti->node_ver], head);
360e6445719SPravin B Shelar }
361e6445719SPravin B Shelar 
362b637e498SPravin B Shelar static void flow_table_copy_flows(struct table_instance *old,
36374ed7ab9SJoe Stringer 				  struct table_instance *new, bool ufid)
364e6445719SPravin B Shelar {
365e6445719SPravin B Shelar 	int old_ver;
366e6445719SPravin B Shelar 	int i;
367e6445719SPravin B Shelar 
368e6445719SPravin B Shelar 	old_ver = old->node_ver;
369e6445719SPravin B Shelar 	new->node_ver = !old_ver;
370e6445719SPravin B Shelar 
371e6445719SPravin B Shelar 	/* Insert in new table. */
372e6445719SPravin B Shelar 	for (i = 0; i < old->n_buckets; i++) {
373e6445719SPravin B Shelar 		struct sw_flow *flow;
374ee9c5e67SKent Overstreet 		struct hlist_head *head = &old->buckets[i];
375e6445719SPravin B Shelar 
37674ed7ab9SJoe Stringer 		if (ufid)
37774ed7ab9SJoe Stringer 			hlist_for_each_entry(flow, head,
37874ed7ab9SJoe Stringer 					     ufid_table.node[old_ver])
37974ed7ab9SJoe Stringer 				ufid_table_instance_insert(new, flow);
38074ed7ab9SJoe Stringer 		else
38174ed7ab9SJoe Stringer 			hlist_for_each_entry(flow, head,
38274ed7ab9SJoe Stringer 					     flow_table.node[old_ver])
383b637e498SPravin B Shelar 				table_instance_insert(new, flow);
384e6445719SPravin B Shelar 	}
385e6445719SPravin B Shelar 
386e6445719SPravin B Shelar 	old->keep_flows = true;
387e6445719SPravin B Shelar }
388e6445719SPravin B Shelar 
389b637e498SPravin B Shelar static struct table_instance *table_instance_rehash(struct table_instance *ti,
39074ed7ab9SJoe Stringer 						    int n_buckets, bool ufid)
391e6445719SPravin B Shelar {
392b637e498SPravin B Shelar 	struct table_instance *new_ti;
393e6445719SPravin B Shelar 
394b637e498SPravin B Shelar 	new_ti = table_instance_alloc(n_buckets);
395b637e498SPravin B Shelar 	if (!new_ti)
396618ed0c8SPravin B Shelar 		return NULL;
397e6445719SPravin B Shelar 
39874ed7ab9SJoe Stringer 	flow_table_copy_flows(ti, new_ti, ufid);
399e6445719SPravin B Shelar 
400b637e498SPravin B Shelar 	return new_ti;
401e6445719SPravin B Shelar }
402e6445719SPravin B Shelar 
403b637e498SPravin B Shelar int ovs_flow_tbl_flush(struct flow_table *flow_table)
404e6445719SPravin B Shelar {
40574ed7ab9SJoe Stringer 	struct table_instance *old_ti, *new_ti;
40674ed7ab9SJoe Stringer 	struct table_instance *old_ufid_ti, *new_ufid_ti;
407e6445719SPravin B Shelar 
408b637e498SPravin B Shelar 	new_ti = table_instance_alloc(TBL_MIN_BUCKETS);
409b637e498SPravin B Shelar 	if (!new_ti)
410b637e498SPravin B Shelar 		return -ENOMEM;
41174ed7ab9SJoe Stringer 	new_ufid_ti = table_instance_alloc(TBL_MIN_BUCKETS);
41274ed7ab9SJoe Stringer 	if (!new_ufid_ti)
41374ed7ab9SJoe Stringer 		goto err_free_ti;
41474ed7ab9SJoe Stringer 
41574ed7ab9SJoe Stringer 	old_ti = ovsl_dereference(flow_table->ti);
41674ed7ab9SJoe Stringer 	old_ufid_ti = ovsl_dereference(flow_table->ufid_ti);
417b637e498SPravin B Shelar 
418b637e498SPravin B Shelar 	rcu_assign_pointer(flow_table->ti, new_ti);
41974ed7ab9SJoe Stringer 	rcu_assign_pointer(flow_table->ufid_ti, new_ufid_ti);
420b637e498SPravin B Shelar 	flow_table->last_rehash = jiffies;
421b637e498SPravin B Shelar 	flow_table->count = 0;
42274ed7ab9SJoe Stringer 	flow_table->ufid_count = 0;
423b637e498SPravin B Shelar 
42474ed7ab9SJoe Stringer 	table_instance_destroy(old_ti, old_ufid_ti, true);
425b637e498SPravin B Shelar 	return 0;
42674ed7ab9SJoe Stringer 
42774ed7ab9SJoe Stringer err_free_ti:
42874ed7ab9SJoe Stringer 	__table_instance_destroy(new_ti);
42974ed7ab9SJoe Stringer 	return -ENOMEM;
430e6445719SPravin B Shelar }
431e6445719SPravin B Shelar 
432272c2cf8SJoe Stringer static u32 flow_hash(const struct sw_flow_key *key,
433272c2cf8SJoe Stringer 		     const struct sw_flow_key_range *range)
434e6445719SPravin B Shelar {
435515b65a4STonghao Zhang 	const u32 *hash_key = (const u32 *)((const u8 *)key + range->start);
436e6445719SPravin B Shelar 
437e6445719SPravin B Shelar 	/* Make sure number of hash bytes are multiple of u32. */
438515b65a4STonghao Zhang 	int hash_u32s = range_n_bytes(range) >> 2;
439e6445719SPravin B Shelar 
44087545899SDaniel Borkmann 	return jhash2(hash_key, hash_u32s, 0);
441e6445719SPravin B Shelar }
442e6445719SPravin B Shelar 
443e6445719SPravin B Shelar static int flow_key_start(const struct sw_flow_key *key)
444e6445719SPravin B Shelar {
44500a93babSJiri Benc 	if (key->tun_proto)
446e6445719SPravin B Shelar 		return 0;
447e6445719SPravin B Shelar 	else
448e6445719SPravin B Shelar 		return rounddown(offsetof(struct sw_flow_key, phy),
449e6445719SPravin B Shelar 					  sizeof(long));
450e6445719SPravin B Shelar }
451e6445719SPravin B Shelar 
452e6445719SPravin B Shelar static bool cmp_key(const struct sw_flow_key *key1,
453e6445719SPravin B Shelar 		    const struct sw_flow_key *key2,
454e6445719SPravin B Shelar 		    int key_start, int key_end)
455e6445719SPravin B Shelar {
4567085130bSDaniele Di Proietto 	const long *cp1 = (const long *)((const u8 *)key1 + key_start);
4577085130bSDaniele Di Proietto 	const long *cp2 = (const long *)((const u8 *)key2 + key_start);
458e6445719SPravin B Shelar 	long diffs = 0;
459e6445719SPravin B Shelar 	int i;
460e6445719SPravin B Shelar 
461e6445719SPravin B Shelar 	for (i = key_start; i < key_end;  i += sizeof(long))
462e6445719SPravin B Shelar 		diffs |= *cp1++ ^ *cp2++;
463e6445719SPravin B Shelar 
464e6445719SPravin B Shelar 	return diffs == 0;
465e6445719SPravin B Shelar }
466e6445719SPravin B Shelar 
467e6445719SPravin B Shelar static bool flow_cmp_masked_key(const struct sw_flow *flow,
468e6445719SPravin B Shelar 				const struct sw_flow_key *key,
469272c2cf8SJoe Stringer 				const struct sw_flow_key_range *range)
470e6445719SPravin B Shelar {
471272c2cf8SJoe Stringer 	return cmp_key(&flow->key, key, range->start, range->end);
472e6445719SPravin B Shelar }
473e6445719SPravin B Shelar 
47474ed7ab9SJoe Stringer static bool ovs_flow_cmp_unmasked_key(const struct sw_flow *flow,
47512eb18f7SThomas Graf 				      const struct sw_flow_match *match)
476e6445719SPravin B Shelar {
477e6445719SPravin B Shelar 	struct sw_flow_key *key = match->key;
478e6445719SPravin B Shelar 	int key_start = flow_key_start(key);
479e6445719SPravin B Shelar 	int key_end = match->range.end;
480e6445719SPravin B Shelar 
48174ed7ab9SJoe Stringer 	BUG_ON(ovs_identifier_is_ufid(&flow->id));
48274ed7ab9SJoe Stringer 	return cmp_key(flow->id.unmasked_key, key, key_start, key_end);
483e6445719SPravin B Shelar }
484e6445719SPravin B Shelar 
485b637e498SPravin B Shelar static struct sw_flow *masked_flow_lookup(struct table_instance *ti,
486e6445719SPravin B Shelar 					  const struct sw_flow_key *unmasked,
48704b7d136STonghao Zhang 					  const struct sw_flow_mask *mask,
48804b7d136STonghao Zhang 					  u32 *n_mask_hit)
489e6445719SPravin B Shelar {
490e6445719SPravin B Shelar 	struct sw_flow *flow;
491e6445719SPravin B Shelar 	struct hlist_head *head;
492e6445719SPravin B Shelar 	u32 hash;
493e6445719SPravin B Shelar 	struct sw_flow_key masked_key;
494e6445719SPravin B Shelar 
495ae5f2fb1SJesse Gross 	ovs_flow_mask_key(&masked_key, unmasked, false, mask);
496272c2cf8SJoe Stringer 	hash = flow_hash(&masked_key, &mask->range);
497b637e498SPravin B Shelar 	head = find_bucket(ti, hash);
49804b7d136STonghao Zhang 	(*n_mask_hit)++;
49904b7d136STonghao Zhang 
50074ed7ab9SJoe Stringer 	hlist_for_each_entry_rcu(flow, head, flow_table.node[ti->node_ver]) {
50174ed7ab9SJoe Stringer 		if (flow->mask == mask && flow->flow_table.hash == hash &&
502272c2cf8SJoe Stringer 		    flow_cmp_masked_key(flow, &masked_key, &mask->range))
503e6445719SPravin B Shelar 			return flow;
504e6445719SPravin B Shelar 	}
505e6445719SPravin B Shelar 	return NULL;
506e6445719SPravin B Shelar }
507e6445719SPravin B Shelar 
508a7f35e78STonghao Zhang /* Flow lookup does full lookup on flow table. It starts with
509a7f35e78STonghao Zhang  * mask from index passed in *index.
510a7f35e78STonghao Zhang  */
51104b7d136STonghao Zhang static struct sw_flow *flow_lookup(struct flow_table *tbl,
51204b7d136STonghao Zhang 				   struct table_instance *ti,
5134bc63b1bSTonghao Zhang 				   struct mask_array *ma,
5141bd7116fSAndy Zhou 				   const struct sw_flow_key *key,
5154bc63b1bSTonghao Zhang 				   u32 *n_mask_hit,
5164bc63b1bSTonghao Zhang 				   u32 *index)
517e6445719SPravin B Shelar {
518b637e498SPravin B Shelar 	struct sw_flow *flow;
51957f7d7b9STonghao Zhang 	struct sw_flow_mask *mask;
5204bc63b1bSTonghao Zhang 	int i;
521e6445719SPravin B Shelar 
522*0a3e0137STonghao Zhang 	if (likely(*index < ma->max)) {
523a7f35e78STonghao Zhang 		mask = rcu_dereference_ovsl(ma->masks[*index]);
524a7f35e78STonghao Zhang 		if (mask) {
525a7f35e78STonghao Zhang 			flow = masked_flow_lookup(ti, key, mask, n_mask_hit);
526a7f35e78STonghao Zhang 			if (flow)
527a7f35e78STonghao Zhang 				return flow;
528a7f35e78STonghao Zhang 		}
529a7f35e78STonghao Zhang 	}
530a7f35e78STonghao Zhang 
5314bc63b1bSTonghao Zhang 	for (i = 0; i < ma->max; i++)  {
532a7f35e78STonghao Zhang 
533a7f35e78STonghao Zhang 		if (i == *index)
534a7f35e78STonghao Zhang 			continue;
5354bc63b1bSTonghao Zhang 
5364bc63b1bSTonghao Zhang 		mask = rcu_dereference_ovsl(ma->masks[i]);
537*0a3e0137STonghao Zhang 		if (unlikely(!mask))
53857f7d7b9STonghao Zhang 			break;
539a7f35e78STonghao Zhang 
54004b7d136STonghao Zhang 		flow = masked_flow_lookup(ti, key, mask, n_mask_hit);
5414bc63b1bSTonghao Zhang 		if (flow) { /* Found */
5424bc63b1bSTonghao Zhang 			*index = i;
543b637e498SPravin B Shelar 			return flow;
544b637e498SPravin B Shelar 		}
5454bc63b1bSTonghao Zhang 	}
5464bc63b1bSTonghao Zhang 
547b637e498SPravin B Shelar 	return NULL;
548e6445719SPravin B Shelar }
549e6445719SPravin B Shelar 
55004b7d136STonghao Zhang /*
55104b7d136STonghao Zhang  * mask_cache maps flow to probable mask. This cache is not tightly
55204b7d136STonghao Zhang  * coupled cache, It means updates to  mask list can result in inconsistent
55304b7d136STonghao Zhang  * cache entry in mask cache.
55404b7d136STonghao Zhang  * This is per cpu cache and is divided in MC_HASH_SEGS segments.
55504b7d136STonghao Zhang  * In case of a hash collision the entry is hashed in next segment.
55604b7d136STonghao Zhang  * */
55704b7d136STonghao Zhang struct sw_flow *ovs_flow_tbl_lookup_stats(struct flow_table *tbl,
55804b7d136STonghao Zhang 					  const struct sw_flow_key *key,
55904b7d136STonghao Zhang 					  u32 skb_hash,
56004b7d136STonghao Zhang 					  u32 *n_mask_hit)
56104b7d136STonghao Zhang {
562a7f35e78STonghao Zhang 	struct mask_array *ma = rcu_dereference(tbl->mask_array);
563a7f35e78STonghao Zhang 	struct table_instance *ti = rcu_dereference(tbl->ti);
564a7f35e78STonghao Zhang 	struct mask_cache_entry *entries, *ce;
56504b7d136STonghao Zhang 	struct sw_flow *flow;
566a7f35e78STonghao Zhang 	u32 hash;
56704b7d136STonghao Zhang 	int seg;
56804b7d136STonghao Zhang 
56904b7d136STonghao Zhang 	*n_mask_hit = 0;
5704bc63b1bSTonghao Zhang 	if (unlikely(!skb_hash)) {
571a7f35e78STonghao Zhang 		u32 mask_index = 0;
5724bc63b1bSTonghao Zhang 
5734bc63b1bSTonghao Zhang 		return flow_lookup(tbl, ti, ma, key, n_mask_hit, &mask_index);
5744bc63b1bSTonghao Zhang 	}
57504b7d136STonghao Zhang 
576a7f35e78STonghao Zhang 	/* Pre and post recirulation flows usually have the same skb_hash
577a7f35e78STonghao Zhang 	 * value. To avoid hash collisions, rehash the 'skb_hash' with
578a7f35e78STonghao Zhang 	 * 'recirc_id'.  */
579a7f35e78STonghao Zhang 	if (key->recirc_id)
580a7f35e78STonghao Zhang 		skb_hash = jhash_1word(skb_hash, key->recirc_id);
581a7f35e78STonghao Zhang 
582a7f35e78STonghao Zhang 	ce = NULL;
583a7f35e78STonghao Zhang 	hash = skb_hash;
58404b7d136STonghao Zhang 	entries = this_cpu_ptr(tbl->mask_cache);
58504b7d136STonghao Zhang 
586a7f35e78STonghao Zhang 	/* Find the cache entry 'ce' to operate on. */
58704b7d136STonghao Zhang 	for (seg = 0; seg < MC_HASH_SEGS; seg++) {
588a7f35e78STonghao Zhang 		int index = hash & (MC_HASH_ENTRIES - 1);
589a7f35e78STonghao Zhang 		struct mask_cache_entry *e;
59004b7d136STonghao Zhang 
591a7f35e78STonghao Zhang 		e = &entries[index];
592a7f35e78STonghao Zhang 		if (e->skb_hash == skb_hash) {
593a7f35e78STonghao Zhang 			flow = flow_lookup(tbl, ti, ma, key, n_mask_hit,
594a7f35e78STonghao Zhang 					   &e->mask_index);
595a7f35e78STonghao Zhang 			if (!flow)
596a7f35e78STonghao Zhang 				e->skb_hash = 0;
59704b7d136STonghao Zhang 			return flow;
59804b7d136STonghao Zhang 		}
59904b7d136STonghao Zhang 
600a7f35e78STonghao Zhang 		if (!ce || e->skb_hash < ce->skb_hash)
601a7f35e78STonghao Zhang 			ce = e;  /* A better replacement cache candidate. */
60204b7d136STonghao Zhang 
60304b7d136STonghao Zhang 		hash >>= MC_HASH_SHIFT;
60404b7d136STonghao Zhang 	}
60504b7d136STonghao Zhang 
606a7f35e78STonghao Zhang 	/* Cache miss, do full lookup. */
607a7f35e78STonghao Zhang 	flow = flow_lookup(tbl, ti, ma, key, n_mask_hit, &ce->mask_index);
6084bc63b1bSTonghao Zhang 	if (flow)
609a7f35e78STonghao Zhang 		ce->skb_hash = skb_hash;
61004b7d136STonghao Zhang 
61104b7d136STonghao Zhang 	return flow;
61204b7d136STonghao Zhang }
61304b7d136STonghao Zhang 
6145bb50632SAndy Zhou struct sw_flow *ovs_flow_tbl_lookup(struct flow_table *tbl,
6155bb50632SAndy Zhou 				    const struct sw_flow_key *key)
6165bb50632SAndy Zhou {
61704b7d136STonghao Zhang 	struct table_instance *ti = rcu_dereference_ovsl(tbl->ti);
6184bc63b1bSTonghao Zhang 	struct mask_array *ma = rcu_dereference_ovsl(tbl->mask_array);
6194bc63b1bSTonghao Zhang 	u32 __always_unused n_mask_hit;
620a7f35e78STonghao Zhang 	u32 index = 0;
6214bc63b1bSTonghao Zhang 
6224bc63b1bSTonghao Zhang 	return flow_lookup(tbl, ti, ma, key, &n_mask_hit, &index);
6235bb50632SAndy Zhou }
6245bb50632SAndy Zhou 
6254a46b24eSAlex Wang struct sw_flow *ovs_flow_tbl_lookup_exact(struct flow_table *tbl,
62612eb18f7SThomas Graf 					  const struct sw_flow_match *match)
6274a46b24eSAlex Wang {
6284bc63b1bSTonghao Zhang 	struct mask_array *ma = ovsl_dereference(tbl->mask_array);
6294bc63b1bSTonghao Zhang 	int i;
6304a46b24eSAlex Wang 
6314a46b24eSAlex Wang 	/* Always called under ovs-mutex. */
6324bc63b1bSTonghao Zhang 	for (i = 0; i < ma->max; i++) {
6334bc63b1bSTonghao Zhang 		struct table_instance *ti = rcu_dereference_ovsl(tbl->ti);
6344bc63b1bSTonghao Zhang 		u32 __always_unused n_mask_hit;
6354bc63b1bSTonghao Zhang 		struct sw_flow_mask *mask;
6364bc63b1bSTonghao Zhang 		struct sw_flow *flow;
6374bc63b1bSTonghao Zhang 
6384bc63b1bSTonghao Zhang 		mask = ovsl_dereference(ma->masks[i]);
6394bc63b1bSTonghao Zhang 		if (!mask)
6404bc63b1bSTonghao Zhang 			continue;
6414bc63b1bSTonghao Zhang 
64204b7d136STonghao Zhang 		flow = masked_flow_lookup(ti, match->key, mask, &n_mask_hit);
64374ed7ab9SJoe Stringer 		if (flow && ovs_identifier_is_key(&flow->id) &&
6444bc63b1bSTonghao Zhang 		    ovs_flow_cmp_unmasked_key(flow, match)) {
64574ed7ab9SJoe Stringer 			return flow;
64674ed7ab9SJoe Stringer 		}
6474bc63b1bSTonghao Zhang 	}
6484bc63b1bSTonghao Zhang 
64974ed7ab9SJoe Stringer 	return NULL;
65074ed7ab9SJoe Stringer }
65174ed7ab9SJoe Stringer 
65274ed7ab9SJoe Stringer static u32 ufid_hash(const struct sw_flow_id *sfid)
65374ed7ab9SJoe Stringer {
65474ed7ab9SJoe Stringer 	return jhash(sfid->ufid, sfid->ufid_len, 0);
65574ed7ab9SJoe Stringer }
65674ed7ab9SJoe Stringer 
65774ed7ab9SJoe Stringer static bool ovs_flow_cmp_ufid(const struct sw_flow *flow,
65874ed7ab9SJoe Stringer 			      const struct sw_flow_id *sfid)
65974ed7ab9SJoe Stringer {
66074ed7ab9SJoe Stringer 	if (flow->id.ufid_len != sfid->ufid_len)
66174ed7ab9SJoe Stringer 		return false;
66274ed7ab9SJoe Stringer 
66374ed7ab9SJoe Stringer 	return !memcmp(flow->id.ufid, sfid->ufid, sfid->ufid_len);
66474ed7ab9SJoe Stringer }
66574ed7ab9SJoe Stringer 
66674ed7ab9SJoe Stringer bool ovs_flow_cmp(const struct sw_flow *flow, const struct sw_flow_match *match)
66774ed7ab9SJoe Stringer {
66874ed7ab9SJoe Stringer 	if (ovs_identifier_is_ufid(&flow->id))
66974ed7ab9SJoe Stringer 		return flow_cmp_masked_key(flow, match->key, &match->range);
67074ed7ab9SJoe Stringer 
67174ed7ab9SJoe Stringer 	return ovs_flow_cmp_unmasked_key(flow, match);
67274ed7ab9SJoe Stringer }
67374ed7ab9SJoe Stringer 
67474ed7ab9SJoe Stringer struct sw_flow *ovs_flow_tbl_lookup_ufid(struct flow_table *tbl,
67574ed7ab9SJoe Stringer 					 const struct sw_flow_id *ufid)
67674ed7ab9SJoe Stringer {
67774ed7ab9SJoe Stringer 	struct table_instance *ti = rcu_dereference_ovsl(tbl->ufid_ti);
67874ed7ab9SJoe Stringer 	struct sw_flow *flow;
67974ed7ab9SJoe Stringer 	struct hlist_head *head;
68074ed7ab9SJoe Stringer 	u32 hash;
68174ed7ab9SJoe Stringer 
68274ed7ab9SJoe Stringer 	hash = ufid_hash(ufid);
68374ed7ab9SJoe Stringer 	head = find_bucket(ti, hash);
68474ed7ab9SJoe Stringer 	hlist_for_each_entry_rcu(flow, head, ufid_table.node[ti->node_ver]) {
68574ed7ab9SJoe Stringer 		if (flow->ufid_table.hash == hash &&
68674ed7ab9SJoe Stringer 		    ovs_flow_cmp_ufid(flow, ufid))
6874a46b24eSAlex Wang 			return flow;
6884a46b24eSAlex Wang 	}
6894a46b24eSAlex Wang 	return NULL;
6904a46b24eSAlex Wang }
6914a46b24eSAlex Wang 
6921bd7116fSAndy Zhou int ovs_flow_tbl_num_masks(const struct flow_table *table)
6931bd7116fSAndy Zhou {
6944bc63b1bSTonghao Zhang 	struct mask_array *ma = rcu_dereference_ovsl(table->mask_array);
69557f7d7b9STonghao Zhang 	return READ_ONCE(ma->count);
6961bd7116fSAndy Zhou }
6971bd7116fSAndy Zhou 
69874ed7ab9SJoe Stringer static struct table_instance *table_instance_expand(struct table_instance *ti,
69974ed7ab9SJoe Stringer 						    bool ufid)
700b637e498SPravin B Shelar {
70174ed7ab9SJoe Stringer 	return table_instance_rehash(ti, ti->n_buckets * 2, ufid);
702e6445719SPravin B Shelar }
703e6445719SPravin B Shelar 
70457f7d7b9STonghao Zhang static void tbl_mask_array_del_mask(struct flow_table *tbl,
7051689754dSTonghao Zhang 				    struct sw_flow_mask *mask)
7061689754dSTonghao Zhang {
70757f7d7b9STonghao Zhang 	struct mask_array *ma = ovsl_dereference(tbl->mask_array);
70857f7d7b9STonghao Zhang 	int i, ma_count = READ_ONCE(ma->count);
7091689754dSTonghao Zhang 
7101689754dSTonghao Zhang 	/* Remove the deleted mask pointers from the array */
71157f7d7b9STonghao Zhang 	for (i = 0; i < ma_count; i++) {
71257f7d7b9STonghao Zhang 		if (mask == ovsl_dereference(ma->masks[i]))
71357f7d7b9STonghao Zhang 			goto found;
7141689754dSTonghao Zhang 	}
71557f7d7b9STonghao Zhang 
7161689754dSTonghao Zhang 	BUG();
71757f7d7b9STonghao Zhang 	return;
71857f7d7b9STonghao Zhang 
71957f7d7b9STonghao Zhang found:
72057f7d7b9STonghao Zhang 	WRITE_ONCE(ma->count, ma_count -1);
72157f7d7b9STonghao Zhang 
72257f7d7b9STonghao Zhang 	rcu_assign_pointer(ma->masks[i], ma->masks[ma_count -1]);
72357f7d7b9STonghao Zhang 	RCU_INIT_POINTER(ma->masks[ma_count -1], NULL);
72457f7d7b9STonghao Zhang 
72557f7d7b9STonghao Zhang 	kfree_rcu(mask, rcu);
72657f7d7b9STonghao Zhang 
72757f7d7b9STonghao Zhang 	/* Shrink the mask array if necessary. */
72857f7d7b9STonghao Zhang 	if (ma->max >= (MASK_ARRAY_SIZE_MIN * 2) &&
72957f7d7b9STonghao Zhang 	    ma_count <= (ma->max / 3))
73057f7d7b9STonghao Zhang 		tbl_mask_array_realloc(tbl, ma->max / 2);
7311689754dSTonghao Zhang }
7321689754dSTonghao Zhang 
73356c19868SJarno Rajahalme /* Remove 'mask' from the mask list, if it is not needed any more. */
73456c19868SJarno Rajahalme static void flow_mask_remove(struct flow_table *tbl, struct sw_flow_mask *mask)
73556c19868SJarno Rajahalme {
73656c19868SJarno Rajahalme 	if (mask) {
73756c19868SJarno Rajahalme 		/* ovs-lock is required to protect mask-refcount and
73856c19868SJarno Rajahalme 		 * mask list.
73956c19868SJarno Rajahalme 		 */
74056c19868SJarno Rajahalme 		ASSERT_OVSL();
74156c19868SJarno Rajahalme 		BUG_ON(!mask->ref_count);
74256c19868SJarno Rajahalme 		mask->ref_count--;
74356c19868SJarno Rajahalme 
74457f7d7b9STonghao Zhang 		if (!mask->ref_count)
74557f7d7b9STonghao Zhang 			tbl_mask_array_del_mask(tbl, mask);
74656c19868SJarno Rajahalme 	}
74756c19868SJarno Rajahalme }
74856c19868SJarno Rajahalme 
74956c19868SJarno Rajahalme /* Must be called with OVS mutex held. */
750e6445719SPravin B Shelar void ovs_flow_tbl_remove(struct flow_table *table, struct sw_flow *flow)
751e6445719SPravin B Shelar {
752b637e498SPravin B Shelar 	struct table_instance *ti = ovsl_dereference(table->ti);
75374ed7ab9SJoe Stringer 	struct table_instance *ufid_ti = ovsl_dereference(table->ufid_ti);
754b637e498SPravin B Shelar 
755e6445719SPravin B Shelar 	BUG_ON(table->count == 0);
75674ed7ab9SJoe Stringer 	hlist_del_rcu(&flow->flow_table.node[ti->node_ver]);
757e6445719SPravin B Shelar 	table->count--;
75874ed7ab9SJoe Stringer 	if (ovs_identifier_is_ufid(&flow->id)) {
75974ed7ab9SJoe Stringer 		hlist_del_rcu(&flow->ufid_table.node[ufid_ti->node_ver]);
76074ed7ab9SJoe Stringer 		table->ufid_count--;
76174ed7ab9SJoe Stringer 	}
76256c19868SJarno Rajahalme 
76356c19868SJarno Rajahalme 	/* RCU delete the mask. 'flow->mask' is not NULLed, as it should be
76456c19868SJarno Rajahalme 	 * accessible as long as the RCU read lock is held.
76556c19868SJarno Rajahalme 	 */
76656c19868SJarno Rajahalme 	flow_mask_remove(table, flow->mask);
767e6445719SPravin B Shelar }
768e6445719SPravin B Shelar 
769618ed0c8SPravin B Shelar static struct sw_flow_mask *mask_alloc(void)
770e6445719SPravin B Shelar {
771e6445719SPravin B Shelar 	struct sw_flow_mask *mask;
772e6445719SPravin B Shelar 
773e6445719SPravin B Shelar 	mask = kmalloc(sizeof(*mask), GFP_KERNEL);
774e6445719SPravin B Shelar 	if (mask)
775e80857ccSAndy Zhou 		mask->ref_count = 1;
776e6445719SPravin B Shelar 
777e6445719SPravin B Shelar 	return mask;
778e6445719SPravin B Shelar }
779e6445719SPravin B Shelar 
780e6445719SPravin B Shelar static bool mask_equal(const struct sw_flow_mask *a,
781e6445719SPravin B Shelar 		       const struct sw_flow_mask *b)
782e6445719SPravin B Shelar {
7837085130bSDaniele Di Proietto 	const u8 *a_ = (const u8 *)&a->key + a->range.start;
7847085130bSDaniele Di Proietto 	const u8 *b_ = (const u8 *)&b->key + b->range.start;
785e6445719SPravin B Shelar 
786e6445719SPravin B Shelar 	return  (a->range.end == b->range.end)
787e6445719SPravin B Shelar 		&& (a->range.start == b->range.start)
788e6445719SPravin B Shelar 		&& (memcmp(a_, b_, range_n_bytes(&a->range)) == 0);
789e6445719SPravin B Shelar }
790e6445719SPravin B Shelar 
791618ed0c8SPravin B Shelar static struct sw_flow_mask *flow_mask_find(const struct flow_table *tbl,
792e6445719SPravin B Shelar 					   const struct sw_flow_mask *mask)
793e6445719SPravin B Shelar {
7944bc63b1bSTonghao Zhang 	struct mask_array *ma;
7954bc63b1bSTonghao Zhang 	int i;
796e6445719SPravin B Shelar 
7974bc63b1bSTonghao Zhang 	ma = ovsl_dereference(tbl->mask_array);
7984bc63b1bSTonghao Zhang 	for (i = 0; i < ma->max; i++) {
7994bc63b1bSTonghao Zhang 		struct sw_flow_mask *t;
8004bc63b1bSTonghao Zhang 		t = ovsl_dereference(ma->masks[i]);
8014bc63b1bSTonghao Zhang 
8024bc63b1bSTonghao Zhang 		if (t && mask_equal(mask, t))
8034bc63b1bSTonghao Zhang 			return t;
804e6445719SPravin B Shelar 	}
805e6445719SPravin B Shelar 
806e6445719SPravin B Shelar 	return NULL;
807e6445719SPravin B Shelar }
808e6445719SPravin B Shelar 
80957f7d7b9STonghao Zhang static int tbl_mask_array_add_mask(struct flow_table *tbl,
81057f7d7b9STonghao Zhang 				   struct sw_flow_mask *new)
81157f7d7b9STonghao Zhang {
81257f7d7b9STonghao Zhang 	struct mask_array *ma = ovsl_dereference(tbl->mask_array);
81357f7d7b9STonghao Zhang 	int err, ma_count = READ_ONCE(ma->count);
81457f7d7b9STonghao Zhang 
81557f7d7b9STonghao Zhang 	if (ma_count >= ma->max) {
81657f7d7b9STonghao Zhang 		err = tbl_mask_array_realloc(tbl, ma->max +
81757f7d7b9STonghao Zhang 					      MASK_ARRAY_SIZE_MIN);
81857f7d7b9STonghao Zhang 		if (err)
81957f7d7b9STonghao Zhang 			return err;
82057f7d7b9STonghao Zhang 
82157f7d7b9STonghao Zhang 		ma = ovsl_dereference(tbl->mask_array);
82257f7d7b9STonghao Zhang 	}
82357f7d7b9STonghao Zhang 
82457f7d7b9STonghao Zhang 	BUG_ON(ovsl_dereference(ma->masks[ma_count]));
82557f7d7b9STonghao Zhang 
82657f7d7b9STonghao Zhang 	rcu_assign_pointer(ma->masks[ma_count], new);
82757f7d7b9STonghao Zhang 	WRITE_ONCE(ma->count, ma_count +1);
82857f7d7b9STonghao Zhang 
82957f7d7b9STonghao Zhang 	return 0;
83057f7d7b9STonghao Zhang }
83157f7d7b9STonghao Zhang 
832d1211908SBen Pfaff /* Add 'mask' into the mask list, if it is not already there. */
833618ed0c8SPravin B Shelar static int flow_mask_insert(struct flow_table *tbl, struct sw_flow *flow,
83412eb18f7SThomas Graf 			    const struct sw_flow_mask *new)
835e6445719SPravin B Shelar {
836618ed0c8SPravin B Shelar 	struct sw_flow_mask *mask;
8374bc63b1bSTonghao Zhang 
838618ed0c8SPravin B Shelar 	mask = flow_mask_find(tbl, new);
839618ed0c8SPravin B Shelar 	if (!mask) {
840618ed0c8SPravin B Shelar 		/* Allocate a new mask if none exsits. */
841618ed0c8SPravin B Shelar 		mask = mask_alloc();
842618ed0c8SPravin B Shelar 		if (!mask)
843618ed0c8SPravin B Shelar 			return -ENOMEM;
844618ed0c8SPravin B Shelar 		mask->key = new->key;
845618ed0c8SPravin B Shelar 		mask->range = new->range;
8464bc63b1bSTonghao Zhang 
8474bc63b1bSTonghao Zhang 		/* Add mask to mask-list. */
84857f7d7b9STonghao Zhang 		if (tbl_mask_array_add_mask(tbl, mask)) {
8494bc63b1bSTonghao Zhang 			kfree(mask);
85057f7d7b9STonghao Zhang 			return -ENOMEM;
8514bc63b1bSTonghao Zhang 		}
852e80857ccSAndy Zhou 	} else {
853e80857ccSAndy Zhou 		BUG_ON(!mask->ref_count);
854e80857ccSAndy Zhou 		mask->ref_count++;
855e6445719SPravin B Shelar 	}
856e6445719SPravin B Shelar 
857618ed0c8SPravin B Shelar 	flow->mask = mask;
858618ed0c8SPravin B Shelar 	return 0;
859618ed0c8SPravin B Shelar }
860618ed0c8SPravin B Shelar 
86156c19868SJarno Rajahalme /* Must be called with OVS mutex held. */
862d29ab6f8SJoe Stringer static void flow_key_insert(struct flow_table *table, struct sw_flow *flow)
863618ed0c8SPravin B Shelar {
864618ed0c8SPravin B Shelar 	struct table_instance *new_ti = NULL;
865618ed0c8SPravin B Shelar 	struct table_instance *ti;
866618ed0c8SPravin B Shelar 
86774ed7ab9SJoe Stringer 	flow->flow_table.hash = flow_hash(&flow->key, &flow->mask->range);
868618ed0c8SPravin B Shelar 	ti = ovsl_dereference(table->ti);
869618ed0c8SPravin B Shelar 	table_instance_insert(ti, flow);
870618ed0c8SPravin B Shelar 	table->count++;
871618ed0c8SPravin B Shelar 
872618ed0c8SPravin B Shelar 	/* Expand table, if necessary, to make room. */
873618ed0c8SPravin B Shelar 	if (table->count > ti->n_buckets)
87474ed7ab9SJoe Stringer 		new_ti = table_instance_expand(ti, false);
875618ed0c8SPravin B Shelar 	else if (time_after(jiffies, table->last_rehash + REHASH_INTERVAL))
87674ed7ab9SJoe Stringer 		new_ti = table_instance_rehash(ti, ti->n_buckets, false);
877618ed0c8SPravin B Shelar 
878618ed0c8SPravin B Shelar 	if (new_ti) {
879618ed0c8SPravin B Shelar 		rcu_assign_pointer(table->ti, new_ti);
88074ed7ab9SJoe Stringer 		call_rcu(&ti->rcu, flow_tbl_destroy_rcu_cb);
881618ed0c8SPravin B Shelar 		table->last_rehash = jiffies;
882618ed0c8SPravin B Shelar 	}
883d29ab6f8SJoe Stringer }
884d29ab6f8SJoe Stringer 
885d29ab6f8SJoe Stringer /* Must be called with OVS mutex held. */
88674ed7ab9SJoe Stringer static void flow_ufid_insert(struct flow_table *table, struct sw_flow *flow)
88774ed7ab9SJoe Stringer {
88874ed7ab9SJoe Stringer 	struct table_instance *ti;
88974ed7ab9SJoe Stringer 
89074ed7ab9SJoe Stringer 	flow->ufid_table.hash = ufid_hash(&flow->id);
89174ed7ab9SJoe Stringer 	ti = ovsl_dereference(table->ufid_ti);
89274ed7ab9SJoe Stringer 	ufid_table_instance_insert(ti, flow);
89374ed7ab9SJoe Stringer 	table->ufid_count++;
89474ed7ab9SJoe Stringer 
89574ed7ab9SJoe Stringer 	/* Expand table, if necessary, to make room. */
89674ed7ab9SJoe Stringer 	if (table->ufid_count > ti->n_buckets) {
89774ed7ab9SJoe Stringer 		struct table_instance *new_ti;
89874ed7ab9SJoe Stringer 
89974ed7ab9SJoe Stringer 		new_ti = table_instance_expand(ti, true);
90074ed7ab9SJoe Stringer 		if (new_ti) {
90174ed7ab9SJoe Stringer 			rcu_assign_pointer(table->ufid_ti, new_ti);
90274ed7ab9SJoe Stringer 			call_rcu(&ti->rcu, flow_tbl_destroy_rcu_cb);
90374ed7ab9SJoe Stringer 		}
90474ed7ab9SJoe Stringer 	}
90574ed7ab9SJoe Stringer }
90674ed7ab9SJoe Stringer 
90774ed7ab9SJoe Stringer /* Must be called with OVS mutex held. */
908d29ab6f8SJoe Stringer int ovs_flow_tbl_insert(struct flow_table *table, struct sw_flow *flow,
909d29ab6f8SJoe Stringer 			const struct sw_flow_mask *mask)
910d29ab6f8SJoe Stringer {
911d29ab6f8SJoe Stringer 	int err;
912d29ab6f8SJoe Stringer 
913d29ab6f8SJoe Stringer 	err = flow_mask_insert(table, flow, mask);
914d29ab6f8SJoe Stringer 	if (err)
915d29ab6f8SJoe Stringer 		return err;
916d29ab6f8SJoe Stringer 	flow_key_insert(table, flow);
91774ed7ab9SJoe Stringer 	if (ovs_identifier_is_ufid(&flow->id))
91874ed7ab9SJoe Stringer 		flow_ufid_insert(table, flow);
919d29ab6f8SJoe Stringer 
920618ed0c8SPravin B Shelar 	return 0;
921618ed0c8SPravin B Shelar }
922618ed0c8SPravin B Shelar 
923e6445719SPravin B Shelar /* Initializes the flow module.
924e6445719SPravin B Shelar  * Returns zero if successful or a negative error code. */
925e6445719SPravin B Shelar int ovs_flow_init(void)
926e6445719SPravin B Shelar {
927e6445719SPravin B Shelar 	BUILD_BUG_ON(__alignof__(struct sw_flow_key) % __alignof__(long));
928e6445719SPravin B Shelar 	BUILD_BUG_ON(sizeof(struct sw_flow_key) % sizeof(long));
929e6445719SPravin B Shelar 
93063e7959cSJarno Rajahalme 	flow_cache = kmem_cache_create("sw_flow", sizeof(struct sw_flow)
931db74a333SThadeu Lima de Souza Cascardo 				       + (nr_cpu_ids
932aef833c5SPablo Neira Ayuso 					  * sizeof(struct sw_flow_stats *)),
93363e7959cSJarno Rajahalme 				       0, 0, NULL);
934e6445719SPravin B Shelar 	if (flow_cache == NULL)
935e6445719SPravin B Shelar 		return -ENOMEM;
936e6445719SPravin B Shelar 
93763e7959cSJarno Rajahalme 	flow_stats_cache
938aef833c5SPablo Neira Ayuso 		= kmem_cache_create("sw_flow_stats", sizeof(struct sw_flow_stats),
93963e7959cSJarno Rajahalme 				    0, SLAB_HWCACHE_ALIGN, NULL);
94063e7959cSJarno Rajahalme 	if (flow_stats_cache == NULL) {
94163e7959cSJarno Rajahalme 		kmem_cache_destroy(flow_cache);
94263e7959cSJarno Rajahalme 		flow_cache = NULL;
94363e7959cSJarno Rajahalme 		return -ENOMEM;
94463e7959cSJarno Rajahalme 	}
94563e7959cSJarno Rajahalme 
946e6445719SPravin B Shelar 	return 0;
947e6445719SPravin B Shelar }
948e6445719SPravin B Shelar 
949e6445719SPravin B Shelar /* Uninitializes the flow module. */
950e6445719SPravin B Shelar void ovs_flow_exit(void)
951e6445719SPravin B Shelar {
95263e7959cSJarno Rajahalme 	kmem_cache_destroy(flow_stats_cache);
953e6445719SPravin B Shelar 	kmem_cache_destroy(flow_cache);
954e6445719SPravin B Shelar }
955