Commit d2a2c64f authored by James Zhu's avatar James Zhu Committed by Alex Deucher
Browse files

drm/amdgpu/vcn2.5: add DPG mode start and stop 



Add DPG mode start and stop functions for vcn2.5

v2: Correct firmware ucode index in vcn_v2_5_mc_resume_dpg_mode

Signed-off-by: default avatarJames Zhu <James.Zhu@amd.com>
Reviewed-by: default avatarLeo Liu <leo.liu@amd.com>
Signed-off-by: default avatarAlex Deucher <alexander.deucher@amd.com>
parent 45cec87c

drivers/gpu/drm/amd/amdgpu/vcn_v2_5.c

+288 −2
Original line number Diff line number Diff line
@@ -286,7 +286,8 @@ static int vcn_v2_5_hw_init(void *handle) 


done:

	if (!r)

		DRM_INFO("VCN decode and encode initialized successfully.\n");

		DRM_INFO("VCN decode and encode initialized successfully(under %s).\n",

			(adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG)?"DPG Mode":"SPG Mode");



	return r;

}
@@ -309,7 +310,9 @@ static int vcn_v2_5_hw_fini(void *handle) 
			continue;

		ring = &adev->vcn.inst[i].ring_dec;



		if (RREG32_SOC15(VCN, i, mmUVD_STATUS))

		if ((adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG) ||

		    (adev->vcn.cur_state != AMD_PG_STATE_GATE &&

		     RREG32_SOC15(VCN, i, mmUVD_STATUS)))

			vcn_v2_5_set_powergating_state(adev, AMD_PG_STATE_GATE);



		ring->sched.ready = false;
@@ -418,6 +421,78 @@ static void vcn_v2_5_mc_resume(struct amdgpu_device *adev) 
	}

}



static void vcn_v2_5_mc_resume_dpg_mode(struct amdgpu_device *adev, int inst_idx, bool indirect)

{

	uint32_t size = AMDGPU_GPU_PAGE_ALIGN(adev->vcn.fw->size + 4);

	uint32_t offset;



	/* cache window 0: fw */

	if (adev->firmware.load_type == AMDGPU_FW_LOAD_PSP) {

		WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

			UVD, inst_idx, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),

			(adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + inst_idx].tmr_mc_addr_lo), 0, indirect);

		WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

			UVD, inst_idx, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),

			(adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + inst_idx].tmr_mc_addr_hi), 0, indirect);

		WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

			UVD, inst_idx, mmUVD_VCPU_CACHE_OFFSET0), 0, 0, indirect);

		offset = 0;

	} else {

		WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

			UVD, inst_idx, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),

			lower_32_bits(adev->vcn.inst[inst_idx].gpu_addr), 0, indirect);

		WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

			UVD, inst_idx, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),

			upper_32_bits(adev->vcn.inst[inst_idx].gpu_addr), 0, indirect);

		offset = size;

		WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

			UVD, inst_idx, mmUVD_VCPU_CACHE_OFFSET0),

			AMDGPU_UVD_FIRMWARE_OFFSET >> 3, 0, indirect);

	}



	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_VCPU_CACHE_SIZE0), size, 0, indirect);



	/* cache window 1: stack */

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_LOW),

		lower_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset), 0, indirect);

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_HIGH),

		upper_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset), 0, indirect);

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_VCPU_CACHE_OFFSET1), 0, 0, indirect);



	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_VCPU_CACHE_SIZE1), AMDGPU_VCN_STACK_SIZE, 0, indirect);



	/* cache window 2: context */

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_LOW),

		lower_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset + AMDGPU_VCN_STACK_SIZE), 0, indirect);

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_HIGH),

		upper_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset + AMDGPU_VCN_STACK_SIZE), 0, indirect);

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_VCPU_CACHE_OFFSET2), 0, 0, indirect);

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_VCPU_CACHE_SIZE2), AMDGPU_VCN_CONTEXT_SIZE, 0, indirect);



	/* non-cache window */

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_LMI_VCPU_NC0_64BIT_BAR_LOW), 0, 0, indirect);

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_LMI_VCPU_NC0_64BIT_BAR_HIGH), 0, 0, indirect);

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_VCPU_NONCACHE_OFFSET0), 0, 0, indirect);

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_VCPU_NONCACHE_SIZE0), 0, 0, indirect);



	/* VCN global tiling registers */

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_GFX8_ADDR_CONFIG), adev->gfx.config.gb_addr_config, 0, indirect);

}



/**

 * vcn_v2_5_disable_clock_gating - disable VCN clock gating

 *
@@ -536,6 +611,54 @@ static void vcn_v2_5_disable_clock_gating(struct amdgpu_device *adev) 
	}

}



static void vcn_v2_5_clock_gating_dpg_mode(struct amdgpu_device *adev,

		uint8_t sram_sel, int inst_idx, uint8_t indirect)

{

	uint32_t reg_data = 0;



	/* enable sw clock gating control */

	if (adev->cg_flags & AMD_CG_SUPPORT_VCN_MGCG)

		reg_data = 1 << UVD_CGC_CTRL__DYN_CLOCK_MODE__SHIFT;

	else

		reg_data = 0 << UVD_CGC_CTRL__DYN_CLOCK_MODE__SHIFT;

	reg_data |= 1 << UVD_CGC_CTRL__CLK_GATE_DLY_TIMER__SHIFT;

	reg_data |= 4 << UVD_CGC_CTRL__CLK_OFF_DELAY__SHIFT;

	reg_data &= ~(UVD_CGC_CTRL__UDEC_RE_MODE_MASK |

		 UVD_CGC_CTRL__UDEC_CM_MODE_MASK |

		 UVD_CGC_CTRL__UDEC_IT_MODE_MASK |

		 UVD_CGC_CTRL__UDEC_DB_MODE_MASK |

		 UVD_CGC_CTRL__UDEC_MP_MODE_MASK |

		 UVD_CGC_CTRL__SYS_MODE_MASK |

		 UVD_CGC_CTRL__UDEC_MODE_MASK |

		 UVD_CGC_CTRL__MPEG2_MODE_MASK |

		 UVD_CGC_CTRL__REGS_MODE_MASK |

		 UVD_CGC_CTRL__RBC_MODE_MASK |

		 UVD_CGC_CTRL__LMI_MC_MODE_MASK |

		 UVD_CGC_CTRL__LMI_UMC_MODE_MASK |

		 UVD_CGC_CTRL__IDCT_MODE_MASK |

		 UVD_CGC_CTRL__MPRD_MODE_MASK |

		 UVD_CGC_CTRL__MPC_MODE_MASK |

		 UVD_CGC_CTRL__LBSI_MODE_MASK |

		 UVD_CGC_CTRL__LRBBM_MODE_MASK |

		 UVD_CGC_CTRL__WCB_MODE_MASK |

		 UVD_CGC_CTRL__VCPU_MODE_MASK |

		 UVD_CGC_CTRL__MMSCH_MODE_MASK);

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_CGC_CTRL), reg_data, sram_sel, indirect);



	/* turn off clock gating */

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_CGC_GATE), 0, sram_sel, indirect);



	/* turn on SUVD clock gating */

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_SUVD_CGC_GATE), 1, sram_sel, indirect);



	/* turn on sw mode in UVD_SUVD_CGC_CTRL */

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_SUVD_CGC_CTRL), 0, sram_sel, indirect);

}



/**

 * vcn_v2_5_enable_clock_gating - enable VCN clock gating

 *
@@ -598,6 +721,130 @@ static void vcn_v2_5_enable_clock_gating(struct amdgpu_device *adev) 
	}

}



static int vcn_v2_5_start_dpg_mode(struct amdgpu_device *adev, int inst_idx, bool indirect)

{

	struct amdgpu_ring *ring;

	uint32_t rb_bufsz, tmp;



	/* disable register anti-hang mechanism */

	WREG32_P(SOC15_REG_OFFSET(UVD, inst_idx, mmUVD_POWER_STATUS), 1,

		~UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);

	/* enable dynamic power gating mode */

	tmp = RREG32_SOC15(UVD, inst_idx, mmUVD_POWER_STATUS);

	tmp |= UVD_POWER_STATUS__UVD_PG_MODE_MASK;

	tmp |= UVD_POWER_STATUS__UVD_PG_EN_MASK;

	WREG32_SOC15(UVD, inst_idx, mmUVD_POWER_STATUS, tmp);



	/* enable clock gating */

	vcn_v2_5_clock_gating_dpg_mode(adev, 0, inst_idx, indirect);



	/* enable VCPU clock */

	tmp = (0xFF << UVD_VCPU_CNTL__PRB_TIMEOUT_VAL__SHIFT);

	tmp |= UVD_VCPU_CNTL__CLK_EN_MASK;

	tmp |= UVD_VCPU_CNTL__BLK_RST_MASK;

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_VCPU_CNTL), tmp, 0, indirect);



	/* disable master interupt */

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_MASTINT_EN), 0, 0, indirect);



	/* setup mmUVD_LMI_CTRL */

	tmp = (0x8 | UVD_LMI_CTRL__WRITE_CLEAN_TIMER_EN_MASK |

		UVD_LMI_CTRL__REQ_MODE_MASK |

		UVD_LMI_CTRL__CRC_RESET_MASK |

		UVD_LMI_CTRL__MASK_MC_URGENT_MASK |

		UVD_LMI_CTRL__DATA_COHERENCY_EN_MASK |

		UVD_LMI_CTRL__VCPU_DATA_COHERENCY_EN_MASK |

		(8 << UVD_LMI_CTRL__WRITE_CLEAN_TIMER__SHIFT) |

		0x00100000L);

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_LMI_CTRL), tmp, 0, indirect);



	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_MPC_CNTL),

		0x2 << UVD_MPC_CNTL__REPLACEMENT_MODE__SHIFT, 0, indirect);



	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_MPC_SET_MUXA0),

		((0x1 << UVD_MPC_SET_MUXA0__VARA_1__SHIFT) |

		 (0x2 << UVD_MPC_SET_MUXA0__VARA_2__SHIFT) |

		 (0x3 << UVD_MPC_SET_MUXA0__VARA_3__SHIFT) |

		 (0x4 << UVD_MPC_SET_MUXA0__VARA_4__SHIFT)), 0, indirect);



	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_MPC_SET_MUXB0),

		((0x1 << UVD_MPC_SET_MUXB0__VARB_1__SHIFT) |

		 (0x2 << UVD_MPC_SET_MUXB0__VARB_2__SHIFT) |

		 (0x3 << UVD_MPC_SET_MUXB0__VARB_3__SHIFT) |

		 (0x4 << UVD_MPC_SET_MUXB0__VARB_4__SHIFT)), 0, indirect);



	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_MPC_SET_MUX),

		((0x0 << UVD_MPC_SET_MUX__SET_0__SHIFT) |

		 (0x1 << UVD_MPC_SET_MUX__SET_1__SHIFT) |

		 (0x2 << UVD_MPC_SET_MUX__SET_2__SHIFT)), 0, indirect);



	vcn_v2_5_mc_resume_dpg_mode(adev, inst_idx, indirect);



	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_REG_XX_MASK), 0x10, 0, indirect);

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_RBC_XX_IB_REG_CHECK), 0x3, 0, indirect);



	/* enable LMI MC and UMC channels */

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_LMI_CTRL2), 0, 0, indirect);



	/* unblock VCPU register access */

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_RB_ARB_CTRL), 0, 0, indirect);



	tmp = (0xFF << UVD_VCPU_CNTL__PRB_TIMEOUT_VAL__SHIFT);

	tmp |= UVD_VCPU_CNTL__CLK_EN_MASK;

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_VCPU_CNTL), tmp, 0, indirect);



	/* enable master interrupt */

	WREG32_SOC15_DPG_MODE_2_0(inst_idx, SOC15_DPG_MODE_OFFSET_2_0(

		UVD, inst_idx, mmUVD_MASTINT_EN),

		UVD_MASTINT_EN__VCPU_EN_MASK, 0, indirect);



	ring = &adev->vcn.inst[inst_idx].ring_dec;

	/* force RBC into idle state */

	rb_bufsz = order_base_2(ring->ring_size);

	tmp = REG_SET_FIELD(0, UVD_RBC_RB_CNTL, RB_BUFSZ, rb_bufsz);

	tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_BLKSZ, 1);

	tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_FETCH, 1);

	tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_UPDATE, 1);

	tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_RPTR_WR_EN, 1);

	WREG32_SOC15(UVD, inst_idx, mmUVD_RBC_RB_CNTL, tmp);



	/* set the write pointer delay */

	WREG32_SOC15(UVD, inst_idx, mmUVD_RBC_RB_WPTR_CNTL, 0);



	/* set the wb address */

	WREG32_SOC15(UVD, inst_idx, mmUVD_RBC_RB_RPTR_ADDR,

		(upper_32_bits(ring->gpu_addr) >> 2));



	/* programm the RB_BASE for ring buffer */

	WREG32_SOC15(UVD, inst_idx, mmUVD_LMI_RBC_RB_64BIT_BAR_LOW,

		lower_32_bits(ring->gpu_addr));

	WREG32_SOC15(UVD, inst_idx, mmUVD_LMI_RBC_RB_64BIT_BAR_HIGH,

		upper_32_bits(ring->gpu_addr));



	/* Initialize the ring buffer's read and write pointers */

	WREG32_SOC15(UVD, inst_idx, mmUVD_RBC_RB_RPTR, 0);



	WREG32_SOC15(UVD, inst_idx, mmUVD_SCRATCH2, 0);



	ring->wptr = RREG32_SOC15(UVD, inst_idx, mmUVD_RBC_RB_RPTR);

	WREG32_SOC15(UVD, inst_idx, mmUVD_RBC_RB_WPTR,

		lower_32_bits(ring->wptr));



	return 0;

}



static int vcn_v2_5_start(struct amdgpu_device *adev)

{

	struct amdgpu_ring *ring;
@@ -610,6 +857,9 @@ static int vcn_v2_5_start(struct amdgpu_device *adev) 
	for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {

		if (adev->vcn.harvest_config & (1 << i))

			continue;

		if (adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG)

			return vcn_v2_5_start_dpg_mode(adev, i, 0);



		/* disable register anti-hang mechanism */

		WREG32_P(SOC15_REG_OFFSET(UVD, i, mmUVD_POWER_STATUS), 0,

			~UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);
@@ -973,6 +1223,35 @@ static int vcn_v2_5_sriov_start(struct amdgpu_device *adev) 
	return vcn_v2_5_mmsch_start(adev, &adev->virt.mm_table);

}



static int vcn_v2_5_stop_dpg_mode(struct amdgpu_device *adev, int inst_idx)

{

	int ret_code = 0;

	uint32_t tmp;



	/* Wait for power status to be 1 */

	SOC15_WAIT_ON_RREG(UVD, inst_idx, mmUVD_POWER_STATUS, 1,

		UVD_POWER_STATUS__UVD_POWER_STATUS_MASK, ret_code);



	/* wait for read ptr to be equal to write ptr */

	tmp = RREG32_SOC15(UVD, inst_idx, mmUVD_RB_WPTR);

	SOC15_WAIT_ON_RREG(UVD, inst_idx, mmUVD_RB_RPTR, tmp, 0xFFFFFFFF, ret_code);



	tmp = RREG32_SOC15(UVD, inst_idx, mmUVD_RB_WPTR2);

	SOC15_WAIT_ON_RREG(UVD, inst_idx, mmUVD_RB_RPTR2, tmp, 0xFFFFFFFF, ret_code);



	tmp = RREG32_SOC15(UVD, inst_idx, mmUVD_RBC_RB_WPTR) & 0x7FFFFFFF;

	SOC15_WAIT_ON_RREG(UVD, inst_idx, mmUVD_RBC_RB_RPTR, tmp, 0xFFFFFFFF, ret_code);



	SOC15_WAIT_ON_RREG(UVD, inst_idx, mmUVD_POWER_STATUS, 1,

		UVD_POWER_STATUS__UVD_POWER_STATUS_MASK, ret_code);



	/* disable dynamic power gating mode */

	WREG32_P(SOC15_REG_OFFSET(UVD, inst_idx, mmUVD_POWER_STATUS), 0,

			~UVD_POWER_STATUS__UVD_PG_MODE_MASK);



	return 0;

}



static int vcn_v2_5_stop(struct amdgpu_device *adev)

{

	uint32_t tmp;
@@ -981,6 +1260,12 @@ static int vcn_v2_5_stop(struct amdgpu_device *adev) 
	for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {

		if (adev->vcn.harvest_config & (1 << i))

			continue;



		if (adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG) {

			r = vcn_v2_5_stop_dpg_mode(adev, i);

			goto power_off;

		}



		/* wait for vcn idle */

		SOC15_WAIT_ON_RREG(VCN, i, mmUVD_STATUS, UVD_STATUS__IDLE, 0x7, r);

		if (r)
@@ -1030,6 +1315,7 @@ static int vcn_v2_5_stop(struct amdgpu_device *adev) 
			~UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);

	}



power_off:

	if (adev->pm.dpm_enabled)

		amdgpu_dpm_enable_uvd(adev, false);

CRA Git | Maintained and supported by SUSTech CRA and CCSE