xref: /openbmc/linux/drivers/gpu/drm/amd/amdgpu/uvd_v5_0.c (revision 254cd2e0)
1 /*
2  * Copyright 2014 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 "vid.h"
30 #include "uvd/uvd_5_0_d.h"
31 #include "uvd/uvd_5_0_sh_mask.h"
32 #include "oss/oss_2_0_d.h"
33 #include "oss/oss_2_0_sh_mask.h"
34 #include "bif/bif_5_0_d.h"
35 #include "vi.h"
36 #include "smu/smu_7_1_2_d.h"
37 #include "smu/smu_7_1_2_sh_mask.h"
38 
39 static void uvd_v5_0_set_ring_funcs(struct amdgpu_device *adev);
40 static void uvd_v5_0_set_irq_funcs(struct amdgpu_device *adev);
41 static int uvd_v5_0_start(struct amdgpu_device *adev);
42 static void uvd_v5_0_stop(struct amdgpu_device *adev);
43 static int uvd_v5_0_set_clockgating_state(void *handle,
44 					  enum amd_clockgating_state state);
45 static void uvd_v5_0_enable_mgcg(struct amdgpu_device *adev,
46 				 bool enable);
47 /**
48  * uvd_v5_0_ring_get_rptr - get read pointer
49  *
50  * @ring: amdgpu_ring pointer
51  *
52  * Returns the current hardware read pointer
53  */
54 static uint32_t uvd_v5_0_ring_get_rptr(struct amdgpu_ring *ring)
55 {
56 	struct amdgpu_device *adev = ring->adev;
57 
58 	return RREG32(mmUVD_RBC_RB_RPTR);
59 }
60 
61 /**
62  * uvd_v5_0_ring_get_wptr - get write pointer
63  *
64  * @ring: amdgpu_ring pointer
65  *
66  * Returns the current hardware write pointer
67  */
68 static uint32_t uvd_v5_0_ring_get_wptr(struct amdgpu_ring *ring)
69 {
70 	struct amdgpu_device *adev = ring->adev;
71 
72 	return RREG32(mmUVD_RBC_RB_WPTR);
73 }
74 
75 /**
76  * uvd_v5_0_ring_set_wptr - set write pointer
77  *
78  * @ring: amdgpu_ring pointer
79  *
80  * Commits the write pointer to the hardware
81  */
82 static void uvd_v5_0_ring_set_wptr(struct amdgpu_ring *ring)
83 {
84 	struct amdgpu_device *adev = ring->adev;
85 
86 	WREG32(mmUVD_RBC_RB_WPTR, ring->wptr);
87 }
88 
89 static int uvd_v5_0_early_init(void *handle)
90 {
91 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
92 
93 	uvd_v5_0_set_ring_funcs(adev);
94 	uvd_v5_0_set_irq_funcs(adev);
95 
96 	return 0;
97 }
98 
99 static int uvd_v5_0_sw_init(void *handle)
100 {
101 	struct amdgpu_ring *ring;
102 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
103 	int r;
104 
105 	/* UVD TRAP */
106 	r = amdgpu_irq_add_id(adev, 124, &adev->uvd.irq);
107 	if (r)
108 		return r;
109 
110 	r = amdgpu_uvd_sw_init(adev);
111 	if (r)
112 		return r;
113 
114 	r = amdgpu_uvd_resume(adev);
115 	if (r)
116 		return r;
117 
118 	ring = &adev->uvd.ring;
119 	sprintf(ring->name, "uvd");
120 	r = amdgpu_ring_init(adev, ring, 512, &adev->uvd.irq, 0);
121 
122 	return r;
123 }
124 
125 static int uvd_v5_0_sw_fini(void *handle)
126 {
127 	int r;
128 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
129 
130 	r = amdgpu_uvd_suspend(adev);
131 	if (r)
132 		return r;
133 
134 	r = amdgpu_uvd_sw_fini(adev);
135 	if (r)
136 		return r;
137 
138 	return r;
139 }
140 
141 /**
142  * uvd_v5_0_hw_init - start and test UVD block
143  *
144  * @adev: amdgpu_device pointer
145  *
146  * Initialize the hardware, boot up the VCPU and do some testing
147  */
148 static int uvd_v5_0_hw_init(void *handle)
149 {
150 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
151 	struct amdgpu_ring *ring = &adev->uvd.ring;
152 	uint32_t tmp;
153 	int r;
154 
155 	amdgpu_asic_set_uvd_clocks(adev, 10000, 10000);
156 	uvd_v5_0_set_clockgating_state(adev, AMD_CG_STATE_UNGATE);
157 	uvd_v5_0_enable_mgcg(adev, true);
158 
159 	ring->ready = true;
160 	r = amdgpu_ring_test_ring(ring);
161 	if (r) {
162 		ring->ready = false;
163 		goto done;
164 	}
165 
166 	r = amdgpu_ring_alloc(ring, 10);
167 	if (r) {
168 		DRM_ERROR("amdgpu: ring failed to lock UVD ring (%d).\n", r);
169 		goto done;
170 	}
171 
172 	tmp = PACKET0(mmUVD_SEMA_WAIT_FAULT_TIMEOUT_CNTL, 0);
173 	amdgpu_ring_write(ring, tmp);
174 	amdgpu_ring_write(ring, 0xFFFFF);
175 
176 	tmp = PACKET0(mmUVD_SEMA_WAIT_INCOMPLETE_TIMEOUT_CNTL, 0);
177 	amdgpu_ring_write(ring, tmp);
178 	amdgpu_ring_write(ring, 0xFFFFF);
179 
180 	tmp = PACKET0(mmUVD_SEMA_SIGNAL_INCOMPLETE_TIMEOUT_CNTL, 0);
181 	amdgpu_ring_write(ring, tmp);
182 	amdgpu_ring_write(ring, 0xFFFFF);
183 
184 	/* Clear timeout status bits */
185 	amdgpu_ring_write(ring, PACKET0(mmUVD_SEMA_TIMEOUT_STATUS, 0));
186 	amdgpu_ring_write(ring, 0x8);
187 
188 	amdgpu_ring_write(ring, PACKET0(mmUVD_SEMA_CNTL, 0));
189 	amdgpu_ring_write(ring, 3);
190 
191 	amdgpu_ring_commit(ring);
192 
193 done:
194 	if (!r)
195 		DRM_INFO("UVD initialized successfully.\n");
196 
197 	return r;
198 
199 }
200 
201 /**
202  * uvd_v5_0_hw_fini - stop the hardware block
203  *
204  * @adev: amdgpu_device pointer
205  *
206  * Stop the UVD block, mark ring as not ready any more
207  */
208 static int uvd_v5_0_hw_fini(void *handle)
209 {
210 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
211 	struct amdgpu_ring *ring = &adev->uvd.ring;
212 
213 	if (RREG32(mmUVD_STATUS) != 0)
214 		uvd_v5_0_stop(adev);
215 
216 	ring->ready = false;
217 
218 	return 0;
219 }
220 
221 static int uvd_v5_0_suspend(void *handle)
222 {
223 	int r;
224 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
225 
226 	r = uvd_v5_0_hw_fini(adev);
227 	if (r)
228 		return r;
229 	uvd_v5_0_set_clockgating_state(adev, AMD_CG_STATE_GATE);
230 
231 	r = amdgpu_uvd_suspend(adev);
232 	if (r)
233 		return r;
234 
235 	return r;
236 }
237 
238 static int uvd_v5_0_resume(void *handle)
239 {
240 	int r;
241 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
242 
243 	r = amdgpu_uvd_resume(adev);
244 	if (r)
245 		return r;
246 
247 	r = uvd_v5_0_hw_init(adev);
248 	if (r)
249 		return r;
250 
251 	return r;
252 }
253 
254 /**
255  * uvd_v5_0_mc_resume - memory controller programming
256  *
257  * @adev: amdgpu_device pointer
258  *
259  * Let the UVD memory controller know it's offsets
260  */
261 static void uvd_v5_0_mc_resume(struct amdgpu_device *adev)
262 {
263 	uint64_t offset;
264 	uint32_t size;
265 
266 	/* programm memory controller bits 0-27 */
267 	WREG32(mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW,
268 			lower_32_bits(adev->uvd.gpu_addr));
269 	WREG32(mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH,
270 			upper_32_bits(adev->uvd.gpu_addr));
271 
272 	offset = AMDGPU_UVD_FIRMWARE_OFFSET;
273 	size = AMDGPU_GPU_PAGE_ALIGN(adev->uvd.fw->size + 4);
274 	WREG32(mmUVD_VCPU_CACHE_OFFSET0, offset >> 3);
275 	WREG32(mmUVD_VCPU_CACHE_SIZE0, size);
276 
277 	offset += size;
278 	size = AMDGPU_UVD_HEAP_SIZE;
279 	WREG32(mmUVD_VCPU_CACHE_OFFSET1, offset >> 3);
280 	WREG32(mmUVD_VCPU_CACHE_SIZE1, size);
281 
282 	offset += size;
283 	size = AMDGPU_UVD_STACK_SIZE +
284 	       (AMDGPU_UVD_SESSION_SIZE * adev->uvd.max_handles);
285 	WREG32(mmUVD_VCPU_CACHE_OFFSET2, offset >> 3);
286 	WREG32(mmUVD_VCPU_CACHE_SIZE2, size);
287 
288 	WREG32(mmUVD_UDEC_ADDR_CONFIG, adev->gfx.config.gb_addr_config);
289 	WREG32(mmUVD_UDEC_DB_ADDR_CONFIG, adev->gfx.config.gb_addr_config);
290 	WREG32(mmUVD_UDEC_DBW_ADDR_CONFIG, adev->gfx.config.gb_addr_config);
291 }
292 
293 /**
294  * uvd_v5_0_start - start UVD block
295  *
296  * @adev: amdgpu_device pointer
297  *
298  * Setup and start the UVD block
299  */
300 static int uvd_v5_0_start(struct amdgpu_device *adev)
301 {
302 	struct amdgpu_ring *ring = &adev->uvd.ring;
303 	uint32_t rb_bufsz, tmp;
304 	uint32_t lmi_swap_cntl;
305 	uint32_t mp_swap_cntl;
306 	int i, j, r;
307 
308 	/*disable DPG */
309 	WREG32_P(mmUVD_POWER_STATUS, 0, ~(1 << 2));
310 
311 	/* disable byte swapping */
312 	lmi_swap_cntl = 0;
313 	mp_swap_cntl = 0;
314 
315 	uvd_v5_0_mc_resume(adev);
316 
317 	/* disable interupt */
318 	WREG32_P(mmUVD_MASTINT_EN, 0, ~(1 << 1));
319 
320 	/* stall UMC and register bus before resetting VCPU */
321 	WREG32_P(mmUVD_LMI_CTRL2, 1 << 8, ~(1 << 8));
322 	mdelay(1);
323 
324 	/* put LMI, VCPU, RBC etc... into reset */
325 	WREG32(mmUVD_SOFT_RESET, UVD_SOFT_RESET__LMI_SOFT_RESET_MASK |
326 		UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK | UVD_SOFT_RESET__LBSI_SOFT_RESET_MASK |
327 		UVD_SOFT_RESET__RBC_SOFT_RESET_MASK | UVD_SOFT_RESET__CSM_SOFT_RESET_MASK |
328 		UVD_SOFT_RESET__CXW_SOFT_RESET_MASK | UVD_SOFT_RESET__TAP_SOFT_RESET_MASK |
329 		UVD_SOFT_RESET__LMI_UMC_SOFT_RESET_MASK);
330 	mdelay(5);
331 
332 	/* take UVD block out of reset */
333 	WREG32_P(mmSRBM_SOFT_RESET, 0, ~SRBM_SOFT_RESET__SOFT_RESET_UVD_MASK);
334 	mdelay(5);
335 
336 	/* initialize UVD memory controller */
337 	WREG32(mmUVD_LMI_CTRL, 0x40 | (1 << 8) | (1 << 13) |
338 			     (1 << 21) | (1 << 9) | (1 << 20));
339 
340 #ifdef __BIG_ENDIAN
341 	/* swap (8 in 32) RB and IB */
342 	lmi_swap_cntl = 0xa;
343 	mp_swap_cntl = 0;
344 #endif
345 	WREG32(mmUVD_LMI_SWAP_CNTL, lmi_swap_cntl);
346 	WREG32(mmUVD_MP_SWAP_CNTL, mp_swap_cntl);
347 
348 	WREG32(mmUVD_MPC_SET_MUXA0, 0x40c2040);
349 	WREG32(mmUVD_MPC_SET_MUXA1, 0x0);
350 	WREG32(mmUVD_MPC_SET_MUXB0, 0x40c2040);
351 	WREG32(mmUVD_MPC_SET_MUXB1, 0x0);
352 	WREG32(mmUVD_MPC_SET_ALU, 0);
353 	WREG32(mmUVD_MPC_SET_MUX, 0x88);
354 
355 	/* take all subblocks out of reset, except VCPU */
356 	WREG32(mmUVD_SOFT_RESET, UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
357 	mdelay(5);
358 
359 	/* enable VCPU clock */
360 	WREG32(mmUVD_VCPU_CNTL,  1 << 9);
361 
362 	/* enable UMC */
363 	WREG32_P(mmUVD_LMI_CTRL2, 0, ~(1 << 8));
364 
365 	/* boot up the VCPU */
366 	WREG32(mmUVD_SOFT_RESET, 0);
367 	mdelay(10);
368 
369 	for (i = 0; i < 10; ++i) {
370 		uint32_t status;
371 		for (j = 0; j < 100; ++j) {
372 			status = RREG32(mmUVD_STATUS);
373 			if (status & 2)
374 				break;
375 			mdelay(10);
376 		}
377 		r = 0;
378 		if (status & 2)
379 			break;
380 
381 		DRM_ERROR("UVD not responding, trying to reset the VCPU!!!\n");
382 		WREG32_P(mmUVD_SOFT_RESET, UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK,
383 				~UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
384 		mdelay(10);
385 		WREG32_P(mmUVD_SOFT_RESET, 0, ~UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
386 		mdelay(10);
387 		r = -1;
388 	}
389 
390 	if (r) {
391 		DRM_ERROR("UVD not responding, giving up!!!\n");
392 		return r;
393 	}
394 	/* enable master interrupt */
395 	WREG32_P(mmUVD_MASTINT_EN, 3 << 1, ~(3 << 1));
396 
397 	/* clear the bit 4 of UVD_STATUS */
398 	WREG32_P(mmUVD_STATUS, 0, ~(2 << 1));
399 
400 	rb_bufsz = order_base_2(ring->ring_size);
401 	tmp = 0;
402 	tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_BUFSZ, rb_bufsz);
403 	tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_BLKSZ, 1);
404 	tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_FETCH, 1);
405 	tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_WPTR_POLL_EN, 0);
406 	tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_UPDATE, 1);
407 	tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_RPTR_WR_EN, 1);
408 	/* force RBC into idle state */
409 	WREG32(mmUVD_RBC_RB_CNTL, tmp);
410 
411 	/* set the write pointer delay */
412 	WREG32(mmUVD_RBC_RB_WPTR_CNTL, 0);
413 
414 	/* set the wb address */
415 	WREG32(mmUVD_RBC_RB_RPTR_ADDR, (upper_32_bits(ring->gpu_addr) >> 2));
416 
417 	/* programm the RB_BASE for ring buffer */
418 	WREG32(mmUVD_LMI_RBC_RB_64BIT_BAR_LOW,
419 			lower_32_bits(ring->gpu_addr));
420 	WREG32(mmUVD_LMI_RBC_RB_64BIT_BAR_HIGH,
421 			upper_32_bits(ring->gpu_addr));
422 
423 	/* Initialize the ring buffer's read and write pointers */
424 	WREG32(mmUVD_RBC_RB_RPTR, 0);
425 
426 	ring->wptr = RREG32(mmUVD_RBC_RB_RPTR);
427 	WREG32(mmUVD_RBC_RB_WPTR, ring->wptr);
428 
429 	WREG32_P(mmUVD_RBC_RB_CNTL, 0, ~UVD_RBC_RB_CNTL__RB_NO_FETCH_MASK);
430 
431 	return 0;
432 }
433 
434 /**
435  * uvd_v5_0_stop - stop UVD block
436  *
437  * @adev: amdgpu_device pointer
438  *
439  * stop the UVD block
440  */
441 static void uvd_v5_0_stop(struct amdgpu_device *adev)
442 {
443 	/* force RBC into idle state */
444 	WREG32(mmUVD_RBC_RB_CNTL, 0x11010101);
445 
446 	/* Stall UMC and register bus before resetting VCPU */
447 	WREG32_P(mmUVD_LMI_CTRL2, 1 << 8, ~(1 << 8));
448 	mdelay(1);
449 
450 	/* put VCPU into reset */
451 	WREG32(mmUVD_SOFT_RESET, UVD_SOFT_RESET__VCPU_SOFT_RESET_MASK);
452 	mdelay(5);
453 
454 	/* disable VCPU clock */
455 	WREG32(mmUVD_VCPU_CNTL, 0x0);
456 
457 	/* Unstall UMC and register bus */
458 	WREG32_P(mmUVD_LMI_CTRL2, 0, ~(1 << 8));
459 
460 	WREG32(mmUVD_STATUS, 0);
461 }
462 
463 /**
464  * uvd_v5_0_ring_emit_fence - emit an fence & trap command
465  *
466  * @ring: amdgpu_ring pointer
467  * @fence: fence to emit
468  *
469  * Write a fence and a trap command to the ring.
470  */
471 static void uvd_v5_0_ring_emit_fence(struct amdgpu_ring *ring, u64 addr, u64 seq,
472 				     unsigned flags)
473 {
474 	WARN_ON(flags & AMDGPU_FENCE_FLAG_64BIT);
475 
476 	amdgpu_ring_write(ring, PACKET0(mmUVD_CONTEXT_ID, 0));
477 	amdgpu_ring_write(ring, seq);
478 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_DATA0, 0));
479 	amdgpu_ring_write(ring, addr & 0xffffffff);
480 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_DATA1, 0));
481 	amdgpu_ring_write(ring, upper_32_bits(addr) & 0xff);
482 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_CMD, 0));
483 	amdgpu_ring_write(ring, 0);
484 
485 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_DATA0, 0));
486 	amdgpu_ring_write(ring, 0);
487 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_DATA1, 0));
488 	amdgpu_ring_write(ring, 0);
489 	amdgpu_ring_write(ring, PACKET0(mmUVD_GPCOM_VCPU_CMD, 0));
490 	amdgpu_ring_write(ring, 2);
491 }
492 
493 /**
494  * uvd_v5_0_ring_emit_hdp_flush - emit an hdp flush
495  *
496  * @ring: amdgpu_ring pointer
497  *
498  * Emits an hdp flush.
499  */
500 static void uvd_v5_0_ring_emit_hdp_flush(struct amdgpu_ring *ring)
501 {
502 	amdgpu_ring_write(ring, PACKET0(mmHDP_MEM_COHERENCY_FLUSH_CNTL, 0));
503 	amdgpu_ring_write(ring, 0);
504 }
505 
506 /**
507  * uvd_v5_0_ring_hdp_invalidate - emit an hdp invalidate
508  *
509  * @ring: amdgpu_ring pointer
510  *
511  * Emits an hdp invalidate.
512  */
513 static void uvd_v5_0_ring_emit_hdp_invalidate(struct amdgpu_ring *ring)
514 {
515 	amdgpu_ring_write(ring, PACKET0(mmHDP_DEBUG0, 0));
516 	amdgpu_ring_write(ring, 1);
517 }
518 
519 /**
520  * uvd_v5_0_ring_test_ring - register write test
521  *
522  * @ring: amdgpu_ring pointer
523  *
524  * Test if we can successfully write to the context register
525  */
526 static int uvd_v5_0_ring_test_ring(struct amdgpu_ring *ring)
527 {
528 	struct amdgpu_device *adev = ring->adev;
529 	uint32_t tmp = 0;
530 	unsigned i;
531 	int r;
532 
533 	WREG32(mmUVD_CONTEXT_ID, 0xCAFEDEAD);
534 	r = amdgpu_ring_alloc(ring, 3);
535 	if (r) {
536 		DRM_ERROR("amdgpu: cp failed to lock ring %d (%d).\n",
537 			  ring->idx, r);
538 		return r;
539 	}
540 	amdgpu_ring_write(ring, PACKET0(mmUVD_CONTEXT_ID, 0));
541 	amdgpu_ring_write(ring, 0xDEADBEEF);
542 	amdgpu_ring_commit(ring);
543 	for (i = 0; i < adev->usec_timeout; i++) {
544 		tmp = RREG32(mmUVD_CONTEXT_ID);
545 		if (tmp == 0xDEADBEEF)
546 			break;
547 		DRM_UDELAY(1);
548 	}
549 
550 	if (i < adev->usec_timeout) {
551 		DRM_INFO("ring test on %d succeeded in %d usecs\n",
552 			 ring->idx, i);
553 	} else {
554 		DRM_ERROR("amdgpu: ring %d test failed (0x%08X)\n",
555 			  ring->idx, tmp);
556 		r = -EINVAL;
557 	}
558 	return r;
559 }
560 
561 /**
562  * uvd_v5_0_ring_emit_ib - execute indirect buffer
563  *
564  * @ring: amdgpu_ring pointer
565  * @ib: indirect buffer to execute
566  *
567  * Write ring commands to execute the indirect buffer
568  */
569 static void uvd_v5_0_ring_emit_ib(struct amdgpu_ring *ring,
570 				  struct amdgpu_ib *ib,
571 				  unsigned vm_id, bool ctx_switch)
572 {
573 	amdgpu_ring_write(ring, PACKET0(mmUVD_LMI_RBC_IB_64BIT_BAR_LOW, 0));
574 	amdgpu_ring_write(ring, lower_32_bits(ib->gpu_addr));
575 	amdgpu_ring_write(ring, PACKET0(mmUVD_LMI_RBC_IB_64BIT_BAR_HIGH, 0));
576 	amdgpu_ring_write(ring, upper_32_bits(ib->gpu_addr));
577 	amdgpu_ring_write(ring, PACKET0(mmUVD_RBC_IB_SIZE, 0));
578 	amdgpu_ring_write(ring, ib->length_dw);
579 }
580 
581 static bool uvd_v5_0_is_idle(void *handle)
582 {
583 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
584 
585 	return !(RREG32(mmSRBM_STATUS) & SRBM_STATUS__UVD_BUSY_MASK);
586 }
587 
588 static int uvd_v5_0_wait_for_idle(void *handle)
589 {
590 	unsigned i;
591 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
592 
593 	for (i = 0; i < adev->usec_timeout; i++) {
594 		if (!(RREG32(mmSRBM_STATUS) & SRBM_STATUS__UVD_BUSY_MASK))
595 			return 0;
596 	}
597 	return -ETIMEDOUT;
598 }
599 
600 static int uvd_v5_0_soft_reset(void *handle)
601 {
602 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
603 
604 	uvd_v5_0_stop(adev);
605 
606 	WREG32_P(mmSRBM_SOFT_RESET, SRBM_SOFT_RESET__SOFT_RESET_UVD_MASK,
607 			~SRBM_SOFT_RESET__SOFT_RESET_UVD_MASK);
608 	mdelay(5);
609 
610 	return uvd_v5_0_start(adev);
611 }
612 
613 static int uvd_v5_0_set_interrupt_state(struct amdgpu_device *adev,
614 					struct amdgpu_irq_src *source,
615 					unsigned type,
616 					enum amdgpu_interrupt_state state)
617 {
618 	// TODO
619 	return 0;
620 }
621 
622 static int uvd_v5_0_process_interrupt(struct amdgpu_device *adev,
623 				      struct amdgpu_irq_src *source,
624 				      struct amdgpu_iv_entry *entry)
625 {
626 	DRM_DEBUG("IH: UVD TRAP\n");
627 	amdgpu_fence_process(&adev->uvd.ring);
628 	return 0;
629 }
630 
631 static void uvd_v5_0_enable_clock_gating(struct amdgpu_device *adev, bool enable)
632 {
633 	uint32_t data1, data3, suvd_flags;
634 
635 	data1 = RREG32(mmUVD_SUVD_CGC_GATE);
636 	data3 = RREG32(mmUVD_CGC_GATE);
637 
638 	suvd_flags = UVD_SUVD_CGC_GATE__SRE_MASK |
639 		     UVD_SUVD_CGC_GATE__SIT_MASK |
640 		     UVD_SUVD_CGC_GATE__SMP_MASK |
641 		     UVD_SUVD_CGC_GATE__SCM_MASK |
642 		     UVD_SUVD_CGC_GATE__SDB_MASK;
643 
644 	if (enable) {
645 		data3 |= (UVD_CGC_GATE__SYS_MASK     |
646 			UVD_CGC_GATE__UDEC_MASK      |
647 			UVD_CGC_GATE__MPEG2_MASK     |
648 			UVD_CGC_GATE__RBC_MASK       |
649 			UVD_CGC_GATE__LMI_MC_MASK    |
650 			UVD_CGC_GATE__IDCT_MASK      |
651 			UVD_CGC_GATE__MPRD_MASK      |
652 			UVD_CGC_GATE__MPC_MASK       |
653 			UVD_CGC_GATE__LBSI_MASK      |
654 			UVD_CGC_GATE__LRBBM_MASK     |
655 			UVD_CGC_GATE__UDEC_RE_MASK   |
656 			UVD_CGC_GATE__UDEC_CM_MASK   |
657 			UVD_CGC_GATE__UDEC_IT_MASK   |
658 			UVD_CGC_GATE__UDEC_DB_MASK   |
659 			UVD_CGC_GATE__UDEC_MP_MASK   |
660 			UVD_CGC_GATE__WCB_MASK       |
661 			UVD_CGC_GATE__JPEG_MASK      |
662 			UVD_CGC_GATE__SCPU_MASK);
663 		/* only in pg enabled, we can gate clock to vcpu*/
664 		if (adev->pg_flags & AMD_PG_SUPPORT_UVD)
665 			data3 |= UVD_CGC_GATE__VCPU_MASK;
666 		data3 &= ~UVD_CGC_GATE__REGS_MASK;
667 		data1 |= suvd_flags;
668 	} else {
669 		data3 = 0;
670 		data1 = 0;
671 	}
672 
673 	WREG32(mmUVD_SUVD_CGC_GATE, data1);
674 	WREG32(mmUVD_CGC_GATE, data3);
675 }
676 
677 static void uvd_v5_0_set_sw_clock_gating(struct amdgpu_device *adev)
678 {
679 	uint32_t data, data2;
680 
681 	data = RREG32(mmUVD_CGC_CTRL);
682 	data2 = RREG32(mmUVD_SUVD_CGC_CTRL);
683 
684 
685 	data &= ~(UVD_CGC_CTRL__CLK_OFF_DELAY_MASK |
686 		  UVD_CGC_CTRL__CLK_GATE_DLY_TIMER_MASK);
687 
688 
689 	data |= UVD_CGC_CTRL__DYN_CLOCK_MODE_MASK |
690 		(1 << REG_FIELD_SHIFT(UVD_CGC_CTRL, CLK_GATE_DLY_TIMER)) |
691 		(4 << REG_FIELD_SHIFT(UVD_CGC_CTRL, CLK_OFF_DELAY));
692 
693 	data &= ~(UVD_CGC_CTRL__UDEC_RE_MODE_MASK |
694 			UVD_CGC_CTRL__UDEC_CM_MODE_MASK |
695 			UVD_CGC_CTRL__UDEC_IT_MODE_MASK |
696 			UVD_CGC_CTRL__UDEC_DB_MODE_MASK |
697 			UVD_CGC_CTRL__UDEC_MP_MODE_MASK |
698 			UVD_CGC_CTRL__SYS_MODE_MASK |
699 			UVD_CGC_CTRL__UDEC_MODE_MASK |
700 			UVD_CGC_CTRL__MPEG2_MODE_MASK |
701 			UVD_CGC_CTRL__REGS_MODE_MASK |
702 			UVD_CGC_CTRL__RBC_MODE_MASK |
703 			UVD_CGC_CTRL__LMI_MC_MODE_MASK |
704 			UVD_CGC_CTRL__LMI_UMC_MODE_MASK |
705 			UVD_CGC_CTRL__IDCT_MODE_MASK |
706 			UVD_CGC_CTRL__MPRD_MODE_MASK |
707 			UVD_CGC_CTRL__MPC_MODE_MASK |
708 			UVD_CGC_CTRL__LBSI_MODE_MASK |
709 			UVD_CGC_CTRL__LRBBM_MODE_MASK |
710 			UVD_CGC_CTRL__WCB_MODE_MASK |
711 			UVD_CGC_CTRL__VCPU_MODE_MASK |
712 			UVD_CGC_CTRL__JPEG_MODE_MASK |
713 			UVD_CGC_CTRL__SCPU_MODE_MASK);
714 	data2 &= ~(UVD_SUVD_CGC_CTRL__SRE_MODE_MASK |
715 			UVD_SUVD_CGC_CTRL__SIT_MODE_MASK |
716 			UVD_SUVD_CGC_CTRL__SMP_MODE_MASK |
717 			UVD_SUVD_CGC_CTRL__SCM_MODE_MASK |
718 			UVD_SUVD_CGC_CTRL__SDB_MODE_MASK);
719 
720 	WREG32(mmUVD_CGC_CTRL, data);
721 	WREG32(mmUVD_SUVD_CGC_CTRL, data2);
722 }
723 
724 #if 0
725 static void uvd_v5_0_set_hw_clock_gating(struct amdgpu_device *adev)
726 {
727 	uint32_t data, data1, cgc_flags, suvd_flags;
728 
729 	data = RREG32(mmUVD_CGC_GATE);
730 	data1 = RREG32(mmUVD_SUVD_CGC_GATE);
731 
732 	cgc_flags = UVD_CGC_GATE__SYS_MASK |
733 				UVD_CGC_GATE__UDEC_MASK |
734 				UVD_CGC_GATE__MPEG2_MASK |
735 				UVD_CGC_GATE__RBC_MASK |
736 				UVD_CGC_GATE__LMI_MC_MASK |
737 				UVD_CGC_GATE__IDCT_MASK |
738 				UVD_CGC_GATE__MPRD_MASK |
739 				UVD_CGC_GATE__MPC_MASK |
740 				UVD_CGC_GATE__LBSI_MASK |
741 				UVD_CGC_GATE__LRBBM_MASK |
742 				UVD_CGC_GATE__UDEC_RE_MASK |
743 				UVD_CGC_GATE__UDEC_CM_MASK |
744 				UVD_CGC_GATE__UDEC_IT_MASK |
745 				UVD_CGC_GATE__UDEC_DB_MASK |
746 				UVD_CGC_GATE__UDEC_MP_MASK |
747 				UVD_CGC_GATE__WCB_MASK |
748 				UVD_CGC_GATE__VCPU_MASK |
749 				UVD_CGC_GATE__SCPU_MASK;
750 
751 	suvd_flags = UVD_SUVD_CGC_GATE__SRE_MASK |
752 				UVD_SUVD_CGC_GATE__SIT_MASK |
753 				UVD_SUVD_CGC_GATE__SMP_MASK |
754 				UVD_SUVD_CGC_GATE__SCM_MASK |
755 				UVD_SUVD_CGC_GATE__SDB_MASK;
756 
757 	data |= cgc_flags;
758 	data1 |= suvd_flags;
759 
760 	WREG32(mmUVD_CGC_GATE, data);
761 	WREG32(mmUVD_SUVD_CGC_GATE, data1);
762 }
763 #endif
764 
765 static void uvd_v5_0_enable_mgcg(struct amdgpu_device *adev,
766 				 bool enable)
767 {
768 	u32 orig, data;
769 
770 	if (enable && (adev->cg_flags & AMD_CG_SUPPORT_UVD_MGCG)) {
771 		data = RREG32_UVD_CTX(ixUVD_CGC_MEM_CTRL);
772 		data |= 0xfff;
773 		WREG32_UVD_CTX(ixUVD_CGC_MEM_CTRL, data);
774 
775 		orig = data = RREG32(mmUVD_CGC_CTRL);
776 		data |= UVD_CGC_CTRL__DYN_CLOCK_MODE_MASK;
777 		if (orig != data)
778 			WREG32(mmUVD_CGC_CTRL, data);
779 	} else {
780 		data = RREG32_UVD_CTX(ixUVD_CGC_MEM_CTRL);
781 		data &= ~0xfff;
782 		WREG32_UVD_CTX(ixUVD_CGC_MEM_CTRL, data);
783 
784 		orig = data = RREG32(mmUVD_CGC_CTRL);
785 		data &= ~UVD_CGC_CTRL__DYN_CLOCK_MODE_MASK;
786 		if (orig != data)
787 			WREG32(mmUVD_CGC_CTRL, data);
788 	}
789 }
790 
791 static int uvd_v5_0_set_clockgating_state(void *handle,
792 					  enum amd_clockgating_state state)
793 {
794 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
795 	bool enable = (state == AMD_CG_STATE_GATE) ? true : false;
796 
797 	if (enable) {
798 		/* wait for STATUS to clear */
799 		if (uvd_v5_0_wait_for_idle(handle))
800 			return -EBUSY;
801 		uvd_v5_0_enable_clock_gating(adev, true);
802 
803 		/* enable HW gates because UVD is idle */
804 /*		uvd_v5_0_set_hw_clock_gating(adev); */
805 	} else {
806 		uvd_v5_0_enable_clock_gating(adev, false);
807 	}
808 
809 	uvd_v5_0_set_sw_clock_gating(adev);
810 	return 0;
811 }
812 
813 static int uvd_v5_0_set_powergating_state(void *handle,
814 					  enum amd_powergating_state state)
815 {
816 	/* This doesn't actually powergate the UVD block.
817 	 * That's done in the dpm code via the SMC.  This
818 	 * just re-inits the block as necessary.  The actual
819 	 * gating still happens in the dpm code.  We should
820 	 * revisit this when there is a cleaner line between
821 	 * the smc and the hw blocks
822 	 */
823 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
824 	int ret = 0;
825 
826 	if (state == AMD_PG_STATE_GATE) {
827 		uvd_v5_0_stop(adev);
828 	} else {
829 		ret = uvd_v5_0_start(adev);
830 		if (ret)
831 			goto out;
832 	}
833 
834 out:
835 	return ret;
836 }
837 
838 static void uvd_v5_0_get_clockgating_state(void *handle, u32 *flags)
839 {
840 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
841 	int data;
842 
843 	mutex_lock(&adev->pm.mutex);
844 
845 	if (RREG32_SMC(ixCURRENT_PG_STATUS) &
846 				CURRENT_PG_STATUS__UVD_PG_STATUS_MASK) {
847 		DRM_INFO("Cannot get clockgating state when UVD is powergated.\n");
848 		goto out;
849 	}
850 
851 	/* AMD_CG_SUPPORT_UVD_MGCG */
852 	data = RREG32(mmUVD_CGC_CTRL);
853 	if (data & UVD_CGC_CTRL__DYN_CLOCK_MODE_MASK)
854 		*flags |= AMD_CG_SUPPORT_UVD_MGCG;
855 
856 out:
857 	mutex_unlock(&adev->pm.mutex);
858 }
859 
860 static const struct amd_ip_funcs uvd_v5_0_ip_funcs = {
861 	.name = "uvd_v5_0",
862 	.early_init = uvd_v5_0_early_init,
863 	.late_init = NULL,
864 	.sw_init = uvd_v5_0_sw_init,
865 	.sw_fini = uvd_v5_0_sw_fini,
866 	.hw_init = uvd_v5_0_hw_init,
867 	.hw_fini = uvd_v5_0_hw_fini,
868 	.suspend = uvd_v5_0_suspend,
869 	.resume = uvd_v5_0_resume,
870 	.is_idle = uvd_v5_0_is_idle,
871 	.wait_for_idle = uvd_v5_0_wait_for_idle,
872 	.soft_reset = uvd_v5_0_soft_reset,
873 	.set_clockgating_state = uvd_v5_0_set_clockgating_state,
874 	.set_powergating_state = uvd_v5_0_set_powergating_state,
875 	.get_clockgating_state = uvd_v5_0_get_clockgating_state,
876 };
877 
878 static const struct amdgpu_ring_funcs uvd_v5_0_ring_funcs = {
879 	.type = AMDGPU_RING_TYPE_UVD,
880 	.align_mask = 0xf,
881 	.nop = PACKET0(mmUVD_NO_OP, 0),
882 	.get_rptr = uvd_v5_0_ring_get_rptr,
883 	.get_wptr = uvd_v5_0_ring_get_wptr,
884 	.set_wptr = uvd_v5_0_ring_set_wptr,
885 	.parse_cs = amdgpu_uvd_ring_parse_cs,
886 	.emit_frame_size =
887 		2 + /* uvd_v5_0_ring_emit_hdp_flush */
888 		2 + /* uvd_v5_0_ring_emit_hdp_invalidate */
889 		14, /* uvd_v5_0_ring_emit_fence  x1 no user fence */
890 	.emit_ib_size = 6, /* uvd_v5_0_ring_emit_ib */
891 	.emit_ib = uvd_v5_0_ring_emit_ib,
892 	.emit_fence = uvd_v5_0_ring_emit_fence,
893 	.emit_hdp_flush = uvd_v5_0_ring_emit_hdp_flush,
894 	.emit_hdp_invalidate = uvd_v5_0_ring_emit_hdp_invalidate,
895 	.test_ring = uvd_v5_0_ring_test_ring,
896 	.test_ib = amdgpu_uvd_ring_test_ib,
897 	.insert_nop = amdgpu_ring_insert_nop,
898 	.pad_ib = amdgpu_ring_generic_pad_ib,
899 	.begin_use = amdgpu_uvd_ring_begin_use,
900 	.end_use = amdgpu_uvd_ring_end_use,
901 };
902 
903 static void uvd_v5_0_set_ring_funcs(struct amdgpu_device *adev)
904 {
905 	adev->uvd.ring.funcs = &uvd_v5_0_ring_funcs;
906 }
907 
908 static const struct amdgpu_irq_src_funcs uvd_v5_0_irq_funcs = {
909 	.set = uvd_v5_0_set_interrupt_state,
910 	.process = uvd_v5_0_process_interrupt,
911 };
912 
913 static void uvd_v5_0_set_irq_funcs(struct amdgpu_device *adev)
914 {
915 	adev->uvd.irq.num_types = 1;
916 	adev->uvd.irq.funcs = &uvd_v5_0_irq_funcs;
917 }
918 
919 const struct amdgpu_ip_block_version uvd_v5_0_ip_block =
920 {
921 		.type = AMD_IP_BLOCK_TYPE_UVD,
922 		.major = 5,
923 		.minor = 0,
924 		.rev = 0,
925 		.funcs = &uvd_v5_0_ip_funcs,
926 };
927