162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * VMware VMCI Driver
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2012 VMware, Inc. All rights reserved.
662306a36Sopenharmony_ci */
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci#include <linux/vmw_vmci_defs.h>
962306a36Sopenharmony_ci#include <linux/hash.h>
1062306a36Sopenharmony_ci#include <linux/types.h>
1162306a36Sopenharmony_ci#include <linux/rculist.h>
1262306a36Sopenharmony_ci#include <linux/completion.h>
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_ci#include "vmci_resource.h"
1562306a36Sopenharmony_ci#include "vmci_driver.h"
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci#define VMCI_RESOURCE_HASH_BITS         7
1962306a36Sopenharmony_ci#define VMCI_RESOURCE_HASH_BUCKETS      (1 << VMCI_RESOURCE_HASH_BITS)
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_cistruct vmci_hash_table {
2262306a36Sopenharmony_ci	spinlock_t lock;
2362306a36Sopenharmony_ci	struct hlist_head entries[VMCI_RESOURCE_HASH_BUCKETS];
2462306a36Sopenharmony_ci};
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_cistatic struct vmci_hash_table vmci_resource_table = {
2762306a36Sopenharmony_ci	.lock = __SPIN_LOCK_UNLOCKED(vmci_resource_table.lock),
2862306a36Sopenharmony_ci};
2962306a36Sopenharmony_ci
3062306a36Sopenharmony_cistatic unsigned int vmci_resource_hash(struct vmci_handle handle)
3162306a36Sopenharmony_ci{
3262306a36Sopenharmony_ci	return hash_32(handle.resource, VMCI_RESOURCE_HASH_BITS);
3362306a36Sopenharmony_ci}
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_ci/*
3662306a36Sopenharmony_ci * Gets a resource (if one exists) matching given handle from the hash table.
3762306a36Sopenharmony_ci */
3862306a36Sopenharmony_cistatic struct vmci_resource *vmci_resource_lookup(struct vmci_handle handle,
3962306a36Sopenharmony_ci						  enum vmci_resource_type type)
4062306a36Sopenharmony_ci{
4162306a36Sopenharmony_ci	struct vmci_resource *r, *resource = NULL;
4262306a36Sopenharmony_ci	unsigned int idx = vmci_resource_hash(handle);
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_ci	rcu_read_lock();
4562306a36Sopenharmony_ci	hlist_for_each_entry_rcu(r,
4662306a36Sopenharmony_ci				 &vmci_resource_table.entries[idx], node) {
4762306a36Sopenharmony_ci		u32 cid = r->handle.context;
4862306a36Sopenharmony_ci		u32 rid = r->handle.resource;
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_ci		if (r->type == type &&
5162306a36Sopenharmony_ci		    rid == handle.resource &&
5262306a36Sopenharmony_ci		    (cid == handle.context || cid == VMCI_INVALID_ID ||
5362306a36Sopenharmony_ci		     handle.context == VMCI_INVALID_ID)) {
5462306a36Sopenharmony_ci			resource = r;
5562306a36Sopenharmony_ci			break;
5662306a36Sopenharmony_ci		}
5762306a36Sopenharmony_ci	}
5862306a36Sopenharmony_ci	rcu_read_unlock();
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_ci	return resource;
6162306a36Sopenharmony_ci}
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ci/*
6462306a36Sopenharmony_ci * Find an unused resource ID and return it. The first
6562306a36Sopenharmony_ci * VMCI_RESERVED_RESOURCE_ID_MAX are reserved so we start from
6662306a36Sopenharmony_ci * its value + 1.
6762306a36Sopenharmony_ci * Returns VMCI resource id on success, VMCI_INVALID_ID on failure.
6862306a36Sopenharmony_ci */
6962306a36Sopenharmony_cistatic u32 vmci_resource_find_id(u32 context_id,
7062306a36Sopenharmony_ci				 enum vmci_resource_type resource_type)
7162306a36Sopenharmony_ci{
7262306a36Sopenharmony_ci	static u32 resource_id = VMCI_RESERVED_RESOURCE_ID_MAX + 1;
7362306a36Sopenharmony_ci	u32 old_rid = resource_id;
7462306a36Sopenharmony_ci	u32 current_rid;
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci	/*
7762306a36Sopenharmony_ci	 * Generate a unique resource ID.  Keep on trying until we wrap around
7862306a36Sopenharmony_ci	 * in the RID space.
7962306a36Sopenharmony_ci	 */
8062306a36Sopenharmony_ci	do {
8162306a36Sopenharmony_ci		struct vmci_handle handle;
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_ci		current_rid = resource_id;
8462306a36Sopenharmony_ci		resource_id++;
8562306a36Sopenharmony_ci		if (unlikely(resource_id == VMCI_INVALID_ID)) {
8662306a36Sopenharmony_ci			/* Skip the reserved rids. */
8762306a36Sopenharmony_ci			resource_id = VMCI_RESERVED_RESOURCE_ID_MAX + 1;
8862306a36Sopenharmony_ci		}
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci		handle = vmci_make_handle(context_id, current_rid);
9162306a36Sopenharmony_ci		if (!vmci_resource_lookup(handle, resource_type))
9262306a36Sopenharmony_ci			return current_rid;
9362306a36Sopenharmony_ci	} while (resource_id != old_rid);
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_ci	return VMCI_INVALID_ID;
9662306a36Sopenharmony_ci}
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_ci
9962306a36Sopenharmony_ciint vmci_resource_add(struct vmci_resource *resource,
10062306a36Sopenharmony_ci		      enum vmci_resource_type resource_type,
10162306a36Sopenharmony_ci		      struct vmci_handle handle)
10262306a36Sopenharmony_ci
10362306a36Sopenharmony_ci{
10462306a36Sopenharmony_ci	unsigned int idx;
10562306a36Sopenharmony_ci	int result;
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_ci	spin_lock(&vmci_resource_table.lock);
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	if (handle.resource == VMCI_INVALID_ID) {
11062306a36Sopenharmony_ci		handle.resource = vmci_resource_find_id(handle.context,
11162306a36Sopenharmony_ci			resource_type);
11262306a36Sopenharmony_ci		if (handle.resource == VMCI_INVALID_ID) {
11362306a36Sopenharmony_ci			result = VMCI_ERROR_NO_HANDLE;
11462306a36Sopenharmony_ci			goto out;
11562306a36Sopenharmony_ci		}
11662306a36Sopenharmony_ci	} else if (vmci_resource_lookup(handle, resource_type)) {
11762306a36Sopenharmony_ci		result = VMCI_ERROR_ALREADY_EXISTS;
11862306a36Sopenharmony_ci		goto out;
11962306a36Sopenharmony_ci	}
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_ci	resource->handle = handle;
12262306a36Sopenharmony_ci	resource->type = resource_type;
12362306a36Sopenharmony_ci	INIT_HLIST_NODE(&resource->node);
12462306a36Sopenharmony_ci	kref_init(&resource->kref);
12562306a36Sopenharmony_ci	init_completion(&resource->done);
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci	idx = vmci_resource_hash(resource->handle);
12862306a36Sopenharmony_ci	hlist_add_head_rcu(&resource->node, &vmci_resource_table.entries[idx]);
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_ci	result = VMCI_SUCCESS;
13162306a36Sopenharmony_ci
13262306a36Sopenharmony_ciout:
13362306a36Sopenharmony_ci	spin_unlock(&vmci_resource_table.lock);
13462306a36Sopenharmony_ci	return result;
13562306a36Sopenharmony_ci}
13662306a36Sopenharmony_ci
13762306a36Sopenharmony_civoid vmci_resource_remove(struct vmci_resource *resource)
13862306a36Sopenharmony_ci{
13962306a36Sopenharmony_ci	struct vmci_handle handle = resource->handle;
14062306a36Sopenharmony_ci	unsigned int idx = vmci_resource_hash(handle);
14162306a36Sopenharmony_ci	struct vmci_resource *r;
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_ci	/* Remove resource from hash table. */
14462306a36Sopenharmony_ci	spin_lock(&vmci_resource_table.lock);
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_ci	hlist_for_each_entry(r, &vmci_resource_table.entries[idx], node) {
14762306a36Sopenharmony_ci		if (vmci_handle_is_equal(r->handle, resource->handle)) {
14862306a36Sopenharmony_ci			hlist_del_init_rcu(&r->node);
14962306a36Sopenharmony_ci			break;
15062306a36Sopenharmony_ci		}
15162306a36Sopenharmony_ci	}
15262306a36Sopenharmony_ci
15362306a36Sopenharmony_ci	spin_unlock(&vmci_resource_table.lock);
15462306a36Sopenharmony_ci	synchronize_rcu();
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_ci	vmci_resource_put(resource);
15762306a36Sopenharmony_ci	wait_for_completion(&resource->done);
15862306a36Sopenharmony_ci}
15962306a36Sopenharmony_ci
16062306a36Sopenharmony_cistruct vmci_resource *
16162306a36Sopenharmony_civmci_resource_by_handle(struct vmci_handle resource_handle,
16262306a36Sopenharmony_ci			enum vmci_resource_type resource_type)
16362306a36Sopenharmony_ci{
16462306a36Sopenharmony_ci	struct vmci_resource *r, *resource = NULL;
16562306a36Sopenharmony_ci
16662306a36Sopenharmony_ci	rcu_read_lock();
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci	r = vmci_resource_lookup(resource_handle, resource_type);
16962306a36Sopenharmony_ci	if (r &&
17062306a36Sopenharmony_ci	    (resource_type == r->type ||
17162306a36Sopenharmony_ci	     resource_type == VMCI_RESOURCE_TYPE_ANY)) {
17262306a36Sopenharmony_ci		resource = vmci_resource_get(r);
17362306a36Sopenharmony_ci	}
17462306a36Sopenharmony_ci
17562306a36Sopenharmony_ci	rcu_read_unlock();
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	return resource;
17862306a36Sopenharmony_ci}
17962306a36Sopenharmony_ci
18062306a36Sopenharmony_ci/*
18162306a36Sopenharmony_ci * Get a reference to given resource.
18262306a36Sopenharmony_ci */
18362306a36Sopenharmony_cistruct vmci_resource *vmci_resource_get(struct vmci_resource *resource)
18462306a36Sopenharmony_ci{
18562306a36Sopenharmony_ci	kref_get(&resource->kref);
18662306a36Sopenharmony_ci
18762306a36Sopenharmony_ci	return resource;
18862306a36Sopenharmony_ci}
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_cistatic void vmci_release_resource(struct kref *kref)
19162306a36Sopenharmony_ci{
19262306a36Sopenharmony_ci	struct vmci_resource *resource =
19362306a36Sopenharmony_ci		container_of(kref, struct vmci_resource, kref);
19462306a36Sopenharmony_ci
19562306a36Sopenharmony_ci	/* Verify the resource has been unlinked from hash table */
19662306a36Sopenharmony_ci	WARN_ON(!hlist_unhashed(&resource->node));
19762306a36Sopenharmony_ci
19862306a36Sopenharmony_ci	/* Signal that container of this resource can now be destroyed */
19962306a36Sopenharmony_ci	complete(&resource->done);
20062306a36Sopenharmony_ci}
20162306a36Sopenharmony_ci
20262306a36Sopenharmony_ci/*
20362306a36Sopenharmony_ci * Resource's release function will get called if last reference.
20462306a36Sopenharmony_ci * If it is the last reference, then we are sure that nobody else
20562306a36Sopenharmony_ci * can increment the count again (it's gone from the resource hash
20662306a36Sopenharmony_ci * table), so there's no need for locking here.
20762306a36Sopenharmony_ci */
20862306a36Sopenharmony_ciint vmci_resource_put(struct vmci_resource *resource)
20962306a36Sopenharmony_ci{
21062306a36Sopenharmony_ci	/*
21162306a36Sopenharmony_ci	 * We propagate the information back to caller in case it wants to know
21262306a36Sopenharmony_ci	 * whether entry was freed.
21362306a36Sopenharmony_ci	 */
21462306a36Sopenharmony_ci	return kref_put(&resource->kref, vmci_release_resource) ?
21562306a36Sopenharmony_ci		VMCI_SUCCESS_ENTRY_DEAD : VMCI_SUCCESS;
21662306a36Sopenharmony_ci}
21762306a36Sopenharmony_ci
21862306a36Sopenharmony_cistruct vmci_handle vmci_resource_handle(struct vmci_resource *resource)
21962306a36Sopenharmony_ci{
22062306a36Sopenharmony_ci	return resource->handle;
22162306a36Sopenharmony_ci}
222