[RFC 19/29] drm/i915: gvt: vGPU OpRegion emulation

[Zhi Wang <zhi.a.wang@intel.com>]

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@intel.com>
---
 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@lists.freedesktop.org
http://lists.freedesktop.org/mailman/listinfo/intel-gfx