xref: /openbmc/linux/drivers/gpu/drm/amd/amdgpu/uvd_v4_2.c (revision 3a786966)
1 /*
2  * Copyright 2013 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  * Authors: Christian König <christian.koenig@amd.com>
23  */
24 
25 #include <linux/firmware.h>
26 #include <drm/drmP.h>
27 #include "amdgpu.h"
28 #include "amdgpu_uvd.h"
29 #include "cikd.h"
30 
31 #include "uvd/uvd_4_2_d.h"
32 #include "uvd/uvd_4_2_sh_mask.h"
33 
34 #include "oss/oss_2_0_d.h"
35 #include "oss/oss_2_0_sh_mask.h"
36 
37 #include "bif/bif_4_1_d.h"
38 
39 #include "smu/smu_7_0_1_d.h"
40 #include "smu/smu_7_0_1_sh_mask.h"
41 
42 static void uvd_v4_2_mc_resume(struct amdgpu_device *adev);
43 static void uvd_v4_2_set_ring_funcs(struct amdgpu_device *adev);
44 static void uvd_v4_2_set_irq_funcs(struct amdgpu_device *adev);
45 static int uvd_v4_2_start(struct amdgpu_device *adev);
46 static void uvd_v4_2_stop(struct amdgpu_device *adev);
47 static int uvd_v4_2_set_clockgating_state(void *handle,
48 				enum amd_clockgating_state state);
49 static void uvd_v4_2_set_dcm(struct amdgpu_device *adev,
50 			     bool sw_mode);
51 /**
52  * uvd_v4_2_ring_get_rptr - get read pointer
53  *
54  * @ring: amdgpu_ring pointer
55  *
56  * Returns the current hardware read pointer
57  */
58 static uint32_t uvd_v4_2_ring_get_rptr(struct amdgpu_ring *ring)
59 {
60 	struct amdgpu_device *adev = ring->adev;
61 
62 	return RREG32(mmUVD_RBC_RB_RPTR);
63 }
64 
65 /**
66  * uvd_v4_2_ring_get_wptr - get write pointer
67  *
68  * @ring: amdgpu_ring pointer
69  *
70  * Returns the current hardware write pointer
71  */
72 static uint32_t uvd_v4_2_ring_get_wptr(struct amdgpu_ring *ring)
73 {
74 	struct amdgpu_device *adev = ring->adev;
75 
76 	return RREG32(mmUVD_RBC_RB_WPTR);
77 }
78 
79 /**
80  * uvd_v4_2_ring_set_wptr - set write pointer
81  *
82  * @ring: amdgpu_ring pointer
83  *
84  * Commits the write pointer to the hardware
85  */
86 static void uvd_v4_2_ring_set_wptr(struct amdgpu_ring *ring)
87 {
88 	struct amdgpu_device *adev = ring->adev;
89 
90 	WREG32(mmUVD_RBC_RB_WPTR, ring->wptr);
91 }
92 
93 static int uvd_v4_2_early_init(void *handle)
94 {
95 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
96 
97 	uvd_v4_2_set_ring_funcs(adev);
98 	uvd_v4_2_set_irq_funcs(adev);
99 
100 	return 0;
101 }
102 
103 static int uvd_v4_2_sw_init(void *handle)
104 {
105 	struct amdgpu_ring *ring;
106 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
107 	int r;
108 
109 	/* UVD TRAP */
110 	r = amdgpu_irq_add_id(adev, 124, &adev->uvd.irq);
111 	if (r)
112 		return r;
113 
114 	r = amdgpu_uvd_sw_init(adev);
115 	if (r)
116 		return r;
117 
118 	r = amdgpu_uvd_resume(adev);
119 	if (r)
120 		return r;
121 
122 	ring = &adev->uvd.ring;
123 	sprintf(ring->name, "uvd");
124 	r = amdgpu_ring_init(adev, ring, 512, &adev->uvd.irq, 0);
125 
126 	return r;
127 }
128 
129 static int uvd_v4_2_sw_fini(void *handle)
130 {
131 	int r;
132 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
133 
134 	r = amdgpu_uvd_suspend(adev);
135 	if (r)
136 		return r;
137 
138 	r = amdgpu_uvd_sw_fini(adev);
139 	if (r)
140 		return r;
141 
142 	return r;
143 }
144 static void uvd_v4_2_enable_mgcg(struct amdgpu_device *adev,
145 				 bool enable);
146 /**
147  * uvd_v4_2_hw_init - start and test UVD block
148  *
149  * @adev: amdgpu_device pointer
150  *
151  * Initialize the hardware, boot up the VCPU and do some testing
152  */
153 static int uvd_v4_2_hw_init(void *handle)
154 {
155 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
156 	struct amdgpu_ring *ring = &adev->uvd.ring;
157 	uint32_t tmp;
158 	int r;
159 
160 	uvd_v4_2_enable_mgcg(adev, true);
161 	amdgpu_asic_set_uvd_clocks(adev, 10000, 10000);
162 	r = uvd_v4_2_start(adev);
163 	if (r)
164 		goto done;
165 
166 	ring->ready = true;
167 	r = amdgpu_ring_test_ring(ring);
168 	if (r) {
169 		ring->ready = false;
170 		goto done;
171 	}
172 
173 	r = amdgpu_ring_alloc(ring, 10);
174 	if (r) {
175 		DRM_ERROR("amdgpu: ring failed to lock UVD ring (%d).\n", r);
176 		goto done;
177 	}
178 
179 	tmp = PACKET0(mmUVD_SEMA_WAIT_FAULT_TIMEOUT_CNTL, 0);
180 	amdgpu_ring_write(ring, tmp);
181 	amdgpu_ring_write(ring, 0xFFFFF);
182 
183 	tmp = PACKET0(mmUVD_SEMA_WAIT_INCOMPLETE_TIMEOUT_CNTL, 0);
184 	amdgpu_ring_write(ring, tmp);
185 	amdgpu_ring_write(ring, 0xFFFFF);
186 
187 	tmp = PACKET0(mmUVD_SEMA_SIGNAL_INCOMPLETE_TIMEOUT_CNTL, 0);
188 	amdgpu_ring_write(ring, tmp);
189 	amdgpu_ring_write(ring, 0xFFFFF);
190 
191 	/* Clear timeout status bits */
192 	amdgpu_ring_write(ring, PACKET0(mmUVD_SEMA_TIMEOUT_STATUS, 0));
193 	amdgpu_ring_write(ring, 0x8);
194 
195 	amdgpu_ring_write(ring, PACKET0(mmUVD_SEMA_CNTL, 0));
196 	amdgpu_ring_write(ring, 3);
197 
198 	amdgpu_ring_commit(ring);
199 
200 done:
201 	if (!r)
202 		DRM_INFO("UVD initialized successfully.\n");
203 
204 	return r;
205 }
206 
207 /**
208  * uvd_v4_2_hw_fini - stop the hardware block
209  *
210  * @adev: amdgpu_device pointer
211  *
212  * Stop the UVD block, mark ring as not ready any more
213  */
214 static int uvd_v4_2_hw_fini(void *handle)
215 {
216 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
217 	struct amdgpu_ring *ring = &adev->uvd.ring;
218 
219 	uvd_v4_2_stop(adev);
220 	ring->ready = false;
221 
222 	return 0;
223 }
224 
225 static int uvd_v4_2_suspend(void *handle)
226 {
227 	int r;
228 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
229 
230 	r = uvd_v4_2_hw_fini(adev);
231 	if (r)
232 		return r;
233 
234 	r = amdgpu_uvd_suspend(adev);
235 	if (r)
236 		return r;
237 
238 	return r;
239 }
240 
241 static int uvd_v4_2_resume(void *handle)
242 {
243 	int r;
244 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
245 
246 	r = amdgpu_uvd_resume(adev);
247 	if (r)
248 		return r;
249 
250 	r = uvd_v4_2_hw_init(adev);
251 	if (r)
252 		return r;
253 
254 	return r;
255 }
256 
257 /**
258  * uvd_v4_2_start - start UVD block
259  *
260  * @adev: amdgpu_device pointer
261  *
262  * Setup and start the UVD block
263  */
264 static int uvd_v4_2_start(struct amdgpu_device *adev)
265 {
266 	struct amdgpu_ring *ring = &adev->uvd.ring;
267 	uint32_t rb_bufsz;
268 	int i, j, r;
269 	/* disable byte swapping */
270 	u32 lmi_swap_cntl = 0;
271 	u32 mp_swap_cntl = 0;
272 
273 	WREG32(mmUVD_CGC_GATE, 0);
274 	uvd_v4_2_set_dcm(adev, true);
275 
276 	uvd_v4_2_mc_resume(adev);
277 
278 	/* disable interupt */
279 	WREG32_P(mmUVD_MASTINT_EN, 0, ~(1 << 1));
280 
281 	/* Stall UMC and register bus before resetting VCPU */
282 	WREG32_P(mmUVD_LMI_CTRL2, 1 << 8, ~(1 << 8));
283 	mdelay(1);
284 
285 	/* put LMI, VCPU, RBC etc... into reset */
286 	WREG32(mmUVD_SOFT_RESET, UVD_SOFT_RESET__LMI_SOFT_RESET_MASK |
287 		UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK | UVD_SOFT_RESET__LBSI_SOFT_RESET_MASK |
288 		UVD_SOFT_RESET__RBC_SOFT_RESET_MASK | UVD_SOFT_RESET__CSM_SOFT_RESET_MASK |
289 		UVD_SOFT_RESET__CXW_SOFT_RESET_MASK | UVD_SOFT_RESET__TAP_SOFT_RESET_MASK |
290 		UVD_SOFT_RESET__LMI_UMC_SOFT_RESET_MASK);
291 	mdelay(5);
292 
293 	/* take UVD block out of reset */
294 	WREG32_P(mmSRBM_SOFT_RESET, 0, ~SRBM_SOFT_RESET__SOFT_RESET_UVD_MASK);
295 	mdelay(5);
296 
297 	/* initialize UVD memory controller */
298 	WREG32(mmUVD_LMI_CTRL, 0x40 | (1 << 8) | (1 << 13) |
299 			     (1 << 21) | (1 << 9) | (1 << 20));
300 
301 #ifdef __BIG_ENDIAN
302 	/* swap (8 in 32) RB and IB */
303 	lmi_swap_cntl = 0xa;
304 	mp_swap_cntl = 0;
305 #endif
306 	WREG32(mmUVD_LMI_SWAP_CNTL, lmi_swap_cntl);
307 	WREG32(mmUVD_MP_SWAP_CNTL, mp_swap_cntl);
308 
309 	WREG32(mmUVD_MPC_SET_MUXA0, 0x40c2040);
310 	WREG32(mmUVD_MPC_SET_MUXA1, 0x0);
311 	WREG32(mmUVD_MPC_SET_MUXB0, 0x40c2040);
312 	WREG32(mmUVD_MPC_SET_MUXB1, 0x0);
313 	WREG32(mmUVD_MPC_SET_ALU, 0);
314 	WREG32(mmUVD_MPC_SET_MUX, 0x88);
315 
316 	/* take all subblocks out of reset, except VCPU */
317 	WREG32(mmUVD_SOFT_RESET, UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
318 	mdelay(5);
319 
320 	/* enable VCPU clock */
321 	WREG32(mmUVD_VCPU_CNTL,  1 << 9);
322 
323 	/* enable UMC */
324 	WREG32_P(mmUVD_LMI_CTRL2, 0, ~(1 << 8));
325 
326 	/* boot up the VCPU */
327 	WREG32(mmUVD_SOFT_RESET, 0);
328 	mdelay(10);
329 
330 	for (i = 0; i < 10; ++i) {
331 		uint32_t status;
332 		for (j = 0; j < 100; ++j) {
333 			status = RREG32(mmUVD_STATUS);
334 			if (status & 2)
335 				break;
336 			mdelay(10);
337 		}
338 		r = 0;
339 		if (status & 2)
340 			break;
341 
342 		DRM_ERROR("UVD not responding, trying to reset the VCPU!!!\n");
343 		WREG32_P(mmUVD_SOFT_RESET, UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK,
344 				~UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
345 		mdelay(10);
346 		WREG32_P(mmUVD_SOFT_RESET, 0, ~UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
347 		mdelay(10);
348 		r = -1;
349 	}
350 
351 	if (r) {
352 		DRM_ERROR("UVD not responding, giving up!!!\n");
353 		return r;
354 	}
355 
356 	/* enable interupt */
357 	WREG32_P(mmUVD_MASTINT_EN, 3<<1, ~(3 << 1));
358 
359 	/* force RBC into idle state */
360 	WREG32(mmUVD_RBC_RB_CNTL, 0x11010101);
361 
362 	/* Set the write pointer delay */
363 	WREG32(mmUVD_RBC_RB_WPTR_CNTL, 0);
364 
365 	/* programm the 4GB memory segment for rptr and ring buffer */
366 	WREG32(mmUVD_LMI_EXT40_ADDR, upper_32_bits(ring->gpu_addr) |
367 				   (0x7 << 16) | (0x1 << 31));
368 
369 	/* Initialize the ring buffer's read and write pointers */
370 	WREG32(mmUVD_RBC_RB_RPTR, 0x0);
371 
372 	ring->wptr = RREG32(mmUVD_RBC_RB_RPTR);
373 	WREG32(mmUVD_RBC_RB_WPTR, ring->wptr);
374 
375 	/* set the ring address */
376 	WREG32(mmUVD_RBC_RB_BASE, ring->gpu_addr);
377 
378 	/* Set ring buffer size */
379 	rb_bufsz = order_base_2(ring->ring_size);
380 	rb_bufsz = (0x1 << 8) | rb_bufsz;
381 	WREG32_P(mmUVD_RBC_RB_CNTL, rb_bufsz, ~0x11f1f);
382 
383 	return 0;
384 }
385 
386 /**
387  * uvd_v4_2_stop - stop UVD block
388  *
389  * @adev: amdgpu_device pointer
390  *
391  * stop the UVD block
392  */
393 static void uvd_v4_2_stop(struct amdgpu_device *adev)
394 {
395 	/* force RBC into idle state */
396 	WREG32(mmUVD_RBC_RB_CNTL, 0x11010101);
397 
398 	/* Stall UMC and register bus before resetting VCPU */
399 	WREG32_P(mmUVD_LMI_CTRL2, 1 << 8, ~(1 << 8));
400 	mdelay(1);
401 
402 	/* put VCPU into reset */
403 	WREG32(mmUVD_SOFT_RESET, UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
404 	mdelay(5);
405 
406 	/* disable VCPU clock */
407 	WREG32(mmUVD_VCPU_CNTL, 0x0);
408 
409 	/* Unstall UMC and register bus */
410 	WREG32_P(mmUVD_LMI_CTRL2, 0, ~(1 << 8));
411 
412 	uvd_v4_2_set_dcm(adev, false);
413 }
414 
415 /**
416  * uvd_v4_2_ring_emit_fence - emit an fence & trap command
417  *
418  * @ring: amdgpu_ring pointer
419  * @fence: fence to emit
420  *
421  * Write a fence and a trap command to the ring.
422  */
423 static void uvd_v4_2_ring_emit_fence(struct amdgpu_ring *ring, u64 addr, u64 seq,
424 				     unsigned flags)
425 {
426 	WARN_ON(flags & AMDGPU_FENCE_FLAG_64BIT);
427 
428 	amdgpu_ring_write(ring, PACKET0(mmUVD_CONTEXT_ID, 0));
429 	amdgpu_ring_write(ring, seq);
430 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_DATA0, 0));
431 	amdgpu_ring_write(ring, addr & 0xffffffff);
432 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_DATA1, 0));
433 	amdgpu_ring_write(ring, upper_32_bits(addr) & 0xff);
434 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_CMD, 0));
435 	amdgpu_ring_write(ring, 0);
436 
437 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_DATA0, 0));
438 	amdgpu_ring_write(ring, 0);
439 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_DATA1, 0));
440 	amdgpu_ring_write(ring, 0);
441 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_CMD, 0));
442 	amdgpu_ring_write(ring, 2);
443 }
444 
445 /**
446  * uvd_v4_2_ring_emit_hdp_flush - emit an hdp flush
447  *
448  * @ring: amdgpu_ring pointer
449  *
450  * Emits an hdp flush.
451  */
452 static void uvd_v4_2_ring_emit_hdp_flush(struct amdgpu_ring *ring)
453 {
454 	amdgpu_ring_write(ring, PACKET0(mmHDP_MEM_COHERENCY_FLUSH_CNTL, 0));
455 	amdgpu_ring_write(ring, 0);
456 }
457 
458 /**
459  * uvd_v4_2_ring_hdp_invalidate - emit an hdp invalidate
460  *
461  * @ring: amdgpu_ring pointer
462  *
463  * Emits an hdp invalidate.
464  */
465 static void uvd_v4_2_ring_emit_hdp_invalidate(struct amdgpu_ring *ring)
466 {
467 	amdgpu_ring_write(ring, PACKET0(mmHDP_DEBUG0, 0));
468 	amdgpu_ring_write(ring, 1);
469 }
470 
471 /**
472  * uvd_v4_2_ring_test_ring - register write test
473  *
474  * @ring: amdgpu_ring pointer
475  *
476  * Test if we can successfully write to the context register
477  */
478 static int uvd_v4_2_ring_test_ring(struct amdgpu_ring *ring)
479 {
480 	struct amdgpu_device *adev = ring->adev;
481 	uint32_t tmp = 0;
482 	unsigned i;
483 	int r;
484 
485 	WREG32(mmUVD_CONTEXT_ID, 0xCAFEDEAD);
486 	r = amdgpu_ring_alloc(ring, 3);
487 	if (r) {
488 		DRM_ERROR("amdgpu: cp failed to lock ring %d (%d).\n",
489 			  ring->idx, r);
490 		return r;
491 	}
492 	amdgpu_ring_write(ring, PACKET0(mmUVD_CONTEXT_ID, 0));
493 	amdgpu_ring_write(ring, 0xDEADBEEF);
494 	amdgpu_ring_commit(ring);
495 	for (i = 0; i < adev->usec_timeout; i++) {
496 		tmp = RREG32(mmUVD_CONTEXT_ID);
497 		if (tmp == 0xDEADBEEF)
498 			break;
499 		DRM_UDELAY(1);
500 	}
501 
502 	if (i < adev->usec_timeout) {
503 		DRM_INFO("ring test on %d succeeded in %d usecs\n",
504 			 ring->idx, i);
505 	} else {
506 		DRM_ERROR("amdgpu: ring %d test failed (0x%08X)\n",
507 			  ring->idx, tmp);
508 		r = -EINVAL;
509 	}
510 	return r;
511 }
512 
513 /**
514  * uvd_v4_2_ring_emit_ib - execute indirect buffer
515  *
516  * @ring: amdgpu_ring pointer
517  * @ib: indirect buffer to execute
518  *
519  * Write ring commands to execute the indirect buffer
520  */
521 static void uvd_v4_2_ring_emit_ib(struct amdgpu_ring *ring,
522 				  struct amdgpu_ib *ib,
523 				  unsigned vm_id, bool ctx_switch)
524 {
525 	amdgpu_ring_write(ring, PACKET0(mmUVD_RBC_IB_BASE, 0));
526 	amdgpu_ring_write(ring, ib->gpu_addr);
527 	amdgpu_ring_write(ring, PACKET0(mmUVD_RBC_IB_SIZE, 0));
528 	amdgpu_ring_write(ring, ib->length_dw);
529 }
530 
531 /**
532  * uvd_v4_2_mc_resume - memory controller programming
533  *
534  * @adev: amdgpu_device pointer
535  *
536  * Let the UVD memory controller know it's offsets
537  */
538 static void uvd_v4_2_mc_resume(struct amdgpu_device *adev)
539 {
540 	uint64_t addr;
541 	uint32_t size;
542 
543 	/* programm the VCPU memory controller bits 0-27 */
544 	addr = (adev->uvd.gpu_addr + AMDGPU_UVD_FIRMWARE_OFFSET) >> 3;
545 	size = AMDGPU_GPU_PAGE_ALIGN(adev->uvd.fw->size + 4) >> 3;
546 	WREG32(mmUVD_VCPU_CACHE_OFFSET0, addr);
547 	WREG32(mmUVD_VCPU_CACHE_SIZE0, size);
548 
549 	addr += size;
550 	size = AMDGPU_UVD_HEAP_SIZE >> 3;
551 	WREG32(mmUVD_VCPU_CACHE_OFFSET1, addr);
552 	WREG32(mmUVD_VCPU_CACHE_SIZE1, size);
553 
554 	addr += size;
555 	size = (AMDGPU_UVD_STACK_SIZE +
556 	       (AMDGPU_UVD_SESSION_SIZE * adev->uvd.max_handles)) >> 3;
557 	WREG32(mmUVD_VCPU_CACHE_OFFSET2, addr);
558 	WREG32(mmUVD_VCPU_CACHE_SIZE2, size);
559 
560 	/* bits 28-31 */
561 	addr = (adev->uvd.gpu_addr >> 28) & 0xF;
562 	WREG32(mmUVD_LMI_ADDR_EXT, (addr << 12) | (addr << 0));
563 
564 	/* bits 32-39 */
565 	addr = (adev->uvd.gpu_addr >> 32) & 0xFF;
566 	WREG32(mmUVD_LMI_EXT40_ADDR, addr | (0x9 << 16) | (0x1 << 31));
567 
568 	WREG32(mmUVD_UDEC_ADDR_CONFIG, adev->gfx.config.gb_addr_config);
569 	WREG32(mmUVD_UDEC_DB_ADDR_CONFIG, adev->gfx.config.gb_addr_config);
570 	WREG32(mmUVD_UDEC_DBW_ADDR_CONFIG, adev->gfx.config.gb_addr_config);
571 }
572 
573 static void uvd_v4_2_enable_mgcg(struct amdgpu_device *adev,
574 				 bool enable)
575 {
576 	u32 orig, data;
577 
578 	if (enable && (adev->cg_flags & AMD_CG_SUPPORT_UVD_MGCG)) {
579 		data = RREG32_UVD_CTX(ixUVD_CGC_MEM_CTRL);
580 		data |= 0xfff;
581 		WREG32_UVD_CTX(ixUVD_CGC_MEM_CTRL, data);
582 
583 		orig = data = RREG32(mmUVD_CGC_CTRL);
584 		data |= UVD_CGC_CTRL__DYN_CLOCK_MODE_MASK;
585 		if (orig != data)
586 			WREG32(mmUVD_CGC_CTRL, data);
587 	} else {
588 		data = RREG32_UVD_CTX(ixUVD_CGC_MEM_CTRL);
589 		data &= ~0xfff;
590 		WREG32_UVD_CTX(ixUVD_CGC_MEM_CTRL, data);
591 
592 		orig = data = RREG32(mmUVD_CGC_CTRL);
593 		data &= ~UVD_CGC_CTRL__DYN_CLOCK_MODE_MASK;
594 		if (orig != data)
595 			WREG32(mmUVD_CGC_CTRL, data);
596 	}
597 }
598 
599 static void uvd_v4_2_set_dcm(struct amdgpu_device *adev,
600 			     bool sw_mode)
601 {
602 	u32 tmp, tmp2;
603 
604 	WREG32_FIELD(UVD_CGC_GATE, REGS, 0);
605 
606 	tmp = RREG32(mmUVD_CGC_CTRL);
607 	tmp &= ~(UVD_CGC_CTRL__CLK_OFF_DELAY_MASK | UVD_CGC_CTRL__CLK_GATE_DLY_TIMER_MASK);
608 	tmp |= UVD_CGC_CTRL__DYN_CLOCK_MODE_MASK |
609 		(1 << UVD_CGC_CTRL__CLK_GATE_DLY_TIMER__SHIFT) |
610 		(4 << UVD_CGC_CTRL__CLK_OFF_DELAY__SHIFT);
611 
612 	if (sw_mode) {
613 		tmp &= ~0x7ffff800;
614 		tmp2 = UVD_CGC_CTRL2__DYN_OCLK_RAMP_EN_MASK |
615 			UVD_CGC_CTRL2__DYN_RCLK_RAMP_EN_MASK |
616 			(7 << UVD_CGC_CTRL2__GATER_DIV_ID__SHIFT);
617 	} else {
618 		tmp |= 0x7ffff800;
619 		tmp2 = 0;
620 	}
621 
622 	WREG32(mmUVD_CGC_CTRL, tmp);
623 	WREG32_UVD_CTX(ixUVD_CGC_CTRL2, tmp2);
624 }
625 
626 static bool uvd_v4_2_is_idle(void *handle)
627 {
628 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
629 
630 	return !(RREG32(mmSRBM_STATUS) & SRBM_STATUS__UVD_BUSY_MASK);
631 }
632 
633 static int uvd_v4_2_wait_for_idle(void *handle)
634 {
635 	unsigned i;
636 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
637 
638 	for (i = 0; i < adev->usec_timeout; i++) {
639 		if (!(RREG32(mmSRBM_STATUS) & SRBM_STATUS__UVD_BUSY_MASK))
640 			return 0;
641 	}
642 	return -ETIMEDOUT;
643 }
644 
645 static int uvd_v4_2_soft_reset(void *handle)
646 {
647 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
648 
649 	uvd_v4_2_stop(adev);
650 
651 	WREG32_P(mmSRBM_SOFT_RESET, SRBM_SOFT_RESET__SOFT_RESET_UVD_MASK,
652 			~SRBM_SOFT_RESET__SOFT_RESET_UVD_MASK);
653 	mdelay(5);
654 
655 	return uvd_v4_2_start(adev);
656 }
657 
658 static int uvd_v4_2_set_interrupt_state(struct amdgpu_device *adev,
659 					struct amdgpu_irq_src *source,
660 					unsigned type,
661 					enum amdgpu_interrupt_state state)
662 {
663 	// TODO
664 	return 0;
665 }
666 
667 static int uvd_v4_2_process_interrupt(struct amdgpu_device *adev,
668 				      struct amdgpu_irq_src *source,
669 				      struct amdgpu_iv_entry *entry)
670 {
671 	DRM_DEBUG("IH: UVD TRAP\n");
672 	amdgpu_fence_process(&adev->uvd.ring);
673 	return 0;
674 }
675 
676 static int uvd_v4_2_set_clockgating_state(void *handle,
677 					  enum amd_clockgating_state state)
678 {
679 	return 0;
680 }
681 
682 static int uvd_v4_2_set_powergating_state(void *handle,
683 					  enum amd_powergating_state state)
684 {
685 	/* This doesn't actually powergate the UVD block.
686 	 * That's done in the dpm code via the SMC.  This
687 	 * just re-inits the block as necessary.  The actual
688 	 * gating still happens in the dpm code.  We should
689 	 * revisit this when there is a cleaner line between
690 	 * the smc and the hw blocks
691 	 */
692 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
693 
694 	if (state == AMD_PG_STATE_GATE) {
695 		uvd_v4_2_stop(adev);
696 		if (adev->pg_flags & AMD_PG_SUPPORT_UVD && amdgpu_dpm == 0) {
697 			if (!(RREG32_SMC(ixCURRENT_PG_STATUS) & 0x4)) {
698 				WREG32(mmUVD_PGFSM_CONFIG, (UVD_PGFSM_CONFIG__UVD_PGFSM_FSM_ADDR_MASK   |
699 							UVD_PGFSM_CONFIG__UVD_PGFSM_POWER_DOWN_MASK |
700 							UVD_PGFSM_CONFIG__UVD_PGFSM_P1_SELECT_MASK));
701 				mdelay(20);
702 			}
703 		}
704 		return 0;
705 	} else {
706 		if (adev->pg_flags & AMD_PG_SUPPORT_UVD && amdgpu_dpm == 0) {
707 			if (RREG32_SMC(ixCURRENT_PG_STATUS) & 0x4) {
708 				WREG32(mmUVD_PGFSM_CONFIG, (UVD_PGFSM_CONFIG__UVD_PGFSM_FSM_ADDR_MASK   |
709 						UVD_PGFSM_CONFIG__UVD_PGFSM_POWER_UP_MASK |
710 						UVD_PGFSM_CONFIG__UVD_PGFSM_P1_SELECT_MASK));
711 				mdelay(30);
712 			}
713 		}
714 		return uvd_v4_2_start(adev);
715 	}
716 }
717 
718 static const struct amd_ip_funcs uvd_v4_2_ip_funcs = {
719 	.name = "uvd_v4_2",
720 	.early_init = uvd_v4_2_early_init,
721 	.late_init = NULL,
722 	.sw_init = uvd_v4_2_sw_init,
723 	.sw_fini = uvd_v4_2_sw_fini,
724 	.hw_init = uvd_v4_2_hw_init,
725 	.hw_fini = uvd_v4_2_hw_fini,
726 	.suspend = uvd_v4_2_suspend,
727 	.resume = uvd_v4_2_resume,
728 	.is_idle = uvd_v4_2_is_idle,
729 	.wait_for_idle = uvd_v4_2_wait_for_idle,
730 	.soft_reset = uvd_v4_2_soft_reset,
731 	.set_clockgating_state = uvd_v4_2_set_clockgating_state,
732 	.set_powergating_state = uvd_v4_2_set_powergating_state,
733 };
734 
735 static const struct amdgpu_ring_funcs uvd_v4_2_ring_funcs = {
736 	.type = AMDGPU_RING_TYPE_UVD,
737 	.align_mask = 0xf,
738 	.nop = PACKET0(mmUVD_NO_OP, 0),
739 	.get_rptr = uvd_v4_2_ring_get_rptr,
740 	.get_wptr = uvd_v4_2_ring_get_wptr,
741 	.set_wptr = uvd_v4_2_ring_set_wptr,
742 	.parse_cs = amdgpu_uvd_ring_parse_cs,
743 	.emit_frame_size =
744 		2 + /* uvd_v4_2_ring_emit_hdp_flush */
745 		2 + /* uvd_v4_2_ring_emit_hdp_invalidate */
746 		14, /* uvd_v4_2_ring_emit_fence  x1 no user fence */
747 	.emit_ib_size = 4, /* uvd_v4_2_ring_emit_ib */
748 	.emit_ib = uvd_v4_2_ring_emit_ib,
749 	.emit_fence = uvd_v4_2_ring_emit_fence,
750 	.emit_hdp_flush = uvd_v4_2_ring_emit_hdp_flush,
751 	.emit_hdp_invalidate = uvd_v4_2_ring_emit_hdp_invalidate,
752 	.test_ring = uvd_v4_2_ring_test_ring,
753 	.test_ib = amdgpu_uvd_ring_test_ib,
754 	.insert_nop = amdgpu_ring_insert_nop,
755 	.pad_ib = amdgpu_ring_generic_pad_ib,
756 	.begin_use = amdgpu_uvd_ring_begin_use,
757 	.end_use = amdgpu_uvd_ring_end_use,
758 };
759 
760 static void uvd_v4_2_set_ring_funcs(struct amdgpu_device *adev)
761 {
762 	adev->uvd.ring.funcs = &uvd_v4_2_ring_funcs;
763 }
764 
765 static const struct amdgpu_irq_src_funcs uvd_v4_2_irq_funcs = {
766 	.set = uvd_v4_2_set_interrupt_state,
767 	.process = uvd_v4_2_process_interrupt,
768 };
769 
770 static void uvd_v4_2_set_irq_funcs(struct amdgpu_device *adev)
771 {
772 	adev->uvd.irq.num_types = 1;
773 	adev->uvd.irq.funcs = &uvd_v4_2_irq_funcs;
774 }
775 
776 const struct amdgpu_ip_block_version uvd_v4_2_ip_block =
777 {
778 		.type = AMD_IP_BLOCK_TYPE_UVD,
779 		.major = 4,
780 		.minor = 2,
781 		.rev = 0,
782 		.funcs = &uvd_v4_2_ip_funcs,
783 };
784