824 строки
22 KiB
C
824 строки
22 KiB
C
/*
|
|
* An implementation of key value pair (KVP) functionality for Linux.
|
|
*
|
|
*
|
|
* Copyright (C) 2010, Novell, Inc.
|
|
* Author : K. Y. Srinivasan <ksrinivasan@novell.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License version 2 as published
|
|
* by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
|
|
* NON INFRINGEMENT. See the GNU General Public License for more
|
|
* details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
*
|
|
*/
|
|
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
|
|
|
|
#include <linux/net.h>
|
|
#include <linux/nls.h>
|
|
#include <linux/connector.h>
|
|
#include <linux/workqueue.h>
|
|
#include <linux/hyperv.h>
|
|
#include <asm/hyperv-tlfs.h>
|
|
|
|
#include "hyperv_vmbus.h"
|
|
#include "hv_utils_transport.h"
|
|
|
|
/*
|
|
* Pre win8 version numbers used in ws2008 and ws 2008 r2 (win7)
|
|
*/
|
|
#define WS2008_SRV_MAJOR 1
|
|
#define WS2008_SRV_MINOR 0
|
|
#define WS2008_SRV_VERSION (WS2008_SRV_MAJOR << 16 | WS2008_SRV_MINOR)
|
|
|
|
#define WIN7_SRV_MAJOR 3
|
|
#define WIN7_SRV_MINOR 0
|
|
#define WIN7_SRV_VERSION (WIN7_SRV_MAJOR << 16 | WIN7_SRV_MINOR)
|
|
|
|
#define WIN8_SRV_MAJOR 4
|
|
#define WIN8_SRV_MINOR 0
|
|
#define WIN8_SRV_VERSION (WIN8_SRV_MAJOR << 16 | WIN8_SRV_MINOR)
|
|
|
|
#define KVP_VER_COUNT 3
|
|
static const int kvp_versions[] = {
|
|
WIN8_SRV_VERSION,
|
|
WIN7_SRV_VERSION,
|
|
WS2008_SRV_VERSION
|
|
};
|
|
|
|
#define FW_VER_COUNT 2
|
|
static const int fw_versions[] = {
|
|
UTIL_FW_VERSION,
|
|
UTIL_WS2K8_FW_VERSION
|
|
};
|
|
|
|
/*
|
|
* Global state maintained for transaction that is being processed. For a class
|
|
* of integration services, including the "KVP service", the specified protocol
|
|
* is a "request/response" protocol which means that there can only be single
|
|
* outstanding transaction from the host at any given point in time. We use
|
|
* this to simplify memory management in this driver - we cache and process
|
|
* only one message at a time.
|
|
*
|
|
* While the request/response protocol is guaranteed by the host, we further
|
|
* ensure this by serializing packet processing in this driver - we do not
|
|
* read additional packets from the VMBUS until the current packet is fully
|
|
* handled.
|
|
*/
|
|
|
|
static struct {
|
|
int state; /* hvutil_device_state */
|
|
int recv_len; /* number of bytes received. */
|
|
struct hv_kvp_msg *kvp_msg; /* current message */
|
|
struct vmbus_channel *recv_channel; /* chn we got the request */
|
|
u64 recv_req_id; /* request ID. */
|
|
} kvp_transaction;
|
|
|
|
/*
|
|
* This state maintains the version number registered by the daemon.
|
|
*/
|
|
static int dm_reg_value;
|
|
|
|
static void kvp_send_key(struct work_struct *dummy);
|
|
|
|
|
|
static void kvp_respond_to_host(struct hv_kvp_msg *msg, int error);
|
|
static void kvp_timeout_func(struct work_struct *dummy);
|
|
static void kvp_host_handshake_func(struct work_struct *dummy);
|
|
static void kvp_register(int);
|
|
|
|
static DECLARE_DELAYED_WORK(kvp_timeout_work, kvp_timeout_func);
|
|
static DECLARE_DELAYED_WORK(kvp_host_handshake_work, kvp_host_handshake_func);
|
|
static DECLARE_WORK(kvp_sendkey_work, kvp_send_key);
|
|
|
|
static const char kvp_devname[] = "vmbus/hv_kvp";
|
|
static u8 *recv_buffer;
|
|
static struct hvutil_transport *hvt;
|
|
/*
|
|
* Register the kernel component with the user-level daemon.
|
|
* As part of this registration, pass the LIC version number.
|
|
* This number has no meaning, it satisfies the registration protocol.
|
|
*/
|
|
#define HV_DRV_VERSION "3.1"
|
|
|
|
static void kvp_poll_wrapper(void *channel)
|
|
{
|
|
/* Transaction is finished, reset the state here to avoid races. */
|
|
kvp_transaction.state = HVUTIL_READY;
|
|
tasklet_schedule(&((struct vmbus_channel *)channel)->callback_event);
|
|
}
|
|
|
|
static void kvp_register_done(void)
|
|
{
|
|
/*
|
|
* If we're still negotiating with the host cancel the timeout
|
|
* work to not poll the channel twice.
|
|
*/
|
|
pr_debug("KVP: userspace daemon registered\n");
|
|
cancel_delayed_work_sync(&kvp_host_handshake_work);
|
|
hv_poll_channel(kvp_transaction.recv_channel, kvp_poll_wrapper);
|
|
}
|
|
|
|
static void
|
|
kvp_register(int reg_value)
|
|
{
|
|
|
|
struct hv_kvp_msg *kvp_msg;
|
|
char *version;
|
|
|
|
kvp_msg = kzalloc(sizeof(*kvp_msg), GFP_KERNEL);
|
|
|
|
if (kvp_msg) {
|
|
version = kvp_msg->body.kvp_register.version;
|
|
kvp_msg->kvp_hdr.operation = reg_value;
|
|
strcpy(version, HV_DRV_VERSION);
|
|
|
|
hvutil_transport_send(hvt, kvp_msg, sizeof(*kvp_msg),
|
|
kvp_register_done);
|
|
kfree(kvp_msg);
|
|
}
|
|
}
|
|
|
|
static void kvp_timeout_func(struct work_struct *dummy)
|
|
{
|
|
/*
|
|
* If the timer fires, the user-mode component has not responded;
|
|
* process the pending transaction.
|
|
*/
|
|
kvp_respond_to_host(NULL, HV_E_FAIL);
|
|
|
|
hv_poll_channel(kvp_transaction.recv_channel, kvp_poll_wrapper);
|
|
}
|
|
|
|
static void kvp_host_handshake_func(struct work_struct *dummy)
|
|
{
|
|
tasklet_schedule(&kvp_transaction.recv_channel->callback_event);
|
|
}
|
|
|
|
static int kvp_handle_handshake(struct hv_kvp_msg *msg)
|
|
{
|
|
switch (msg->kvp_hdr.operation) {
|
|
case KVP_OP_REGISTER:
|
|
dm_reg_value = KVP_OP_REGISTER;
|
|
pr_info("KVP: IP injection functionality not available\n");
|
|
pr_info("KVP: Upgrade the KVP daemon\n");
|
|
break;
|
|
case KVP_OP_REGISTER1:
|
|
dm_reg_value = KVP_OP_REGISTER1;
|
|
break;
|
|
default:
|
|
pr_info("KVP: incompatible daemon\n");
|
|
pr_info("KVP: KVP version: %d, Daemon version: %d\n",
|
|
KVP_OP_REGISTER1, msg->kvp_hdr.operation);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*
|
|
* We have a compatible daemon; complete the handshake.
|
|
*/
|
|
pr_debug("KVP: userspace daemon ver. %d connected\n",
|
|
msg->kvp_hdr.operation);
|
|
kvp_register(dm_reg_value);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/*
|
|
* Callback when data is received from user mode.
|
|
*/
|
|
|
|
static int kvp_on_msg(void *msg, int len)
|
|
{
|
|
struct hv_kvp_msg *message = (struct hv_kvp_msg *)msg;
|
|
struct hv_kvp_msg_enumerate *data;
|
|
int error = 0;
|
|
|
|
if (len < sizeof(*message))
|
|
return -EINVAL;
|
|
|
|
/*
|
|
* If we are negotiating the version information
|
|
* with the daemon; handle that first.
|
|
*/
|
|
|
|
if (kvp_transaction.state < HVUTIL_READY) {
|
|
return kvp_handle_handshake(message);
|
|
}
|
|
|
|
/* We didn't send anything to userspace so the reply is spurious */
|
|
if (kvp_transaction.state < HVUTIL_USERSPACE_REQ)
|
|
return -EINVAL;
|
|
|
|
kvp_transaction.state = HVUTIL_USERSPACE_RECV;
|
|
|
|
/*
|
|
* Based on the version of the daemon, we propagate errors from the
|
|
* daemon differently.
|
|
*/
|
|
|
|
data = &message->body.kvp_enum_data;
|
|
|
|
switch (dm_reg_value) {
|
|
case KVP_OP_REGISTER:
|
|
/*
|
|
* Null string is used to pass back error condition.
|
|
*/
|
|
if (data->data.key[0] == 0)
|
|
error = HV_S_CONT;
|
|
break;
|
|
|
|
case KVP_OP_REGISTER1:
|
|
/*
|
|
* We use the message header information from
|
|
* the user level daemon to transmit errors.
|
|
*/
|
|
error = message->error;
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* Complete the transaction by forwarding the key value
|
|
* to the host. But first, cancel the timeout.
|
|
*/
|
|
if (cancel_delayed_work_sync(&kvp_timeout_work)) {
|
|
kvp_respond_to_host(message, error);
|
|
hv_poll_channel(kvp_transaction.recv_channel, kvp_poll_wrapper);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int process_ob_ipinfo(void *in_msg, void *out_msg, int op)
|
|
{
|
|
struct hv_kvp_msg *in = in_msg;
|
|
struct hv_kvp_ip_msg *out = out_msg;
|
|
int len;
|
|
|
|
switch (op) {
|
|
case KVP_OP_GET_IP_INFO:
|
|
/*
|
|
* Transform all parameters into utf16 encoding.
|
|
*/
|
|
len = utf8s_to_utf16s((char *)in->body.kvp_ip_val.ip_addr,
|
|
strlen((char *)in->body.kvp_ip_val.ip_addr),
|
|
UTF16_HOST_ENDIAN,
|
|
(wchar_t *)out->kvp_ip_val.ip_addr,
|
|
MAX_IP_ADDR_SIZE);
|
|
if (len < 0)
|
|
return len;
|
|
|
|
len = utf8s_to_utf16s((char *)in->body.kvp_ip_val.sub_net,
|
|
strlen((char *)in->body.kvp_ip_val.sub_net),
|
|
UTF16_HOST_ENDIAN,
|
|
(wchar_t *)out->kvp_ip_val.sub_net,
|
|
MAX_IP_ADDR_SIZE);
|
|
if (len < 0)
|
|
return len;
|
|
|
|
len = utf8s_to_utf16s((char *)in->body.kvp_ip_val.gate_way,
|
|
strlen((char *)in->body.kvp_ip_val.gate_way),
|
|
UTF16_HOST_ENDIAN,
|
|
(wchar_t *)out->kvp_ip_val.gate_way,
|
|
MAX_GATEWAY_SIZE);
|
|
if (len < 0)
|
|
return len;
|
|
|
|
len = utf8s_to_utf16s((char *)in->body.kvp_ip_val.dns_addr,
|
|
strlen((char *)in->body.kvp_ip_val.dns_addr),
|
|
UTF16_HOST_ENDIAN,
|
|
(wchar_t *)out->kvp_ip_val.dns_addr,
|
|
MAX_IP_ADDR_SIZE);
|
|
if (len < 0)
|
|
return len;
|
|
|
|
len = utf8s_to_utf16s((char *)in->body.kvp_ip_val.adapter_id,
|
|
strlen((char *)in->body.kvp_ip_val.adapter_id),
|
|
UTF16_HOST_ENDIAN,
|
|
(wchar_t *)out->kvp_ip_val.adapter_id,
|
|
MAX_ADAPTER_ID_SIZE);
|
|
if (len < 0)
|
|
return len;
|
|
|
|
out->kvp_ip_val.dhcp_enabled =
|
|
in->body.kvp_ip_val.dhcp_enabled;
|
|
out->kvp_ip_val.addr_family =
|
|
in->body.kvp_ip_val.addr_family;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void process_ib_ipinfo(void *in_msg, void *out_msg, int op)
|
|
{
|
|
struct hv_kvp_ip_msg *in = in_msg;
|
|
struct hv_kvp_msg *out = out_msg;
|
|
|
|
switch (op) {
|
|
case KVP_OP_SET_IP_INFO:
|
|
/*
|
|
* Transform all parameters into utf8 encoding.
|
|
*/
|
|
utf16s_to_utf8s((wchar_t *)in->kvp_ip_val.ip_addr,
|
|
MAX_IP_ADDR_SIZE,
|
|
UTF16_LITTLE_ENDIAN,
|
|
(__u8 *)out->body.kvp_ip_val.ip_addr,
|
|
MAX_IP_ADDR_SIZE);
|
|
|
|
utf16s_to_utf8s((wchar_t *)in->kvp_ip_val.sub_net,
|
|
MAX_IP_ADDR_SIZE,
|
|
UTF16_LITTLE_ENDIAN,
|
|
(__u8 *)out->body.kvp_ip_val.sub_net,
|
|
MAX_IP_ADDR_SIZE);
|
|
|
|
utf16s_to_utf8s((wchar_t *)in->kvp_ip_val.gate_way,
|
|
MAX_GATEWAY_SIZE,
|
|
UTF16_LITTLE_ENDIAN,
|
|
(__u8 *)out->body.kvp_ip_val.gate_way,
|
|
MAX_GATEWAY_SIZE);
|
|
|
|
utf16s_to_utf8s((wchar_t *)in->kvp_ip_val.dns_addr,
|
|
MAX_IP_ADDR_SIZE,
|
|
UTF16_LITTLE_ENDIAN,
|
|
(__u8 *)out->body.kvp_ip_val.dns_addr,
|
|
MAX_IP_ADDR_SIZE);
|
|
|
|
out->body.kvp_ip_val.dhcp_enabled = in->kvp_ip_val.dhcp_enabled;
|
|
|
|
fallthrough;
|
|
|
|
case KVP_OP_GET_IP_INFO:
|
|
utf16s_to_utf8s((wchar_t *)in->kvp_ip_val.adapter_id,
|
|
MAX_ADAPTER_ID_SIZE,
|
|
UTF16_LITTLE_ENDIAN,
|
|
(__u8 *)out->body.kvp_ip_val.adapter_id,
|
|
MAX_ADAPTER_ID_SIZE);
|
|
|
|
out->body.kvp_ip_val.addr_family = in->kvp_ip_val.addr_family;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
static void
|
|
kvp_send_key(struct work_struct *dummy)
|
|
{
|
|
struct hv_kvp_msg *message;
|
|
struct hv_kvp_msg *in_msg;
|
|
__u8 operation = kvp_transaction.kvp_msg->kvp_hdr.operation;
|
|
__u8 pool = kvp_transaction.kvp_msg->kvp_hdr.pool;
|
|
__u32 val32;
|
|
__u64 val64;
|
|
int rc;
|
|
|
|
/* The transaction state is wrong. */
|
|
if (kvp_transaction.state != HVUTIL_HOSTMSG_RECEIVED)
|
|
return;
|
|
|
|
message = kzalloc(sizeof(*message), GFP_KERNEL);
|
|
if (!message)
|
|
return;
|
|
|
|
message->kvp_hdr.operation = operation;
|
|
message->kvp_hdr.pool = pool;
|
|
in_msg = kvp_transaction.kvp_msg;
|
|
|
|
/*
|
|
* The key/value strings sent from the host are encoded in
|
|
* in utf16; convert it to utf8 strings.
|
|
* The host assures us that the utf16 strings will not exceed
|
|
* the max lengths specified. We will however, reserve room
|
|
* for the string terminating character - in the utf16s_utf8s()
|
|
* function we limit the size of the buffer where the converted
|
|
* string is placed to HV_KVP_EXCHANGE_MAX_*_SIZE -1 to guarantee
|
|
* that the strings can be properly terminated!
|
|
*/
|
|
|
|
switch (message->kvp_hdr.operation) {
|
|
case KVP_OP_SET_IP_INFO:
|
|
process_ib_ipinfo(in_msg, message, KVP_OP_SET_IP_INFO);
|
|
break;
|
|
case KVP_OP_GET_IP_INFO:
|
|
/*
|
|
* We only need to pass on the info of operation, adapter_id
|
|
* and addr_family to the userland kvp daemon.
|
|
*/
|
|
process_ib_ipinfo(in_msg, message, KVP_OP_GET_IP_INFO);
|
|
break;
|
|
case KVP_OP_SET:
|
|
switch (in_msg->body.kvp_set.data.value_type) {
|
|
case REG_SZ:
|
|
/*
|
|
* The value is a string - utf16 encoding.
|
|
*/
|
|
message->body.kvp_set.data.value_size =
|
|
utf16s_to_utf8s(
|
|
(wchar_t *)in_msg->body.kvp_set.data.value,
|
|
in_msg->body.kvp_set.data.value_size,
|
|
UTF16_LITTLE_ENDIAN,
|
|
message->body.kvp_set.data.value,
|
|
HV_KVP_EXCHANGE_MAX_VALUE_SIZE - 1) + 1;
|
|
break;
|
|
|
|
case REG_U32:
|
|
/*
|
|
* The value is a 32 bit scalar.
|
|
* We save this as a utf8 string.
|
|
*/
|
|
val32 = in_msg->body.kvp_set.data.value_u32;
|
|
message->body.kvp_set.data.value_size =
|
|
sprintf(message->body.kvp_set.data.value,
|
|
"%u", val32) + 1;
|
|
break;
|
|
|
|
case REG_U64:
|
|
/*
|
|
* The value is a 64 bit scalar.
|
|
* We save this as a utf8 string.
|
|
*/
|
|
val64 = in_msg->body.kvp_set.data.value_u64;
|
|
message->body.kvp_set.data.value_size =
|
|
sprintf(message->body.kvp_set.data.value,
|
|
"%llu", val64) + 1;
|
|
break;
|
|
|
|
}
|
|
|
|
/*
|
|
* The key is always a string - utf16 encoding.
|
|
*/
|
|
message->body.kvp_set.data.key_size =
|
|
utf16s_to_utf8s(
|
|
(wchar_t *)in_msg->body.kvp_set.data.key,
|
|
in_msg->body.kvp_set.data.key_size,
|
|
UTF16_LITTLE_ENDIAN,
|
|
message->body.kvp_set.data.key,
|
|
HV_KVP_EXCHANGE_MAX_KEY_SIZE - 1) + 1;
|
|
|
|
break;
|
|
|
|
case KVP_OP_GET:
|
|
message->body.kvp_get.data.key_size =
|
|
utf16s_to_utf8s(
|
|
(wchar_t *)in_msg->body.kvp_get.data.key,
|
|
in_msg->body.kvp_get.data.key_size,
|
|
UTF16_LITTLE_ENDIAN,
|
|
message->body.kvp_get.data.key,
|
|
HV_KVP_EXCHANGE_MAX_KEY_SIZE - 1) + 1;
|
|
break;
|
|
|
|
case KVP_OP_DELETE:
|
|
message->body.kvp_delete.key_size =
|
|
utf16s_to_utf8s(
|
|
(wchar_t *)in_msg->body.kvp_delete.key,
|
|
in_msg->body.kvp_delete.key_size,
|
|
UTF16_LITTLE_ENDIAN,
|
|
message->body.kvp_delete.key,
|
|
HV_KVP_EXCHANGE_MAX_KEY_SIZE - 1) + 1;
|
|
break;
|
|
|
|
case KVP_OP_ENUMERATE:
|
|
message->body.kvp_enum_data.index =
|
|
in_msg->body.kvp_enum_data.index;
|
|
break;
|
|
}
|
|
|
|
kvp_transaction.state = HVUTIL_USERSPACE_REQ;
|
|
rc = hvutil_transport_send(hvt, message, sizeof(*message), NULL);
|
|
if (rc) {
|
|
pr_debug("KVP: failed to communicate to the daemon: %d\n", rc);
|
|
if (cancel_delayed_work_sync(&kvp_timeout_work)) {
|
|
kvp_respond_to_host(message, HV_E_FAIL);
|
|
kvp_transaction.state = HVUTIL_READY;
|
|
}
|
|
}
|
|
|
|
kfree(message);
|
|
}
|
|
|
|
/*
|
|
* Send a response back to the host.
|
|
*/
|
|
|
|
static void
|
|
kvp_respond_to_host(struct hv_kvp_msg *msg_to_host, int error)
|
|
{
|
|
struct hv_kvp_msg *kvp_msg;
|
|
struct hv_kvp_exchg_msg_value *kvp_data;
|
|
char *key_name;
|
|
char *value;
|
|
struct icmsg_hdr *icmsghdrp;
|
|
int keylen = 0;
|
|
int valuelen = 0;
|
|
u32 buf_len;
|
|
struct vmbus_channel *channel;
|
|
u64 req_id;
|
|
int ret;
|
|
|
|
/*
|
|
* Copy the global state for completing the transaction. Note that
|
|
* only one transaction can be active at a time.
|
|
*/
|
|
|
|
buf_len = kvp_transaction.recv_len;
|
|
channel = kvp_transaction.recv_channel;
|
|
req_id = kvp_transaction.recv_req_id;
|
|
|
|
icmsghdrp = (struct icmsg_hdr *)
|
|
&recv_buffer[sizeof(struct vmbuspipe_hdr)];
|
|
|
|
if (channel->onchannel_callback == NULL)
|
|
/*
|
|
* We have raced with util driver being unloaded;
|
|
* silently return.
|
|
*/
|
|
return;
|
|
|
|
icmsghdrp->status = error;
|
|
|
|
/*
|
|
* If the error parameter is set, terminate the host's enumeration
|
|
* on this pool.
|
|
*/
|
|
if (error) {
|
|
/*
|
|
* Something failed or we have timed out;
|
|
* terminate the current host-side iteration.
|
|
*/
|
|
goto response_done;
|
|
}
|
|
|
|
kvp_msg = (struct hv_kvp_msg *)
|
|
&recv_buffer[sizeof(struct vmbuspipe_hdr) +
|
|
sizeof(struct icmsg_hdr)];
|
|
|
|
switch (kvp_transaction.kvp_msg->kvp_hdr.operation) {
|
|
case KVP_OP_GET_IP_INFO:
|
|
ret = process_ob_ipinfo(msg_to_host,
|
|
(struct hv_kvp_ip_msg *)kvp_msg,
|
|
KVP_OP_GET_IP_INFO);
|
|
if (ret < 0)
|
|
icmsghdrp->status = HV_E_FAIL;
|
|
|
|
goto response_done;
|
|
case KVP_OP_SET_IP_INFO:
|
|
goto response_done;
|
|
case KVP_OP_GET:
|
|
kvp_data = &kvp_msg->body.kvp_get.data;
|
|
goto copy_value;
|
|
|
|
case KVP_OP_SET:
|
|
case KVP_OP_DELETE:
|
|
goto response_done;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
kvp_data = &kvp_msg->body.kvp_enum_data.data;
|
|
key_name = msg_to_host->body.kvp_enum_data.data.key;
|
|
|
|
/*
|
|
* The windows host expects the key/value pair to be encoded
|
|
* in utf16. Ensure that the key/value size reported to the host
|
|
* will be less than or equal to the MAX size (including the
|
|
* terminating character).
|
|
*/
|
|
keylen = utf8s_to_utf16s(key_name, strlen(key_name), UTF16_HOST_ENDIAN,
|
|
(wchar_t *) kvp_data->key,
|
|
(HV_KVP_EXCHANGE_MAX_KEY_SIZE / 2) - 2);
|
|
kvp_data->key_size = 2*(keylen + 1); /* utf16 encoding */
|
|
|
|
copy_value:
|
|
value = msg_to_host->body.kvp_enum_data.data.value;
|
|
valuelen = utf8s_to_utf16s(value, strlen(value), UTF16_HOST_ENDIAN,
|
|
(wchar_t *) kvp_data->value,
|
|
(HV_KVP_EXCHANGE_MAX_VALUE_SIZE / 2) - 2);
|
|
kvp_data->value_size = 2*(valuelen + 1); /* utf16 encoding */
|
|
|
|
/*
|
|
* If the utf8s to utf16s conversion failed; notify host
|
|
* of the error.
|
|
*/
|
|
if ((keylen < 0) || (valuelen < 0))
|
|
icmsghdrp->status = HV_E_FAIL;
|
|
|
|
kvp_data->value_type = REG_SZ; /* all our values are strings */
|
|
|
|
response_done:
|
|
icmsghdrp->icflags = ICMSGHDRFLAG_TRANSACTION | ICMSGHDRFLAG_RESPONSE;
|
|
|
|
vmbus_sendpacket(channel, recv_buffer, buf_len, req_id,
|
|
VM_PKT_DATA_INBAND, 0);
|
|
}
|
|
|
|
/*
|
|
* This callback is invoked when we get a KVP message from the host.
|
|
* The host ensures that only one KVP transaction can be active at a time.
|
|
* KVP implementation in Linux needs to forward the key to a user-mde
|
|
* component to retrieve the corresponding value. Consequently, we cannot
|
|
* respond to the host in the context of this callback. Since the host
|
|
* guarantees that at most only one transaction can be active at a time,
|
|
* we stash away the transaction state in a set of global variables.
|
|
*/
|
|
|
|
void hv_kvp_onchannelcallback(void *context)
|
|
{
|
|
struct vmbus_channel *channel = context;
|
|
u32 recvlen;
|
|
u64 requestid;
|
|
|
|
struct hv_kvp_msg *kvp_msg;
|
|
|
|
struct icmsg_hdr *icmsghdrp;
|
|
int kvp_srv_version;
|
|
static enum {NEGO_NOT_STARTED,
|
|
NEGO_IN_PROGRESS,
|
|
NEGO_FINISHED} host_negotiatied = NEGO_NOT_STARTED;
|
|
|
|
if (kvp_transaction.state < HVUTIL_READY) {
|
|
/*
|
|
* If userspace daemon is not connected and host is asking
|
|
* us to negotiate we need to delay to not lose messages.
|
|
* This is important for Failover IP setting.
|
|
*/
|
|
if (host_negotiatied == NEGO_NOT_STARTED) {
|
|
host_negotiatied = NEGO_IN_PROGRESS;
|
|
schedule_delayed_work(&kvp_host_handshake_work,
|
|
HV_UTIL_NEGO_TIMEOUT * HZ);
|
|
}
|
|
return;
|
|
}
|
|
if (kvp_transaction.state > HVUTIL_READY)
|
|
return;
|
|
|
|
if (vmbus_recvpacket(channel, recv_buffer, HV_HYP_PAGE_SIZE * 4, &recvlen, &requestid)) {
|
|
pr_err_ratelimited("KVP request received. Could not read into recv buf\n");
|
|
return;
|
|
}
|
|
|
|
if (!recvlen)
|
|
return;
|
|
|
|
/* Ensure recvlen is big enough to read header data */
|
|
if (recvlen < ICMSG_HDR) {
|
|
pr_err_ratelimited("KVP request received. Packet length too small: %d\n",
|
|
recvlen);
|
|
return;
|
|
}
|
|
|
|
icmsghdrp = (struct icmsg_hdr *)&recv_buffer[sizeof(struct vmbuspipe_hdr)];
|
|
|
|
if (icmsghdrp->icmsgtype == ICMSGTYPE_NEGOTIATE) {
|
|
if (vmbus_prep_negotiate_resp(icmsghdrp,
|
|
recv_buffer, recvlen,
|
|
fw_versions, FW_VER_COUNT,
|
|
kvp_versions, KVP_VER_COUNT,
|
|
NULL, &kvp_srv_version)) {
|
|
pr_info("KVP IC version %d.%d\n",
|
|
kvp_srv_version >> 16,
|
|
kvp_srv_version & 0xFFFF);
|
|
}
|
|
} else if (icmsghdrp->icmsgtype == ICMSGTYPE_KVPEXCHANGE) {
|
|
/*
|
|
* recvlen is not checked against sizeof(struct kvp_msg) because kvp_msg contains
|
|
* a union of structs and the msg type received is not known. Code using this
|
|
* struct should provide validation when accessing its fields.
|
|
*/
|
|
kvp_msg = (struct hv_kvp_msg *)&recv_buffer[ICMSG_HDR];
|
|
|
|
/*
|
|
* Stash away this global state for completing the
|
|
* transaction; note transactions are serialized.
|
|
*/
|
|
|
|
kvp_transaction.recv_len = recvlen;
|
|
kvp_transaction.recv_req_id = requestid;
|
|
kvp_transaction.kvp_msg = kvp_msg;
|
|
|
|
if (kvp_transaction.state < HVUTIL_READY) {
|
|
/* Userspace is not registered yet */
|
|
kvp_respond_to_host(NULL, HV_E_FAIL);
|
|
return;
|
|
}
|
|
kvp_transaction.state = HVUTIL_HOSTMSG_RECEIVED;
|
|
|
|
/*
|
|
* Get the information from the
|
|
* user-mode component.
|
|
* component. This transaction will be
|
|
* completed when we get the value from
|
|
* the user-mode component.
|
|
* Set a timeout to deal with
|
|
* user-mode not responding.
|
|
*/
|
|
schedule_work(&kvp_sendkey_work);
|
|
schedule_delayed_work(&kvp_timeout_work,
|
|
HV_UTIL_TIMEOUT * HZ);
|
|
|
|
return;
|
|
|
|
} else {
|
|
pr_err_ratelimited("KVP request received. Invalid msg type: %d\n",
|
|
icmsghdrp->icmsgtype);
|
|
return;
|
|
}
|
|
|
|
icmsghdrp->icflags = ICMSGHDRFLAG_TRANSACTION
|
|
| ICMSGHDRFLAG_RESPONSE;
|
|
|
|
vmbus_sendpacket(channel, recv_buffer,
|
|
recvlen, requestid,
|
|
VM_PKT_DATA_INBAND, 0);
|
|
|
|
host_negotiatied = NEGO_FINISHED;
|
|
hv_poll_channel(kvp_transaction.recv_channel, kvp_poll_wrapper);
|
|
}
|
|
|
|
static void kvp_on_reset(void)
|
|
{
|
|
if (cancel_delayed_work_sync(&kvp_timeout_work))
|
|
kvp_respond_to_host(NULL, HV_E_FAIL);
|
|
kvp_transaction.state = HVUTIL_DEVICE_INIT;
|
|
}
|
|
|
|
int
|
|
hv_kvp_init(struct hv_util_service *srv)
|
|
{
|
|
recv_buffer = srv->recv_buffer;
|
|
kvp_transaction.recv_channel = srv->channel;
|
|
|
|
/*
|
|
* When this driver loads, the user level daemon that
|
|
* processes the host requests may not yet be running.
|
|
* Defer processing channel callbacks until the daemon
|
|
* has registered.
|
|
*/
|
|
kvp_transaction.state = HVUTIL_DEVICE_INIT;
|
|
|
|
hvt = hvutil_transport_init(kvp_devname, CN_KVP_IDX, CN_KVP_VAL,
|
|
kvp_on_msg, kvp_on_reset);
|
|
if (!hvt)
|
|
return -EFAULT;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void hv_kvp_cancel_work(void)
|
|
{
|
|
cancel_delayed_work_sync(&kvp_host_handshake_work);
|
|
cancel_delayed_work_sync(&kvp_timeout_work);
|
|
cancel_work_sync(&kvp_sendkey_work);
|
|
}
|
|
|
|
int hv_kvp_pre_suspend(void)
|
|
{
|
|
struct vmbus_channel *channel = kvp_transaction.recv_channel;
|
|
|
|
tasklet_disable(&channel->callback_event);
|
|
|
|
/*
|
|
* If there is a pending transtion, it's unnecessary to tell the host
|
|
* that the transaction will fail, because that is implied when
|
|
* util_suspend() calls vmbus_close() later.
|
|
*/
|
|
hv_kvp_cancel_work();
|
|
|
|
/*
|
|
* Forece the state to READY to handle the ICMSGTYPE_NEGOTIATE message
|
|
* later. The user space daemon may go out of order and its write()
|
|
* may fail with EINVAL: this doesn't matter since the daemon will
|
|
* reset the device by closing and re-opening it.
|
|
*/
|
|
kvp_transaction.state = HVUTIL_READY;
|
|
return 0;
|
|
}
|
|
|
|
int hv_kvp_pre_resume(void)
|
|
{
|
|
struct vmbus_channel *channel = kvp_transaction.recv_channel;
|
|
|
|
tasklet_enable(&channel->callback_event);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void hv_kvp_deinit(void)
|
|
{
|
|
kvp_transaction.state = HVUTIL_DEVICE_DYING;
|
|
|
|
hv_kvp_cancel_work();
|
|
|
|
hvutil_transport_destroy(hvt);
|
|
}
|