xref: /linux/drivers/gpu/drm/amd/amdgpu/vcn_v5_0_1.c (revision 9738280aae592b579a25b5b1b6584c894827d3c7)
1 /*
2  * Copyright 2024 Advanced Micro Devices, Inc. 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 shall be included in
12  * all copies or substantial portions of the Software.
13  *
14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20  * OTHER DEALINGS IN THE SOFTWARE.
21  *
22  */
23 
24 #include <linux/firmware.h>
25 #include "amdgpu.h"
26 #include "amdgpu_vcn.h"
27 #include "amdgpu_pm.h"
28 #include "soc15.h"
29 #include "soc15d.h"
30 #include "soc15_hw_ip.h"
31 #include "vcn_v2_0.h"
32 #include "vcn_v4_0_3.h"
33 #include "mmsch_v5_0.h"
34 
35 #include "vcn/vcn_5_0_0_offset.h"
36 #include "vcn/vcn_5_0_0_sh_mask.h"
37 #include "ivsrcid/vcn/irqsrcs_vcn_5_0.h"
38 #include "vcn_v5_0_0.h"
39 #include "vcn_v5_0_1.h"
40 
41 #include <drm/drm_drv.h>
42 
43 static int vcn_v5_0_1_start_sriov(struct amdgpu_device *adev);
44 static void vcn_v5_0_1_set_unified_ring_funcs(struct amdgpu_device *adev);
45 static void vcn_v5_0_1_set_irq_funcs(struct amdgpu_device *adev);
46 static int vcn_v5_0_1_set_pg_state(struct amdgpu_vcn_inst *vinst,
47 				   enum amd_powergating_state state);
48 static void vcn_v5_0_1_unified_ring_set_wptr(struct amdgpu_ring *ring);
49 static void vcn_v5_0_1_set_ras_funcs(struct amdgpu_device *adev);
50 /**
51  * vcn_v5_0_1_early_init - set function pointers and load microcode
52  *
53  * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
54  *
55  * Set ring and irq function pointers
56  * Load microcode from filesystem
57  */
58 static int vcn_v5_0_1_early_init(struct amdgpu_ip_block *ip_block)
59 {
60 	struct amdgpu_device *adev = ip_block->adev;
61 	int i, r;
62 
63 	for (i = 0; i < adev->vcn.num_vcn_inst; ++i)
64 		/* re-use enc ring as unified ring */
65 		adev->vcn.inst[i].num_enc_rings = 1;
66 
67 	vcn_v5_0_1_set_unified_ring_funcs(adev);
68 	vcn_v5_0_1_set_irq_funcs(adev);
69 	vcn_v5_0_1_set_ras_funcs(adev);
70 
71 	for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
72 		adev->vcn.inst[i].set_pg_state = vcn_v5_0_1_set_pg_state;
73 
74 		r = amdgpu_vcn_early_init(adev, i);
75 		if (r)
76 			return r;
77 	}
78 
79 	return 0;
80 }
81 
82 static void vcn_v5_0_1_fw_shared_init(struct amdgpu_device *adev, int inst_idx)
83 {
84 	struct amdgpu_vcn5_fw_shared *fw_shared;
85 
86 	fw_shared = adev->vcn.inst[inst_idx].fw_shared.cpu_addr;
87 
88 	if (fw_shared->sq.is_enabled)
89 		return;
90 	fw_shared->present_flag_0 =
91 		cpu_to_le32(AMDGPU_FW_SHARED_FLAG_0_UNIFIED_QUEUE);
92 	fw_shared->sq.is_enabled = 1;
93 
94 	if (amdgpu_vcnfw_log)
95 		amdgpu_vcn_fwlog_init(&adev->vcn.inst[inst_idx]);
96 }
97 
98 /**
99  * vcn_v5_0_1_sw_init - sw init for VCN block
100  *
101  * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
102  *
103  * Load firmware and sw initialization
104  */
105 static int vcn_v5_0_1_sw_init(struct amdgpu_ip_block *ip_block)
106 {
107 	struct amdgpu_device *adev = ip_block->adev;
108 	struct amdgpu_ring *ring;
109 	int i, r, vcn_inst;
110 
111 	/* VCN UNIFIED TRAP */
112 	r = amdgpu_irq_add_id(adev, SOC15_IH_CLIENTID_VCN,
113 		VCN_5_0__SRCID__UVD_ENC_GENERAL_PURPOSE, &adev->vcn.inst->irq);
114 	if (r)
115 		return r;
116 
117 	/* VCN POISON TRAP */
118 	r = amdgpu_irq_add_id(adev, SOC15_IH_CLIENTID_VCN,
119 		VCN_5_0__SRCID_UVD_POISON, &adev->vcn.inst->ras_poison_irq);
120 
121 	for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
122 		vcn_inst = GET_INST(VCN, i);
123 
124 		r = amdgpu_vcn_sw_init(adev, i);
125 		if (r)
126 			return r;
127 
128 		amdgpu_vcn_setup_ucode(adev, i);
129 
130 		r = amdgpu_vcn_resume(adev, i);
131 		if (r)
132 			return r;
133 
134 		ring = &adev->vcn.inst[i].ring_enc[0];
135 		ring->use_doorbell = true;
136 		if (!amdgpu_sriov_vf(adev))
137 			ring->doorbell_index =
138 				(adev->doorbell_index.vcn.vcn_ring0_1 << 1) +
139 				11 * vcn_inst;
140 		else
141 			ring->doorbell_index =
142 				(adev->doorbell_index.vcn.vcn_ring0_1 << 1) +
143 				32 * vcn_inst;
144 
145 		ring->vm_hub = AMDGPU_MMHUB0(adev->vcn.inst[i].aid_id);
146 		sprintf(ring->name, "vcn_unified_%d", adev->vcn.inst[i].aid_id);
147 
148 		r = amdgpu_ring_init(adev, ring, 512, &adev->vcn.inst[i].irq, 0,
149 					AMDGPU_RING_PRIO_DEFAULT, &adev->vcn.inst[i].sched_score);
150 		if (r)
151 			return r;
152 
153 		vcn_v5_0_1_fw_shared_init(adev, i);
154 	}
155 
156 	/* TODO: Add queue reset mask when FW fully supports it */
157 	adev->vcn.supported_reset =
158 		amdgpu_get_soft_full_reset_mask(&adev->vcn.inst[0].ring_enc[0]);
159 
160 	if (amdgpu_sriov_vf(adev)) {
161 		r = amdgpu_virt_alloc_mm_table(adev);
162 		if (r)
163 			return r;
164 	}
165 
166 	vcn_v5_0_0_alloc_ip_dump(adev);
167 
168 	return amdgpu_vcn_sysfs_reset_mask_init(adev);
169 }
170 
171 /**
172  * vcn_v5_0_1_sw_fini - sw fini for VCN block
173  *
174  * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
175  *
176  * VCN suspend and free up sw allocation
177  */
178 static int vcn_v5_0_1_sw_fini(struct amdgpu_ip_block *ip_block)
179 {
180 	struct amdgpu_device *adev = ip_block->adev;
181 	int i, r, idx;
182 
183 	if (drm_dev_enter(adev_to_drm(adev), &idx)) {
184 		for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
185 			volatile struct amdgpu_vcn5_fw_shared *fw_shared;
186 
187 			fw_shared = adev->vcn.inst[i].fw_shared.cpu_addr;
188 			fw_shared->present_flag_0 = 0;
189 			fw_shared->sq.is_enabled = 0;
190 		}
191 
192 		drm_dev_exit(idx);
193 	}
194 
195 	if (amdgpu_sriov_vf(adev))
196 		amdgpu_virt_free_mm_table(adev);
197 
198 	for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
199 		r = amdgpu_vcn_suspend(adev, i);
200 		if (r)
201 			return r;
202 	}
203 
204 	for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
205 		r = amdgpu_vcn_sw_fini(adev, i);
206 		if (r)
207 			return r;
208 	}
209 
210 	amdgpu_vcn_sysfs_reset_mask_fini(adev);
211 
212 	kfree(adev->vcn.ip_dump);
213 
214 	return 0;
215 }
216 
217 /**
218  * vcn_v5_0_1_hw_init - start and test VCN block
219  *
220  * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
221  *
222  * Initialize the hardware, boot up the VCPU and do some testing
223  */
224 static int vcn_v5_0_1_hw_init(struct amdgpu_ip_block *ip_block)
225 {
226 	struct amdgpu_device *adev = ip_block->adev;
227 	struct amdgpu_ring *ring;
228 	int i, r, vcn_inst;
229 
230 	if (amdgpu_sriov_vf(adev)) {
231 		r = vcn_v5_0_1_start_sriov(adev);
232 		if (r)
233 			return r;
234 
235 		for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
236 			ring = &adev->vcn.inst[i].ring_enc[0];
237 			ring->wptr = 0;
238 			ring->wptr_old = 0;
239 			vcn_v5_0_1_unified_ring_set_wptr(ring);
240 			ring->sched.ready = true;
241 		}
242 	} else {
243 		if (RREG32_SOC15(VCN, GET_INST(VCN, 0), regVCN_RRMT_CNTL) & 0x100)
244 			adev->vcn.caps |= AMDGPU_VCN_CAPS(RRMT_ENABLED);
245 		for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
246 			vcn_inst = GET_INST(VCN, i);
247 			ring = &adev->vcn.inst[i].ring_enc[0];
248 
249 			if (ring->use_doorbell)
250 				adev->nbio.funcs->vcn_doorbell_range(adev, ring->use_doorbell,
251 					((adev->doorbell_index.vcn.vcn_ring0_1 << 1) +
252 					11 * vcn_inst),
253 					adev->vcn.inst[i].aid_id);
254 
255 			/* Re-init fw_shared, if required */
256 			vcn_v5_0_1_fw_shared_init(adev, i);
257 
258 			r = amdgpu_ring_test_helper(ring);
259 			if (r)
260 				return r;
261 		}
262 	}
263 
264 	return 0;
265 }
266 
267 /**
268  * vcn_v5_0_1_hw_fini - stop the hardware block
269  *
270  * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
271  *
272  * Stop the VCN block, mark ring as not ready any more
273  */
274 static int vcn_v5_0_1_hw_fini(struct amdgpu_ip_block *ip_block)
275 {
276 	struct amdgpu_device *adev = ip_block->adev;
277 	int i;
278 
279 	for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
280 		struct amdgpu_vcn_inst *vinst = &adev->vcn.inst[i];
281 
282 		cancel_delayed_work_sync(&adev->vcn.inst[i].idle_work);
283 		if (vinst->cur_state != AMD_PG_STATE_GATE)
284 			vinst->set_pg_state(vinst, AMD_PG_STATE_GATE);
285 	}
286 
287 	if (amdgpu_ras_is_supported(adev, AMDGPU_RAS_BLOCK__VCN))
288 		amdgpu_irq_put(adev, &adev->vcn.inst->ras_poison_irq, 0);
289 
290 	return 0;
291 }
292 
293 /**
294  * vcn_v5_0_1_suspend - suspend VCN block
295  *
296  * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
297  *
298  * HW fini and suspend VCN block
299  */
300 static int vcn_v5_0_1_suspend(struct amdgpu_ip_block *ip_block)
301 {
302 	struct amdgpu_device *adev = ip_block->adev;
303 	int r, i;
304 
305 	r = vcn_v5_0_1_hw_fini(ip_block);
306 	if (r)
307 		return r;
308 
309 	for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
310 		r = amdgpu_vcn_suspend(ip_block->adev, i);
311 		if (r)
312 			return r;
313 	}
314 
315 	return r;
316 }
317 
318 /**
319  * vcn_v5_0_1_resume - resume VCN block
320  *
321  * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
322  *
323  * Resume firmware and hw init VCN block
324  */
325 static int vcn_v5_0_1_resume(struct amdgpu_ip_block *ip_block)
326 {
327 	struct amdgpu_device *adev = ip_block->adev;
328 	int r, i;
329 
330 	for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
331 		struct amdgpu_vcn_inst *vinst = &adev->vcn.inst[i];
332 
333 		if (amdgpu_in_reset(adev))
334 			vinst->cur_state = AMD_PG_STATE_GATE;
335 
336 		r = amdgpu_vcn_resume(ip_block->adev, i);
337 		if (r)
338 			return r;
339 	}
340 
341 	r = vcn_v5_0_1_hw_init(ip_block);
342 
343 	return r;
344 }
345 
346 /**
347  * vcn_v5_0_1_mc_resume - memory controller programming
348  *
349  * @vinst: VCN instance
350  *
351  * Let the VCN memory controller know it's offsets
352  */
353 static void vcn_v5_0_1_mc_resume(struct amdgpu_vcn_inst *vinst)
354 {
355 	struct amdgpu_device *adev = vinst->adev;
356 	int inst = vinst->inst;
357 	uint32_t offset, size, vcn_inst;
358 	const struct common_firmware_header *hdr;
359 
360 	hdr = (const struct common_firmware_header *)adev->vcn.inst[inst].fw->data;
361 	size = AMDGPU_GPU_PAGE_ALIGN(le32_to_cpu(hdr->ucode_size_bytes) + 8);
362 
363 	vcn_inst = GET_INST(VCN, inst);
364 	/* cache window 0: fw */
365 	if (adev->firmware.load_type == AMDGPU_FW_LOAD_PSP) {
366 		WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW,
367 			(adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + inst].tmr_mc_addr_lo));
368 		WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH,
369 			(adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + inst].tmr_mc_addr_hi));
370 		WREG32_SOC15(VCN, vcn_inst, regUVD_VCPU_CACHE_OFFSET0, 0);
371 		offset = 0;
372 	} else {
373 		WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW,
374 			lower_32_bits(adev->vcn.inst[inst].gpu_addr));
375 		WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH,
376 			upper_32_bits(adev->vcn.inst[inst].gpu_addr));
377 		offset = size;
378 		WREG32_SOC15(VCN, vcn_inst, regUVD_VCPU_CACHE_OFFSET0,
379 				AMDGPU_UVD_FIRMWARE_OFFSET >> 3);
380 	}
381 	WREG32_SOC15(VCN, vcn_inst, regUVD_VCPU_CACHE_SIZE0, size);
382 
383 	/* cache window 1: stack */
384 	WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_VCPU_CACHE1_64BIT_BAR_LOW,
385 		lower_32_bits(adev->vcn.inst[inst].gpu_addr + offset));
386 	WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_VCPU_CACHE1_64BIT_BAR_HIGH,
387 		upper_32_bits(adev->vcn.inst[inst].gpu_addr + offset));
388 	WREG32_SOC15(VCN, vcn_inst, regUVD_VCPU_CACHE_OFFSET1, 0);
389 	WREG32_SOC15(VCN, vcn_inst, regUVD_VCPU_CACHE_SIZE1, AMDGPU_VCN_STACK_SIZE);
390 
391 	/* cache window 2: context */
392 	WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_VCPU_CACHE2_64BIT_BAR_LOW,
393 		lower_32_bits(adev->vcn.inst[inst].gpu_addr + offset + AMDGPU_VCN_STACK_SIZE));
394 	WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_VCPU_CACHE2_64BIT_BAR_HIGH,
395 		upper_32_bits(adev->vcn.inst[inst].gpu_addr + offset + AMDGPU_VCN_STACK_SIZE));
396 	WREG32_SOC15(VCN, vcn_inst, regUVD_VCPU_CACHE_OFFSET2, 0);
397 	WREG32_SOC15(VCN, vcn_inst, regUVD_VCPU_CACHE_SIZE2, AMDGPU_VCN_CONTEXT_SIZE);
398 
399 	/* non-cache window */
400 	WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_VCPU_NC0_64BIT_BAR_LOW,
401 		lower_32_bits(adev->vcn.inst[inst].fw_shared.gpu_addr));
402 	WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_VCPU_NC0_64BIT_BAR_HIGH,
403 		upper_32_bits(adev->vcn.inst[inst].fw_shared.gpu_addr));
404 	WREG32_SOC15(VCN, vcn_inst, regUVD_VCPU_NONCACHE_OFFSET0, 0);
405 	WREG32_SOC15(VCN, vcn_inst, regUVD_VCPU_NONCACHE_SIZE0,
406 		AMDGPU_GPU_PAGE_ALIGN(sizeof(struct amdgpu_vcn5_fw_shared)));
407 }
408 
409 /**
410  * vcn_v5_0_1_mc_resume_dpg_mode - memory controller programming for dpg mode
411  *
412  * @vinst: VCN instance
413  * @indirect: indirectly write sram
414  *
415  * Let the VCN memory controller know it's offsets with dpg mode
416  */
417 static void vcn_v5_0_1_mc_resume_dpg_mode(struct amdgpu_vcn_inst *vinst,
418 					  bool indirect)
419 {
420 	struct amdgpu_device *adev = vinst->adev;
421 	int inst_idx = vinst->inst;
422 	uint32_t offset, size;
423 	const struct common_firmware_header *hdr;
424 
425 	hdr = (const struct common_firmware_header *)adev->vcn.inst[inst_idx].fw->data;
426 	size = AMDGPU_GPU_PAGE_ALIGN(le32_to_cpu(hdr->ucode_size_bytes) + 8);
427 
428 	/* cache window 0: fw */
429 	if (adev->firmware.load_type == AMDGPU_FW_LOAD_PSP) {
430 		if (!indirect) {
431 			WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
432 				VCN, 0, regUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),
433 				(adev->firmware.ucode[AMDGPU_UCODE_ID_VCN +
434 				 inst_idx].tmr_mc_addr_lo), 0, indirect);
435 			WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
436 				VCN, 0, regUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),
437 				(adev->firmware.ucode[AMDGPU_UCODE_ID_VCN +
438 				 inst_idx].tmr_mc_addr_hi), 0, indirect);
439 			WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
440 				VCN, 0, regUVD_VCPU_CACHE_OFFSET0), 0, 0, indirect);
441 		} else {
442 			WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
443 				VCN, 0, regUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW), 0, 0, indirect);
444 			WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
445 				VCN, 0, regUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH), 0, 0, indirect);
446 			WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
447 				VCN, 0, regUVD_VCPU_CACHE_OFFSET0), 0, 0, indirect);
448 		}
449 		offset = 0;
450 	} else {
451 		WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
452 			VCN, 0, regUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),
453 			lower_32_bits(adev->vcn.inst[inst_idx].gpu_addr), 0, indirect);
454 		WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
455 			VCN, 0, regUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),
456 			upper_32_bits(adev->vcn.inst[inst_idx].gpu_addr), 0, indirect);
457 		offset = size;
458 		WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
459 			VCN, 0, regUVD_VCPU_CACHE_OFFSET0),
460 			AMDGPU_UVD_FIRMWARE_OFFSET >> 3, 0, indirect);
461 	}
462 
463 	if (!indirect)
464 		WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
465 			VCN, 0, regUVD_VCPU_CACHE_SIZE0), size, 0, indirect);
466 	else
467 		WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
468 			VCN, 0, regUVD_VCPU_CACHE_SIZE0), 0, 0, indirect);
469 
470 	/* cache window 1: stack */
471 	if (!indirect) {
472 		WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
473 			VCN, 0, regUVD_LMI_VCPU_CACHE1_64BIT_BAR_LOW),
474 			lower_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset), 0, indirect);
475 		WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
476 			VCN, 0, regUVD_LMI_VCPU_CACHE1_64BIT_BAR_HIGH),
477 			upper_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset), 0, indirect);
478 		WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
479 			VCN, 0, regUVD_VCPU_CACHE_OFFSET1), 0, 0, indirect);
480 	} else {
481 		WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
482 			VCN, 0, regUVD_LMI_VCPU_CACHE1_64BIT_BAR_LOW), 0, 0, indirect);
483 		WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
484 			VCN, 0, regUVD_LMI_VCPU_CACHE1_64BIT_BAR_HIGH), 0, 0, indirect);
485 		WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
486 			VCN, 0, regUVD_VCPU_CACHE_OFFSET1), 0, 0, indirect);
487 	}
488 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
489 			VCN, 0, regUVD_VCPU_CACHE_SIZE1), AMDGPU_VCN_STACK_SIZE, 0, indirect);
490 
491 	/* cache window 2: context */
492 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
493 		VCN, 0, regUVD_LMI_VCPU_CACHE2_64BIT_BAR_LOW),
494 		lower_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset +
495 			AMDGPU_VCN_STACK_SIZE), 0, indirect);
496 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
497 		VCN, 0, regUVD_LMI_VCPU_CACHE2_64BIT_BAR_HIGH),
498 		upper_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset +
499 			AMDGPU_VCN_STACK_SIZE), 0, indirect);
500 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
501 		VCN, 0, regUVD_VCPU_CACHE_OFFSET2), 0, 0, indirect);
502 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
503 		VCN, 0, regUVD_VCPU_CACHE_SIZE2), AMDGPU_VCN_CONTEXT_SIZE, 0, indirect);
504 
505 	/* non-cache window */
506 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
507 		VCN, 0, regUVD_LMI_VCPU_NC0_64BIT_BAR_LOW),
508 		lower_32_bits(adev->vcn.inst[inst_idx].fw_shared.gpu_addr), 0, indirect);
509 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
510 		VCN, 0, regUVD_LMI_VCPU_NC0_64BIT_BAR_HIGH),
511 		upper_32_bits(adev->vcn.inst[inst_idx].fw_shared.gpu_addr), 0, indirect);
512 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
513 		VCN, 0, regUVD_VCPU_NONCACHE_OFFSET0), 0, 0, indirect);
514 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
515 		VCN, 0, regUVD_VCPU_NONCACHE_SIZE0),
516 		AMDGPU_GPU_PAGE_ALIGN(sizeof(struct amdgpu_vcn5_fw_shared)), 0, indirect);
517 
518 	/* VCN global tiling registers */
519 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
520 		VCN, 0, regUVD_GFX10_ADDR_CONFIG), adev->gfx.config.gb_addr_config, 0, indirect);
521 }
522 
523 /**
524  * vcn_v5_0_1_disable_clock_gating - disable VCN clock gating
525  *
526  * @vinst: VCN instance
527  *
528  * Disable clock gating for VCN block
529  */
530 static void vcn_v5_0_1_disable_clock_gating(struct amdgpu_vcn_inst *vinst)
531 {
532 }
533 
534 /**
535  * vcn_v5_0_1_enable_clock_gating - enable VCN clock gating
536  *
537  * @vinst: VCN instance
538  *
539  * Enable clock gating for VCN block
540  */
541 static void vcn_v5_0_1_enable_clock_gating(struct amdgpu_vcn_inst *vinst)
542 {
543 }
544 
545 /**
546  * vcn_v5_0_1_pause_dpg_mode - VCN pause with dpg mode
547  *
548  * @vinst: VCN instance
549  * @new_state: pause state
550  *
551  * Pause dpg mode for VCN block
552  */
553 static int vcn_v5_0_1_pause_dpg_mode(struct amdgpu_vcn_inst *vinst,
554 				     struct dpg_pause_state *new_state)
555 {
556 	struct amdgpu_device *adev = vinst->adev;
557 	uint32_t reg_data = 0;
558 	int vcn_inst;
559 
560 	vcn_inst = GET_INST(VCN, vinst->inst);
561 
562 	/* pause/unpause if state is changed */
563 	if (vinst->pause_state.fw_based != new_state->fw_based) {
564 		DRM_DEV_DEBUG(adev->dev, "dpg pause state changed %d -> %d %s\n",
565 			vinst->pause_state.fw_based, new_state->fw_based,
566 			new_state->fw_based ? "VCN_DPG_STATE__PAUSE" : "VCN_DPG_STATE__UNPAUSE");
567 		reg_data = RREG32_SOC15(VCN, vcn_inst, regUVD_DPG_PAUSE) &
568 			(~UVD_DPG_PAUSE__NJ_PAUSE_DPG_ACK_MASK);
569 
570 		if (new_state->fw_based == VCN_DPG_STATE__PAUSE) {
571 			/* pause DPG */
572 			reg_data |= UVD_DPG_PAUSE__NJ_PAUSE_DPG_REQ_MASK;
573 			WREG32_SOC15(VCN, vcn_inst, regUVD_DPG_PAUSE, reg_data);
574 
575 			/* wait for ACK */
576 			SOC15_WAIT_ON_RREG(VCN, vcn_inst, regUVD_DPG_PAUSE,
577 					UVD_DPG_PAUSE__NJ_PAUSE_DPG_ACK_MASK,
578 					UVD_DPG_PAUSE__NJ_PAUSE_DPG_ACK_MASK);
579 		} else {
580 			/* unpause DPG, no need to wait */
581 			reg_data &= ~UVD_DPG_PAUSE__NJ_PAUSE_DPG_REQ_MASK;
582 			WREG32_SOC15(VCN, vcn_inst, regUVD_DPG_PAUSE, reg_data);
583 		}
584 		vinst->pause_state.fw_based = new_state->fw_based;
585 	}
586 
587 	return 0;
588 }
589 
590 
591 /**
592  * vcn_v5_0_1_start_dpg_mode - VCN start with dpg mode
593  *
594  * @vinst: VCN instance
595  * @indirect: indirectly write sram
596  *
597  * Start VCN block with dpg mode
598  */
599 static int vcn_v5_0_1_start_dpg_mode(struct amdgpu_vcn_inst *vinst,
600 				     bool indirect)
601 {
602 	struct amdgpu_device *adev = vinst->adev;
603 	int inst_idx = vinst->inst;
604 	volatile struct amdgpu_vcn5_fw_shared *fw_shared =
605 		adev->vcn.inst[inst_idx].fw_shared.cpu_addr;
606 	struct amdgpu_ring *ring;
607 	struct dpg_pause_state state = {.fw_based = VCN_DPG_STATE__PAUSE};
608 	int vcn_inst;
609 	uint32_t tmp;
610 
611 	vcn_inst = GET_INST(VCN, inst_idx);
612 
613 	/* disable register anti-hang mechanism */
614 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_POWER_STATUS), 1,
615 		~UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);
616 
617 	/* enable dynamic power gating mode */
618 	tmp = RREG32_SOC15(VCN, vcn_inst, regUVD_POWER_STATUS);
619 	tmp |= UVD_POWER_STATUS__UVD_PG_MODE_MASK;
620 	WREG32_SOC15(VCN, vcn_inst, regUVD_POWER_STATUS, tmp);
621 
622 	if (indirect) {
623 		adev->vcn.inst[inst_idx].dpg_sram_curr_addr =
624 			(uint32_t *)adev->vcn.inst[inst_idx].dpg_sram_cpu_addr;
625 		/* Use dummy register 0xDEADBEEF passing AID selection to PSP FW */
626 		WREG32_SOC24_DPG_MODE(inst_idx, 0xDEADBEEF,
627 				adev->vcn.inst[inst_idx].aid_id, 0, true);
628 	}
629 
630 	/* enable VCPU clock */
631 	tmp = (0xFF << UVD_VCPU_CNTL__PRB_TIMEOUT_VAL__SHIFT);
632 	tmp |= UVD_VCPU_CNTL__CLK_EN_MASK | UVD_VCPU_CNTL__BLK_RST_MASK;
633 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
634 		VCN, 0, regUVD_VCPU_CNTL), tmp, 0, indirect);
635 
636 	/* disable master interrupt */
637 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
638 		VCN, 0, regUVD_MASTINT_EN), 0, 0, indirect);
639 
640 	/* setup regUVD_LMI_CTRL */
641 	tmp = (UVD_LMI_CTRL__WRITE_CLEAN_TIMER_EN_MASK |
642 		UVD_LMI_CTRL__REQ_MODE_MASK |
643 		UVD_LMI_CTRL__CRC_RESET_MASK |
644 		UVD_LMI_CTRL__MASK_MC_URGENT_MASK |
645 		UVD_LMI_CTRL__DATA_COHERENCY_EN_MASK |
646 		UVD_LMI_CTRL__VCPU_DATA_COHERENCY_EN_MASK |
647 		(8 << UVD_LMI_CTRL__WRITE_CLEAN_TIMER__SHIFT) |
648 		0x00100000L);
649 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
650 		VCN, 0, regUVD_LMI_CTRL), tmp, 0, indirect);
651 
652 	vcn_v5_0_1_mc_resume_dpg_mode(vinst, indirect);
653 
654 	tmp = (0xFF << UVD_VCPU_CNTL__PRB_TIMEOUT_VAL__SHIFT);
655 	tmp |= UVD_VCPU_CNTL__CLK_EN_MASK;
656 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
657 		VCN, 0, regUVD_VCPU_CNTL), tmp, 0, indirect);
658 
659 	/* enable LMI MC and UMC channels */
660 	tmp = 0x1f << UVD_LMI_CTRL2__RE_OFLD_MIF_WR_REQ_NUM__SHIFT;
661 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
662 		VCN, 0, regUVD_LMI_CTRL2), tmp, 0, indirect);
663 
664 	/* enable master interrupt */
665 	WREG32_SOC24_DPG_MODE(inst_idx, SOC24_DPG_MODE_OFFSET(
666 		VCN, 0, regUVD_MASTINT_EN),
667 		UVD_MASTINT_EN__VCPU_EN_MASK, 0, indirect);
668 
669 	if (indirect)
670 		amdgpu_vcn_psp_update_sram(adev, inst_idx, AMDGPU_UCODE_ID_VCN0_RAM);
671 
672 	/* Pause dpg */
673 	vcn_v5_0_1_pause_dpg_mode(vinst, &state);
674 
675 	ring = &adev->vcn.inst[inst_idx].ring_enc[0];
676 
677 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_BASE_LO, lower_32_bits(ring->gpu_addr));
678 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_BASE_HI, upper_32_bits(ring->gpu_addr));
679 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_SIZE, ring->ring_size / sizeof(uint32_t));
680 
681 	tmp = RREG32_SOC15(VCN, vcn_inst, regVCN_RB_ENABLE);
682 	tmp &= ~(VCN_RB_ENABLE__RB1_EN_MASK);
683 	WREG32_SOC15(VCN, vcn_inst, regVCN_RB_ENABLE, tmp);
684 	fw_shared->sq.queue_mode |= FW_QUEUE_RING_RESET;
685 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_RPTR, 0);
686 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_WPTR, 0);
687 
688 	tmp = RREG32_SOC15(VCN, vcn_inst, regUVD_RB_RPTR);
689 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_WPTR, tmp);
690 	ring->wptr = RREG32_SOC15(VCN, vcn_inst, regUVD_RB_WPTR);
691 
692 	tmp = RREG32_SOC15(VCN, vcn_inst, regVCN_RB_ENABLE);
693 	tmp |= VCN_RB_ENABLE__RB1_EN_MASK;
694 	WREG32_SOC15(VCN, vcn_inst, regVCN_RB_ENABLE, tmp);
695 	fw_shared->sq.queue_mode &= ~(FW_QUEUE_RING_RESET | FW_QUEUE_DPG_HOLD_OFF);
696 
697 	WREG32_SOC15(VCN, vcn_inst, regVCN_RB1_DB_CTRL,
698 		ring->doorbell_index << VCN_RB1_DB_CTRL__OFFSET__SHIFT |
699 		VCN_RB1_DB_CTRL__EN_MASK);
700 	/* Read DB_CTRL to flush the write DB_CTRL command. */
701 	RREG32_SOC15(VCN, vcn_inst, regVCN_RB1_DB_CTRL);
702 
703 	return 0;
704 }
705 
706 static int vcn_v5_0_1_start_sriov(struct amdgpu_device *adev)
707 {
708 	int i, vcn_inst;
709 	struct amdgpu_ring *ring_enc;
710 	uint64_t cache_addr;
711 	uint64_t rb_enc_addr;
712 	uint64_t ctx_addr;
713 	uint32_t param, resp, expected;
714 	uint32_t offset, cache_size;
715 	uint32_t tmp, timeout;
716 
717 	struct amdgpu_mm_table *table = &adev->virt.mm_table;
718 	uint32_t *table_loc;
719 	uint32_t table_size;
720 	uint32_t size, size_dw;
721 	uint32_t init_status;
722 	uint32_t enabled_vcn;
723 
724 	struct mmsch_v5_0_cmd_direct_write
725 		direct_wt = { {0} };
726 	struct mmsch_v5_0_cmd_direct_read_modify_write
727 		direct_rd_mod_wt = { {0} };
728 	struct mmsch_v5_0_cmd_end end = { {0} };
729 	struct mmsch_v5_0_init_header header;
730 
731 	volatile struct amdgpu_vcn5_fw_shared *fw_shared;
732 	volatile struct amdgpu_fw_shared_rb_setup *rb_setup;
733 
734 	direct_wt.cmd_header.command_type =
735 		MMSCH_COMMAND__DIRECT_REG_WRITE;
736 	direct_rd_mod_wt.cmd_header.command_type =
737 		MMSCH_COMMAND__DIRECT_REG_READ_MODIFY_WRITE;
738 	end.cmd_header.command_type = MMSCH_COMMAND__END;
739 
740 	for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
741 		vcn_inst = GET_INST(VCN, i);
742 
743 		vcn_v5_0_1_fw_shared_init(adev, vcn_inst);
744 
745 		memset(&header, 0, sizeof(struct mmsch_v5_0_init_header));
746 		header.version = MMSCH_VERSION;
747 		header.total_size = sizeof(struct mmsch_v5_0_init_header) >> 2;
748 
749 		table_loc = (uint32_t *)table->cpu_addr;
750 		table_loc += header.total_size;
751 
752 		table_size = 0;
753 
754 		MMSCH_V5_0_INSERT_DIRECT_RD_MOD_WT(SOC15_REG_OFFSET(VCN, 0, regUVD_STATUS),
755 			~UVD_STATUS__UVD_BUSY, UVD_STATUS__UVD_BUSY);
756 
757 		cache_size = AMDGPU_GPU_PAGE_ALIGN(adev->vcn.inst[i].fw->size + 4);
758 
759 		if (adev->firmware.load_type == AMDGPU_FW_LOAD_PSP) {
760 			MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
761 				regUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),
762 				adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + i].tmr_mc_addr_lo);
763 
764 			MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
765 				regUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),
766 				adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + i].tmr_mc_addr_hi);
767 
768 			offset = 0;
769 			MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
770 				regUVD_VCPU_CACHE_OFFSET0), 0);
771 		} else {
772 			MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
773 				regUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),
774 				lower_32_bits(adev->vcn.inst[i].gpu_addr));
775 			MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
776 				regUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),
777 				upper_32_bits(adev->vcn.inst[i].gpu_addr));
778 			offset = cache_size;
779 			MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
780 				regUVD_VCPU_CACHE_OFFSET0),
781 				AMDGPU_UVD_FIRMWARE_OFFSET >> 3);
782 		}
783 
784 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
785 			regUVD_VCPU_CACHE_SIZE0),
786 			cache_size);
787 
788 		cache_addr = adev->vcn.inst[vcn_inst].gpu_addr + offset;
789 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
790 			regUVD_LMI_VCPU_CACHE1_64BIT_BAR_LOW), lower_32_bits(cache_addr));
791 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
792 			regUVD_LMI_VCPU_CACHE1_64BIT_BAR_HIGH), upper_32_bits(cache_addr));
793 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
794 			regUVD_VCPU_CACHE_OFFSET1), 0);
795 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
796 			regUVD_VCPU_CACHE_SIZE1), AMDGPU_VCN_STACK_SIZE);
797 
798 		cache_addr = adev->vcn.inst[vcn_inst].gpu_addr + offset +
799 			AMDGPU_VCN_STACK_SIZE;
800 
801 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
802 			regUVD_LMI_VCPU_CACHE2_64BIT_BAR_LOW), lower_32_bits(cache_addr));
803 
804 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
805 			regUVD_LMI_VCPU_CACHE2_64BIT_BAR_HIGH), upper_32_bits(cache_addr));
806 
807 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
808 			regUVD_VCPU_CACHE_OFFSET2), 0);
809 
810 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
811 			regUVD_VCPU_CACHE_SIZE2), AMDGPU_VCN_CONTEXT_SIZE);
812 
813 		fw_shared = adev->vcn.inst[vcn_inst].fw_shared.cpu_addr;
814 		rb_setup = &fw_shared->rb_setup;
815 
816 		ring_enc = &adev->vcn.inst[vcn_inst].ring_enc[0];
817 		ring_enc->wptr = 0;
818 		rb_enc_addr = ring_enc->gpu_addr;
819 
820 		rb_setup->is_rb_enabled_flags |= RB_ENABLED;
821 		rb_setup->rb_addr_lo = lower_32_bits(rb_enc_addr);
822 		rb_setup->rb_addr_hi = upper_32_bits(rb_enc_addr);
823 		rb_setup->rb_size = ring_enc->ring_size / 4;
824 		fw_shared->present_flag_0 |= cpu_to_le32(AMDGPU_VCN_VF_RB_SETUP_FLAG);
825 
826 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
827 			regUVD_LMI_VCPU_NC0_64BIT_BAR_LOW),
828 			lower_32_bits(adev->vcn.inst[vcn_inst].fw_shared.gpu_addr));
829 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
830 			regUVD_LMI_VCPU_NC0_64BIT_BAR_HIGH),
831 			upper_32_bits(adev->vcn.inst[vcn_inst].fw_shared.gpu_addr));
832 		MMSCH_V5_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(VCN, 0,
833 			regUVD_VCPU_NONCACHE_SIZE0),
834 			AMDGPU_GPU_PAGE_ALIGN(sizeof(struct amdgpu_vcn4_fw_shared)));
835 		MMSCH_V5_0_INSERT_END();
836 
837 		header.vcn0.init_status = 0;
838 		header.vcn0.table_offset = header.total_size;
839 		header.vcn0.table_size = table_size;
840 		header.total_size += table_size;
841 
842 		/* Send init table to mmsch */
843 		size = sizeof(struct mmsch_v5_0_init_header);
844 		table_loc = (uint32_t *)table->cpu_addr;
845 		memcpy((void *)table_loc, &header, size);
846 
847 		ctx_addr = table->gpu_addr;
848 		WREG32_SOC15(VCN, vcn_inst, regMMSCH_VF_CTX_ADDR_LO, lower_32_bits(ctx_addr));
849 		WREG32_SOC15(VCN, vcn_inst, regMMSCH_VF_CTX_ADDR_HI, upper_32_bits(ctx_addr));
850 
851 		tmp = RREG32_SOC15(VCN, vcn_inst, regMMSCH_VF_VMID);
852 		tmp &= ~MMSCH_VF_VMID__VF_CTX_VMID_MASK;
853 		tmp |= (0 << MMSCH_VF_VMID__VF_CTX_VMID__SHIFT);
854 		WREG32_SOC15(VCN, vcn_inst, regMMSCH_VF_VMID, tmp);
855 
856 		size = header.total_size;
857 		WREG32_SOC15(VCN, vcn_inst, regMMSCH_VF_CTX_SIZE, size);
858 
859 		WREG32_SOC15(VCN, vcn_inst, regMMSCH_VF_MAILBOX_RESP, 0);
860 
861 		param = 0x00000001;
862 		WREG32_SOC15(VCN, vcn_inst, regMMSCH_VF_MAILBOX_HOST, param);
863 		tmp = 0;
864 		timeout = 1000;
865 		resp = 0;
866 		expected = MMSCH_VF_MAILBOX_RESP__OK;
867 		while (resp != expected) {
868 			resp = RREG32_SOC15(VCN, vcn_inst, regMMSCH_VF_MAILBOX_RESP);
869 			if (resp != 0)
870 				break;
871 
872 			udelay(10);
873 			tmp = tmp + 10;
874 			if (tmp >= timeout) {
875 				DRM_ERROR("failed to init MMSCH. TIME-OUT after %d usec"\
876 					" waiting for regMMSCH_VF_MAILBOX_RESP "\
877 					"(expected=0x%08x, readback=0x%08x)\n",
878 					tmp, expected, resp);
879 				return -EBUSY;
880 			}
881 		}
882 
883 		enabled_vcn = amdgpu_vcn_is_disabled_vcn(adev, VCN_DECODE_RING, 0) ? 1 : 0;
884 		init_status = ((struct mmsch_v5_0_init_header *)(table_loc))->vcn0.init_status;
885 		if (resp != expected && resp != MMSCH_VF_MAILBOX_RESP__INCOMPLETE
886 					&& init_status != MMSCH_VF_ENGINE_STATUS__PASS) {
887 			DRM_ERROR("MMSCH init status is incorrect! readback=0x%08x, header init "\
888 				"status for VCN%x: 0x%x\n", resp, enabled_vcn, init_status);
889 		}
890 	}
891 
892 	return 0;
893 }
894 
895 /**
896  * vcn_v5_0_1_start - VCN start
897  *
898  * @vinst: VCN instance
899  *
900  * Start VCN block
901  */
902 static int vcn_v5_0_1_start(struct amdgpu_vcn_inst *vinst)
903 {
904 	struct amdgpu_device *adev = vinst->adev;
905 	int i = vinst->inst;
906 	volatile struct amdgpu_vcn5_fw_shared *fw_shared;
907 	struct amdgpu_ring *ring;
908 	uint32_t tmp;
909 	int j, k, r, vcn_inst;
910 
911 	fw_shared = adev->vcn.inst[i].fw_shared.cpu_addr;
912 
913 	if (adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG)
914 		return vcn_v5_0_1_start_dpg_mode(vinst, adev->vcn.inst[i].indirect_sram);
915 
916 	vcn_inst = GET_INST(VCN, i);
917 
918 	/* set VCN status busy */
919 	tmp = RREG32_SOC15(VCN, vcn_inst, regUVD_STATUS) | UVD_STATUS__UVD_BUSY;
920 	WREG32_SOC15(VCN, vcn_inst, regUVD_STATUS, tmp);
921 
922 	/* enable VCPU clock */
923 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_VCPU_CNTL),
924 		 UVD_VCPU_CNTL__CLK_EN_MASK, ~UVD_VCPU_CNTL__CLK_EN_MASK);
925 
926 	/* disable master interrupt */
927 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_MASTINT_EN), 0,
928 		 ~UVD_MASTINT_EN__VCPU_EN_MASK);
929 
930 	/* enable LMI MC and UMC channels */
931 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_LMI_CTRL2), 0,
932 		 ~UVD_LMI_CTRL2__STALL_ARB_UMC_MASK);
933 
934 	tmp = RREG32_SOC15(VCN, vcn_inst, regUVD_SOFT_RESET);
935 	tmp &= ~UVD_SOFT_RESET__LMI_SOFT_RESET_MASK;
936 	tmp &= ~UVD_SOFT_RESET__LMI_UMC_SOFT_RESET_MASK;
937 	WREG32_SOC15(VCN, vcn_inst, regUVD_SOFT_RESET, tmp);
938 
939 	/* setup regUVD_LMI_CTRL */
940 	tmp = RREG32_SOC15(VCN, vcn_inst, regUVD_LMI_CTRL);
941 	WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_CTRL, tmp |
942 		     UVD_LMI_CTRL__WRITE_CLEAN_TIMER_EN_MASK |
943 		     UVD_LMI_CTRL__MASK_MC_URGENT_MASK |
944 		     UVD_LMI_CTRL__DATA_COHERENCY_EN_MASK |
945 		     UVD_LMI_CTRL__VCPU_DATA_COHERENCY_EN_MASK);
946 
947 	vcn_v5_0_1_mc_resume(vinst);
948 
949 	/* VCN global tiling registers */
950 	WREG32_SOC15(VCN, vcn_inst, regUVD_GFX10_ADDR_CONFIG,
951 		     adev->gfx.config.gb_addr_config);
952 
953 	/* unblock VCPU register access */
954 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_RB_ARB_CTRL), 0,
955 		 ~UVD_RB_ARB_CTRL__VCPU_DIS_MASK);
956 
957 	/* release VCPU reset to boot */
958 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_VCPU_CNTL), 0,
959 		 ~UVD_VCPU_CNTL__BLK_RST_MASK);
960 
961 	for (j = 0; j < 10; ++j) {
962 		uint32_t status;
963 
964 		for (k = 0; k < 100; ++k) {
965 			status = RREG32_SOC15(VCN, vcn_inst, regUVD_STATUS);
966 			if (status & 2)
967 				break;
968 			mdelay(100);
969 			if (amdgpu_emu_mode == 1)
970 				msleep(20);
971 		}
972 
973 		if (amdgpu_emu_mode == 1) {
974 			r = -1;
975 			if (status & 2) {
976 				r = 0;
977 				break;
978 			}
979 		} else {
980 			r = 0;
981 			if (status & 2)
982 				break;
983 
984 			dev_err(adev->dev,
985 				"VCN[%d] is not responding, trying to reset the VCPU!!!\n", i);
986 			WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_VCPU_CNTL),
987 				 UVD_VCPU_CNTL__BLK_RST_MASK,
988 				 ~UVD_VCPU_CNTL__BLK_RST_MASK);
989 			mdelay(10);
990 			WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_VCPU_CNTL), 0,
991 				 ~UVD_VCPU_CNTL__BLK_RST_MASK);
992 
993 			mdelay(10);
994 			r = -1;
995 		}
996 	}
997 
998 	if (r) {
999 		dev_err(adev->dev, "VCN[%d] is not responding, giving up!!!\n", i);
1000 		return r;
1001 	}
1002 
1003 	/* enable master interrupt */
1004 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_MASTINT_EN),
1005 		 UVD_MASTINT_EN__VCPU_EN_MASK,
1006 		 ~UVD_MASTINT_EN__VCPU_EN_MASK);
1007 
1008 	/* clear the busy bit of VCN_STATUS */
1009 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_STATUS), 0,
1010 		 ~(2 << UVD_STATUS__VCPU_REPORT__SHIFT));
1011 
1012 	ring = &adev->vcn.inst[i].ring_enc[0];
1013 
1014 	WREG32_SOC15(VCN, vcn_inst, regVCN_RB1_DB_CTRL,
1015 		     ring->doorbell_index << VCN_RB1_DB_CTRL__OFFSET__SHIFT |
1016 		     VCN_RB1_DB_CTRL__EN_MASK);
1017 
1018 	/* Read DB_CTRL to flush the write DB_CTRL command. */
1019 	RREG32_SOC15(VCN, vcn_inst, regVCN_RB1_DB_CTRL);
1020 
1021 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_BASE_LO, ring->gpu_addr);
1022 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_BASE_HI, upper_32_bits(ring->gpu_addr));
1023 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_SIZE, ring->ring_size / 4);
1024 
1025 	tmp = RREG32_SOC15(VCN, vcn_inst, regVCN_RB_ENABLE);
1026 	tmp &= ~(VCN_RB_ENABLE__RB1_EN_MASK);
1027 	WREG32_SOC15(VCN, vcn_inst, regVCN_RB_ENABLE, tmp);
1028 	fw_shared->sq.queue_mode |= FW_QUEUE_RING_RESET;
1029 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_RPTR, 0);
1030 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_WPTR, 0);
1031 
1032 	tmp = RREG32_SOC15(VCN, vcn_inst, regUVD_RB_RPTR);
1033 	WREG32_SOC15(VCN, vcn_inst, regUVD_RB_WPTR, tmp);
1034 	ring->wptr = RREG32_SOC15(VCN, vcn_inst, regUVD_RB_WPTR);
1035 
1036 	tmp = RREG32_SOC15(VCN, vcn_inst, regVCN_RB_ENABLE);
1037 	tmp |= VCN_RB_ENABLE__RB1_EN_MASK;
1038 	WREG32_SOC15(VCN, vcn_inst, regVCN_RB_ENABLE, tmp);
1039 	fw_shared->sq.queue_mode &= ~(FW_QUEUE_RING_RESET | FW_QUEUE_DPG_HOLD_OFF);
1040 
1041 	/* Keeping one read-back to ensure all register writes are done,
1042 	 * otherwise it may introduce race conditions.
1043 	 */
1044 	RREG32_SOC15(VCN, vcn_inst, regUVD_STATUS);
1045 
1046 	return 0;
1047 }
1048 
1049 /**
1050  * vcn_v5_0_1_stop_dpg_mode - VCN stop with dpg mode
1051  *
1052  * @vinst: VCN instance
1053  *
1054  * Stop VCN block with dpg mode
1055  */
1056 static void vcn_v5_0_1_stop_dpg_mode(struct amdgpu_vcn_inst *vinst)
1057 {
1058 	struct amdgpu_device *adev = vinst->adev;
1059 	int inst_idx = vinst->inst;
1060 	uint32_t tmp;
1061 	int vcn_inst;
1062 	struct dpg_pause_state state = {.fw_based = VCN_DPG_STATE__UNPAUSE};
1063 
1064 	vcn_inst = GET_INST(VCN, inst_idx);
1065 
1066 	/* Unpause dpg */
1067 	vcn_v5_0_1_pause_dpg_mode(vinst, &state);
1068 
1069 	/* Wait for power status to be 1 */
1070 	SOC15_WAIT_ON_RREG(VCN, vcn_inst, regUVD_POWER_STATUS, 1,
1071 		UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);
1072 
1073 	/* wait for read ptr to be equal to write ptr */
1074 	tmp = RREG32_SOC15(VCN, vcn_inst, regUVD_RB_WPTR);
1075 	SOC15_WAIT_ON_RREG(VCN, vcn_inst, regUVD_RB_RPTR, tmp, 0xFFFFFFFF);
1076 
1077 	/* disable dynamic power gating mode */
1078 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_POWER_STATUS), 0,
1079 		~UVD_POWER_STATUS__UVD_PG_MODE_MASK);
1080 
1081 	/* Keeping one read-back to ensure all register writes are done,
1082 	 * otherwise it may introduce race conditions.
1083 	 */
1084 	RREG32_SOC15(VCN, vcn_inst, regUVD_STATUS);
1085 }
1086 
1087 /**
1088  * vcn_v5_0_1_stop - VCN stop
1089  *
1090  * @vinst: VCN instance
1091  *
1092  * Stop VCN block
1093  */
1094 static int vcn_v5_0_1_stop(struct amdgpu_vcn_inst *vinst)
1095 {
1096 	struct amdgpu_device *adev = vinst->adev;
1097 	int i = vinst->inst;
1098 	volatile struct amdgpu_vcn5_fw_shared *fw_shared;
1099 	uint32_t tmp;
1100 	int r = 0, vcn_inst;
1101 
1102 	vcn_inst = GET_INST(VCN, i);
1103 
1104 	fw_shared = adev->vcn.inst[i].fw_shared.cpu_addr;
1105 	fw_shared->sq.queue_mode |= FW_QUEUE_DPG_HOLD_OFF;
1106 
1107 	if (adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG) {
1108 		vcn_v5_0_1_stop_dpg_mode(vinst);
1109 		return 0;
1110 	}
1111 
1112 	/* wait for vcn idle */
1113 	r = SOC15_WAIT_ON_RREG(VCN, vcn_inst, regUVD_STATUS, UVD_STATUS__IDLE, 0x7);
1114 	if (r)
1115 		return r;
1116 
1117 	tmp = UVD_LMI_STATUS__VCPU_LMI_WRITE_CLEAN_MASK |
1118 		UVD_LMI_STATUS__READ_CLEAN_MASK |
1119 		UVD_LMI_STATUS__WRITE_CLEAN_MASK |
1120 		UVD_LMI_STATUS__WRITE_CLEAN_RAW_MASK;
1121 	r = SOC15_WAIT_ON_RREG(VCN, vcn_inst, regUVD_LMI_STATUS, tmp, tmp);
1122 	if (r)
1123 		return r;
1124 
1125 	/* disable LMI UMC channel */
1126 	tmp = RREG32_SOC15(VCN, vcn_inst, regUVD_LMI_CTRL2);
1127 	tmp |= UVD_LMI_CTRL2__STALL_ARB_UMC_MASK;
1128 	WREG32_SOC15(VCN, vcn_inst, regUVD_LMI_CTRL2, tmp);
1129 	tmp = UVD_LMI_STATUS__UMC_READ_CLEAN_RAW_MASK |
1130 		UVD_LMI_STATUS__UMC_WRITE_CLEAN_RAW_MASK;
1131 	r = SOC15_WAIT_ON_RREG(VCN, vcn_inst, regUVD_LMI_STATUS, tmp, tmp);
1132 	if (r)
1133 		return r;
1134 
1135 	/* block VCPU register access */
1136 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_RB_ARB_CTRL),
1137 		 UVD_RB_ARB_CTRL__VCPU_DIS_MASK,
1138 		 ~UVD_RB_ARB_CTRL__VCPU_DIS_MASK);
1139 
1140 	/* reset VCPU */
1141 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_VCPU_CNTL),
1142 		 UVD_VCPU_CNTL__BLK_RST_MASK,
1143 		 ~UVD_VCPU_CNTL__BLK_RST_MASK);
1144 
1145 	/* disable VCPU clock */
1146 	WREG32_P(SOC15_REG_OFFSET(VCN, vcn_inst, regUVD_VCPU_CNTL), 0,
1147 		 ~(UVD_VCPU_CNTL__CLK_EN_MASK));
1148 
1149 	/* apply soft reset */
1150 	tmp = RREG32_SOC15(VCN, vcn_inst, regUVD_SOFT_RESET);
1151 	tmp |= UVD_SOFT_RESET__LMI_UMC_SOFT_RESET_MASK;
1152 	WREG32_SOC15(VCN, vcn_inst, regUVD_SOFT_RESET, tmp);
1153 	tmp = RREG32_SOC15(VCN, vcn_inst, regUVD_SOFT_RESET);
1154 	tmp |= UVD_SOFT_RESET__LMI_SOFT_RESET_MASK;
1155 	WREG32_SOC15(VCN, vcn_inst, regUVD_SOFT_RESET, tmp);
1156 
1157 	/* clear status */
1158 	WREG32_SOC15(VCN, vcn_inst, regUVD_STATUS, 0);
1159 
1160 	/* Keeping one read-back to ensure all register writes are done,
1161 	 * otherwise it may introduce race conditions.
1162 	 */
1163 	RREG32_SOC15(VCN, vcn_inst, regUVD_STATUS);
1164 
1165 	return 0;
1166 }
1167 
1168 /**
1169  * vcn_v5_0_1_unified_ring_get_rptr - get unified read pointer
1170  *
1171  * @ring: amdgpu_ring pointer
1172  *
1173  * Returns the current hardware unified read pointer
1174  */
1175 static uint64_t vcn_v5_0_1_unified_ring_get_rptr(struct amdgpu_ring *ring)
1176 {
1177 	struct amdgpu_device *adev = ring->adev;
1178 
1179 	if (ring != &adev->vcn.inst[ring->me].ring_enc[0])
1180 		DRM_ERROR("wrong ring id is identified in %s", __func__);
1181 
1182 	return RREG32_SOC15(VCN, GET_INST(VCN, ring->me), regUVD_RB_RPTR);
1183 }
1184 
1185 /**
1186  * vcn_v5_0_1_unified_ring_get_wptr - get unified write pointer
1187  *
1188  * @ring: amdgpu_ring pointer
1189  *
1190  * Returns the current hardware unified write pointer
1191  */
1192 static uint64_t vcn_v5_0_1_unified_ring_get_wptr(struct amdgpu_ring *ring)
1193 {
1194 	struct amdgpu_device *adev = ring->adev;
1195 
1196 	if (ring != &adev->vcn.inst[ring->me].ring_enc[0])
1197 		DRM_ERROR("wrong ring id is identified in %s", __func__);
1198 
1199 	if (ring->use_doorbell)
1200 		return *ring->wptr_cpu_addr;
1201 	else
1202 		return RREG32_SOC15(VCN, GET_INST(VCN, ring->me), regUVD_RB_WPTR);
1203 }
1204 
1205 /**
1206  * vcn_v5_0_1_unified_ring_set_wptr - set enc write pointer
1207  *
1208  * @ring: amdgpu_ring pointer
1209  *
1210  * Commits the enc write pointer to the hardware
1211  */
1212 static void vcn_v5_0_1_unified_ring_set_wptr(struct amdgpu_ring *ring)
1213 {
1214 	struct amdgpu_device *adev = ring->adev;
1215 
1216 	if (ring != &adev->vcn.inst[ring->me].ring_enc[0])
1217 		DRM_ERROR("wrong ring id is identified in %s", __func__);
1218 
1219 	if (ring->use_doorbell) {
1220 		*ring->wptr_cpu_addr = lower_32_bits(ring->wptr);
1221 		WDOORBELL32(ring->doorbell_index, lower_32_bits(ring->wptr));
1222 	} else {
1223 		WREG32_SOC15(VCN, GET_INST(VCN, ring->me), regUVD_RB_WPTR,
1224 				lower_32_bits(ring->wptr));
1225 	}
1226 }
1227 
1228 static const struct amdgpu_ring_funcs vcn_v5_0_1_unified_ring_vm_funcs = {
1229 	.type = AMDGPU_RING_TYPE_VCN_ENC,
1230 	.align_mask = 0x3f,
1231 	.nop = VCN_ENC_CMD_NO_OP,
1232 	.get_rptr = vcn_v5_0_1_unified_ring_get_rptr,
1233 	.get_wptr = vcn_v5_0_1_unified_ring_get_wptr,
1234 	.set_wptr = vcn_v5_0_1_unified_ring_set_wptr,
1235 	.emit_frame_size = SOC15_FLUSH_GPU_TLB_NUM_WREG * 3 +
1236 			   SOC15_FLUSH_GPU_TLB_NUM_REG_WAIT * 4 +
1237 			   4 + /* vcn_v2_0_enc_ring_emit_vm_flush */
1238 			   5 +
1239 			   5 + /* vcn_v2_0_enc_ring_emit_fence x2 vm fence */
1240 			   1, /* vcn_v2_0_enc_ring_insert_end */
1241 	.emit_ib_size = 5, /* vcn_v2_0_enc_ring_emit_ib */
1242 	.emit_ib = vcn_v2_0_enc_ring_emit_ib,
1243 	.emit_fence = vcn_v2_0_enc_ring_emit_fence,
1244 	.emit_vm_flush = vcn_v4_0_3_enc_ring_emit_vm_flush,
1245 	.emit_hdp_flush = vcn_v4_0_3_ring_emit_hdp_flush,
1246 	.test_ring = amdgpu_vcn_enc_ring_test_ring,
1247 	.test_ib = amdgpu_vcn_unified_ring_test_ib,
1248 	.insert_nop = amdgpu_ring_insert_nop,
1249 	.insert_end = vcn_v2_0_enc_ring_insert_end,
1250 	.pad_ib = amdgpu_ring_generic_pad_ib,
1251 	.begin_use = amdgpu_vcn_ring_begin_use,
1252 	.end_use = amdgpu_vcn_ring_end_use,
1253 	.emit_wreg = vcn_v4_0_3_enc_ring_emit_wreg,
1254 	.emit_reg_wait = vcn_v4_0_3_enc_ring_emit_reg_wait,
1255 	.emit_reg_write_reg_wait = amdgpu_ring_emit_reg_write_reg_wait_helper,
1256 };
1257 
1258 /**
1259  * vcn_v5_0_1_set_unified_ring_funcs - set unified ring functions
1260  *
1261  * @adev: amdgpu_device pointer
1262  *
1263  * Set unified ring functions
1264  */
1265 static void vcn_v5_0_1_set_unified_ring_funcs(struct amdgpu_device *adev)
1266 {
1267 	int i, vcn_inst;
1268 
1269 	for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
1270 		adev->vcn.inst[i].ring_enc[0].funcs = &vcn_v5_0_1_unified_ring_vm_funcs;
1271 		adev->vcn.inst[i].ring_enc[0].me = i;
1272 		vcn_inst = GET_INST(VCN, i);
1273 		adev->vcn.inst[i].aid_id = vcn_inst / adev->vcn.num_inst_per_aid;
1274 	}
1275 }
1276 
1277 /**
1278  * vcn_v5_0_1_is_idle - check VCN block is idle
1279  *
1280  * @ip_block: Pointer to the amdgpu_ip_block structure
1281  *
1282  * Check whether VCN block is idle
1283  */
1284 static bool vcn_v5_0_1_is_idle(struct amdgpu_ip_block *ip_block)
1285 {
1286 	struct amdgpu_device *adev = ip_block->adev;
1287 	int i, ret = 1;
1288 
1289 	for (i = 0; i < adev->vcn.num_vcn_inst; ++i)
1290 		ret &= (RREG32_SOC15(VCN, GET_INST(VCN, i), regUVD_STATUS) == UVD_STATUS__IDLE);
1291 
1292 	return ret;
1293 }
1294 
1295 /**
1296  * vcn_v5_0_1_wait_for_idle - wait for VCN block idle
1297  *
1298  * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
1299  *
1300  * Wait for VCN block idle
1301  */
1302 static int vcn_v5_0_1_wait_for_idle(struct amdgpu_ip_block *ip_block)
1303 {
1304 	struct amdgpu_device *adev = ip_block->adev;
1305 	int i, ret = 0;
1306 
1307 	for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
1308 		ret = SOC15_WAIT_ON_RREG(VCN, GET_INST(VCN, i), regUVD_STATUS, UVD_STATUS__IDLE,
1309 			UVD_STATUS__IDLE);
1310 		if (ret)
1311 			return ret;
1312 	}
1313 
1314 	return ret;
1315 }
1316 
1317 /**
1318  * vcn_v5_0_1_set_clockgating_state - set VCN block clockgating state
1319  *
1320  * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
1321  * @state: clock gating state
1322  *
1323  * Set VCN block clockgating state
1324  */
1325 static int vcn_v5_0_1_set_clockgating_state(struct amdgpu_ip_block *ip_block,
1326 					    enum amd_clockgating_state state)
1327 {
1328 	struct amdgpu_device *adev = ip_block->adev;
1329 	bool enable = state == AMD_CG_STATE_GATE;
1330 	int i;
1331 
1332 	for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
1333 		struct amdgpu_vcn_inst *vinst = &adev->vcn.inst[i];
1334 
1335 		if (enable) {
1336 			if (RREG32_SOC15(VCN, GET_INST(VCN, i), regUVD_STATUS) != UVD_STATUS__IDLE)
1337 				return -EBUSY;
1338 			vcn_v5_0_1_enable_clock_gating(vinst);
1339 		} else {
1340 			vcn_v5_0_1_disable_clock_gating(vinst);
1341 		}
1342 	}
1343 
1344 	return 0;
1345 }
1346 
1347 static int vcn_v5_0_1_set_pg_state(struct amdgpu_vcn_inst *vinst,
1348 				   enum amd_powergating_state state)
1349 {
1350 	struct amdgpu_device *adev = vinst->adev;
1351 	int ret = 0;
1352 
1353 	/* for SRIOV, guest should not control VCN Power-gating
1354 	 * MMSCH FW should control Power-gating and clock-gating
1355 	 * guest should avoid touching CGC and PG
1356 	 */
1357 	if (amdgpu_sriov_vf(adev)) {
1358 		vinst->cur_state = AMD_PG_STATE_UNGATE;
1359 		return 0;
1360 	}
1361 
1362 	if (state == vinst->cur_state)
1363 		return 0;
1364 
1365 	if (state == AMD_PG_STATE_GATE)
1366 		ret = vcn_v5_0_1_stop(vinst);
1367 	else
1368 		ret = vcn_v5_0_1_start(vinst);
1369 
1370 	if (!ret)
1371 		vinst->cur_state = state;
1372 
1373 	return ret;
1374 }
1375 
1376 /**
1377  * vcn_v5_0_1_process_interrupt - process VCN block interrupt
1378  *
1379  * @adev: amdgpu_device pointer
1380  * @source: interrupt sources
1381  * @entry: interrupt entry from clients and sources
1382  *
1383  * Process VCN block interrupt
1384  */
1385 static int vcn_v5_0_1_process_interrupt(struct amdgpu_device *adev, struct amdgpu_irq_src *source,
1386 	struct amdgpu_iv_entry *entry)
1387 {
1388 	uint32_t i, inst;
1389 
1390 	i = node_id_to_phys_map[entry->node_id];
1391 
1392 	DRM_DEV_DEBUG(adev->dev, "IH: VCN TRAP\n");
1393 
1394 	for (inst = 0; inst < adev->vcn.num_vcn_inst; ++inst)
1395 		if (adev->vcn.inst[inst].aid_id == i)
1396 			break;
1397 	if (inst >= adev->vcn.num_vcn_inst) {
1398 		dev_WARN_ONCE(adev->dev, 1,
1399 				"Interrupt received for unknown VCN instance %d",
1400 				entry->node_id);
1401 		return 0;
1402 	}
1403 
1404 	switch (entry->src_id) {
1405 	case VCN_5_0__SRCID__UVD_ENC_GENERAL_PURPOSE:
1406 		amdgpu_fence_process(&adev->vcn.inst[inst].ring_enc[0]);
1407 		break;
1408 	default:
1409 		DRM_DEV_ERROR(adev->dev, "Unhandled interrupt: %d %d\n",
1410 			  entry->src_id, entry->src_data[0]);
1411 		break;
1412 	}
1413 
1414 	return 0;
1415 }
1416 
1417 static int vcn_v5_0_1_set_ras_interrupt_state(struct amdgpu_device *adev,
1418 					struct amdgpu_irq_src *source,
1419 					unsigned int type,
1420 					enum amdgpu_interrupt_state state)
1421 {
1422 	return 0;
1423 }
1424 
1425 static const struct amdgpu_irq_src_funcs vcn_v5_0_1_irq_funcs = {
1426 	.process = vcn_v5_0_1_process_interrupt,
1427 };
1428 
1429 static const struct amdgpu_irq_src_funcs vcn_v5_0_1_ras_irq_funcs = {
1430 	.set = vcn_v5_0_1_set_ras_interrupt_state,
1431 	.process = amdgpu_vcn_process_poison_irq,
1432 };
1433 
1434 
1435 /**
1436  * vcn_v5_0_1_set_irq_funcs - set VCN block interrupt irq functions
1437  *
1438  * @adev: amdgpu_device pointer
1439  *
1440  * Set VCN block interrupt irq functions
1441  */
1442 static void vcn_v5_0_1_set_irq_funcs(struct amdgpu_device *adev)
1443 {
1444 	int i;
1445 
1446 	for (i = 0; i < adev->vcn.num_vcn_inst; ++i)
1447 		adev->vcn.inst->irq.num_types++;
1448 
1449 	adev->vcn.inst->irq.funcs = &vcn_v5_0_1_irq_funcs;
1450 
1451 	adev->vcn.inst->ras_poison_irq.num_types = 1;
1452 	adev->vcn.inst->ras_poison_irq.funcs = &vcn_v5_0_1_ras_irq_funcs;
1453 
1454 }
1455 
1456 static const struct amd_ip_funcs vcn_v5_0_1_ip_funcs = {
1457 	.name = "vcn_v5_0_1",
1458 	.early_init = vcn_v5_0_1_early_init,
1459 	.late_init = NULL,
1460 	.sw_init = vcn_v5_0_1_sw_init,
1461 	.sw_fini = vcn_v5_0_1_sw_fini,
1462 	.hw_init = vcn_v5_0_1_hw_init,
1463 	.hw_fini = vcn_v5_0_1_hw_fini,
1464 	.suspend = vcn_v5_0_1_suspend,
1465 	.resume = vcn_v5_0_1_resume,
1466 	.is_idle = vcn_v5_0_1_is_idle,
1467 	.wait_for_idle = vcn_v5_0_1_wait_for_idle,
1468 	.check_soft_reset = NULL,
1469 	.pre_soft_reset = NULL,
1470 	.soft_reset = NULL,
1471 	.post_soft_reset = NULL,
1472 	.set_clockgating_state = vcn_v5_0_1_set_clockgating_state,
1473 	.set_powergating_state = vcn_set_powergating_state,
1474 	.dump_ip_state = vcn_v5_0_0_dump_ip_state,
1475 	.print_ip_state = vcn_v5_0_0_print_ip_state,
1476 };
1477 
1478 const struct amdgpu_ip_block_version vcn_v5_0_1_ip_block = {
1479 	.type = AMD_IP_BLOCK_TYPE_VCN,
1480 	.major = 5,
1481 	.minor = 0,
1482 	.rev = 1,
1483 	.funcs = &vcn_v5_0_1_ip_funcs,
1484 };
1485 
1486 static uint32_t vcn_v5_0_1_query_poison_by_instance(struct amdgpu_device *adev,
1487 			uint32_t instance, uint32_t sub_block)
1488 {
1489 	uint32_t poison_stat = 0, reg_value = 0;
1490 
1491 	switch (sub_block) {
1492 	case AMDGPU_VCN_V5_0_1_VCPU_VCODEC:
1493 		reg_value = RREG32_SOC15(VCN, instance, regUVD_RAS_VCPU_VCODEC_STATUS);
1494 		poison_stat = REG_GET_FIELD(reg_value, UVD_RAS_VCPU_VCODEC_STATUS, POISONED_PF);
1495 		break;
1496 	default:
1497 		break;
1498 	}
1499 
1500 	if (poison_stat)
1501 		dev_info(adev->dev, "Poison detected in VCN%d, sub_block%d\n",
1502 			instance, sub_block);
1503 
1504 	return poison_stat;
1505 }
1506 
1507 static bool vcn_v5_0_1_query_poison_status(struct amdgpu_device *adev)
1508 {
1509 	uint32_t inst, sub;
1510 	uint32_t poison_stat = 0;
1511 
1512 	for (inst = 0; inst < adev->vcn.num_vcn_inst; inst++)
1513 		for (sub = 0; sub < AMDGPU_VCN_V5_0_1_MAX_SUB_BLOCK; sub++)
1514 			poison_stat +=
1515 			vcn_v5_0_1_query_poison_by_instance(adev, inst, sub);
1516 
1517 	return !!poison_stat;
1518 }
1519 
1520 static const struct amdgpu_ras_block_hw_ops vcn_v5_0_1_ras_hw_ops = {
1521 	.query_poison_status = vcn_v5_0_1_query_poison_status,
1522 };
1523 
1524 static int vcn_v5_0_1_aca_bank_parser(struct aca_handle *handle, struct aca_bank *bank,
1525 				      enum aca_smu_type type, void *data)
1526 {
1527 	struct aca_bank_info info;
1528 	u64 misc0;
1529 	int ret;
1530 
1531 	ret = aca_bank_info_decode(bank, &info);
1532 	if (ret)
1533 		return ret;
1534 
1535 	misc0 = bank->regs[ACA_REG_IDX_MISC0];
1536 	switch (type) {
1537 	case ACA_SMU_TYPE_UE:
1538 		bank->aca_err_type = ACA_ERROR_TYPE_UE;
1539 		ret = aca_error_cache_log_bank_error(handle, &info, ACA_ERROR_TYPE_UE,
1540 						     1ULL);
1541 		break;
1542 	case ACA_SMU_TYPE_CE:
1543 		bank->aca_err_type = ACA_ERROR_TYPE_CE;
1544 		ret = aca_error_cache_log_bank_error(handle, &info, bank->aca_err_type,
1545 						     ACA_REG__MISC0__ERRCNT(misc0));
1546 		break;
1547 	default:
1548 		return -EINVAL;
1549 	}
1550 
1551 	return ret;
1552 }
1553 
1554 /* reference to smu driver if header file */
1555 static int vcn_v5_0_1_err_codes[] = {
1556 	14, 15, /* VCN */
1557 };
1558 
1559 static bool vcn_v5_0_1_aca_bank_is_valid(struct aca_handle *handle, struct aca_bank *bank,
1560 					 enum aca_smu_type type, void *data)
1561 {
1562 	u32 instlo;
1563 
1564 	instlo = ACA_REG__IPID__INSTANCEIDLO(bank->regs[ACA_REG_IDX_IPID]);
1565 	instlo &= GENMASK(31, 1);
1566 
1567 	if (instlo != mmSMNAID_AID0_MCA_SMU)
1568 		return false;
1569 
1570 	if (aca_bank_check_error_codes(handle->adev, bank,
1571 				       vcn_v5_0_1_err_codes,
1572 				       ARRAY_SIZE(vcn_v5_0_1_err_codes)))
1573 		return false;
1574 
1575 	return true;
1576 }
1577 
1578 static const struct aca_bank_ops vcn_v5_0_1_aca_bank_ops = {
1579 	.aca_bank_parser = vcn_v5_0_1_aca_bank_parser,
1580 	.aca_bank_is_valid = vcn_v5_0_1_aca_bank_is_valid,
1581 };
1582 
1583 static const struct aca_info vcn_v5_0_1_aca_info = {
1584 	.hwip = ACA_HWIP_TYPE_SMU,
1585 	.mask = ACA_ERROR_UE_MASK,
1586 	.bank_ops = &vcn_v5_0_1_aca_bank_ops,
1587 };
1588 
1589 static int vcn_v5_0_1_ras_late_init(struct amdgpu_device *adev, struct ras_common_if *ras_block)
1590 {
1591 	int r;
1592 
1593 	r = amdgpu_ras_block_late_init(adev, ras_block);
1594 	if (r)
1595 		return r;
1596 
1597 	r = amdgpu_ras_bind_aca(adev, AMDGPU_RAS_BLOCK__VCN,
1598 				&vcn_v5_0_1_aca_info, NULL);
1599 	if (r)
1600 		goto late_fini;
1601 
1602 	return 0;
1603 
1604 late_fini:
1605 	amdgpu_ras_block_late_fini(adev, ras_block);
1606 
1607 	return r;
1608 }
1609 
1610 static struct amdgpu_vcn_ras vcn_v5_0_1_ras = {
1611 	.ras_block = {
1612 		.hw_ops = &vcn_v5_0_1_ras_hw_ops,
1613 		.ras_late_init = vcn_v5_0_1_ras_late_init,
1614 	},
1615 };
1616 
1617 static void vcn_v5_0_1_set_ras_funcs(struct amdgpu_device *adev)
1618 {
1619 	adev->vcn.ras = &vcn_v5_0_1_ras;
1620 }
1621