This patch introduces the vGPU OpRegion emulation routines based on the
MPT services and GVT-g CFG/MMIO emulation framework to support guest OpRegion
facilities.
Signed-off-by: Zhi Wang <zhi.a.wang@xxxxxxxxx>
---
drivers/gpu/drm/i915/gvt/Makefile | 2 +-
drivers/gpu/drm/i915/gvt/cfg_space.c | 13 ++
drivers/gpu/drm/i915/gvt/gvt.c | 4 +
drivers/gpu/drm/i915/gvt/gvt.h | 12 +-
drivers/gpu/drm/i915/gvt/instance.c | 6 +
drivers/gpu/drm/i915/gvt/opregion.c | 314 +++++++++++++++++++++++++++++++++++
drivers/gpu/drm/i915/gvt/opregion.h | 34 ++++
7 files changed, 383 insertions(+), 2 deletions(-)
create mode 100644 drivers/gpu/drm/i915/gvt/opregion.c
create mode 100644 drivers/gpu/drm/i915/gvt/opregion.h
diff --git a/drivers/gpu/drm/i915/gvt/Makefile b/drivers/gpu/drm/i915/gvt/Makefile
index a821d3d..8f59bbc 100644
--- a/drivers/gpu/drm/i915/gvt/Makefile
+++ b/drivers/gpu/drm/i915/gvt/Makefile
@@ -1,5 +1,5 @@
GVT_SOURCE := gvt.o params.o aperture_gm.o mmio.o handlers.o instance.o \
- trace_points.o interrupt.o gtt.o cfg_space.o utility.o fb_decoder.o
+ trace_points.o interrupt.o gtt.o cfg_space.o opregion.o utility.o fb_decoder.o
ccflags-y += -I$(src) -I$(src)/.. -Wall -Werror -Wno-unused-function
i915_gvt-y := $(GVT_SOURCE)
diff --git a/drivers/gpu/drm/i915/gvt/cfg_space.c b/drivers/gpu/drm/i915/gvt/cfg_space.c
index bda0e9d..ab351e0 100644
--- a/drivers/gpu/drm/i915/gvt/cfg_space.c
+++ b/drivers/gpu/drm/i915/gvt/cfg_space.c
@@ -135,6 +135,19 @@ bool gvt_emulate_cfg_write(struct vgt_device *vgt, unsigned int off,
*(char *)p_data, bytes);
break;
+ case GVT_REG_CFG_SWSCI_TRIGGER:
+ new = *(u32 *)p_data;
+ gvt_emulate_opregion_request(vgt, new);
+ break;
+
+ case GVT_REG_CFG_OPREGION:
+ new = *(u32 *)p_data;
+ if (!gvt_init_instance_opregion(vgt, new))
+ return false;
+
+ memcpy(&vgt->state.cfg.space[off], p_data, bytes);
+ break;
+
case GVT_REG_CFG_SPACE_BAR1+4:
case GVT_REG_CFG_SPACE_BAR0+4:
case GVT_REG_CFG_SPACE_BAR2+4:
diff --git a/drivers/gpu/drm/i915/gvt/gvt.c b/drivers/gpu/drm/i915/gvt/gvt.c
index 32853b2..63eb02c 100644
--- a/drivers/gpu/drm/i915/gvt/gvt.c
+++ b/drivers/gpu/drm/i915/gvt/gvt.c
@@ -263,6 +263,7 @@ static void clean_pgt_device(struct pgt_device *pdev)
gvt_clean_gtt(pdev);
gvt_irq_exit(pdev);
gvt_clean_mmio_emulation_state(pdev);
+ gvt_clean_opregion(pdev);
clean_initial_mmio_state(pdev);
gvt_clean_resource_allocator(pdev);
}
@@ -277,6 +278,9 @@ static bool init_pgt_device(struct pgt_device *pdev, struct drm_i915_private *de
if (!init_initial_mmio_state(pdev))
goto err;
+ if (!gvt_init_opregion(pdev))
+ goto err;
+
gvt_init_resource_allocator(pdev);
if (!gvt_setup_mmio_emulation_state(pdev))
diff --git a/drivers/gpu/drm/i915/gvt/gvt.h b/drivers/gpu/drm/i915/gvt/gvt.h
index 244d8764..cf88bd6 100644
--- a/drivers/gpu/drm/i915/gvt/gvt.h
+++ b/drivers/gpu/drm/i915/gvt/gvt.h
@@ -37,6 +37,7 @@
#include "perf.h"
#include "gtt.h"
#include "cfg_space.h"
+#include "opregion.h"
#define GVT_MAX_VGPU 8
@@ -100,7 +101,12 @@ struct gvt_virtual_cfg_state {
unsigned char space[GVT_CFG_SPACE_SZ];
bool bar_mapped[GVT_BAR_NUM];
u64 bar_size[GVT_BAR_NUM];
- void *opregion_va;
+};
+
+struct gvt_virtual_opregion_state {
+ void *va;
+ u64 gfn[GVT_OPREGION_PAGES];
+ struct page *pages[GVT_OPREGION_PAGES];
};
struct gvt_virtual_gm_state {
@@ -119,6 +125,7 @@ struct gvt_virtual_device_state {
struct gvt_virtual_gm_state gm;
struct gvt_virtual_mmio_state mmio;
struct gvt_virtual_cfg_state cfg;
+ struct gvt_virtual_opregion_state opregion;
};
struct vgt_device {
@@ -161,6 +168,9 @@ struct pgt_device {
u32 mmio_size;
u32 reg_num;
+ void *opregion_va;
+ u32 opregion_pa;
+
wait_queue_head_t service_thread_wq;
struct task_struct *service_thread;
unsigned long service_request;
diff --git a/drivers/gpu/drm/i915/gvt/instance.c b/drivers/gpu/drm/i915/gvt/instance.c
index 1540661..91f52c6 100644
--- a/drivers/gpu/drm/i915/gvt/instance.c
+++ b/drivers/gpu/drm/i915/gvt/instance.c
@@ -165,6 +165,7 @@ static void destroy_virtual_device_state(struct vgt_device *vgt)
gvt_clean_vgtt(vgt);
destroy_virtual_mmio_state(vgt);
destroy_virtual_gm_state(vgt);
+ gvt_clean_instance_opregion(vgt);
}
static bool create_virtual_device_state(struct vgt_device *vgt,
@@ -199,6 +200,7 @@ void gvt_destroy_instance(struct vgt_device *vgt)
struct vgt_device *gvt_create_instance(struct pgt_device *pdev,
struct gvt_instance_info *info)
{
+ struct gvt_host *host = &gvt_host;
struct vgt_device *vgt = NULL;
int id;
@@ -232,6 +234,10 @@ struct vgt_device *gvt_create_instance(struct pgt_device *pdev,
if (hypervisor_hvm_init(vgt) < 0)
goto err;
+ if (host->hypervisor_type == GVT_HYPERVISOR_TYPE_KVM)
+ if (!gvt_init_instance_opregion(vgt, 0))
+ goto err;
+
gvt_set_instance_online(vgt);
return vgt;
diff --git a/drivers/gpu/drm/i915/gvt/opregion.c b/drivers/gpu/drm/i915/gvt/opregion.c
new file mode 100644
index 0000000..0640918
--- /dev/null
+++ b/drivers/gpu/drm/i915/gvt/opregion.c
@@ -0,0 +1,314 @@
+/*
+ * Copyright(c) 2011-2016 Intel Corporation. All rights reserved.
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a
+ * copy of this software and associated documentation files (the "Software"),
+ * to deal in the Software without restriction, including without limitation
+ * the rights to use, copy, modify, merge, publish, distribute, sublicense,
+ * and/or sell copies of the Software, and to permit persons to whom the
+ * Software is furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice (including the next
+ * paragraph) shall be included in all copies or substantial portions of the
+ * Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
+ * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
+ * SOFTWARE.
+ */
+
+#include <linux/acpi.h>
+
+#include "gvt.h"
+
+static bool init_virtual_opregion(struct vgt_device *vgt, u64 gpa)
+{
+ struct gvt_virtual_opregion_state *opregion = &vgt->state.opregion;
+ void *host_va = vgt->pdev->opregion_va;
+ u8 *buf;
+ int i;
+
+ if (opregion->va) {
+ gvt_err("[vgt %d] is trying to init opregion multiple times",
+ vgt->id);
+ return false;
+ }
+
+ opregion->va = (void *)__get_free_pages(GFP_ATOMIC |
+ GFP_DMA32 | __GFP_ZERO,
+ GVT_OPREGION_PORDER);
+
+ if (!opregion->va) {
+ gvt_err("fail to allocate memory for opregion pages");
+ return false;
+ }
+
+ memcpy_fromio(opregion->va, host_va, GVT_OPREGION_SIZE);
+
+ for (i = 0; i < GVT_OPREGION_PAGES; i++)
+ opregion->gfn[i] = (gpa >> PAGE_SHIFT) + i;
+
+ /* for unknown reason, the value in LID field is incorrect
+ * which block the windows guest, so workaround it by force
+ * setting it to "OPEN"
+ */
+ buf = (u8 *)opregion->va;
+ buf[GVT_OPREGION_REG_CLID] = 0x3;
+
+ return true;
+}
+
+static bool map_virtual_opregion(struct vgt_device *vgt, int map)
+{
+ struct gvt_virtual_opregion_state *opregion = &vgt->state.opregion;
+ int r;
+ int i;
+
+ for (i = 0; i < GVT_OPREGION_PAGES; i++) {
+ r = hypervisor_map_mfn_to_gpfn(vgt,
+ opregion->gfn[i],
+ hypervisor_virt_to_mfn(opregion->va + i * PAGE_SIZE),
+ 1,
+ map,
+ GVT_MAP_OPREGION);
+ if (r != 0) {
+ gvt_err("hypervisor_map_mfn_to_gpfn fail with %d!\n", r);
+ return false;
+ }
+ }
+ return true;
+}
+
+void gvt_clean_instance_opregion(struct vgt_device *vgt)
+{
+ struct gvt_host *host = &gvt_host;
+ struct gvt_virtual_opregion_state *opregion = &vgt->state.opregion;
+ int i;
+
+ gvt_dbg_core("clean instance opregion, id %d", vgt->id);
+
+ if (!opregion->va)
+ return;
+
+ if (host->hypervisor_type == GVT_HYPERVISOR_TYPE_KVM) {
+ vunmap(opregion->va);
+ for (i = 0; i < GVT_OPREGION_PAGES; i++) {
+ if (opregion->pages[i]) {
+ put_page(opregion->pages[i]);
+ opregion->pages[i] = NULL;
+ }
+ }
+ } else {
+ map_virtual_opregion(vgt, 0);
+ free_pages((unsigned long)opregion->va,
+ GVT_OPREGION_PORDER);
+ }
+
+ opregion->va = NULL;
+}
+
+bool gvt_init_instance_opregion(struct vgt_device *vgt, u64 gpa)
+{
+ struct gvt_host *host = &gvt_host;
+
+ gvt_dbg_core("init instance opregion, id %d", vgt->id);
+
+ if (host->hypervisor_type == GVT_HYPERVISOR_TYPE_XEN) {
+ gvt_dbg_core("emulate opregion from kernel");
+
+ if (!init_virtual_opregion(vgt, gpa))
+ return false;
+
+ if (!map_virtual_opregion(vgt, 1))
+ return false;
+ } else {
+ gvt_dbg_core("emulate opregion from userspace");
+
+ /* If opregion pages are not allocated from host kenrel, most of
+ * the params are meaningless */
+ hypervisor_map_mfn_to_gpfn(vgt,
+ 0, //not used
+ 0, //not used
+ 2, //not used
+ 1,
+ GVT_MAP_OPREGION);
+ }
+
+ return true;
+}
+
+void gvt_clean_opregion(struct pgt_device *pdev)
+{
+ if (pdev->opregion_va) {
+ iounmap(pdev->opregion_va);
+ pdev->opregion_va = NULL;
+ }
+}
+
+bool gvt_init_opregion(struct pgt_device *pdev)
+{
+ gvt_dbg_core("init host opregion");
+
+ pci_read_config_dword(pdev->dev_priv->dev->pdev, GVT_REG_CFG_OPREGION,
+ &pdev->opregion_pa);
+
+ pdev->opregion_va = acpi_os_ioremap(pdev->opregion_pa,
+ GVT_OPREGION_SIZE);
+
+ if (!pdev->opregion_va) {
+ gvt_err("fail to map host opregion");
+ return false;
+ }
+ return true;
+}
+
+#define GVT_OPREGION_FUNC(scic) \
+ ({ \
+ u32 __ret; \
+ __ret = (scic & _REGBIT_OPREGION_SCIC_FUNC_MASK) >> \
+ _REGBIT_OPREGION_SCIC_FUNC_SHIFT; \
+ __ret; \
+ })
+
+#define GVT_OPREGION_SUBFUNC(scic) \
+ ({ \
+ u32 __ret; \
+ __ret = (scic & _REGBIT_OPREGION_SCIC_SUBFUNC_MASK) >> \
+ _REGBIT_OPREGION_SCIC_SUBFUNC_SHIFT; \
+ __ret; \
+ })
+
+static const char *opregion_func_name(u32 func)
+{
+ const char *name = NULL;
+
+ switch (func) {
+ case 0 ... 3:
+ case 5:
+ case 7 ... 15:
+ name = "Reserved";
+ break;
+
+ case 4:
+ name = "Get BIOS Data";
+ break;
+
+ case 6:
+ name = "System BIOS Callbacks";
+ break;
+
+ default:
+ name = "Unknown";
+ break;
+ }
+ return name;
+}
+
+static const char *opregion_subfunc_name(u32 subfunc)
+{
+ const char *name = NULL;
+ switch (subfunc) {
+ case 0:
+ name = "Supported Calls";
+ break;
+
+ case 1:
+ name = "Requested Callbacks";
+ break;
+
+ case 2 ... 3:
+ case 8 ... 9:
+ name = "Reserved";
+ break;
+
+ case 5:
+ name = "Boot Display";
+ break;
+
+ case 6:
+ name = "TV-Standard/Video-Connector";
+ break;
+
+ case 7:
+ name = "Internal Graphics";
+ break;
+
+ case 10:
+ name = "Spread Spectrum Clocks";
+ break;
+
+ case 11:
+ name = "Get AKSV";
+ break;
+
+ default:
+ name = "Unknown";
+ break;
+ }
+ return name;
+};
+
+/* Only allowing capability queries */
+static bool opregion_is_capability_get(u32 scic)
+{
+ u32 func, subfunc;
+
+ func = GVT_OPREGION_FUNC(scic);
+ subfunc = GVT_OPREGION_SUBFUNC(scic);
+
+ if ((func == GVT_OPREGION_SCIC_F_GETBIOSDATA &&
+ subfunc == GVT_OPREGION_SCIC_SF_SUPPRTEDCALLS) ||
+ (func == GVT_OPREGION_SCIC_F_GETBIOSDATA &&
+ subfunc == GVT_OPREGION_SCIC_SF_REQEUSTEDCALLBACKS) ||
+ (func == GVT_OPREGION_SCIC_F_GETBIOSCALLBACKS &&
+ subfunc == GVT_OPREGION_SCIC_SF_SUPPRTEDCALLS)) {
+ return true;
+ }
+
+ return false;
+}
+
+/*
+ * emulate multiple capability query requests
+ */
+void gvt_emulate_opregion_request(struct vgt_device *vgt, u32 swsci)
+{
+ struct gvt_virtual_opregion_state *opregion = &vgt->state.opregion;
+ u32 *scic, *parm;
+ u32 func, subfunc;
+ scic = opregion->va + GVT_OPREGION_REG_SCIC;
+ parm = opregion->va + GVT_OPREGION_REG_PARM;
+
+ if (!(swsci & _REGBIT_CFG_SWSCI_SCI_SELECT)) {
+ gvt_err("[vgt %d] requesting SMI service\n", vgt->id);
+ return;
+ }
+ /* ignore non 0->1 trasitions */
+ if ((vgt->state.cfg.space[GVT_REG_CFG_SWSCI_TRIGGER] &
+ _REGBIT_CFG_SWSCI_SCI_TRIGGER) ||
+ !(swsci & _REGBIT_CFG_SWSCI_SCI_TRIGGER)) {
+ return;
+ }
+
+ func = GVT_OPREGION_FUNC(*scic);
+ subfunc = GVT_OPREGION_SUBFUNC(*scic);
+ if (!opregion_is_capability_get(*scic)) {
+ gvt_err("[vgt %d] requesting runtime service: func \"%s\", subfunc \"%s\"\n",
+ vgt->id,
+ opregion_func_name(func),
+ opregion_subfunc_name(subfunc));
+ /*
+ * emulate exit status of function call, '0' means
+ * "failure, generic, unsupported or unkown cause"
+ */
+ *scic &= ~_REGBIT_OPREGION_SCIC_EXIT_MASK;
+ return;
+ }
+
+ *scic = 0;
+ *parm = 0;
+}
diff --git a/drivers/gpu/drm/i915/gvt/opregion.h b/drivers/gpu/drm/i915/gvt/opregion.h
new file mode 100644
index 0000000..02d80c3
--- /dev/null
+++ b/drivers/gpu/drm/i915/gvt/opregion.h
@@ -0,0 +1,34 @@
+/*
+ * Copyright(c) 2011-2016 Intel Corporation. All rights reserved.
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a
+ * copy of this software and associated documentation files (the "Software"),
+ * to deal in the Software without restriction, including without limitation
+ * the rights to use, copy, modify, merge, publish, distribute, sublicense,
+ * and/or sell copies of the Software, and to permit persons to whom the
+ * Software is furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice (including the next
+ * paragraph) shall be included in all copies or substantial portions of the
+ * Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
+ * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
+ * SOFTWARE.
+ */
+
+#ifndef __GVT_OPREGION_H__
+#define __GVT_OPREGION_H__
+
+void gvt_clean_instance_opregion(struct vgt_device *vgt);
+bool gvt_init_instance_opregion(struct vgt_device *vgt, u64 gpa);
+void gvt_clean_opregion(struct pgt_device *pdev);
+bool gvt_init_opregion(struct pgt_device *pdev);
+
+void gvt_emulate_opregion_request(struct vgt_device *vgt, u32 swsci);
+
+#endif
--
1.9.1
_______________________________________________
Intel-gfx mailing list
Intel-gfx@xxxxxxxxxxxxxxxxxxxxx
http://lists.freedesktop.org/mailman/listinfo/intel-gfx
