162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci *
462306a36Sopenharmony_ci * Copyright (c) 2009, Microsoft Corporation.
562306a36Sopenharmony_ci *
662306a36Sopenharmony_ci * Authors:
762306a36Sopenharmony_ci *   Haiyang Zhang <haiyangz@microsoft.com>
862306a36Sopenharmony_ci *   Hank Janssen  <hjanssen@microsoft.com>
962306a36Sopenharmony_ci */
1062306a36Sopenharmony_ci#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ci#include <linux/kernel.h>
1362306a36Sopenharmony_ci#include <linux/sched.h>
1462306a36Sopenharmony_ci#include <linux/wait.h>
1562306a36Sopenharmony_ci#include <linux/delay.h>
1662306a36Sopenharmony_ci#include <linux/mm.h>
1762306a36Sopenharmony_ci#include <linux/module.h>
1862306a36Sopenharmony_ci#include <linux/slab.h>
1962306a36Sopenharmony_ci#include <linux/vmalloc.h>
2062306a36Sopenharmony_ci#include <linux/hyperv.h>
2162306a36Sopenharmony_ci#include <linux/export.h>
2262306a36Sopenharmony_ci#include <linux/io.h>
2362306a36Sopenharmony_ci#include <linux/set_memory.h>
2462306a36Sopenharmony_ci#include <asm/mshyperv.h>
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci#include "hyperv_vmbus.h"
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_cistruct vmbus_connection vmbus_connection = {
3062306a36Sopenharmony_ci	.conn_state		= DISCONNECTED,
3162306a36Sopenharmony_ci	.unload_event		= COMPLETION_INITIALIZER(
3262306a36Sopenharmony_ci				  vmbus_connection.unload_event),
3362306a36Sopenharmony_ci	.next_gpadl_handle	= ATOMIC_INIT(0xE1E10),
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_ci	.ready_for_suspend_event = COMPLETION_INITIALIZER(
3662306a36Sopenharmony_ci				  vmbus_connection.ready_for_suspend_event),
3762306a36Sopenharmony_ci	.ready_for_resume_event	= COMPLETION_INITIALIZER(
3862306a36Sopenharmony_ci				  vmbus_connection.ready_for_resume_event),
3962306a36Sopenharmony_ci};
4062306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(vmbus_connection);
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ci/*
4362306a36Sopenharmony_ci * Negotiated protocol version with the host.
4462306a36Sopenharmony_ci */
4562306a36Sopenharmony_ci__u32 vmbus_proto_version;
4662306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(vmbus_proto_version);
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_ci/*
4962306a36Sopenharmony_ci * Table of VMBus versions listed from newest to oldest.
5062306a36Sopenharmony_ci * VERSION_WIN7 and VERSION_WS2008 are no longer supported in
5162306a36Sopenharmony_ci * Linux guests and are not listed.
5262306a36Sopenharmony_ci */
5362306a36Sopenharmony_cistatic __u32 vmbus_versions[] = {
5462306a36Sopenharmony_ci	VERSION_WIN10_V5_3,
5562306a36Sopenharmony_ci	VERSION_WIN10_V5_2,
5662306a36Sopenharmony_ci	VERSION_WIN10_V5_1,
5762306a36Sopenharmony_ci	VERSION_WIN10_V5,
5862306a36Sopenharmony_ci	VERSION_WIN10_V4_1,
5962306a36Sopenharmony_ci	VERSION_WIN10,
6062306a36Sopenharmony_ci	VERSION_WIN8_1,
6162306a36Sopenharmony_ci	VERSION_WIN8
6262306a36Sopenharmony_ci};
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci/*
6562306a36Sopenharmony_ci * Maximal VMBus protocol version guests can negotiate.  Useful to cap the
6662306a36Sopenharmony_ci * VMBus version for testing and debugging purpose.
6762306a36Sopenharmony_ci */
6862306a36Sopenharmony_cistatic uint max_version = VERSION_WIN10_V5_3;
6962306a36Sopenharmony_ci
7062306a36Sopenharmony_cimodule_param(max_version, uint, S_IRUGO);
7162306a36Sopenharmony_ciMODULE_PARM_DESC(max_version,
7262306a36Sopenharmony_ci		 "Maximal VMBus protocol version which can be negotiated");
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_ciint vmbus_negotiate_version(struct vmbus_channel_msginfo *msginfo, u32 version)
7562306a36Sopenharmony_ci{
7662306a36Sopenharmony_ci	int ret = 0;
7762306a36Sopenharmony_ci	struct vmbus_channel_initiate_contact *msg;
7862306a36Sopenharmony_ci	unsigned long flags;
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci	init_completion(&msginfo->waitevent);
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_ci	msg = (struct vmbus_channel_initiate_contact *)msginfo->msg;
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci	memset(msg, 0, sizeof(*msg));
8562306a36Sopenharmony_ci	msg->header.msgtype = CHANNELMSG_INITIATE_CONTACT;
8662306a36Sopenharmony_ci	msg->vmbus_version_requested = version;
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci	/*
8962306a36Sopenharmony_ci	 * VMBus protocol 5.0 (VERSION_WIN10_V5) and higher require that we must
9062306a36Sopenharmony_ci	 * use VMBUS_MESSAGE_CONNECTION_ID_4 for the Initiate Contact Message,
9162306a36Sopenharmony_ci	 * and for subsequent messages, we must use the Message Connection ID
9262306a36Sopenharmony_ci	 * field in the host-returned Version Response Message. And, with
9362306a36Sopenharmony_ci	 * VERSION_WIN10_V5 and higher, we don't use msg->interrupt_page, but we
9462306a36Sopenharmony_ci	 * tell the host explicitly that we still use VMBUS_MESSAGE_SINT(2) for
9562306a36Sopenharmony_ci	 * compatibility.
9662306a36Sopenharmony_ci	 *
9762306a36Sopenharmony_ci	 * On old hosts, we should always use VMBUS_MESSAGE_CONNECTION_ID (1).
9862306a36Sopenharmony_ci	 */
9962306a36Sopenharmony_ci	if (version >= VERSION_WIN10_V5) {
10062306a36Sopenharmony_ci		msg->msg_sint = VMBUS_MESSAGE_SINT;
10162306a36Sopenharmony_ci		msg->msg_vtl = ms_hyperv.vtl;
10262306a36Sopenharmony_ci		vmbus_connection.msg_conn_id = VMBUS_MESSAGE_CONNECTION_ID_4;
10362306a36Sopenharmony_ci	} else {
10462306a36Sopenharmony_ci		msg->interrupt_page = virt_to_phys(vmbus_connection.int_page);
10562306a36Sopenharmony_ci		vmbus_connection.msg_conn_id = VMBUS_MESSAGE_CONNECTION_ID;
10662306a36Sopenharmony_ci	}
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_ci	/*
10962306a36Sopenharmony_ci	 * shared_gpa_boundary is zero in non-SNP VMs, so it's safe to always
11062306a36Sopenharmony_ci	 * bitwise OR it
11162306a36Sopenharmony_ci	 */
11262306a36Sopenharmony_ci	msg->monitor_page1 = virt_to_phys(vmbus_connection.monitor_pages[0]) |
11362306a36Sopenharmony_ci				ms_hyperv.shared_gpa_boundary;
11462306a36Sopenharmony_ci	msg->monitor_page2 = virt_to_phys(vmbus_connection.monitor_pages[1]) |
11562306a36Sopenharmony_ci				ms_hyperv.shared_gpa_boundary;
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_ci	msg->target_vcpu = hv_cpu_number_to_vp_number(VMBUS_CONNECT_CPU);
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_ci	/*
12062306a36Sopenharmony_ci	 * Add to list before we send the request since we may
12162306a36Sopenharmony_ci	 * receive the response before returning from this routine
12262306a36Sopenharmony_ci	 */
12362306a36Sopenharmony_ci	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
12462306a36Sopenharmony_ci	list_add_tail(&msginfo->msglistentry,
12562306a36Sopenharmony_ci		      &vmbus_connection.chn_msg_list);
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci	spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
12862306a36Sopenharmony_ci
12962306a36Sopenharmony_ci	ret = vmbus_post_msg(msg,
13062306a36Sopenharmony_ci			     sizeof(struct vmbus_channel_initiate_contact),
13162306a36Sopenharmony_ci			     true);
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_ci	trace_vmbus_negotiate_version(msg, ret);
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ci	if (ret != 0) {
13662306a36Sopenharmony_ci		spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
13762306a36Sopenharmony_ci		list_del(&msginfo->msglistentry);
13862306a36Sopenharmony_ci		spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock,
13962306a36Sopenharmony_ci					flags);
14062306a36Sopenharmony_ci		return ret;
14162306a36Sopenharmony_ci	}
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_ci	/* Wait for the connection response */
14462306a36Sopenharmony_ci	wait_for_completion(&msginfo->waitevent);
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_ci	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
14762306a36Sopenharmony_ci	list_del(&msginfo->msglistentry);
14862306a36Sopenharmony_ci	spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
14962306a36Sopenharmony_ci
15062306a36Sopenharmony_ci	/* Check if successful */
15162306a36Sopenharmony_ci	if (msginfo->response.version_response.version_supported) {
15262306a36Sopenharmony_ci		vmbus_connection.conn_state = CONNECTED;
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_ci		if (version >= VERSION_WIN10_V5)
15562306a36Sopenharmony_ci			vmbus_connection.msg_conn_id =
15662306a36Sopenharmony_ci				msginfo->response.version_response.msg_conn_id;
15762306a36Sopenharmony_ci	} else {
15862306a36Sopenharmony_ci		return -ECONNREFUSED;
15962306a36Sopenharmony_ci	}
16062306a36Sopenharmony_ci
16162306a36Sopenharmony_ci	return ret;
16262306a36Sopenharmony_ci}
16362306a36Sopenharmony_ci
16462306a36Sopenharmony_ci/*
16562306a36Sopenharmony_ci * vmbus_connect - Sends a connect request on the partition service connection
16662306a36Sopenharmony_ci */
16762306a36Sopenharmony_ciint vmbus_connect(void)
16862306a36Sopenharmony_ci{
16962306a36Sopenharmony_ci	struct vmbus_channel_msginfo *msginfo = NULL;
17062306a36Sopenharmony_ci	int i, ret = 0;
17162306a36Sopenharmony_ci	__u32 version;
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ci	/* Initialize the vmbus connection */
17462306a36Sopenharmony_ci	vmbus_connection.conn_state = CONNECTING;
17562306a36Sopenharmony_ci	vmbus_connection.work_queue = create_workqueue("hv_vmbus_con");
17662306a36Sopenharmony_ci	if (!vmbus_connection.work_queue) {
17762306a36Sopenharmony_ci		ret = -ENOMEM;
17862306a36Sopenharmony_ci		goto cleanup;
17962306a36Sopenharmony_ci	}
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_ci	vmbus_connection.rescind_work_queue =
18262306a36Sopenharmony_ci		create_workqueue("hv_vmbus_rescind");
18362306a36Sopenharmony_ci	if (!vmbus_connection.rescind_work_queue) {
18462306a36Sopenharmony_ci		ret = -ENOMEM;
18562306a36Sopenharmony_ci		goto cleanup;
18662306a36Sopenharmony_ci	}
18762306a36Sopenharmony_ci	vmbus_connection.ignore_any_offer_msg = false;
18862306a36Sopenharmony_ci
18962306a36Sopenharmony_ci	vmbus_connection.handle_primary_chan_wq =
19062306a36Sopenharmony_ci		create_workqueue("hv_pri_chan");
19162306a36Sopenharmony_ci	if (!vmbus_connection.handle_primary_chan_wq) {
19262306a36Sopenharmony_ci		ret = -ENOMEM;
19362306a36Sopenharmony_ci		goto cleanup;
19462306a36Sopenharmony_ci	}
19562306a36Sopenharmony_ci
19662306a36Sopenharmony_ci	vmbus_connection.handle_sub_chan_wq =
19762306a36Sopenharmony_ci		create_workqueue("hv_sub_chan");
19862306a36Sopenharmony_ci	if (!vmbus_connection.handle_sub_chan_wq) {
19962306a36Sopenharmony_ci		ret = -ENOMEM;
20062306a36Sopenharmony_ci		goto cleanup;
20162306a36Sopenharmony_ci	}
20262306a36Sopenharmony_ci
20362306a36Sopenharmony_ci	INIT_LIST_HEAD(&vmbus_connection.chn_msg_list);
20462306a36Sopenharmony_ci	spin_lock_init(&vmbus_connection.channelmsg_lock);
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_ci	INIT_LIST_HEAD(&vmbus_connection.chn_list);
20762306a36Sopenharmony_ci	mutex_init(&vmbus_connection.channel_mutex);
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_ci	/*
21062306a36Sopenharmony_ci	 * Setup the vmbus event connection for channel interrupt
21162306a36Sopenharmony_ci	 * abstraction stuff
21262306a36Sopenharmony_ci	 */
21362306a36Sopenharmony_ci	vmbus_connection.int_page = hv_alloc_hyperv_zeroed_page();
21462306a36Sopenharmony_ci	if (vmbus_connection.int_page == NULL) {
21562306a36Sopenharmony_ci		ret = -ENOMEM;
21662306a36Sopenharmony_ci		goto cleanup;
21762306a36Sopenharmony_ci	}
21862306a36Sopenharmony_ci
21962306a36Sopenharmony_ci	vmbus_connection.recv_int_page = vmbus_connection.int_page;
22062306a36Sopenharmony_ci	vmbus_connection.send_int_page =
22162306a36Sopenharmony_ci		(void *)((unsigned long)vmbus_connection.int_page +
22262306a36Sopenharmony_ci			(HV_HYP_PAGE_SIZE >> 1));
22362306a36Sopenharmony_ci
22462306a36Sopenharmony_ci	/*
22562306a36Sopenharmony_ci	 * Setup the monitor notification facility. The 1st page for
22662306a36Sopenharmony_ci	 * parent->child and the 2nd page for child->parent
22762306a36Sopenharmony_ci	 */
22862306a36Sopenharmony_ci	vmbus_connection.monitor_pages[0] = hv_alloc_hyperv_page();
22962306a36Sopenharmony_ci	vmbus_connection.monitor_pages[1] = hv_alloc_hyperv_page();
23062306a36Sopenharmony_ci	if ((vmbus_connection.monitor_pages[0] == NULL) ||
23162306a36Sopenharmony_ci	    (vmbus_connection.monitor_pages[1] == NULL)) {
23262306a36Sopenharmony_ci		ret = -ENOMEM;
23362306a36Sopenharmony_ci		goto cleanup;
23462306a36Sopenharmony_ci	}
23562306a36Sopenharmony_ci
23662306a36Sopenharmony_ci	ret = set_memory_decrypted((unsigned long)
23762306a36Sopenharmony_ci				vmbus_connection.monitor_pages[0], 1);
23862306a36Sopenharmony_ci	ret |= set_memory_decrypted((unsigned long)
23962306a36Sopenharmony_ci				vmbus_connection.monitor_pages[1], 1);
24062306a36Sopenharmony_ci	if (ret)
24162306a36Sopenharmony_ci		goto cleanup;
24262306a36Sopenharmony_ci
24362306a36Sopenharmony_ci	/*
24462306a36Sopenharmony_ci	 * Set_memory_decrypted() will change the memory contents if
24562306a36Sopenharmony_ci	 * decryption occurs, so zero monitor pages here.
24662306a36Sopenharmony_ci	 */
24762306a36Sopenharmony_ci	memset(vmbus_connection.monitor_pages[0], 0x00, HV_HYP_PAGE_SIZE);
24862306a36Sopenharmony_ci	memset(vmbus_connection.monitor_pages[1], 0x00, HV_HYP_PAGE_SIZE);
24962306a36Sopenharmony_ci
25062306a36Sopenharmony_ci	msginfo = kzalloc(sizeof(*msginfo) +
25162306a36Sopenharmony_ci			  sizeof(struct vmbus_channel_initiate_contact),
25262306a36Sopenharmony_ci			  GFP_KERNEL);
25362306a36Sopenharmony_ci	if (msginfo == NULL) {
25462306a36Sopenharmony_ci		ret = -ENOMEM;
25562306a36Sopenharmony_ci		goto cleanup;
25662306a36Sopenharmony_ci	}
25762306a36Sopenharmony_ci
25862306a36Sopenharmony_ci	/*
25962306a36Sopenharmony_ci	 * Negotiate a compatible VMBUS version number with the
26062306a36Sopenharmony_ci	 * host. We start with the highest number we can support
26162306a36Sopenharmony_ci	 * and work our way down until we negotiate a compatible
26262306a36Sopenharmony_ci	 * version.
26362306a36Sopenharmony_ci	 */
26462306a36Sopenharmony_ci
26562306a36Sopenharmony_ci	for (i = 0; ; i++) {
26662306a36Sopenharmony_ci		if (i == ARRAY_SIZE(vmbus_versions)) {
26762306a36Sopenharmony_ci			ret = -EDOM;
26862306a36Sopenharmony_ci			goto cleanup;
26962306a36Sopenharmony_ci		}
27062306a36Sopenharmony_ci
27162306a36Sopenharmony_ci		version = vmbus_versions[i];
27262306a36Sopenharmony_ci		if (version > max_version)
27362306a36Sopenharmony_ci			continue;
27462306a36Sopenharmony_ci
27562306a36Sopenharmony_ci		ret = vmbus_negotiate_version(msginfo, version);
27662306a36Sopenharmony_ci		if (ret == -ETIMEDOUT)
27762306a36Sopenharmony_ci			goto cleanup;
27862306a36Sopenharmony_ci
27962306a36Sopenharmony_ci		if (vmbus_connection.conn_state == CONNECTED)
28062306a36Sopenharmony_ci			break;
28162306a36Sopenharmony_ci	}
28262306a36Sopenharmony_ci
28362306a36Sopenharmony_ci	if (hv_is_isolation_supported() && version < VERSION_WIN10_V5_2) {
28462306a36Sopenharmony_ci		pr_err("Invalid VMBus version %d.%d (expected >= %d.%d) from the host supporting isolation\n",
28562306a36Sopenharmony_ci		       version >> 16, version & 0xFFFF, VERSION_WIN10_V5_2 >> 16, VERSION_WIN10_V5_2 & 0xFFFF);
28662306a36Sopenharmony_ci		ret = -EINVAL;
28762306a36Sopenharmony_ci		goto cleanup;
28862306a36Sopenharmony_ci	}
28962306a36Sopenharmony_ci
29062306a36Sopenharmony_ci	vmbus_proto_version = version;
29162306a36Sopenharmony_ci	pr_info("Vmbus version:%d.%d\n",
29262306a36Sopenharmony_ci		version >> 16, version & 0xFFFF);
29362306a36Sopenharmony_ci
29462306a36Sopenharmony_ci	vmbus_connection.channels = kcalloc(MAX_CHANNEL_RELIDS,
29562306a36Sopenharmony_ci					    sizeof(struct vmbus_channel *),
29662306a36Sopenharmony_ci					    GFP_KERNEL);
29762306a36Sopenharmony_ci	if (vmbus_connection.channels == NULL) {
29862306a36Sopenharmony_ci		ret = -ENOMEM;
29962306a36Sopenharmony_ci		goto cleanup;
30062306a36Sopenharmony_ci	}
30162306a36Sopenharmony_ci
30262306a36Sopenharmony_ci	kfree(msginfo);
30362306a36Sopenharmony_ci	return 0;
30462306a36Sopenharmony_ci
30562306a36Sopenharmony_cicleanup:
30662306a36Sopenharmony_ci	pr_err("Unable to connect to host\n");
30762306a36Sopenharmony_ci
30862306a36Sopenharmony_ci	vmbus_connection.conn_state = DISCONNECTED;
30962306a36Sopenharmony_ci	vmbus_disconnect();
31062306a36Sopenharmony_ci
31162306a36Sopenharmony_ci	kfree(msginfo);
31262306a36Sopenharmony_ci
31362306a36Sopenharmony_ci	return ret;
31462306a36Sopenharmony_ci}
31562306a36Sopenharmony_ci
31662306a36Sopenharmony_civoid vmbus_disconnect(void)
31762306a36Sopenharmony_ci{
31862306a36Sopenharmony_ci	/*
31962306a36Sopenharmony_ci	 * First send the unload request to the host.
32062306a36Sopenharmony_ci	 */
32162306a36Sopenharmony_ci	vmbus_initiate_unload(false);
32262306a36Sopenharmony_ci
32362306a36Sopenharmony_ci	if (vmbus_connection.handle_sub_chan_wq)
32462306a36Sopenharmony_ci		destroy_workqueue(vmbus_connection.handle_sub_chan_wq);
32562306a36Sopenharmony_ci
32662306a36Sopenharmony_ci	if (vmbus_connection.handle_primary_chan_wq)
32762306a36Sopenharmony_ci		destroy_workqueue(vmbus_connection.handle_primary_chan_wq);
32862306a36Sopenharmony_ci
32962306a36Sopenharmony_ci	if (vmbus_connection.rescind_work_queue)
33062306a36Sopenharmony_ci		destroy_workqueue(vmbus_connection.rescind_work_queue);
33162306a36Sopenharmony_ci
33262306a36Sopenharmony_ci	if (vmbus_connection.work_queue)
33362306a36Sopenharmony_ci		destroy_workqueue(vmbus_connection.work_queue);
33462306a36Sopenharmony_ci
33562306a36Sopenharmony_ci	if (vmbus_connection.int_page) {
33662306a36Sopenharmony_ci		hv_free_hyperv_page(vmbus_connection.int_page);
33762306a36Sopenharmony_ci		vmbus_connection.int_page = NULL;
33862306a36Sopenharmony_ci	}
33962306a36Sopenharmony_ci
34062306a36Sopenharmony_ci	set_memory_encrypted((unsigned long)vmbus_connection.monitor_pages[0], 1);
34162306a36Sopenharmony_ci	set_memory_encrypted((unsigned long)vmbus_connection.monitor_pages[1], 1);
34262306a36Sopenharmony_ci
34362306a36Sopenharmony_ci	hv_free_hyperv_page(vmbus_connection.monitor_pages[0]);
34462306a36Sopenharmony_ci	hv_free_hyperv_page(vmbus_connection.monitor_pages[1]);
34562306a36Sopenharmony_ci	vmbus_connection.monitor_pages[0] = NULL;
34662306a36Sopenharmony_ci	vmbus_connection.monitor_pages[1] = NULL;
34762306a36Sopenharmony_ci}
34862306a36Sopenharmony_ci
34962306a36Sopenharmony_ci/*
35062306a36Sopenharmony_ci * relid2channel - Get the channel object given its
35162306a36Sopenharmony_ci * child relative id (ie channel id)
35262306a36Sopenharmony_ci */
35362306a36Sopenharmony_cistruct vmbus_channel *relid2channel(u32 relid)
35462306a36Sopenharmony_ci{
35562306a36Sopenharmony_ci	if (vmbus_connection.channels == NULL) {
35662306a36Sopenharmony_ci		pr_warn_once("relid2channel: relid=%d: No channels mapped!\n", relid);
35762306a36Sopenharmony_ci		return NULL;
35862306a36Sopenharmony_ci	}
35962306a36Sopenharmony_ci	if (WARN_ON(relid >= MAX_CHANNEL_RELIDS))
36062306a36Sopenharmony_ci		return NULL;
36162306a36Sopenharmony_ci	return READ_ONCE(vmbus_connection.channels[relid]);
36262306a36Sopenharmony_ci}
36362306a36Sopenharmony_ci
36462306a36Sopenharmony_ci/*
36562306a36Sopenharmony_ci * vmbus_on_event - Process a channel event notification
36662306a36Sopenharmony_ci *
36762306a36Sopenharmony_ci * For batched channels (default) optimize host to guest signaling
36862306a36Sopenharmony_ci * by ensuring:
36962306a36Sopenharmony_ci * 1. While reading the channel, we disable interrupts from host.
37062306a36Sopenharmony_ci * 2. Ensure that we process all posted messages from the host
37162306a36Sopenharmony_ci *    before returning from this callback.
37262306a36Sopenharmony_ci * 3. Once we return, enable signaling from the host. Once this
37362306a36Sopenharmony_ci *    state is set we check to see if additional packets are
37462306a36Sopenharmony_ci *    available to read. In this case we repeat the process.
37562306a36Sopenharmony_ci *    If this tasklet has been running for a long time
37662306a36Sopenharmony_ci *    then reschedule ourselves.
37762306a36Sopenharmony_ci */
37862306a36Sopenharmony_civoid vmbus_on_event(unsigned long data)
37962306a36Sopenharmony_ci{
38062306a36Sopenharmony_ci	struct vmbus_channel *channel = (void *) data;
38162306a36Sopenharmony_ci	void (*callback_fn)(void *context);
38262306a36Sopenharmony_ci
38362306a36Sopenharmony_ci	trace_vmbus_on_event(channel);
38462306a36Sopenharmony_ci
38562306a36Sopenharmony_ci	hv_debug_delay_test(channel, INTERRUPT_DELAY);
38662306a36Sopenharmony_ci
38762306a36Sopenharmony_ci	/* A channel once created is persistent even when
38862306a36Sopenharmony_ci	 * there is no driver handling the device. An
38962306a36Sopenharmony_ci	 * unloading driver sets the onchannel_callback to NULL.
39062306a36Sopenharmony_ci	 */
39162306a36Sopenharmony_ci	callback_fn = READ_ONCE(channel->onchannel_callback);
39262306a36Sopenharmony_ci	if (unlikely(!callback_fn))
39362306a36Sopenharmony_ci		return;
39462306a36Sopenharmony_ci
39562306a36Sopenharmony_ci	(*callback_fn)(channel->channel_callback_context);
39662306a36Sopenharmony_ci
39762306a36Sopenharmony_ci	if (channel->callback_mode != HV_CALL_BATCHED)
39862306a36Sopenharmony_ci		return;
39962306a36Sopenharmony_ci
40062306a36Sopenharmony_ci	if (likely(hv_end_read(&channel->inbound) == 0))
40162306a36Sopenharmony_ci		return;
40262306a36Sopenharmony_ci
40362306a36Sopenharmony_ci	hv_begin_read(&channel->inbound);
40462306a36Sopenharmony_ci	tasklet_schedule(&channel->callback_event);
40562306a36Sopenharmony_ci}
40662306a36Sopenharmony_ci
40762306a36Sopenharmony_ci/*
40862306a36Sopenharmony_ci * vmbus_post_msg - Send a msg on the vmbus's message connection
40962306a36Sopenharmony_ci */
41062306a36Sopenharmony_ciint vmbus_post_msg(void *buffer, size_t buflen, bool can_sleep)
41162306a36Sopenharmony_ci{
41262306a36Sopenharmony_ci	struct vmbus_channel_message_header *hdr;
41362306a36Sopenharmony_ci	union hv_connection_id conn_id;
41462306a36Sopenharmony_ci	int ret = 0;
41562306a36Sopenharmony_ci	int retries = 0;
41662306a36Sopenharmony_ci	u32 usec = 1;
41762306a36Sopenharmony_ci
41862306a36Sopenharmony_ci	conn_id.asu32 = 0;
41962306a36Sopenharmony_ci	conn_id.u.id = vmbus_connection.msg_conn_id;
42062306a36Sopenharmony_ci
42162306a36Sopenharmony_ci	/*
42262306a36Sopenharmony_ci	 * hv_post_message() can have transient failures because of
42362306a36Sopenharmony_ci	 * insufficient resources. Retry the operation a couple of
42462306a36Sopenharmony_ci	 * times before giving up.
42562306a36Sopenharmony_ci	 */
42662306a36Sopenharmony_ci	while (retries < 100) {
42762306a36Sopenharmony_ci		ret = hv_post_message(conn_id, 1, buffer, buflen);
42862306a36Sopenharmony_ci
42962306a36Sopenharmony_ci		switch (ret) {
43062306a36Sopenharmony_ci		case HV_STATUS_INVALID_CONNECTION_ID:
43162306a36Sopenharmony_ci			/*
43262306a36Sopenharmony_ci			 * See vmbus_negotiate_version(): VMBus protocol 5.0
43362306a36Sopenharmony_ci			 * and higher require that we must use
43462306a36Sopenharmony_ci			 * VMBUS_MESSAGE_CONNECTION_ID_4 for the Initiate
43562306a36Sopenharmony_ci			 * Contact message, but on old hosts that only
43662306a36Sopenharmony_ci			 * support VMBus protocol 4.0 or lower, here we get
43762306a36Sopenharmony_ci			 * HV_STATUS_INVALID_CONNECTION_ID and we should
43862306a36Sopenharmony_ci			 * return an error immediately without retrying.
43962306a36Sopenharmony_ci			 */
44062306a36Sopenharmony_ci			hdr = buffer;
44162306a36Sopenharmony_ci			if (hdr->msgtype == CHANNELMSG_INITIATE_CONTACT)
44262306a36Sopenharmony_ci				return -EINVAL;
44362306a36Sopenharmony_ci			/*
44462306a36Sopenharmony_ci			 * We could get this if we send messages too
44562306a36Sopenharmony_ci			 * frequently.
44662306a36Sopenharmony_ci			 */
44762306a36Sopenharmony_ci			ret = -EAGAIN;
44862306a36Sopenharmony_ci			break;
44962306a36Sopenharmony_ci		case HV_STATUS_INSUFFICIENT_MEMORY:
45062306a36Sopenharmony_ci		case HV_STATUS_INSUFFICIENT_BUFFERS:
45162306a36Sopenharmony_ci			ret = -ENOBUFS;
45262306a36Sopenharmony_ci			break;
45362306a36Sopenharmony_ci		case HV_STATUS_SUCCESS:
45462306a36Sopenharmony_ci			return ret;
45562306a36Sopenharmony_ci		default:
45662306a36Sopenharmony_ci			pr_err("hv_post_msg() failed; error code:%d\n", ret);
45762306a36Sopenharmony_ci			return -EINVAL;
45862306a36Sopenharmony_ci		}
45962306a36Sopenharmony_ci
46062306a36Sopenharmony_ci		retries++;
46162306a36Sopenharmony_ci		if (can_sleep && usec > 1000)
46262306a36Sopenharmony_ci			msleep(usec / 1000);
46362306a36Sopenharmony_ci		else if (usec < MAX_UDELAY_MS * 1000)
46462306a36Sopenharmony_ci			udelay(usec);
46562306a36Sopenharmony_ci		else
46662306a36Sopenharmony_ci			mdelay(usec / 1000);
46762306a36Sopenharmony_ci
46862306a36Sopenharmony_ci		if (retries < 22)
46962306a36Sopenharmony_ci			usec *= 2;
47062306a36Sopenharmony_ci	}
47162306a36Sopenharmony_ci	return ret;
47262306a36Sopenharmony_ci}
47362306a36Sopenharmony_ci
47462306a36Sopenharmony_ci/*
47562306a36Sopenharmony_ci * vmbus_set_event - Send an event notification to the parent
47662306a36Sopenharmony_ci */
47762306a36Sopenharmony_civoid vmbus_set_event(struct vmbus_channel *channel)
47862306a36Sopenharmony_ci{
47962306a36Sopenharmony_ci	u32 child_relid = channel->offermsg.child_relid;
48062306a36Sopenharmony_ci
48162306a36Sopenharmony_ci	if (!channel->is_dedicated_interrupt)
48262306a36Sopenharmony_ci		vmbus_send_interrupt(child_relid);
48362306a36Sopenharmony_ci
48462306a36Sopenharmony_ci	++channel->sig_events;
48562306a36Sopenharmony_ci
48662306a36Sopenharmony_ci	if (ms_hyperv.paravisor_present) {
48762306a36Sopenharmony_ci		if (hv_isolation_type_snp())
48862306a36Sopenharmony_ci			hv_ghcb_hypercall(HVCALL_SIGNAL_EVENT, &channel->sig_event,
48962306a36Sopenharmony_ci					  NULL, sizeof(channel->sig_event));
49062306a36Sopenharmony_ci		else if (hv_isolation_type_tdx())
49162306a36Sopenharmony_ci			hv_tdx_hypercall(HVCALL_SIGNAL_EVENT | HV_HYPERCALL_FAST_BIT,
49262306a36Sopenharmony_ci					 channel->sig_event, 0);
49362306a36Sopenharmony_ci		else
49462306a36Sopenharmony_ci			WARN_ON_ONCE(1);
49562306a36Sopenharmony_ci	} else {
49662306a36Sopenharmony_ci		hv_do_fast_hypercall8(HVCALL_SIGNAL_EVENT, channel->sig_event);
49762306a36Sopenharmony_ci	}
49862306a36Sopenharmony_ci}
49962306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(vmbus_set_event);
500