[mirror_ubuntu-bionic-kernel.git] / drivers / gpu / drm / i915 / gvt / display.c

/*
 * 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.
 *
 * Authors:
 *    Ke Yu
 *    Zhiyuan Lv <zhiyuan.lv@intel.com>
 *
 * Contributors:
 *    Terrence Xu <terrence.xu@intel.com>
 *    Changbin Du <changbin.du@intel.com>
 *    Bing Niu <bing.niu@intel.com>
 *    Zhi Wang <zhi.a.wang@intel.com>
 *
 */

#include "i915_drv.h"
#include "gvt.h"

static int get_edp_pipe(struct intel_vgpu *vgpu)
{
	u32 data = vgpu_vreg(vgpu, _TRANS_DDI_FUNC_CTL_EDP);
	int pipe = -1;

	switch (data & TRANS_DDI_EDP_INPUT_MASK) {
	case TRANS_DDI_EDP_INPUT_A_ON:
	case TRANS_DDI_EDP_INPUT_A_ONOFF:
		pipe = PIPE_A;
		break;
	case TRANS_DDI_EDP_INPUT_B_ONOFF:
		pipe = PIPE_B;
		break;
	case TRANS_DDI_EDP_INPUT_C_ONOFF:
		pipe = PIPE_C;
		break;
	}
	return pipe;
}

static int edp_pipe_is_enabled(struct intel_vgpu *vgpu)
{
	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;

	if (!(vgpu_vreg(vgpu, PIPECONF(_PIPE_EDP)) & PIPECONF_ENABLE))
		return 0;

	if (!(vgpu_vreg(vgpu, _TRANS_DDI_FUNC_CTL_EDP) & TRANS_DDI_FUNC_ENABLE))
		return 0;
	return 1;
}

static int pipe_is_enabled(struct intel_vgpu *vgpu, int pipe)
{
	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;

	if (WARN_ON(pipe < PIPE_A || pipe >= I915_MAX_PIPES))
		return -EINVAL;

	if (vgpu_vreg(vgpu, PIPECONF(pipe)) & PIPECONF_ENABLE)
		return 1;

	if (edp_pipe_is_enabled(vgpu) &&
			get_edp_pipe(vgpu) == pipe)
		return 1;
	return 0;
}

static unsigned char virtual_dp_monitor_edid[GVT_EDID_NUM][EDID_SIZE] = {
	{
/* EDID with 1024x768 as its resolution */
		/*Header*/
		0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00,
		/* Vendor & Product Identification */
		0x22, 0xf0, 0x54, 0x29, 0x00, 0x00, 0x00, 0x00, 0x04, 0x17,
		/* Version & Revision */
		0x01, 0x04,
		/* Basic Display Parameters & Features */
		0xa5, 0x34, 0x20, 0x78, 0x23,
		/* Color Characteristics */
		0xfc, 0x81, 0xa4, 0x55, 0x4d, 0x9d, 0x25, 0x12, 0x50, 0x54,
		/* Established Timings: maximum resolution is 1024x768 */
		0x21, 0x08, 0x00,
		/* Standard Timings. All invalid */
		0x00, 0xc0, 0x00, 0xc0, 0x00, 0x40, 0x00, 0x80, 0x00, 0x00,
		0x00, 0x40, 0x00, 0x00, 0x00, 0x01,
		/* 18 Byte Data Blocks 1: invalid */
		0x00, 0x00, 0x80, 0xa0, 0x70, 0xb0,
		0x23, 0x40, 0x30, 0x20, 0x36, 0x00, 0x06, 0x44, 0x21, 0x00, 0x00, 0x1a,
		/* 18 Byte Data Blocks 2: invalid */
		0x00, 0x00, 0x00, 0xfd, 0x00, 0x18, 0x3c, 0x18, 0x50, 0x11, 0x00, 0x0a,
		0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
		/* 18 Byte Data Blocks 3: invalid */
		0x00, 0x00, 0x00, 0xfc, 0x00, 0x48,
		0x50, 0x20, 0x5a, 0x52, 0x32, 0x34, 0x34, 0x30, 0x77, 0x0a, 0x20, 0x20,
		/* 18 Byte Data Blocks 4: invalid */
		0x00, 0x00, 0x00, 0xff, 0x00, 0x43, 0x4e, 0x34, 0x33, 0x30, 0x34, 0x30,
		0x44, 0x58, 0x51, 0x0a, 0x20, 0x20,
		/* Extension Block Count */
		0x00,
		/* Checksum */
		0xef,
	},
	{
/* EDID with 1920x1200 as its resolution */
		/*Header*/
		0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00,
		/* Vendor & Product Identification */
		0x22, 0xf0, 0x54, 0x29, 0x00, 0x00, 0x00, 0x00, 0x04, 0x17,
		/* Version & Revision */
		0x01, 0x04,
		/* Basic Display Parameters & Features */
		0xa5, 0x34, 0x20, 0x78, 0x23,
		/* Color Characteristics */
		0xfc, 0x81, 0xa4, 0x55, 0x4d, 0x9d, 0x25, 0x12, 0x50, 0x54,
		/* Established Timings: maximum resolution is 1024x768 */
		0x21, 0x08, 0x00,
		/*
		 * Standard Timings.
		 * below new resolutions can be supported:
		 * 1920x1080, 1280x720, 1280x960, 1280x1024,
		 * 1440x900, 1600x1200, 1680x1050
		 */
		0xd1, 0xc0, 0x81, 0xc0, 0x81, 0x40, 0x81, 0x80, 0x95, 0x00,
		0xa9, 0x40, 0xb3, 0x00, 0x01, 0x01,
		/* 18 Byte Data Blocks 1: max resolution is 1920x1200 */
		0x28, 0x3c, 0x80, 0xa0, 0x70, 0xb0,
		0x23, 0x40, 0x30, 0x20, 0x36, 0x00, 0x06, 0x44, 0x21, 0x00, 0x00, 0x1a,
		/* 18 Byte Data Blocks 2: invalid */
		0x00, 0x00, 0x00, 0xfd, 0x00, 0x18, 0x3c, 0x18, 0x50, 0x11, 0x00, 0x0a,
		0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
		/* 18 Byte Data Blocks 3: invalid */
		0x00, 0x00, 0x00, 0xfc, 0x00, 0x48,
		0x50, 0x20, 0x5a, 0x52, 0x32, 0x34, 0x34, 0x30, 0x77, 0x0a, 0x20, 0x20,
		/* 18 Byte Data Blocks 4: invalid */
		0x00, 0x00, 0x00, 0xff, 0x00, 0x43, 0x4e, 0x34, 0x33, 0x30, 0x34, 0x30,
		0x44, 0x58, 0x51, 0x0a, 0x20, 0x20,
		/* Extension Block Count */
		0x00,
		/* Checksum */
		0x45,
	},
};

#define DPCD_HEADER_SIZE        0xb

/* let the virtual display supports DP1.2 */
static u8 dpcd_fix_data[DPCD_HEADER_SIZE] = {
	0x12, 0x014, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
};

static void emulate_monitor_status_change(struct intel_vgpu *vgpu)
{
	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;
	vgpu_vreg(vgpu, SDEISR) &= ~(SDE_PORTB_HOTPLUG_CPT |
			SDE_PORTC_HOTPLUG_CPT |
			SDE_PORTD_HOTPLUG_CPT);

	if (IS_SKYLAKE(dev_priv) || IS_KABYLAKE(dev_priv)) {
		vgpu_vreg(vgpu, SDEISR) &= ~(SDE_PORTA_HOTPLUG_SPT |
				SDE_PORTE_HOTPLUG_SPT);
		vgpu_vreg(vgpu, SKL_FUSE_STATUS) |=
				SKL_FUSE_DOWNLOAD_STATUS |
				SKL_FUSE_PG_DIST_STATUS(SKL_PG0) |
				SKL_FUSE_PG_DIST_STATUS(SKL_PG1) |
				SKL_FUSE_PG_DIST_STATUS(SKL_PG2);
		vgpu_vreg(vgpu, LCPLL1_CTL) |=
				LCPLL_PLL_ENABLE |
				LCPLL_PLL_LOCK;
		vgpu_vreg(vgpu, LCPLL2_CTL) |= LCPLL_PLL_ENABLE;

	}

	if (intel_vgpu_has_monitor_on_port(vgpu, PORT_B)) {
		vgpu_vreg(vgpu, SFUSE_STRAP) |= SFUSE_STRAP_DDIB_DETECTED;
		vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) &=
			~(TRANS_DDI_BPC_MASK | TRANS_DDI_MODE_SELECT_MASK |
			TRANS_DDI_PORT_MASK);
		vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) |=
			(TRANS_DDI_BPC_8 | TRANS_DDI_MODE_SELECT_DP_SST |
			(PORT_B << TRANS_DDI_PORT_SHIFT) |
			TRANS_DDI_FUNC_ENABLE);
		if (IS_BROADWELL(dev_priv)) {
			vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_B)) &=
				~PORT_CLK_SEL_MASK;
			vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_B)) |=
				PORT_CLK_SEL_LCPLL_810;
		}
		vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_B)) |= DDI_BUF_CTL_ENABLE;
		vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_B)) &= ~DDI_BUF_IS_IDLE;
		vgpu_vreg(vgpu, SDEISR) |= SDE_PORTB_HOTPLUG_CPT;
	}

	if (intel_vgpu_has_monitor_on_port(vgpu, PORT_C)) {
		vgpu_vreg(vgpu, SDEISR) |= SDE_PORTC_HOTPLUG_CPT;
		vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) &=
			~(TRANS_DDI_BPC_MASK | TRANS_DDI_MODE_SELECT_MASK |
			TRANS_DDI_PORT_MASK);
		vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) |=
			(TRANS_DDI_BPC_8 | TRANS_DDI_MODE_SELECT_DP_SST |
			(PORT_C << TRANS_DDI_PORT_SHIFT) |
			TRANS_DDI_FUNC_ENABLE);
		if (IS_BROADWELL(dev_priv)) {
			vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_C)) &=
				~PORT_CLK_SEL_MASK;
			vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_C)) |=
				PORT_CLK_SEL_LCPLL_810;
		}
		vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_C)) |= DDI_BUF_CTL_ENABLE;
		vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_C)) &= ~DDI_BUF_IS_IDLE;
		vgpu_vreg(vgpu, SFUSE_STRAP) |= SFUSE_STRAP_DDIC_DETECTED;
	}

	if (intel_vgpu_has_monitor_on_port(vgpu, PORT_D)) {
		vgpu_vreg(vgpu, SDEISR) |= SDE_PORTD_HOTPLUG_CPT;
		vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) &=
			~(TRANS_DDI_BPC_MASK | TRANS_DDI_MODE_SELECT_MASK |
			TRANS_DDI_PORT_MASK);
		vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) |=
			(TRANS_DDI_BPC_8 | TRANS_DDI_MODE_SELECT_DP_SST |
			(PORT_D << TRANS_DDI_PORT_SHIFT) |
			TRANS_DDI_FUNC_ENABLE);
		if (IS_BROADWELL(dev_priv)) {
			vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_D)) &=
				~PORT_CLK_SEL_MASK;
			vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_D)) |=
				PORT_CLK_SEL_LCPLL_810;
		}
		vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_D)) |= DDI_BUF_CTL_ENABLE;
		vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_D)) &= ~DDI_BUF_IS_IDLE;
		vgpu_vreg(vgpu, SFUSE_STRAP) |= SFUSE_STRAP_DDID_DETECTED;
	}

	if ((IS_SKYLAKE(dev_priv) || IS_KABYLAKE(dev_priv)) &&
			intel_vgpu_has_monitor_on_port(vgpu, PORT_E)) {
		vgpu_vreg(vgpu, SDEISR) |= SDE_PORTE_HOTPLUG_SPT;
	}

	if (intel_vgpu_has_monitor_on_port(vgpu, PORT_A)) {
		if (IS_BROADWELL(dev_priv))
			vgpu_vreg(vgpu, GEN8_DE_PORT_ISR) |=
				GEN8_PORT_DP_A_HOTPLUG;
		else
			vgpu_vreg(vgpu, SDEISR) |= SDE_PORTA_HOTPLUG_SPT;

		vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_A)) |= DDI_INIT_DISPLAY_DETECTED;
	}

	/* Clear host CRT status, so guest couldn't detect this host CRT. */
	if (IS_BROADWELL(dev_priv))
		vgpu_vreg(vgpu, PCH_ADPA) &= ~ADPA_CRT_HOTPLUG_MONITOR_MASK;

	vgpu_vreg(vgpu, PIPECONF(PIPE_A)) |= PIPECONF_ENABLE;
}

static void clean_virtual_dp_monitor(struct intel_vgpu *vgpu, int port_num)
{
	struct intel_vgpu_port *port = intel_vgpu_port(vgpu, port_num);

	kfree(port->edid);
	port->edid = NULL;

	kfree(port->dpcd);
	port->dpcd = NULL;
}

static int setup_virtual_dp_monitor(struct intel_vgpu *vgpu, int port_num,
				    int type, unsigned int resolution)
{
	struct intel_vgpu_port *port = intel_vgpu_port(vgpu, port_num);

	if (WARN_ON(resolution >= GVT_EDID_NUM))
		return -EINVAL;

	port->edid = kzalloc(sizeof(*(port->edid)), GFP_KERNEL);
	if (!port->edid)
		return -ENOMEM;

	port->dpcd = kzalloc(sizeof(*(port->dpcd)), GFP_KERNEL);
	if (!port->dpcd) {
		kfree(port->edid);
		return -ENOMEM;
	}

	memcpy(port->edid->edid_block, virtual_dp_monitor_edid[resolution],
			EDID_SIZE);
	port->edid->data_valid = true;

	memcpy(port->dpcd->data, dpcd_fix_data, DPCD_HEADER_SIZE);
	port->dpcd->data_valid = true;
	port->dpcd->data[DPCD_SINK_COUNT] = 0x1;
	port->type = type;

	emulate_monitor_status_change(vgpu);

	return 0;
}

/**
 * intel_gvt_check_vblank_emulation - check if vblank emulation timer should
 * be turned on/off when a virtual pipe is enabled/disabled.
 * @gvt: a GVT device
 *
 * This function is used to turn on/off vblank timer according to currently
 * enabled/disabled virtual pipes.
 *
 */
void intel_gvt_check_vblank_emulation(struct intel_gvt *gvt)
{
	struct intel_gvt_irq *irq = &gvt->irq;
	struct intel_vgpu *vgpu;
	int pipe, id;

	if (WARN_ON(!mutex_is_locked(&gvt->lock)))
		return;

	for_each_active_vgpu(gvt, vgpu, id) {
		for (pipe = 0; pipe < I915_MAX_PIPES; pipe++) {
			if (pipe_is_enabled(vgpu, pipe))
				goto out;
		}
	}

	/* all the pipes are disabled */
	hrtimer_cancel(&irq->vblank_timer.timer);
	return;

out:
	hrtimer_start(&irq->vblank_timer.timer,
		ktime_add_ns(ktime_get(), irq->vblank_timer.period),
		HRTIMER_MODE_ABS);

}

static void emulate_vblank_on_pipe(struct intel_vgpu *vgpu, int pipe)
{
	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;
	struct intel_vgpu_irq *irq = &vgpu->irq;
	int vblank_event[] = {
		[PIPE_A] = PIPE_A_VBLANK,
		[PIPE_B] = PIPE_B_VBLANK,
		[PIPE_C] = PIPE_C_VBLANK,
	};
	int event;

	if (pipe < PIPE_A || pipe > PIPE_C)
		return;

	for_each_set_bit(event, irq->flip_done_event[pipe],
			INTEL_GVT_EVENT_MAX) {
		clear_bit(event, irq->flip_done_event[pipe]);
		if (!pipe_is_enabled(vgpu, pipe))
			continue;

		vgpu_vreg(vgpu, PIPE_FLIPCOUNT_G4X(pipe))++;
		intel_vgpu_trigger_virtual_event(vgpu, event);
	}

	if (pipe_is_enabled(vgpu, pipe)) {
		vgpu_vreg(vgpu, PIPE_FRMCOUNT_G4X(pipe))++;
		intel_vgpu_trigger_virtual_event(vgpu, vblank_event[pipe]);
	}
}

static void emulate_vblank(struct intel_vgpu *vgpu)
{
	int pipe;

	for_each_pipe(vgpu->gvt->dev_priv, pipe)
		emulate_vblank_on_pipe(vgpu, pipe);
}

/**
 * intel_gvt_emulate_vblank - trigger vblank events for vGPUs on GVT device
 * @gvt: a GVT device
 *
 * This function is used to trigger vblank interrupts for vGPUs on GVT device
 *
 */
void intel_gvt_emulate_vblank(struct intel_gvt *gvt)
{
	struct intel_vgpu *vgpu;
	int id;

	if (WARN_ON(!mutex_is_locked(&gvt->lock)))
		return;

	for_each_active_vgpu(gvt, vgpu, id)
		emulate_vblank(vgpu);
}

/**
 * intel_vgpu_clean_display - clean vGPU virtual display emulation
 * @vgpu: a vGPU
 *
 * This function is used to clean vGPU virtual display emulation stuffs
 *
 */
void intel_vgpu_clean_display(struct intel_vgpu *vgpu)
{
	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;

	if (IS_SKYLAKE(dev_priv) || IS_KABYLAKE(dev_priv))
		clean_virtual_dp_monitor(vgpu, PORT_D);
	else
		clean_virtual_dp_monitor(vgpu, PORT_B);
}

/**
 * intel_vgpu_init_display- initialize vGPU virtual display emulation
 * @vgpu: a vGPU
 *
 * This function is used to initialize vGPU virtual display emulation stuffs
 *
 * Returns:
 * Zero on success, negative error code if failed.
 *
 */
int intel_vgpu_init_display(struct intel_vgpu *vgpu, u64 resolution)
{
	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;

	intel_vgpu_init_i2c_edid(vgpu);

	if (IS_SKYLAKE(dev_priv) || IS_KABYLAKE(dev_priv))
		return setup_virtual_dp_monitor(vgpu, PORT_D, GVT_DP_D,
						resolution);
	else
		return setup_virtual_dp_monitor(vgpu, PORT_B, GVT_DP_B,
						resolution);
}

/**
 * intel_vgpu_reset_display- reset vGPU virtual display emulation
 * @vgpu: a vGPU
 *
 * This function is used to reset vGPU virtual display emulation stuffs
 *
 */
void intel_vgpu_reset_display(struct intel_vgpu *vgpu)
{
	emulate_monitor_status_change(vgpu);
}
Commit	Line	Data
04d348ae ZW	1	/*
	2	* Copyright(c) 2011-2016 Intel Corporation. All rights reserved.
	3	*
	4	* Permission is hereby granted, free of charge, to any person obtaining a
	5	* copy of this software and associated documentation files (the "Software"),
	6	* to deal in the Software without restriction, including without limitation
	7	* the rights to use, copy, modify, merge, publish, distribute, sublicense,
	8	* and/or sell copies of the Software, and to permit persons to whom the
	9	* Software is furnished to do so, subject to the following conditions:
	10	*
	11	* The above copyright notice and this permission notice (including the next
	12	* paragraph) shall be included in all copies or substantial portions of the
	13	* Software.
	14	*
	15	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	16	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	17	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	18	* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
	19	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
	20	* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
	21	* SOFTWARE.
	22	*
	23	* Authors:
	24	* Ke Yu
	25	* Zhiyuan Lv <zhiyuan.lv@intel.com>
	26	*
	27	* Contributors:
	28	* Terrence Xu <terrence.xu@intel.com>
	29	* Changbin Du <changbin.du@intel.com>
	30	* Bing Niu <bing.niu@intel.com>
	31	* Zhi Wang <zhi.a.wang@intel.com>
	32	*
	33	*/
	34
	35	#include "i915_drv.h"
feddf6e8	36	#include "gvt.h"
04d348ae ZW	37
	38	static int get_edp_pipe(struct intel_vgpu *vgpu)
	39	{
	40	u32 data = vgpu_vreg(vgpu, _TRANS_DDI_FUNC_CTL_EDP);
	41	int pipe = -1;
	42
	43	switch (data & TRANS_DDI_EDP_INPUT_MASK) {
	44	case TRANS_DDI_EDP_INPUT_A_ON:
	45	case TRANS_DDI_EDP_INPUT_A_ONOFF:
	46	pipe = PIPE_A;
	47	break;
	48	case TRANS_DDI_EDP_INPUT_B_ONOFF:
	49	pipe = PIPE_B;
	50	break;
	51	case TRANS_DDI_EDP_INPUT_C_ONOFF:
	52	pipe = PIPE_C;
	53	break;
	54	}
	55	return pipe;
	56	}
	57
	58	static int edp_pipe_is_enabled(struct intel_vgpu *vgpu)
	59	{
	60	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;
	61
	62	if (!(vgpu_vreg(vgpu, PIPECONF(_PIPE_EDP)) & PIPECONF_ENABLE))
	63	return 0;
	64
	65	if (!(vgpu_vreg(vgpu, _TRANS_DDI_FUNC_CTL_EDP) & TRANS_DDI_FUNC_ENABLE))
	66	return 0;
	67	return 1;
	68	}
	69
	70	static int pipe_is_enabled(struct intel_vgpu *vgpu, int pipe)
	71	{
	72	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;
	73
	74	if (WARN_ON(pipe < PIPE_A \|\| pipe >= I915_MAX_PIPES))
	75	return -EINVAL;
	76
	77	if (vgpu_vreg(vgpu, PIPECONF(pipe)) & PIPECONF_ENABLE)
	78	return 1;
	79
	80	if (edp_pipe_is_enabled(vgpu) &&
	81	get_edp_pipe(vgpu) == pipe)
	82	return 1;
	83	return 0;
	84	}
	85
bca5609f ZW	86	static unsigned char virtual_dp_monitor_edid[GVT_EDID_NUM][EDID_SIZE] = {
	87	{
	88	/* EDID with 1024x768 as its resolution */
	89	/Header/
	90	0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00,
	91	/* Vendor & Product Identification */
	92	0x22, 0xf0, 0x54, 0x29, 0x00, 0x00, 0x00, 0x00, 0x04, 0x17,
	93	/* Version & Revision */
	94	0x01, 0x04,
	95	/* Basic Display Parameters & Features */
	96	0xa5, 0x34, 0x20, 0x78, 0x23,
	97	/* Color Characteristics */
	98	0xfc, 0x81, 0xa4, 0x55, 0x4d, 0x9d, 0x25, 0x12, 0x50, 0x54,
	99	/* Established Timings: maximum resolution is 1024x768 */
	100	0x21, 0x08, 0x00,
	101	/* Standard Timings. All invalid */
	102	0x00, 0xc0, 0x00, 0xc0, 0x00, 0x40, 0x00, 0x80, 0x00, 0x00,
	103	0x00, 0x40, 0x00, 0x00, 0x00, 0x01,
	104	/* 18 Byte Data Blocks 1: invalid */
	105	0x00, 0x00, 0x80, 0xa0, 0x70, 0xb0,
	106	0x23, 0x40, 0x30, 0x20, 0x36, 0x00, 0x06, 0x44, 0x21, 0x00, 0x00, 0x1a,
	107	/* 18 Byte Data Blocks 2: invalid */
	108	0x00, 0x00, 0x00, 0xfd, 0x00, 0x18, 0x3c, 0x18, 0x50, 0x11, 0x00, 0x0a,
	109	0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
	110	/* 18 Byte Data Blocks 3: invalid */
	111	0x00, 0x00, 0x00, 0xfc, 0x00, 0x48,
	112	0x50, 0x20, 0x5a, 0x52, 0x32, 0x34, 0x34, 0x30, 0x77, 0x0a, 0x20, 0x20,
	113	/* 18 Byte Data Blocks 4: invalid */
	114	0x00, 0x00, 0x00, 0xff, 0x00, 0x43, 0x4e, 0x34, 0x33, 0x30, 0x34, 0x30,
	115	0x44, 0x58, 0x51, 0x0a, 0x20, 0x20,
	116	/* Extension Block Count */
	117	0x00,
	118	/* Checksum */
	119	0xef,
	120	},
	121	{
2c883136	122	/* EDID with 1920x1200 as its resolution */
bca5609f ZW	123	/Header/
	124	0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00,
	125	/* Vendor & Product Identification */
	126	0x22, 0xf0, 0x54, 0x29, 0x00, 0x00, 0x00, 0x00, 0x04, 0x17,
	127	/* Version & Revision */
	128	0x01, 0x04,
	129	/* Basic Display Parameters & Features */
	130	0xa5, 0x34, 0x20, 0x78, 0x23,
	131	/* Color Characteristics */
	132	0xfc, 0x81, 0xa4, 0x55, 0x4d, 0x9d, 0x25, 0x12, 0x50, 0x54,
	133	/* Established Timings: maximum resolution is 1024x768 */
	134	0x21, 0x08, 0x00,
	135	/*
	136	* Standard Timings.
	137	* below new resolutions can be supported:
	138	* 1920x1080, 1280x720, 1280x960, 1280x1024,
	139	* 1440x900, 1600x1200, 1680x1050
	140	*/
	141	0xd1, 0xc0, 0x81, 0xc0, 0x81, 0x40, 0x81, 0x80, 0x95, 0x00,
	142	0xa9, 0x40, 0xb3, 0x00, 0x01, 0x01,
	143	/* 18 Byte Data Blocks 1: max resolution is 1920x1200 */
	144	0x28, 0x3c, 0x80, 0xa0, 0x70, 0xb0,
	145	0x23, 0x40, 0x30, 0x20, 0x36, 0x00, 0x06, 0x44, 0x21, 0x00, 0x00, 0x1a,
	146	/* 18 Byte Data Blocks 2: invalid */
	147	0x00, 0x00, 0x00, 0xfd, 0x00, 0x18, 0x3c, 0x18, 0x50, 0x11, 0x00, 0x0a,
	148	0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
	149	/* 18 Byte Data Blocks 3: invalid */
	150	0x00, 0x00, 0x00, 0xfc, 0x00, 0x48,
	151	0x50, 0x20, 0x5a, 0x52, 0x32, 0x34, 0x34, 0x30, 0x77, 0x0a, 0x20, 0x20,
	152	/* 18 Byte Data Blocks 4: invalid */
	153	0x00, 0x00, 0x00, 0xff, 0x00, 0x43, 0x4e, 0x34, 0x33, 0x30, 0x34, 0x30,
	154	0x44, 0x58, 0x51, 0x0a, 0x20, 0x20,
	155	/* Extension Block Count */
	156	0x00,
	157	/* Checksum */
	158	0x45,
	159	},
04d348ae ZW	160	};
	161
	162	#define DPCD_HEADER_SIZE 0xb
	163
e2e02cbb	164	/* let the virtual display supports DP1.2 */
999ccb40	165	static u8 dpcd_fix_data[DPCD_HEADER_SIZE] = {
e2e02cbb	166	0x12, 0x014, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
04d348ae ZW	167	};
	168
	169	static void emulate_monitor_status_change(struct intel_vgpu *vgpu)
	170	{
	171	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;
	172	vgpu_vreg(vgpu, SDEISR) &= ~(SDE_PORTB_HOTPLUG_CPT \|
	173	SDE_PORTC_HOTPLUG_CPT \|
	174	SDE_PORTD_HOTPLUG_CPT);
	175
e3476c00	176	if (IS_SKYLAKE(dev_priv) \|\| IS_KABYLAKE(dev_priv)) {
04d348ae ZW	177	vgpu_vreg(vgpu, SDEISR) &= ~(SDE_PORTA_HOTPLUG_SPT \|
04d348ae ZW	178	SDE_PORTE_HOTPLUG_SPT);
88a16b64 WL	179	vgpu_vreg(vgpu, SKL_FUSE_STATUS) \|=
88a16b64 WL	180	SKL_FUSE_DOWNLOAD_STATUS \|
b2891eb2 ID	181	SKL_FUSE_PG_DIST_STATUS(SKL_PG0) \|
	182	SKL_FUSE_PG_DIST_STATUS(SKL_PG1) \|
	183	SKL_FUSE_PG_DIST_STATUS(SKL_PG2);
88a16b64 WL	184	vgpu_vreg(vgpu, LCPLL1_CTL) \|=
	185	LCPLL_PLL_ENABLE \|
	186	LCPLL_PLL_LOCK;
	187	vgpu_vreg(vgpu, LCPLL2_CTL) \|= LCPLL_PLL_ENABLE;
	188
	189	}
04d348ae	190
858b0f57	191	if (intel_vgpu_has_monitor_on_port(vgpu, PORT_B)) {
858b0f57	192	vgpu_vreg(vgpu, SFUSE_STRAP) \|= SFUSE_STRAP_DDIB_DETECTED;
efa69d73 PZ	193	vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) &=
	194	~(TRANS_DDI_BPC_MASK \| TRANS_DDI_MODE_SELECT_MASK \|
	195	TRANS_DDI_PORT_MASK);
	196	vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) \|=
	197	(TRANS_DDI_BPC_8 \| TRANS_DDI_MODE_SELECT_DP_SST \|
	198	(PORT_B << TRANS_DDI_PORT_SHIFT) \|
	199	TRANS_DDI_FUNC_ENABLE);
295a0d0b XZ	200	if (IS_BROADWELL(dev_priv)) {
	201	vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_B)) &=
	202	~PORT_CLK_SEL_MASK;
	203	vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_B)) \|=
	204	PORT_CLK_SEL_LCPLL_810;
	205	}
efa69d73 PZ	206	vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_B)) \|= DDI_BUF_CTL_ENABLE;
	207	vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_B)) &= ~DDI_BUF_IS_IDLE;
	208	vgpu_vreg(vgpu, SDEISR) \|= SDE_PORTB_HOTPLUG_CPT;
858b0f57	209	}
04d348ae	210
858b0f57	211	if (intel_vgpu_has_monitor_on_port(vgpu, PORT_C)) {
04d348ae	212	vgpu_vreg(vgpu, SDEISR) \|= SDE_PORTC_HOTPLUG_CPT;
efa69d73 PZ	213	vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) &=
	214	~(TRANS_DDI_BPC_MASK \| TRANS_DDI_MODE_SELECT_MASK \|
	215	TRANS_DDI_PORT_MASK);
	216	vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) \|=
	217	(TRANS_DDI_BPC_8 \| TRANS_DDI_MODE_SELECT_DP_SST \|
	218	(PORT_C << TRANS_DDI_PORT_SHIFT) \|
	219	TRANS_DDI_FUNC_ENABLE);
295a0d0b XZ	220	if (IS_BROADWELL(dev_priv)) {
	221	vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_C)) &=
	222	~PORT_CLK_SEL_MASK;
	223	vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_C)) \|=
	224	PORT_CLK_SEL_LCPLL_810;
	225	}
efa69d73 PZ	226	vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_C)) \|= DDI_BUF_CTL_ENABLE;
efa69d73 PZ	227	vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_C)) &= ~DDI_BUF_IS_IDLE;
858b0f57 BN	228	vgpu_vreg(vgpu, SFUSE_STRAP) \|= SFUSE_STRAP_DDIC_DETECTED;
858b0f57 BN	229	}
04d348ae	230
858b0f57	231	if (intel_vgpu_has_monitor_on_port(vgpu, PORT_D)) {
04d348ae	232	vgpu_vreg(vgpu, SDEISR) \|= SDE_PORTD_HOTPLUG_CPT;
efa69d73 PZ	233	vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) &=
	234	~(TRANS_DDI_BPC_MASK \| TRANS_DDI_MODE_SELECT_MASK \|
	235	TRANS_DDI_PORT_MASK);
	236	vgpu_vreg(vgpu, TRANS_DDI_FUNC_CTL(TRANSCODER_A)) \|=
	237	(TRANS_DDI_BPC_8 \| TRANS_DDI_MODE_SELECT_DP_SST \|
	238	(PORT_D << TRANS_DDI_PORT_SHIFT) \|
	239	TRANS_DDI_FUNC_ENABLE);
295a0d0b XZ	240	if (IS_BROADWELL(dev_priv)) {
	241	vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_D)) &=
	242	~PORT_CLK_SEL_MASK;
	243	vgpu_vreg(vgpu, PORT_CLK_SEL(PORT_D)) \|=
	244	PORT_CLK_SEL_LCPLL_810;
	245	}
efa69d73 PZ	246	vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_D)) \|= DDI_BUF_CTL_ENABLE;
efa69d73 PZ	247	vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_D)) &= ~DDI_BUF_IS_IDLE;
858b0f57 BN	248	vgpu_vreg(vgpu, SFUSE_STRAP) \|= SFUSE_STRAP_DDID_DETECTED;
858b0f57 BN	249	}
04d348ae	250
e3476c00	251	if ((IS_SKYLAKE(dev_priv) \|\| IS_KABYLAKE(dev_priv)) &&
04d348ae ZW	252	intel_vgpu_has_monitor_on_port(vgpu, PORT_E)) {
	253	vgpu_vreg(vgpu, SDEISR) \|= SDE_PORTE_HOTPLUG_SPT;
	254	}
	255
	256	if (intel_vgpu_has_monitor_on_port(vgpu, PORT_A)) {
	257	if (IS_BROADWELL(dev_priv))
	258	vgpu_vreg(vgpu, GEN8_DE_PORT_ISR) \|=
	259	GEN8_PORT_DP_A_HOTPLUG;
	260	else
	261	vgpu_vreg(vgpu, SDEISR) \|= SDE_PORTA_HOTPLUG_SPT;
858b0f57 BN	262
858b0f57 BN	263	vgpu_vreg(vgpu, DDI_BUF_CTL(PORT_A)) \|= DDI_INIT_DISPLAY_DETECTED;
04d348ae	264	}
75e64ff2 XZ	265
	266	/* Clear host CRT status, so guest couldn't detect this host CRT. */
	267	if (IS_BROADWELL(dev_priv))
	268	vgpu_vreg(vgpu, PCH_ADPA) &= ~ADPA_CRT_HOTPLUG_MONITOR_MASK;
f5f00e7d XZ	269
f5f00e7d XZ	270	vgpu_vreg(vgpu, PIPECONF(PIPE_A)) \|= PIPECONF_ENABLE;
04d348ae ZW	271	}
	272
	273	static void clean_virtual_dp_monitor(struct intel_vgpu *vgpu, int port_num)
	274	{
	275	struct intel_vgpu_port *port = intel_vgpu_port(vgpu, port_num);
	276
	277	kfree(port->edid);
	278	port->edid = NULL;
	279
	280	kfree(port->dpcd);
	281	port->dpcd = NULL;
	282	}
	283
	284	static int setup_virtual_dp_monitor(struct intel_vgpu *vgpu, int port_num,
d1a513be	285	int type, unsigned int resolution)
04d348ae ZW	286	{
	287	struct intel_vgpu_port *port = intel_vgpu_port(vgpu, port_num);
	288
d1a513be ZW	289	if (WARN_ON(resolution >= GVT_EDID_NUM))
	290	return -EINVAL;
	291
04d348ae ZW	292	port->edid = kzalloc(sizeof(*(port->edid)), GFP_KERNEL);
	293	if (!port->edid)
	294	return -ENOMEM;
	295
	296	port->dpcd = kzalloc(sizeof(*(port->dpcd)), GFP_KERNEL);
	297	if (!port->dpcd) {
	298	kfree(port->edid);
	299	return -ENOMEM;
	300	}
	301
d1a513be	302	memcpy(port->edid->edid_block, virtual_dp_monitor_edid[resolution],
04d348ae ZW	303	EDID_SIZE);
	304	port->edid->data_valid = true;
	305
	306	memcpy(port->dpcd->data, dpcd_fix_data, DPCD_HEADER_SIZE);
	307	port->dpcd->data_valid = true;
	308	port->dpcd->data[DPCD_SINK_COUNT] = 0x1;
	309	port->type = type;
	310
	311	emulate_monitor_status_change(vgpu);
f5f00e7d	312
04d348ae ZW	313	return 0;
	314	}
	315
	316	/**
	317	* intel_gvt_check_vblank_emulation - check if vblank emulation timer should
	318	* be turned on/off when a virtual pipe is enabled/disabled.
	319	* @gvt: a GVT device
	320	*
	321	* This function is used to turn on/off vblank timer according to currently
	322	* enabled/disabled virtual pipes.
	323	*
	324	*/
	325	void intel_gvt_check_vblank_emulation(struct intel_gvt *gvt)
	326	{
	327	struct intel_gvt_irq *irq = &gvt->irq;
	328	struct intel_vgpu *vgpu;
04d348ae ZW	329	int pipe, id;
	330
	331	if (WARN_ON(!mutex_is_locked(&gvt->lock)))
	332	return;
	333
04d348ae ZW	334	for_each_active_vgpu(gvt, vgpu, id) {
04d348ae ZW	335	for (pipe = 0; pipe < I915_MAX_PIPES; pipe++) {
f43aa31f	336	if (pipe_is_enabled(vgpu, pipe))
f43aa31f	337	goto out;
04d348ae ZW	338	}
	339	}
	340
f43aa31f	341	/* all the pipes are disabled */
	342	hrtimer_cancel(&irq->vblank_timer.timer);
	343	return;
	344
	345	out:
	346	hrtimer_start(&irq->vblank_timer.timer,
	347	ktime_add_ns(ktime_get(), irq->vblank_timer.period),
	348	HRTIMER_MODE_ABS);
	349
04d348ae ZW	350	}
	351
	352	static void emulate_vblank_on_pipe(struct intel_vgpu *vgpu, int pipe)
	353	{
	354	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;
	355	struct intel_vgpu_irq *irq = &vgpu->irq;
	356	int vblank_event[] = {
	357	[PIPE_A] = PIPE_A_VBLANK,
	358	[PIPE_B] = PIPE_B_VBLANK,
	359	[PIPE_C] = PIPE_C_VBLANK,
	360	};
	361	int event;
	362
	363	if (pipe < PIPE_A \|\| pipe > PIPE_C)
	364	return;
	365
	366	for_each_set_bit(event, irq->flip_done_event[pipe],
	367	INTEL_GVT_EVENT_MAX) {
	368	clear_bit(event, irq->flip_done_event[pipe]);
	369	if (!pipe_is_enabled(vgpu, pipe))
	370	continue;
	371
	372	vgpu_vreg(vgpu, PIPE_FLIPCOUNT_G4X(pipe))++;
	373	intel_vgpu_trigger_virtual_event(vgpu, event);
	374	}
	375
	376	if (pipe_is_enabled(vgpu, pipe)) {
	377	vgpu_vreg(vgpu, PIPE_FRMCOUNT_G4X(pipe))++;
	378	intel_vgpu_trigger_virtual_event(vgpu, vblank_event[pipe]);
	379	}
	380	}
	381
	382	static void emulate_vblank(struct intel_vgpu *vgpu)
	383	{
	384	int pipe;
	385
	386	for_each_pipe(vgpu->gvt->dev_priv, pipe)
	387	emulate_vblank_on_pipe(vgpu, pipe);
	388	}
	389
	390	/**
	391	* intel_gvt_emulate_vblank - trigger vblank events for vGPUs on GVT device
	392	* @gvt: a GVT device
	393	*
	394	* This function is used to trigger vblank interrupts for vGPUs on GVT device
	395	*
	396	*/
	397	void intel_gvt_emulate_vblank(struct intel_gvt *gvt)
	398	{
	399	struct intel_vgpu *vgpu;
	400	int id;
	401
	402	if (WARN_ON(!mutex_is_locked(&gvt->lock)))
	403	return;
	404
	405	for_each_active_vgpu(gvt, vgpu, id)
	406	emulate_vblank(vgpu);
	407	}
	408
	409	/**
	410	* intel_vgpu_clean_display - clean vGPU virtual display emulation
	411	* @vgpu: a vGPU
	412	*
	413	* This function is used to clean vGPU virtual display emulation stuffs
414	*
415	*/
416	void intel_vgpu_clean_display(struct intel_vgpu *vgpu)
417	{
418	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;
419
e3476c00	420	if (IS_SKYLAKE(dev_priv) \|\| IS_KABYLAKE(dev_priv))
04d348ae ZW	421	clean_virtual_dp_monitor(vgpu, PORT_D);
	422	else
	423	clean_virtual_dp_monitor(vgpu, PORT_B);
	424	}
	425
	426	/**
	427	* intel_vgpu_init_display- initialize vGPU virtual display emulation
	428	* @vgpu: a vGPU
	429	*
	430	* This function is used to initialize vGPU virtual display emulation stuffs
	431	*
	432	* Returns:
	433	* Zero on success, negative error code if failed.
	434	*
	435	*/
d1a513be	436	int intel_vgpu_init_display(struct intel_vgpu *vgpu, u64 resolution)
04d348ae ZW	437	{
	438	struct drm_i915_private *dev_priv = vgpu->gvt->dev_priv;
	439
	440	intel_vgpu_init_i2c_edid(vgpu);
	441
e3476c00	442	if (IS_SKYLAKE(dev_priv) \|\| IS_KABYLAKE(dev_priv))
d1a513be ZW	443	return setup_virtual_dp_monitor(vgpu, PORT_D, GVT_DP_D,
d1a513be ZW	444	resolution);
04d348ae	445	else
d1a513be ZW	446	return setup_virtual_dp_monitor(vgpu, PORT_B, GVT_DP_B,
d1a513be ZW	447	resolution);
04d348ae	448	}
6294b61b CD	449
	450	/**
	451	* intel_vgpu_reset_display- reset vGPU virtual display emulation
	452	* @vgpu: a vGPU
	453	*
	454	* This function is used to reset vGPU virtual display emulation stuffs
	455	*
	456	*/
	457	void intel_vgpu_reset_display(struct intel_vgpu *vgpu)
	458	{
	459	emulate_monitor_status_change(vgpu);
	460	}