|
@@ -15,6 +15,12 @@
|
|
|
#include "hw/remote/mpqemu-link.h"
|
|
|
#include "qapi/error.h"
|
|
|
#include "sysemu/runstate.h"
|
|
|
+#include "hw/pci/pci.h"
|
|
|
+
|
|
|
+static void process_config_write(QIOChannel *ioc, PCIDevice *dev,
|
|
|
+ MPQemuMsg *msg, Error **errp);
|
|
|
+static void process_config_read(QIOChannel *ioc, PCIDevice *dev,
|
|
|
+ MPQemuMsg *msg, Error **errp);
|
|
|
|
|
|
void coroutine_fn mpqemu_remote_msg_loop_co(void *data)
|
|
|
{
|
|
@@ -40,6 +46,12 @@ void coroutine_fn mpqemu_remote_msg_loop_co(void *data)
|
|
|
}
|
|
|
|
|
|
switch (msg.cmd) {
|
|
|
+ case MPQEMU_CMD_PCI_CFGWRITE:
|
|
|
+ process_config_write(com->ioc, pci_dev, &msg, &local_err);
|
|
|
+ break;
|
|
|
+ case MPQEMU_CMD_PCI_CFGREAD:
|
|
|
+ process_config_read(com->ioc, pci_dev, &msg, &local_err);
|
|
|
+ break;
|
|
|
default:
|
|
|
error_setg(&local_err,
|
|
|
"Unknown command (%d) received for device %s"
|
|
@@ -55,3 +67,51 @@ void coroutine_fn mpqemu_remote_msg_loop_co(void *data)
|
|
|
qemu_system_shutdown_request(SHUTDOWN_CAUSE_GUEST_SHUTDOWN);
|
|
|
}
|
|
|
}
|
|
|
+
|
|
|
+static void process_config_write(QIOChannel *ioc, PCIDevice *dev,
|
|
|
+ MPQemuMsg *msg, Error **errp)
|
|
|
+{
|
|
|
+ ERRP_GUARD();
|
|
|
+ PciConfDataMsg *conf = (PciConfDataMsg *)&msg->data.pci_conf_data;
|
|
|
+ MPQemuMsg ret = { 0 };
|
|
|
+
|
|
|
+ if ((conf->addr + sizeof(conf->val)) > pci_config_size(dev)) {
|
|
|
+ error_setg(errp, "Bad address for PCI config write, pid "FMT_pid".",
|
|
|
+ getpid());
|
|
|
+ ret.data.u64 = UINT64_MAX;
|
|
|
+ } else {
|
|
|
+ pci_default_write_config(dev, conf->addr, conf->val, conf->len);
|
|
|
+ }
|
|
|
+
|
|
|
+ ret.cmd = MPQEMU_CMD_RET;
|
|
|
+ ret.size = sizeof(ret.data.u64);
|
|
|
+
|
|
|
+ if (!mpqemu_msg_send(&ret, ioc, NULL)) {
|
|
|
+ error_prepend(errp, "Error returning code to proxy, pid "FMT_pid": ",
|
|
|
+ getpid());
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void process_config_read(QIOChannel *ioc, PCIDevice *dev,
|
|
|
+ MPQemuMsg *msg, Error **errp)
|
|
|
+{
|
|
|
+ ERRP_GUARD();
|
|
|
+ PciConfDataMsg *conf = (PciConfDataMsg *)&msg->data.pci_conf_data;
|
|
|
+ MPQemuMsg ret = { 0 };
|
|
|
+
|
|
|
+ if ((conf->addr + sizeof(conf->val)) > pci_config_size(dev)) {
|
|
|
+ error_setg(errp, "Bad address for PCI config read, pid "FMT_pid".",
|
|
|
+ getpid());
|
|
|
+ ret.data.u64 = UINT64_MAX;
|
|
|
+ } else {
|
|
|
+ ret.data.u64 = pci_default_read_config(dev, conf->addr, conf->len);
|
|
|
+ }
|
|
|
+
|
|
|
+ ret.cmd = MPQEMU_CMD_RET;
|
|
|
+ ret.size = sizeof(ret.data.u64);
|
|
|
+
|
|
|
+ if (!mpqemu_msg_send(&ret, ioc, NULL)) {
|
|
|
+ error_prepend(errp, "Error returning code to proxy, pid "FMT_pid": ",
|
|
|
+ getpid());
|
|
|
+ }
|
|
|
+}
|