xref: /openbmc/linux/drivers/gpu/drm/amd/amdgpu/uvd_v7_0.c (revision 8795a739)
1 /*
2  * Copyright 2016 Advanced Micro Devices, Inc.
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 
26 #include "amdgpu.h"
27 #include "amdgpu_uvd.h"
28 #include "soc15.h"
29 #include "soc15d.h"
30 #include "soc15_common.h"
31 #include "mmsch_v1_0.h"
32 
33 #include "uvd/uvd_7_0_offset.h"
34 #include "uvd/uvd_7_0_sh_mask.h"
35 #include "vce/vce_4_0_offset.h"
36 #include "vce/vce_4_0_default.h"
37 #include "vce/vce_4_0_sh_mask.h"
38 #include "nbif/nbif_6_1_offset.h"
39 #include "hdp/hdp_4_0_offset.h"
40 #include "mmhub/mmhub_1_0_offset.h"
41 #include "mmhub/mmhub_1_0_sh_mask.h"
42 #include "ivsrcid/uvd/irqsrcs_uvd_7_0.h"
43 
44 #define mmUVD_PG0_CC_UVD_HARVESTING                                                                    0x00c7
45 #define mmUVD_PG0_CC_UVD_HARVESTING_BASE_IDX                                                           1
46 //UVD_PG0_CC_UVD_HARVESTING
47 #define UVD_PG0_CC_UVD_HARVESTING__UVD_DISABLE__SHIFT                                                         0x1
48 #define UVD_PG0_CC_UVD_HARVESTING__UVD_DISABLE_MASK                                                           0x00000002L
49 
50 #define UVD7_MAX_HW_INSTANCES_VEGA20			2
51 
52 static void uvd_v7_0_set_ring_funcs(struct amdgpu_device *adev);
53 static void uvd_v7_0_set_enc_ring_funcs(struct amdgpu_device *adev);
54 static void uvd_v7_0_set_irq_funcs(struct amdgpu_device *adev);
55 static int uvd_v7_0_start(struct amdgpu_device *adev);
56 static void uvd_v7_0_stop(struct amdgpu_device *adev);
57 static int uvd_v7_0_sriov_start(struct amdgpu_device *adev);
58 
59 static int amdgpu_ih_clientid_uvds[] = {
60 	SOC15_IH_CLIENTID_UVD,
61 	SOC15_IH_CLIENTID_UVD1
62 };
63 
64 /**
65  * uvd_v7_0_ring_get_rptr - get read pointer
66  *
67  * @ring: amdgpu_ring pointer
68  *
69  * Returns the current hardware read pointer
70  */
71 static uint64_t uvd_v7_0_ring_get_rptr(struct amdgpu_ring *ring)
72 {
73 	struct amdgpu_device *adev = ring->adev;
74 
75 	return RREG32_SOC15(UVD, ring->me, mmUVD_RBC_RB_RPTR);
76 }
77 
78 /**
79  * uvd_v7_0_enc_ring_get_rptr - get enc read pointer
80  *
81  * @ring: amdgpu_ring pointer
82  *
83  * Returns the current hardware enc read pointer
84  */
85 static uint64_t uvd_v7_0_enc_ring_get_rptr(struct amdgpu_ring *ring)
86 {
87 	struct amdgpu_device *adev = ring->adev;
88 
89 	if (ring == &adev->uvd.inst[ring->me].ring_enc[0])
90 		return RREG32_SOC15(UVD, ring->me, mmUVD_RB_RPTR);
91 	else
92 		return RREG32_SOC15(UVD, ring->me, mmUVD_RB_RPTR2);
93 }
94 
95 /**
96  * uvd_v7_0_ring_get_wptr - get write pointer
97  *
98  * @ring: amdgpu_ring pointer
99  *
100  * Returns the current hardware write pointer
101  */
102 static uint64_t uvd_v7_0_ring_get_wptr(struct amdgpu_ring *ring)
103 {
104 	struct amdgpu_device *adev = ring->adev;
105 
106 	return RREG32_SOC15(UVD, ring->me, mmUVD_RBC_RB_WPTR);
107 }
108 
109 /**
110  * uvd_v7_0_enc_ring_get_wptr - get enc write pointer
111  *
112  * @ring: amdgpu_ring pointer
113  *
114  * Returns the current hardware enc write pointer
115  */
116 static uint64_t uvd_v7_0_enc_ring_get_wptr(struct amdgpu_ring *ring)
117 {
118 	struct amdgpu_device *adev = ring->adev;
119 
120 	if (ring->use_doorbell)
121 		return adev->wb.wb[ring->wptr_offs];
122 
123 	if (ring == &adev->uvd.inst[ring->me].ring_enc[0])
124 		return RREG32_SOC15(UVD, ring->me, mmUVD_RB_WPTR);
125 	else
126 		return RREG32_SOC15(UVD, ring->me, mmUVD_RB_WPTR2);
127 }
128 
129 /**
130  * uvd_v7_0_ring_set_wptr - set write pointer
131  *
132  * @ring: amdgpu_ring pointer
133  *
134  * Commits the write pointer to the hardware
135  */
136 static void uvd_v7_0_ring_set_wptr(struct amdgpu_ring *ring)
137 {
138 	struct amdgpu_device *adev = ring->adev;
139 
140 	WREG32_SOC15(UVD, ring->me, mmUVD_RBC_RB_WPTR, lower_32_bits(ring->wptr));
141 }
142 
143 /**
144  * uvd_v7_0_enc_ring_set_wptr - set enc write pointer
145  *
146  * @ring: amdgpu_ring pointer
147  *
148  * Commits the enc write pointer to the hardware
149  */
150 static void uvd_v7_0_enc_ring_set_wptr(struct amdgpu_ring *ring)
151 {
152 	struct amdgpu_device *adev = ring->adev;
153 
154 	if (ring->use_doorbell) {
155 		/* XXX check if swapping is necessary on BE */
156 		adev->wb.wb[ring->wptr_offs] = lower_32_bits(ring->wptr);
157 		WDOORBELL32(ring->doorbell_index, lower_32_bits(ring->wptr));
158 		return;
159 	}
160 
161 	if (ring == &adev->uvd.inst[ring->me].ring_enc[0])
162 		WREG32_SOC15(UVD, ring->me, mmUVD_RB_WPTR,
163 			lower_32_bits(ring->wptr));
164 	else
165 		WREG32_SOC15(UVD, ring->me, mmUVD_RB_WPTR2,
166 			lower_32_bits(ring->wptr));
167 }
168 
169 /**
170  * uvd_v7_0_enc_ring_test_ring - test if UVD ENC ring is working
171  *
172  * @ring: the engine to test on
173  *
174  */
175 static int uvd_v7_0_enc_ring_test_ring(struct amdgpu_ring *ring)
176 {
177 	struct amdgpu_device *adev = ring->adev;
178 	uint32_t rptr;
179 	unsigned i;
180 	int r;
181 
182 	if (amdgpu_sriov_vf(adev))
183 		return 0;
184 
185 	r = amdgpu_ring_alloc(ring, 16);
186 	if (r)
187 		return r;
188 
189 	rptr = amdgpu_ring_get_rptr(ring);
190 
191 	amdgpu_ring_write(ring, HEVC_ENC_CMD_END);
192 	amdgpu_ring_commit(ring);
193 
194 	for (i = 0; i < adev->usec_timeout; i++) {
195 		if (amdgpu_ring_get_rptr(ring) != rptr)
196 			break;
197 		udelay(1);
198 	}
199 
200 	if (i >= adev->usec_timeout)
201 		r = -ETIMEDOUT;
202 
203 	return r;
204 }
205 
206 /**
207  * uvd_v7_0_enc_get_create_msg - generate a UVD ENC create msg
208  *
209  * @adev: amdgpu_device pointer
210  * @ring: ring we should submit the msg to
211  * @handle: session handle to use
212  * @fence: optional fence to return
213  *
214  * Open up a stream for HW test
215  */
216 static int uvd_v7_0_enc_get_create_msg(struct amdgpu_ring *ring, uint32_t handle,
217 				       struct dma_fence **fence)
218 {
219 	const unsigned ib_size_dw = 16;
220 	struct amdgpu_job *job;
221 	struct amdgpu_ib *ib;
222 	struct dma_fence *f = NULL;
223 	uint64_t dummy;
224 	int i, r;
225 
226 	r = amdgpu_job_alloc_with_ib(ring->adev, ib_size_dw * 4, &job);
227 	if (r)
228 		return r;
229 
230 	ib = &job->ibs[0];
231 	dummy = ib->gpu_addr + 1024;
232 
233 	ib->length_dw = 0;
234 	ib->ptr[ib->length_dw++] = 0x00000018;
235 	ib->ptr[ib->length_dw++] = 0x00000001; /* session info */
236 	ib->ptr[ib->length_dw++] = handle;
237 	ib->ptr[ib->length_dw++] = 0x00000000;
238 	ib->ptr[ib->length_dw++] = upper_32_bits(dummy);
239 	ib->ptr[ib->length_dw++] = dummy;
240 
241 	ib->ptr[ib->length_dw++] = 0x00000014;
242 	ib->ptr[ib->length_dw++] = 0x00000002; /* task info */
243 	ib->ptr[ib->length_dw++] = 0x0000001c;
244 	ib->ptr[ib->length_dw++] = 0x00000000;
245 	ib->ptr[ib->length_dw++] = 0x00000000;
246 
247 	ib->ptr[ib->length_dw++] = 0x00000008;
248 	ib->ptr[ib->length_dw++] = 0x08000001; /* op initialize */
249 
250 	for (i = ib->length_dw; i < ib_size_dw; ++i)
251 		ib->ptr[i] = 0x0;
252 
253 	r = amdgpu_job_submit_direct(job, ring, &f);
254 	if (r)
255 		goto err;
256 
257 	if (fence)
258 		*fence = dma_fence_get(f);
259 	dma_fence_put(f);
260 	return 0;
261 
262 err:
263 	amdgpu_job_free(job);
264 	return r;
265 }
266 
267 /**
268  * uvd_v7_0_enc_get_destroy_msg - generate a UVD ENC destroy msg
269  *
270  * @adev: amdgpu_device pointer
271  * @ring: ring we should submit the msg to
272  * @handle: session handle to use
273  * @fence: optional fence to return
274  *
275  * Close up a stream for HW test or if userspace failed to do so
276  */
277 static int uvd_v7_0_enc_get_destroy_msg(struct amdgpu_ring *ring, uint32_t handle,
278 				struct dma_fence **fence)
279 {
280 	const unsigned ib_size_dw = 16;
281 	struct amdgpu_job *job;
282 	struct amdgpu_ib *ib;
283 	struct dma_fence *f = NULL;
284 	uint64_t dummy;
285 	int i, r;
286 
287 	r = amdgpu_job_alloc_with_ib(ring->adev, ib_size_dw * 4, &job);
288 	if (r)
289 		return r;
290 
291 	ib = &job->ibs[0];
292 	dummy = ib->gpu_addr + 1024;
293 
294 	ib->length_dw = 0;
295 	ib->ptr[ib->length_dw++] = 0x00000018;
296 	ib->ptr[ib->length_dw++] = 0x00000001;
297 	ib->ptr[ib->length_dw++] = handle;
298 	ib->ptr[ib->length_dw++] = 0x00000000;
299 	ib->ptr[ib->length_dw++] = upper_32_bits(dummy);
300 	ib->ptr[ib->length_dw++] = dummy;
301 
302 	ib->ptr[ib->length_dw++] = 0x00000014;
303 	ib->ptr[ib->length_dw++] = 0x00000002;
304 	ib->ptr[ib->length_dw++] = 0x0000001c;
305 	ib->ptr[ib->length_dw++] = 0x00000000;
306 	ib->ptr[ib->length_dw++] = 0x00000000;
307 
308 	ib->ptr[ib->length_dw++] = 0x00000008;
309 	ib->ptr[ib->length_dw++] = 0x08000002; /* op close session */
310 
311 	for (i = ib->length_dw; i < ib_size_dw; ++i)
312 		ib->ptr[i] = 0x0;
313 
314 	r = amdgpu_job_submit_direct(job, ring, &f);
315 	if (r)
316 		goto err;
317 
318 	if (fence)
319 		*fence = dma_fence_get(f);
320 	dma_fence_put(f);
321 	return 0;
322 
323 err:
324 	amdgpu_job_free(job);
325 	return r;
326 }
327 
328 /**
329  * uvd_v7_0_enc_ring_test_ib - test if UVD ENC IBs are working
330  *
331  * @ring: the engine to test on
332  *
333  */
334 static int uvd_v7_0_enc_ring_test_ib(struct amdgpu_ring *ring, long timeout)
335 {
336 	struct dma_fence *fence = NULL;
337 	long r;
338 
339 	r = uvd_v7_0_enc_get_create_msg(ring, 1, NULL);
340 	if (r)
341 		goto error;
342 
343 	r = uvd_v7_0_enc_get_destroy_msg(ring, 1, &fence);
344 	if (r)
345 		goto error;
346 
347 	r = dma_fence_wait_timeout(fence, false, timeout);
348 	if (r == 0)
349 		r = -ETIMEDOUT;
350 	else if (r > 0)
351 		r = 0;
352 
353 error:
354 	dma_fence_put(fence);
355 	return r;
356 }
357 
358 static int uvd_v7_0_early_init(void *handle)
359 {
360 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
361 
362 	if (adev->asic_type == CHIP_VEGA20) {
363 		u32 harvest;
364 		int i;
365 
366 		adev->uvd.num_uvd_inst = UVD7_MAX_HW_INSTANCES_VEGA20;
367 		for (i = 0; i < adev->uvd.num_uvd_inst; i++) {
368 			harvest = RREG32_SOC15(UVD, i, mmUVD_PG0_CC_UVD_HARVESTING);
369 			if (harvest & UVD_PG0_CC_UVD_HARVESTING__UVD_DISABLE_MASK) {
370 				adev->uvd.harvest_config |= 1 << i;
371 			}
372 		}
373 		if (adev->uvd.harvest_config == (AMDGPU_UVD_HARVEST_UVD0 |
374 						 AMDGPU_UVD_HARVEST_UVD1))
375 			/* both instances are harvested, disable the block */
376 			return -ENOENT;
377 	} else {
378 		adev->uvd.num_uvd_inst = 1;
379 	}
380 
381 	if (amdgpu_sriov_vf(adev))
382 		adev->uvd.num_enc_rings = 1;
383 	else
384 		adev->uvd.num_enc_rings = 2;
385 	uvd_v7_0_set_ring_funcs(adev);
386 	uvd_v7_0_set_enc_ring_funcs(adev);
387 	uvd_v7_0_set_irq_funcs(adev);
388 
389 	return 0;
390 }
391 
392 static int uvd_v7_0_sw_init(void *handle)
393 {
394 	struct amdgpu_ring *ring;
395 
396 	int i, j, r;
397 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
398 
399 	for (j = 0; j < adev->uvd.num_uvd_inst; j++) {
400 		if (adev->uvd.harvest_config & (1 << j))
401 			continue;
402 		/* UVD TRAP */
403 		r = amdgpu_irq_add_id(adev, amdgpu_ih_clientid_uvds[j], UVD_7_0__SRCID__UVD_SYSTEM_MESSAGE_INTERRUPT, &adev->uvd.inst[j].irq);
404 		if (r)
405 			return r;
406 
407 		/* UVD ENC TRAP */
408 		for (i = 0; i < adev->uvd.num_enc_rings; ++i) {
409 			r = amdgpu_irq_add_id(adev, amdgpu_ih_clientid_uvds[j], i + UVD_7_0__SRCID__UVD_ENC_GEN_PURP, &adev->uvd.inst[j].irq);
410 			if (r)
411 				return r;
412 		}
413 	}
414 
415 	r = amdgpu_uvd_sw_init(adev);
416 	if (r)
417 		return r;
418 
419 	if (adev->firmware.load_type == AMDGPU_FW_LOAD_PSP) {
420 		const struct common_firmware_header *hdr;
421 		hdr = (const struct common_firmware_header *)adev->uvd.fw->data;
422 		adev->firmware.ucode[AMDGPU_UCODE_ID_UVD].ucode_id = AMDGPU_UCODE_ID_UVD;
423 		adev->firmware.ucode[AMDGPU_UCODE_ID_UVD].fw = adev->uvd.fw;
424 		adev->firmware.fw_size +=
425 			ALIGN(le32_to_cpu(hdr->ucode_size_bytes), PAGE_SIZE);
426 
427 		if (adev->uvd.num_uvd_inst == UVD7_MAX_HW_INSTANCES_VEGA20) {
428 			adev->firmware.ucode[AMDGPU_UCODE_ID_UVD1].ucode_id = AMDGPU_UCODE_ID_UVD1;
429 			adev->firmware.ucode[AMDGPU_UCODE_ID_UVD1].fw = adev->uvd.fw;
430 			adev->firmware.fw_size +=
431 				ALIGN(le32_to_cpu(hdr->ucode_size_bytes), PAGE_SIZE);
432 		}
433 		DRM_INFO("PSP loading UVD firmware\n");
434 	}
435 
436 	for (j = 0; j < adev->uvd.num_uvd_inst; j++) {
437 		if (adev->uvd.harvest_config & (1 << j))
438 			continue;
439 		if (!amdgpu_sriov_vf(adev)) {
440 			ring = &adev->uvd.inst[j].ring;
441 			sprintf(ring->name, "uvd_%d", ring->me);
442 			r = amdgpu_ring_init(adev, ring, 512, &adev->uvd.inst[j].irq, 0);
443 			if (r)
444 				return r;
445 		}
446 
447 		for (i = 0; i < adev->uvd.num_enc_rings; ++i) {
448 			ring = &adev->uvd.inst[j].ring_enc[i];
449 			sprintf(ring->name, "uvd_enc_%d.%d", ring->me, i);
450 			if (amdgpu_sriov_vf(adev)) {
451 				ring->use_doorbell = true;
452 
453 				/* currently only use the first enconding ring for
454 				 * sriov, so set unused location for other unused rings.
455 				 */
456 				if (i == 0)
457 					ring->doorbell_index = adev->doorbell_index.uvd_vce.uvd_ring0_1 * 2;
458 				else
459 					ring->doorbell_index = adev->doorbell_index.uvd_vce.uvd_ring2_3 * 2 + 1;
460 			}
461 			r = amdgpu_ring_init(adev, ring, 512, &adev->uvd.inst[j].irq, 0);
462 			if (r)
463 				return r;
464 		}
465 	}
466 
467 	r = amdgpu_uvd_resume(adev);
468 	if (r)
469 		return r;
470 
471 	r = amdgpu_uvd_entity_init(adev);
472 	if (r)
473 		return r;
474 
475 	r = amdgpu_virt_alloc_mm_table(adev);
476 	if (r)
477 		return r;
478 
479 	return r;
480 }
481 
482 static int uvd_v7_0_sw_fini(void *handle)
483 {
484 	int i, j, r;
485 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
486 
487 	amdgpu_virt_free_mm_table(adev);
488 
489 	r = amdgpu_uvd_suspend(adev);
490 	if (r)
491 		return r;
492 
493 	for (j = 0; j < adev->uvd.num_uvd_inst; ++j) {
494 		if (adev->uvd.harvest_config & (1 << j))
495 			continue;
496 		for (i = 0; i < adev->uvd.num_enc_rings; ++i)
497 			amdgpu_ring_fini(&adev->uvd.inst[j].ring_enc[i]);
498 	}
499 	return amdgpu_uvd_sw_fini(adev);
500 }
501 
502 /**
503  * uvd_v7_0_hw_init - start and test UVD block
504  *
505  * @adev: amdgpu_device pointer
506  *
507  * Initialize the hardware, boot up the VCPU and do some testing
508  */
509 static int uvd_v7_0_hw_init(void *handle)
510 {
511 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
512 	struct amdgpu_ring *ring;
513 	uint32_t tmp;
514 	int i, j, r;
515 
516 	if (amdgpu_sriov_vf(adev))
517 		r = uvd_v7_0_sriov_start(adev);
518 	else
519 		r = uvd_v7_0_start(adev);
520 	if (r)
521 		goto done;
522 
523 	for (j = 0; j < adev->uvd.num_uvd_inst; ++j) {
524 		if (adev->uvd.harvest_config & (1 << j))
525 			continue;
526 		ring = &adev->uvd.inst[j].ring;
527 
528 		if (!amdgpu_sriov_vf(adev)) {
529 			r = amdgpu_ring_test_helper(ring);
530 			if (r)
531 				goto done;
532 
533 			r = amdgpu_ring_alloc(ring, 10);
534 			if (r) {
535 				DRM_ERROR("amdgpu: (%d)ring failed to lock UVD ring (%d).\n", j, r);
536 				goto done;
537 			}
538 
539 			tmp = PACKET0(SOC15_REG_OFFSET(UVD, j,
540 				mmUVD_SEMA_WAIT_FAULT_TIMEOUT_CNTL), 0);
541 			amdgpu_ring_write(ring, tmp);
542 			amdgpu_ring_write(ring, 0xFFFFF);
543 
544 			tmp = PACKET0(SOC15_REG_OFFSET(UVD, j,
545 				mmUVD_SEMA_WAIT_INCOMPLETE_TIMEOUT_CNTL), 0);
546 			amdgpu_ring_write(ring, tmp);
547 			amdgpu_ring_write(ring, 0xFFFFF);
548 
549 			tmp = PACKET0(SOC15_REG_OFFSET(UVD, j,
550 				mmUVD_SEMA_SIGNAL_INCOMPLETE_TIMEOUT_CNTL), 0);
551 			amdgpu_ring_write(ring, tmp);
552 			amdgpu_ring_write(ring, 0xFFFFF);
553 
554 			/* Clear timeout status bits */
555 			amdgpu_ring_write(ring, PACKET0(SOC15_REG_OFFSET(UVD, j,
556 				mmUVD_SEMA_TIMEOUT_STATUS), 0));
557 			amdgpu_ring_write(ring, 0x8);
558 
559 			amdgpu_ring_write(ring, PACKET0(SOC15_REG_OFFSET(UVD, j,
560 				mmUVD_SEMA_CNTL), 0));
561 			amdgpu_ring_write(ring, 3);
562 
563 			amdgpu_ring_commit(ring);
564 		}
565 
566 		for (i = 0; i < adev->uvd.num_enc_rings; ++i) {
567 			ring = &adev->uvd.inst[j].ring_enc[i];
568 			r = amdgpu_ring_test_helper(ring);
569 			if (r)
570 				goto done;
571 		}
572 	}
573 done:
574 	if (!r)
575 		DRM_INFO("UVD and UVD ENC initialized successfully.\n");
576 
577 	return r;
578 }
579 
580 /**
581  * uvd_v7_0_hw_fini - stop the hardware block
582  *
583  * @adev: amdgpu_device pointer
584  *
585  * Stop the UVD block, mark ring as not ready any more
586  */
587 static int uvd_v7_0_hw_fini(void *handle)
588 {
589 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
590 	int i;
591 
592 	if (!amdgpu_sriov_vf(adev))
593 		uvd_v7_0_stop(adev);
594 	else {
595 		/* full access mode, so don't touch any UVD register */
596 		DRM_DEBUG("For SRIOV client, shouldn't do anything.\n");
597 	}
598 
599 	for (i = 0; i < adev->uvd.num_uvd_inst; ++i) {
600 		if (adev->uvd.harvest_config & (1 << i))
601 			continue;
602 		adev->uvd.inst[i].ring.sched.ready = false;
603 	}
604 
605 	return 0;
606 }
607 
608 static int uvd_v7_0_suspend(void *handle)
609 {
610 	int r;
611 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
612 
613 	r = uvd_v7_0_hw_fini(adev);
614 	if (r)
615 		return r;
616 
617 	return amdgpu_uvd_suspend(adev);
618 }
619 
620 static int uvd_v7_0_resume(void *handle)
621 {
622 	int r;
623 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
624 
625 	r = amdgpu_uvd_resume(adev);
626 	if (r)
627 		return r;
628 
629 	return uvd_v7_0_hw_init(adev);
630 }
631 
632 /**
633  * uvd_v7_0_mc_resume - memory controller programming
634  *
635  * @adev: amdgpu_device pointer
636  *
637  * Let the UVD memory controller know it's offsets
638  */
639 static void uvd_v7_0_mc_resume(struct amdgpu_device *adev)
640 {
641 	uint32_t size = AMDGPU_UVD_FIRMWARE_SIZE(adev);
642 	uint32_t offset;
643 	int i;
644 
645 	for (i = 0; i < adev->uvd.num_uvd_inst; ++i) {
646 		if (adev->uvd.harvest_config & (1 << i))
647 			continue;
648 		if (adev->firmware.load_type == AMDGPU_FW_LOAD_PSP) {
649 			WREG32_SOC15(UVD, i, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW,
650 				i == 0 ?
651 				adev->firmware.ucode[AMDGPU_UCODE_ID_UVD].tmr_mc_addr_lo:
652 				adev->firmware.ucode[AMDGPU_UCODE_ID_UVD1].tmr_mc_addr_lo);
653 			WREG32_SOC15(UVD, i, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH,
654 				i == 0 ?
655 				adev->firmware.ucode[AMDGPU_UCODE_ID_UVD].tmr_mc_addr_hi:
656 				adev->firmware.ucode[AMDGPU_UCODE_ID_UVD1].tmr_mc_addr_hi);
657 			WREG32_SOC15(UVD, i, mmUVD_VCPU_CACHE_OFFSET0, 0);
658 			offset = 0;
659 		} else {
660 			WREG32_SOC15(UVD, i, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW,
661 				lower_32_bits(adev->uvd.inst[i].gpu_addr));
662 			WREG32_SOC15(UVD, i, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH,
663 				upper_32_bits(adev->uvd.inst[i].gpu_addr));
664 			offset = size;
665 			WREG32_SOC15(UVD, i, mmUVD_VCPU_CACHE_OFFSET0,
666 					AMDGPU_UVD_FIRMWARE_OFFSET >> 3);
667 		}
668 
669 		WREG32_SOC15(UVD, i, mmUVD_VCPU_CACHE_SIZE0, size);
670 
671 		WREG32_SOC15(UVD, i, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_LOW,
672 				lower_32_bits(adev->uvd.inst[i].gpu_addr + offset));
673 		WREG32_SOC15(UVD, i, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_HIGH,
674 				upper_32_bits(adev->uvd.inst[i].gpu_addr + offset));
675 		WREG32_SOC15(UVD, i, mmUVD_VCPU_CACHE_OFFSET1, (1 << 21));
676 		WREG32_SOC15(UVD, i, mmUVD_VCPU_CACHE_SIZE1, AMDGPU_UVD_HEAP_SIZE);
677 
678 		WREG32_SOC15(UVD, i, mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_LOW,
679 				lower_32_bits(adev->uvd.inst[i].gpu_addr + offset + AMDGPU_UVD_HEAP_SIZE));
680 		WREG32_SOC15(UVD, i, mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_HIGH,
681 				upper_32_bits(adev->uvd.inst[i].gpu_addr + offset + AMDGPU_UVD_HEAP_SIZE));
682 		WREG32_SOC15(UVD, i, mmUVD_VCPU_CACHE_OFFSET2, (2 << 21));
683 		WREG32_SOC15(UVD, i, mmUVD_VCPU_CACHE_SIZE2,
684 				AMDGPU_UVD_STACK_SIZE + (AMDGPU_UVD_SESSION_SIZE * 40));
685 
686 		WREG32_SOC15(UVD, i, mmUVD_UDEC_ADDR_CONFIG,
687 				adev->gfx.config.gb_addr_config);
688 		WREG32_SOC15(UVD, i, mmUVD_UDEC_DB_ADDR_CONFIG,
689 				adev->gfx.config.gb_addr_config);
690 		WREG32_SOC15(UVD, i, mmUVD_UDEC_DBW_ADDR_CONFIG,
691 				adev->gfx.config.gb_addr_config);
692 
693 		WREG32_SOC15(UVD, i, mmUVD_GP_SCRATCH4, adev->uvd.max_handles);
694 	}
695 }
696 
697 static int uvd_v7_0_mmsch_start(struct amdgpu_device *adev,
698 				struct amdgpu_mm_table *table)
699 {
700 	uint32_t data = 0, loop;
701 	uint64_t addr = table->gpu_addr;
702 	struct mmsch_v1_0_init_header *header = (struct mmsch_v1_0_init_header *)table->cpu_addr;
703 	uint32_t size;
704 	int i;
705 
706 	size = header->header_size + header->vce_table_size + header->uvd_table_size;
707 
708 	/* 1, write to vce_mmsch_vf_ctx_addr_lo/hi register with GPU mc addr of memory descriptor location */
709 	WREG32_SOC15(VCE, 0, mmVCE_MMSCH_VF_CTX_ADDR_LO, lower_32_bits(addr));
710 	WREG32_SOC15(VCE, 0, mmVCE_MMSCH_VF_CTX_ADDR_HI, upper_32_bits(addr));
711 
712 	/* 2, update vmid of descriptor */
713 	data = RREG32_SOC15(VCE, 0, mmVCE_MMSCH_VF_VMID);
714 	data &= ~VCE_MMSCH_VF_VMID__VF_CTX_VMID_MASK;
715 	data |= (0 << VCE_MMSCH_VF_VMID__VF_CTX_VMID__SHIFT); /* use domain0 for MM scheduler */
716 	WREG32_SOC15(VCE, 0, mmVCE_MMSCH_VF_VMID, data);
717 
718 	/* 3, notify mmsch about the size of this descriptor */
719 	WREG32_SOC15(VCE, 0, mmVCE_MMSCH_VF_CTX_SIZE, size);
720 
721 	/* 4, set resp to zero */
722 	WREG32_SOC15(VCE, 0, mmVCE_MMSCH_VF_MAILBOX_RESP, 0);
723 
724 	for (i = 0; i < adev->uvd.num_uvd_inst; ++i) {
725 		if (adev->uvd.harvest_config & (1 << i))
726 			continue;
727 		WDOORBELL32(adev->uvd.inst[i].ring_enc[0].doorbell_index, 0);
728 		adev->wb.wb[adev->uvd.inst[i].ring_enc[0].wptr_offs] = 0;
729 		adev->uvd.inst[i].ring_enc[0].wptr = 0;
730 		adev->uvd.inst[i].ring_enc[0].wptr_old = 0;
731 	}
732 	/* 5, kick off the initialization and wait until VCE_MMSCH_VF_MAILBOX_RESP becomes non-zero */
733 	WREG32_SOC15(VCE, 0, mmVCE_MMSCH_VF_MAILBOX_HOST, 0x10000001);
734 
735 	data = RREG32_SOC15(VCE, 0, mmVCE_MMSCH_VF_MAILBOX_RESP);
736 	loop = 1000;
737 	while ((data & 0x10000002) != 0x10000002) {
738 		udelay(10);
739 		data = RREG32_SOC15(VCE, 0, mmVCE_MMSCH_VF_MAILBOX_RESP);
740 		loop--;
741 		if (!loop)
742 			break;
743 	}
744 
745 	if (!loop) {
746 		dev_err(adev->dev, "failed to init MMSCH, mmVCE_MMSCH_VF_MAILBOX_RESP = %x\n", data);
747 		return -EBUSY;
748 	}
749 
750 	return 0;
751 }
752 
753 static int uvd_v7_0_sriov_start(struct amdgpu_device *adev)
754 {
755 	struct amdgpu_ring *ring;
756 	uint32_t offset, size, tmp;
757 	uint32_t table_size = 0;
758 	struct mmsch_v1_0_cmd_direct_write direct_wt = { {0} };
759 	struct mmsch_v1_0_cmd_direct_read_modify_write direct_rd_mod_wt = { {0} };
760 	struct mmsch_v1_0_cmd_direct_polling direct_poll = { {0} };
761 	struct mmsch_v1_0_cmd_end end = { {0} };
762 	uint32_t *init_table = adev->virt.mm_table.cpu_addr;
763 	struct mmsch_v1_0_init_header *header = (struct mmsch_v1_0_init_header *)init_table;
764 	uint8_t i = 0;
765 
766 	direct_wt.cmd_header.command_type = MMSCH_COMMAND__DIRECT_REG_WRITE;
767 	direct_rd_mod_wt.cmd_header.command_type = MMSCH_COMMAND__DIRECT_REG_READ_MODIFY_WRITE;
768 	direct_poll.cmd_header.command_type = MMSCH_COMMAND__DIRECT_REG_POLLING;
769 	end.cmd_header.command_type = MMSCH_COMMAND__END;
770 
771 	if (header->uvd_table_offset == 0 && header->uvd_table_size == 0) {
772 		header->version = MMSCH_VERSION;
773 		header->header_size = sizeof(struct mmsch_v1_0_init_header) >> 2;
774 
775 		if (header->vce_table_offset == 0 && header->vce_table_size == 0)
776 			header->uvd_table_offset = header->header_size;
777 		else
778 			header->uvd_table_offset = header->vce_table_size + header->vce_table_offset;
779 
780 		init_table += header->uvd_table_offset;
781 
782 		for (i = 0; i < adev->uvd.num_uvd_inst; ++i) {
783 			if (adev->uvd.harvest_config & (1 << i))
784 				continue;
785 			ring = &adev->uvd.inst[i].ring;
786 			ring->wptr = 0;
787 			size = AMDGPU_GPU_PAGE_ALIGN(adev->uvd.fw->size + 4);
788 
789 			MMSCH_V1_0_INSERT_DIRECT_RD_MOD_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_STATUS),
790 							   0xFFFFFFFF, 0x00000004);
791 			/* mc resume*/
792 			if (adev->firmware.load_type == AMDGPU_FW_LOAD_PSP) {
793 				MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i,
794 							mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),
795 							adev->firmware.ucode[AMDGPU_UCODE_ID_UVD].tmr_mc_addr_lo);
796 				MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i,
797 							mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),
798 							adev->firmware.ucode[AMDGPU_UCODE_ID_UVD].tmr_mc_addr_hi);
799 				MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, 0, mmUVD_VCPU_CACHE_OFFSET0), 0);
800 				offset = 0;
801 			} else {
802 				MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),
803 							    lower_32_bits(adev->uvd.inst[i].gpu_addr));
804 				MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),
805 							    upper_32_bits(adev->uvd.inst[i].gpu_addr));
806 				offset = size;
807 				MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, 0, mmUVD_VCPU_CACHE_OFFSET0),
808 							AMDGPU_UVD_FIRMWARE_OFFSET >> 3);
809 
810 			}
811 
812 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_VCPU_CACHE_SIZE0), size);
813 
814 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_LOW),
815 						    lower_32_bits(adev->uvd.inst[i].gpu_addr + offset));
816 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_HIGH),
817 						    upper_32_bits(adev->uvd.inst[i].gpu_addr + offset));
818 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_VCPU_CACHE_OFFSET1), (1 << 21));
819 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_VCPU_CACHE_SIZE1), AMDGPU_UVD_HEAP_SIZE);
820 
821 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_LOW),
822 						    lower_32_bits(adev->uvd.inst[i].gpu_addr + offset + AMDGPU_UVD_HEAP_SIZE));
823 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_HIGH),
824 						    upper_32_bits(adev->uvd.inst[i].gpu_addr + offset + AMDGPU_UVD_HEAP_SIZE));
825 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_VCPU_CACHE_OFFSET2), (2 << 21));
826 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_VCPU_CACHE_SIZE2),
827 						    AMDGPU_UVD_STACK_SIZE + (AMDGPU_UVD_SESSION_SIZE * 40));
828 
829 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_GP_SCRATCH4), adev->uvd.max_handles);
830 			/* mc resume end*/
831 
832 			/* disable clock gating */
833 			MMSCH_V1_0_INSERT_DIRECT_RD_MOD_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_CGC_CTRL),
834 							   ~UVD_CGC_CTRL__DYN_CLOCK_MODE_MASK, 0);
835 
836 			/* disable interupt */
837 			MMSCH_V1_0_INSERT_DIRECT_RD_MOD_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_MASTINT_EN),
838 							   ~UVD_MASTINT_EN__VCPU_EN_MASK, 0);
839 
840 			/* stall UMC and register bus before resetting VCPU */
841 			MMSCH_V1_0_INSERT_DIRECT_RD_MOD_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_LMI_CTRL2),
842 							   ~UVD_LMI_CTRL2__STALL_ARB_UMC_MASK,
843 							   UVD_LMI_CTRL2__STALL_ARB_UMC_MASK);
844 
845 			/* put LMI, VCPU, RBC etc... into reset */
846 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_SOFT_RESET),
847 						    (uint32_t)(UVD_SOFT_RESET__LMI_SOFT_RESET_MASK |
848 							       UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK |
849 							       UVD_SOFT_RESET__LBSI_SOFT_RESET_MASK |
850 							       UVD_SOFT_RESET__RBC_SOFT_RESET_MASK |
851 							       UVD_SOFT_RESET__CSM_SOFT_RESET_MASK |
852 							       UVD_SOFT_RESET__CXW_SOFT_RESET_MASK |
853 							       UVD_SOFT_RESET__TAP_SOFT_RESET_MASK |
854 							       UVD_SOFT_RESET__LMI_UMC_SOFT_RESET_MASK));
855 
856 			/* initialize UVD memory controller */
857 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_LMI_CTRL),
858 						    (uint32_t)((0x40 << UVD_LMI_CTRL__WRITE_CLEAN_TIMER__SHIFT) |
859 							       UVD_LMI_CTRL__WRITE_CLEAN_TIMER_EN_MASK |
860 							       UVD_LMI_CTRL__DATA_COHERENCY_EN_MASK |
861 							       UVD_LMI_CTRL__VCPU_DATA_COHERENCY_EN_MASK |
862 							       UVD_LMI_CTRL__REQ_MODE_MASK |
863 							       0x00100000L));
864 
865 			/* take all subblocks out of reset, except VCPU */
866 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_SOFT_RESET),
867 						    UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
868 
869 			/* enable VCPU clock */
870 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_VCPU_CNTL),
871 						    UVD_VCPU_CNTL__CLK_EN_MASK);
872 
873 			/* enable master interrupt */
874 			MMSCH_V1_0_INSERT_DIRECT_RD_MOD_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_MASTINT_EN),
875 							   ~(UVD_MASTINT_EN__VCPU_EN_MASK|UVD_MASTINT_EN__SYS_EN_MASK),
876 							   (UVD_MASTINT_EN__VCPU_EN_MASK|UVD_MASTINT_EN__SYS_EN_MASK));
877 
878 			/* clear the bit 4 of UVD_STATUS */
879 			MMSCH_V1_0_INSERT_DIRECT_RD_MOD_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_STATUS),
880 							   ~(2 << UVD_STATUS__VCPU_REPORT__SHIFT), 0);
881 
882 			/* force RBC into idle state */
883 			size = order_base_2(ring->ring_size);
884 			tmp = REG_SET_FIELD(0, UVD_RBC_RB_CNTL, RB_BUFSZ, size);
885 			tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_FETCH, 1);
886 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_RBC_RB_CNTL), tmp);
887 
888 			ring = &adev->uvd.inst[i].ring_enc[0];
889 			ring->wptr = 0;
890 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_RB_BASE_LO), ring->gpu_addr);
891 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_RB_BASE_HI), upper_32_bits(ring->gpu_addr));
892 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_RB_SIZE), ring->ring_size / 4);
893 
894 			/* boot up the VCPU */
895 			MMSCH_V1_0_INSERT_DIRECT_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_SOFT_RESET), 0);
896 
897 			/* enable UMC */
898 			MMSCH_V1_0_INSERT_DIRECT_RD_MOD_WT(SOC15_REG_OFFSET(UVD, i, mmUVD_LMI_CTRL2),
899 											   ~UVD_LMI_CTRL2__STALL_ARB_UMC_MASK, 0);
900 
901 			MMSCH_V1_0_INSERT_DIRECT_POLL(SOC15_REG_OFFSET(UVD, i, mmUVD_STATUS), 0x02, 0x02);
902 		}
903 		/* add end packet */
904 		memcpy((void *)init_table, &end, sizeof(struct mmsch_v1_0_cmd_end));
905 		table_size += sizeof(struct mmsch_v1_0_cmd_end) / 4;
906 		header->uvd_table_size = table_size;
907 
908 	}
909 	return uvd_v7_0_mmsch_start(adev, &adev->virt.mm_table);
910 }
911 
912 /**
913  * uvd_v7_0_start - start UVD block
914  *
915  * @adev: amdgpu_device pointer
916  *
917  * Setup and start the UVD block
918  */
919 static int uvd_v7_0_start(struct amdgpu_device *adev)
920 {
921 	struct amdgpu_ring *ring;
922 	uint32_t rb_bufsz, tmp;
923 	uint32_t lmi_swap_cntl;
924 	uint32_t mp_swap_cntl;
925 	int i, j, k, r;
926 
927 	for (k = 0; k < adev->uvd.num_uvd_inst; ++k) {
928 		if (adev->uvd.harvest_config & (1 << k))
929 			continue;
930 		/* disable DPG */
931 		WREG32_P(SOC15_REG_OFFSET(UVD, k, mmUVD_POWER_STATUS), 0,
932 				~UVD_POWER_STATUS__UVD_PG_MODE_MASK);
933 	}
934 
935 	/* disable byte swapping */
936 	lmi_swap_cntl = 0;
937 	mp_swap_cntl = 0;
938 
939 	uvd_v7_0_mc_resume(adev);
940 
941 	for (k = 0; k < adev->uvd.num_uvd_inst; ++k) {
942 		if (adev->uvd.harvest_config & (1 << k))
943 			continue;
944 		ring = &adev->uvd.inst[k].ring;
945 		/* disable clock gating */
946 		WREG32_P(SOC15_REG_OFFSET(UVD, k, mmUVD_CGC_CTRL), 0,
947 				~UVD_CGC_CTRL__DYN_CLOCK_MODE_MASK);
948 
949 		/* disable interupt */
950 		WREG32_P(SOC15_REG_OFFSET(UVD, k, mmUVD_MASTINT_EN), 0,
951 				~UVD_MASTINT_EN__VCPU_EN_MASK);
952 
953 		/* stall UMC and register bus before resetting VCPU */
954 		WREG32_P(SOC15_REG_OFFSET(UVD, k, mmUVD_LMI_CTRL2),
955 				UVD_LMI_CTRL2__STALL_ARB_UMC_MASK,
956 				~UVD_LMI_CTRL2__STALL_ARB_UMC_MASK);
957 		mdelay(1);
958 
959 		/* put LMI, VCPU, RBC etc... into reset */
960 		WREG32_SOC15(UVD, k, mmUVD_SOFT_RESET,
961 			UVD_SOFT_RESET__LMI_SOFT_RESET_MASK |
962 			UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK |
963 			UVD_SOFT_RESET__LBSI_SOFT_RESET_MASK |
964 			UVD_SOFT_RESET__RBC_SOFT_RESET_MASK |
965 			UVD_SOFT_RESET__CSM_SOFT_RESET_MASK |
966 			UVD_SOFT_RESET__CXW_SOFT_RESET_MASK |
967 			UVD_SOFT_RESET__TAP_SOFT_RESET_MASK |
968 			UVD_SOFT_RESET__LMI_UMC_SOFT_RESET_MASK);
969 		mdelay(5);
970 
971 		/* initialize UVD memory controller */
972 		WREG32_SOC15(UVD, k, mmUVD_LMI_CTRL,
973 			(0x40 << UVD_LMI_CTRL__WRITE_CLEAN_TIMER__SHIFT) |
974 			UVD_LMI_CTRL__WRITE_CLEAN_TIMER_EN_MASK |
975 			UVD_LMI_CTRL__DATA_COHERENCY_EN_MASK |
976 			UVD_LMI_CTRL__VCPU_DATA_COHERENCY_EN_MASK |
977 			UVD_LMI_CTRL__REQ_MODE_MASK |
978 			0x00100000L);
979 
980 #ifdef __BIG_ENDIAN
981 		/* swap (8 in 32) RB and IB */
982 		lmi_swap_cntl = 0xa;
983 		mp_swap_cntl = 0;
984 #endif
985 		WREG32_SOC15(UVD, k, mmUVD_LMI_SWAP_CNTL, lmi_swap_cntl);
986 		WREG32_SOC15(UVD, k, mmUVD_MP_SWAP_CNTL, mp_swap_cntl);
987 
988 		WREG32_SOC15(UVD, k, mmUVD_MPC_SET_MUXA0, 0x40c2040);
989 		WREG32_SOC15(UVD, k, mmUVD_MPC_SET_MUXA1, 0x0);
990 		WREG32_SOC15(UVD, k, mmUVD_MPC_SET_MUXB0, 0x40c2040);
991 		WREG32_SOC15(UVD, k, mmUVD_MPC_SET_MUXB1, 0x0);
992 		WREG32_SOC15(UVD, k, mmUVD_MPC_SET_ALU, 0);
993 		WREG32_SOC15(UVD, k, mmUVD_MPC_SET_MUX, 0x88);
994 
995 		/* take all subblocks out of reset, except VCPU */
996 		WREG32_SOC15(UVD, k, mmUVD_SOFT_RESET,
997 				UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
998 		mdelay(5);
999 
1000 		/* enable VCPU clock */
1001 		WREG32_SOC15(UVD, k, mmUVD_VCPU_CNTL,
1002 				UVD_VCPU_CNTL__CLK_EN_MASK);
1003 
1004 		/* enable UMC */
1005 		WREG32_P(SOC15_REG_OFFSET(UVD, k, mmUVD_LMI_CTRL2), 0,
1006 				~UVD_LMI_CTRL2__STALL_ARB_UMC_MASK);
1007 
1008 		/* boot up the VCPU */
1009 		WREG32_SOC15(UVD, k, mmUVD_SOFT_RESET, 0);
1010 		mdelay(10);
1011 
1012 		for (i = 0; i < 10; ++i) {
1013 			uint32_t status;
1014 
1015 			for (j = 0; j < 100; ++j) {
1016 				status = RREG32_SOC15(UVD, k, mmUVD_STATUS);
1017 				if (status & 2)
1018 					break;
1019 				mdelay(10);
1020 			}
1021 			r = 0;
1022 			if (status & 2)
1023 				break;
1024 
1025 			DRM_ERROR("UVD(%d) not responding, trying to reset the VCPU!!!\n", k);
1026 			WREG32_P(SOC15_REG_OFFSET(UVD, k, mmUVD_SOFT_RESET),
1027 					UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK,
1028 					~UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
1029 			mdelay(10);
1030 			WREG32_P(SOC15_REG_OFFSET(UVD, k, mmUVD_SOFT_RESET), 0,
1031 					~UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
1032 			mdelay(10);
1033 			r = -1;
1034 		}
1035 
1036 		if (r) {
1037 			DRM_ERROR("UVD(%d) not responding, giving up!!!\n", k);
1038 			return r;
1039 		}
1040 		/* enable master interrupt */
1041 		WREG32_P(SOC15_REG_OFFSET(UVD, k, mmUVD_MASTINT_EN),
1042 			(UVD_MASTINT_EN__VCPU_EN_MASK|UVD_MASTINT_EN__SYS_EN_MASK),
1043 			~(UVD_MASTINT_EN__VCPU_EN_MASK|UVD_MASTINT_EN__SYS_EN_MASK));
1044 
1045 		/* clear the bit 4 of UVD_STATUS */
1046 		WREG32_P(SOC15_REG_OFFSET(UVD, k, mmUVD_STATUS), 0,
1047 				~(2 << UVD_STATUS__VCPU_REPORT__SHIFT));
1048 
1049 		/* force RBC into idle state */
1050 		rb_bufsz = order_base_2(ring->ring_size);
1051 		tmp = REG_SET_FIELD(0, UVD_RBC_RB_CNTL, RB_BUFSZ, rb_bufsz);
1052 		tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_BLKSZ, 1);
1053 		tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_FETCH, 1);
1054 		tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_WPTR_POLL_EN, 0);
1055 		tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_UPDATE, 1);
1056 		tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_RPTR_WR_EN, 1);
1057 		WREG32_SOC15(UVD, k, mmUVD_RBC_RB_CNTL, tmp);
1058 
1059 		/* set the write pointer delay */
1060 		WREG32_SOC15(UVD, k, mmUVD_RBC_RB_WPTR_CNTL, 0);
1061 
1062 		/* set the wb address */
1063 		WREG32_SOC15(UVD, k, mmUVD_RBC_RB_RPTR_ADDR,
1064 				(upper_32_bits(ring->gpu_addr) >> 2));
1065 
1066 		/* programm the RB_BASE for ring buffer */
1067 		WREG32_SOC15(UVD, k, mmUVD_LMI_RBC_RB_64BIT_BAR_LOW,
1068 				lower_32_bits(ring->gpu_addr));
1069 		WREG32_SOC15(UVD, k, mmUVD_LMI_RBC_RB_64BIT_BAR_HIGH,
1070 				upper_32_bits(ring->gpu_addr));
1071 
1072 		/* Initialize the ring buffer's read and write pointers */
1073 		WREG32_SOC15(UVD, k, mmUVD_RBC_RB_RPTR, 0);
1074 
1075 		ring->wptr = RREG32_SOC15(UVD, k, mmUVD_RBC_RB_RPTR);
1076 		WREG32_SOC15(UVD, k, mmUVD_RBC_RB_WPTR,
1077 				lower_32_bits(ring->wptr));
1078 
1079 		WREG32_P(SOC15_REG_OFFSET(UVD, k, mmUVD_RBC_RB_CNTL), 0,
1080 				~UVD_RBC_RB_CNTL__RB_NO_FETCH_MASK);
1081 
1082 		ring = &adev->uvd.inst[k].ring_enc[0];
1083 		WREG32_SOC15(UVD, k, mmUVD_RB_RPTR, lower_32_bits(ring->wptr));
1084 		WREG32_SOC15(UVD, k, mmUVD_RB_WPTR, lower_32_bits(ring->wptr));
1085 		WREG32_SOC15(UVD, k, mmUVD_RB_BASE_LO, ring->gpu_addr);
1086 		WREG32_SOC15(UVD, k, mmUVD_RB_BASE_HI, upper_32_bits(ring->gpu_addr));
1087 		WREG32_SOC15(UVD, k, mmUVD_RB_SIZE, ring->ring_size / 4);
1088 
1089 		ring = &adev->uvd.inst[k].ring_enc[1];
1090 		WREG32_SOC15(UVD, k, mmUVD_RB_RPTR2, lower_32_bits(ring->wptr));
1091 		WREG32_SOC15(UVD, k, mmUVD_RB_WPTR2, lower_32_bits(ring->wptr));
1092 		WREG32_SOC15(UVD, k, mmUVD_RB_BASE_LO2, ring->gpu_addr);
1093 		WREG32_SOC15(UVD, k, mmUVD_RB_BASE_HI2, upper_32_bits(ring->gpu_addr));
1094 		WREG32_SOC15(UVD, k, mmUVD_RB_SIZE2, ring->ring_size / 4);
1095 	}
1096 	return 0;
1097 }
1098 
1099 /**
1100  * uvd_v7_0_stop - stop UVD block
1101  *
1102  * @adev: amdgpu_device pointer
1103  *
1104  * stop the UVD block
1105  */
1106 static void uvd_v7_0_stop(struct amdgpu_device *adev)
1107 {
1108 	uint8_t i = 0;
1109 
1110 	for (i = 0; i < adev->uvd.num_uvd_inst; ++i) {
1111 		if (adev->uvd.harvest_config & (1 << i))
1112 			continue;
1113 		/* force RBC into idle state */
1114 		WREG32_SOC15(UVD, i, mmUVD_RBC_RB_CNTL, 0x11010101);
1115 
1116 		/* Stall UMC and register bus before resetting VCPU */
1117 		WREG32_P(SOC15_REG_OFFSET(UVD, i, mmUVD_LMI_CTRL2),
1118 				UVD_LMI_CTRL2__STALL_ARB_UMC_MASK,
1119 				~UVD_LMI_CTRL2__STALL_ARB_UMC_MASK);
1120 		mdelay(1);
1121 
1122 		/* put VCPU into reset */
1123 		WREG32_SOC15(UVD, i, mmUVD_SOFT_RESET,
1124 				UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
1125 		mdelay(5);
1126 
1127 		/* disable VCPU clock */
1128 		WREG32_SOC15(UVD, i, mmUVD_VCPU_CNTL, 0x0);
1129 
1130 		/* Unstall UMC and register bus */
1131 		WREG32_P(SOC15_REG_OFFSET(UVD, i, mmUVD_LMI_CTRL2), 0,
1132 				~UVD_LMI_CTRL2__STALL_ARB_UMC_MASK);
1133 	}
1134 }
1135 
1136 /**
1137  * uvd_v7_0_ring_emit_fence - emit an fence & trap command
1138  *
1139  * @ring: amdgpu_ring pointer
1140  * @fence: fence to emit
1141  *
1142  * Write a fence and a trap command to the ring.
1143  */
1144 static void uvd_v7_0_ring_emit_fence(struct amdgpu_ring *ring, u64 addr, u64 seq,
1145 				     unsigned flags)
1146 {
1147 	struct amdgpu_device *adev = ring->adev;
1148 
1149 	WARN_ON(flags & AMDGPU_FENCE_FLAG_64BIT);
1150 
1151 	amdgpu_ring_write(ring,
1152 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_CONTEXT_ID), 0));
1153 	amdgpu_ring_write(ring, seq);
1154 	amdgpu_ring_write(ring,
1155 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_DATA0), 0));
1156 	amdgpu_ring_write(ring, addr & 0xffffffff);
1157 	amdgpu_ring_write(ring,
1158 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_DATA1), 0));
1159 	amdgpu_ring_write(ring, upper_32_bits(addr) & 0xff);
1160 	amdgpu_ring_write(ring,
1161 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_CMD), 0));
1162 	amdgpu_ring_write(ring, 0);
1163 
1164 	amdgpu_ring_write(ring,
1165 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_DATA0), 0));
1166 	amdgpu_ring_write(ring, 0);
1167 	amdgpu_ring_write(ring,
1168 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_DATA1), 0));
1169 	amdgpu_ring_write(ring, 0);
1170 	amdgpu_ring_write(ring,
1171 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_CMD), 0));
1172 	amdgpu_ring_write(ring, 2);
1173 }
1174 
1175 /**
1176  * uvd_v7_0_enc_ring_emit_fence - emit an enc fence & trap command
1177  *
1178  * @ring: amdgpu_ring pointer
1179  * @fence: fence to emit
1180  *
1181  * Write enc a fence and a trap command to the ring.
1182  */
1183 static void uvd_v7_0_enc_ring_emit_fence(struct amdgpu_ring *ring, u64 addr,
1184 			u64 seq, unsigned flags)
1185 {
1186 
1187 	WARN_ON(flags & AMDGPU_FENCE_FLAG_64BIT);
1188 
1189 	amdgpu_ring_write(ring, HEVC_ENC_CMD_FENCE);
1190 	amdgpu_ring_write(ring, addr);
1191 	amdgpu_ring_write(ring, upper_32_bits(addr));
1192 	amdgpu_ring_write(ring, seq);
1193 	amdgpu_ring_write(ring, HEVC_ENC_CMD_TRAP);
1194 }
1195 
1196 /**
1197  * uvd_v7_0_ring_emit_hdp_flush - skip HDP flushing
1198  *
1199  * @ring: amdgpu_ring pointer
1200  */
1201 static void uvd_v7_0_ring_emit_hdp_flush(struct amdgpu_ring *ring)
1202 {
1203 	/* The firmware doesn't seem to like touching registers at this point. */
1204 }
1205 
1206 /**
1207  * uvd_v7_0_ring_test_ring - register write test
1208  *
1209  * @ring: amdgpu_ring pointer
1210  *
1211  * Test if we can successfully write to the context register
1212  */
1213 static int uvd_v7_0_ring_test_ring(struct amdgpu_ring *ring)
1214 {
1215 	struct amdgpu_device *adev = ring->adev;
1216 	uint32_t tmp = 0;
1217 	unsigned i;
1218 	int r;
1219 
1220 	WREG32_SOC15(UVD, ring->me, mmUVD_CONTEXT_ID, 0xCAFEDEAD);
1221 	r = amdgpu_ring_alloc(ring, 3);
1222 	if (r)
1223 		return r;
1224 
1225 	amdgpu_ring_write(ring,
1226 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_CONTEXT_ID), 0));
1227 	amdgpu_ring_write(ring, 0xDEADBEEF);
1228 	amdgpu_ring_commit(ring);
1229 	for (i = 0; i < adev->usec_timeout; i++) {
1230 		tmp = RREG32_SOC15(UVD, ring->me, mmUVD_CONTEXT_ID);
1231 		if (tmp == 0xDEADBEEF)
1232 			break;
1233 		udelay(1);
1234 	}
1235 
1236 	if (i >= adev->usec_timeout)
1237 		r = -ETIMEDOUT;
1238 
1239 	return r;
1240 }
1241 
1242 /**
1243  * uvd_v7_0_ring_patch_cs_in_place - Patch the IB for command submission.
1244  *
1245  * @p: the CS parser with the IBs
1246  * @ib_idx: which IB to patch
1247  *
1248  */
1249 static int uvd_v7_0_ring_patch_cs_in_place(struct amdgpu_cs_parser *p,
1250 					   uint32_t ib_idx)
1251 {
1252 	struct amdgpu_ring *ring = to_amdgpu_ring(p->entity->rq->sched);
1253 	struct amdgpu_ib *ib = &p->job->ibs[ib_idx];
1254 	unsigned i;
1255 
1256 	/* No patching necessary for the first instance */
1257 	if (!ring->me)
1258 		return 0;
1259 
1260 	for (i = 0; i < ib->length_dw; i += 2) {
1261 		uint32_t reg = amdgpu_get_ib_value(p, ib_idx, i);
1262 
1263 		reg -= p->adev->reg_offset[UVD_HWIP][0][1];
1264 		reg += p->adev->reg_offset[UVD_HWIP][1][1];
1265 
1266 		amdgpu_set_ib_value(p, ib_idx, i, reg);
1267 	}
1268 	return 0;
1269 }
1270 
1271 /**
1272  * uvd_v7_0_ring_emit_ib - execute indirect buffer
1273  *
1274  * @ring: amdgpu_ring pointer
1275  * @ib: indirect buffer to execute
1276  *
1277  * Write ring commands to execute the indirect buffer
1278  */
1279 static void uvd_v7_0_ring_emit_ib(struct amdgpu_ring *ring,
1280 				  struct amdgpu_job *job,
1281 				  struct amdgpu_ib *ib,
1282 				  uint32_t flags)
1283 {
1284 	struct amdgpu_device *adev = ring->adev;
1285 	unsigned vmid = AMDGPU_JOB_GET_VMID(job);
1286 
1287 	amdgpu_ring_write(ring,
1288 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_LMI_RBC_IB_VMID), 0));
1289 	amdgpu_ring_write(ring, vmid);
1290 
1291 	amdgpu_ring_write(ring,
1292 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_LMI_RBC_IB_64BIT_BAR_LOW), 0));
1293 	amdgpu_ring_write(ring, lower_32_bits(ib->gpu_addr));
1294 	amdgpu_ring_write(ring,
1295 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_LMI_RBC_IB_64BIT_BAR_HIGH), 0));
1296 	amdgpu_ring_write(ring, upper_32_bits(ib->gpu_addr));
1297 	amdgpu_ring_write(ring,
1298 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_RBC_IB_SIZE), 0));
1299 	amdgpu_ring_write(ring, ib->length_dw);
1300 }
1301 
1302 /**
1303  * uvd_v7_0_enc_ring_emit_ib - enc execute indirect buffer
1304  *
1305  * @ring: amdgpu_ring pointer
1306  * @ib: indirect buffer to execute
1307  *
1308  * Write enc ring commands to execute the indirect buffer
1309  */
1310 static void uvd_v7_0_enc_ring_emit_ib(struct amdgpu_ring *ring,
1311 					struct amdgpu_job *job,
1312 					struct amdgpu_ib *ib,
1313 					uint32_t flags)
1314 {
1315 	unsigned vmid = AMDGPU_JOB_GET_VMID(job);
1316 
1317 	amdgpu_ring_write(ring, HEVC_ENC_CMD_IB_VM);
1318 	amdgpu_ring_write(ring, vmid);
1319 	amdgpu_ring_write(ring, lower_32_bits(ib->gpu_addr));
1320 	amdgpu_ring_write(ring, upper_32_bits(ib->gpu_addr));
1321 	amdgpu_ring_write(ring, ib->length_dw);
1322 }
1323 
1324 static void uvd_v7_0_ring_emit_wreg(struct amdgpu_ring *ring,
1325 				    uint32_t reg, uint32_t val)
1326 {
1327 	struct amdgpu_device *adev = ring->adev;
1328 
1329 	amdgpu_ring_write(ring,
1330 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_DATA0), 0));
1331 	amdgpu_ring_write(ring, reg << 2);
1332 	amdgpu_ring_write(ring,
1333 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_DATA1), 0));
1334 	amdgpu_ring_write(ring, val);
1335 	amdgpu_ring_write(ring,
1336 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_CMD), 0));
1337 	amdgpu_ring_write(ring, 8);
1338 }
1339 
1340 static void uvd_v7_0_ring_emit_reg_wait(struct amdgpu_ring *ring, uint32_t reg,
1341 					uint32_t val, uint32_t mask)
1342 {
1343 	struct amdgpu_device *adev = ring->adev;
1344 
1345 	amdgpu_ring_write(ring,
1346 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_DATA0), 0));
1347 	amdgpu_ring_write(ring, reg << 2);
1348 	amdgpu_ring_write(ring,
1349 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_DATA1), 0));
1350 	amdgpu_ring_write(ring, val);
1351 	amdgpu_ring_write(ring,
1352 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GP_SCRATCH8), 0));
1353 	amdgpu_ring_write(ring, mask);
1354 	amdgpu_ring_write(ring,
1355 		PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_GPCOM_VCPU_CMD), 0));
1356 	amdgpu_ring_write(ring, 12);
1357 }
1358 
1359 static void uvd_v7_0_ring_emit_vm_flush(struct amdgpu_ring *ring,
1360 					unsigned vmid, uint64_t pd_addr)
1361 {
1362 	struct amdgpu_vmhub *hub = &ring->adev->vmhub[ring->funcs->vmhub];
1363 	uint32_t data0, data1, mask;
1364 
1365 	pd_addr = amdgpu_gmc_emit_flush_gpu_tlb(ring, vmid, pd_addr);
1366 
1367 	/* wait for reg writes */
1368 	data0 = hub->ctx0_ptb_addr_lo32 + vmid * 2;
1369 	data1 = lower_32_bits(pd_addr);
1370 	mask = 0xffffffff;
1371 	uvd_v7_0_ring_emit_reg_wait(ring, data0, data1, mask);
1372 }
1373 
1374 static void uvd_v7_0_ring_insert_nop(struct amdgpu_ring *ring, uint32_t count)
1375 {
1376 	struct amdgpu_device *adev = ring->adev;
1377 	int i;
1378 
1379 	WARN_ON(ring->wptr % 2 || count % 2);
1380 
1381 	for (i = 0; i < count / 2; i++) {
1382 		amdgpu_ring_write(ring, PACKET0(SOC15_REG_OFFSET(UVD, ring->me, mmUVD_NO_OP), 0));
1383 		amdgpu_ring_write(ring, 0);
1384 	}
1385 }
1386 
1387 static void uvd_v7_0_enc_ring_insert_end(struct amdgpu_ring *ring)
1388 {
1389 	amdgpu_ring_write(ring, HEVC_ENC_CMD_END);
1390 }
1391 
1392 static void uvd_v7_0_enc_ring_emit_reg_wait(struct amdgpu_ring *ring,
1393 					    uint32_t reg, uint32_t val,
1394 					    uint32_t mask)
1395 {
1396 	amdgpu_ring_write(ring, HEVC_ENC_CMD_REG_WAIT);
1397 	amdgpu_ring_write(ring,	reg << 2);
1398 	amdgpu_ring_write(ring, mask);
1399 	amdgpu_ring_write(ring, val);
1400 }
1401 
1402 static void uvd_v7_0_enc_ring_emit_vm_flush(struct amdgpu_ring *ring,
1403 					    unsigned int vmid, uint64_t pd_addr)
1404 {
1405 	struct amdgpu_vmhub *hub = &ring->adev->vmhub[ring->funcs->vmhub];
1406 
1407 	pd_addr = amdgpu_gmc_emit_flush_gpu_tlb(ring, vmid, pd_addr);
1408 
1409 	/* wait for reg writes */
1410 	uvd_v7_0_enc_ring_emit_reg_wait(ring, hub->ctx0_ptb_addr_lo32 + vmid * 2,
1411 					lower_32_bits(pd_addr), 0xffffffff);
1412 }
1413 
1414 static void uvd_v7_0_enc_ring_emit_wreg(struct amdgpu_ring *ring,
1415 					uint32_t reg, uint32_t val)
1416 {
1417 	amdgpu_ring_write(ring, HEVC_ENC_CMD_REG_WRITE);
1418 	amdgpu_ring_write(ring,	reg << 2);
1419 	amdgpu_ring_write(ring, val);
1420 }
1421 
1422 #if 0
1423 static bool uvd_v7_0_is_idle(void *handle)
1424 {
1425 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1426 
1427 	return !(RREG32(mmSRBM_STATUS) & SRBM_STATUS__UVD_BUSY_MASK);
1428 }
1429 
1430 static int uvd_v7_0_wait_for_idle(void *handle)
1431 {
1432 	unsigned i;
1433 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1434 
1435 	for (i = 0; i < adev->usec_timeout; i++) {
1436 		if (uvd_v7_0_is_idle(handle))
1437 			return 0;
1438 	}
1439 	return -ETIMEDOUT;
1440 }
1441 
1442 #define AMDGPU_UVD_STATUS_BUSY_MASK    0xfd
1443 static bool uvd_v7_0_check_soft_reset(void *handle)
1444 {
1445 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1446 	u32 srbm_soft_reset = 0;
1447 	u32 tmp = RREG32(mmSRBM_STATUS);
1448 
1449 	if (REG_GET_FIELD(tmp, SRBM_STATUS, UVD_RQ_PENDING) ||
1450 	    REG_GET_FIELD(tmp, SRBM_STATUS, UVD_BUSY) ||
1451 	    (RREG32_SOC15(UVD, ring->me, mmUVD_STATUS) &
1452 		    AMDGPU_UVD_STATUS_BUSY_MASK))
1453 		srbm_soft_reset = REG_SET_FIELD(srbm_soft_reset,
1454 				SRBM_SOFT_RESET, SOFT_RESET_UVD, 1);
1455 
1456 	if (srbm_soft_reset) {
1457 		adev->uvd.inst[ring->me].srbm_soft_reset = srbm_soft_reset;
1458 		return true;
1459 	} else {
1460 		adev->uvd.inst[ring->me].srbm_soft_reset = 0;
1461 		return false;
1462 	}
1463 }
1464 
1465 static int uvd_v7_0_pre_soft_reset(void *handle)
1466 {
1467 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1468 
1469 	if (!adev->uvd.inst[ring->me].srbm_soft_reset)
1470 		return 0;
1471 
1472 	uvd_v7_0_stop(adev);
1473 	return 0;
1474 }
1475 
1476 static int uvd_v7_0_soft_reset(void *handle)
1477 {
1478 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1479 	u32 srbm_soft_reset;
1480 
1481 	if (!adev->uvd.inst[ring->me].srbm_soft_reset)
1482 		return 0;
1483 	srbm_soft_reset = adev->uvd.inst[ring->me].srbm_soft_reset;
1484 
1485 	if (srbm_soft_reset) {
1486 		u32 tmp;
1487 
1488 		tmp = RREG32(mmSRBM_SOFT_RESET);
1489 		tmp |= srbm_soft_reset;
1490 		dev_info(adev->dev, "SRBM_SOFT_RESET=0x%08X\n", tmp);
1491 		WREG32(mmSRBM_SOFT_RESET, tmp);
1492 		tmp = RREG32(mmSRBM_SOFT_RESET);
1493 
1494 		udelay(50);
1495 
1496 		tmp &= ~srbm_soft_reset;
1497 		WREG32(mmSRBM_SOFT_RESET, tmp);
1498 		tmp = RREG32(mmSRBM_SOFT_RESET);
1499 
1500 		/* Wait a little for things to settle down */
1501 		udelay(50);
1502 	}
1503 
1504 	return 0;
1505 }
1506 
1507 static int uvd_v7_0_post_soft_reset(void *handle)
1508 {
1509 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1510 
1511 	if (!adev->uvd.inst[ring->me].srbm_soft_reset)
1512 		return 0;
1513 
1514 	mdelay(5);
1515 
1516 	return uvd_v7_0_start(adev);
1517 }
1518 #endif
1519 
1520 static int uvd_v7_0_set_interrupt_state(struct amdgpu_device *adev,
1521 					struct amdgpu_irq_src *source,
1522 					unsigned type,
1523 					enum amdgpu_interrupt_state state)
1524 {
1525 	// TODO
1526 	return 0;
1527 }
1528 
1529 static int uvd_v7_0_process_interrupt(struct amdgpu_device *adev,
1530 				      struct amdgpu_irq_src *source,
1531 				      struct amdgpu_iv_entry *entry)
1532 {
1533 	uint32_t ip_instance;
1534 
1535 	switch (entry->client_id) {
1536 	case SOC15_IH_CLIENTID_UVD:
1537 		ip_instance = 0;
1538 		break;
1539 	case SOC15_IH_CLIENTID_UVD1:
1540 		ip_instance = 1;
1541 		break;
1542 	default:
1543 		DRM_ERROR("Unhandled client id: %d\n", entry->client_id);
1544 		return 0;
1545 	}
1546 
1547 	DRM_DEBUG("IH: UVD TRAP\n");
1548 
1549 	switch (entry->src_id) {
1550 	case 124:
1551 		amdgpu_fence_process(&adev->uvd.inst[ip_instance].ring);
1552 		break;
1553 	case 119:
1554 		amdgpu_fence_process(&adev->uvd.inst[ip_instance].ring_enc[0]);
1555 		break;
1556 	case 120:
1557 		if (!amdgpu_sriov_vf(adev))
1558 			amdgpu_fence_process(&adev->uvd.inst[ip_instance].ring_enc[1]);
1559 		break;
1560 	default:
1561 		DRM_ERROR("Unhandled interrupt: %d %d\n",
1562 			  entry->src_id, entry->src_data[0]);
1563 		break;
1564 	}
1565 
1566 	return 0;
1567 }
1568 
1569 #if 0
1570 static void uvd_v7_0_set_sw_clock_gating(struct amdgpu_device *adev)
1571 {
1572 	uint32_t data, data1, data2, suvd_flags;
1573 
1574 	data = RREG32_SOC15(UVD, ring->me, mmUVD_CGC_CTRL);
1575 	data1 = RREG32_SOC15(UVD, ring->me, mmUVD_SUVD_CGC_GATE);
1576 	data2 = RREG32_SOC15(UVD, ring->me, mmUVD_SUVD_CGC_CTRL);
1577 
1578 	data &= ~(UVD_CGC_CTRL__CLK_OFF_DELAY_MASK |
1579 		  UVD_CGC_CTRL__CLK_GATE_DLY_TIMER_MASK);
1580 
1581 	suvd_flags = UVD_SUVD_CGC_GATE__SRE_MASK |
1582 		     UVD_SUVD_CGC_GATE__SIT_MASK |
1583 		     UVD_SUVD_CGC_GATE__SMP_MASK |
1584 		     UVD_SUVD_CGC_GATE__SCM_MASK |
1585 		     UVD_SUVD_CGC_GATE__SDB_MASK;
1586 
1587 	data |= UVD_CGC_CTRL__DYN_CLOCK_MODE_MASK |
1588 		(1 << REG_FIELD_SHIFT(UVD_CGC_CTRL, CLK_GATE_DLY_TIMER)) |
1589 		(4 << REG_FIELD_SHIFT(UVD_CGC_CTRL, CLK_OFF_DELAY));
1590 
1591 	data &= ~(UVD_CGC_CTRL__UDEC_RE_MODE_MASK |
1592 			UVD_CGC_CTRL__UDEC_CM_MODE_MASK |
1593 			UVD_CGC_CTRL__UDEC_IT_MODE_MASK |
1594 			UVD_CGC_CTRL__UDEC_DB_MODE_MASK |
1595 			UVD_CGC_CTRL__UDEC_MP_MODE_MASK |
1596 			UVD_CGC_CTRL__SYS_MODE_MASK |
1597 			UVD_CGC_CTRL__UDEC_MODE_MASK |
1598 			UVD_CGC_CTRL__MPEG2_MODE_MASK |
1599 			UVD_CGC_CTRL__REGS_MODE_MASK |
1600 			UVD_CGC_CTRL__RBC_MODE_MASK |
1601 			UVD_CGC_CTRL__LMI_MC_MODE_MASK |
1602 			UVD_CGC_CTRL__LMI_UMC_MODE_MASK |
1603 			UVD_CGC_CTRL__IDCT_MODE_MASK |
1604 			UVD_CGC_CTRL__MPRD_MODE_MASK |
1605 			UVD_CGC_CTRL__MPC_MODE_MASK |
1606 			UVD_CGC_CTRL__LBSI_MODE_MASK |
1607 			UVD_CGC_CTRL__LRBBM_MODE_MASK |
1608 			UVD_CGC_CTRL__WCB_MODE_MASK |
1609 			UVD_CGC_CTRL__VCPU_MODE_MASK |
1610 			UVD_CGC_CTRL__JPEG_MODE_MASK |
1611 			UVD_CGC_CTRL__JPEG2_MODE_MASK |
1612 			UVD_CGC_CTRL__SCPU_MODE_MASK);
1613 	data2 &= ~(UVD_SUVD_CGC_CTRL__SRE_MODE_MASK |
1614 			UVD_SUVD_CGC_CTRL__SIT_MODE_MASK |
1615 			UVD_SUVD_CGC_CTRL__SMP_MODE_MASK |
1616 			UVD_SUVD_CGC_CTRL__SCM_MODE_MASK |
1617 			UVD_SUVD_CGC_CTRL__SDB_MODE_MASK);
1618 	data1 |= suvd_flags;
1619 
1620 	WREG32_SOC15(UVD, ring->me, mmUVD_CGC_CTRL, data);
1621 	WREG32_SOC15(UVD, ring->me, mmUVD_CGC_GATE, 0);
1622 	WREG32_SOC15(UVD, ring->me, mmUVD_SUVD_CGC_GATE, data1);
1623 	WREG32_SOC15(UVD, ring->me, mmUVD_SUVD_CGC_CTRL, data2);
1624 }
1625 
1626 static void uvd_v7_0_set_hw_clock_gating(struct amdgpu_device *adev)
1627 {
1628 	uint32_t data, data1, cgc_flags, suvd_flags;
1629 
1630 	data = RREG32_SOC15(UVD, ring->me, mmUVD_CGC_GATE);
1631 	data1 = RREG32_SOC15(UVD, ring->me, mmUVD_SUVD_CGC_GATE);
1632 
1633 	cgc_flags = UVD_CGC_GATE__SYS_MASK |
1634 		UVD_CGC_GATE__UDEC_MASK |
1635 		UVD_CGC_GATE__MPEG2_MASK |
1636 		UVD_CGC_GATE__RBC_MASK |
1637 		UVD_CGC_GATE__LMI_MC_MASK |
1638 		UVD_CGC_GATE__IDCT_MASK |
1639 		UVD_CGC_GATE__MPRD_MASK |
1640 		UVD_CGC_GATE__MPC_MASK |
1641 		UVD_CGC_GATE__LBSI_MASK |
1642 		UVD_CGC_GATE__LRBBM_MASK |
1643 		UVD_CGC_GATE__UDEC_RE_MASK |
1644 		UVD_CGC_GATE__UDEC_CM_MASK |
1645 		UVD_CGC_GATE__UDEC_IT_MASK |
1646 		UVD_CGC_GATE__UDEC_DB_MASK |
1647 		UVD_CGC_GATE__UDEC_MP_MASK |
1648 		UVD_CGC_GATE__WCB_MASK |
1649 		UVD_CGC_GATE__VCPU_MASK |
1650 		UVD_CGC_GATE__SCPU_MASK |
1651 		UVD_CGC_GATE__JPEG_MASK |
1652 		UVD_CGC_GATE__JPEG2_MASK;
1653 
1654 	suvd_flags = UVD_SUVD_CGC_GATE__SRE_MASK |
1655 				UVD_SUVD_CGC_GATE__SIT_MASK |
1656 				UVD_SUVD_CGC_GATE__SMP_MASK |
1657 				UVD_SUVD_CGC_GATE__SCM_MASK |
1658 				UVD_SUVD_CGC_GATE__SDB_MASK;
1659 
1660 	data |= cgc_flags;
1661 	data1 |= suvd_flags;
1662 
1663 	WREG32_SOC15(UVD, ring->me, mmUVD_CGC_GATE, data);
1664 	WREG32_SOC15(UVD, ring->me, mmUVD_SUVD_CGC_GATE, data1);
1665 }
1666 
1667 static void uvd_v7_0_set_bypass_mode(struct amdgpu_device *adev, bool enable)
1668 {
1669 	u32 tmp = RREG32_SMC(ixGCK_DFS_BYPASS_CNTL);
1670 
1671 	if (enable)
1672 		tmp |= (GCK_DFS_BYPASS_CNTL__BYPASSDCLK_MASK |
1673 			GCK_DFS_BYPASS_CNTL__BYPASSVCLK_MASK);
1674 	else
1675 		tmp &= ~(GCK_DFS_BYPASS_CNTL__BYPASSDCLK_MASK |
1676 			 GCK_DFS_BYPASS_CNTL__BYPASSVCLK_MASK);
1677 
1678 	WREG32_SMC(ixGCK_DFS_BYPASS_CNTL, tmp);
1679 }
1680 
1681 
1682 static int uvd_v7_0_set_clockgating_state(void *handle,
1683 					  enum amd_clockgating_state state)
1684 {
1685 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1686 	bool enable = (state == AMD_CG_STATE_GATE) ? true : false;
1687 
1688 	uvd_v7_0_set_bypass_mode(adev, enable);
1689 
1690 	if (!(adev->cg_flags & AMD_CG_SUPPORT_UVD_MGCG))
1691 		return 0;
1692 
1693 	if (enable) {
1694 		/* disable HW gating and enable Sw gating */
1695 		uvd_v7_0_set_sw_clock_gating(adev);
1696 	} else {
1697 		/* wait for STATUS to clear */
1698 		if (uvd_v7_0_wait_for_idle(handle))
1699 			return -EBUSY;
1700 
1701 		/* enable HW gates because UVD is idle */
1702 		/* uvd_v7_0_set_hw_clock_gating(adev); */
1703 	}
1704 
1705 	return 0;
1706 }
1707 
1708 static int uvd_v7_0_set_powergating_state(void *handle,
1709 					  enum amd_powergating_state state)
1710 {
1711 	/* This doesn't actually powergate the UVD block.
1712 	 * That's done in the dpm code via the SMC.  This
1713 	 * just re-inits the block as necessary.  The actual
1714 	 * gating still happens in the dpm code.  We should
1715 	 * revisit this when there is a cleaner line between
1716 	 * the smc and the hw blocks
1717 	 */
1718 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
1719 
1720 	if (!(adev->pg_flags & AMD_PG_SUPPORT_UVD))
1721 		return 0;
1722 
1723 	WREG32_SOC15(UVD, ring->me, mmUVD_POWER_STATUS, UVD_POWER_STATUS__UVD_PG_EN_MASK);
1724 
1725 	if (state == AMD_PG_STATE_GATE) {
1726 		uvd_v7_0_stop(adev);
1727 		return 0;
1728 	} else {
1729 		return uvd_v7_0_start(adev);
1730 	}
1731 }
1732 #endif
1733 
1734 static int uvd_v7_0_set_clockgating_state(void *handle,
1735 					  enum amd_clockgating_state state)
1736 {
1737 	/* needed for driver unload*/
1738 	return 0;
1739 }
1740 
1741 const struct amd_ip_funcs uvd_v7_0_ip_funcs = {
1742 	.name = "uvd_v7_0",
1743 	.early_init = uvd_v7_0_early_init,
1744 	.late_init = NULL,
1745 	.sw_init = uvd_v7_0_sw_init,
1746 	.sw_fini = uvd_v7_0_sw_fini,
1747 	.hw_init = uvd_v7_0_hw_init,
1748 	.hw_fini = uvd_v7_0_hw_fini,
1749 	.suspend = uvd_v7_0_suspend,
1750 	.resume = uvd_v7_0_resume,
1751 	.is_idle = NULL /* uvd_v7_0_is_idle */,
1752 	.wait_for_idle = NULL /* uvd_v7_0_wait_for_idle */,
1753 	.check_soft_reset = NULL /* uvd_v7_0_check_soft_reset */,
1754 	.pre_soft_reset = NULL /* uvd_v7_0_pre_soft_reset */,
1755 	.soft_reset = NULL /* uvd_v7_0_soft_reset */,
1756 	.post_soft_reset = NULL /* uvd_v7_0_post_soft_reset */,
1757 	.set_clockgating_state = uvd_v7_0_set_clockgating_state,
1758 	.set_powergating_state = NULL /* uvd_v7_0_set_powergating_state */,
1759 };
1760 
1761 static const struct amdgpu_ring_funcs uvd_v7_0_ring_vm_funcs = {
1762 	.type = AMDGPU_RING_TYPE_UVD,
1763 	.align_mask = 0xf,
1764 	.support_64bit_ptrs = false,
1765 	.no_user_fence = true,
1766 	.vmhub = AMDGPU_MMHUB_0,
1767 	.get_rptr = uvd_v7_0_ring_get_rptr,
1768 	.get_wptr = uvd_v7_0_ring_get_wptr,
1769 	.set_wptr = uvd_v7_0_ring_set_wptr,
1770 	.patch_cs_in_place = uvd_v7_0_ring_patch_cs_in_place,
1771 	.emit_frame_size =
1772 		6 + /* hdp invalidate */
1773 		SOC15_FLUSH_GPU_TLB_NUM_WREG * 6 +
1774 		SOC15_FLUSH_GPU_TLB_NUM_REG_WAIT * 8 +
1775 		8 + /* uvd_v7_0_ring_emit_vm_flush */
1776 		14 + 14, /* uvd_v7_0_ring_emit_fence x2 vm fence */
1777 	.emit_ib_size = 8, /* uvd_v7_0_ring_emit_ib */
1778 	.emit_ib = uvd_v7_0_ring_emit_ib,
1779 	.emit_fence = uvd_v7_0_ring_emit_fence,
1780 	.emit_vm_flush = uvd_v7_0_ring_emit_vm_flush,
1781 	.emit_hdp_flush = uvd_v7_0_ring_emit_hdp_flush,
1782 	.test_ring = uvd_v7_0_ring_test_ring,
1783 	.test_ib = amdgpu_uvd_ring_test_ib,
1784 	.insert_nop = uvd_v7_0_ring_insert_nop,
1785 	.pad_ib = amdgpu_ring_generic_pad_ib,
1786 	.begin_use = amdgpu_uvd_ring_begin_use,
1787 	.end_use = amdgpu_uvd_ring_end_use,
1788 	.emit_wreg = uvd_v7_0_ring_emit_wreg,
1789 	.emit_reg_wait = uvd_v7_0_ring_emit_reg_wait,
1790 	.emit_reg_write_reg_wait = amdgpu_ring_emit_reg_write_reg_wait_helper,
1791 };
1792 
1793 static const struct amdgpu_ring_funcs uvd_v7_0_enc_ring_vm_funcs = {
1794 	.type = AMDGPU_RING_TYPE_UVD_ENC,
1795 	.align_mask = 0x3f,
1796 	.nop = HEVC_ENC_CMD_NO_OP,
1797 	.support_64bit_ptrs = false,
1798 	.no_user_fence = true,
1799 	.vmhub = AMDGPU_MMHUB_0,
1800 	.get_rptr = uvd_v7_0_enc_ring_get_rptr,
1801 	.get_wptr = uvd_v7_0_enc_ring_get_wptr,
1802 	.set_wptr = uvd_v7_0_enc_ring_set_wptr,
1803 	.emit_frame_size =
1804 		3 + 3 + /* hdp flush / invalidate */
1805 		SOC15_FLUSH_GPU_TLB_NUM_WREG * 3 +
1806 		SOC15_FLUSH_GPU_TLB_NUM_REG_WAIT * 4 +
1807 		4 + /* uvd_v7_0_enc_ring_emit_vm_flush */
1808 		5 + 5 + /* uvd_v7_0_enc_ring_emit_fence x2 vm fence */
1809 		1, /* uvd_v7_0_enc_ring_insert_end */
1810 	.emit_ib_size = 5, /* uvd_v7_0_enc_ring_emit_ib */
1811 	.emit_ib = uvd_v7_0_enc_ring_emit_ib,
1812 	.emit_fence = uvd_v7_0_enc_ring_emit_fence,
1813 	.emit_vm_flush = uvd_v7_0_enc_ring_emit_vm_flush,
1814 	.test_ring = uvd_v7_0_enc_ring_test_ring,
1815 	.test_ib = uvd_v7_0_enc_ring_test_ib,
1816 	.insert_nop = amdgpu_ring_insert_nop,
1817 	.insert_end = uvd_v7_0_enc_ring_insert_end,
1818 	.pad_ib = amdgpu_ring_generic_pad_ib,
1819 	.begin_use = amdgpu_uvd_ring_begin_use,
1820 	.end_use = amdgpu_uvd_ring_end_use,
1821 	.emit_wreg = uvd_v7_0_enc_ring_emit_wreg,
1822 	.emit_reg_wait = uvd_v7_0_enc_ring_emit_reg_wait,
1823 	.emit_reg_write_reg_wait = amdgpu_ring_emit_reg_write_reg_wait_helper,
1824 };
1825 
1826 static void uvd_v7_0_set_ring_funcs(struct amdgpu_device *adev)
1827 {
1828 	int i;
1829 
1830 	for (i = 0; i < adev->uvd.num_uvd_inst; i++) {
1831 		if (adev->uvd.harvest_config & (1 << i))
1832 			continue;
1833 		adev->uvd.inst[i].ring.funcs = &uvd_v7_0_ring_vm_funcs;
1834 		adev->uvd.inst[i].ring.me = i;
1835 		DRM_INFO("UVD(%d) is enabled in VM mode\n", i);
1836 	}
1837 }
1838 
1839 static void uvd_v7_0_set_enc_ring_funcs(struct amdgpu_device *adev)
1840 {
1841 	int i, j;
1842 
1843 	for (j = 0; j < adev->uvd.num_uvd_inst; j++) {
1844 		if (adev->uvd.harvest_config & (1 << j))
1845 			continue;
1846 		for (i = 0; i < adev->uvd.num_enc_rings; ++i) {
1847 			adev->uvd.inst[j].ring_enc[i].funcs = &uvd_v7_0_enc_ring_vm_funcs;
1848 			adev->uvd.inst[j].ring_enc[i].me = j;
1849 		}
1850 
1851 		DRM_INFO("UVD(%d) ENC is enabled in VM mode\n", j);
1852 	}
1853 }
1854 
1855 static const struct amdgpu_irq_src_funcs uvd_v7_0_irq_funcs = {
1856 	.set = uvd_v7_0_set_interrupt_state,
1857 	.process = uvd_v7_0_process_interrupt,
1858 };
1859 
1860 static void uvd_v7_0_set_irq_funcs(struct amdgpu_device *adev)
1861 {
1862 	int i;
1863 
1864 	for (i = 0; i < adev->uvd.num_uvd_inst; i++) {
1865 		if (adev->uvd.harvest_config & (1 << i))
1866 			continue;
1867 		adev->uvd.inst[i].irq.num_types = adev->uvd.num_enc_rings + 1;
1868 		adev->uvd.inst[i].irq.funcs = &uvd_v7_0_irq_funcs;
1869 	}
1870 }
1871 
1872 const struct amdgpu_ip_block_version uvd_v7_0_ip_block =
1873 {
1874 		.type = AMD_IP_BLOCK_TYPE_UVD,
1875 		.major = 7,
1876 		.minor = 0,
1877 		.rev = 0,
1878 		.funcs = &uvd_v7_0_ip_funcs,
1879 };
1880