[mirror_ubuntu-artful-kernel.git] / net / core / flow.c

/* flow.c: Generic flow cache.
 *
 * Copyright (C) 2003 Alexey N. Kuznetsov (kuznet@ms2.inr.ac.ru)
 * Copyright (C) 2003 David S. Miller (davem@redhat.com)
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/list.h>
#include <linux/jhash.h>
#include <linux/interrupt.h>
#include <linux/mm.h>
#include <linux/random.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/smp.h>
#include <linux/completion.h>
#include <linux/percpu.h>
#include <linux/bitops.h>
#include <linux/notifier.h>
#include <linux/cpu.h>
#include <linux/cpumask.h>
#include <linux/mutex.h>
#include <net/flow.h>
#include <linux/atomic.h>
#include <linux/security.h>
#include <net/net_namespace.h>

struct flow_cache_entry {
	union {
		struct hlist_node	hlist;
		struct list_head	gc_list;
	} u;
	struct net			*net;
	u16				family;
	u8				dir;
	u32				genid;
	struct flowi			key;
	struct flow_cache_object	*object;
};

struct flow_flush_info {
	struct flow_cache		*cache;
	atomic_t			cpuleft;
	struct completion		completion;
};

static struct kmem_cache *flow_cachep __read_mostly;

#define flow_cache_hash_size(cache)	(1U << (cache)->hash_shift)
#define FLOW_HASH_RND_PERIOD		(10 * 60 * HZ)

static void flow_cache_new_hashrnd(unsigned long arg)
{
	struct flow_cache *fc = (void *) arg;
	int i;

	for_each_possible_cpu(i)
		per_cpu_ptr(fc->percpu, i)->hash_rnd_recalc = 1;

	fc->rnd_timer.expires = jiffies + FLOW_HASH_RND_PERIOD;
	add_timer(&fc->rnd_timer);
}

static int flow_entry_valid(struct flow_cache_entry *fle,
				struct netns_xfrm *xfrm)
{
	if (atomic_read(&xfrm->flow_cache_genid) != fle->genid)
		return 0;
	if (fle->object && !fle->object->ops->check(fle->object))
		return 0;
	return 1;
}

static void flow_entry_kill(struct flow_cache_entry *fle,
				struct netns_xfrm *xfrm)
{
	if (fle->object)
		fle->object->ops->delete(fle->object);
	kmem_cache_free(flow_cachep, fle);
}

static void flow_cache_gc_task(struct work_struct *work)
{
	struct list_head gc_list;
	struct flow_cache_entry *fce, *n;
	struct netns_xfrm *xfrm = container_of(work, struct netns_xfrm,
						flow_cache_gc_work);

	INIT_LIST_HEAD(&gc_list);
	spin_lock_bh(&xfrm->flow_cache_gc_lock);
	list_splice_tail_init(&xfrm->flow_cache_gc_list, &gc_list);
	spin_unlock_bh(&xfrm->flow_cache_gc_lock);

	list_for_each_entry_safe(fce, n, &gc_list, u.gc_list) {
		flow_entry_kill(fce, xfrm);
		atomic_dec(&xfrm->flow_cache_gc_count);
	}
}

static void flow_cache_queue_garbage(struct flow_cache_percpu *fcp,
				     unsigned int deleted,
				     struct list_head *gc_list,
				     struct netns_xfrm *xfrm)
{
	if (deleted) {
		atomic_add(deleted, &xfrm->flow_cache_gc_count);
		fcp->hash_count -= deleted;
		spin_lock_bh(&xfrm->flow_cache_gc_lock);
		list_splice_tail(gc_list, &xfrm->flow_cache_gc_list);
		spin_unlock_bh(&xfrm->flow_cache_gc_lock);
		schedule_work(&xfrm->flow_cache_gc_work);
	}
}

static void __flow_cache_shrink(struct flow_cache *fc,
				struct flow_cache_percpu *fcp,
				unsigned int shrink_to)
{
	struct flow_cache_entry *fle;
	struct hlist_node *tmp;
	LIST_HEAD(gc_list);
	unsigned int deleted = 0;
	struct netns_xfrm *xfrm = container_of(fc, struct netns_xfrm,
						flow_cache_global);
	unsigned int i;

	for (i = 0; i < flow_cache_hash_size(fc); i++) {
		unsigned int saved = 0;

		hlist_for_each_entry_safe(fle, tmp,
					  &fcp->hash_table[i], u.hlist) {
			if (saved < shrink_to &&
			    flow_entry_valid(fle, xfrm)) {
				saved++;
			} else {
				deleted++;
				hlist_del(&fle->u.hlist);
				list_add_tail(&fle->u.gc_list, &gc_list);
			}
		}
	}

	flow_cache_queue_garbage(fcp, deleted, &gc_list, xfrm);
}

static void flow_cache_shrink(struct flow_cache *fc,
			      struct flow_cache_percpu *fcp)
{
	unsigned int shrink_to = fc->low_watermark / flow_cache_hash_size(fc);

	__flow_cache_shrink(fc, fcp, shrink_to);
}

static void flow_new_hash_rnd(struct flow_cache *fc,
			      struct flow_cache_percpu *fcp)
{
	get_random_bytes(&fcp->hash_rnd, sizeof(u32));
	fcp->hash_rnd_recalc = 0;
	__flow_cache_shrink(fc, fcp, 0);
}

static u32 flow_hash_code(struct flow_cache *fc,
			  struct flow_cache_percpu *fcp,
			  const struct flowi *key,
			  unsigned int keysize)
{
	const u32 *k = (const u32 *) key;
	const u32 length = keysize * sizeof(flow_compare_t) / sizeof(u32);

	return jhash2(k, length, fcp->hash_rnd)
		& (flow_cache_hash_size(fc) - 1);
}

/* I hear what you're saying, use memcmp.  But memcmp cannot make
 * important assumptions that we can here, such as alignment.
 */
static int flow_key_compare(const struct flowi *key1, const struct flowi *key2,
			    unsigned int keysize)
{
	const flow_compare_t *k1, *k1_lim, *k2;

	k1 = (const flow_compare_t *) key1;
	k1_lim = k1 + keysize;

	k2 = (const flow_compare_t *) key2;

	do {
		if (*k1++ != *k2++)
			return 1;
	} while (k1 < k1_lim);

	return 0;
}

struct flow_cache_object *
flow_cache_lookup(struct net *net, const struct flowi *key, u16 family, u8 dir,
		  flow_resolve_t resolver, void *ctx)
{
	struct flow_cache *fc = &net->xfrm.flow_cache_global;
	struct flow_cache_percpu *fcp;
	struct flow_cache_entry *fle, *tfle;
	struct flow_cache_object *flo;
	unsigned int keysize;
	unsigned int hash;

	local_bh_disable();
	fcp = this_cpu_ptr(fc->percpu);

	fle = NULL;
	flo = NULL;

	keysize = flow_key_size(family);
	if (!keysize)
		goto nocache;

	/* Packet really early in init?  Making flow_cache_init a
	 * pre-smp initcall would solve this.  --RR */
	if (!fcp->hash_table)
		goto nocache;

	if (fcp->hash_rnd_recalc)
		flow_new_hash_rnd(fc, fcp);

	hash = flow_hash_code(fc, fcp, key, keysize);
	hlist_for_each_entry(tfle, &fcp->hash_table[hash], u.hlist) {
		if (tfle->net == net &&
		    tfle->family == family &&
		    tfle->dir == dir &&
		    flow_key_compare(key, &tfle->key, keysize) == 0) {
			fle = tfle;
			break;
		}
	}

	if (unlikely(!fle)) {
		if (fcp->hash_count > fc->high_watermark)
			flow_cache_shrink(fc, fcp);

		if (atomic_read(&net->xfrm.flow_cache_gc_count) >
		    2 * num_online_cpus() * fc->high_watermark) {
			flo = ERR_PTR(-ENOBUFS);
			goto ret_object;
		}

		fle = kmem_cache_alloc(flow_cachep, GFP_ATOMIC);
		if (fle) {
			fle->net = net;
			fle->family = family;
			fle->dir = dir;
			memcpy(&fle->key, key, keysize * sizeof(flow_compare_t));
			fle->object = NULL;
			hlist_add_head(&fle->u.hlist, &fcp->hash_table[hash]);
			fcp->hash_count++;
		}
	} else if (likely(fle->genid == atomic_read(&net->xfrm.flow_cache_genid))) {
		flo = fle->object;
		if (!flo)
			goto ret_object;
		flo = flo->ops->get(flo);
		if (flo)
			goto ret_object;
	} else if (fle->object) {
	        flo = fle->object;
	        flo->ops->delete(flo);
	        fle->object = NULL;
	}

nocache:
	flo = NULL;
	if (fle) {
		flo = fle->object;
		fle->object = NULL;
	}
	flo = resolver(net, key, family, dir, flo, ctx);
	if (fle) {
		fle->genid = atomic_read(&net->xfrm.flow_cache_genid);
		if (!IS_ERR(flo))
			fle->object = flo;
		else
			fle->genid--;
	} else {
		if (!IS_ERR_OR_NULL(flo))
			flo->ops->delete(flo);
	}
ret_object:
	local_bh_enable();
	return flo;
}
EXPORT_SYMBOL(flow_cache_lookup);

static void flow_cache_flush_tasklet(unsigned long data)
{
	struct flow_flush_info *info = (void *)data;
	struct flow_cache *fc = info->cache;
	struct flow_cache_percpu *fcp;
	struct flow_cache_entry *fle;
	struct hlist_node *tmp;
	LIST_HEAD(gc_list);
	unsigned int deleted = 0;
	struct netns_xfrm *xfrm = container_of(fc, struct netns_xfrm,
						flow_cache_global);
	unsigned int i;

	fcp = this_cpu_ptr(fc->percpu);
	for (i = 0; i < flow_cache_hash_size(fc); i++) {
		hlist_for_each_entry_safe(fle, tmp,
					  &fcp->hash_table[i], u.hlist) {
			if (flow_entry_valid(fle, xfrm))
				continue;

			deleted++;
			hlist_del(&fle->u.hlist);
			list_add_tail(&fle->u.gc_list, &gc_list);
		}
	}

	flow_cache_queue_garbage(fcp, deleted, &gc_list, xfrm);

	if (atomic_dec_and_test(&info->cpuleft))
		complete(&info->completion);
}

/*
 * Return whether a cpu needs flushing.  Conservatively, we assume
 * the presence of any entries means the core may require flushing,
 * since the flow_cache_ops.check() function may assume it's running
 * on the same core as the per-cpu cache component.
 */
static int flow_cache_percpu_empty(struct flow_cache *fc, int cpu)
{
	struct flow_cache_percpu *fcp;
	unsigned int i;

	fcp = per_cpu_ptr(fc->percpu, cpu);
	for (i = 0; i < flow_cache_hash_size(fc); i++)
		if (!hlist_empty(&fcp->hash_table[i]))
			return 0;
	return 1;
}

static void flow_cache_flush_per_cpu(void *data)
{
	struct flow_flush_info *info = data;
	struct tasklet_struct *tasklet;

	tasklet = &this_cpu_ptr(info->cache->percpu)->flush_tasklet;
	tasklet->data = (unsigned long)info;
	tasklet_schedule(tasklet);
}

void flow_cache_flush(struct net *net)
{
	struct flow_flush_info info;
	cpumask_var_t mask;
	int i, self;

	/* Track which cpus need flushing to avoid disturbing all cores. */
	if (!alloc_cpumask_var(&mask, GFP_KERNEL))
		return;
	cpumask_clear(mask);

	/* Don't want cpus going down or up during this. */
	get_online_cpus();
	mutex_lock(&net->xfrm.flow_flush_sem);
	info.cache = &net->xfrm.flow_cache_global;
	for_each_online_cpu(i)
		if (!flow_cache_percpu_empty(info.cache, i))
			cpumask_set_cpu(i, mask);
	atomic_set(&info.cpuleft, cpumask_weight(mask));
	if (atomic_read(&info.cpuleft) == 0)
		goto done;

	init_completion(&info.completion);

	local_bh_disable();
	self = cpumask_test_and_clear_cpu(smp_processor_id(), mask);
	on_each_cpu_mask(mask, flow_cache_flush_per_cpu, &info, 0);
	if (self)
		flow_cache_flush_tasklet((unsigned long)&info);
	local_bh_enable();

	wait_for_completion(&info.completion);

done:
	mutex_unlock(&net->xfrm.flow_flush_sem);
	put_online_cpus();
	free_cpumask_var(mask);
}

static void flow_cache_flush_task(struct work_struct *work)
{
	struct netns_xfrm *xfrm = container_of(work, struct netns_xfrm,
						flow_cache_flush_work);
	struct net *net = container_of(xfrm, struct net, xfrm);

	flow_cache_flush(net);
}

void flow_cache_flush_deferred(struct net *net)
{
	schedule_work(&net->xfrm.flow_cache_flush_work);
}

static int flow_cache_cpu_prepare(struct flow_cache *fc, int cpu)
{
	struct flow_cache_percpu *fcp = per_cpu_ptr(fc->percpu, cpu);
	unsigned int sz = sizeof(struct hlist_head) * flow_cache_hash_size(fc);

	if (!fcp->hash_table) {
		fcp->hash_table = kzalloc_node(sz, GFP_KERNEL, cpu_to_node(cpu));
		if (!fcp->hash_table) {
			pr_err("NET: failed to allocate flow cache sz %u\n", sz);
			return -ENOMEM;
		}
		fcp->hash_rnd_recalc = 1;
		fcp->hash_count = 0;
		tasklet_init(&fcp->flush_tasklet, flow_cache_flush_tasklet, 0);
	}
	return 0;
}

static int flow_cache_cpu_up_prep(unsigned int cpu, struct hlist_node *node)
{
	struct flow_cache *fc = hlist_entry_safe(node, struct flow_cache, node);

	return flow_cache_cpu_prepare(fc, cpu);
}

static int flow_cache_cpu_dead(unsigned int cpu, struct hlist_node *node)
{
	struct flow_cache *fc = hlist_entry_safe(node, struct flow_cache, node);
	struct flow_cache_percpu *fcp = per_cpu_ptr(fc->percpu, cpu);

	__flow_cache_shrink(fc, fcp, 0);
	return 0;
}

int flow_cache_init(struct net *net)
{
	int i;
	struct flow_cache *fc = &net->xfrm.flow_cache_global;

	if (!flow_cachep)
		flow_cachep = kmem_cache_create("flow_cache",
						sizeof(struct flow_cache_entry),
						0, SLAB_PANIC, NULL);
	spin_lock_init(&net->xfrm.flow_cache_gc_lock);
	INIT_LIST_HEAD(&net->xfrm.flow_cache_gc_list);
	INIT_WORK(&net->xfrm.flow_cache_gc_work, flow_cache_gc_task);
	INIT_WORK(&net->xfrm.flow_cache_flush_work, flow_cache_flush_task);
	mutex_init(&net->xfrm.flow_flush_sem);
	atomic_set(&net->xfrm.flow_cache_gc_count, 0);

	fc->hash_shift = 10;
	fc->low_watermark = 2 * flow_cache_hash_size(fc);
	fc->high_watermark = 4 * flow_cache_hash_size(fc);

	fc->percpu = alloc_percpu(struct flow_cache_percpu);
	if (!fc->percpu)
		return -ENOMEM;

	if (cpuhp_state_add_instance(CPUHP_NET_FLOW_PREPARE, &fc->node))
		goto err;

	setup_timer(&fc->rnd_timer, flow_cache_new_hashrnd,
		    (unsigned long) fc);
	fc->rnd_timer.expires = jiffies + FLOW_HASH_RND_PERIOD;
	add_timer(&fc->rnd_timer);

	return 0;

err:
	for_each_possible_cpu(i) {
		struct flow_cache_percpu *fcp = per_cpu_ptr(fc->percpu, i);
		kfree(fcp->hash_table);
		fcp->hash_table = NULL;
	}

	free_percpu(fc->percpu);
	fc->percpu = NULL;

	return -ENOMEM;
}
EXPORT_SYMBOL(flow_cache_init);

void flow_cache_fini(struct net *net)
{
	int i;
	struct flow_cache *fc = &net->xfrm.flow_cache_global;

	del_timer_sync(&fc->rnd_timer);

	cpuhp_state_remove_instance_nocalls(CPUHP_NET_FLOW_PREPARE, &fc->node);

	for_each_possible_cpu(i) {
		struct flow_cache_percpu *fcp = per_cpu_ptr(fc->percpu, i);
		kfree(fcp->hash_table);
		fcp->hash_table = NULL;
	}

	free_percpu(fc->percpu);
	fc->percpu = NULL;
}
EXPORT_SYMBOL(flow_cache_fini);

void __init flow_cache_hp_init(void)
{
	int ret;

	ret = cpuhp_setup_state_multi(CPUHP_NET_FLOW_PREPARE,
				      "net/flow:prepare",
				      flow_cache_cpu_up_prep,
				      flow_cache_cpu_dead);
	WARN_ON(ret < 0);
}
Commit	Line	Data
1da177e4 LT	1	/* flow.c: Generic flow cache.
	2	*
	3	* Copyright (C) 2003 Alexey N. Kuznetsov (kuznet@ms2.inr.ac.ru)
	4	* Copyright (C) 2003 David S. Miller (davem@redhat.com)
	5	*/
	6
	7	#include <linux/kernel.h>
	8	#include <linux/module.h>
	9	#include <linux/list.h>
	10	#include <linux/jhash.h>
	11	#include <linux/interrupt.h>
	12	#include <linux/mm.h>
	13	#include <linux/random.h>
	14	#include <linux/init.h>
	15	#include <linux/slab.h>
	16	#include <linux/smp.h>
	17	#include <linux/completion.h>
	18	#include <linux/percpu.h>
	19	#include <linux/bitops.h>
	20	#include <linux/notifier.h>
	21	#include <linux/cpu.h>
	22	#include <linux/cpumask.h>
4a3e2f71	23	#include <linux/mutex.h>
1da177e4	24	#include <net/flow.h>
60063497	25	#include <linux/atomic.h>
df71837d	26	#include <linux/security.h>
ca925cf1	27	#include <net/net_namespace.h>
1da177e4 LT	28
1da177e4 LT	29	struct flow_cache_entry {
8e479560 TT	30	union {
	31	struct hlist_node hlist;
	32	struct list_head gc_list;
	33	} u;
0542b69e	34	struct net *net;
fe1a5f03 TT	35	u16 family;
	36	u8 dir;
	37	u32 genid;
	38	struct flowi key;
	39	struct flow_cache_object *object;
1da177e4 LT	40	};
1da177e4 LT	41
1da177e4	42	struct flow_flush_info {
fe1a5f03	43	struct flow_cache *cache;
d7997fe1 TT	44	atomic_t cpuleft;
d7997fe1 TT	45	struct completion completion;
1da177e4	46	};
1da177e4	47
d32d9bb8 ED	48	static struct kmem_cache *flow_cachep __read_mostly;
d32d9bb8 ED	49
f31cc7e8	50	#define flow_cache_hash_size(cache) (1U << (cache)->hash_shift)
d7997fe1	51	#define FLOW_HASH_RND_PERIOD (10 * 60 * HZ)
1da177e4 LT	52
	53	static void flow_cache_new_hashrnd(unsigned long arg)
	54	{
d7997fe1	55	struct flow_cache fc = (void ) arg;
1da177e4 LT	56	int i;
1da177e4 LT	57
6f912042	58	for_each_possible_cpu(i)
d7997fe1	59	per_cpu_ptr(fc->percpu, i)->hash_rnd_recalc = 1;
1da177e4	60
d7997fe1 TT	61	fc->rnd_timer.expires = jiffies + FLOW_HASH_RND_PERIOD;
d7997fe1 TT	62	add_timer(&fc->rnd_timer);
1da177e4 LT	63	}
1da177e4 LT	64
ca925cf1 FD	65	static int flow_entry_valid(struct flow_cache_entry *fle,
ca925cf1 FD	66	struct netns_xfrm *xfrm)
fe1a5f03	67	{
ca925cf1	68	if (atomic_read(&xfrm->flow_cache_genid) != fle->genid)
fe1a5f03 TT	69	return 0;
	70	if (fle->object && !fle->object->ops->check(fle->object))
	71	return 0;
	72	return 1;
	73	}
	74
ca925cf1 FD	75	static void flow_entry_kill(struct flow_cache_entry *fle,
ca925cf1 FD	76	struct netns_xfrm *xfrm)
134b0fc5 JM	77	{
134b0fc5 JM	78	if (fle->object)
fe1a5f03	79	fle->object->ops->delete(fle->object);
d32d9bb8	80	kmem_cache_free(flow_cachep, fle);
8e479560 TT	81	}
	82
	83	static void flow_cache_gc_task(struct work_struct *work)
	84	{
	85	struct list_head gc_list;
	86	struct flow_cache_entry fce, n;
ca925cf1 FD	87	struct netns_xfrm *xfrm = container_of(work, struct netns_xfrm,
ca925cf1 FD	88	flow_cache_gc_work);
8e479560 TT	89
8e479560 TT	90	INIT_LIST_HEAD(&gc_list);
ca925cf1 FD	91	spin_lock_bh(&xfrm->flow_cache_gc_lock);
	92	list_splice_tail_init(&xfrm->flow_cache_gc_list, &gc_list);
	93	spin_unlock_bh(&xfrm->flow_cache_gc_lock);
8e479560	94
6ad3122a	95	list_for_each_entry_safe(fce, n, &gc_list, u.gc_list) {
ca925cf1	96	flow_entry_kill(fce, xfrm);
6ad3122a	97	atomic_dec(&xfrm->flow_cache_gc_count);
6ad3122a	98	}
8e479560	99	}
8e479560 TT	100
8e479560 TT	101	static void flow_cache_queue_garbage(struct flow_cache_percpu *fcp,
ec2e45a9 AD	102	unsigned int deleted,
ec2e45a9 AD	103	struct list_head *gc_list,
ca925cf1	104	struct netns_xfrm *xfrm)
8e479560 TT	105	{
8e479560 TT	106	if (deleted) {
6ad3122a	107	atomic_add(deleted, &xfrm->flow_cache_gc_count);
8e479560	108	fcp->hash_count -= deleted;
ca925cf1 FD	109	spin_lock_bh(&xfrm->flow_cache_gc_lock);
	110	list_splice_tail(gc_list, &xfrm->flow_cache_gc_list);
	111	spin_unlock_bh(&xfrm->flow_cache_gc_lock);
	112	schedule_work(&xfrm->flow_cache_gc_work);
8e479560	113	}
134b0fc5 JM	114	}
134b0fc5 JM	115
d7997fe1 TT	116	static void __flow_cache_shrink(struct flow_cache *fc,
d7997fe1 TT	117	struct flow_cache_percpu *fcp,
ec2e45a9	118	unsigned int shrink_to)
1da177e4	119	{
8e479560	120	struct flow_cache_entry *fle;
b67bfe0d	121	struct hlist_node *tmp;
8e479560	122	LIST_HEAD(gc_list);
ec2e45a9	123	unsigned int deleted = 0;
ca925cf1 FD	124	struct netns_xfrm *xfrm = container_of(fc, struct netns_xfrm,
ca925cf1 FD	125	flow_cache_global);
f31cc7e8	126	unsigned int i;
1da177e4	127
d7997fe1	128	for (i = 0; i < flow_cache_hash_size(fc); i++) {
ec2e45a9	129	unsigned int saved = 0;
1da177e4	130
b67bfe0d	131	hlist_for_each_entry_safe(fle, tmp,
8e479560	132	&fcp->hash_table[i], u.hlist) {
fe1a5f03	133	if (saved < shrink_to &&
ca925cf1	134	flow_entry_valid(fle, xfrm)) {
fe1a5f03	135	saved++;
fe1a5f03	136	} else {
8e479560 TT	137	deleted++;
	138	hlist_del(&fle->u.hlist);
	139	list_add_tail(&fle->u.gc_list, &gc_list);
fe1a5f03	140	}
1da177e4 LT	141	}
1da177e4 LT	142	}
8e479560	143
ca925cf1	144	flow_cache_queue_garbage(fcp, deleted, &gc_list, xfrm);
1da177e4 LT	145	}
1da177e4 LT	146
d7997fe1 TT	147	static void flow_cache_shrink(struct flow_cache *fc,
d7997fe1 TT	148	struct flow_cache_percpu *fcp)
1da177e4	149	{
ec2e45a9	150	unsigned int shrink_to = fc->low_watermark / flow_cache_hash_size(fc);
1da177e4	151
d7997fe1	152	__flow_cache_shrink(fc, fcp, shrink_to);
1da177e4 LT	153	}
1da177e4 LT	154
d7997fe1 TT	155	static void flow_new_hash_rnd(struct flow_cache *fc,
d7997fe1 TT	156	struct flow_cache_percpu *fcp)
1da177e4	157	{
d7997fe1 TT	158	get_random_bytes(&fcp->hash_rnd, sizeof(u32));
	159	fcp->hash_rnd_recalc = 0;
	160	__flow_cache_shrink(fc, fcp, 0);
1da177e4 LT	161	}
1da177e4 LT	162
d7997fe1 TT	163	static u32 flow_hash_code(struct flow_cache *fc,
d7997fe1 TT	164	struct flow_cache_percpu *fcp,
aa1c366e	165	const struct flowi *key,
5a17d9ed	166	unsigned int keysize)
1da177e4	167	{
dee9f4bc	168	const u32 k = (const u32 ) key;
aa1c366e	169	const u32 length = keysize * sizeof(flow_compare_t) / sizeof(u32);
1da177e4	170
aa1c366e	171	return jhash2(k, length, fcp->hash_rnd)
a02cec21	172	& (flow_cache_hash_size(fc) - 1);
1da177e4 LT	173	}
1da177e4 LT	174
1da177e4	175	/* I hear what you're saying, use memcmp. But memcmp cannot make
aa1c366e	176	* important assumptions that we can here, such as alignment.
1da177e4	177	*/
aa1c366e	178	static int flow_key_compare(const struct flowi key1, const struct flowi key2,
5a17d9ed	179	unsigned int keysize)
1da177e4	180	{
dee9f4bc	181	const flow_compare_t k1, k1_lim, *k2;
1da177e4	182
dee9f4bc	183	k1 = (const flow_compare_t *) key1;
aa1c366e	184	k1_lim = k1 + keysize;
1da177e4	185
dee9f4bc	186	k2 = (const flow_compare_t *) key2;
1da177e4 LT	187
	188	do {
	189	if (k1++ != k2++)
	190	return 1;
	191	} while (k1 < k1_lim);
	192
	193	return 0;
	194	}
	195
fe1a5f03	196	struct flow_cache_object *
dee9f4bc	197	flow_cache_lookup(struct net net, const struct flowi key, u16 family, u8 dir,
fe1a5f03	198	flow_resolve_t resolver, void *ctx)
1da177e4	199	{
ca925cf1	200	struct flow_cache *fc = &net->xfrm.flow_cache_global;
d7997fe1	201	struct flow_cache_percpu *fcp;
8e479560	202	struct flow_cache_entry fle, tfle;
fe1a5f03	203	struct flow_cache_object *flo;
5a17d9ed	204	unsigned int keysize;
1da177e4	205	unsigned int hash;
1da177e4 LT	206
1da177e4 LT	207	local_bh_disable();
7a9b2d59	208	fcp = this_cpu_ptr(fc->percpu);
1da177e4 LT	209
1da177e4 LT	210	fle = NULL;
fe1a5f03	211	flo = NULL;
aa1c366e	212
	213	keysize = flow_key_size(family);
	214	if (!keysize)
	215	goto nocache;
	216
1da177e4 LT	217	/* Packet really early in init? Making flow_cache_init a
1da177e4 LT	218	* pre-smp initcall would solve this. --RR */
d7997fe1	219	if (!fcp->hash_table)
1da177e4 LT	220	goto nocache;
1da177e4 LT	221
d7997fe1 TT	222	if (fcp->hash_rnd_recalc)
d7997fe1 TT	223	flow_new_hash_rnd(fc, fcp);
1da177e4	224
aa1c366e	225	hash = flow_hash_code(fc, fcp, key, keysize);
b67bfe0d	226	hlist_for_each_entry(tfle, &fcp->hash_table[hash], u.hlist) {
0542b69e	227	if (tfle->net == net &&
0542b69e	228	tfle->family == family &&
8e479560	229	tfle->dir == dir &&
aa1c366e	230	flow_key_compare(key, &tfle->key, keysize) == 0) {
8e479560	231	fle = tfle;
1da177e4	232	break;
8e479560	233	}
1da177e4 LT	234	}
1da177e4 LT	235
fe1a5f03	236	if (unlikely(!fle)) {
d7997fe1 TT	237	if (fcp->hash_count > fc->high_watermark)
d7997fe1 TT	238	flow_cache_shrink(fc, fcp);
1da177e4	239
6b226487 MU	240	if (atomic_read(&net->xfrm.flow_cache_gc_count) >
6b226487 MU	241	2 * num_online_cpus() * fc->high_watermark) {
6ad3122a SK	242	flo = ERR_PTR(-ENOBUFS);
	243	goto ret_object;
	244	}
	245
d32d9bb8	246	fle = kmem_cache_alloc(flow_cachep, GFP_ATOMIC);
1da177e4	247	if (fle) {
0542b69e	248	fle->net = net;
1da177e4 LT	249	fle->family = family;
1da177e4 LT	250	fle->dir = dir;
aa1c366e	251	memcpy(&fle->key, key, keysize * sizeof(flow_compare_t));
1da177e4	252	fle->object = NULL;
8e479560	253	hlist_add_head(&fle->u.hlist, &fcp->hash_table[hash]);
d7997fe1	254	fcp->hash_count++;
1da177e4	255	}
ca925cf1	256	} else if (likely(fle->genid == atomic_read(&net->xfrm.flow_cache_genid))) {
fe1a5f03 TT	257	flo = fle->object;
	258	if (!flo)
	259	goto ret_object;
	260	flo = flo->ops->get(flo);
	261	if (flo)
	262	goto ret_object;
	263	} else if (fle->object) {
	264	flo = fle->object;
	265	flo->ops->delete(flo);
	266	fle->object = NULL;
1da177e4 LT	267	}
	268
	269	nocache:
fe1a5f03 TT	270	flo = NULL;
	271	if (fle) {
	272	flo = fle->object;
	273	fle->object = NULL;
	274	}
	275	flo = resolver(net, key, family, dir, flo, ctx);
	276	if (fle) {
ca925cf1	277	fle->genid = atomic_read(&net->xfrm.flow_cache_genid);
fe1a5f03 TT	278	if (!IS_ERR(flo))
	279	fle->object = flo;
	280	else
	281	fle->genid--;
	282	} else {
8fbcec24	283	if (!IS_ERR_OR_NULL(flo))
fe1a5f03	284	flo->ops->delete(flo);
1da177e4	285	}
fe1a5f03 TT	286	ret_object:
	287	local_bh_enable();
	288	return flo;
1da177e4	289	}
9e34a5b5	290	EXPORT_SYMBOL(flow_cache_lookup);
1da177e4 LT	291
	292	static void flow_cache_flush_tasklet(unsigned long data)
	293	{
	294	struct flow_flush_info info = (void )data;
d7997fe1 TT	295	struct flow_cache *fc = info->cache;
d7997fe1 TT	296	struct flow_cache_percpu *fcp;
8e479560	297	struct flow_cache_entry *fle;
b67bfe0d	298	struct hlist_node *tmp;
8e479560	299	LIST_HEAD(gc_list);
ec2e45a9	300	unsigned int deleted = 0;
ca925cf1 FD	301	struct netns_xfrm *xfrm = container_of(fc, struct netns_xfrm,
ca925cf1 FD	302	flow_cache_global);
f31cc7e8	303	unsigned int i;
1da177e4	304
7a9b2d59	305	fcp = this_cpu_ptr(fc->percpu);
d7997fe1	306	for (i = 0; i < flow_cache_hash_size(fc); i++) {
b67bfe0d	307	hlist_for_each_entry_safe(fle, tmp,
8e479560	308	&fcp->hash_table[i], u.hlist) {
ca925cf1	309	if (flow_entry_valid(fle, xfrm))
1da177e4 LT	310	continue;
1da177e4 LT	311
8e479560 TT	312	deleted++;
	313	hlist_del(&fle->u.hlist);
	314	list_add_tail(&fle->u.gc_list, &gc_list);
1da177e4 LT	315	}
	316	}
	317
ca925cf1	318	flow_cache_queue_garbage(fcp, deleted, &gc_list, xfrm);
8e479560	319
1da177e4 LT	320	if (atomic_dec_and_test(&info->cpuleft))
	321	complete(&info->completion);
	322	}
	323
8fdc929f CM	324	/*
	325	* Return whether a cpu needs flushing. Conservatively, we assume
	326	* the presence of any entries means the core may require flushing,
	327	* since the flow_cache_ops.check() function may assume it's running
	328	* on the same core as the per-cpu cache component.
	329	*/
	330	static int flow_cache_percpu_empty(struct flow_cache *fc, int cpu)
	331	{
	332	struct flow_cache_percpu *fcp;
f31cc7e8	333	unsigned int i;
8fdc929f	334
27815032	335	fcp = per_cpu_ptr(fc->percpu, cpu);
8fdc929f CM	336	for (i = 0; i < flow_cache_hash_size(fc); i++)
	337	if (!hlist_empty(&fcp->hash_table[i]))
	338	return 0;
	339	return 1;
	340	}
	341
1da177e4 LT	342	static void flow_cache_flush_per_cpu(void *data)
	343	{
	344	struct flow_flush_info *info = data;
1da177e4 LT	345	struct tasklet_struct *tasklet;
1da177e4 LT	346
50eab050	347	tasklet = &this_cpu_ptr(info->cache->percpu)->flush_tasklet;
1da177e4 LT	348	tasklet->data = (unsigned long)info;
	349	tasklet_schedule(tasklet);
	350	}
	351
ca925cf1	352	void flow_cache_flush(struct net *net)
1da177e4 LT	353	{
1da177e4 LT	354	struct flow_flush_info info;
8fdc929f CM	355	cpumask_var_t mask;
	356	int i, self;
	357
	358	/* Track which cpus need flushing to avoid disturbing all cores. */
	359	if (!alloc_cpumask_var(&mask, GFP_KERNEL))
	360	return;
	361	cpumask_clear(mask);
1da177e4 LT	362
1da177e4 LT	363	/* Don't want cpus going down or up during this. */
86ef5c9a	364	get_online_cpus();
ca925cf1 FD	365	mutex_lock(&net->xfrm.flow_flush_sem);
ca925cf1 FD	366	info.cache = &net->xfrm.flow_cache_global;
8fdc929f CM	367	for_each_online_cpu(i)
	368	if (!flow_cache_percpu_empty(info.cache, i))
	369	cpumask_set_cpu(i, mask);
	370	atomic_set(&info.cpuleft, cpumask_weight(mask));
	371	if (atomic_read(&info.cpuleft) == 0)
	372	goto done;
	373
1da177e4 LT	374	init_completion(&info.completion);
	375
	376	local_bh_disable();
8fdc929f CM	377	self = cpumask_test_and_clear_cpu(smp_processor_id(), mask);
	378	on_each_cpu_mask(mask, flow_cache_flush_per_cpu, &info, 0);
	379	if (self)
	380	flow_cache_flush_tasklet((unsigned long)&info);
1da177e4 LT	381	local_bh_enable();
	382
	383	wait_for_completion(&info.completion);
8fdc929f CM	384
8fdc929f CM	385	done:
ca925cf1	386	mutex_unlock(&net->xfrm.flow_flush_sem);
86ef5c9a	387	put_online_cpus();
8fdc929f	388	free_cpumask_var(mask);
1da177e4 LT	389	}
1da177e4 LT	390
c0ed1c14 SK	391	static void flow_cache_flush_task(struct work_struct *work)
c0ed1c14 SK	392	{
ca925cf1	393	struct netns_xfrm *xfrm = container_of(work, struct netns_xfrm,
233c96fc	394	flow_cache_flush_work);
ca925cf1	395	struct net *net = container_of(xfrm, struct net, xfrm);
c0ed1c14	396
ca925cf1 FD	397	flow_cache_flush(net);
ca925cf1 FD	398	}
c0ed1c14	399
ca925cf1	400	void flow_cache_flush_deferred(struct net *net)
c0ed1c14	401	{
ca925cf1	402	schedule_work(&net->xfrm.flow_cache_flush_work);
c0ed1c14 SK	403	}
c0ed1c14 SK	404
013dbb32	405	static int flow_cache_cpu_prepare(struct flow_cache *fc, int cpu)
1da177e4	406	{
83b6b1f5	407	struct flow_cache_percpu *fcp = per_cpu_ptr(fc->percpu, cpu);
f31cc7e8	408	unsigned int sz = sizeof(struct hlist_head) * flow_cache_hash_size(fc);
d7997fe1	409
83b6b1f5 ED	410	if (!fcp->hash_table) {
	411	fcp->hash_table = kzalloc_node(sz, GFP_KERNEL, cpu_to_node(cpu));
	412	if (!fcp->hash_table) {
f31cc7e8	413	pr_err("NET: failed to allocate flow cache sz %u\n", sz);
83b6b1f5 ED	414	return -ENOMEM;
	415	}
	416	fcp->hash_rnd_recalc = 1;
	417	fcp->hash_count = 0;
	418	tasklet_init(&fcp->flush_tasklet, flow_cache_flush_tasklet, 0);
	419	}
	420	return 0;
1da177e4 LT	421	}
1da177e4 LT	422
a4fc1bfc	423	static int flow_cache_cpu_up_prep(unsigned int cpu, struct hlist_node *node)
1da177e4	424	{
a4fc1bfc SAS	425	struct flow_cache *fc = hlist_entry_safe(node, struct flow_cache, node);
	426
	427	return flow_cache_cpu_prepare(fc, cpu);
	428	}
	429
	430	static int flow_cache_cpu_dead(unsigned int cpu, struct hlist_node *node)
	431	{
	432	struct flow_cache *fc = hlist_entry_safe(node, struct flow_cache, node);
d7997fe1 TT	433	struct flow_cache_percpu *fcp = per_cpu_ptr(fc->percpu, cpu);
d7997fe1 TT	434
a4fc1bfc SAS	435	__flow_cache_shrink(fc, fcp, 0);
a4fc1bfc SAS	436	return 0;
1da177e4	437	}
1da177e4	438
ca925cf1	439	int flow_cache_init(struct net *net)
1da177e4 LT	440	{
1da177e4 LT	441	int i;
ca925cf1 FD	442	struct flow_cache *fc = &net->xfrm.flow_cache_global;
ca925cf1 FD	443
d32d9bb8 ED	444	if (!flow_cachep)
	445	flow_cachep = kmem_cache_create("flow_cache",
	446	sizeof(struct flow_cache_entry),
	447	0, SLAB_PANIC, NULL);
ca925cf1 FD	448	spin_lock_init(&net->xfrm.flow_cache_gc_lock);
	449	INIT_LIST_HEAD(&net->xfrm.flow_cache_gc_list);
	450	INIT_WORK(&net->xfrm.flow_cache_gc_work, flow_cache_gc_task);
	451	INIT_WORK(&net->xfrm.flow_cache_flush_work, flow_cache_flush_task);
	452	mutex_init(&net->xfrm.flow_flush_sem);
6ad3122a	453	atomic_set(&net->xfrm.flow_cache_gc_count, 0);
1da177e4	454
d7997fe1 TT	455	fc->hash_shift = 10;
	456	fc->low_watermark = 2 * flow_cache_hash_size(fc);
	457	fc->high_watermark = 4 * flow_cache_hash_size(fc);
	458
d7997fe1	459	fc->percpu = alloc_percpu(struct flow_cache_percpu);
83b6b1f5 ED	460	if (!fc->percpu)
83b6b1f5 ED	461	return -ENOMEM;
1da177e4	462
a4fc1bfc SAS	463	if (cpuhp_state_add_instance(CPUHP_NET_FLOW_PREPARE, &fc->node))
a4fc1bfc SAS	464	goto err;
1da177e4	465
83b6b1f5 ED	466	setup_timer(&fc->rnd_timer, flow_cache_new_hashrnd,
	467	(unsigned long) fc);
	468	fc->rnd_timer.expires = jiffies + FLOW_HASH_RND_PERIOD;
	469	add_timer(&fc->rnd_timer);
	470
1da177e4	471	return 0;
6ccc3abd	472
	473	err:
	474	for_each_possible_cpu(i) {
	475	struct flow_cache_percpu *fcp = per_cpu_ptr(fc->percpu, i);
	476	kfree(fcp->hash_table);
	477	fcp->hash_table = NULL;
	478	}
	479
	480	free_percpu(fc->percpu);
	481	fc->percpu = NULL;
	482
	483	return -ENOMEM;
1da177e4	484	}
ca925cf1	485	EXPORT_SYMBOL(flow_cache_init);
4a93f509 SK	486
	487	void flow_cache_fini(struct net *net)
	488	{
	489	int i;
	490	struct flow_cache *fc = &net->xfrm.flow_cache_global;
	491
	492	del_timer_sync(&fc->rnd_timer);
a4fc1bfc SAS	493
a4fc1bfc SAS	494	cpuhp_state_remove_instance_nocalls(CPUHP_NET_FLOW_PREPARE, &fc->node);
4a93f509 SK	495
	496	for_each_possible_cpu(i) {
	497	struct flow_cache_percpu *fcp = per_cpu_ptr(fc->percpu, i);
	498	kfree(fcp->hash_table);
	499	fcp->hash_table = NULL;
	500	}
	501
	502	free_percpu(fc->percpu);
	503	fc->percpu = NULL;
	504	}
	505	EXPORT_SYMBOL(flow_cache_fini);
a4fc1bfc SAS	506
	507	void __init flow_cache_hp_init(void)
	508	{
	509	int ret;
	510
	511	ret = cpuhp_setup_state_multi(CPUHP_NET_FLOW_PREPARE,
	512	"net/flow:prepare",
	513	flow_cache_cpu_up_prep,
	514	flow_cache_cpu_dead);
	515	WARN_ON(ret < 0);
	516	}