#include "ixd.h"
#include "ixd_ctlq.h"
#include "ixd_virtchnl.h"
void ixd_vc_recv_event_msg(struct ixd_adapter *adapter,
struct libie_ctlq_msg *ctlq_msg)
{
int payload_size = ctlq_msg->data_len;
struct virtchnl2_event *v2e;
if (payload_size < sizeof(*v2e)) {
dev_warn_ratelimited(ixd_to_dev(adapter),
"Failed to receive valid payload for event msg (op 0x%X len %u)\n",
ctlq_msg->chnl_opcode,
payload_size);
return;
}
v2e = (struct virtchnl2_event *)ctlq_msg->recv_mem.iov_base;
dev_dbg(ixd_to_dev(adapter), "Got event 0x%X from the CP\n",
le32_to_cpu(v2e->event));
}
bool ixd_vc_can_handle_msg(struct libie_ctlq_msg *ctlq_msg)
{
return ctlq_msg->chnl_opcode == VIRTCHNL2_OP_EVENT;
}
static int ixd_handle_caps(struct ixd_adapter *adapter, void *recv_buff,
size_t recv_size, void *ctx)
{
if (recv_size < sizeof(adapter->caps))
return -EBADMSG;
adapter->caps = *(typeof(adapter->caps) *)recv_buff;
return 0;
}
static int ixd_req_vc_caps(struct ixd_adapter *adapter)
{
const struct ixd_ctlq_req req = {
.opcode = VIRTCHNL2_OP_GET_CAPS,
.send_size = sizeof(struct virtchnl2_get_capabilities),
.ctx = NULL,
.send_buff_init = NULL,
.recv_process = ixd_handle_caps,
};
return ixd_ctlq_do_req(adapter, &req);
}
static struct virtchnl2_version_info ixd_get_vc_ver(void)
{
return (struct virtchnl2_version_info) {
.major = cpu_to_le32(VIRTCHNL2_VERSION_MAJOR_2),
.minor = cpu_to_le32(VIRTCHNL2_VERSION_MINOR_0),
};
}
static void ixd_fill_vc_ver(struct ixd_adapter *adapter, void *send_buff,
void *ctx)
{
*(struct virtchnl2_version_info *)send_buff = ixd_get_vc_ver();
}
static int ixd_handle_vc_ver(struct ixd_adapter *adapter, void *recv_buff,
size_t recv_size, void *ctx)
{
struct virtchnl2_version_info need_ver = ixd_get_vc_ver();
struct virtchnl2_version_info *recv_ver;
if (recv_size < sizeof(need_ver))
return -EBADMSG;
recv_ver = recv_buff;
if (le32_to_cpu(need_ver.major) != le32_to_cpu(recv_ver->major) ||
le32_to_cpu(need_ver.minor) != le32_to_cpu(recv_ver->minor))
dev_warn(ixd_to_dev(adapter),
"Virtchnl version does not match (expected %u.%u, received %u.%u)\n",
le32_to_cpu(need_ver.major),
le32_to_cpu(need_ver.minor),
le32_to_cpu(recv_ver->major),
le32_to_cpu(recv_ver->minor));
if (le32_to_cpu(need_ver.major) != le32_to_cpu(recv_ver->major)) {
dev_err(ixd_to_dev(adapter),
"Device initialization failed due to virtchnl major version mismatch\n");
return -EOPNOTSUPP;
}
adapter->vc_ver.major = le32_to_cpu(recv_ver->major);
adapter->vc_ver.minor = le32_to_cpu(recv_ver->minor);
return 0;
}
static int ixd_req_vc_version(struct ixd_adapter *adapter)
{
const struct ixd_ctlq_req req = {
.opcode = VIRTCHNL2_OP_VERSION,
.send_size = sizeof(struct virtchnl2_version_info),
.ctx = NULL,
.send_buff_init = ixd_fill_vc_ver,
.recv_process = ixd_handle_vc_ver,
};
return ixd_ctlq_do_req(adapter, &req);
}
int ixd_vc_dev_init(struct ixd_adapter *adapter)
{
int err;
err = ixd_req_vc_version(adapter);
if (err) {
dev_warn(ixd_to_dev(adapter),
"Getting virtchnl version failed, error=%pe\n",
ERR_PTR(err));
return err;
}
err = ixd_req_vc_caps(adapter);
if (err) {
dev_warn(ixd_to_dev(adapter),
"Getting virtchnl capabilities failed, error=%pe\n",
ERR_PTR(err));
return err;
}
return err;
}