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